一種擺式球形水下機器人水底滾動特性分析

李艷生，孫漢旭，賈慶軒，張延恒，褚明

?

一種擺式球形水下機器人水底滾動特性分析

李艷生1, 2，孫漢旭1，賈慶軒1，張延恒1，褚明1

(1. 北京郵電大學(xué)自動化學(xué)院，北京，100876；2. 重慶郵電大學(xué)先進制造工程學(xué)院，重慶，400065)

為了更加深入的掌握BYSQ-2球形水下機器人水底滾動特性，在建立機器人水底滾動方程基礎(chǔ)之上，分析得出機器人質(zhì)量和電機轉(zhuǎn)速也會對機器人的水底滾動產(chǎn)生影響。搭建該種水下機器人水底仿真環(huán)境平臺和虛擬樣機，通過對比在不同質(zhì)量和電機轉(zhuǎn)速下的仿真結(jié)果，得出該種球形水下機器人水底滾動的波動特點，并且增加機器人的質(zhì)量和降低電機的轉(zhuǎn)速，會有效的提高機器人在水底滾動的穩(wěn)定性。

球形機器人；無人水下航行器；水底滾動；虛擬仿真

無人水下機器人(autonomous underwater vehicles, AUV)已經(jīng)在民用領(lǐng)域、工業(yè)領(lǐng)域和科學(xué)研究領(lǐng)域中廣泛應(yīng)用，近年來又在軍用領(lǐng)域得到重視。美國海軍針對無人水下航行器的優(yōu)勢，制定了9類使命任務(wù)，并且充分肯定了以潛艇攜帶水下航行器的優(yōu)點[1?2]。球形機器人成功著落在水底，可以利用自身裝載的傳感器就可以近距離的對水底生物環(huán)境進行考察，拍攝水底地貌和獲取水文信息等[3?4]。球形機器人在水底有時需要偏離原來的著陸位置，進行短距離移動。通過啟動螺旋槳使機器人上浮，然后控制運動到預(yù)定地點進行著底運動的方式對于短距離的移動過于繁瑣。本文研究的運動靈活的球形水下機器人BYSQ-2，在水底探測方面具有很大的優(yōu)勢，能夠以滾動的方式進行姿態(tài)調(diào)整和位置變換。本文設(shè)計方案中的球形機器人通過重擺的重力矩來驅(qū)動球形機器人進行姿態(tài)調(diào)整和向前滾動。段海慶等[5?6]對水下機器人進行水底探測時的欠驅(qū)動控制與水底地形跟蹤控制進行了深入研究。鄭一力等[7?8]對球形機器人在陸地滾動的特性進行了分析，尤其是球形機器人重擺的穩(wěn)定性。為了更加深入的掌握該種球形水下機器人在硬質(zhì)平坦水底姿態(tài)變換和水底滾動情況，本文作者首先建立了球形機器人在水底的滾動數(shù)學(xué)模型，導(dǎo)出球形機器人的質(zhì)量參數(shù)和重擺電機的轉(zhuǎn)動速度對機器人在水底滾動有重要影響。然后在建立機器人水底滾動的Adams虛擬樣機仿真模型的基礎(chǔ)上，對球形機器人在水底滾動的特性和影響因素進行了充分的仿真分析和總結(jié)。

1 機器人實物樣機

BYSQ-2水下機器人與陸地球形機器人[6]有很大相似之處，機器人長軸與推進螺旋槳軸心共線，長軸電機可以用來調(diào)整橫滾角度。機器人短軸軸線與長軸軸線垂直，短軸電機用來調(diào)整機器人俯仰角度。機器人內(nèi)部控制電路和驅(qū)動電機全部密封在一個圓形玻璃纖維球殼內(nèi)，其物理樣機實物如圖1所示。

圖1 機器人的樣機和模型

表1 物理參數(shù)

2 水底滾動數(shù)學(xué)模型

在水底環(huán)境下，球形機器人的滾動速度受到的水阻力不可忽略，并且由于水的浮力影響，機器人的對水底的壓力會減小，從而降低球殼與水底的摩擦 力[9?10]。對球形水下機器人進行水底運動分析，首先要建立動力學(xué)模型來確定研究參數(shù)，本方案中的球形水下機器人系統(tǒng)在水底滾動時，以球殼為研究對象的受力示意圖如圖2所示。

