W13 姿態融合與平衡 PID

融合 IMU 資料取得可用傾角並建立平衡回授

今天要完成什麼?

融合 IMU 資料取得可用傾角並建立平衡回授

可驗證成果: 記錄原始感測、融合角度與 PID 輸出

IMU 融合與平衡回授

  • 先確認軸向、零點、角度正負與融合輸出,再接高輸出馬達。
  • 平衡環 PD:角度誤差提供回復,Gyro 角速度提供阻尼;平衡環通常不需要 I。

三環並聯與差速

\[M_L=B+V+T,\qquad M_R=B+V-T\]

平衡 \(B\) 讓車體回直,速度 \(V\) 讓兩輪同步,轉向 \(T\) 讓左右輪一加一減。這與 W12 單馬達串級 PID 的組裝方式不同。

調參與安全

  1. Middle_angle 校準
  2. 平衡 P -> 平衡 D
  3. 速度 P -> 速度 I
  4. 最後才測轉向 P/D

輸出限幅、角度/電壓關機與拿起/放下偵測的門檻,須依來源程式與實際硬體核對。

學生檢核表

  • 我能說明融合角度如何進入平衡回授。
  • 我能畫出三環並聯到左右馬達的訊號流。
  • 我能以日誌或波形證明一次調參結果。

本週結論

  • 融合 IMU 資料取得可用傾角並建立平衡回授
  • 記錄原始感測、融合角度與 PID 輸出
  • 下一步前先保存程式版本、接線與測試證據。