Create motor tester

[rreamy]

We want the ability to hook up to one of the testing boards and control up to 3 motors to aid in testing whether motors are good.

[rreamy]

Next steps:

1. figure out why the diagnostics program isn't working
2. clean up changes to the robot project (restore to what is currently on dev)