Open Source Robotics

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

TriFinger 組裝指南

開源的 9 自由度三指靈巧操作平台,用於強化學習與機器人研究

授權條款

BSD-3-Clause

組裝指南

1. 原專案公開了什麼

原專案只為致動器模組提供書面步驟。手指、框架、擋板與攝影機則只公開零件、圖面與照片,本指南在沒有提供步驟之處都會註明。

1.1 原專案記錄與未記錄的內容

致動器模組有八頁逐步說明;手指、機架、防護欄與攝影機只有零件清單、圖面與照片。

  1. TriFingerEdu 頁面表示,這個平台有 9 個扭矩控制的自由度,由 3 個相同的手指模組安裝在鋁製框架結構上組成。
  2. 手指頁面表示,每根手指由 3 個不同的致動器模組組成:Hip AA(148g)、Hip FE(160g)與 Upper Leg(155g),與 12dof 四足機器人腿部使用的致動器模組相同。組裝好的手指重 930g。
  3. 原專案針對致動器模組的逐步頁面,依其順序為:Motor Preparation、Motor Shaft Preparation、Encoder Preparation、Center Pulley Preparation、Output Pulley Preparation、Shell Preparation、Actuator Module Assembly 與 Actuator Module Testing。每個頁面主要是照片,每張照片下方附有說明文字。Testing 頁面只有標題。
  4. Actuator Module Assembly 頁面表示,該步驟需要先前準備好的 6 個子組件。請先為全部九個模組準備好零件,之後再組裝,如接下來兩節所述。
  5. 原專案沒有發布組裝手指底座框架、將三個模組組成一根手指、製作鋁框架,或將手指、隔板與攝影機固定到框架上的文字步驟。對這些部分,它提供的是零件、圖面與照片。本指南在每個相關步驟都會註明這一點,不會自行補充任何內容。

1.2 決定如何取得機加工件與列印件

每個模組都需要以金屬機加工的馬達軸、馬達皮帶輪與中間皮帶輪,以及列印的殼體、皮帶輪與滾輪。

  1. 每個致動器模組中有三個零件必須以金屬加工製作:10 齒的鋁製馬達皮帶輪(0.6g)、10 齒的鋁製中間皮帶輪(2,1g),以及以 4mm 不鏽鋼棒製作的馬達軸(3,2g)。原專案的圖面為 motor_pulley_at3_t10.PDF、center_pulley_at3_t10.PDF 與 motor_shaft.PDF,每份都有英制版本。
  2. 原專案的提醒:不要使用標準 AT3 同步皮帶輪的尺寸或刀具。它修改了原本的 AT3 齒形以減少背隙。
  3. 除了自行加工,你也可以訂購 ODRI Encoder Kit,原專案的 Actuator Module Core v1.1 頁面對此有說明。套件包含已完全準備好的馬達軸組件、中間皮帶輪(鋁 7075)以及 Broadcom AEDT-9810-Z00 編碼器讀頭。原專案表示,這樣其 Motor Shaft Preparation 頁面上的所有步驟就都已完成,且套件的馬達軸組件與自製的組件相容並可互換。
  4. 在列印方面,原專案以 FDM 或 SLS 印表機列印外殼等大型結構零件,以 Multijet 或 SLA 印表機列印同步皮帶輪等需要高精度的小零件。每個零件都依其 STL 檔的正 z 方向列印。
  5. 列印公差因供應商、技術與材料而異。關鍵表面是軸承座。原專案表示,最好使用自己的印表機列印,以便進行試印;軸承座若過大將無法固定軸承,零件可能無法使用。

2. 準備九個致動器模組的零件

原專案的六個準備頁面,依其順序。一根手指有一個 Hip AA、一個 Hip FE 與一個 Upper Leg 模組,因此整個平台每種各需三個;在組裝任何模組之前,先準備好全部九個模組的零件。

2.1 準備轉子

將 T-Motor Antigravity 4004 300kV 的轉子與定子分開,拉出原廠軸,並為客製的 4mm 軸鉸削內孔。

  1. 用小尖嘴鉗取下馬達軸上的扣環。之後不再需要它。
  2. 輕輕拉開以克服磁力,將轉子與定子分開。保留黃銅墊圈。將轉子放在乾淨的表面上,因為金屬碎屑會吸附在磁鐵上,之後可能造成問題。
  3. 用 1,5mm 六角起子取下轉子上的兩顆 M3 止付螺絲,保留供重新組裝使用。
  4. 將轉子放在 3D 列印的馬達軸拆卸工具(tool_motor_shaft_extraction.STL)上,用鐵鎚與沖棒將軸敲出。
  5. 用 3.98mm、3.99mm 與 4.00mm 的鉸刀擴孔。從最小的開始,在鉸刀上塗一點油,小心插入,裝在刀把上用手轉幾圈。
  6. 在客製馬達軸上塗一點油,試著插入。如果孔太緊,用同一支鉸刀再做一次,再換下一個較大的尺寸,直到軸能以適度的力量裝入與取出為止。
  7. 原專案特別強調:孔徑不要擴得太大。配合太鬆時,轉子旋轉會晃動。
  8. 用 1,5mm 六角起子將兩顆 M3 止付螺絲鎖入一半。轉子現在可以進行組裝了。

