Created a class to test running a motor at a variety of speeds.
Refactored mutlithreaded code a bit.
PID ball following works on blocks.

Still needs to be calibrated on the ground.