CN110304074A - 一种基于分层状态机的混合式驾驶方法 - Google Patents
一种基于分层状态机的混合式驾驶方法 Download PDFInfo
- Publication number
- CN110304074A CN110304074A CN201910574456.1A CN201910574456A CN110304074A CN 110304074 A CN110304074 A CN 110304074A CN 201910574456 A CN201910574456 A CN 201910574456A CN 110304074 A CN110304074 A CN 110304074A
- Authority
- CN
- China
- Prior art keywords
- lane
- vehicle
- state
- state machine
- speed
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000013517 stratification Methods 0.000 title claims abstract description 21
- 230000001133 acceleration Effects 0.000 claims abstract description 20
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 13
- 238000005096 rolling process Methods 0.000 claims abstract description 11
- 230000007613 environmental effect Effects 0.000 claims abstract description 7
- 238000003786 synthesis reaction Methods 0.000 claims abstract description 7
- 230000006870 function Effects 0.000 claims description 37
- 230000008569 process Effects 0.000 claims description 11
- 238000005070 sampling Methods 0.000 claims description 10
- 230000008859 change Effects 0.000 claims description 4
- 238000006073 displacement reaction Methods 0.000 claims description 4
- 230000008450 motivation Effects 0.000 claims description 4
- 230000006855 networking Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 230000035945 sensitivity Effects 0.000 claims description 2
- 230000006399 behavior Effects 0.000 description 12
- 238000005457 optimization Methods 0.000 description 9
- 238000004088 simulation Methods 0.000 description 7
- 238000001514 detection method Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 238000012549 training Methods 0.000 description 3
- 230000008447 perception Effects 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000003066 decision tree Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000012360 testing method Methods 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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 or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0016—State machine analysis
-
- 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
-
- 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
- B60W2556/00—Input parameters relating to data
- B60W2556/45—External transmission of data to or from the vehicle
- B60W2556/50—External transmission of data to or from the vehicle for navigation systems
Abstract
本发明公开了一种基于分层状态机的混合式驾驶方法,先利用传感器感知环境信息,再利用分层状态机认定具体场景和规划驾驶动作,然后利用滚动时域优化的局部路径规划方法进行具体驾驶路线及指令的规划,最后对规划的驾驶路线进行合成,合成后的轨迹点所对应的加速度等信息即为智能车决策系统的指令规划,那么智能车按照合成轨迹就可以进行安全驾驶。
Description
技术领域
本发明属于自动驾驶技术领域,更为具体地讲,涉及一种基于分层状态机的混合式驾驶方法。
背景技术
车辆不恰当的换道行为是道路交通事故和交通拥堵的主要因素。城区环境下,交通要素复杂多变,其状态难以预测。在换道过程中,驾驶员不仅需要仔细观察车辆周围的交通条件,还需要短时间内,根据当前车辆与目标车辆的空间条件、时间条件、车辆状况和驾驶员的主管意愿等,进行判断,决策是否换道、如何换道。换道行为作为日常驾驶中的一种常见行为,也是一种比较复杂的驾驶行为。
传统的经验规则决策算法对智能车及环境模型的依赖较高,在复杂动态的交通环境下,车辆的换道空间具有明显的差异性,换道过程中的大量动态性、不确定信息也为自动驾驶车辆的驾驶决策带来了巨大挑战。
先验规则型驾驶行为建模过程通常不涉及数据采样和训练,而是人为解析驾驶场景抽取有用信息,利用先验规则,综合考虑安全性、舒适性、目的便利性等因素,建立驾驶场景到安全驾驶行为的映射。
发明内容
本发明的目的在于克服现有技术的不足,提供一种基于分层状态机的混合式驾驶方法,针对多车道换道场景,实现无人驾驶过程中的有效决策。
为实现上述发明目的,本发明一种基于分层状态机的混合式驾驶方法,其特征在于,包括以下步骤:
(1)、利用传感器感知环境信息
在车联网方式下,利用传感器获取本车道和周围两边车道前方和后方最近车辆的距离、速度信息,以及本车的速度信息以及GPS导航和路网文件;
(2)、利用分层状态机的顶层状态机认定具体场景
顶层状态机M顶=(Q顶,Σ顶,δ顶,q0顶,F顶),其中,Q顶为位于不同场景之间的特定状态;Σ顶多为GPS坐标、地图、任务文件构成的对场景认定的特定约束,作为输入事件;q0∈Q为系统的初始状态,;在时刻i,系统处于状态qi顶时,qi顶∈Q顶,接受输入事件ai后,δ顶为状态迁移到新状态的概率分布;是系统任务完成的终止状态;
(3)、利用分层状态机的底层状态机规划驾驶动作
底层状态机M底=(Q底,Σ底,δ底,q0底,F底),Q底为决策过程的各子阶段状态,Σ底为决策过程中产生的各种换道逻辑,δ底采用全概率转移,q0底为决策开始的初始阶段状态,F底为车道保持和换道决策结果对应的状态集合;
(4)、基于步骤(3)规划的驾驶动作,利用滚动时域优化的局部路径规划方法进行具体驾驶路线及指令的规划
(4.1)、在Frenet坐标系下,初始时刻t0,智能车横、纵向方向的位置、速度、加速度状态分别为(l0,l′0,l″0),(s0,s′0,s″0),规划路径的末时刻为t1,其状态为(l1,l′1,l″1),(s1,s′1,s″1),智能车轨迹的制动周期为T=t1-t0;
(4.2)、智能车横向控制
(4.2.1)、设置目标配置集合[l1,l′1,l″1,T]=[d,0,0,t],d为横向位置,t为决策时间;
(4.2.2)、设置横向控制的代价函数:CL=kjmax(|at0-at|)+ktT+kd|l1-llabel|
其中,max(|at0-at|)表示决策时间t内最大加速度的变化值,保证智能车舒适性,T为制动时间,要求智能车能短时间内制动,|l1-llabel|为末状态的横向位移与车道线中心的距离,保证车辆不会偏离目标车道中心线,中心线位置为llabel;kj、kt和kd为惩罚性系数;
(4.2.3)、基于代价函数,通过配置d和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
(4.3)、智能车纵向控制
(4.3.1)、跟车:t1时刻车辆速度应该为前车速度,位置应该前车位置减去安全距离,加速度为0;
(4.3.2)、车速保持:设置目标配置集合:
[s′1,s″1,T]=[s′,0,t]
其中,s′为纵向速度,t为决策时间;
制定车速保持的代价函数:
其中,s′label为需要保持的纵向速度;
基于代价函数,通过配置s′和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
(4.3.3)、停车:设置目标配置集合:
[s1,s′1,s″1,T]=[d*,0,0,t]
其中,d*为纵向位置,t为决策时间;
制定停车的代价函数:
基于代价函数,通过配置d*和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
(5)、轨迹二维合成
其中,kL横行控制系数,kS纵向控制系数;τ=1,2,当τ=1时,取车速保持的代价函数当τ=2时,取车速保持的代价函数
(6)、智能车按照合成轨迹进行安全驾驶。
本发明的发明目的是这样实现的:
本发明基于分层状态机的混合式驾驶方法,先利用传感器感知环境信息,再利用分层状态机认定具体场景和规划驾驶动作,然后利用滚动时域优化的局部路径规划方法进行具体驾驶路线及指令的规划,最后对规划的驾驶路线进行合成,合成后的轨迹点所对应的加速度等信息即为智能车决策系统的指令规划,那么智能车按照合成轨迹就可以进行安全驾驶。
同时,本发明基于分层状态机的混合式驾驶方法还具有以下有益效果:
(1)、采用混合式规划决策体系结构,既符合逐层递阶体系的特点:系统结构层次清晰,每个模块各司其职,问题求解精度较高;也满足动作反应体系的特点:结合了诸如变道超车的动作分解,各子行为相对独立,提高了系统鲁棒性。
(2)、系统中的行为规划层加上滚动时域优化的局部路径规划,综合传感器感知的周围环境,规划出一条无碰撞路径,进一步保障了系统的安全性。
(3)滚动时域优化的局部路径规划能保障系统的实时性以及考虑驾驶过程的舒适性作出决策。
附图说明
图1是本发明基于分层状态机的混合式驾驶方法流程图;
图2是智能车感知信息示意图;
图3是顶层状态机的决策机制结构图;
图4是换道状态机的决策机制结构图;
图5是路径规划的决策机制结构图;
图6是横向位移路径规划仿真图;
图7是跟车模型纵向规划仿真图;
图8是速度保持模型纵向速率规划仿真图;
图9是停车模型纵向速率规划仿真图;
图10是中轨迹的二维合成仿真图。
具体实施方式
下面结合附图对本发明的具体实施方式进行描述,以便本领域的技术人员更好地理解本发明。需要特别提醒注意的是,在以下的描述中,当已知功能和设计的详细描述也许会淡化本发明的主要内容时,这些描述在这里将被忽略。
实施例
图1是本发明基于分层状态机的混合式驾驶方法流程图。
在本实施例中,如图1所示,本发明一种基于分层状态机的混合式驾驶方法,包括以下步骤:
S1、利用传感器感知环境信息
如图2所示,在车联网方式下,通过雷达等传感器获取本车道和周围两边车道前方和后方最近车辆的距离、速度信息,以及本车的速度信息以及GPS导航和路网文件;
S2、利用分层状态机的顶层状态机认定具体场景
顶层状态机M顶=(Q顶,Σ顶,δ顶,q0顶,F顶),其中,Q顶为位于不同场景之间的特定状态;Σ顶多为GPS坐标、地图、任务文件构成的对场景认定的特定约束,作为输入事件;q0∈Q为系统的初始状态,;在时刻i,系统处于状态qi顶时,qi顶∈Q顶,接受输入事件ai后,δ顶为状态迁移到新状态的概率分布;是系统任务完成的终止状态;
在本实施例中,如图3,采用GPS导航和路网文件等完成如乡村道路、城区道路、高速道路场景的认定及路上、匝道等具体子场景的细化。
S3、利用分层状态机的底层状态机规划驾驶动作
如图4所示,底层状态机负责具体驾驶子动作的决策,不但承接了上层状态机对驾驶环境的认定,更是对下层实际行车的轨迹规划模块服务,能够将复杂的决策逻辑清晰条理化,排错容易。
底层状态机M底=(Q底,Σ底,δ底,q0底,F底),Q底为决策过程的各子阶段状态,Σ底为决策过程中产生的各种换道逻辑,δ底采用全概率转移,q0底为决策开始的初始阶段状态,F底为车道保持和换道决策结果对应的状态集合;
其中,针对多车道换道场景,底层状态机在决策过程中产生的各种换道逻辑为:
S3.1、产生换道意图
在多车道道路中,在路上状态下智能车需要根据实际道路环境,采取车道保持和换道两种驾驶行为。我们常用车头时距去衡量是否离前方车辆足够近,即:
TH=d/vhost
其中,d为前后车辆车头间距,vhost为后车的速度;
车头时距可以反应当前车刹车时,后车驾驶员的最大反应时,可间接用于评价车辆通行时空间层面的安全性因素。后车速度一定的情况下,当TH值大于预设阈值,则不存在换道动机,进行车道保持;否则,存在空间层面的换道动机,并进行后续步骤判断;
S3.2、交通规则下的车道选择
在实际交通规则的约束下,根据实际车况路况,选择邻近的一条具体可行的车道,优先考虑临界左车道;若当前路段不允许变道,则进行车道保持,否则进行后续步骤判断;
S3.3、计算换道的风险系数
在选定好具体目标车道后,分别考虑目标车道的前导车和跟随车的因素,计算换道的风险系数,如果任意的一个风险系数较大,则由换道状态机内部状态迁移到车道保持状态机,如果满足上述条件,则执行换道策略,向相应方向横向移动车辆,在未完成换道时,不断进行风险系数的计算,确认整个换道过程更加安全可靠。下面我们对具体过程进行说明。
S3.3.1、计算智能车与目标车道后方跟随车的风险系数P1:
其中,τ∈(0,t),反应了加速度对纵向位移的影响,d0为在换道初始阶段,智能车的车尾部和跟随车的车头部的横向距离,as-host和vs-host为智能车的加速度和速度,as-follow和vs-follow为后方跟随车辆的加速度和速度,dtb为智能车与跟随车的实际距离;
S3.3.2、计算智能车与目标车道前方前导车的风险系数P2:
其中,ksafe为驾驶员的敏感系数,L1为前导车车辆长度,L2为冗余距离;
S3.3.3、综合判断
判断步骤S3.3.1和S3.3.2计算得到的风险系数均小于预设阈值,则执行换道策略,否则,进行车道保持。
S4、基于步骤S3规划的驾驶动作,利用滚动时域优化的局部路径规划方法进行具体驾驶路线及指令的规划
基于滚动时域优化的路径规划算法依靠智能车的传感器实时对周围局部环境进行探测,随着滚动优化在线实时规划,更新最优路径,通过启发式的方法生成最优子目标,在当前时域范围内规划最优路径并实施,时间域信息往前滚动推进,环境信息有可能发生动态变化,此时进行轨迹优化及在线更新。该算法能确保智能车在实时动态跟新的换道环境以确保安全性。
如图5,Frenet坐标系很方便的将智能车的二维移动问题解耦成横向和纵向相对独立的优化问题,针对两个方向的目标状态分别求其轨迹的备选集合,针对不同的优化场景和任务诉求分别制定代价函数,结合两者代价函数,选取一条代价最低的轨迹进行物理限制和碰撞检测,如果挑选出的轨迹不满足检测要求,则剔除,接着挑选代价次低的轨迹,直到找到满足条件的代价最小的轨迹。最后进行二维合成,用于进行智能车位置的更新。其中,规划轨迹所对应的的速度、加速度、位置即为智能车决策系统的输出。
S4.1、在Frenet坐标系下,初始时刻t0,智能车横、纵向方向的位置、速度、加速度状态分别为(l0,l′0,l″0),(s0,s′0,s″0),规划路径的末时刻为t1,其状态为(l1,l′1,l″1),(s1,s′1,s″1),智能车轨迹的制动周期为T=t1-t0;
S4.2、智能车横向控制
S4.2.1、设置目标配置集合[l1,l′1,l″1,T]=[d,0,0,t],d为横向位置,t为决策时间;
S4.2.2、设置横向控制的代价函数:CL=kjmax(|at0-at|)+ktT+kd|l1-llabel|
其中,max(|at0-at|)表示决策时间t内最大加速度的变化值,保证智能车舒适性,T为制动时间,要求智能车能短时间内制动,|l1-llabel|为末状态的横向位移与车道线中心的距离,保证车辆不会偏离目标车道中心线,中心线位置为llabel;kj、kt和kd为惩罚性系数;
S4.2.3、基于代价函数,通过配置d和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
在本实施例中,初始状态假设为:初始时刻l0=3,l′0=0.3,l″0=0,道路的中心线为l=0,时间滚动窗口为3s,智能车的横向控制目的为使智能车能沿道路中心线方向平稳行驶,则存在约束:l′1=0,l″1=0。其仿真结果如图6所示,虚线为所有备选轨迹曲线,实线为根据上述损失函数选出的备选集合中选择最优轨迹曲线。
S4.3、智能车纵向控制
对于智能车的纵向控制,不同运动情形其优化目标配置集合不尽相同,其场景大致可分为跟车、停车、车速保持,下面我们分别进行讨论。
S4.3.1、跟车:t1时刻车辆速度应该为前车速度,位置应该前车位置减去安全距离,加速度为0;
在本实施例中,初始状态假设为:s0=0,s′0=10m/s,s″0=10,为满足安全驾驶约束,t1时刻车辆速度应该为前车速度,位置应该前车位置减去安全距离,加速度为0。其位置、速度、加速度轨迹可以表示为如图7所示。
S4.3.2、车速保持:设置目标配置集合:
[s′1,s1″,T]=[s′,0,t]
其中,s′为纵向速度,t为决策时间;
制定车速保持的代价函数:
其中,s′label为需要保持的纵向速度;
基于代价函数,通过配置s′和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
在本实施例中,假设需要保持的纵向速度为5m/s,其仿真结果图8如下所示。
S4.3.3、停车:设置目标配置集合:
[s1,s′1,s″1,T]=[d*,0,0,t]
其中,d*为纵向位置,t为决策时间;
制定停车的代价函数:
基于代价函数,通过配置d*和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
在本实施例中,初始状态假设为:s0=0,s′0=3m/s,s″0=0,停车点为slabel=12,时间滚动窗口为3s,要求智能车能够以较舒适的方式在停车点停车,且存在约束:s′1=0,s″1=0,其仿真结果如图9所示。
S5、轨迹二维合成
为了能够轨迹线的物理和碰撞检测,需要进行轨迹线和代价函数的二维合成:
其中,kL横行控制系数,kS纵向控制系数;τ=1,2,当τ=1时,取车速保持的代价函数当τ=2时,取车速保持的代价函数
轨迹二维合成结果如图10所示,在合成轨迹曲线上,各轨迹点所对应的加速度等信息即为智能车决策系统的指令规划。其中,如图10所示,虚线为备选轨迹集合,每一个轨迹对应着按照算得的代价值,实线为代价值最小的最优轨迹。我们将代价值由低到高依次进行物理检测和碰撞检测,直到找到一条最优轨迹满足以下所有条件:
①轨迹线与其他障碍物无任何碰撞;
②纵向S方向的速度、加速度不超过最大限定值;
③轨迹线曲率不超过最大曲率。
S6、智能车按照合成轨迹进行安全驾驶。
尽管上面对本发明说明性的具体实施方式进行了描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
Claims (2)
1.一种基于分层状态机的混合式驾驶方法,其特征在于,包括以下步骤:
(1)、利用传感器感知环境信息
在车联网方式下,利用传感器获取本车道和周围两边车道前方和后方最近车辆的距离、速度信息,以及本车的速度信息以及GPS导航和路网文件;
(2)、利用分层状态机的顶层状态机认定具体场景
顶层状态机M顶=(Q顶,Σ顶,δ顶,q0顶,F顶),其中,Q顶为位于不同场景之间的特定状态;Σ顶多为GPS坐标、地图、任务文件构成的对场景认定的特定约束,作为输入事件;q0∈Q为系统的初始状态,;在时刻i,系统处于状态qi顶时,qi顶∈Q顶,接受输入事件ai后,δ顶为状态迁移到新状态的概率分布;是系统任务完成的终止状态;
(3)、利用分层状态机的底层状态机规划驾驶动作
底层状态机M底=(Q底,Σ底,δ底,q0底,F底),Q底为决策过程的各子阶段状态,Σ底为决策过程中产生的各种换道逻辑,δ底采用全概率转移,q0底为决策开始的初始阶段状态,F底为车道保持和换道决策结果对应的状态集合;
(4)、基于步骤(3)规划的驾驶驶动作,利用滚动时域优化的局部路径规划方法进行具体驾驶路线及指令的规划
(4.1)、在Frenet坐标系下,初始时刻t0,智能车横、纵向方向的位置、速度、加速度状态分别为(l0,l′0,l″0),(s0,s′0,s″0),规划路径的末时刻为t1,其状态为(l1,l′1,l″1),(s1,s′1,s″1),智能车轨迹的制动周期为T=t1-t0;
(4.2)、智能车横向控制
(4.2.1)、设置目标配置集合[l1,l′1,l″1,T]=[d,0,0,t],d为横向位置,t为决策时间;
(4.2.2)、设置横向控制的代价函数:CL=kjmax(|at0-at|)+ktT+kd|l1-llabel|
其中,max(|at0-at|)表示决策时间t内最大加速度的变化值,保证智能车舒适性,T为制动时间,要求智能车能短时间内制动,|l1-llabel|为末状态的横向位移与车道线中心的距离,保证车辆不会偏离目标车道中心线,中心线位置为llabel;kj、kt和kd为惩罚性系数;
(4.2.3)、基于代价函数,通过配置d和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
(4.3)、智能车纵向控制
(4.3.1)、跟车:t1时刻车辆速度应该为前车速度,位置应该前车位置减去安全距离,加速度为0;
(4.3.2)、车速保持:设置目标配置集合:
[s′1,s1″,T]=[s′,0,t]
其中,s'为纵向速度,t为决策时间;
制定车速保持的代价函数:
其中,s′label为需要保持的纵向速度;
基于代价函数,通过配置s'和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
(4.3.3)、停车:设置目标配置集合:
[s1,s′1,s″1,T]=[d*,0,0,t]
其中,d*为纵向位置,t为决策时间;
制定停车的代价函数:
基于代价函数,通过配置d*和t来进行轨迹采样,从而在备选轨迹集合中选取代价函数最小的最优的轨迹;
(5)、轨迹维合成
其中,kL横行控制系数,kS纵向控制系数;τ=1,2,当τ=1时,取车速保持的代价函数当τ=2时,取车速保持的代价函数
(6)、智能车按照合成轨迹进行安全驾驶。
2.根据权利要求1所示的基于分层状态机的混合式驾驶方法,其特征在于,所述底层状态机在决策过程中产生的各种换道逻辑为:
(2.1)、产生换道意图
利用车头时距去衡量是否离前方车辆足够近,即:
TH=d/vhost
其中,d为前后车辆车头间距,vhost为后车的速度;
当TH值大于预设阈值,则不存在换道动机,进行车道保持;否则,存在空间层面的换道动机,并进行后续步骤判断;
(2.2)、交通规则下的车道选择
在实际交通规则的约束下,根据实际车况路况,选择邻近的一条具体可行的车道,优先考虑临界左车道;若当前路段不允许变道,则进行车道保持,否则进行后续步骤判断;
(2.3)、计算换道的风险系数
(2.3.1)、计算智能车与目标车道后方跟随车的风险系数P1:
其中,d0为在换道初始阶段,智能车的车尾部和跟随车的车头部的横向距离,as-host和vs-host为智能车的加速度和速度,as-follow和vs-follow为后方跟随车辆的加速度和速度,dtb为智能车与跟随车的实际距离;
(2.3.2)、计算智能车与目标车道前方前导车的风险系数P2:
其中,ksafe为驾驶员的敏感系数,L1为前导车车辆长度,L2为冗余距离;
(2.3.3)、综合判断
判断步骤(2.3.1)和(2.3.2)计算得到的风险系数均小于预设阈值,则执行换道策略,否则,进行车道保持。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910574456.1A CN110304074B (zh) | 2019-06-28 | 2019-06-28 | 一种基于分层状态机的混合式驾驶方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910574456.1A CN110304074B (zh) | 2019-06-28 | 2019-06-28 | 一种基于分层状态机的混合式驾驶方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110304074A true CN110304074A (zh) | 2019-10-08 |
CN110304074B CN110304074B (zh) | 2020-07-31 |
Family
ID=68078491
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910574456.1A Active CN110304074B (zh) | 2019-06-28 | 2019-06-28 | 一种基于分层状态机的混合式驾驶方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110304074B (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111026110A (zh) * | 2019-11-20 | 2020-04-17 | 北京理工大学 | 面向含软、硬约束线性时序逻辑的不确定动作规划方法 |
CN111681452A (zh) * | 2020-01-19 | 2020-09-18 | 重庆大学 | 一种基于Frenet坐标系下的无人驾驶汽车动态换道轨迹规划方法 |
CN111874007A (zh) * | 2020-08-06 | 2020-11-03 | 中国科学院自动化研究所 | 基于知识与数据驱动的无人车分层决策方法、系统、装置 |
CN112068545A (zh) * | 2020-07-23 | 2020-12-11 | 哈尔滨工业大学(深圳) | 一种无人驾驶车辆在十字路口的行驶轨迹规划方法、系统及存储介质 |
CN112406970A (zh) * | 2020-11-27 | 2021-02-26 | 华晟(青岛)智能装备科技有限公司 | 一种环形有轨制导车辆防撞系统及方法 |
CN112896158A (zh) * | 2021-02-25 | 2021-06-04 | 东风汽车集团股份有限公司 | 基于分层状态机的紧急车道保持功能的控制方法及系统 |
CN113335278A (zh) * | 2021-07-20 | 2021-09-03 | 常州机电职业技术学院 | 一种网联式智能车队自适应巡航控制方法及系统 |
CN113467474A (zh) * | 2021-07-29 | 2021-10-01 | 安徽江淮汽车集团股份有限公司 | 自动驾驶层次化控制系统 |
CN113670319A (zh) * | 2021-08-18 | 2021-11-19 | 东风悦享科技有限公司 | 一种路边停车容错方法和系统 |
CN114261399A (zh) * | 2021-11-24 | 2022-04-01 | 吉林大学 | 一种冰雪路面下智能驾驶汽车决策规划方法 |
CN114291112A (zh) * | 2021-12-30 | 2022-04-08 | 同济大学 | 一种应用于自动驾驶汽车的决策规划协同增强方法 |
CN117485366A (zh) * | 2023-10-30 | 2024-02-02 | 青岛理工大学 | 基于风险势场的网联自主车辆换道决策方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108602509A (zh) * | 2016-12-30 | 2018-09-28 | 百度(美国)有限责任公司 | 基于运动规划来操作自动驾驶车辆的方法和系统 |
CN108875998A (zh) * | 2018-04-20 | 2018-11-23 | 北京智行者科技有限公司 | 一种自动驾驶车辆规划方法和系统 |
CN109643496A (zh) * | 2016-09-21 | 2019-04-16 | 苹果公司 | 车辆控制系统 |
CN109799821A (zh) * | 2019-01-25 | 2019-05-24 | 汉腾汽车有限公司 | 一种基于状态机的自动驾驶控制方法 |
-
2019
- 2019-06-28 CN CN201910574456.1A patent/CN110304074B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109643496A (zh) * | 2016-09-21 | 2019-04-16 | 苹果公司 | 车辆控制系统 |
CN108602509A (zh) * | 2016-12-30 | 2018-09-28 | 百度(美国)有限责任公司 | 基于运动规划来操作自动驾驶车辆的方法和系统 |
CN108875998A (zh) * | 2018-04-20 | 2018-11-23 | 北京智行者科技有限公司 | 一种自动驾驶车辆规划方法和系统 |
CN109799821A (zh) * | 2019-01-25 | 2019-05-24 | 汉腾汽车有限公司 | 一种基于状态机的自动驾驶控制方法 |
Non-Patent Citations (2)
Title |
---|
耿新力: "城区不确定环境下无人驾驶车辆行为决策方法研究", 《中国知网全文库》 * |
袁盛玥: "自动驾驶车辆城区道路环境换道行为决策方法研究", 《中国知网全文库》 * |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111026110B (zh) * | 2019-11-20 | 2021-04-30 | 北京理工大学 | 面向含软、硬约束线性时序逻辑的不确定动作规划方法 |
CN111026110A (zh) * | 2019-11-20 | 2020-04-17 | 北京理工大学 | 面向含软、硬约束线性时序逻辑的不确定动作规划方法 |
CN111681452A (zh) * | 2020-01-19 | 2020-09-18 | 重庆大学 | 一种基于Frenet坐标系下的无人驾驶汽车动态换道轨迹规划方法 |
CN112068545A (zh) * | 2020-07-23 | 2020-12-11 | 哈尔滨工业大学(深圳) | 一种无人驾驶车辆在十字路口的行驶轨迹规划方法、系统及存储介质 |
CN111874007A (zh) * | 2020-08-06 | 2020-11-03 | 中国科学院自动化研究所 | 基于知识与数据驱动的无人车分层决策方法、系统、装置 |
CN111874007B (zh) * | 2020-08-06 | 2021-03-16 | 中国科学院自动化研究所 | 基于知识与数据驱动的无人车分层决策方法、系统、装置 |
CN112406970B (zh) * | 2020-11-27 | 2022-09-30 | 华晟(青岛)智能装备科技有限公司 | 一种环形有轨制导车辆防撞系统及方法 |
CN112406970A (zh) * | 2020-11-27 | 2021-02-26 | 华晟(青岛)智能装备科技有限公司 | 一种环形有轨制导车辆防撞系统及方法 |
CN112896158A (zh) * | 2021-02-25 | 2021-06-04 | 东风汽车集团股份有限公司 | 基于分层状态机的紧急车道保持功能的控制方法及系统 |
CN113335278A (zh) * | 2021-07-20 | 2021-09-03 | 常州机电职业技术学院 | 一种网联式智能车队自适应巡航控制方法及系统 |
CN113335278B (zh) * | 2021-07-20 | 2023-08-11 | 常州机电职业技术学院 | 一种网联式智能车队自适应巡航控制方法及系统 |
CN113467474A (zh) * | 2021-07-29 | 2021-10-01 | 安徽江淮汽车集团股份有限公司 | 自动驾驶层次化控制系统 |
CN113467474B (zh) * | 2021-07-29 | 2023-09-22 | 安徽江淮汽车集团股份有限公司 | 自动驾驶层次化控制系统 |
CN113670319A (zh) * | 2021-08-18 | 2021-11-19 | 东风悦享科技有限公司 | 一种路边停车容错方法和系统 |
CN114261399A (zh) * | 2021-11-24 | 2022-04-01 | 吉林大学 | 一种冰雪路面下智能驾驶汽车决策规划方法 |
CN114261399B (zh) * | 2021-11-24 | 2023-11-07 | 吉林大学 | 一种冰雪路面下智能驾驶汽车决策规划方法 |
CN114291112A (zh) * | 2021-12-30 | 2022-04-08 | 同济大学 | 一种应用于自动驾驶汽车的决策规划协同增强方法 |
CN114291112B (zh) * | 2021-12-30 | 2023-08-04 | 同济大学 | 一种应用于自动驾驶汽车的决策规划协同增强方法 |
CN117485366A (zh) * | 2023-10-30 | 2024-02-02 | 青岛理工大学 | 基于风险势场的网联自主车辆换道决策方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110304074B (zh) | 2020-07-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110304074A (zh) | 一种基于分层状态机的混合式驾驶方法 | |
US11635764B2 (en) | Motion prediction for autonomous devices | |
Zhang et al. | Energy management strategies of connected HEVs and PHEVs: Recent progress and outlook | |
US10503172B2 (en) | Controlling an autonomous vehicle based on independent driving decisions | |
CN108256233B (zh) | 基于驾驶员风格的智能车轨迹规划及跟踪方法和系统 | |
CN109085820A (zh) | 临界条件的自主车辆驾驶系统和方法 | |
CN110136254B (zh) | 基于动态概率驾驶地图的驾驶辅助信息显示方法 | |
CN113291308B (zh) | 一种考虑驾驶行为特性的车辆自学习换道决策系统及方法 | |
CN110068346A (zh) | 用于自主车辆中不受保护的操纵缓解的系统和方法 | |
US20180164827A1 (en) | Systems and methods for autonomous vehicle path follower correction | |
CN107798861A (zh) | 一种车辆协作式编队行驶方法及系统 | |
CN108011947A (zh) | 一种车辆协作式编队行驶系统 | |
CN109521764A (zh) | 车辆远程辅助模式 | |
CN108445885A (zh) | 一种基于纯电动物流车的自动驾驶系统及其控制方法 | |
CN109814520A (zh) | 用于确定自主车辆的安全事件的系统和方法 | |
CN108725446A (zh) | 用于自主车辆的俯仰角补偿 | |
CN110126837A (zh) | 用于自主车辆运动规划的系统和方法 | |
CN107272683A (zh) | 基于acp方法的平行智能车控制系统 | |
US11520338B2 (en) | Systems and methods for vehicle spatial path sampling | |
CN109808688A (zh) | 针对即将到来的变道在自主车辆中调整速度的系统和方法 | |
CN108583578A (zh) | 用于自动驾驶车辆的基于多目标决策矩阵的车道决策方法 | |
US20180162412A1 (en) | Systems and methods for low level feed forward vehicle control strategy | |
CN109643118A (zh) | 基于关于车辆的环境的与功能相关的信息来影响车辆的功能 | |
CN113264059B (zh) | 支持多驾驶行为的基于深度强化学习的无人车运动决策控制方法 | |
CN107886750A (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 |