Open Source Robotics

精選高品質的開源機器人專案、工具與軟體,推動機器人社群向前發展。

Solo12 組裝指南

用於足式行走運動研究的輕量 12 自由度扭矩控制四足機器人

授權條款

BSD-3-Clause

組裝指南

1. 請先閱讀:原專案公開了什麼

原專案沒有為 Solo12 發布單一的組裝手冊。它為十二個致動器模組發布了完整的逐步頁面,而機器人的其餘部分只有零件清單、配線表、照片與 CAD;本指南依照這樣的劃分,並註明原專案在哪裡停止。

1.1 了解本指南涵蓋的版本

本指南涵蓋 Solo12 第 1 版(quadruped_robot_12dof_v1),即使用 24 V 電源的有線機器人;1.1 版只在最後一節作為選配升級說明。

  1. Version 1 有一條用於供電與乙太網路通訊的連接線。它沒有內建電池,也沒有無線連線。原專案給出的重量為 2.5kg,尺寸為 45cm x 30cm x 6cm。
  2. Version 1.1 是原專案為 version 1 推出的自主化升級:兩顆鋰聚合物電池、一塊客製電源管理板、一個電源開關、一個緊急停止開關,以及一個有 12 顆 RGB LED 的狀態燈環,重量約增加 300g(機器人為 2.8kg)。原專案將其描述為正在進行中的升級,其元件清單也說電池尚未經過測試。
  3. 不要單獨為 version 1 機器人加裝電池。原專案:「沒有電源管理板時,不要使用鋰聚電池!」

1.2 了解原專案未公開的內容

原專案沒有提供書面順序,說明如何將三個模組組成一條腿、將腿部與電子元件裝進機身,也沒有說明如何測試、調校或讓機器人行走。

  1. 關於腿部與機身,原專案公開了物料清單、列印件圖片、線長表、馬達分配表、佈線圖片,以及可在瀏覽器中開啟的 CAD 模型。它沒有公開這些部分的組裝順序、扭力值或啟動程序。
  2. 儲存庫中的 Actuator Module Testing 頁面是空的,Known Issues 頁面也是空的。
  3. 機器人軟體位於另外的 ODRI 儲存庫中。本指南不涵蓋軟體,只涵蓋原專案連結的 master board 燒錄頁面。
  4. 原專案在 ODRI 網頁上連結了站立狀態、折疊狀態的機器人與機身結構的 CAD 模型,儲存庫中也有一個 Solidworks 檔案。用它們來確認零件的安裝位置。

1.3 留意商用選項

原專案表示,PAL Robotics 販售組裝完成或套件形式的 Solo12,內含 IMU、校正工具與燒錄器。

  1. 原專案:「Solo12 機器人現在可向 PAL Robotics 購買,可選完整組裝版或包含所有必要元件的套件。」
  2. 兩種選項都包含慣性量測單元、校正工具與三種中央板選項。Micro Driver Board Programmer 與 Master Board Programmer 也包含在內。

2. 列印、加工並訂購零件

備齊列印零件、每個致動器模組的三個加工件(或 PWB 編碼器套件),以及原專案列出的現成零件;除了選配的支架型材之外,這裡沒有任何零件是 CNC 加工鋁件。

2.1 列印機身結構零件

以 STL 檔案列印第 1 版機身零件,每個檔案的 z 軸正方向朝上,並在零件中使用 Helicoil M3 x 4.5 螺紋護套。

  1. 沿 STL 檔的正 z 方向列印。這是原專案對所有機身零件建議的列印方向。
  2. 原專案物料清單中的數量:Body Structure Back 1、Body Structure Bottom Rev A 2、Body Structure Center 1、Body Structure Center Handle 1、Body Structure Center Vicon 1、Body Structure Front 1、Body Structure Hip AA Support 4、Body Structure Side 4、Body Structure Top IMU 1、Body Structure Top Master Board 1、Led Cover 1、Hip Adapter 2、Spacer Micro Driver Stack 16。
  3. 原專案表示中央上板有 3 種版本:最簡版、帶握把版,以及帶握把與 Vicon 標記安裝點的版本。Led Cover 應以透明或半透明材料列印。
  4. Body Structure Bottom Rev A 適用於帶 90 度 Hirose 編碼器接頭的 Micro Driver 板。資料夾中也有較早的 Body Structure Bottom 檔案;原專案沒有以文字說明它適用於哪些電路板。
  5. 對於大型結構件,原專案使用 FDM 或 SLS 印表機。機身與外殼零件方面,其自己的列印設定是在 Fortus 360mc 上以 PC-ABS、標準實心內部列印。

2.2 列印腿部與致動器模組零件

以高細節印表機列印每個致動器模組的殼體底座與上蓋,以及小型精密零件,殼體預計使用 Helicoil M2.5 x 3.75 mm 螺紋護套。

  1. 原專案每條腿的物料清單:Hip AA Module Shell Base 1 與 Cover 1、Hip FE Module Shell Base 1 與 Cover 1、Upper Leg Module Shell Base 1 與 Cover 1,以及一個 Lower Leg v2 或 v3。機器人有 4 條腿,每條腿有 3 個致動器模組。
  2. 原專案為每個致動器模組列出以下列印件:Encoder Codewheel PWB Mount 1(若使用 AEDM-5810-Z12 套件則為 Encoder Codewheel Kit Mount)、Transmission Pulley AT3 T30 Center 1、Transmission Pulley AT3 T30 Output 1,以及 Transmission Belt Tensioner Roller 10.0mm 2。
  3. 原專案:「皮帶輪的齒形必須相當精確且同心。」它建議以光固化(stereolithography)或 multijet 印表機列印皮帶輪、碼盤座與張緊滾輪。它在 Projet 3500 HD Max 上以 VisiJet M3X 列印這些零件。在其 Fortus 上列印的外殼為 PC-ABS。
  4. 原專案也表示,外殼可以訂購以 Duraform HST 製作的選擇性雷射燒結件。訂購的零件列印方向至關重要:列印方向必須是 STL 檔的正 z 軸,自動以隨機角度擺放的零件可能無法使用。
  5. Lower Leg v2 用於 FDM,採用 sparse double dense 設定;Lower Leg v3 用於實心列印。兩者可互換。
  6. 原專案的公差警告:軸承座是關鍵表面,若尺寸過大太多,軸承將無法牢固定位,零件可能無法使用。