2.2 準備定子與相線

移除定子相線的絕緣層,焊上 0,5 mm² LiY 延長線,確定線長後再焊上 2mm 鍍金接頭。

  1. 剪開並移除底部的大熱縮套管。以斜角剪掉一段相線上的熱縮套管,用鉗子夾住相線,一邊捏住熱縮套管一邊慢慢拉電線,讓電線把套管割開。持續進行直到移除一半的絕緣層,然後把其餘部分拉掉。
  2. Hip AA 模組:不要剪短馬達相線。跳過剪短的步驟,直接處理熱縮套管。Hip FE 與 Upper Leg 模組:將馬達相線剪短到從定子底部量起約 3cm,使焊點保持在外殼內。
  3. 用約 400 度 C 的溫控烙鐵燒掉線端的橘色絕緣層。在烙鐵頭上加焊錫,等到約 5mm 的銀色導線露出。用熱風槍套上細熱縮套管。
  4. 將焊接溫度降到約 300 度 C。準備比所需長幾 cm 的延長線(原專案使用截面積 0,5mm² 的 LiY 線),焊到相線上,並用短熱縮套管包覆每個接點。
  5. 如果你不確定電線長度,請在此停下,先完成其他所有準備步驟並組裝模組,之後再決定長度並焊接接頭。
  6. 安裝接頭:將電線剪到適當長度,剝除少許絕緣層,絞緊線芯並上錫。將 2mm 鍍金公接頭(原專案使用 REELY)焊到相線上。裝上配對的接頭,將熱縮套管對準接點,用熱風槍加熱收縮。

2.3 將皮帶輪黏到馬達軸上

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

  1. 使用 3D 列印工具 tool_motor_shaft_pulley_bonding.STL。這個工具必須將皮帶輪支撐在正確位置。用數位卡尺的深度桿測量工具的深度:應約為 6,6mm。工具與馬達軸末端之間的距離應約為 26,8mm。
  2. 用棉花棒沾酒精清潔黏接表面。請戴手套。
  3. 在黏接表面塗上一層薄薄的 Loctite 648。將馬達軸插入皮帶輪並稍微轉動。用棉花棒清除底部多餘的 Loctite。
  4. 將軸與皮帶輪放在黏接工具上,馬達軸上的平面朝上。清除頂部多餘的 Loctite。確認軸保持垂直並完全插入工具。
  5. 讓零件在室溫下固化幾個小時。然後留在工具上,放入烤箱再固化幾個小時。原專案以 70 度 C 固化約 3 小時。

2.4 將碼盤黏到其安裝座上

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

  1. 碼盤有兩種來源。A:向 PWB 訂購,搭配安裝座 encoder_codewheel_pwb_mount.STL。B:來自編碼器套件,搭配安裝座 encoder_codewheel_kit_mount.STL。請使用與你的碼盤相符的安裝座。其他所有步驟都相同。
  2. 塗膠之前,先將碼盤放到安裝座上確認是否合適。碼盤必須完全就位、平整,轉動時不晃動。如果 3D 列印的殘料使它無法放平,用一字起子把零件角落的殘料刮掉。
  3. 原專案在馬達軸裝在定子中的狀態下黏接碼盤:將軸以平面朝下插入定子軸承。用 4mm 鉸刀調整安裝座的內徑。將安裝座套到軸上,對齊皮帶輪與安裝座的齒,然後推到底。
  4. 檢查馬達軸末端與安裝座之間的距離。應約為 2mm;誤差 0,1 或 0,2mm 都沒關係。
  5. 原專案特別強調:碼盤必須以正確方向安裝。碼盤上的印字必須能從上方正向閱讀。
  6. 戴上手套。在安裝座上塗一層薄薄的瞬間膠(原專案使用 Loctite 406)。將碼盤印字朝上放好,用工具 tool_code_wheel_bonding.STL 推到底,按住 30 秒,輕輕移開工具,等待幾分鐘讓膠固化。
  7. 轉動馬達軸,確認碼盤保持水平且不晃動。將馬達軸組件從定子中取出。它現在可以進行安裝了。

2.5 準備編碼器

