最近看到了Brett Beauregard发表的有关PID的系列文章,感觉对于理解PID算法很有帮助,于是将系列文章翻译过来!在自我提高的过程中,也希望对同道中人有所帮助。作者Brett Beauregard的原文网址:http://brettbeauregard.com/blog/2011/04/improving-the-beginner%E2%80%99s-pid-sample-time/
1、问题
初学者的PID设计为不规则地调用。这导致2个问题:
2、解决方案
为了确保定期调用PID。我决定采用这样的方法,就是指定每个周期调用计算函数。根据预先确定的采样时间,PID决定是否应立即计算或返回。
一旦我们知道PID以恒定间隔进行评估,也可以简化微分和积分计算。来点鼓励!
3、代码
/*working variables*/
unsigned long lastTime;
double Input,Output,Setpoint;
double errSum,lastErr;
double kp,ki,kd;
int SampleTime = ; //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)/;
kp = Kp;
ki = Ki * SampleTimeInSec;
kd = Kd / SampleTimeInSec;
}
void SetSampleTime(int NewSampleTime)
{
if (NewSampleTime > )
{
double ratio = (double)NewSampleTime
/ (double)SampleTime;
ki *= ratio;
kd /= ratio;
SampleTime = (unsigned long)NewSampleTime;
}
}
在第10行和第11行,算法现在决定是否需要计算。另外,因为我们现在知道样本之间的时间间隔是相同的,所以我们不需要经常乘以时间变化。我们只能适当地调整Ki和Kd(第31和32行),结果在数学上是等价的,但效率更高。
尽管如此,这样做还有点小问题。如果用户决定在操作期间更改采样时间,则需要重新调整Ki和Kd以反映这一新变化。这就是39-42行的全部内容。
另请注意,我将采样时间转换为第29行的秒。严格来说,这不是必需的,但允许用户以1 / sec和s为单位输入Ki和Kd,而不是1 / mS和mS。
4、结果
上面的变化为我们做了三件事
5、关于中断的附注
如果该PID控制器应用于微控制器,则可以使用中断进行非常好的验证。SetSampleTime设置中断频率,然后使用中断周期调用Compute。在这种情况下,上述代码中的第9-12行,第23行和第24行没有必要。如果你计划用你的PID实现这样的功能,那就这么办吧!继续阅读这个系列。希望您仍然可以从后面的修改中获益。
我没有使用中断有三个原因:
就这个系列而言,并非每个人都能使用中断。
如果你想要同时实现许多PID控制器,事情会变得棘手。
老实说,我没想过。 Jimmie Rodgers在帮我做校对时提出了建议。我可能决定在未来版本的PID库中使用中断。
欢迎关注:
手机扫一扫
移动阅读更方便
你可能感兴趣的文章