Motor and Servo Common Code