fcl 0.7.0 FCL: the Flexible Collision Library TRI Geometry Team BSD cmake libccd-dev eigen octomap catkin cmake