
浏览全部资源
扫码关注微信
河北工程大学 机械与装备工程学院, 河北 邯郸 056038
Received:04 April 2023,
Published Online:16 July 2024,
Published:31 July 2024
移动端阅览
Peng JI, Minghao GUO. Local Path Planning for Unmanned Ground Vehicles Based on Improved Artificial Potential Field Method in Frenet Coordinate System[J]. Acta Armamentarii, 2024, 45(7): 2097-2109.
Peng JI, Minghao GUO. Local Path Planning for Unmanned Ground Vehicles Based on Improved Artificial Potential Field Method in Frenet Coordinate System[J]. Acta Armamentarii, 2024, 45(7): 2097-2109. DOI: 10.12382/bgxb.2023.0305.
人工势场法由于运算量小、精度高
广泛应用于无人车的局部路径规划。针对传统人工势场法存在目标不可达、局部最小值及陷入U型障碍物的问题
提出一种基于Frenet坐标系下改进人工势场法的路径规划算法。构建Frenet坐标系来表述车辆避障运动
简化规划模型
解决路径规划中车辆与所在道路相对位置不易表述的问题。提出安全椭圆模型和预测距离的概念来调整势场影响区域
加入基于Frenet坐标系下的参考线势场及动态速度势场改进斥力场函数
解决车辆在静态和动态下的避障问题。利用数学仿真软件进行仿真
以不同车速在直道和弯道场景中对所提出的路径规划方法进行静态和动态避障仿真实验。研究结果表明:不同车速下的前轮转角、横摆角速度均控制在较小范围内
改进算法可以有效解决传统人工势场法的缺陷
同时与快速搜索随机树(Rapidly-exploring Random Tree
RRT)算法相比
其在避障过程中路径规划计算效率提高了42.8%
改进算法优势明显。
The artificial potential field method is widely used in the local path planning for unmanned ground vehicle (UGV) due to its small amount of computation and high accuracy. For the problems of target unreachability
local minimum and falling into U-shaped obstacles existing in the conventional artificial potential field method
a local path planning algorithm based on the improved artificial potential field method in Frenet coordinate system is proposed. In this paper
the Frenet coordinate system is used to describe the UGV’s obstacle avoidance movement
which simplifies the planning model and addresses the difficulty in expressing the relative position of UGV and the road during path planning. A safety ellipse model and the concept of prediction distance are proposed to adjust the influence area of the potential field. Additionally
the repulsive field function is improved by adding the reference line potential field and the dynamic velocity potential field based on the Frenet coordinate system. These modifications enable the UGVs to avoid obstacles under both static and dynamic conditions. The path planning methods are proposed to launch the static and dynamic obstacle avoidance simulation experiments with different vehicle speeds in straight and curved road scenarios using mathematical simulation software. The results demonstrate that the front wheel turning angle and traverse angular velocity at different vehicle speeds are controlled within a small range
and the improved algorithm can effectively solve the defects of the conventional artificial potential field method. Besides
compared with the rapidly-exploring random tree(RRT) algorithm
the computational efficiency of path planning of the improved algorithm in the obstacle avoidance process is improved by 42.8%
and achieves better computational performance.
翟丽 , 张雪莹 , 张闲 , 等 . 基于势场法的无人车局部动态避障路径规划算法 [J ] . 北京理工大学学报 , 2022 , 42 ( 7 ): 696 - 705 .
ZHAI L , ZHANG X Y , ZHANG X , et al . Local dynamic obstacle avoidance path planning algorithm for unmanned vehicles based on potential field method [J ] . Transactions of Beijing Institute of Technology , 2022 , 42 ( 7 ): 696 - 705 . (in Chinese)
牛秦玉 , 李美凡 , 赵勇 . 改进人工势场法的AGV路径规划算法研究 [J ] . 机床与液压 , 2022 , 50 ( 17 ): 19 - 24 . DOI: 10.3969/j.issn.1001-3881.2022.17.004 http://doi.org/10.3969/j.issn.1001-3881.2022.17.004 针对传统人工势场法路径规划中存在的局部极小值和目标不可达问题,提出了一种面向AGV路径规划的改进人工势场法。该算法将道路边界障碍化,对障碍物密集区域的障碍物进行连锁处理,在斥力函数中引入目标点与AGV间的距离因数,在局部极小值点附近合适位置增加虚拟障碍物。仿真结果表明:改进算法可以有效解决局部极小值问题和目标不可达问题,同时使AGV避开障碍物陷阱成功到达目标点。
NIU Q Y , LI M F , ZHAO Y . Research on AGV path planning algorithm based on improved artificial potential field method [J ] . Machine and Hydraulic , 2022 , 50 ( 17 ): 19 - 24 . (in Chinese)
YUAN C C , WENG S F , SHEN J , et al . Research on active collision avoidance algorithm for intelligent vehicle based on improved artificial potential field model [J ] . International Journal of Advanced Robotic Systems , 2020 , 17 ( 3 ): 172988 142091123.
修彩靖 , 陈慧 . 基于改进人工势场法的无人驾驶车辆局部路径规划的研究 [J ] . 汽车工程 , 2013 , 35 ( 9 ): 808 - 811 .
XIU C J , CHEN H . Research on local path planning of autonomous vehicles based on improved artificial potential field method [J ] . Automotive Engineering , 2013 , 35 ( 9 ): 808 - 811 . (in Chinese)
陈相茹 . 基于人工势场理论的车辆行驶路径建模研究 [D ] . 长春 : 吉林大学 , 2020 .
CHEN X R . Research on vehicle driving path modeling based on artificial potential field theory [D ] . Changchun : Jilin University , 2020 . (in Chinese)
李二超 , 王玉华 . 改进人工势场法的移动机器人避障轨迹研究 [J ] . 计算机工程与应用 , 2022 , 58 ( 6 ): 296 - 304 . DOI: 10.3778/j.issn.1002-8331.2108-0122 http://doi.org/10.3778/j.issn.1002-8331.2108-0122 针对传统人工势场法在多障碍物复杂环境的全局路径规划中出现的目标不可达、易陷入陷阱区域以及局部极小点问题,提出一种简化障碍物预测碰撞人工势场法(simplified obstacles and predict collision of artificial potential field method,SOPC-APF),算法引入预测碰撞思想,在机器人未进入陷阱区域或者极小点问题前做出决策;对于多障碍物的斥力与目标点的引力产生的合力使机器人陷入震荡,提出简化障碍物,即简化为影响范围内目标点一侧的受限障碍物;针对目标不可达问题,在碰撞预测基础上,设定虚拟目标点,经改进的斥力函数引导机器人快速生成一条平滑、平稳、无碰撞的路径。通过与传统算法、改进APF算法以及改进蚁群算法的仿真对比实验表明,SOPC-APF有效解决了人工势场法不适用于多障碍物复杂环境的问题,以及传统算法容易陷入陷阱区域和局部极小点问题。
LI E C , WANG Y H . Research on obstacle avoidance trajectory of mobile robot based on improved artificial potential field method [J ] . Computer Engineering and Application , 2022 , 58 ( 6 ): 296 - 304 . (in Chinese)
孙鹏耀 , 黄炎焱 , 潘尧 . 基于改进势场法的移动机器人路径规划 [J ] . 兵工学报 , 2020 , 41 ( 10 ): 2106 - 2121 . DOI: 10.3969/j.issn.1000-1093.2020.10.021 http://doi.org/10.3969/j.issn.1000-1093.2020.10.021 针对传统势场法存在的路径不被识别、局部极小陷阱、振荡问题,提出适用于复杂障碍环境情况下机器人路径规划、结合多行为策略与可变影响范围的势场法。通过对障碍物影响范围做可变处理,消除问题共同必要条件,提前规避路径不识别、多障碍区导致的振荡、多障碍区导致的局部极小陷阱3个问题;采取新的步进与振荡分类方式,设计多行为行动策略,并给出各行为的准确起止条件,通过预判问题的共同表现形式以及起止条件的衔接进行行为切换,提前规避单障碍区导致的局部极小陷阱和单障碍区导致的振荡2个问题;基于数学仿真软件MATLAB平台的仿真结果验证所提方法在战场复杂障碍环境下的有效性与稳定性,与传统势场法、动态窗口法、A星算法、快速随机树算法的对比结果更突出了该方法的可行性与优越性。
SUN P Y , HUANG Y Y , PAN Y . Mobile robot path planning based on improved potential field method [J ] . Acta Armamentarii , 2020 , 41 ( 10 ): 2106 - 2121 . (in Chinese)
HOU P Q , PAN H , GUO C . Simulation research for mobile robot path planning based on improved artificial potential field method recommended by the AsiaSim [J ] . International Journal of Modeling, Simulation and Scientific Computing (English) , 2017 ( 2 ): 008 .
王沙晶 , 陈建业 . 基于Frenet坐标系的智能车运动规划研究 [J ] . 移动电源与车辆 , 2019 , 195 ( 1 ): 22 - 29 .
WANG S J , CHEN J Y . Research on motion planning of intelligent vehicle based on Frenet coordinate system [J ] . Mobile Power and Vehicle , 2019 , 195 ( 1 ): 22 - 29 . (in Chinese)
魏民祥 , 滕德成 , 吴树凡 . 基于Frenet坐标系的自动驾驶轨迹规划与优化算法 [J ] . 控制与决策 , 2021 , 36 ( 4 ): 815 - 824 .
WEI M X , TENG D C , WU S F . Autonomous driving trajectory planning and optimization algorithm based on Frenet coordinate system [J ] . Control and Decision , 2021 , 36 ( 4 ): 815 - 824 . (in Chinese)
刘冰雁 , 叶雄兵 , 方胜良 , 等 . 基于Frenet和改进人工势场的在轨规避路径自主规划 [J ] . 北京航空航天大学学报 , 2021 , 47 ( 4 ): 731 - 741 .
LIU B Y , YE X B , FANG S L , et al . On-orbit avoidance path autonomous planning based on Frenet and improved artificial potential field [J ] . Journal of Beijing University of Aeronautics and Astronautics , 2021 , 47 ( 4 ): 731 - 741 . (in Chinese)
王威 , 陈慧岩 , 马建昊 , 等 . 基于Frenet坐标系和控制延时补偿的智能车辆路径跟踪 [J ] . 兵工学报 , 2019 , 40 ( 11 ): 2336 - 2351 . DOI: 10.3969/j.issn.1000-1093.2019.11.019 http://doi.org/10.3969/j.issn.1000-1093.2019.11.019 对智能车辆路径跟踪问题中存在的控制延时问题进行研究。前轮转角表述为纯滞后和1阶惯性延时的串联结构模型,通过使用Matlab/Simulink建立转向控制延时模型,并对实车采集的转向控制数据进行分析,完成延时模型的参数辨识;基于V-REP和ROS搭建仿真测试平台,根据延时模型的辨识结果模拟转向响应特性,实现与实车转向特性等效的控制延时效果;基于Frenet坐标系和运动学、动力学模型构建不考虑控制延时和考虑控制延时的模型预测控制(MPC)路径跟踪控制器,使得控制器可以直接扩展到多车编队行驶场景;在V-REP仿真环境中设置以5 m/s、10 m/s、20 m/s车 速采集的变曲率参考路径,先针对无延时系统考察不考虑控制延时的MPC路径跟踪控制器,获得了平均跟踪误差低于0.22 m的控制效果,验证了不考虑控制延时的MPC控制器在处理无延时车辆系统路径跟踪问题的跟踪性能,再针对大延时车辆系统对比测试两种MPC控制器。试验结果表明:考虑控制延时的MPC控制器相比不考虑控制延时的MPC控制器取得了较大的效果提升,特别是在最大跟踪误差和航向误差指标上表现优异,平均跟踪误差降低了83.7%,最大跟踪误差降低了74.4%;对于高延时系统,低速工况下考虑延时的运动学MPC表现更好,而高速工况动力学MPC表现出了更加稳定的跟踪性能,20 m/s延时试验中仅考虑控制延时的动力学MPC控制器安全地跑完了全程。
WANG W , CHEN H Y , MA J H , et al . Intelligent vehicle path tracking based on Frenet coordinate system and control delay compensation [J ] . Acta Armamentarii , 2019 , 40 ( 11 ): 2336 - 2351 . (in Chinese) DOI: 10.3969/j.issn.1000-1093.2019.11.019 http://doi.org/10.3969/j.issn.1000-1093.2019.11.019 The path tracking problem for intelligent vehicle with delayed control inputs is studied. The cramping angle is expressed as a series structure model with pure lag and first-order inertial delay, and a steering control delay model is established using Matlab/Simulink. The collected steering control data of an actual vehicle is analyzed for parameter identification of the proposed delay model.The equivalent delay performance in simulation environment based on V-REP and ROS is implemented. The model predictive control (MPC)-based path tracking controllers without or with considering delay control are designed based on Frenet coordinates, and the kinematic and dynamics models, which can also be used for marching vehicle formation. A curvature-variant reference paths collected at 5, 10 and 20 m/s are set in V-REP simulation environment. Three curvature-variant reference paths are presented. For the MPC path tracking controller without delay modeling, the average tracking error is less than 0.22 m for a vehicle platform without control delay. The MPC controllers with and without delay modeling are tested to compare their tracking performances for the vehicle system with long control delay. Simulated results indicate that the average and maximum tracking errors of MPC controller with delay modeling are 83.7% and 74.4% less than those of MPC controller without delay modeling when they are used on a vehicle with delayed control inputs. The kinematics-based MPC controller performs better at low speed, whereas the dynamics-based MPC controller performs better at high speed. Only dynamics-based MPC controller with delay modeling completed the whole test safely at 20 m/s on the vehicle with delayed control. Key
袁春 , 龚城 , 何成诚 , 等 . Frenet坐标系及凸近似避障原理的无人车局部路径规划 [J ] . 重庆理工大学学报(自然科学) , 2022 , 36 ( 4 ): 59 - 67 .
YUAN C , GONG C , HE C C , et al . Frenet coordinate system and convex approximation obstacle avoidance principle of unmanned vehicle local path planning [J ] . Journal of Chongqing University of Technology(Natural Science) , 2022 , 36 ( 4 ): 59 - 67 . (in Chinese)
李萌 . 基于Frenet坐标系的智能车辆多场景轨迹规划研究 [D ] . 哈尔滨 : 哈尔滨工业大学 , 2021 .
LI M . Research on multi-scenario trajectory planning of intelligent vehicles based on Frenet coordinate system [D ] . Harbin : Harbin Institute of Technology , 2021 . (in Chinese)
WERLING M , ZIEGLER J , KAMMEL S , et al . Optimal trajectory generation for dynamic street scenarios in a Frenét Frame [C/OL ] //Proceedings of 2010 IEEE International Conference on Robotics and Automation. Anchorage, AK, US:IEEE , 2010 .
陈天德 , 黄炎焱 , 沈炜 . 基于虚拟障碍物法的无震荡航路规划 [J ] . 兵工学报 , 2019 , 40 ( 3 ): 651 - 658 . DOI: 10.3969/j.issn.1000-1093.2019.03.025 http://doi.org/10.3969/j.issn.1000-1093.2019.03.025 人工势场法作为路径规划的一种算法,凭借其解算得到的平滑航路,特别适用于不够灵活的移动机器人、智能体的路径规划。由于人工势场法自身不可避免地存在局部极小值以及算法执行不可避免的离散化,导致航路点解算可能会陷入局部极小值陷阱而进入死循环以及出现航路点震荡问题。针对局部极小值陷阱问题,提出改进型虚拟障碍物法;对虚拟障碍物位置的确定,引入了威胁区的概念,并提出了一个确定标准。针对航路点震荡问题,提出过滤震荡点法。仿真实验证明:改进型虚拟障碍物法能够有效地使陷入局部极小值陷阱的航路点解算,成功逃出陷阱;过滤震荡点法能够有效地消除震荡航路点,得到相对平滑的航路。
CHEN T D , HUANG Y Y , SHEN W . Shock-free route planning based on virtual obstacle method [J ] . Acta Armamentarii , 2019 , 40 ( 3 ): 651 - 658 . (in Chinese)
韩宇洪 . 基于改进人工势场法的无人车避障路径规划研究 [D ] . 重庆 : 重庆理工大学 , 2020 .
HAN Y H . Research on obstacle avoidance path planning of unmanned vehicles based on improved artificial potential field method [D ] . Chongqing : Chongqing University of Technology , 2020 . (in Chinese)
朱伟达 . 基于改进型人工势场法的车辆避障路径规划研究 [D ] . 镇江 : 江苏大学 , 2017 .
ZHU W D . Research on vehicle obstacle avoidance path planning based on improved artificial potential field method [D ] . Zhenjiang : Jiangsu University , 2017 . (in Chinese)
范世鹏 , 祁琪 , 路坤锋 , 等 . 基于改进人工势场法的巡航导弹自主避障技术 [J ] . 北京理工大学学报 , 2018 , 38 ( 8 ): 828 - 834 .
FAN S P , QI Q , LU K F , et al . Autonomous obstacle avoidance technology of cruise missile based on improved artificial potential field method [J ] . Transactions of Beijing Institute of Technology , 2018 , 38 ( 8 ): 828 - 834 . (in Chinese)
RASEKHIPOUR Y , KHAJEPOUR A , CHEN S K , et al . A potential field-based model predictive path-planning controller for autonomous road vehicles [J ] . IEEE Transactions on Intelligent Transportation Systems , 2017 , 18 ( 5 ): 1255 .
0
Views
3905
下载量
0
CNKI被引量
Publicity Resources
Related Articles
Related Author
Related Institution
京公网安备11010802024360号