2026年11月19日 星期四

DIY Robot Cars EP1: ESP32 Bluetooth RC Car to Obstacle Avoidance | 自造機器人車 EP1:ESP32 藍牙遙控車到自動避障

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

English summary: Episode 1 of the "DIY Robot Cars" series turns four posts from summer 2023 into one story: spinning DC motors with an L298N dual H-bridge, controlling them with single letters over ESP32 Classic Bluetooth SPP, building a four-wheel skid-steer car, driving it with the Bluetooth RC Controller app, and finally adding an HC-SR04 on a servo with two FreeRTOS tasks for obstacle avoidance. Along the way: L298N voltage drop and jumpers, the Arduino-ESP32 3.x LEDC API change, a strstr bug where "VER" also triggers Right(), and why readString() waits one second.

這是「自造機器人車」系列的第一集,把部落格 2023 年夏天連續四篇 ESP32 小車文章整理成一條故事線:L298N 讓馬達轉起來 → 藍牙 SPP 用字母控制 → 組成四輪車 → 手機 App 遙控 → 超音波+伺服馬達自動避障。影片約 16 分鐘,有章節可以跳著看;程式全文在各篇原文。

本集章節

  1. 讓馬達轉起來:L298N 雙 H 橋、接線(ENA 4、IN1~IN4 16~19、ENB 5)、共地;壓降 2~3 V、ENA/5V 跳帽;Robojax 函式庫與 ESP32 PWM 通道;Arduino-ESP32 3.x 的 LEDC 改版。→ ESP32 Bluetooth SPP control -- DC motors with L298N module(2023/07)
  2. 藍牙 SPP:手機送一個字母:BluetoothSerial、F/B/L/R/S;strstr 讓 VER 也觸發右轉;只有原版 ESP32 有傳統藍牙、iPhone 不開放 SPP。→ 同上
  3. 組一台四輪車:車體套件、18650 電池、四顆馬達同側並聯、L298N +5V 供電給 ESP32、滑移轉向三種轉法。→ ESP32 Bluetooth Remote Control Car -DIY(2023/08)
  4. App 遙控:Bluetooth RC Controller 指令表(F B L R G I H J S、W/U/V/X、0~9 q);為什麼程式比對的是 FS、FGFS(readString 預設等 1 秒)與逐字元改法。→ ESP32 Bluetooth RC Car APP - Bluetooth RC Controller(2023/08)
  5. 自動避障:HC-SR04(duration/29/2、Echo 5 V 分壓)、ESP32Servo 50 Hz 500~2400 µs、35 cm 避障邏輯、兩個 FreeRTOS 任務與 App X/x 切換;pulseIn 逾時、伺服電流、volatile、斜面軟布四個坑。→ ESP32 Obstacle Avoiding Robot Car(2023/08)
  6. 總整理與下一集:四篇=一台車長大;EP2 麥克納姆輪(ESP32-CAM 影像車 → Pi 5 自走車)、EP3 步進平衡車。

單篇影片

  • DC motors with L298N module - ESP32 Bluetooth SPP control:https://youtu.be/F3gByuOwLIU
  • ESP32 Bluetooth Remote Control Car DIY:https://youtu.be/mcMax-saFSY
  • ESP32 Bluetooth RC Car APP - Bluetooth RC Controller:https://youtu.be/RWFrd_aHiwI
  • ESP32 Obstacle Avoiding Robot Car:https://youtu.be/ZjxEfAh5XB8

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

補充一、H 橋怎麼讓馬達正反轉

四個開關排成 H 字形,馬達在中間。L298 每個橋由 IN1/IN2 決定方向、EN 決定開關:

ENIN1IN2馬達
HHL一個方向(正轉)
HLH另一個方向(反轉)
HIN1=IN2快速煞車
L任意自由滑行

EN 接 PWM,開的時間比例=平均電壓=速度。所以每顆馬達要三條線:兩條管方向、一條管速度。

補充二、L298N 模組的三個坑

  • 壓降約 2~3 V:L298 是雙極電晶體輸出(datasheet 的飽和壓降上下橋合計在 1 A 時約 1.8~3.2 V),7.4 V 電池到馬達端可能只剩 5 V 左右。
  • ENA/ENB 跳帽:插著=EN 接 5 V,永遠全速;要用 PWM 調速必須拔掉,改接 ESP32。
  • 5V 穩壓跳帽:供電 12 V 以下才插著,此時 +5V 端子是輸出,可以供電給 ESP32(原文接線就是這樣接);超過 12 V 要拔掉、+5V 改成輸入。
  • 另外:ESP32 與 L298N 一定要共地;2 A 是單路上限,馬達堵轉時電流最大。

補充三、ESP32 的 PWM 與 Arduino-ESP32 3.x

ESP32 的 PWM 來自 LEDC 周邊(通道、頻率、解析度)。Arduino-ESP32 核心 3.0 起 LEDC API 改版:ledcSetup()+ledcAttachPin() 合併為 ledcAttach(pin, freq, resolution),ledcWrite() 改成用腳位而不是通道。2023 年依 2.0.x 寫的範例與函式庫(例如需要傳 PWM 通道的 L298N 函式庫)用新核心可能編譯失敗:在開發板管理員改裝 2.0.x,或改寫成 3.x 寫法。

