Fix computation of closest points in global frame.
Fix test_fcl_box_box_distance.
Add a test on distance computation between boxes.