CN115328152B - 基于改进人工势场法的无人车局部实时避障路径规划方法 - Google Patents
基于改进人工势场法的无人车局部实时避障路径规划方法 Download PDFInfo
- Publication number
- CN115328152B CN115328152B CN202211077482.1A CN202211077482A CN115328152B CN 115328152 B CN115328152 B CN 115328152B CN 202211077482 A CN202211077482 A CN 202211077482A CN 115328152 B CN115328152 B CN 115328152B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- obstacle
- potential field
- relative
- dynamic
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 58
- 230000001133 acceleration Effects 0.000 claims abstract description 28
- 230000003068 static effect Effects 0.000 claims abstract description 26
- 230000008569 process Effects 0.000 claims abstract description 10
- 230000004888 barrier function Effects 0.000 claims description 8
- 238000012360 testing method Methods 0.000 claims description 8
- 238000012216 screening Methods 0.000 claims description 7
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 238000009499 grossing Methods 0.000 claims description 4
- 238000009795 derivation Methods 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 abstract description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005381 potential energy Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种基于改进人工势场法的无人车局部实时避障路径规划方法,其通过改进人工势场法静态障碍物的斥力势场函数,加入改进的距离调节因子,构建了水滴形斥力势场,可显著提高路径规划的精度与效率。方法在路径规划过程中,考虑了车辆运动学与动力学影响因素,在动态障碍物势场函数中加入了相对速度函数、相对加速度函数,解决了传统势场法对于动态避障工况无解的问题,规划的路径实时性和平顺性较好。通过对道路环境中存在复杂动态障碍物的工况进行分析,分别针对静态障碍物进行换道避障,针对侧向动态障碍物进行减速避障,规划算法静态规划效率高,且在动态规划中也有较高的适用性和有效性。
Description
技术领域
本发明属于无人车自动驾驶技术领域,具体涉及一种无人车的局部实时避障 路径规划方法。
背景技术
路径规划作为无人驾驶车辆避障功能的重要环节,其性能直接关系到车辆在 复杂场景下选择路径的质量和行驶的平稳度。当前用于无人车避障的现有技术中 所常用的人工势场法由于其模型结构简单,不需要很大的计算量就可以实时避障 并完成规划任务,具有结构简单、实时性好、生成的路径圆滑等优点,有利于在 实时避障与平滑轨迹控制等动态规划方面加以应用。然而,现有人工势场法在应用中仍然存在一些缺点与不足,常发生局部极小值、目标不可达、动态规划效果 差等情况。虽然本领域中有个别方案使用了改进的人工势场法,但依然存在静态 避障效率低、未考虑车辆运动学与动力学影响因素等弊端,导致了处理动态避障 工况时的无解、无法跟踪、避障工况单一等问题。
发明内容
有鉴于此,针对上述本领域中存在的技术问题,本发明提供了一种基于改进 人工势场法的无人车局部实时避障路径规划方法,具体包括以下步骤:
步骤一、针对履带式无人车所在的局部避障行驶环境,对车辆传感器检测到 的障碍物分别进行筛选,基于障碍物与车辆之间的距离去除对车辆轨迹规划无影 响的障碍物,然后评估剩余的静态和动态障碍物以及目标行驶目标点对轨迹规划 的影响风险用于后续建立行车势场环境;
步骤二、针对筛选的静态障碍物建立其对车辆的斥力势场函数模型,考虑车 速与车辆—障碍物相对位置的夹角α对斥力势场进行改进,得到以下改进后的水 滴形斥力势场函数模型Urep:
式中,krep为斥力势场正比例系数,dobs为车辆与静态障碍物距离,d0为障碍物 对车辆产生斥力的最大影响范围,kd为调节因子,md为常数;
步骤三、针对筛选的动态障碍物建立其对车辆的斥力势场函数模型,考虑其 与车辆的相对位置、相对速度以及相对加速度对斥力场进行改进,得到以下改进 后的动态障碍物斥力势场函数Urep:
式中,veo为动态障碍物相对于车辆的相对速度,kv为相对速度比例系数,aeo为动态障碍物相对于车辆的相对加速度,ka为相对加速度比例系数,β为动态障碍 物和车辆的相对速度与相对位置的夹角,γ为动态障碍物和自主车辆的相对加速度 与相对位置的夹角;
步骤四、针对行驶目标点建立其对车辆的引力势场函数模型;
步骤五、利用所建立的斥力势场函数模型和引力势场函数模型计算车辆所受 的引力与斥力,并由所述引力与斥力构建行车环境风险场势力函数模型;结合障 碍物运动速度和方位设置动态路径规划周期、安全距离阈值、碰撞风险约束条件, 以进行避障路径规划并实时滚动获取车辆位置与速度控制量;
步骤六、进行避障工况试验,包括静态障碍物的换道避障、侧向动态障碍物 的减速避障工况;利用贝塞尔曲线对所规划的避障路径中的车辆位置进行平滑处 理,从而得到完整的无人车局部避障规划路径。
进一步地,步骤一中对车辆传感器检测到的障碍物分别进行筛选具体包括以 下过程:
首先建立一条自我车辆到目标点的虚拟直线,记为LST,其表达式如下:
设障碍物到车辆的距离为dobs-ego,障碍物到直线LST的距离为dobs-ST,dobs-ego与dobs-ST的表达式如下:
其中,dobs-ego和dobs-ST对应的安全阈值分别为dobs-ego *和dobs-ST *。
进一步地,步骤四针对行驶目标点建立其对无人车的引力势场函数模型具体 包括以下过程:
设车辆在二维坐标系中的当前位置坐标为(x,y),目标点坐标为(xg,yg),则该引力势场函数Uatt的表达式为:
式中,katt为为引力势场正比例系数,dgoal为车辆当前位置坐标与目标点坐标 之间的距离矢量,方向为从车辆指向目标点。
进一步地,步骤五中车辆所受的引力与斥力计算过程具体包括:
对水滴形斥力势场函数模型Urep求导得到镜头障碍物对车辆的斥力函数:
对于动态障碍物的斥力势场,将其看作由相对位置势场函数Urep-d、相对速度 势场函数Urep-v、相对加速度势场函数Urep-a三部分构成,分别为:
对相对位置势场函数Urep-d求导得到相对位置斥力函数为:
将车辆当前位置坐标为(x,y)由原坐标系转换到以动态障碍物位置坐标为原 点,以障碍物和车辆相对速度方向为x轴的坐标系下,得到坐标(m,n),转换关系为:
则相对速度势场函数Urep-v分别对位置和速度求导得到相对速度斥力函数为:
其中,相对速度斥力Frep-v1的大小与车辆和障碍物距离dobs有关,方向与车辆 和障碍物的连线垂直;相对速度斥力Frep-v2的大小与相对速度有关,方向在车辆和 障碍物的连线上;▽表示相应势场的梯度;
相对速度势场函数Urep-a分别对位置和速度求导得到相对速度斥力函数为:
其中,相对加速度斥力Frep-a1的大小与车辆和障碍物距离dobs有关,方向与车 辆和障碍物的连线垂直;相对加速度斥力Frep-a2的大小与相对加速度有关,方向在 车辆和障碍物的连线上;
得到动态障碍物对车辆的总斥力为:
将行驶目标对车辆的引力势场函数模型Uatt求导得到引力函数:
Fatt=-▽Uatt=-kattdgoal。
进一步地,步骤五中由目标点引力势场、镜头障碍物和动态障碍物斥力势场 共同作用构成行车环境风险势场函数:
U=Uatt+∑Urep
对其求导得到行车环境风险场势力函数模型:
F=-▽U=Fatt+∑Frep。
进一步地,步骤五中采用以下形式的贝塞尔曲线对所规划的避障路径中的车 辆位置进行平滑处理:
其中,P(s)为控制点,s为变量,P(i)代表位置点坐标,Bi,n(s)为n次伯恩斯 坦多项式,可表示为:
式中,n表示贝塞尔曲线的阶数,位置点个数为n+1,控制点个数为n-1。
上述本发明所提供的基于改进人工势场法的无人车局部实时避障路径规划方法,其相对于现有技术至少具有以下有益效果:
(1).本发明通过改进人工势场法静态障碍物的斥力势场函数,加入改进的 距离调节因子,构建了水滴形斥力势场,可显著提高路径规划的精度与效率;
(2).本发明在路径规划过程中,考虑了车辆运动学与动力学影响因素,在 动态障碍物势场函数中加入了相对速度函数、相对加速度函数,解决了传统势场 法对于动态避障工况无解的问题,规划的路径实时性和平顺性较好;
(3).本发明通过对道路环境中存在复杂动态障碍物的工况进行分析,分别 针对静态障碍物进行换道避障,针对侧向动态障碍物进行减速避障,规划算法静 态规划效率高,且在动态规划中也有较高的适用性和有效性。
附图说明
图1为本发明所提供方法的流程框图;
图2为本发明所提供方法中障碍物斥力与车辆速度、位置关系示意图;
图3为本发明所提供方法中改进后的水滴型斥力势场;
图4为本发明所提供方法中改进障碍物斥力场与现有技术斥力场的二维对比图;
图5为本发明所提供方法中计算动态障碍物斥力所执行的坐标转换示意图;
图6为本发明所提供方法中的静态障碍物的换道避障试验场景示意图;
图7为本发明所提供方法中的静态避障试验结果航向角对比图;
图8为本发明所提供方法中的动态障碍物的减速避障试验场景示意图;
图9为本发明所提供方法中的动态避障试验结果对比图。
具体实施方式
下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述 的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例, 本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都 属于本发明保护的范围。
本发明所提供的一种基于改进人工势场法的无人车局部实时避障路径规划方法,如图1所示,具体包括:
在步骤一中,针对履带式无人车所在的局部避障行驶环境,对车辆传感器检 测到的障碍物分别进行筛选,基于障碍物与车辆之间的距离去除对车辆轨迹规划 无影响的障碍物,然后评估剩余的静态和动态障碍物以及目标行驶目标点对轨迹 规划的影响风险用于后续建立行车势场环境;
在步骤二中,针对筛选的静态障碍物建立其对车辆的斥力势场函数模型,考 虑车速与车辆—障碍物相对位置的夹角α对斥力势场进行改进,如图2所示,设 车辆速度与车辆和障碍物相对位置的夹角为α,当车辆朝向障碍物运动时(黑车), α=0,根据当前运动趋势车辆会与障碍物发生碰撞,此时障碍物斥力最大;当车 辆速度与车辆和障碍物相对位置的夹角逐渐增大时(红车),二者碰撞几率减小,应当减小障碍物斥力,此时0<α<90°。当车辆速度与车辆和障碍物相对位置的夹 角继续增大时(蓝车),二者碰撞几率更小,此时α>90°。由此根据上述对障碍物 斥力和车辆位置、速度的分析,得到以下改进后的水滴形斥力势场函数模型Urep:
式中,krep为斥力势场正比例系数,dobs为车辆与静态障碍物距离,d0为障碍物 对车辆产生斥力的最大影响范围,kd为调节因子,md为常数。传统势场法中md等 价于0,本发明为了使避障规划更加高效、安全,取md为0.6;
通过对改进的障碍物斥力势场进行建模,其三维模型如图3所示,可以看出 改进后的斥力势场相比于传统势场形状不再是一个圆柱样,而是随静态障碍物和 车辆的距离、方位的不同呈现水滴样。为了更直观的展示本文提出的改进势场法 的合理性与创新性,将本发明提出的改进障碍物斥力场与传统势场法的障碍物斥 力场以及其他研究者提出的障碍物斥力场进行对比,障碍物斥力场二维对比分析 图如图4所示。图中蓝色圆形为传统斥力场的斥力分布,黑色不完整圆是根据其 他研究者提出的斥力势场函数生成的,红色水滴形是本文提出的改进斥力场的斥力分布。图中数值代表车辆速度与车辆相对静态障碍物位置的夹角α,范围是 0-180°。
当环境中存在动态障碍物时,随着时间、障碍物位置的变化,动态障碍物速 度大小、方向和加速度变化对势场环境也存在影响。在路径规划过程中,动态障 碍物的斥力势场应实时反馈障碍物的速度大小、加速度大小和运动方向。若障碍 物朝向车辆运动,二者的相对速度和相对加速度就会增加,车辆受到障碍物的斥 力也应随之增加。
为此在步骤三中,针对筛选的动态障碍物建立其对车辆的斥力势场函数模型, 考虑其与车辆的相对位置、相对速度以及相对加速度对斥力场进行改进,得到以 下改进后的动态障碍物斥力势场函数Urep:
式中,veo为动态障碍物相对于车辆的相对速度,kv为相对速度比例系数,aeo为动态障碍物相对于车辆的相对加速度,ka为相对加速度比例系数,β为动态障碍 物和车辆的相对速度与相对位置的夹角,γ为动态障碍物和自主车辆的相对加速度 与相对位置的夹角;
通过车载传感器可获得动态障碍物运动信息,当cosβ<0时,动态障碍物和自 主车辆的相对速度与相对位置的夹角大于90°,此时动态障碍物驶离自主车辆, 对应的障碍物斥力势场也相应减弱。通过在步骤三改进后的静态障碍物斥力势场 函数的基础上加入引入相对速度和相对加速度,动态障碍物的斥力势场更加符合 实际。
在步骤四中,针对行驶目标点建立其对车辆的引力势场函数模型;
在步骤五中,利用所建立的斥力势场函数模型和引力势场函数模型计算车辆 所受的引力与斥力,并由所述引力与斥力构建行车环境风险场势力函数模型;结 合障碍物运动速度和方位设置动态路径规划周期、安全距离阈值、碰撞风险约束 条件,以进行避障路径规划并实时滚动获取车辆位置与速度控制量;
在步骤六中,进行避障工况试验,包括静态障碍物的换道避障、侧向动态障 碍物的减速避障工况;利用贝塞尔曲线对所规划的避障路径中的车辆位置进行平 滑处理,从而得到完整的无人车局部避障规划路径。
在本发明的一个优选实施方式中,步骤一中对车辆传感器检测到的障碍物分 别进行筛选具体包括以下过程:
首先建立一条自我车辆到目标点的虚拟直线,记为LST,其表达式如下:
设障碍物到车辆的距离为dobs-ego,障碍物到直线LST的距离为dobs-ST,当dobs-ego或dobs-ST任意一项小于各自的安全阈值时,就判定其对应的障碍物会对自我车辆后 续的路径规划造成影响,从而将这些可能对路径规划有影响的障碍物筛选出来。 这种障碍物预筛选方法忽略了距离较远的障碍物对自身期望轨迹的影响,可大大 提高路径规划的效率,因此dobs-ego与dobs-ST的表达式如下:
其中,dobs-ego和dobs-ST对应的安全阈值分别为dobs-ego *和dobs-ST *。通过大量仿真 实验证明:当dobs-ego*和dobs-ST*分别取60m和30m时,自主车辆可在最短时间内 规划出有效的避障路径。当dobs-ego<dobs-ST*或者dobs-ST<dobs-ST *时,其对应的障碍 物便能够参与到后续的规划算法计算。
在本发明的一个优选实施方式中,步骤四针对行驶目标点建立其对无人车的 引力势场函数模型具体包括以下过程:
在势场法路径规划中,由目标点产生的引力势场与车辆到目标点的距离相关, 车辆与目标点的距离越短,其引力势能的值就越小。设车辆在二维坐标系中的当 前位置坐标为(x,y),目标点坐标为(xg,yg),则该引力势场函数Uatt的表达式为:
式中,katt为为引力势场正比例系数,dgoal为车辆当前位置坐标与目标点坐标 之间的距离矢量,方向为从车辆指向目标点。
在本发明的一个优选实施方式中,步骤五中车辆所受的引力与斥力计算过程 具体包括:
对水滴形斥力势场函数模型Urep求导得到镜头障碍物对车辆的斥力函数:
对于动态障碍物的斥力势场,将其看作由相对位置势场函数Urep-d、相对速度 势场函数Urep-v、相对加速度势场函数Urep-a三部分构成,分别为:
对相对位置势场函数Urep-d求导得到相对位置斥力函数为:
为了确定相对速度、相对加速度和相对位置的关系,对原坐标系XOY进行变 换,变换后的坐标系为xoy以动态障碍物位置坐标为原点,以障碍物和自主车辆相 对速度方向为x轴,那么自主车辆相对障碍物的位置就是自主车辆在xoy中的坐标,自主车辆与障碍物的连线与x轴的夹角就是与相对速度的夹角β。坐标转换关系如 图5所示。
根据坐标系的平移和旋转原理,可得到xoy坐标系中车辆的位置坐标(m,n)与 原坐标系中坐标(x,y)的关系为:
式中,θ为相对速度方向和原坐标系x轴方向的夹角。
故可根据几何知识得到坐标(m,n),转换关系为:
则相对速度势场函数Urep-v分别对位置和速度求导得到相对速度斥力函数为:
其中,相对速度斥力Frep-v1的大小与车辆和障碍物距离dobs有关,方向与车辆 和障碍物的连线垂直;相对速度斥力Frep-v2的大小与相对速度有关,方向在车辆和 障碍物的连线上;▽表示相应势场的梯度;
相对速度势场函数Urep-a分别对位置和速度求导得到相对速度斥力函数为:
其中,相对加速度斥力Frep-a1的大小与车辆和障碍物距离dobs有关,方向与车 辆和障碍物的连线垂直;相对加速度斥力Frep-a2的大小与相对加速度有关,方向在 车辆和障碍物的连线上;
得到动态障碍物对车辆的总斥力为:
将行驶目标对车辆的引力势场函数模型Uatt求导得到引力函数:
在本发明的一个优选实施方式中,步骤五中由目标点引力势场、镜头障碍物 和动态障碍物斥力势场共同作用构成行车环境风险势场函数:
对其求导得到行车环境风险场势力函数模型:
F=-▽U=Fatt+∑Frep。
在本发明的一个优选实施方式中,步骤五中采用以下形式的贝塞尔曲线对所 规划的避障路径中的车辆位置进行平滑处理:
其中,P(s)为控制点,s为变量,P(i)代表位置点坐标,Bi,n(s)为n次伯恩斯 坦多项式,可表示为:
式中,n表示贝塞尔曲线的阶数,位置点个数为n+1,控制点个数为n-1。
如图6在Prescan中搭建的静态障碍物的换道避障场景,静态障碍物车辆放 置在自主车辆行进方向上,自主车辆以18km/h的速度沿着主路行驶。图7给出了 本发明的方法的运行结果。车辆在前进过程中检测到前方的障碍物后,开始进行 转向避障,避障过程中航向角幅值变化不大,规划路径很快回正,证明了基于水 滴型势场函数的静态避障规划算法的合理性。
如图8在Prescan中搭建的动态障碍物的减速避障场景,障碍物车辆以10.8km/h的速度从自主车辆的左前方向自主车辆行驶过来,自主车辆以18km/h的速度沿着主路行驶,二者在交叉口处相遇,自主车辆进行避障。图9给出了本发明的方法的运行结果。在改 进动态障碍物势场函数后,与传统人工势场法相比,由(a)、(b)可知,避障路径更加平 缓。由(c)、(d)可知改进后车辆和障碍物之间的最小距离为2.5m,比改进前的距离大了 1m左右,也就是说车辆在避障的同时提高了与动态障碍物的距离,保证了车辆行驶安全 性。由(e)、(f)可知,与传统势场法车辆航向角的变化量减少了84%。综上可得,改进动 态障碍物势场环境的构建后,避障路径相较之前的路径更加平滑,路径更短,航向角变化几乎为零,车辆没有大幅度转弯,提高了车辆的行驶效率,同时保证了车辆和障碍物 的安全距离,验证了所提改进算法的有效性和可靠性。
应理解,本发明实施例中各步骤的序号的大小并不意味着执行顺序的先后, 各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过 程构成任何限定。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言, 可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变 化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (6)
1.基于改进人工势场法的无人车局部实时避障路径规划方法,其特征在于:具体包括以下步骤:
步骤一、针对履带式无人车所在的局部避障行驶环境,对车辆传感器检测到的障碍物分别进行筛选,基于障碍物与车辆之间的距离去除对车辆轨迹规划无影响的障碍物,然后评估剩余的静态和动态障碍物以及目标行驶目标点对轨迹规划的影响风险用于后续建立行车势场环境;
步骤二、针对筛选的静态障碍物建立其对车辆的斥力势场函数模型,考虑车速与车辆—障碍物相对位置的夹角α对斥力势场进行改进,得到以下改进后的水滴形斥力势场函数模型Urep:
式中,krep为斥力势场正比例系数,dobs为车辆与静态障碍物距离,d0为障碍物对车辆产生斥力的最大影响范围,kd为调节因子,md为常数;
步骤三、针对筛选的动态障碍物建立其对车辆的斥力势场函数模型,考虑其与车辆的相对位置、相对速度以及相对加速度对斥力场进行改进,得到以下改进后的动态障碍物斥力势场函数Urep:
式中,veo为动态障碍物相对于车辆的相对速度,kv为相对速度比例系数,aeo为动态障碍物相对于车辆的相对加速度,ka为相对加速度比例系数,β为动态障碍物和车辆的相对速度与相对位置的夹角,γ为动态障碍物和自主车辆的相对加速度与相对位置的夹角;
步骤四、针对行驶目标点建立其对车辆的引力势场函数模型;
步骤五、利用所建立的斥力势场函数模型和引力势场函数模型计算车辆所受的引力与斥力,并由所述引力与斥力构建行车环境风险场势力函数模型;结合障碍物运动速度和方位设置动态路径规划周期、安全距离阈值、碰撞风险约束条件,以进行避障路径规划并实时滚动获取车辆位置与速度控制量;
步骤六、进行避障工况试验,包括静态障碍物的换道避障、侧向动态障碍物的减速避障工况;利用贝塞尔曲线对所规划的避障路径中的车辆位置进行平滑处理,从而得到完整的无人车局部避障规划路径。
4.如权利要求3所述的方法,其特征在于:步骤五中车辆所受的引力与斥力计算过程具体包括:
对水滴形斥力势场函数模型Urep求导得到镜头障碍物对车辆的斥力函数:
对于动态障碍物的斥力势场,将其看作由相对位置势场函数Urep-d、相对速度势场函数Urep-v、相对加速度势场函数Urep-a三部分构成,分别为:
对相对位置势场函数Urep-d求导得到相对位置斥力函数为:
将车辆当前位置坐标为(x,y)由原坐标系转换到以动态障碍物位置坐标为原点,以障碍物和车辆相对速度方向为x轴的坐标系下,得到坐标(m,n),转换关系为:
则相对速度势场函数Urep-v分别对位置和速度求导得到相对速度斥力函数为:
相对速度势场函数Urep-a分别对位置和速度求导得到相对速度斥力函数为:
其中,相对加速度斥力Frep-a1的大小与车辆和障碍物距离dobs有关,方向与车辆和障碍物的连线垂直;相对加速度斥力Frep-a2的大小与相对加速度有关,方向在车辆和障碍物的连线上;
得到动态障碍物对车辆的总斥力为:
将行驶目标对车辆的引力势场函数模型Uatt求导得到引力函数:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211077482.1A CN115328152B (zh) | 2022-09-05 | 2022-09-05 | 基于改进人工势场法的无人车局部实时避障路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211077482.1A CN115328152B (zh) | 2022-09-05 | 2022-09-05 | 基于改进人工势场法的无人车局部实时避障路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115328152A CN115328152A (zh) | 2022-11-11 |
CN115328152B true CN115328152B (zh) | 2023-06-30 |
Family
ID=83930658
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211077482.1A Active CN115328152B (zh) | 2022-09-05 | 2022-09-05 | 基于改进人工势场法的无人车局部实时避障路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115328152B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116202550B (zh) * | 2023-05-06 | 2023-07-11 | 华东交通大学 | 融合改进势场与动态窗口的汽车路径规划方法 |
CN116465427B (zh) * | 2023-06-20 | 2023-09-08 | 吉林大学 | 一种基于时空风险量化的智能车辆换道避障路径规划方法 |
CN117055559A (zh) * | 2023-08-30 | 2023-11-14 | 苏州大成运和智能科技有限公司 | 一种改进人工势场法的自动驾驶车辆避障方法 |
CN117369482B (zh) * | 2023-12-06 | 2024-03-12 | 华润数字科技有限公司 | 移动机器人的路径规划方法、装置、设备及存储介质 |
CN117826825B (zh) * | 2024-02-29 | 2024-06-07 | 苏州观瑞汽车技术有限公司 | 基于人工势场算法的无人矿卡局部路径规划方法及*** |
CN117961915B (zh) * | 2024-03-28 | 2024-06-04 | 太原理工大学 | 煤矿掘进机器人的智能辅助决策方法 |
CN118163116B (zh) * | 2024-05-11 | 2024-07-12 | 北京航空航天大学 | 一种机器人控制方法、装置和机器人 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104317291A (zh) * | 2014-09-16 | 2015-01-28 | 哈尔滨恒誉名翔科技有限公司 | 一种基于人工势场法的机器人避碰路径规划方法 |
JP6606442B2 (ja) * | 2016-02-24 | 2019-11-13 | 本田技研工業株式会社 | 移動体の経路計画生成装置 |
CN108469828A (zh) * | 2018-03-23 | 2018-08-31 | 哈尔滨工程大学 | 一种改进人工势场优化算法的auv航路规划方法 |
CN112379672B (zh) * | 2020-11-24 | 2022-05-10 | 浙大宁波理工学院 | 一种基于改进人工势场的智能无人船路径规划方法 |
CN113848914B (zh) * | 2021-09-28 | 2024-04-26 | 福州大学 | 动态环境下碰撞系数人工势场法局部路径规划方法 |
CN113985875B (zh) * | 2021-10-27 | 2024-02-27 | 福州大学 | 基于碰撞预测模型的人工势场无人车动态路径规划方法 |
CN114442637B (zh) * | 2022-02-10 | 2023-11-10 | 北京理工大学 | 一种无人车局部动态避障路径规划方法 |
-
2022
- 2022-09-05 CN CN202211077482.1A patent/CN115328152B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN115328152A (zh) | 2022-11-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115328152B (zh) | 基于改进人工势场法的无人车局部实时避障路径规划方法 | |
CN111338346B (zh) | 一种自动驾驶控制方法、装置、车辆及存储介质 | |
Okumura et al. | Challenges in perception and decision making for intelligent automotive vehicles: A case study | |
CN111260963B (zh) | 一种多船会遇避碰方法 | |
CN112965476B (zh) | 一种基于多窗口模型的高速无人车轨迹规划***及方法 | |
CN109270933A (zh) | 基于圆锥曲线的无人驾驶避障方法、装置、设备及介质 | |
CN114442637B (zh) | 一种无人车局部动态避障路径规划方法 | |
CN112810630A (zh) | 一种自动驾驶车辆轨迹规划方法及*** | |
CN110992695A (zh) | 基于冲突消解的智能车辆城市交叉口通行决策多目标优化模型 | |
CN113895463B (zh) | 一种适用于自动驾驶车辆掉头的路径规划方法 | |
Ben-Messaoud et al. | Smooth obstacle avoidance path planning for autonomous vehicles | |
CN110146087B (zh) | 一种基于动态规划思想的船舶路径规划方法 | |
CN111896004A (zh) | 一种狭窄通道车辆轨迹规划方法及*** | |
CN113515111B (zh) | 一种车辆避障路径规划方法及装置 | |
CN116118780A (zh) | 一种车辆避障轨迹规划方法、***、车辆及存储介质 | |
CN116501030A (zh) | 基于改进人工势场法的自动驾驶车辆路径规划方法 | |
Lattarulo et al. | Real-time trajectory planning method based on n-order curve optimization | |
CN112519783B (zh) | 一种智能驾驶的自底向上平滑轨迹生成方法及*** | |
Park et al. | Path generation algorithm based on crash point prediction for lane changing of autonomous vehicles | |
Wang et al. | A novel autonomous trajectory control for vehicular cyber-physical systems with flocking control algorithms | |
Naidja et al. | An interactive game theory-pso based comprehensive framework for autonomous vehicle decision making and trajectory planning | |
Liu et al. | Research on local real-time obstacle avoidance path planning of unmanned vehicle based on improved artificial potential field method | |
Wang et al. | Reference path correction for autonomous ground vehicles driving over rough terrain | |
Rosero et al. | CNN-Planner: A neural path planner based on sensor fusion in the bird's eye view representation space for mapless autonomous driving | |
CN111857112A (zh) | 一种汽车局部路径规划方法及电子设备 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |