Fixed conversion from radian to degrees.
Added todo section in order to finish https://github.com/robotology/gazebo_yarp_plugins/issues/106

Thanks @traversaro