-added send all positions and torques functions
-bug fix send position in radians