基于線(xiàn)性自抗擾的消防水炮控制系統(tǒng)

胡海兵 崔世林 張波 張愛(ài)文

關(guān)鍵詞： 消防水炮; 線(xiàn)性自抗擾; 伺服控制; 直流電機(jī); 數(shù)學(xué)模型; PID控制

中圖分類(lèi)號(hào)： TN876?34; TP29 ? ? ? ? ? ? ? ? ? ? ?文獻(xiàn)標(biāo)識(shí)碼： A ? ? ? ? ? ? ? ? ? ?文章編號(hào)： 1004?373X（2019）05?0183?04

Fire water monitor control system based on LADRC

HU Haibing1， CUI Shilin1， ZHANG Bo1， ZHANG Aiwen2

（1. Academy of Photoelectric Technology， Hefei University of Technology， Hefei 230009， China;

2. Gaoyou Shengxin Fire Technology Company Limited， Gaoyou 225600， China）

Abstract： Since the fire water monitor control system in fire?fighting robot has the nonlinear， time?varying and strong?coupling characteristics， a control strategy based on linear active disturbance rejection controller （LADRC） is proposed to improve the control accuracy. The structure and mathematical model of the fire water monitor servo control system are given. The LADRC is designed. The parameter selection method of linear active disturbance rejection control is given according to modern control theory. The comparative experiment of the LADRC and traditional PD controller is conducted on the fire water monitor control platform. The experimental result shows that， in comparison with the traditional PD controller， the proposed controller has the advantages of high control precision and low overshoot， and can improve the control performance of the system.

Keywords： fire water monitor; linear active disturbance rejection; servo control; DC motor; mathematical model; PID control

0 ?引 ?言

消防水炮是消防機(jī)器人滅火裝置的執(zhí)行機(jī)構(gòu)，其任務(wù)是根據(jù)消防機(jī)器人探測(cè)到的火源點(diǎn)信息給出相應(yīng)的位置控制指令控制炮頭偏轉(zhuǎn)，使水炮噴出的水流達(dá)到預(yù)期的狀態(tài)和位置。消防水炮伺服控制系統(tǒng)存在非線(xiàn)性、轉(zhuǎn)動(dòng)慣量變化大、強(qiáng)耦合等特點(diǎn)，經(jīng)常出現(xiàn)控制偏差，影響消防水炮的控制精度，不僅會(huì)造成水資源的浪費(fèi)，而且可能導(dǎo)致火焰的蔓延。故提高消防水炮的控制精度非常重要。

對(duì)于伺服系統(tǒng)控制有多種常用的控制策略，如PID控制、模糊PID控制、滑模變結(jié)構(gòu)控制、神經(jīng)網(wǎng)絡(luò)控制、自抗擾控制（ADRC）等[1]。其中，文獻(xiàn)[2]提出的自抗擾控制方法不依賴(lài)于被控對(duì)象的精確參數(shù)模型，在原有PID控制的基礎(chǔ)上運(yùn)用現(xiàn)代控制理論加入狀態(tài)觀測(cè)器，對(duì)被控對(duì)象的外部擾動(dòng)和不確定性擾動(dòng)進(jìn)行估計(jì)并補(bǔ)償，具有較強(qiáng)的適應(yīng)性和魯棒性，在伺服控制領(lǐng)域中得到了廣泛應(yīng)用[3?4]。但自抗擾控制器需要調(diào)節(jié)的參數(shù)過(guò)多，不利于實(shí)際應(yīng)用問(wèn)題發(fā)展，因此文獻(xiàn)[5]提出線(xiàn)性自抗擾控制器，不但繼承了 ADRC的優(yōu)點(diǎn)，而且需要調(diào)節(jié)的參數(shù)大大減少。本文研究將利用線(xiàn)性自抗擾控制（LADRC）方法提高消防水炮的控制精度，并通過(guò)實(shí)驗(yàn)驗(yàn)證方案的有效性。

1 ?消防水炮控制系統(tǒng)構(gòu)成

