趙 鈺, 高天柱, 陳 靜, 王立文, 寇小明
基于數(shù)字PID控制的魚雷深度模擬系統(tǒng)研究
趙 鈺1,2, 高天柱1, 陳 靜1, 王立文1,2, 寇小明1
(1. 中國船舶重工集團(tuán)公司第705研究所, 陜西 西安, 710075; 2. 水下信息與控制重點實驗室, 陜西 西安, 710075)
為了提高魚雷半實物仿真試驗中深度模擬設(shè)備的響應(yīng)速度和控制精度等性能指標(biāo), 開發(fā)了一種基于PC104產(chǎn)品的動態(tài)數(shù)字比例-積分-微分(PID)控制系統(tǒng)。該系統(tǒng)在結(jié)構(gòu)上采用上、下位機(jī)的模式, 利用串口進(jìn)行通信; 在控制算法上, 針對PID控制存在的積分飽和、抗干擾和動態(tài)過程加速等問題, 設(shè)計了相應(yīng)的控制修正算法,確保了系統(tǒng)的控制速度和精度。通過對魚雷半實物仿真試驗數(shù)據(jù)分析可知, 所得到性能指標(biāo)滿足實際要求。
魚雷深度模擬; 數(shù)字PID; 控制修正算法
深度模擬器是魚雷半實物仿真中的重要設(shè)備, 其通過控制液壓油源的壓力輸出, 模擬海水不同深度變化時作用于魚雷上的靜態(tài)壓力。在魚雷半實物仿真試驗中, 深度模擬系統(tǒng)的精度及響應(yīng)速度會直接影響到試驗中深度模擬的準(zhǔn)確性, 進(jìn)而影響仿真試驗數(shù)據(jù)的可信度。本文采用修正后的比例-積分-微分(proportion-integration-differentia- tion, PID)控制算法, 完成了基于液壓隨動的深度模擬系統(tǒng)的研究與設(shè)計, 該系統(tǒng)具有響應(yīng)時間快、精度及動態(tài)指標(biāo)高、噪聲小等特點, 可以滿足魚雷半實物仿真對深度模擬準(zhǔn)確性及快速性的需求。
本文研究結(jié)果適用于高精度的液壓隨動控制系統(tǒng), 也可應(yīng)用于對靜態(tài)、動態(tài)壓力輸出模擬有較高標(biāo)準(zhǔn)要求的其他場合。
深度模擬器由兩部分組成, 一部分為控制系統(tǒng), 是該模擬器的計算機(jī)控制模塊; 另一部分為液壓系統(tǒng), 是該模擬器的液壓油源和電液轉(zhuǎn)換執(zhí)行模塊, 用于完成電信號到壓力的轉(zhuǎn)換。深度模擬器的系統(tǒng)組成及原理如圖1所示。
圖1 深度模擬器原理圖
深度模擬器具有深度模擬范圍大、動態(tài)響應(yīng)快、精度要求高等特點, 用經(jīng)典的模擬PID方法難以在整個深度范圍內(nèi)同時獲得良好的靜態(tài)精度和動態(tài)性能。近年來, 隨著計算機(jī)技術(shù)發(fā)展, 現(xiàn)代工業(yè)控制過程中, 基本采取參數(shù)調(diào)節(jié)更加靈活的動態(tài)數(shù)字PID控制器取代參數(shù)固定的模擬PID控制器, 以實現(xiàn)更加復(fù)雜的控制策略[1]。為保證系統(tǒng)的控制速度和精度, 本文亦采用帶有智能性的動態(tài)數(shù)字PID控制器來構(gòu)建深度模擬器的控制系統(tǒng)。根據(jù)系統(tǒng)設(shè)計要求及市場調(diào)研選用PC104產(chǎn)品, PC104是一種緊湊型的IEEE-P996工業(yè)總線規(guī)范, 是專門為嵌入式控制而定義的工業(yè)控制總線, 其主要優(yōu)點[2]是: 1) 小尺寸結(jié)構(gòu)。標(biāo)準(zhǔn)的機(jī)械尺寸是96′90 mm; 2) 堆棧式連接。總線以“針”和“孔”形式層疊連接, 即PC104總線模塊之間總線的連接是通過上層的針和下層的孔相互咬合相連, 這種層疊封裝有極好的抗震性; 3) 輕松總線驅(qū)動。4 mA總線驅(qū)動即可使模塊正常工作, 每個模塊1~2 W功耗。
在液壓系統(tǒng)設(shè)計時, 為保證輸出壓力穩(wěn)定, 油源系統(tǒng)必須向伺服閥提供恒定的壓力油, 模擬深度最大值為600 m, 換算壓力為6.0 MPa, 因此油源系統(tǒng)壓力應(yīng)能穩(wěn)定在6.5 MPa左右。液壓系統(tǒng)油路原理如圖2所示。
電機(jī)驅(qū)動內(nèi)嚙合齒輪油泵轉(zhuǎn)動, 油泵從油箱吸油, 對液壓系統(tǒng)供油。精密濾油器對液壓油進(jìn)行過濾, 板式溢流閥使系統(tǒng)壓力穩(wěn)定在6.5 MPa, 油源壓力表監(jiān)測并顯示系統(tǒng)壓力值。壓力恒定的系統(tǒng)油液接入電液伺服閥的壓力腔, 通過控制伺服閥, 使其工作腔產(chǎn)生期望的壓力輸出。壓力傳感器測量輸出壓力, 并將測量結(jié)果反饋回PID控制計算機(jī), 油源壓力表和控制壓力表分別顯示油源壓力及系統(tǒng)的輸出壓力值。
圖2 液壓系統(tǒng)原理圖
PID控制是最早發(fā)展起來的控制策略之一, 它所涉及的算法和控制結(jié)構(gòu)簡單, 十分適用于工程應(yīng)用背景, 且控制效果一般都能令人滿意, 是一種應(yīng)用非常普遍的控制策略[3]。隨著計算機(jī)技術(shù)的發(fā)展, 數(shù)字PID控制器成為主要趨勢。在控制過程中, 把連續(xù)的PID算法離散化, 結(jié)合計算機(jī)CPU的邏輯判斷和分析能力, 使得數(shù)字PID的形式多樣化, 如果想要更改某些參數(shù)時, 無需修改硬件, 只需要修改軟件即可, 所以靈活性強(qiáng)[4]。數(shù)字PID 控制器的離散化數(shù)學(xué)表達(dá)式為
式中:K是比例系數(shù);K是積分系數(shù);K是微分系數(shù);()為第個采樣時刻控制器的輸出量;()為第個采樣時刻的偏差值。
PID控制器是深度模擬器控制系統(tǒng)的核心。由于軟件系統(tǒng)的靈活性, 數(shù)字PID控制器可設(shè)計為帶有一定的智能性, 其3個控制參數(shù)K,K,K可根據(jù)系統(tǒng)的實際情況在控制過程中不斷自我調(diào)節(jié), 以適應(yīng)系統(tǒng)變化, 達(dá)到最佳的控制效果。
分析及產(chǎn)品調(diào)試結(jié)果表明, PID 參數(shù)可依據(jù)以下原則選取[5-6]。
1)K作為主控量的比例增益值, 其主要作用是提高系統(tǒng)響應(yīng)的快速性, 其值越大, 作用越明顯, 但可能導(dǎo)致系統(tǒng)震蕩加劇, 甚至不穩(wěn)定;K作為誤差的積分增益值, 其主要作用是消除系統(tǒng)的穩(wěn)態(tài)誤差, 其值越大, 積分作用越明顯, 亦有可能導(dǎo)致系統(tǒng)震蕩加劇, 超調(diào)量增大;K作為誤差的微分增益值, 在誤差的調(diào)整過程中主要起阻尼作用, 可以改善系統(tǒng)的動態(tài)特性, 有助于減小超調(diào)量, 消除振蕩, 縮短調(diào)節(jié)時間t。
2) PID控制中的比例控制是最基本的控制環(huán)節(jié), 它在整個過程中均起作用, 微分控制主要在前期過程起作用, 積分控制主要在后期起作用。
3) 在誤差的調(diào)整過程中合理選取并匹配上述3個增益值, 可以在系統(tǒng)穩(wěn)態(tài)精度和快速性方面達(dá)到滿意的控制效果。在偏差比較大時, 為盡快消除偏差, 提高響應(yīng)速度, 同時為了避免系統(tǒng)響應(yīng)出現(xiàn)超調(diào), 應(yīng)提高K的增益值, 降低K及K的增益值; 在偏差比較小時, 為提高穩(wěn)態(tài)精度、減小偏差, 并防止超調(diào)過大、產(chǎn)生振蕩、穩(wěn)定性變壞, 應(yīng)降低K和K值, 適當(dāng)提高K值; 在偏差很小時, 為消除靜差, 克服超調(diào), 使系統(tǒng)盡快穩(wěn)定, 應(yīng)進(jìn)一步降低K值, 提高K值, 合理控制K值為小量。
PID控制在實際應(yīng)用過程中, 雖有其獨(dú)特的優(yōu)越性, 但也存在著一些缺陷, 比如積分飽和問題、抗干擾問題和動態(tài)過程加速問題等等。對于數(shù)字PID控制器來說, 通??梢詮目刂扑惴ㄈ胧? 對這些問題進(jìn)行修正, 最大限度地降低其對控制系統(tǒng)的影響。本文為解決上述問題, 研究設(shè)計了針對性的修正算法, 具體如下。
1) 飽和作用及其抑制。實際系統(tǒng)中, 控制量因受元件物理或機(jī)械性能的約束而限制在一定范圍內(nèi), 即min≤≤max。如果控制量在這個范圍內(nèi), 那么PID控制可以達(dá)到預(yù)期效果; 一旦超出了這個范圍, 則實際執(zhí)行機(jī)構(gòu)的控制量就不再是計算值, 由此將引出不期望的飽和效應(yīng)[7]。數(shù)字PID控制中的飽和作用主要是由積分項引起, 稱為積分飽和, 積分飽和的影響是使系統(tǒng)輸出產(chǎn)生明顯的超調(diào)。
針對積分飽和現(xiàn)象, 本文根據(jù)實際情況, 采用了遇限消減積分法對控制算法進(jìn)行修正。遇限消減積分法的基本思路是[8]: 當(dāng)控制進(jìn)入飽和區(qū)以后, 便不再進(jìn)行積分項的累加, 而只執(zhí)行消弱積分的運(yùn)算。即在計算()時, 先判斷(–1)是否已超出限制值。若(–1)>max,則只累加負(fù)偏差; 若(–1) 2) 干擾的抑制。為了消除隨機(jī)干擾的影響, 除了從系統(tǒng)硬件及環(huán)境方面采取措施外, 在控制算法上也應(yīng)采取一定措施, 抑制干擾的影響。 對于作用時間較為短暫的快速干擾, 可以連續(xù)多次采樣, 剔除其中的最大、最小值, 對其余的采樣值求平均數(shù), 該方法足以消除快速隨機(jī)干擾。對于一般的隨機(jī)干擾, 考慮到干擾主要通過微分項對控制系統(tǒng)產(chǎn)生影響, 可采取對干擾不過于敏感的四點中心差分法抑制隨機(jī)干擾。主要思路是[4], 將K選擇的比理想情況稍小一些, 用四點差分法構(gòu)成偏差平均值 再通過加權(quán)求和形式近似構(gòu)成微分項 然后將其替代原式中的微分項。 3) 動態(tài)過程加速。采取增量算法的數(shù)字PID, 在被控量尚未接近給定量, 僅僅開始向給定量變化時, 比例項與積分項的符號相反, 這造成控制過程減慢。為加快開始階段的動態(tài)過程, 可選擇一偏差范圍ε, 當(dāng)系統(tǒng)偏差絕對值在此偏差范圍內(nèi)時, 按正常規(guī)律調(diào)節(jié); 當(dāng)系統(tǒng)偏差絕對值在此偏差范圍外時, 可令K值取0, 即采取PD算法。利用該修改算法, 能夠有效加快控制的動態(tài)過程。 深度模擬器軟件設(shè)計為顯控軟件和PID控制軟件兩部分, 其通過串口通信完成數(shù)據(jù)信息交換。 顯控軟件運(yùn)行在顯控計算機(jī)上, 可以為用戶提供友好清晰的操作界面, 如圖3所示。顯控軟件主要實現(xiàn)接收主仿真計算機(jī)傳送的過程控制命令, 并根據(jù)執(zhí)行結(jié)果, 返回相應(yīng)狀態(tài)標(biāo)志; 進(jìn)行工作設(shè)定、數(shù)據(jù)通信、圖像顯示及模擬器正常工作的協(xié)調(diào)管理; 自動生成工作報告等。 圖3 深度模擬器操作界面 PID控制軟件運(yùn)行在PID控制計算機(jī)上, 主要負(fù)責(zé)反饋傳感器的數(shù)據(jù)采集, 接收顯控計算機(jī)通過串口發(fā)送的指令, 完成PID數(shù)字控制, 驅(qū)動伺服閥, 完成深度模擬。軟件主要由AD采集、DA輸出、濾波模塊、PID控制、串口通信、定時中斷、自檢、數(shù)據(jù)監(jiān)控報警等模塊組成。采用修正的PID控制算法后, 深度模擬器的主要技術(shù)性能指標(biāo)如表1所示。 表1 深度模擬器主要技術(shù)性能指標(biāo) 深度模擬器在魚雷半實物仿真試驗實際應(yīng)用中, 對試驗數(shù)據(jù)進(jìn)行記錄, 如圖4所示。從試驗數(shù)據(jù)曲線圖中可以看出, 無論是指令響應(yīng)速度、還是跟隨性方面, 該深度模擬系統(tǒng)均能夠達(dá)到很好的作用效果。 圖4 仿真試驗數(shù)據(jù)圖 本文根據(jù)魚雷半實物仿真試驗的實際需求, 通過對液壓隨動輸出系統(tǒng)的分析和研究, 確定采用帶有智能性的動態(tài)數(shù)字PID控制器來實現(xiàn)液壓隨動控制。為了能夠更好地提供人機(jī)界面操作以及提高深度模擬器的控制精度和響應(yīng)速度等性能指標(biāo), 在結(jié)構(gòu)上采用了上、下位機(jī)的模式, 上位機(jī)(顯控計算機(jī))用于人機(jī)操作界面的顯示, 下位機(jī)(PID控制計算機(jī))完成PID算法并輸出。在此基礎(chǔ)上, 又針對PID控制過程中存在的積分飽和、抗干擾、動態(tài)過程加速問題, 逐一設(shè)計了修正算法, 使深度模擬器的技術(shù)性能指標(biāo)達(dá)到了一個較高的標(biāo)準(zhǔn)。 通過魚雷半實物仿真試驗的實際應(yīng)用, 證明本文的研究成果技術(shù)性能良好、系統(tǒng)安全可靠, 完全可以滿足魚雷半實物仿真試驗的實際需求。 [1] 李淵.智能PID控制器優(yōu)化仿真研究[J].計算機(jī)仿真, 2012, 29(12): 180-183. Li Yuan. Parameters Optimization of PID Controller[J]. The Computer Simulation, 2012, 29(12): 180-183. [2] 胡安平. PC104在工程實踐中的應(yīng)用[J]. 電子產(chǎn)品世界, 2002(08A): 60-62. [3] Astrom K J, Hagglund. The Future of PID Control[J]. Control Engineering Practice, 2001(9): 1163-1175. [4] 楊德剛, 姜磊, 賈文杰.?dāng)?shù)字PID與其算法改進(jìn)的研析[J].中國科技信息, 2010(14): 102-104. [5] 胡壽松.自動控制原理[M].北京: 科學(xué)出版社, 2007. [6] 何清華, 曾益昆.基于模糊PID 的液壓同步控制[J].機(jī)械與電子, 2001(1): 13-15. [7] 柯志敏, 張桂香.?dāng)?shù)字PID調(diào)節(jié)器應(yīng)用中的幾個技術(shù)問題[J].微計算機(jī)信息, 2008, 24(4): 103-105. Ke Zhi-Min, Zhang Gui-Xiang.Some Technology Problems in Digital PID Regulator Application[J]. Microcomputer Information, 2008, 24(4): 103-105. [8] 楊錦.?dāng)?shù)字PID控制中的積分飽和問題[J].華電技術(shù), 2008, 30(6): 1-4. Yang Jin. Integral Saturation in Digital PID Control[J]. Huadian Technology, 2008, 30(6): 1-4. (責(zé)任編輯: 許 妍) A Digital PID Control System for Torpedo Depth Simulator ZHAO Yu,GAO TianzhuCHEN Jing, WANG Li-wen,KOU Xiao-ming (1. The 705 Research Institute, China Shipbuilding Industry Corporation, Xi¢an 710075, China; 2. Science and Technology on Underwater Information and Control Laboratory, Xi¢an 710075, China) For improving such performances as response speed and control precision of a depth simulator in torpedo hardware-in-the-loop simulation test, a dynamic digital proportion-integration-differentiation(PID) control system was developed on the basis of PC104 products. The control system adopts the master/slave computers structure, and realizes communication through a serial port. Aiming at the problems in PID control, such as integral saturation, anti-interference, and dynamic process acceleration, a corresponding control correction algorithm was designed to guarantee the control speed and precision of the system. By analyzing the hardware-in-the-loop simulation test data of a torpedo, it is proved that the depth simulator with this PID control system achieves very good performances and meets the requirement in actual use. torpedo depth simulation; digital proportion-integration-differentiation(PID); control correction algorithm TJ630.33; TP391.9 A 1673-1948(2014)06-0461-04 2014-05-07; 2014-05-21. 趙 鈺(1987-), 男, 在讀碩士, 主要研究方向為水下載體測試技術(shù).3 系統(tǒng)實現(xiàn)及算法驗證
4 結(jié)束語