張敏駿,吉曉冬,李旭,瞿圓媛,吳淼

(1.清華大學(xué)機械工程系,100084,北京;2.中國礦業(yè)大學(xué)(北京)機電與信息工程學(xué)院,100083,北京;3.天地科技股份有限公司,100013,北京;4.煤炭科學(xué)研究總院儲裝技術(shù)研究分院,100013,北京)

隨著煤礦生產(chǎn)效率的不斷提高[1-3],對掘進機的智能化需求也與日俱增。掘進機機身姿態(tài)的精準控制是實現(xiàn)智能掘進的重要環(huán)節(jié)[4]。當前掘進機的機身姿態(tài)主要通過手動進行調(diào)整,極大影響其精度與可靠性。首先手動調(diào)整機身姿態(tài)無法保證巷道的截割成型質(zhì)量,進而可能導(dǎo)致巷道掘進偏離設(shè)計軌跡,降低煤礦開采產(chǎn)量,同時誘發(fā)更多安全隱患。此外,綜掘巷道內(nèi)的巷道傾斜、底板松軟及粉塵等復(fù)雜工況也對掘進機機身姿態(tài)的精準控制造成了極大困擾[5-6]。

上述復(fù)雜工況嚴重影響了掘進機機身姿態(tài)控制系統(tǒng)的動態(tài)性能,同時伴隨系統(tǒng)自身非線性的影響,給掘進機機身姿態(tài)精準控制帶來極大困難。針對上述問題,文獻[7-8]采用模糊PID控制實現(xiàn)了掘進機機身俯仰角的智能控制;文獻[9]基于液壓軟件仿真分析了掘進機俯仰角PID控制方法,上述研究中因被控模型與實際模型存在較大差別,因此很難實現(xiàn)高精度的姿態(tài)控制。在其他類似領(lǐng)域,為解決復(fù)雜工況下的液壓缸控制問題,文獻[10]對微位移液壓系統(tǒng)進行了建模與模型辨識,通過PD控制實現(xiàn)了高精度的位移控制;文獻[11]基于II型模糊控制實現(xiàn)了液壓挖掘機工作裝置位姿的高精度控制;文獻[12]基于神經(jīng)網(wǎng)絡(luò)進行了盾構(gòu)機液壓推進系統(tǒng)模型辨識,為其精確控制提供了模型基礎(chǔ);文獻[13]針對不同地質(zhì)模型進行了以液壓缸調(diào)控為基礎(chǔ)的掘進位姿控制模型建模。上述研究為復(fù)雜工況下的液壓缸位移精準控制提供了研究基礎(chǔ),但上述研究中的被控對象的實際結(jié)構(gòu)與掘進機存在一定差別。

本文首先分析了掘進機機身姿態(tài)角與巷道截割斷面之間的關(guān)系,結(jié)合掘進機機身姿態(tài)控制系統(tǒng)理論模型及系統(tǒng)延時確定姿態(tài)傳遞函數(shù)的基本框架;通過粒子群優(yōu)化算法實現(xiàn)掘進機姿態(tài)控制系統(tǒng)在復(fù)雜工況下的模型辨識并得到準確的控制模型,通過仿真對該方法進行合理性驗證;基于該模型,提出了基于模糊神經(jīng)網(wǎng)絡(luò)的姿態(tài)控制算法,為驗證控制算法的有效性,設(shè)計了掘進機姿態(tài)控制試驗系統(tǒng),并進行了基于實測數(shù)據(jù)的辨識試驗,對本文所提出的姿態(tài)控制算法的有效性與優(yōu)越性進行了驗證,結(jié)果表明,本文辨識方法與控制算法在煤礦實際生產(chǎn)中具有有效性和可實現(xiàn)性,可對其他煤礦井下設(shè)備的姿態(tài)控制提供理論支撐與技術(shù)借鑒。

1 掘進機姿態(tài)角與截割斷面分析

1.1 掘進機機身姿態(tài)角與截割斷面關(guān)系

掘進機機身姿態(tài)角如圖1所示,機身俯仰角β為掘進機機身軸向水平面與巷道底面的夾角,翻滾角γ為掘進機機身側(cè)向水平面與巷道中線垂線在巷道后視截面上投影之間的夾角[14],掘進機機身姿態(tài)角通過機身傾角傳感器進行測量,傳感器通過激光全站儀對機身傾角傳感器進行標定。

已知掘進機在行駛至目標位置后準備截割前通過前鏟板與后支撐對機身姿態(tài)進行調(diào)整,調(diào)整至在巷道斷面進行截割時可通過截割機構(gòu)的補償?shù)姆秶鷥?nèi),進而通過截割機構(gòu)進行掘進機機身姿態(tài)的調(diào)整與補償,圖2為機身出現(xiàn)俯角、仰角與翻滾角時的巷道預(yù)截割斷面與標準斷面形狀。

(a)機身存在俯角誤差

設(shè)xβ、yβ與zβ分別為存在俯仰角誤差時的巷道斷面軌跡點坐標,其截割斷面軌跡方程為

(1)

式中:βc為掘進機截割臂俯仰角;αc為掘進機截割臂水平轉(zhuǎn)角;r為截割臂長度;e為掘進機截割臂下端點距回轉(zhuǎn)中心距離。

同理,xγ、yγ與zγ分別為存在翻滾角誤差時的巷道斷面軌跡點坐標,機身存在翻滾角時的巷道斷面軌跡方程如下

(2)

由此可得截割臂在截割過程中可補償?shù)臋C身姿態(tài)角如下

(3)

式中:r為截割臂長度;βc,min為截割臂相對機身的俯仰角的最小值;D為巷道斷面寬度;H為巷道高度;H0為水平狀態(tài)截割臂距離履帶重心的垂直距離。

(a)俯仰角調(diào)整量

基于上述模型可得不同機身尺寸的掘進機在截割不同尺寸巷道時的機身姿態(tài)角最大補償范圍如圖3所示,不同尺寸的掘進機截割機構(gòu)的俯仰角調(diào)整量為8.4°～15.3°;翻滾角調(diào)整量為4.6°～5.9°。若機身姿態(tài)角偏差大于此范圍時需要通過掘進機支撐機構(gòu)進行機身姿態(tài)的調(diào)整。

(b)翻滾調(diào)整量 圖3 不同寬度掘進機的截割機構(gòu)在不同巷道的姿態(tài)角補償量Fig.3 The posture angle compensation of different tunneling machine in different roadway

1.2 掘進機姿態(tài)角調(diào)整系統(tǒng)建模

當掘進機機身姿態(tài)誤差超過截割臂的補償范圍,則必須通過支撐液壓缸運動實現(xiàn)姿態(tài)角的調(diào)整,分別以掘進機前端其姿態(tài)調(diào)整時的運動學(xué)模型分析如圖4所示。

(a)姿態(tài)角調(diào)整時前鏟板運動學(xué)模型

圖4a以掘進機鏟板回轉(zhuǎn)中心為坐標點建立坐標系YOZ,I為前鏟板頂點,其坐標為(rI,θI);A為前鏟板與姿態(tài)調(diào)整油缸鉸接點;d為A點到O點的長度;油缸伸縮使掘進機前鏟板轉(zhuǎn)動,其轉(zhuǎn)角為φI?？傻们扮P板頂點的運動學(xué)方程如下

(4)

式中:c為OZ軸上兩個鉸接點之間的距離;rI為O至鏟板頂端的距離;θI0為鏟板頂點運動過程中其坐標的變化量。

同理,如圖4b所示,以后支撐回轉(zhuǎn)中心做原點建立坐標系ZOY。L為后支撐頂點,其坐標為(rL,θL);M為姿態(tài)調(diào)整油缸后端鉸接點;N為后支撐與姿態(tài)調(diào)整油缸鉸接點;e為N點到O點的距離;f為M點到O點的距離;油缸伸縮使得后支撐發(fā)生轉(zhuǎn)動,其轉(zhuǎn)角為φL;rL為O至后支撐頂端的距離;θL0為后支撐頂點運動過程中其坐標的變化量。由此可得后支撐頂點的運動學(xué)方程如下

(5)

由式(4)與(5)可得掘進機俯仰角與翻滾角的解算方程[15]如下

(6)

式中:rL1與rL2分別為后支撐左右兩側(cè)油缸運動后的接地點至頂點的距離;θL1與θL2為左右兩側(cè)后支撐的頂點坐標;D為掘進機前后支撐點之間的距離;k為機身俯仰角計算因數(shù),計算方程如下

(7)

式中:k1、k2與k3分別為前鏟板獨立調(diào)整姿態(tài)、后支撐獨立調(diào)整與前后復(fù)合調(diào)整的3種工況下的姿態(tài)角計算因數(shù)[16];zp、yp、zQ與yQ分別為鏟板與后支撐獨立調(diào)整姿態(tài)時掘進機機身履帶接地點的位置坐標。

無論掘進機在何種支撐狀態(tài)下進行機身姿態(tài)調(diào)整,其實質(zhì)均為各支撐機構(gòu)所對應(yīng)的液壓缸的位移控制,掘進機姿態(tài)液壓系統(tǒng)如圖5所示。

圖5 掘進機姿態(tài)液壓系統(tǒng)Fig.5 The hydraulic system of the TBM

基于液壓系統(tǒng)的數(shù)學(xué)建模方法與掘進機姿態(tài)液壓系統(tǒng)基本原理可得該被控對象為三階非線性系統(tǒng)[5],由于進行了一定程度上的模型簡化,且系統(tǒng)存在延時,因此需要通過一定的辨識方法對被控模型進行精確辨識。

2 粒子群優(yōu)化系統(tǒng)辨識算法

2.1 粒子群優(yōu)化算法原理

粒子群算法多用于求解多參數(shù)非線性系統(tǒng)的全局優(yōu)化問題[17]。設(shè)一個D維空間中存在n個粒子,粒子在種群中的位置向量為Xi,速度向量為Vi,將Xi代入目標函數(shù)即可算出每個粒子位置所對應(yīng)的適應(yīng)度值,為避免其個體極值Pi與種群極值Pg在每次迭代中陷入局部最優(yōu),加入一個局部自適應(yīng)變異算子進行調(diào)整,如下所示

(8)

式中:w(t)為慣性權(quán)重;n為進化代數(shù);i為粒子種群規(guī)模;r為0到1的隨機數(shù);c1、c2為局部與全局學(xué)習(xí)因子;SB為種群的最優(yōu)解。

2.2 基于粒子群優(yōu)化的姿態(tài)控制系統(tǒng)辨識

粒子群優(yōu)化算法的系統(tǒng)辨識是基于粒子群算法的尋優(yōu)特性,通過輸入與輸出的信號響應(yīng)對傳遞函數(shù)參數(shù)進行擬合的過程,基于理論模型與實際系統(tǒng)中的延時,其傳遞模型可簡化為

(9)

式中:G(s)為被控對象傳遞函數(shù);X=[α,β,K,T]為需要辨識的參數(shù)集,其中α為二階項,β為一階項,K為增益系數(shù),T為延時系數(shù)。由于實際系統(tǒng)中,往往存在測量與執(zhí)行誤差及外界干擾等,預(yù)測模型不可能完全替代真實模型,因此需要在估計模型中加入殘差e=di-fi,其中di為第i個測試樣本的輸出,fi為群體中各個粒子的初始適應(yīng)值。為確保辨識模型盡可能的接近實際模型,以辨識誤差指標函數(shù)作為粒子群算法的目標函數(shù),選擇合適的誤差指標函數(shù)更新粒子位置與速度,進而求取殘差絕對值最小時的預(yù)測模型參數(shù)。辨識誤差指標函數(shù)的計算式如下

(10)

設(shè)待辨識參數(shù)位置向量為Xi,速度向量為Vi,各個粒子初始位置為個體極值?；谏鲜鰠?shù)可計算出群體中各粒子的初始適應(yīng)值f(Xi),同時更新粒子速度與位置并對粒子的速度與位置進行越界檢查,則模型的預(yù)測輸出為

(11)

式中,Q為仿真計算步長。通過式(11)中求得的fi與di即可由式(10)計算得到辨識誤差,該辨識誤差的絕對值越小,則預(yù)測模型越逼近真實模型,當辨識誤差指標函數(shù)J逐漸接近0時,則完成系統(tǒng)辨識,此時模型最接近實際模型。

2.3 系統(tǒng)辨識仿真

為驗證該辨識方法的可行性,將EBZ-55型掘進機系統(tǒng)參數(shù)理論模型[5]作為辨識對象,進行仿真驗證。針對傳統(tǒng)帶延時環(huán)節(jié)的三階系統(tǒng)辨識的計算難度,取粒子群個數(shù)為80,最大迭代次數(shù)200次,為保證粒子種群的局部搜索能力全局搜索能力的平衡,粒子最大運動速度Vmax為1.0 m/s,Xi中4個參數(shù)的搜索范圍為[0,1]、[0,1]、[0,10]與[0,1][6],學(xué)習(xí)因子取c1=1.1、c2=1.3,采用線性遞減的慣性權(quán)重,慣性權(quán)重采用從0.9線性遞減至0.1的策略,目標函數(shù)的倒數(shù)作為粒子群的適應(yīng)度函數(shù),將辨識誤差作為的目標函數(shù)。系統(tǒng)通過偽隨機二進制序列信號激勵下生成辨識所用的歷史數(shù)據(jù),并加入測量時的隨機擾動,同時與其他幾種智能辨識方法進行比較,驗證本文辨識方法的優(yōu)越性,仿真結(jié)果如表1所示。

表1 不同辨識方法的辨識誤差Table 1 The identification error of different methods

由表1可得,被測傳遞函數(shù)的4組辨識參數(shù)經(jīng)過粒子群辨識算法平均辨識誤差相較于最小二乘法與遺傳算法分別降低了96.75%與95.15%,同時對系統(tǒng)延時的辨識誤差接近于0,由此可得其辨識精度相較于其他兩種方法有明顯的提高,因此采用粒子群算法的可對掘進機姿態(tài)控制系統(tǒng)此類非線性動態(tài)模型實現(xiàn)高精度辨識。

3 掘進機姿態(tài)角神經(jīng)網(wǎng)絡(luò)控制

由于掘進機機身姿態(tài)調(diào)整系統(tǒng)的非線性較強,而傳統(tǒng)PID控制難以實現(xiàn)高精度控制,因此提出通過的模糊控制與神經(jīng)網(wǎng)絡(luò)結(jié)合形成的模糊神經(jīng)網(wǎng)絡(luò)PID控制算法在復(fù)雜工況下實現(xiàn)掘進機機身姿態(tài)高精度控制[18],其控制結(jié)構(gòu)如圖6所示,其中r(k)為系統(tǒng)輸入,y(k)為系統(tǒng)輸出,kp、ki與kd分別為PID控制的比例、積分與微分控制參數(shù)。

圖6 掘進機姿態(tài)角控制系統(tǒng)結(jié)構(gòu)Fig.6 The control system structure of TBM

圖7為模糊神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)圖,輸入?yún)?shù)為姿態(tài)偏差e及偏差變化率ec,輸出為PID控制參數(shù)kp、ki與kd,輸入與輸出的模糊子集為{A,B,C,D,E,F,G}={負大,負中,負小,零,正小,正中,正大}。模糊集合論域為{-3,-2,-1,0,1,2,3},輸出集合為{-1.5,-1,-0.5,0,0.5,1,1.5}與{-0.3,-0.2,-0.1,0,0.1,0.2,0.3}。

圖7 模糊神經(jīng)網(wǎng)絡(luò)結(jié)構(gòu)圖Fig.7 The structure of the fuzzy neural network

輸入層中的e(k)與ec(k)對應(yīng)的輸出為:O1(1,j)或O1(2,j);模糊化層的輸入與輸出如下

(12)

式中:bij為模糊隸屬度函數(shù)的中心值;cij為模糊隸屬度函數(shù)的寬度;ωmn為權(quán)值系數(shù)。此時模糊規(guī)則計算層、模糊推理層及輸出層的輸入與輸出分別為

(13)

此時PID控制參數(shù)變化如下

(14)

式中:kx為PID控制參數(shù);kx0分別為PID控制參數(shù)的初始值。設(shè)系統(tǒng)誤差反饋過程中的性能指標函數(shù)為E(k)=0.5[r(k)-y(k)]2,當r(k)與r(k)接近時,E(k)趨近于最小值,而高斯隸屬函數(shù)的中心bij、寬度cij以及其對應(yīng)的權(quán)值ωmn可以通過神經(jīng)網(wǎng)絡(luò)實現(xiàn)在線糾正,其調(diào)整規(guī)律分別為

(15)

δ(k)=

(16)

4 試驗驗證

為驗證粒子群優(yōu)化辨識算法與模糊神經(jīng)網(wǎng)絡(luò)PID的控制效果,搭建了基于EBZ-55掘進機機身姿態(tài)角控制試驗系統(tǒng):掘進機結(jié)構(gòu)尺寸為78 400 mm×1 500 mm×1 315 mm;控制系統(tǒng)與采集系統(tǒng)采用B&R9005系統(tǒng),鏟板與支撐的油缸行程為106 mm;采用SME-90傾角傳感器測量機身姿態(tài)角,測量分辨率為0.1°;采用GUC1000油缸位移傳感器測量油缸行程,測量分辨率為0.01 mm[19]。首先通過Leica全自動激光全站儀對機載姿態(tài)測量傳感器在同一坐標系下進行標定與校準,試驗現(xiàn)場如圖8所示。

(a)掘進機機身傾角傳感器

