張海濤

(合肥通用職業(yè)技術(shù)學(xué)院機(jī)械工程系 安徽合肥 230031)

在控制范疇中變結(jié)構(gòu)自動控制系統(tǒng)屬邊緣學(xué)科，在當(dāng)今己經(jīng)發(fā)展成與其它系統(tǒng)可區(qū)分的控制學(xué)科，變結(jié)構(gòu)控制體系不但在明確性與不明確性、線性和非線性系統(tǒng)中可以適用，而且還可以適用于集合控制和分散控制、持續(xù)和離散、集中參數(shù)與分散參數(shù)系統(tǒng)等系統(tǒng)。變結(jié)構(gòu)控制實質(zhì)是一類獨特的非線性控制系統(tǒng)，它的特點是控制系統(tǒng)機(jī)構(gòu)的非靜態(tài)性，它能夠有方向變化，依據(jù)當(dāng)前所處的狀態(tài)環(huán)境的改變，有目的的使系統(tǒng)按照預(yù)定“滑動模態(tài)”進(jìn)行軌跡運動，這種基于“滑動模態(tài)”的軌跡控制過程，我們稱之為滑模控制。除此之外它還體現(xiàn)為控制的不連續(xù)性。非線性系統(tǒng)上的魯棒性和抗干擾性是滑?？刂扑憩F(xiàn)的最大的優(yōu)點，本文主要對六自由度機(jī)械臂在滑模變空結(jié)構(gòu)中設(shè)計出一套通用的滑?？刂破?，以此優(yōu)化機(jī)械臂在運動軌跡控制上的規(guī)劃問題。

一、機(jī)械臂位姿描述

如圖1所示為現(xiàn)代化生產(chǎn)線上經(jīng)常使用到的PUMA560型機(jī)械臂。這種機(jī)械臂有6個可以自由運動的關(guān)節(jié)，分別是大臂、小臂、底座等組成。手臂的前端有3個自由度，分別是大軸底座的轉(zhuǎn)動為自由度1，肩部主軸的轉(zhuǎn)動為自由度2和肘部主軸的轉(zhuǎn)動為自由度3。通過安裝在底座軸中心的伺服電機(jī)來實現(xiàn)的機(jī)械臂機(jī)體繞主軸的回轉(zhuǎn)。機(jī)械臂是依靠安裝在內(nèi)部的平衡裝置來控制大臂和小臂的平衡的?；剞D(zhuǎn)平臺上安裝機(jī)械臂的大臂臺座。大臂上下擺動是通過安裝在內(nèi)部的直流伺服電機(jī)實現(xiàn)的。大臂的臂體的前端關(guān)節(jié)處安裝了小臂,安裝在內(nèi)部的伺服電機(jī)可帶動小臂的上下俯仰和小臂的回轉(zhuǎn)運動。手臂的后端有3個自由度，分別是手臂的轉(zhuǎn)動為自由度4，手腕軸的俯仰轉(zhuǎn)動為自由度5和機(jī)械臂的執(zhí)行端的轉(zhuǎn)動為自由度6。通過伺服電機(jī)來控制機(jī)械臂的小臂前端的腕部的擺動和轉(zhuǎn)動。各個關(guān)節(jié)的協(xié)同合作，通過安裝在各個關(guān)節(jié)處的傳感器來收集信號并反饋給控制系統(tǒng)，最終完成事先編制好程序的各種指定工作[1]。

圖1 PUMA560機(jī)械臂連桿坐標(biāo)系示意圖

機(jī)械臂PUMA560作為一個6自由度機(jī)械臂，它的結(jié)構(gòu)是串聯(lián)開鏈結(jié)構(gòu)，它的6個關(guān)節(jié)都是轉(zhuǎn)動關(guān)節(jié)，其中前3個關(guān)節(jié)用來確定機(jī)械臂末端的位置,后3個關(guān)節(jié)的軸線交于一點來確定機(jī)械臂末端執(zhí)行器的位置。因此選取這個交點為機(jī)械臂末端執(zhí)行器的參考點，機(jī)械臂桿件坐標(biāo)參數(shù)如表1所示。

表1 PUMA560機(jī)械臂桿件坐標(biāo)參數(shù)

二、滑動模態(tài)的控制

