朱敬花，邵珠楓

(1.九州職業(yè)技術(shù)學(xué)院機電與汽車工程系，江蘇徐州 221000；2.中國礦業(yè)大學(xué)信息與控制工程學(xué)院，江蘇徐州 221000)

0 前言

人機交互一般是指機器人/機械臂與自然人之間的交互，接觸式人機交互是最普遍、最廣泛的人機交互方式，在裝配機器人、手術(shù)機器人、護理機器人中得到了廣泛應(yīng)用[1]。由于接觸式交互機器人和自然人處在共同的工作空間，交互安全是首要考慮的問題，其次還要考慮交互的柔順性、自然性和平滑性。因此，研究人機間的柔順接觸交互問題，對于保證交互安全、提高機器人服務(wù)質(zhì)量具有重要意義。

機械臂接觸式交互的柔順性是指機械臂與外界環(huán)境接觸時產(chǎn)生順從運動的能力，根據(jù)控制方式的不同，機械臂柔順控制包括被動柔順控制和主動柔順控制2類[2]。被動柔順控制是指以彈簧、阻尼等吸能或儲能元件作為輔助元件，使機械臂對環(huán)境的接觸力產(chǎn)生被動的柔順。被動柔順控制這種借助外部元件的實現(xiàn)方式，無法滿足機械臂的高精度、高柔性接觸要求[3]，因此主動柔順控制應(yīng)需而生。主動柔順控制是指根據(jù)反饋的接觸力信息，通過主動控制接觸力大小的方式，實現(xiàn)機械臂與環(huán)境交互的柔順性。主動柔順控制包括力/位控制和阻抗控制2類[4]。力/位混合控制的核心思想是將任務(wù)空間分解為相互獨立的位置控制子空間和力控制子空間，并各自進行獨立控制的方式[5]。力/位混合控制在機械臂和環(huán)境參數(shù)已知的情況下可以取得較好的控制效果，但是在參數(shù)未知情況下難以取得預(yù)期效果。阻抗控制將機械臂與環(huán)境接觸過程建模為質(zhì)量-阻尼-彈簧系統(tǒng)，并針對力和位移之間的關(guān)系進行動態(tài)控制[6]。根據(jù)實現(xiàn)方式的不同，阻抗控制分為力阻抗控制和位置阻抗控制，在環(huán)境參數(shù)未知的前提下，位置阻抗控制表現(xiàn)出更強的魯棒性和環(huán)境適應(yīng)性。文獻[7]針對空間機械臂加注時的插孔控制問題，設(shè)計了基于阻抗控制的柔順控制方法，通過仿真驗證了該方法的有效性。文獻[8]研究了漂浮空間機器人抓捕不配合衛(wèi)星過程的柔順控制問題，設(shè)計了一種旋轉(zhuǎn)型串聯(lián)彈性執(zhí)行器，經(jīng)仿真驗證了該方法在衛(wèi)星抓捕過程中的有效性。文獻[9]針對重載液壓機械臂的柔順控制問題，提出了基于遺傳神經(jīng)網(wǎng)絡(luò)的位置/力同環(huán)控制算法，用于高功率動態(tài)機械臂的柔度控制。

柔順控制需要已知機械臂的動力學(xué)參數(shù)并感知末端接觸力，但是存在以下問題：(1)動力學(xué)參數(shù)一般通過人為設(shè)定或者試驗得到，但是當(dāng)前辨識方法存在損失函數(shù)鞍點多、辨識誤差大等問題；(2)末端接觸力需要力傳感器進行測量，這種方式增加了系統(tǒng)復(fù)雜度，也限制了柔順控制的推廣使用。

