2026年11月19日 星期四

Driving an ODrive Motor from ECU RPM: OBD-II PID 0C to Set_Input_Vel on One CAN Bus | ECU 轉速連動 ODrive:行車電腦 OBD 轉速換算後直接控制無刷馬達

上一篇〈ATS 操作台用 PCAN 控制 ODrive v3.6〉已經能在網頁上手動控制兩顆無刷馬達。這次要讓馬達「自己動」:從行車電腦模擬器用 OBD-II 讀引擎轉速,換算成馬達速度、加上限制,一直送給 ODrive 的 M1(A2212 1400KV,沒有編碼器的 sensorless 馬達)。引擎轉速升高,馬達就跟著轉快;熄火、斷線,馬達就停。

為了少一支 PCAN,ODrive 和模擬器接在同一條 CAN bus 上,全部交給 ATS 處理。功能一天就寫好、在模擬環境測過,真正花時間的是實機接上去之後的幾個坑,這篇都記下來。

圖說:整體架構:PCAN、行車電腦模擬器、ODrive 三個節點在同一條 500k 的 CAN bus 上

做法

1. 讀轉速:OBD-II PID 0C

ATS 原本就有 OBD 掃描頁。引擎轉速是 Mode 01 的 PID 0C:送功能定址 7DF 02 01 0C,ECU 從 7E8 回 04 41 0C A B,轉速=(A×256+B)/4 rpm。OBD 頁平常會輪流問儀表那 8 個 PID 再加一個其他的,轉速大約每 0.5 秒才更新一次,太慢。所以連動多了一個選項「OBD 只問轉速」,打勾時只輪詢 0C,實測每秒約 14 次,資料延遲約 50 ms。

2. 換算與限制

  • 線性換算:轉速下限 → 速度下限、轉速上限 → 速度上限之間拉一條直線,超出範圍就停在兩端。實測用 600~8000 rpm 對 5~40 turns/s。
  • 熄火就停:低於 500 rpm 送 0。速度下限設 5 turns/s 是因為 sensorless 太慢轉不穩。
  • 速度上限:不管換算出多少,最多 40 turns/s(ODrive 本身的 vel_limit 是 50)。
  • 加減速斜率:20 turns/s²,轉速跳動時馬達不會跟著猛拉。
  • ECU 逾時:500 ms 沒有新的轉速就把目標歸 0。
  • 反轉:勾了就送負的速度。

圖說:換算規則(藍線)和實機量到的點(橘點):轉速約 5150 rpm 時 M1 約 26.6 turns/s,落在線上

3. 送速度給 ODrive

ODrive 韌體 0.5.6 走 CANSimple,CAN ID=node×32+指令。M1 是 node 3,Set_Input_Vel 是指令 0x0D,所以 ID 是 0x06D,資料是兩個 little-endian float(速度 turns/s、力矩前饋)。連動開始時先送 Set_Controller_Mode 切成「速度控制+PASSTHROUGH」,斜率由 ATS 自己算,之後每 50 ms 送一次速度。

同一條 bus 上 ID 會不會打架?ODrive 兩軸(node 2、3)用的是 0x40~0x7F,OBD 用 0x7DF/0x7E8,不會衝突。

4. 網頁畫面

在 ATS 的 ODrive 頁下面加一張「ECU 轉速連動」卡片:轉速來源可以選同一條 bus 或另一支 PCAN,所有參數都能在畫面上改、按「套用設定」立即生效。下面四格即時顯示 ECU 轉速、目標速度、送出速度(含斜率)和轉速資料延遲。

圖說:實機畫面:ECU 5153 rpm → 目標 26.53 turns/s,轉速資料延遲 47 ms

圖說:同一時間的 M1:閉迴路、26.63 turns/s,沒有錯誤

實測結果

連動中從 ATS 的 WebSocket 錄 60 秒(約 300 點):模擬器的轉速在 5117~5245 rpm 之間小幅跳動,目標速度跟著在 26.36~26.97 turns/s 之間變,M1 實際速度和目標的差距平均 0.11 turns/s、最大 0.47。OBD 這段時間 4510 次查詢只逾時 4 次。

圖說:60 秒實錄:藍線是由轉速換算的目標,橘線是 M1 的 sensorless 估計速度(縱軸只放大 26~27 turns/s 這一段)

