W15 循跡與平衡控制整合

協調快速平衡迴路與較慢的方向修正任務

今天要完成什麼?

協調快速平衡迴路與較慢的方向修正任務

可驗證成果: 展示直行、修正與擾動恢復

本週定位

你會學到

  • TCRT5000 -> track bias -> tracking PD -> W13 差速輸出。
  • 先分開驗證平衡與循跡,再整合到同一控制流程。

本週成果

  • 展示直行、偏離修正與擾動恢復,保存讀值與輸出證據。

感測器與位置誤差

  • 1/2 顆可用離散狀態;3/5 顆可用位置權重計算連續 bias。
  • 全白要有最後有效 bias 或尋線策略;全黑可能是十字、粗線或起終點,需明確處理。

循跡 PD 與 W13 接法

\[turn=K_{p,track}\,bias+K_{d,track}\,gyro_z\]

來源教材主推把 turn 直接放入 W13 差速項:\(M_L=B+V+T\), \(M_R=B+V-T\)。更進階的 target yaw-rate 接法待教師示範後再採用。

測試與風險

  1. 校準黑白閾值與方向
  2. 不接馬達檢查 bias
  3. 低速直線 -> 大彎 -> 銳角/十字
  4. 最後再加入變速與斷線恢復

感測器數量、安裝高度、速度門檻與軌道規格依實際器材確認。

學生檢核表

  • 我能由讀值算出狀態或 bias。
  • 我能說明 tracking PD 如何進入 W13 差速。
  • 我能以讀值、輸出和影片展示直行與修正。

本週結論

  • 協調快速平衡迴路與較慢的方向修正任務
  • 展示直行、修正與擾動恢復
  • 下一步前先保存程式版本、接線與測試證據。