人工势场法因其平滑的路径被广泛应用于解决水面无人艇路径规划问题,但人工势场法与无人艇的结合会出现转向角过大、航迹不可控、局部最小值问题。本文研究一种基于视线法的人工势力场法,利用视线法确定出各期望航迹点的位置,通过目标点引力与障碍物斥力实现避障;修正新定义的引力点函数和障碍物斥力函数,使其更加适用于期望航迹点的避障。仿真结果表明,改进后的算法在多障碍物与大型障碍物环境中的航迹偏差分别降低了85.61%、13.2%,艏向角变化分别降低了59.52%、17.3%,且能够引导无人艇摆脱局部最小值环境。优化后的人工势场法有着更强的路径保持能力,更小的避障角度需求,对无人艇的操控性能要求也更低,大大提高了无人艇的行驶安全性, 具有一定的实际应用价值。
The artificial potential field method is widely used to solve the path planning problem of unmanned surface vehicle (USV) because of its smooth path. However, the combination of artificial potential field method and USV will cause problems such as excessive steering angle, uncontrollable track and local minimum. In this paper, an artificial force field method based on line of sight method is studied. The position of each desired track point is determined by line of sight method, and obstacle avoidance is realized by the attraction of target point and the repulsion of obstacles. The newly defined attraction point function and obstacle repulsion function are modified to make them more suitable for the obstacle avoidance of the desired track point. The simulation results show that the track deviation of the improved algorithm is reduced by 85.61% and 13.2%, and the change of the heading angle is reduced by 59.52% and 17.3% respectively in the environment of multiple obstacles and large obstacles, and the improved algorithm can guide the USV to get rid of the local minimum environment. The optimized artificial potential field method has stronger path maintaining ability, smaller obstacle avoidance angle demand, and lower control performance requirements for USV, which greatly improves the driving safety of USV and has certain practical application value.
2025,47(5): 126-131 收稿日期:2024-3-30
DOI:10.3404/j.issn.1672-7649.2025.05.019
分类号:U675.73
基金项目:江苏省研究生实践创新计划(SJCX23_2140)
作者简介:顾潮宏(1999 – ),男,硕士研究生,研究方向为船舶综合控制技术
参考文献:
[1] 王磊, 刘晶晶, 齐俊艳, 等. 基于改进人工势场法的AUV全局路径规划[J]. 河南理工大学学报(自然科学版), 2024, 43(1): 132-139.
[2] MARIN-PLAZA P, HUSSEIN A, MARTIN D, et al. Global and local path planning study in a ROS-Based research platform for autonomous vehicles[J]. Journal of Advanced Transportation, 2018, 20181-10.
[3] 葛甜, 岳佳豪. 改进人工势场法的避障轨迹规划[J]. 汽车实用技术, 2023, 48(23): 50-55.
[4] 张扬, 彭鹏菲, 曹杰. 基于改进APF算法的水面无人艇局部路径规划[J]. 兵器装备工程学报, 2023, 44(9): 42-48.
[5] 刘涛, 贾立校, 曹翔. 动态人工势场法的无人船避障路径规划[J]. 舰船科学技术, 2023, 45(5): 89-92.
[6] FAN X, GUO Y, LIU H, et al. Improved artificial potential field method applied for AUV path planning[J]. Mathematical Problems in Engineering, 2020(1): 1-21.
[7] SONG J, HAO C, SU J. Path planning for unmanned surface vehicle based on predictive artificial potential field[J]. International Journal of Advanced Robotic Systems, 2020, 17(2): 255689146.
[8] ZHU Z, YIN Y, LYU H. Automatic collision avoidance algorithm based on route-plan-guided artificial potential field method[J]. Ocean Engineering, 2023, 271(3): 1-23.
[9] CHU Y, WU Z, YUE Y, et al. PK-APF: path-keeping algorithm for USVs based on artificial potential field[J]. Applied Sciences, 2022, 12(16): 8201.
[10] LIU Z, SONG S, YUAN S, et al. ALOS-based USV path-following control with obstacle avoidance strategy[J]. Journal of Marine Science and Engineering, 2022, 10(9): 1203.
[11] WANG X, LIU J, PENG H, et al. A simultaneous planning and control method integrating APF and MPC to solve autonomous navigation for USVs in unknown environments[J]. Journal of Intelligent & Robotic Systems, 2022, 105(2): 36-52.