Simple arduino code using AdaFruit MotorShield for PD control of brushed motor.