採用 AT89C51 MCU 為核心,雙後輪差速驅動,具備道路學習記憶與循跡重現功能。支援地圖仿真訓練、避障繞行、光線自適應、LCD 里程顯示、狀態指示燈、故障報警。
L,取樣週期 T (30ms),計數 M。N = M / (L·T),車輪轉速 N/5 (皮帶輪比 1:5)。T=30ms 讀取左右輪速率 (VL, VR) 存入閃存。T=30ms 輸出目標 PWM,驅動馬達。遇障礙物時,不重新規劃,改用幾何轉移繞行並回歸原路徑:
原路徑段 AD → 轉移為 BC
A 點左轉 90° → 勻速 v 前進 t1 到 B
B 點右轉 90° → 恢復原記錄數據前進 t2 到 C
C 點轉角 θ (θ=90° - 輪距差/輪距) → 勻速 v 前進 t1 到 D
D 點反向轉 θ 回歸原方向 d1 // d1 平行 AD
// BC 運動等效於 AD,完美繞過矩形障礙物並回歸原軌跡
t1/t2 由雷射測距依障礙物大小動態決定。
訓練於縮圖地圖,輸出時按比例放大 PWM 週期/里程,靈活適應不同實際場景。
| 對比對象 | 本模型優勢 |
|---|---|
| 無線遙控 | 可工作於電磁屏蔽環境 (礦井、核設施) |
| 有線遙控 | 無需人工即時操作,自主完成,精度高、效率高 |
| 固定軌道 (AGV) | 擺脫軌道限制,路徑靈活可重訓練,適應範圍廣 |