圖2 球殼受力示意圖

圖2所示半徑為的球形機器人在水底向前以角速度向前滾動時的受力情況，在球殼與水底接觸點處，水底對球殼有摩擦力和支持力的作用，同時也受到周圍流體對球殼的水阻力D和浮力的作用。機器人系統(tǒng)內(nèi)部重擺機構(gòu)也會對機器人施加水平分力F，豎直分力F和轉(zhuǎn)動力矩，同時機器人自身的球殼部分結(jié)構(gòu)也受到重力作用。根據(jù)力學(xué)平衡和牛頓歐拉定理，可以得到球形機器人在水底滾動的球殼力學(xué)方程：

同理，對整個球形機器人系統(tǒng)水底運動受力分析，除了球殼部分外，還要對內(nèi)部重擺驅(qū)動機構(gòu)進行受力分析[11?12]，以重擺為研究對象的受力分析如圖3所示。

圖3 重擺受力示意圖

Fig. 3 Force diagrams of heavy pendulums

式(1)和(2)中的水平分力F和，豎直分力F和，轉(zhuǎn)動力矩和為成對出現(xiàn)的作用力與反作用力，根據(jù)牛頓第三定律可以得到這3對力和力矩分別對應(yīng)大小相等。將重擺機構(gòu)的力學(xué)方程帶入球殼力學(xué)程，消去相互作用力可得如下方程組：

(3)

球形機器人在水底滾動狀態(tài)時的質(zhì)量與懸浮狀態(tài)時的配平質(zhì)量差Δ和摩擦力又可表示為

球形機器人在水底滾動時，其驅(qū)動力矩是通過重擺電機驅(qū)動重擺的擺動，反作用力矩驅(qū)動球殼滾動，實質(zhì)上可以看作機器人的滾動運動函數(shù)是電機轉(zhuǎn)動的函數(shù)。電機轉(zhuǎn)動角度與重擺擺角和機器人滾動速度之間建立的約束關(guān)系為

(5)

將式(5)代入方程(3)得球形機器人水底滾動力學(xué)方程：

從上面的方程可以看出球形水下機器人在水底滾動和姿態(tài)調(diào)整，不但與重擺驅(qū)動電機的轉(zhuǎn)動角度變化過程有關(guān)，而且還和球形機器人的配平質(zhì)量Δ有關(guān)。顯然，對球形機器人水底運動規(guī)律和相關(guān)參數(shù)影響規(guī)律的總結(jié)是必要的。

3 機器人仿真模型

為了清晰地分析這2個參數(shù)對球形機器人在水底運動的影響，通過建立Adams樣機模型，添加水底約束條件，在變參數(shù)條件下仿真運動情況。在建立水底滾動動力學(xué)模型時，將機器人分為2個部分：一部分質(zhì)量等效集中在球殼中心處，另一部分質(zhì)量等效集中在重擺質(zhì)心處[13?14]。建立球形機器人水底滾動虛擬樣機，球形機器人系統(tǒng)主要被簡化為配重部分和球殼部分，其中能夠與重擺機構(gòu)一起擺動的部件，其質(zhì)量全部被等效集中到重擺質(zhì)心，而和球殼固定在一起，能和球殼一起轉(zhuǎn)動的部件，其質(zhì)量全部被等效集中在球殼中心。球形機器人水底滾動分析涉及水動力學(xué)和剛體動力學(xué)，Adams軟件可以仿真來球形機器人內(nèi)部的重擺擺動與球殼滾動的規(guī)律。但是對于水動力部分，需要將Fluent水動力系數(shù)結(jié)果加入，作為仿真約束條件。球形機器人在水中的旋轉(zhuǎn)阻力，在水底滾動的滾動摩阻系數(shù)很小，系統(tǒng)各個零件間的摩擦力的能量損耗也很小，仿真時忽略這些因素影響。根據(jù)上述原則，三維模型并導(dǎo)入Adams虛擬環(huán)境中[15?16]。

