ROV在水底的前進(jìn)和轉(zhuǎn)向運(yùn)動通過控制兩個螺旋槳推進(jìn)器來實(shí)現(xiàn)。給定參數(shù)為航速和航向角,輸出為兩個推進(jìn)器的推力。這里航向角控制器選擇PID調(diào)節(jié)器。只有兩個推進(jìn)器,推力分配算法簡單。

5 仿真研究為了驗(yàn)證水下探測ROV設(shè)計的合理性,進(jìn)行了仿真研究。5.1 水下機(jī)器人模型建立水下機(jī)器人6自由度運(yùn)動模型的各個自由度彼此之間存在耦合,由于水下探測ROV常在低速下運(yùn)動,可以將其運(yùn)動分解為為水平面運(yùn)動(包括狀態(tài)變量

)和垂直面運(yùn)動(包括狀態(tài)變量

)兩部分,并且認(rèn)為這兩個自由度之間不存在耦合關(guān)系。結(jié)合本文研究對象的情況,設(shè)計方案中ROV的外形為左右、前后對稱,且重力、浮力分布可使其保持水平狀態(tài),無橫傾或縱傾。其在水平面運(yùn)動過程中,ROV滿足條件:

此外,由于其只沿縱向平行安裝兩個水平推進(jìn)器,推進(jìn)器的作用只限于產(chǎn)生水下機(jī)器人的進(jìn)退和轉(zhuǎn)艏運(yùn)動。當(dāng)左右推進(jìn)器產(chǎn)生相同推力矢量時可引起進(jìn)退運(yùn)動,而當(dāng)兩者產(chǎn)生大小或方向不同的推力時則可引起轉(zhuǎn)艏運(yùn)動。根據(jù)上述假設(shè)和條件可以得到ROV在水平面內(nèi)的簡化模型:

式中:

——包含附加質(zhì)量的質(zhì)量和轉(zhuǎn)動慣量;

—沿

方向的流體阻力中線性項和非線性項;

——繞Z軸轉(zhuǎn)動方向的流體阻力的線性項和非線性項;

——為推進(jìn)器產(chǎn)生的X軸向力和繞Z軸的轉(zhuǎn)艏力矩。ROV采用壓載水艙進(jìn)行垂直面的位置控制,其在垂直面的模型可以簡化為:

式中:

——包含附加質(zhì)量的質(zhì)量;

——沿Z方向流體阻力的線性項和非線性項;

——壓載水艙產(chǎn)生的垂向作用力。5.2 仿真驗(yàn)證

仿真情況設(shè)定為:ROV由初始靜止?fàn)顟B(tài)開始運(yùn)動。為實(shí)現(xiàn)直航,需保持左右推進(jìn)器輸出相同大小和方向的推力。不同推力情況下ROV的速度響應(yīng)曲線如圖4所示。由速度響應(yīng)曲線可以發(fā)現(xiàn),其速度經(jīng)過一段時間的增加后最終保持在一定的數(shù)值,此時推力與阻力達(dá)到動態(tài)平衡,ROV作勻速直線航行。令

表示ROV在大地坐標(biāo)系下的位置和姿態(tài)。圖5為ROV由初態(tài)

控制ROV垂直下潛到10米處懸停。ROV橫傾角

的控制是通過調(diào)節(jié)特種ROV左右兩個浮力調(diào)節(jié)艙的不同的注、排水量來產(chǎn)生左右兩個浮力調(diào)節(jié)艙的浮力差,即產(chǎn)生旋轉(zhuǎn)運(yùn)動的偏傾力矩。其仿真結(jié)果如下圖6所示。從仿真實(shí)驗(yàn)結(jié)果看出所設(shè)計的ROV深度協(xié)調(diào)控制器達(dá)到了預(yù)期的控制效果。

6 結(jié)束語本文介紹了開架式水下探測機(jī)器人的結(jié)構(gòu)、傳感器系統(tǒng),基于AT91RM9200處理器設(shè)計了ROV嵌入式控制器。建立了ROV的數(shù)學(xué)模型,提出了ROV垂直面協(xié)調(diào)運(yùn)動控制的方法,并進(jìn)行了深度和橫傾角協(xié)調(diào)控制仿真。仿真實(shí)驗(yàn)證明控制器設(shè)計的有效性。

參考文獻(xiàn):[1] 徐玉如,龐永杰,甘永.智能水下機(jī)器人技術(shù)展望[J].智能系統(tǒng)學(xué)報,2006,1(1):9-16.[2] 封錫盛,劉永寬.自治水下機(jī)器人研究開發(fā)的現(xiàn)狀和趨勢[J].高技術(shù)通訊,1999,(9):55-59.[3] 甘永,王麗榮,劉建成.水下機(jī)器人嵌入式基礎(chǔ)運(yùn)動控制系統(tǒng)[J].機(jī)器人,2004,26(3):25-29.[4] MICHAEL J,RUTH A.Robust depth and speed control system for a low-speed undersea vehicle[C].Proceedings of the Symposium on Autonomous Underwater Vehicle Technology.1990:51-58.[5] 戴學(xué)豐,邊信黔.6自由度水下機(jī)器人軌跡控制仿真研究[J].系統(tǒng)仿真學(xué)報,2001,13(3):368-369.[6] 翟宇毅,馬金明,姚志良。超小型潛水機(jī)器人沉浮系統(tǒng)設(shè)計[J].光學(xué)精密工程,2004,12(3):231-234.[7] 周立功.AMR嵌入式系統(tǒng)基礎(chǔ)教程[M].北京:北京航空航天大學(xué),2005.作者簡介:周麗麗(1983-),在讀博士,助理研究員,研究方向:機(jī)器視覺與安全分析。