2026年11月20日 星期五

DIY Robot Cars EP2: Mecanum Wheels, from an ESP32-CAM Car to a Pi 5 Self-Driving Car | 自造機器人車 EP2:麥克納姆輪,從 ESP32-CAM 影像車到 Pi 5 自走車

📺 影片版(約 24 分鐘,有章節可跳著看):本集整理成一支影片,細節在下方文字與各篇原文。
YouTube:https://youtu.be/CJlI0VgPpS0(winson-DIY 頻道)

English summary: Episode 2 of the "DIY Robot Cars" series merges three posts into one story about mecanum wheels: why 45-degree rollers let a car strafe and move diagonally (with the kinematics formula), a 2024 ESP32-CAM car that streams video and sends 4-bit commands to an Arduino Mega2560 driving two L298Ns and a servo arm, and a 2026 Raspberry Pi 5 rebuild with web joysticks, YOLO, gyro-assisted straight driving, distance and route maps, camera ground-plane ranging, scan-driven obstacle avoidance, and record-and-replay routes. The big lesson: a runaway caused by lgpio leaving the enable pins high, and how pinctrl in systemd, a PWM watchdog and an operation log fixed it.

這是「自造機器人車」系列的第二集,主角換成麥克納姆輪。把 2024 年的 ESP32-CAM 影像車和 2026 年 Pi 5 自走車的兩篇文章整理成一條故事線:輪子為什麼能橫著走 → ESP32-CAM 邊看邊開 → 換 Pi 5 網頁遙控 → 陀螺儀走直線與地圖 → 自動避障與一次暴衝 → 錄路線照軌跡走。影片約 20 分鐘,有章節可以跳著看;程式全文在各篇原文。

本集章節

  1. 麥克納姆輪為什麼能橫著走:45° 滾子、X 排列、四輪速度公式、鏡像安裝的 CW/CCW。
  2. 2024:ESP32-CAM 邊看邊開:ESP32-CAM 影像+網頁、4 支 GPIO 當 4 位元指令碼、Mega2560 推兩片 L298N 與 4 顆手臂伺服;從程式反推每顆輪子的位置。→ ESP32CAM + 麥克納姆倫 + Car(2024/06)
  3. 2026:換 Pi 5 網頁遙控:零件與接線、12.6 V 與 PWM 上限、雙搖桿網頁與 0.5 秒斷線停車、輪子 invert、實體腳號 13 ≠ GPIO13。→ Pi 5 麥克納姆輪自走車(一)(2026/11)
  4. 走直線、畫地圖、鏡頭測距:3 秒偏 10° → PD+學習量、兩個網頁互蓋、積分飽和、距離圖與路線圖、地面法測距與鏡頭校正。→ 同上+Pi 5 麥克納姆輪自走車(二)(2026/11)
  5. 避障與暴衝:避障一路改版、超聲波打到自己的鏡頭、掃描導向策略;lgpio tx_pwm(0) 不拉低+SIGKILL、tx_servo(0) 卡住別支腳 PWM(79/80 → 0/90);systemd pinctrl、PWM 看門狗、操作紀錄。→ 同上兩篇
  6. 照軌跡走與總整理:每 3 cm/5° 記點、麥克納姆斜走追點、搬到目前位置、對齊起點;實車 5.3 m、142 點、24 秒。

單篇影片

  • ESP32CAM Mecanum wheel CAR:https://youtu.be/qQoEmHxq1BA
  • Pi 5 麥克納姆輪自走車:https://youtu.be/Imtc1hFkkwQ

補充:原文沒寫到的原理與常見坑

補充一:麥克納姆輪的運動學

每顆麥克納姆輪的外圈是一排斜 45° 的小滾子。輪子轉動時,地面推回來的力不是正前方,而是沿著滾子垂直的方向斜 45°;四顆輪子的斜向力加起來,前後分量和左右分量各自可以抵消或相加,所以車子能直走、平移、斜走、原地轉。由上往下看,四顆輪子的滾子要排成「X」(左前、右後一組,右前、左後一組),裝反的話平移方向會反。

vx:往前、vy:往左平移、w:逆時針旋轉(都在 -1~1)
FL = vx - vy - w      FR = vx + vy + w
RL = vx + vy - w      RR = vx - vy + w
任一輪的絕對值超過 1 時,四輪一起除以最大值(保持方向比例)