(a) 球殼與水底模型；(b) 內(nèi)部重擺模型

在虛擬仿真中，水底被建立成一個比球形機器人大很多的薄平板，被設(shè)置成剛體與大地固連。等效球殼與等效重擺也被設(shè)置成剛體，重擺與球殼之間設(shè)置成轉(zhuǎn)動副。球殼和水底兩剛體之間設(shè)置為接觸副。設(shè)定水的密度為1 000 kg/m3，重力加速度為10 m/s2，由于球形機器人的具有完美對稱性，可將浮力、重力和水動力施加在球殼中心，根據(jù)樣機模型，球殼直徑為500 mm，浮力為654 N，其中水動力與球形機器人本身在水底運動的速度和加速度等運動參數(shù)有關(guān)，根據(jù)Fluent軟件水動力仿真數(shù)據(jù)，設(shè)定與速度二次方項有關(guān)的阻力系數(shù)被設(shè)置為40.2，與加速度有關(guān)附加質(zhì)量系數(shù)被設(shè)置為32.7。因此在Adams中機器人的球心處添加水動力約束條件。

其中：水平方向力1的方向與機器人運動方向相反，豎直方向力2的方向與重力方向相同。

4 水底滾動仿真結(jié)果

基于上面建立的球形機器人樣機和水底運動環(huán)境條件設(shè)定，在Adams環(huán)境中分別對帶有水動力和浮力條件下的水底滾動進行仿真分析，機器人質(zhì)量為60 kg，重擺驅(qū)動電機轉(zhuǎn)速為π rad/s，啟動10 s內(nèi)的仿真結(jié)果如圖5所示。由圖5可以看出：球形機器人在水底滾動，速度(圖5(a))、擺角(圖5(b))和電機力矩(圖5(c))都是波動的，波動幅值逐漸衰減，輸出力矩基本位于軸上方，表示要機器人向前滾動要持續(xù)輸出 力矩。

在得到機器人在水底滾動的仿真結(jié)果后，進一步研究機器人水底滾動特性。在原來樣機模型基礎(chǔ)上，球殼質(zhì)量變化Δ為10 kg的條件下進行仿真，分析研究配平質(zhì)量因素對滾動特性的影響。

由圖5和圖6可以看出：球形機器人在水底滾動過程中，其運動特性受機器人配平質(zhì)量影響較大。從位移曲線中可以看出在相同時間內(nèi)配平質(zhì)量增加，球形機器人在水底滾動距離變大；從擺角曲線中可以看出配平質(zhì)量增大，球形機器人重擺擺動幅值衰減較快；從力矩曲線中可以看出配平質(zhì)量增大，球形機器人在水底滾動力矩波動的幅值變小。從仿真結(jié)果可以得出配平質(zhì)量增加，可以增強球形機器人水底滾動的穩(wěn)定性。

在重擺電機驅(qū)動轉(zhuǎn)速為1.5πrad/s，其他參數(shù)不變的條件下進行仿真，分析研究電機轉(zhuǎn)動速度對滾動特性的影響。

由圖5和圖7可以看出：球形機器人在水底滾動過程中，其運動特性受機器人重擺電機轉(zhuǎn)動速度影響較大。從位移曲線中可以看出在相同時間內(nèi)球形機器人滾動的距離并不與轉(zhuǎn)動速度成正比；從擺角曲線中可以看出電機轉(zhuǎn)速增大，球形機器人重擺擺動幅值衰減較慢，波動頻率變大；從力矩曲線中可以看出電機轉(zhuǎn)動速度增大，球形機器人在水底滾動力矩波動的幅值增加。從仿真結(jié)果可以得出僅僅增加電機驅(qū)動轉(zhuǎn)速對提高機器人水底移動速度不明顯，并且穩(wěn)定性受到破壞。

(a) 位移；(b) 擺角；(c) 力矩

(a) 位移；(b) 擺角；(c) 力矩

(a) 位移；(b) 擺角；(c) 力矩

5 結(jié)論

1) 擺式球形水下機器人在水底滾動時，重擺電機以恒角速度輸出時，機器人的位移是波動曲線，表明滾動速度是周期性變化的，并且機器人的重擺擺動角度和電機的輸出力矩也是表現(xiàn)周期性波動變化。