2.3 取得機加工零件或 ODRI Encoder Kit

每個致動器模組都需要一根馬達軸、一個 10 齒馬達皮帶輪與一個 10 齒中間皮帶輪,除非你購買內含這些零件的 PWB ODRI Encoder Kit。

  1. 每個模組的加工件:馬達軸(4mm 不鏽鋼棒)、10 齒馬達皮帶輪(鋁)、10 齒中央皮帶輪(鋁)。皮帶輪圖面是原專案的 PDF 圖面。
  2. 原專案的警告:「不要使用標準 AT3 時規皮帶輪的尺寸或刀具。我們修改了原始的 AT3 齒形,以減少背隙。」
  3. 原專案的皮帶輪加工途徑是依其圖面製作的客製成形刀,用於 7075 鋁。它試過線切割放電加工(wire EDM),但沒有繼續採用。
  4. 馬達軸料:4mm h9 精密研磨不鏽鋼,直徑介於 3.99mm 與 3.97mm 之間;原專案指名 Precision Ground Stainless Steel Rod 1.4301 EN10278 h9 4,0mm。
  5. 替代方案:ODRI Encoder Kit v1.0(PWB Encoders GmbH 訂購編號 109381)包含已完成的馬達軸組件與碼盤、7075 鋁製中央皮帶輪,以及修改過的 Broadcom AEDT-9810-Z00 編碼器讀頭。使用它就可以跳過馬達軸準備頁面。

2.4 訂購一個致動器模組的硬體

每個模組需要一顆 T-Motor Antigravity 4004 300kV、一顆搭配 PWB 碼盤的 Broadcom AEDT-9810-Z00 編碼器、兩條 Conti Synchroflex AT3 皮帶、EZO 軸承,以及所列的扣件。

  1. 馬達:T-Motor Antigravity 4004 300kV,24 顆磁鐵,12 對極,18 槽,3 相 Y 接,轉子直徑 45mm,重量 53g。馬達以 2 顆一組販售。
  2. 編碼器:Broadcom AEDT-9810-Z00(不含碼盤的編碼器),每通道每轉 5000 個脈衝,微控制器端每轉 20000 個計數,5V 雙通道正交輸出並帶索引脈衝(ABZ)。碼盤來自 PWB,訂購編號 104768,帶索引的碼盤,625cpr 3K for AEDT98X,內徑 7mm,外徑 25.56mm。
  3. 皮帶:Conti Synchroflex AT3 GEN III,齒距 3mm。第一級 150mm、50 齒、寬 4mm。第二級 201mm、67 齒、寬 6mm。總減速比 9:1,每級 3:1。
  4. 軸承(EZO,不鏽鋼):輸出軸 32mm x 25mm x 4mm,61705 2RS VA,每個模組 2 顆;馬達軸與中央軸 8mm x 4mm x 2mm,MR84 VA,每個模組 3 顆;皮帶張緊器 7mm x 3mm x 3mm,683 2Z VA,每個模組 2 顆。
  5. 扣件:M3 x 5 平頭螺絲 4 顆(馬達);聚醯胺材質的 M3 x 16 十字平頭螺絲 2 顆(編碼器);M3 x 10 平頭螺絲 2 顆與 M2,5 墊圈 2 個(皮帶張緊器);Helicoil M3 x 6 2 個(輸出軸);外殼用 M2,5x6 與 M2,5x10 內六角螺絲。
  6. 每個模組的線材與接頭:3 個 Reely RE-1373188 2mm 鍍金馬達相線接頭;LiY 0.50 mm² 黑色馬達相線;Hirose DF13 5 pin 母座與 5 個 DF13 壓接端子;編碼器用紅、黃、黑、白、綠色的 LifY 0.14 mm² 線。
  7. 原專案提供替代的編碼器套件(Broadcom AEDM-5810-Z12,附自己的碼盤座,碼盤凸緣需以車床修改)以及替代的張緊器(SKF 623-2Z 10mm x 3mm x 4mm 軸承搭配 M3 墊圈)。本指南採用主要途徑。

2.5 訂購電子元件

機器人使用一塊 Master Board v2、六塊 Micro Driver Board v2,以及一顆 Lord Microstrain 3DM-CX5-25 IMU。

  1. Master Board v2,1 片,ODRI 客製電路板,重量 19g。其硬體與韌體位於另外的 master-board 儲存庫中。
  2. Micro Driver Board v2,6 片,雙無刷馬達驅動器,6 層板,51mm x 50mm,重量 13g,輸入電壓 5V - 32V(原專案:「我們的機器人以 24V 運作」)。原專案的訂購途徑是請 PCB 代工服務複製訂單 AU-201909/38760,除精密電阻與 Hirose 接頭外的所有元件都已焊好;其最近幾次訂單的元件價格約為每片 50 歐元。
  3. 每片 Micro Driver 板:6 個精密電阻 7mΩ ±1% CRE2512-FZ-R007E-3、用於編碼器與 SPI 接頭的 Hirose DF13 直角 5 pin 排針 DF13-5P-1.25DS(20),以及用於馬達相線與電源連接的 2.54mm 間距直角排針。
  4. 慣性量測單元:Lord Microstrain 3DM-CX5-25,擴展量測範圍,陀螺儀速率 +/- 900 deg/sec,加速度計範圍 +/- 20G。3 顆塑膠 M2,5x16 一字螺絲(Conrad 839940-62),截短到 13mm。
  5. 燒錄器:用於 Micro Driver 板的 JTAG 模擬器 XDS100V2 USB(原專案的元件頁面也列出 Blackhawk USB100v2 JTAG 模擬器),搭配 8 位 1.27mm 排針線。Master Board 燒錄器說明見 master-board 頁面。

