Made a pause function for the robot, its a service

If you send $ rosservice call /pause_robot true the robot will pause. A false command will un-pause it.