Rewrote MotorDriver, put basic test code in main loop.