Added auto-tuning class - not quite 100% yet, but close; made some minor changes to the controller and config classes
Fixed the auto-tuner and integrated it into the state machine; fixed units on Kd gain