lots of testing and updating of code, PID almost works now