Rewrote the motor driver to control DRV8801