韓東宇，陳歡龍，余春華

(1. 南京理工大學(xué) 理學(xué)院，江蘇 南京 210094；2. 上海宇航系統(tǒng)工程研究所，上海 201109)

0 引言

航天飛行器的研發(fā)設(shè)計(jì)中，往往無(wú)法全面考慮外太空惡劣工況下所出現(xiàn)的突發(fā)狀況，在航天器在軌運(yùn)行中，也容易發(fā)生表面結(jié)構(gòu)脫離，燃料不足，模塊單元分離或預(yù)設(shè)性動(dòng)作失諧等情況，這些通常需要空間機(jī)器人的協(xié)助操作。特別是遇到大型空間組裝及搬運(yùn)任務(wù)時(shí)，這些在失重環(huán)境下的程序性動(dòng)作顯得復(fù)雜而難以滿(mǎn)足功能性需求。因此空間機(jī)器人的研制對(duì)于在軌操作有重要的意義。

為實(shí)現(xiàn)航天器研發(fā)及運(yùn)行過(guò)程中所需的維修、加注、回收等有效利用，同時(shí)為減少突發(fā)勞損等航天器非自然破壞而引發(fā)的高昂成本，以及減小未來(lái)宇航員可能發(fā)生的艙外作業(yè)的危險(xiǎn)性，空間機(jī)械臂的研究逐漸進(jìn)入各個(gè)國(guó)家航天領(lǐng)域的視野[1-2]。

圖2 平移關(guān)節(jié)鎖定時(shí)的機(jī)械臂D-H坐標(biāo)系Fig.2 D-H coordinate system of manipulator with translational joint locking

空間多自由度機(jī)械臂的研究除了需要克服失重條件，另一個(gè)難點(diǎn)在于漂浮基座空間位置的不確定性，即基座的可移動(dòng)性，使機(jī)械臂的運(yùn)動(dòng)多了移動(dòng)導(dǎo)軌或者氣浮平臺(tái)這個(gè)冗余自由度，在完成規(guī)定動(dòng)作的目標(biāo)任務(wù)時(shí)，如何分配運(yùn)動(dòng)指令到各個(gè)關(guān)節(jié)和移動(dòng)基座，成為核心的技術(shù)指標(biāo)[3]。另外，衛(wèi)星基座的運(yùn)動(dòng)還要考慮到多種非確定性擾動(dòng)因子。這就使通常的數(shù)學(xué)解析或全物理實(shí)驗(yàn)都受到限制[4]。數(shù)學(xué)解析或純數(shù)字仿真無(wú)法真實(shí)還原太空環(huán)境，尤其是瞬間碰撞的數(shù)據(jù)無(wú)法通過(guò)建模準(zhǔn)確測(cè)出；而全物理實(shí)驗(yàn)中的重力補(bǔ)償與完全失重區(qū)別較大不能準(zhǔn)確模擬，所以國(guó)際上目前最新的方法多是采用數(shù)學(xué)仿真加實(shí)驗(yàn)平臺(tái)的半物理方法[5]。

用數(shù)學(xué)仿真完成動(dòng)力學(xué)過(guò)程，將運(yùn)動(dòng)指令直接賦給實(shí)驗(yàn)平臺(tái)的電機(jī)驅(qū)動(dòng)，將接觸碰撞的力學(xué)數(shù)據(jù)反饋給仿真控制平臺(tái)，進(jìn)行運(yùn)動(dòng)補(bǔ)償，從而實(shí)現(xiàn)空間機(jī)械臂移動(dòng)路徑的跟蹤規(guī)劃。而數(shù)學(xué)仿真的主要困難在于多剛體系統(tǒng)的動(dòng)力學(xué)特性分析。目前機(jī)械臂的研究分析一般從結(jié)構(gòu)學(xué)、運(yùn)動(dòng)學(xué)及動(dòng)力學(xué)三方面展開(kāi)[6]，運(yùn)動(dòng)學(xué)方程和動(dòng)力學(xué)方程是機(jī)械臂運(yùn)動(dòng)規(guī)劃的基礎(chǔ)。

