基于蟻群算法的水下機(jī)器人機(jī)械臂工作路徑優(yōu)化

林樹鋒, 王冬姣, 葉家瑋, 劉 鯤

?

基于蟻群算法的水下機(jī)器人機(jī)械臂工作路徑優(yōu)化

林樹鋒, 王冬姣, 葉家瑋, 劉 鯤

(華南理工大學(xué) 土木與交通學(xué)院, 廣州 廣東, 510641)

為了提高水下機(jī)器人機(jī)械臂對(duì)導(dǎo)管架清污的工作效率, 縮短電機(jī)持續(xù)高負(fù)荷工作的時(shí)間, 在采用聲吶回波數(shù)據(jù)識(shí)別工作區(qū)域附著物分布圖的基礎(chǔ)上, 分別以工作時(shí)間最短和能耗最小為優(yōu)化目標(biāo), 提出基于蟻群算法的機(jī)械臂工作路徑規(guī)劃算法。通過MATLAB和PRO/E軟件建立機(jī)械臂三維運(yùn)動(dòng)學(xué)模型, 在某一隨機(jī)附著物分布條件下, 采用以上2種路徑優(yōu)化算法得到相應(yīng)的優(yōu)化路徑。仿真結(jié)果表明, 與傳統(tǒng)的掃描路徑相比, 文中提出的2種優(yōu)化算法在滿足工作區(qū)域范圍的前提下, 能提高機(jī)械臂2倍以上的工作效率并降低50%的能耗, 證明了該路徑優(yōu)化算法的有效性。

水下機(jī)器人; 蟻群算法; 路徑優(yōu)化

0 引言

導(dǎo)管架平臺(tái)是近海油氣開采的主要基礎(chǔ)設(shè)施, 其安全性能關(guān)系到人員和生產(chǎn)安全。而在平臺(tái)服役期間, 由于大量海洋生物長(zhǎng)時(shí)間附著在導(dǎo)管架上, 會(huì)造成導(dǎo)管架平臺(tái)樁基的嚴(yán)重腐蝕, 從而危害平臺(tái)安全。據(jù)統(tǒng)計(jì)每年約有8%～10%的海洋平臺(tái)因?yàn)楹Ｑ笊锔g發(fā)生過事故, 造成的損失高達(dá)數(shù)百億美元[1]。因此, 導(dǎo)管架水下部分結(jié)構(gòu)一般需要定期清理維護(hù)。

目前, 國(guó)內(nèi)外研究機(jī)構(gòu)針對(duì)導(dǎo)管架附著生物主要采用刷具和高壓水射流技術(shù)的清洗方式, 并成功研制出模型機(jī)用于作業(yè), 例如哈爾濱工程大學(xué)機(jī)器人研究所研制的永磁吸附履帶式攀爬機(jī)器人[2]、美國(guó)卡內(nèi)基梅隆大學(xué)研制的干燥橡膠粘附材料微型機(jī)器人等[3]。這類機(jī)器人均采用壁面吸附原理, 體積較小, 負(fù)載能力較低, 限制了其工作強(qiáng)度。針對(duì)上述問題, 文中采用雙抱臂系統(tǒng)設(shè)計(jì)了一臺(tái)用于深海除污的水下機(jī)器人。機(jī)器人配備了一個(gè)6自由度的機(jī)械臂, 在機(jī)械臂末端安裝了高壓水槍, 如圖1所示。由于深海作業(yè)環(huán)境下海水能見度低, 除了裝有攝像頭外, 通過借鑒湯渭霖[4]、朱利超等[5]利用聲吶目標(biāo)回波的亮點(diǎn)模型原理進(jìn)行聲吶成像上的研究成果, 在機(jī)器人本體裝配了一套用于識(shí)別工作區(qū)域的聲吶系統(tǒng)。

圖1 雙抱臂機(jī)器人

導(dǎo)管架平臺(tái)結(jié)構(gòu)體積龐大, 水下清污作業(yè)工作量大, 如何合理規(guī)劃?rùn)C(jī)器人的機(jī)械臂作業(yè)路徑, 高速有效地完成清洗任務(wù), 顯得十分關(guān)鍵。文中利用聲吶回波數(shù)據(jù)識(shí)別工作區(qū)域, 得到海蠣子等附著物分布圖像, 采用蟻群算法以時(shí)間最優(yōu)和能量最優(yōu)作為優(yōu)化目標(biāo), 規(guī)劃?rùn)C(jī)械臂的工作路徑,使其能夠高速有效地完成清洗任務(wù)。

