趙 亮，趙智遠(yuǎn)，朱德勇，劉 闖，李 毅

(1.中國科學(xué)院長春光學(xué)精密機械與物理研究所 空間機器人工程中心，吉林 長春 130033；2.中國科學(xué)院大學(xué) 材料科學(xué)與光電技術(shù)學(xué)院，北京 100049)

0 引 言

微創(chuàng)手術(shù)是一種可以避免或者減小手術(shù)切口，減短傷口愈合時間、減輕患者疼痛以及降低手術(shù)感染風(fēng)險的外科手術(shù)方法[1]。手術(shù)機器人可以克服一些傳統(tǒng)手術(shù)的局限[2]。

按運動結(jié)構(gòu)不同，機器人可分為3類：離散型機器人、蜿蜒型機器人和連續(xù)型機器人[3]。離散型機器人難以在復(fù)雜環(huán)境下連續(xù)運動。蜿蜒型機器人難以在狹小空間的手術(shù)環(huán)境下工作。連續(xù)型機器人具有很強的彎曲性能，結(jié)構(gòu)可以很小，可以在非線性狹小空間的手術(shù)環(huán)境下靈活操作。

美國范德堡大學(xué)的SARLI N等[4]研發(fā)了一種微創(chuàng)連續(xù)型手術(shù)機器人系統(tǒng)Turbot，該連續(xù)型結(jié)構(gòu)采用單孔三通道方式，內(nèi)含激光器、內(nèi)窺鏡、執(zhí)行器，機器人用Ti-Ni合金驅(qū)動，不同溫度下可以有不同的曲率，但該手術(shù)機器人負(fù)載小、穩(wěn)定性低；美國卡耐基梅隆大學(xué)的TAKEYOSHI O等[5]開發(fā)了Cardio arm連續(xù)型手術(shù)機器人，連續(xù)型結(jié)構(gòu)由50個剛性圓柱體構(gòu)成，具有105個自由度，但其直徑偏大，難以從人體自然腔道進(jìn)入病灶部位；美國哈佛醫(yī)學(xué)院的DUPOURQUé L等[6]開發(fā)了一種用于肺經(jīng)支氣管檢查的連續(xù)型機器人，由3段連續(xù)型關(guān)節(jié)構(gòu)成，每個關(guān)節(jié)由一根方向?qū)Ь€和兩根不銹鋼驅(qū)動線組成；英國利茲大學(xué)的GARBIN N等[7]研制了一種用于上消化道檢查的便攜式連續(xù)型內(nèi)窺鏡，由形狀記憶合金材料的連續(xù)型關(guān)節(jié)和塑質(zhì)材料的波紋管執(zhí)行器組成，并在人體模型中進(jìn)行了實驗；哈爾濱工業(yè)大學(xué)的楊文龍等[8]開展了單孔腔鏡的連續(xù)型機器人研究，研制的單孔腔鏡長度為245 mm，直徑為10 mm，末端安裝有微型夾持器，但該機器人直徑大，難以進(jìn)入人體鼻腔、耳道等自然腔道；上海交通大學(xué)的徐凱等人[9]開發(fā)了一種用于微創(chuàng)手術(shù)的連續(xù)型手術(shù)機器人，可以自由伸縮軸向長度，但同樣用了Ti-Ni合金，負(fù)載較小。

本研究將設(shè)計一種可以靈活進(jìn)入狹小非線性空間的線驅(qū)動連續(xù)型手術(shù)機器人。

1 機械系統(tǒng)設(shè)計

1.1 UR機械臂選型

本文選擇UR串聯(lián)機械臂作為手術(shù)機器人系統(tǒng)的第一部分。該串聯(lián)機械臂主要分為桌面機器人UR3、靈活型機器人UR5、大型機器人UR10。本文選擇大型機器人UR10。

1.2 并聯(lián)平臺設(shè)計

在并聯(lián)機器人的選擇上，本文采用Gough-Stewart平臺，上平臺和下平臺分別利用6個單腿促動器驅(qū)動，每個單腿促動器都由兩邊的十字鉸鏈連接。

1.3 連續(xù)型末端執(zhí)行器設(shè)計