對(duì)多關(guān)節(jié)運(yùn)動(dòng)機(jī)構(gòu)的研究，通常方法是分別在每個(gè)坐標(biāo)系上建立空間坐標(biāo)系，利用齊次坐標(biāo)轉(zhuǎn)換的方法，求解出每個(gè)關(guān)節(jié)的位置和姿態(tài)，直到末端執(zhí)行機(jī)構(gòu)的位姿[7]，即Denavit-Hartenberg方法，但是建立坐標(biāo)系方案的細(xì)節(jié)也有很多種[8-9]。

本實(shí)驗(yàn)研究的對(duì)象為星體基座帶三臂的空間機(jī)械臂系統(tǒng)，即給定各個(gè)關(guān)節(jié)值求末端操作器的物理量。主要困難仍然是由于自由飄浮基座的位置在關(guān)節(jié)角變化過(guò)程中同時(shí)變化，不能簡(jiǎn)單用地面固定基座的方法求解，需要綜合考慮基座位姿變化帶來(lái)的影響[10]。在研究空間或移動(dòng)基座機(jī)械臂問(wèn)題上，較為通行的方案是在固定基座機(jī)械臂的運(yùn)動(dòng)學(xué)方程基礎(chǔ)上，乘以一個(gè)基座隨移動(dòng)導(dǎo)軌運(yùn)動(dòng)的參數(shù)矩陣，從而全面反映整體自由度坐標(biāo)系的運(yùn)動(dòng)特性[11-12]。但此方法易出現(xiàn)冗余自由度，難以實(shí)現(xiàn)運(yùn)動(dòng)指令分配的自動(dòng)化[13]。而這一問(wèn)題的解決主要依靠閉環(huán)控制系統(tǒng)完成，通過(guò)機(jī)械臂的動(dòng)力學(xué)仿真反饋運(yùn)動(dòng)數(shù)據(jù)，進(jìn)行運(yùn)動(dòng)補(bǔ)償，以實(shí)現(xiàn)運(yùn)動(dòng)分配自動(dòng)化。

本文將探討運(yùn)用SimMechanics工具搭建動(dòng)力學(xué)系統(tǒng)平臺(tái)，進(jìn)而封裝成子模塊，嵌入到控制系統(tǒng)中調(diào)試，進(jìn)行路徑規(guī)劃，并加載到仿真機(jī)中運(yùn)行。并應(yīng)用Matlab和ADAMS作聯(lián)合仿真[14]，進(jìn)行動(dòng)力學(xué)特性的對(duì)比分析。

1 機(jī)械臂移動(dòng)路徑系統(tǒng)的原理模型

1.1 參數(shù)化多臂系統(tǒng)建模

機(jī)械臂抓捕系統(tǒng)動(dòng)力學(xué)建模主要包括三個(gè)部分：多機(jī)械臂系統(tǒng)的建模、操控飛行器平臺(tái)的建模以及操作目標(biāo)飛行器的建模。機(jī)械臂抓捕系統(tǒng)的動(dòng)力學(xué)模型示意圖如圖1所示。

圖1 機(jī)械臂抓捕系統(tǒng)動(dòng)力學(xué)模型示意圖Fig.1 Schematic diagram of the dynamic model of robotic arm arresting system

空間操控機(jī)械臂共有9個(gè)關(guān)節(jié)，采用3-1-1-1-3的偏置式布局方式，9個(gè)關(guān)節(jié)中包含7個(gè)轉(zhuǎn)動(dòng)關(guān)節(jié)和2個(gè)移動(dòng)關(guān)節(jié)，其中各轉(zhuǎn)動(dòng)關(guān)節(jié)的關(guān)節(jié)變量分別為θ1，θ2，θ3，θ4，θ5，θ6，θ7。當(dāng)機(jī)械臂執(zhí)行抓捕任務(wù)時(shí)，需將兩個(gè)平移關(guān)節(jié)鎖定，此時(shí)坐標(biāo)系定義如圖2所示。將機(jī)械臂的展開(kāi)狀態(tài)定義為初始參考構(gòu)型。

利用機(jī)構(gòu)動(dòng)力學(xué)仿真分析商業(yè)軟件ADAMS，建立全參數(shù)化的多機(jī)械臂系統(tǒng)動(dòng)力學(xué)模型。利用Matlab/Simulink與ADAMS聯(lián)合仿真，進(jìn)行運(yùn)動(dòng)學(xué)、動(dòng)力學(xué)以及平臺(tái)和多臂系統(tǒng)的協(xié)調(diào)控制分析。其核心問(wèn)題在于核驗(yàn)仿真結(jié)果的正確性，所以要基于數(shù)學(xué)動(dòng)力學(xué)方程的推算與對(duì)比。參數(shù)化機(jī)械臂動(dòng)力學(xué)模型的展開(kāi)和收攏效果示意如圖3所示。

圖3 機(jī)械展開(kāi)和收攏效果示意圖Fig.3 Schematic diagram of mechanical unfolding and folding

1.2 機(jī)械臂抓捕動(dòng)力學(xué)仿真分析

機(jī)械臂動(dòng)力學(xué)仿真分析主要包括以下幾個(gè)部分：機(jī)械臂位姿反解、關(guān)節(jié)空間的路徑規(guī)劃、笛卡兒空間的路徑規(guī)劃、飛行器的平臺(tái)控制、機(jī)械臂與平臺(tái)的協(xié)同控制、末端工具位姿調(diào)整等。

機(jī)械臂路徑規(guī)劃、位姿反解程序、平臺(tái)姿態(tài)控制在Matlab/Simulink中編寫(xiě)程序?qū)崿F(xiàn)，機(jī)械臂動(dòng)力學(xué)模型在ADAMS中實(shí)現(xiàn)，通過(guò)ADAMS/Control模塊與Simulink控制程序進(jìn)行信息交互，Simulink向ADAMS輸入機(jī)械臂每個(gè)關(guān)節(jié)的運(yùn)動(dòng)指令和操控飛行器平臺(tái)的控制力矩，ADAMS向Simulink反饋狀態(tài)量，完成聯(lián)合仿真。

1.3 機(jī)械臂的路徑規(guī)劃與抓捕及其主要問(wèn)題

對(duì)機(jī)械臂進(jìn)行路徑規(guī)劃時(shí)，機(jī)械臂的基座坐標(biāo)系與抓捕目標(biāo)坐標(biāo)系是相對(duì)固定的，因此需要將操控飛行器平臺(tái)與大地固定連接，而且需要鎖定機(jī)械臂的兩個(gè)平移關(guān)節(jié)，并鎖定第二個(gè)轉(zhuǎn)動(dòng)關(guān)節(jié)。

考慮單臂的路徑規(guī)劃。機(jī)械臂處于初始構(gòu)型時(shí)，7個(gè)轉(zhuǎn)動(dòng)關(guān)節(jié)相對(duì)于D-H坐標(biāo)系下的關(guān)節(jié)角為[180° 0° 70° 90° -70° 0° 45°]。

由此可實(shí)現(xiàn)以下全過(guò)程的仿真分析：機(jī)械臂末端工具由起始位置到目標(biāo)特定點(diǎn)的各個(gè)關(guān)節(jié)的空間路徑規(guī)劃；機(jī)械臂末端到達(dá)預(yù)期位置和姿態(tài)時(shí)，末端執(zhí)行機(jī)構(gòu)接收指令開(kāi)始工作，實(shí)施抓捕動(dòng)作。

其中主要問(wèn)題在于核驗(yàn)仿真分析的正確性，首先對(duì)仿真所基于的數(shù)學(xué)原理進(jìn)行分析，之后再運(yùn)用兩套仿真系統(tǒng)的結(jié)果數(shù)據(jù)作對(duì)比。

2 機(jī)械臂系統(tǒng)動(dòng)力學(xué)建模

2.1 算法原理模型

通過(guò)對(duì)比國(guó)內(nèi)外常用機(jī)械臂建模方法的優(yōu)劣，結(jié)合研究方向，采用基于Lagrange的建模方法。

基本假設(shè)：本實(shí)驗(yàn)研究的機(jī)械臂系統(tǒng)為剛體系統(tǒng)，且各零件之間彼此剛性連接；機(jī)械臂與載體及每條機(jī)械臂的臂與臂之間只有一個(gè)轉(zhuǎn)動(dòng)關(guān)節(jié)；忽略重力梯度影響。

