1. Added the ability to set the max torgue on the dynamixel servo.
2. Fixed a bug where the force/torque magnitudes were not getting collected properly