提高初学者的PID——采样时间
初学者的PID被称作不规则的,这就有了以下两个问题:
》你没有从PID中得到一致的状态特性,因为有时它是非常快的变化,有时却没有。
》你需要额外的数学运算解决微分和积分,它们都同时依赖于时间的变化。
解决方法:
确保PID定义在一个固定的时间间隔里。我这样做的原因是让compute指令每个周期都被调用一次。根据之前设定好的采样周期,PID决定是该计算还是立刻返回值。
一旦我们知道了PID是在一个恒定的时间内运算,微分和积分也就变得简单了。
代码:- /*working variables*/
- unsigned long lastTime;
- double Input, Output, Setpoint;
- double errSum, lastErr;
- double kp, ki, kd;
- int SampleTime = 1000; //1 sec
- void Compute()
- {
- unsigned long now = millis();
- int timeChange = (now - lastTime);
- if(timeChange>=SampleTime)
- {
- /*Compute all the working error variables*/
- double error = Setpoint - Input;
- errSum += error;
- double dErr = (error - lastErr);
-
- /*Compute PID Output*/
- Output = kp * error + ki * errSum + kd * dErr;
-
- /*Remember some variables for next time*/
- lastErr = error;
- lastTime = now;
- }
- }
-
- void SetTunings(double Kp, double Ki, double Kd)
- {
- double SampleTimeInSec = ((double)SampleTime)/1000;
- kp = Kp;
- ki = Ki * SampleTimeInSec;
- kd = Kd / SampleTimeInSec;
- }
-
- void SetSampleTime(int NewSampleTime)
- {
- if (NewSampleTime > 0)
- {
- double ratio = (double)NewSampleTime
- / (double)SampleTime;
- ki *= ratio;
- kd /= ratio;
- SampleTime = (unsigned long)NewSampleTime;
- }
- }
复制代码 在第10和第11行,如果它的时间可以计算出来,那就将由算法本身决定。因为我们现在知道样本之间的时间是相同的,我们并不需要不断乘以时间的变化。我们只需要适当调整Ki和Kd(30和31行),虽然在数学上的结果是等价的,但更有效。
虽然这样做又一个小小的波动。如果用户在操作过程中决定改变采样时间,Ki和Kd将需要重新调整来以对这一新的变化做出反应。这就第39-42行代码所处理的问题。
另外请注意我在第29行将采样时间转换成秒s了。严格的的说这是没有必要的,只是允许用户输入的Ki和Kd是uint型的s而不是ms。
……待续 |