Fixing handling of non-world frame velocities in setModelState.

To fix the issue described here: http://answers.ros.org/question/191924/coordinate-frames-in-set_model_state-topic-with-gazebo_ros/