final version of ifma
merge
fix
-added send all positions and torques functions
-bug fix send position in radians
ups
-separate joints that can be controlled from joints that report their state
-Constructor that does not take the main function arguments
-report state for zero joints
-fix segmentation fault