模塊化水下仿生蛇形搜救裝置研究

馬文科，高強，趙博文，孫斌，胡歆遙，趙俊哲

（1.沈陽工程學(xué)院，遼寧沈陽，110000；2.中建東方裝飾有限公司，遼寧沈陽，110000）

0 引言

隨著海上運輸、海洋資源開發(fā)活動的日益增多，海上事故發(fā)生率也居高不下。因此，建立完備的海上搜救裝備體系尤為重要，而目前的水下機器人ROV 及AUV 分別暴露出運動能力弱和環(huán)境適應(yīng)性差的問題，均只能在特定的場景中進行應(yīng)用，并不能滿足實際應(yīng)用的需要。而仿蛇形水下搜救機器人同時兼顧了地形兼容性及運動靈活性，在沉船體內(nèi)部、礁石地帶等復(fù)雜環(huán)境中，優(yōu)勢更為明顯。除此之外，仿蛇形機器人得益于獨特的仿生結(jié)構(gòu)和靈活性，在水產(chǎn)養(yǎng)殖、輸油管道及水下工作平臺的檢修工作中以及海洋探索等領(lǐng)域也具有巨大的應(yīng)用前景。綜上所述，針對基于模塊化技術(shù)的新型仿生蛇形機器人的研究將會在社會生產(chǎn)工作中為人們提供更大的便利。

1 主體結(jié)構(gòu)設(shè)計

■1.1 驅(qū)動結(jié)構(gòu)設(shè)計

考慮到水下搜救機器人在實際應(yīng)用場景中針對工作效率的需求，計劃將蛇頭及蛇尾兩端均設(shè)計為主驅(qū)動裝置，即形成雙動力模式。采用“橫縱雙向”螺旋槳推進結(jié)構(gòu)為裝置提供動力（裝置驅(qū)動結(jié)構(gòu)示意如圖1 所示），分布于蛇頭結(jié)構(gòu)兩側(cè)的橫向水推器可實現(xiàn)橫向驅(qū)動及差速轉(zhuǎn)向，而安裝于蛇頭結(jié)構(gòu)內(nèi)部的縱向水推器用于實現(xiàn)裝置整體的“下沉－上浮”運動。這樣的雙驅(qū)動模式既可以保證裝置在有限的硬件條件下維持高效率工作，同時也可實現(xiàn)裝置在一端驅(qū)動結(jié)構(gòu)受損的情況下，仍可以低功耗狀態(tài)進行工作，大大提高了裝置在極限工作情況下的運動容錯率。同時，這樣的結(jié)構(gòu)設(shè)計也可以幫助實現(xiàn)水下工作環(huán)境對于運動平衡性的要求。

圖1 驅(qū)動裝置結(jié)構(gòu)示意圖

■1.2 功能區(qū)塊設(shè)計

結(jié)合水下搜救及探索工作的功能需求，將主要功能定位于自動避障越障、生命體征監(jiān)測、音頻通話及圖像回傳、導(dǎo)航定位回傳四項功能。將各大功能模塊平均分布在直徑為90mm 的蛇頭結(jié)構(gòu)表面，各功能區(qū)塊分布結(jié)構(gòu)如圖2 所示。

圖2 功能區(qū)塊分布圖

■1.3 關(guān)節(jié)結(jié)構(gòu)設(shè)計

由于水下仿生蛇形搜救機器人的關(guān)節(jié)機構(gòu)要實現(xiàn)左右偏轉(zhuǎn)擺動和上下俯仰擺動的功能，所以在關(guān)節(jié)整體架構(gòu)上采用俯仰－偏轉(zhuǎn)雙模塊正交結(jié)構(gòu)，兩個運動方向的最大擺動角度預(yù)計按照±90°（采用180°舵機實現(xiàn)精準(zhǔn)轉(zhuǎn)角運動）設(shè)計，而實際最大擺動角度可根據(jù)需要在電控信號上加以調(diào)整。

我們采用錐齒傳動結(jié)構(gòu)作為設(shè)計主體，用正交關(guān)節(jié)+錐齒輪傳動，舵機與傳動結(jié)構(gòu)的主動輪相連接，運動時通過呈90°分布的錐齒結(jié)構(gòu)傳遞動力，由于從動輪與關(guān)節(jié)內(nèi)壁相固定的設(shè)計，從而實現(xiàn)關(guān)節(jié)之間的俯仰－翻轉(zhuǎn)運動。我們在此基礎(chǔ)上還增加了空轉(zhuǎn)嚙合齒輪結(jié)構(gòu)設(shè)計，采用三個軸線垂直的直線圓錐齒輪組作為傳動機構(gòu)。關(guān)節(jié)單元構(gòu)成示意如圖3 所示。

圖3 關(guān)節(jié)單元構(gòu)成示意圖