滑動模態(tài)變結(jié)構(gòu)的控制過程主要是在切換面雙側(cè)，通過改變開關(guān)來實現(xiàn)系統(tǒng)結(jié)構(gòu)發(fā)生改變，切換函數(shù)s(x)用表示，當(dāng)s(x)=0時可以表示切換面。

通常的常非線性系統(tǒng)表達(dá)式如下：

方程式中，x∈Rn記為體系的狀態(tài)向量，u∈Rm稱為控制向量。在式1的狀態(tài)環(huán)境中，當(dāng)轉(zhuǎn)換成s(x,t)=s(x1,x2,...,xn)=0時兩個上下部分構(gòu)成了狀態(tài)環(huán)境即，s〉0或s〈0。其中通常點、起始點和終止點是在s=0上點的三種情況，它們對應(yīng)圖2中的A，B和C三類點。

圖2 切換面上三種點的特性

三種運動點可分為:

常點：當(dāng)一點運動到s=0切換面周圍時保持其原有狀態(tài)，并且通過此點(對應(yīng)圖中點A)。起點：當(dāng)點運動到s=0周圍時，從轉(zhuǎn)換面的兩側(cè)遠(yuǎn)離該點(對應(yīng)圖中點B )。終點：當(dāng)點運動到s=0周圍時，從轉(zhuǎn)換面兩邊接近這點(對應(yīng)圖中點C)且停頓在上面[2]。

假如每個點全是終止點，在轉(zhuǎn)換面的某一區(qū)域內(nèi)，只要接近該區(qū)域該點將會被“吸引”，那么將該周圍叫做“滑動模態(tài)”區(qū)。在滑動模態(tài)范圍內(nèi)，若能夠滿足終止點的條件，在某一個運動點移動到轉(zhuǎn)換面s=0的周圍時則有：

其中u+(x) ≠u-(x)，滿足前面的條件使得：

(1)滑動模態(tài)是存在狀態(tài)；

(2)滑模面外的活動的點能夠在規(guī)定的時間內(nèi)抵達(dá)滑模面，即符合以下公式：

(3)使其穩(wěn)定性得到保證；

(4)符合動態(tài)品質(zhì)的基本要求。

符合這四個條件時就稱之為滑模變結(jié)構(gòu)控制。這四個條件也是滑?？刂频乃膫€基本條件。

三、基于RBF滑模變結(jié)構(gòu)的控制算法

RBF具有很強(qiáng)的逼近能力，在前饋神經(jīng)它具有訓(xùn)練速度快，方法簡單，不會產(chǎn)生極小值，它的輸出值和權(quán)值都成線性關(guān)系等特點，因此用RBF進(jìn)行滑?？刂平Y(jié)構(gòu)。

RBF滑模變控結(jié)構(gòu)設(shè)計是將切換函數(shù)連接到神經(jīng)網(wǎng)絡(luò)RBF輸入端中，將滑?？刂破鞯妮斎攵伺c神經(jīng)網(wǎng)絡(luò)RBF的輸出端連接[3]。RBF滑模變結(jié)構(gòu)控制器結(jié)構(gòu)圖如下圖3所示。

圖3 RBF滑模變結(jié)構(gòu)控制器結(jié)構(gòu)圖

將一個被控對象為

的系統(tǒng)，設(shè)r(t)為它的位置指令，設(shè)為它的切換函數(shù)。

基于RBF滑?？刂破髟O(shè)計在滑模控制器的前端，RBF網(wǎng)絡(luò)的輸出端用字母u 表示輸出，輸出結(jié)果作為滑模變結(jié)構(gòu)控制器的輸入值。即m作為隱含層神經(jīng)元的個數(shù)。RBF網(wǎng)絡(luò)通過不斷調(diào)整權(quán)值E，使得的值趨向于0，實現(xiàn)滑模變結(jié)構(gòu)控制的目的。

四、笛卡爾坐標(biāo)系下的機(jī)械臂

