Some fixes to make the code compile. Whoops...
Mostly just switched back to USB output for the serial - Also small fix

Fixed it up so DMOC is set to RPM mode when not using throttle.