AR4 組裝指南
開源 6 軸工業機器手臂,提供完整 CAD 檔案與自製控制系統
授權條款
Annin Robotics Open Source Non-Commercial License v1.1
Annin Robotics 自訂的授權(v1.1,2025 年)僅允許非商業用途。軟體可為非商業目的使用、複製與再散布。硬體、設計檔案、CAD 模型與列印檔案僅供教育、研究與個人非商業用途:不得以任何形式再散布、重新發布或託管,而販售機器人、零件、套件、衍生品或修改版本則需要 Annin 的書面許可。社群的 ROS 驅動程式(ar4_ros_driver)是另一個採用 MIT 授權的獨立專案。查核日期:2026 年 11 月 2 日。
組裝指南
1. 開始之前
Annin 為每一代 AR4 各發布一份冗長的圖解 PDF 組裝手冊。本頁依據目前的版本 AR4-MK5 手冊,並以我們自己的文字改寫其步驟。Annin 的圖片、圖面與配線圖不在此重製:請將手冊開在本頁旁邊對照。
1.1 選擇與你的世代相符的手冊
使用 AR4-MK5 手冊搭配 MK5 列印檔案壓縮包;較早的世代各有自己的手冊,零件與感測器也不同。
- 目前的手冊為 AR4-MK5-Robot-Manul-1.1.pdf(原專案檔名即如此拼寫),共 390 頁,歸檔於 Annin 下載彙整中的 2026 年 7 月。其封面寫版本 1.0,但版本紀錄列出日期為 6/8/26 的 1.1,該版更新了 J3 感測器座與皮帶張力,並補上第 187 頁缺漏的文字。
- 章節:1 物料清單、2 機器人組裝、3 PLC Modbus 選配、4 氣動夾爪、5 伺服夾爪、6 附加軸、7 規格與圖表、8 啟動、9 程式設計。本頁涵蓋第 1、2 與 8 章,其他章節僅提供指引。
- 同一彙整中較早的手冊:AR4-MK4-Robot-Manul-1.1.pdf(2026 年 2 月)、AR4-MK3-Robot-Manul.pdf(2025 年 12 月)、AR4-MK2-Robot-Manul-1.3.pdf、AR4-Robot-Manul-V1.6-.pdf 與 AR4-Robot-Manul-V1.5-.pdf。請勿將某一代的列印檔包與另一代的手冊混用。
- 第 7 章的規格:臂展 26.5 英吋(675 mm)、負載 4.15 lb(1.9 kg)、重複精度 0.25 mm、鋁製機器人重量 27 lb(12.25 kg)、最大耗電 8.25 A(198 W)。
- 手冊中的觸電警告:控制箱會使你暴露於可能造成傷害或死亡的交流電與直流電,應由受過訓練或合格的人員組裝與維修。僅在正確接地時操作。
1.2 閱讀一般注意事項、工具與焊接指引
總覽章節訂定了螺絲固定劑、皮帶、軸承、焊接與纜線準備的規則,適用於之後的每個步驟。
- 只使用低強度螺絲固定劑,且只用於 4 mm 以上的螺絲;3 mm 及以下的螺絲請勿使用。每條皮帶都適度張緊,不要過緊,也不要讓皮帶或零件受力。
- 列出的工具與材料:公制六角扳手、大力鉗、斜口鉗與剝線鉗、烙鐵與含助焊劑芯的含銀焊錫、1.5 mm 或 2 mm 熱縮套管(伺服夾爪用 6 mm)、熱風槍或打火機、數位游標卡尺、磁極測試器、用於清理列印孔的鑽頭、M3 與 M4 螺絲攻、數位水平儀、J5 用的角度規、白色鋰基脂或通用潤滑脂、軸承固定劑、液態絕緣膠帶、黑色布質線束膠帶與束線帶。
- 軸承配合:CAD 的尺寸設計使所有軸承與座圈都是輕微壓入配合。用軸承壓床、手扳壓床或虎鉗將軸承與座圈端正地壓入。手冊寫道「NEVER USE A HAMMER」(絕對不要用鐵鎚)。用熱風槍或杯墊加熱器加熱鋁製外殼會有幫助;座圈鬆動時使用固定劑。在所有軸承上塗少量潤滑脂。
- 剪斷編織套管後,用火焰熔化剪口,否則套管會散開。
- 大多數馬達線束的接點是焊接而非插接,因為手冊作者發現低成本連接器在緊湊的手臂中並不可靠。先套上熱縮套管,兩條導線末端都先上錫,重疊焊接,再用火焰輕輕掃過讓套管收縮。火焰要遠離可燃物、塑膠零件與套管。
- 線材準備:手冊提供一個可列印的剝線器,用於耐連續彎曲的 Cat5 線。要去除遮蔽層,將其往一個夾點聚攏,再用尖頭剪鉗小心剪開。手冊警告剪刀刃只能伸到遮蔽層下方,因為很容易剪斷導線。
1.3 列印外蓋、間隔件,以及(如有需要)結構件
外蓋與間隔件盡可能以 PETG 列印;結構件可以列印,也可以購買鋁製套件。
- Annin 建議盡可能使用 PETG。PLA 非常脆,對少數需要攻牙孔的零件而言很難鑽孔與攻牙。列印檔來自 Annin 的下載頁面;本頁不託管也不複製這些檔案。
- 物料清單中各零件的設定:多數外蓋與間隔件標示為 15% 填充、2 層牆。J1 底座外殼前板、J2 馬達間隔件第 1 與第 2 件,以及 J4 時規輪轂標示為 50% 填充、4 層牆。概覽另外寫外蓋與間隔件以 20% 填充、0.2 mm 層高、5 層外殼列印,兩處說法不一致。
- 底座外殼在大型零件資料夾中也有單件版本,J2 側蓋與間隔件則有為較小印表機分割的版本。
- 全列印機器人:概覽寫結構零件以 50% 以上填充列印,J2 與 J3 驅動主軸及張力環為 90% 以上,外殼厚 5 層。層高寫為「2mm」,很可能是 0.2 mm 的筆誤。所有螺紋孔先用適當的鑽頭清理,再攻牙。J1 底板、底板間隔件與 J2 手臂對多數列印平台而言太大,分成兩件列印後以環氧樹脂黏合。J1 主軸分成兩件列印,中央以環氧樹脂黏合的對位塞接合。
- J4 管無法列印。若是列印版機器人,請依手冊圖面,將外徑 1 英吋、壁厚 0.035 英吋的鋁管切成 116.3 mm 長並鑽孔。
- 主要結構零件需要兩捲線材;若想讓外蓋用另一種顏色,需要第三捲。
1.4 依物料清單訂購零件
第 1 章將零件分為結構套件、五金套件、電氣套件、馬達與驅動器組,以及列印件。
- 結構元件:27 個零件,列印或來自鋁製套件。五金:第 1 章列出的軸承、皮帶、皮帶輪、軸、銷與螺絲。馬達與驅動器:來自 Annin 連結的套組。電氣:見第 1 章的清單。
- 馬達(關節、零件編號):J1 17HS15-1684D-EG10-AR4、J2 23HS22-2804D-YGS50-AR4、J3 17HS15-1684D-EG50-AR4、J4 11HS20-0674D-EGS16-AR4、J5 17LS19-1684E-200G-AR4(線性導螺桿馬達)、J6 14HS11-1004D-EGS20-AR4。J4 馬達另需一個支架,零件 ST-M3。
- 驅動器:軸 1、2、3 使用三顆 DM332T,軸 4、5、6 使用三顆 DM320T。手冊未使用 TB6600 驅動器。
- 控制器:Teensy 4.1(附針腳)以及 Teensy 4.1 用的 Terminal Block Breakout Board Module,各一。另需一個 2x12 配電端子台、一個 5.5 mm DC 電源插座、一個 KCD1 SPST 翹板開關、一個 40 mm 24 V DC 無刷散熱風扇、一個 PBS-110 按鈕開關、一個 90 度 USB-C keystone 插座、一條 20 cm micro USB 轉 USB-C 線、兩個 PG-21 纜線固定頭螺帽與 EMI 遮蔽膠帶。
- 感測器:三顆 3144 霍爾效應感測器(3.3 V)、三顆 4 mm x 4 mm 圓形磁鐵、五條 Dupont 2.54 mm 母頭 3-pin 連接線,以及三個 10T85 極限開關。關節 1 至 3 使用霍爾感測器;關節 4 至 6 使用極限開關。
- 五金重點:軸承 32009(兩顆)、30206(兩顆)、30204、30203、附墊圈的 AXK3552/AS3552 止推軸承、NTA1625(三顆)、TRA1625 墊圈(四片)、TRD1625 墊圈(兩片)、B1616 滾針軸承(兩顆)、HK1612 與 688Z;皮帶 HTD 550-5M、180XL037、150XL037 與 84XL037;一個 60T XL 皮帶輪、兩個 HTD-20 皮帶輪、兩個 XL 15 齒 8 mm 孔徑皮帶輪,以及一個 XL 10 齒 6 mm 孔徑皮帶輪。兩根 3 mm x 85 mm 軸通常以 100 mm 販售,必須切成 85 mm。
- 電線與線材:黑、紅、藍、綠 20 AWG 軟矽膠線(各 3.2 m)、6.6 m 的 26 AWG 遮蔽型耐連續彎曲 Cat5 或更好規格的線(絞線)、50 cm 標準 Cat5、37 cm 2 芯 20 AWG 線、3 m 的 1/4 英吋與 1.65 m 的 3/4 英吋編織套管。
- 手冊的清單未註明主 24 V 電源供應器的額定規格。請見本草稿所記的衝突。
- 若你需要夾爪,現在就查看夾爪章節,因為它們有各自的零件清單。依目錄,這些是第 4 章(氣動)與第 5 章(伺服);物料清單頁面本身則寫第 3 與第 4 章。
2. 底座外殼、驅動器與電源
先組裝電氣底座:清理列印外殼、安裝六個驅動器、設定其開關,並為 24 V 電源路徑、風扇與開關配線。
2.1 清理列印的底座外殼
移除列印時的支撐結構,並打通 J1 底座外殼上的螺絲孔。
- 移除 J1 底座外殼上所有的列印支撐結構。用 3 mm 鑽頭清理底部的六個孔與背面的四個孔。
- 清理兩側的沉頭孔,並用 3.5 mm 鑽頭擴開每個孔的中心。
- 先將六顆 #6 自攻螺絲部分旋入,目前只旋入幾牙。
2.2 安裝六個步進馬達驅動器
在底座外殼左側裝上三個 DM332T 驅動器,右側裝上三個 DM320T 驅動器。
- 將每顆驅動器先掛在左側槽口的 #6 螺絲上,放到定位後先鎖緊左側螺絲,再鎖右側。手冊警告不要鎖得過緊。
- 三顆 DM332T 驅動器裝在左側,對應 J1、J2 與 J3,J1 在最左邊。三顆 DM320T 驅動器裝在右側,對應 J4、J5 與 J6,J6 在最右邊。
2.3 設定驅動器的 DIP 開關
在通電之前,依各驅動器所接馬達的電流與微步設定其開關。
- J1(17HS15-1684D-EG10),800 微步,1.82 A,DM332T:SW1 off、SW2 on、SW3 off、SW4 off、SW5 on、SW6 on。
- J2,800 微步,2.29 A,DM332T:SW1 off、SW2 off、SW3 off、SW4 off、SW5 on、SW6 on。
- J3(17HS15-1684D-EG50),800 微步,1.82 A,DM332T:SW1 off、SW2 on、SW3 off、SW4 off、SW5 on、SW6 on。
- J4(11HS20-0674D-EGS16),800 微步,0.50 A,DM320T:SW1 on、SW2 off、SW3 on、SW4 off、SW5 on、SW6 on。
- J5(17LS19-1684E-200G),1600 微步,1.56 A,DM320T:SW1 off、SW2 off、SW3 off、SW4 on、SW5 off、SW6 on。
- J6,800 微步,0.92 A,DM320T:SW1 on、SW2 on、SW3 off、SW4 off、SW5 on、SW6 on。
- 手冊此清單中 J2、J5 與 J6 馬達的名稱與其物料清單不同;請以關節為準,而非名稱。請見衝突說明。
2.4 裝上電源插座、翹板開關與風扇
以 5.5 mm 電源插座、翹板開關與 40 mm 風扇組裝風扇蓋。
- 清除底座外殼風扇蓋上的列印支撐結構。裝上 5.5 mm 電源插座,並壓入翹板開關,開關會卡入定位。
- 剪斷翹板開關的黑線,在開關上保留 50 mm。將一條 13 cm 的黑色 20 AWG 導線(剝線 3 mm)焊到插座的接地片上,即外殼引出的較長那一片。將翹板開關的黑線焊到插座中央的正極端子。確認焊點牢固,沒有散落的線股,插座端子之間也不可能短路。
- 將 40 mm 風扇壓入外殼,標籤朝外。它是緊密的滑入配合,沒有扣件。
- 將紅、黑電源線與風扇線穿過底座外殼的維修孔,再用四顆 #6 塑膠用自攻螺絲固定風扇蓋。
2.5 為驅動器與風扇接上電源
以菊鏈方式將 +Vdc 與接地串接到全部六個驅動器,風扇接在最後一個驅動器上。
- 剪五對 48 mm 長的紅、黑 20 AWG 導線,兩端各剝 3 mm。用它們將全部六顆驅動器的 +Vdc 與 GND 跨接起來。一次拔出一個綠色驅動器插座,插入導線並鎖緊端子螺絲。
- 將風扇蓋引出的紅、黑線接到第一顆(J1)驅動器的電源與 GND 端子。這會為第一顆驅動器供電,再由它沿著串接傳遞電源。
- 剪掉風扇線的連接器,剝開線端,將風扇的紅、黑線接到最後一顆(J6)驅動器的電源與 GND 端子,讓驅動器通電時風扇就會運轉。
2.6 將 J1 底板裝到外殼上
在組裝與運送時,將底板固定在外殼前方。
- 用 3.3 至 3.5 mm 鑽頭清理 J1 底座外殼前板上的兩個孔,並用 M4 螺絲攻攻牙。
- 用兩顆 M4x20 圓頭螺絲將 J1 底板固定到外殼前板。這些螺絲僅供組裝與運送使用。機器人完成後,請用 8 mm 扣件穿過四個安裝孔將其固定在桌面上。
3. J1 轉台與底座
在錐形滾子軸承上組裝 J1 轉台,再裝上 J1 馬達與皮帶。
3.1 裝上 J1 軸承與主軸
將兩個 32009 軸承座圈壓入 J1 轉台外殼,並裝上附軸承的 J1 主軸。
- 將兩個 32009 軸承座圈逐一壓入 J1 轉台外殼。
- 將一顆 M6x14 內六角螺絲鎖入 J1 主軸。在一顆 32009 軸承上塗一層薄薄的白色鋰基脂,並將其裝到主軸上。
- 將主軸插入轉台外殼,並在主軸頂端裝上第二顆 32009 軸承,同樣塗上潤滑脂。
3.2 將磁鐵壓入 J1 磁鐵座
J1 霍爾感測器需要一顆南極朝向安裝座外側的磁鐵。
- 將一顆 4 mm x 4 mm 磁鐵放在一字起子的尖端,用磁極測試器確認北極朝外、南極貼著起子。
- 將磁鐵壓入列印的 J1 磁鐵座,並用測試器確認南極現在朝外。
- 用兩顆 M3x10 圓頭螺絲將 J1 磁鐵座固定到 J1 平台上。手冊特別強調:「MAKE SURE SOUTH POLE OF MAGNET IS FACING UP」(務必讓磁鐵南極朝上)。
3.3 裝上 J2 轉台外殼與平台
壓入 J2 軸承座圈,將 J2 轉台外殼固定到 J1 平台上,再將平台裝到主軸上。
- 將兩個 30206 軸承座圈分別壓入 J2 轉台外殼的兩側。
- 用三顆 M6x18 平頭螺絲將 J2 轉台外殼固定到 J1 平台上,並在外殼前方加上兩顆鎖入平台的 M6x20 內六角承窩頭螺絲。
- 將平台組件裝到 J1 主軸上,用五顆 M6x14 內六角承窩頭螺絲固定,主軸上的內六角螺絲朝前。
- 在平台周邊的四個孔中裝上四顆 M4x10 止付螺絲。它們用於預壓上軸承。平均地鎖緊,直到沒有間隙,同時主軸與平台仍能自由轉動。平台與 J2 外殼之間的縫隙應又緊又窄,以防灰塵進入。
- 如果平台有摩擦,將其拆下,在主軸與平台之間加一片 0.1 mm 墊片。手冊是從鋁罐上剪下一片。
3.4 將 J1 轉台裝到底座
從下方以螺栓將轉台組件鎖到 J1 底板上。
- 從下方用八顆 M4x10 內六角承窩頭螺絲將 J1 轉台組件固定到 J1 底座上,J1 主軸的內六角螺絲朝上。
- 此處文字提到極限開關平面的方向。MK5 的 J1 使用霍爾感測器,因此這看起來是早期手冊殘留的內容。
3.5 裝上 J1 馬達、皮帶輪與皮帶
安裝附 10:1 減速頭的 J1 齒輪馬達,並張緊 180XL037 皮帶。
- 將 3 mm 鍵裝入 J1 馬達(17HS15-1684D-EG10-AR4)的軸上,並確認已完全插入。鍵有時會鬆散地與馬達文件一起放在袋子裡出貨。
- 用四顆 M4x10 平頭螺絲將 J1 馬達座固定到馬達上,馬達線在右側,馬達座的張緊孔朝向你。手冊警告:「MAKE SURE YOU ARE INSTALLING THE J1 MOTOR AND NOT THE J3 MOTOR」(務必安裝的是 J1 馬達而非 J3 馬達)。兩者外觀相似,J1 馬達標有 EG10,即 10:1 減速比。
- 將 XL 15 齒 8 mm 孔徑皮帶輪裝到馬達軸上,對齊鍵,用兩顆 M3x4 止付螺絲固定,下緣法蘭距馬達 11 mm。
- 在馬達座槽口的後方裝上兩顆 M3x10 止付螺絲。用四顆 M4x20 內六角承窩頭螺絲與四片墊圈將馬達裝到底座上,先不鎖緊,兩個 3 mm 張緊孔朝後。
- 用四顆 M6x14 內六角承窩頭螺絲將 60T 時規輪轂皮帶輪裝到 J1 主軸上,並套上 180XL037 皮帶。
- 用兩顆 M3x10 止付螺絲張緊皮帶,直到完全沒有鬆弛,且用手反轉方向時察覺不到背隙。皮帶應感覺緊實繃緊,而非鬆垮;稍緊一點勝過有任何間隙,但要避免張力過大。然後鎖緊四顆 M4x20 螺絲。
3.6 將底座組件放到外殼上
將列印的底座與外殼互相卡合,從這一步起兩者都要放在平坦的表面上。
- 將 J1 底座組件裝到外殼組件上,使列印的底座與外殼互相嵌合。
- 從現在起,將機器人與外殼放在平坦的表面上。若必須移動,請抬起時同時支撐兩者。
4. 底座外殼內的控制器配線
為驅動器訊號配線、製作 Teensy 4.1 分線板,並為 J1 馬達、編碼器與霍爾感測器配線。
4.1 裝上纜線固定頭螺帽並連接 PUL 與 DIR 訊號
使用單芯 Cat5 纜線中的雙絞線對,從每個驅動器拉出步進與方向訊號線。
- 在底座外殼上裝兩個 PG-21 纜線固定頭螺帽。剪兩段 145 mm 長的單芯 Cat5 線,剝除外皮,並將橙色線對放在一旁。
- 剝開藍、綠、棕線對的末端。每一對中,純色線接到驅動器的 PUL 端子,條紋線接到其 DIR 端子。
- J1 用藍色線對,J2 用綠色線對,J3 用棕色線對,J4 用藍色線對,J5 用綠色線對,J6 用棕色線對。
4.2 跳接 OPTO 端子
以單芯橘色線連接全部六個驅動器的 OPTO 端子。
- 將橙色線對的純色線與條紋線分開。將純橙色線剪成 43 mm,並剝開其中五條的末端。條紋線不要剪。
- 用五條 43 mm 導線將全部六顆驅動器的 OPTO 端子跨接起來。
- 將剩下的其中一條 130 mm 橙色條紋線接到 J1 驅動器的 OPTO 端子。
4.3 準備托盤與 USB 插座
清理 J1 底座外殼的托盤,並裝上 USB-C keystone 插座。
- 移除托盤上的列印支撐結構。用 3 mm 鑽頭清理兩側各兩個鉸鏈孔,以及八個螺絲安裝孔。
- 將 USB 延長線的 USB-C 端插入 90 度 USB-C keystone 插座,並將插座裝入托盤的左側插槽。
4.4 製作 Teensy 4.1 轉接板
以六根排針在轉接板上加入 5 V 匯流排,務必非常小心,不要讓 5 V 與接地短路。
- 將轉接板從其小外殼中取出(卸下兩顆側邊螺絲與側蓋)。
- 從隨附的排針條上剪下一條六針的 PCB 排針。將其插入洞洞板上緊鄰 5V 與 GND 端子的第一排。
- 按住排針,將電路板翻面,用一小塊紙板墊住排針,讓短的一側完全穿出。將六個針腳端子全部焊成一座焊橋。
- 從一股 Cat5 線中剪下 8 mm 長的銅線,去除絕緣層,從 5V 端子焊到焊橋上。手冊以大寫字強調,務必絕對確認不要橋接到 GND 端子,並用三用電表量測 GND 與 5V 螺絲端子之間,確認沒有短路。
- 裝回電路板與側蓋。將 Teensy 4.1 插入其插座,USB 連接埠朝左,與 5V 端子在同一側。
- 用兩顆 #6 自攻螺絲將 Teensy 與轉接板裝到托盤中,USB 連接器朝左。用兩顆 #6 螺絲裝上 2x12 端子板,A 與 B 標示朝上。A 與 B 端子在上下兩排交錯排列;上排並非全是 A,下排也並非全是 B。
- 將線材的 micro USB 端插入 Teensy。你可能需要將 Teensy 從插座中抬起才能插入。
4.5 將 J1 馬達線材接入外殼
為 J1 馬達與編碼器線材套上套管,走線進入外殼,並將馬達接到 J1 驅動器。
- 在 J1 編碼器線上貼一段 14 cm 的 EMI 遮蔽膠帶。將 J1 馬達線與編碼器線穿過一段 16.5 cm 的 1/4 英吋編織套管,並熔化套管末端。
- 將線材引入外殼;在線材與套管根部塗液態絕緣膠帶為選擇性步驟。將紅、黑、藍、綠的馬達電源線與編碼器線分開。
- 將 J1 馬達線接到 J1 驅動器:A+ 黑、A- 綠、B+ 紅、B- 藍。保留剩下的線頭。
- 用兩顆 #6 自攻螺絲在鉸鏈位置將托盤裝到底座外殼上。
4.6 將驅動器訊號與端子板接到 Teensy
將每個驅動器的 PUL 與 DIR 線接到轉接板,並在端子板上設定 3.3 V 與接地。
- 將 J1 OPTO 條紋線接到左側的 3.3V 端子。
- PUL 與 DIR 的 Teensy 端子:J1 為 0 與 1,J2 為 2 與 3,J3 為 4 與 5,J4 為 6 與 7,J5 為 8 與 9,J6 為 10 與 11。
- 用剩下的馬達線,以紅線將 Teensy 的 3.3V 端子接到端子板的 A 端子,以黑線將 Teensy 的 GND 端子接到 B 端子。
- 將兩條 Dupont 2.54 mm 母頭連接線接到六支 5 V 排針上。之後每個編碼器的紅色 5 V 線會焊到這些連接線的其中一條,如手冊照片所示。
4.7 J1 編碼器與霍爾感測器配線
將 J1 編碼器接到 Teensy,並安裝 J1 霍爾效應感測器、完成配線。
- 將 J1 編碼器的紅線焊到 Dupont 5 V 連接線的第一條線上,並套上熱縮套管。將編碼器的黑線接到 Teensy 的 GND 端子,藍線接到端子 14,棕線接到端子 15。剪掉黃、綠、橙、白線,因為編碼器不使用它們。
- 使用剩下的編碼器線與一條 Dupont 3-pin 母頭連接線:將綠線焊到來自右側端子的線,橙線焊到中央端子,白線焊到左側端子。
- 在這些線材上貼一段 16 cm 的 EMI 遮蔽膠帶。將極限開關的線穿過一段 15.5 cm 的 1/4 英吋編織套管。
- 用兩顆 M1.6x4 螺絲將一顆 3144 霍爾效應感測器固定到列印的 Sensor Mount 1 上,再用兩顆 M3x14 十字圓頭螺絲將該座固定到 J1 轉台上。
- 將 Dupont 連接線插到感測器上,綠線的端子在右側。該端子在感測器板上標為代表訊號的「S」。
- 將感測器線引入底座外殼。將綠色訊號線接到 Teensy 端子 26,橙色電源線接到一個 3.3V 端子,白色接地線接到 GND。
5. J2 肩部
將 J2 手臂裝到軸承上,加上感測器與磁鐵,再裝上 J2 減速馬達及其配線。
5.1 裝上 J2 手臂與主軸
將 J2 主軸裝入手臂,並以張緊環張緊 J2 軸承。
- 用八顆 M4x10 平頭螺絲將 J2 主軸裝到 J2 手臂上,鍵槽朝上,M8 螺紋孔朝右。
- 將列印的 J2 軸承蓋裝到一顆塗好潤滑脂的 30206 軸承上,並將其放入 J2 轉台。用一顆略為壓住軸承蓋的 M8x14 內六角承窩頭螺絲固定。
- 插入 J2 手臂組件,使主軸穿過該軸承,然後從另一側裝上一顆塗好潤滑脂的 30206 軸承。
- 用六顆 M3x10 平頭螺絲裝上 J2 張力環,其鍵槽與主軸鍵槽對齊。裝上四顆 M4x5 止付螺絲並鎖緊,直到 J2 軸承沒有間隙。
- 將 J2 手臂前後移動數次,視需要重新鎖緊固定螺絲。
5.2 裝上 J2 霍爾感測器與纜線
以耐連續彎曲的 Cat5 製作 J2 感測器纜線,並安裝感測器。
- 剪 65 cm 的耐連續彎曲 Cat5 線,去除外皮,從一端(接到外殼的那一端)去除 15 cm 的遮蔽層,另一端去除 4 cm。
- 將一條 Dupont 3-pin 連接線修剪到剩 25 mm 導線。將其焊到短端的橙線與綠線上並套上熱縮套管:綠線接右側端子,純橙線接中央,橙白條紋線接左側。
- 用一段 5 cm 的 EMI 遮蔽膠帶包覆橙線與綠線。
- 用兩顆 M1.6x4 螺絲將一顆 3144 霍爾感測器固定到 J2 感測器座上,插上連接線,綠線的端子在右側(標示為 S),再用兩顆 M3x10 圓頭螺絲將感測器座固定到 J2 轉台外殼上。
5.3 裝上 J2 磁鐵並測試感測器
將 J2 磁鐵座裝到張緊環上,繼續之前先確認感測器能被觸發。
- 以與 J1 相同的方式將一顆 4 mm x 4 mm 磁鐵壓入 J2 磁鐵座:用測試器確認在起子上時北極朝外,裝入座後南極朝外。
- 用兩顆 M2.5x6 圓頭螺絲將 J2 磁鐵座固定到 J2 張力環上。
- 測試:暫時將纜線長端的橙線接到端子板的 B1 端子,橙白條紋線接到 B2,為感測器提供 3.3 V。將來自 PC 的 USB 線插入機器人底座,為 Teensy 供電。
- 前後擺動 J2 手臂,檢查手臂位於後方位置時感測器的 LED 會亮。調整感測器座並彎折感測器頭的引腳,使其每次都能可靠觸發。
- 拔下 USB 線,並從端子板上拆下橙線與白線。
5.4 準備 J2 齒輪馬達
檢查 J2 馬達的鍵,並以較長的螺絲裝上間隔件與馬達支架。
- 檢查 J2 馬達軸(23HS22-2804D-YGS50-AR4)上的鍵是否完全就位:量測值應略小於 16 mm。若不是,在虎鉗鉗口貼上膠帶後將其壓入。手冊寫道「DO NOT USE A HAMMER」(不要用鐵鎚)。
- 逐一將固定馬達與減速箱外殼的四顆內六角螺絲,換成 M4x45 全牙圓頭螺絲。
- 將 J2 Motor Spacer Part 1、接著 Part 2 沿螺絲滑下,抵住減速箱的肩部,再裝上 J2 馬達支撐座。馬達線在左側。裝上四片 M4 墊圈與螺帽並鎖緊。
5.5 將 J2 減速箱裝入手臂
將 J2 減速箱軸推入主軸,並將馬達支架固定到 J1 平台上。
- 將附鍵的 14 mm 減速箱軸放入 J2 主軸。鍵必須完全壓入,否則軸放不進去。
- 必要時可使用軟橡膠槌。不要敲擊馬達:用一隻手牢牢握住馬達,敲擊 J2 手臂,使整個下方組件往馬達方向移動。
- 就位後,減速箱肩部與 J2 張力環之間應有約 2 mm 的間隙,馬達座與 J1 平台齊平。用三顆 M6x18 平頭螺絲穿過馬達座板鎖入平台。
5.6 J2 馬達與編碼器配線
將 J2 編碼器接到 Cat5 纜線,並延長馬達線。
- 將編碼器線與馬達線分開,剪掉未使用的白、黃、綠、橙編碼器線。在編碼器線上貼 14 cm 的 EMI 遮蔽膠帶。
- 將 J2 馬達線與編碼器線套入 15 cm 的 1/4 英吋編織套管。先用膠帶纏住馬達線末端,以便穿入。將編碼器線剪得比馬達線短 10 至 15 cm,以便區分。
- 將導線穿過 J2 馬達支撐板上的孔。板上的另外兩個孔是讓起子伸入鎖霍爾感測器螺絲用的。在馬達線、編碼器線與套管的根部套一條小束線帶。在此處塗液態絕緣膠帶為選擇性步驟。
- 將編碼器焊到 Cat5 線上並套上熱縮套管:紅接棕、黑接白棕條紋、棕接白藍條紋、藍接藍。在焊點外包覆 7 cm 的 EMI 膠帶。
- 剪 34 cm 長的紅、黑、藍、綠 20 AWG 導線,依顏色對應焊到 J2 馬達線上,使馬達線與 Cat5 線長度相同。
- 用膠帶包住末端,並各畫上兩條標記,以便在外殼內辨識為 J2。
6. J3 肘部
組裝 J3 關節、其皮帶傳動與感測器,然後在外殼內連接 J2 與 J3。
6.1 組裝 J3 軸承杯與主軸
將 J3 軸承杯裝在 J2 手臂末端,並將 J3 主軸裝在其軸承上。
- 將一個 30204 軸承座圈壓入 J3 軸承杯,並用六顆 M3x20 平頭螺絲將軸承杯固定到 J2 手臂末端。
- 將一段 50 mm 長、附 2x2 mm 鍵條(同樣 50 mm 長)的 8 mm 鍵軸裝入 J3 主軸,並用一顆 M3x4 止付螺絲固定。
- 在主軸上依序裝上一片 AS3552 墊圈、AXK3552 滾針軸承與另一片 AS3552 墊圈,在滾針軸承上塗少許潤滑脂,然後將主軸插入 J2 手臂。
- 一邊扶著,一邊在主軸軸上裝上一顆 30204 軸承,並用四顆 M3x10 平頭螺絲裝上 J3 主軸固定座。調整螺絲的鬆緊,使其沒有間隙但軸仍能順暢轉動。將主軸轉動數次讓軸承磨合,再重新調整張緊。
6.2 裝上 J3 馬達、皮帶輪與皮帶
安裝 J3 馬達(EG50,50:1),並張緊 HTD 550-5M 皮帶。
- 用四顆 M4x10 平頭螺絲將 J3 馬達座固定到 J3 馬達(17HS15-1684D-EG50-AR4)上,張緊孔與馬達線成 90 度。在張緊槽孔中裝上兩顆 M3x14 內六角螺絲。
- 將長肩 HTD-20 皮帶輪裝到 J3 馬達軸上,對齊鍵,使馬達座表面到皮帶輪頂部的距離為 33 mm。鎖緊皮帶輪軸環上的 M3x4 止付螺絲。
- 用四顆 M4x20 內六角承窩頭螺絲與四片墊圈將馬達組件固定到 J2 手臂上,引出線朝左(後方)。螺絲先保持稍鬆,讓馬達可以滑動。
- 將短肩 HTD-20 皮帶輪裝到 J3 的 8 mm 軸上,其內緣與 J2 板齊平,並鎖緊其 M3x3 止付螺絲。
- 將 HTD 550-5M 皮帶套在兩個皮帶輪上。鎖緊 M3 張緊螺絲,直到皮帶達到適中的張力,然後鎖緊四顆 M4x20 馬達座螺絲。
- 皮帶張力,簡述手冊的說法:消除所有鬆弛,使用手反轉方向時察覺不到背隙。皮帶應感覺緊實繃緊,寧可稍緊也不要偏鬆,但不要張力過大。
6.3 製作 J3 纜線並裝上 J3 感測器
製作承載感測器、編碼器與馬達線材的 J3 纜線,並安裝感測器。
- 剪 120 cm 的耐連續彎曲 Cat5 線,去除外皮,從一端(接到外殼)去除 15 cm 的遮蔽層,另一端去除 28 cm。保留這段 28 cm 的遮蔽層。
- 從 28 cm 那一端剪掉棕色與藍色線對的 25 cm,保留 3 cm。將橙色與綠色線對放入保留的 28 cm 遮蔽層中,兩端貼上膠帶,並讓線對露出 1.5 至 2 cm。
- 將橙色與綠色線對穿過一段 23 cm 的 1/4 英吋編織套管。將一條 Dupont 3-pin 連接線(修剪到 25 mm)焊到外露的導線上:綠線接右側端子,純橙線接中央,橙白條紋線接左側。
- 用兩顆 M1.6x4 螺絲將一顆 3144 霍爾感測器固定到 J3 感測器座上,再用兩顆 M3x10 圓頭螺絲將感測器座固定到 J2 轉台外殼上。測試自動校正時,你可能需要調整感測器座並彎折感測器引腳。手冊 1.1 版更新了這個感測器座。
- 將連接線插到感測器上,並用一條大束線帶將纜線固定到 J3 減速箱上。
6.4 J3 編碼器與馬達配線
將 J3 編碼器接到纜線,並延長馬達線。
- 剪掉未使用的白、黃、橙、綠編碼器線。將藍、棕、紅、黑編碼器線剪到 4 cm,小心剪的是編碼器線而不是馬達線。
- 焊接並套上熱縮套管:編碼器紅線接纜線棕線,黑接白棕條紋,棕接白藍條紋,藍接藍。
- 將 J3 馬達線與纜線穿過一段 35 cm 的 3/4 英吋編織套管,末端用束線帶綁住。將纜線從 J3 減速箱下方穿過,再繞過並穿到 J2 減速箱下方,使其在 J1 轉台上方與 J2 的線會合。
- 剪 50 cm 長的紅、黑、藍、綠 20 AWG 導線,依顏色對應焊到 J3 馬達線上。用膠帶包住末端,並各畫上三條標記代表 J3。
6.5 製作 J2 與 J3 線束
將 J2 與 J3 線材一起套上套管,以 J2 纜線固定座固定,並走線進入外殼。
- 在 J3 套管根部,用絕緣膠帶將 J2 與 J3 線束纏繞一圈。將所有 J2 與 J3 的導線與纜線穿過一段 52 cm 的 3/4 英吋編織套管。
- 將兩條大束線帶穿過列印的 J2 理線座,並用兩顆 M4x8 圓頭螺絲將理線座固定到 J1 平台上。
- 將 J2 與 J3 纜線沿理線座中央放好,綁緊並剪掉束線帶多餘的尾端。將 J2 與 J3 線束連同 J1 的線,引入左側的纜線固定頭螺帽。
6.6 在外殼中連接 J2 與 J3
將 J2 與 J3 馬達線接到各自的驅動器,編碼器、霍爾感測器與感測器線材則接到端子板與 Teensy。
- 馬達線:掀起外殼托盤,找出標記數量正確的導線(J2 為兩條,J3 為三條),剪到適當長度後接到該關節的驅動器:A+ 黑、A- 綠、B+ 紅、B- 藍。
- J2 編碼器:將棕線焊到 Dupont 5 V 連接線的第二條線上,並將棕色條紋線(GND)接到端子台的第 12 個(最後一個)端子。將純橙線接到第 9 個端子,橙色條紋線接到第 10 個。將純綠線接到 Teensy 端子 27(剪掉綠色條紋線)。將藍色線對接到端子 16(純色)與 17(條紋)。
- J3 編碼器:將棕線焊到 Dupont 連接線的第三條線上;棕色條紋線接第 8 個端子;純橙線接第 5 個,橙色條紋線接第 6 個;純綠線接 Teensy 端子 28;藍色線對接端子 18(純色)與 19(條紋)。
- 對每一組,用三用電表檢查你所接的端子與端子板的 B(GND)端子導通,且純橙線與 A(+3.3 V)導通。記得 A 與 B 在各排之間交錯排列。
- 用一條小束線帶將 J1、J2 與 J3 的編碼器線,以及接到端子台的導線綁在一起。
6.7 裝上 J2 側蓋
將標誌黏入 J2 側蓋,並將間隔件與側蓋鎖在 J3 皮帶上方。
- 用環氧樹脂將 AR4 標誌黏入 J2 側蓋的凹槽中。
- 將 J2 側蓋間隔件放在 J3 皮帶與皮帶輪上方,再將側蓋放上去。先鎖一顆 M3x30 圓頭螺絲固定,再鎖上其餘 15 顆 M3x30 圓頭螺絲。
- 如果你的印表機較小,此零件在「為較小印表機分割的大型零件」資料夾中有兩件式版本。
7. J4、J5 與 J6 腕部
組裝 J4 轉台與主軸、J5 導螺桿傳動與 J6 外殼。
7.1 裝上 J4 轉台外殼
將滾針軸承壓入 J4 轉台外殼,並將它固定到 J3 主軸上。
- 將兩顆 B-1616 滾針軸承壓入 J4 轉台外殼,兩側各一顆,並塗少許潤滑脂。它們可能裝得很緊。手冊建議用杯墊加熱器加熱外殼,並使用好的壓床,絕對不要用鐵鎚。
- 用中央的兩顆 M4x14 平頭螺絲與外圍的四顆 M4x10 內六角螺絲,將 J4 轉台外殼固定到 J3 主軸上。
7.2 準備 J4 同步輪轂與主軸
為 J4 同步輪轂攻牙,並以正確的深度與對位將它裝到 J4 主軸上。
- 用 M4 螺絲攻為 J4 時規輪轂的四個周邊孔與四個端面孔攻牙。不要用油;手冊在攻牙時將零件與螺絲攻置於冷的流水下。
- 列印的輪轂厚度不得超過 15 mm。若較厚,請在平面上從平的一側砂磨或銼掉多餘部分。
- 將輪轂裝到 J4 主軸上,使其中一個周邊孔對準軸上的第二個孔,軸末端到皮帶輪端面的距離為 25.3 mm。
- 在對準軸孔的那個孔中裝一顆 M4x10 止付螺絲,旋入軸中約 3 圈以鎖定對位。在其餘的周邊孔中裝上三顆 M4x5 止付螺絲並鎖緊。
- 在主軸上依序套入一片 TRD1625 墊圈(0.126 英吋)、一顆 NTA1625 滾針軸承(內徑 1 英吋,已塗潤滑脂)與一片 TRA1625 墊圈(0.032 英吋),放入輪轂凹槽。將管與輪轂組件裝入 J4 轉台,軸承完全就位並與轉台外殼齊平。
7.3 裝上 J5 馬達座並張緊 J4 軸承
將 J5 導螺桿馬達裝入 J4 管中,並設定 J4 軸承的張緊度。
- 在 J5 馬達外殼上裝一顆 M3x6 圓頭內六角螺絲,露出一到兩牙。它是 J4 極限開關的定時凸塊,會在試運轉時調整。
- 先拆下 J5 馬達導螺桿上的塑膠 POM 螺帽。用四顆 M3x16 內六角承窩頭螺絲固定 J5 馬達座,馬達連接器朝下,定時凸塊在右側 90 度處。
- 在 J5 馬達軸與凹槽上裝一片 TRA1625 墊圈、一顆 NTA1625 滾針軸承(已塗潤滑脂)與另一片 TRA1625 墊圈。
- 將 J5 馬達組件滑入 J4 主管,保持軸承在原位,直到馬達座完全就位,軸承與 J4 外殼齊平。用四顆 M4x10 止付螺絲固定,馬達連接器朝下,朝外的那顆止付螺絲要卡入主軸上的孔。
- 依手冊所示的位置,在 J4 時規輪轂上裝四顆 M4x5 止付螺絲。調整鬆緊,使軸承沒有間隙,但馬達與軸仍能自由轉動。
7.4 裝上 J3 磁鐵與 J4 馬達安裝塊
壓入 J3 磁鐵,將它裝到 J4 馬達安裝塊上,再裝上安裝塊。
- 依先前的磁極檢查方式,將一顆 4 mm x 4 mm 磁鐵壓入 J3 磁鐵座,南極朝外。
- 用兩顆 M2.5x6 圓頭螺絲將 J3 磁鐵座固定到 J4 馬達座塊上。用三顆 M4x10 內六角承窩頭螺絲裝上 J4 馬達座與極限開關接觸塊。
7.5 裝上 J4 馬達、皮帶輪與皮帶
將 J4 馬達裝到其 NEMA 11 支架上,並裝上 84XL037 皮帶。
- 用四顆 M3x14 內六角承窩頭螺絲裝上 NEMA 11 支架,支架與鋁件之間夾著列印的 J4 馬達間隔件。列印檔中有 3、4 與 5 mm 的間隔件,提供不同的皮帶張力選擇。手冊發現通常以 4 mm 最佳。
- 用四顆 M3x5 內六角承窩頭螺絲裝上 J4 馬達,馬達線與編碼器線朝內,朝向 J2 手臂。
- 用兩顆 M3x4 止付螺絲將 XL 10 齒 6 mm 孔徑皮帶輪裝到 J4 馬達軸上。
- 將 84XL037 皮帶套在馬達皮帶輪上,再往上套到主軸鏈輪上,一邊轉動 J5/J4 組件讓皮帶捲入。
7.6 組裝 J5 滑座與導桿
將 POM 螺帽與銅襯套裝到 J5 滑座上,再裝上 3 mm 導桿。
- 在 J5 導螺桿馬達的 POM 螺帽上,為三個孔加工沉頭。
- 將兩個內徑 3 mm x 20 mm 的黃銅襯套壓入 J5 滑座。它們可能很緊;必要時用杯墊加熱器加熱滑座,並使用壓床或有鉗口保護的虎鉗。手冊寫道:「DO NOT HAMMER THESE IN PLACE」(不要用鐵鎚敲入)。用四顆 M3x4 止付螺絲固定。
- 用三顆 M3x10 平頭螺絲將 POM 螺帽裝到滑座中。
- 測試每根 3 mm 桿在其襯套中都能順暢滑動。若不能,將桿夾在電鑽上,塗上潤滑脂,一邊轉動一邊前後移動,讓襯套磨合。
- 將 J5 滑座放入 J5 外殼,將兩根 3 mm 桿滑過滑座襯套,並暫時在孔中放一顆 M3x8 螺絲,以免桿插得太深。將桿推到齊平,用一顆 M3x6 止付螺絲固定下方的桿,拆下暫時的螺絲,再用一顆 M3x6 止付螺絲固定上方的桿。
- 滑座必須能順暢滑動。如果卡住,在桿上塗潤滑脂並前後推動滑座,或拆下桿子重新磨合襯套。
7.7 裝上 J5 惰輪與外殼
裝上惰輪張緊塊與軸承柱,再將 J5 外殼滑入 J4 管上。
- 用兩顆 M4x8 內六角承窩頭螺絲裝上 J5 惰輪張緊塊。將 HK1612 軸承套到 J5 軸承柱上,再套上列印的軸承柱間隔件,並用一顆 M4x14 內六角承窩頭螺絲將軸承柱固定到張緊塊上,先保持稍鬆。
- 在 J5 外殼末端裝一顆 688Z 軸承,並用一顆 M3x6 止付螺絲固定。
- 將 J5 外殼組件旋到 J5 導螺桿上。隨著轉動,外殼會開始套上 J4 主管。兩者都必須完全乾淨,沒有灰塵、碎屑或切屑,否則外殼可能會咬死。
- 將外殼往前滑動,直到完全抵住 J4 時規輪轂。不要強行推入或扭轉;若無法用手滑動,請拋光 J4 主軸。用一顆完全旋入主軸孔中的 M4x10 止付螺絲固定,以確定其角度位置。
7.8 裝上 J6 手臂、外殼與軸承
組裝 J6 軸承臂與軸承蓋,再將 J6 外殼裝在兩者之間。
- 將一個 30203 軸承座圈壓入 J6 主軸承支撐臂,並用六顆 M4x18 平頭螺絲將支撐臂固定到 J5 外殼上。
- 將一顆塗好潤滑脂的 30203 軸承壓到 J6 外殼側柱上。
- 在 J6 軸承蓋凹槽中裝一片 TRD1625 墊圈、一顆 NTA1625 滾針軸承(已塗潤滑脂)與一片 TRA1625 墊圈。
- 從左側裝入 J6 外殼,從右側裝入帶軸承的軸承蓋。用一顆 M6x14 內六角承窩頭螺絲固定軸承蓋,然後在蓋周圍裝上六顆 M4x5 止付螺絲。平均地調整,使 J6 外殼旋轉時沒有間隙但仍轉動順暢。
7.9 裝上 J5 側板與極限開關
將 J5 10T85 極限開關裝到側板上,並將側板放到定位。
- 先用 2.5 mm 鑽頭清理 J5 側板前方的四個孔,再用 M3 螺絲攻攻牙,不要用油。用 3 mm 鑽頭清理後方的八個孔。銼掉凹陷鼻部的所有列印支撐結構。
- 用兩顆 M2.5x8 圓頭螺絲將一個 10T85 極限開關固定到 J5 側蓋上,紅色按鈕偏向下方,NC 端子朝上。
- 用兩顆暫時的 M3x14 圓頭螺絲裝上 J5 側板。將 XL 15 齒皮帶輪套到 J6 外殼柱上,需乾淨且能自由轉動。若不易滑入,請勿強行裝入;清潔或拋光軸,使其成為滑動配合。止付螺絲先不要裝。
7.10 J5 極限開關配線
J5 極限開關的線材要與 J5 編碼器分開走線,因為開關位於 J3 的另一側。
- 在尖嘴鉗的鉗口貼上保護膠帶,用手轉動 J5 導螺桿,直到滑座完全移到最前方,喀一聲觸發極限開關。
- 剪 130 cm 的耐連續彎曲 Cat5 線並去除外皮。將所有導線從遮蔽層中抽出,去除綠色包覆層與中心芯,保留遮蔽層與四組雙絞線。
- 極限開關只使用橙色線對與純綠線。綠色條紋線不用。保留藍色與棕色線對及遮蔽層。將橙色線對與綠線穿過 J5 側板上的槽,從兩個壓線爪下方通過。
- 將橙線焊到 NO 端子,橙白條紋線焊到 NC,純綠線焊到 C。用膠帶包住末端,並畫上五條標記代表 J5。暫時將它們垂放在一旁。
7.11 裝上 J5 皮帶,並在機構上將 J5 設定為 105 度
以較緊的張力裝上 150XL037 皮帶,再在 J6 外殼位於 105 度時鎖定 J5 皮帶輪。
- 將 150XL037 皮帶放在木塊上,在兩條齒之間的中央鑽一個 3 mm 的孔。
- 調整 J5 惰輪張力塊,讓皮帶緊繃、很難滑過惰輪軸承,然後鎖緊張力塊螺絲。
- 將皮帶推過惰輪軸承,並將孔對準 J5 托架。鎖緊軸承柱的內六角螺絲:因為它先前留得稍鬆、軸承向前傾,鎖緊後會把皮帶拉得更緊一些。3D 列印的機器人無法達到鋁件那樣緊的皮帶張力。
- 用一顆 M3x8 內六角螺絲穿過皮帶孔,將皮帶牢牢固定到托架夾上。
- 在 J5 托架向前、極限開關剛好按下的狀態下,將 J6 外殼轉到朝上的角度,馬達側朝下。將角度規橫放在 J5 外殼頂部,把 J6 外殼角度設為 105 度。
- 在 105 度時,鎖緊 XL 皮帶輪上的兩顆 M3x4 止付螺絲。J5 現在已機械校正到 105 度,之後再以軟體微調。手冊指出,運轉幾個小時後務必重新檢查這些螺絲,必要時再鎖緊。
7.12 裝上 J5 側間隔件與側蓋
以標誌、間隔件與側蓋封好 J5 外殼。
- 用 3 mm 鑽頭清理 J5 側間隔件上的 12 個孔。用環氧樹脂將 AR4 標誌黏入 J5 側蓋的凹槽。
- 在 J5 導螺桿與導桿上塗少量潤滑脂。
- 以八顆 M3x25 十字盤頭螺絲安裝側間隔件與側蓋,並在側蓋前段使用四顆 M3x20 十字盤頭螺絲。
7.13 安裝 J6 馬達
將 J6 齒輪馬達裝入 J6 外殼。
- 拆下 14HS11-1004D-EGS20-AR4 減速機兩側各兩個塑膠塞。
- 安裝馬達前,撕掉減速機貼紙並清除所有殘膠。
- 將馬達裝入 J6 外殼,線朝後,以四顆 M3x3 止付螺絲固定,前面兩顆、後面兩顆。
8. 腕部纜線與外殼收尾
製作 J4、J5 與 J6 的纜線,將線束拉到底座,並完成外殼內的配線。
8.1 製作 J4 極限開關與纜線
製作附極限開關的 J4 纜線。
- 剪下 117 cm 的高柔性 Cat5 線,剝除外皮,在一端(接外殼的一端)去除 15 cm 的屏蔽,另一端去除 17 cm。從 17 cm 那端剪掉棕色與藍色線對的 14 cm,留下 3 cm。
- 將綠色與橙色線對穿過一段 15 cm 的 1/4 inch 編織套管。將橙色線焊到 10T85 極限開關的 NO 端子,橙白條紋線焊到 NC,綠色線焊到 C。綠白條紋線不使用。
- 將開關與線裝入 J4 極限開關馬達座,端子與線要凹入表面之下,避免碰到鋁外殼。必要時以液態絕緣膠帶包覆端子。
- 以兩顆 M3x14 十字盤頭螺絲將開關座固定到 J4 外殼上。試車時,必須調整 J4 定時螺絲,讓它碰觸這個開關。
8.2 J4 編碼器與馬達配線
將 J4 編碼器接到纜線,並延長馬達線。
- 剪掉 J4 編碼器未使用的白、黃、綠、橙色線。將棕、黑、藍、紅色編碼器線剪到 4 cm。
- 焊接並套上熱縮套管:編碼器紅線接纜線棕線,黑接白棕條紋,棕接白藍條紋,藍接藍。
- 將 55 cm 的紅、黑、藍、綠色 20 AWG 延長線依顏色對應焊到 J4 馬達線上。用膠帶包住線端,並在每條線上標四道條紋,代表 J4。
- 將 J4 馬達線與線纜穿過一段 25 cm 的 1/4 inch 編織套管,稍微與 J4 極限開關的套管重疊,並用小束線帶固定重疊處。
- 依圖示的弧度與餘量佈線到 J2 手臂線槽中,並在 J4 馬達根部外露的編碼器線與馬達線上塗液態絕緣膠帶。膠帶固化期間不要碰動線。
8.3 製作 J5 編碼器纜線
以先前保留的棕色與藍色線對製作 J5 編碼器纜線,並延長 J5 馬達線。
- 將保留的棕色與藍色線對剪到 114 cm,並將保留的屏蔽層縮短 10 cm。將線對穿過屏蔽層,一端(接外殼的一端)露出 15 cm,另一端露出 3 cm。
- 剪掉 J5 編碼器未使用的黃、白、綠、橙色線。將紅、黑、棕、藍色線剪到 4 cm。依與之前相同的對應方式焊接並套上熱縮套管。將屏蔽層套過接點。
- 將 75 cm 的紅、黑、藍、綠色 20 AWG 延長線焊到 J5 馬達線上。將馬達線與線纜穿過一段 33 cm 的 1/4 inch 編織套管。
- 用一條大束線帶將列印的 J5 馬達支架固定到 J5 馬達外殼上。將線佈入 J2 手臂線槽,留足餘量,讓 J4 能完全活動而不拉扯線。用一條小束線帶固定到支架上。
- 在外露的編碼器線與馬達線上塗液態絕緣膠帶,用膠帶包住線端,並標上五道條紋。
8.4 製作 J6 極限開關與纜線
製作附極限開關以及馬達與編碼器線材的 J6 纜線。
- 剪下 151 cm 的高柔性 Cat5 線,剝除外皮,在一端(接外殼的一端)去除 15 cm 的屏蔽,另一端去除 14 cm。從 14 cm 那端剪掉棕色與藍色線對的 11 cm,留下 3 cm。
- 將綠色線對解開。綠色條紋線留在棕色與藍色線對旁邊,純綠色線留在橙色線對旁邊。
- 將橙色線對與純綠色線穿過一段 12 cm 的 1/4 inch 編織套管。將橙色線焊到 10T85 極限開關的 NO,橙白條紋線焊到 NC,綠色線焊到 C。在開關端子上塗液態絕緣膠帶。
- 剪掉 J6 編碼器的橙、黃、白、綠色線。將其餘的線剪到 3 cm,依與之前相同的對應方式焊接。在編碼器線上纏 5 cm 的 EMI 屏蔽膠帶。
- 將 100 cm 的紅、黑、藍、綠色 20 AWG 延長線依顏色對應焊到 J6 馬達線上。用膠帶包住線端,並標上六道條紋,代表 J6。
8.5 如果需要夾爪,現在就加入夾爪的纜線
在組裝的這個階段,夾爪的線材或氣管必須與 J6 纜線一起走線。
- 手冊以大寫字強調,任何夾爪的線或氣管都必須在這個時候一起佈入,並要你查看夾爪章節中的元件(手冊寫的是第 3 與第 4 章,但依其目錄應是第 4 與第 5 章)。
- 伺服夾爪:將兩條 20 AWG 紅黑矽膠線與 J6 線纜及馬達線一起佈線,末端與 Cat5 的綠色條紋線齊平。零件頁面寫這些線為 162 cm,但佈線頁面寫 100 cm;請參見矛盾之處。
- 氣動夾爪:將兩段 4 mm 矽膠管與 J6 線纜及馬達線一起佈線,末端超出 J6 馬達 20 cm。
- 第 2 章其餘部分示範伺服選項。第 4 章(氣動)與第 5 章(伺服)完成夾爪。本頁不涵蓋這些內容。
8.6 為手腕線束套上套管並走線
將 J4、J5 與 J6 纜線合併套入套管,並引到底座外殼。
- 將 J6 馬達線、編碼器線與夾爪線穿過一段 24 cm 的 1/4 inch 編織套管,與極限開關的套管重疊,再往上穿過上臂。
- 將一條小束線帶從 J6 線纜與 J5 橙綠色極限開關線下方穿過,穿過 J5 側間隔件的下方槽,再從上方繞過穿入上方槽。拉緊後剪掉多餘部分。
- 將 J6 的線穿過一段 40 cm 的 1/4 inch 套管,延伸到 J5 側間隔件下方,並用一條小束線帶固定到 J5 側間隔件上。
- 將 J4、J5 與 J6 的線與線纜穿過一段 70 cm 的 3/4 inch 編織套管,並在它與較小套管重疊處用一條小束線帶固定。
- 將線束放回 J2 線槽,用四條小束線帶固定。將 J4、J5 與 J6 的線穿過右側的格蘭頭螺帽並鎖緊。注意不要勾到或拉扯其他線。
- 用一條中束線帶將 J4 至 J6 的套管綁到 J1 至 J3 的套管上,J4 至 J6 套管在上,位置靠近 J1 減速機頂部、但在黑色馬達外殼下方一點。
8.7 在外殼中連接 J4、J5 與 J6
將 J4 至 J6 的馬達、編碼器與極限開關線材接到驅動器、端子板與 Teensy。
- 馬達線:為每個關節找出標記數量正確的線(J4 四道、J5 五道、J6 六道),裁到所需長度並接到該驅動器:A+ 黑、A- 綠、B+ 紅、B- 藍。
- 純綠色極限開關線的 Teensy 端子:J4 端子 29、J5 端子 30、J6 端子 31。藍色編碼器線對的 Teensy 端子:J4 為 20(純色)與 21(條紋),J5 為 22 與 23,J6 為 24 與 25。J4 與 J5 的綠色條紋線剪掉不用。J6 的則不剪:將它從托盤下方繞回,作為伺服夾爪的訊號線。
- 每個編碼器的純棕色線焊到 Dupont 5 V 引線中各自的一條線上(J4 第一條、J5 第二條、J6 第三條)。其棕色條紋線(GND)與橙色線對接到 2x12 端子台。手冊文字給 J4 與 J5 的是相同端子(GND 接第 2 個,橙色接第 3 與第 4 個),J6 則是 GND 接第 6 個、橙色接第 7 與第 8 個。請依照片操作,並用三用電表檢查 GND 線接到 B、純橙色線接到 A(+3.3 V)。
- 將另外佈線的 J5 極限開關橙色線對與綠色線,沿著 J5 線纜一起佈線。
8.8 完成外殼
整理配線,裝上按鈕,並合上托盤與上蓋。
- 使用兩條小束線帶:一條綁住 5 V 編碼器電源線,一條綁住外殼前方的線。
- 將伺服夾爪的紅黑電源線與白綠條紋訊號線塞進底座外殼底部。若有佈氣管,將 4 mm 氣管從後方檢修孔拉出。
- 在托盤角落以兩顆 #6 自攻成型螺絲將托盤固定到底座外殼上。
- 將 PBS-110 按鈕裝在外殼上蓋。將其紅線接到 Teensy 轉接板的端子 39,黑線接到 GND 端子。配線圖將它標為緊急停止(E-stop)按鈕。將線塞到上蓋下方,並以四顆 #6 自攻成型螺絲將上蓋固定到托盤上。
9. 韌體與控制軟體
AR4 由執行 Annin 韌體的 Teensy 4.1 驅動,並由 PC 上的 Python 桌面程式控制。另一片小型 Arduino 板負責夾爪與 5 V 輸入輸出。
9.1 了解控制器
機器人由 Teensy 4.1 驅動;它不是 Arduino Mega。
- Teensy 4.1 以 3.3 V 運作,腳位有限,因此手冊只用它來控制機器人運動。
- Annin 的 README 指出控制器是 Teensy 4.1。在任何 AR4 手冊或目前的軟體中,Arduino Mega 都不是 AR4 的控制器。
9.2 安裝選配的輔助輸入輸出板
一塊 5 V Arduino Nano 或 Arduino Mega 負責處理夾爪、繼電器與其他周邊裝置,因此只有在使用這些裝置時才需要。
- 原專案的說明指出,Arduino 板以 5 V 運作,較適合 I/O 與繼電器,而 Teensy 只負責機器人運動。
- 使用 Nano 時,輸入為腳位 2 到 7,輸出為腳位 8 到 13,伺服腳位為 A0 到 A7。
- 使用 Mega 時,輸入為腳位 0 到 27,輸出為腳位 28 到 53,伺服腳位為 A0 到 A7。
- 兩份目前的 sketch(版本 2.0)都需要 ArduinoJson 函式庫。其自身的註解寫伺服排針使用 A0 到 A6,與上述的 A0 到 A7 不同。
- 手冊第 4 與第 5 章列出夾爪零件與配線,包括氣動夾爪 I/O 外殼用的 24 V 8 A 電源變壓器。
9.3 將韌體載入 Teensy
將 Annin 最新的 AR4 Teensy 4.1 sketch 燒錄到板子上。
- 手冊要你安裝最新的 AR4 Teensy 4.1 sketch,並指出 Arduino IDE 需要 ModbusMaster 與 ArduinoJson 函式庫。目前的 sketch 已包含這兩者。
- 目前的 sketch 是 AR4_teensy41_sketch_v8.1,其版本紀錄中的日期為 2026 年 10 月 30 日。它位於 Annin 的 ar4-hmi 儲存庫的 sketches 資料夾中,下載封存中也有 AR4_teensy41_sketch_v8.1.zip。MK5 手冊早於它;其霍爾效應校正是在 sketch 6.8 加入的。
- 手冊指出載入方法請看其啟動影片,若電路板無法連到軟體,請參考 PJRC Teensy 疑難排解頁面。
- sketch 開頭說明其運動學求解器與 PC 程式(ARrobots/src/kinematics.cpp)共用,兩者必須保持同步。請使用同一版本的 sketch 與控制軟體。
9.4 安裝並執行控制軟體
控制軟體是一個 Python 桌面程式,透過 USB 序列埠與 Teensy 通訊。
- Annin 的 README 建議使用 Windows 10 或 11 x64,從原始碼執行時也支援 Linux 與 macOS。在 Linux 上還要安裝 wmctrl。
- 取得 v8.1 版本的 ar4-hmi 儲存庫,可視需要建立虛擬環境,然後執行 pip install -r requirements.txt 與 python AR4.py。
- README 寫 Python 3.11 到 3.12;同一儲存庫中的 readme.txt 寫 Python 3.14.6,而 requirements.txt 列出了 README 沒有提到的函式庫。請參見本草稿所記的矛盾之處。
- README 要你切換到名為 Control Software 的資料夾,但 v8.1 中沒有這個資料夾:AR4.py 位於儲存庫最上層。
- 要找出 Teensy 的序列埠,在 Windows 上用裝置管理員,或執行 python -m serial.tools.list_ports。Python 程式介面對 Teensy 使用 115200 鮑率,對 Nano 使用 9600 鮑率。
10. 啟動、檢查與校正
MK5 手冊第 8 章。在裝上 J6 夾爪座之前先完成第一次寸動檢查,因為組裝時需要將 J5 往下寸動。
10.1 通電前檢查配線
通電前,依接線圖檢查每一個連接。
- 通電前,依配線圖再次檢查所有連接。檢查每個馬達、編碼器與極限開關的所有線與連接器是否導通。
- 手冊強調,連接器務必仔細壓接或焊接,並用電壓表檢查。
10.2 啟動軟體並檢查通訊
載入 sketch,啟動控制軟體,並確認它回報已連線到 Teensy。
- 依照 Annin 的啟動影片,安裝最新的 Teensy sketch 並載入控制軟體。
- 在手冊所用的軟體版本中,記錄畫面會顯示 COMMUNICATIONS STARTED WITH TEENSY 4.1 BOARD,主控制畫面頂端的系統訊息會顯示 SYSTEM READY。v8.1 中的文字尚未確認。
10.3 寸動每顆馬達並檢查方向與距離
在軟體中關閉編碼器,將每個關節往兩個方向各寸動一點,確認轉動方向與轉動量正確。
- 在 Config Settings 分頁,先勾選停用所有編碼器的選項,讓編碼器故障不會干擾馬達檢查。
- 在主控制畫面上,將寸動步距設為 10,依序對每個關節按正與負。
- 若馬達完全不動,檢查馬達電源配線(A+、A-、B+、B-、線纜、底座插頭),再檢查從 Teensy 到該驅動器的脈衝線。若馬達只往一個方向動,檢查從 Teensy 到該驅動器的方向線。
- 務必確認每個驅動器的 OPTO 端子有 3.3 V。那裡接觸不良可能讓關節暴衝、行為非常怪異。
- 依手冊的圖,檢查每個關節按正與負時都往正確方向轉。A+ A- B+ B- 接錯可能讓馬達反轉。若你使用不同的驅動器,檢查其方向 DIP 開關。
- 用角度規檢查距離:在關節的平面上將角度規歸零,寸動 10 度,檢查是否移動了 10 度。若沒有,先檢查驅動器的微步設定。手冊也警告 J1 與 J3 的馬達可能會被裝反。
10.4 寸動 J5 並完成 J6 安裝座
J6 夾爪安裝座與極限開關要等 J5 往下寸動之後才裝上。
- 手冊在這裡中斷組裝。先看完啟動章節的前三頁,確認每個關節都能寸動,然後將 J5 寸動到約 45 度。小心將極限開關及其線從手臂中往上送,不要夾到。
- 若因為尚未校正而出現關節超出範圍的錯誤,在 Config Settings 分頁按 Force Cal to Rest,它會將校正強制設為零,讓你能繼續寸動。
- 用一條小束線帶將 J6 極限開關線固定到 J6 馬達與編碼器線的根部,不要太緊,並用柔軟的黑色布質線束膠帶包住 J6 的線。
- 用兩顆 M2.5x6 盤頭螺絲將 J6 極限開關座裝到 J6 外殼上,再用兩顆 M2.5x8 盤頭螺絲將 J6 極限開關裝到座上。
- 用兩顆 M2.5x8 盤頭螺絲將 J6 限位觸點裝到 J6 夾爪座上。對齊 J6 馬達軸上的鍵槽與鍵,用一顆 M4x10 止付螺絲裝上夾爪座,限位觸點朝後。若你要安裝伺服或氣動夾爪,請等到夾爪準備好再裝,因為安裝夾爪時必須拆下這個座。
10.5 測試極限開關與霍爾感測器
執行 Annin 的測試程式,確認六個歸零感測器都正確回報。
- 在程式視窗中輸入 test limit switches,按 Load Program 再按播放。畫面底部的手動輸入欄會為每個關節顯示 0 或 1。
- 用手按下 J4、J5 與 J6 極限開關,並小心將 J1、J2 與 J3 驅動到其霍爾效應感測器處,檢查每一個的狀態都有改變。
- 你可能需要沿長槽孔螺絲調整每個感測器座的位置。如同組裝前期對 J2 的做法,暫時通電並以相同方式調整 J1 與 J3,彎曲感測器頭的引腳,讓它每次都能可靠觸發。
- J4 定時螺絲:關閉機器人的 24 V DC 電源,轉動 J4 直到 M3x6 圓頭螺絲碰到極限開關,再將螺絲鎖進或退出,讓開關被觸發。用手轉動 J4 時,檢查測試程式中的 J4 訊號會變高。
10.6 測試編碼器
執行 Annin 的編碼器測試,確認每個編碼器在兩個方向都能計數。
- 在 Config Settings 分頁取消勾選停用編碼器的選項。載入編碼器測試程式並按播放。訊息會為每個關節顯示 1000。
- 關閉控制箱的電源,切斷馬達的電,但不要拔掉 Teensy 的 USB。用手朝兩個方向轉動每顆馬達,檢查顯示的數值會增減。1000 與計數值都是任意的。
- 若編碼器朝哪個方向都沒有反應,重新檢查所有配線。
- 重新開啟控制箱電源,寸動每個關節。檢查沒有出現關節碰撞或位置偏離警報,且每個關節的位置讀數合理。
10.7 校正每個關節
一次校正一個關節,再以校正偏移量修正剩餘的誤差。
- 在 Config Settings 分頁,對每個關節按 Calibrate joint only。它會移動到其極限開關或感測器處完成校正,然後回到零點。
- 若校正後某個關節偏離零點,在該關節的校正偏移值視窗中輸入誤差,按 save 並再次執行校正。手冊的例子:校正 J1 與 J2、讓 J2 正好位於 90 度後,數位水平儀上 J3 讀數為 0.8 度,因此輸入 -0.8,之後該關節便校正到零點。
- 保持工作範圍淨空,並從低速開始。Annin 2026 年的 Python 指南警告,校正會引起動作,且軟體停止指令不能取代實體緊急停止或安全迴路。
10.8 將機器人固定到工作台面
組裝完成後,將底座以螺栓鎖到桌上。
- 以 M8 或同等級的扣件與墊圈穿過底座的四個安裝孔,將機器人固定在工作台上。作者在桌面上使用 M8 螺紋埋入件與 M8x50 螺栓。
- 手冊接著指向 Annin 教學頁面上的教學影片。
11. 將 MK4 機器人升級為 MK5 感測器(關節 1 至 3)
適用於已有 MK4 機器人的人。Annin 另外的升級手冊將關節 1、2、3 的極限開關換成霍爾感測器與磁鐵。這份文件早於 MK5 手冊 1.1,後者之後更新了 J3 感測器座與 J1 感測器座的螺絲長度,因此兩者不同之處,請以 MK5 手冊本身的 J1 至 J3 頁面為準。
11.1 備齊更新所需零件
列印替換用的感測器座與磁鐵座,並備齊扣件、感測器與磁鐵。
- 列印件,皆以 PETG、15% 填充、2 層牆列印:MK4 to MK5 J1 感測器座(2 個)、J2 感測器座(2 個)、J3 感測器座(2 個)、J1 磁鐵座、J3 磁鐵座與 J2 線材固定座。MK4 to MK5 J2 張力環以 ABS-GF、100% 填充、4 層牆列印(4 個)。
- 扣件與其他物品:6 顆 M3 x 10 盤頭螺絲、6 顆 M1.6 x 4 盤頭螺絲、4 顆 M4 x 8 盤頭螺絲、4 個 M4 塑膠用熱壓螺紋埋入件、一個 M8 轉 M4 變徑埋入件、3 個霍爾效應感測器(3144,3.3 V)、3 顆 4 mm x 4 mm 圓形磁鐵、3 條 Dupont 2.54 mm 母頭 3-pin 連接器引線,以及寬 2.5 cm、長 30 cm 的 EMI 屏蔽膠帶。
- 你還需要一個磁極測試器、一個小十字起子頭、一把一字螺絲起子、一個熱壓埋入工具、一支烙鐵與熱縮套管。
11.2 剪任何線之前先拔下 USB
剪斷或焊接任何感測器線之前,先拔下機器人的 USB 纜線。
- 手冊要你在剪斷 J1 極限開關線之前,確認接到機器人的 USB 線已拔掉。在處理三個關節的配線期間都保持拔除。
- 只有在進行下述感測器測試時才插回 USB 線,測試後再拔掉。
11.3 裝上 J1 感測器與磁鐵
在新的 J1 感測器座上以霍爾效應感測器取代 J1 極限開關,並在轉台平台下方的 J1 磁鐵座上裝一顆磁鐵。
- 將兩顆 M1.6 x 4 螺絲鎖入 J1 感測器座後再取出,讓孔在裝入感測器前先攻好螺紋。
- 拆下原本的 J1 極限開關並放在一旁。用兩顆 M3 x 10 螺絲裝上新的 J1 感測器座。這個狹窄的位置需要用小十字起子頭。用兩顆 M1.6 x 4 盤頭螺絲裝上霍爾效應感測器。
- 剪斷 J1 極限開關的三條線,焊到一條 Dupont 2.54 mm 3-pin 連接器引線上並套上熱縮套管。綠線接右側端子,橙線接中間端子,黃線接左側端子。
- 將編織套管盡量往後拉,並用夾子固定。在感測器引線上纏一段 12 cm 的 EMI 屏蔽膠帶。將 Dupont 連接器插到感測器上,綠線端子在右側。
- 磁極方向很重要。將一顆 4 mm x 4 mm 磁鐵放在一字螺絲起子的尖端,用磁極測試器確認 N 極朝外。將它壓入 J1 磁鐵座,再確認此時座上朝外的是 S 極。
- 拆下並丟棄原本用來觸發舊極限開關的 M8 內六角螺絲。用小一字起子頭裝上 M8 轉 M4 螺紋轉接件。用十字起子頭將 J1 磁鐵座固定在 J1 轉塔平台的底面,磁鐵的 S 極朝下。
11.4 裝上 J2 張緊環、感測器與纜線固定座
拆下 J2 馬達,將 J2 張緊環換成新的、裝有磁鐵的列印件,再裝上 J2 感測器與纜線固定座。
- 鬆開 J2 馬達軸上的 M3 止付螺絲。手冊的做法是拆下 J3 馬達以碰到它,或用彎成適當形狀的 M1.5 六角扳手。
- 拆下將 J2 馬達座固定在 J1 平台上的三顆 M6 平頭螺絲。用寬頭沖子與木槌小心敲擊馬達軸,讓馬達開始脫出,然後將馬達放在一旁。
- 拆下原本的 J2 張力環,保留其 M3 扣件與 M4 止付螺絲。用熱壓埋入工具將四個 M4 熱壓螺紋埋入件壓入新的張力環。
- 讓磁鐵座的凸耳朝下並伸出工作台邊緣,用一字螺絲起子將一顆 4 mm x 4 mm 磁鐵壓入凸耳,並用測試器確認 S 極朝外。
- 用先前拆下的六顆 M3 平頭螺絲裝上新的張力環。將四顆 M4 止付螺絲裝入螺紋埋入件並鎖緊,為 J2 軸承施加適度的張力。
- 用兩顆 M3 x 10 圓頭螺絲將 J2 感測器座裝到 J2 轉台外殼上,再用兩顆 M1.6 x 4 圓頭螺絲裝上霍爾效應感測器。
- 剪斷舊 J2 極限開關的線並將其丟棄。將三條線焊到一條 Dupont 接頭線上並套上熱縮套管:綠色條紋線接右側端子,橘色線接中間端子,橘色條紋線接左側端子。
- 在感測器導線上貼一段 8 cm 長的 EMI 屏蔽膠帶,並將接頭插到感測器上,綠線端子在右側。
- 測試感測器:將 USB 線插回機器人底座,用手將手臂轉回,並確認磁鐵到位時感測器會亮。必要時調整感測器座的螺絲,然後拔下 USB 線。
- 裝回 J2 馬達,並將其馬達座固定到 J1 平台上。將兩條大束線帶穿過列印的 J2 線材固定座,用兩顆 M4 x 8 圓頭螺絲將固定座裝到 J1 平台上,將 J2 與 J3 線沿其中央放置,用束線帶固定並修剪末端。
11.5 裝上 J3 感測器與磁鐵
以霍爾效應感測器取代 J3 極限開關及其列印安裝座,並將磁鐵座固定到 J4 馬達座上。
- 拆下先前的 J3 極限開關,剪斷其線,並將開關及其列印座丟棄。
- 先將兩顆 M1.6 x 4 螺絲預鎖入 J3 感測器座再取出。用兩顆 M3 x 10 螺絲裝上感測器座,再用兩顆 M1.6 x 4 圓頭螺絲裝上霍爾效應感測器。
- 依與 J2 相同的順序,將 J3 極限開關的三條線焊到一條 Dupont 接頭線上並套上熱縮套管:綠色條紋線接右側端子,橘色線接中間端子,橘色條紋線接左側端子。
- 將編織套管往回拉,並用夾子固定。在感測器導線上貼一段 10 cm 長的 EMI 屏蔽膠帶,並將接頭插到感測器上,綠線端子在右側。
- 將一顆 4 mm x 4 mm 磁鐵壓入 J3 磁鐵座,並用測試器確認南極朝外。
- 將 J3 磁鐵座固定到 J4 馬達座上:可以用磁鐵座當模板,在 J4 馬達座上標記、鑽孔並攻 M3 牙,再用 M3 扣件固定;或者用黏著劑固定。
11.6 更新之後
執行機器人之前,先閱讀手冊的啟動章節。
- 更新手冊的最後,要你複習組裝手冊中關於機器人啟動的章節,以及 Annin 教學頁面上的教學影片。