消防水炮控制系統(tǒng)主要由微處理器、電源模塊、電機(jī)驅(qū)動(dòng)模塊、位置和速度采集模塊、控制器等組成。系統(tǒng)的結(jié)構(gòu)框圖如圖1所示。電機(jī)轉(zhuǎn)速信息通過(guò)編碼器獲取，經(jīng)eQEP模塊處理反饋給處理器，構(gòu)成速度閉環(huán)控制。消防水炮的旋轉(zhuǎn)角度由方位旋轉(zhuǎn)變壓器獲取信號(hào)，經(jīng)RDC轉(zhuǎn)換為角度的數(shù)字量反饋給處理器，構(gòu)成位置閉環(huán)控制。

2 ?消防水炮控制系統(tǒng)模型

消防水炮伺服控制系統(tǒng)采用直流無(wú)刷電機(jī)作為執(zhí)行機(jī)構(gòu)。直流無(wú)刷電機(jī)是一個(gè)非線(xiàn)性、強(qiáng)耦合的復(fù)雜系統(tǒng)，為了簡(jiǎn)化分析，假設(shè)直流無(wú)刷電機(jī)工作在理想狀態(tài)下，即電機(jī)的磁路不飽和，不計(jì)電機(jī)鐵耗及電樞反應(yīng)，忽略齒槽效應(yīng)。電機(jī)功率驅(qū)動(dòng)方式選擇兩兩導(dǎo)通方式，即任意時(shí)刻只有兩相電樞繞組導(dǎo)通，另一相為懸空。直流無(wú)刷電機(jī)的電壓方程、電磁轉(zhuǎn)矩方程、機(jī)械運(yùn)動(dòng)方程分別為：

[ud=idRaKs+LdidKsdt+KenKs] （1）

[Tem=Kmid] （2）

[Tem=Jdndt+Tmf+Tl] （3）

式中：[L]為電機(jī)電樞的電感;[Ra]為電機(jī)電樞的電阻;[id]為電機(jī)電樞的電流;[n]為電機(jī)機(jī)械角速度;[Ke]為反電勢(shì)系數(shù);[Ks]為PWM功率放大器放大系數(shù);[Km]為電機(jī)的力矩系數(shù);[J]為等效到電機(jī)輸入端的總轉(zhuǎn)動(dòng)慣量;[Tmf]為總摩擦力矩;[Tl]為折算到電機(jī)軸上的負(fù)載力矩。

考慮電機(jī)的電感非常小，當(dāng)忽略電機(jī)電樞電感時(shí)，取狀態(tài)變量[X=x1，x2T]，[x1]是系統(tǒng)的實(shí)際轉(zhuǎn)角，[x2]是系統(tǒng)的角速度，則消防水炮伺服系統(tǒng)的狀態(tài)空間方程如式（4）所示：

[x1=x2x2=-KmKeJRax2-TmfJ-TlJ+KsKmJRaudy=x1] （4）

由于系統(tǒng)轉(zhuǎn)動(dòng)慣量[J]、摩擦力矩[Tmf]和負(fù)載擾動(dòng)力矩[Tl]等均隨工作狀態(tài)的變化而變化，所以該系統(tǒng)是一個(gè)二階非線(xiàn)性系統(tǒng)。

3 ?消防水炮線(xiàn)性自抗擾控制器設(shè)計(jì)

自抗擾控制器是由中科院的韓京清于1998年提出的一種新型非線(xiàn)性控制器[2]。它是在原有PID控制的基礎(chǔ)上運(yùn)用現(xiàn)代控制理論的狀態(tài)觀測(cè)器。線(xiàn)性自抗擾控制（LADRC）是為解決自抗擾控制需要調(diào)節(jié)參數(shù)過(guò)多，不利于實(shí)際應(yīng)用問(wèn)題發(fā)展起來(lái)的，不但繼承了ADRC的優(yōu)點(diǎn)，而且需要調(diào)節(jié)的參數(shù)大大減少。所設(shè)計(jì)的消防水炮線(xiàn)性自抗擾控制器由跟蹤微分器（TD）、線(xiàn)性擴(kuò)張狀態(tài)觀測(cè)器（LESO）、線(xiàn)性誤差反饋控制律（LSEF）三部分組成，其結(jié)構(gòu)如圖2所示。

在LADRC中，跟蹤微分器安排消防水炮輸入信號(hào)的過(guò)渡過(guò)程并提取其微分信號(hào)，解決系統(tǒng)超調(diào)與快速性的矛盾。線(xiàn)性擴(kuò)張觀測(cè)器對(duì)消防水炮被控對(duì)象的狀態(tài)和對(duì)象模型中的內(nèi)擾和外擾進(jìn)行估計(jì)，補(bǔ)償系統(tǒng)未建模部分和其他因素導(dǎo)致的系統(tǒng)變化。線(xiàn)性PD控制器利用擴(kuò)張狀態(tài)觀測(cè)器和微分跟蹤器的輸出組合生成相應(yīng)的水炮控制信號(hào)。

3.1 ?跟蹤微分器

跟蹤微分器采用文獻(xiàn)[5]提出的新型離散形式實(shí)現(xiàn)安排過(guò)渡過(guò)程和提取消防水炮控制輸入位置信號(hào)[θ（t）]的微分，在TD的兩個(gè)輸出[θ1（t）]，[θ2（t）]中，[θ1（t）]跟蹤輸入信號(hào)[θ（t）]，[θ2（t）]跟蹤控制信號(hào)的微分，[δ]為速度因子，[h]為采樣步長(zhǎng)。

消防水炮控制系統(tǒng)跟蹤微分器設(shè)計(jì)如下：

[r1（k+1）=r1（k）+hr2（k）+0.5uh2r2（k+1）=r2（k）+huu=fc（r1（k）-v（k），r2（k），δ，h）] （5）

式中[fc（r1（k）-v（k），r2（k），δ，h）]的定義見(jiàn)文獻(xiàn)[5]。

3.2 ?線(xiàn)性擴(kuò)張狀態(tài)觀測(cè)器

消防水炮控制系統(tǒng)是二階非線(xiàn)性系統(tǒng)，對(duì)系統(tǒng)建立二階擴(kuò)張狀態(tài)觀測(cè)器，定義系統(tǒng)的總擾動(dòng)為[ω]，將系統(tǒng)內(nèi)部擾動(dòng)[ω0]及外部擾動(dòng)[ω1]作為總擾動(dòng)進(jìn)行估計(jì)，令[x1=y]，[x2=x1]，[x3=ω0+ω1=ω]，其狀態(tài)空間方程如下：

[x1=x2x2=x3+bux3=ωy=x1] （6）

根據(jù)消防水炮控制系統(tǒng)模型擴(kuò)張狀態(tài)設(shè)計(jì)狀態(tài)觀測(cè)器之后的系統(tǒng)狀態(tài)空間表達(dá)式為：

[z=Az+By=Cz] （7）

其中：[A=010001000];[B=0b0];[C=100Τ]。

設(shè)[L]為設(shè)計(jì)觀測(cè)器反饋矩陣，則二階擴(kuò)張狀態(tài)觀測(cè)器為：

[e=z1-x1z1=z2-L1（e）z2=z3-L2（e）+buz3=-L3ey=z1] （8）

通過(guò)極點(diǎn)配置方法，將消防水炮控制系統(tǒng)狀態(tài)觀測(cè)器配置在[-ω0]點(diǎn)，則狀態(tài)觀測(cè)器特征矩陣的所有特征值均為[ω0]，即[ω0]為狀態(tài)觀測(cè)器的帶寬[6]。式（8）的頻域表達(dá)式為：

[sI-（A-LC）=s3+L1s2+L2s+L3=（s+ω0）3] （9）

其中：

[L1=3ω0L2=3ω20L2=ω30] （10）

3.3 ?線(xiàn)性誤差反饋控制律

在線(xiàn)性誤差反饋控制律中，消防水炮控制系統(tǒng)當(dāng)前時(shí)刻的狀態(tài)誤差為[e1]和[e2]，根據(jù)這兩個(gè)狀態(tài)誤差實(shí)時(shí)更新控制輸入[u0]：

[e1=v1-z1e2=v2-z2] （11）

在本文設(shè)計(jì)的線(xiàn)性自抗擾控制器中，選取PD控制為控制器：

