New DC Servo code for Paul's new PCB.

Signed-off-by: Seb Lee-Delisle <sebleedelisle@gmail.com>