水下機器人運動控制系統(tǒng)設(shè)計與實現(xiàn)

2.3 電機與推進器傳遞函數(shù)

　　(1) 直流電機傳遞函數(shù)

　　一般直流電機的動態(tài)特性為慣性環(huán)節(jié)，其傳遞函數(shù)為：

　　系統(tǒng)閉環(huán)傳遞函數(shù)為：

　　在MATLAB Simulink環(huán)境下進行模型搭建，如圖3所示。

　　輸入一個階躍信號，用以模擬航向設(shè)定值，信號如圖4所示。反復(fù)調(diào)整PID參數(shù)，獲得了比較理想的響應(yīng)曲線如圖5所示。

　　從響應(yīng)曲線可得，系統(tǒng)較快地上升到設(shè)定值附近，在經(jīng)過一個較小的超調(diào)后，穩(wěn)定在設(shè)定值。響應(yīng)時間約為8s左右，能夠滿足對ROV定向控制的要求。

3 航向控制閉環(huán)模擬試驗

　　設(shè)計如圖6所示的閉環(huán)結(jié)構(gòu)對ROV進行航向控制閉環(huán)回路的模擬。

　　上位機發(fā)送定向設(shè)定值120°至PC104，PC104生成推進器的輸出信號。工業(yè)控制計算機采集PC104生成的4路水平方向上的DA輸出信號。工業(yè)控制計算機上運行仿真計算程序，將采集的信號作為輸入量，經(jīng)閉環(huán)傳遞函數(shù)處理后，得到航向輸出量，并在界面上顯示，同時將航向數(shù)據(jù)由串口發(fā)送至PC104的羅經(jīng)串口，再由PC104采集后，繼續(xù)進行數(shù)字PID運算，以此實現(xiàn)閉環(huán)回路。

　　將采集的4路電壓信號和航向變化來說明航向控制的調(diào)節(jié)過程，以偏差2°作為間隔，記錄每次數(shù)據(jù)，實驗數(shù)據(jù)如表1所示。

　　從表1中數(shù)據(jù)可得：轉(zhuǎn)向調(diào)節(jié)時，4路推進器的輸出電壓所產(chǎn)生的力矩方向一致，以便ROV能盡快達到設(shè)定值附近。設(shè)定航向為120°，隨著控制過程的進行，航向偏差由高到低變化，到0之后，形成一定超調(diào)量，此時航向會繼續(xù)增大，在到達頂點后開始下降，并進入振蕩過程，系統(tǒng)經(jīng)過短時間的振蕩，最后會趨于穩(wěn)定。模擬實驗的結(jié)果驗證了控制系統(tǒng)的可靠性。

4 結(jié)論

　　本文主要研究了ROV的運動學(xué)模型的建立以及航向控制策略。首先對航向閉環(huán)控制系統(tǒng)進行研究，推導(dǎo)出了ROV航向閉環(huán)控制系統(tǒng)的傳遞函數(shù)。再基于PID算法和Simulink仿真完成了PID控制器的設(shè)計。最后，建立模擬閉環(huán)仿真系統(tǒng)，對ROV的航向調(diào)節(jié)控制進行仿真驗證，對試驗結(jié)果和試驗數(shù)據(jù)進行了分析和總結(jié)，驗證了所使用的控制算法及所設(shè)計的PID控制器的可行性。

　　參考文獻：

　　[1]孫玉山,梁霄,萬磊,等.一種開架式水下機器人控制技術(shù)的研究[J].四川大學(xué)學(xué)報.2008,40(2): 147-152.

　　[2]晏勇,馬培蓀,王道炎,等.深海ROV及其作業(yè)系統(tǒng)綜述[J].機器人,2005,27(1):82-89.

　　[3]朱康武,顧臨怡.作業(yè)型遙控水下運載器的多變量backstepping魯棒控制[J].控制理論與應(yīng)用,2011,28(10):1441-1446.

　　[4]邊宇樞,高志慧,贠超. 6自由度水下機器人動力學(xué)分析與運動控制[J].機械工程學(xué)報,2007,43(7):87-92.

　　[5]唐旭東,龐永杰,李曄.水下機器人運動的免疫控制方法[J].電機與控制學(xué)報,2007,11(6):676-680.

　　[6]嚴衛(wèi)生.魚雷航行力學(xué)[M].西安:西北工業(yè)大學(xué)出版社,2005.

　　[7]李殿璞.船舶的數(shù)學(xué)建模[M].哈爾濱:哈爾濱工業(yè)大學(xué)出版社,2001.

　　[8]黃海.遙控潛水器的控制體系結(jié)構(gòu)及作業(yè)技術(shù)[M]. 北京:國防工業(yè)出版社,2011.

本文來源于《電子產(chǎn)品世界》2017年第1期第33頁，歡迎您寫論文時引用，并注明出處。