2.2 運(yùn)動(dòng)學(xué)方程

采用基于D-H參數(shù)法的正運(yùn)動(dòng)學(xué)建模，正運(yùn)動(dòng)學(xué)方程可以描述相鄰連桿坐標(biāo)系之間的相對(duì)空間關(guān)系，從而可以根據(jù)每個(gè)連桿之間的相互關(guān)系，由基坐標(biāo)系遞推到末端坐標(biāo)系的表達(dá)式，即可推導(dǎo)出正運(yùn)動(dòng)學(xué)方程。

考慮基座慣性姿態(tài)由俯仰角θb、滾動(dòng)角φb和偏航角ψb給出，則從慣性坐標(biāo)系到基座坐標(biāo)系的坐標(biāo)轉(zhuǎn)換矩陣為

(1)

三條剛性臂的D-H參數(shù)一致，其中O0-x0y0z0坐標(biāo)原點(diǎn)與安裝坐標(biāo)系原點(diǎn)轉(zhuǎn)換矩陣為固定值。

對(duì)于任意一個(gè)滿(mǎn)足前述假設(shè)的多自由度運(yùn)動(dòng)體系，定義各種運(yùn)動(dòng)學(xué)參數(shù)如下。

R安裝坐標(biāo)系原點(diǎn)Oc關(guān)于大地坐標(biāo)系O0x0y0z0的位置矢徑。

v0安裝坐標(biāo)系原點(diǎn)Oc關(guān)于大地坐標(biāo)系O0x0y0z0的瞬時(shí)速度。

基于上述定義，可以給出多自由度上任一關(guān)節(jié)點(diǎn)的角速度和角加速度，以及任一點(diǎn)的位置，進(jìn)一步可以求出其速度和加速度。

第i組機(jī)械臂中第j節(jié)臂的質(zhì)心位置為

(2)

第i組機(jī)械臂中第j節(jié)臂的質(zhì)心線(xiàn)速度為

(3)

第i組機(jī)械臂中第j節(jié)機(jī)械臂的質(zhì)心角速度為

(4)

2.3 動(dòng)力學(xué)方程

三臂多自由度機(jī)械臂系統(tǒng)的拉格朗日公式為

(5)

系統(tǒng)的動(dòng)能為

(6)

為計(jì)算方便將T寫(xiě)成如下形式

T=T0+T1+T2

(8)

(9)

(10)

(11)

系統(tǒng)的廣義坐標(biāo)選為

(12)

式中：θT為角位移矩陣。

根據(jù)需要改寫(xiě)為

式中：δ0為本體的歐拉角，q(m)表示第m臂的關(guān)節(jié)角，系統(tǒng)動(dòng)力學(xué)方程的形式為

(16)

式中：C為一個(gè)N×1維矢量，包含了微重力環(huán)境下所有的非線(xiàn)性速度項(xiàng)；Q為一個(gè)N×1維廣義力矢量。H,C和Q為線(xiàn)位移σ0和角位移θ以及其一次求導(dǎo)的方程式。如除本體外，施加在系統(tǒng)其他部分的外力為零，則Q可以表示為

(17)

式中：0fs和0ns為施加在飛行器本體上的靜力；JQ為一個(gè)N×N的雅克比矩陣；τK×1為施加在各個(gè)臂的每個(gè)關(guān)節(jié)的控制力矩。為了獲得多臂多自由度空間機(jī)械臂的顯式動(dòng)力學(xué)表達(dá)形式，且減小計(jì)算的復(fù)雜度，在求解質(zhì)量矩陣H、非線(xiàn)性速度項(xiàng)C和廣義力Q之前，需要做一些預(yù)計(jì)算處理。

質(zhì)量矩陣H是加速度項(xiàng)的系數(shù)，經(jīng)過(guò)計(jì)算得到的Hij為

(18)

此處左上標(biāo)代表的是進(jìn)行微分的坐標(biāo)系，如果缺省表示慣性坐標(biāo)系。

