Fix bug in capsule support function

The computation of the nearest points does not seem to work properly. test_fcl_capsule_box_2 has been added to check this issue.