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.
Merge pull request #33 from florent-lamiraux/master

Fix bug in capsule support function