gazebo_ros_control_test: fixed gravity force calculation