fix 2dof gazebo sim