3. 組裝十二個致動器模組

這是 Solo12 中原專案附照片逐步記錄的部分;你要組裝 12 個相同的核心,而 Hip AA 模組有兩處小差異,註明於下方。

3.1 將轉子與定子分開

以小鉗子取下 T-Motor Antigravity 4004 軸上的扣環,將轉子從定子上拉出,並保留銅墊圈。

  1. 用小鉗子拆下馬達軸上的扣環。原專案:「不用擔心損壞扣環,之後不再需要它。」
  2. 輕輕拉開以克服磁力,將轉子與定子分開。務必保留黃銅墊圈。
  3. 將轉子放在乾淨的表面上。金屬顆粒會吸附在磁鐵上,之後可能造成問題。

3.2 拆下原廠軸並鉸削轉子內孔

以 1.5mm 六角起子拆下兩顆 M3 止付螺絲,用列印的馬達軸拆卸工具敲出軸,再以 3.98mm、3.99mm 與 4.00mm 鉸刀鉸削內孔,直到客製軸能裝入。

  1. 用 1.5mm 六角起子拆下轉子上的兩顆 M3 止付螺絲並保留。將轉子放在 3D 列印的馬達軸拆卸工具(STL 檔 tool_motor_shaft_extraction)上,用鎚子與衝棒將軸敲出。
  2. 將鉸刀裝在刀具夾持器上,手動鉸孔。原專案使用 3.98mm、3.99mm 與 4.00mm 的鉸刀。從 3.98mm 開始,在鉸刀上抹一點油,插入並轉動幾圈。
  3. 試裝客製馬達軸(上油)。若孔太緊,先用同一支鉸刀重複,再換下一支較大的,直到軸能以適度的力量裝入與取出。
  4. 重要:小心不要將孔徑擴得太大。若配合太鬆,轉子旋轉時會晃動。
  5. 用 1.5mm 六角起子將兩顆 M3 止付螺絲鎖入一半。

3.3 剝除定子線並加上延長線

移除定子相線上的熱縮套管,以約 400 攝氏度的烙鐵燒除線端的漆包層,再以約 300 攝氏度焊上 0.5 mm² 的 LiY 延長線。

  1. 剪開並移除底部的大熱縮套管,然後依圖片所示將每條相線上的熱縮套管拉掉。
  2. 用溫控烙鐵設定約攝氏 400 度,燒掉橘色絕緣層,直到露出 5mm 的銀色導線。用熱風槍套上細熱縮套管。
  3. Hip AA 致動器模組的馬達相線不要截短。Hip FE 與 Upper Leg 模組的相線截短到自定子底部量起約 3cm,讓焊點保持在外殼結構內。
  4. 將焊接溫度降到約攝氏 300 度。延長線做得比所需長幾公分,使用截面積 0.5mm² 的 LiY 線。將它們焊到相線上,並用短熱縮套管絕緣。
  5. 若不確定線長,就在這裡停下,先組裝模組,再決定長度並稍後焊上接頭。

3.4 將馬達皮帶輪黏到馬達軸上

使用列印的黏合治具,以 Loctite 648 將 10 齒鋁製馬達皮帶輪黏到 4mm 不鏽鋼馬達軸上,並使其固化。

  1. 用棉花棒與乙醇清潔黏合面。戴上手套。在黏合面上塗一層薄薄的 Loctite 648。
  2. 確認工具將皮帶輪支撐在正確位置。工具的深度應約為 6.6mm,工具與馬達軸末端的距離約為 26.8mm。
  3. 將軸插入皮帶輪,稍微轉動,並用棉花棒清除底部多餘的 Loctite。將零件放到黏合工具上,馬達軸上的平面朝上,再清除頂部多餘的 Loctite。
  4. 保持軸垂直並完全插入。讓零件在室溫下固化數小時,再以攝氏 70 度固化約 3 小時。

3.5 將碼盤黏到其安裝座上

將列印的碼盤座裝到馬達軸上,以 Loctite 406 將 PWB 碼盤黏上,印刷面朝上、從上方可讀。

  1. 使用與你的碼盤相符的碼盤座:向 PWB 訂購的碼盤用 PWB mount,編碼器套件附的碼盤用 kit mount。其餘步驟都相同。
  2. 上膠之前,先確認碼盤能裝入且平貼。若列印殘留物使它無法平貼,用一字起子刮掉。必要時用 4mm 鉸刀調整碼盤座的內徑。
  3. 原專案在定子上進行黏合:將軸以平面朝下插入定子軸承,將碼盤座套到軸上,對齊皮帶輪與碼盤座的齒,一路推到底。軸末端與碼盤座之間的距離應約為 2mm,偏差 0.1 或 0.2mm 沒有關係。
  4. 重要:碼盤必須以正確方向安裝。碼盤上的印刷字必須能從上方閱讀,如原專案的圖片所示。
  5. 在碼盤座上塗一層薄薄的瞬間膠(Loctite 406),放上碼盤,用工具將它一路推到底。保持 30 秒,輕輕取下工具,等待幾分鐘。
  6. 轉動軸,確認碼盤水平且不晃動。小心處理碼盤,避免彎折或刮傷。

3.6 準備編碼器

將編碼器的兩個安裝孔鑽到 3mm,並為 M3 平頭螺絲倒角,剪短針腳並彎折 45 度,再將五條 0.14 mm² 的線焊接並壓接到 Hirose 5 pin 接頭上。

  1. 用 3mm 鑽頭擴大兩個安裝孔(原直徑 2.8mm)。用 45 度倒角刀倒角,直到 M3 平頭螺絲與編碼器表面齊平。
  2. 用平口鉗截短接腳,並將它們向下彎 45 度。
  3. 依接線圖將五條 0.14mm² 延長線焊到接腳上,並用短熱縮套管絕緣。若不確定長度,就在這裡停下,組裝後再壓接接頭。
  4. 壓接時,剝去約 1mm 的絕緣層,將導線筆直插入 Hirose DF13 壓接鉗,直到線芯碰到止擋,然後將握把完全壓合。絕緣層應被第一個夾口夾住,線芯被第二個夾口夾住。
  5. 依接線圖的順序將壓接好的導線插入 Hirose 5 pin 接頭。原專案的圖片,從 Micro Driver 接頭看起:GND(綠)、5V(黃)、I(白)、B(紅)、A(黑)。在編碼器端,圖片顯示的順序是 B(紅)、5V(黃)、A(黑)、I(白)、GND(綠)。