把機(jī)械臂放置笛卡爾坐標(biāo)系中，對其中的各個關(guān)節(jié)進(jìn)行軌跡參數(shù)的設(shè)定，在t為0時設(shè)置初始參數(shù)，根據(jù)機(jī)械臂的軌跡進(jìn)行運算，每個時間加量△t產(chǎn)生一個數(shù)值，對應(yīng)于機(jī)械臂關(guān)節(jié)所處的位置。通過笛卡爾坐標(biāo)系的變換，產(chǎn)生相對應(yīng)的關(guān)節(jié)變量值，對這兩個過程中所產(chǎn)生的位置信息進(jìn)行比較，如果不同，則重新返回計算，如果相同，則可以退出循環(huán)，算法計算結(jié)束。由于在位置求解過程中，關(guān)節(jié)的數(shù)量較多，必須引入矩陣計算，在得知位置結(jié)果的情況下求解過程信息對矩陣的逆計算，如圖4所示。

圖4 笛卡爾坐標(biāo)系下的關(guān)節(jié)算法

在笛卡爾坐標(biāo)系中進(jìn)行機(jī)械臂的軌跡規(guī)劃，需要對機(jī)械臂關(guān)節(jié)位置的逆運動學(xué)求解，其中最主要的問題是，在通過笛卡爾坐標(biāo)系變換的情況下，已知機(jī)械臂末端位置來求解機(jī)械臂各關(guān)節(jié)在運動過程中的空間坐標(biāo)，這是相當(dāng)困難的。但是通過上述算法過程，我們可以按照如下步驟完成對機(jī)械臂關(guān)節(jié)的逆運動學(xué)求解：

（1）笛卡爾坐標(biāo)系內(nèi)機(jī)械臂末端空間點的選擇可以是任意的，也可以是按照規(guī)律最初設(shè)定好的，但是空間點的坐標(biāo)必須是連續(xù)變化的。

（2）跳躍空間節(jié)點的選取必須通過擬合曲線來求解，在位置空間位置的情況下，通過插值函數(shù)，求解中間數(shù)值，在插值節(jié)點數(shù)足夠多的情況下，擬合曲線是光滑的。對于笛卡爾坐標(biāo)系內(nèi)擬合曲線的求解，與機(jī)械臂本身的結(jié)構(gòu)特性有關(guān)。相對于本文中所示的六自由度機(jī)械臂，可以通過增加插值函數(shù)內(nèi)的點來進(jìn)行快速求解[4]。

五、六自由度機(jī)械臂滑模變結(jié)構(gòu)控制的設(shè)計

滑動模態(tài)是指滑動模態(tài)運動軌跡限制在某個理想的區(qū)域，它可以解決當(dāng)使用切換函數(shù)而引起的抖振問題時，可以通過準(zhǔn)滑動模態(tài)控制器的方法來解決滑模控制的抖振問題。當(dāng)準(zhǔn)滑動模態(tài)滿足＜0條件時，它就要求在滑動模態(tài)的切面區(qū)域上進(jìn)行變結(jié)構(gòu)切換。在現(xiàn)實生活中許多的系統(tǒng)應(yīng)用中都應(yīng)用到了滑動模態(tài)能夠減弱抖振問題。本節(jié)中準(zhǔn)滑動模態(tài)控制器將原來的控制器函數(shù)符號sgn(s)使用飽和函數(shù)符號sat(s)，來進(jìn)行替換。

圖5 飽和函數(shù)

s的線性函數(shù)使用sat(s)符號表示，所以根據(jù)線性函數(shù)的特點，可知它的反饋控制也是連續(xù)性的,另外切換控制方法也可以使用在邊界層外[5]。通過對滑?？刂七M(jìn)行各個自由度的解耦，可以把系統(tǒng)模型劃分成六塊小的子系統(tǒng)，然后在進(jìn)行對各個子系統(tǒng)進(jìn)行劃面切換設(shè)計，這樣能夠快速的確定趨向原點的各個滑動模塊。

六、基于滑模變結(jié)構(gòu)控制的機(jī)械臂運動軌跡仿真

根據(jù)表1中關(guān)于PUMA560機(jī)械臂桿件坐標(biāo)參數(shù)，在MATLAB軟件中，可以使用相應(yīng)的功能插件，功能插件對應(yīng)的工具條可以對機(jī)械臂的相應(yīng)參數(shù)進(jìn)行設(shè)定，為了實現(xiàn)對機(jī)械臂軌跡的仿真，根據(jù)前述表格的機(jī)械臂各關(guān)節(jié)節(jié)點在笛卡爾坐標(biāo)系下的初始位置，需要對軟件參數(shù)進(jìn)行相應(yīng)的設(shè)定，以方便后續(xù)運算的系統(tǒng)調(diào)用。