針對上述問題，本文作者研究機械臂系統(tǒng)動力學(xué)參數(shù)的遞歸辨識方法和柔順控制方法。首先，針對傳統(tǒng)辨識方法損失函數(shù)鞍點多、易陷入局部最優(yōu)、計算量大的問題，提出機械臂由外向內(nèi)遞歸的參數(shù)辨識方法；其次，針對機械臂柔順控制問題，設(shè)計基于非奇異終端滑?？刂频奈恢米杩箍刂破鳎蛔詈?，通過實驗驗證上述方法的有效性和優(yōu)越性。

1 機械臂動力學(xué)模型及參數(shù)辨識

1.1 包含未知參數(shù)的動力學(xué)模型

對于具有N個關(guān)節(jié)的機械臂系統(tǒng)，考慮系統(tǒng)中的未知擾動和摩擦力矩，得到機械臂系統(tǒng)動力學(xué)方程[10]為

(1)

摩擦的類型包括滑動摩擦、滾動摩擦和靜摩擦，人機交互運動過程中，機械臂摩擦力主要表現(xiàn)為滑動摩擦，則：

(2)

式中：ν=diag(ν1，ν2，…，νN)為關(guān)節(jié)的滑動摩擦因數(shù)。

將動力學(xué)方程中的未知參數(shù)全部歸納到矩陣?中，為

(3)

式中：?i為關(guān)節(jié)i的未知參數(shù)矩陣；mi為連桿i的質(zhì)量；Ii為連桿i的轉(zhuǎn)動慣量；νi為關(guān)節(jié)i的滑動摩擦因數(shù)。

1.2 基于遞歸的參數(shù)降維辨識方法

(4)

上述參數(shù)辨識方法的目標(biāo)函數(shù)為minL，但是這種辨識方法存在以下問題：(1)未知參數(shù)共有3N個，全部耦合在一起進行辨識，極大地增加了計算量和計算復(fù)雜度；(2)損失函數(shù)的損失面函數(shù)存在大量鞍點(即局部極值點)，辨識過程中容易陷入局部最優(yōu)而降低參數(shù)辨識精度。

為了解決上述問題，作者采用遞歸的方式由外而內(nèi)地辨識連桿動力學(xué)參數(shù)，實現(xiàn)了參數(shù)降維，降低了算法復(fù)雜度，同時解決了損失面函數(shù)的鞍點問題。對連桿i進行力分析和力矩分析，如圖1所示。

圖1 連桿力/力矩分析Fig.1 Force/moment analysis of connecting rod

圖1中：Zi-1和Zi分別為關(guān)節(jié)i-1和關(guān)節(jié)i的Z坐標(biāo)軸；fi為連桿i受到的合力；τi為連桿i的驅(qū)動力矩；ωi為連桿i質(zhì)心的轉(zhuǎn)動角速度；pi為關(guān)節(jié)相較于質(zhì)心的力臂。連桿i質(zhì)心位置受到的力Fi和力矩Ti為

(5)

式中：vci連桿i質(zhì)心的線速度矢量；Δt為采樣間隔。

基于牛頓-歐拉法得到連桿i的驅(qū)動力矩τi為

(6)

使用遞歸的方法由外而內(nèi)依次辨識機械臂的動力學(xué)參數(shù)，具體步驟為：

(2)由外向內(nèi)遞歸，依次辨識出連桿N、N-1、…、1的動力學(xué)參數(shù)。

將文中基于遞歸的參數(shù)辨識法與傳統(tǒng)的辨識方法相比，可以看出此辨識方法具有以下優(yōu)勢：

(1)式(4)給出的傳統(tǒng)辨識法中，共有3N個參數(shù)同時辨識；此方法每次辨識3個參數(shù)，通過N次辨識完畢，實現(xiàn)了辨識參數(shù)的單次降維，極大地降低了計算過程的復(fù)雜程度；

(2)從損失函數(shù)的角度講，傳統(tǒng)辨識方法損失函數(shù)中包含3N個平方項的和；此辨識方法的損失函數(shù)中只包含3個平方項的和，這意味著傳統(tǒng)損失面函數(shù)的鞍點(極值點)必然遠遠多于此辨識方法。因此，此方法的辨識精度從理論上高于傳統(tǒng)辨識方法。

2 機械臂柔順控制方法

此節(jié)設(shè)計了非奇異終端滑模阻抗控制器，實現(xiàn)對機械臂的柔順控制。其核心思想是：將機械臂末端的接觸力轉(zhuǎn)化為軌跡偏差，通過對期望軌跡進行修正，實現(xiàn)全關(guān)節(jié)空間的柔順控制。

2.1 基于位置阻抗控制的期望軌跡修正方法

阻抗控制將機械臂末端與環(huán)境之間的接觸模型等效為質(zhì)量-阻尼-彈性模型，如圖2所示。其中：M為接觸模型的質(zhì)量矩陣；B為阻尼矩陣；K為彈性矩陣；Fe為環(huán)境接觸力。

圖2 阻抗模型Fig.2 Impedance model

對機械臂的關(guān)節(jié)軌跡進行跟蹤控制，實現(xiàn)關(guān)節(jié)位置的二階阻抗模型[11]為

(7)

式中：qex為期望的關(guān)節(jié)角位置；q為實際的關(guān)節(jié)角位置。

穩(wěn)態(tài)時，機械臂的接觸力為

K(qex-q)=Fe

(8)

基于雅可比矩陣，可以將機械臂接觸力Fe轉(zhuǎn)化為關(guān)節(jié)驅(qū)動力τe：

τe=JTFe

(9)

式中：J為雅可比矩陣。

(10)

式中：qxz為修正的期望關(guān)節(jié)角軌跡。

分析式(10)可知：基于機械臂動力學(xué)模型，可以將接觸力轉(zhuǎn)化為關(guān)節(jié)角軌跡的修正值，通過對期望軌跡進行修正，實現(xiàn)機械臂末端的柔順控制。綜合上述分析，得到阻抗控制框架如圖3所示。

圖3 阻抗控制框架Fig.3 Framework of impedance control

圖3給定的阻抗控制方法，通過將接觸力轉(zhuǎn)化為期望軌跡修正量，實現(xiàn)了機械臂的柔順控制。但是其中的角位置控制器尚未設(shè)計，在下一小節(jié)中實現(xiàn)。

2.2 考慮參數(shù)不確定性的角位置控制器設(shè)計

在設(shè)計角位置控制器時，需要考慮以下2個方面：(1)必須考慮動力學(xué)參數(shù)不確定性引起的控制誤差，并對這一控制誤差進行補償；(2)機械臂控制具有較高的實時性要求。針對上述2個方面，角位置控制器設(shè)計如下：(1)使用RBF神經(jīng)網(wǎng)絡(luò)對參數(shù)不確定性進行補償；(2)考慮到非奇異終端滑?？刂凭哂锌焖偈諗俊⒎€(wěn)態(tài)精度高的優(yōu)點，基于非奇異終端滑模控制設(shè)計機械臂控制器。

定義角位置跟蹤誤差為e=qxz-q，設(shè)計非奇異終端滑模面s為

(11)

式中：s=(s1，s2，…，sN)T為各關(guān)節(jié)控制器滑模面；λ=diag(λ1，λ2，…λN)為滑模面斜率矩陣；m和k為人為設(shè)定的正奇數(shù)，要求m∈(k，2k)。

將機械臂接觸力轉(zhuǎn)化的驅(qū)動力τe考慮到動力學(xué)方程中，則式(1)可以寫為

(12)

對非奇異終端滑模面函數(shù)s求導(dǎo)，并將式(12)代入，得：

(13)

參考文獻[12]設(shè)計一種具有快速收斂能力的指數(shù)趨近律：

(14)

式中：a>0、b>0為人為設(shè)定參數(shù)。選取較大的a值，可以使系統(tǒng)狀態(tài)的趨近速度遠大于等速趨近過程，從而提高機械臂軌跡的跟蹤速度。