3.7 壓入中間皮帶輪並組裝皮帶張緊器

以 Loctite 648 將 10 齒鋁製中間皮帶輪壓入列印的 30 齒中間皮帶輪,並以 M3 x 10 平頭螺絲與擴開的 M2.5 墊圈,將兩個張緊滾輪組裝在軸承上。

  1. 在 3D 列印皮帶輪的內齒形上塗一點 Loctite 648。將鋁製皮帶輪垂直放上去,對齊齒形,中心孔朝上。
  2. 將列印的保護工具裝在上方、列印的組裝工具裝在底側。用手扳壓床(台虎鉗也可以)將鋁製皮帶輪一路壓到底。用棉花棒清除多餘的 Loctite。零件底側應齊平。
  3. 張緊器:將每顆 7mm 軸承壓到一個列印滾輪上(預設直徑 10mm,較大的滾輪可調整皮帶張力)。M2,5 墊圈(內徑 2.7mm / 外徑 5.8mm)用圓銼擴孔到約 3mm 以配合 M3 螺絲,因為 M3 墊圈太大,會妨礙軸承外環自由轉動。
  4. 將 M3 螺絲從有凸緣的一側插入,將組件翻面,裝上修改過的墊圈。每個模組需要兩組張緊器。

3.8 準備輸出皮帶輪

以車床將列印的輸出皮帶輪兩根軸車小,使其與 32 x 25 x 4 軸承形成輕壓配合,再鑽孔、攻牙並裝上兩個 M3 x 6 Helicoil,Hip AA 模組除外。

  1. 原專案將軸承座直徑印得偏大,再用車床加工。用 25mm 筒夾輕輕夾住,以鋒利的車刀小幅度逐步縮小直徑,並用輸出軸承檢查配合。應為輕壓入配合,讓你能用手以適度的力量裝入與取出軸承。在另一側重複。
  2. Hip AA 例外:扣件會穿過皮帶輪,因此不要安裝 Helicoil。將安裝孔倒角,並用 3mm 鑽頭擴孔。然後就停下;忽略此步驟的其餘部分。
  3. 其他所有模組:凸緣朝上,將孔倒角,再以每次 0.1mm 的幅度從 3mm 逐步加大鑽到 3.3mm。用 Helicoil M3 螺絲攻攻兩個孔的牙,阻力增加時退出清理螺絲攻。
  4. 裝入兩個長 6mm 的 M3 Helicoil,讓末端約低於外表面半圈,然後用斷尾工具折斷兩個安裝柄。確認安裝柄沒有留在零件內。

3.9 準備殼體底座與上蓋

確認列印的殼體平整,為 M3 孔攻牙,裝上八個 M2.5 x 3.75 mm Helicoil,修整軸承座,並壓入五顆軸承。

  1. 在平坦表面上檢查外殼蓋與外殼底座的平整度;若零件翹曲,可能無法使用。用卡尺或穿過一顆 M3 與一顆 M2,5 螺絲,檢查兩個 3mm 與八個 2.5mm 的貫穿孔,若螺絲不易穿過就鑽開。
  2. 用盡量保持垂直的 M3 螺絲攻將外殼完全攻穿 M3 螺紋:兩個編碼器安裝孔與兩個時規皮帶張緊器孔。
  3. 用 M2,5 Helicoil 螺絲攻在外殼底座攻四個孔、外殼蓋攻四個孔,每個零件裝入四個 M2,5 x 3,75mm Helicoil,並移除安裝柄。阻力增加時就停止攻牙:列印件中的螺紋很容易滑牙。
  4. 軸承座應為輕壓入配合。若太緊,用具有鋒利 90 度刃口的端銑刀(8mm 與 32mm)擴大,底刃先用銼刀磨鈍,讓它只用側刃切削。原專案不建議使用鉸刀。
  5. 用手指裝入三顆 8mm x 4mm x 2mm 傳動軸承與兩顆 32mm x 25mm x 4mm 輸出軸承,保持每顆都水平。
  6. 用八顆螺絲試裝外殼,並檢查空的外殼組件。外殼組件重量:61g。
  7. 不要做 2dof Hip FE 額外錨點的步驟:那是給 8dof 四足機器人與腿部測試台用的,不適用於 Solo12。

3.10 安裝定子、馬達軸與轉子

以四顆 M3 x 5 平頭螺絲將定子固定在殼體底座中,連同銅間隔環裝入馬達軸組件,再以兩顆 M3 止付螺絲裝上轉子。

  1. 將馬達相線穿過外殼的開口,將定子放到安裝面上,將導線向上彎並對齊缺口。用 2mm 六角起子鎖四顆 M3x5 平頭螺絲。確認定子完全就位且不會移動。
  2. 將相線穿過編碼器座後方的開口,再從安裝介面穿出。
  3. 將裝有黃銅墊片的馬達軸組件插入定子軸承。將組件翻面。用 1.5mm 六角起子將兩顆 M3 止付螺絲鎖入一半。
  4. 將轉子上的止付螺絲對準馬達軸上的平面,將轉子一路推到底,一邊下壓轉子,一邊用 1.5mm 六角起子鎖緊兩顆止付螺絲。
  5. 用手轉動轉子,確認它能自由轉動。沿軸向拉轉子:應沒有或只有極小的間隙。

3.11 安裝兩條時規皮帶

