W12 直流馬達速度與定位 PID

從開迴路 PWM 進入編碼器回授的閉迴路控制

今天要完成什麼?

從開迴路 PWM 進入編碼器回授的閉迴路控制

可驗證成果: 以曲線比較目標值、量測值與控制輸出

W11 回顧:為何需要回授

  • 固定 PWM 不會自動補償負載、電池電壓或馬達差異。
  • 編碼器把實際速度/位置量回來,PID 才能計算誤差並補償。

PID 與離散化

\[u=K_p e+K_i\int e\,dt+K_d\frac{de}{dt}\]

本週必做是編碼器速度 PI;位置 P 外環是進階。輸出飽和時要限制積分,避免 windup。若沒有電流感測硬體,不建立電流 PI,只保留電流上限與過流保護觀念。

編碼器與兩層串級

  • A/B 相相差 90 度:相位先後判斷方向,邊緣計數提供速度與位置。
  • 來源示範以 STM32 Timer QEI 讀取計數;實際計時器與接腳依板卡確認。
  • 速度內環 -> 位置外環:由內而外調參,位置外環應比速度內環慢。

實作路線

  1. 檢查方向、計數溢位與速度估測。
  2. 只開速度 PI,確認追蹤且不振盪。
  3. 進階組再加入較慢的位置 P 外環。
  4. 比較目標、量測與輸出曲線。

學生檢核表

  • 我能由 A/B 相說明方向、速度與位置的來源。
  • 我能說明串級控制的順序與 anti-windup。
  • 我能以曲線驗證一次閉迴路步階測試。

本週結論

  • 從開迴路 PWM 進入編碼器回授的閉迴路控制
  • 以曲線比較目標值、量測值與控制輸出
  • 下一步前先保存程式版本、接線與測試證據。