da Vinci Research Kit (dVRK) 組裝指南
用於控制退役 da Vinci 手術機器人的開放電子、韌體與軟體
授權條款
- software (sawIntuitiveResearchKit, dvrk-ros, cisst): JHU CISST Software License 1.0
- robot models (jhu-dvrk/dvrk_model): MIT
混合授權。軟體(sawIntuitiveResearchKit、dvrk-ros 與 cisst 函式庫)採用 JHU CISST Software License 1.0,而不是 MIT:可以使用、複製、改編、展示與散布,也可用於商業用途,前提是每一份副本都依 JHU 的前言附上完整條款、保留致謝並標示修改,且不得以 JHU 的名義推廣產品。jhu-dvrk/dvrk_model 中的機器人模型採用 MIT。JHU 表示其軟體僅為研究而設計,不建議用於臨床。查核日期:2026 年 11 月 3 日。
組裝指南
1. 了解套件並取得一套
dVRK 是什麼、原專案的免責聲明、da Vinci 手臂與 dVRK 控制器的來源,以及需自行購買的 PC 與額外零件。
1.1 閱讀原專案的免責聲明
在任何設定工作開始之前,原專案的四項警告適用於每一台 dVRK。
- 絕不可將 dVRK 用於病患:原專案表示它未經 FDA 核准。
- 不提供任何保固:dVRK 的軟體、韌體與硬體完全不附任何保固。
- 組裝的規劃:dVRK 不是開箱即用的系統,需要花時間設定。
- 操作它需要具備一些軟體、機構與機器人方面的知識。
- 不要把 dVRK 等同於 da Vinci:兩者共用機構零件,但電子與軟體不同。
1.2 辨識套件的三個部分
dVRK 結合了退役的 da Vinci 硬體、開源的 JHU 控制器與軟體,以及你自行購買的 PC。
- dVRK 是開源的電子、韌體與軟體,用於控制以 Intuitive Surgical 退役的 da Vinci 系統打造的研究系統。
- 第一部分是來自退役 da Vinci 系統的機械手臂與其他硬體(內視鏡、立體顯示器)。
- 第二部分是控制器、軟體,以及來自 Johns Hopkins University dVRK 團隊的部分支援,全部開源。
- 第三部分是 Linux PC,需由你自行挑選與購買;dVRK 控制器不附帶 PC。
- PC 與硬體的安裝、設定與校正由 dVRK 擁有者執行。
- 你的套件可能與其他人的不同,因為每個 dVRK 團隊收到的硬體可能不一樣。
1.3 取得 da Vinci 手臂與 dVRK 控制器
原專案列出各團隊取得退役 da Vinci 零件的管道,以及如何取得控制器。
- 大多數 dVRK 團隊透過 Intuitive Foundation(https://www.intuitive-foundation.org/dvrk/)取得退役機器人。
- 有些團隊直接從醫院回收退役的 da Vinci;也請一併保留器械與其他拋棄式零件。
- 完整的 da Vinci 系統或零件也能在 eBay 等拍賣網站上以合理的價格找到。
- 如果你是透過 Intuitive Foundation 取得,他們會協助你取得控制器;否則請聯絡 dVRK 開發者。
- 你可以依開源設計自行製造控制器,但原專案稱這是困難得多的做法。
- 其他所有東西(電腦、線材、顯示器、支架)請自行購買;所有設計、韌體、軟體與文件都在 GitHub 上。
1.4 辨識你的控制器組裝版本
電路板序號可告訴你手上的控制器屬於哪一種組裝版本,之後的步驟會依此而定。
- 讀取每塊 FPGA 與 QLA 板上的白色 S/N 貼紙;序號的格式為 BBBB-xx 或 BBBB-xxx,其中 BBBB 是批次編號。
- 在原專案的表格中查詢該批次:dVRK Classic 手臂控制器(CA0 至 CA10)、dVRK-Si 手臂控制器(SA1、SA2)與 dVRK Classic SUJ 控制器(CS0、CS1)。
- 所有控制器都附有 FireWire 介面卡。
- 乙太網路介面卡於 FPGA 2+ 引入,即批次 5(2016)。
- 對 Si 系統而言,SUJ 支援來自擴充板(dSIB-Si 與 dSIB-Z-Si),這些擴充板沒有另外追蹤。
- 查看本頁連結的 FPGA、QLA 與 dRAC 版本說明;有些批次需要修改硬體。
1.5 選擇 Linux PC 及其轉接器
原專案對驅動控制器的 PC、其 FireWire 與乙太網路轉接器,以及作業系統的建議。
- 至少使用一台執行 Linux 的 PC;若你要建置影像管線,或在 dVRK 之外同時執行繁重的運算,原專案強烈建議使用兩台以上。
- 在另一台 PC 上執行 ROS bag 資料收集,不要用 dVRK PC。
- 對連接控制器的 PC,原專案建議至少 8 核心(最好支援超執行緒)、至少 16 GB RAM(建議 32 GB),以及 SSD。
- 裝上 FireWire 介面卡(必要),最好是採用原生 PCIe FireWire 晶片組的卡;避免使用經由 PCI 轉 PCIe 橋接器的 PCI 晶片組。
- 原專案列出 SYBA Low Profile PCI-Express FireWire 與 SIIG NN-E20012-S2 為良好的介面卡,StarTech pex1394a2v2 則為不佳的介面卡。
- 如果你打算以乙太網路連接控制器,請加裝第二張 乙太網路介面卡;優先選擇 PCIe,若用 USB,至少要 USB3。
- 如果你使用 NVIDIA 顯示卡,請正確安裝 NVIDIA 的驅動程式:nouveau 驅動程式容易干擾 FireWire 通訊;用 nvidia-smi 檢查。
- 對 dVRK 2.4 與 main,原專案建議在 Ubuntu 24.04 上使用 ROS 2 Jazzy;Ubuntu 22.04 上的 Humble 與 Ubuntu 20.04 上的 Galactic 也有列出。
1.6 備齊額外零件
原專案要你購買的纜線、SD 讀卡機與顯示器選項。
- 使用控制器隨附的 FireWire 線。
- 若需要更多或更長的線,原專案強烈建議使用 UniBrain FireWire-400 A 對 A 線(6 針對 6 針)。
- 避免使用來路不明的 FireWire 線;原專案警告這些線會讓你花很多時間除錯連線問題。
- 若要使用原廠的 Classic 或 S 腳踏板,請購買 DB15 延長線。
- 2024 年之後推出的控制器(以 dRAC 或 DQLA 為基礎)從 SD 卡載入韌體;請在你的 dVRK Linux PC 上準備一台 SD 讀卡機。
- 若需要立體顯示,可使用 Goovis 等頭戴式顯示器。
2. 配置安全鏈(緊急停止)
原專案表示硬體設置取決於各單位自己的硬體,但有一個例外適用於所有 dVRK:控管馬達電源的緊急停止安全鏈。
2.1 了解安全鏈的作用
每個連接中的控制器,其馬達電源都取決於一條閉合的安全鏈。
- 安全鏈必須保持不中斷(電氣上閉合),所有已連接控制器箱中的馬達電源才會啟用。
- 如果鏈上任何裝置中斷了導通,所有已連接箱子中的所有馬達電源都會停用。
- 鏈上的裝置包括手動開關(例如緊急停止按鈕)以及電腦控制的繼電器。
- 每個控制器箱的兩塊 QLA 板上各有一個安全繼電器,另外還有一個用於馬達電源的 AC Input Relay。
- 原專案已將所有控制器箱統一為一個 4 針與一個 5 針的安全連接器。
- 如果你的箱子沒有這些連接器,請用 https://github.com/jhu-dvrk/dvrk-estop-retrofit 的改裝套件升級。
2.2 連接模組化緊急停止鏈
原專案建議使用由緊急停止纜線、延長線與終端插頭組成的模組化鏈。
- 使用模組化(可重新配置)的緊急停止鏈;原專案建議用它取代一體式的鏈。
- 將緊急停止開關的 E-Stop Cable 接到某個控制器箱的 5 針連接器。
- 每再加一個箱子,就用一條 Extension(Daisy-Chain)Cable,從一個箱子的 4 針連接器接到另一個箱子的 5 針連接器。
- 將 Termination Plug 插在其中一個箱子的 4 針連接器上。
- 4 個菊鏈串接箱子的完整配置使用 1 條 E-Stop Cable、3 條 Extension Cable 與 1 個 Termination Plug。
- 若要自製更多纜線,原專案列出的材料為任何 2 芯加接地線的 AWG 22 纜線,以及 Digikey 277-1013-ND(Phoenix 1757035,4 針)與 277-8670-ND(Phoenix 1752399,5 針)連接器。
2.3 檢查 Build #4 控制箱與接地
原專案的兩項提醒:Build #4 纜線若接反可能繞過繼電器,且整個系統應共用 GND。
- Build #4 控制器箱有兩個 5 針安全連接器。
- 在這些箱子上,Extension Cable 並非直通線,因此連接方向很重要。
- 接反會導致部分安全繼電器被旁路。
- 將系統中所有元件的 GND 相連;在 5 針安全連接器上,GND 位於針腳 2。
- 在只有 4 針連接器的箱子上,GND 可透過機殼上的螺絲連接;請見 dvrk-estop-retrofit 的說明。
2.4 若馬達電源無法開啟,以 qladisp 除錯
原專案針對馬達無法通電的控制器箱所提供的測試程序。
- 先測試一個箱子:將其 QLA 繼電器旁路,但緊急停止開關仍留在鏈中,做法是經由緊急停止開關將 +12V 接到 EN。
- 將修改過的連接器接到箱子上,執行 qladisp 0 1(以 MTML 箱為例),然後按 p 開啟電源。
- mv-good 與所有放大器應該會開啟;若沒有,請檢查電源系統的實體連接。
- 接著測試 QLA 繼電器在迴路中的箱子:E-Stop Cable 接在 5 針連接器、Termination Plug 接在 4 針連接器,然後執行 qladisp 0 1 並再次按 p。
- 如果電源仍無法開啟,請使用三用電表:每個 QLA 繼電器上的測試點 T1 與 T2,在繼電器關閉時應為開路,開啟時應為短路(你應該會聽到喀噠聲)。
- 如果 T1 與 T2 的行為不是這樣,請聯絡 dVRK 維護者。
- 也請檢查兩個繼電器是否串聯,以及 E-STOP 端子的連接是否正確。
3. 設置 Classic 手臂與控制器
適用於 da Vinci Classic(以及 Classic 或 S 外科醫師控制台)硬體:開箱、安裝、手臂纜線,以及 QLA 散熱片升級。若你的完整控制台或病患推車已涵蓋安裝步驟,請略過。
3.1 拆箱 Intuitive 元件(Classic)
從 Intuitive Surgical 收到新元件時,原專案建議的檢查項目。
- 閱讀 Intuitive 的開箱文件(research.intusurg.com 上受密碼保護的頁面)。
- 保留運送用的箱子,並詢問 Intuitive 是否需要退回。
- 在 Classic PSM 上,確認手臂可以自由移動:如果軟罩下方有白色的 Delrin 運輸支架,請將其移除。
- 目視檢查是否有明顯損傷,例如 PSM 或 MTM 上的纜線斷裂。
- 盡快在連接器上標註手臂名稱、板子 ID 及/或序號。
3.2 檢查並標示 Classic 控制器
不要混用 MTM、PSM 與 ECM 控制器,運送後也要檢查每個控制箱內部。
- 不要混用三種控制器類型:MTM 控制器前 4 個致動器使用 24V、後 3 個使用 12V,PSM 控制器全部 7 個都使用 24V,而 ECM 控制器以單一 36V 電源供應 4 個馬達與 3 個煞車。
- 打開每個控制器以確認其類型。
- 在每個控制器的前後兩面標註手臂名稱與板子 ID,例如 MTMR(板子 ID 2 - 3)。
- 第一次開箱時,檢查內部連接,並重新插好任何鬆脫或半脫落的纜線。
- 如果你不放心自己重新插接纜線,請聯絡 dVRK 維護者。
- 將所有控制器插到同一條附開關的延長線插座上。
3.3 如果沒有外科醫師主控台,將 MTM 裝到機架上(Classic)
僅適用於沒有原廠外科醫師主控台,或要取代它的團隊。
- 如果你有完整的外科醫師控制台,請略過此步驟。
- 將 dVRK 控制器放在非常靠近控制台的位置:從 MTM 引出的纜線相當短。
- 每個 MTM 都附有一個具 4 個安裝孔的鋼製支架;在 JHU,它與 8020 框架上的鋁板結合。
- 如果你要從零打造推車,原專案推薦 Vanderbilt 的設計;其物料清單(PDF)與 IdeaBuilder 設計檔(JSON)都在這個頁面上。
- 更多安裝框架範例請見 Intuitive Research Wiki(需要帳號)。
3.4 將 Classic PSM 裝到自訂機架上
僅在你沒有完整病患推車時;擺放 PSM 時要避開關節極限。
- 如果你有完整的病患推車,請略過此步驟,因為 PSM 安裝在 SUJ 上。
- 使用 PSM 黑色橫桿底部的 4 個孔,它們構成一個 2 英吋見方的正方形;若要剛性安裝,請在 80-20 標準板上鑽孔並攻出 4 個螺紋孔。
- 仔細擺放每個 PSM 的位置:它的工作範圍相當有限,因此要避免撞到實體關節限位。
- 理想情況下,在零點位置時,器械軸應與病患表面的法線對齊。
- 理想情況下,將所有 RCM 點(PSM 與 ECM)置於病患表面上;RCM 點位於套管上那條大黑色環帶附近。
- 每個 PSM 使用一個球型雲台座,即可適應所有底座方向;有些團隊使用 Really Right Stuff BH-55 球型雲台。
3.5 將 Classic ECM 裝到自訂機架上
僅在你沒有完整病患推車時。
- 如果你有完整的病患推車,請略過此步驟,因為 ECM 安裝在 SUJ 上。
- 將 ECM 安裝在向前傾斜 45 度的板上,與臨床系統相同。
- 依照 PSM Classic 關於 RCM 點的安裝說明來定位 ECM。
3.6 安裝 Classic SUJ 控制器
dVRK SUJ 控制器裝在病患推車直立柱的背面。
- 將 dVRK SUJ 控制器安裝在推車垂直立柱的背面,使用外殼上與既有螺絲孔對應的 4 個孔。
- 拆下原有的板子。
- 不要動那 4 條細的灰色線材:它們連接量測 SUJ 上下平移的電位器。
- 在立柱與控制器之間使用墊片,以免壓壞線材。
- 連接 SUJ 接頭;將 SUJ-PSM1 與 SUJ-ECM 線材從控制器下方穿過。
3.7 將每支 Classic 手臂接到其控制器
每支 Classic MTM、PSM 與 ECM 都有一個大型 ITT Cannon 156 接頭,必須鎖緊。
- 連接手臂引出、帶有 ITT Cannon 156 接頭的粗線材;對於 Classic MTM、PSM 與 ECM,這是唯一需要連接的線材。
- 不要硬插接頭:它是零插入力(ZIF)接頭。
- 用大號一字螺絲起子轉動後殼上的螺絲來鎖定:最多轉四分之一圈,順時針鎖定,逆時針解鎖。
- 警告:手臂接頭沒有鎖定會造成接觸不良,使手臂無法正常運作。
- 拔下接頭前先將其旋鬆。
- 將 MTM 控制器放在外科醫師控制台上或旁邊;若放在旁邊,原專案建議放在左側,以免線材彎折過緊。
- 將 SUJ 直接連接到 dVRK SUJ 控制器,不要經過原本從推車到控制台的長線材;完成後推車底座的所有接頭都應是空的。
3.8 為較舊的 Classic 控制器升級 QLA 散熱片
早期的 Classic 與 Classic SUJ 控制器若沒有加裝散熱片與風扇,容易過熱。
- 這只適用於舊款 Classic(FPGA V1 或 V2)或 Classic SUJ 控制器,且僅限尚未有人升級過的情況。
- 對於 ECM 與 SUJ 控制器,被動散熱絕對不夠:請加裝額外的散熱片與風扇。
- MTM 與 PSM 控制器可正常運作約半小時;若要長時間使用,原專案強烈建議加裝散熱片與風扇。
- 從 QLA 的 2 針 12 V 連接器為風扇供電,馬達電源開啟時這些連接器就會有電。
- QLA S/N 4265-xx 使用公制 M3、8 mm 螺絲,其他所有 QLA 則使用英制 4-40、3/8 inch 螺絲。
- 原專案發現,單一個 Pentium Socket 370 散熱片加風扇效果很好,例如 StarTech FANP1003LD。
4. 設置 Si 手臂與控制器
適用於搭配 dVRK-Si 控制器的 da Vinci Si 病患端手臂(PSM、ECM),可裝在客製框架上,或原本的 Si 病患推車(SUJ)上。dVRK 不支援 Si/Xi 外科醫師控制台。
4.1 將 Si PSM 與 ECM 裝到自訂機架上
僅在你沒有完整的 Si 病患推車,或要拆下、更換手臂時。
- 如果你有完整的 Si 病患推車,除非打算拆下或更換手臂,否則可略過此步驟。
- 要從 SUJ 上拆下手臂,先取下它的 4 根長螺栓,再沿著內壁的兩道溝槽將其滑出。
- 拆下主動手臂時,SUJ 被動臂因為配重的關係,即使有煞車仍容易往上抬;請將它綁固在推車底部。
- 如果手臂已折起而搆不到螺栓,可以在煞車作用下強行移動它,但不要經常這樣做。
- 向 Intuitive Surgical 索取安裝支架(多數為鋼製,來自舊的臨床系統),以製作你自己的安裝座。
- 框架設計請參考 Intuitive Research wiki 頁面,以及本頁連結的 Onshape CAD 與物料清單。
4.2 在沒有 SUJ 的情況下連接 Si 手臂
裝在自訂機架上的手臂,以兩條客製 D-sub 纜線連接到 dVRK-Si 控制器。
- 對於沒有 SUJ 的系統,請使用兩端皆為 D-sub 連接器的兩條客製線材:一端插到手臂,另一端插到 dVRK-Si 控制器。
- 將連接器從安裝支架底部的開口空間穿過。
- 連接器不用螺絲也能固定,但由於線材很重,請加上應力消除。
- 若使用原廠病患推車(SUJ),手臂連接器無法觸及;訊號改經由 SUJ 內部配線與一片 dSIB-Si 板傳遞。
4.3 為 dVRK 控制器準備 Si 病患推車
移除推車的原廠電子元件,但保留 dSIB 所需的纜線。
- 警告:將 dSIB-Si 直接連接到以 dRAC 為基礎的控制器;不要在 dSIB 與控制器之間使用客製手臂線材,因為這些線材並未傳遞 SUJ 與 ESSJ 所需的全部訊號。
- 注意:Si 推車一旦改裝成使用 dVRK 控制器,雖然仍可以改回原廠控制器,但會非常困難。
- 拆下兩件式背蓋:先卸下 2 顆螺絲(3/16 六角扳手),再撬開其強力壓扣。
- 拔下頂部的 Z-AXIS 線(捏住卡榫),並保留給 dSIB-Z-Si 使用;這是唯一一條需要、但沒有插在 RAC 上的線。
- 從前方的 4 個 RAC 上,分別取下標示為 SJA2、SJX、SJC 與 SJA1 的線,依序給 PSM2、PSM3、ECM 與 PSM1 的 dSIB 使用;將每支手臂的線材綁成一束並標示(2 個白色集束連接器、一條 2 芯黑色線、一條用於 LVDS 的 FireWire B 線,以及一個接地環形端子)。
- 每個 RAC 上方的 FireWire 線(J10)與底部的線(J13)保留原處;這些不需要。
- 注意:PCB 背面的 J11 FireWire 線空間很小;拔除前請先將整個 RAC 從鋼板上拆下,以免損壞連接器。
- 拆除其餘的電子元件、支架與電池,讓肩部上方留出平面,以堆疊 4 台 dVRK-Si 控制器。
4.4 裝上 dSIB-Si 與 dSIB-Z-Si 板
dSIB 板將推車內部的 SUJ 配線連接到 dVRK-Si 控制器。
- 每台 dVRK-Si 控制器裝一片 dSIB-Si 板(完整系統共 4 片),直接安裝在控制器背面。
- 警告:dSIB 與控制器之間不要使用任何延長線。
- 將 SUJ 立柱底部的原廠線材插到各 dSIB 上;dSIB 也負責為 SUJ 煞車供電。
- 將 dSIB-Z-Si 連接到 SUJ 立柱上唯一的大型連接器;它會讀取全部四個平移軸的線性電位器。
- 將 dSIB-Z-Si 上 4 個已標示的序列埠連接到正確的 dSIB/控制器。
- 將控制器放在推車的低處,讓立柱的短線材能接到 dSIB。
- 在線材、控制器與電路板上標示手臂名稱,必要時也標示手臂序號。
5. 載入韌體
建議的 FPGA 韌體為 v10,向下相容所有 dVRK 控制器。Classic V1/V2 板需要燒錄,V3 板從 SD 卡開機,而 Si 手臂與 SUJ 則需要以 ESXX 燒錄器重新燒錄其 ESPM 與 ESSJ 板。
5.1 確認每塊電路板需要的韌體
原專案對內建韌體的電路板及其各自開機方式的總覽。
- 使用原專案建議的 FPGA 韌體 v10;它向下相容所有 dVRK 控制器。
- FPGA1394V1 與 FPGA1394V2 從 EPROM 開機;FPGA1394V3 從 SD 卡開機。
- Power Indicator 板(僅 Classic)從 EPROM 開機。
- ESPM(位於每支 Si PSM 與 ECM 中)與 ESSJ(位於 Si SUJ 中)以 ESXX 燒錄器重新燒錄,並從板載快閃記憶體開機。
- dSIB-Si 與 dSIB-Si-Z 板(附 SUJ 的 Si)從 EPROM 開機;請參考 https://github.com/jhu-dvrk/dSIB-Si-firmware 與 https://github.com/jhu-dvrk/dSIB-Z-Si-firmware。
5.2 升級 FPGA1394V1 與 V2 韌體(Classic)
較舊的 Classic 控制器依照 mechatronics-firmware wiki 進行升級。
- 對大多數使用者而言,透過 FireWire 升級即可。
- 若控制器已變磚,請使用 OpenOCD 搭配 JTAG 轉接器。
- 進階使用者與 FPGA 程式設計人員可以使用 Xilinx ISE。
- 請依照 mechatronics-firmware wiki 上的說明操作:https://github.com/jhu-cisst/mechatronics-firmware/wiki/FPGA-Program。
5.3 更新 FPGA1394V3 SD 卡(DQLA Classic 與 Si)
一個韌體 Zip 檔涵蓋所有 FPGA1394V3 控制器;載入程式會依檔名挑選正確的檔案。
- FPGA1394V3 用於 dVRK-Si PSM 與 ECM 控制器,以及較新的 DQLA MTM 控制器。
- 從系統中取出所有 SD 卡:dVRK Classic V3 控制器的卡槽在背面,dVRK Si 控制器的卡槽在正面。
- 執行 dVRK SD 卡更新程式 dvrk-sd-card-updater.py,這是 dVRK 軟體的一個工具程式(sawIntuitiveResearchKit core/applications/sd-card-updater)。
- 這個腳本會下載並解壓縮最新韌體、等待每張卡插入、將現有檔案移到備份目錄、安裝新檔案,然後卸載該卡。
- 不必重新啟動腳本,依序插入每張 SD 卡即可。
- 或者,從 https://github.com/jhu-cisst/mechatronics-embedded/releases/latest 下載最新的 Zip,解壓縮後將所有檔案複製到 SD 卡上。
- 如果控制器是透過乙太網路連接到 PC,也可以用 scp 更新 SD 卡。
5.4 準備 ESXX 燒錄器 SD 卡(Si)
ESXX 燒錄器會在設定過程中取代 ESPM 與 ESSJ 板上的 Intuitive 韌體。
- ESXX 燒錄器只在安裝設定時需要;請保留以供日後更新韌體使用。
- 從 https://github.com/jhu-dvrk/esxx-programmer-sd-content/releases 下載 sd_content.zip。
- 解壓縮後,其中有一個目錄 esxx_programmer/,內含 esxx_loader.rbf、espm.rpd 與 essj.rpd。
- 將 esxx_programmer/ 直接複製到已格式化為 FAT32 的 micro SD 卡根目錄。
- 將 micro SD 卡插入 ESXX 燒錄器。
- dvrk-sd-card-updater 腳本不處理這些檔案,該腳本僅適用於 FPGA1394V3 控制器的 SD 卡。
5.5 燒錄每支 Si PSM 與 ECM 中的 ESPM
每支與 dVRK 控制器搭配使用的 Si PSM 與 ECM 都必須進行,無論是否裝在 SUJ 上。
- 打開手臂前,確認手臂沒有通電。
- 拆下手臂的塑膠外蓋:用英制六角扳手卸下唯一的一根螺栓,再搖動或撬開外蓋,使其脫離卡扣。
- 警告:不要硬插連接器;請先確認方向:線材上的黃色標記朝向 ESXX 燒錄器那一側。
- 將 ESXX 燒錄器連接到 ESPM 板上的 J22 JTAG 埠。
- 打開控制器電源開關,為目標板供電;ESPM 由 dVRK Si 控制器經由 dSIB-Si 供電。
- 用 espm.rpd 燒錄該板。
- 取下 ESXX 燒錄器,並裝回外蓋。
5.6 燒錄 Si SUJ 中的 ESSJ
僅適用於搭配原廠 Si 病患推車的 dVRK-Si。
- 病患推車內的 ESSJ 板負責管理 Si SUJ 的電位器。
- 警告:不要硬插連接器;線材上的黃色標記朝向 ESXX 燒錄器那一側。
- 將 ESXX 燒錄器連接到 ESSJ 板左側的 JTAG 埠。
- 打開控制器電源開關,為目標板供電。
- 用 essj.rpd 燒錄該板,然後取下 ESXX 燒錄器。
5.7 確認 Si 控制器以新韌體開機
原專案在 ESPM 與 ESSJ 燒錄後的 LED 檢查。
- 拔除 ESXX 燒錄器,並將 dVRK Si 控制器斷電後重新開機。
- 前方的 LED(PL、PS、ESPM、COM、48V 與 AMP)會由左至右閃爍綠燈,直到在 SD 卡上找到韌體為止。
- 開機完成後,PL LED 會閃爍綠燈。
- 除非控制器與 ESPM 之間有問題,否則 ESPM LED 應恆亮綠燈。
- 手臂以 dVRK 韌體開機後,手臂上無菌轉接器旁的兩顆 LED 會來回閃爍粉紅色燈光。
6. 建置軟體(ROS 2)
最新的 dVRK 軟體版本是 2.5.0。原專案建議在 Ubuntu 24.04 上使用 ROS 2 Jazzy 並以 colcon 建置;ROS 1 只依原專案的說法帶過。
6.1 安裝 ROS 2 與基本套件
ROS 2,以及原專案為每個 ROS 發行版列出的建置工具與函式庫。
- 依照 www.ros.org 上的說明安裝 ROS 2。
- 執行:sudo apt install python-is-python3
- 執行:sudo apt install python3-vcstool python3-colcon-common-extensions
- 執行:sudo apt install python3-pykdl
- 執行:sudo apt install git-lfs
- 匯入工作區前先安裝 Git LFS:dvrk_model 將器械網格存放在 Git LFS 中。
6.2 安裝 dVRK Ubuntu 套件(Ubuntu 24.04、ROS Jazzy)
原專案針對建議的 Ubuntu 24.04 搭配 ROS Jazzy 所列的套件清單。
- 執行:sudo apt install libraw1394-dev libncurses5-dev qtcreator swig sox espeak cmake-curses-gui cmake-qt-gui git subversion libcppunit-dev qt6-base-dev qt6-5compat-dev qt6-tools-dev qt6-declarative-dev qt6-svg-dev libgl-dev libegl-dev libhidapi-dev python3-pyudev libgraphviz-dev
- 執行:sudo apt install ros-jazzy-joint-state-publisher* ros-jazzy-xacro ros-jazzy-camera-info-manager ros-jazzy-image-transport ros-jazzy-image-transport-plugins
- 執行:sudo apt install libgstreamer1.0-dev libgstreamer-plugins-base1.0-dev libcairo2-dev libjsoncpp-dev python3-opencv python3-numpy libgtk-3-dev libgtkmm-3.0-dev
- Ubuntu 24.04 使用 Qt 6;這些 Qt 6 套件取代了舊版 dVRK 說明中的 Qt 5 套件。
- 若使用 Ubuntu 22.04 搭配 ROS Humble,或 Ubuntu 26.04 搭配 ROS Lyrical,請使用本頁上對應的套件清單。
6.3 建立工作區並以 vcs 複製儲存庫
vcs 會將 dVRK 軟體堆疊中的每個儲存庫拉取到 ROS 2 工作區中。
- 執行:source /opt/ros/jazzy/setup.bash
- 執行:mkdir -p ~/ros2_ws/src
- 執行:cd ~/ros2_ws/src
- 執行:vcs import --input https://raw.githubusercontent.com/jhu-saw/vcs/main/ros2-dvrk-main.vcs --recursive
- 執行:vcs custom --git --nested --workers 1 --args lfs pull
- 若要改用特定版本,請執行:vcs import --input https://raw.githubusercontent.com/jhu-saw/vcs/main/ros2-dvrk-2.5.0.vcs --recursive
- 如果 GitHub 回報存取被拒錯誤,請嘗試:vcs import --input https://raw.githubusercontent.com/jhu-saw/vcs/main/ros2-dvrk-main.vcs --recursive --retry 10 --workers 1
- 如果忘了加 --recursive,請前往 ~/ros2_ws/src/cisst-saw/sawRobotIO1394 並執行:git submodule init; git submodule update
6.4 以 colcon 建置工作區
在工作區頂層以 Release 模式建置。
- 執行:cd ~/ros2_ws
- 執行:colcon build --cmake-args -DCMAKE_BUILD_TYPE=Release --symlink-install
- 執行:source ~/ros2_ws/install/setup.bash
- 一律從工作區的最上層目錄建置;在子目錄中建置會讓 colcon 另外建立新的 build、install 與 log 目錄。
- 可選擇將這些參數存到 ~/.colcon/defaults.yaml 或 ~/ros2_ws/colcon_defaults.yaml,如本頁所示。
6.5 設定環境並在模擬中測試
在登入時 source 工作區,並以模擬的 Classic 病患推車檢查建置結果。
- 將以下內容加到 ~/.bashrc 結尾(原專案寫成三行):if [ -f ~/ros2_ws/install/setup.bash ]; then . ~/ros2_ws/install/setup.bash; fi
- 使用 ROS 2 時不需要 source cisstvars.sh。
- 執行:ros2 launch dvrk_model patient_cart.launch.py generation:=Classic
- 在 dVRK GUI 中開啟 Arm PSM1 分頁並選擇一個器械。
- 在第二個終端機中執行:ros2 run dvrk_python dvrk_arm_test.py -a PSM1
- ROS 2 會在你的子網路上廣播;可使用 ROS_AUTOMATIC_DISCOVERY_RANGE 或 ROS_DOMAIN_ID 避免這種情況。
6.6 只在原專案允許的範圍內使用 ROS 1
原專案的 ROS 1 頁面附有兩項警告,並保留了舊版本的 catkin 說明。
- 原專案提醒,ROS 1 尚未在 dVRK 軟體 2.5.0 或更新版本上測試過;2.5.0 及之後的版本請使用 ROS 2。
- ROS 1 本身已不再維護,原專案強烈建議使用 ROS 2。
- 針對較舊的環境,原專案記載了在 Ubuntu 20.04 上以 ROS Noetic 進行 catkin 建置的方法,包括版本檔 ros1-dvrk-2.4.0.vcs。
- 使用 ROS 1 時,記得在使用 rosrun 時啟動 roscore,用完後再停止它。
7. 將 PC 連接到控制器
以菊鏈方式串接控制器,再依控制器版本,以 FireWire、透過乙太網路連到橋接控制器,或僅以乙太網路連接 PC。
7.1 選擇 PC 與控制器的通訊方式
原專案的三種配置方式,以及各自使用的連接埠設定。
- 僅 FireWire(port fw):控制器以 FireWire 菊鏈串接,PC 也在鏈上;適用於所有世代的控制器,也是最可靠的方式。
- FireWire 搭配乙太網路橋接(port udpfw):控制器之間使用 FireWire,PC 以乙太網路連接到其中一台控制器。
- 橋接配置需要 dVRK 軟體 2.0 以上、所有控制器的韌體 7 以上,以及至少一片 FPGA V2 或 V3 板。
- 若兩者皆有,請用配備 FPGA V3 的控制器作為橋接:FPGA V3 有兩個 1 Gb 網路介面,FPGA V2 只有一個 100 Mb 網路介面。
- 僅乙太網路(port udp):所有控制器都使用 FPGA V3 時可採用;不需要 FireWire。
7.2 安全地設定 FireWire
FireWire 接頭若上下顛倒硬插,可能燒毀 FPGA 板。
- 注意:FireWire A 連接器不能反插;若強行反插,兩根電源針腳會碰到資料線,對 dVRK FPGA 板造成無法復原的損壞。
- 若必須用力插入 FireWire 連接器,請先目視確認沒有上下顛倒。
- 請使用原生的 Linux 作業系統(原專案強烈建議 Ubuntu LTS):虛擬機器不支援 FireWire,而且沒有 FireWire 轉 USB 的轉接器。
- 絕對不要將兩台 PC 連接到同一條 FireWire 鏈上。
- 避免在同一條匯流排上混用 dVRK 控制器與其他 FireWire 裝置。
- 優先選用原生支援 PCIe 的 Texas Instruments 晶片組;可用 lshw 檢查你的晶片組。
- 每台電腦安裝一次驅動程式函式庫:sudo apt-get install libraw1394-dev
7.3 設定 FireWire 裝置權限
udev 規則讓控制軟體不需 root 即可執行;原專案建議使用其便利的做法。
- 在原專案提供的兩種方案中選擇一種;這是較方便的一種,每台電腦執行一次即可。
- 執行:sudo mkdir -p /etc/udev/rules.d
- 執行:cd
- 執行:echo 'KERNEL=="fw*", GROUP="fpgaqla", MODE="0666"' > ~/80-firewire-all.rules
- 執行:sudo mv ~/80-firewire-all.rules /etc/udev/rules.d/80-firewire-all.rules
- 執行:sudo addgroup fpgaqla
- 執行:sudo udevadm control --reload-rules
- 如果你的機構需要存取控制,請使用本頁上較安全的方案(MODE 0660,並將每位使用者加入 fpgaqla,然後登出再登入)。
7.4 測試 FireWire 連線
qladisp、/dev/fw* 與 dmesg 可顯示每塊電路板是否都在匯流排上。
- 先建置 dVRK 軟體:qladisp 包含在其中。
- 不加任何選項執行 qladisp;它會列出找到的電路板及其板號與韌體版本。
- 應找到的電路板數量取決於你的配置;請參閱原專案的 Number of FPGAs 一節。
- 如果 qladisp 無法運作,請執行 ls -l /dev/fw*,確認裝置存在且權限正確;fw0 是 PC 本身的介面卡。
- 警告:fw 裝置的編號必須連續不中斷;若有空號,表示匯流排初始化很可能失敗。請在 PC 端拔下 FireWire 線,等待 5 秒後再插回。
- 拔除與重新插入 FireWire 線之間請等待幾秒鐘。
- 插線時用 dmesg -w 觀察核心訊息;Ubuntu 24.04 及之後的版本需要 sudo,或先執行 sudo sysctl kernel.dmesg_restrict=0。
7.5 設定並測試乙太網路連線
dVRK 乙太網路埠是一條專用、link-local、直接連到單一控制器的連線。
- 使用一張 dVRK 專用的網路卡,以網路線直接連接到鏈上的其中一台控制器,中間不經過集線器或交換器。
- 不要透過乙太網路將 dVRK 控制器連接到兩台不同的電腦。
- 執行 sudo nm-connection-editor,選擇 dVRK 專用的網路卡,並在 Ethernet 分頁中將 MTU 設為 3000。
- 在 IPv4 Settings 中將方法設為 Link-Local Only;在 IPv6 Settings 中設為 Disabled。
- 用 ifconfig 確認該網路卡的位址以 169.254 開頭,且子網路遮罩為 255.255.0.0。
- 執行 qladisp -pudp 透過 UDP 列出電路板;若它回報了一個不是 QLA 板的節點,請將 PC 從 FireWire 鏈上拔除。
- 執行 ping 169.254.0.100;迴圈時間約 0.3 ms 屬於合理範圍。
8. 建立設定檔
辨識每支手臂與每個控制器,產生每支手臂的 IO、手臂與系統檔,手動撰寫 SUJ 檔,再全部合併成一個系統檔。
8.1 記錄每支手臂的序號
手臂序號將每支手臂與其校正檔對應起來。
- 在每支手臂的標籤上找到序號(tracking ID,TRK ID)。
- 在所有設定檔中一致地使用該序號。
- 注意:除非你非常清楚自己在做什麼,否則不要修改設定檔中的序號(內容或檔名)。
- 注意:不要複製或重新命名檔名中含有序號的檔案來為另一支手臂建立設定檔;這可能造成嚴重損壞。
8.2 檢查電路板 ID
每塊 FPGA 板的旋轉開關會設定一個 ID,在同一條鏈上必須不重複。
- 板號由每片 FPGA1394 板上的 4 位元旋轉開關(0 到 F)設定,在菊鏈串接的電路板之間必須各不相同。
- 使用原專案的預設板號:MTML 0 與 1、MTMR 2 與 3、ECM 4 與 5、PSM1 6 與 7、PSM2 8 與 9、PSM3 10 與 11、SUJ Classic 12。
- 即使你的套件沒有 ECM、PSM3 與 SUJ,也要保留它們的板號。
- 配備 FPGA1394 v3 的控制器(DQLA 與 dRAC)只使用第一個板號;例如 Si PSM1 使用板號 6。
- 連接控制器後執行 qladisp 或 dmesg 來確認板號。
- 要變更板號,請打開機殼,用小一字起子轉動旋轉開關。
- 在 da Vinci Standard 上,PSM 貼有顏色貼紙:黃色為 PSM1、綠色為 PSM2、紅色為 PSM3。
8.3 產生手臂 IO 檔、手臂檔與系統檔
dvrk-io-config-generator.py 會為每支手臂建立一個空白 IO 檔、一個手臂檔與一個單臂系統檔。
- source 你的工作區(ROS 2 為 install/setup.bash),讓 dvrk-io-config-generator.py 位於你的路徑中。
- 每一支 Classic 手臂都要向 Intuitive Surgical 取得 .cal 檔案,並與你的設定檔存放在一起。
- 使用 QLA1 控制器的 Classic 手臂,執行:dvrk-io-config-generator.py -a MTMR -g Classic -H QLA1 -c m23456.cal
- 使用 DQLA 控制器的 Classic 手臂,執行:dvrk-io-config-generator.py -a MTMR -g Classic -H DQLA -c m23456.cal
- Si 手臂,執行:dvrk-io-config-generator.py -a PSM1 -g Si -H dRA1 -s 123456
- 預設埠為 fw;如果 PC 到第一台控制器使用乙太網路、控制器之間使用 FireWire,請加上 -p udpfw。
- 如果某台 MTM 還沒有重力補償檔案(例如 gc-MTMx-12345.json),請在它的手臂檔中將 gravity_compensation 那一行註解掉(//)。
- 產生某支手臂的檔案後,請針對該手臂的類型與世代完成所有校正步驟。
8.4 將檔案存放在站點設定目錄中
原專案對站點專屬檔案的目錄配置,以及手動編輯的規則。
- 以 https://github.com/dvrk-config/dvrk_config_jhu 作為 CMakeLists.txt、package.xml 與 colcon.pkg 的範本。
- 每套系統使用一個子目錄,名稱以你的機構名稱開頭並包含系統名稱(例如 jhu-daVinci)。
- 原專案鼓勵每個單位在 https://github.com/dvrk-config 下維護自己的儲存庫;請聯絡 dVRK 維護者申請一個。
- 將你的 IO、手臂與系統檔案存放在那裡,以及 Classic 手臂的原始 .cal 檔案。
- 不要將共用檔案複製到你的目錄中:那裡的複本會取代預設的檔案被使用。
- 提交檔案之前,用 dvrk-remove-logs.py 清除暫存檔與記錄檔。
- 注意:若手動編輯檔案,請使用 SI 單位(公尺、弧度、伏特、安培)。
- 注意:對 Si PSM 與 ECM 而言,序號用來識別校正檔案;任何手動編輯都要保持序號正確。
8.5 手動建立 SUJ 設定檔
SUJ 檔案沒有產生器;請從 JHU 針對你的 SUJ 類型提供的範例開始。
- SUJ 檔案沒有 schema 也沒有產生器:請複製現有檔案後手動編輯。
- 從正確的 SUJ 類型開始:Classic、Si 或 Fixed。
- Classic:從 dvrk/dvrk_config_jhu/jhu-daVinci 開始;sawRobotIO1394-SUJ.json 與 suj-ECM-1-2-3.json 是每套系統專屬的,請保留你自己的版本。
- Classic:如果你的系統檔同時包含 SUJ 與主動手臂,請為每支主動手臂設定 base-frame。
- Si:從 dvrk/dvrk_config_jhu/jhu-daVinci-Si 開始;系統檔中有一個 SUJ_Si 手臂項目,其 arm_file 為 kinematic/suj-si.json。
- Si:各手臂的檔案 sawRobotIO1394-SUJ-Si-<arm>-<serial>.json 由產生器建立,並由 Si SUJ 校正更新。
- Fixed:沒有 IO 檔;該檔只包含世界座標與每支主動手臂基座之間的 4x4 轉換矩陣。
8.6 將各支手臂合併成一個系統檔
每支手臂都有了自己的檔案與校正後,系統精靈會建立多臂系統檔。
- 所有 IO 檔都建立完成、手臂也校正好之後,將手臂、腳踏板與頭部感測器整合到單一的系統設定檔中。
- 前往存放 dVRK 設定檔的目錄並執行:dvrk-system-config-wizard
- 精靈會掃描目錄中的手臂,讓你設定 IO、手臂與主控台各部分。
- 主控台部分包含你想要的遠端操作元件。
- 你也可以用精靈開啟並編輯現有的系統檔,或在文字編輯器中直接編輯 JSON。
8.7 設定 PSM 器械偵測
每個 PSM 設定檔可選擇自動、手動或固定的工具偵測方式。
- 在你的 PSM 設定檔中(例如 PSM1-12345.json),將 tool_detection 設為 AUTOMATIC、MANUAL 或 FIXED。
- AUTOMATIC 使用 Dallas 晶片查詢;適用於所有 Si PSM,以及搭配新版或改裝控制器的 Classic PSM。
- MANUAL:插入器械時,由使用者或應用程式選擇器械(Arm GUI 下拉選單,或 ROS topic 等程式介面)。
- FIXED:以 tool 設定單一器械類型,例如 LARGE_NEEDLE_DRIVER:400006;要變更時,需停止程式、編輯檔案後重新啟動。
9. 校正手臂
Classic 手臂需要依原專案的順序,為每組手臂與控制器進行數項類比校正;Si 的 PSM、ECM 與 SUJ 則需要電位器校正。原專案提供的 Classic 校正指令大多是 ROS 1 形式。
9.1 確認每支 Classic 手臂需要哪些校正
原專案依手臂類型列出的 Classic 校正步驟表。
- 這只適用於 Classic 手臂;請先完成硬體、連線與設定檔的設置。
- 初始值來自 Intuitive 的 .cal 檔案,但並未考慮 dVRK 控制器,因此每組手臂與控制器都要校正。
- 所有 Classic 手臂與 SUJ:馬達電流偏移量。
- ECM:煞車電流偏移量與煞車釋放電流。
- PSM、MTM 與 ECM:先校正電位器比例,再校正偏移量;PSM 另外需要第三關節偏移量。
- MTM:夾爪與重力補償。
- SUJ:依 SUJ 程序校正電位器比例與偏移量。
9.2 校正馬達電流偏移量(Classic)
sawRobotIO1394CurrentCalibration 會量測並儲存命令電流與量測電流的偏移量。
- 緊急停止鏈上只有一台控制器時比較單純;若所有控制器都在鏈上,請讓它們全部使用 FireWire,並以 qlacommand -c close-relays 啟用電源。
- 以你手臂的 IO 檔執行:sawRobotIO1394CurrentCalibration -c sawRobotIO1394-MTML-12345.json
- 預設埠為 fw;僅使用乙太網路時用 -p udp,若 PC 到第一台控制器使用乙太網路、控制器之間使用 FireWire,則用 -p udpfw。
- ECM 需要執行兩次:一次加 -b 校正煞車,一次不加 -b 校正致動器。
- 若新的平均值超過數十 mA,請不要繼續;請聯絡 dVRK 維護者。
- 回答 y 以儲存;舊的 IO 檔會被重新命名作為備份。
- 重新執行程式進行測試:以 mA 計的偏移量現在應接近 0。
- 若持續出現 WriteAllBoards: handle for port 0 is NULL,請按 ctrl-c,並用 qladisp 測試連線。
9.3 設定 ECM 煞車電流(Classic)
ECM IO 檔中的四個煞車數值需手動調整。
- 警告:這一步一定要做;煞車釋放沒有感測器,因此 PID 可能在煞車仍作用時施加足以損壞馬達的電流。
- 警告:對於第 3 個(插入)煞車,原專案解讀電磁閥規格為 7 秒內不超過 13W 或連續 1.3W,即 release_current 1.48 A、released_current 0.465 A。
- 先校正煞車電流回授(加 -b 的電流校正),使用 ECM 控制器(單一 36V 電源,板號 4 與 5),並直接連接手臂線材。
- 在 ECM IO JSON 中編輯 release_current、release_time、released_current 與 engaged_current(一律為 0);每次修改後都要結束並重新啟動 sawRobotIO1394 主控台(sawRobotIO1394QtConsole)。
- 找出 release_current:將 released_current 設為 0、release_time 設為 10 s,從低值開始,點選 Enable All 再點 Release,然後試著移動每個關節;逐步提高數值,直到每個煞車都能釋放。
- 接著縮短 release_time,最好降到 2.0 秒。
- 從低值開始逐步提高,找出能讓煞車維持釋放的最低 released_current。
- 如果提高需求值時電流回授不再上升,較舊的控制器可能需要將 24V 電源升級為 36V。
9.4 校正電位器比例(Classic)
在每個致動器上進行以編碼器為參考的大幅度動作,以修正電位器比例;請在偏移量之前完成。
- 先校正比例,再校正偏移量;ECM 要先校正煞車。
- 以 IO topics 與校正模式啟動系統:rosrun dvrk_robot dvrk_system -j <my-config-dir>/system-PSM2.json -K -C
- 在另一個 shell 中,於你的設定目錄執行:rosrun dvrk_python dvrk_calibrate_potentiometers.py -t scales -a PSM2 -c sawRobotIO1394-PSM2-00000.json -i IO1
- 腳本與系統要使用同一個 IO JSON 檔;-i 必須與系統檔中的 IO 名稱相符。
- 注意:手臂會從一端的關節極限移動到另一端;請確認路徑上沒有障礙物。
- 若為 PSM,依提示取下任何器械或校正板。
- 按 y 儲存,以更新後的檔案重新啟動系統並再執行一次;第二次通常不需要儲存。
9.5 校正電位器偏移量(Classic)
將手臂保持在機構零點,讓腳本計算偏移量。
- 原專案只知道一種讓 PSM 最後 4 個關節固定在零點的簡單方法:用壓克力模板或樂高積木條對齊四個齒輪(檔案位於 https://github.com/jhu-dvrk/dvrk-calibration-parts)。
- 若為 MTM 或 ECM,你必須自行想辦法讓手臂固定在其機械零點。
- 為手臂通電並歸位,然後用馬達、離合按鈕(ECM 與 PSM)、ROS 移動目標或 Qt GUI 將其移到接近機械零點的位置。
- 在另一個 shell 中執行:rosrun dvrk_python dvrk_calibrate_potentiometers.py -t offsets -a PSM2 -c sawRobotIO1394-PSM2-00000.json -i IO1
- 依提示放上校正模板。
- 對於使用 Lego 棒或模板的 PSM,不要儲存所有關節;只儲存最後 4 個。
- 以更新後的檔案重新啟動系統,並重新執行以確認。
9.6 校正 PSM 第三關節電位器偏移量(Classic)
讓 PSM 繞關節 1 來回擺動,並調整插入偏移量,直到器械的關節 5 軸不再移動。
- 你需要搭配 ROS 的 dVRK 2.0、可運作的 PSM 系統檔、固定的攝影機、一支 8 mm Classic 器械(S/Si 器械太長),以及一個套管替代品,例如橡皮筋或來自 https://github.com/jhu-dvrk/dvrk-cannulas 的 3D 列印支架。
- 以 -C 啟動系統:roscd dvrk_config,接著 qlacommand -c close-relays,然後 rosrun dvrk_robot dvrk_system -j <my-config-dir>/system-PSM1.json -C
- 在插入受支援的 Classic 8 mm 器械的情況下讓 PSM 歸零,並用攝影機在螢幕上顯示 RCM 點(例如使用 tvtime)。
- 在第三個終端機中,從 roscd dvrk_config/<my-config-dir> 執行:rosrun dvrk_python dvrk_calibrate_potentiometer_psm.py -a PSM1 -c sawRobotIO1394-PSMx-xxxxx.json
- 依腳本要求找出 PSM 的最大運動範圍,以避免碰撞;按下 d 之後,PSM 會快速移動並繞著關節 1 擺動。
- 在螢幕上標出關節 5 的軸;若它沿著開口朝下的弧線移動,按 +;若開口朝上,按 -;運動最小時按 d。
- 儲存後,以 -C 重新啟動系統並重複一次;理想情況下不需要再調整。
- 本頁也記載了一種自動方法:用亮粉紅色指甲油標記關節 5,並使用 dvrk_calibrate_potentiometer_psm_cv.py。
9.7 校正 MTM 夾爪(Classic)
在完全張開與閉合但未夾緊之間,對應夾爪的霍爾效應感測器數值。
- 先練習找出「閉合但不夾緊」的位置,也就是較強的內側彈簧開始作用的位置;此時機器人不需要開機。
- 以你的夾爪檔執行:sawIntuitiveResearchKitGripperCalibration -c sawRobotIO1394-MTML-gripper-34863.json
- 若未使用預設的 fw 埠,請加上 -p(例如 -p udpfw)。
- 此程式不需要致動器通電;緊急停止可以處於斷開狀態。
- 反覆完全張開、再閉合到第二段彈簧,直到計數與範圍不再增加;絕不要閉合超過那個位置,否則請不儲存並重新開始。
- 詢問時輸入 60 度作為新的最大值(建議),然後儲存。
- 在 dvrk_system GUI 的夾爪分頁中以 Service、Plot position 驗證:完全張開約 60,第二段彈簧處約 0,完全閉合為 -40 或更小。
9.8 校正 MTM 重力補償(Classic)
原專案將此程序放在另一個儲存庫中。
- 依照 https://github.com/jhu-dvrk/dvrk-gravity-compensation 中的文件操作。
- 這個 readthedocs 頁面本身沒有任何程序;它只指向該儲存庫。
9.9 校正 SUJ 電位器(Classic)
為每個 SUJ 關節加上標籤,在 GUI 中為每個關節輸入兩個已知位置,並將計算出的數值複製到你的 SUJ 檔中。
- 警告:SUJ 位置通常只準確到 50 mm 的立方體範圍內;若需要更高的精度,請使用外部感測器為手臂進行配準。
- 列印原專案的 SUJ 標籤(SVG 或 PDF),不要縮放(印出的 20 cm 參考尺必須量起來是 20 cm),並貼在每個關節前方的連桿上。
- 警告:ECM 關節 3 的標籤上,180 必須對準凹痕。
- 在 SUJ GUI 中(Show more),用 Clutch 釋放煞車,將一個關節移到一端極限,重新啟動煞車,等待幾秒,然後在 Joint Start 中輸入標籤讀數;在另一端極限重複,填入 Joint Finish。
- 關節 0(平移)請用雷射量測工具或捲尺量測最低點與最高點的高度;ECM 要在 PSM1 或 PSM2 之後才校正。
- 對於 ECM SUJ,最後兩個關節填入不同的佔位值。
- 按下 Manual Recalibration,將印出的偏移量與比例複製到你的 SUJ 檔案中對應的段落(例如 suj-ECM-1-2-3.json),然後重新啟動。
- 驗證:釋放煞車,將所有 RCM 聚在一起,確認回報的 SUJ 位置都在 20 mm 的立方體範圍內。
9.10 校正 Si PSM 與 ECM 電位器(Si)
將每個關節從一端極限移到另一端極限,讓程式建立數位電位器對照表。
- 警告:一律要與你所使用手臂的序號相符。
- source 你的工作區:source ~/ros2_ws/install/setup.bash
- 以你手臂的檔案執行:sawIntuitiveResearchKitSPotentiometersCalibration -c sawRobotIO1394-ECM-123456.json
- 程式會為手臂通電並釋放煞車;按下手臂頂端的白色離合按鈕即可釋放。
- 警告:此時沒有重力補償;請一隻手保持扶著內視鏡夾持器。
- 將每個關節從一端極限移到另一端,每個極限各碰幾次但不要太用力,直到所有計數都接近 3000,然後按任意鍵。
- 若量測到的範圍與預期範圍不符,請重做一次,並確認每個關節極限都有碰到。
9.11 校正 Si SUJ 電位器(Si)
dvrk_calibrate_suj.py 會將每個設定關節的電壓範圍對應到其機構極限。
- 為每支要校正其 SUJ 的主動手臂的控制器通電;若要一次全部校正,請使用包含所有主動手臂與 SUJ Si 的系統檔。
- 從你的設定目錄執行:ros2 run dvrk_robot dvrk_system -j system-SUJ-ECM-PSM1-PSM2-PSM3.json -s
- 從存放 sawRobotIO1394-SUJ-Si 檔案的目錄執行:ros2 run dvrk_python dvrk_calibrate_suj.py
- 一次校正一支 SUJ 手臂:釋放其煞車,將每個設定關節從一端機械極限移到另一端,在每個極限停留約一秒。
- 在 GUI 中確認該手臂上每個主要與次要電位器的範圍都有增加,然後按下對應的 Save 按鈕。
- 注意:PSM3 SUJ 的第五關節有電位器死區;請避開它,在機械極限與刻痕對齊的位置之間移動,必要時使用 Reset PSM3 joint 5。
- 儲存後重新啟動 dvrk_system,以載入新的校正資料。
10. 運行機器人
原專案在完整設置、設定並校正好的 dVRK 上的典型操作流程:開電、連線檢查、系統啟動、馬達電源、歸位、監控、手臂擺位、遠端操作與影像。
10.1 啟動控制器電源
打開每個控制器,並確認它已開機。
- 警告:最早期的 dVRK 群組(約 2012 年)的 FPGA 板會從 FireWire 取電;對這些系統,請在為控制器通電前,先拔掉連到 PC 的 FireWire 線。
- 用電源線旁的黑色 0/1 開關開啟每台控制器;使用單一延長線插座即可一次全部開關。
- Classic:開機完成後,LED A 與 B(以及 C 與 D)會在綠色與紅色之間來回切換。
- Si:開機完成後,PL LED 會閃爍綠燈;以 FPGA 3 為基礎的控制器開機時間稍長。
- 控制器很少需要重新開機;JHU 讓它們 24/7 全天候保持通電。
10.2 檢查與控制器的連線
必須讓 qladisp 找到每塊電路板,才能使用 dVRK。
- 若找不到 qladisp,請 source 你的工作區:source ~/ros2_ws/install/setup.bash
- 僅 FireWire,執行:qladisp -pfw
- PC 到第一台控制器使用乙太網路、控制器之間使用 FireWire,執行:qladisp -pudpfw
- 確認找到的電路板、其板號、韌體版本與電源板類型(QLA1、DQLA、dRAC)。
- 已知的 FireWire 問題:控制器通電後,可能需要拔掉 PC 與第一台控制器之間的線,等待 5 秒後再插回。
- 若找不到電路板,請先修正連線;在此之前無法使用 dVRK。
10.3 以你的設定啟動 dVRK 系統
dvrk_system 會載入你的系統檔,並建立所有元件與 GUI。
- 警告:使用錯誤的設定檔會導致精度降低,並可能損壞你的 dVRK。
- Classic 手臂無法回報序號,因此沒有任何機制能阻止你使用其他系統的檔案;Si PSM 與 ECM 會將序號儲存在 ESPM 上,軟體會進行檢查。
- 執行:source ~/ros2_ws/install/setup.bash
- 執行:cd ~/ros2_ws/src/dvrk/dvrk_config_XXX(將 XXX 換成你機構的縮寫)
- 執行:ros2 run dvrk_robot dvrk_system -j system-XXX.json(將 XXX 換成你的設定)
10.4 正常使用時,保持降低安全性的選項關閉
部分 dvrk_system 選項會停用檢查或開放低階指令。
- 只在校正電位器時使用 -C(校正模式);它會停用部分安全檢查,不應在日常使用。
- 將 -J(所有 PID topics)視為危險選項:它讓你能直接對 PID 元件下指令。
- 將 -L(所有 IO topics)視為危險選項:它讓你能直接對 IO 元件下指令。
- -K(唯讀 IO topics)用於除錯與校正。
10.5 開啟馬達電源
控制器開啟且緊急停止鏈閉合後,由 PC 下達開啟馬達電源的指令。
- 用 GUI 的 Power On 按鈕或 ROS topic power_on 開啟馬達電源。
- IO 分頁應顯示綠色按鈕(MTM 夾爪除外,它沒有通電),控制器前方的 LED 應顯示馬達電源已開啟。
- 控制器必須已接上交流電並開啟;之後由 PC 控制 QLA 或 dRAC 板上的馬達放大器。
- 若無法開啟馬達電源,請檢查緊急停止開關。
10.6 讓手臂歸零
歸零會啟動位置控制,且各手臂的行為不同。
- 用 GUI 或 ROS topic home 讓 dVRK 歸位。
- 所有主動手臂開始進行位置控制。
- MTM 會執行滾轉校正程序,並移動到其零點位置。
- PSM 與 ECM 不應移動;這是正常的。
- 裝有無菌轉接器但沒有器械的 PSM 會將其插入軸往上移並卡合轉接器;若已裝上器械但尚未插入,則會卡合器械。
- 在 ECM Classic、ECM Si 與 PSM Si 上,手臂啟用期間煞車會釋放並保持釋放;手臂以馬達維持位置。
10.7 在系統運作時進行監控
原專案稱 dVRK 是建立在舊機器人上的實驗性系統,並列出需要留意的事項。
- 機器人應保持安靜:如果聽到噪音或看到振動,請停止並查明原因(MTM 手腕偶爾的輕微振動除外)。
- 用 GUI 的時序小工具或各元件的 period_statistics ROS topic 檢查 IO 頻率。
- 保持電腦整體負載偏低;用 htop 監控。
- 在 IO 小工具中檢查放大器溫度。
- 內建檢查使用的門檻值很高;若你的系統不穩定,請檢查 CPU 負載、時序與溫度。
10.8 裝上器械,並擺放 PSM 與 ECM
先看器械與內視鏡的設定影片,再將手臂擺放在工作範圍周圍。
- 觀看原專案的設定影片:PSM Classic https://youtu.be/yeQKU2_O6uo、PSM Si https://youtu.be/F7cOVPVq_TY、ECM https://youtu.be/jx0bB64NaPo、ECM Si https://youtu.be/7DCDEeAbb3k。
- 器械尖端位於工作空間中心附近時,避免任何關節接近其極限。
- 將手臂呈扇形展開,避免彼此碰撞。
- 將所有病患側的 RCM 點放在以工作空間為中心、直徑約 15 到 20 cm 的球面上(影片:https://youtu.be/nUsEUC4xOYc)。
10.9 從 MTM 遠端操作 PSM
從操作者的角度說明原專案的 PSM 遠端操作元件如何運作。
- 遠端操作開始時,會啟用 MTM 與 PSM 並使其歸位,然後移動 MTM 使其方向與 PSM 一致。
- 不要對 MTM 手腕施加過大的扭矩,否則它無法到達目標方向,遠端操作也就不會開始。
- 將手指放在 MTM 夾爪上並輕微擺動,表示你已準備好;系統沒有在場感測器。
- 在跟隨模式下,MTM 的平移以相對且縮放的方式驅動 PSM,MTM 的方向則以絕對方式驅動 PSM。
- 使用離合來重新調整雙手位置;離合期間 MTM 的方向會持續鎖定在 PSM 上。
10.10 啟動立體影像串流流程
一個啟動檔即可啟動擷取、對位與立體顯示。
- 從存放影像設定檔的目錄執行:ros2 launch dvrk_console stereo_video_pipeline.launch.py
- 預設會從目前目錄讀取 stereo_source.json、stereo_alignment.json 與 stereo_display.json。
- 它會依序啟動 dvrk_data stereo_source、dvrk_data stereo_alignment 與 dvrk_console stereo_display。
- 也可以選擇在另一個終端機中執行控制面板:ros2 run dvrk_console control_panel