火炮模塊藥輸送伺服系統(tǒng)自適應(yīng)模糊滑?？刂?/h1>
2017-11-10 00:39:51岳才成錢林方孔建壽李穎
兵工學(xué)報(bào) 2017年10期
岳才成， 錢林方， 孔建壽， 李穎
(1.南京理工大學(xué) 機(jī)械工程學(xué)院, 江蘇 南京 210094; 2.南京理工大學(xué) 自動(dòng)化學(xué)院, 江蘇 南京 210094; 3.西北機(jī)電工程研究所， 陜西 咸陽(yáng) 712000)
火炮模塊藥輸送伺服系統(tǒng)自適應(yīng)模糊滑?？刂?/p>
岳才成1， 錢林方1， 孔建壽2， 李穎3
(1.南京理工大學(xué) 機(jī)械工程學(xué)院, 江蘇 南京 210094; 2.南京理工大學(xué) 自動(dòng)化學(xué)院, 江蘇 南京 210094; 3.西北機(jī)電工程研究所， 陜西 咸陽(yáng) 712000)
針對(duì)火炮模塊藥輸送伺服系統(tǒng)傳動(dòng)過(guò)程中存在參數(shù)時(shí)變和抖振等問(wèn)題，設(shè)計(jì)了一種帶有積分滑模函數(shù)的自適應(yīng)模糊滑?？刂破鳌２捎米赃m應(yīng)方法對(duì)系統(tǒng)時(shí)變參數(shù)進(jìn)行估計(jì)，減小不確定部分對(duì)控制系統(tǒng)的影響。引入新型飽和函數(shù)代替?zhèn)鹘y(tǒng)切換函數(shù)，保證整個(gè)切換過(guò)程連續(xù)、平滑過(guò)渡；采用模糊自適應(yīng)算法對(duì)切換系數(shù)在線調(diào)整，提高系統(tǒng)的魯棒性能，進(jìn)一步抑制切換過(guò)程中的抖振。實(shí)驗(yàn)結(jié)果表明，火炮模塊藥輸送伺服系統(tǒng)在空載、半載和滿載3種情況下均具有良好的位置跟蹤性能，滿足性能指標(biāo)要求，提出的自適應(yīng)模糊滑?？刂扑惴軌蚩朔?fù)載變化對(duì)系統(tǒng)控制精度的影響。
兵器科學(xué)與技術(shù)； 火炮模塊藥輸送伺服系統(tǒng)； 抖振； 自適應(yīng)模糊滑?？刂疲?位置跟蹤
0 引言
火炮模塊藥輸送伺服系統(tǒng)是自行火炮自動(dòng)裝填系統(tǒng)的重要組成部分，包含顯控終端、綜合控制器、驅(qū)動(dòng)器、永磁同步伺服電機(jī)、減速器、角編碼器、傳動(dòng)軸、齒輪、傳動(dòng)鏈、藥筒、選藥機(jī)構(gòu)和推藥機(jī)構(gòu)等組成，該系統(tǒng)具有齒輪傳動(dòng)和帶傳動(dòng)的特點(diǎn)，大量裝備在自動(dòng)化程度高、可靠性高的特種裝備上。由于系統(tǒng)安裝位置空間狹小，較難維修，所以要求系統(tǒng)在運(yùn)動(dòng)過(guò)程中具備較高的可靠性、較好的定位精度等。系統(tǒng)在傳動(dòng)過(guò)程中，通過(guò)同步交流伺服電機(jī)作用在中間機(jī)構(gòu)上，帶動(dòng)藥筒完成回轉(zhuǎn)動(dòng)作；通過(guò)藥筒回轉(zhuǎn)，實(shí)現(xiàn)藥筒從任意位置到達(dá)規(guī)定選藥位，配合選藥裝置等完成選藥任務(wù)；選藥完成后，推藥電機(jī)負(fù)責(zé)將模塊藥輸送至輸藥機(jī)構(gòu)上，等待后續(xù)動(dòng)作?；鹋谀K藥輸送伺服系統(tǒng)在運(yùn)動(dòng)過(guò)程中的運(yùn)動(dòng)狀態(tài)，以及定位精度對(duì)后續(xù)選藥、推藥等具有較大的影響。
火炮模塊藥輸送伺服系統(tǒng)在旋轉(zhuǎn)選藥過(guò)程中，藥筒中模塊藥的數(shù)量是隨時(shí)可能發(fā)生改變的，隨著模塊藥數(shù)量的變化，系統(tǒng)轉(zhuǎn)動(dòng)慣量、負(fù)載力矩、非線性摩擦等都在發(fā)生改變。由于參數(shù)的不斷變化，很難確定系統(tǒng)精確的數(shù)學(xué)模型，在解決系統(tǒng)模型參數(shù)不確定控制問(wèn)題方面，滑模變結(jié)構(gòu)控制應(yīng)用較為廣泛。王昭磊等[1]考慮目標(biāo)機(jī)動(dòng)、建模誤差和氣動(dòng)參數(shù)攝動(dòng)等不確定性影響，設(shè)計(jì)了自適應(yīng)模糊控制器，采用模糊逼近手段逼近不確定函數(shù)，應(yīng)用模糊補(bǔ)償方法補(bǔ)償逼近誤差及干擾，提高了系統(tǒng)的魯棒性。文獻(xiàn)[2]采用傳統(tǒng)自適應(yīng)模糊滑模及自適應(yīng)PI控制算法完成了對(duì)感應(yīng)直流伺服電機(jī)位置的控制，證明了所提出算法在解決伺服電機(jī)參數(shù)不確定、負(fù)載環(huán)境不確定、抖振問(wèn)題和跟蹤性能方面具有較好的效果。文獻(xiàn)[3]針對(duì)武器大功率交流伺服系統(tǒng)所存在的大變負(fù)載、慢時(shí)變、強(qiáng)耦合的非線性特性和不確定擾動(dòng)等問(wèn)題，采用模糊小波神經(jīng)網(wǎng)絡(luò)間接自適應(yīng)控制策略，有效地提高了整個(gè)系統(tǒng)的跟蹤穩(wěn)定性和響應(yīng)快速性。李坤全等[4]針對(duì)焊接系統(tǒng)具有強(qiáng)耦合、非線性且建模困難的特點(diǎn)，提出了一種變論域自適應(yīng)模糊PID復(fù)合的焊縫控制方法。仿真與實(shí)驗(yàn)結(jié)果表明，該方法可靠性好，抗干擾能力強(qiáng)，跟蹤能力好，能夠?qū)崿F(xiàn)焊縫的精確跟蹤。
滑模變結(jié)構(gòu)控制通過(guò)對(duì)切換函數(shù)符號(hào)的判別，不斷地切換控制量來(lái)改變系統(tǒng)的結(jié)構(gòu)，使?fàn)顟B(tài)變量運(yùn)動(dòng)在已設(shè)定的切換面上。由于需要在不同控制邏輯間反復(fù)切換，這種切換會(huì)使系統(tǒng)產(chǎn)生抖振現(xiàn)象[5]。因此，火炮模塊藥輸送伺服系統(tǒng)的控制要解決好模型參數(shù)不確定和抖振等帶來(lái)的問(wèn)題。
文獻(xiàn)[6]針對(duì)旋轉(zhuǎn)彈模型的非線性、強(qiáng)耦合和參數(shù)不確定性等問(wèn)題，提出一種基于自適應(yīng)反演和滑模控制理論的旋轉(zhuǎn)彈體姿態(tài)控制律。該方法有效地抑制不確定氣動(dòng)參數(shù)和外部干擾的影響，使系統(tǒng)具有良好的穩(wěn)定性和魯棒性。文獻(xiàn)[7]針對(duì)存在擾動(dòng)、執(zhí)行機(jī)構(gòu)死區(qū)非線性以及系統(tǒng)不確定性的高超聲速飛行器巡航飛行縱向通道模型，提出了帶有新型非線性擾動(dòng)觀測(cè)器的遞階滑?？刂破鳎行Ы档土丝刂破髟鲆?，削弱了抖振，消除了執(zhí)行機(jī)構(gòu)死區(qū)特性對(duì)動(dòng)態(tài)系統(tǒng)的影響。仿真結(jié)果表明，該控制策略對(duì)高超聲速飛行器具有較好的控制作用。文獻(xiàn)[8-14]提出了自適應(yīng)模糊算法用以解決非線性系統(tǒng)參數(shù)不確定、擾動(dòng)帶來(lái)的抖振等問(wèn)題，文獻(xiàn)中所研究系統(tǒng)包含無(wú)抖振異步電動(dòng)機(jī)控制、大型液壓起豎系統(tǒng)、具有未知輸出死區(qū)的非線性不確定、具有不穩(wěn)定子系統(tǒng)的切換不確定非線性、單輸入單輸出非線性系統(tǒng)、狀態(tài)延時(shí)的不確定非線性多輸入多輸出、位置伺服等系統(tǒng)，算法對(duì)該類非線性系統(tǒng)控制效果良好。Wai等[15]采用帶有積分運(yùn)算切換面的自適應(yīng)模糊趨近策略，完成了對(duì)伺服驅(qū)動(dòng)系統(tǒng)的精確魯棒位置控制，將模糊滑模控制和自適應(yīng)模糊滑?？刂菩ЧM(jìn)行對(duì)比，結(jié)果表明后者具有較好的位置跟蹤性能，控制過(guò)程更加平穩(wěn)，有效地降低了抖振影響。
現(xiàn)今特種裝備控制中，應(yīng)用最多的控制策略仍為PID控制。傳統(tǒng)PID控制算法缺少對(duì)模型非線性和參數(shù)不確定性的考慮，控制精度略低，運(yùn)動(dòng)的平穩(wěn)性不好，較難獲得理想的動(dòng)態(tài)品質(zhì)，在處理參數(shù)變化和擾動(dòng)帶來(lái)的影響方面效果欠佳[16-17]?；鹋谀K藥輸送系統(tǒng)和這些文獻(xiàn)中所研究的對(duì)象結(jié)構(gòu)差別較大，同時(shí)，該系統(tǒng)工作環(huán)境更為苛刻，性能要求更高，傳統(tǒng)控制算法很難獲得滿意的動(dòng)態(tài)品質(zhì)。在文獻(xiàn)資料的提示下，針對(duì)算法中對(duì)切換系數(shù)考慮不充分的現(xiàn)象，結(jié)合被控對(duì)象火炮模塊藥輸送伺服系統(tǒng)負(fù)載非線性變化、存在擾動(dòng)、控制精度要求高的特點(diǎn)，本文提出采用等效控制和切換控制相結(jié)合的控制策略，對(duì)等效轉(zhuǎn)動(dòng)慣量和阻尼系數(shù)參數(shù)采用自適應(yīng)方式，降低負(fù)載非線性變化對(duì)系統(tǒng)穩(wěn)定性的影響；同時(shí)對(duì)切換系數(shù)這個(gè)關(guān)鍵參數(shù)采用了模糊自適應(yīng)方法進(jìn)行在線估計(jì)，提高系統(tǒng)對(duì)參數(shù)非線性變化和擾動(dòng)的不敏感性，提高系統(tǒng)的定位精度和魯棒性，降低系統(tǒng)運(yùn)動(dòng)中的抖振和撞擊。
1 系統(tǒng)控制模型
永磁同步電機(jī)采用d軸定子電流id=0的控制，電機(jī)轉(zhuǎn)矩[18]定義為
Te=ktui，
(1)
式中：kt=pnψf為電機(jī)轉(zhuǎn)矩常數(shù)，且kt>0，pn為電機(jī)的極對(duì)數(shù)，ψf為磁鏈；ui=iq為控制輸入q軸電流(A)，iq為q軸電流。
火炮模塊藥輸送伺服系統(tǒng)為2階系統(tǒng)，其系統(tǒng)動(dòng)力學(xué)方程可以定義為
(2)
將(1)式代入(2)式，整理得到火炮模塊藥輸送伺服系統(tǒng)動(dòng)力學(xué)方程為
(3)
或
(4)
在實(shí)際的永磁同步電機(jī)伺服系統(tǒng)中，給定電機(jī)轉(zhuǎn)子理論角位置θd，并完成對(duì)永磁同步電機(jī)控制電流ui的輸入，就可獲得實(shí)際轉(zhuǎn)子角位置θ，其中θd和ui均有界，伺服系統(tǒng)跟蹤誤差越小，變化范圍越小，控制效果越好。
本文的火炮模塊藥輸送伺服系統(tǒng)要求為：能夠跟蹤給定的角位置軌跡；運(yùn)動(dòng)過(guò)程具有較好的穩(wěn)定性，抖振控制在合理范圍內(nèi)；為保證電機(jī)輸出軸經(jīng)過(guò)減速裝置后機(jī)構(gòu)的末端誤差控制在合理范圍內(nèi)，根據(jù)機(jī)構(gòu)末端精度指標(biāo)要求等效至電機(jī)輸出軸的動(dòng)態(tài)誤差不大于±3.75 rad，穩(wěn)定誤差不大于±1.5 rad.
2 控制器設(shè)計(jì)
火炮模塊藥輸送伺服系統(tǒng)角位置誤差定義為
e=θd-θ.
(5)
采用PID積分型滑模函數(shù)為
(6)
式中：kP、kI、kD為待確定的參數(shù)，且kP>0、kI>0、kD>0.
由(3)式、(5)式和(6)式可知
(7)
等效控制律設(shè)計(jì)為
(8)
式中：ue為等效控制項(xiàng)；J0=J/kt；B0=B/kt.
設(shè)計(jì)切換控制為
us=ηsgn(s)+λs，
(9)
式中：us為切換控制項(xiàng)；η為切換系數(shù)，η>0；λ為指數(shù)項(xiàng)系數(shù)，λ>0；sgn(s)為符號(hào)函數(shù)，可以表示為
(10)
由(8)式和(9)式可知系統(tǒng)控制器為
(11)
將(11)式代入(7)式中，得
(12)
式中：Td0=Td/kt. 考慮定義如下Lyapunov函數(shù)：
(13)
將(13)式對(duì)時(shí)間求導(dǎo)可知：
(14)
由于火炮模塊藥輸送伺服系統(tǒng)的負(fù)載是動(dòng)態(tài)變化的，變化過(guò)程中等效轉(zhuǎn)動(dòng)慣量J和等效阻尼系數(shù)B的值發(fā)生非線性變化。因此，控制器(11)式中參數(shù)J0和B0的值也是非線性變化的，若采取賦予固定值的方法顯然是不準(zhǔn)確的。本文中采用自適應(yīng)方法對(duì)該參量進(jìn)行動(dòng)態(tài)調(diào)節(jié)，實(shí)時(shí)適應(yīng)運(yùn)動(dòng)過(guò)程?？刂破髟O(shè)計(jì)為
(15)
由(7)式和(15)式可知
(16)
設(shè)計(jì)Lyapunov函數(shù)為
(17)
(18)
(19)
故選取自適應(yīng)律為
(20)
選用飽和函數(shù)代替(10)式符號(hào)函數(shù)，飽和函數(shù)形式為
(21)
式中：Δ為飽和函數(shù)邊界常數(shù)，Δ>0. 新型飽和函數(shù)用飽和特性代替了傳統(tǒng)符號(hào)函數(shù)的繼電特性，改善了切換過(guò)程中的不連續(xù)性。
切換控制中η值對(duì)控制的輸出影響較大，如果η較小，趨近速度比較慢；反之η較大，趨近速度較大，當(dāng)運(yùn)動(dòng)到切換面時(shí)，將會(huì)引起系統(tǒng)抖振。所以本文針對(duì)η值的大小，取滑模函數(shù)s的絕對(duì)值作為輸入，模糊輸出變量為η. 當(dāng)滑模函數(shù)距離滑模面較遠(yuǎn)時(shí)，應(yīng)提高趨近速度，故η應(yīng)增加；當(dāng)系統(tǒng)逼近滑模面時(shí)，應(yīng)降低趨近速度，故η應(yīng)減小。基于此原則引入模糊規(guī)則，模糊變量的隸屬函數(shù)如圖1所示，圖中：s0、s1為待定參數(shù)，s0>0、s1>0；α1、α2、α3為模糊系統(tǒng)待設(shè)計(jì)自適應(yīng)參量，Z、PM、PB為變量的模糊狀態(tài)，PB為正大，PM為正中，Z為0.
圖1 模糊系統(tǒng)的隸屬度函數(shù)Fig.1 Membership function of fuzzy system
采用表1所示的模糊規(guī)則進(jìn)行推理。
表1 模糊規(guī)則
采用重心法解模糊，得到模糊系統(tǒng)的輸出η為
(22)
式中：ωi為模糊輸入|s|在各模糊子集上的隸屬度，且0≤ωi≤1，即ω1=μPB(s)，ω2=μPM(s)，ω3=μZ(s).
對(duì)參數(shù)αi采取自適應(yīng)處理，即自適應(yīng)估計(jì)值T=[1,2,3]，可知
(|s|,)=()Tδ.
(23)
將(23)式代入(15)式，可得控制律為
(24)
考慮定義如下Lyapunov函數(shù)：
(25)
kDαTδs·sat(s)-kDλs2+kDTd0s.
(26)
(27)
由(26)式和(27)式可知
(28)
3 實(shí)驗(yàn)驗(yàn)證分析
火炮模塊藥輸送伺服系統(tǒng)示意圖如圖2所示。系統(tǒng)包含顯控終端、綜合控制器、驅(qū)動(dòng)器、永磁同步伺服電機(jī)、減速器、角編碼器、傳動(dòng)軸、齒輪、傳動(dòng)鏈、藥筒、選藥和推藥等執(zhí)行機(jī)構(gòu)。
圖2 火炮模塊藥輸送伺服系統(tǒng)控制框圖Fig.2 Block diagram of artillery modular charge transport servo system
火炮模塊藥輸送伺服系統(tǒng)精確定位控制實(shí)驗(yàn)中，上位機(jī)通過(guò)標(biāo)準(zhǔn)TCP/IP協(xié)議(以太網(wǎng))與控制器完成控制信息和數(shù)據(jù)信息交互；控制器通過(guò)數(shù)據(jù)總線完成伺服電機(jī)控制電流的輸出，并獲取實(shí)際的電機(jī)轉(zhuǎn)子角位置和角速度值；驅(qū)動(dòng)器將控制輸入的驅(qū)動(dòng)電流作用在伺服電機(jī)上，伺服電機(jī)帶動(dòng)藥筒完成運(yùn)動(dòng)。實(shí)驗(yàn)過(guò)程中采用預(yù)設(shè)理論運(yùn)動(dòng)軌跡的方式校驗(yàn)控制策略的控制效果，該方法通過(guò)比較測(cè)量輸出的角位置值和理論規(guī)劃的角位置值之間的差值，可直觀地觀測(cè)控制精度。理論運(yùn)動(dòng)軌跡如圖3所示。
圖3 預(yù)設(shè)理論運(yùn)動(dòng)軌跡Fig.3 Supposed theoretical motion track
參數(shù)選取：電機(jī)額定功率P=800 W，采樣周期為0.004 s，總線通信波特率為500 kbit/s，kP=4.5，kI=40，kD=1，λ=0.5，Δ=1.5，s0=8，s1=20，γ1=1×10-6，γ2=1×10-6，γ3=0.01，J0的初始值設(shè)為2.02×10-3A·s2/rad，B0的初始值設(shè)為3.36×10-4A·s/rad.
實(shí)驗(yàn)中分別對(duì)火炮模塊藥輸送伺服系統(tǒng)的滿載、半載、空載3種狀態(tài)進(jìn)行了研究。圖4為不同負(fù)載下的控制輸入電流u，從空載(見(jiàn)圖4(a))、半載(見(jiàn)圖4(b))和滿載(見(jiàn)圖4(c))曲線可以看出：隨著負(fù)載的加大，啟動(dòng)電流隨之增加，伴隨著跟蹤誤差的減小，控制電流逐漸趨于穩(wěn)定，不同負(fù)載電流變化規(guī)律基本一致；整個(gè)過(guò)程中由于反饋信號(hào)導(dǎo)致測(cè)量噪聲無(wú)法消除，使得過(guò)程中控制輸入存在一定程度的波動(dòng)，但該抖振未對(duì)系統(tǒng)控制性能造成影響；系統(tǒng)最終由于非線性摩擦等因素，控制電流穩(wěn)定在一個(gè)值附近，進(jìn)入穩(wěn)定狀態(tài)。
圖4 系統(tǒng)控制輸入電流uFig.4 Control inputs of the system
圖5(a)、圖5(b)和圖5(c)為3種狀態(tài)下的角位置跟蹤誤差e情況，反映了預(yù)設(shè)角度值和實(shí)際電機(jī)轉(zhuǎn)子運(yùn)動(dòng)角位置的差值變化狀況。在最初的自適應(yīng)學(xué)習(xí)階段，誤差存在一個(gè)小高峰，但持續(xù)時(shí)間短，系統(tǒng)很快收斂到一個(gè)小的誤差范圍內(nèi)，整個(gè)過(guò)程較為平穩(wěn)，抖振較小，即使在空載、半載和滿載參數(shù)范圍變化的情況下，控制精度依然能夠滿足系統(tǒng)的功能性能要求，能夠抵抗參數(shù)非線性變化和擾動(dòng)帶來(lái)的影響。3種負(fù)載下的最大動(dòng)態(tài)跟蹤誤差分別為0.41 rad、0.95 rad、1.23 rad，穩(wěn)定誤差均在0.1 rad以內(nèi)，控制精度遠(yuǎn)高于要求精度。
圖5 系統(tǒng)角位置跟蹤誤差eFig.5 Angular position tracking errors of the system
圖6 J0的估計(jì)值Fig.6 Estimated values of J0
圖6～圖10為不同狀態(tài)下自適應(yīng)參數(shù)的變化范圍，從圖中可以看到，在不同負(fù)載下，參數(shù)變化曲線是不同的，曲線最終都是收斂的。其中圖8～圖10為采取模糊算法獲得的模糊自適應(yīng)參數(shù)，由曲線可知，引入模糊算法獲得了趨近速度參數(shù)的動(dòng)態(tài)值，彌補(bǔ)了固定趨近參數(shù)值對(duì)系統(tǒng)魯棒性能的影響，使系統(tǒng)獲得了良好的性能和穩(wěn)定性。
圖7 B0的估計(jì)值Fig.7 Estimated values of B0
圖8 α1的估計(jì)值Fig.8 Estimated values of α1
圖9 α2的估計(jì)值Fig.9 Estimated values of α2
圖10 α3的估計(jì)值Fig.10 Estimated values of α3
4 結(jié)論
本文根據(jù)火炮模塊藥伺服系統(tǒng)結(jié)構(gòu)、運(yùn)動(dòng)特點(diǎn)和該類對(duì)象的控制現(xiàn)狀，提出了采用自適應(yīng)模糊算法以及新型飽和函數(shù)相結(jié)合的控制策略，分析了該策略解決負(fù)載變化和抖振等對(duì)系統(tǒng)控制精度的影響，進(jìn)行了火炮模塊藥輸送伺服系統(tǒng)精確定位控制實(shí)驗(yàn)，得到以下結(jié)論：
1) 控制策略對(duì)系統(tǒng)不同負(fù)載、參數(shù)變化是不敏感的，各種負(fù)載下均具有良好的位置跟蹤精度，能夠很好地跟蹤給定的運(yùn)動(dòng)軌跡。
2) 系統(tǒng)動(dòng)態(tài)誤差和穩(wěn)定誤差均收斂在較小的范圍，滿足性能指標(biāo)，為后續(xù)的模塊藥輸送傳遞提供了保障。
3) 從實(shí)驗(yàn)結(jié)果可以看出，測(cè)量噪聲的存在對(duì)被控對(duì)象運(yùn)動(dòng)造成一定程度的抖振。因此，通過(guò)分析處理測(cè)量噪聲來(lái)降低抖振值得繼續(xù)深入研究。
References)
[1] 王昭磊, 王青, 冉茂鵬, 等. 基于自適應(yīng)模糊滑模的復(fù)合控制導(dǎo)彈制導(dǎo)控制一體化反演設(shè)計(jì)[J]. 兵工學(xué)報(bào), 2015, 36(1):78-86.
WANG Zhao-lei, WANG Qing, RAN Mao-peng, et al. Integrated guidance and control backstepping design of blended control missile based on adaptive fuzzy sliding mode control[J]. Acta Armamentarii, 2015, 36(1):78-86. (in Chinese)
[2] Shahnazi R, Shanechi H, Pariz N. Position control of induction and DC servomotors: a novel adaptive fuzzy PI sliding mode control[J]. IEEE Transactions on Energy Conversion, 2008, 23(1):138-147.
[3] 侯潤(rùn)民, 劉榮忠, 高強(qiáng), 等. 一種自適應(yīng)模糊小波神經(jīng)網(wǎng)絡(luò)及其在交流伺服控制中的應(yīng)用[J]. 兵工學(xué)報(bào), 2015, 36(5):781-788.
HOU Run-min, LIU Rong-zhong, GAO Qiang, et al. Application of adaptive fuzzy wavelet neural network in AC servo control system[J]. Acta Armamentarii, 2015, 36(5):781-788. (in Chinese)
[4] 李坤全, 文睿. 焊接機(jī)器人焊縫模糊PID跟蹤控制[J]. 控制工程, 2017, 24(2):351-354.
LI Kun-quan, WEN Rui. Fuzzy PID tracking control for welding robots [J]. Control Engineering of China, 2017, 24(2):351-354. (in Chinese)
[5] Hung J Y, Gao W, Hung J C. Variable structure control: a survey[J]. IEEE Transactions on Industrial Electronics, 1993, 40(1):2-22.
[6] 鮑雪, 王大志, 胡明. 基于自適應(yīng)模糊的旋轉(zhuǎn)彈反演滑?？刂坡稍O(shè)計(jì)[J]. 儀器儀表學(xué)報(bào), 2016, 37(6):1333-1339.
BAO Xue, WANG Da-zhi, HU Ming. Backstepping sliding mode control design for spinning ammunition based on adaptive fuzzy method[J]. Chinese Journal of Scientific Instrument, 2016, 37(6):1333-1339. (in Chinese)
[7] 陳辰, 馬廣富, 孫延超, 等. 基于擾動(dòng)觀測(cè)器的高速聲速飛行器遞階滑模控制[J]. 兵工學(xué)報(bào), 2016, 37(5):840-850.
CHEN Chen, MA Guang-fu, SUN Yan-chao, et al. Recursive sliding mode control for hypersonic vehicle based on nonlinear disturbance observer[J]. Acta Armamentarii, 2016, 37(5):840-850. (in Chinese)
[8] Saghafinia A, Ping H W, Uddin M N, et al. Adaptive fuzzy sliding-mode control into chattering-free IM drive[J]. IEEE Transactions on Industry Applications, 2015, 51(1):692-701.
[9] 李良, 李峰, 馮永保, 等. 基于自適應(yīng)模糊滑模的大型液壓起豎系統(tǒng)控制策略研究[J]. 兵工學(xué)報(bào), 2016, 37(1):71-76.
LI Liang, LI Feng, FENG Yong-bao, et al. Research on control strategy of large hydraulic erecting system based on adaptive fuzzy sliding mode[J]. Acta Armamentarii, 2016, 37(1):71-76. (in Chinese)
[10] Wang F, Liu Z, Lai G Y. Fuzzy adaptive control of nonlinear uncertain plants with unknown dead zone output[J]. Fuzzy Sets and Systems, 2014, 263:27-48.
[11] Long L J, Zhao J. Adaptive fuzzy tracking control of switched uncertain nonlinear systems with unstable subsystems[J]. Fuzzy Sets and Systems, 2015, 273:49-67.
[12] Ho H F, Wong Y K, Rad A B. Adaptive fuzzy sliding mode control with chattering elimination for nonlinear SISO systems[J]. Simulation Modelling Practiceand Theory, 2009, 17(7):1199-1210.
[13] Wu T S, Karkoub M, Chen H S, et al.Robust tracking observer-based adaptive fuzzy control design for uncertain nonlinear MIMO systems with time delayed states[J]. Information Sciences, 2015, 290:86-105.
[14] Ullah N, Wang S P, Khattak M I, et al. Fractional order adaptive fuzzy sliding mode controller for a position servo system subjected to aerodynamic loading and nonlinearities[J]. Aerospace Science & Technology, 2015, 43:381-387.
[15] Wai R J, Lin C M, Hsu C F. Adaptive fuzzy sliding-mode control for electrical servo drive[J]. Fuzzy Sets and Systems, 2004, 143(2):295-310.
[16] 郭亞軍, 馬大為, 王曉峰, 等. 交流伺服系統(tǒng)自適應(yīng)反演滑?？刂破髟O(shè)計(jì)[J]. 北京理工大學(xué)學(xué)報(bào), 2010, 30(1):99-102.
GUO Ya-jun, MA Da-wei, WANG Xiao-feng, et al. Design of adaptive backstepping sliding mode controller in alternating current servo system[J]. Transactions of Beijing Institute of Technology, 2010, 30(1):99-102. (in Chinese)
[17] 姚來(lái)鵬, 侯保林. 隨機(jī)振動(dòng)機(jī)械臂的自適應(yīng)魯棒滑?？刂芠J]. 中國(guó)機(jī)械工程, 2016, 27(5):694-697.
YAO Lai-peng, HOU Bao-lin. Adaptive sliding mode control of robotic manipulators with external uncertain stochastic vibration[J]. China Mechanical Engineering, 2016, 27(5):694-697. (in Chinese)
[18] 陳明俊, 李長(zhǎng)紅, 楊燕. 武器伺服系統(tǒng)工程實(shí)踐[M]. 北京：國(guó)防工業(yè)出版社, 2013：193-220..
CHEN Ming-jun, LI Chang-hong, YANG Yan. Weapon servo system engineering practice[M]. Beijing: National Defense Industry Press, 2013:193-220. (in Chinese)
AdaptiveFuzzySlidingModeControlfortheArtilleryModularChargeTransportServoSystem
YUE Cai-cheng1, QIAN Lin-fang1, KONG Jian-shou2, LI Ying3
(1.School of Mechanical Engineering, Nanjing University of Science and Technology, Nanjing 210094, Jiangsu, China;2.School of Automation, Nanjing University of Science and Technology, Nanjing 210094, Jiangsu, China;3.Northwest Institute of Mechanical Engineering, Xianyang 712000, Shaanxi, China)
An adaptive fuzzy sliding mode controller (AFSMC) with an integral sliding mode function is proposed for the control of the artillery modular charge transport servo system which has time-varying parameters and chattering problem. The time-varying system parameters are estimated by using adaptive method. The influence of model uncertainty on the control system is reduced. Then, the traditional switching function is replaced by an improved saturation function. This ensures that the process of switching is more continuous and smooth. The coefficient of switching is tuned online by the fuzzy adaptive scheme. In this way, the robustness of system is enhanced, and the chattering of system is restrained. Experimental results show the system has a good position tracking performance under empty-load, half-load and full-load, which can meet the performance index. The proposed AFSMC scheme can overcome the influence of variable loads on the control precision of the system.
ordnance science and technology; artillery modular charge transport servo system; chattering; adaptive fuzzy sliding mode controll; position tracking
2017-03-20
國(guó)家自然科學(xué)基金項(xiàng)目(11472137)
岳才成(1990—)， 男， 博士研究生。 E-mail: yuecaicheng226@126.com
錢林方(1961—)， 男， 教授， 博士生導(dǎo)師。 E-mail: lfqian@vip.163.com
TJ303+.3； TP273+.4
A
1000-1093(2017)10-1891-08
10.3969/j.issn.1000-1093.2017.10.003
猜你喜歡
北京航空航天大學(xué)學(xué)報(bào)(2022年6期)2022-07-02 01:59:46 專利名稱:一種適應(yīng)壓鑄環(huán)境的伺服電機(jī)微特電機(jī)(2020年11期)2020-12-30 19:42:32 火炮也減肥小哥白尼(軍事科學(xué))(2020年2期)2020-06-16 03:11:04 基于復(fù)合前饋模糊PID的位置伺服系統(tǒng)研究測(cè)控技術(shù)(2018年12期)2018-11-25 09:37:44 生產(chǎn)線中的伺服電機(jī)定位控制電子制作(2018年17期)2018-09-28 01:57:00 伺服電機(jī)控制技術(shù)的應(yīng)用及發(fā)展趨向分析通信電源技術(shù)(2018年3期)2018-06-26 06:33:36 淺說(shuō)伺服電機(jī)位置控制下的定位問(wèn)題工業(yè)設(shè)計(jì)(2016年6期)2016-04-17 06:42:53 基于自適應(yīng)反步的DGMSCMG框架伺服系統(tǒng)控制方法北京航空航天大學(xué)學(xué)報(bào)(2016年4期)2016-02-27 06:32:11 消除彈道跟蹤數(shù)據(jù)中伺服系統(tǒng)的振顫干擾彈箭與制導(dǎo)學(xué)報(bào)(2015年1期)2015-03-11 15:32:18 陸戰(zhàn)之神——火炮小哥白尼·趣味科學(xué)畫報(bào)(2006年8期)2006-03-18 07:41:12
岳才成， 錢林方， 孔建壽， 李穎
(1.南京理工大學(xué) 機(jī)械工程學(xué)院, 江蘇 南京 210094; 2.南京理工大學(xué) 自動(dòng)化學(xué)院, 江蘇 南京 210094; 3.西北機(jī)電工程研究所， 陜西 咸陽(yáng) 712000)
火炮模塊藥輸送伺服系統(tǒng)自適應(yīng)模糊滑?？刂?/p>
岳才成1， 錢林方1， 孔建壽2， 李穎3
(1.南京理工大學(xué) 機(jī)械工程學(xué)院, 江蘇 南京 210094; 2.南京理工大學(xué) 自動(dòng)化學(xué)院, 江蘇 南京 210094; 3.西北機(jī)電工程研究所， 陜西 咸陽(yáng) 712000)
針對(duì)火炮模塊藥輸送伺服系統(tǒng)傳動(dòng)過(guò)程中存在參數(shù)時(shí)變和抖振等問(wèn)題，設(shè)計(jì)了一種帶有積分滑模函數(shù)的自適應(yīng)模糊滑?？刂破鳌２捎米赃m應(yīng)方法對(duì)系統(tǒng)時(shí)變參數(shù)進(jìn)行估計(jì)，減小不確定部分對(duì)控制系統(tǒng)的影響。引入新型飽和函數(shù)代替?zhèn)鹘y(tǒng)切換函數(shù)，保證整個(gè)切換過(guò)程連續(xù)、平滑過(guò)渡；采用模糊自適應(yīng)算法對(duì)切換系數(shù)在線調(diào)整，提高系統(tǒng)的魯棒性能，進(jìn)一步抑制切換過(guò)程中的抖振。實(shí)驗(yàn)結(jié)果表明，火炮模塊藥輸送伺服系統(tǒng)在空載、半載和滿載3種情況下均具有良好的位置跟蹤性能，滿足性能指標(biāo)要求，提出的自適應(yīng)模糊滑?？刂扑惴軌蚩朔?fù)載變化對(duì)系統(tǒng)控制精度的影響。
兵器科學(xué)與技術(shù)； 火炮模塊藥輸送伺服系統(tǒng)； 抖振； 自適應(yīng)模糊滑?？刂疲?位置跟蹤
0 引言
火炮模塊藥輸送伺服系統(tǒng)是自行火炮自動(dòng)裝填系統(tǒng)的重要組成部分，包含顯控終端、綜合控制器、驅(qū)動(dòng)器、永磁同步伺服電機(jī)、減速器、角編碼器、傳動(dòng)軸、齒輪、傳動(dòng)鏈、藥筒、選藥機(jī)構(gòu)和推藥機(jī)構(gòu)等組成，該系統(tǒng)具有齒輪傳動(dòng)和帶傳動(dòng)的特點(diǎn)，大量裝備在自動(dòng)化程度高、可靠性高的特種裝備上。由于系統(tǒng)安裝位置空間狹小，較難維修，所以要求系統(tǒng)在運(yùn)動(dòng)過(guò)程中具備較高的可靠性、較好的定位精度等。系統(tǒng)在傳動(dòng)過(guò)程中，通過(guò)同步交流伺服電機(jī)作用在中間機(jī)構(gòu)上，帶動(dòng)藥筒完成回轉(zhuǎn)動(dòng)作；通過(guò)藥筒回轉(zhuǎn)，實(shí)現(xiàn)藥筒從任意位置到達(dá)規(guī)定選藥位，配合選藥裝置等完成選藥任務(wù)；選藥完成后，推藥電機(jī)負(fù)責(zé)將模塊藥輸送至輸藥機(jī)構(gòu)上，等待后續(xù)動(dòng)作?；鹋谀K藥輸送伺服系統(tǒng)在運(yùn)動(dòng)過(guò)程中的運(yùn)動(dòng)狀態(tài)，以及定位精度對(duì)后續(xù)選藥、推藥等具有較大的影響。
火炮模塊藥輸送伺服系統(tǒng)在旋轉(zhuǎn)選藥過(guò)程中，藥筒中模塊藥的數(shù)量是隨時(shí)可能發(fā)生改變的，隨著模塊藥數(shù)量的變化，系統(tǒng)轉(zhuǎn)動(dòng)慣量、負(fù)載力矩、非線性摩擦等都在發(fā)生改變。由于參數(shù)的不斷變化，很難確定系統(tǒng)精確的數(shù)學(xué)模型，在解決系統(tǒng)模型參數(shù)不確定控制問(wèn)題方面，滑模變結(jié)構(gòu)控制應(yīng)用較為廣泛。王昭磊等[1]考慮目標(biāo)機(jī)動(dòng)、建模誤差和氣動(dòng)參數(shù)攝動(dòng)等不確定性影響，設(shè)計(jì)了自適應(yīng)模糊控制器，采用模糊逼近手段逼近不確定函數(shù)，應(yīng)用模糊補(bǔ)償方法補(bǔ)償逼近誤差及干擾，提高了系統(tǒng)的魯棒性。文獻(xiàn)[2]采用傳統(tǒng)自適應(yīng)模糊滑模及自適應(yīng)PI控制算法完成了對(duì)感應(yīng)直流伺服電機(jī)位置的控制，證明了所提出算法在解決伺服電機(jī)參數(shù)不確定、負(fù)載環(huán)境不確定、抖振問(wèn)題和跟蹤性能方面具有較好的效果。文獻(xiàn)[3]針對(duì)武器大功率交流伺服系統(tǒng)所存在的大變負(fù)載、慢時(shí)變、強(qiáng)耦合的非線性特性和不確定擾動(dòng)等問(wèn)題，采用模糊小波神經(jīng)網(wǎng)絡(luò)間接自適應(yīng)控制策略，有效地提高了整個(gè)系統(tǒng)的跟蹤穩(wěn)定性和響應(yīng)快速性。李坤全等[4]針對(duì)焊接系統(tǒng)具有強(qiáng)耦合、非線性且建模困難的特點(diǎn)，提出了一種變論域自適應(yīng)模糊PID復(fù)合的焊縫控制方法。仿真與實(shí)驗(yàn)結(jié)果表明，該方法可靠性好，抗干擾能力強(qiáng)，跟蹤能力好，能夠?qū)崿F(xiàn)焊縫的精確跟蹤。
滑模變結(jié)構(gòu)控制通過(guò)對(duì)切換函數(shù)符號(hào)的判別，不斷地切換控制量來(lái)改變系統(tǒng)的結(jié)構(gòu)，使?fàn)顟B(tài)變量運(yùn)動(dòng)在已設(shè)定的切換面上。由于需要在不同控制邏輯間反復(fù)切換，這種切換會(huì)使系統(tǒng)產(chǎn)生抖振現(xiàn)象[5]。因此，火炮模塊藥輸送伺服系統(tǒng)的控制要解決好模型參數(shù)不確定和抖振等帶來(lái)的問(wèn)題。
文獻(xiàn)[6]針對(duì)旋轉(zhuǎn)彈模型的非線性、強(qiáng)耦合和參數(shù)不確定性等問(wèn)題，提出一種基于自適應(yīng)反演和滑模控制理論的旋轉(zhuǎn)彈體姿態(tài)控制律。該方法有效地抑制不確定氣動(dòng)參數(shù)和外部干擾的影響，使系統(tǒng)具有良好的穩(wěn)定性和魯棒性。文獻(xiàn)[7]針對(duì)存在擾動(dòng)、執(zhí)行機(jī)構(gòu)死區(qū)非線性以及系統(tǒng)不確定性的高超聲速飛行器巡航飛行縱向通道模型，提出了帶有新型非線性擾動(dòng)觀測(cè)器的遞階滑?？刂破鳎行Ы档土丝刂破髟鲆?，削弱了抖振，消除了執(zhí)行機(jī)構(gòu)死區(qū)特性對(duì)動(dòng)態(tài)系統(tǒng)的影響。仿真結(jié)果表明，該控制策略對(duì)高超聲速飛行器具有較好的控制作用。文獻(xiàn)[8-14]提出了自適應(yīng)模糊算法用以解決非線性系統(tǒng)參數(shù)不確定、擾動(dòng)帶來(lái)的抖振等問(wèn)題，文獻(xiàn)中所研究系統(tǒng)包含無(wú)抖振異步電動(dòng)機(jī)控制、大型液壓起豎系統(tǒng)、具有未知輸出死區(qū)的非線性不確定、具有不穩(wěn)定子系統(tǒng)的切換不確定非線性、單輸入單輸出非線性系統(tǒng)、狀態(tài)延時(shí)的不確定非線性多輸入多輸出、位置伺服等系統(tǒng)，算法對(duì)該類非線性系統(tǒng)控制效果良好。Wai等[15]采用帶有積分運(yùn)算切換面的自適應(yīng)模糊趨近策略，完成了對(duì)伺服驅(qū)動(dòng)系統(tǒng)的精確魯棒位置控制，將模糊滑模控制和自適應(yīng)模糊滑?？刂菩ЧM(jìn)行對(duì)比，結(jié)果表明后者具有較好的位置跟蹤性能，控制過(guò)程更加平穩(wěn)，有效地降低了抖振影響。
現(xiàn)今特種裝備控制中，應(yīng)用最多的控制策略仍為PID控制。傳統(tǒng)PID控制算法缺少對(duì)模型非線性和參數(shù)不確定性的考慮，控制精度略低，運(yùn)動(dòng)的平穩(wěn)性不好，較難獲得理想的動(dòng)態(tài)品質(zhì)，在處理參數(shù)變化和擾動(dòng)帶來(lái)的影響方面效果欠佳[16-17]?；鹋谀K藥輸送系統(tǒng)和這些文獻(xiàn)中所研究的對(duì)象結(jié)構(gòu)差別較大，同時(shí)，該系統(tǒng)工作環(huán)境更為苛刻，性能要求更高，傳統(tǒng)控制算法很難獲得滿意的動(dòng)態(tài)品質(zhì)。在文獻(xiàn)資料的提示下，針對(duì)算法中對(duì)切換系數(shù)考慮不充分的現(xiàn)象，結(jié)合被控對(duì)象火炮模塊藥輸送伺服系統(tǒng)負(fù)載非線性變化、存在擾動(dòng)、控制精度要求高的特點(diǎn)，本文提出采用等效控制和切換控制相結(jié)合的控制策略，對(duì)等效轉(zhuǎn)動(dòng)慣量和阻尼系數(shù)參數(shù)采用自適應(yīng)方式，降低負(fù)載非線性變化對(duì)系統(tǒng)穩(wěn)定性的影響；同時(shí)對(duì)切換系數(shù)這個(gè)關(guān)鍵參數(shù)采用了模糊自適應(yīng)方法進(jìn)行在線估計(jì)，提高系統(tǒng)對(duì)參數(shù)非線性變化和擾動(dòng)的不敏感性，提高系統(tǒng)的定位精度和魯棒性，降低系統(tǒng)運(yùn)動(dòng)中的抖振和撞擊。
1 系統(tǒng)控制模型
永磁同步電機(jī)采用d軸定子電流id=0的控制，電機(jī)轉(zhuǎn)矩[18]定義為
Te=ktui，
(1)
式中：kt=pnψf為電機(jī)轉(zhuǎn)矩常數(shù)，且kt>0，pn為電機(jī)的極對(duì)數(shù)，ψf為磁鏈；ui=iq為控制輸入q軸電流(A)，iq為q軸電流。
火炮模塊藥輸送伺服系統(tǒng)為2階系統(tǒng)，其系統(tǒng)動(dòng)力學(xué)方程可以定義為
(2)
將(1)式代入(2)式，整理得到火炮模塊藥輸送伺服系統(tǒng)動(dòng)力學(xué)方程為
(3)
或
(4)
在實(shí)際的永磁同步電機(jī)伺服系統(tǒng)中，給定電機(jī)轉(zhuǎn)子理論角位置θd，并完成對(duì)永磁同步電機(jī)控制電流ui的輸入，就可獲得實(shí)際轉(zhuǎn)子角位置θ，其中θd和ui均有界，伺服系統(tǒng)跟蹤誤差越小，變化范圍越小，控制效果越好。
本文的火炮模塊藥輸送伺服系統(tǒng)要求為：能夠跟蹤給定的角位置軌跡；運(yùn)動(dòng)過(guò)程具有較好的穩(wěn)定性，抖振控制在合理范圍內(nèi)；為保證電機(jī)輸出軸經(jīng)過(guò)減速裝置后機(jī)構(gòu)的末端誤差控制在合理范圍內(nèi)，根據(jù)機(jī)構(gòu)末端精度指標(biāo)要求等效至電機(jī)輸出軸的動(dòng)態(tài)誤差不大于±3.75 rad，穩(wěn)定誤差不大于±1.5 rad.
2 控制器設(shè)計(jì)
火炮模塊藥輸送伺服系統(tǒng)角位置誤差定義為
e=θd-θ.
(5)
采用PID積分型滑模函數(shù)為
(6)
式中：kP、kI、kD為待確定的參數(shù)，且kP>0、kI>0、kD>0.
由(3)式、(5)式和(6)式可知
(7)
等效控制律設(shè)計(jì)為
(8)
式中：ue為等效控制項(xiàng)；J0=J/kt；B0=B/kt.
設(shè)計(jì)切換控制為
us=ηsgn(s)+λs，
(9)
式中：us為切換控制項(xiàng)；η為切換系數(shù)，η>0；λ為指數(shù)項(xiàng)系數(shù)，λ>0；sgn(s)為符號(hào)函數(shù)，可以表示為
(10)
由(8)式和(9)式可知系統(tǒng)控制器為
(11)
將(11)式代入(7)式中，得
(12)
式中：Td0=Td/kt. 考慮定義如下Lyapunov函數(shù)：
(13)
將(13)式對(duì)時(shí)間求導(dǎo)可知：
(14)
由于火炮模塊藥輸送伺服系統(tǒng)的負(fù)載是動(dòng)態(tài)變化的，變化過(guò)程中等效轉(zhuǎn)動(dòng)慣量J和等效阻尼系數(shù)B的值發(fā)生非線性變化。因此，控制器(11)式中參數(shù)J0和B0的值也是非線性變化的，若采取賦予固定值的方法顯然是不準(zhǔn)確的。本文中采用自適應(yīng)方法對(duì)該參量進(jìn)行動(dòng)態(tài)調(diào)節(jié)，實(shí)時(shí)適應(yīng)運(yùn)動(dòng)過(guò)程?？刂破髟O(shè)計(jì)為
(15)
由(7)式和(15)式可知
(16)
設(shè)計(jì)Lyapunov函數(shù)為
(17)
(18)
(19)
故選取自適應(yīng)律為
(20)
選用飽和函數(shù)代替(10)式符號(hào)函數(shù)，飽和函數(shù)形式為
(21)
式中：Δ為飽和函數(shù)邊界常數(shù)，Δ>0. 新型飽和函數(shù)用飽和特性代替了傳統(tǒng)符號(hào)函數(shù)的繼電特性，改善了切換過(guò)程中的不連續(xù)性。
切換控制中η值對(duì)控制的輸出影響較大，如果η較小，趨近速度比較慢；反之η較大，趨近速度較大，當(dāng)運(yùn)動(dòng)到切換面時(shí)，將會(huì)引起系統(tǒng)抖振。所以本文針對(duì)η值的大小，取滑模函數(shù)s的絕對(duì)值作為輸入，模糊輸出變量為η. 當(dāng)滑模函數(shù)距離滑模面較遠(yuǎn)時(shí)，應(yīng)提高趨近速度，故η應(yīng)增加；當(dāng)系統(tǒng)逼近滑模面時(shí)，應(yīng)降低趨近速度，故η應(yīng)減小。基于此原則引入模糊規(guī)則，模糊變量的隸屬函數(shù)如圖1所示，圖中：s0、s1為待定參數(shù)，s0>0、s1>0；α1、α2、α3為模糊系統(tǒng)待設(shè)計(jì)自適應(yīng)參量，Z、PM、PB為變量的模糊狀態(tài)，PB為正大，PM為正中，Z為0.
圖1 模糊系統(tǒng)的隸屬度函數(shù)Fig.1 Membership function of fuzzy system
采用表1所示的模糊規(guī)則進(jìn)行推理。
表1 模糊規(guī)則
采用重心法解模糊，得到模糊系統(tǒng)的輸出η為
(22)
式中：ωi為模糊輸入|s|在各模糊子集上的隸屬度，且0≤ωi≤1，即ω1=μPB(s)，ω2=μPM(s)，ω3=μZ(s).
對(duì)參數(shù)αi采取自適應(yīng)處理，即自適應(yīng)估計(jì)值T=[1,2,3]，可知
(|s|,)=()Tδ.
(23)
將(23)式代入(15)式，可得控制律為
(24)
考慮定義如下Lyapunov函數(shù)：
(25)
kDαTδs·sat(s)-kDλs2+kDTd0s.
(26)
(27)
由(26)式和(27)式可知
(28)
3 實(shí)驗(yàn)驗(yàn)證分析
火炮模塊藥輸送伺服系統(tǒng)示意圖如圖2所示。系統(tǒng)包含顯控終端、綜合控制器、驅(qū)動(dòng)器、永磁同步伺服電機(jī)、減速器、角編碼器、傳動(dòng)軸、齒輪、傳動(dòng)鏈、藥筒、選藥和推藥等執(zhí)行機(jī)構(gòu)。
圖2 火炮模塊藥輸送伺服系統(tǒng)控制框圖Fig.2 Block diagram of artillery modular charge transport servo system
火炮模塊藥輸送伺服系統(tǒng)精確定位控制實(shí)驗(yàn)中，上位機(jī)通過(guò)標(biāo)準(zhǔn)TCP/IP協(xié)議(以太網(wǎng))與控制器完成控制信息和數(shù)據(jù)信息交互；控制器通過(guò)數(shù)據(jù)總線完成伺服電機(jī)控制電流的輸出，并獲取實(shí)際的電機(jī)轉(zhuǎn)子角位置和角速度值；驅(qū)動(dòng)器將控制輸入的驅(qū)動(dòng)電流作用在伺服電機(jī)上，伺服電機(jī)帶動(dòng)藥筒完成運(yùn)動(dòng)。實(shí)驗(yàn)過(guò)程中采用預(yù)設(shè)理論運(yùn)動(dòng)軌跡的方式校驗(yàn)控制策略的控制效果，該方法通過(guò)比較測(cè)量輸出的角位置值和理論規(guī)劃的角位置值之間的差值，可直觀地觀測(cè)控制精度。理論運(yùn)動(dòng)軌跡如圖3所示。
圖3 預(yù)設(shè)理論運(yùn)動(dòng)軌跡Fig.3 Supposed theoretical motion track
參數(shù)選取：電機(jī)額定功率P=800 W，采樣周期為0.004 s，總線通信波特率為500 kbit/s，kP=4.5，kI=40，kD=1，λ=0.5，Δ=1.5，s0=8，s1=20，γ1=1×10-6，γ2=1×10-6，γ3=0.01，J0的初始值設(shè)為2.02×10-3A·s2/rad，B0的初始值設(shè)為3.36×10-4A·s/rad.
實(shí)驗(yàn)中分別對(duì)火炮模塊藥輸送伺服系統(tǒng)的滿載、半載、空載3種狀態(tài)進(jìn)行了研究。圖4為不同負(fù)載下的控制輸入電流u，從空載(見(jiàn)圖4(a))、半載(見(jiàn)圖4(b))和滿載(見(jiàn)圖4(c))曲線可以看出：隨著負(fù)載的加大，啟動(dòng)電流隨之增加，伴隨著跟蹤誤差的減小，控制電流逐漸趨于穩(wěn)定，不同負(fù)載電流變化規(guī)律基本一致；整個(gè)過(guò)程中由于反饋信號(hào)導(dǎo)致測(cè)量噪聲無(wú)法消除，使得過(guò)程中控制輸入存在一定程度的波動(dòng)，但該抖振未對(duì)系統(tǒng)控制性能造成影響；系統(tǒng)最終由于非線性摩擦等因素，控制電流穩(wěn)定在一個(gè)值附近，進(jìn)入穩(wěn)定狀態(tài)。
圖4 系統(tǒng)控制輸入電流uFig.4 Control inputs of the system
圖5(a)、圖5(b)和圖5(c)為3種狀態(tài)下的角位置跟蹤誤差e情況，反映了預(yù)設(shè)角度值和實(shí)際電機(jī)轉(zhuǎn)子運(yùn)動(dòng)角位置的差值變化狀況。在最初的自適應(yīng)學(xué)習(xí)階段，誤差存在一個(gè)小高峰，但持續(xù)時(shí)間短，系統(tǒng)很快收斂到一個(gè)小的誤差范圍內(nèi)，整個(gè)過(guò)程較為平穩(wěn)，抖振較小，即使在空載、半載和滿載參數(shù)范圍變化的情況下，控制精度依然能夠滿足系統(tǒng)的功能性能要求，能夠抵抗參數(shù)非線性變化和擾動(dòng)帶來(lái)的影響。3種負(fù)載下的最大動(dòng)態(tài)跟蹤誤差分別為0.41 rad、0.95 rad、1.23 rad，穩(wěn)定誤差均在0.1 rad以內(nèi)，控制精度遠(yuǎn)高于要求精度。
圖5 系統(tǒng)角位置跟蹤誤差eFig.5 Angular position tracking errors of the system
圖6 J0的估計(jì)值Fig.6 Estimated values of J0
圖6～圖10為不同狀態(tài)下自適應(yīng)參數(shù)的變化范圍，從圖中可以看到，在不同負(fù)載下，參數(shù)變化曲線是不同的，曲線最終都是收斂的。其中圖8～圖10為采取模糊算法獲得的模糊自適應(yīng)參數(shù)，由曲線可知，引入模糊算法獲得了趨近速度參數(shù)的動(dòng)態(tài)值，彌補(bǔ)了固定趨近參數(shù)值對(duì)系統(tǒng)魯棒性能的影響，使系統(tǒng)獲得了良好的性能和穩(wěn)定性。
圖7 B0的估計(jì)值Fig.7 Estimated values of B0
圖8 α1的估計(jì)值Fig.8 Estimated values of α1
圖9 α2的估計(jì)值Fig.9 Estimated values of α2
圖10 α3的估計(jì)值Fig.10 Estimated values of α3
4 結(jié)論
本文根據(jù)火炮模塊藥伺服系統(tǒng)結(jié)構(gòu)、運(yùn)動(dòng)特點(diǎn)和該類對(duì)象的控制現(xiàn)狀，提出了采用自適應(yīng)模糊算法以及新型飽和函數(shù)相結(jié)合的控制策略，分析了該策略解決負(fù)載變化和抖振等對(duì)系統(tǒng)控制精度的影響，進(jìn)行了火炮模塊藥輸送伺服系統(tǒng)精確定位控制實(shí)驗(yàn)，得到以下結(jié)論：
1) 控制策略對(duì)系統(tǒng)不同負(fù)載、參數(shù)變化是不敏感的，各種負(fù)載下均具有良好的位置跟蹤精度，能夠很好地跟蹤給定的運(yùn)動(dòng)軌跡。
2) 系統(tǒng)動(dòng)態(tài)誤差和穩(wěn)定誤差均收斂在較小的范圍，滿足性能指標(biāo)，為后續(xù)的模塊藥輸送傳遞提供了保障。
3) 從實(shí)驗(yàn)結(jié)果可以看出，測(cè)量噪聲的存在對(duì)被控對(duì)象運(yùn)動(dòng)造成一定程度的抖振。因此，通過(guò)分析處理測(cè)量噪聲來(lái)降低抖振值得繼續(xù)深入研究。
References)
[1] 王昭磊, 王青, 冉茂鵬, 等. 基于自適應(yīng)模糊滑模的復(fù)合控制導(dǎo)彈制導(dǎo)控制一體化反演設(shè)計(jì)[J]. 兵工學(xué)報(bào), 2015, 36(1):78-86.
WANG Zhao-lei, WANG Qing, RAN Mao-peng, et al. Integrated guidance and control backstepping design of blended control missile based on adaptive fuzzy sliding mode control[J]. Acta Armamentarii, 2015, 36(1):78-86. (in Chinese)
[2] Shahnazi R, Shanechi H, Pariz N. Position control of induction and DC servomotors: a novel adaptive fuzzy PI sliding mode control[J]. IEEE Transactions on Energy Conversion, 2008, 23(1):138-147.
[3] 侯潤(rùn)民, 劉榮忠, 高強(qiáng), 等. 一種自適應(yīng)模糊小波神經(jīng)網(wǎng)絡(luò)及其在交流伺服控制中的應(yīng)用[J]. 兵工學(xué)報(bào), 2015, 36(5):781-788.
HOU Run-min, LIU Rong-zhong, GAO Qiang, et al. Application of adaptive fuzzy wavelet neural network in AC servo control system[J]. Acta Armamentarii, 2015, 36(5):781-788. (in Chinese)
[4] 李坤全, 文睿. 焊接機(jī)器人焊縫模糊PID跟蹤控制[J]. 控制工程, 2017, 24(2):351-354.
LI Kun-quan, WEN Rui. Fuzzy PID tracking control for welding robots [J]. Control Engineering of China, 2017, 24(2):351-354. (in Chinese)
[5] Hung J Y, Gao W, Hung J C. Variable structure control: a survey[J]. IEEE Transactions on Industrial Electronics, 1993, 40(1):2-22.
[6] 鮑雪, 王大志, 胡明. 基于自適應(yīng)模糊的旋轉(zhuǎn)彈反演滑?？刂坡稍O(shè)計(jì)[J]. 儀器儀表學(xué)報(bào), 2016, 37(6):1333-1339.
BAO Xue, WANG Da-zhi, HU Ming. Backstepping sliding mode control design for spinning ammunition based on adaptive fuzzy method[J]. Chinese Journal of Scientific Instrument, 2016, 37(6):1333-1339. (in Chinese)
[7] 陳辰, 馬廣富, 孫延超, 等. 基于擾動(dòng)觀測(cè)器的高速聲速飛行器遞階滑模控制[J]. 兵工學(xué)報(bào), 2016, 37(5):840-850.
CHEN Chen, MA Guang-fu, SUN Yan-chao, et al. Recursive sliding mode control for hypersonic vehicle based on nonlinear disturbance observer[J]. Acta Armamentarii, 2016, 37(5):840-850. (in Chinese)
[8] Saghafinia A, Ping H W, Uddin M N, et al. Adaptive fuzzy sliding-mode control into chattering-free IM drive[J]. IEEE Transactions on Industry Applications, 2015, 51(1):692-701.
[9] 李良, 李峰, 馮永保, 等. 基于自適應(yīng)模糊滑模的大型液壓起豎系統(tǒng)控制策略研究[J]. 兵工學(xué)報(bào), 2016, 37(1):71-76.
LI Liang, LI Feng, FENG Yong-bao, et al. Research on control strategy of large hydraulic erecting system based on adaptive fuzzy sliding mode[J]. Acta Armamentarii, 2016, 37(1):71-76. (in Chinese)
[10] Wang F, Liu Z, Lai G Y. Fuzzy adaptive control of nonlinear uncertain plants with unknown dead zone output[J]. Fuzzy Sets and Systems, 2014, 263:27-48.
[11] Long L J, Zhao J. Adaptive fuzzy tracking control of switched uncertain nonlinear systems with unstable subsystems[J]. Fuzzy Sets and Systems, 2015, 273:49-67.
[12] Ho H F, Wong Y K, Rad A B. Adaptive fuzzy sliding mode control with chattering elimination for nonlinear SISO systems[J]. Simulation Modelling Practiceand Theory, 2009, 17(7):1199-1210.
[13] Wu T S, Karkoub M, Chen H S, et al.Robust tracking observer-based adaptive fuzzy control design for uncertain nonlinear MIMO systems with time delayed states[J]. Information Sciences, 2015, 290:86-105.
[14] Ullah N, Wang S P, Khattak M I, et al. Fractional order adaptive fuzzy sliding mode controller for a position servo system subjected to aerodynamic loading and nonlinearities[J]. Aerospace Science & Technology, 2015, 43:381-387.
[15] Wai R J, Lin C M, Hsu C F. Adaptive fuzzy sliding-mode control for electrical servo drive[J]. Fuzzy Sets and Systems, 2004, 143(2):295-310.
[16] 郭亞軍, 馬大為, 王曉峰, 等. 交流伺服系統(tǒng)自適應(yīng)反演滑?？刂破髟O(shè)計(jì)[J]. 北京理工大學(xué)學(xué)報(bào), 2010, 30(1):99-102.
GUO Ya-jun, MA Da-wei, WANG Xiao-feng, et al. Design of adaptive backstepping sliding mode controller in alternating current servo system[J]. Transactions of Beijing Institute of Technology, 2010, 30(1):99-102. (in Chinese)
[17] 姚來(lái)鵬, 侯保林. 隨機(jī)振動(dòng)機(jī)械臂的自適應(yīng)魯棒滑?？刂芠J]. 中國(guó)機(jī)械工程, 2016, 27(5):694-697.
YAO Lai-peng, HOU Bao-lin. Adaptive sliding mode control of robotic manipulators with external uncertain stochastic vibration[J]. China Mechanical Engineering, 2016, 27(5):694-697. (in Chinese)
[18] 陳明俊, 李長(zhǎng)紅, 楊燕. 武器伺服系統(tǒng)工程實(shí)踐[M]. 北京：國(guó)防工業(yè)出版社, 2013：193-220..
CHEN Ming-jun, LI Chang-hong, YANG Yan. Weapon servo system engineering practice[M]. Beijing: National Defense Industry Press, 2013:193-220. (in Chinese)
AdaptiveFuzzySlidingModeControlfortheArtilleryModularChargeTransportServoSystem
YUE Cai-cheng1, QIAN Lin-fang1, KONG Jian-shou2, LI Ying3
(1.School of Mechanical Engineering, Nanjing University of Science and Technology, Nanjing 210094, Jiangsu, China;2.School of Automation, Nanjing University of Science and Technology, Nanjing 210094, Jiangsu, China;3.Northwest Institute of Mechanical Engineering, Xianyang 712000, Shaanxi, China)
An adaptive fuzzy sliding mode controller (AFSMC) with an integral sliding mode function is proposed for the control of the artillery modular charge transport servo system which has time-varying parameters and chattering problem. The time-varying system parameters are estimated by using adaptive method. The influence of model uncertainty on the control system is reduced. Then, the traditional switching function is replaced by an improved saturation function. This ensures that the process of switching is more continuous and smooth. The coefficient of switching is tuned online by the fuzzy adaptive scheme. In this way, the robustness of system is enhanced, and the chattering of system is restrained. Experimental results show the system has a good position tracking performance under empty-load, half-load and full-load, which can meet the performance index. The proposed AFSMC scheme can overcome the influence of variable loads on the control precision of the system.
ordnance science and technology; artillery modular charge transport servo system; chattering; adaptive fuzzy sliding mode controll; position tracking
2017-03-20
國(guó)家自然科學(xué)基金項(xiàng)目(11472137)
岳才成(1990—)， 男， 博士研究生。 E-mail: yuecaicheng226@126.com
錢林方(1961—)， 男， 教授， 博士生導(dǎo)師。 E-mail: lfqian@vip.163.com
TJ303+.3； TP273+.4
A
1000-1093(2017)10-1891-08
10.3969/j.issn.1000-1093.2017.10.003
猜你喜歡
微特電機(jī)(2020年11期)2020-12-30 19:42:32
小哥白尼(軍事科學(xué))(2020年2期)2020-06-16 03:11:04
測(cè)控技術(shù)(2018年12期)2018-11-25 09:37:44
電子制作(2018年17期)2018-09-28 01:57:00
通信電源技術(shù)(2018年3期)2018-06-26 06:33:36
工業(yè)設(shè)計(jì)(2016年6期)2016-04-17 06:42:53
北京航空航天大學(xué)學(xué)報(bào)(2016年4期)2016-02-27 06:32:11
彈箭與制導(dǎo)學(xué)報(bào)(2015年1期)2015-03-11 15:32:18
小哥白尼·趣味科學(xué)畫報(bào)(2006年8期)2006-03-18 07:41:12