動態(tài)環(huán)境下遇到障礙的機(jī)械臂軌跡路徑規(guī)劃，“動態(tài)環(huán)境”的界定主要是指在機(jī)械臂的軌跡規(guī)劃過程中，可能在任意位置出現(xiàn)障礙，這種出現(xiàn)是隨機(jī)的，不是設(shè)定好的，而系統(tǒng)可以根據(jù)這種隨機(jī)出現(xiàn)的障礙進(jìn)行軌跡規(guī)劃的調(diào)整，并規(guī)劃出合理的滿足要求的運行軌跡。

依據(jù)功能插件對機(jī)械臂初始參數(shù)進(jìn)行輸入，在輸入的過程中要注意輸入的順序，以防止由于參數(shù)順序錯誤導(dǎo)致軌跡運動無法正常進(jìn)行，相關(guān)空間曲線坐標(biāo)點如表2所示。

表2 空間曲線坐標(biāo)點

運行MATLAB軟件，在 Robotics Toolbox 工具欄，使用link 函數(shù)用來創(chuàng)建一個桿件，它有兩種創(chuàng)建方法，文中使用了改進(jìn)的D-H（modified）參數(shù)，分別對應(yīng)于兩種坐標(biāo)系的進(jìn)行參數(shù)設(shè)置。還有一種是采用標(biāo)準(zhǔn)的D-H參數(shù)（standard），本文并未使用。

在對系統(tǒng)參數(shù)進(jìn)行設(shè)定的過程中，元素0代表轉(zhuǎn)動關(guān)節(jié)，元素1代表移動關(guān)節(jié)。Link的另外四個參數(shù)α,a,d,θ，分別表示如下：連桿兩端軸線之間的公垂線的長度定義成連桿的長度α，連桿的扭角a定義成連桿兩端軸線在公垂線方向的夾角。相鄰連桿的長度在關(guān)節(jié)軸線上的距離定義成關(guān)節(jié)的平移量d，相鄰連桿的長度在關(guān)節(jié)軸線上的夾角定義成關(guān)節(jié)的轉(zhuǎn)量θ。

在MATLAB環(huán)境下，創(chuàng)建機(jī)械臂，根據(jù)表2的參數(shù)和數(shù)據(jù)，構(gòu)建機(jī)械臂的仿真程序如圖6所示。顯示的是機(jī)械臂在MATLAB繪圖空間的三維圖，表示機(jī)械臂處在初始位置θ為0，可以通過調(diào)節(jié)控制面板中相應(yīng)按鈕來使機(jī)械臂的末端節(jié)點發(fā)生變化。

圖6 PUMA560機(jī)械臂三維圖

在機(jī)械臂的笛卡爾空間中，機(jī)械臂的末端節(jié)點依據(jù)函數(shù)設(shè)置運動軌跡，并設(shè)置機(jī)械臂末端節(jié)點的初始點坐標(biāo)和終點坐標(biāo)，為了實現(xiàn)了機(jī)械臂末端節(jié)點正運動學(xué)的求解，先求得機(jī)械臂末端相對于基坐標(biāo)系的位置坐標(biāo)為(0.372，0.259，-0.531)，機(jī)械臂在起點和終點的位置如圖6所示。

根據(jù)齊次變換矩陣求得到機(jī)械臂由初始位姿到末端位姿時的各關(guān)節(jié)變量。

對機(jī)械臂由R點到Z點的運動軌跡進(jìn)行仿真，選擇六關(guān)節(jié)機(jī)械臂末端的2個關(guān)節(jié)，假設(shè)它們的期望軌跡為

通過MATLAB的相關(guān)函數(shù)可以繪出機(jī)械臂由R點運動到Z點，各關(guān)節(jié)隨時間變換的位置、速度和加速度圖像。