其工作原理為主動齒輪通過舵機與端部活動關(guān)節(jié)固定，從動齒輪通過軸與中間固定管連接，其中一個從動齒輪與中間固定管固定，無相對轉(zhuǎn)動，另一個從動齒輪可自由轉(zhuǎn)動。當(dāng)舵機驅(qū)動主動齒輪旋轉(zhuǎn)時，主動齒輪與固定端從動齒輪相對轉(zhuǎn)動，帶動端部活動管轉(zhuǎn)動，實現(xiàn)關(guān)節(jié)沿一個方向的旋轉(zhuǎn)。而可自由轉(zhuǎn)動的空轉(zhuǎn)端從動齒輪用于補償主動齒輪單側(cè)嚙合導(dǎo)致的受力不均勻，更好的保障了裝置運行的平穩(wěn)性。同時也在一定程度上延緩了舵機驅(qū)動軸的使用壽命，另一個關(guān)節(jié)方向的轉(zhuǎn)動與上述同理。整體效果如圖4 所示。

圖4 最終方案整體效果圖

■1.4 蛇身結(jié)構(gòu)設(shè)計

由于在實際應(yīng)用場景中蛇身需滿足蜿蜒擺動、前后移動的多方向運動，擬在蛇身布置萬向球裝置（牛眼軸承），優(yōu)先考慮選用非金屬萬向球軸承，按間隔60°布置，當(dāng)機器人在海底管道內(nèi)部進行蜿蜒扭曲運動時，萬向輪可依靠裝置與管道內(nèi)壁的摩擦實現(xiàn)萬向轉(zhuǎn)動，有效降低蛇身與管道間的摩擦，有效地解決了裝置在海底管道等狹小水下空間移動靈活性的問題。蛇身萬向輪位置結(jié)構(gòu)如圖5 所示。

蛇身模塊的首個關(guān)節(jié)和尾部關(guān)節(jié)均為左右偏轉(zhuǎn)擺動關(guān)節(jié)，以便于更好的調(diào)整運動方向及攝像角度。蛇身整體結(jié)構(gòu)中共有4 個左右翻轉(zhuǎn)關(guān)節(jié)及3 個抬升關(guān)節(jié)，關(guān)節(jié)之間均為模塊化連接，可根據(jù)具體應(yīng)用場景進行特殊裝配。

關(guān)節(jié)裸露位置在外側(cè)設(shè)置了密封防水防塵罩（橡膠防塵波紋管）裝置，在實現(xiàn)裝置整體防水功能的基礎(chǔ)上，同時也防止了因水下環(huán)境中的揚沙、水草進入裝置內(nèi)部而造成的運動故障。蛇身防水防塵罩位置結(jié)構(gòu)如圖5 所示。

綜上所述，本裝置主要由蛇頭、蛇尾結(jié)構(gòu)（驅(qū)動機構(gòu)）、蛇身結(jié)構(gòu)（防護及輔助運動機構(gòu)）及關(guān)節(jié)結(jié)構(gòu)（運動姿態(tài)調(diào)整機構(gòu)）三部分構(gòu)成，整體結(jié)構(gòu)如圖6 所示。出于裝置結(jié)構(gòu)清晰化的目的，作爆炸視圖分析如圖7 所示。

圖6 整體結(jié)構(gòu)示意圖

圖7 裝置爆炸視圖

2 運動姿態(tài)分析

該裝置在水下場景中工作時的運動姿態(tài)主要參照了“蛇形蜿蜒曲線”的概念，其運動原理如圖8 所示，該類型運動主要依靠水推器驅(qū)動結(jié)構(gòu)與水平翻轉(zhuǎn)關(guān)節(jié)單元的配合運動。首先，利用橫向水推器驅(qū)動結(jié)構(gòu)向前航行，在航行過程中，第一水平翻轉(zhuǎn)單元進行小角度轉(zhuǎn)動進入正弦運動軌跡，達到圖8 中的b 姿態(tài)，之后，后接的水平翻轉(zhuǎn)單元也依次完成小角度翻轉(zhuǎn)以完成最終的蜿蜒運動。

圖8 蜿蜒運動原理圖

3 控制系統(tǒng)設(shè)計

水下機器人總體控制方案，如圖9 所示，控制系統(tǒng)主要包括水上控制器、姿態(tài)控制系統(tǒng)、圖像控制系統(tǒng)三部分。姿態(tài)控制是對水下機器人進行姿態(tài)調(diào)整，包括水下機器人懸停控制、水下機器人前進、后退以及下潛等控制。圖像控制主要是對于水下圖像的采集，包括拍照、錄像等操作。

圖9 總體控制方案

■3.1 姿態(tài)控制系統(tǒng)

圖10 為姿態(tài)控制系統(tǒng)總體框圖。機器人的運動控制系統(tǒng)需要完成的任務(wù)，包括機器人所有自由度的協(xié)調(diào)控制、機器人與上位機軟件的實時通訊，以及在自動模式下控制機器人進行自平衡調(diào)整。

圖10 姿態(tài)控制系統(tǒng)總體框圖

3.1.1 姿態(tài)算法設(shè)計

