Added _robotDescription from RobotMsg in stdr_robot.
Added robot_tools header
Added collision check for circular robot.