連續(xù)型末端執(zhí)行器由兩個模塊組成，并采用分布式彈簧結(jié)構(gòu)，兩個單元體用球關(guān)節(jié)進(jìn)行連接，兩個模塊各自都有兩個自由度，整體上采用鋼絲線驅(qū)動。

連續(xù)型末端執(zhí)行器機械結(jié)構(gòu)如圖1所示。

圖1 連續(xù)型末端執(zhí)行器機械結(jié)構(gòu)

其中，模塊1開有4個孔，4個孔中穿入驅(qū)動線來驅(qū)動模塊1運動；模塊2開有8個孔，其中4個孔用來穿過模塊1的驅(qū)動線，另外4個孔用來穿過模塊2的驅(qū)動線。整個連續(xù)型末端執(zhí)行器具有4個自由度，最大外徑4 mm，滿足連續(xù)型末端執(zhí)行器進(jìn)入人體鼻腔、耳道等自然腔道的要求。

本文選擇Maxon motor公司的EC40伺服電機作為動力源，Harmonicdrive公司的諧波減速器CSG-25-100-2A-GR作為減速裝置，用來增加輸出轉(zhuǎn)矩；利用滾珠絲杠配合驅(qū)動線連接裝置改變連續(xù)型末端執(zhí)行器的驅(qū)動線長度，從而改變執(zhí)行器的操作空間位姿。

1.4 力反饋主手選擇

本文選擇Sensable公司的Phantom作為手術(shù)機器人系統(tǒng)的觸覺式力反饋手柄，主手裝置中的一個連桿是底座，其他4根桿可以轉(zhuǎn)動，一共具有6個自由度。醫(yī)生操作Phantom裝置的時候其末端關(guān)節(jié)會發(fā)生移動，前3個關(guān)節(jié)的每一個關(guān)節(jié)都安裝了交流電機和編碼器，具有記錄角度的功能。

線驅(qū)動連續(xù)型手術(shù)機器人系統(tǒng)模型如圖2所示。

圖2 線驅(qū)動連續(xù)型手術(shù)機器人系統(tǒng)模型

系統(tǒng)由UR10串聯(lián)機械臂、Stewart并聯(lián)平臺、連續(xù)型末端執(zhí)行器等組成。系統(tǒng)可以和5G技術(shù)相結(jié)合，實現(xiàn)遠(yuǎn)程手術(shù)。

2 運動學(xué)分析

2.1 串聯(lián)機械臂運動學(xué)分析

本文利用D-H參數(shù)法建立UR機械臂的運動學(xué)模型，建立機械臂的連桿坐標(biāo)系，求得連桿1對原始連桿的變換矩陣表達(dá)式為：

(1)

式中：l—連桿長度；φ—連桿轉(zhuǎn)角；d—連桿偏距；θ—關(guān)節(jié)角。

則機械臂的末端坐標(biāo)系相對于原始坐標(biāo)系的齊次變換矩陣是：

(2)

2.2 連續(xù)型末端執(zhí)行器運動學(xué)分析

為了得到連續(xù)型末端執(zhí)行器的單個關(guān)節(jié)段的運動學(xué)模型[10-11]，本文在其第一個關(guān)節(jié)段的基座圓盤中心點處建立基坐標(biāo)系OXYZ，在其末端設(shè)立末端坐標(biāo)系O1X1Y1Z1。

末端執(zhí)行器單關(guān)節(jié)段運動學(xué)模型如圖3所示。

圖3 單關(guān)節(jié)段運動學(xué)模型

首先原始坐標(biāo)系OXYZ沿3個方向進(jìn)行平移，其中，坐標(biāo)系的O點移動到O1點，平移矩陣是：

(3)

再進(jìn)行旋轉(zhuǎn)變換，得到齊次變換矩陣的表達(dá)式是：

(4)

式中：φ1—坐標(biāo)系繞Z軸旋轉(zhuǎn)角度；θ1—坐標(biāo)系繞Y軸旋轉(zhuǎn)角度；-φ1—坐標(biāo)系繞新的Z軸旋轉(zhuǎn)角度；l—單關(guān)節(jié)段的長度。

