A Path Planning Method Based on Artificial Vector Field for Autonomous Recovery of AUV
-
摘要: 针对自主水下航行器(AUV)水下自主回收过程中的路径规划问题, 采用人工矢量场法规划回收路径。将回收过程划分为回坞导引阶段和入坞阶段, 其中回坞导引阶段以入坞预备点为目标点, 使用传统的人工矢量场法为AUV规划出一条无障碍路径; 而入坞阶段则采用模糊变系数矢量场法, 定义回收入口处的3个虚拟目标点, 将AUV到回收中轴线的距离作为输入, 通过模糊规则调整虚拟目标点的引力系数, 使人工引力场的梯度方向指向回收入口, AUV沿光滑的入坞路径以期望的姿态驶进回收入口。仿真结果证明了该路径规划方法的有效性。Abstract: To solve the path planning problem of autonomous underwater vehicle (AUV) in the process of underwater autonomous recovery, an artificial vector field method is adopted. The whole autonomous recovery process is divided into the homing guidance stage and the docking stage. In the homing guidance stage, the preparatory point for docking is taken as the goal, and an obstacle-free path is planned for AUV by the artificial vector field method. In the docking stage, the three virtual goal points at the recovery entrance of the dock are defined with a fuzzy variable-coefficient vector field method. Taking the distance between dock axis and AUV as the input, the coefficients of vector field are adjusted by a fuzzy control method, and the gradient direction of artificial attraction force field is pointed to the entrance of dock by calculating the attraction force coefficients of the virtual target points by fuzzy rules. Hence, AUV can dock into the recovery entrance along the smooth path in the desired posture. Simulation results verify the effectiveness of the presented method.
-
[1] Park S Y, Jun B H, Lee P M, et al. Experiment on Vision Guided Docking of an Autonomous Underwater Vehicle Using One Camera[J], Oceanic Engineering, 2009, 36(1): 48-61. [2] Feezor M D, Sorrell Y, Blankinship P R, et al. Autonomous Underwater Vehicle Homing/Docking via Electromagnetic Guidance[J]. Oceanic Engineering, 2001, 26(4): 515-521. [3] Batista P, Silvestre C, Oliveira P. A Sensor-Based Controller for Homing of Underactuated AUVs[J]. IEEE Transactions on Robotics, 2009, 25(3): 701-716. [4] 王会丽, 傅卫平.基于改进的势场函数的移动机器人路径规划[J]. 机床与液压, 2002, (6): 67-71.Wang Hui-li, Fu Wei-ping, Fang Zong-de, et al. A Path Plann Method for Mobile Robot Based on Improved Potential Field Function[J]. Machine Tool & Hydraulics, 2002, (6): 67-71. [5] Jantapremjit P, Wilson P A. Guidance-Control Based Path Following for Homing and Docking using an Autonomous Underwater Vehicle[C]//IEEE, 2008. [6] Jantapremjit P, Wilson P A. Control and Guidance for Homing and Docking Tasks using an Autonomous Underwater Vehicle[C]//The 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems, 2007: 3672-3677.
点击查看大图
计量
- 文章访问数: 1560
- HTML全文浏览量: 10
- PDF下载量: 720
- 被引次数: 0