錢 偉/中國(guó)人民解放軍92419 部隊(duì)

在無(wú)人機(jī)的全數(shù)字仿真過(guò)程中，需要對(duì)離散過(guò)程進(jìn)行控制。本文指出了pid離散系統(tǒng)控制中常見(jiàn)的幾個(gè)問(wèn)題，對(duì)仿真控制過(guò)程中用到的改進(jìn)離散系統(tǒng)pid控制方法進(jìn)行了介紹，并給出了仿真結(jié)果。結(jié)果表明，在pid控制基礎(chǔ)上可以結(jié)合實(shí)際情況調(diào)整控制律參數(shù)結(jié)構(gòu)，以應(yīng)對(duì)可能發(fā)生的問(wèn)題。

在無(wú)人機(jī)的全數(shù)字仿真中，數(shù)學(xué)模型是基礎(chǔ)，基礎(chǔ)如果不準(zhǔn)會(huì)對(duì)后續(xù)的控制律設(shè)計(jì)帶來(lái)很大的影響。有了數(shù)學(xué)模型就可以設(shè)計(jì)控制律，無(wú)人機(jī)最初的控制律設(shè)計(jì)和飛行控制仿真可以在 MATLAB/ Simulink環(huán)境下進(jìn)行。利用風(fēng)洞吹風(fēng)數(shù)據(jù)和理論計(jì)算建立無(wú)人機(jī)的非線性動(dòng)力學(xué)模型，選取若干個(gè)平衡狀態(tài)，對(duì)非線性模型進(jìn)行配平、線性化以后得到無(wú)人機(jī)線性小擾動(dòng)模型。在線性化小擾動(dòng)模型的基礎(chǔ)上進(jìn)行縱向和橫向控制系統(tǒng)的解耦，按照由內(nèi)環(huán)向外環(huán)的順序，利用經(jīng)典時(shí)域或頻域控制理論或者利用現(xiàn)代控制理論進(jìn)行控制律設(shè)計(jì)。在控制律設(shè)計(jì)中，比例-微分-積分（PID）控制方法是最常見(jiàn)的一種，其魯棒性和適應(yīng)性也最強(qiáng)，能夠滿足無(wú)人機(jī)全數(shù)字仿真中控制的需求，為了提高系統(tǒng)的穩(wěn)定性和快速性，也需要對(duì)pid算法進(jìn)行一些適應(yīng)性改進(jìn)。

控制系統(tǒng)數(shù)學(xué)模型

整個(gè)模型解算過(guò)程首先進(jìn)行無(wú)人機(jī)空氣動(dòng)力參數(shù)計(jì)算，求解出計(jì)算三軸力和力矩所需的三軸力和力矩系數(shù)，計(jì)算公式如下：

升力系數(shù)cy：

阻力系數(shù)cx：

側(cè)力系數(shù)cz：

俯仰力矩系數(shù)mz：

滾轉(zhuǎn)力矩系數(shù)mx：

偏航力矩系數(shù)my：

升力Y、阻力X、側(cè)力為Z：

俯仰力矩ΣMz、滾轉(zhuǎn)力矩ΣMx、偏航力矩為ΣMy：

公式中α為迎角，β為側(cè)滑角，δz為升降舵，δx為副翼舵，δy為方向舵。

對(duì)計(jì)算的到氣動(dòng)力和力矩進(jìn)行坐標(biāo)轉(zhuǎn)換，轉(zhuǎn)到機(jī)體坐標(biāo)系，再加入發(fā)動(dòng)機(jī)推力、重力、火箭推力，和各個(gè)力帶來(lái)的偏差，得到機(jī)體坐標(biāo)系的三軸力和力矩。代入到無(wú)人機(jī)運(yùn)動(dòng)的動(dòng)力學(xué)和運(yùn)動(dòng)學(xué)方程計(jì)算出無(wú)人機(jī)的狀態(tài)信息。無(wú)人機(jī)十二階狀態(tài)方程如下：

其中，十二個(gè)狀態(tài)變量： [V，α，β，ωx，ωy，ωz，?，γ，Ψ，x，y，z]分別表示空速、迎角、側(cè)滑角、滾轉(zhuǎn)角速率、偏航角速率、俯仰角速率、俯仰角、滾轉(zhuǎn)角、偏航角、縱向位移、高度、側(cè)向位移；[∑Mx，∑My，∑Mz]，[Vx，Vy，Vz]分別為作用在飛機(jī)上的合力矩和速度在機(jī)體軸上的分量，Ix，Iy，Iz表示慣性矩，Ixy表示慣性積。

