OpenAMR 組裝指南
開源倉儲自主移動機器人(AMR),具備光達(LiDAR)SLAM 導航與 150 kg 負載
授權條款
- CAD, schematics, design files and manufacturing source: CERN-OHL-P 2.0 (permissive)
- documentation: CC BY 4.0
- software and firmware: MIT
依部分授權。原創的 CAD、電路圖、機構與電氣設計檔案及製造原始檔採用 CERN-OHL-P-2.0,原創文件採用 CC BY 4.0,原創軟體與韌體採用 MIT。衍生自 linorobot2 的韌體覆蓋檔案採用 Apache-2.0,儲存庫中的資料表則仍為其製造商所有之著作。查核日期:2026 年 11 月 2 日。
組裝指南
1. 概覽與準備
1.1 閱讀文件並準備材料
請閱讀硬體儲存庫,而不是舊版儲存庫:其中包含機械與電子物料清單、配線與腳位圖、電源與安全注意事項,以及 CAD 檔案。
- 原專案沒有為這台機器人發布有編號步驟的組裝手冊。它發布了一支驅動輪組裝影片與五張無說明文字的圖片、有編號的生產圖面與 CAD 檔案(MMP.*)、一份附有扣件位置對照表的機械物料清單、一份電氣物料清單,以及每個電氣子系統各一份文件。
- 底盤的組裝順序並未公開。因此本指南的步驟列出原專案有明確說明的零件、接合處與扣件;其順序沿用本指南先前的版本,並非原專案的順序。
- 接線前請先閱讀,因為這可能造成硬體實體損壞:Teensy 4.0 的 GPIO 為 3.3 V,不耐受 5 V(絕對最大值約 3.6 V)。將 5 V 訊號輸入 Teensy 的輸入腳可能燒毀該腳位或整片板子。AS5040 編碼器必須由 3.3 V 電源供電,不能用 5 V。目前尚未裝設保險絲,也沒有電池端的斷電開關。
- 文件中記載了兩代硬體。已完成接線、燒錄並實際行駛過的是現有機器人 OpenAMRobot v0.0.1,文件中稱為 Gate A 單元。本指南依循此版本:Teensy 4.0、Raspberry Pi 5、兩台 ZBLD.C20-120L2R 驅動器、RPLIDAR A1、Raspberry Pi Camera Module 3 NoIR 與一顆 MPU6500 IMU。
- OpenAMRobot 2.0 正在硬體儲存庫的 main 分支上開發中:STM32H723ZG 底盤控制器、一台 Jetson、RPLIDAR S3、Orbbec Gemini 336L 相機、ICM-42688-P IMU、四顆 MaxBotix MB7060 超音波感測器,以及兩顆 Benewake TF-Luna 防跌落感測器。原專案表示,其 2.0 控制器頁面列出的是需求而非腳位,因此 2.0 控制器目前沒有接線文件。
- 原本的儲存庫 openAMRobot/openamr 已拆分到硬體、軟體與韌體三個儲存庫,現在主要作為歷史參考保留。其 wiki 描述的是較舊的 ROS 1 架構,內容已過時。
- 硬體儲存庫中的二進位 CAD 檔案(STEP、SLDPRT、SLDASM、SLDDRW、DXF、PDF、zip)以 Git LFS 儲存;請在已安裝 Git LFS 的環境下複製,才能取得實際檔案而非指標檔。
- 原專案表示,若所有零件都已備妥,一個人一天內就能組裝完成這台機器人,但需要具備電子、軟體與機械的基本知識。
1.2 準備所需工具
原專案沒有發布工具清單;其文件只提到,未加彈簧墊圈的螺絲要使用螺絲固定劑,以及在接上 24 V 之前要用三用電錶確認線材顏色。
- 未加裝彈簧墊圈的螺絲應以螺絲固定劑固定,例如 Loxeal 55-03。
- 這台機器人的導線顏色僅供推測:接上 24 V 導線前,請先用三用電表確認。
- 硬體儲存庫沒有列出其他工具。
1.3 委託鈑金加工
將鈑金零件的 PDF 與 DXF 檔案寄給加工廠:鋼材 EN 1.0114,厚度 0.8、1.2 與 2.0 mm,折彎係數 K 0.47,塗裝 RAL9016。
- 鈑金零件會因製作方式而有差異。設計所假設的 K 係數為 0.47,內彎半徑 R 為:0.8 mm 板 1.2、1.2 mm 板 1.5、2.0 mm 板 2.4。請將這些數值提供給加工廠商。
- 各零件厚度,材質皆為 EN 1.0114 鋼、塗裝 RAL9016:Front panel MMP.00.00.00.001 與 Back panel MMP.00.00.00.002,2 mm;Side panel MMP.00.00.00.003(數量 2),0.8 mm;Cover MMP.01.00.00.001,0.8 mm;Cover flange MMP.01.00.00.002(數量 2),0.8 mm;Base MMP.02.00.00.001,2 mm;Wheel bracket outer MMP.03.00.00.001、Wheel bracket inner MMP.03.00.00.002 與 Motor bracket MMP.03.00.00.003(各數量 2),2 mm;Center bracket MMP.04.00.00.001,2 mm;Support MMP.05.00.00.001 與 Support MMP.05.00.00.001-01(各數量 2),1.2 mm;Lidar support MMP.07.00.00.001,1.2 mm。
- Drive shaft MMP.03.00.00.004(數量 2)材質為 37Cr4 鋼,提供 PDF、SLDDRW、SLDPRT 與 STEP,但沒有 DXF。Plastic cover MMP.00.00.00.004 只以 SLDPRT 與 STEP 發布。
- 版本注意事項:main 分支現在放的是 OpenAMRobot 2.0 的 Revision B 前後面板(新的 STEP 與 DXF,原生檔已移除,PDF 圖面仍為 Rev A,DXF 只有面輪廓,展開圖仍然缺少)。現有機器人的原始檔案保留在硬體儲存庫的 release 標籤 v0.0.1。若要製作本指南所依循的機器人,請依 v0.0.1 的檔案下單。
1.4 選用:為底盤零件上漆
零件可在折彎後上漆(零件清單標示 RAL9016);原專案在上漆後才安裝拉帽,若螺紋有做好防塗料保護,也可在上漆前安裝。
- 折彎後,零件可以進行塗裝。塗裝後再安裝拉帽。也可以在塗裝前安裝拉帽,但必須保護拉帽的螺紋部分不被塗料覆蓋。
2. 底盤組裝
2.1 在所有底盤零件上安裝拉帽
在底盤零件上安裝不鏽鋼拉帽(M4 x 58、M5 x 48、M6 x 16、M8 x 8)與 16 個 Al/St 4.0x8 DIN 7337 拉釘。
- 拉帽為 Blind Rivet Nut - Round Thin - Stainless Steel。一個平台的總數:M4 58、M5 48、M6 16、M8 8。
- 安裝位置:Base assembly MMP.02.00.00.000,26 x M4 與 16 x M6;Wheel assembly MMP.03.00.00.000(兩個輪組合計),8 x M4 與 40 x M5;Center bracket assembly MMP.04.00.00.000,8 x M5 與 8 x M8;Support assemblies MMP.05.00.00.000 與 MMP.05.00.00.000-01,各 10 x M4;Lidar support assembly MMP.07.00.00.000,4 x M4。
- Center bracket assembly 另外使用 16 顆 Al/St 4.0x8 DIN 7337 抽芯鉚釘。
2.2 組裝底板
Base(MMP.02.00.00.001,2 mm 鋼板)是中央支架、支撐件、腳輪、輪組與光達(LiDAR)支架鎖附的零件。
- 扣件表列出以下與底座的接合:Center bracket to base、Support assemblies to base、Light duty swivel castors to base、Wheel assemblies to base 與 Lidar support assembly to base。Base assembly 上還有拉帽(26 x M4、16 x M6)。
2.3 安裝中央支架
用 16 顆 M5x20 DIN 912 螺絲、16 個 5 DIN 125 墊圈與 16 個 5 DIN 7980 彈簧墊圈,將中央支架組件(MMP.04.00.00.000)固定到底板上。
- Cover 之後會以螺栓固定到 Center bracket 上(請見上蓋步驟)。
2.4 安裝支撐結構
用 8 顆 M4x16 DIN 912 螺絲、8 個 4 DIN 7980 彈簧墊圈與 8 個 4 DIN 9021 大墊圈,將支撐組件(MMP.05.00.00.000,數量 2;MMP.05.00.00.000-01,數量 2)固定到底板上。
- 用 8 顆 M4x16 DIN 912 螺絲、8 片 4 DIN 7980 彈簧墊圈與 8 片 4 DIN 9021 大墊圈,將 Support assemblies(MMP.05.00.00.000,數量 2,以及 MMP.05.00.00.000-01,數量 2)固定到底座上。
2.5 安裝前後面板
用 M4x12 DIN 967 與 M4x16 DIN 967 螺絲固定前面板(MMP.00.00.00.001)與後面板(MMP.00.00.00.002)。
- 扣件表列出 Front panel - up:4 顆 M4x12 DIN 967 螺絲,以及 Front panel - down:10 顆 M4x16 DIN 967 螺絲。Back panel 沒有另列一行。
- 現有機器人的前面板上,緊急停止開關與按鈕裝在 22.5 mm 的孔中。這些是 release 標籤 v0.0.1 的 Rev A 面板;main 上的 Rev B 面板適用於 OpenAMRobot 2.0。
2.6 安裝側板
用 32 顆 M4x12 DIN 967 螺絲固定兩片側板(MMP.00.00.00.003,0.8 mm 鋼板)。
- 用 32 顆 M4x12 DIN 967 螺絲固定兩片 Side panel(MMP.00.00.00.003,0.8 mm 鋼板)。
2.7 安裝腳輪
用 16 顆 M6x20 DIN 912 螺絲、16 個 6 DIN 125 墊圈與 16 個 6 DIN 7980 彈簧墊圈,將四個 Blickle LPA-VSTH 35K 輕型萬向腳輪固定到底板上。
- 用 16 顆 M6x20 DIN 912 螺絲、16 片 6 DIN 125 墊圈與 16 片 6 DIN 7980 彈簧墊圈,將四個 Blickle LPA-VSTH 35K 輕型萬向腳輪固定到底座上。
3. 驅動輪組裝
3.1 準備車輪支架組件
為兩個車輪模組分別準備物料清單中列出的三個支架、驅動軸、Blickle 車輪、兩個軸承座、兩個平鍵、馬達與編碼器零件。
- 原專案僅以一支輪組組裝影片與五張圖片呈現這個模組的組裝順序,並表示左右兩側以相同順序組裝。這些圖片沒有說明文字。
- 每個輪組模組:Wheel bracket outer MMP.03.00.00.001、Wheel bracket inner MMP.03.00.00.002、Motor bracket MMP.03.00.00.003、Drive shaft MMP.03.00.00.004、一個 Blickle GEVN 200/30H7 重型驅動輪、一個 REXNORD UCFL 205 C 655472(d25)與一個 REXNORD UCFL 206 C 666412(d30)菱形法蘭軸承座、一支 4x4x25 與一支 8x7x28 平鍵(DIN 6885-UNI 6604),以及一顆 Z4BLD60-24GN-30S/4GN 25K 馬達。
- 兩個輪組模組合計的扣件:8 顆 M5x20 DIN 912 螺絲、8 顆 M5x70 DIN 912 螺絲、8 顆 M10x45 DIN 912 螺絲、4 顆 M3x12 DIN 965 螺絲、4 顆 M3 DIN 934 螺帽、8 顆 M10 DIN 934 螺帽、16 片 5 DIN 125 墊圈、12 片 10 DIN 125 墊圈、8 片 10 DIN 7980 彈簧墊圈,以及前面列出的拉帽。
- 物料清單中沒有列出扣環或 C 型扣環。
3.2 在車輪支架上安裝法蘭軸承
在每個車輪模組上裝一個 REXNORD UCFL 205 C(d25)與一個 UCFL 206 C(d30)菱形法蘭軸承座。
- 物料清單沒有說明哪個軸承座裝在哪個支架上;原專案只在系列圖片與影片中呈現這一點。工作簿另外提到,軸承座部分可能有些細節需要注意,而且所有零件彼此高度關聯。
3.3 安裝無刷馬達
將搭配 4GN 25K 減速箱(25:1)的 ZD Z4BLD60-24GN-30S 馬達裝到馬達支架 MMP.03.00.00.003 上,並使用物料清單中列出的平鍵。
- 馬達:三相 BLDC,24 V,60 W,額定 3.8 A,3000 rpm,P=5(銘牌上標示 5 對極),搭配 1:25 正齒輪減速箱(4GN 25K),輪端轉速 120 rpm,每輪額定扭矩約 3.48 N.m。尾碼 -30S 是 ZD 系列代碼,不是減速比。
- 物料清單列出 4x4x25 與 8x7x28 平鍵(兩個輪子各數量 2),但沒有文字說明哪支鍵裝在哪裡;請從系列圖片或影片中判斷。
3.4 安裝驅動軸與車輪
將驅動軸 MMP.03.00.00.004(37Cr4 鋼)穿過軸承座,並以其平鍵將 Blickle GEVN 200/30H7 車輪裝在軸上。
- 輪子為 Blickle GEVN 200/30H7:直徑 200 mm,30 mm H7 軸孔。驅動軸在其輸出端裝有磁性編碼器(請見編碼器步驟)。
3.5 組裝完整的車輪模組
依照五張車輪組裝圖片與車輪組裝影片,以相同順序組裝左、右車輪模組。
- 驅動輪組件(馬達、減速箱、驅動軸與支架,MMP.03.*)依五張圖片所示的順序組裝。左右兩側依相同順序進行。各零件的生產圖面(PDF 與 DXF)請見 mechanical/cad/production_files。
3.6 將車輪組件裝到底盤上
用 16 顆 M5x20 DIN 912 螺絲、16 個 5 DIN 125 墊圈與 16 個 5 DIN 7980 彈簧墊圈,將兩組車輪組件固定到底板上。
- 用 16 顆 M5x20 DIN 912 螺絲、16 片 5 DIN 125 墊圈與 16 片 5 DIN 7980 彈簧墊圈,將兩個輪組組件固定到底座上。
4. 電子零件安裝
4.1 安裝電池
裝上任何電池化學類型的 24 V 電池組;原專案的參考組裝使用兩顆串聯的 12 V 7 Ah 密封鉛酸電池(DM12-7S)。
- 此設計可使用任何 24 V 電池:驅動器與 DC-DC 轉換器只看到 24 V 匯流排,與電池化學類型無關。
- 參考組裝:4 顆 DM12-7S 12 V 7 Ah 密封式鉛酸(AGM)電池,每 2 顆串聯得到 24 V。實際上只使用一組,即 24 V 7 Ah。
- 參考用的鉛酸電池組:注意極性,不要讓端子短路(電流非常大),使用合適的鉛酸充電器充電,且不要深度放電到完全沒電。LiFePO4 與鋰離子電池需要各自的 BMS、充電器與電壓限制。
- 電池在負載下電壓會下降。測試步驟中的靜置電壓門檻適用於參考用的鉛酸電池組;若使用其他電池化學類型,請自行調整。
- 電源文件指出,兩組電池可以組成 24 V(兩組並聯)或 48 V(兩組串聯)。ZBLD.C20-120L2R 驅動器的額定電壓為 24 V 正負 20%,而且沒有任何文件描述 48 V 的組裝,因此本指南只涵蓋 24 V。
- 現有機器人中電池的固定位置與方式並未記載。
4.2 安裝主電源分配
將 24 V 電源接到兩個驅動器的 V+ 與 V-,以及供 Raspberry Pi 使用的 24 V 轉 5 V 轉換器,並加上原專案指出缺少的保險絲與電池斷電開關。
- 架構:24 V 電源並聯供電給兩台驅動器的 V+ / V-,以及一個為 Raspberry Pi 供電的 24 V 轉 5 V DC-DC 轉換器。Teensy 經由 USB 由 Pi 供電。IMU 與編碼器從 Teensy 取得 3.3 V。
- 這台機器人的電源線顏色與直覺相反:棕色 = V+,藍色 = V-。顏色僅供推測:接上 24 V 導線前,請先用三用電表確認。
- 安全缺口 1:電池上沒有保險絲,而 24 V 電池在短路時可輸出數百安培的電流。請在電池正極加裝保險絲或斷路器,位置盡量靠近端子。規格估算:2 顆馬達以額定 3.8 A 計約 7.6 A,再加上 DC-DC 轉換器,因此約 15 到 20 A。這是高於額定電流、而非堵轉電流的數值;卡住的馬達電流會遠超過 3.8 A,因此定案前請確認馬達的堵轉電流。
- 安全缺口 2:電池端沒有斷電開關;只有市電端有開關。請在電池正極加裝開關或斷電裝置,最好是蘑菇頭緊急停止開關。只使用具有認證強制開路接點(IEC 60947-5-5)的緊急停止開關;未經認證的仿製品不建議用於任何用途。Schneider XB4-BS542 接點在 24 V 下約為 3 A DC-13,因此應以常閉接點切斷接觸器線圈,而非直接切斷馬達全電流。建議加裝不依賴 ROS 的實體緊急停止開關。
- 安全缺口 3:一顆 24 V 電池與一台 230 V AC/DC 轉換器並聯接在同一條匯流排上。若兩者同時接上,較強的電源會反灌到另一個電源。一次只能接一個電源;加裝電源切換開關才能確保安全。
- 230 V 交流電可能致命;流經人體約 30 mA 就已經很危險。最低防護措施:原專案迴路裝設 30 mA 漏電斷路器、所有 230 V 配線都封在密閉盒內、轉換器的金屬機殼接地、市電輸入端裝設保險絲或斷路器,以及市電線加上應力消除。觸碰電源側任何部件之前,請先切斷或拔除市電;絕對不要帶電作業。
4.3 安裝並連接馬達驅動器
將兩個 ZBLD.C20-120L2R 驅動器各自接到 24 V、對應的馬達接頭(U、V、W 與霍爾)以及來自 Teensy 的四條訊號線;不使用 RS485。
- 驅動器:ZBLD.C20-120L2R,24 V 正負 20%,輸出 7.5 A,120 W,開迴路或閉迴路,5 個 NPN 數位輸入與 2 個數位輸出。每個輪子一台:左 = MOTOR1,右 = MOTOR2。製造商的圖示要求電源供應器的額定功率大於馬達額定功率的 2 倍,並建議馬達到驅動器的線長短於 1 m。
- 驅動器電源:V+ / V- = 24 V DC,接在右下角的大型螺絲端子上(標示為 电源DC24V),並加裝保險絲。棕色 = V+,藍色 = V-;請先用三用電表確認。
- 馬達連接器(白色 Molex,8 針):U、V、W(相線)、Hu、Hv、Hw(霍爾 U、V、W)、Vcc(+5 V 霍爾電源)、0V(霍爾 GND)。驅動器根據霍爾感測器為馬達換相;Teensy 完全不會接觸到 U/V/W 或霍爾訊號。製造商的圖示列出馬達線顏色:U 粗黃線、V 粗綠線、W 粗藍線、5V 細紅線、Hw 細藍線、Hv 細綠線、Hu 細黃線、Com 細黑線。
- 訊號端子台,12 個位置,每台驅動器恰好接 4 個:VAR/AI2 = 速度設定值,類比 0-5 V(Teensy PWM,3 kHz);FWD/DI1 = 正轉;REV/DI2 = 反轉;COM = 共同接地,必接。左驅動器:PWM 接腳 1、IN_A 接腳 20、IN_B 接腳 21。右驅動器:PWM 接腳 5、IN_A 接腳 6、IN_B 接腳 8。
- 未使用的端子:JOG/DI3、CLR/DI4、BRK/DI5、+5V、ERR/DO1、SPD/DO2 與 A+/B-(未使用 RS485)。驅動器的 COM 必須連到 Teensy 的 GND,否則訊號與編碼器會有雜訊。
- DIP 開關,兩台驅動器設定相同:SW1 OFF、SW2 ON、SW3 OFF、SW4 ON、SW5 ON、SW6 OFF。SW1 OFF = 開迴路,因此 Teensy 的 PID 是唯一的調節器。SW2 ON = 速度來源為 AI2,也就是接收 Teensy PWM 的外部 0-5 V 輸入。SW3 OFF = 內部控制,而非 RS485 控制。SW6 OFF = 不使用 RS485 終端電阻。SW2 ON 時,VAR 電位器不會設定速度。
- 極對數:原專案依 2026-06-19 讀取的驅動器絲印,針對馬達的 5 對極設定 SW4 ON 與 SW5 ON,並發現之前是設在 OFF/OFF(2 對極)。同一儲存庫中製造商的參考圖示則顯示相反的對應(2 對極 = SW4 ON、SW5 ON;5 對極 = SW4 OFF、SW5 OFF)。此設定只在閉迴路中使用,而 SW1 OFF 已避開閉迴路;採用前請先查看你自己驅動器上印的表格。
- 每台驅動器有兩個微調電位器,左右兩台必須設定一致:VAR(上方)約 3.5/10,ACC/DEC(靠近 DIP 開關)4/10。在 SW2 ON 時,這些是保持不動的設定值,不是用來平衡左右的旋鈕。
- 驅動器偵測到故障時會停止馬達,並以綠色與紅色 LED 閃爍故障代碼;故障會一直保持,直到 24 V 斷電後重新上電。代碼 10 為匯流排欠壓(24 V 過低)。代碼 7 到 9 為過壓(電源高於 28.8 V)。代碼 13 為霍爾感測器錯誤,代碼 30 為馬達缺相。
- 現有機器人中 ZBLD 驅動器的固定位置並未記載;main 上的 3D 列印 Motor driver mount MMP.02.00.00.002 是給 2.0 版的 ZLAC8015D 驅動器使用的。
4.4 安裝 Teensy 微控制器
依下列腳位將 Teensy 4.0(不是 4.1)接到兩個驅動器、兩個編碼器與 IMU,並將它的 USB 埠接到 Raspberry Pi。
- 控制器為 Teensy 4.0(NXP i.MX RT1062,Cortex-M7,600 MHz)。原專案的物料清單、配線、韌體環境(teensy40)與燒錄文件都指名 Teensy 4.0;韌體儲存庫中只有一個給 4.1 用的空白預留資料夾。
- 邏輯電位為 3.3 V,並非所有接腳都耐受 5 V。將 5 V 訊號輸入輸入腳可能燒毀該接腳或整片板子。
- 接腳:IMU SDA 18、IMU SCL 19。左編碼器(M1)A 14、B 15。右編碼器(M2)A 11、B 12。左馬達(M1)PWM 1、IN_A/FWD 20、IN_B/REV 21。右馬達(M2)PWM 5、IN_A/FWD 6、IN_B/REV 8。除錯 LED 13。micro-ROS 經由原生 USB 序列埠通訊,鮑率 115200。MOTOR1 為左輪,MOTOR2 為右輪。
- 在 Teensy 4.x 上,接腳 21 不是 PWM 接腳,因此左側 PWM 使用接腳 1;原專案稱這是常見的陷阱。
- 電源:Teensy 經由 USB 由 Raspberry Pi 供電(5 V)。IMU 與編碼器從 Teensy 的 3.3 V 電源取電;5 V(VUSB)接腳不供電給任何元件。Teensy 的 GND 接到兩台驅動器的 COM。
- USB:原生序列埠,顯示為 /dev/ttyACM0;Teensy 是 micro-ROS 用戶端,agent 在 Pi 上執行。接腳 13 的 LED:重複閃 3 下表示初始化失敗(無法辨識 IMU,或 ROS 實體建立失敗);恆亮表示已連上 agent。
- 在基本組裝中,Teensy 沒有 RS485 連線。RS485 只以 ZBLD 驅動器上一組未使用的端子(SW6 OFF)出現,以及作為選配 ZLAC8015D 驅動器的介面。
- Teensy 如何固定並未記載;物料清單中的 TFF-M3/25 間隔套筒是列給相機使用的。
4.5 安裝 Raspberry Pi 5
安裝搭配官方 Active Cooler 的 Raspberry Pi 5(8 GB),由 DC-DC 轉換器供應 5 V、5 A 電源,並以 USB 連接 Teensy 與光達(LiDAR),以 CSI 排線連接相機。
- 型號:Raspberry Pi 5 Model B Rev 1.1,8 GB。請加裝官方的 Raspberry Pi 5 Active Cooler:經驗證的機器人原本沒有裝,Pi 在執行機器人軟體堆疊時降頻,核心溫度達 83.4 °C(硬性上限為 85 °C),時脈被限制在約 2.1 GHz(正常為 2.4 GHz)。
- Pi 5 需要 5 V / 5 A。啟動時馬達、光達與相機會同時開始運作;電流突波可能讓 5 V 電源崩潰,Pi 隨即當機並從網路上消失。請使用峰值額定至少 5 A 的 5 V 降壓轉換器並搭配短而粗的線材,同時讓電池靜置電壓保持在 25 V 以上。
- 連接:Teensy 接 USB(/dev/ttyACM0);光達經由 CP2102 橋接晶片接 USB(/dev/ttyUSB0);相機接 CSI 排線,不是 USB。由於編號可能在重新開機後改變,請優先使用穩定的 /dev/serial/by-id 路徑。
- Pi 在底盤中如何固定並未記載。
4.6 安裝 DC-DC 轉換器
從 24 V 匯流排接一個額定 5 A 以上的 24 V 轉 5 V 降壓轉換器,只供電給 Raspberry Pi。
- 轉換器為 Raspberry Pi 供電。Teensy 不由它供電。
- 電子物料清單為 Raspberry Pi 列出一個 LM2596 降壓轉換器(24V 轉 5V,5 A 以上)。參考機器人使用的是一個約 300 W 20 A 的通用降壓轉換器(有環形電感與 2 個微調電位器),沒有明確型號。
5. 感測器安裝
5.1 安裝光達(LiDAR)感測器
用 4 顆 M2.5x6 DIN 7985 螺絲將 RPLIDAR A1 裝在光達支架(MMP.07.00.00.001)上,並透過其 CP2102 轉接板以 USB 連接到 Raspberry Pi。
- 現有機器人使用 Slamtec RPLIDAR A1(從外形判斷為 A1M8;型號貼紙仍待確認)。OpenAMRobot 2.0 將它換成 RPLIDAR S3(S3M1-R2)。
- 光達到支撐組件(扣件表):4 顆 M2.5x6 DIN 7985 螺絲、4 片 2.5 DIN 125 墊圈、4 片 2.5 DIN 7980 彈簧墊圈。
- 在現有機器人上量測的位置:位於輪軸前方 33.5 cm、置中,安裝時旋轉 180 度。它的 0 度朝向後方;機器人的正前方是光達的 180 度(靜態轉換 x 0.335 m、y 0、z 0.18 m、yaw pi)。
- 連接:經由 Silicon Labs CP2102 USB 轉 UART 橋接晶片(10c4:ea60)以 USB 連接到 Pi,由 USB 供電。通訊協定:115200 鮑,Standard 掃描模式。輸出 /scan,約 7 Hz,量測範圍 0.15 到 12 m。
- 機器人本身的框架會在多個方向產生近距離回波,因此必須以 scan_body_filter 將其遮蔽,產生供 Nav2 使用的 /scan_filtered。不要在驅動程式掃描時強行終止它:它會卡住。先重新啟動節點一次,若仍失敗,再拔插 USB。
5.2 選用:近接與超音波感測器(不在基本組裝內)
原專案在物料清單中列出 E18-D80NK 紅外線近接感測器與一個 JSN-SR04T 超音波感測器,但將超音波與紅外線感測環列為選用的額外安全套件,而非基本組裝的一部分。
- 物料清單列出 Proximity sensor E18-D80NK(數量 4)與 US sensor JSN-SR04T(數量 1)。架構頁面則將超音波(JSN-SR04)與紅外線(E18-D80NK)接近感測環列為圖中所示、但不屬於基本配置的項目。
- 沒有任何文件提供它們的配線或接腳定義;Teensy 的接腳表中也沒有它們的項目。
- OpenAMRobot 2.0 則改用 4 顆 MaxBotix MB7060 XL-MaxSonar-WR 超音波感測器(RS232 輸出;每顆使用一個 STM32 UART,9600 8N1 並將接收反相,另各有一個觸發用 GPIO)以及 2 顆 Benewake TF-Luna 防跌落感測器(每顆一個 UART,接腳 5 接到 3.3 V)。原專案表示:僅用於功能性感測:近場感測器不是安全裝置。
5.3 安裝相機
將 Raspberry Pi Camera Module 3 NoIR(IMX708)裝在前面板上,並以 15 針 CSI 排線及 15 轉 22 針 CSI 轉接板連接到 Pi 5。
- 相機:Raspberry Pi Camera Module 3 NoIR(Sony IMX708,無紅外線濾光片,自動對焦)。Gate A 單元;在 2.0 版中由安裝在 MMP.01.00.00.003 相機座上的 Orbbec Gemini 336L 取代。物料清單將此零件命名為 Camera Module NVision Assem,並將 PT1.00.00.032 Camera upper body 列為 3D 列印零件。
- 介面:CSI(MIPI 排線),不是 USB。15 針 FPC 排線需要 CSI 轉接線(15 轉 22 針)才能接上 Pi 5 較窄的連接器;裝置為 cam1。
- 相機到 Front panel 的扣件(扣件表):4 顆 M3x8 DIN 966 螺絲、4 顆 M3x12 DIN 967 螺絲、4 顆 M2x16 DIN 7985 螺絲、4 顆 M2 DIN 934 螺帽、4 片 2 DIN 125 墊圈、4 片 2 DIN 7980 彈簧墊圈、4 個 TFF-M3/25 螺紋間隔套筒,以及 16 片 3 DIN 125 墊圈。
5.4 安裝 IMU
將 MPU6500 IMU 板(絲印為 MPU-6050 或 GY-521)以 I2C 接到 Teensy 4.0 的腳位 18(SDA)與腳位 19(SCL),以 3.3 V 供電。
- 配線於 2026-06-19 驗證:SDA = 接腳 18、SCL = 接腳 19、供電 = 3.3 V(實測)、AD0 = GND,位址為 0x68,GND 與 Teensy 共地。Teensy 為 I2C 主控端。未使用的接腳:XCL、XDA 與 INT。
- 晶片是 MPU6500(WHO_AM_I 0x70),不是 MPU6050,沒有磁力計。板上的上拉電阻拉到 3.3 V,因此 SDA 與 SCL 永遠不會超過 3.3 V。
- EKF 只使用陀螺儀的偏航角速度(angular_velocity.z)。靜止時 linear_acceleration.x 約為 -2,原專案解讀為安裝位置略有傾斜。IMU 在現有機器人上的安裝位置並未記載。
- OpenAMRobot 2.0 使用一顆 ICM-42688-P(TDK EV_ICM-42688-P 板),接在專用的 SPI 上,Mode 0,時脈最高 8 MHz,安裝於中心線上。
5.5 安裝磁性編碼器
在每個驅動輪上裝一組 AMS AS5040 磁性編碼器組件(PT1.00.00.240),由 Teensy 的 3.3 V 電源供電,絕不可接 5 V。
- 每個輪子一顆 AS5040(磁性,正交 A/B,每轉 1024 計數),為 Teensy 提供輪速,用於 PID 與里程計。它們屬於設計的一部分,列出的數量為 2。
- 每個編碼器組件 PT1.00.00.240 都有一個 3D 列印的轉接件(PT1.00.00.241)、支架(PT1.00.00.242)與外蓋(PT1.00.00.243),以 M2x8 DIN 7985 螺絲與 M2 DIN 934 螺帽固定(兩個編碼器各 8 顆)。
- 它安裝在輸出端,因此 1024 計數等於輪子轉一圈(COUNTS_PER_REV = 每圈 1024)。徑向充磁磁鐵必須準確置中於晶片上方:右輪的磁鐵偏心曾讓機器人蛇行,重新置中後就解決了。
- 供電電壓:取自 Teensy 3.3 V 電源的 3.3 V,不是 5 V。AS5040 的輸出高電位等於其供電電壓,因此在 5 V 下,A/B 輸出約達 4 V,送入不耐受 5 V 的 Teensy 輸入腳(絕對最大值約 3.6 V)。它透過內部穩壓器可在 3.3 到 5 V 下工作。原專案表示:不要改回去。
- 配線:左(MOTOR1)A 接接腳 14、B 接接腳 15;右(MOTOR2)A 接接腳 11、B 接接腳 12;共同 GND。
- 每顆馬達內部的三個霍爾感測器是獨立的:驅動器讀取它們來為馬達換相,Teensy 完全不會接觸到。Teensy 只讀取 AS5040。
6. 外蓋組裝與收尾
6.1 安裝 LED 指示燈模組
原專案在物料清單中列出兩個 3 LED RGB Module 0.72W SWP LED 模組,但沒有任何文件說明它們裝在哪裡或如何配線。
- 原專案在物料清單中列出兩個 3 LED RGB Module 0.72W SWP LED 模組,但沒有任何文件說明它們裝在哪裡或如何接線。
6.2 安裝光達(LiDAR)支架組件
用 4 顆 M4x16 DIN 7985 螺絲、4 個 4 DIN 125 墊圈與 4 個 4 DIN 7980 彈簧墊圈,將光達支架組件(MMP.07.00.00.000)固定到底板上。
- 光達支撐件上有 4 個 M4 拉帽。現有機器人上光達的掃描平面距地面 222.0 mm。
6.3 安裝外蓋組件
用 4 顆 M8x25 DIN 967 螺絲與 4 個 8 DIN 125 墊圈將外蓋 MMP.01.00.00.001 固定到中央支架上,並裝上兩個外蓋法蘭 MMP.01.00.00.002。
- Cover assembly MMP.01.00.00.000 本身使用 10 顆 M3x8 DIN 7985 螺絲、10 顆 M3 DIN 934 螺帽、20 片 3 DIN 125 墊圈與 10 片 3 DIN 7980 彈簧墊圈。
6.4 安裝選用的塑膠外蓋
選用的塑膠外蓋 MMP.00.00.00.004 只以 STEP 與 SLDPRT 檔案發布;原專案沒有說明如何製作。
- 原專案標示的機器人負載能力最高為 150 kg;塑膠外蓋並未標示此數值。
7. 軟體設定
7.1 在 Raspberry Pi 上安裝 Ubuntu 與 ROS2
為 Raspberry Pi 5 安裝 Ubuntu Server 24.04 LTS 與 ROS 2 Jazzy,在 domain 0 上使用 CycloneDDS,並以機器人的 mDNS 名稱進行 SSH 連線。
- 參考安裝環境:Raspberry Pi 5 Model B Rev 1.1,8 GB,Ubuntu Server 24.04 LTS(Noble),核心 6.8.x-raspi,ROS 2 Jazzy(/opt/ros/jazzy)。原專案沒有發布寫入映像檔、設定 Wi-Fi 或安裝 micro-ROS agent 工作區的逐步程序。
- Pi 以無螢幕方式運作。請從一台 Ubuntu 24.04 開發用 PC 透過 SSH 操作,並在 PC 上執行 RViz。請使用 mDNS 名稱 ssh <user>@<robot>.local,絕不要寫死 IP,因為位址由 DHCP 分配,會改變。
- 機器人在 domain 0 上執行 CycloneDDS;PC 預設使用 FastDDS 與 domain 42,因此什麼都看不到。在 PC 與 Pi 的每個終端機中,以及每個非互動式 SSH 指令中,都要執行:source /opt/ros/jazzy/setup.bash
- export RMW_IMPLEMENTATION=rmw_cyclonedds_cpp
- export ROS_DOMAIN_ID=0
- Pi 使用者屬於 dialout、video 與 sudo 群組。參考 Pi 上的工作區:~/linorobot2_ws(micro-ROS agent)、~/camera_ws(Raspberry Pi 的 libcamera 分支與 camera_ros)、~/sllidar_ws(光達驅動程式)以及 ~/openamr-platform-sw/ros2。
- 相機:apt 的 libcamera 套件不支援 Pi 5 上的 IMX708(症狀:camera_node 回報 no cameras available)。請改為建置 Raspberry Pi 的分支版本。安裝建置相依套件:sudo apt install -y g++ cmake meson ninja-build pkg-config libboost-dev libgnutls28-dev openssl libjpeg-dev libpng-dev libtiff-dev python3-yaml python3-ply pybind11-dev python3-colcon-meson libglib2.0-dev libgstreamer-plugins-base1.0-dev libdrm-dev libevent-dev
- 接著執行:mkdir -p ~/camera_ws/src && cd ~/camera_ws/src,並從 GitHub 將 raspberrypi/libcamera(Raspberry Pi 的分支版本,這是關鍵)與 christianrauch/camera_ros 兩個儲存庫複製到其中。
- 接著執行:cd ~/camera_ws ; source /opt/ros/jazzy/setup.bash ; rosdep install --from-paths src --ignore-src -y ; colcon build --packages-select libcamera camera_ros(在 Pi 5 上約需 6 到 7 分鐘)。此覆蓋層會遮蔽 apt 的 libcamera,但不會將其移除;每個啟動用的 shell 都要 source ~/camera_ws/install/setup.bash。
7.2 燒錄 Teensy 韌體
使用 PlatformIO 環境 teensy40 建置 Teensy 4.0 韌體(在 linorobot2_hardware 的 jazzy 分支上覆蓋三個檔案),並用 teensy_loader_cli 燒錄。
- 此韌體是疊加在 linorobot2_hardware 韌體上的覆蓋層,分支 jazzy,commit aaf9d59(2026 年 4 月 30 日)。在該 checkout 中,將覆蓋層的 config/lino_base_config.h、lib/pid/pid.cpp 與 src/firmware.ino 複製覆蓋到對應路徑。建置使用的是 config/lino_base_config.h,不是 dev_config.h。
- 建置:cd <linorobot2_hardware>/firmware
- ROS_DISTRO=jazzy ~/.platformio/penv/bin/pio run -e teensy40
- 在 Ubuntu 24.04 上,請如上所示從 PlatformIO 自己的 venv 執行,因為直接執行 pio 可能會失敗。第一次建置約需 5 分鐘,之後的建置約 8 秒。輸出檔為 .pio/build/teensy40/firmware.hex。
- 燒錄:安裝 teensy_loader_cli 與 PJRC 的 udev 規則(/etc/udev/rules.d/00-teensy.rules)。先用以下指令停止 micro-ROS agent:pkill -f "[m]icro_ros_agent"
- HEX=<linorobot2_hardware>/firmware/.pio/build/teensy40/firmware.hex
- sudo teensy_loader_cli --mcu=TEENSY40 -s -w -v "$HEX"
- -s 軟重啟的時序不穩定,可能回報 error writing。若發生這種情況,板子其實已進入 HalfKay 開機載入程式;請不加 -s 重試一次:sudo teensy_loader_cli --mcu=TEENSY40 -w -v "$HEX"。最可靠的方法是按下 Teensy 的實體按鈕,再用 -w 燒錄。燒錄失敗後拔插 USB,會以上一個正常的韌體開機。
- 韌體在通電時會自行啟動;Teensy 上不需要啟動任何東西。你要在 Pi 上啟動的是 micro-ROS agent。韌體執行 50 Hz 迴圈:輸入 /cmd_vel,每個輪子一個 PID,輸出 PWM 與方向給驅動器,並輸出里程計與 IMU 資料。
- Teensy 無法讀回內容;唯一的備份是韌體原始碼。除非你能重新燒錄一個已知正常的版本,否則不要燒錄新韌體。重新燒錄會讓 Teensy 重新開機並使編碼器零點偏移,因此要重新進行編碼器對位(請見測試步驟)。
7.3 使用固定的序列裝置路徑
以 /dev/serial/by-id 路徑指定 Teensy 與光達,因為 ttyACM 和 ttyUSB 的編號在重新開機後可能改變。
- Teensy:/dev/serial/by-id/usb-Teensyduino_USB_Serial_<serial>-if00(參考單元序號 16778200)。光達 A1:/dev/serial/by-id/usb-Silicon_Labs_CP2102_USB_to_UART_Bridge_Controller_0001-if00-port0。這些路徑每台機器人各不相同;在其他單元上請覆寫,例如使用 drivers.launch.py 的 teensy_port 與 lidar_port 參數。
- 相機接在 CSI 上,不是 USB,因此沒有序列路徑。
- 目前文件中唯一的 udev 規則,是用於燒錄 Teensy 的 PJRC 規則(00-teensy.rules)。較舊的 wiki 描述了建立 /dev/base 與 /dev/lidar 的 lino_udev 規則;那些屬於 ROS 1 的設定,內容已過時。
7.4 建置並啟動 ROS 2 導航堆疊
在 Pi 上的 colcon 工作空間中建置光達(LiDAR)驅動程式與 openamr-platform-sw,檢查韌體設定中的車輪幾何參數,並以 bringup_composed.launch.py 啟動整個堆疊。
- 舊版 wiki 中較舊的 Linorobot ROS 1 設定(Ubuntu 20.04、ROS Noetic、lino_install 搭配 2wd rplidar)已過時。目前的軟體是 openamr-platform-sw:ROS 2 Jazzy、Nav2、AMCL 與自動對接,並以 micro-ROS 與 Teensy 通訊。
- 光達驅動程式:sllidar_ros2 沒有 Jazzy 的二進位套件。執行:mkdir -p ~/sllidar_ws/src && cd ~/sllidar_ws/src,從 GitHub 複製 Slamtec/sllidar_ros2,然後執行:git -C sllidar_ros2 checkout 34300099fadfc772965962dec837bf436706188f
- cd ~/sllidar_ws ; source /opt/ros/jazzy/setup.bash ; rosdep install -y --rosdistro jazzy --ignore-src --from-paths src ; colcon build --cmake-args -DCMAKE_BUILD_TYPE=Release ; source ~/sllidar_ws/install/setup.bash
- 從 GitHub 複製 openAMRobot/openamr-platform-sw。colcon 工作區是 ros2 子目錄:cd openamr-platform-sw/ros2 ; source /opt/ros/jazzy/setup.bash ; colcon build --symlink-install ; source install/setup.bash。實體機器人還需要上述的 micro-ROS agent 工作區與相機工作區。
- 輪子幾何參數,取自韌體設定並經實際量測:WHEEL_DIAMETER 0.2(200 mm)、LR_WHEELS_DISTANCE 0.46(輪距,中心到中心),以及 COUNTS_PER_REV 1024,這個值必須以輪子每轉一圈計。不要用 0.046533 m 作為輪子半徑(那是 CAD 匯出的 URDF 中的輪軸高度),也不要用 0.4075 m 作為輪距(那是 CAD 產生的誤差)。驗證里程計:精確行駛 1 m,然後與 /odom 比較。
- 在 Pi 上以 composed 設定檔啟動完整軟體堆疊,這是相機與自動回充對接的預設設定。在同一個 shell 中 source /opt/ros/jazzy/setup.bash、~/linorobot2_ws/install/setup.bash、~/camera_ws/install/setup.bash 與 ~/openamr-platform-sw/ros2/install/setup.bash,export RMW_IMPLEMENTATION=rmw_cyclonedds_cpp 與 ROS_DOMAIN_ID=0,然後執行:ros2 launch openamrobot_bringup bringup_composed.launch.py map:=$HOME/maps/<your_map>.yaml
- 地圖是必要的:在 sim:=false 時,若沒有明確指定地圖,launch 會拒絕啟動。相機工作區那一行不是選用的;少了它,相機會以 no cameras available 失敗,對接也會中止。
- 在機器人能感知環境或導航之前,必須先在 PC 的 RViz 中執行 2D Pose Estimate,因為 AMCL 的自動初始姿態是關閉的。在你給定姿態之前,不會有 map 到 odom 的轉換,代價地圖也會保持空白。請以 openamr_nav.rviz 設定檔執行 RViz,而非 nav2_view.rviz,並送出 2D Goal Pose,而非 Nav2 Goal。
7.5 安裝並設定網頁介面
在機器人的 Raspberry Pi 上以 Docker 執行獨立的 openamrobot-ui 儀表板,這是由 Flask 在連接埠 5050 提供的 React 前端,並搭配連接埠 9090 上的 rosbridge。
- openamrobot-ui 是用於 ROS 2 機器人的瀏覽器儀表板:建圖、手動駕駛、Nav2 目標、相機畫面、已儲存路線、視覺化程式、任務、健康診斷與錄製。它需要 Docker Engine 與 Docker Compose 外掛程式,或手動安裝 Ubuntu 24.04、ROS 2 Jazzy、Python 3、colcon、Node.js 18 到 20 與 npm。
- 機器人軟體堆疊與 UI 是分開的工作區:先啟動機器人或模擬,再啟動 UI。Docker:docker compose up --build
- 請將機器人的 DDS 設定提供給 UI,因為它預設使用 FastDDS,這樣會顯示已連線但面板一片空白:RMW_IMPLEMENTATION=rmw_cyclonedds_cpp ROS_DOMAIN_ID=0 docker compose up
- 請在 Pi 上執行,不要在透過 Wi-Fi 連線的 PC 上執行:在 PC 上執行時,大型可靠傳輸 topic 會塞滿連線並阻礙導航。原專案在 2026-07-06 註記,當時 Pi 上尚未安裝任何 UI。
- 儀表板上的紅色 E-STOP 是不會自鎖的軟體停止,不具安全等級;操作實體硬體時,請隨時在伸手可及之處準備一個經過測試的實體緊急停止開關。
7.6 測試並校正
先檢查電池電壓,然後在車輪離地、極低速度、一隻手放在 24 V 斷電開關上的情況下測試馬達;在手動運動、編碼器方向、里程計與停止功能都驗證無誤之前,不要啟用 Nav2 或回充對接。
- 所有初始馬達測試都要讓輪子離地。只在需要輪子轉動時才開啟 24 V;一隻手隨時放在 24 V 斷電開關上。起始速度上限為線速度 0.05 m/s、角速度 0.15 rad/s。
- 在地面上實測的可靠下限:線速度約 0.04 m/s(0.05 m/s 時運行乾淨)與角速度 0.15 rad/s。下達的速度指令請保持在這些值以上。
- 停止的方法:在 teleop 中按 k、在發布端按 Ctrl-C,或切斷 24 V。若 200 ms 內沒有收到 /cmd_vel,韌體會停止馬達,但這不能取代實體緊急停止開關;根據韌體文件,目前尚未接上任何硬體緊急停止開關。
- 任何導航測試前的電池靜置電壓:約 25.5 到 26 V 為滿電,約 24.5 V 可接受,約 24 V 為臨界,23.5 V 以下則不要進行導航測試。原則:靜置時以 25 V 以上為目標。在負載下電池組電壓會再下降 1 到 2 V;低於約 22 V 時,驅動器會觸發匯流排欠壓保護(故障代碼 10)。
- 不經 PID 的馬達測試,機器人架高:ros2 topic pub --rate 15 /debug/openloop geometry_msgs/msg/Vector3 "{x: 100.0}"。指令會被限制在約正負 716 PWM,且只維持 300 ms,因此必須持續重新發布才能保持運轉。
- 編碼器漣波表:每次 Teensy 斷電重開後(而非每次 ROS 啟動),在輪子離地、24 V 開啟且一隻手放在斷電開關上、micro-ROS agent 正在執行的狀態下,於 <openamr-platform-fw>/tools/encoder-calibration 中執行:python3 align_enc_cal.py --arm 250。成功時會印出:table placed -> /debug/enc_cal。Teensy 重置會清除這張表。
- 任何韌體或設定變更之後,正常行駛前都要重新確認編碼器方向,並以低速 /cmd_vel 測試。在手動移動、編碼器方向、里程計與停止行為全部驗證完成之前,不要啟用 SLAM、Nav2 或自動對接。
8. 選用:無線充電設定
8.1 在機器人上安裝無線充電接收器
基本組裝不包含無線充電;WCM-300 只是現有機器人的充電器,原專案將 TZBOT WCM-500-24(輸出 28.4 V)列為 2.0 版的充電方案。
- 原專案的說法:TZBOT WCM-500-24 無線充電是 2.0 與 release 001 的充電方案(register CHARGING);WCM-300 只是 release 001 機器人上現有的單元,並非設計方案。WCM-300 手冊已於 2026 年 10 月 22 日從硬體儲存庫移除,仍保留在其 Git 歷史中;舊版儲存庫也仍有一份副本。WCM-500-24 的規格書尚未放入儲存庫。
- 摘自 WCM-300 手冊(V2.6):無線接收器(WCM-300R)固定在機器人上,發射器(WCM-300T)放在充電區。發射器與接收器周圍 2 cm 內不得有金屬(A 至少 2 cm)。氣隙 0 到 50 mm;X 軸偏差正負 30 mm;Y 軸偏差正負 30 mm。
- 接收器在機器人上的固定位置並未以文字說明;硬體 README 的俯視圖中顯示為選配無線充電器預留的區域。
8.2 設定地面充電站
WCM-300 發射器固定在充電區,使用 AC 220 V 正負 15%、單相 50 Hz、最大 3 A 電源。
- WCM-300 參數:輸入電壓 AC220V +/- 15%,單相 50Hz;輸入電流 3A(最大);輸出電壓 28.8V;輸出電流 7A;防護等級 IP65;尺寸 240(W)x 210(H)x 65(D)mm;重量約 5 kg。作為對照,ZBLD 驅動器的過壓故障(代碼 7 到 9)是在電源高於 28.8 V 時觸發。
- 230 V 交流電可能致命;請採取電源步驟中列出的防護措施:原專案迴路裝設 30 mA 漏電斷路器、配線封閉、機殼接地,以及市電輸入端裝設保險絲。
8.3 設定自主回充對接
原專案的對接功能是由 /dock_trigger 上的 Bool 啟動的 AprilTag 3 標籤組序列;沒有任何文件說明以電池電量門檻觸發,或充電器如何啟動。
- 自動對接由 /dock_trigger 上的 Bool 觸發(或 UI 的對接按鈕);啟動時必須將 use_docking 設為 true,或使用 bringup_composed.launch.py。在依啟動步驟設定好 ROS shell 後執行:ros2 topic pub --once /dock_trigger std_msgs/msg/Bool "{data: true}"
- 離開充電座:ros2 topic pub --once /undock_robot std_msgs/msg/Bool "{data: true}"
- 在實體機器人上,充電座是一組列印出來的 3 個標籤(AprilTag 家族 36h11,ID 0、1 與 2),沒有實體充電座;中央的標籤 ID 1 是對接目標。
- 韌體狀態:battery_monitor 模組尚未實作;目前還沒有電池電壓遙測。
- WCM-300 啟動訊號,摘自其手冊:機器人控制器在棕色線上輸出 3 到 30 VDC 的高電位以開始充電,輸出低電位則停止;黃色為故障指示線(低電位有效,開集極輸出,最大灌入電流 200 mA,耐壓 30 VDC);藍色為訊號地。現有機器人上的接法並未記載。