put back PID loop, since encoders have been wired