Lots of bug fixes and a new ADC function.

* Still updating motor speed control.
* Added one ADC utility function.