式中的非線(xiàn)性速度項(xiàng)為

(19)

式中：C1為廣義位移一次求導(dǎo)的系數(shù)矩陣；C2為廣義位移的常量矩陣；而

(20)

(21)

如果除了本體，施加在系統(tǒng)其他部分的外力為零，雅克比矩陣JQ由下式?jīng)Q定，即

(22)

式中：T0為本體坐標(biāo)系到慣性坐標(biāo)系的轉(zhuǎn)換矩陣，S0為歐拉角速率到角速度的轉(zhuǎn)換矩陣；Ik×k為k階單位陣。定義如下

(23)

0ω0為本體坐標(biāo)系下的角速率矩陣。

至此，便完成了完整的動(dòng)力學(xué)求解過(guò)程。

3 基于Matlab與SimMechanics模塊的動(dòng)力學(xué)算法驗(yàn)證

3.1 動(dòng)力學(xué)模型的構(gòu)建

這里利用Matlab中的Simulink和SimMechanics作機(jī)械系統(tǒng)的建模和仿真分析，并將其模型的實(shí)時(shí)處理結(jié)果加載到仿真機(jī)中做硬件在回路的仿真。

SimMechanics內(nèi)嵌于Simscape中，并擴(kuò)展了其三維機(jī)械系統(tǒng)建模的能力，并應(yīng)用sensor和source模塊將其拓?fù)淠Ｐ偷奈锢硇畔⒎答佊诳刂葡到y(tǒng)，實(shí)現(xiàn)對(duì)閉環(huán)控制算法的開(kāi)發(fā)。

由于每一個(gè)支鏈的結(jié)構(gòu)都是相同的，并且支鏈內(nèi)部的各個(gè)參數(shù)涉及轉(zhuǎn)動(dòng)方向和移動(dòng)方向的計(jì)算。坐標(biāo)系以模型的初始狀態(tài)為基礎(chǔ)，根據(jù)D-H參數(shù)，為方便調(diào)試，每條支鏈在實(shí)體模塊中建立一個(gè)過(guò)渡坐標(biāo)系CS3,并用變量名表示。

Position標(biāo)簽下的CS1、CS2、CG、CS3根據(jù)初始狀態(tài)計(jì)算，CG為每個(gè)實(shí)體初始重心，CS1為該桿與固定平臺(tái)或上一實(shí)體連接的鉸點(diǎn)坐標(biāo)，CS3為初始狀態(tài)下該桿的長(zhǎng)度，CS2為理論上與移動(dòng)副連接的點(diǎn)坐標(biāo)，因此，把它和CS1的Show Port勾選。方括號(hào)中的實(shí)際坐標(biāo)值根據(jù)參考的坐標(biāo)系，結(jié)合D-H參數(shù)實(shí)際測(cè)量后填寫(xiě)。變量采用結(jié)構(gòu)體(Struct)形式。Orientation下的CG、CS1、CS2和CS3，主要是運(yùn)動(dòng)副坐標(biāo)系的旋轉(zhuǎn)方式，具體參數(shù)值的設(shè)置主要根據(jù)D-H參數(shù)定義的旋轉(zhuǎn)變換矩陣。同時(shí)將每個(gè)臂節(jié)的質(zhì)量慣量參數(shù)設(shè)計(jì)成變量輸入到對(duì)話(huà)窗的Mass和Inertia一欄中。

定義好一個(gè)臂節(jié)的參數(shù)后，就將其封裝成一個(gè)子模塊，嵌套進(jìn)一個(gè)七自由度機(jī)械臂的模塊，最后一個(gè)臂節(jié)的實(shí)體中CS2的參數(shù)涉及到末端位置姿態(tài)數(shù)據(jù)輸出，要添加額外的關(guān)節(jié)傳感器接口。

