TriFinger 組裝指南
開源的 9 自由度三指靈巧操作平台,用於強化學習與機器人研究
授權條款
BSD-3-Clause
組裝指南
1. 原專案公開了什麼
原專案只為致動器模組提供書面步驟。手指、框架、擋板與攝影機則只公開零件、圖面與照片,本指南在沒有提供步驟之處都會註明。
1.1 原專案記錄與未記錄的內容
致動器模組有八頁逐步說明;手指、機架、防護欄與攝影機只有零件清單、圖面與照片。
- TriFingerEdu 頁面表示,這個平台有 9 個扭矩控制的自由度,由 3 個相同的手指模組安裝在鋁製框架結構上組成。
- 手指頁面表示,每根手指由 3 個不同的致動器模組組成:Hip AA(148g)、Hip FE(160g)與 Upper Leg(155g),與 12dof 四足機器人腿部使用的致動器模組相同。組裝好的手指重 930g。
- 原專案針對致動器模組的逐步頁面,依其順序為:Motor Preparation、Motor Shaft Preparation、Encoder Preparation、Center Pulley Preparation、Output Pulley Preparation、Shell Preparation、Actuator Module Assembly 與 Actuator Module Testing。每個頁面主要是照片,每張照片下方附有說明文字。Testing 頁面只有標題。
- Actuator Module Assembly 頁面表示,該步驟需要先前準備好的 6 個子組件。請先為全部九個模組準備好零件,之後再組裝,如接下來兩節所述。
- 原專案沒有發布組裝手指底座框架、將三個模組組成一根手指、製作鋁框架,或將手指、隔板與攝影機固定到框架上的文字步驟。對這些部分,它提供的是零件、圖面與照片。本指南在每個相關步驟都會註明這一點,不會自行補充任何內容。
1.2 決定如何取得機加工件與列印件
每個模組都需要以金屬機加工的馬達軸、馬達皮帶輪與中間皮帶輪,以及列印的殼體、皮帶輪與滾輪。
- 每個致動器模組中有三個零件必須以金屬加工製作:10 齒的鋁製馬達皮帶輪(0.6g)、10 齒的鋁製中間皮帶輪(2,1g),以及以 4mm 不鏽鋼棒製作的馬達軸(3,2g)。原專案的圖面為 motor_pulley_at3_t10.PDF、center_pulley_at3_t10.PDF 與 motor_shaft.PDF,每份都有英制版本。
- 原專案的提醒:不要使用標準 AT3 同步皮帶輪的尺寸或刀具。它修改了原本的 AT3 齒形以減少背隙。
- 除了自行加工,你也可以訂購 ODRI Encoder Kit,原專案的 Actuator Module Core v1.1 頁面對此有說明。套件包含已完全準備好的馬達軸組件、中間皮帶輪(鋁 7075)以及 Broadcom AEDT-9810-Z00 編碼器讀頭。原專案表示,這樣其 Motor Shaft Preparation 頁面上的所有步驟就都已完成,且套件的馬達軸組件與自製的組件相容並可互換。
- 在列印方面,原專案以 FDM 或 SLS 印表機列印外殼等大型結構零件,以 Multijet 或 SLA 印表機列印同步皮帶輪等需要高精度的小零件。每個零件都依其 STL 檔的正 z 方向列印。
- 列印公差因供應商、技術與材料而異。關鍵表面是軸承座。原專案表示,最好使用自己的印表機列印,以便進行試印;軸承座若過大將無法固定軸承,零件可能無法使用。
2. 準備九個致動器模組的零件
原專案的六個準備頁面,依其順序。一根手指有一個 Hip AA、一個 Hip FE 與一個 Upper Leg 模組,因此整個平台每種各需三個;在組裝任何模組之前,先準備好全部九個模組的零件。
2.1 準備轉子
將 T-Motor Antigravity 4004 300kV 的轉子與定子分開,拉出原廠軸,並為客製的 4mm 軸鉸削內孔。
- 用小尖嘴鉗取下馬達軸上的扣環。之後不再需要它。
- 輕輕拉開以克服磁力,將轉子與定子分開。保留黃銅墊圈。將轉子放在乾淨的表面上,因為金屬碎屑會吸附在磁鐵上,之後可能造成問題。
- 用 1,5mm 六角起子取下轉子上的兩顆 M3 止付螺絲,保留供重新組裝使用。
- 將轉子放在 3D 列印的馬達軸拆卸工具(tool_motor_shaft_extraction.STL)上,用鐵鎚與沖棒將軸敲出。
- 用 3.98mm、3.99mm 與 4.00mm 的鉸刀擴孔。從最小的開始,在鉸刀上塗一點油,小心插入,裝在刀把上用手轉幾圈。
- 在客製馬達軸上塗一點油,試著插入。如果孔太緊,用同一支鉸刀再做一次,再換下一個較大的尺寸,直到軸能以適度的力量裝入與取出為止。
- 原專案特別強調:孔徑不要擴得太大。配合太鬆時,轉子旋轉會晃動。
- 用 1,5mm 六角起子將兩顆 M3 止付螺絲鎖入一半。轉子現在可以進行組裝了。
2.2 準備定子與相線
移除定子相線的絕緣層,焊上 0,5 mm² LiY 延長線,確定線長後再焊上 2mm 鍍金接頭。
- 剪開並移除底部的大熱縮套管。以斜角剪掉一段相線上的熱縮套管,用鉗子夾住相線,一邊捏住熱縮套管一邊慢慢拉電線,讓電線把套管割開。持續進行直到移除一半的絕緣層,然後把其餘部分拉掉。
- Hip AA 模組:不要剪短馬達相線。跳過剪短的步驟,直接處理熱縮套管。Hip FE 與 Upper Leg 模組:將馬達相線剪短到從定子底部量起約 3cm,使焊點保持在外殼內。
- 用約 400 度 C 的溫控烙鐵燒掉線端的橘色絕緣層。在烙鐵頭上加焊錫,等到約 5mm 的銀色導線露出。用熱風槍套上細熱縮套管。
- 將焊接溫度降到約 300 度 C。準備比所需長幾 cm 的延長線(原專案使用截面積 0,5mm² 的 LiY 線),焊到相線上,並用短熱縮套管包覆每個接點。
- 如果你不確定電線長度,請在此停下,先完成其他所有準備步驟並組裝模組,之後再決定長度並焊接接頭。
- 安裝接頭:將電線剪到適當長度,剝除少許絕緣層,絞緊線芯並上錫。將 2mm 鍍金公接頭(原專案使用 REELY)焊到相線上。裝上配對的接頭,將熱縮套管對準接點,用熱風槍加熱收縮。
2.3 將皮帶輪黏到馬達軸上
在列印的黏合治具上,以 Loctite 648 將 10 齒鋁製馬達皮帶輪黏到 4mm 不鏽鋼馬達軸上。
- 使用 3D 列印工具 tool_motor_shaft_pulley_bonding.STL。這個工具必須將皮帶輪支撐在正確位置。用數位卡尺的深度桿測量工具的深度:應約為 6,6mm。工具與馬達軸末端之間的距離應約為 26,8mm。
- 用棉花棒沾酒精清潔黏接表面。請戴手套。
- 在黏接表面塗上一層薄薄的 Loctite 648。將馬達軸插入皮帶輪並稍微轉動。用棉花棒清除底部多餘的 Loctite。
- 將軸與皮帶輪放在黏接工具上,馬達軸上的平面朝上。清除頂部多餘的 Loctite。確認軸保持垂直並完全插入工具。
- 讓零件在室溫下固化幾個小時。然後留在工具上,放入烤箱再固化幾個小時。原專案以 70 度 C 固化約 3 小時。
2.4 將碼盤黏到其安裝座上
以 Loctite 406 將碼盤黏到馬達軸上的列印碼盤座,印刷面朝上、從上方可讀。
- 碼盤有兩種來源。A:向 PWB 訂購,搭配安裝座 encoder_codewheel_pwb_mount.STL。B:來自編碼器套件,搭配安裝座 encoder_codewheel_kit_mount.STL。請使用與你的碼盤相符的安裝座。其他所有步驟都相同。
- 塗膠之前,先將碼盤放到安裝座上確認是否合適。碼盤必須完全就位、平整,轉動時不晃動。如果 3D 列印的殘料使它無法放平,用一字起子把零件角落的殘料刮掉。
- 原專案在馬達軸裝在定子中的狀態下黏接碼盤:將軸以平面朝下插入定子軸承。用 4mm 鉸刀調整安裝座的內徑。將安裝座套到軸上,對齊皮帶輪與安裝座的齒,然後推到底。
- 檢查馬達軸末端與安裝座之間的距離。應約為 2mm;誤差 0,1 或 0,2mm 都沒關係。
- 原專案特別強調:碼盤必須以正確方向安裝。碼盤上的印字必須能從上方正向閱讀。
- 戴上手套。在安裝座上塗一層薄薄的瞬間膠(原專案使用 Loctite 406)。將碼盤印字朝上放好,用工具 tool_code_wheel_bonding.STL 推到底,按住 30 秒,輕輕移開工具,等待幾分鐘讓膠固化。
- 轉動馬達軸,確認碼盤保持水平且不晃動。將馬達軸組件從定子中取出。它現在可以進行安裝了。
2.5 準備編碼器
將 Broadcom AEDT-9810-Z00 的兩個安裝孔擴大以裝 M3 平頭螺絲,彎折其針腳,並焊上五條 0,14mm² 延長線。
- 用 3mm 鑽頭擴大兩個安裝孔(原始直徑為 2,8mm)。用 45 度倒角刀倒角,使 M3 平頭螺絲與編碼器表面齊平。
- 用平口鉗截短接腳,並將它們向下彎 45 度。
- 準備 5 條 0,14mm² 的延長線(原專案使用紅、黃、黑、白、綠色)。剝線、絞線、上錫並剪短線端,在編碼器針腳上加一點焊錫,依照原專案頁面上的配線圖將電線焊到針腳上。以短熱縮套管包覆每個接點,並每隔幾公分用一段較粗的熱縮套管將電線束在一起。
- 如果你不確定電線長度,請在此停下,等模組組裝後再壓接 Hirose 接頭。
- 壓接方式:使用 Hirose DF13 壓接工具與壓接端子。將電線剪到適當長度,剝除約 1mm 的絕緣層。將每條電線盡量筆直地插入,直到線芯碰到止擋,將把手完全壓合後放開。第一道壓接應夾住絕緣層,第二道應夾住線芯。
- 依照原專案配線圖所示的順序,將壓接好的電線插入 Hirose 5 pin 接頭。使用鑷子會比較容易。
2.6 準備中間皮帶輪與皮帶張緊器
將 10 齒鋁製皮帶輪壓入列印的 30 齒中間皮帶輪,並以 683 軸承、M3x10 平頭螺絲與修改過的 M2,5 墊圈製作兩個皮帶張緊滾輪。
- 在列印皮帶輪的內齒形上塗一點 Loctite 648。將鋁製皮帶輪放上去,保持垂直並對準齒形,定心孔朝上,用手稍微推入。
- 將 3D 列印的保護工具(tool_center_pulley_protection.STL)放到鋁製皮帶輪上。將組件翻面,把組裝工具(tool_center_pulley_assembly.STL)對準底部中心。用手壓機將鋁製皮帶輪慢慢壓到底;也可以用虎鉗。
- 移除工具,並用棉花棒清除多餘的 Loctite。零件底面應該齊平;如果不平,再用壓機壓一次。
- 每個模組需要兩個同步皮帶張緊輪。將軸承壓入每個 3D 列印的滾輪(預設直徑為 10mm;較大的滾輪可調整皮帶張力),並確認軸承完全壓入。
- M3 墊圈太大,會使軸承外環無法自由轉動。請改用 M2,5 墊圈(內徑 2,7mm,外徑 5,8mm),並用圓銼將內徑擴大到約 3mm。
- 將 M3x10 平頭螺絲從有凸緣的一側插入,將組件翻面,裝上修改過的 M2,5 墊圈。
2.7 準備輸出皮帶輪
車削列印輸出皮帶輪的兩根軸,使其能裝入 32mm x 25mm x 4mm 軸承,再裝上兩個 Helicoil M3 x 6 螺紋護套,Hip AA 模組除外。
- 列印尺寸會有差異,因此原專案會將與軸承配合的軸徑列印得稍大,再用車床車到正確尺寸。輕輕夾住一側的輸出軸(使用 25mm 筒夾會有幫助),使用鋒利的車刀,分小段逐步減小直徑,並用輸出軸承檢查配合。
- 應為輕度壓入配合:你應該能以適度的力量用手裝上與取下軸承。然後將皮帶輪轉過來,在另一側重複同樣步驟。
- Hip AA 例外:扣件會穿過 Hip AA 的輸出皮帶輪,因此不要安裝 Helicoil。將安裝孔稍微倒角,並用 3mm 鑽頭擴大到 3mm。原專案表示,Hip AA 皮帶輪做到這裡即可。
- 其他所有模組:每個步驟都讓凸緣朝上。為兩個安裝孔倒角。孔徑應約為 2,9mm;先用 3mm 鑽頭鑽穿,再以每次 0,1mm 的級距擴大到 3.3mm。
- 用 Helicoil M3 螺絲攻為兩個孔攻牙。如果阻力變大,小心將螺絲攻退出,用牙刷清潔後再繼續,直到螺紋完全攻好。
- 用安裝工具裝入兩個長 6mm 的 M3 Helicoil,使每個螺紋襯套的末端約位於外表面以下半圈。用折斷工具折斷兩個安裝柄,並確認零件內沒有殘留安裝柄。
2.8 準備殼體並裝上軸承
檢查列印的殼體底座與上蓋,為 M3 螺紋攻牙,在每一半各裝四個 M2,5 x 3,75mm Helicoil,裝上兩顆 32mm x 25mm x 4mm 與三顆 8mm x 4mm x 2mm 軸承,並以八顆螺絲試裝。
- 將外殼蓋與外殼底座放在平面上檢查平整度。如果零件翹曲,可能無法使用。
- 共有兩個 3mm 與八個 2,5mm 的貫穿孔。用卡尺檢查,或試著穿過一顆 M3 與一顆 M2,5 螺絲。如果螺絲不易穿過,用鑽頭擴孔。
- 用螺絲攻攻 M3 螺紋,盡量保持垂直,並完全攻穿外殼:兩個用於固定編碼器,兩個用於同步皮帶張緊輪。
- 用 M2,5 Helicoil 螺絲攻為外殼底座的 4 個孔與外殼蓋的 4 個孔攻牙,然後在兩半各裝入四個 M2,5 x 3,75mm Helicoil,並移除安裝柄。攻到孔底、阻力變大時就停止,因為 3D 列印零件上的螺紋很容易崩牙。
- 軸承座應為輕度壓入配合。如果太緊,用具有銳利 90 度刃口的端銑刀調整(原專案展示的是 8mm 與 32mm),並用銼刀將刀刃底部磨鈍,使其只在側面切削。原專案不建議使用鉸刀,因為鉸刀通常有倒角,無法加工出銳利的直角。
- 用手指安裝軸承,保持每個軸承水平:依原專案圖片所示,在外殼底座與外殼蓋上安裝兩個 32mm x 25mm x 4mm 的輸出軸承,以及三個 8mm x 4mm x 2mm 的傳動軸承。張緊輪軸承不裝在外殼內,而是裝在滾輪上。
- 用八顆不鏽鋼內六角螺絲與 2mm 六角起子試裝外殼:五顆 M2,5x6 與三顆 M2,5x10。在外殼蓋上裝四顆 M2,5x6,再在底座上裝三顆 M2,5x10 與一顆 M2,5x6。準備好的外殼組件重 61g。
3. 組裝並測試每個致動器模組
取自原專案的 Actuator Module Assembly 頁面。九個模組都要重複進行。完成的模組連同 30cm 電線重 160g。
3.1 安裝定子
以四顆 M3x5 平頭螺絲將定子固定到殼體底座上。
- 將馬達相線從外殼的開口穿過,並將定子放到安裝面上。
- 將相線向上彎,對準缺口。
- 用 2mm 六角起子裝上四顆 M3x5 平頭螺絲。確認定子完全就位且不會移動。
- 將相線穿過編碼器座後方的開口,再從安裝介面穿出。
3.2 安裝馬達軸與轉子
將馬達軸組件裝入定子軸承,再以兩顆 M3 止付螺絲裝上轉子。
- 請小心拿取碼盤。在以下步驟中避免彎折或刮傷它。
- 將馬達軸組件插入定子軸承。確認已裝上黃銅墊片。
- 將組件轉過來,用 1,5mm 六角起子將兩顆 M3 止付螺絲鎖入一半。
- 將轉子上的止付螺絲對準馬達軸上的平面,裝上轉子並推到底。
- 一邊向下壓住轉子,一邊用 1,5mm 六角起子鎖緊兩顆止付螺絲。用手轉動轉子,確認轉動順暢,然後沿軸向拉動:應該沒有間隙,或只有極小的間隙。
3.3 安裝時規皮帶傳動機構
將 150mm 的第一段皮帶套在馬達皮帶輪與中間皮帶輪上,201mm 的第二段皮帶套在中間皮帶輪與輸出皮帶輪上。
- 將 150mm 同步皮帶套到中間皮帶輪上並使齒嚙合。再套到馬達皮帶輪上並使齒嚙合。
- 保持皮帶張緊,將中間皮帶輪插入其軸承。
- 將 201mm 同步皮帶套到輸出皮帶輪上並使齒嚙合,凸緣側朝上。
- 將這條皮帶套到中間皮帶輪上並使齒嚙合。保持張緊,將輸出皮帶輪插入其軸承。
- 來回轉動輸出軸,確認傳動機構如預期般運作。
3.4 安裝編碼器
將準備好的編碼器放在碼盤上方,並以兩顆 M3x16 平頭螺絲固定。
- 將編碼器電線從介面上的開口穿過。
- 將編碼器以斜角小心插入,使碼盤落在間隙中。原專案會把編碼器的針腳剪短並折彎,讓這一步更容易。
- 將編碼器放到安裝面上,裝上兩顆 M3x16 螺絲。
- 確認碼盤位置正確,且不會碰到編碼器。致動器模組的底座到此完成。
3.5 將皮帶張緊滾輪裝到殼體上蓋
以兩個準備好的張緊滾輪所附的 M3x10 螺絲與墊圈,將它們鎖到殼體上蓋上。
- 需要外殼上蓋與同步皮帶張緊滾輪。確認墊圈已裝好。
- 用 2mm 六角起子安裝滾輪。逐一轉動每個滾輪,確認轉動順暢。
3.6 合上殼體
將殼體上蓋合到底座上,並以八顆 M2,5 內六角承窩頭螺絲鎖緊。
- 將外殼上蓋放到外殼底座上。把上蓋稍微傾斜,並將輸出皮帶輪部分裝入。在這一步接下來的過程中,持續對組件中心施加適度壓力。
- 用小一字起子把第二級皮帶向內推,使其越過張緊滾輪:先推一側,將組件翻面後再推另一側。皮帶越過滾輪時,上蓋應會稍微下沉。
- 接著中央皮帶輪必須對準上蓋中的軸承。握住轉子來回轉動幾次,同時輕壓上蓋。每個方向轉幾圈後,上蓋應該就能闔上。
- 若外殼無法闔上,可用尖頭工具穿過中央皮帶輪上的孔,將中央皮帶輪導入軸承,同時轉動轉子。
- 確認外殼已完全闔上,且馬達可以轉動。
- 用 2mm 六角起子裝上八顆連接螺絲,並以適中扭矩鎖緊。原專案的外殼準備頁面列出五顆 M2,5x6 與三顆 M2,5x10 內六角圓柱頭螺絲;其組裝頁面則列為三顆 M2,5x8,而非 M2,5x10。
3.7 裝上馬達相線與編碼器接頭
如果尚未完成,將 2mm 鍍金接頭焊到相線上,並將 Hirose DF13 接頭壓接到編碼器線上。
- 原專案的最後一個組裝步驟是加上馬達相線與編碼器連接器。請依照馬達準備頁面中的 Soldering the Motor Phase Connectors 一節,以及編碼器準備頁面中的 Crimping Hirose Connector 一節進行。
- 原專案測量致動器模組的線長時,是從導線離開外殼的表面量到連接器介面。
- 配線頁面列出模組的電氣介面為一條 5 極編碼器線與 3 條馬達相線:編碼器使用 0,14 mm² 導線與 5 極 Hirose DF13 連接器,相線使用 0,50 mm² 導線與 2mm Reely 鍍金連接器。色碼與針腳定義在該頁面上以圖片呈現。
3.8 測試模組
原專案表示,組裝後的下一步是測試模組並找出馬達相線的正確順序,但沒有公開相關程序。
- 組裝頁面的結尾是:下一步是測試模組,並確定馬達相線的正確順序。
- 原專案的 Actuator Module Testing 頁面只有標題、沒有內文,因此本指南不提供測試程序。
4. 組裝三根手指
取自原專案的 FingerEdu 頁面。它提供零件與照片,沒有書面組裝步驟。
4.1 列印手指底座框架、手指連桿與轉接件
列印手指底座框架板、TI 疊板間隔柱與支架、手指轉接件與手指連桿,每個零件都依其 STL 檔案的 z 軸正方向列印。
- 原專案提供的手指結構 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。
- 以 FDM 印表機列印手指連桿,設定為 sparse double dense。連桿加上指尖重 22g。
- 三種致動器模組(Hip AA、Hip FE 與 Upper Leg,各有一個底座與一個上蓋)的外殼取自原專案的 Leg 3dof STL 檔案。原專案另外列出一款可簡化走線的 Hip FE 替代底座外殼。
- 原專案沒有提供用板件組裝底座框架的文字步驟,只有一張組裝完成框架的照片。
4.2 將三個致動器模組組成一根手指
將一個 Hip AA、一個 Hip FE 與一個 Upper Leg 致動器模組,與手指底座框架及手指轉接件組合在一起。
- 製作三根手指,每根由一個 Hip AA、一個 Hip FE 與一個 Upper Leg 致動器模組組成。
- 原專案沒有提供扣件清單,也沒有說明模組的連接順序或如何固定到手指底座框架上。它只提供照片,說明文字為:每根手指由 3 種不同的致動器模組組成,手指可以完全收進底座結構以便運送。
- 手指頁面指向 Leg 3dof 頁面以取得更詳細的資訊。該頁面列出三模組腿部的扣件,例如連接 Hip AA 與 Hip FE 時,視有無轉接件而使用 M3x35 或 M3x22 內六角圓柱頭螺絲。該頁面並未說明這些就是手指所用的扣件,使用前請對照手指的照片確認。
4.3 裝上指尖
將橡膠指尖套到列印的手指連桿上。
- 橡膠指尖重 2g。它是處理紙張用的一般文具:請找 Rubber Thimblette,size 2,large。
- 原專案以照片呈現已列印的連桿及其指尖,沒有再提供將連桿裝到 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 針腳上。
- 移除跳線 JP1、JP2、JP4 與 JP5。裝上跳線 JP6,並確認 JP7 與 JP3 也已連接。
- 原專案提醒:將 Launchpad 接上 USB 與外部電源供應器時,務必確認 JP1 與 JP2 已移除。這樣可讓電腦與經由 booster pack 供應的外部電源隔離。
- 準備編碼器導線與一個 5 極 Hirose 連接器。依照針腳定義圖將導線焊到連接器上,在紅線與黃線套上細熱縮套管,再於所有導線外套上較粗的熱縮套管。用同樣方法製作第二條線。
- 在 Launchpad 上找到標示為 QEP_A 與 QEP_B 的編碼器針腳。用平口鉗將針腳向下折 90 度,焊上編碼器導線並套上熱縮套管。
- 原專案針腳頁面的注意事項:將 GPIO 26 接地會停用馬達驅動器;不要將 5V 電源接到類比輸入通道,其最大電壓為 3,3V。
5.2 準備 Booster Pack 與線材
如有需要,可修改兩塊 DRV8305 Booster Pack 的螺絲端子,並製作附 2mm 接頭的電源線(1mm²)與六條馬達相線(0,5mm²)。
- 改裝螺絲端子為選用步驟;你也可以用其他方式走線。兩片 booster pack 都必須連接到電源供應器。下層 booster pack 只需改裝 3 針相線端子,2 針電源端子可維持原樣。
- 原專案的改裝方法:鬆開螺絲,將全部 5 個金屬夾片向外扳開,取下螺絲與夾片,將塑膠蓋向內推以取下,在標記處依序用 2mm、2,5mm、3mm 鑽頭鑽孔,再裝回。2 針的蓋子照原樣裝回;3 針的蓋子旋轉 180 度後反向安裝。
- 電源線:1mm² 導線。剝線、絞線並在線端上錫,將兩條線都剪短至約 7cm,剝除 5mm 絕緣層,再裝上接電源供應器用的 4mm 連接器。可以把 booster pack 放到 Launchpad 上來決定線長。
- 馬達相線:準備六條 0,5mm² 導線並配 2mm 連接器,焊上連接器、套上熱縮套管並標示馬達相位。
- 安裝電源線與馬達相線。
5.3 堆疊電路板、設定 DIP 開關並燒錄
將兩塊 Booster Pack 裝在 Launchpad 底部,然後將 DIP 開關分別設定為燒錄與執行。
- 將兩片 booster pack 裝到 Launchpad 的底面,確認排針對齊。
- 要讓馬達驅動板從快閃記憶體執行,將 DIP 開關設為 ON - ON - OFF。要經由 USB 燒錄程式,則設為 ON - ON - ON。
- 在開關設為 ON - ON - ON 時經由 USB 燒錄 Launchpad,之後設為 ON - ON - OFF,以經由 CAN 控制馬達。本頁沒有指明要燒錄哪個韌體。
5.4 將電路板分配到關節與 CAN 連接埠
依原專案的順序,將每根手指的兩塊馬達板 A 與 B 接到兩個 CAN 連接埠。
- 每根手指由 A、B 兩片馬達板控制。A 板控制中關節與下關節;B 板控制上關節。
- 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。
- CAN 部分,原專案在雙通道 PCI Express CAN 卡上使用附 9 針 D-sub 連接器的 2 極導線。Finger Edu 馬達驅動卡的配置以圖片呈現在 FingerEdu 頁面上,電源連接器的極性規範則以圖片呈現在配線頁面上;通電前請兩者都確認。
6. 框架、擋板與攝影機
取自原專案的 TriFingerEdu 頁面及其兩張圖面。原專案提供零件、圖面與組裝照片,但沒有書面組裝順序。
6.1 裁切鋁擠型
裁切九根 Item 鋁擠型(size 8、40mm x 40mm),分三種長度,並備齊角架、端蓋、T 型槽螺帽與列印的中央連接件。
- 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。
- 在 Top 與 Camera Attachment 段上,圖面的端視圖標示一個直徑 6,80、深 26,25 的孔,攻 M8x1.25 - 6H 螺紋,深度 20。Side 段沒有這項註記。圖面日期為 25.5.2020。
- 其他框架零件: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 型槽螺帽與列印的中央連接件接合鋁擠型。
- 原專案發布了兩張組裝照片,說明文字分別為 Frame assembly - 6mm hex driver 與 Frame assembly - 6mm allen key,另有一張以 T 型槽鋁擠型組成的完成框架照片。
- 它沒有提供文字順序,也沒有說明角座與螺帽裝在哪裡。請參考它的照片,以及它發布、可在網頁瀏覽器中檢視的 TriFingerEdu v1 CAD 模型;本指南尚未開啟該模型。
6.3 裁切聚碳酸酯防護欄
裁切三片 3mm 聚碳酸酯板,尺寸 553mm x 250mm,每片有六個 5mm 孔。
- 原專案的護欄由 3 片 3mm 聚碳酸酯板組成,用來讓物件保持在操作區域內。
- 圖面顯示每片板為 553mm x 250mm,有六個直徑 5 的孔,分成兩欄、每欄三個。兩欄相距 513mm,因此各距短邊 20mm。每欄的三個孔間距 100mm,外側兩孔距長邊 25mm。
- 原專案沒有提供將板片固定到框架的文字步驟,只有護欄的照片。
6.4 列印攝影機座並選擇攝影機
列印三個攝影機座(camera_mount.STL),並取得三台搭配 C125-0418-5M 鏡頭的 Basler acA720-520uc 攝影機。
- 相機:Basler acA720-520uc。鏡頭:Basler C125-0418-5M。相機座:3D 列印,STL 檔案 camera_mount.STL,需要三個。
- 在原專案的軟體文件中,相機名稱為 camera60、camera180 與 camera300。在 TriFingerEdu 上,相機座一律位於兩根手指之間的正中央,所以這些名稱是準確的。
- 原專案沒有提供將相機座與相機裝到框架上的文字步驟或扣件清單。
6.5 將手指、防護欄與攝影機固定到機架上
原專案提供了手指的名稱與位置,但沒有固定程序或扣件清單。
- 原專案依三根手指繞機器人中心的角度位置來命名,以第一根手指為零度:finger0、finger120 與 finger240。
- 它沒有提供螺絲清單、孔位或安裝的文字順序。只能參考它的照片、簡化版手指的尺寸圖(兩段各 160mm)以及它的 CAD 模型。
- TriFingerEdu 頁面也提到,這個機器手臂平台可以倒置使用。
7. 電腦與軟體
取自原專案的 TriFinger 文件與 robot_fingers 套件文件。原專案的 TriFinger 文件表示內容仍在撰寫中。
7.1 設定電腦與 CAN 介面
使用一台具備 6 個 CAN 介面與即時核心的電腦,並以 1000000 bit/s 啟用 CAN 介面。
- 任何桌上型電腦應該都可以,只要能裝上足夠的 CAN 介面:TriFinger 需要 6 個,每根手指 2 個。原專案使用 PEAK 的雙通道 PCI Express CAN 卡,型號 IPEH-003027,不是 FD 版本,因此需要 3 張卡。原專案使用 FD 卡時遇過問題。
- 需要具備即時能力的作業系統。原專案使用標準 Ubuntu 22.04,搭配即時能力較佳的核心,即 lowlatency 或 preempt_rt。
- 建立檔案 /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 中。
- 要找出哪個實體連接埠對應哪個介面:拔掉所有 CAN 連接器,執行 watch -n 1 netstat -i(用 sudo apt install net-tools 安裝),開啟機器人電源,將它的一個 CAN 連接器插入插座,記下 RX-OK 數值開始增加的連接埠。標示後拔除,對每個連接埠重複以上步驟。
7.2 安裝軟體
以 treep 與 colcon 建置 ROBOT_FINGERS 工作區,或使用預先建置的容器。
- 原專案提供兩種方式:已安裝好所有東西的 trifinger_robot 容器映像檔,或使用其 Apptainer 映像檔從原始碼建置。
- 從原始碼建置: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。
- 在工作區目錄中執行 apptainer shell -e --no-home --bind=$(pwd) path/to/image.sif,然後執行 source /setup.bash,再執行 colcon build。
- 如果初始化輸出出現 Warning this thread is not going to be real time,表示你執行的是非即時建置。原專案說明,建置時會自動偵測 PREEMPT_RT 核心。
- 檢查建置結果:source ./install/setup.bash,接著執行 ros2 run robot_fingers demo_fake_finger,這不需要機器人。它會印出不斷增加的 Position 行;按 Ctrl+C 停止。
7.3 在硬體上測試一根手指
在一根手指上執行 single_finger_test,檢查其關節、編碼器與 CAN 連線。
- 用 ros2 run robot_fingers single_finger_test 啟動。初始化後,它會以位置控制讓所有關節保持在目前位置,並在終端機上顯示所有可用資料。按 q 結束。
- 在這個應用中,歸位不使用限位擋塊:各關節直接以最近的編碼器索引歸位,不加偏移量。
- 其設定檔為 robot_fingers/config/single_finger_test.yml。原專案說明它通常都能正常運作,但你可能需要調整 CAN 埠,使其與手指實際連接的埠相符。
7.4 設定歸零方式與原點偏移量
選擇一種歸零方式並找出原點偏移量,讓零點位置符合你的需求。
- 這些機器人使用相對式編碼器,因此若沒有歸位,零點就是開機時關節所在的位置。原專案的規則:zero_position = home_position + home_offset。
- 原專案支援的方法:none、current_position、next_index、endstop、endstop_release 與 endstop_index。使用編碼器索引的方法需要針對每台機器人個別校正歸位偏移量,並且每次因維護拆開關節或更換編碼器碼盤後都要重新校正。
- 找出歸位偏移量的方法:先將它設為零,啟動機器人並歸位,用手將機器人移到你想作為零點的位置並印出各關節位置,再將這些位置設為歸位偏移量。
- 原專案為(Tri-)Finger 機器人提供的預設設定位於 robot_fingers 的 config 資料夾中。本指南尚未閱讀這些設定,因此不說明 TriFinger 使用哪一種方法。
7.5 執行示範程式並試用模擬
執行 robot_fingers 中的示範程式,以及 PyBullet 模擬,其介面與實體機器人大致相同。
- 原專案的示範程式有 demo_fake_finger、demo_single_finger_torque_control、demo_single_finger_position_control 與 demo_trifinger,最後一個會讓 TriFinger 執行一段寫死的編排動作。demo_trifinger.py 位於套件的 demos 資料夾中。
- 在容器中,從工作區執行: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 腳本。
- TriFinger 的關節陣列順序為 finger0_joint0 到 finger240_joint2,每根手指皆由底座往指尖排列。當手指筆直朝下時,所有關節都在零點。
- trifinger_simulation 是這些機器人的 PyBullet 模擬,介面與實體機器人大致相同,部分差異記載於其自身的文件中。