Sample between lower bound and upper bound in SampleSE2::sample.

   This fixes test_fcl_simple.
Add a test for distance computation between boxes.
Do not express closest points in local frame.