first commit with test code

This revision of the program has the motor/servo controllers set up, as
well as a little test code