姿態(tài)控制原理圖，如圖11 所示，水下機器人接收遙控器發(fā)送來的姿態(tài)角，作為期望角度輸入到控制系統(tǒng)中與姿態(tài)解算算法解算出的實際姿態(tài)角度進行求取偏差，分別經(jīng)過各自的PID 控制器進行PID 運算，運算結(jié)果轉(zhuǎn)化成電機調(diào)速的PWM 方波來調(diào)節(jié)四個電機的轉(zhuǎn)速，從而調(diào)節(jié)水下機器人的姿態(tài)和運動。調(diào)節(jié)后的姿態(tài)角又進過姿態(tài)反饋環(huán)反饋給了輸入為下一次控制做準(zhǔn)備。經(jīng)過反復(fù)試驗調(diào)試發(fā)現(xiàn)采用單級PID 控制飛行姿態(tài)。水下機器人懸停則是姿態(tài)算法控制的一種特殊的情況，即期待的橫滾角設(shè)定在零度。

圖11 姿態(tài)控制原理圖

3.1.2 電機伺服控制方式

水下機器人的控制具體實現(xiàn)方案，如圖12 所示，采用開環(huán)控制和閉環(huán)控制相結(jié)合的方式。

圖12 控制原理圖

開環(huán)控制上位機可以直接控制水下機器人的運動，也可以利用控制箱內(nèi)的搖桿，通過模-數(shù)轉(zhuǎn)換器，把搖桿的模擬量轉(zhuǎn)化成數(shù)字量傳入STM32F407，再通過CAN 總線傳入水下的控制器直接控制PWM 的占空比來控制電機的轉(zhuǎn)速和轉(zhuǎn)向。閉環(huán)控制則是利用姿態(tài)傳感器的反饋水下機器人姿態(tài)，然后對水下機器人進行位置控制，但為了獲得更多和更高質(zhì)量獲得角度數(shù)據(jù)通常使用6 軸姿態(tài)傳感器（陀螺儀）即MPU6500，通過該傳感器可以通過姿態(tài)解算算法的獲得相對準(zhǔn)確歐拉角，把歐拉角再傳入姿態(tài)控制器，通過姿態(tài)解算出控制每個電機轉(zhuǎn)動PWM 調(diào)整水下機器人到合適的姿態(tài)。

■3.2 圖像采集系統(tǒng)

3.2.1 圖像采集系統(tǒng)原理分析

圖像采集系統(tǒng)原理，如圖13 所示，圖像采集的主控板選擇樹莓派，樹莓派通過控制舵機轉(zhuǎn)動從而控制小型云臺的位置，改變攝像頭位置。攝像頭則通過SCI 接口直接連接到樹莓派，通過遠程連接，將電腦和樹莓派相連，控制攝像頭完成響應(yīng)的動作。

圖13 圖像采集系統(tǒng)原理圖

3.2.2 圖像采集系統(tǒng)云臺設(shè)計

圖像采集云臺，如圖14 所示，該云臺由兩個舵機組成，上邊的舵機控制攝像頭俯仰角度，下邊舵機控制攝像頭的方位角。使用30~150 度的云臺機制， 這個范圍足夠用于相機。

圖14 圖像采集云臺

4 實驗測試分析

為了測試裝置在實際應(yīng)用中的運動性能，分別測試裝置在無障礙物清澈水下環(huán)境、無障礙物渾濁水下環(huán)境、有障礙物渾清澈水下環(huán)境、有障礙物渾濁水下環(huán)境四種場景下通過5m 水平距離所需時間。具體數(shù)據(jù)如表1 所示。

表1 實驗數(shù)據(jù)記錄表

表1 數(shù)據(jù)表明，該裝置在無障礙物清澈環(huán)境和無障礙物渾濁環(huán)境中利用水推起器結(jié)構(gòu)航行通過5m 水平距離的時間分別為12.83s 和13.83s，在有障礙物清澈環(huán)境和有障礙物渾濁環(huán)境中，航行通過5m 水平距離的時間分別為18.89s和24.30s。分析數(shù)據(jù)可知，水下環(huán)境的清澈程度及障礙物數(shù)量會對裝置的水下識別航行速度產(chǎn)生影響，其中存在障礙物因素對于裝置航行的干擾程度相較于環(huán)境清澈程度的干擾來說更大。該裝置在各項針對性實驗過程中運行平穩(wěn)，無明顯卡頓現(xiàn)象。

5 總結(jié)

本文創(chuàng)新之處：（1）采用“橫縱雙向”水推器驅(qū)動結(jié)構(gòu)，并結(jié)合“雙驅(qū)動模式”，運動效率較高。（2）利用錐齒傳動關(guān)節(jié)單元實現(xiàn)“蛇形曲線”運動，同時兼顧了運動精度及靈活性。（3）結(jié)合了模塊化結(jié)構(gòu)設(shè)計，實現(xiàn)了“即插即用”的功能。

浩瀚的海洋中蘊藏著極其豐富的資源，而海洋探索技術(shù)的落后所暴露出的問題也在隨著海洋探索研究的逐步深入而逐漸浮現(xiàn)，所以目前建立一套完善的海洋裝備體系尤為重要。在未來，或許針對水下蛇形機器人的進一步相關(guān)研究可以幫助我們實現(xiàn)在海洋探索領(lǐng)域上的技術(shù)突破。