refactoring to pass CM730 by reference.
new class "joint" to wrap around all joint low-level actions.
new getter/setter for torque enable.