1 機(jī)械臂工作路徑優(yōu)化理論

1.1 機(jī)械臂關(guān)節(jié)空間軌跡求解

機(jī)械臂主要由連桿和連桿間的關(guān)節(jié)組成。每個(gè)連桿用4個(gè)運(yùn)動(dòng)學(xué)參數(shù)描述, 即連桿長(zhǎng)度、連桿偏移量、關(guān)節(jié)角和扭轉(zhuǎn)角。這種用連桿參數(shù)描述機(jī)構(gòu)運(yùn)動(dòng)關(guān)系的規(guī)則稱為D-H參數(shù)[6]。

文中研究的水下機(jī)器人工作機(jī)械臂示意圖如圖2 所示, 其連桿主要幾何參數(shù)見表1。根據(jù)連桿參數(shù)可得到各連桿的變換矩陣為

圖2 6自由度機(jī)械臂簡(jiǎn)圖

表1 機(jī)械臂D-H參數(shù)表

1.2 蟻群優(yōu)化算法

蟻群算法是一種仿生學(xué)算法。螞蟻在覓食過程中會(huì)釋放信息素, 這些信息素會(huì)形成一條指示軌跡。從起點(diǎn)到終點(diǎn), 在短路徑上留下激素的量越多, 在長(zhǎng)路徑上留下的激素就越少。以此類推, 后來的螞蟻選擇激素濃度大的路徑概率就越大, 反之, 則越小[7]。圖3為蟻群覓食模擬原理圖。

圖3 蟻群覓食模擬圖

圖中:是蟻穴,是食物源, 螞蟻只能通過或由到。由于路徑更短, 螞蟻在其上留下的信息素強(qiáng)度高, 該路徑被其他螞蟻選擇的概率就高。隨著信息素的積累, 螞蟻趨向于路徑。

在路徑優(yōu)化問題中, 螞蟻隨機(jī)分配到各個(gè)目標(biāo)位置, 且各目標(biāo)位置只能被訪問一次, 故螞蟻(=1, 2, 3,…,)在點(diǎn)訪問下一個(gè)點(diǎn)的概率為

式中: ρ為信息素衰減系數(shù); 為上次搜索路徑后的信息素; 為第ｋ只螞蟻的搜索路徑; 為第ｋ只螞蟻在路徑上的信息素增量, Q為信息素增量系數(shù), 為本次搜索的最優(yōu)解, 與有關(guān)。蟻群算法步驟如圖4所示。

2 基于蟻群算法的機(jī)械臂路徑優(yōu)化

文中采用MATLAB和PRO/E軟件建立三維仿真系統(tǒng), 模擬水下機(jī)器人在直徑為1 m的導(dǎo)管架立柱上進(jìn)行作業(yè), 對(duì)機(jī)械臂進(jìn)行路徑優(yōu)化。機(jī)械臂的工作空間如圖5所示, 根據(jù)機(jī)械臂的工作空間及聲吶回波數(shù)據(jù)成像, 得到機(jī)器人當(dāng)前位置下可工作柱面上海洋生物附著位置信息, 即機(jī)械臂的工作目標(biāo)點(diǎn)。假設(shè)獲得的工作點(diǎn)分布如圖6所示。其中1號(hào)點(diǎn)為初始位姿末端所處的位置, 其余點(diǎn)均分布于圓柱面上, 隨機(jī)編號(hào)。目標(biāo)點(diǎn)的坐標(biāo)以及對(duì)應(yīng)的關(guān)節(jié)角度如表2所示。根據(jù)不同優(yōu)化目標(biāo), 對(duì)機(jī)械臂進(jìn)行運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)分析, 得到優(yōu)化軌跡。

2.1 能量最優(yōu)的優(yōu)化結(jié)果

針對(duì)深海水下機(jī)械臂, 運(yùn)用疊加原理將水動(dòng)力分解為靜水環(huán)境下的攪水力和來流沖擊力。采用Morison公式估算機(jī)械手的攪水力, 因機(jī)械手是慢速運(yùn)動(dòng), 故忽略輻射阻尼的影響, 只考慮機(jī)械手的附加質(zhì)量所引起的附加力矩。機(jī)械臂幾何外形近似長(zhǎng)方體, 附加質(zhì)量系數(shù)取1.2, 產(chǎn)生的附加轉(zhuǎn)動(dòng)慣量約為浮重條件下的14%。結(jié)合式(6)得到如表3所示的機(jī)械臂動(dòng)力學(xué)參數(shù)表。

