CN114194215B - 一种智能车辆避障换道轨迹规划方法及*** - Google Patents
一种智能车辆避障换道轨迹规划方法及*** Download PDFInfo
- Publication number
- CN114194215B CN114194215B CN202111661902.6A CN202111661902A CN114194215B CN 114194215 B CN114194215 B CN 114194215B CN 202111661902 A CN202111661902 A CN 202111661902A CN 114194215 B CN114194215 B CN 114194215B
- Authority
- CN
- China
- Prior art keywords
- track
- vehicle
- obstacle avoidance
- lane change
- index
- 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
- 230000008859 change Effects 0.000 title claims abstract description 55
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000001514 detection method Methods 0.000 claims abstract description 27
- 238000011156 evaluation Methods 0.000 claims abstract description 19
- 238000012216 screening Methods 0.000 claims abstract description 15
- 238000005457 optimization Methods 0.000 claims abstract description 9
- 230000001133 acceleration Effects 0.000 claims description 37
- 238000012937 correction Methods 0.000 claims description 10
- 230000006870 function Effects 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 8
- 238000004458 analytical method Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 230000036461 convulsion Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 2
- 230000007613 environmental effect Effects 0.000 claims 2
- 238000010586 diagram Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0011—Planning or execution of driving tasks involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0953—Predicting travel path or likelihood of collision the prediction being responsive to vehicle dynamic parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4042—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/802—Longitudinal distance
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种智能车辆避障换道轨迹规划方法及***,根据道路环境、障碍物信息以及当前车速,基于操稳性极限起始回正点以及多项式曲线生成可行轨迹簇,对可行轨迹簇中的换道轨迹进行预碰撞检测,筛选并剔除出不满足预碰撞检测条件的轨迹得到无碰撞轨迹簇;在无碰撞轨迹簇的基础上建立关于舒适性、避障效率、侧滑这三个评价指标的代价函数;并采用模糊推理来确定三个评价指标的权重,通过求解多目标优化问题,搜索出最优的避障换道回正点,即规划出最终的避障换道轨迹。同时本申请还提出了一种智能车辆避障换道轨迹规划***,可以在兼顾安全性、实时性以及曲率连续的同时,使得轨迹的性能指标如舒适性、避障效率等最大化,有效改善乘员的乘坐体验。
Description
技术领域
本发明属于智能驾驶车辆规划技术领域,具体涉及一种智能车辆避障换道轨迹规划方法。
背景技术
目前我国机动车保有量呈逐年上升趋势,由此所带来的交通安全、道路拥堵等问题日益突出。经研究表明,驾驶员注意力不集中或驾驶经验不足等人为因素是导致交通事故的主要原因。因此,智能驾驶车辆正在飞速的发展和进步,它可承担人类驾驶员的更多负担和压力,从而提高道路安全性,关键技术包括感知、定位、决策、规划和控制。
目前智能车辆的主动避障策略主要分为制动避障和转向避障两种。但车辆在高速行驶时,基于制动的主动避障需要较长的制动距离,仍然会有很高的碰撞风险,甚至有可能导致后方车辆追尾。因此,通过制动避免碰撞更适用于低车速以及障碍车辆较多的城市道路;而如果在车道畅通的高速公路,更适合采用转向来避免碰撞。因此在紧急避障时,快速的规划出一条合理的换道路径是至关重要的。
智能车辆运动规划是指根据决策层输入的行为意图,在相应的时空内搜索出一条具有详细路径、速度信息,并且满足各个约束条件的轨迹,最后发送给控制模块去跟踪。运动规划最初起源于机器人领域,主要分为三类方法:基于采样的方法、基于曲线插值的方法和基于数值优化的方法。其中,基于采样的方法实时性一般且生成的曲线可能存在曲率突变;曲线插值法虽然实时性好且曲率连续,但灵活性较差;而数值优化法需要处理多约束的搜索问题,计算成本很高。其中各类规划方法都有各自的特点,单一的方法无法实现最优。
发明内容
针对现有技术存在的不足,本发明提出了一种智能车辆避障换道轨迹规划方法及***。可以保证安全、曲率连续以及实时性好,使得车辆在顺利避障的同时,并最大化的满足乘员要求,提高规划轨迹的灵活性。
本发明采用的技术方案如下:
一种智能车辆避障换道轨迹规划方法,包括如下步骤:
S1,采用多项式曲线求得广义换道轨迹,由广义换道轨迹得到参考侧向加速度关于时间的表达式,对参考侧向加速度求极值得到参考轨迹下最大侧向加速度ay_rmax,由当前路面状况结合侧向加速度相关标准定义阈值:
|ay_rmax|≤aymax=fμg,其中系数f<1
其中,aymax为最大侧向加速度,系数f<1,μ为路面附着系数;g为重力加速度;
根据最大侧向加速度阈值计算换道起始回正点;由换道起始回正点在横向上进行等距离迭代,采样得到N-1个换道回正点,带入到多项式曲线广义轨迹公式中得到可行轨迹簇;
S2,对可行轨迹簇中的N条换道轨迹进行预碰撞检测,筛选并剔除出不满足预碰撞检测条件的轨迹即可能发生碰撞的轨迹,得到无碰撞轨迹簇;
S3,在无碰撞轨迹簇的基础上建立关于舒适性指标、避障效率指标、侧滑指标这三个评价指标的代价函数;并采用模糊推理来确定舒适性指标、避障效率指标、侧滑指标这三个评价指标的权重,最后通过求解多目标优化问题,搜索出最优的避障换道回正点XT_R,即规划出最终的避障换道轨迹。
进一步,所述S3中所建立的代价函数表示为:
式中,wC、wE、wS分别为舒适性指标、避障效率指标、侧滑指标的权重值;JC为舒适性指标,JE为避障效率指标,JS为侧滑性指标。
进一步,采用模糊推理来确定舒适性指标、避障效率指标、侧滑指标这三个评价指标的权重的方法为:
首先,采用预碰撞时间TTC倒数来表征危险程度,采用路面附着系数μ表征当前路面状况;将预碰撞时间倒数TTC-1、路面附着系数μ作为输入,wC、wE、wS作为输出;设计如下模糊规则:
规则1)if TTC-1is B andμis B,then(wC is B)(wE is S)(wS is S)
规则2)if TTC-1is B andμis S,then(wC is S)(wE is S)(wS is B)
规则3)if TTC-1is M andμis B,then(wC is M)(wE is M)(wS is S)
规则4)if TTC-1is M andμis S,then(wC is S)(wE is M)(wS is M)
规则5)if TTC-1is S andμis B,then(wC is S)(wE is B)(wS is S)
规则6)if TTC-1is S andμis S,then(wC is S)(wE is M)(wS is M)
其中,S为小,M为中,B为大。
进一步,舒适性指标、避障效率指标、侧滑指标分别表示如下:
JE=T
式中:jy_r为期望侧向跃度;ay_r为期望侧向加速度;T为全程所需要的时间。
进一步,所述S2中的预碰撞检测流程为:
1)当自车右前角点与前方障碍车辆尾部的横坐标相等时,即X(A1)=X(B)时,开始发生碰撞,此时刻记为t1。
式中,为t时刻的航向角,可由轨迹公式计算得到。xf(t1)、Bf分别为前方障碍车辆的质心位置及该质心到前方障碍车辆车尾的距离,可由感知信息获取得到。Aego、Wego分别为自车质心到自车车头的距离以及自车车宽。求解得到t1作为预碰撞检测起始时间点。
2)当自车右后角点与前方障碍车辆尾部的横坐标相等时,即X(A2)=X(B)时,完全脱离碰撞风险,此时刻记为t2。
式中,Bego为自车质心到自车车尾的距离。求解得到t2作为碰撞检测终止点。
3)在t1、t2时间点处,进行预碰撞检测。无碰撞的条件为前方障碍车辆的左后角点到自车轴线的垂直距离大于设定的阈值,即:dCB≥dmin。
其中,dmin为垂直距离的最小值,筛选并剔除出不满足预碰撞检测条件的轨迹即可能发生碰撞的轨迹,得到无碰撞轨迹簇。
进一步,所述S1中的广义换道轨迹:
式中:以自车建立坐标系,车辆前进方向为x轴,垂直于车身方向为y轴,x(t),y(t)分别为t时刻的x坐标和y坐标;v为车速,w为车道宽度,t为时间变量,XT为换道回正点的期望位置。
进一步,由广义换道轨迹求两阶导数得到参考侧向加速度关于时间的表达式:
上式求极值得到参考轨迹下最大侧向加速度:
时,/>
进一步,根据最大侧向加速度阈值计算换道起始回正点:
由换道起始回正点在横向上进行等距离迭代,采样得到N-1个换道回正点,带入到多项式曲线广义轨迹公式中得到可行轨迹簇。
XTn=XT1+(n-1)d,n=2,3,…,N
式中,XTn为第n个换道回正点的位置,d为迭代距离。
一种智能车辆避障换道轨迹规划***,包括环境感知模块、候选轨迹生成模块、场景分析模块和候选轨迹筛选模块;
所述环境感知模块用于获取道路环境信息和障碍车辆运动信息,并将所获取的信息输入给其他三个模块;
所述候选轨迹生成模块根据道路环境信息并结合自车状态信息,由最大侧向加速度阈值基于多项式曲线生成操稳性极限换道轨迹,通过迭代生成可行轨迹簇,并输入给候选轨迹筛选模块;
所述场景分析模块根据道路环境信息、障碍车辆运动信息分析当前路面状况及危险程度,通过模糊决策得到当前场景下的各评价指标的权重值;将权重值输入给候选轨迹筛选模块;
所述候选轨迹筛选模块结合障碍车辆运动信息进行预碰撞检测,筛选并剔除出可能发生碰撞的轨迹得到无碰撞轨迹簇,并进一步建立舒适性、避障效率、侧滑指数三个评价指标的代价函数;基于场景分析模块输出的各评价指标相应的权重值,搜索得到最优回正点即规划出最终的避障换道轨迹。
进一步,所述环境感知模块具体包括各环境感知传感器如摄像头、激光雷达、毫米波雷达、GPS、惯导。
本发明有益效果如下:
本发明涉及一种智能车辆避障换道轨迹规划方法及***。在曲线插值法的基础上结合了采样法、数值优化法的优势,设计了一种多目标优化轨迹规划方法,有效解决了曲线插值法普遍存在的目标点难以选取的问题,提高规划轨迹的灵活性。在实际应用层面,本发明提出的轨迹规划方法可以在兼顾安全性、实时性以及曲率连续的同时,使得轨迹的性能指标如舒适性、避障效率等最大化,有效改善乘员的乘坐体验。
附图说明
图1是避障换道轨迹规划***总体框图;
图2是基于多项式曲线可行轨迹簇生成示意图;
图3是无碰撞轨迹簇生成示意图;
图4是最优避障换道轨迹生成示意图;
图5、6是预碰撞检测流程示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用于解释本发明,并不用于限定本发明。
如图1所示,本发明提出了一种智能车辆避障换道轨迹规划***。其中***的总体结构包括:环境感知模块、候选轨迹生成模块、场景分析模块和候选轨迹筛选模块。
环境感知模块用于获取道路环境信息和障碍车辆运动信息,并将所获取的信息输入给其他三个模块。环境感知模块具体包括各环境感知传感器如摄像头、激光雷达、毫米波雷达、GPS、惯导等。所述道路环境信息包括车道中心线、车道宽度、障碍车辆的几何尺寸等;所述障碍车辆运动信息包括各时刻的位置、速度等。
候选轨迹生成模块根据道路环境信息并结合自车状态信息,由最大侧向加速度阈值基于多项式曲线生成操稳性极限换道轨迹,通过迭代生成可行轨迹簇,并输入给候选轨迹筛选模块。
场景分析模块根据道路环境信息、障碍车辆运动信息分析当前路面状况及危险程度,通过模糊决策得到当前场景下的各评价指标的权重值。最后将权重值输入给候选轨迹筛选模块。
候选轨迹筛选模块结合障碍车辆运动信息进行预碰撞检测,筛选并剔除出可能发生碰撞的轨迹得到无碰撞轨迹簇,并进一步建立舒适性、避障效率、侧滑指数三个评价指标的代价函数;基于场景分析模块输出的各评价指标相应的权重值,搜索得到最优回正点即规划出最终的避障换道轨迹。
一种智能车辆避障换道轨迹规划方法,包括如下步骤:
S1,基于由感知传感器获得车道信息及自车状态信息。采用多项式曲线求得广义换道轨迹:
式中:以自车建立坐标系,车辆前进方向为x轴,垂直于车身方向为y轴,x(t),y(t)分别为t时刻的x坐标和y坐标;v为车速,w为车道宽度,t为时间变量,XT为换道回正点的期望位置。
其中,为了最大化车辆的纵向舒适性,上式确保了纵向加速度(d2x/dt2)为0,因此规划车速在大地坐标系下恒定,即:dx/dt=v,XT=vT,T为避障换道全程所需的时间。通过调整回正点XT的位置,可得到不同的换道轨迹。为了确定换道回正点XT的具***置,将采用如下迭代、搜索的方法找到最优的避障换道回正点XT_R。
由上述轨迹曲线表达式求两阶导数可得到参考侧向加速度关于时间的表达式:
上式求极值得到参考轨迹下最大侧向加速度:
时,/>
由于侧向加速度反映了车辆在轨迹跟踪时的操纵稳定性,因此需要保证其在合理范围内,否则该轨迹无法被跟踪。由当前路面状况结合侧向加速度相关标准定义阈值:
|ay_rmax|≤aymax=fμg,
其中,aymax为最大侧向加速度,系数f<1,μ为路面附着系数;g为重力加速度。
根据最大侧向加速度阈值计算换道起始回正点:
根据上式求得的起始回正点进而生成第一条换道轨迹,即为操稳性极限换道轨迹,表示车辆在当前路面状况以及车速下能发挥出的最大转向避障潜能。此后回正点距离越远,其轨迹的参考侧向加速度极限值越小,车辆跟踪越平稳。
由换道起始回正点在横向上进行等距离迭代,采样得到(N-1)个换道回正点,带入到多项式曲线广义轨迹公式中得到可行轨迹簇,如图2所示。
XTn=XT1+(n-1)d,n=2,3,…,N
式中,XTn为第n个换道回正点的位置,d为迭代距离。
S2,对可行轨迹簇中的N条换道轨迹进行搜索,寻找最优轨迹。初步筛选方法为预碰撞检测。由感知传感器获得的信息对前方车辆进行轨迹预测,结合每一条可行轨迹中自车在未来时刻的期望位置,根据自车和障碍车辆之间的相对运动信息求解出碰撞可能发生的时刻,再根据自车和障碍车辆的几何特征定义预碰撞检测条件,如图5、图6所示。
假设向左侧避障时,预碰撞检测流程为:
1)当自车右前角点与前方障碍车辆尾部的横坐标相等时,即X(A1)=X(B)时,开始发生碰撞,此时刻记为t1。
式中,为t时刻的航向角,可由轨迹公式计算得到。xf(t1)、Bf分别为前方障碍车辆的质心位置及该质心到前方障碍车辆车尾的距离,可由感知信息获取得到。Aego、Wego分别为自车质心到自车车头的距离以及自车车宽。求解得到t1作为预碰撞检测起始时间点。
2)当自车右后角点与前方障碍车辆尾部的横坐标相等时,即X(A2)=X(B)时,完全脱离碰撞风险,此时刻记为t2。
式中,Bego为自车质心到自车车尾的距离。求解得到t2作为碰撞检测终止点。
3)在t1、t2时间点处,进行预碰撞检测。无碰撞的条件为前方障碍车辆的左后角点到自车轴线的垂直距离大于设定的阈值,即:dCB≥dmin。
其中,dmin为垂直距离的最小值,筛选并剔除出不满足预碰撞检测条件的轨迹即可能发生碰撞的轨迹,得到无碰撞轨迹簇,如图3所示。
S3,在无碰撞轨迹簇的基础上建立三个评价指标的代价函数,通过搜索得到最优避障换道轨迹,三个评价指标分别是舒适性指标、避障效率指标、侧滑指标,表示如下:
其中:/>
JE=T
式中:JC为舒适性指标,jy_r表示为期望侧向加速度的导数即侧向跃度;ay_r为期望侧向加速度;JE为避障效率指标,表示为全程所需要的时间T;JS为侧滑性指标,表示为侧向加速度在当前路面状况下的利用率。
基于上述舒适性指标、避障效率指标、侧滑指标建立如下代价函数:
式中,wC、wE、wS分别为舒适性指标、避障效率指标、侧滑指标的权重值。
其中,三个权重值是与当前的危险程度以及路面状况有关的。例如,当此刻距离前方障碍车辆比较近、危险程度很高时,乘员的心理压力是最大的,此时需要尽快的躲避障碍车辆,因此避障效率的权重值应该更高;而当路面状况不太好的时候,车辆在避障时的侧滑指数不能过高,否则会有失稳的风险;最后当危险程度不太高以及路面状况较好时,乘员没有太大的心理压力、车辆的操纵稳定性较好,因此舒适性指标的权重可以更高。由于各权重值与当前具体场景有关,但没有一个定量的关系,因此采用模糊推理来确定三个指标的具体权重。
由感知传感器获得道路信息及障碍车辆信息,分析当前路面状况及危险程度。
采用预碰撞时间(TTC)倒数来表征危险程度:
式中,Vego为当前自车车速,Vf为当前障碍车辆车速;Dob为此刻距离前方障碍车辆的间距。当前路面状况由路面附着系数μ表征。
设计如下模糊规则。输入为预碰撞时间倒数TTC-1、路面附着系数μ;输出为wC、wE、wS。
规则1)if TTC-1is B andμis B,then(wC is B)(wE is S)(wS is S)
规则2)if TTC-1is B andμis S,then(wC is S)(wE is S)(wS is B)
规则3)if TTC-1is M andμis B,then(wC is M)(wE is M)(wS is S)
规则4)if TTC-1is M andμis S,then(wC is S)(wE is M)(wS is M)
规则5)if TTC-1is S andμis B,then(wC is S)(wE is B)(wS is S)
规则6)if TTC-1is S andμis S,then(wC is S)(wE is M)(wS is M)
其中,S为小,M为中,B为大。
将模糊推理确定的各权重值输入到候选轨迹筛选模块,可根据当前具体场景与路面状况得到具体的代价函数,最后通过求解多目标优化问题,搜索出最优的避障换道回正点XT_R,即规划出最终的避障换道轨迹,如图4所示。
以上实施例仅用于说明本发明的设计思想和特点,其目的在于使本领域内的技术人员能够了解本发明的内容并据以实施,本发明的保护范围不限于上述实施例。所以,凡依据本发明所揭示的原理、设计思路所作的等同变化或修饰,均在本发明的保护范围之内。
Claims (9)
1.一种智能车辆避障换道轨迹规划方法,其特征在于,包括如下步骤:
S1,采用多项式曲线求得广义换道轨迹,所述广义换道轨迹:
式中:以自车建立坐标系,车辆前进方向为x轴,垂直于车身方向为y轴,x(t),y(t)分别为t时刻的x坐标和y坐标;v为车速,w为车道宽度,t为时间变量,XT为换道回正点的期望位置;
由广义换道轨迹得到参考侧向加速度关于时间的表达式,对参考侧向加速度求极值得到参考轨迹下最大侧向加速度ay_rmax,由当前路面状况结合侧向加速度相关标准定义阈值:
|ay_rmax|≤aymax=fμg,其中系数f<1
其中,aymax为最大侧向加速度,系数f<1,μ为路面附着系数;g为重力加速度;
根据最大侧向加速度阈值计算换道起始回正点;由换道起始回正点在横向上进行等距离迭代,采样得到N-1个换道回正点,带入到多项式曲线广义轨迹公式中得到可行轨迹簇;
S2,对可行轨迹簇中的N条换道轨迹进行预碰撞检测,筛选并剔除出不满足预碰撞检测条件的轨迹即可能发生碰撞的轨迹,得到无碰撞轨迹簇;
S3,在无碰撞轨迹簇的基础上建立关于舒适性指标、避障效率指标、侧滑指标这三个评价指标的代价函数;并采用模糊推理来确定舒适性指标、避障效率指标、侧滑指标这三个评价指标的权重,最后通过求解多目标优化问题,搜索出最优的避障换道回正点XT_R,即规划出最终的避障换道轨迹。
2.根据权利要求1所述的一种智能车辆避障换道轨迹规划方法,其特征在于,所述S3中所建立的代价函数表示为:
式中,wC、wE、wS分别为舒适性指标、避障效率指标、侧滑指标的权重值;JC为舒适性指标,JE为避障效率指标,JS为侧滑性指标。
3.根据权利要求2所述的一种智能车辆避障换道轨迹规划方法,其特征在于,采用模糊推理来确定舒适性指标、避障效率指标、侧滑指标这三个评价指标的权重的方法为:
首先,采用预碰撞时间TTC倒数来表征危险程度,采用路面附着系数μ表征当前路面状况;将预碰撞时间倒数TTC-1、路面附着系数μ作为输入,wC、wE、wS作为输出;设计如下模糊规则:
规则1)if TTC-1is B andμis B,then(wC is B)(wE is S)(wS is S)
规则2)if TTC-1is B andμis S,then(wC is S)(wE is S)(wS is B)
规则3)if TTC-1is M andμis B,then(wC is M)(wE is M)(wS is S)
规则4)if TTC-1is M andμis S,then(wC is S)(wE is M)(wS is M)
规则5)if TTC-1is S andμis B,then(wC is S)(wE is B)(wS is S)
规则6)if TTC-1is S andμis S,then(wC is S)(wE is M)(wS is M)
其中,S为小,M为中,B为大。
4.根据权利要求1、2或3所述的一种智能车辆避障换道轨迹规划方法,其特征在于,舒适性指标、避障效率指标、侧滑指标分别表示如下:
JE=T
式中:jy_r为期望侧向跃度;ay_r为期望侧向加速度;T为全程所需要的时间。
5.根据权利要求4所述的一种智能车辆避障换道轨迹规划方法,其特征在于,所述S2中的预碰撞检测流程为:
1)当自车右前角点与前方障碍车辆尾部的横坐标相等时,即X(A1)=X(B)时,开始发生碰撞,此时刻记为t1;
式中,为t时刻的航向角,可由轨迹公式计算得到;xf(t1)、Bf分别为前方障碍车辆的质心位置及该质心到前方障碍车辆车尾的距离,可由感知信息获取得到;Aego、Wego分别为自车质心到自车车头的距离以及自车车宽;求解得到t1作为预碰撞检测起始时间点;
2)当自车右后角点与前方障碍车辆尾部的横坐标相等时,即X(A2)=X(B)时,完全脱离碰撞风险,此时刻记为t2;
式中,Bego为自车质心到自车车尾的距离;求解得到t2作为碰撞检测终止点;
3)在t1、t2时间点处,进行预碰撞检测;无碰撞的条件为前方障碍车辆的左后角点到自车轴线的垂直距离大于设定的阈值,即:dCB≥dmin:
T1:
T2:
其中,dmin为垂直距离的最小值,筛选并剔除出不满足预碰撞检测条件的轨迹即可能发生碰撞的轨迹,得到无碰撞轨迹簇。
6.根据权利要求1所述的一种智能车辆避障换道轨迹规划方法,其特征在于,由广义换道轨迹求两阶导数得到参考侧向加速度关于时间的表达式:
上式求极值得到参考轨迹下最大侧向加速度:
时,/>
7.根据权利要求1或6所述的一种智能车辆避障换道轨迹规划方法,其特征在于,根据最大侧向加速度阈值计算换道起始回正点:
由换道起始回正点在横向上进行等距离迭代,采样得到N-1个换道回正点,带入到多项式曲线广义轨迹公式中得到可行轨迹簇;
XTn=XT1+(n-1)d,n=2,3,…,N
式中,XTn为第n个换道回正点的位置,d为迭代距离。
8.一种基于权利要求1所述的一种智能车辆避障换道轨迹规划方法的智能车辆避障换道轨迹规划***,其特征在于,包括环境感知模块、候选轨迹生成模块、场景分析模块和候选轨迹筛选模块;
所述环境感知模块用于获取道路环境信息和障碍车辆运动信息,并将所获取的信息输入给其他三个模块;
所述候选轨迹生成模块根据道路环境信息并结合自车状态信息,由最大侧向加速度阈值基于多项式曲线生成操稳性极限换道轨迹,通过迭代生成可行轨迹簇,并输入给候选轨迹筛选模块;
所述场景分析模块根据道路环境信息、障碍车辆运动信息分析当前路面状况及危险程度,通过模糊决策得到当前场景下的各评价指标的权重值;将权重值输入给候选轨迹筛选模块;
所述候选轨迹筛选模块结合障碍车辆运动信息进行预碰撞检测,筛选并剔除出可能发生碰撞的轨迹得到无碰撞轨迹簇,并进一步建立舒适性、避障效率、侧滑指数三个评价指标的代价函数;基于场景分析模块输出的各评价指标相应的权重值,搜索得到最优回正点即规划出最终的避障换道轨迹。
9.根据权利要求8所述的一种智能车辆避障换道轨迹规划***,其特征在于,所述环境感知模块包括环境感知传感器,所述环境感知传感器包括摄像头、激光雷达、毫米波雷达、GPS、惯导。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111661902.6A CN114194215B (zh) | 2021-12-30 | 2021-12-30 | 一种智能车辆避障换道轨迹规划方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111661902.6A CN114194215B (zh) | 2021-12-30 | 2021-12-30 | 一种智能车辆避障换道轨迹规划方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114194215A CN114194215A (zh) | 2022-03-18 |
CN114194215B true CN114194215B (zh) | 2024-05-10 |
Family
ID=80657616
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111661902.6A Active CN114194215B (zh) | 2021-12-30 | 2021-12-30 | 一种智能车辆避障换道轨迹规划方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114194215B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115071698B (zh) * | 2022-06-21 | 2024-07-23 | 深蓝汽车科技有限公司 | 一种基于最低碰撞代价的避撞控制方法及*** |
CN115195743B (zh) * | 2022-09-16 | 2022-12-23 | 毫末智行科技有限公司 | 基于无人驾驶的车辆自动变道方法、装置、设备及介质 |
CN115489548B (zh) * | 2022-09-20 | 2024-06-04 | 重庆大学 | 智能汽车园区道路路径规划方法 |
CN117141489B (zh) * | 2023-11-01 | 2024-01-09 | 吉林大学 | 一种基于最小作用量原理的智能车辆轨迹分层规划方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106926844A (zh) * | 2017-03-27 | 2017-07-07 | 西南交通大学 | 一种基于实时环境信息的动态自动驾驶换道轨迹规划方法 |
CN110286681A (zh) * | 2019-07-05 | 2019-09-27 | 西南交通大学 | 一种变曲率弯道的动态自动驾驶换道轨迹规划方法 |
CN110362096A (zh) * | 2019-08-13 | 2019-10-22 | 东北大学 | 一种基于局部最优性的无人驾驶车辆动态轨迹规划方法 |
IT201800011029A1 (it) * | 2018-12-12 | 2020-06-12 | Milano Politecnico | Procedimento e sistema di pianificazione di un percorso per un veicolo terrestre per elusione di ostacoli con rapida reazione, particolarmente in uno scenario di guida autonoma. |
CN111750887A (zh) * | 2020-06-11 | 2020-10-09 | 上海交通大学 | 降低事故严重程度的无人驾驶车辆轨迹规划方法及*** |
CN112572443A (zh) * | 2020-12-22 | 2021-03-30 | 北京理工大学 | 一种高速公路车辆换道实时避撞轨迹规划方法及*** |
WO2021077725A1 (zh) * | 2019-10-21 | 2021-04-29 | 南京航空航天大学 | 一种基于驾驶意图的周围车辆运动状态预测***及方法 |
CN112947469A (zh) * | 2021-03-16 | 2021-06-11 | 安徽卡思普智能科技有限公司 | 汽车换道轨迹规划与动态轨迹跟踪控制方法 |
CN112965489A (zh) * | 2021-02-05 | 2021-06-15 | 北京理工大学 | 一种基于碰撞检测的智能车高速换道规划方法 |
CN113276848A (zh) * | 2021-04-09 | 2021-08-20 | 江苏大学 | 一种智能驾驶换道避障轨迹规划、跟踪控制方法及*** |
-
2021
- 2021-12-30 CN CN202111661902.6A patent/CN114194215B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106926844A (zh) * | 2017-03-27 | 2017-07-07 | 西南交通大学 | 一种基于实时环境信息的动态自动驾驶换道轨迹规划方法 |
IT201800011029A1 (it) * | 2018-12-12 | 2020-06-12 | Milano Politecnico | Procedimento e sistema di pianificazione di un percorso per un veicolo terrestre per elusione di ostacoli con rapida reazione, particolarmente in uno scenario di guida autonoma. |
CN110286681A (zh) * | 2019-07-05 | 2019-09-27 | 西南交通大学 | 一种变曲率弯道的动态自动驾驶换道轨迹规划方法 |
CN110362096A (zh) * | 2019-08-13 | 2019-10-22 | 东北大学 | 一种基于局部最优性的无人驾驶车辆动态轨迹规划方法 |
WO2021077725A1 (zh) * | 2019-10-21 | 2021-04-29 | 南京航空航天大学 | 一种基于驾驶意图的周围车辆运动状态预测***及方法 |
CN111750887A (zh) * | 2020-06-11 | 2020-10-09 | 上海交通大学 | 降低事故严重程度的无人驾驶车辆轨迹规划方法及*** |
CN112572443A (zh) * | 2020-12-22 | 2021-03-30 | 北京理工大学 | 一种高速公路车辆换道实时避撞轨迹规划方法及*** |
CN112965489A (zh) * | 2021-02-05 | 2021-06-15 | 北京理工大学 | 一种基于碰撞检测的智能车高速换道规划方法 |
CN112947469A (zh) * | 2021-03-16 | 2021-06-11 | 安徽卡思普智能科技有限公司 | 汽车换道轨迹规划与动态轨迹跟踪控制方法 |
CN113276848A (zh) * | 2021-04-09 | 2021-08-20 | 江苏大学 | 一种智能驾驶换道避障轨迹规划、跟踪控制方法及*** |
Non-Patent Citations (2)
Title |
---|
基于前车轨迹预测的高速智能车运动规划;张一鸣;周兵;吴晓建;崔庆佳;柴天;;汽车工程;20200525(05);12-18 * |
面向低速自动驾驶车辆的避障规划研究;肖宏宇;付志强;陈慧勇;;同济大学学报(自然科学版);20191215(S1);170-176 * |
Also Published As
Publication number | Publication date |
---|---|
CN114194215A (zh) | 2022-03-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114194215B (zh) | 一种智能车辆避障换道轨迹规划方法及*** | |
CN113386795B (zh) | 一种自动驾驶车辆智能决策及局部轨迹规划方法及其决策*** | |
CN109669461B (zh) | 一种复杂工况下自动驾驶车辆决策***及其轨迹规划方法 | |
CN109501799B (zh) | 一种车联网条件下的动态路径规划方法 | |
CN113291308B (zh) | 一种考虑驾驶行为特性的车辆自学习换道决策***及方法 | |
CN111273668B (zh) | 针对结构化道路的无人驾驶汽车运动轨迹规划***及方法 | |
Khodayari et al. | A historical review on lateral and longitudinal control of autonomous vehicle motions | |
US20220080961A1 (en) | Control system and control method for sampling based planning of possible trajectories for motor vehicles | |
CN110379203B (zh) | 一种行车转向碰撞预警方法 | |
CN112193244B (zh) | 基于线性约束的自动驾驶车辆运动规划方法 | |
CN106371439B (zh) | 一种统一的自动驾驶横向规划方法与*** | |
CN112896188B (zh) | 一种考虑前车遭遇的自动驾驶决策控制的*** | |
JP7313298B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
CN113085852A (zh) | 自动驾驶车辆的行为预警方法、装置及云端设备 | |
CN115520218B (zh) | 自动驾驶车辆四点转弯轨迹规划方法 | |
CN114074681A (zh) | 基于概率的车道变更决策和运动规划***及其方法 | |
CN112224202B (zh) | 一种紧急工况下的多车协同避撞***及方法 | |
CN111002993A (zh) | 一种基于场景识别的自动驾驶低油耗运动规划方法及*** | |
Ma et al. | Collision-avoidance lane change control method for enhancing safety for connected vehicle platoon in mixed traffic environment | |
CN113570747A (zh) | 一种基于大数据分析的行驶安全监测***和方法 | |
CN113460080A (zh) | 车辆控制装置、车辆控制方法及存储介质 | |
CN112650064B (zh) | 一种适应于混杂道路的智能汽车汇入控制***及方法 | |
CN111376901A (zh) | 车辆的控制方法、装置及车辆 | |
CN115848363A (zh) | 一种避撞和降损轨迹规划方法 | |
JP7125969B2 (ja) | 車両制御装置、車両制御方法、およびプログラム |
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 |