Condense speedFactor code.
Servo numbers
Enable dynamixel_writeword() method
Everything now within 256 bytes