// 3.x 寫法示意(未編譯)
ledcAttach(ENA, 1000, 8);    // 1 kHz、8 bit
ledcWrite(ENA, 180);         // 0~255
digitalWrite(IN1, LOW); digitalWrite(IN2, HIGH);

補充四、為什麼用傳統藍牙 SPP、它的限制

  • SPP(Serial Port Profile)把藍牙當序列埠,Android 上的終端機、遙控 App 最多,ESP32 用 BluetoothSerial 幾行就好。
  • 只有原版 ESP32(ESP32-WROOM/WROVER)有 BR/EDR 傳統藍牙;ESP32-S3、C3、C6 只有 BLE,BluetoothSerial 不能用。
  • iOS 不開放一般 App 使用 SPP(需 MFi),要支援 iPhone 就改用 BLE(例如 Nordic UART Service)或 WiFi。

補充五、strstr 的小坑:打 VER 車子會右轉

原文 USB 序列埠這一路用 strstr(data, "R") 判斷「字串裡有沒有 R」;查版本的 VER 剛好含 R,所以印出版本號的同時也會呼叫 Right()(依程式邏輯推論,原文沒有寫到這個現象)。改法:

if (strcmp(data, "VER") == 0) { Serial.println(F("ESP32_20230710")); return; }
switch (data[0]) {
  case 'F': Forward(); break;
  case 'B': Reverse(); break;
  case 'L': Left();    break;
  case 'R': Right();   break;
  case 'S': Stop();    break;
}

補充六、四輪車的電源與轉彎

  • 電源:電池 → L298N +12V(馬達);L298N +5V → ESP32 5V 腳(主控)。兩顆 18650 串聯滿電 8.4 V、標稱 7.4 V,扣掉 L298N 壓降,馬達約 5~6 V。
  • 四顆馬達同側並聯:左兩顆接 OUT1/OUT2、右兩顆接 OUT3/OUT4,程式仍只有 motor1/motor2。
  • 滑移轉向(skid steering):輪子不能轉向,只能靠兩側速度差。單邊停(原文 L/R)以停住那側為圓心畫弧;兩邊反向=原地旋轉,最快但輪胎側滑、耗電;兩邊同向不同速=差速轉彎,最順(原文 App 版 FGFS 等斜角就是 60%/100%)。
  • 原文三篇的 Left()/Right() 改過一次:2023/07、2023/08 第一版是單邊往後轉,App 版改成另一側單邊往前轉。

補充七、Bluetooth RC Controller 指令表與 readString 等一秒

按鍵送出
前/後/左/右F/B/L/R,放開送 S
左前/右前/左後/右後G/I/H/J
前燈/後燈W 開 w 關/U 開 u 關
喇叭/額外鍵V/v、X/x(原文用 X/x 切換自動避障)
速度滑桿0~9、q(100%)

原文 App 版比對的是 "FS"、"FGFS" 這種組合,原因是 SerialBT.readString() 會一直讀到「超過逾時都沒有新字元」才回傳,預設逾時 1000 ms:一秒內的按下、放開會黏成一串,而且每個指令都要等一秒才執行。改法是逐字元處理:

void loop() {
  while (SerialBT.available()) {
    char c = SerialBT.read();
    switch (c) {
      case 'F': Forward(); break;
      case 'B': Reverse(); break;
      case 'G': ForwardLeft(); break;   // 60% / 100%
      case 'I': ForwardRight(); break;
      case 'S': Stop(); break;
      case 'X': autoMode = false; Stop(); break;
      case 'x': autoMode = true; break;
    }
  }
}

(或至少 SerialBT.setTimeout(20);,讓 readString 只等 20 ms。)

補充八、避障車:超音波、伺服與常見坑

  • HC-SR04:Trig 送 10 µs 脈衝,Echo 高電位時間=聲波去回時間。聲速約 340 m/s,1 cm 約 29 µs,去回除以 2 → distance = duration / 29 / 2(例:2030 µs ≈ 35 cm)。
  • Echo 是 5 V 訊號,ESP32 GPIO 只能 3.3 V:建議 1 kΩ/2 kΩ 分壓。
  • 伺服:ESP32 要用 ESP32Servo 函式庫;50 Hz(20 ms),原文 attach(13, 500, 2400):0° 500 µs、180° 2400 µs,90° 約 1450 µs;程式用 90°(前)、20°(右)、160°(左)。
  • pulseIn() 預設逾時 1 秒:前方沒回波時任務會卡一秒,建議 pulseIn(ECHO, HIGH, 25000)(約 4 m);原文定義的 MAX_DISTANCE 200 可以用在這裡。
  • 伺服啟動電流大,電壓掉下來 ESP32 可能 brownout 重開:伺服另外供電、加 470 µF 以上電容、共地。
  • distance、HCSR04Flag 由兩個 FreeRTOS 任務共用:宣告 volatile 或改用 queue。
  • 斜面會把超音波彈走、軟布會吸收,量不到 → 可加紅外線或 ToF(如 VL53L0X)補強。

自造機器人車系列

  • EP1 ESP32 藍牙遙控車到自動避障(本篇)
  • EP2 麥克納姆輪:ESP32-CAM 影像車 → Pi 5 自走車(製作中)
  • EP3 ESP32-S3 步進平衡車(製作中)