實機踩到的坑

坑 1:ODrive 還是 250k,bus 上全是錯誤框

模擬器是 500k,ODrive 出廠設定是 250k。PCAN 用 500k 一連上,2 秒就是 5 萬多個錯誤框,ATS 自動斷線。CAN 讀不到 ODrive 的設定,改走 ODrive 的 USB 序列埠(ASCII 協定):w can.config.baud_rate 500000 → ss 存檔 → sr 重開,再讀回確認是 500000。之後只接 ODrive 的 5 秒內收了 1106 框、零錯誤。

坑 2:零星錯誤框被當成錯誤風暴

模擬器接上 bus 後會有零星的接收錯誤框(平均幾秒一個),PCAN 的錯誤計數一直停在 1,OBD 也照樣有回應。但 ATS 原本的規則是「錯誤持續 2 秒就斷線、剛送過框又出錯 0.5 秒就重開通道」,把它當成風暴,結果一直斷線、或重開通道打斷 OBD。改成:一波至少 50 個送出時的錯誤才重開通道(接收錯誤是別人的框壞掉,重開自己沒用),至少 500 個且持續 2 秒才斷線;零星的只在紀錄裡報告。

坑 3:模擬器卡住後,OBD 不會自己再問

模擬器一度沒回應,OBD 掃描第一次問不到支援表就停在「沒有回應」,模擬器好了也不會再試,要手動重開 OBD。改成沒回應時每 3 秒自動重試(紀錄只寫第一次),模擬器一回應連動就自己接上。

坑 4:OBD 重開後「只問轉速」失效,馬達一頓一頓

「只問轉速」原本是開始連動時設在當下那個 OBD 掃描器上。OBD 被停掉重開後換了一個新的,又回到輪詢全部 PID,轉速約 0.5 秒才更新一次,剛好碰到 500 ms 的逾時,速度在「歸 0」和「恢復」之間一直跳。改成每次讀轉速時都把設定套到目前的掃描器。

坑 5:模擬器 bus-off

有兩次模擬器只回了 1~2 秒,接著來一波錯誤,然後完全不說話,bus 上也沒有錯誤框了。ODrive 照樣在回 ACK,表示 bus 是通的,是模擬器自己停了。研判是錯誤太多進入 bus-off,模擬器斷電重開、重新檢查接線後才恢復。其中一次是在模擬器的 GND 拉到 PCAN 共地之後發生的,零星錯誤框的根本原因(接線、地、或模擬器本身的位元時序)還沒查清楚,先記下來。

安全:打開 ODrive 看門狗

連動時馬達是一直轉的。按「停止連動」或停止 ODrive 控制,ATS 都會先送速度 0;但如果 ATS 當掉、被直接關掉,或 PCAN 被拔掉,ODrive 會一直維持最後的速度。所以把 ODrive 兩軸的看門狗打開:config.enable_watchdog = 1、config.watchdog_timeout = 1.0(秒),存檔。ATS 開著 ODrive 控制時每 0.1 秒會用 RTR 問一次狀態,連動時每 50 ms 送一次速度,這些 CAN 指令都會餵看門狗;1 秒沒收到,該軸就自己回 IDLE。

副作用是 ATS 沒在跑 ODrive 控制時,兩軸會帶著 WATCHDOG_TIMER_EXPIRED 錯誤,所以使用順序變成:ODrive 頁按「開始」→ 兩軸「清錯誤」→ M1「閉迴路」→「開始連動」。ATS 的「設定(USB)」也加了看門狗兩欄,可以直接看、改、存檔。

小結

  • OBD 讀轉速 → 線性換算、限制、斜率 → Set_Input_Vel,ECU 和 ODrive 共用一條 500k CAN bus 可行,ID 不衝突。
  • 只問 PID 0C 時轉速每秒約 14 次、延遲約 50 ms,M1 跟目標的差距平均 0.11 turns/s。
  • 沒有編碼器的 M1 用 CAN 切進 sensorless 閉迴路,這次在實機上確認可行。
  • 實機上最花時間的是實體層:鮑率、終端電阻、錯誤框的判讀,以及模擬器 bus-off。
  • 還沒做:零星錯誤框的根本原因、用示波器看 CAN-H/L 波形。

沒有留言:

張貼留言