motor driver code

Adding some code to drive motors.  This will likely be modified heavily, but is a good starting point.