PID增量算法,有程序可验证