Updated to publish to gazebo topics and added angle limits
Updated arm control