Added _robotDescription from RobotMsg in stdr_robot.
Added robot_tools header
Added collision check for circular robot.
Added future_pose
Fixed collision avoidance with pose prediction