將 Broadcom AEDT-9810-Z00 的兩個安裝孔擴大以裝 M3 平頭螺絲,彎折其針腳,並焊上五條 0,14mm² 延長線。

  1. 用 3mm 鑽頭擴大兩個安裝孔(原始直徑為 2,8mm)。用 45 度倒角刀倒角,使 M3 平頭螺絲與編碼器表面齊平。
  2. 用平口鉗截短接腳,並將它們向下彎 45 度。
  3. 準備 5 條 0,14mm² 的延長線(原專案使用紅、黃、黑、白、綠色)。剝線、絞線、上錫並剪短線端,在編碼器針腳上加一點焊錫,依照原專案頁面上的配線圖將電線焊到針腳上。以短熱縮套管包覆每個接點,並每隔幾公分用一段較粗的熱縮套管將電線束在一起。
  4. 如果你不確定電線長度,請在此停下,等模組組裝後再壓接 Hirose 接頭。
  5. 壓接方式:使用 Hirose DF13 壓接工具與壓接端子。將電線剪到適當長度,剝除約 1mm 的絕緣層。將每條電線盡量筆直地插入,直到線芯碰到止擋,將把手完全壓合後放開。第一道壓接應夾住絕緣層,第二道應夾住線芯。
  6. 依照原專案配線圖所示的順序,將壓接好的電線插入 Hirose 5 pin 接頭。使用鑷子會比較容易。

2.6 準備中間皮帶輪與皮帶張緊器

將 10 齒鋁製皮帶輪壓入列印的 30 齒中間皮帶輪,並以 683 軸承、M3x10 平頭螺絲與修改過的 M2,5 墊圈製作兩個皮帶張緊滾輪。

  1. 在列印皮帶輪的內齒形上塗一點 Loctite 648。將鋁製皮帶輪放上去,保持垂直並對準齒形,定心孔朝上,用手稍微推入。
  2. 將 3D 列印的保護工具(tool_center_pulley_protection.STL)放到鋁製皮帶輪上。將組件翻面,把組裝工具(tool_center_pulley_assembly.STL)對準底部中心。用手壓機將鋁製皮帶輪慢慢壓到底;也可以用虎鉗。
  3. 移除工具,並用棉花棒清除多餘的 Loctite。零件底面應該齊平;如果不平,再用壓機壓一次。
  4. 每個模組需要兩個同步皮帶張緊輪。將軸承壓入每個 3D 列印的滾輪(預設直徑為 10mm;較大的滾輪可調整皮帶張力),並確認軸承完全壓入。
  5. M3 墊圈太大,會使軸承外環無法自由轉動。請改用 M2,5 墊圈(內徑 2,7mm,外徑 5,8mm),並用圓銼將內徑擴大到約 3mm。
  6. 將 M3x10 平頭螺絲從有凸緣的一側插入,將組件翻面,裝上修改過的 M2,5 墊圈。

2.7 準備輸出皮帶輪

車削列印輸出皮帶輪的兩根軸,使其能裝入 32mm x 25mm x 4mm 軸承,再裝上兩個 Helicoil M3 x 6 螺紋護套,Hip AA 模組除外。

  1. 列印尺寸會有差異,因此原專案會將與軸承配合的軸徑列印得稍大,再用車床車到正確尺寸。輕輕夾住一側的輸出軸(使用 25mm 筒夾會有幫助),使用鋒利的車刀,分小段逐步減小直徑,並用輸出軸承檢查配合。
  2. 應為輕度壓入配合:你應該能以適度的力量用手裝上與取下軸承。然後將皮帶輪轉過來,在另一側重複同樣步驟。
  3. Hip AA 例外:扣件會穿過 Hip AA 的輸出皮帶輪,因此不要安裝 Helicoil。將安裝孔稍微倒角,並用 3mm 鑽頭擴大到 3mm。原專案表示,Hip AA 皮帶輪做到這裡即可。
  4. 其他所有模組:每個步驟都讓凸緣朝上。為兩個安裝孔倒角。孔徑應約為 2,9mm;先用 3mm 鑽頭鑽穿,再以每次 0,1mm 的級距擴大到 3.3mm。
  5. 用 Helicoil M3 螺絲攻為兩個孔攻牙。如果阻力變大,小心將螺絲攻退出,用牙刷清潔後再繼續,直到螺紋完全攻好。
  6. 用安裝工具裝入兩個長 6mm 的 M3 Helicoil,使每個螺紋襯套的末端約位於外表面以下半圈。用折斷工具折斷兩個安裝柄,並確認零件內沒有殘留安裝柄。

2.8 準備殼體並裝上軸承

