Do not express closest points in local frame.
Add a test in test_fcl_box_box_distance.
Remove useless code.