[u0=Kp（v0（t）-z1）-Kd（v2（t）-z2）] （12）

式中：[Kp]和[Kd]參數(shù)選擇方法為：[Kp=ω2c]，[Kd=2ωc]，[ωc]為期望閉環(huán)系統(tǒng)的帶寬。根據(jù)現(xiàn)代控制理論主導(dǎo)極點(diǎn)的概念和工程經(jīng)驗(yàn)，[ω0]和[ωc]二者應(yīng)滿(mǎn)足[ω0>5ωc]，即觀測(cè)器的希望極點(diǎn)與虛軸距離為系統(tǒng)希望的極點(diǎn)距虛軸距離的5倍以上，其物理意義為線(xiàn)性狀態(tài)觀測(cè)器的動(dòng)態(tài)過(guò)程可以在閉環(huán)系統(tǒng)上升時(shí)間之前結(jié)束[3]。

4 ?實(shí)驗(yàn)與分析

為了驗(yàn)證消防水炮線(xiàn)性自抗擾控制的實(shí)際應(yīng)用效果，在消防水炮實(shí)驗(yàn)平臺(tái)上進(jìn)行線(xiàn)性自抗擾控制實(shí)驗(yàn)和傳統(tǒng)PD控制實(shí)驗(yàn)。實(shí)驗(yàn)平臺(tái)裝置包括控制器和被控對(duì)象兩部分，控制器主要通過(guò)9英寸觸摸屏給出控制命令，控制界面如圖3所示。

消防水炮控制系統(tǒng)采用TMS320F28335作為主處理器，TMS320F28335產(chǎn)生PWM信號(hào)給無(wú)刷直流電機(jī)驅(qū)動(dòng)器控制電機(jī)運(yùn)動(dòng)。通過(guò)RDC轉(zhuǎn)換器得到消防水炮俯仰角位置信號(hào)。通過(guò)處理器對(duì)編碼器信號(hào)的處理獲取電機(jī)的角速度信號(hào)。實(shí)驗(yàn)裝置如圖4所示。

分別采用PD，LADRC控制方法進(jìn)行消防水炮控制實(shí)驗(yàn)。實(shí)驗(yàn)過(guò)程中，數(shù)據(jù)采樣周期為100 ms，消防水炮俯仰狀態(tài)初始位置為0°，設(shè)定消防水炮俯仰狀態(tài)跟蹤值[θ=45°]。PD控制器和線(xiàn)性自抗擾控制器的位置跟蹤響應(yīng)曲線(xiàn)如圖5所示。

通過(guò)比較線(xiàn)性自抗擾控制與PD控制的位置響應(yīng)曲線(xiàn)可以看出，與傳統(tǒng)PD控制器相比，線(xiàn)性自抗擾控制器超調(diào)量小，穩(wěn)態(tài)性能好，提高了消防水炮控制系統(tǒng)的控制精度。

5 ?結(jié) ?語(yǔ)

本文根據(jù)消防水炮的電機(jī)控制模型，對(duì)消防水炮控制系統(tǒng)采用線(xiàn)性自抗擾控制策略設(shè)計(jì)控制器，并根據(jù)設(shè)計(jì)的LADRC控制器與傳統(tǒng)PD控制器做了對(duì)比實(shí)驗(yàn)。實(shí)驗(yàn)結(jié)果表明，基于線(xiàn)性自抗擾控制器提高了消防水炮控制系統(tǒng)的控制精度，控制效果較PD控制有明顯改善。

參考文獻(xiàn)

[1] 黃京，童仲志，侯遠(yuǎn)龍，等.消防炮伺服系統(tǒng)控制策略[J].消防科學(xué)與技術(shù)，2017，36（6）：809?813.

HUANG J， TONG Z Z， HOU Y L， et al. Fire extinguishing cannon servo system control strategy [J]. Fire science and technology， 2017， 36（6）： 809?813.

[2] 韓京清.從PID技術(shù)到“自抗擾控制”技術(shù)[J].控制工程，2002，9（3）：13?18.

HAN J Q. From PID technique to active disturbances rejection control technique [J]. Control engineering， 2002， 9（3）： 13?18.

