Express closest points in frame of first object.

src/distance_capsule_capsule.cpp

test/test_fcl_box_box_distance.cpp

test/test_fcl_capsule_box_1.cpp

test/test_fcl_capsule_box_2.cpp