檢查列印的殼體底座與上蓋,為 M3 螺紋攻牙,在每一半各裝四個 M2,5 x 3,75mm Helicoil,裝上兩顆 32mm x 25mm x 4mm 與三顆 8mm x 4mm x 2mm 軸承,並以八顆螺絲試裝。

  1. 將外殼蓋與外殼底座放在平面上檢查平整度。如果零件翹曲,可能無法使用。
  2. 共有兩個 3mm 與八個 2,5mm 的貫穿孔。用卡尺檢查,或試著穿過一顆 M3 與一顆 M2,5 螺絲。如果螺絲不易穿過,用鑽頭擴孔。
  3. 用螺絲攻攻 M3 螺紋,盡量保持垂直,並完全攻穿外殼:兩個用於固定編碼器,兩個用於同步皮帶張緊輪。
  4. 用 M2,5 Helicoil 螺絲攻為外殼底座的 4 個孔與外殼蓋的 4 個孔攻牙,然後在兩半各裝入四個 M2,5 x 3,75mm Helicoil,並移除安裝柄。攻到孔底、阻力變大時就停止,因為 3D 列印零件上的螺紋很容易崩牙。
  5. 軸承座應為輕度壓入配合。如果太緊,用具有銳利 90 度刃口的端銑刀調整(原專案展示的是 8mm 與 32mm),並用銼刀將刀刃底部磨鈍,使其只在側面切削。原專案不建議使用鉸刀,因為鉸刀通常有倒角,無法加工出銳利的直角。
  6. 用手指安裝軸承,保持每個軸承水平:依原專案圖片所示,在外殼底座與外殼蓋上安裝兩個 32mm x 25mm x 4mm 的輸出軸承,以及三個 8mm x 4mm x 2mm 的傳動軸承。張緊輪軸承不裝在外殼內,而是裝在滾輪上。
  7. 用八顆不鏽鋼內六角螺絲與 2mm 六角起子試裝外殼:五顆 M2,5x6 與三顆 M2,5x10。在外殼蓋上裝四顆 M2,5x6,再在底座上裝三顆 M2,5x10 與一顆 M2,5x6。準備好的外殼組件重 61g。

3. 組裝並測試每個致動器模組

取自原專案的 Actuator Module Assembly 頁面。九個模組都要重複進行。完成的模組連同 30cm 電線重 160g。

3.1 安裝定子

以四顆 M3x5 平頭螺絲將定子固定到殼體底座上。

  1. 將馬達相線從外殼的開口穿過,並將定子放到安裝面上。
  2. 將相線向上彎,對準缺口。
  3. 用 2mm 六角起子裝上四顆 M3x5 平頭螺絲。確認定子完全就位且不會移動。
  4. 將相線穿過編碼器座後方的開口,再從安裝介面穿出。

3.2 安裝馬達軸與轉子

將馬達軸組件裝入定子軸承,再以兩顆 M3 止付螺絲裝上轉子。

  1. 請小心拿取碼盤。在以下步驟中避免彎折或刮傷它。
  2. 將馬達軸組件插入定子軸承。確認已裝上黃銅墊片。
  3. 將組件轉過來,用 1,5mm 六角起子將兩顆 M3 止付螺絲鎖入一半。
  4. 將轉子上的止付螺絲對準馬達軸上的平面,裝上轉子並推到底。
  5. 一邊向下壓住轉子,一邊用 1,5mm 六角起子鎖緊兩顆止付螺絲。用手轉動轉子,確認轉動順暢,然後沿軸向拉動:應該沒有間隙,或只有極小的間隙。

3.3 安裝時規皮帶傳動機構

將 150mm 的第一段皮帶套在馬達皮帶輪與中間皮帶輪上,201mm 的第二段皮帶套在中間皮帶輪與輸出皮帶輪上。

  1. 將 150mm 同步皮帶套到中間皮帶輪上並使齒嚙合。再套到馬達皮帶輪上並使齒嚙合。
  2. 保持皮帶張緊,將中間皮帶輪插入其軸承。
  3. 將 201mm 同步皮帶套到輸出皮帶輪上並使齒嚙合,凸緣側朝上。
  4. 將這條皮帶套到中間皮帶輪上並使齒嚙合。保持張緊,將輸出皮帶輪插入其軸承。
  5. 來回轉動輸出軸,確認傳動機構如預期般運作。

3.4 安裝編碼器

將準備好的編碼器放在碼盤上方,並以兩顆 M3x16 平頭螺絲固定。

  1. 將編碼器電線從介面上的開口穿過。
  2. 將編碼器以斜角小心插入,使碼盤落在間隙中。原專案會把編碼器的針腳剪短並折彎,讓這一步更容易。
  3. 將編碼器放到安裝面上,裝上兩顆 M3x16 螺絲。
  4. 確認碼盤位置正確,且不會碰到編碼器。致動器模組的底座到此完成。

3.5 將皮帶張緊滾輪裝到殼體上蓋

