16 Commits (bugfix/gazebo_rviz)