pid控制算法

連續(xù)型系統(tǒng)pid 控制

圖1 pid控制器結(jié)構(gòu)

PID控制器是一種線性的控制器，它根據(jù)給定值r(t)和實(shí)際輸出值c(t)構(gòu)成控制偏差：

將偏差的比例（P）、積分（I）、微分(D)通過(guò)線性組合構(gòu)成控制量，對(duì)被控對(duì)象進(jìn)行控制，故稱PID控制器。其輸入e(t)與輸出u(t)的關(guān)系為

在無(wú)人機(jī)的全數(shù)字仿真中，采用的是采樣控制系統(tǒng)，系統(tǒng)按照0.02s的時(shí)間間隔進(jìn)行采樣，因此采樣控制系統(tǒng)中的pid控制器只能依據(jù)采樣點(diǎn)上的偏差值計(jì)算控制量輸出。

離散型系統(tǒng)pid 控制

在實(shí)現(xiàn)離散前，我們假設(shè)系統(tǒng)采樣周期為T。假設(shè)我們檢查第K個(gè)采樣周期，很顯然系統(tǒng)進(jìn)行第K次采樣。此時(shí)的偏差可以表示為：

那么積分就可以表示為：

微分就可以表示為：

于是我們可以將第K次采樣時(shí)，PID算法的離線形式表示為：

如果采樣周期足夠小，這種離散逼近相當(dāng)準(zhǔn)確。上式中U(k)為全量輸出，它對(duì)應(yīng)著被控對(duì)象的執(zhí)行機(jī)構(gòu)第k次采樣時(shí)刻應(yīng)該達(dá)到的位置，因此也成為位置式pid算式。位置型PID控制的優(yōu)點(diǎn)是速度快，穩(wěn)態(tài)誤差小，但也存在缺點(diǎn)，由于它的輸出與整個(gè)過(guò)去的狀態(tài)有關(guān)，用了偏差的累加值進(jìn)行積分，會(huì)產(chǎn)生累積偏差。由于產(chǎn)生偏差的部分為積分環(huán)節(jié)，所以在pid控制器中，就考慮到了積分的分離控制。

積分分離方法

PID控制器中積分環(huán)節(jié)主要是為了消除靜差，提高控制精度。但在過(guò)程的啟動(dòng)、結(jié)束或大幅度增減設(shè)定值時(shí)，短時(shí)間內(nèi)系統(tǒng)輸出有很大偏差，會(huì)造成PID運(yùn)算的積分累積，引起超調(diào)或者振蕩。為了解決這一干擾，引入了積分分離的思想。其思路是偏差值較大時(shí)，取消積分作用，以免于超調(diào)量增大；而偏差值較小時(shí)，引入積分作用，以便消除靜差，提高控制精度。

具體的實(shí)現(xiàn)步驟是：根據(jù)實(shí)際情況，設(shè)定一個(gè)閾值；當(dāng)偏差大于閾值時(shí)，消除積分僅用PD控制；當(dāng)偏差小于等于閾值時(shí)，引入積分采用PID控制。則控制算法可表示為：

其中，β稱為積分開(kāi)關(guān)系數(shù)，其取值范圍為：

由上述表述及公式我們可以知道，積分分離算法的效果其實(shí)與ε值的選取有莫大關(guān)系，所以ε值的選取實(shí)際上是實(shí)現(xiàn)的難點(diǎn)，ε值過(guò)大則達(dá)不到積分分離的效果，而ε值過(guò)小則難以進(jìn)入積分區(qū)，ε值的選取存在很大的主觀因素。積分分離算法的思想非常簡(jiǎn)單。當(dāng)然，對(duì)于β的取值，很多人提出了改進(jìn)措施，例如分多段取值，設(shè)定多個(gè)閾值ε1，ε2，ε3，ε4等，不過(guò)這些閾值也需要根據(jù)實(shí)際的系統(tǒng)來(lái)設(shè)定。除了分段取值外，甚至也有采用函數(shù)關(guān)系來(lái)獲取β值。

抗積分飽和

積分作用的引入是為了消除系統(tǒng)的靜差，提高控制精度。但是如果一個(gè)系統(tǒng)總是存在統(tǒng)一個(gè)方向的偏差，PID控制器的輸出由于積分作用的不斷累加而擴(kuò)大，從而導(dǎo)致控制器輸出不斷增大超出正常范圍進(jìn)入飽和區(qū)。當(dāng)系統(tǒng)出現(xiàn)反響的偏差時(shí)，需要首先從飽和區(qū)退出，而不能對(duì)反向的偏差進(jìn)行快速的響應(yīng)。

