文獻(xiàn)標(biāo)識(shí)碼: A
文章編號(hào): 0258-7998(2011)05-0130-04
兩輪不平衡小車(chē)是一個(gè)集環(huán)境感知、動(dòng)態(tài)決策與規(guī)劃、行為控制與執(zhí)行等多種功能于一體的綜合系統(tǒng)。它的動(dòng)力學(xué)方程是一個(gè)多變量、耦合、時(shí)變的非線性高階方程,加上運(yùn)動(dòng)學(xué)方程中的非完整約束,使它成為一個(gè)具體的、實(shí)現(xiàn)起來(lái)相對(duì)簡(jiǎn)單的系統(tǒng)。近年來(lái),兩輪不平衡小車(chē)作為一個(gè)理論與實(shí)踐相結(jié)合的系統(tǒng),受到高度重視,它是檢驗(yàn)各種控制方法處理能力的典型裝置[1]。針對(duì)以往[2]通過(guò)反饋線性化得到小車(chē)系統(tǒng)的線性模型,然后在指數(shù)趨近律基礎(chǔ)上進(jìn)行變結(jié)構(gòu)控制的方法,消抖效果并非很好,而且在削弱系統(tǒng)抖振的同時(shí)也削弱了系統(tǒng)的抗干擾能力。為此,本文首先基于飽和特性的準(zhǔn)滑模指數(shù)趨近律設(shè)計(jì)出了常規(guī)切換面滑??刂破骱蛣?dòng)態(tài)切換面滑??刂破?。該控制器較以前的方法更有效地削弱了系統(tǒng)的抖振;然后通過(guò)給飽和特性的準(zhǔn)滑模指數(shù)趨近律中加入擾動(dòng)跟蹤項(xiàng),設(shè)計(jì)出了帶擾動(dòng)跟蹤項(xiàng)的動(dòng)態(tài)切換面準(zhǔn)滑??刂破鳌T摽刂破鞑粌H很好地削弱了系統(tǒng)抖振,增大了系統(tǒng)的可控范圍,更重要的是很好地保證了系統(tǒng)的魯棒性。
1 小車(chē)系統(tǒng)建模及其反饋線性化
設(shè)電機(jī)的力矩系數(shù)為km,反電動(dòng)勢(shì)常數(shù)為ke,電機(jī)電阻為R,轉(zhuǎn)子慣量為J,接入減速箱的減速比為kj;小車(chē)車(chē)體質(zhì)量為Mp,車(chē)輪及軸的質(zhì)量為Mw,車(chē)體質(zhì)心到車(chē)體轉(zhuǎn)動(dòng)中心距離為l,車(chē)輪半徑為r,車(chē)體轉(zhuǎn)動(dòng)慣量為Ip,車(chē)輪及軸轉(zhuǎn)動(dòng)慣量為Iw,重力加速度為g,車(chē)輪水平位移為x1,水平速度為x2,車(chē)體偏離垂直方向的角度為x3,偏離垂直方向角加速度為x4,整個(gè)系統(tǒng)的輸入即電機(jī)的輸入電壓為u。
取狀態(tài)變量X[x1 x2 x3 x4]T,將電機(jī)的輸入電壓u作為控制信號(hào)。為了便于研究,把系統(tǒng)看作線性化的單輸入單輸出系統(tǒng)。由于角度對(duì)系統(tǒng)的影響最大,所以將角度x3作為輸出,它可由傾角傳感器測(cè)得[1]。根據(jù)力學(xué)建模得到系統(tǒng)的非線性方程為[3]:
則小車(chē)的局部線性化模型可簡(jiǎn)記為:
顯然,動(dòng)態(tài)切換面是在常規(guī)切換面中加入與控制輸入有關(guān)的Tv0項(xiàng),使得不連續(xù)切換項(xiàng)M0sat(HX/Δ)轉(zhuǎn)移到控制的一階導(dǎo)數(shù)v0中。因?yàn)榭刂苪中不存在不連續(xù)切換項(xiàng),所以有效地降低了抖振。
2.3 帶擾動(dòng)跟蹤的動(dòng)態(tài)滑模控制器的設(shè)計(jì)
由于以往的方法在消抖的同時(shí)也削弱了系統(tǒng)的抗干擾能力,而擾動(dòng)的存在會(huì)惡化系統(tǒng)的性能。在滑??刂浦校瑪_動(dòng)會(huì)使本來(lái)位于滑動(dòng)面的運(yùn)動(dòng)偏離滑動(dòng)面。從幾何學(xué)角度可以將該擾動(dòng)分解為兩個(gè)方向:沿滑動(dòng)面的切線方向和垂直于該切線的法線方向。從物理學(xué)角度,分解在沿滑動(dòng)面切線方向的擾動(dòng)將給系統(tǒng)一個(gè)繼續(xù)沿滑動(dòng)面運(yùn)動(dòng)的加速度,它對(duì)系統(tǒng)的影響不大;而分解在垂直于滑動(dòng)面方向的擾動(dòng)會(huì)給系統(tǒng)一個(gè)垂直滑動(dòng)面方向的加速度,也就是擾動(dòng)引起系統(tǒng)在滑動(dòng)面垂直方向上產(chǎn)生遠(yuǎn)離滑動(dòng)面的加速度,使系統(tǒng)脫離滑動(dòng)面。為了避免擾動(dòng)造成系統(tǒng)運(yùn)動(dòng)偏離滑動(dòng)面過(guò)大,本文在飽和特性的指數(shù)趨近律中加入擾動(dòng)動(dòng)力跟蹤項(xiàng)來(lái)減小系統(tǒng)遠(yuǎn)離滑動(dòng)面運(yùn)動(dòng)的加速度,以增強(qiáng)系統(tǒng)的抗干擾能力。
3 仿真比較[8]
由maxon電機(jī)手冊(cè)得到:額定電壓為30 V,力矩系數(shù)km=0.0389 Nm/A,電機(jī)電阻R=1.23 Ω, 轉(zhuǎn)子慣量J=0.000 065 5 kgm2,反電動(dòng)勢(shì)常數(shù)ke=1/246=0.004 065 V/rpm,接入減速箱的減速比kj=33,測(cè)量得小車(chē)車(chē)體質(zhì)量為Mp=10.36 kg,車(chē)體質(zhì)心到車(chē)體轉(zhuǎn)動(dòng)中心距離l=0.2 m,車(chē)輪及軸質(zhì)量Mw=0.4 kg,車(chē)輪半徑r=0.06 m,車(chē)輪及軸轉(zhuǎn)動(dòng)慣量Iw=0.000 36 kg·m2,車(chē)體轉(zhuǎn)動(dòng)慣量Ip=0.037 59 kg·m2,取重力加速度g=9.81 N/kg。
3.1 可控范圍的比較
取M0=20,k=10,T=0.5,G=0.3,在小車(chē)位置、速度、角速度全都為0的情況下,通過(guò)不斷變換角度初始值,觀察控制電壓為額定值時(shí)的角度值即為小車(chē)在此控制器下的最大可控傾角。仿真得到如表1所示的三種控制器的最大可控傾角。
由表1可以看出,系統(tǒng)在帶擾動(dòng)跟蹤項(xiàng)的動(dòng)態(tài)切換面滑模控制器作用下的可控角最大,動(dòng)態(tài)切換面準(zhǔn)滑??刂破鞔沃?,而常規(guī)切換面準(zhǔn)滑??刂破髯饔孟孪到y(tǒng)的可控角最小。下面對(duì)三種控制器控制效果的比較都在其傾角可控范圍內(nèi)。
3.2 系統(tǒng)抖振的比較
根據(jù)變結(jié)構(gòu)理論:系統(tǒng)運(yùn)動(dòng)在滑模區(qū)時(shí),其特性和參數(shù)只取決于切換函數(shù)而與其他無(wú)關(guān),即滑模具有完全魯棒性。但伴隨滑模的運(yùn)動(dòng),系統(tǒng)會(huì)出現(xiàn)抖振,這種高頻振動(dòng)會(huì)嚴(yán)重影響系統(tǒng)的性能。下面就上文所設(shè)計(jì)的三種不同控制器作用系統(tǒng)時(shí)所產(chǎn)生的抖振進(jìn)行觀察比較。
仍取初始狀態(tài)X=[0 0 0.45 0]T,其他參數(shù)不變,在三種不同控制器控制作用小車(chē)角度在10 s內(nèi)的響應(yīng)曲線如圖1示。
由圖1可看出,在三種不同控制器的作用下,系統(tǒng)的位置、速度、角速度以及控制u響應(yīng)曲線都有圖1所示的特性,即動(dòng)態(tài)切換面滑模控制器比常規(guī)切換面滑??刂破髟谙斗矫嬗忻黠@的優(yōu)勢(shì),而帶擾動(dòng)跟蹤的動(dòng)態(tài)切換面滑??刂破鞅炔粠_動(dòng)跟蹤的動(dòng)態(tài)切換面滑??刂破髟谙斗矫嬗忻黠@的優(yōu)勢(shì)。
3.3 系統(tǒng)抗干擾性比較
設(shè)小車(chē)位于平衡狀態(tài)X=[0 0 0 0]T處,給系統(tǒng)的控制輸入端u處加入幅值為5的隨機(jī)干擾信號(hào),在上述三種不同控制器作用下小車(chē)速度在3 s內(nèi)的響應(yīng)曲線如圖2示。
由圖2可看出,對(duì)于系統(tǒng)角度,動(dòng)態(tài)切換面滑模控制器作用下系統(tǒng)的抗干擾能力比常規(guī)切換面滑??刂破髯饔孟孪到y(tǒng)抗干擾能力弱很多,但是通過(guò)增加擾動(dòng)跟蹤項(xiàng),可使動(dòng)態(tài)切換面滑??刂破鞯目垢蓴_能力又得以顯著地增強(qiáng)。
大量仿真曲線表明:對(duì)于相同的趨近律,與常規(guī)切換面滑??刂破飨啾?,動(dòng)態(tài)切換面滑模控制器雖然顯著地削弱了系統(tǒng)的抖振,但同時(shí)也削弱了系統(tǒng)的抗干擾能力。而通過(guò)給趨近律中加入擾動(dòng)跟蹤項(xiàng)設(shè)計(jì)的帶擾動(dòng)跟蹤的動(dòng)態(tài)滑??刂破髯饔孟到y(tǒng)時(shí),不僅顯著地削弱了系統(tǒng)的抖振,而且保留了常規(guī)切換面滑??刂破鬏^強(qiáng)的抗干擾能力。由此可見(jiàn),擾動(dòng)跟蹤項(xiàng)不但很好地補(bǔ)償了變結(jié)構(gòu)控制的抖振缺陷,而且還實(shí)現(xiàn)了系統(tǒng)對(duì)擾動(dòng)的不變性,增大了系統(tǒng)的可控范圍。
本文針對(duì)反饋線性化得到的小車(chē)系統(tǒng)線性模型,設(shè)計(jì)了基于常規(guī)切換面和動(dòng)態(tài)滑模切換面的準(zhǔn)滑動(dòng)模態(tài)變結(jié)構(gòu)控制器,并在此基礎(chǔ)上通過(guò)給控制u中加入擾動(dòng)跟蹤項(xiàng),設(shè)計(jì)出能同時(shí)削弱抖振和保證系統(tǒng)抗干擾能力的控制器,實(shí)現(xiàn)了小車(chē)的穩(wěn)定控制。通過(guò)仿真比較可以看出,與常規(guī)切換面控制器作用相比,在基于動(dòng)態(tài)切換面控制器作用下系統(tǒng)的可控范圍較大、抑制系統(tǒng)抖振能力強(qiáng),但同時(shí)系統(tǒng)的魯棒性變差,即在削弱系統(tǒng)抖振的同時(shí)也削弱了系統(tǒng)的魯棒性。而通過(guò)給控制u中加入擾動(dòng)跟蹤項(xiàng)使系統(tǒng)抗干擾能力顯著增強(qiáng),即具有擾動(dòng)跟蹤的動(dòng)態(tài)滑模控制器不僅更好地削弱了系統(tǒng)的抖振,同時(shí)還保證了滑模對(duì)擾動(dòng)的不變性,實(shí)現(xiàn)了滑動(dòng)模態(tài)魯棒性和消除抖振的統(tǒng)一。
參考文獻(xiàn)
[1] Li Yanzhao, Qu Shengli, Zhu Jiahui, et al. Study on the control of a two-wheeled unstable vehicle based on sensitivity Analysis[M]. The University of Western Australia School of Mechanical Engineering, IEEE, 2009.
[2] OOI R C.Banlancing a two-wheeled autonomous robot[M]. IEEE, 2003.
[3] 朱加輝.兩輪自平衡小車(chē)反饋線性化及變結(jié)構(gòu)控制研究[D].西安:西安電子科技大學(xué),2010.
[4] 胡躍明.非線性控制系統(tǒng)理論與應(yīng)用[M].北京:國(guó)防工業(yè)出版社,2005.
[5] 高為炳.變結(jié)構(gòu)控制理論基礎(chǔ)[M].北京:中國(guó)科學(xué)技術(shù)出版社,1990.
[6] 姚瓊薈.變結(jié)構(gòu)控制系統(tǒng)[M]. 重慶:重慶大學(xué)出版社,1997.
[7] 趙勇.兩輪不穩(wěn)定機(jī)器人載體運(yùn)動(dòng)學(xué)及動(dòng)力學(xué)變結(jié)構(gòu)控制研究[D].西安:西安電子科技大學(xué),2007.
[8] 黃忠霖.控制系統(tǒng)MATLAB計(jì)算及仿真[M].北京:國(guó)防工業(yè)出版社,2004. (收稿日期:2010-06-28)