先在馬達皮帶輪與中間皮帶輪之間裝上 150 mm 皮帶,再在中間皮帶輪與輸出皮帶輪之間裝上 201 mm 皮帶,皮帶輪裝入軸承時要讓每條皮帶保持張緊。

  1. 將 150mm 時規皮帶套到中央皮帶輪上並使齒嚙合,再套到馬達皮帶輪上並使齒嚙合。保持皮帶張緊,將中央皮帶輪插入軸承。
  2. 將 201mm 時規皮帶套到輸出皮帶輪上,有凸緣的一側朝上,並使齒嚙合。再套到中央皮帶輪上,保持張緊,將輸出皮帶輪插入軸承。
  3. 來回轉動輸出軸,確認傳動如預期運作。

3.12 安裝編碼器

將編碼器線材從介面處引出,將編碼器斜向滑入,讓碼盤落在其間隙中,再以兩顆 M3 x 16 螺絲固定。

  1. 將編碼器線穿過介面的開口。以一個角度小心插入編碼器,讓碼盤位於間隙中。原專案會截短並彎折編碼器接腳以簡化這一步。
  2. 將編碼器放到安裝面上,裝上兩顆 M3x16 螺絲。
  3. 確認碼盤位置正確,且不會碰到編碼器。

3.13 裝上張緊滾輪並合上殼體

以 2mm 六角起子將兩個張緊滾輪鎖入殼體上蓋,將殼體蓋過皮帶合上,再以八顆 M2.5 螺絲固定(五顆 M2.5 x 6 與三顆 M2.5 x 10)。

  1. 確認墊圈已裝上。用 2mm 六角起子裝上時規皮帶張緊滾輪,並確認它們能自由轉動。
  2. 將外殼蓋稍微傾斜地放到外殼底座上,輸出皮帶輪部分裝入。之後的所有步驟都對組件中央施加適度的壓力。
  3. 用小一字起子將第二級皮帶向內推,讓它避開一側的張緊滾輪,然後將組件翻面,在另一側做同樣的事。皮帶避開滾輪時,外殼蓋應會稍微下降。
  4. 抓住轉子來回轉動幾次,同時輕壓外殼蓋,讓中央皮帶輪找到其軸承。若無法闔上,用尖頭工具穿過中央皮帶輪上的孔,將中央皮帶輪推向馬達,同時轉動轉子。
  5. 確認外殼完全闔上,且馬達可以轉動。用 2mm 六角起子以適度扭力裝上八顆連接螺絲。
  6. 螺絲長度:外殼準備頁面與腿部物料清單給出五顆 M2,5x6 與三顆 M2,5x10;組裝頁面則說三顆 M2,5x8。本指南採用較新的 M2,5x10。

3.14 焊接馬達相線接頭並壓接編碼器接頭

確定線長後,將三個 Reely 2mm 鍍金公接頭焊到相線上,並壓接 Hirose 5 pin 編碼器接頭。

  1. 從導線離開外殼的表面量到接頭介面,量出線長。原專案為 Solo12 每個模組給出的線長列於本指南的接線章節。
  2. 將導線剪到所需長度,剝去一點絕緣層,絞緊線芯並上錫。將 2mm 公頭鍍金接頭焊到三條相線上。插上對接接頭以對齊熱縮套管,然後用熱風槍收縮。
  3. 以與編碼器步驟相同的方式壓接 Hirose 接頭。
  4. 完成的致動器模組(帶 30cm 導線)重量:160g。原專案的下一步是測試模組並確定馬達相線的正確順序,但其測試頁面是空的,因此沒有公開的測試程序。

4. 準備腿部

原專案提供了腿部物料清單、扣件清單與小腿的準備方式,但沒有寫明 Hip AA、Hip FE、大腿模組與小腿的接合順序;這部分請參考腿部 CAD 模型。

4.1 準備小腿

清除矩形介面上的列印凸點,將安裝孔擴大到 3mm,並以 Loctite 406 在每隻腳上黏一段 75mm x 7mm 的自行車輪胎。

  1. 必要時用 3mm 鑽頭擴大安裝孔。若以 FDM 列印,表面可能有凸起的珠痕;用鋒利的工具去除矩形介面表面上的珠痕,因為它會在安裝小腿時造成問題。
  2. 將自行車外胎切成矩形片段。原專案使用 Schwalbe Lugano 28 inch 23-622 外胎的中央部分,Lower Leg v2 與 v3 用 7mm x 75mm 的片段。
  3. 用乙醇清潔黏合面。用一根穿過外胎的針標記外胎位置,用打火機加熱針,再將它在標記位置刺入小腿 2mm 或 3mm。
  4. 在外胎上塗一層薄薄的 Loctite 406,將它放到腳上,用拉緊的電工膠帶緊緊纏繞固定,等待 30 分鐘,然後移除膠帶與針。將外胎兩端水平切齊。
  5. 包含外胎的腳直徑為 34mm,膝關節中心到腳中心的距離為 160mm。

4.2 了解原專案列出的腿部扣件

一條腿使用 M3 x 35 或 M3 x 22 螺絲接合 Hip AA 與 Hip FE 模組,另外還有 M3 x 16、M3 x 12、M2.5 x 6 與 M2.5 x 10 螺絲,以及 27 個 M2.5 x 3.75 Helicoil。

  1. 原專案每條腿的清單:Hip AA 到 Hip FE 的連接,使用轉接件時為 M3x35 x2,不使用轉接件時為 M3x22 x2;M3x16 x2;M3x12 x2;M3 墊圈 x2;M2,5x6 x12;M2,5x10 x15;Helical inserts M2,5x3,75 x27。
  2. 髖部轉接件裝在右前腿與左後腿上。
  3. 原專案沒有公開這些螺絲的組裝順序;請參考 ODRI 網頁上的腿部 CAD 模型。

5. 準備機身與電子電路板

以 Helicoil 螺牙襯套與螺絲攻處理列印的機身零件,焊接六片 Micro Driver 電路板並燒錄;原專案為此提供照片與零件清單,但沒有寫明機身的組裝順序。