將式(13)代入到式(14)中，并使用RBF神經(jīng)網(wǎng)絡(luò)對未知擾動τd進行估計，得到控制律τ為

(15)

式中：τ為機械臂控制律；τ1為逆動力學(xué)的解算力矩；τ2為趨近過程控制力矩；τ3為基于RBF神經(jīng)網(wǎng)絡(luò)的補償力矩；θ為網(wǎng)絡(luò)權(quán)值矩陣；φ(χ)為激活函數(shù)，χ為神經(jīng)網(wǎng)絡(luò)輸入?yún)?shù)。

(16)

式中：Γθ為正定實數(shù)矩陣。

2.3 柔順控制框架及穩(wěn)定性分析

基于上述位置阻抗控制器和角位置控制器的設(shè)計原理，得到機械臂柔順控制框架如圖4所示。

圖4 機械臂柔順控制框架Fig.4 Framework of manipulator compliance control

使用Lyapunov理論[13]對機械臂控制系統(tǒng)的穩(wěn)定性進行分析，能量函數(shù)設(shè)計為

(17)

對能量函數(shù)求導(dǎo)，得：

(18)

分別代入τ1、τ2、τ3，得

(19)

3 實驗驗證與分析

此節(jié)從2個方面對柔順控制方法進行驗證：(1)對動力學(xué)參數(shù)進行辨識和精度驗證；(2)對柔順控制的位置控制和接觸力控制精度進行驗證。

3.1 動力學(xué)參數(shù)辨識與精度驗證

搭建的機械臂實驗平臺包括工控機、電氣控制柜和機械臂本體，其中機械臂本體固定在支架上，如圖5所示。

圖5 機械臂實驗平臺Fig.5 Experimental platform of manipulator：(a)experimental system；(b)manipulator body

機械臂本體由肩關(guān)節(jié)1、肩關(guān)節(jié)2、大臂、肘關(guān)節(jié)和小臂組成。不同關(guān)節(jié)角軌跡對辨識參數(shù)的激發(fā)效果是不同的，文中使用對干擾不敏感、速度和加速度平滑性極好的Fourier級數(shù)作為關(guān)節(jié)角軌跡：

(20)

對于關(guān)節(jié)i，其激勵軌跡的待定系數(shù)具有2D+1個，為了充分激發(fā)出關(guān)節(jié)動力學(xué)參數(shù)、提高參數(shù)辨識精度，最優(yōu)激勵軌跡的確定使用文獻[14]中的確定方法。而后分別使用傳統(tǒng)辨識方法和遞歸辨識方法對動力學(xué)參數(shù)進行辨識，結(jié)果如表1所示。

表1 動力學(xué)參數(shù)辨識結(jié)果Tab.1 Identification results of dynamic parameters

基于第1.2節(jié)的參數(shù)遞歸辨識方法，得到參數(shù)辨識結(jié)果如表1所示。

由表1可知：傳統(tǒng)方法和遞歸方法得到的辨識結(jié)果有一定差別。由于動力學(xué)參數(shù)真值未知，無法直接比較2種辨識方法的優(yōu)劣。將參數(shù)辨識結(jié)果代入式(1)中得到辨識力矩，再與真實力矩比較，以關(guān)節(jié)2的辨識結(jié)果為例，結(jié)果如圖6所示。

圖6 關(guān)節(jié)2的力矩反算結(jié)果Fig.6 Torque inverse calculation result of joint 2

統(tǒng)計2種方法反算力矩的累計絕對誤差，傳統(tǒng)辨識方法反算力矩的累計絕對誤差為9.35 N·m，遞歸辨識方法反算力矩的累計絕對誤差為1.05 N·m。結(jié)合圖6可知：傳統(tǒng)辨識方法反算力矩與真實力矩的誤差明顯大于遞歸辨識方法反算力矩的誤差。這是因為傳統(tǒng)辨識方法同步辨識所有的參數(shù)，損失面函數(shù)中存在大量的鞍點位置，在辨識過程極易陷入局部最優(yōu)位置；而遞歸辨識方法由外向內(nèi)逐步遞歸，一步只辨識一個機械臂的未知參數(shù)，其損失面函數(shù)中鞍點極少，因此遞歸辨識方法的參數(shù)精度遠遠高于傳統(tǒng)辨識方法。