這就是 Pi 5 車 car/hw.py 的 mecanum()。例:vx=0、vy=1(往左平移)→ FL -1、FR +1、RL +1、RR -1,同一條對角線的兩顆輪子轉向一樣。只轉對角線上的兩顆(例如 FR 與 RL 往前),車子會往左前 45° 斜走。

補充二:從 2024 版程式反推每顆馬達的位置

Mega2560 程式裡的 Forward(CW、CCW、CCW、CW)和 S_Left(四顆全 CW)比較,變號的是 motors1 的馬達 2 和 motors2 的馬達 1,它們是同一條對角線;Xtrun(原地轉)變號的是 motors2 的兩顆,所以 motors2 管同一側。對照上面的公式可以推出:一片 L298N 管右側(右前、右後)、另一片管左側(左前、左後);Left() 只轉右前+左後,就是往左前斜走。左右兩側馬達是鏡像安裝,同樣讓車往前,一邊要正轉、另一邊要反轉,所以程式裡同一個動作會同時出現 CW 和 CCW。(依原文程式推論,非原作者說明)

補充三:ESP32-CAM 為什麼要再接一片 Mega2560

AI-Thinker ESP32-CAM 的鏡頭佔掉大部分 GPIO,排針上只拉出 GPIO 0、1、2、3、4、12、13、14、15、16,其中 16 在有 PSRAM 的板子上接著 PSRAM、 1/3 是序列埠、0 是開機模式腳、2/12/15 是開機 strapping 腳、2/4/12/13/14/15 同時接到 microSD 卡、GPIO4 還接著板上的閃光燈 LED。要同時推 4 顆馬達(8 支方向腳+PWM)和 4 顆手臂伺服,腳位根本不夠,所以原文用 ESP32-CAM 只負責影像和網頁,把 4 支 GPIO 當成 4 位元的指令碼送給 Mega2560,16 種組合剛好放得下 7 種移動、停止和 8 個手臂動作。

原文的 WRITE_PERI_REG(RTC_CNTL_BROWN_OUT_REG, 0) 是關掉欠壓偵測:馬達啟動拉低電壓時 ESP32-CAM 不會一直重開,代價是電壓真的太低時晶片可能跑出錯誤行為而不是乾淨地重開。比較好的做法仍是把馬達和 ESP32-CAM 的電源分開、加大電容。

補充四:TT 馬達的電壓與 PWM 上限

TT 黃色減速馬達常見額定 3~6 V。三顆 18650 串聯滿電 12.6 V,L298N(雙極電晶體 H 橋)大約吃掉 2 V,馬達端仍有 9~10 V,所以要用 PWM 上限把平均電壓壓低;原文從 60% 再降到 50%。PWM 只是平均值,峰值仍是全電壓,長時間高 PWM 會讓馬達發熱與壽命縮短。

補充五:接馬達的程式要先想「死掉時腳位停在哪」

  • 停車一定直接把 EN 腳寫成低電位,不要只「停掉 PWM」(lgpio 的 tx_pwm(…, 0) 會讓腳停在最後的電位)。
  • 服務啟動前、結束後用 pinctrl 把馬達腳全部拉低(ExecStartPre/ExecStopPost),程式被砍也一樣。
  • 網頁遙控要有「沒收到指令就停車」的逾時(原文 0.5 秒)。
  • 硬體上可在 EN 腳加下拉電阻,讓 Pi 開機、腳位還是輸入狀態時馬達也不會動。
  • Pi 5 的 GPIO12/13/18/19 是硬體 PWM 腳,換成硬體 PWM 可避開軟體 PWM 卡住的問題(原文列為待辦)。

補充六:只靠輪速推算位置會飄

沒有輪子編碼器時,位置是「送給馬達的指令 × 實測速度 × 時間」積分出來的(dead reckoning),方向用陀螺儀。輪子打滑、電池電壓下降、麥克納姆輪平移效率(原文假設 0.8)都會讓誤差一路累積,所以路線圖上「照著走」的綠線疊在黃線上,只代表控制照著計畫走,不代表地上的真實位置;要量真實偏差得用地上標記或俯拍。

自造機器人車系列

沒有留言:

張貼留言