[3] 張明月，楊洪波，章家保，等.改進(jìn)自抗擾控制諧波式電動(dòng)舵機(jī)伺服系統(tǒng)[J].光學(xué)精密工程，2014，22（1）：99?108.

ZHANG M Y， YANG H B， ZHANG J B， et al. Servo system of harmonic drive electromechanical actuator using improved ADRC [J]. Optics & precision engineering， 2014， 22（1）： 99?108.

[4] 夏長(zhǎng)亮，李正軍，楊榮，等.基于自抗擾控制器的無(wú)刷直流電機(jī)控制系統(tǒng)[J].中國(guó)電機(jī)工程學(xué)報(bào)，2005，25（2）：82?86.

XIA C L， LI Z J， YANG R， et al. Control system of brushless DC motor based on active?disturbance rejection controller [J]. Proceedings of the CSEE， 2008， 25（2）： 82?86.

[5] GAO Z. Scaling and bandwidth?parameterization based controller tuning [C]// Proceedings of 2003 American Control Confe?rence. Denver： IEEE， 2003： 4989?4996.

[6] 張超，朱紀(jì)洪，高亞奎.自抗擾控制器的階次與參數(shù)的選取[J].控制理論與應(yīng)用，2014，31（11）：1480?1485.

ZHANG C， ZHU J H， GAO Y K. Order and parameter selections for active disturbance rejection controller [J]. Control theory & applications， 2014， 31（11）： 1480?1485.

[7] 任海鵬，劉丁，李琦.DSP在無(wú)刷直流電動(dòng)機(jī)伺服系統(tǒng)中的應(yīng)用[J].微電機(jī)，2000，33（2）：21?24.

REN H P， LIU D， LI Q. Application of TMS320F240 DSP in brushless DC motor servo system [J]. Micromotors， 2000， 33（2）： 21?24.

[8] 劉希，孫秀霞，郝震，等.最速跟蹤微分器的一種新型離散形式[J].信息與控制，2013，42（6）：729?734.

LIU X， SUN X X， HAO Z， et al. A new discrete?time form of optimal tracking differentiator [J]. Information & control， 2013， 42（6）： 729?734.

[9] 杜博超，韓守亮，張超，等.基于自抗擾控制器的內(nèi)置式永磁同步電機(jī)無(wú)位置傳感器控制[J].電工技術(shù)學(xué)報(bào)，2017，32（3）：105?112.

DU B C， HAN S L， ZHANG C， et al. Sensorless control of interior permanent magnet synchronous motor based on active disturbance rejection controller [J]. Transactions of China electrotechnical society， 2017， 32（3）： 105?112.

[10] 傅彩芬，譚文.基于高階控制器設(shè)計(jì)的線(xiàn)性自抗擾控制參數(shù)調(diào)整[J].控制理論與應(yīng)用，2017，34（2）：265?272.

FU C F， TAN W. Parameters tuning of linear active disturbance rejection control based on high order controller design [J]. Control theory & applications， 2017， 34（2）： 265?272.

[11] 馬麗.高性能數(shù)字信號(hào)控制器在自動(dòng)消防炮中的應(yīng)用[J].消防科學(xué)與技術(shù)，2015（8）：1062?1064.

MA L. Application of high?performance digital signal controller in automatic fire gun [J]. Fire science and technology， 2015（8）： 1062?1064.

[12] 彭艷，劉梅，羅均，等.無(wú)人旋翼機(jī)線(xiàn)性自抗擾航向控制[J].儀器儀表學(xué)報(bào)，2013，34（8）：1894?1900.

PENG Y， LIU M， LUO J， et al. Research on linear adaptive disturbance rejection control method for yaw tracking of unmanned rotorcraft [J]. Chinese journal of scientific instrument， 2013， 34（8）： 1894?1900.

[13] 陳增強(qiáng)，程赟，孫明瑋，等.線(xiàn)性自抗擾控制理論及工程應(yīng)用的若干進(jìn)展[J].信息與控制，2017，46（3）：257?266.

CHEN Z Q， CHENG Y， SUN M W， et al. Surveys on theory and engineering applications for linear active disturbance rejection control [J]. Information & control， 2017， 46（3）： 257?266.