圖4為單只機(jī)械臂一個(gè)臂節(jié)的內(nèi)部模塊選用及構(gòu)架圖，相應(yīng)的英文名稱(chēng)為具體選取的模塊類(lèi)型，主要包括actuator(驅(qū)動(dòng)模塊)，用于傳輸外部驅(qū)動(dòng)數(shù)據(jù)如速度、力、力矩等，通過(guò)圖中的接口drivermo由外部控制系統(tǒng)輸入；sensor(實(shí)體傳感器模塊)測(cè)出revolute(關(guān)節(jié)模塊)的運(yùn)動(dòng)數(shù)據(jù)包括角度angle、角速度avelocity，并通過(guò)該名稱(chēng)的接口反饋給外部控制系統(tǒng)，eye為用戶(hù)對(duì)相應(yīng)實(shí)體的定義，因末端抓捕器含手眼視覺(jué)，所以定義為“eye_00”，實(shí)體內(nèi)部參數(shù)的定義上面已經(jīng)說(shuō)明，當(dāng)勾選“Show Port”時(shí)，將作為接口連接其他臂節(jié)，CS3未勾選，只作為過(guò)渡坐標(biāo)系統(tǒng)，便于不同型號(hào)下D-H參數(shù)的輸入。

圖4 單只臂節(jié)的內(nèi)部架構(gòu)Fig.4 Internal structure of single arm

圖5 一條機(jī)械臂的內(nèi)部架構(gòu)Fig.5 Internal structure of a mechanical arm

圖6 整個(gè)平臺(tái)動(dòng)力學(xué)的架構(gòu)Fig.6 Architecture of the whole platform dynamics

圖5為七個(gè)臂節(jié)通過(guò)名為“conn”的接口首尾相接構(gòu)成一個(gè)完整的機(jī)械臂arm，并和其余三個(gè)機(jī)械臂共同接于ground坐標(biāo)系下的星體安裝接口。其中每一個(gè)模塊為一個(gè)臂節(jié)，由圖4的臂節(jié)詳圖縮合而成，其輸入端口需從控制系統(tǒng)取得每個(gè)臂節(jié)的驅(qū)動(dòng)參數(shù)，由driver接口輸入，并通過(guò)鍵標(biāo)指號(hào)“D_A～D_G”引導(dǎo)，其輸出端口由“avelocity”“angle”端口向控制系統(tǒng)反饋每一個(gè)關(guān)節(jié)的角速度和角度運(yùn)動(dòng)參量，通過(guò)“A1～G1”“A_2～G_2”引導(dǎo)。

最后將完全相同的三條七自由度機(jī)械臂根據(jù)接口位置定義連接到操控飛行器平臺(tái)上，如圖6所示。將機(jī)械環(huán)境變量中的重力輸入選項(xiàng)勾掉，設(shè)置固定基座的中心坐標(biāo)默認(rèn)為零，平臺(tái)與其連接的關(guān)節(jié)選用Six-Dof 六自由度連接，表示飛行器完全不受約束，其中“Env”代表機(jī)械環(huán)境變量，ground為慣性坐標(biāo)系，XY_MoForce為控制系統(tǒng)傳入的飛行器平臺(tái)的驅(qū)動(dòng)數(shù)據(jù)，CS1接口為要向控制系統(tǒng)輸出星體各項(xiàng)運(yùn)動(dòng)參量的接口，包括位置p，速度v，角速度ω，姿態(tài)矩陣R和加速度a；并可通過(guò)顯示器將其數(shù)據(jù)顯示為隨時(shí)間變化的運(yùn)動(dòng)曲線(xiàn)。對(duì)于其他各條機(jī)械臂，除了關(guān)注各個(gè)關(guān)節(jié)運(yùn)動(dòng)數(shù)據(jù)外，還特別關(guān)注末端的運(yùn)動(dòng)數(shù)據(jù),包括位置、姿態(tài)、移動(dòng)速度、角速度。

SimMechanics模塊最好由每個(gè)模塊本身功能及原始英文加編號(hào)定義，便于Simulink中的控制系統(tǒng)以及和其他軟件的聯(lián)合調(diào)用，切不可譯成中文，否則會(huì)出現(xiàn)調(diào)用失敗。

將整個(gè)平臺(tái)動(dòng)力學(xué)SimMechanics模塊搭建好后，就可以設(shè)置輸入輸出接口，然后串行到控制系統(tǒng)中，接收外部輸入的驅(qū)動(dòng)信號(hào)、輸出位置、速度、姿態(tài)等反饋信號(hào)，進(jìn)行控制調(diào)試。

