王國剛,孫德煒,金紅嬌,孫其龍
(吉林化工學(xué)院 信息與控制工程學(xué)院,吉林吉林,132022)
機(jī)械臂已經(jīng)成為工業(yè)控制領(lǐng)域中的不可或缺的工具。由于機(jī)械臂是一個(gè)非線性、強(qiáng)耦合、時(shí)變的系統(tǒng),并且存在未建模動(dòng)態(tài)、參數(shù)變化、外部擾動(dòng)及摩擦等 各種不確定因素的影響。這些不確定因素會(huì)導(dǎo)致機(jī)械臂各關(guān)節(jié)跟蹤精度變差,因此使機(jī)械臂具有良好的動(dòng)態(tài)性能具有重要的研究意義,設(shè)計(jì)控制器以實(shí)現(xiàn)機(jī)械臂能快速、穩(wěn)定地跟蹤期望軌跡是機(jī)械臂控制的核心問題。在實(shí)際工程中,機(jī)械臂系統(tǒng)存在建模不確定性以及受外界干擾等諸多復(fù)雜因素的影響,專家學(xué)者在解決這個(gè)難題的同時(shí),也在機(jī)械臂的軌跡跟蹤方面取得了重大突破[1~4]。諸多學(xué)者提出過各種的控制方法,主要有PD 控制,滑??刂疲?jì)算力矩控制,模糊滑??刂频萚5~8]。文獻(xiàn)[9]對(duì)傳統(tǒng)干擾觀測器進(jìn)行優(yōu)化,反饋補(bǔ)償外界干擾的同時(shí)利用神經(jīng)網(wǎng)絡(luò)的萬能逼近特性,提高響應(yīng)速度和軌跡跟蹤精度;文獻(xiàn)[10]為解決由于系統(tǒng)存在建模不確定性以及外界干擾對(duì)控制結(jié)果造成的不良影響,提出一種學(xué)習(xí)系統(tǒng)不確定性的未知上界的自適應(yīng)神經(jīng)滑??刂品椒?,以此來提高系統(tǒng)的控制性能;文獻(xiàn)[11]針對(duì)滑??刂浦写嬖诘氖諗克俣群拖到y(tǒng)抖振兩個(gè)方面的問題,通過分析兩種類型趨近律的優(yōu)缺點(diǎn),設(shè)計(jì)一種對(duì)系統(tǒng)抖振能夠有效控制的同時(shí)也能提升收斂速度的改進(jìn)型滑模趨近律;文獻(xiàn)[12]提出了一種采用自適應(yīng)神經(jīng)網(wǎng)絡(luò)補(bǔ)償包括建模不確定性和外部干擾在內(nèi)的系統(tǒng)不確定性的滑模邊界控制器,以將關(guān)節(jié)驅(qū)動(dòng)到所需位置并快速抑制振動(dòng)。文獻(xiàn)[13]針對(duì)機(jī)械臂系統(tǒng)的滑??刂拼嬖诙墩竦膯栴},提出了一種變指數(shù)趨近律滑??刂坡桑抡娼Y(jié)果表明該控制策略可以有效抑制抖振:文獻(xiàn)[14]針對(duì)一種并聯(lián)機(jī)械臂提出了魯棒PID 控制策略,通過選擇合適的PID 控制器增益,使系統(tǒng)達(dá)到穩(wěn)定的狀態(tài)。
針對(duì)機(jī)械臂跟蹤精度和穩(wěn)定性等問題,本文對(duì)基于神經(jīng)網(wǎng)絡(luò)滑??刂谱龀鰞?yōu)化與改進(jìn),相比于上述文獻(xiàn),本文對(duì)機(jī)械臂系統(tǒng)的整體性控制有了進(jìn)一步的提升。考慮到對(duì)機(jī)械臂動(dòng)力學(xué)模型進(jìn)行建模時(shí),存在不確定項(xiàng)以及外部干擾。對(duì)此本文先利用神經(jīng)網(wǎng)絡(luò)對(duì)建模的不確定項(xiàng)進(jìn)行逼近,然后采用基于指數(shù)趨近律的滑??刂朴靡韵魅跸到y(tǒng)的抖振、提高系統(tǒng)的控制性能。
考慮n關(guān)節(jié)機(jī)械臂動(dòng)力學(xué)方程[15~16]如下:
其中,q∈Rn為關(guān)節(jié)角位移量,M(q)∈Rn×n為慣性矩陣,C(q,)∈Rn為離心力和哥氏力項(xiàng),G(q)∈Rn為重力項(xiàng),F(xiàn)()∈Rn為摩擦力項(xiàng),τ∈Rn為控制力矩,τd∈Rn為外加干擾以及系統(tǒng)建模的誤差項(xiàng),利用RBF 神經(jīng)網(wǎng)絡(luò)對(duì)其進(jìn)行處理。
由于在實(shí)際控制系統(tǒng)中存在的干擾因素較為復(fù)雜。例如,系統(tǒng)摩擦力,系統(tǒng)建模誤差以及外界干擾等都會(huì)影響到系統(tǒng)的軌跡跟蹤。
RBF 神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)簡單,收斂速度快,能夠較高精度地逼近任何連續(xù)非線性函數(shù),結(jié)構(gòu)采用并列處理機(jī)制,具備較強(qiáng)的容錯(cuò)能力等優(yōu)勢,其主要的工作機(jī)理為系統(tǒng)實(shí)際的控制參數(shù)經(jīng)隱含層激活函數(shù)的非線性變換后,通過權(quán)值的線性相加傳遞至輸出層。其中隱含層中的激活函數(shù)為徑向基函數(shù),結(jié)構(gòu)特點(diǎn)為徑向中心對(duì)稱且兩邊衰減過渡,輸入的數(shù)據(jù)距離中心越近,輸出越敏感?;赗BF 神經(jīng)網(wǎng)絡(luò)能夠以任意精度逼近未知函數(shù)的特點(diǎn),RBF 神經(jīng)網(wǎng)絡(luò)能夠較好地滿足存在不確定性的系統(tǒng)控制的需要要求。
在設(shè)計(jì)控制系統(tǒng)時(shí),我們需要將上述的不確定項(xiàng)利用RBF 神經(jīng)網(wǎng)絡(luò)進(jìn)行估計(jì),然后對(duì)整個(gè)系統(tǒng)采用滑??刂茷榭刂破鳌R源藖硖岣邫C(jī)械臂軌跡跟蹤精度和穩(wěn)定性。
控制系統(tǒng)的原理如圖1 所示。
圖1 控制原理
采用基于RBF 神經(jīng)網(wǎng)絡(luò)的滑??刂茖?duì)機(jī)械臂進(jìn)行位置的軌跡跟蹤控制。設(shè)qd為q的期望值,為的期望值。跟蹤誤差為:
定義滑模函數(shù)為:
滑模動(dòng)態(tài)特性保證了系統(tǒng)的穩(wěn)定性和狀態(tài)收斂到平衡狀態(tài)e=0。結(jié)合式(2)和式(3),可得:
滑??刂凭哂许憫?yīng)快、對(duì)干擾不敏感等優(yōu)點(diǎn)。但是由于滑??刂谱陨硖匦栽颍蛊浯嬖诙墩瘳F(xiàn)象,并且該現(xiàn)象無法被控制系統(tǒng)消除。
選取合適的趨近律可以實(shí)現(xiàn)在相同的控制抖振下更快的趨于零或在相同收斂速度下削減抖振。為削減抖振現(xiàn)象,本文采用基于指數(shù)趨近律的滑模控制。
式中,-ks是指數(shù)趨近項(xiàng),k越大,-εsgn(s)趨近滑模面速度越大,-εsgn(s)是等速趨近項(xiàng),可消減抖振。增大k的同時(shí)減少ε可保證快速趨近的同時(shí)消減抖振。
高斯基函數(shù)具有良好的解析性,用于理論分析時(shí)比較方便,其圖像不僅光滑性好而且還是徑向?qū)ΨQ的。應(yīng)用RBF神經(jīng)網(wǎng)絡(luò)時(shí)可以從一定程度上使系統(tǒng)的跟蹤性能更好,并且其自適應(yīng)調(diào)節(jié)能力更強(qiáng)。因此,RBF 神經(jīng)網(wǎng)絡(luò)控制機(jī)械臂的不確定性問題、跟蹤問題以及穩(wěn)定性問題是有意義的,結(jié)合機(jī)械臂的動(dòng)力學(xué)特性,利用RBF 神經(jīng)網(wǎng)絡(luò)控制機(jī)械臂,進(jìn)而提高系統(tǒng)性能,實(shí)現(xiàn)快速收斂。同時(shí)RBF 神經(jīng)網(wǎng)絡(luò)技術(shù)可對(duì)機(jī)械臂動(dòng)力學(xué)方程中未知部分進(jìn)行逼近,由此提高了對(duì)機(jī)器人的控制精度。
RBF 神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)如圖2 所示。
圖2 神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)
根據(jù)RBF 網(wǎng)絡(luò)自身特性,采用RBF 神經(jīng)網(wǎng)絡(luò)逼近不確定項(xiàng)f,網(wǎng)絡(luò)算法為:
其中,x為網(wǎng)絡(luò)的輸入,j為網(wǎng)絡(luò)隱含層第j個(gè)節(jié)點(diǎn),為神經(jīng)網(wǎng)絡(luò)高斯基函數(shù)輸出,W*為網(wǎng)絡(luò)理想權(quán)值,ε為網(wǎng)絡(luò)的逼近誤差,ε≤εN。
則RBF 神經(jīng)網(wǎng)絡(luò)的輸出為:
將式(1)與式(4)進(jìn)行聯(lián)立可得:
在實(shí)際工程模型中的f項(xiàng)是未知的,然后對(duì)f進(jìn)行逼近。為RBF 神經(jīng)網(wǎng)絡(luò)的估計(jì)值。
?。?/p>
為實(shí)現(xiàn)自適應(yīng)逼近定義神經(jīng)網(wǎng)絡(luò)自適應(yīng)律:
為更好的抑制滑模控制帶來的抖振,本文采用了指數(shù)趨近律來實(shí)現(xiàn)滑模控制。由式(9)和式(5)可知:
將指數(shù)趨近律式(5)與式(12)結(jié)合得到控制器:
上式中,v為魯棒項(xiàng)。將其設(shè)為:
定理1:針對(duì)機(jī)械臂動(dòng)力學(xué)系統(tǒng)式(1),設(shè)計(jì)了滑模函數(shù)式(4),并在自適應(yīng)律式(11)下得到系統(tǒng)的控制器方程式(13),保證了跟蹤誤差的有限時(shí)間內(nèi)收斂。
對(duì)于整個(gè)系統(tǒng)控制器取式(13),自適應(yīng)律取式(11)。定義Lyapunov 函數(shù)為:
將式(13)代入式(9)中,可得:
將式(17)代入式(16)中,可得:
所以系統(tǒng)漸進(jìn)穩(wěn)定。
在對(duì)滑??刂扑惴ǖ难芯亢头€(wěn)定性分析完成后,為進(jìn)一步證明該控制算法的可行性,采用MATLAB 搭建機(jī)械臂控制系統(tǒng)來對(duì)該控制算法進(jìn)行仿真驗(yàn)證。
選用的機(jī)械臂示意圖如圖3 所示。
圖3 雙關(guān)節(jié)機(jī)械臂
動(dòng)力學(xué)參數(shù)為:
機(jī)械臂的物理參數(shù)值見表1。
表1 物理參數(shù)
以機(jī)械臂動(dòng)力學(xué)模型為被控對(duì)象來驗(yàn)證所提方法有效性,控制器見式(15)。系統(tǒng)的兩個(gè)關(guān)節(jié)的指令分別為qd1=cos(πt),qd2=sin(πt),初始狀態(tài)為[0.050 -0.050],在魯棒項(xiàng)中,取bd=0.20,εN=0.30,同時(shí)取F=diag[100,100],Λ=diag[12,12]。RBF 神經(jīng)網(wǎng)絡(luò)的網(wǎng)絡(luò)結(jié)構(gòu)為5-7-2,網(wǎng)絡(luò)輸入取x=,高斯基函數(shù)的中心點(diǎn)cj為[-1.5,-1,-0.5,0,0.5,1,1.5],高斯基函數(shù)的寬度為bj=18,仿真結(jié)果如圖4~14 所示。
圖4 關(guān)節(jié)1 角度跟蹤
圖5 關(guān)節(jié)2 角度跟蹤
本文在為解決機(jī)械臂軌跡跟蹤精準(zhǔn)度、穩(wěn)定性等問題時(shí),對(duì)基于神經(jīng)網(wǎng)絡(luò)滑模的控制方法做出優(yōu)化與改進(jìn)。提出了一種基于指數(shù)趨近律的神經(jīng)網(wǎng)絡(luò)滑??刂扑惴?。對(duì)仿真結(jié)果進(jìn)行分析與總結(jié)。
由圖6 及圖7 可知,角度跟蹤誤差最高不超過1rad,并且在約0.5s 后角度跟蹤誤差曲線波動(dòng)極小,軌跡跟蹤曲線與期望軌跡幾乎重合。由此可以說明該控制算法有較好的軌跡跟蹤性能;由圖10 和圖11 可知,在約0.5s 前關(guān)節(jié)1角速度跟蹤誤差達(dá)到11rad/s,關(guān)節(jié)2 的角速度跟蹤誤差約為1.5rad/s,隨后圖像急速削減,無限趨近于零。所以可知本文提出的控制算法也具有良好的角速度跟蹤效果,有效地抑制了系統(tǒng)的抖振問題。仿真結(jié)果表明該控制算法具有較好的軌跡跟蹤效果的同時(shí)也具有良好的穩(wěn)定性和快速性。
圖6 關(guān)節(jié)1 角度跟蹤誤差
圖7 關(guān)節(jié)2 角度跟蹤誤差
圖8 關(guān)節(jié)1 角速度跟蹤
圖9 關(guān)節(jié)2 角速度跟蹤
圖10 關(guān)節(jié)1 角速度跟蹤誤差
圖11 關(guān)節(jié)2 角速度跟蹤誤差
圖12 關(guān)節(jié)1 控制輸入
圖13 關(guān)節(jié)2 控制輸入
圖14 關(guān)節(jié)1 及關(guān)節(jié)2 的 ||f (x)||及其逼近||(x)||