CN115848363A - 一种避撞和降损轨迹规划方法 - Google Patents
一种避撞和降损轨迹规划方法 Download PDFInfo
- Publication number
- CN115848363A CN115848363A CN202211507178.6A CN202211507178A CN115848363A CN 115848363 A CN115848363 A CN 115848363A CN 202211507178 A CN202211507178 A CN 202211507178A CN 115848363 A CN115848363 A CN 115848363A
- Authority
- CN
- China
- Prior art keywords
- collision
- collision avoidance
- vehicle
- track
- transverse
- 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.)
- Pending
Links
Images
Landscapes
- Traffic Control Systems (AREA)
Abstract
Description
技术领域
本发明涉及无人驾驶汽车的紧急避撞领域,特别是涉及一种无人驾驶应急场景下避撞和降损轨迹规划方法。
背景技术
汽车紧急避让***作为一种主动安全技术,通过毫米波雷达、激光雷达或者是摄像头来检测周围环境信息,在即将发生碰撞时帮助驾驶员完成避撞操作,提升驾驶安全性。紧急避让***按照执行器划分,可分为制动避撞、转向避撞、制动转向联合避撞。目前的汽车避撞产品主要通过制动方式实现,它通过检测道路前方的障碍物,根据汽车车速和相对距离,当将要发生碰撞时,通过主动制动方式使汽车停车。一般来说,一个完整的汽车避让***包括4部分:1.环境识别及融合;2.行为决策;3.路径规划;4.路径跟踪。基于智能车辆、无人驾驶车辆的紧急工况下的避撞***,是在环境识别模块做出避撞决策后,经过上层的路径规划和下层路径跟踪,进行紧急避撞控制。
当前无人驾驶避撞技术存在对应急场景下和降损方面考虑的不足。大多仅考虑自车与单一的障碍车辆,很少考虑自车周围存在多个障碍车的应急场景;另外考虑的场景多是速度较低的情况,大部分仅考虑自车时速在80km/h及以下的情况,对于80km/h~120km/h的高速紧急情况考虑较少;而对于80km/h~120km/h的高速紧急情况,则必然会出现不能完全避撞的情况,因此需要将不能完全避撞情况下的降损纳入考量范围。
发明内容
为了解决上述技术中的问题,本发明提出了一种无人驾驶应急场景下避撞和降损轨迹规划方法,使规划出的轨迹的碰撞受损度最低。
一种无人驾驶应急场景下避撞和降损轨迹规划方法,包括以下步骤:
步骤1:基于传感器获取自车周围车辆运动信息。
步骤2:基于步骤1获取的周围车辆运动信息,基于纵向避撞临界距离和横向避撞临界距离,构建轨迹规划可行域。
步骤3:基于五次多项式,在可行域生成避撞轨迹簇。根据不同的横向加速度,可生成多段避撞轨迹,即生成避撞轨迹簇。
步骤4:建立碰撞受损度代价函数K,代价函数K由碰撞速度系数Kv、碰撞角度系数换道稳定度系数KS组成。采用多目标优化法,求解出最小碰撞受损度代价函数K对应的横向加速度ayref,从而确定出碰撞受损度最小的换道轨迹。
进一步的,基于步骤1获取的周围车辆运动信息,基于纵向避撞临界距离和横向避撞临界距离,构建轨迹规划可行域。具体为,所述纵向避撞临界距离公式如下:
式中,为自车纵向车速,/>为周围车辆纵向车速,Tdelay为制动***延迟时间,αxmax为最大制动减速度,Ssafe为安全车距。参数取值为,Tdelay=0.2s,αxmax=0.8g,Ssafe=5m。
所述横向避撞临界距离公式如下:
式中,μ为路面附着系数。
基于计算得到的周围各车相对于自车的纵向避撞临界距离和横向避撞临界距离,可构建出轨迹规划可行域,为轨迹规划提供约束。
进一步的,基于五次多项式,在可行域生成避撞轨迹簇。具体为,所述五次多项式轨迹公式如下:
式中,xref(t)为参考纵向位置随时间t的关系,yref(t)为参考横向位置随时间t的关系,ye为横向总位移即避撞过程横向总位移,ye=3.75m,te为总的换道时间。
所生成避撞轨迹的横向加速度为:
根据不同的横向加速度,可生成多段避撞轨迹,即生成避撞轨迹簇。
具体为,所述碰撞速度系数Kv,基于运动学计算自车与周围车纵向发生碰撞时的相对速度,其数学表示为
进一步的,所述换道稳定度系数KS,基于自车换道的横向加速度,判断自车换道过程的稳定性,其数学表示为
进一步的,所述碰撞受损度代价函数K为
通过步骤2中建立的可行域建立约束为
采用多目标优化法,求解出最小碰撞受损度代价函数K对应的横向加速度αyref,从而确定出碰撞受损度最小的换道轨迹。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明提供的避撞和降损轨迹规划方法总体框图;
图2为本发明提供的构建轨迹规划可行域示意图;
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
如图1所示,本发明提供了一种人驾驶应急场景下避撞和降损轨迹规划方法。其总体结构包括:环境感知和预测模块、可行域生成模块、轨迹簇生成模块和轨迹优化模块。
可行域生成模块基于环境感知和预测模块获取的周围车辆运动信息,基于纵向避撞临界距离和横向避撞临界距离,构建轨迹规划可行域。
轨迹簇生成模块基于五次多项式,在可行域生成避撞轨迹簇。根据不同的横向加速度,可生成多段避撞轨迹,即生成避撞轨迹簇。
轨迹优化模块建立碰撞受损度代价函数K,代价函数K由碰撞速度系数Kv、碰撞角度系数换道稳定度系数KS组成。采用多目标优化法,求解出最小碰撞受损度代价函数K对应的横向加速度ayref,从而确定出碰撞受损度最小的换道轨迹。
本发明的技术方案是一种无人驾驶应急场景下避撞和降损轨迹规划方法,包括以下步骤:
步骤2:基于步骤1获取的周围车辆运动信息,基于纵向避撞临界距离和横向避撞临界距离,构建轨迹规划可行域,如图2所示。具体为,所述纵向避撞临界距离公式如下:
式中,为自车纵向车速,/>为周围车辆纵向车速,Tdelay为制动***延迟时间,axmax为最大制动减速度,Ssafe为安全车距。参数取值为,Tdelay=0.2s,axmax=0.8g,Ssafe=5m。
所述横向避撞临界距离公式如下:
式中,μ为路面附着系数。
基于计算得到的周围各车相对于自车的纵向避撞临界距离和横向避撞临界距离,可构建出轨迹规划可行域,为轨迹规划提供约束。
步骤3:基于五次多项式,在可行域生成避撞轨迹簇,如图2所示。具体为,所述五次多项式轨迹公式如下:
式中,xref(t)为参考纵向位置随时间t的关系,yref(t)为参考横向位置随时间t的关系,ye为横向总位移即避撞过程横向总位移,ye=3.75m,te为总的换道时间。
所生成避撞轨迹的横向加速度为:
根据不同的横向加速度,可生成多段避撞轨迹,即生成避撞轨迹簇。
具体为,所述碰撞速度系数Kv,基于运动学计算自车与周围车纵向发生碰撞时的相对速度,其数学表示为
所述换道稳定度系数Ks,基于自车换道的横向加速度,判断自车换道过程的稳定性,其数学表示为
综上,所述碰撞受损度代价函数K为
通过步骤2中建立的可行域建立约束为
采用多目标优化法,求解出最小碰撞受损度代价函数K对应的横向加速度αyref,从而确定出碰撞受损度最小的换道轨迹。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,对于本技术领域的技术人员在本发明揭露的技术范围内,还可以做出若干改动和调整。因此,本发明的保护范围应该以权利要求的保护范围为准。
Claims (10)
1.一种避撞和降损轨迹规划方法,其特征在于,包括以下步骤,
步骤1:基于传感器获取自车及周围车辆运动信息;
步骤2:基于步骤1获取的周围车辆运动信息,基于纵向避撞临界距离和横向避撞临界距离,构建轨迹规划可行域;
步骤3:基于五次多项式轨迹公式,在所述可行域内根据不同的横向加速度生成多段避撞轨迹簇;
步骤4:建立碰撞受损度代价函数K,采用多目标优化法,求解出最小碰撞受损度代价函数K对应的横向加速度αyref,确定碰撞受损度最小的换道轨迹。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211507178.6A CN115848363A (zh) | 2022-11-29 | 2022-11-29 | 一种避撞和降损轨迹规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211507178.6A CN115848363A (zh) | 2022-11-29 | 2022-11-29 | 一种避撞和降损轨迹规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115848363A true CN115848363A (zh) | 2023-03-28 |
Family
ID=85667503
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211507178.6A Pending CN115848363A (zh) | 2022-11-29 | 2022-11-29 | 一种避撞和降损轨迹规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115848363A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118061994A (zh) * | 2024-04-16 | 2024-05-24 | 湖南天烽科技有限公司 | 基于数据交互的车辆距离智能避让*** |
-
2022
- 2022-11-29 CN CN202211507178.6A patent/CN115848363A/zh active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118061994A (zh) * | 2024-04-16 | 2024-05-24 | 湖南天烽科技有限公司 | 基于数据交互的车辆距离智能避让*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8428843B2 (en) | Method to adaptively control vehicle operation using an autonomic vehicle control system | |
EP3699051A1 (en) | Vehicle control device | |
US20200238980A1 (en) | Vehicle control device | |
CN112193244B (zh) | 基于线性约束的自动驾驶车辆运动规划方法 | |
US20220080961A1 (en) | Control system and control method for sampling based planning of possible trajectories for motor vehicles | |
US20210188258A1 (en) | Vehicle control device | |
JP7440324B2 (ja) | 車両制御装置、車両制御方法、及びプログラム | |
CN111422196A (zh) | 一种适用于微巴的智能网联自动驾驶***及方法 | |
US20200353918A1 (en) | Vehicle control device | |
CN111661055A (zh) | 一种自动驾驶车辆的换道控制方法和*** | |
JP7429143B2 (ja) | 移動体制御装置、移動体制御方法、およびプログラム | |
CN112896188B (zh) | 一种考虑前车遭遇的自动驾驶决策控制的*** | |
CN111650945B (zh) | 动态障碍物防撞方法 | |
CN113844445B (zh) | 基于预测参考线坐标系的车辆自动紧急制动***与方法 | |
CN114194215B (zh) | 一种智能车辆避障换道轨迹规划方法及*** | |
Sun et al. | An active safety control method of collision avoidance for intelligent connected vehicle based on driving risk perception | |
Mehmood et al. | Trajectory planning and control for lane-change of autonomous vehicle | |
JP2019147486A (ja) | 車両制御システム、車両制御方法、およびプログラム | |
CN115848363A (zh) | 一种避撞和降损轨迹规划方法 | |
JP2021160532A (ja) | 車両制御装置、車両制御方法、及びプログラム | |
CN115129053A (zh) | 一种机场牵引运输车及其自动驾驶*** | |
JP7225185B2 (ja) | 車両制御装置、車両制御方法、およびプログラム | |
CN117227714A (zh) | 一种自动驾驶车辆转弯避让控制方法及*** | |
JP2022083012A (ja) | 車両制御装置、車両制御方法、およびプログラム | |
CN116946137A (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 |