逆運動學(xué)分析是根據(jù)執(zhí)行器操作空間中的末端位姿計算關(guān)節(jié)空間中的關(guān)節(jié)變量。其矩陣表達(dá)式如下：

(5)

式中：R1—末端坐標(biāo)系相對于原始坐標(biāo)系的旋轉(zhuǎn)矩陣；P1—末端坐標(biāo)系在原始坐標(biāo)系中的位置坐標(biāo)；n，o，a—末端坐標(biāo)系中3個坐標(biāo)軸的單位矢量。

已知末端位姿，聯(lián)立式(3，4)，可求得對應(yīng)的關(guān)節(jié)變量參數(shù)是：

θ1=arccos(az)

(6)

(7)

機器人彎曲時，單關(guān)節(jié)段驅(qū)動線模型如圖4所示。

圖4 單關(guān)節(jié)段驅(qū)動線模型

根據(jù)幾何關(guān)系，可以得到連續(xù)型末端執(zhí)行器單關(guān)節(jié)段驅(qū)動線的長度是：

(8)

式中：s1(i=1,…,4)—連續(xù)型末端執(zhí)行器單關(guān)節(jié)段彎曲角度為θ1時的各個驅(qū)動線的彎曲曲率半徑；s—連續(xù)型末端執(zhí)行器單關(guān)節(jié)段軸線中心的彎曲曲率半徑；r—圓盤基座上的孔和軸中心線之間的距離。

按照幾何關(guān)系，所得的連續(xù)型末端執(zhí)行器單關(guān)節(jié)段中的驅(qū)動線長度的變化量為：

(9)

為了驗證相關(guān)運動學(xué)計算的正確與否，本文利用Matlab對運動學(xué)進(jìn)行仿真，在驅(qū)動空間中輸入4組不同驅(qū)動線長度變化量的數(shù)值，其變化量如表1所示。

表1 驅(qū)動線長度變化量

連續(xù)型末端執(zhí)行器彎曲運動仿真如圖5所示。

圖5 連續(xù)型末端執(zhí)行器彎曲運動仿真圖

從圖5可以看出：通過改變驅(qū)動線長度，就可以實現(xiàn)連續(xù)型末端執(zhí)行器的靈活運動。該結(jié)果驗證了本文運動學(xué)模型的正確性。

3 末端執(zhí)行器工作空間分析

機器人的可達(dá)工作空間[12]是由機器人的幾何形狀和關(guān)節(jié)運動的限位決定的。機器人的工作空間是評價機器人工作能力的重要指標(biāo)[13]。

一般機器人工作空間求解方法有：幾何法、解析法和數(shù)值法[14]。本文采用數(shù)值法中的蒙特卡羅法計算連續(xù)型末端執(zhí)行器工作空間[15]。首先筆者利用蒙特卡羅法取得連續(xù)型末端執(zhí)行器關(guān)節(jié)組合，然后把機器人關(guān)節(jié)組合引入正向運動學(xué)計算中，得到機器人末端執(zhí)行器在空間坐標(biāo)系中的空間位置矢量，最后把位置矢量可視化，得到機器人工作空間[16]。具體步驟如下：

(1)利用數(shù)值隨機函數(shù)來產(chǎn)生機器人空間關(guān)節(jié)變量的偽隨機數(shù)；

(2)把取得的機器人空間關(guān)節(jié)變量值帶入機器人正向運動學(xué)方程中，計算機器人末端的空間位置矢量；

(3)利用Matlab軟件把第二步計算的機器人末端空間位置矢量可視化，所得就是機器人工作空間。

對于連續(xù)型末端執(zhí)行器的正向運動學(xué)分析，首先利用蒙特卡羅法計算單關(guān)節(jié)段末端執(zhí)行器的工作空間，再利用蒙特卡羅法對兩關(guān)節(jié)段的末端執(zhí)行器可達(dá)工作空間進(jìn)行仿真；將計算的單關(guān)節(jié)段和兩關(guān)節(jié)段工作空間放在同一個三維坐標(biāo)系中，沿平面截開，可得到執(zhí)行器可達(dá)工作空間，如圖6所示。

圖6 連續(xù)型末端執(zhí)行器可達(dá)工作空間對比圖