3.2 柔順控制效果驗證

以機械臂定點打磨平面形的鋁合金計算機外殼為例，鋁合金計算機外殼如圖7所示。

將期望接觸力設(shè)置為20 N，阻抗參數(shù)設(shè)計為M=[20，20，20]T，B=[200，200，200]T，K=[150，150，150]T。根據(jù)任務(wù)需要，機械臂3個關(guān)節(jié)的期望關(guān)節(jié)角分別為0°、24°、41°。在機械臂末端加裝力傳感器，測量末端接觸力，從而驗證柔順控制效果。

圖8給出了關(guān)節(jié)1-3的期望軌跡、修正的期望軌跡和實際跟蹤軌跡，可知：實際軌跡能夠較為精確地跟蹤修正的期望軌跡，說明非奇異終端滑?？刂破髂軌蚩焖?、精確地跟蹤期望軌跡。

為了驗證基于位置阻抗控制對接觸力的控制效果，同時使用文中方法與文獻[15]的神經(jīng)網(wǎng)絡(luò)阻抗控制方法對鋁合金計算機外殼進行打磨，2種方法的接觸力控制效果如圖9所示。

圖9 接觸力控制效果Fig.9 Control effect of contact force

經(jīng)計算，在文中位置阻抗控制下，接觸力誤差最終在±0.4 N范圍內(nèi)波動；在神經(jīng)網(wǎng)絡(luò)阻抗控制作用下，接觸力誤差最終在[-1.8，-0.5]N內(nèi)波動。另外，在文中位置阻抗控制作用下，接觸力在2.8 s達到設(shè)定值；而在神經(jīng)網(wǎng)絡(luò)阻抗控制作用下，接觸力在5.4 s達到設(shè)置值。結(jié)合圖9的控制效果可知：文中位置阻抗控制方法可以快速、準(zhǔn)確地跟蹤設(shè)定接觸力。這是因為：(1)使用遞歸參數(shù)辨識方法有效提高了參數(shù)的辨識精度，進而提高了控制精度；(2)在角位置跟蹤控制中，利用快速收斂、穩(wěn)態(tài)精度高的非奇異終端滑模控制器進行跟蹤，實現(xiàn)了角位置的快速、精確控制。

實驗結(jié)果表明：基于期望軌跡修正的位置阻抗控制能夠?qū)崿F(xiàn)機械臂與環(huán)境的自然、柔順交互，能夠快速、準(zhǔn)確跟蹤設(shè)定的接觸力。

4 結(jié)論

文中研究了機械臂系統(tǒng)的動力學(xué)參數(shù)辨識與主動柔順控制問題，首先針對傳統(tǒng)辨識方法存在的鞍點多、易陷入局部最優(yōu)、計算復(fù)雜等問題，提出了機械臂參數(shù)由外而內(nèi)的遞歸辨識方法。然后針對機械臂與環(huán)境交互的柔順控制問題，設(shè)計了基于非奇異終端滑模控制的位置阻抗控制器。

經(jīng)實驗驗證得出以下結(jié)論：(1)基于傳統(tǒng)辨識方法的反算力矩累計絕對誤差為9.35 N·m，基于遞歸辨識方法的反算力矩累計絕對誤差為1.05 N·m，說明參數(shù)遞歸辨識精度遠高于傳統(tǒng)辨識方法；(2)文中位置阻抗控制作用下，接觸力在2.8 s達到設(shè)定值，誤差波動范圍為±0.4 N，與神經(jīng)網(wǎng)絡(luò)阻抗控制比具有更高的控制精度和更快的跟蹤速度。