2) 通過建立球形機器人水底滾動數(shù)學(xué)模型發(fā)現(xiàn)，滾動特性受機器人質(zhì)量和電機轉(zhuǎn)速影響。仿真結(jié)果表明，機器人質(zhì)量增大會提高滾動的穩(wěn)定性，而增加電機轉(zhuǎn)速會破壞這種穩(wěn)定性。

參考文獻：

[1] 陳強, 張林根. 美軍軍用UUV現(xiàn)狀及發(fā)展趨勢分析[J]. 艦船科學(xué)技術(shù), 2010, 32(7): 129?134. CHEN Qiang, ZHANG Lingen. Analysis of current situational development trend of US military UUV[J].Ship Science and Technology, 2010, 32(7): 129?134.

[2] 姜軍, 宋保維, 潘光, 等. 超低速小型AUV外形及流體動力布局研究[J]. 魚類技術(shù), 2011, 19(5): 321?324. JIANG Jun, SONG Baowei, PAN Guang, et al. Study on design of shape and hydrodynamic layout for ultra-low-speed AUV[J]. Torpedo Technology, 2011, 19(5): 321?324.

[3] WATSON S A, GREEN P N. A de-coupled vertical controller for micro-autonomous underwater vehicles (μAUVs)[C]// Mechatronics and Automation (ICMA). Washington DC, USA: IEEE Computer Society, 2010: 561?566.

[4] GUO S, LIN X, TANAKA K, et al. Modeling of water-jet propeller for underwater vehicles[C]// Proceedings of the 2010 IEEE International Conference on Automation and Logistics. Washington DC,USA: IEEE Computer Society, 2010: 92?97.

[5] 段海慶,賈鶴鳴, 周佳如. 基于神經(jīng)網(wǎng)絡(luò)的欠驅(qū)動水下機器人地形跟蹤控制[J]. 東南大學(xué)學(xué)報(自然科學(xué)版), 2012, 42(Sup1): 203?207. DUAN Haiqing, JIA Heming, ZHOU Jiaru. Bottom following control for underactuated AUV based on neural network[J]. Journal of Southeast University (Natural Science Edition), 2012, 42(Sup1): 203?207.

[6] 張立軍, 齊雪, 趙杰梅.垂直面欠驅(qū)動自治水下機器人定深問題的自適應(yīng)輸出反饋控制[J]. 控制理論與應(yīng)用, 2012, 29(10): 1371?1376. ZHANG Lijun, QI Xue, ZHAO Jiemei. Depth-keeping control for autonomous underwater vehicle in vertical plane using adaptive output feedback controller[J]. Control Theory & Applications, 2012, 29(10): 1371?1376.

[7] 鄭一力, 孫漢旭. 帶高速旋轉(zhuǎn)飛輪的球形機器人結(jié)構(gòu)設(shè)計與運動穩(wěn)定性分析[J]. 機械工程學(xué)報, 2013, 49(3): 36?41. ZHENG Yili, SUN Hanxu. Mechanical design and motion stability analysis of a spherical robot equipped with high-rate flywheel[J]. Journal of Mechanical Engineer, 2013, 49(3): 36?41.

[8] 于濤, 孫漢旭, 賈慶軒. 一類欠驅(qū)動的解耦滑?？刂品椒╗J]. 東南大學(xué)學(xué)報(自然科學(xué)版), 2012, 42(Sup1): 11?14. YU Tao, SUN Hanxu, JIA Qingxuan. Decoupled sliding mode control for a class of underactuated systems[J]. Journal of Southeast University (Natural Science Edition), 2012, 42(Sup1): 11?14.

[9] 蘭曉娟, 孫漢旭, 賈慶軒. 水下球形機器人BYSQ_2的原理與動力學(xué)分析[J]. 北京郵電大學(xué)學(xué)報, 2010, 33(3): 20?23. LAN Xiaojuan, SUN Hanxu, JIA Qingxuan. Principle and dynamic analysis of a new-type spherical underwater vehicle[J]. Journal of Beijing University of Posts and Telecommunications, 2010, 33(3): 20?23.

