W13 姿態融合與平衡 PID

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

本週任務: 融合 IMU 資料取得可用傾角並建立平衡回授

課堂投影片 實作活動 驗收挑戰

本週定位

你會學到

  • 以 IMU 融合取得可用傾角,理解互補濾波/姿態資料的角色。
  • 以平衡 PD、速度 PI、轉向 PD 建立三環並聯輸出。
  • 依 Middle_angle、符號、限幅與安全保護順序調參。

本週成果

  • 能記錄原始感測、融合角度與三個控制輸出。
  • 能說明 Motor_left = Balance + Velocity + Turn 的差速意義。
  • 完成由平衡 P/D 到速度,再到轉向的分階段測試;參數與硬體依實際板卡確認。

教材檔案怎麼用

  • W13 課堂投影片整理新版三環架構;原始 Office 檔與參考程式不放入學生網站。

建議學習流程

  1. 先校準 Middle_angle,確認 IMU 角度正負與濾波輸出。
  2. 只開平衡 P,再由小到大加入平衡 D;關閉其他環。
  3. 加入速度 PI,最後才加入轉向 PD;移動時才評估轉向 D。
  4. 每次只改一個主要參數,記錄角度、陀螺儀、各環輸出與安全狀態。

三小時流程

  1. 0:00-0:35: IMU 原始資料、融合傾角與座標/符號確認。
  2. 0:35-1:10: 平衡 PD:P 產生回復,陀螺儀角速度提供阻尼。
  3. 1:10-1:35: 速度 PI、轉向 PD 與三環並聯差速公式。
  4. 1:35-2:35: 依序校準、調參、觀察安全保護與限幅。
  5. 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 不在學生網站提供下載。

回到顶部