Xacro, Gazebo, and Control