一种基于可行驶区域的高速公路自动变道方法技术

本发明专利技术公开了一种基于可行驶区域的高速公路自动变道方法，ADAS采集距离信息、方位信息和仰角相对固定误差信息，将ADAS采集的数据进行坐标系上的空间配准，将空间配准后的数据进行融合并进行航位推算，按照航位推算进行变道控制。本发明专利技术不使用昂贵的高精度地图和高精度定位系统，仅仅依靠ADAS系统基本必备的感知系统提供的信息，建立起了一套自动变道的策略，并同样完成车辆自动变道并最终进入下匝道驶离高速的功能。驶离高速的功能。驶离高速的功能。

【技术实现步骤摘要】
一种基于可行驶区域的高速公路自动变道方法


[0001]本专利技术涉及一种自动变道方法，特别是一种基于可行驶区域的高速公路自动变道方法，属于自动驾驶领域。

技术介绍

[0002]高级驾驶辅助系统ADAS，是利用安装于车上的各式的传感器，或者感知系统，在第一时间收集车内外的环境数据，并进行静、动态物体的辨识、侦测与追踪等技术上的处理，从而能够让车辆在最快的时间察觉可能发生的危险，并对驾驶员加以提醒甚至介入车辆控制，避免危险的一种主动安全技术。同时随着客户需求和技术的发展，高级驾驶辅助系统也衍生出更多舒适及便利性功能，例如交通拥堵辅助(TJA)，或者高速公路巡航辅助(HWA)来为驾驶员提供一定程度的自动驾驶，减少驾驶员的频繁的机械性操作，提升驾驶舒适度。
[0003]在高速公路巡航辅助(HWA)功能中，车辆需要根据导航路线，自动完成在高速公路上的自动驾驶行为，例如加减速控制，侧向的自动变道，以及最终驶出匝道。目前，为了能够使车辆在开启高速公路巡航辅助功能之后，可以自动由当前车道变换到最右侧或者最左侧车道并且沿着匝道驶出高速，就需要结合感知或者定位系统为车辆提供足够的定位精度。例如，依靠前向的视觉来判断车辆当前在车道内的位置，利用高精度定位和高精度地图来判断车辆在当前高速公路所有车道中所处的位置。特别当车辆需要通过下匝道驶离高速公路的时候，行业的普遍做法是实用高精度定位和高精度地图来确定车辆当前的精确位置，并依靠该定位系统提供的信息来指导车辆慢慢变道并最终行驶到下匝道上。但是，高精度定位和高精度地图系统价格昂贵，每车的成本在2000到4000人民币，对于汽车企业来说，是巨大的成本投入，并且还需要持续地每年付授权费用来使用地图服务。

技术实现思路