Controlling an ODrive v3.6 over CAN from the ATS Console: Two BLDC Motors, Sensorless Pitfalls and USB Settings | ATS 操作台用 PCAN 控制 ODrive v3.6:兩顆無刷馬達、sensorless 抖動與 USB 設定讀寫

手邊這片 ODrive v3.6-56V 以前就玩過兩次:2023 年用 odrivetool 調 SunnySky X2212 配 TLE5012B 編碼器做位置控制,2025 年用 PeakCAN 控制兩顆馬達(另一顆 A2212 走 sensorless)。這次把它接進自己寫的 ATS 網頁操作台:同一支 PCAN 開一個「ODrive」視窗,兩軸的狀態、校正、閉迴路、位置/速度/力矩控制、即時曲線、緊急停止都在網頁上按;CAN 讀不到的設定值,再走 ODrive 的 USB 序列埠讀寫、存檔。這篇記錄做法,還有實測時踩到的四個坑。

圖說:整體架構:控制走 CAN(PCAN-USB FD,250k),設定走 USB(ODrive 的 CDC 序列埠,ASCII 協定),兩條可以同時用

硬體與接線

項目內容
控制板ODrive v3.6-56V(STM32F405、兩顆 DRV8301),韌體 0.5.6;板上 DIP 開關有 CAN-R(120 Ω 終端)、RUN/DFU
電源12 V,接 DC+/DC−
M0(axis0)SunnySky X2212-13 KV980,7 極對,TLE5012B 磁編碼器(incremental,CPR 16384)→ 位置控制
M1(axis1)A2212/10T 1400KV,7 極對,沒有編碼器 → sensorless 速度控制
AUX2 Ω 鋁殼煞車電阻(減速時把回充的能量燒掉)
CANPCAN-USB FD 接 ODrive 的 CAN H/L,250 kbit/s,Classic CAN(不開 FD)
USBODrive 的 micro USB 接同一台筆電,Windows 上出現 COM48(VID 1209、PID 0D32)

圖說:實際接線:M0 接 X2212(三相+編碼器排線接到 M0 編碼器座),AUX 接鋁殼煞車電阻,M1 接 A2212(只有三相),右側 DC 端子接 12 V

ODrive 的 CAN 協定(CANSimple)

ODrive 0.5.x 的 CAN 協定叫 CANSimple,很單純:CAN ID = node_id × 32 + 指令編號(11-bit 標準框,資料 little-endian)。每一軸有自己的 node ID,這片板子是 axis0=node 2、axis1=node 3,所以 M0 的 ID 落在 0x040~0x05F、M1 在 0x060~0x07F。「讀」類的指令要送 RTR(remote frame),ODrive 用同一個 ID 回資料。這次用到的:

指令編號方向資料
Heartbeat0x01ODrive 自己送,每 100 msaxis 錯誤碼 u32、目前狀態 u8、各子系統錯誤旗標
Estop0x02送(無)→ 該軸停下並帶 ESTOP_REQUESTED 錯誤
Set Axis State0x07送u32:1 IDLE、3 完整校正、4 馬達校正、7 編碼器校正、8 閉迴路
Encoder Estimates0x09ODrive 自己送,每 10 ms位置 f32(turns)、速度 f32(turns/s)
Set Controller Mode0x0B送控制模式 i32(1 力矩、2 速度、3 位置)、輸入模式 i32(1 PASSTHROUGH、2 VEL_RAMP、5 TRAP_TRAJ…)
Set Input Pos/Vel/Torque0x0C/0x0D/0x0E送目標值 f32(位置另帶兩個 int16 前饋)
Set Limits0x0F送vel_limit f32、current_limit f32
Get Iq0x14RTR 問Iq 設定 f32、Iq 實際 f32
Get Sensorless Estimates0x15RTR 問sensorless 的位置、速度 f32
Get Vbus Voltage0x17RTR 問電壓 f32
Clear Errors0x18送(無)

例如讓 M1 用 10 turns/s 轉:ID = 3×32+0x0D = 0x06D,資料 00 00 20 41 00 00 00 00(前 4 byte 是 float 10.0)。進閉迴路:ID 0x067、資料 08 00 00 00。

接上之後第一件事是「只聽、不送」:用 PCAN 在 250k 收 2 秒,看到 0x041/0x061(heartbeat)和 0x049/0x069(編碼器估計),才知道 node ID 是 2、3,不是一般預設的 0、1。再用 RTR 讀 Encoder Count,node 2 有計數(336)、node 3 是 0,確認 node 2 就是接編碼器的 M0。

ATS 的 ODrive 視窗

ATS 開一條 PCAN 連線(250k、不勾 FD),工具列按「ODrive」就跳出這個視窗,按「開始」。程式(ats/odrive.py)掛在 CAN 收訊執行緒上解碼 ODrive 的框,另開一個輪詢執行緒每 100 ms 用 RTR 問 Iq 和 sensorless 估計、每 500 ms 問 Vbus,網頁每 0.1 秒更新一次。ODrive 一秒大約送 250 框,預設「安靜」不進 CAN 視窗和 log,只有我送出的指令和狀態變化會各記一行。