5.1 準備列印的機身零件

原專案以五張圖片標示機身零件上要鑽孔與攻牙的孔位:整個機身共使用 32 個 Helicoil M3 x 4.5 螺紋護套,Micro Driver 與 IMU 支架使用 M2.5 螺絲攻,選配的 Vicon 板則使用 M4 螺絲攻。

  1. 圖片在機身零件上標出每個零件 2 或 4 個 Helicoil M3 x 4,5 螺紋襯套、部分位置攻 M2,5 牙,並在 Vicon 中央板上標出 7 加 6 個要鑽成直徑 3.3mm 並攻 M4 牙的孔。圖片沒有文字標示,因此請依形狀對應到零件。
  2. 物料清單中 Helicoil M3 x 4,5 的總數:32(RS 470-838 或 Hoffmann 082812 M3)。你需要 M3 與 M2,5 Helicoil 工具組,以及 M2,5 與 M3 螺絲攻。
  3. 以與外殼步驟相同的方式安裝 Helicoil:攻牙、裝入、折斷安裝柄,且不要讓安裝柄留在零件內。

5.2 焊接六塊 Micro Driver 板

在每塊 Micro Driver v2 板背面焊上六顆 7mΩ 精密電阻,在底面焊上供兩個編碼器與 SPI 使用的 Hirose DF13 直角排針座,並焊上供電源與六條馬達相線連接用的直角排針。

  1. 電路板出貨時沒有電源線、編碼器、SPI 與馬達線的接頭,且背面需要焊上六個電阻。
  2. 電阻:Precision Resistors 7mΩ ±1% CRE2512-FZ-R007E-3。原專案的訣竅:先在烙鐵頭沾一點焊錫,將電阻稍微固定,焊好另一側,再將最初那一側確實焊好。
  3. Hirose 接頭:直角接頭裝在電路板底側,直立接頭裝在頂側,因此腳位分配相同。原專案建議堆疊的電路板使用直角接頭,這樣不必拆開堆疊就能連接編碼器與 SPI 線。焊上兩個編碼器接頭與 SPI 接頭,用台虎鉗夾住電路板。
  4. 馬達與電源線:在電源端子上焊一個兩 pin 直角接頭;對全部六個馬達相線連接重複此步驟。截短接腳,焊上延長線,套上熱縮套管。焊接時用一個對接接頭固定接腳。
  5. 裝上 2mm 馬達相線接頭並標示導線。在其中一片電路板上接一條 2 pin Hirose 線,為 Master Board 供電。

5.3 燒錄 Micro Driver 板

依原專案燒錄章節的說明,以長度不超過約 10 cm 的纜線,透過 USB 將 JTAG 模擬器連接到 Micro Driver。

  1. Micro Driver 板以透過 USB 連接的 JTAG 模擬器燒錄,模擬器則用連接線接到 Micro Driver。
  2. 原專案的說明:「過長的線在嘗試燒錄時可能造成通訊問題。10 cm 的線長對我們來說效果很好。」
  3. 導線腳位表是儲存庫中的一張圖片。此頁面既沒有指出韌體檔案,也沒有指出要使用的軟體,因此這部分請依照 ODRI 的軟體頁面。

5.4 燒錄 Master Board

在 Linux 主機上安裝 esp-idf,在 5V 至 60V 的供電下連接 PROG 接頭,並執行原專案 master-board 韌體頁面中的 make 指令。

  1. 原專案:「master board 以 ESP32 模組為基礎,使用 esp-idf SDK 以 C++ 編程。」用以下指令安裝相依套件:sudo apt-get install git wget flex bison gperf python3 python3-pip python3-setuptools cmake ninja-build ccache libffi-dev libssl-dev dfu-util
  2. 複製並安裝 esp-idf:mkdir ~/esp ; cd ~/esp ; git clone -b v4.0.1 --recursive https://github.com/espressif/esp-idf.git ; cd ~/esp/esp-idf ; ./install.sh。用以下指令安裝 esptool:pip install esptool。
  3. 電路板透過 PROG 接頭連接到主機,且必須由 5V 到 60V 的直流電源供電。燒錄時電路板需要供電。若要在沒有管理員權限的情況下燒錄,請將你的使用者加入 dialout 群組並重新開機。
  4. 警告:在剛組裝好的電路板上,用以下指令燒寫一次設定熔絲:espefuse.py set_flash_voltage 3.3V。原專案表示熔絲燒寫過程不可逆,因此務必完全照寫的方式執行。
  5. 用以下指令載入環境:cd master-board/firmware ; source setup_esp_idf.bash。然後將 esp-idf 回退:cd ~/esp/esp-idf ; git checkout 8d1a9c0 ; git submodule update --init --recursive。
  6. 在 master-board/firmware 中執行:make flash(燒錄電路板)、make menuconfig(變更設定)、make monitor(為電路板除錯)。

6. 為機器人配線

原專案提供 12 自由度機器人的電線長度、連接器類型、針腳顏色與馬達分配表,另附走線照片;電路板裝進機身的順序則沒有寫明。

6.1 製作 Micro Driver 疊板線材

以 0.50 mm² 線材,為每組疊板製作 18 條 8cm 的馬達相線,以及三條附 XT30 接頭的電源線,前疊板的長度為 25cm,後疊板為 15cm。

  1. 前方堆疊:18 條 8cm 馬達相線;3 條 25cm 電源線。後方堆疊:18 條 8cm 馬達相線;3 條 15cm 電源線;1 條 12cm Master Board 電源線。
  2. 馬達相線:0.50 mm² 線,搭配 2mm Reely 鍍金接頭。電源線:0.50 mm² 線,搭配 XT30 電源接頭。線長從電子電路板邊緣量到接頭介面。
  3. 堆疊使用 16 個列印的 Micro Driver 堆疊間隔柱與 8 顆 M2,5x25 內六角螺絲。原專案只以照片展示完成的堆疊。