[0004]本专利技术所要解决的技术问题是提供一种基于可行驶区域的高速公路自动变道方法，不使用高精度地图和高精度定位系统，降低成本。
[0005]为解决上述技术问题，本专利技术所采用的技术方案是：
[0006]一种基于可行驶区域的高速公路自动变道方法，其特征在于包含以下步骤：
[0007]步骤一：ADAS采集距离信息、方位信息和仰角相对固定误差信息；
[0008]步骤二：将ADAS采集的数据进行坐标系上的空间配准；
[0009]步骤三：将空间配准后的数据进行融合并进行航位推算；
[0010]步骤四：按照航位推算进行变道控制。
[0011]进一步地，所述步骤二具体为
[0012]将ADAS采集的数据进行坐标系上的空间配准：
[0013]r'＝r+Dr
[0014]q'＝q+Dq
[0015]j'＝j+Dj
[0016]Dr＝Dr
b
+r
×
Dr
g
+v
r
(t)
[0017]Dq＝Dq
b
+v
q
(t)
[0018]Dj＝Dj
b
+v
j
(t)
[0019]其中，r、q、j是配准前的空间坐标，r
′
、q
′
、j
′
是配准后的空间坐标，Dr为距离误差增益，Dq为车辆方位误差增益，Dj为ADAS采集的仰角相对固定误差信息，Dr
b
为ADAS采集的车辆距离信息，Dr
g
为车辆距离修正比例，Dq
b
为ADAS采集的车辆方位信息，Dj
b
为采集的仰角信息，v
r
(t)为距离随机误差，v
q
(t)为方位随机误差，v
j
(t)为仰角随机误差。
[0020]进一步地，所述步骤三具体为
[0021]首先选取全局坐标系下车辆后轴中点坐标(X
RM
，Y
RM
)，航向角θ，航向角变化率ω，车速v为状态量；定义k时刻的系统状态向量为：
[0022]X
k
＝[X
RM
，Y
RM
，θ，ω，v]T
[0023]单位时间为T0，用K
‑
1时刻的状态最优值X
k
‑1推算k时刻状态估计值X
k,k
‑1：
[0024][0025]之后，对于非线性函数求偏导：
[0026][0027]选取左右前轮单位时间行驶距离l
FL
，l
FR
，车辆航向角变化率ω
sw
，后轴中点车速v
R
为观测量：
[0028]Z
k
＝[l
FL
,l
FR
,ω
sw
,v
R
][0029]其中，e为车辆后轴的半轴长，则观测方程的非线性函数为：
[0030]h(
·
)＝[T0(v
‑
e
·
ω),T0((v+e
·
ω),ω,v][0031]对非线性函数h(
·
)求偏导：
[0032][0033]同时，k时刻系统误差协方差矩阵估计值为：
[0034][0035]卡尔曼增益矩阵为：
[0036]K
k
＝P
k,k
‑1H
kT
[H
k
P
k,k
‑1H
kT
+P
k
]T
[0037]则k时刻状态向量的最优值为：
[0038][0039]更新后的系统误差的协方差矩阵为：
[0040]P
k
＝[I
‑
K
k
H
k
]P
k,k
‑1[0041]最终得出航位推算的协方差矩阵，得道航道推算的结果。
[0042]进一步地，所述步骤四具体为
[0043]4.1通过转向灯开关的总线信号激活自动变道功能；
[0044]4.2数据融合模块通过CAN总线收取来自ADAS提供的车道、路面及周边交通参与物
的信息，通过坐标系的数据融合并进行卡尔曼滤波后得出当前车道信息、左右相邻车道信息以及周围交通参与屋体距离及速度信息；
[0045]4.3决策控制模块根据数据融合模块给出的车道、路面、参与物信息，计算出和前后以及相邻车道车辆或者交通参与屋体的最小碰撞时间TTC，最小碰撞时间小于2秒的，车辆发出报警并不执行横向加速度计算，最小碰撞事件大于2秒的，车辆启动局部路径规划模块进行横向加速度计算并进行横向变道控制；
[0046]4.4根据车辆感知系统数据融合之后提供的可行驶区域信息，结合车道分割信息，获取从当前车道开始一直自动变道到最侧面的下匝道相邻车道的参数；
[0047]4.5车辆根据可行驶区域信息，根据当前获得的信息输入本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于可行驶区域的高速公路自动变道方法，其特征在于包含以下步骤：步骤一：ADAS采集距离信息、方位信息和仰角相对固定误差信息；步骤二：将ADAS采集的数据进行坐标系上的空间配准；步骤三：将空间配准后的数据进行融合并进行航位推算；步骤四：按照航位推算进行变道控制。2.按照权利要求1所述的一种基于可行驶区域的高速公路自动变道方法，其特征在于：所述步骤二具体为将ADAS采集的数据进行坐标系上的空间配准：r'＝r+Drq'＝q+Dqj'＝j+DjDr＝Dr
b
+r
×
Dr
g
+v
r
(t)Dq＝Dq
b
+v
q
(t)Dj＝Dj
b
+v
j
(t)其中，r、q、j是配准前的空间坐标，r
′
、q
′
、j
′
是配准后的空间坐标，Dr为距离误差增益，Dq为车辆方位误差增益，Dj为ADAS采集的仰角相对固定误差信息，Dr
b
为ADAS采集的车辆距离信息，Dr
g
为车辆距离修正比例，Dq
b
为ADAS采集的车辆方位信息，Dj
b
为采集的仰角信息，v
r
(t)为距离随机误差，v
q
(t)为方位随机误差，v
j
(t)为仰角随机误差。3.按照权利要求1所述的一种基于可行驶区域的高速公路自动变道方法，其特征在于：所述步骤三具体为首先选取全局坐标系下车辆后轴中点坐标(X
RM
，Y
RM
)，航向角θ，航向角变化率ω，车速v为状态量；定义k时刻的系统状态向量为：X
k
＝[X
RM
，Y
RM
，θ，ω，v]
T
单位时间为T0，用K
‑
1时刻的状态最优值X
k
‑1推算k时刻状态估计值X
k,k
‑1：之后，对于非线性函数求偏导：选取左右前轮单位时间行驶距离l
FL
，l
FR
，车辆航向角变化率ω
sw
，后轴中点车速v
R
为观测量：Z
k
＝[l
FL
,l
FR
,ω
sw
,v
R
]其中，e为车辆后轴的半轴长，则观测方程的非线性函数为：h(<...

【专利技术属性】
技术研发人员：张铮，
申请(专利权)人：江苏琥珀汽车科技有限公司，
类型：发明
国别省市：