W13 姿態融合與平衡 PID
融合 IMU 資料取得可用傾角並建立平衡回授
本週定位
你會學到
- 以 IMU 融合取得可用傾角,理解互補濾波/姿態資料的角色。
- 以平衡 PD、速度 PI、轉向 PD 建立三環並聯輸出。
- 依 Middle_angle、符號、限幅與安全保護順序調參。
本週成果
- 能記錄原始感測、融合角度與三個控制輸出。
- 能說明
Motor_left = Balance + Velocity + Turn的差速意義。 - 完成由平衡 P/D 到速度,再到轉向的分階段測試;參數與硬體依實際板卡確認。
教材檔案怎麼用
- W13 課堂投影片整理新版三環架構;原始 Office 檔與參考程式不放入學生網站。
建議學習流程
- 先校準 Middle_angle,確認 IMU 角度正負與濾波輸出。
- 只開平衡 P,再由小到大加入平衡 D;關閉其他環。
- 加入速度 PI,最後才加入轉向 PD;移動時才評估轉向 D。
- 每次只改一個主要參數,記錄角度、陀螺儀、各環輸出與安全狀態。
三小時流程
- 0:00-0:35: IMU 原始資料、融合傾角與座標/符號確認。
- 0:35-1:10: 平衡 PD:P 產生回復,陀螺儀角速度提供阻尼。
- 1:10-1:35: 速度 PI、轉向 PD 與三環並聯差速公式。
- 1:35-2:35: 依序校準、調參、觀察安全保護與限幅。
- 2:35-3:00: 比較一項錯誤符號/錯誤 D 項的現象,整理驗收證據。
核心概念
| 概念 | 你需要掌握的意思 |
|---|---|
| Sensor fusion | 把 IMU 感測資料整理成可用的姿態估測。 |
| Parallel PID | 平衡、速度、轉向各自計算,再彙整到左右馬達輸出。 |
| D-on-measurement | 平衡/轉向 D 項優先用陀螺儀真實角速度,避免命令突變造成 derivative kick。 |
實作/任務
在低風險條件下完成 IMU 融合與三環輸出記錄,並展示車體被輕推後的恢復趨勢;高輸出與站立時間門檻待教師確認。
學生檢核表
- 我能說明原始 IMU、融合角度與平衡回授的關係。
- 我能解釋三環並聯與左右輪差速輸出。
- 我能依序校準 Middle_angle、平衡 PD、速度 PI、轉向 PD。
- 我能指出符號錯誤、D 項雜訊與輸出飽和的證據。
本頁依 114-2 課程教材重新編排;原始 PPTX、PDF 與 DOCX 不在學生網站提供下載。