3.2 正逆運(yùn)動(dòng)學(xué)以及正動(dòng)力學(xué)的驗(yàn)算

將正逆運(yùn)動(dòng)學(xué)方程由3.2節(jié)推導(dǎo)的公式編入程序，寫(xiě)成m文件，或?qū)懭隕mbeded函數(shù)中，輸入不同的關(guān)節(jié)角指令，查驗(yàn)每個(gè)關(guān)節(jié)的位置姿態(tài)矩陣，并將運(yùn)行結(jié)果輸出到workspace，和SimMechanics每個(gè)實(shí)體的傳感器sensor檢測(cè)到的運(yùn)動(dòng)參數(shù)作比對(duì)，監(jiān)視其輸出結(jié)果，核驗(yàn)動(dòng)力學(xué)模型的正確性。

為核驗(yàn)動(dòng)力學(xué)模型的正確性，將ADAMS和SimMechanics搭建的動(dòng)力學(xué)模型的運(yùn)算結(jié)果進(jìn)行比對(duì)，在第一個(gè)關(guān)節(jié)角處輸入一個(gè)正弦力矩驅(qū)動(dòng)，查驗(yàn)各關(guān)節(jié)角度、角速度以及角加速度10 s內(nèi)運(yùn)行的變化曲線(xiàn)，仿真結(jié)果如圖7～9所示。

圖7 單只機(jī)械臂各個(gè)關(guān)節(jié)角10 s內(nèi)的變化Fig.7 Variation of each joint angle of the single arm in 10 s

圖8 單只機(jī)械臂各個(gè)關(guān)節(jié)角角速度10 s內(nèi)的變化Fig.8 Variation of angular velocity of each joint angle of the single arm in 10 s

圖9 單只機(jī)械臂各個(gè)關(guān)節(jié)角角加速度10 s內(nèi)的變化Fig.9 Variation of acceleration of each joint angle of the single arm in 10 s

經(jīng)過(guò)核驗(yàn)，發(fā)現(xiàn)在不同關(guān)節(jié)輸入不同驅(qū)動(dòng)下，其運(yùn)算后的角度、角速度及角加速度曲線(xiàn)與ADAMS驗(yàn)算的仿真曲線(xiàn)基本一致。圖10～11為在星體上的第一安裝坐標(biāo)系原點(diǎn)上輸入一個(gè)正弦驅(qū)動(dòng)后，其末端的工況曲線(xiàn)，包括機(jī)械臂末端相對(duì)于本體基座的姿態(tài)角(圖10)，相對(duì)于平臺(tái)的角速度(圖11)。從而驗(yàn)證了兩種動(dòng)力學(xué)模型構(gòu)建的正確性。

圖10 機(jī)械臂末端相對(duì)于平臺(tái)的姿態(tài)角Fig.10 Attitude angle of the manipulator relative to the platform

圖11 機(jī)械臂對(duì)于平臺(tái)的相對(duì)角速度Fig.11 Relative angular velocity of the manipulator to the platform

4 結(jié)束語(yǔ)

本文首先應(yīng)用拉格朗日公式推導(dǎo)了空間平臺(tái)帶3個(gè)機(jī)械臂的運(yùn)動(dòng)學(xué)方程和動(dòng)力學(xué)方程，并利用SimMechanics工具箱以及ADAMS軟件分別實(shí)現(xiàn)了對(duì)空間操控飛行器帶三個(gè)七自由度機(jī)械臂的動(dòng)力學(xué)模型的搭建，然后通過(guò)算法程序計(jì)算了末端執(zhí)行器的靜位姿態(tài)，核驗(yàn)了運(yùn)動(dòng)學(xué)理論方程的正確性，再通過(guò)在不同的關(guān)節(jié)處輸入不同的關(guān)節(jié)驅(qū)動(dòng)，觀察各個(gè)自由度的工況曲線(xiàn)，核查動(dòng)力學(xué)模型的正確性。