以兩個準備好的張緊滾輪所附的 M3x10 螺絲與墊圈,將它們鎖到殼體上蓋上。

  1. 需要外殼上蓋與同步皮帶張緊滾輪。確認墊圈已裝好。
  2. 用 2mm 六角起子安裝滾輪。逐一轉動每個滾輪,確認轉動順暢。

3.6 合上殼體

將殼體上蓋合到底座上,並以八顆 M2,5 內六角承窩頭螺絲鎖緊。

  1. 將外殼上蓋放到外殼底座上。把上蓋稍微傾斜,並將輸出皮帶輪部分裝入。在這一步接下來的過程中,持續對組件中心施加適度壓力。
  2. 用小一字起子把第二級皮帶向內推,使其越過張緊滾輪:先推一側,將組件翻面後再推另一側。皮帶越過滾輪時,上蓋應會稍微下沉。
  3. 接著中央皮帶輪必須對準上蓋中的軸承。握住轉子來回轉動幾次,同時輕壓上蓋。每個方向轉幾圈後,上蓋應該就能闔上。
  4. 若外殼無法闔上,可用尖頭工具穿過中央皮帶輪上的孔,將中央皮帶輪導入軸承,同時轉動轉子。
  5. 確認外殼已完全闔上,且馬達可以轉動。
  6. 用 2mm 六角起子裝上八顆連接螺絲,並以適中扭矩鎖緊。原專案的外殼準備頁面列出五顆 M2,5x6 與三顆 M2,5x10 內六角圓柱頭螺絲;其組裝頁面則列為三顆 M2,5x8,而非 M2,5x10。

3.7 裝上馬達相線與編碼器接頭

如果尚未完成,將 2mm 鍍金接頭焊到相線上,並將 Hirose DF13 接頭壓接到編碼器線上。

  1. 原專案的最後一個組裝步驟是加上馬達相線與編碼器連接器。請依照馬達準備頁面中的 Soldering the Motor Phase Connectors 一節,以及編碼器準備頁面中的 Crimping Hirose Connector 一節進行。
  2. 原專案測量致動器模組的線長時,是從導線離開外殼的表面量到連接器介面。
  3. 配線頁面列出模組的電氣介面為一條 5 極編碼器線與 3 條馬達相線:編碼器使用 0,14 mm² 導線與 5 極 Hirose DF13 連接器,相線使用 0,50 mm² 導線與 2mm Reely 鍍金連接器。色碼與針腳定義在該頁面上以圖片呈現。

3.8 測試模組

原專案表示,組裝後的下一步是測試模組並找出馬達相線的正確順序,但沒有公開相關程序。

  1. 組裝頁面的結尾是:下一步是測試模組,並確定馬達相線的正確順序。
  2. 原專案的 Actuator Module Testing 頁面只有標題、沒有內文,因此本指南不提供測試程序。

4. 組裝三根手指

取自原專案的 FingerEdu 頁面。它提供零件與照片,沒有書面組裝步驟。

4.1 列印手指底座框架、手指連桿與轉接件

列印手指底座框架板、TI 疊板間隔柱與支架、手指轉接件與手指連桿,每個零件都依其 STL 檔案的 z 軸正方向列印。

  1. 原專案提供的手指結構 STL 檔案及其重量:Finger Adapter 10g;Finger Tip 20g(手指連桿);Structure Bottom Plate 16g;Structure Front Plate 23g;Structure Side Plate Left 100g;Structure Side Plate Right 71g;TI Stack Spacer 2g;TI Stack Support 3g。組裝完成的底座框架重 226g。
  2. 以 FDM 印表機列印手指連桿,設定為 sparse double dense。連桿加上指尖重 22g。
  3. 三種致動器模組(Hip AA、Hip FE 與 Upper Leg,各有一個底座與一個上蓋)的外殼取自原專案的 Leg 3dof STL 檔案。原專案另外列出一款可簡化走線的 Hip FE 替代底座外殼。
  4. 原專案沒有提供用板件組裝底座框架的文字步驟,只有一張組裝完成框架的照片。

4.2 將三個致動器模組組成一根手指

將一個 Hip AA、一個 Hip FE 與一個 Upper Leg 致動器模組,與手指底座框架及手指轉接件組合在一起。

  1. 製作三根手指,每根由一個 Hip AA、一個 Hip FE 與一個 Upper Leg 致動器模組組成。
  2. 原專案沒有提供扣件清單,也沒有說明模組的連接順序或如何固定到手指底座框架上。它只提供照片,說明文字為:每根手指由 3 種不同的致動器模組組成,手指可以完全收進底座結構以便運送。
  3. 手指頁面指向 Leg 3dof 頁面以取得更詳細的資訊。該頁面列出三模組腿部的扣件,例如連接 Hip AA 與 Hip FE 時,視有無轉接件而使用 M3x35 或 M3x22 內六角圓柱頭螺絲。該頁面並未說明這些就是手指所用的扣件,使用前請對照手指的照片確認。