6.2 製作 SPI 線材

為前疊板製作三條 30 cm、為後疊板製作三條 14 cm 的 SPI 線,每條兩端各有一個 5 pin Hirose DF13 接頭,顏色順序依原專案的圖片。

  1. 導線:0.14 mm² 線,搭配兩個 5 極 Hirose DF13 接頭。SPI 匯流排以高頻運作,因此導線要保持短。
  2. 前方堆疊 SPI 線,30cm:0-AA、1-FL、2-FR。後方堆疊 SPI 線,14cm:3-AA、4-HL、5-HR。
  3. 依原專案圖片的腳位分配:MOSI 藍、CS 紫、CLK 灰、MISO 白、GND 黑,兩端相同。

6.3 製作 IMU 線材

以排線製作一條 35 cm 的 IMU 線,一端為 10 pin 矩形接頭,另一端為 4 pin Hirose 接頭,並將其接到 Master Board 上的 UART1 接頭。

  1. 原專案使用一條帶 10 pin 矩形接頭的排線,以及帶 4 pin Hirose 接頭的延長線。IMU 線長:35cm。
  2. 3dm-cx5-25 IMU 接到 master board 的 4 pin UART1 接頭。腳位分配見 master-board 接線頁面。

6.4 製作致動器模組線材

依原專案表格中的長度裁切每個模組的三條馬達相線與編碼器線,從膝關節模組的 17cm 到右前 Hip FE 編碼器線的 41cm 不等。

  1. Hip AA 模組(相線 / 編碼器):FR 21cm / 26cm、FL 23cm / 27cm、HR 22cm / 29cm、HL 20cm / 25cm。
  2. Hip FE 模組(相線 / 編碼器):FR 35cm / 41cm、FL 27cm / 33cm、HR 26cm / 31cm、HL 34cm / 40cm。
  3. 膝關節(大腿)模組,四條腿皆同:相線 17cm、編碼器 20cm。
  4. 每個模組有 3 條馬達相線與一條 5 極編碼器線。編碼器線的顏色順序見編碼器步驟。

6.5 將馬達分配到驅動板

依原專案表格將每個關節接到對應的 Micro Driver 板與連接埠,關節 ID 為 0 至 11。

  1. 關節 ID、名稱、卡、埠、馬達索引:0 FL_HAA card 0 port 0 index 0;1 FL_HFE card 1 port 1 index 3;2 FL_K card 1 port 0 index 2;3 FR_HAA card 0 port 1 index 1;4 FR_HFE card 2 port 1 index 5;5 FR_K card 2 port 0 index 4。
  2. 6 HL_HAA card 3 port 0 index 6;7 HL_HFE card 4 port 1 index 9;8 HL_K card 4 port 0 index 8;9 HR_HAA card 3 port 1 index 7;10 HR_HFE card 5 port 1 index 11;11 HR_K card 5 port 0 index 10。

6.6 安裝 IMU

以三顆裁短至 13mm 的塑膠 M2.5 x 16 螺絲,將 3DM-CX5-25 裝在機器人前方,標籤朝下。

  1. IMU 裝在機器人前方,標籤朝下。IMU 與機器人的座標系方向相同。
  2. IMU 原點不在 IMU 的幾何中心。它在機器人座標系中的位置:X 104.07mm、Y -6.35mm、Z 15.40mm。
  3. 機器人座標系:正 X 朝前、正 Y 朝左、正 Z 朝上。

6.7 線材走線

將致動器模組線材走在機器人底部,電源、IMU 與 SPI 線材走在頂部,所有線材都要遠離馬達轉子。

  1. 底視圖:所有致動器模組的導線都佈在機器人底部。頂視圖:電源、imu 與 spi 線佈在頂部。
  2. 原專案針對 Hip AA、Hip FE 與大腿模組的佈線圖片,將每一路線顯示為 3 條馬達相線加上 5 極編碼器線。讓導線遠離馬達轉子(圖片中的紅框)。
  3. 穿過 Hip FE 關節的導線會限制該關節可轉動的圈數。

7. 電源供應器與校正工具

版本 1 透過一條連接線由外部 24 V 電源供電;原專案記錄了這條線、電壓限制與校正工具,但沒有啟動或調校程序。

7.1 連接 24 V 電源

以 24 V 電源透過機器人介面線為機器人供電,Micro Driver 板端的電壓須保持在 5V 至 32V 之間。

  1. 電壓限制:Micro Driver 的輸入電壓為 5V - 32V,原專案以 24V 運作其機器人。Master Board 的最低電壓為 4.5V,絕對最大值為 60V;由於其電源接頭的尺寸,若沒有額外絕緣,電壓應更低(30V)。
  2. 機器人介面線:1 mm² 線,電源端使用 4mm 電源接頭,機器人端使用 XT30 電源接頭。乙太網路方面,原專案使用自製的 4 極乙太網路線以減少線徑與硬度,並表示你也可以改用標準乙太網路線。兩端的乙太網路接頭相同。
  3. 原專案的電源接頭圖片將帶圓形插孔的 XT30 接頭標為電源端,帶插針的標為用電端,各有一條紅線與一條黑線。文字中沒有說明極性;請依照圖片。
  4. 原專案的清單在 Power Supply 下列出實驗室電源供應器 VOLTCRAFT DPPS-32-20(1-32V DC,最大 20A)與 DPPS-32-30(1-32V DC,最大 30A)。12dof 頁面中並未將它們與 Solo12 綁定。
  5. 此處不要使用 version 1.1 的電池。原專案:「沒有電源管理板時,不要使用鋰聚電池!」

7.2 製作校正工具

