Added rbx2_gazebo for testing