4.3 裝上指尖

將橡膠指尖套到列印的手指連桿上。

  1. 橡膠指尖重 2g。它是處理紙張用的一般文具:請找 Rubber Thimblette,size 2,large。
  2. 原專案以照片呈現已列印的連桿及其指尖,沒有再提供將連桿裝到 Upper Leg 模組的步驟。

5. 馬達驅動電子元件

每個手指模組需要一個 24V 電源供應器與 2 個 CAN 通訊通道。原專案的 TI 頁面為兩顆馬達準備一片 Launchpad F28069M 搭配兩片 DRV8305 Booster Pack。請注意電源:原專案給出的最大供電電壓為 45V,而它的機器人以 24V 運行。

5.1 準備 Launchpad

設定 TI Launchpad F28069M 上的跳線,並將兩條附 5 pole Hirose 接頭的編碼器纜線焊到其 QEP_A 與 QEP_B 針腳上。

  1. 移除跳線 JP1、JP2、JP4 與 JP5。裝上跳線 JP6,並確認 JP7 與 JP3 也已連接。
  2. 原專案提醒:將 Launchpad 接上 USB 與外部電源供應器時,務必確認 JP1 與 JP2 已移除。這樣可讓電腦與經由 booster pack 供應的外部電源隔離。
  3. 準備編碼器導線與一個 5 極 Hirose 連接器。依照針腳定義圖將導線焊到連接器上,在紅線與黃線套上細熱縮套管,再於所有導線外套上較粗的熱縮套管。用同樣方法製作第二條線。
  4. 在 Launchpad 上找到標示為 QEP_A 與 QEP_B 的編碼器針腳。用平口鉗將針腳向下折 90 度,焊上編碼器導線並套上熱縮套管。
  5. 原專案針腳頁面的注意事項:將 GPIO 26 接地會停用馬達驅動器;不要將 5V 電源接到類比輸入通道,其最大電壓為 3,3V。

5.2 準備 Booster Pack 與線材

如有需要,可修改兩塊 DRV8305 Booster Pack 的螺絲端子,並製作附 2mm 接頭的電源線(1mm²)與六條馬達相線(0,5mm²)。

  1. 改裝螺絲端子為選用步驟;你也可以用其他方式走線。兩片 booster pack 都必須連接到電源供應器。下層 booster pack 只需改裝 3 針相線端子,2 針電源端子可維持原樣。
  2. 原專案的改裝方法:鬆開螺絲,將全部 5 個金屬夾片向外扳開,取下螺絲與夾片,將塑膠蓋向內推以取下,在標記處依序用 2mm、2,5mm、3mm 鑽頭鑽孔,再裝回。2 針的蓋子照原樣裝回;3 針的蓋子旋轉 180 度後反向安裝。
  3. 電源線:1mm² 導線。剝線、絞線並在線端上錫,將兩條線都剪短至約 7cm,剝除 5mm 絕緣層,再裝上接電源供應器用的 4mm 連接器。可以把 booster pack 放到 Launchpad 上來決定線長。
  4. 馬達相線:準備六條 0,5mm² 導線並配 2mm 連接器,焊上連接器、套上熱縮套管並標示馬達相位。
  5. 安裝電源線與馬達相線。

5.3 堆疊電路板、設定 DIP 開關並燒錄

將兩塊 Booster Pack 裝在 Launchpad 底部,然後將 DIP 開關分別設定為燒錄與執行。

  1. 將兩片 booster pack 裝到 Launchpad 的底面,確認排針對齊。
  2. 要讓馬達驅動板從快閃記憶體執行,將 DIP 開關設為 ON - ON - OFF。要經由 USB 燒錄程式,則設為 ON - ON - ON。
  3. 在開關設為 ON - ON - ON 時經由 USB 燒錄 Launchpad,之後設為 ON - ON - OFF,以經由 CAN 控制馬達。本頁沒有指明要燒錄哪個韌體。

5.4 將電路板分配到關節與 CAN 連接埠

依原專案的順序,將每根手指的兩塊馬達板 A 與 B 接到兩個 CAN 連接埠。

  1. 每根手指由 A、B 兩片馬達板控制。A 板控制中關節與下關節;B 板控制上關節。
  2. TriFinger 需要 6 個 CAN 介面,每根手指 2 個。原專案建議的順序如下,這樣預設設定就不需修改:can0 為 Finger0 CAN A,can1 為 Finger0 CAN B,can2 為 Finger120 CAN A,can3 為 Finger120 CAN B,can4 為 Finger240 CAN A,can5 為 Finger240 CAN B。
  3. CAN 部分,原專案在雙通道 PCI Express CAN 卡上使用附 9 針 D-sub 連接器的 2 極導線。Finger Edu 馬達驅動卡的配置以圖片呈現在 FingerEdu 頁面上,電源連接器的極性規範則以圖片呈現在配線頁面上;通電前請兩者都確認。

