详情

原文传递一种基于分层状态机的混合式驾驶方法

专利名称：	一种基于分层状态机的混合式驾驶方法
摘要：	本发明公开了一种基于分层状态机的混合式驾驶方法，先利用传感器感知环境信息，再利用分层状态机认定具体场景和规划驾驶动作，然后利用滚动时域优化的局部路径规划方法进行具体驾驶路线及指令的规划，最后对规划的驾驶路线进行合成，合成后的轨迹点所对应的加速度等信息即为智能车决策系统的指令规划，那么智能车按照合成轨迹就可以进行安全驾驶。
专利类型：	发明专利
国家地区组织代码：	四川;51
申请人：	电子科技大学
发明人：	胡江平;吕维;李咏章
专利状态：	有效
申请日期：	2019-06-28T00:00:00+0800
发布日期：	2019-10-08T00:00:00+0800
申请号：	CN201910574456.1
公开号：	CN110304074A
代理机构：	成都行之专利代理事务所(普通合伙)
代理人：	温利平
分类号：	B60W50/00(2006.01);B;B60;B60W;B60W50
申请人地址：	611731 四川省成都市高新区(西区)西源大道2006号
主权项：	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)计算得到的风险系数均小于预设阈值，则执行换道策略，否则，进行车道保持。
所属类别：	发明专利