為了解決積分飽和的問(wèn)題，引入了抗積分飽和的PID算法。其思路是在計(jì)算U(k)的時(shí)候，先判斷上一時(shí)刻的控制量U(k-1)是否已經(jīng)超出了限制范圍。若U(k-1)>Umax，則只累加負(fù)偏差；同理，若U(k-1)

變積分法

在普通的PID控制算法中，由于積分系數(shù)Ki是常數(shù)，所以在整個(gè)控制過(guò)程中，積分增量是不變的。然而，系統(tǒng)對(duì)于積分項(xiàng)的要求是，系統(tǒng)偏差大時(shí)，積分作用應(yīng)該減弱甚至是全無(wú)，而在偏差小時(shí)，則應(yīng)該加強(qiáng)。積分系數(shù)取大了會(huì)產(chǎn)生超調(diào)，甚至積分飽和，取小了又不能短時(shí)間內(nèi)消除靜差。因此，如何根據(jù)系統(tǒng)的偏差大小改變積分速度，對(duì)提高系統(tǒng)的品質(zhì)是有必要的。變積分PID算法正好可以滿足這一要求。算法公式如下，將積分系數(shù)設(shè)置為與偏差值相對(duì)應(yīng)的值，偏差大，積分系數(shù)小，甚至為0；偏差小，適當(dāng)增加積分系數(shù)。這里的積分系數(shù)以及偏差區(qū)間應(yīng)當(dāng)根據(jù)系統(tǒng)的實(shí)際進(jìn)行設(shè)計(jì)確定

不完全微分PID 控制實(shí)現(xiàn)

在PID控制中，微分信號(hào)可以改善系統(tǒng)的動(dòng)態(tài)特性，但也容易引入高頻干擾，在誤差信號(hào)存在擾動(dòng)時(shí)，更是能夠顯示微分的不足之處?？朔鲜鰡?wèn)題的方法之一就是不完全微分PID控制，其核心思想就是在PID控制算法的微分項(xiàng)中加入一個(gè)一階慣性環(huán)節(jié)。

微分項(xiàng)中加入慣性環(huán)節(jié)可以理解為讓微分作用不能給立即體現(xiàn)，假如說(shuō)微分作用給定的信號(hào)輸出是100，那么加入慣性環(huán)節(jié)后，其不能立即輸出100，而是由0逐漸上升到100，上升的速率與慣性環(huán)節(jié)的系數(shù)有關(guān)。采用不完全微分的優(yōu)點(diǎn)在于，如果誤差存在高頻干擾，那么與誤差信號(hào)直接關(guān)系的微分項(xiàng)不能發(fā)生突變，從而起到濾波的作用，準(zhǔn)確的說(shuō)是低通濾波，緩慢變化的信號(hào)可以通過(guò)，而高頻干擾信號(hào)就被濾掉了，從而有效減小高頻噪聲對(duì)控制器的影響。

仿真結(jié)果

按照無(wú)人機(jī)的氣動(dòng)數(shù)據(jù)建立非線性模型，對(duì)其進(jìn)行線性化后設(shè)計(jì)控制律。在對(duì)高度和航向角的控制中采用了積分分離法和變積分法，以高度控制為例：高度控制系統(tǒng)的控制律規(guī)律為：

其中，前兩項(xiàng)為內(nèi)回路，為穩(wěn)定回路；第三項(xiàng)為比例控制，第四項(xiàng)為垂直速度控制，屬微分控制，最后一項(xiàng)為積分項(xiàng)。全系統(tǒng)仿真中對(duì)積分項(xiàng)的系數(shù)進(jìn)行了設(shè)置，當(dāng)高度差大于40m時(shí)，取值為零；當(dāng)高度差小于6m時(shí)取值3；高度差在6～40m之間時(shí)取值為1。通過(guò)全數(shù)字仿真系統(tǒng)進(jìn)行仿真，控制高度從300m爬升至400m結(jié)果如圖2，可以看出，無(wú)人機(jī)穩(wěn)定爬升，有超調(diào)（<5%），到達(dá)穩(wěn)態(tài)時(shí)間約為14m。

