added code for publishing robot status in rviz and gazebo
code for constantly moving the robot in gazebo
set_model_state service call