Added error message for an empty list of collision_links
Added the ability to recompute the distance field when calling setRobotState()