Added (untested) motor control code to motor driver add-on library