Added a stop message to be sent when close to object. Implemented code in motion to stop the robot in response to it.