added integral term to the PID position controller