Few changes added to timing of torque balance before mass added.
Merge branch 'master' of https://github.com/JoshMarino/gazebo_and_ros_control