CN109532832B - 一种智能驾驶中纵向规划方法 - Google Patents
一种智能驾驶中纵向规划方法 Download PDFInfo
- Publication number
- CN109532832B CN109532832B CN201811499161.4A CN201811499161A CN109532832B CN 109532832 B CN109532832 B CN 109532832B CN 201811499161 A CN201811499161 A CN 201811499161A CN 109532832 B CN109532832 B CN 109532832B
- Authority
- CN
- China
- Prior art keywords
- speed
- planning
- vehicle
- target
- emergency
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 230000001960 triggered effect Effects 0.000 claims description 3
- 230000004888 barrier function Effects 0.000 claims 3
- 230000000694 effects Effects 0.000 claims 1
- 230000001133 acceleration Effects 0.000 abstract description 14
- 238000011217 control strategy Methods 0.000 description 2
- 239000000446 fuel Substances 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 230000007812 deficiency Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000007257 malfunction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
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
- 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/14—Adaptive cruise control
- B60W30/143—Speed control
-
- 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/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/804—Relative longitudinal speed
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供了一种智能驾驶中纵向规划方法,包括:步骤01:获取多个目标对象的目标速度;步骤02:对目标速度分别进行多目标速度规划;步骤03:根据多目标速度规划得到的结果,选取其中最低速度为当前的规划结果。采用基于插值和多目标综合规划的方法,可以保证车辆的纵向安全性,并重点保障其加减速过程中具有的舒适性,以响应前方多目标的信息进行速度规划,从而保证纵向上的安全性;可以实现稳定的速度保持功能,降低停车误差;针对不同精度的刹车系统,均能实现自动驾驶车辆的纵向规划。
Description
技术领域
本发明涉及自动驾驶技术领域,具体涉及一种智能驾驶中纵向规划方法。
背景技术
汽车在保持纵向安全距离的过程中,需要对车辆的行进速度和加速度进行规划,并保证加减速过程的安全性和舒适性。
现有技术方案存在的问题和缺点:车辆加减速过程往往追求快速响应,而造成加减速过猛、舒适性较差;一般自动驾驶系统的纵向规划方法往往难以适应多种车型和多种路况等条件,刹车和停车精度难以保证。
现有的纵向规划方案为单目标速度规划,单目标速度规划的原理如下:
一、约束距离
约束距离,为车辆由当前速度加速到最大速度、并能在到达障碍物前平缓减速到与之保持相对静止的最短距离.约束距离随驾驶态势而变,其大小取决于车辆当前速度、容许的最大速度、目标障碍物速度、最大加速度约束和心理减速度约束等,如下:
stotal=sacce+sdece
其中,sacce为加速约束距离,sdece为减速约束距离,stotal为总的约束距离.
进一步的,vcur为车辆当前速度,vmax为容许的最大速度,vobj目标障碍物速度(包括动态障碍物速度、根据曲率计算得到的过弯速度和根据可通行路径宽度计算得到避障速度等);aacce为最大加速度(可设置,默认为10s由零加速到最大速度),adece为心理减速度(可设置,默认为10s由最大速度减速到零,突发情况下减速度不受此减速度约束).
二、速度插值
A插值原理
当车辆与障碍物距离在约束距离之外时,说明车辆按照最大速度行驶也能保证安全性和纵向舒适性(实际加速度介于aacce和adece之间,不会骤升骤减),规划速度取最大速度vmax;
当车辆与障碍物距离在约束距离之内时,车速无法达到最大速度,于是为了保证规划速度的连续性需要对速度进行插值,如下:
其中,vplan为针对该障碍物的规划速度,s为车辆(后轴中心)到障碍物的实际距离.
B插值模式
根据驾驶行为的不同表现,纵向规划分为节能模式和运动模式,如下:
a.节能模式:
对车道内可避让障碍物不进行速度插值,目标速度直接采用障碍物速度vobj;
b.运动模式:
更注重时间性能,对车道内可避让障碍物进行速度插值vplan,这些速度包括过弯速度和避障速度等.
C控制策略
纵向速度的控制策略包括精确控制与模糊控制两种,秦EV总体上采用精确的速度控制,以下例外:
弯道内速度规划:采用模糊控制,当实际车速与过弯速度的差异在5km/h之内波动时,不再对速度进行调整,而是采用当前速度过弯。
因此,由于实际道路环境的多变,传统的智能驾驶中的速度规划方法存在仅针对前方单一目标进行纵向规划、加减速过猛,不能实现定点停车等方面的问题。
发明内容
为了克服以上问题,本发明旨在一种智能驾驶中纵向规划方法,弥补单目标纵向规划的不足。
为了实现上述目的,本发明提供了一种智能驾驶中纵向规划方法,包括:
步骤01:获取多个目标对象的目标速度;
步骤02:对目标速度分别进行多目标速度规划;
步骤03:根据多目标速度规划得到的结果,选取其中最低速度为当前的规划结果。
在一些实施例中,所述步骤03中,还包括安全策略规划。
在一些实施例中,所述安全策略规划包括基本安全策略规划和紧急安全策
略规划;
基本安全策略规划包括:在非突发情况下,根据满足多目标约束的纵向规划策略来保持安全距离并保证纵向安全性;
紧急安全策略规划包括:在突发情况下,在障碍物与车辆过于接近碰撞距离时,自动触发紧急安全策略并进行紧急刹车。
在一些实施例中,所述突发情况包括:动态障碍物过于逼近、刹车系统执
行效果变差。
在一些实施例中,所述步骤03中,所述最低速度如果是由于自车刹车系统
失灵或前方突发状况造成的,则自车进入紧急刹车状态。
在一些实施例中,所述碰撞距离为所设定的自车与障碍物发生碰撞的极限
距离。
在一些实施例中,所述步骤03之后还包括:将多目标速度规划得到的结果
发送到车辆控制模块;车辆控制模块根据所述结果控制智能驾驶的速度。
在一些实施例中,所述步骤01中,所述目标速度包括:车辆当前速度、前
方动态障碍物速度、过弯速度、避障速度。
在一些实施例中,所述步骤01中,所述目标对象包括:自车、前方动态障
碍物。
在一些实施例中,所述步骤02具体包括:
对单个目标分别进行速度规划,并对结果综合考虑,选取最低速度作为最终结果,如下:
本发明的智能驾驶中纵向规划方法,采用基于插值和多目标综合规划的方法,可以保证车辆的纵向安全性,并重点保障其加减速过程中具有的舒适性;可以响应前方多目标的信息进行速度规划(如包括弯道、弯道前障碍物、弯道中障碍物和弯道后障碍物这类复杂多目标的速度规划),从而保证纵向上的安全性;本技术可以实现稳定的速度保持功能,在正常工况下速度误差不超过正负1km/h;本技术可以实现定点停车,在正常工况下停车误差不超过正负20cm,还可以有效处理静动态障碍物、红绿灯与停止线、减速带等纵向规划场景;本技术针对燃油车和电动车、乘用车和商用车等不同车型时均具有明显的实用性;针对不同精度的刹车系统(从用于刹车精度亮度良好的0.01g到仅能用于紧急刹车AEB场景的0.1g),均能实现自动驾驶车辆的纵向规划。
附图说明
图1为本发明的一个实施例的智能驾驶中纵向规划方法的流程示意图
具体实施方式
为使本发明的内容更加清楚易懂,以下结合说明书附图,对本发明的内容作进一步说明。当然本发明并不局限于该具体实施例,本领域内的技术人员所熟知的一般替换也涵盖在本发明的保护范围内。
以下结合附图1和具体实施例对本发明作进一步详细说明。需说明的是,附图均采用非常简化的形式、使用非精准的比例,且仅用以方便、清晰地达到辅助说明本实施例的目的。
请参阅图1,本实施例的一种智能驾驶中纵向规划方法,其包括:
步骤01:获取多个目标对象的目标速度;
具体的,步骤01中,目标速度包括:车辆当前速度、前方动态障碍物速度、过弯速度、避障速度等。目标对象包括:自车、前方动态障碍物等。
步骤02:对目标速度分别进行多目标速度规划;
具体的,对单个目标分别进行速度规划,并对结果综合考虑,选取最低速度作为最终结果,如下:
步骤03:根据多目标速度规划得到的结果,选取其中最低速度为当前的规划结果。
具体的,本步骤03中,还包括安全策略规划。这里的安全策略规划包括基本安全策略规划和紧急安全策略规划。基本安全策略规划包括:在非突发情况下,根据满足多目标约束的纵向规划策略来保持安全距离并保证纵向安全性。紧急安全策略规划包括:在突发情况下,在障碍物与车辆过于接近碰撞距离时,自动触发紧急安全策略并进行紧急刹车。这里的碰撞距离为所设定的自车与障碍物发生碰撞的极限距离。一旦小于该极限距离,会出现车辆碰撞。
这里,突发情况包括:动态障碍物过于逼近、刹车系统执行效果变差等。基于该安全策略规划,本实施例的步骤03中,最低速度如果是由于自车刹车系统失灵或前方突发状况造成的,则自车进入紧急刹车状态。
此外,本实施例中,步骤03之后还包括:将多目标速度规划得到的结果发送到车辆控制模块;车辆控制模块根据所述结果控制智能驾驶的速度。
综上所述,本发明的智能驾驶中纵向规划方法,采用基于插值和多目标综合规划的方法,可以保证车辆的纵向安全性,并重点保障其加减速过程中具有的舒适性;本技术可以响应前方多目标的信息进行速度规划(如包括弯道、弯道前障碍物、弯道中障碍物和弯道后障碍物这类复杂多目标的速度规划),从而保证纵向上的安全性;本技术可以实现稳定的速度保持功能,在正常工况下速度误差很小;本技术可以实现定点停车,在正常工况下停车误差很小;本技术可以有效处理静动态障碍物、红绿灯与停止线、减速带等纵向规划场景,并且针对燃油车和电动车、乘用车和商用车等不同车型时均具有明显的实用性;针对不同精度的刹车系统,均能实现自动驾驶车辆的纵向规划。
虽然本发明已以较佳实施例揭示如上,然所述实施例仅为了便于说明而举例而已,并非用以限定本发明,本领域的技术人员在不脱离本发明精神和范围的前提下可作若干的更动与润饰,本发明所主张的保护范围应以权利要求书所述为准。
Claims (3)
1.一种智能驾驶中纵向规划方法,其特征在于,包括:
步骤01:获取多个目标对象的目标速度;
步骤02:对目标速度分别进行多目标速度规划;
步骤03:根据多目标速度规划得到的结果,选取其中最低速度为当前的规划结果;
所述步骤01中,所述目标速度包括:车辆当前速度、前方动态障碍物速度、过弯速度、避障速度;
所述步骤01中,所述目标对象包括:自车、前方动态障碍物;
所述步骤02具体包括:
对单个目标分别进行速度规划,并对结果综合考虑,选取最低速度作为最终结果;
所述步骤03中,还包括安全策略规划;
所述安全策略规划包括基本安全策略规划和紧急安全策略规划;
基本安全策略规划包括:在非突发情况下,根据满足多目标约束的纵向规划策略来保持安全距离并保证纵向安全性;
紧急安全策略规划包括:在突发情况下,在障碍物与车辆过于接近碰撞距离时,自动触发紧急安全策略并进行紧急刹车;
所述突发情况包括:动态障碍物过于逼近、刹车系统执行效果变差;
所述步骤03中,所述最低速度如果是由于自车刹车系统失灵或前方突发状况造成的,则自车进入紧急刹车状态。
2.根据权利要求1所述的纵向规划方法,其特征在于,所述碰撞距离为所设定的自车与障碍物发生碰撞的极限距离。
3.根据权利要求1所述的纵向规划方法,其特征在于,所述步骤03之后还包括:将多目标速度规划得到的结果发送到车辆控制模块;车辆控制模块根据所述结果控制智能驾驶的速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811499161.4A CN109532832B (zh) | 2018-12-08 | 2018-12-08 | 一种智能驾驶中纵向规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811499161.4A CN109532832B (zh) | 2018-12-08 | 2018-12-08 | 一种智能驾驶中纵向规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109532832A CN109532832A (zh) | 2019-03-29 |
CN109532832B true CN109532832B (zh) | 2020-12-15 |
Family
ID=65853319
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811499161.4A Expired - Fee Related CN109532832B (zh) | 2018-12-08 | 2018-12-08 | 一种智能驾驶中纵向规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109532832B (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105589464A (zh) * | 2016-03-28 | 2016-05-18 | 哈尔滨工程大学 | 一种基于速度障碍法的uuv动态避障方法 |
CN106470884A (zh) * | 2014-06-17 | 2017-03-01 | 大众汽车有限公司 | 车辆状态的确定和在驾驶车辆时的驾驶员辅助 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7349767B2 (en) * | 2003-12-16 | 2008-03-25 | Nissan Motor Co., Ltd. | Method and system for intention estimation and operation assistance |
KR101029096B1 (ko) * | 2010-11-18 | 2011-04-13 | 김은숙 | 차량의 측면 충돌 회피 방법 |
CN105261224B (zh) * | 2015-09-02 | 2017-09-12 | 奇瑞汽车股份有限公司 | 智能车辆控制方法和装置 |
CN107719369B (zh) * | 2017-09-14 | 2019-05-10 | 北京智行者科技有限公司 | 自动驾驶纵向控制方法、装置及具有其的无人驾驶车辆 |
CN108189835B (zh) * | 2017-12-28 | 2020-04-21 | 清华大学苏州汽车研究院(吴江) | 一种自动驾驶的避撞控制方法及系统 |
-
2018
- 2018-12-08 CN CN201811499161.4A patent/CN109532832B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106470884A (zh) * | 2014-06-17 | 2017-03-01 | 大众汽车有限公司 | 车辆状态的确定和在驾驶车辆时的驾驶员辅助 |
CN105589464A (zh) * | 2016-03-28 | 2016-05-18 | 哈尔滨工程大学 | 一种基于速度障碍法的uuv动态避障方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109532832A (zh) | 2019-03-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106940933B (zh) | 一种基于智能交通系统的智能车辆决策换道方法 | |
CN110723141B (zh) | 一种车辆主动避撞系统及其避撞方式切换方法 | |
CN107993453B (zh) | 一种基于车路协同的弯道安全车速计算方法 | |
CN111583693B (zh) | 一种城市道路智能交通协同运行系统及智能车辆控制方法 | |
CN110488802A (zh) | 一种网联环境下的自动驾驶车辆动态行为决策方法 | |
CN107161143A (zh) | 一种采用人工势场法的车辆主动避撞方法 | |
CN110723142B (zh) | 一种智能汽车紧急避撞控制方法 | |
CN106527452A (zh) | 一种无人驾驶汽车遇障时运动路径规划方法及系统 | |
CN102800214A (zh) | 一种基于车车信息交互条件下的车辆换道冲突消解方法 | |
CN110304074A (zh) | 一种基于分层状态机的混合式驾驶方法 | |
CN106314430B (zh) | 一种应用于智能汽车的纵向主动安全防撞系统及其方法 | |
CN112224202B (zh) | 一种紧急工况下的多车协同避撞系统及方法 | |
CN105857294A (zh) | 一种汽车换道避撞控制方法 | |
JP2022521137A (ja) | 車両を安全化するための方法 | |
WO2023029239A1 (zh) | 一种基于毫米波雷达的紧急转向系统 | |
CN116946137A (zh) | 一种基于驾驶意图的车路协同智能车辆换道防碰撞系统 | |
CN115158308A (zh) | 一种智能车辆主动避障控制方法及装置、存储介质、终端 | |
CN114763135A (zh) | 一种车辆行驶控制方法、装置、电子设备及存储介质 | |
WO2021109163A1 (zh) | 用于车辆自动驾驶的数据处理方法 | |
CN110775027A (zh) | 基于后车驾驶模式的防追尾制动系统和方法 | |
CN114104003A (zh) | 一种车辆控制方法 | |
CN109532832B (zh) | 一种智能驾驶中纵向规划方法 | |
CN117382619A (zh) | 一种换道风险评估方法及其装置和智能车辆、存储介质 | |
Ding et al. | Research on safety lane change warning method based on potential angle collision point | |
CN117246321A (zh) | 一种多场景下的前方危险目标检测方法及aeb控制策略 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20201215 Termination date: 20211208 |
|
CF01 | Termination of patent right due to non-payment of annual fee |