数字PID位置型算法