Create collision detectior interface.
Add new fcl collition detector. (mesh and primitives)
Keep old fcl collision detector. (always mesh-mesh)