Simple arduino code using AdaFruit MotorShield for PD control of brushed motor. - View it on GitHub