圖6中，小的橢圓體是單關(guān)節(jié)段工作空間，大的橢圓體是雙關(guān)節(jié)段工作空間。

4 結(jié)束語

面對狹小非線性手術(shù)環(huán)境的需求，本文設(shè)計了一種用于微創(chuàng)外科的線驅(qū)動連續(xù)型手術(shù)機器人系統(tǒng)。首先在Inventor軟件中建立了連續(xù)型手術(shù)機器人系統(tǒng)的三維模型，然后對手術(shù)機器人進(jìn)行了正向運動學(xué)和逆向運動學(xué)分析，并在Matlab中進(jìn)行了仿真，最后利用蒙特卡羅法進(jìn)行連續(xù)型末端執(zhí)行器工作空間的計算。

仿真結(jié)果表明：連續(xù)型末端執(zhí)行器可以靈活地彎曲，可達(dá)工作空間范圍[-40,80]，最遠(yuǎn)距離120 mm，符合狹小非線性手術(shù)要求。

參考文獻(xiàn)(References):

[1] 王建辰.變剛度單孔手術(shù)機器人系統(tǒng)設(shè)計方法及主從控制策略研究[D].天津：天津大學(xué)機械工程學(xué)院，2017.

[2] 鄭先鋒.單通道蛇形手機機器人的開發(fā)及研究[D].西安：西安電子科技大學(xué)機電工程學(xué)院，2015.

[3] ROBINSON G, DAVIES J B C. Continuum robots-a state of the art[C]. IEEE International Conference on Robotics and Automation,Michigan: IEEE,1999.

[4] SARLI N, SIMAAN N. Minimal visual occlusion redundancy resolution of continuum robots in confined spaces[C].IEEE/RSJ International Conference on Intelligent Robots and Systems, Vancouver: IEEE, 2017.

[5] TAKEYOSHI O, HOWIE C. A highly articulated robotic surgical system for minimally invasive surgery[J]. The Society of Thoracic Surgeons, 2009,87(4):1253-1256.

[6] DUPOURQUé L, MASAKI F, COLSON L Y, et al. Transbronchial biopsy catheter enhanced by a multi-section continuum robot with follow-the-leader motion[J]. International Journal of Computer Assisted Radiology and Surgery, 2019(9):1-9.

[7] GARBIN N, WANG L, CHANDLER H J, et al. Dual continuum design approach for intuitive and low cost upper gastrointestinal endoscopy[J]. IEEE Transactions on Biomedical Engineering, 2019,66(7):1963-1973.

[8] 楊文龍.面向單孔腔鏡手術(shù)的連續(xù)型機械臂及其運動建模的研究[D].哈爾濱：哈爾濱工業(yè)大學(xué)機電工程學(xué)院,2016.

[9] SHUAN Z, QI L, XU K, et al. Configuration transition control of a continuum surgical manipulator for improved kinematic performance[J]. IEEE Robotics and Automation Letters, 2019,4(4):3750-3757.

[10] CRAIG J. Introduction to robotics: mechanics and control[M]. 3th ed. New York: Person Education, 2005.

[11] 陳光明,黃 旋.基于高壓水射流的船體清洗機器人關(guān)鍵技術(shù)分析[J].流體機械,2019,47(9):56-62.

[12] 劉海濤，楊樂平，朱彥偉，等.空間機器人工作空間研究[J].組合機床與自動化加工技術(shù)，2011(8):26-29.

[13] 李保豐，孫漢旭，賈慶軒，等.基于蒙特卡洛法的空間機器人工作空間計算[J].航天器工程，2011，20(4):79-85.

[14] BOHIGAS O,MANUBENS M,ROS L. Complete method for workspace boundary determination[J]. IEEE Transaction on Robotics, 2012,28(5):993-1006.

[15] CAO Y, LU K, LI X. Accurate numerical methods for computing 2D and 3D robot workspace[J]. International Journal of Advanced Robotic Systems, 2011,8(6):1-13.

[16] 田海波，馬宏偉，魏 娟，等.串聯(lián)機器人機械臂工作空間與結(jié)構(gòu)參數(shù)研究[J].農(nóng)業(yè)機械學(xué)報.2013,44(4):196-201.