郭祥洋,魯守銀,高鵬 ,劉存根,胡濤
(1.山東建筑大學機器人與智能系統(tǒng)研究院, 山東 濟南250101;2.山東省城鄉(xiāng)規(guī)劃設計研究院,山東 濟南 250013)
?
基于模糊-PID控制的水沖洗機器人液壓伺服控制系統(tǒng)
郭祥洋1,魯守銀1,高鵬2,劉存根1,胡濤1
(1.山東建筑大學機器人與智能系統(tǒng)研究院, 山東 濟南250101;2.山東省城鄉(xiāng)規(guī)劃設計研究院,山東 濟南 250013)
摘要:變電站帶電作業(yè)水沖洗機器人是針對220 kV變電站污閃問題研制的特種機器人,本文針對機器人的液壓伺服控制系統(tǒng)的非線性特點建立數學模型,對該模型提出了模糊-PID綜合控制方案,并對控制方案在理想條件和受干擾條件下進行Matlab仿真和變電站環(huán)境下的實地實驗。結果表明,該控制方案能夠提高機器人液壓伺服控制的精度,并且具有一定的抗干擾性。
關鍵詞:水沖洗機器人;液壓伺服控制系統(tǒng);模糊-PID控制;仿真
持續(xù)電力供應已經成為影響當今社會發(fā)展的重要因素,變電站的正常運行是持續(xù)電力供應的一個重要環(huán)節(jié)。由于大氣中很多污染物長時間沉積在絕緣柱的表面上,降低了絕緣性能,容易發(fā)生污閃事故[1],造成大面積停電。國內當前多采用人工水沖洗,工作效率低、危險系數高,上海交通大學發(fā)明的關節(jié)式超高壓帶電清掃機器人HVCR-II提高了清掃工作效率,但毛刷的清掃對絕緣子具有一定的摩擦傷害[2]。韓國電力研究院研制的變電站絕緣子干洗機器人[3]小巧便捷,但效率相對較低。帶電水沖洗較其他沖洗技術效率更高,且對變電站設備沒有傷害,是當前重要的清洗技術之一[4]。
為此,我們研制了對變電站帶電作業(yè)水沖洗機器人,在對機器人系統(tǒng)進行研發(fā)時, 發(fā)現較難采用一種精確的數學模型對其進行控制,特別是為整個機器人提供動力的液壓伺服系統(tǒng),具有較強的非線性,而變電站帶電清洗作業(yè)對整個機器人的線性和魯棒性要求較高。模糊控制是一種不依賴于數學模型, 且有很強的魯棒性的控制方法;而傳統(tǒng)PID控制為線性控制,具有較平穩(wěn)的輸出[5],這為液壓伺服系統(tǒng)的控制研究提供了理論基礎。結合兩種控制方法形成模糊-PID綜合控制,該控制方法能夠在提高響應速度的同時減小超調,同時增強系統(tǒng)的魯棒性[6]。本文將該方案應用于機器人液壓伺服控制系統(tǒng)中,仿真和實地實驗都取得了較好的控制效果。
水沖洗機器人包含移動車體、液壓動力系統(tǒng)、機械臂以及控制系統(tǒng),變電站帶電作業(yè)水沖洗機器人結構示意圖如圖1所示。移動車體采用履帶式行走機構,四條支腿實現對機器人的固定和支撐;液壓動力系統(tǒng)驅動機器人各個關節(jié)和機構進行動作;機械臂具有大臂回轉、大臂俯仰、小臂伸縮、平臺俯仰和平臺回轉5個自由度,通過平臺回轉機構與車體相連。機械臂具有3級升降機構,在升降機構的末端裝有俯仰和回轉平臺,高壓噴槍固定在平臺上,能滿足不同位姿沖洗的需求。
機器人控制系統(tǒng)采用人-機交互的智能控制方式,操作人員對水沖洗的操作任務進行分析,制定沖洗作業(yè)流程,機器人按流程進行組織、協(xié)調和執(zhí)行。在這個過程中機器人實時反饋狀態(tài)信息,操作人員根據信息不斷進行修正。
圖1 變電站帶電水沖洗移動機器人Fig.1 Water cleaning robot of a substation
水沖洗機器人由柴油機提供動力,通過聯(lián)軸器與液壓泵相連,為整個液壓系統(tǒng)提供液壓能。水沖洗機器人的液壓系統(tǒng)主要應用于履帶式工作機移動平臺、4個液壓支腿和5個自由度的機械臂,移動車體的移動、支腿的伸縮和機械臂的運動分別通過機器人的下部電磁換向閥組、上裝電磁換向閥組和液壓伺服閥組進行控制,各閥組再通過分配閥與液壓泵連接。
機器人的位姿對于整個清洗作業(yè)噴射過程較為重要,因此,要針對機器人進行位置伺服控制。本文以四通滑閥為研究對象,液壓缸采用對稱式的,將單個自由度的機械臂的液壓伺服控制系統(tǒng)簡化為一個二級線性系統(tǒng),機器人的液壓伺服控制系統(tǒng)如圖2所示[7],圖中控制器對整個液壓系統(tǒng)輸出動作控制的信號,伺服放大器則實現對信號的放大,電液伺服閥將放大了的信電信號轉換成液壓信號,用來驅動液壓缸進行動作,傳感器將動作的實際運行結果反饋到輸入端,過程中因元件不同產生不同的增益。下面分別進行數學建模。
圖2 液壓伺服控制結構圖Fig.2 Structure chart of hydraulic servo control
3.1伺服放大器數學模型
在整個系統(tǒng)中伺服放大器對信號具有線性比例放大的作用,將電壓信號轉化為放大的電流信號,即
UrKf=I,
(1)式中,Ur為伺服放大器的輸入電壓,V;Kf為伺服放大器的放大系數,A/V;I為伺服放大器的輸出電流,A。
3.2伺服閥數學模型
伺服閥傳遞函數為
采用相似性搜索法(BLAST1)和最小距離法對濱海白首烏及其近緣種進行鑒定研究,2種方法分析結果均表明ITS2序列可以準確地將3種濱海白首烏之間及與近緣種鑒別開。為了更直觀地反映鑒定結果,本研究基于相似性搜索法和最近距離法結果構建了NJ系統(tǒng)聚類樹(圖2),bootstrap 1 000次重復。濱海白首烏與戟葉牛皮消及隔山消聚為一支,且互有區(qū)別。濱海白首烏與鵝絨藤屬的植物距離較近,與蘿藦科其他物種可以明顯區(qū)分開。
(2)
式中,Ksv為伺服閥的流量系數,m3/s·A;ωsv為伺服閥的固有頻率,rad/s;Q0為伺服閥的空載流量,m3/s;ΔI為伺服閥的輸入電流增量,A;ξsv為伺服閥的阻尼比;s為復頻域變量。
3.3閥控缸數學模型
閥控缸的動態(tài)特性在控制系統(tǒng)中具有重要的作用,其基本的流量方程有[8]:
滑閥的基本流量特性方程
Ql=KqXl-KcPl,
(3)
式中,Ql為伺服閥的負載流量,m3/s;Kq為滑閥總的流量系數,m2/s;Xl為滑閥閥芯的位移,m;Kc為滑閥在穩(wěn)定工作點附近的流量壓力系數,(m3/s)/MPa;Pl為負載壓差,MPa。
液壓缸和負載的力平衡方程
(4)
式中,Ap為活塞有效面積,m2;x為活塞位移,m;Bp為活塞和負載的粘性阻尼系數,N/(m/s) ;K為負載的彈性剛度,N/m;m為活塞及負載的總質量,kg;fh為負載的摩擦力,N;f為負載阻力,N。
液壓缸連續(xù)性方程
(5)式中,Cp為液壓缸總的泄漏系數,m3/(MPa·s);V0為兩個油腔的總容積,m3;βe為有效體積彈性模數,N/m2。
機器臂在運動過程中所受的彈性阻力較小,可以將其忽略;同時機器人應用無阻尼缸,粘性阻力較小,同樣將其忽略。在建立力平衡方程時只需考慮負載的摩擦力fh和任意負載阻力f,設F=f+fh,對式(3)、(4)、(5)進行拉氏變換得
Ql=KqXl-KcPl,
(6)
ApPl=ms2X+F,
(7)
(8)
聯(lián)合方程(6)、(7)、(8)可得到閥控缸的位移數學模型的方程為
(9)
則指令輸入的傳遞函數分別為
(10)
令
可得液壓缸的傳遞函數為
(11)
3.4位置傳感反饋
位置傳感器是將機器人動作的角度或者位移值(這里以大臂回轉的角度為180°為例)轉化為電信號反饋到控制的輸入端,可以將其看作兩個比例模型:
Uy=Kyθ,
(12)
θ=KθX。
(13)
Uy=KyKθX,
(14)
式中,Uy為位移反饋電信號,V;Ky為位移轉化系數,V/(°);Kθ為角度位移轉化系數,(°) /m;θ為關節(jié)轉動角度,(°)。
水沖洗機器人系統(tǒng)中,根據計算和調試的經驗,得到相應的設置參數表(機器人采用丹弗斯PVG32伺服比例閥組[6]),如表1所示。
表1 參數設置表
4.1模糊-PID位置伺服控制
由于液壓伺服系統(tǒng)具有較強的非線性,且位置伺服控制本身具有一定的時變特性和干擾性,較難滿足機器人清洗作業(yè)的需求。本文將魯棒性強的模糊控制和具有良好線性的傳統(tǒng)PID控制結合,形成綜合控制-模糊-PID控制[9],用以控制液壓伺服系統(tǒng)。模糊控制的魯棒性能夠有效地濾除液壓系統(tǒng)自身擾動及變電站其他信號帶來的干擾,具有一定的抗外部干擾的能力,將液壓系統(tǒng)維持在較穩(wěn)定的狀態(tài)。通過上一節(jié)推理的結果,得到機器人液壓系統(tǒng)的模糊-PID位置伺服控制圖如圖3所示。
圖3 模糊-PID位置伺服控制圖Fig.3 Fuzzy PID- position servo control chart
4.2仿真
考慮到機器人液壓伺服系統(tǒng)位置控制的特點,模糊-PID控制器采用二維模糊控制器[10],以位置誤差e及誤差的變化率ec作為輸入,以Kp、Ki、Kd作為輸出。首先對輸入和輸出變量進行模糊化處理,設定的語言值為{NB(負大)、NM(負中)、NS(負小)、Z(0)、PS(正小)、PM(正中)、PB(正大)}。根據對水沖洗機器人的液壓伺服控制的調試經驗,要求在0附近時要控制精確,兩邊的控制精度可以稍微降低,因此在選擇各個變量的隸屬度函數時,在中間采用靈敏度較好的三角(trimf)函數,兩邊則采用較為簡單的Z形(zmf)函數。同時,為增加在開始階段控制的靈敏性和精確性,在0附近的論域設置的比較緊密。e、ec、 Kp、Ki和Kd的隸屬度函數及響應的論域如圖4所示。
圖4 各變量的隸屬度函數Fig.4 Membership function of individual variable
利用Mamdani法和加權平均法進行模糊推理和去模糊化,總結各個變量之間的模糊規(guī)則,如表2所示。通過實時檢測e和ec,根據模糊規(guī)則實時地對Kp、Ki和Kd3個參數進行在線調整,以提高液壓伺服控制的穩(wěn)定性和響應速度,對變電站干擾信號也有一定的抑制作用。
表2 模糊控制規(guī)則表
通過Matlab(Simulink)建立液壓伺服系統(tǒng)的模糊-PID控制仿真模型,如圖5所示(此模型中只有階躍信號作為輸入信號),其中PID控制器的Kp、Ki和Kd3個參數分別設為3.2、1.31和0.000 3。
在對水沖洗機器人進行控制時,主要考慮機器人開始動作和連續(xù)動作兩個過程,因此對應仿真模型中分別以單位階躍信號和正弦波信號作為起始信號以模擬這兩個過程。鑒于變電站的復雜環(huán)境,在進行仿真時考慮到理想條件和受干擾條件兩個情況。在理想無干擾的條件下得到仿真圖如圖6~7所示。
圖5 模糊-PID控制仿真模型Fig.5 Simulation model of fuzzy-PID Control
圖6 理想條件階躍信號系統(tǒng)仿真圖Fig.6 System simulation figure of ideal step signal
圖7 理想條件正弦波信號系統(tǒng)仿真圖Fig.7 System simulation figure of sine wave signal in ideal condition
從圖6容易看出,當輸入階躍信號時,模糊-PID控制比常規(guī)PID控制響應速度更快,常規(guī)PID控制超調9%左右,而模糊-PID控制超調僅為1%左右,且沒有產生震蕩現象,穩(wěn)定性更高。從圖7中可以看出,當輸入正弦波信號時,常規(guī)PID峰值超調接近10%,模糊-PID控制峰值更接近于原始的正弦波信號,且跟隨性更好。
由于機器人所處變電站環(huán)境容易受到高壓強磁環(huán)境的影響,因此在上述仿真模型的信號輸入端同時加入一定的高斯白噪聲作干擾信號,得到了在干擾信號下以高斯噪聲、階躍信號和正弦波信號為輸入信號的仿真圖,如圖8~10所示。
圖8 高斯白噪聲系統(tǒng)仿真圖Fig.8 System simulation figure of Gaussian white noise
圖9 干擾條件階躍信號系統(tǒng)仿真圖Fig.9 System simulation figure of step signal in interference condition
圖10 干擾條件正弦波信號系統(tǒng)仿真圖Fig.10 System simulation figure of sine wave signal in interference condition
從圖8中可以看到,模糊-PID控制對高斯噪聲有較好的過濾作用。從圖9~10可以看出,傳統(tǒng)PID控制能夠對噪聲信號起到一定的調節(jié)作用,但作用不是很明顯,出現了噪聲引起的震蕩現象,隨著時間的推移,仿真結果并沒有得到任何的改善。而模糊-PID控制能夠有效地濾除噪聲信號的干擾作用,受干擾信號影響比較微弱,體現出該系統(tǒng)較好的魯棒性,但抗干擾程度受當前模糊推理規(guī)則的限制。
圖11 機器人水沖洗實驗圖Fig.11 Water cleaning experiment figure of the robot
4.3實地實驗
在遵守電業(yè)安全工作規(guī)程的前提下,應用機器人進行了一系列變電站沖洗實驗,如圖11所示。通過實驗表明,機器人各個關節(jié)及行走機構反應靈敏,控制精度較高,穩(wěn)定性和流暢性較好
變電站水沖洗機器人能夠通過對絕緣子進行水沖洗來解決污閃事故,高效、便捷、安全而且無傷害。本文對液壓伺服系統(tǒng)進行了研究,并應用模糊-PID混合控制對其進行控制。該設計提高了機器人液壓伺服控制的精度,并且具有一定的抗干擾性。但在研究過程中發(fā)現,因為當前模糊規(guī)則的局限性,液壓伺服控制的精度還有待提高。同時本文主要是對單關節(jié)進行研究,對多關節(jié)伺服控制的耦合性沒有作進一步的探討,這將是今后的研究方向。
參考文獻:
[1]白雪蓮,楊玲.淺談輸變電設備的防污閃措施[J].中國電子商務,2010(4):167.
[2]李健,魯守銀,董旭.變電站帶電作業(yè)水沖洗機器人的研制[J].制造業(yè)自動化.2015,37(5):67-71.
[3]PARKJY,CHOBH,BYUNSH.Developmentofautomaticcleaningrobotforlive-lineinsulators[M]//IEEE11thInternationalConferenceonTransmission&DistributionConstruction,OperationandLive-LineMaintenance(ESMO2006).[S.l.]:IEEE,2006.
[4]王慶昌.淺談帶電水沖洗在新疆電力系統(tǒng)的應用技術及故障分析[J].大眾科技,2010(11):124-126.
[5]江桂云,王勇勤,嚴興春. 液壓伺服閥控缸動態(tài)特性數學建模及仿真分析[J]. 四川大學學報(工程科學版),2008,40(5):195-198.
[6]王述彥,師宇,馮忠緒.基于模糊PID控制器的控制方法研究[J].機械科學與技術,2011,30(1).:166-172.
[7]顧毅,翁新華,楊汝清,等.關節(jié)式超高壓帶電清掃機器人HVCR-II[J].上海交通大學學報,2016,40(12):2173-2176.
[8]高明玉.基于模糊控制的液壓伺服控制系統(tǒng)研究[J].機械工程與自動化.2014(4):158-159.
[9]趙升噸,魏樹國,王軍.液壓伺服控制系統(tǒng)研究現狀的分析[J]. 伺服控制,2006(11):16-23.
[10]鄧勇. 智能PID控制器在閥控液壓控制系統(tǒng)中的應用[D].哈爾濱:哈爾濱工業(yè)大學,2007.
DOI:10.3976/j.issn.1002-4026.2016.04.019
收稿日期:2016-06-02
基金項目:國家高新技術研究發(fā)展計劃(863計劃)(2012AA041506)
作者簡介:郭祥洋(1988-),男,碩士,研究方向為智能機器人。Email:guoxy126@126.com
中圖分類號:TP242
文獻標識碼:A
文章編號:1002-4026(2016)04-0099-07
Fussy-PID control based hydraulic servo controlsystemofwatercleaningrobot
GUO Xiang-yang1,LU Shou-yin1,GAO Peng2,LIU Cun-gen1,HU Tao1
(1.Robotics and Intelligent System Institute, Shandong Jianzhu University, Jinan 250101, China;2.ShandongUrbanandRuralPlanningDesignInstitute,Jinan250013,China)
Abstract∶Water cleaning robot of a substation is a special robot. It is developed for the issue of "Pollution Flashover" of 220 kV substation. We establish a mathematical model for non-linear characteristic of its hydraulic servo system. We further present a fuzzy-PID control scheme for the model and perform Matlab simulation and practical substation experiment under ideal and interfered conditions. Results show that the scheme can improve the accuracy of its hydraulic servo control, and has certain interference suppression capability.
Key words∶water cleaning robot; hydraulic servo control system; fuzzy-PID control;simulation