圖說:實機畫面(msi 筆電、Vbus 12.23 V):M0 位置模式正在用梯形軌跡跑向目標,M1 sensorless 穩定在約 10 turns/s。目前狀態的按鈕會亮綠色

  • 每一軸:狀態(灰=IDLE、橘=校正中、綠=閉迴路)、錯誤碼解碼成名稱、位置/速度/Iq,按鈕有 IDLE、馬達校正、編碼器校正、完整校正、閉迴路、清錯誤、停止(M1 沒有編碼器,不顯示編碼器校正)。
  • 控制:位置/速度/力矩三種模式加輸入模式;目標值可以打數字、按 ±1/±10,或拖滑桿(勾「拖曳即送」就邊拖邊送,一秒最多 20 次)。
  • 曲線:最近 20 秒的位置(虛線是目標)、速度、Iq,各自自動縮放。
  • 安全:右上「全部 IDLE」「緊急停止」(Esc 鍵也可以);按「停止」或關掉 CAN 連線時兩軸自動送 IDLE。
  • 限制與增益:vel_limit、電流上限、軌跡速度/加減速、pos_gain、vel 增益可以從 CAN 改,但不會存進 flash。

沒有接硬體時,ATS 的模擬模式裡另外有一條 virtual CAN 通道 odrive-sim,上面掛一片假的 ODrive(node 2 有編碼器、node 3 sensorless),校正、閉迴路、軌跡都會動,畫面可以先在電腦上測好。

CAN 讀不到設定值,改走 USB

CANSimple 只有上面那一組固定訊息:可以下指令、讀狀態,但讀不到任何設定值(相電阻、sensorless 參數、增益、node ID…),也不能存檔。新版韌體 0.6 的 CAN 可以讀寫任意參數,但那只給 ODrive Pro/S1,v3.6 最後一版就是 0.5.6。

所以 ODrive 視窗下面加了「設定(USB)」:ODrive 的 USB 除了 odrivetool 用的原生介面,還有一個 CDC 序列埠,可以送 ASCII 指令,不用另外裝 odrivetool:

r axis1.motor.config.phase_resistance      ← 讀,回一行值(不存在回 invalid property)
w axis1.motor.config.current_lim 15        ← 寫,不回應(ATS 寫完會再讀回比對)
ss                                         ← save_configuration,存進 flash(ODrive 會重開)
sr                                         ← reboot

按「讀取」一次讀主板和兩軸約 100 個值(實機 0.1 秒),分成主板、狀態、CAN、馬達、編碼器、Sensorless、控制器、開機幾組並排顯示。灰字是唯讀(量到或算出來的),改過的欄位會變黃底,按「寫入變更」才送出;寫入只改 RAM,按「存檔」才會留到下次開機(兩軸都要 IDLE 才准存)。每次操作才開、用完就關 COM 埠,不會占著。

圖說:設定(USB)上半:韌體、CAN 鮑率、兩軸狀態與錯誤碼、node ID、馬達校正結果(相電阻 M0 0.088 Ω、M1 0.065 Ω)

圖說:設定(USB)下半:sensorless 參數、控制器增益、開機選項

實測踩到的坑

1. 送了速度,馬達不動:忘了進閉迴路

第一次實機測速度:完整校正做完、切速度模式、送 10 turns/s,馬達不動。看 log,set_input_vel 都有送出去,但校正完軸回到 IDLE,之後沒有送過「閉迴路」(0x047 08 00 00 00),IDLE 的軸會忽略所有目標值。原因是介面上「閉迴路」按鈕一直是藍底,看起來像已經在閉迴路。改成:目前是哪個狀態,那顆按鈕才亮綠色。

2. 急停之後按什麼都沒反應:要先清錯誤

按過緊急停止,兩軸帶著 ESTOP_REQUESTED。ODrive 只要身上有錯誤,就拒絕所有狀態切換,重開 ATS 也一樣(錯誤在 ODrive 上)。偏偏錯誤標籤被頁首的樣式蓋成灰色,很不明顯。改成:錯誤標籤紅底;有錯誤時「清錯誤」按鈕閃橘色;這時按其他狀態按鈕不送出,直接在紀錄提示「先按清錯誤」。

3. M1(sensorless)一直原地抖:相電阻校正壞掉

M1 進閉迴路後給 1~5 turns/s,只會原地抖,sensorless 估計的位置幾乎不動。用 USB 讀設定,sensorless 已經開、pm_flux_linkage = 5.513 / (7 × 1400) ≈ 0.000563 也對,問題在馬達校正值:

項目M0(正常)M1 校正前M1 重新校正後
相電阻 phase_resistance0.087 Ω0.000125 Ω0.0637 Ω
電流迴路 i_gain—0.12563.7

電阻小了約 700 倍。sensorless 是用「電壓 − 電阻 × 電流」積分出磁通來估轉子角度,電流迴路的積分增益也是用電阻算的,電阻幾乎是 0,兩邊都會歪。重新按一次「馬達校正」,電阻回到 0.0637 Ω,M1 就能正常轉。現在 USB 設定表裡相電阻小於 0.005 Ω 會紅字提示「重做馬達校正」。

另一個要知道的:ODrive 0.5.x 的 sensorless 一進閉迴路,會先用 10 A 把馬達拖到電氣 400 rad/s(7 極對換算約 9 turns/s)才交給估計器,之後給太低的速度又會開始抖。實測 M1 維持在 10 turns/s 左右很穩(曲線上速度在 9.4~10.7 之間小幅起伏),要停就按 IDLE,不要給 0。sensorless 的「位置」會繞回(截圖裡在 ±3.7 之間鋸齒狀),只能看速度。

