Modify test_fcl_capsule_capsule

  - use API distance function instead of selecting gjk solver.
Implement capsule capsule distance function instead of using gjk algorithm.

  - copied code from Wildmagic (http://www.geometrictools.com) nodified
    boost license.
  - collision detection calls distance function.