當(dāng)加入抗積分飽和控制以后，設(shè)置積分上限為10，當(dāng)控制量輸出大于積分上限時(shí)，積分只累積負(fù)值的偏差；當(dāng)控制量輸出小于積分上限時(shí)，積分只累積正值偏差。同時(shí)由于抗積分飽和可以提高系統(tǒng)穩(wěn)定度，因此適當(dāng)增大系統(tǒng)積分系數(shù)，可以使系統(tǒng)更快的到達(dá)穩(wěn)定值。同樣取高度由300米爬升至400米，加入抗積分飽和以后的高度響應(yīng)曲線如圖3所示。

對(duì)比圖2和圖3可知，采用常規(guī)PID算法對(duì)高度進(jìn)行控制，響應(yīng)時(shí)間較長(zhǎng)，為14秒；高度有超調(diào)，超調(diào)約5米。采用抗積分飽和的PID控制算法對(duì)高度進(jìn)行控制，系統(tǒng)到達(dá)穩(wěn)態(tài)的時(shí)間更短，為8秒，超調(diào)也更小，僅有0.5米。因此抗積分飽和PID控制算法在對(duì)穩(wěn)態(tài)精度要求較高的場(chǎng)合更能發(fā)揮作用。

加入抗積分飽和的高度控制系統(tǒng)對(duì)應(yīng)的無(wú)人機(jī)俯仰角變化曲線如圖4所示。圖4中綠色曲線表示無(wú)人機(jī)的俯仰角反饋，紅色曲線表示無(wú)人機(jī)滾轉(zhuǎn)角反饋值，藍(lán)色曲線表示航向角曲線。

由于當(dāng)前無(wú)人機(jī)航向角不在顯示的[-30,30]范圍區(qū)間，因此航向角并未顯示。通過(guò)圖4可以看出，從收到高度調(diào)整指令開(kāi)始，無(wú)人機(jī)的俯仰角按照控制規(guī)律進(jìn)行變化，前期由于偏差較大，按照較大的固定俯仰角爬升，中期偏差較小時(shí)采用較小的固定俯仰角進(jìn)行爬升，最后當(dāng)偏差小于20米時(shí)，采用增加了抗積分飽和功能PID控制算法進(jìn)行高度控制，最終保證了高度控制系統(tǒng)的實(shí)現(xiàn)。

由于無(wú)人機(jī)在調(diào)整高度的過(guò)程中橫側(cè)向不受影響，副翼舵用來(lái)保持無(wú)人機(jī)的姿態(tài)角始終為零，因此在高度調(diào)整時(shí)無(wú)人機(jī)的滾轉(zhuǎn)角為零，如圖4。

結(jié)語(yǔ)

在無(wú)人機(jī)的設(shè)計(jì)階段需要進(jìn)行大量的仿真，從全數(shù)字仿真，設(shè)計(jì)和驗(yàn)證控制律，到半物理仿真，控制律與實(shí)物聯(lián)調(diào)，需要多次對(duì)控制律進(jìn)行設(shè)計(jì)和微調(diào)。一方面要保證各個(gè)通道的控制性能，另一方面也不能嚴(yán)重影響其他通道。本文以高度控制系統(tǒng)為例講解了幾分分離和變積分法的應(yīng)用，一般來(lái)說(shuō)積分項(xiàng)只在控制系統(tǒng)的外環(huán)控制中使用，比如無(wú)人機(jī)控制中的高度控制、航向控制、位置控制等，如果不采取措施，很容易使積分飽和。而在內(nèi)回路中，為了提高系統(tǒng)的響應(yīng)速度，對(duì)控制的精度準(zhǔn)度反而沒(méi)有特別高的要求，一般也就不需要積分項(xiàng)，只采取比例控制或比例微分控制即可，如無(wú)人機(jī)仿真中的俯仰角控制、滾轉(zhuǎn)角控制等。PID控制方法在被控系統(tǒng)為連續(xù)系統(tǒng)和離散系統(tǒng)情況下都有很好的控制效果。根據(jù)自身系統(tǒng)特性，設(shè)計(jì)合適和控制律優(yōu)化和改進(jìn)PID算法，是對(duì)基礎(chǔ)性算法的良好補(bǔ)充，能更好的實(shí)現(xiàn)控制系統(tǒng)“快、準(zhǔn)、穩(wěn)”的控制目的?！?/p>

圖2 高度控制系統(tǒng)及響應(yīng)

圖3 加入抗積分飽和的高度控制

圖4 加入抗積分飽和的俯仰角變化量

（參考文獻(xiàn)：略，如有需要，請(qǐng)聯(lián)系編輯部。）