4. 存檔重開後 M0 變成 INVALID_STATE

圖說:存檔後 ODrive 重開:M1 直接就能進閉迴路,M0 卻帶著 INVALID_STATE

把 M1 的新校正值存檔後,ODrive 重開,M1 沒事,M0 卻一開機就是 INVALID_STATE。讀 USB 設定就看懂了:

  • M1 的 motor.config.pre_calibrated 是 1:開機沿用存好的校正值,sensorless 不需要編碼器,所以開機就能用。
  • M0 的 pre_calibrated 是 0:重開後馬達等於沒校正;但 startup_encoder_offset_calibration 是 1,開機會自動做編碼器校正,而編碼器校正需要馬達先校正好 → 失敗,留下 INVALID_STATE。
  • M0 的 TLE5012B 用的是 incremental 模式、沒有 index 訊號,編碼器偏移本來就每次上電都要重做,不能 pre_calibrated。

可以把 M0 的馬達 pre_calibrated 勾起來再存檔,開機就會自動完成編碼器校正(通電時 M0 會自己轉一小段)。我選擇維持現狀、每次手動做,比較清楚馬達什麼時候會動。

每次上電的操作順序

M0(X2212+編碼器)M1(A2212 sensorless)
1清錯誤(開機自動校正失敗留下的 INVALID_STATE)有錯誤才清
2完整校正(嗶一聲、再轉一小段,回到 IDLE)不用(已存 pre_calibrated)
3選位置(TRAP_TRAJ)或速度模式選速度模式
4閉迴路(按鈕變綠)閉迴路
5送目標位置/速度送 8~10 turns/s 以上
停0 =減速並鎖住;IDLE =放掉IDLE

小結

ODrive v3.6 用 CAN 控制其實很簡單,難的是「看得到狀態」:沒進閉迴路、帶著錯誤、校正值壞掉,從馬達外表看起來都只是「不動」或「抖」。這次的介面把狀態按鈕、錯誤、校正值都攤在同一個視窗,CAN 控制和 USB 設定一起用,下次換馬達或調參數應該就快很多。之前的 ATS 文章:ATS 操作台讀行車電腦模擬器(OBD-II、PCAN)、ATS 透過網路控制 ESP32 四路繼電器。ODrive 早期的設定過程在軟硬體的天空:odrive perform Sunnysky X2212 980KV motor with Encoder TLE5012B、PeakCAN Control ODrive with A2212-1400KV and X2212-980KV。

2026年11月18日 星期三

Turning an Old Android Phone into a GPS Tracker with Termux: On-Device Logging, a Leaflet Map, and Five Pitfalls | 舊 Android 手機用 Termux 變 GPS 追蹤器:手機端記錄、Leaflet 地圖頁與五個實測踩坑

一支沒插 SIM 卡的舊 Android 手機,裝上 Termux 之後可以當成 GPS 追蹤器:手機自己記錄位置,家裡的 Linux 主機把資料收回來,用瀏覽器就能看到目前位置、走過的軌跡、每一趟行程的里程和時速。整套東西不用寫 Android App、不用 Google Maps 金鑰、不用雲端服務,主機端只用 Python 標準函式庫。這篇記錄兩天內從第一版做到可用的過程,重點放在實際踩到的五個坑,每一個都是實測出來的。

先講清楚範圍:這是放在自己手機、看自己位置的工具,網頁只開在 Tailscale 私有網路裡。文中的截圖用的是裁掉住家和公司附近路段之後的示範資料。


圖說:完成後的畫面:軌跡依時速上色,下方是目前位置和這趟行程的摘要

一、架構:手機記錄、主機同步、瀏覽器顯示

圖說:三個部分各做一件事,中間只靠 SSH 和 HTTP

  • 手機:Termux 加 Termux:API,一支 shell script 常駐,用 termux-location 取位置,寫進手機本機的 CSV。
  • 主機:一支 Python 程式,每 20 秒用 SSH 把 CSV 裡比資料庫新的行拉回來存進 SQLite,同時提供網頁和 JSON API。
  • 瀏覽器:Leaflet 加 OpenStreetMap 圖磚,每 10 秒更新一次。
  • 連線:手機和主機都在 Tailscale 裡,手機不管連家裡 Wi-Fi、公司 Wi-Fi 還是另一支手機的熱點,主機都用同一個位址連得到。

手機要能遠端 SSH 進 Termux、開機自動起 sshd 和 Tailscale,這部分的設定是另一個專題,這裡不重複。座標轉地址用 OpenStreetMap 的 Nominatim,免費、不用金鑰,規定是每秒最多查一次,所以主機端有快取。

二、第一版為什麼不行:主機每分鐘去問手機

最直覺的做法是主機每分鐘 SSH 到手機跑一次 termux-location,把結果存起來。在家裡測沒問題,第二天帶出門就露出兩個毛病:

  • 斷網就漏:手機走熱點時連線不穩,有一段 6 分鐘、一段 14 分鐘主機連不上手機,那幾分鐘的位置就永遠沒有了。地圖上變成一條橫跨街區、切過河面的直線。
  • 太稀:一次 SSH 加一次定位就要十幾秒,實際是 1.5 到 2 分鐘才一筆,開車時每個轉彎都被切掉。