6. 框架、擋板與攝影機

取自原專案的 TriFingerEdu 頁面及其兩張圖面。原專案提供零件、圖面與組裝照片,但沒有書面組裝順序。

6.1 裁切鋁擠型

裁切九根 Item 鋁擠型(size 8、40mm x 40mm),分三種長度,並備齊角架、端蓋、T 型槽螺帽與列印的中央連接件。

  1. Item 鋁擠型,size 8,40mm x 40mm,Item 料號 0.0.026.33。依原專案圖面切出九段:3 段 Frame Element Side,600mm;3 段 Frame Element Top,250mm;3 段 Frame Element Camera Attachment,300mm。
  2. 在 Top 與 Camera Attachment 段上,圖面的端視圖標示一個直徑 6,80、深 26,25 的孔,攻 M8x1.25 - 6H 螺紋,深度 20。Side 段沒有這項註記。圖面日期為 25.5.2020。
  3. 其他框架零件:3 個 90 度大型角座,Item 料號 0.0.411.32;9 個端蓋,size 8,Item 料號 0.0.026.01;M5 T 型槽螺帽,Item 料號 0.0.480.54(原專案未提供數量);以及一個 3D 列印的中央連接件 frame_center_connector_top.STL。

6.2 組裝機架

使用 6mm 六角起子,以角架、T 型槽螺帽與列印的中央連接件接合鋁擠型。

  1. 原專案發布了兩張組裝照片,說明文字分別為 Frame assembly - 6mm hex driver 與 Frame assembly - 6mm allen key,另有一張以 T 型槽鋁擠型組成的完成框架照片。
  2. 它沒有提供文字順序,也沒有說明角座與螺帽裝在哪裡。請參考它的照片,以及它發布、可在網頁瀏覽器中檢視的 TriFingerEdu v1 CAD 模型;本指南尚未開啟該模型。

6.3 裁切聚碳酸酯防護欄

裁切三片 3mm 聚碳酸酯板,尺寸 553mm x 250mm,每片有六個 5mm 孔。

  1. 原專案的護欄由 3 片 3mm 聚碳酸酯板組成,用來讓物件保持在操作區域內。
  2. 圖面顯示每片板為 553mm x 250mm,有六個直徑 5 的孔,分成兩欄、每欄三個。兩欄相距 513mm,因此各距短邊 20mm。每欄的三個孔間距 100mm,外側兩孔距長邊 25mm。
  3. 原專案沒有提供將板片固定到框架的文字步驟,只有護欄的照片。

6.4 列印攝影機座並選擇攝影機

列印三個攝影機座(camera_mount.STL),並取得三台搭配 C125-0418-5M 鏡頭的 Basler acA720-520uc 攝影機。

  1. 相機:Basler acA720-520uc。鏡頭:Basler C125-0418-5M。相機座:3D 列印,STL 檔案 camera_mount.STL,需要三個。
  2. 在原專案的軟體文件中,相機名稱為 camera60、camera180 與 camera300。在 TriFingerEdu 上,相機座一律位於兩根手指之間的正中央,所以這些名稱是準確的。
  3. 原專案沒有提供將相機座與相機裝到框架上的文字步驟或扣件清單。

6.5 將手指、防護欄與攝影機固定到機架上

原專案提供了手指的名稱與位置,但沒有固定程序或扣件清單。

  1. 原專案依三根手指繞機器人中心的角度位置來命名,以第一根手指為零度:finger0、finger120 與 finger240。
  2. 它沒有提供螺絲清單、孔位或安裝的文字順序。只能參考它的照片、簡化版手指的尺寸圖(兩段各 160mm)以及它的 CAD 模型。
  3. TriFingerEdu 頁面也提到,這個機器手臂平台可以倒置使用。

7. 電腦與軟體

取自原專案的 TriFinger 文件與 robot_fingers 套件文件。原專案的 TriFinger 文件表示內容仍在撰寫中。

7.1 設定電腦與 CAN 介面

