Added variable input to DynamixelController, needs to be tested