所以改成手機自己記:位置先寫在手機本機,主機只負責同步。網路斷掉時照記,連上後一次補回來。

# 手機端:取一筆、寫一行(欄位:時間,緯度,經度,誤差,海拔,速度,來源)
j=$(timeout 15 termux-location -p gps -r once </dev/null)
echo "$(date +%s),$lat,$lon,$acc,$alt,$speed,gps" >> ~/gpslog/track.csv

# 主機端:只拉比資料庫新的行(since 是資料庫裡最後一筆的時間)
ssh -p 8022 phone "awk -F, -v t=$since '\$1>t' ~/gpslog/track.csv"

主機的同步指令順便檢查記錄程式還在不在,不在就把它叫起來,所以手機重開機後不用另外設自動啟動。

三、踩到的五個坑

坑 1:termux-* 指令會吃掉 stdin

用 ssh phone 'bash -s' <<EOF 一次送一整批指令過去測試時,跑到一半後面的指令全部不見,有些還假性逾時。原因是 termux-* 這些指令會讀標準輸入,把還沒執行的腳本內容當成輸入吃掉了。解法是每個指令後面加 </dev/null,或先把腳本 scp 過去再執行。

坑 2:室內等不到 GPS,Termux:API 被系統砍掉,通知狂跳

圖說:手機放在辦公室約一小時,累積了 50 則錯誤通知

手機帶進辦公室後,位置變成 20 分鐘才進來一筆,通知列還一直跳「Termux:API Error: Error in ResultReturner」。從手機的 logcat 看,Termux:API 這個 App 每 80 秒左右就被重啟一次:

09:12:42  TermuxAPIApplication: AppInit                 ← 行程啟動
09:14:05  com.termux.api: reacting to signal 3          ← 系統判定沒回應,要它吐堆疊
09:14:05  com.termux.api: Wrote stack traces to tombstoned
09:14:05  TermuxAPIApplication: AppInit                 ← 被砍掉後重啟
09:14:05  ResultReturner: java.io.IOException: Connection refused   (連續好幾筆)

termux-location -r once 是「等到下一筆定位才回」。室內收不到衛星就一直等,卡到系統判定這個 App 沒回應而砍掉它;這時排隊中的其他請求,客戶端早就逾時走了,App 重啟後一筆一筆回傳都找不到人,每筆失敗就跳一則通知。

對策是室內根本不要試 GPS。判斷方法很土但有效:手機連著家裡或公司的 Wi-Fi 就當作在室內,只讀系統已經算好的網路定位(-p network -r last,這個是立即回應的);連的是熱點或沒有 Wi-Fi 才進 GPS 模式。

INDOOR_SSIDS="家裡的SSID|公司的SSID"
if ssid | grep -qxE "$INDOOR_SSIDS"; then
  termux-location -p network -r last </dev/null   # 立即回應,不會卡
  sleep 60; continue
fi

坑 3:移動中的網路定位會把你丟回幾百公尺外

過橋的時候 GPS 有一次沒在時限內回應,程式退而求其次用了網路定位,結果拿到的是對岸 600 公尺外的舊位置(誤差標示 100 公尺)。軌跡就多了一條從南岸跳回北岸再跳回來的線。

網路定位靠的是周圍 Wi-Fi 基地台的位置資料庫,人在移動、又是連著一支也在移動的熱點時,它給的常常是過時的位置。處理分兩層:

  • 手機端:兩分鐘內有過 GPS 定位,就繼續等 GPS,不拿網路定位頂替。
  • 主機端:顯示和匯出前過濾,前後三分鐘內有 GPS 點的網路定位不採用;要時速 180 公里以上才到得了的點也丟掉。資料庫保留原始資料,只在輸出時濾。

坑 4:兩次 GPS 請求之間多做一件事,晶片就涼了

這個最難找。同一支程式,早上去程是 4 秒一筆、誤差 2 到 3 公尺;傍晚回程卻變成 8 到 30 秒一筆、誤差 10 公尺,軌跡變成鋸齒狀。

早上去程傍晚回程
取樣間隔約 4 秒8~30 秒
誤差2~3 公尺9~11 公尺
差別每輪:GPS → 休息 2 秒每輪:查 Wi-Fi 名稱 → GPS → 休息 2 秒

差別就是坑 2 加的那個「每輪先查 Wi-Fi 名稱」。查一次約 2 秒,加上原本休息的 2 秒,兩次 GPS 請求之間隔太久,GPS 晶片就關掉了;下一筆等於重新開機定位,要十幾秒,而且剛定到位的第一筆精度本來就差。請求夠密的時候晶片一直開著,每筆幾秒就回,精度也好。

改法是 GPS 剛定到位(10 秒內)就不查 Wi-Fi,直接要下一筆;只有 GPS 斷了一陣子才回頭查是不是進室內了。改完當場在戶外量 100 秒:

間隔(誤差):4(2m) 5(1m) 4(1m) 5(1m) 6(2m) 4(2m) 5(2m) 4(2m) 4(2m) 4(2m) 5(2m) 5(2m) 5(2m) 5(2m) 4(2m) 4(2m)