圖5 機(jī)械臂工作空間

圖6 工作點(diǎn)分布的聲吶掃描成像結(jié)果

表2 導(dǎo)管架圓柱表面目標(biāo)點(diǎn)坐標(biāo)和關(guān)節(jié)角度(前10個(gè)點(diǎn))

表3 機(jī)械臂動(dòng)力學(xué)參數(shù)

根據(jù)表3計(jì)算結(jié)果, 建立以能量最優(yōu)為目標(biāo)的數(shù)學(xué)模型

圖7和圖8為以能量最優(yōu)為優(yōu)化目標(biāo)的優(yōu)化結(jié)果, 得到該種優(yōu)化方式下的最佳路徑: 1–22– 13–20–21–18–17–2–19–11–30–23–25–26–6–7–10–16–15–4–24–14–8–3–5–12–9–28–29–31–32–27。

圖7 能量最優(yōu)路徑優(yōu)化結(jié)果

圖8 能量最優(yōu)迭代曲線

2.2 時(shí)間最優(yōu)的優(yōu)化結(jié)果

在以時(shí)間最優(yōu)為優(yōu)化目標(biāo)的算法中, 不考慮機(jī)械臂4個(gè)大關(guān)節(jié)的差別, 假定每次只轉(zhuǎn)動(dòng)一個(gè)關(guān)節(jié), 且各關(guān)節(jié)轉(zhuǎn)動(dòng)相同角度所需的時(shí)間相同, 研究如何規(guī)劃目標(biāo)點(diǎn)的順序, 使機(jī)械臂的所有關(guān)節(jié)轉(zhuǎn)動(dòng)的角度之和最小, 即所用的時(shí)間最小。

其數(shù)學(xué)模型表達(dá)式

優(yōu)化結(jié)果如圖9和圖10所示。得到以時(shí)間最優(yōu)為優(yōu)化目標(biāo)的最佳路徑: 1–9–23–30–11–9–2– 17–21–18–20–13–22–26–25–10–6–7–12–5–16–15–4–14–3–8–29–32–31–28–27–24。

圖9 時(shí)間最優(yōu)路徑優(yōu)化結(jié)果

圖10 時(shí)間最優(yōu)迭代曲線

3 優(yōu)化方法對(duì)比分析

在評(píng)估中添加以掃描方式得到的路徑作為參照, 根據(jù)式(8)和式(10)計(jì)算這3種算法的路徑優(yōu)劣性, 其對(duì)照結(jié)果如圖11所示。由表可知, 3種路徑規(guī)劃中, 以能量消耗為優(yōu)化指標(biāo)時(shí), 第2種優(yōu)化方式僅僅比第1種多3%; 以時(shí)間耗費(fèi)為優(yōu)化指標(biāo)時(shí), 第1種優(yōu)化方式比第2種高13%, 這2種優(yōu)化方法結(jié)果差異較小; 相比前2種, 第3種傳統(tǒng)掃描路徑在2個(gè)指標(biāo)均高出1倍多, 也就是說在機(jī)械臂第2工作階段中, 無論采用能量最優(yōu)還是時(shí)間最優(yōu)的算法, 均能使機(jī)械臂的能量和時(shí)間消耗相比于掃描路徑方式節(jié)省50%以上, 大大提高機(jī)械臂的工作效率。

圖11 優(yōu)化方法對(duì)照結(jié)果

4 結(jié)束語(yǔ)

文中針對(duì)水下除污機(jī)器人的工作流程研究了基于能量和時(shí)間最優(yōu)的蟻群算法, 其中考慮了如何在利用聲吶成像原理獲取導(dǎo)管架平臺(tái)工作區(qū)域目標(biāo)點(diǎn)的基礎(chǔ)上, 求解目標(biāo)點(diǎn)與機(jī)械臂角度的數(shù)學(xué)關(guān)系, 建立機(jī)械臂轉(zhuǎn)動(dòng)角度與優(yōu)化目標(biāo)的數(shù)學(xué)模型, 并利用MATLAB軟件進(jìn)行仿真, 得到了最佳工作路徑。仿真結(jié)果表明該算法簡(jiǎn)單有效。

但文中求解的最終方案是假定機(jī)械臂預(yù)設(shè)工作路徑中不會(huì)出現(xiàn)碰撞問題, 這個(gè)與現(xiàn)實(shí)工作情況有一定差距, 需要在優(yōu)化算法中添加無碰撞約束條件, 這將是今后進(jìn)一步的研究方向。