機(jī)械臂在笛卡爾空間軌跡規(guī)劃運動過程中，可能遇到未知狀態(tài)下的障礙物，這個需要在軟件仿真情況下加以設(shè)定，障礙物的設(shè)定是隨機(jī)的，可以出現(xiàn)在笛卡爾空間的任何位置，也可以以任何狀態(tài)出現(xiàn)，可以是圓形的物體或矩形的物體或其他空間物體得到形狀。機(jī)械臂的各關(guān)節(jié)在滑動模態(tài)控制下，應(yīng)該能夠自主進(jìn)行避障，并且在運行的過程中保持機(jī)械臂關(guān)節(jié)的速度和加速度平滑的過度，沒有劇烈的振動。這是對機(jī)械臂仿真軌跡控制的一般要求，通過笛卡爾空間坐標(biāo)系的有效驅(qū)動函數(shù)得以實現(xiàn)。以下為機(jī)械臂PUMA560各個關(guān)節(jié)添加的關(guān)節(jié)函數(shù)如下表3所示：

表3 機(jī)械臂的關(guān)節(jié)函數(shù)

根據(jù)以上分析可以知道機(jī)械臂的各關(guān)節(jié)的角速度曲線比較平滑，機(jī)械臂的末端節(jié)點在運動的過程中能夠有效避開不規(guī)則形狀的空間物體，并且機(jī)械臂的其它節(jié)點的速度和加速度能夠在穩(wěn)定狀態(tài)下運動，沒有出現(xiàn)明顯的振動現(xiàn)象。

如圖7和8所示為機(jī)械臂各關(guān)節(jié)的角速度和角加速度的曲線，從這兩個曲線圖可以看出，機(jī)械臂的關(guān)節(jié)在運動過程中的角速度和角加速度均能夠光滑平穩(wěn)過度。

圖7 機(jī)械臂各關(guān)節(jié)的角速度

圖8 機(jī)械臂各關(guān)節(jié)的角加速度

在機(jī)械臂軌跡規(guī)劃過程中，末端節(jié)點的位置、速度、加速度曲線如圖9所示。由機(jī)械臂關(guān)節(jié)軌跡仿真圖可得，軌跡之間的差異很小，并且能和期望的軌跡線幾乎重合，機(jī)械臂關(guān)節(jié)運動軌跡的精確度較高，在很短的時間內(nèi)機(jī)械臂的振動得到了收斂，在規(guī)避障礙物過程中能夠有效規(guī)避障礙物，并且整個運動軌跡的運行所使用的時間較短，精確性能良好不受外界環(huán)境變化的干擾。

圖9 末端節(jié)點的位置、速度及加速度曲線圖

由圖10機(jī)械臂仿真結(jié)果可得出，第一個機(jī)械臂始終與障礙物保持著0.2rad的距離繞開障礙物。分別在運動到第25s和40s時候，以平滑的曲線軌跡繞開了前方的障礙。同樣也可以得出第二個機(jī)械臂關(guān)節(jié)，與障礙物保持著0.2rad的距離繞開障礙物。分別在運動到第32s和42s時候，以平滑的曲線軌跡繞開了前方的障礙。最終使得機(jī)械臂能夠安全的到達(dá)目標(biāo)位置。雖然在移動的軌跡過程中兩個關(guān)節(jié)之間存在微小的波動，但是期望的路線都能夠在較短的周期內(nèi)并且精確度較高的實現(xiàn)，性能良好，不受外界的干擾，并且魯棒性很強(qiáng)。

圖10 機(jī)械臂末端節(jié)點的運動軌跡

七、結(jié)論

本文以六自由度機(jī)械臂為例，研究機(jī)械臂在運動過程中的仿真軌跡，在笛卡爾坐標(biāo)下建立機(jī)械臂的位姿描述，然后建立基于RBF滑動模塊變結(jié)構(gòu)的控制算法，通過滑動模塊控制的引入，在MATLAB軟件環(huán)境中建立笛卡爾坐標(biāo)系下數(shù)學(xué)模型，設(shè)置軌跡參數(shù)的初狀態(tài)和終狀態(tài)，最后生成機(jī)械臂末端節(jié)點在規(guī)避障礙物過程中的運動軌跡，通過運動仿真的輸出參數(shù)可以看出，在運動過程中的速度、加速度等參數(shù)光滑過度，能有效避開在機(jī)械臂運動過程中出現(xiàn)的障礙物，解決了機(jī)械臂在運動過程中的振動問題和規(guī)避障礙物的問題，在工業(yè)自動化應(yīng)用中居有一定的現(xiàn)實指導(dǎo)意義。