W15 循跡與平衡控制整合

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

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

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

本週定位

你會學到

  • 以 TCRT5000 讀值計算循跡位置誤差,區分離散判斷與加權平均。
  • 以循跡 PD 產生轉向命令,理解 Gyro Z 角速度作為阻尼回授。
  • 將循跡輸出接入 W13 三環並聯與左右輪差速,處理直線、彎道、十字與斷線。

本週成果

  • 在 W13 平衡基礎上完成循跡模式,展示直行、修正與擾動恢復。
  • 能說明感測器數量、位置解析度、速度與脫線風險的取捨。
  • 保存感測器讀值、bias、轉向輸出、速度命令與測試條件。

教材檔案怎麼用

  • W15 課堂投影片整理 TCRT5000、循跡 PD、W13 差速接法與故障處理;原始 Office 檔不放入學生網站。

建議學習流程

  1. 先確認 W13 平衡、TCRT5000 黑白判斷、安裝位置與閾值。
  2. 不接馬達先移動車體,確認 bias 的方向與斷線記憶行為。
  3. 低速接入差速項,先跑直線,再增加大彎、銳角與十字。
  4. 最後才測變速;每次只改一項,記錄速度、bias、轉向與脫線現象。

三小時流程

  1. 0:00-0:30: 回顧 W13 三環並聯與循跡整合位置。
  2. 0:30-1:00: 校準 TCRT5000,建立離散狀態或加權 bias。
  3. 1:00-1:25: 循跡 PD 與 Gyro Z 阻尼,確認轉向正負。
  4. 1:25-2:35: 分別測直線、大彎,再測銳角/十字/斷線。
  5. 2:35-3:00: 整理直行、修正、擾動恢復和一次失敗案例。

核心概念

概念 你需要掌握的意思
Track bias 把多顆感測器讀值轉成車體相對黑線的位置誤差。
Tracking PD 用位置偏差產生轉向,並用 Gyro Z 角速度提供阻尼。
Line-loss recovery 短暫全白時沿用最後有效偏差,超時則減速或尋線;門檻待教師確認。

實作/任務

完成 W13 平衡模式上的循跡模式,至少以固定條件展示直行與一次偏離修正;銳角、十字、變速與完賽門檻依課堂規劃,未定者待教師確認。

學生檢核表

  • 我能把感測器讀值轉成離散狀態或連續 bias。
  • 我能說明循跡 PD、Gyro 阻尼與 W13 左右輪差速的關係。
  • 我能分別驗證平衡、循跡,再進行整合。
  • 我能以讀值、bias、轉向輸出與影片說明一次結果。

本頁依 114-2 課程教材重新編排;原始 PPTX、PDF 與 DOCX 不在學生網站提供下載。

回到顶部