結論是:GPS 請求之間不要插任何耗時的動作,間隔維持在 4 秒左右。

坑 5:想讓 GPS 保持開著,反而更慢

在找到坑 4 的真正原因之前,我先猜是「GPS 晶片沒保溫」,於是在背景多開一個 termux-location -p gps -r updates 想讓晶片不要關。結果更糟。實測發現兩件事:這一版 Termux:API 的 updates 跑 32 秒只回一筆;而且定位請求是排隊一個一個處理的,背景那個佔著的時候,正常的請求全部被擋住。這個修改上線約兩小時就拿掉了。先量再改,比先猜再改省事。

四、網頁功能

圖說:手機上的即時畫面

  • 目前位置:藍點加誤差圈,下方顯示地址、時間、座標、誤差、定位來源、電量、目前時速。
  • 回現在位置:地圖跟著手機移動;手動拖地圖就停止跟隨,方便看別的地方。
  • 旋轉與車頭朝上:Leaflet 本身不能轉,用 leaflet-rotate 外掛。車頭朝上是拿最近兩分鐘內相距 20 公尺以上的兩個 GPS 點算行進方向,停著不動時沿用上一次的方向,不會亂轉。
  • 依日期查看、下載:選某一天看整天路線;可下載 GPX(匯入其他地圖軟體)或 CSV(Excel 直接開)。
  • 停止記錄:按一下,主機通知手機關掉記錄程式。停止的時段另外記在資料庫,那段時間的位置一律不匯入,地圖上直接斷開。

圖說:車頭朝上:地圖轉成行進方向朝上,左上的紅色箭頭指向北方

行程清單、時速上色、平滑

圖說:行程清單:自動切成一趟一趟,點一趟就只看那一趟

  • 切行程:資料中斷超過 5 分鐘,或在 60 公尺範圍內停留滿 5 分鐘,就算一趟結束。不到 200 公尺的不算,免得室內定位飄動被當成出門。
  • 時速:手機單次定位回來的速度欄位幾乎都是 0,所以用前後兩點的距離除以時間來算。軌跡線依時速分四級上色。
  • 交通方式:用移動中時速的中位數猜,只分走路、慢速、行車。開車和騎機車從速度分不出來,就不硬分。
  • 平滑:連續的 GPS 點做 1-2-1 加權平均,濾掉一兩公尺的左右跳動。地圖和 GPX 用平滑後的位置,CSV 給原始座標。

圖說:點進單一行程:藍色是 25~60 公里,橘色 7~25,綠色是 7 以下(等紅燈、轉彎)

五、資料量和耗電

  • 資料量:一筆約 70 位元組。每天外出兩小時(GPS 4 秒一筆)加上其餘時間在室內,一天約 0.2 MB,一年不到 100 MB。
  • 室內不重複存:位置沒變(30 公尺內)就不寫,只每 10 分鐘存一筆表示還活著。
  • 耗電:晚上連續記錄約 35 分鐘(多數時間 GPS 開著),電量從 98% 掉到 97%。樣本只有這一次,長時間的數字還要再觀察。

六、還沒做和已知限制

  • 車頭朝上、目前時速這兩項做好時手機都不在移動,只用指定方向的方式驗證過畫面,實際邊走邊轉的效果還沒看過。
  • 戶外長時間收不到衛星(例如地下停車場)時,仍可能偶爾跳一兩則 Termux:API 錯誤通知。
  • 手機靜置室內時系統會放慢背景程式,設定 60 秒一輪實際拉長到 3、4 分鐘。位置沒變所以影響不大,還沒處理。
  • 資料庫沒有備份,只有主機上一份。
  • 看一整週的軌跡時點數會很多,還沒做抽稀。
  • 室內的判斷靠 Wi-Fi 名稱清單,常待的新地點要手動加進去。

回頭看,這個專題真正花時間的不是地圖頁,而是搞清楚 termux-location 在各種情況下的行為:什麼時候立即回、什麼時候會卡住、卡住會拖累誰、請求之間隔多久晶片會關。這些文件上都沒寫,只能一個一個量出來。

CAN Bus in Practice EP4: Industrial Testing (Radar Fixtures, UWB Ranging, CAN FD Error Frames) | CAN Bus 實戰 EP4:工業實戰(雷達治具、UWB 測距、CAN FD 錯誤框)

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

English summary: The final episode of the "CAN Bus in Practice" series takes the DIY tools into the workplace. Five posts (2023–2026) become one story: a Mega2560 + MCP2515 radar test fixture with quantified PASS/FAIL, the production version verified with a PCAN-USB FD, using CAN as a command channel to put a 24 GHz radar into CW mode for a spectrum analyzer, ranging software that plots UWB distance and angle on a 360° view, and the ATS console's CAN FD tab: why 7,700 error frames per second meant the other side was sending CAN FD, and how scripts with UCI over CAN replaced the vendor's encrypted UWB ranging tool.

這是「CAN Bus 實戰」系列的第四集,也是最後一集。把部落格 2023~2026 年五篇工作上的 CAN 文章整理成一條線:從 Mega2560 雷達測試治具開始,走到產線版本、用 CAN 指令驗證 24 GHz 雷達的發射、把 UWB 的距離角度畫出來,最後回到 ATS 操作台解開「每秒 7700 個錯誤框」,並用腳本讓兩片 UWB 模組開始測距。影片有章節可以跳著看。