動(dòng)力學(xué)模型的搭建，實(shí)現(xiàn)了對(duì)空間機(jī)械臂在軌操作和抓捕等的仿真和運(yùn)動(dòng)模擬，為研究空間機(jī)器人問(wèn)題奠定基礎(chǔ)，并可嵌入到控制系統(tǒng)中，實(shí)現(xiàn)閉環(huán)聯(lián)合仿真測(cè)試，也可以為進(jìn)一步半物理實(shí)驗(yàn)做好基礎(chǔ)準(zhǔn)備工作。

該多自由度機(jī)械臂動(dòng)力學(xué)特性的理論分析和數(shù)學(xué)仿真是機(jī)器人學(xué)應(yīng)用的核心問(wèn)題。在多體動(dòng)力學(xué)的諸多領(lǐng)域，該多自由度機(jī)械臂有廣泛的應(yīng)用前景：航天領(lǐng)域如在軌操作、艙外維修等；醫(yī)學(xué)、建設(shè)、機(jī)械、生活領(lǐng)域，如醫(yī)用助力臂、車(chē)間沖壓機(jī)械手、自動(dòng)焊接設(shè)備、吊車(chē)抓捕、家用洗碗機(jī)等，建立模型時(shí)只需在機(jī)械環(huán)境變量中設(shè)置重力慣性環(huán)境。

[1] 翟光, 仇越, 梁斌, 等. 在軌捕獲技術(shù)發(fā)展綜述[J]. 機(jī)器人, 2008, 30(5): 467-477.

[2] 黃渙. 空間機(jī)器人功能行為建模與飛行任務(wù)仿真[D]. 長(zhǎng)沙: 國(guó)防科技大學(xué), 2009.

[3] 趙陽(yáng), 張大偉, 田浩, 等. 飛行器在軌任務(wù)[J]. 上海航天, 2009, 26(3): 38-41.

[4] SHAO Z F, TANG X Q, CHEN X, et al. Inertia match of a 3-RRR reconfigurable planar parallel manipulator [J]. Chinese Journal of Mechanical Engineering, 2009, 22(6): 791-799.

[5] 胡俊峰. 柔性機(jī)器人機(jī)構(gòu)動(dòng)力學(xué)分析及振動(dòng)控制研究[D]. 廣州: 華南理工大學(xué), 2010.

[6] NIKU S B. Introduction to robotics analysis, control, applications[M]. 2th ed. Cincinnati: Prentice Hall, 2001.

[7] 黃獻(xiàn)龍, 梁斌, 陳建新, 等. EMR系統(tǒng)機(jī)器人運(yùn)動(dòng)學(xué)分析和求解[J]. 宇航學(xué)報(bào), 2001, 22(2): 18-25.

[8] 梁斌, 劉良棟, 李庚田, 等. 空間機(jī)器人的動(dòng)力學(xué)等價(jià)機(jī)械臂[J]. 自動(dòng)化學(xué)報(bào), 1998, 24(6): 761-767.

[9] 王鴻鵬, 洪炳熔. 自由飛行空間機(jī)器人通用運(yùn)動(dòng)學(xué)模型及其仿真[J]. 宇航學(xué)報(bào), 2000, 21(3): 45-51.

[10] 胡松華, 薛力軍, 強(qiáng)文義, 等. 空間機(jī)器人系統(tǒng)動(dòng)力學(xué)建模與控制仿真研究[C]∥中國(guó)控制與決策學(xué)術(shù)年會(huì)論文集.南京: [s.n.], 2005: 1978-1987.

[11] 于登云, 孫京, 馬興瑞. 空間機(jī)械臂技術(shù)與發(fā)展分析[J]. 航天器工程, 2007, 16(4): 1-8.

[12] 范成建, 熊光明, 周明飛. 虛擬樣機(jī)軟件 MSC. ADAMS應(yīng)用與提高[M]. 北京: 機(jī)械工業(yè)出版社, 2006.

[13] 張國(guó)亮. 空間機(jī)器人遙操作中基于視覺(jué)的局部自主控制研究[D]. 哈爾濱: 哈爾濱工業(yè)大學(xué), 2010.

[14] ROVNER R. SimMechanics 3 getting started guide[M]. Massachusetts: Intel Robot System, 2009: 1-199.