Add clone method for Collision geometries

Except for Octree, as it seems a bit harder to handle it with the current Octomap API

Enable early stopping for GJK solver when computing contacts

inside CollisionRequest and enables its use when calling GJK

Add serialization