本集章節

  1. 雷達測試治具:1.5 m 金屬扇葉風扇、C# GUI → Mega2560 單軸 → 雷達 → CAN → PASS/FAIL、先用 CanHacker 驗證治具、Mega SPI 腳位、250 kbps。→ Arduino Mega2560 CAN Bus Radar Test System
  2. 產線版本與 24 GHz 雷達:最便宜的測試站+PCAN-USB FD 驗證;CAN 下 CW 指令、FSV40 頻譜分析儀量 TX。→ 雷達產品的CAN Bus測試、24G Radar TX Verify
  3. CAN Bus 測距通訊軟體:PeakCAN 雙通道接收、UWB Initiator/Responder、360 度距離角度圖、Webcam 對照。→ CAN Bus 測距通訊軟件開發
  4. ATS 操作台:CAN FD:PCAN FD 位元時序、依 ID 彙整、每秒 7700 個錯誤框怎麼解。→ ATS 操作台的 CAN 介面
  5. 腳本化與 UWB 測距:@expect 依序消耗、UCI over CAN 分段、四個腳本、11/06 實機約 106 cm。(同上篇)

本集重點

  • 做治具:先驗證治具,判定標準要量化;Mega2560 的 SPI 在 50~53 腳。
  • CAN 也能當指令通道:讓雷達進 CW 模式,頻譜上一根窄峰最好量。
  • UWB:DS-TWR 量距離、兩天線相位差換角度,天線間距 ≤ 半波長。
  • PCAN 開 CAN FD 要給完整位元時序(80 MHz、取樣點 80%)。
  • 錯誤框先解碼:接收端填充錯誤、REC 127 → 對方送 CAN FD,自己沒開 FD。
  • UCI 分段+依序 @expect,腳本就能取代原廠加密工具。

CAN Bus 實戰系列

補充資料

補充一:Mega2560 的 SPI 腳位

板子MOSIMISOSCKCS(常用)
Uno11121310
Mega256051505253

網路上的 MCP2515 範例多半照 Uno 接線,換到 Mega 照抄會一直 init fail。也可以直接接 ICSP 六針(每塊板子位置相同)。原文程式:MCP_CAN myCAN(53)、begin(MCP_NORMAL, CAN_250KBPS, MCP_8MHZ)——雷達這條匯流排是 250 kbps,不是 OBD-II 常見的 500 kbps。

小建議(讀程式發現,未實機驗證):原文把 getCanId() 存進 unsigned char,ID 大於 0xFF(例如 0x7E8)會被截成 0xE8,建議改 unsigned long。

補充二:為什麼驗證 TX 要用 CW 模式

  • 雷達平常多是 FMCW(頻率一直掃),能量分散在一段頻寬,頻譜分析儀上峰值不好判斷。
  • CW(連續波)固定單一頻率持續發射,頻譜上是一根窄峰,Peak Search 就能讀頻率與功率。
  • 24 GHz 雷達用 ISM 頻段 24.00~24.25 GHz,峰值應落在範圍內。

路徑損耗估算(示意,不是原文實測):FSPL(dB) = 20·log10(4πd/λ)。24.125 GHz 時 λ ≈ 12.4 mm,d = 1 m 約 60.1 dB、0.5 m 約 54.1 dB。EIRP ≈ 分析儀讀值 + 線損 + FSPL - 喇叭天線增益。產線實務:同治具、同距離先量黃金樣品訂上下限,之後比對讀值即可。

補充三:UWB 怎麼量距離和角度

距離用 DS-TWR(雙邊雙向測距):ToF = (Tround1·Tround2 − Treply1·Treply2) / (Tround1 + Treply1 + Tround2 + Treply2),兩邊時鐘誤差大致抵消;距離 = ToF × c,1 ns ≈ 30 cm。

角度用兩根天線的相位差(PDoA):sin(AoA) = λ·Δφ / (2π·d)。Channel 9(7987.2 MHz)λ ≈ 37.5 mm,天線間距要 ≤ λ/2(約 18.8 mm)才不會混淆;ATS 篇的 NCJ29D6 模組天線間距設 17 mm。

補充四:CAN FD 與傳統 CAN

傳統 CANCAN FD
資料長度最多 8 bytes最多 64 bytes
速率整框同一速率資料段可加速(BRS),例如 500k/2M
控制欄位r0 保留位元FDF 位元標示 FD 框

只支援傳統 CAN 的控制器收到 FD 框,會把它當錯誤並送錯誤框(除非是 FD-tolerant 收發器/控制器)。ATS 實機的「接收時填充錯誤、REC 127、每秒約 7700 個」就是這個情況:對方送 CAN FD,自己沒開 FD。

補充五:錯誤計數與節點狀態

狀態條件行為
Error ActiveTEC、REC 都 < 128偵測到錯誤送主動錯誤框(破壞該框,讓對方重送)
Error Passive任一 ≥ 128只送被動錯誤框
Bus OffTEC > 255退出匯流排,要重新初始化

REC 停在 127 正好是 Error Active 的上限:沒開 FD 的節點一直主動破壞對方的 FD 框,對方不停重送,於是錯誤框洗版。

若有問題歡迎留言討論!!!