second commit, added PID control