[10] LAN Xiaojuan, SUN Hanxu, JIA Qingxuan. The hydrodynamic analysis for the underwater robot with a spherical hull[C]// Proceedings of SPIE-The International Society for Optical Engineering, Space Exploration Technologies II.Bellingham USA:SPIE, 2009: 73310E-1?73310E-8.

[11] 俞建成, 張奇峰, 吳利紅, 等. 水下滑翔機器人運動調(diào)節(jié)機構(gòu)設(shè)計與運動性能分析[J]. 機器人, 2005, 27(5): 390?395. YU Jiancheng, ZHANG Qifeng, WU Lihong, et al. Movement mechanism design and motion performance analysis of an underwater glider[J]. Robot, 2005, 27(5): 390?395.

[12] 高丙團, 陳宏鈞, 張曉華. 龍門吊車系統(tǒng)的動力學(xué)建模[J]. 計算機仿真, 2006, 23(2): 50?109. GAO Bingtuan, CHEN Hongjun, ZHANG Xiaohua. Dynamic modeling of a gantry crane system[J]. Computer Simulation, 2006, 23(2): 50?109.

[13] 王鵬飛, 王鑫, 李滿天, 等. 一款微小型球形機器人的動力學(xué)分析[J]. 哈爾濱工業(yè)大學(xué), 2010, 42(9): 1398?1402. WANG Pengfei, WANG Xin, LI Mantian, et al. Dynamics analysis of a micro-spherical robot[J]. Journal of Harbin Institute of Technology, 2010, 42(9): 1398?1402.

[14] 占強, 賈川, 馬曉輝, 等. 一種球形機器人運動性能分析[J]. 北京航空航天大學(xué), 2005, 31(7): 744?747. ZHAN Qiang, JIA Chuan, MA Xiaohui, et al. Analysis of moving capability of a spherical mobile robot[J]. Journal o f Beijing University of Aeronautics and Astronautics, 2005, 31(7): 744?747.

[15] 劉貴杰, 王猛, 何波, 等. 基于Adams與Matlab/Simulink的水下自航行器協(xié)同仿真[J]. 機械工程學(xué)報, 2009, 45(10): 22?29. LIU Guijie, WANG Meng, HE Bo, et al. Cooperative simulation based on Adams and Matlab/Simulink for autonomous underwater vehicle[J]. Journal of Mechanical Engineer, 2009, 45(10): 22?29.

[16] 馬鑫, 丑武勝, 方斌, 等. 基于Pro/E和ADAMS的水下機器人設(shè)計方法研究[J]. 機械工程與自動化, 2013, 45(6): 3?5. MA Xin, COU Wusheng, FANG Bin, et al. ROV design method based on Pro/E and ADAMS[J]. Mechanical Engineering & Automation, 2013, 45(6): 3?5.

(編輯 陳愛華)

Analysis of rolling characteristics at water bottom for spherical robot with heavy pendulums

LI Yansheng1, 2, SUN Hanxu1, JIA Qingxuan1, ZHANG Yanheng1, CHU Ming1

(1. Institute of Automation, Beijing University of Posts and Telecommunications, Beijing 100876; 2. School of Advanced manufacturing engineering, Chongqing University of Posts and Telecommunications, Chongqing 400065)

In order to know the robot rolling characteristics of BYSQ-2 spherical underwater, the rolling equation was established and an impact on rolling at the bottom of water was analyzed with the robot’s quality and the motor’s speed. After making comparison of the rolling characteristics under water with different quality and motor speed, the simulation results show the volatility characteristics and show that increasing the quality and the moderate motor speed can effectively improve the rolling stability of the robot at the bottom of water.

spherical robot; unmanned underwater vehicle; neural network control; sliding mode method

10.11817/j.issn.1672-7207.2016.11.007

TP242

A

1672?7207(2016)11?3664?06

2016?01?08；

2016?04?07

國家自然科學(xué)基金資助項目(51175048) (Project(51175048) supported by the National Natural Science Foundation of China)

李艷生，博士，從事特種機器人研究；E-mail: liyansheng0@163.com