Merge pull request #32 from florent-lamiraux/master

Add a test on distance computation between capsule and box.
Fix bug in capsule support function.

  - do not assume that input vector dir is normalized.
Split test_fcl_capsule_box into two tests:

  one is working, the other one fails to compute the nearest points although
  it properly computes the distance.