Removed extra code.
Wrote motor controller code for the Teensy.