基于粒子群辨識方法對模擬巷道中的掘進機俯仰角姿態(tài)控制系統(tǒng)進行辨識,經(jīng)過100次迭代后其最終目標函數(shù)的平均誤差為5.264×10-6,其優(yōu)化與收斂過程如圖9所示。經(jīng)過上述模型辨識方法得到實際工況下的掘進機俯仰角姿態(tài)控制傳遞函數(shù)如下

圖9 粒子群辨識算法辨識誤差函數(shù)優(yōu)化過程Fig.9 The optimization procedure of the PSO identification

(17)

表示本文模型在開環(huán)狀態(tài)下的增益大小與相位隨頻率變化的伯德圖如圖10所示。為驗證辨識模型的準確性,在AMESim中建立相同液壓模型,其階躍響應(yīng)仿真如圖11所示,其中辨識結(jié)果的超調(diào)與響應(yīng)時間與半實體模型及真實模型基本一致,辨識結(jié)果的階躍響應(yīng)超調(diào)量約超過理論模型與仿真模型20%,其響應(yīng)時間的理論模型與仿真模型相差0.1 s,因為實際模型的隨機擾動與非線性更強,超調(diào)量與響應(yīng)時間存在一定差別為正常現(xiàn)象。

圖10 粒子群辨識算法辨識模型傳遞函數(shù)伯德圖Fig.10 The bode diagram of the PSO identification model

圖11 模型辨識結(jié)果與半實體模型階躍響應(yīng)輸出Fig.11 The step response of the identification model and AMESim model

掘進機姿態(tài)控制試驗中,因試驗機型EBZ-55掘進機的單后支撐無法調(diào)節(jié)翻滾角,故只進行了俯仰角控制試驗。為驗證控制系統(tǒng)對不同輸入信號的響應(yīng),分別將正弦、方波與三角波信號作為輸入信號進行俯仰角控制跟蹤[20],與模糊PID控制作為對比的試驗結(jié)果如圖12所示,具體的實驗數(shù)據(jù)對比如表2所示。

(a)正弦輸入信號

表2 不同控制算法掘進機俯仰角控制誤差統(tǒng)計表Table 2 The TBM pitch angle control error of different control methods

試驗結(jié)果表明,與模糊PID相比,在3種不同的試驗工況下,模糊神經(jīng)網(wǎng)絡(luò)PID控制算法的超調(diào)誤差分別降低了57.1%、12.3%和44.6%,其響應(yīng)時間分別降低了37.6%、53.4和37.1%,因此基于此模型與控制算法的實現(xiàn)的姿態(tài)控制,在保證快速響應(yīng)的基礎(chǔ)上可實現(xiàn)穩(wěn)定的1°以內(nèi)的姿態(tài)角精度控制。

5 結(jié) 論

為解決由于掘進機機身姿態(tài)自動控制精度低的問題并避免機身偏斜導(dǎo)致的巷道成形質(zhì)量差及相關(guān)安全問題,提出了一種基于粒子群算法的掘進機機身姿態(tài)控制模型辨識方法及模糊神經(jīng)網(wǎng)絡(luò)PID控制方法。首先分析了掘進機機身姿態(tài)角與巷道斷面輪廓的耦合關(guān)系,并建立掘進機機身姿態(tài)運動學(xué)模型。之后,基于粒子群算法提出了掘進機機身姿態(tài)控制模型的高精度辨識方法,通過仿真驗證其可行性,設(shè)計了基于模糊神經(jīng)網(wǎng)絡(luò)的PID控制算法。最后,為了驗證本文提出的辨識方法與控制算法,搭建了基于模擬巷道工況的掘進機俯仰角控制試驗平臺。試驗結(jié)果表明,粒子群辨識方法可在100次迭代實現(xiàn)5.26×10-6以內(nèi)的辨識精度,模糊神經(jīng)網(wǎng)絡(luò)控制可在不同工況下實現(xiàn)1°以內(nèi)的姿態(tài)角快速高精度控制,與其他方法相比,粒子群辨識算法能夠在較短的計算周期內(nèi)實現(xiàn)高精度模型辨識,同時模糊神經(jīng)網(wǎng)絡(luò)PID控制算法可在保證快速響應(yīng)的前提下實現(xiàn)更高精度的姿態(tài)角控制,從而實現(xiàn)掘進機姿態(tài)的高精度自動調(diào)整,進而保證高效率、高精度與安全的煤礦掘進與開采,并為掘進機及其他大型液壓設(shè)備的精準姿態(tài)控制提供技術(shù)支撐與參考。