Fixed ADC read problem

We still need work getting it working. Will try PID controller next.