dynamixel controller adjusted, needs to be tested on robot
Added variable input to DynamixelController, needs to be tested
Dynamixelcontroller tested and working!
Merge branch 'improve_dynamixel'