改進初學者的PID-采樣時間


  最近看到了Brett Beauregard發表的有關PID的系列文章,感覺對於理解PID算法很有幫助,於是將系列文章翻譯過來!在自我提高的過程中,也希望對同道中人有所幫助。作者Brett Beauregard的原文網址:http://brettbeauregard.com/blog/2011/04/improving-the-beginner%E2%80%99s-pid-sample-time/

 

1、問題

  初學者的PID設計為不規則地調用。這導致2個問題:

  • 你沒有從PID中獲得一致的行為,因為有時候它被頻繁調用,有時侯卻很少使用。
  • 你需要做額外的數學計算—微分和積分,因為它們都依賴於時間的變化。

2、解決方案

  為了確保定期調用PID。我決定采用這樣的方法,就是指定每個周期調用計算函數。根據預先確定的采樣時間,PID決定是否應立即計算或返回。

  一旦我們知道PID以恆定間隔進行評估,也可以簡化微分和積分計算。來點鼓勵!

3、代碼

 1 /*working variables*/
 2 unsigned long lastTime;
 3 double Input,Output,Setpoint;
 4 double errSum,lastErr;
 5 double kp,ki,kd;
 6 int SampleTime = 1000; //1 sec
 7 void Compute()
 8 {
 9    unsigned long now = millis();
10    int timeChange = (now - lastTime);
11    if(timeChange>=SampleTime)
12    {
13       /*Compute all the working error variables*/
14       double error = Setpoint - Input;
15       errSum += error;
16       double dErr = (error - lastErr);
17  
18       /*Compute PID Output*/
19       Output = kp * error + ki * errSum + kd * dErr;
20  
21       /*Remember some variables for next time*/
22       lastErr = error;
23       lastTime = now;
24    }
25 }
26  
27 void SetTunings(double Kp,double Ki,double Kd)
28 {
29   double SampleTimeInSec = ((double)SampleTime)/1000;
30    kp = Kp;
31    ki = Ki * SampleTimeInSec;
32    kd = Kd / SampleTimeInSec;
33 }
34  
35 void SetSampleTime(int NewSampleTime)
36 {
37    if (NewSampleTime > 0)
38    {
39       double ratio  = (double)NewSampleTime
40                       / (double)SampleTime;
41       ki *= ratio;
42       kd /= ratio;
43       SampleTime = (unsigned long)NewSampleTime;
44    }
45 }

  在第10行和第11行,算法現在決定是否需要計算。另外,因為我們現在知道樣本之間的時間間隔是相同的,所以我們不需要經常乘以時間變化。我們只能適當地調整Ki和Kd(第31和32行),結果在數學上是等價的,但效率更高。

  盡管如此,這樣做還有點小問題。如果用戶決定在操作期間更改采樣時間,則需要重新調整Ki和Kd以反映這一新變化。這就是39-42行的全部內容。

  另請注意,我將采樣時間轉換為第29行的秒。嚴格來說,這不是必需的,但允許用戶以1 / sec和s為單位輸入Ki和Kd,而不是1 / mS和mS。

4、結果

  上面的變化為我們做了三件事

  1. 無論調用Compute()的頻率如何,PID算法都將定期評估[第11行]。
  2. 由於減去時間[第10行],當millis()回到0時不會出現問題。這種情況每隔55天會發生一次,但是我們要記得預防,切記!
  3. 我們不需要再乘以和除以時間變化量。因為它是一個常量,所以我們可以將它從計算代碼(第15+16行)移到調優常量(第31+32行)中。從數學上講,它的結果是一樣的,但是每次計算PID時,它都節省了乘法和除法。

5、關於中斷的附注

  如果該PID控制器應用於微控制器,則可以使用中斷進行非常好的驗證。SetSampleTime設置中斷頻率,然后使用中斷周期調用Compute。在這種情況下,上述代碼中的第9-12行,第23行和第24行沒有必要。如果你計划用你的PID實現這樣的功能,那就這么辦吧!繼續閱讀這個系列。希望您仍然可以從后面的修改中獲益。

  我沒有使用中斷有三個原因:

  1. 就這個系列而言,並非每個人都能使用中斷。
  2. 如果你想要同時實現許多PID控制器,事情會變得棘手。
  3. 老實說,我沒想過。 Jimmie Rodgers在幫我做校對時提出了建議。我可能決定在未來版本的PID庫中使用中斷。

 歡迎關注:


免責聲明!

本站轉載的文章為個人學習借鑒使用,本站對版權不負任何法律責任。如果侵犯了您的隱私權益,請聯系本站郵箱yoyou2525@163.com刪除。



 
粵ICP備18138465號   © 2018-2025 CODEPRJ.COM