[1] 魏羲. 淺談海洋生物污損對(duì)導(dǎo)管架平臺(tái)安全的影響[J].全面腐蝕控制, 2015, 29(2): 55-57. Wei Xi. Discussion on the Influence of Marine Biofouling of Jacket Platform Security[J]. Total Corrosion Control, 2015, 29(2): 55-57.

[2] 付宜利, 李志海. 爬壁機(jī)器人的研究進(jìn)展[J]. 機(jī)械設(shè)計(jì), 2008, 25(4): 1-5.Fu Yi-li, Li Zhi-hai. Researching Headway of Wall-Climbing Robots[J]. Journal of Machine Design, 2008, 25(4):1-5.

[3] Mel Siegel. Remote and Automated Inspection: Status and Prospects[C]//The First Join DoD/FAA/NASA Conference on Aging Aircraft. Ogden UT: DoD/FAA/NASA Conference on Aging Aircraft, 1997.

[4] 湯渭霖. 聲吶目標(biāo)回波的亮點(diǎn)模型[J]. 聲學(xué)學(xué)報(bào), 1994, 19(2): 92-100. Tang Wei-lin. Highlight Model of Echoes from Sonar Targets[J]. Acta Acustica, 1994, 19(2): 92-100.

[5] 朱利超, 魏鵬舉, 高杰, 等. 基于亮點(diǎn)模型的水下目標(biāo)近程回波仿真研究[J]. 艦船電子工程, 2011, 31(11): 153-155. Zhu Li-chao, Wei Peng-ju, Gao Jie, et al. Simulation of Echoes from Underwater Scaling Targets in Short Range Based on Highlight Model[J]. Ship Electronic Engine-ering, 2011, 31(11): 153-155.

[6] Denavit J, Hartenberg R S. A Kinematic Notation for Lower Pair Mechanisms Based on Matrices[J]. ASME Journal of Applied Mechanics, 1955, 77(6): 215-221.

[7] 吳慶洪, 張穎, 馬宗民. 蟻群算法綜述[J]. 微計(jì)算機(jī)信息, 2011, 27(9): 1-2, 5. Wu Qing-hong, Zhang Ying, Ma Zong-min. Review of Ant Colony Optimization[J]. Control & Automation, 2011, 27(9): 1-2, 5.

Working Path Optimization of Manipulator Arm of Underwater Robot Based on Ant Colony Algorithm

LIN Shu-feng, WANG Dong-jiao, YE Jia-wei, LIU Kun

(School of Civil and Transportation Engineering, South China University of Technology, Guangzhou, 510641, China)

To improve the efficiency of the manipulator arm of an underwater robot for cleaning jackets and to shorten the motor working time under high load, the sonar echo data are used to identify the distribution of attachments onto the working area,and two working path planning algorithms of manipulator arm based on ant colony algorithm is proposed by respectively taking the shortest working time and the minimum energy consumption as the optimization targets. A three-dimensional kinematic model of the manipulator arm is established through the software MATLAB and PRO/E. Two optimal paths are obtained by the proposed algorithms for a certain random attachment distribution. Simulation results show that compared with the traditional scan path, the proposed two working path planning algorithms increase the working efficiency of the manipulator arm by more than 2 times and reduce its energy consumption by 50% under the premise of satisfying the range of working area, verifying the feasibility of the two proposed path planning algorithms.

underwater robot; ant colony optimization; path optimization

林樹鋒, 王冬姣, 葉家瑋, 等. 基于蟻群算法的水下機(jī)器人機(jī)械臂工作路徑優(yōu)化[J]. 水下無人系統(tǒng)學(xué)報(bào), 2019, 27 (1): 45-50.

TP241.3; TE58

A

2096-3920(2019)01-0045-06

10.11993/j.issn.2096-3920.2019.01.008

2018-08-31;

2018-11-14.

國(guó)家重點(diǎn)研發(fā)計(jì)劃項(xiàng)目(2016YFC1400202); 廣東省科技項(xiàng)目(2015B010919006); 中國(guó)博士后面上基金資助(2017M6 22692).

林樹鋒(1993-), 男, 在讀碩士, 主要研究方向?yàn)樗聶C(jī)器人運(yùn)動(dòng)控制.

劉 鯤(1986-), 男, 講師, 主要研究方向?yàn)楹Ｑ蠊こ探Y(jié)構(gòu)振動(dòng)控制, 電子郵箱: kunliu_hit@hotmail.com.

(責(zé)任編輯: 陳 曦)