列印兩個工具、兩個鏡像工具與兩個連接件,將 2mm x 16mm 與 2.5mm x 12mm 的銷壓入其中,並在連接件中裝上 M3 x 4.5 Helicoil。

  1. 原專案對 12dof 四足機器人的清單:Calibration Tool 12dof v1 x2、mirrored version x2、Connector x2、Pin Spacer Tool 4mm x1(皆為列印件;工具以 sparse double dense 列印)、Pin 2mm x 16mm x8、Pin 2,5mm x 12mm x8、M3 x 16 socket head cap screw x8、Threaded Inserts M3 x 4,5 x8。
  2. 用 1.9mm 鑽頭調整 2mm 定位銷的孔徑,用鎚子將它們敲入,使其凸出表面 4mm(銷間隔工具有幫助)。2.5mm 定位銷用 2.4mm 鑽頭。
  3. 用 2.5mm / 2.7mm / 2.9mm 與 3.1mm 鑽頭小幅度逐步擴大連接件上的方孔,並在全部四個位置裝入 M3x4,5 Helicoil。

7.3 裝上校正工具

將銷推入每個致動器模組與小腿的螺絲頭中,不留間隙,用魔鬼氈綁帶繞過膝部固定,再以 M3 x 16 螺絲接上連接件。

  1. 將定位銷插入致動器模組與小腿的螺絲頭中。確認工具完全就位,沒有間隙。
  2. 原專案在膝部周圍使用魔鬼氈束帶讓工具保持定位,並用 M3x16 螺絲安裝連接件。
  3. 為什麼這很重要:機器人開機時關節角度是未知的,因此要手動將腿對齊到大約零位,軟體會找到最近的編碼器索引,而每個自由度的索引位置與零位之間的偏移量必須量測並儲存一次。若致動器模組經過維修、更換或修改,就必須重新量測並儲存偏移量。
  4. 執行這項工作的軟體位於另外的儲存庫中,原專案的硬體頁面沒有指出任何增益調整或步態腳本。

8. 選配:版本 1.1 自主化升級

原專案將版本 1.1 描述為版本 1 的升級,加入機載電池與電源管理板;它只公開零件、電線長度與照片,而它自己的元件頁面表示電池尚未經過測試。

8.1 閱讀 1.1 版的警告

1.1 版加入兩顆 SLS X-Cube 850mAh 3S LiPo 電池,絕不可在沒有電源管理板的情況下使用這些電池運作。

  1. 原專案:「沒有電源管理板時,不要使用鋰聚電池!」其元件頁面另外寫道:「電池尚未經過測試。」
  2. 電池:SLS X-Cube 850mAh,3S1P,11.1V,持續 30C,瞬間 60C,重量 68g,60mm x 30mm x 21mm,電源接頭 XT 30,平衡接頭 XH。機器人搭載兩顆,一顆在前、一顆在後。
  3. 原專案的電池接線圖片顯示兩顆電池串聯,電源板接頭、前電池接頭與後電池接頭都標有 + 與 -。請依照圖片;該頁面沒有說明總電壓。
  4. 電源管理板是 Thomas Flayols 設計的客製電路板,記錄在另外的 power-board 儲存庫中。它監測電池電壓與電流,讀取電源開關與緊急停止開關,在緊急停止啟動時切斷電池電源,限制湧入電流,透過 SPI 與 Master Board 通訊,並有 8 個 XT30 輸出。

8.2 列印並準備 1.1 版零件

列印 Body Structure Center Payload(2)、Front Batterie Lid(2)、Front Batterie(2)、Top IMU Leds(1)、Top Master Power Board(1)、Mount Switches(1)與 Neo Pixel Cover(1),並裝上原專案列出的 Helicoil。

  1. 原專案的清單:Body Structure Center Payload 2、Body Structure Front Batterie Lid 2、Body Structure Front Batterie 2、Body Structure Top IMU Leds 1、Body Structure Top Master Power Board 1、Mount Switches 1、Neo Pixel Cover 1。列印方向為 STL 檔的正 z 方向。
  2. 扣件:M2 x 6 SHCS 8 顆(Power Board 與 Master Board)、M2,5 x 6 SHCS 1 顆(開關座後方)、M2,5 x 8 SHCS 1 顆(開關座前方)、M3 x 6 SHCS 4 顆(電池蓋)。Helicoil M2,5 x 3,75mm 10 個與 Helicoil M3 x 4,5mm 20 個。
  3. 原專案的七張準備圖片給出了鑽頭與螺絲攻尺寸,例如 M3 x 4,5 Helicoil 用 3.1mm 鑽頭、M2,5 x 3,75mm Helicoil 用 2.6mm 鑽頭、2.1mm 鑽頭搭配 M2,5 螺絲攻,以及 1.6mm 鑽頭搭配 M2 螺絲攻。圖片沒有文字標示,因此請依形狀將每張圖對應到零件。

8.3 1.1 版電子元件配線

依原專案的長度製作電源、SPI、開關、IMU、LED 環與電池線材,注意疊板線材較長,IMU 線為 40cm。

  1. Power Board 與 Master Board:電源線 8cm,XT30 轉 2 pin Hirose;SPI 線 5cm;開關線的腳位分配見圖片:三支腳,COM 在中間,OFF 在緊急停止開關那一側,ON 在電源開關那一側。開關:E-Stop 紅色,常閉,按下時瞬間斷開(RS 820-7587);On-Off 綠色,常開,按下時瞬間閉合(RS 820-7593)。
  2. 前方 Micro Driver 堆疊:18 條 8cm 馬達相線、3 條 30cm 電源線、3 條 34cm SPI 線。後方堆疊:18 條 8cm 馬達相線、3 條 16cm 電源線、3 條 18cm SPI 線。IMU 介面線 40cm。
  3. Neo Pixel LED 燈環(12 x WS2812,Adafruit 1643):介面線 34cm;依圖片的接頭腳位順序為 Ground、5V Power、Data Input。
  4. 電池接線圖片:從電源板接頭到前電池接頭 50cm,後電池在距電源板約 7cm 處分接,分支長 4cm;兩顆電池串聯。
  5. 原專案沒有公開將 version 1.1 零件裝到機身上的書面順序。

本網站需要 JavaScript 才能正常運作。請啟用 JavaScript 以瀏覽我們的開源機器人專案。