Combining the curvature continuous feature of cubic B-spline and the superior global search performance of genetic algorithm, a docking path planning method suitable for underactuated AUV (autonomous underwater vehicle) is designed. A smooth 3-dimensional path from the start point to the end point is given for the homing stage in AUV recovery, by which appropriate AUV position and attitude required by the following guided docking stage are guaranteed. Firstly, geometrical constraints caused by underactuated AUV are analyzed, including terminal constraint and kinematical constraint. Secondly, an idea of determining 3-D path by selecting control points sequence is presented according to the features of B-spline curves. In the first step, some control points are selected through analyzing mission terminal constraints in template pattern. In the second step, the control points in the middle section are given out after adaptive heuristic search in the solution space by using gene algorithm, whose fitness function contains constraints of AUV motion like rotation and heaving respectively in horizontal and vertical plane. The curve defined by the previous two sections of control points finally satisfies all geometrical constraints. At last, semi-physical dynamical simulation experiments on path generation and tracking are carried out. The tracking result shows that the geometrical character of path matches the maneuverability of AUV. Position and attitude of AUV are suitable for the following guided docking stage while path tracking finished.
[1] 潘光,黄明明,宋保维,等.AUV 回收技术现状及发展趋 势[J].鱼雷技术,2008,16(6):10-14. Pan G, Huang M M, Song B W, et al. Current situation and development trend of AUV recovery technology[J]. Torpedo Technology, 2008, 16(6): 10-14.[2] Park J Y, Jun B H, Lee P M, et al. Experiments on vision guided docking of an autonomous underwater vehicle using one camera[J]. Ocean Engineering, 2009, 36(1): 48-61. [3] McEwen R S, Hobson B W, McBride L, et al. Docking control system for a 54-cm-diameter AUV[J]. IEEE Journal of Oceanic Engineering, 2008, 33(4): 550-562. [4] Davis D T. Precision control and maneuvering of the Phoenix autonomous underwater vehicle for entering a recovery tube[D]. Monterey, USA: Naval Postgraduate School, 1996: 67-81.[5] Cowen S, Briest S, Dombrowski J. Underwater docking of autonomous undersea vehicles using optical terminal guidance[C]//Oceans 97 MTS/IEEE Conference. Piscataway, USA: IEEE, 1997: 1143-1147.[6] Maire F, Prasser D, Dunbabin M, et al. A vision based target detection system for docking of an autonomous underwater vehicle[C]//Australasian Conference on Robotics and Automation. Sydney, Australia: Australian Robotics and Automation Association Inc., 2009.[7] Feezor M D, Sorrell F Y, Blankinship P R, et al. Autonomous underwater vehicle homing/docking via electromagnetic guidance[J]. IEEE Journal of Oceanic Engineering, 2001, 26(4): 515-521. [8] Deltheil C, Didier L, Hospital E, et al. Simulating an optical guidance system for the recovery of an unmanned underwater vehicle[J]. IEEE Journal of Oceanic Engineering, 2000, 25(4): 568-574. [9] 吴利红,闫鹏.海流作用下AUV 与圆锥状DOCK 水下对 接的水动力分析[C]//第十六届中国海洋(岸) 工程学会讨论 会论文集.北京:海洋出版社,2013:75-88. Wu L H, Yan P. Hydrodynamic analysis of underwater interfacing of AUV and conical DOCK under current circumstance[C]//Sixteenth Conference on Ocean and Coastal Engineering of China. Beijing: China Ocean Press, 2013: 75-88.[10] 潘光,王培,杜晓旭.不同攻角下AUV 回收过程中的水 动力规律[J].火力与指挥控制,2012,37(5):24-26. Pan G, Wang P, Du X X. Research on the law of the hydrodynamic during AUV recovery under different angle of attack[J]. Fire Control & Command Control, 2012, 37(5): 24-26.[11] Sotiropoulos P, Tosi N, Andritsos F, et al. Optimal docking pose and tactile hook-localisation strategy for AUV intervention: The DIFIS deployment case[J]. Ocean Engineering, 2012, 46: 33-45.[12] 吴利红,许文海,王利鹏.AUV 水下终端对接目标识别 与定位技术[J].大连海事大学学报:自然科学版,2014, 40(2):81-85. Wu L H, XuWH,Wang L P. Dock position and pose estimation algorithm for AUV underwater terminal docking[J]. Journal of Dalian Maritime University, 2014, 40(2): 81-85.[13] 王芳,万磊,李晔,等.欠驱动AUV 的运动控制技术综 述[J].中国造船,2010,51(2):227-241. Wang F, Wan L, Li Y, et al. A survey on development of motion control for underactuated AUV[J]. Shipbuilding of China, 2010, 51(2): 227-241.[14] Shang L J, Wang S. A path planning algorithm based on Bezier curves for underwater vehicles[J]. High Technology Letters, 2010, 16(3): 293-298.[15] 单恩忠.基于微分平坦与样条理论的自主泊车轨迹规划研 究[D].长沙:国防科学技术大学,2009:32-42. Shan E Z. Research on trajectory planning of auto-parking based on differential flatness and spline theory[D]. Changsha: National University of Defense Technology, 2009: 32-42.[16] 张超杰.基于微分平坦理论的飞行器轨迹规划方法研究[D].长沙:国防科学技术大学,2010:33-39. Zhang C J. Research on aircraft trajectory planning based on differential flatness theory[D]. Changsha: National University of Defense Technology, 2010: 33-39.[17] de Boor C. A practical guide to spline[M]. New York, USA: Springer-Verlag, 1978: 131-142.[18] 谭跃刚.非完整机器人的原理与控制[M].北京:科学出 版社,2011:25-32. Tan Y G. Principle and control of nonholonomic robots[M]. Beijing: Science Press, 2011: 25-32.[19] 施生达.潜艇操纵性[M].北京:国防工业出版社,1995: 35-43. Shi S D. Maneuverability of submarine[M]. Beijing: National Defense Industry Press, 1995: 35-43.[20] 陈国良,王煦法,庄镇泉,等.遗传算法及其应用[M]. 北京:人民邮电出版社,1996:69-75. Chen G L, Wang X F, Zhuang Z Q, et al. Genetic algorithm theory and application[M]. Beijing: Posts and Telecom Press, 1996: 69-75.[21] 李晔,姜言清,张国成,等.一种基于电子海图的欠驱动 AUV 区域搜索方案[J].机器人,2014,36(5):609-618. Li Y, Jiang Y Q, Zhang G C, et al. An underactuated AUVoriented region search method based on electronic chart[J]. Robot, 2014, 36(5): 609-618.