使用一台具備 6 個 CAN 介面與即時核心的電腦,並以 1000000 bit/s 啟用 CAN 介面。

  1. 任何桌上型電腦應該都可以,只要能裝上足夠的 CAN 介面:TriFinger 需要 6 個,每根手指 2 個。原專案使用 PEAK 的雙通道 PCI Express CAN 卡,型號 IPEH-003027,不是 FD 版本,因此需要 3 張卡。原專案使用 FD 卡時遇過問題。
  2. 需要具備即時能力的作業系統。原專案使用標準 Ubuntu 22.04,搭配即時能力較佳的核心,即 lowlatency 或 preempt_rt。
  3. 建立檔案 /etc/systemd/network/80-can.network,內容為 [Match] Name=can* 與 [CAN] BitRate=1000000。執行 sudo systemctl enable systemd-networkd,再執行 sudo systemctl restart systemd-networkd,不必重新開機即可啟用介面。之後它們應會以 can0 到 can5 出現在 ip link 中。
  4. 要找出哪個實體連接埠對應哪個介面:拔掉所有 CAN 連接器,執行 watch -n 1 netstat -i(用 sudo apt install net-tools 安裝),開啟機器人電源,將它的一個 CAN 連接器插入插座,記下 RX-OK 數值開始增加的連接埠。標示後拔除,對每個連接埠重複以上步驟。

7.2 安裝軟體

以 treep 與 colcon 建置 ROBOT_FINGERS 工作區,或使用預先建置的容器。

  1. 原專案提供兩種方式:已安裝好所有東西的 trifinger_robot 容器映像檔,或使用其 Apptainer 映像檔從原始碼建置。
  2. 從原始碼建置:pip install treep;git clone [email protected]:machines-in-motion/treep_machines_in_motion.git;接著 treep --clone ROBOT_FINGERS(若沒有 GitHub SSH 金鑰則用 --clone-https)。原專案說明,SSH 方式需要一把已註冊、不會跳出密碼提示的金鑰,並建議先執行 ssh-add。
  3. 在工作區目錄中執行 apptainer shell -e --no-home --bind=$(pwd) path/to/image.sif,然後執行 source /setup.bash,再執行 colcon build。
  4. 如果初始化輸出出現 Warning this thread is not going to be real time,表示你執行的是非即時建置。原專案說明,建置時會自動偵測 PREEMPT_RT 核心。
  5. 檢查建置結果:source ./install/setup.bash,接著執行 ros2 run robot_fingers demo_fake_finger,這不需要機器人。它會印出不斷增加的 Position 行;按 Ctrl+C 停止。

7.3 在硬體上測試一根手指

在一根手指上執行 single_finger_test,檢查其關節、編碼器與 CAN 連線。

  1. 用 ros2 run robot_fingers single_finger_test 啟動。初始化後,它會以位置控制讓所有關節保持在目前位置,並在終端機上顯示所有可用資料。按 q 結束。
  2. 在這個應用中,歸位不使用限位擋塊:各關節直接以最近的編碼器索引歸位,不加偏移量。
  3. 其設定檔為 robot_fingers/config/single_finger_test.yml。原專案說明它通常都能正常運作,但你可能需要調整 CAN 埠,使其與手指實際連接的埠相符。

7.4 設定歸零方式與原點偏移量

選擇一種歸零方式並找出原點偏移量,讓零點位置符合你的需求。

  1. 這些機器人使用相對式編碼器,因此若沒有歸位,零點就是開機時關節所在的位置。原專案的規則:zero_position = home_position + home_offset。
  2. 原專案支援的方法:none、current_position、next_index、endstop、endstop_release 與 endstop_index。使用編碼器索引的方法需要針對每台機器人個別校正歸位偏移量,並且每次因維護拆開關節或更換編碼器碼盤後都要重新校正。
  3. 找出歸位偏移量的方法:先將它設為零,啟動機器人並歸位,用手將機器人移到你想作為零點的位置並印出各關節位置,再將這些位置設為歸位偏移量。
  4. 原專案為(Tri-)Finger 機器人提供的預設設定位於 robot_fingers 的 config 資料夾中。本指南尚未閱讀這些設定,因此不說明 TriFinger 使用哪一種方法。

7.5 執行示範程式並試用模擬

執行 robot_fingers 中的示範程式,以及 PyBullet 模擬,其介面與實體機器人大致相同。

  1. 原專案的示範程式有 demo_fake_finger、demo_single_finger_torque_control、demo_single_finger_position_control 與 demo_trifinger,最後一個會讓 TriFinger 執行一段寫死的編排動作。demo_trifinger.py 位於套件的 demos 資料夾中。
  2. 在容器中,從工作區執行:singularity shell -e --no-home --bind=$(pwd) path/to/image.sif,然後 source /setup.bash,再 source ./install/local_setup.bash,接著執行例如 ros2 run robot_fingers demo_single_finger_torque_control。也可以直接呼叫 Python 腳本。
  3. TriFinger 的關節陣列順序為 finger0_joint0 到 finger240_joint2,每根手指皆由底座往指尖排列。當手指筆直朝下時,所有關節都在零點。
  4. trifinger_simulation 是這些機器人的 PyBullet 模擬,介面與實體機器人大致相同,部分差異記載於其自身的文件中。

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