一种路口预警方法及装置制造方法及图纸

本发明专利技术提供一种路口预警方法及装置，首先获取基础数据，该基础数据中包括本车的几何参数和运动信息、以及本车与作为路口潜在危险目标的目标车辆的相对位置信息，进而基于本车的几何参数和运动信息确定本车当前的行驶行为，并结合相对位置信息确定与本车当前的行驶行为相对应的本车的行驶路径和目标车辆的行驶路径，进一步基于本车的行驶路径和目标车辆的行驶路径确定本车与目标车辆间的碰撞参数，该碰撞参数包括碰撞时间和碰撞点的横向位移，最后从目标车辆中选择碰撞时间最小的危险目标车辆，并依据危险目标车辆对应的碰撞时间和碰撞点的横向位移进行路口预警。撞点的横向位移进行路口预警。撞点的横向位移进行路口预警。

【技术实现步骤摘要】
一种路口预警方法及装置


[0001]本专利技术涉及智能驾驶
，更具体地说，涉及一种路口预警方法及装置。

技术介绍

[0002]伴随智能驾驶水平提高，各种交通环境以及应急情况的预警是保证车辆安全的核心技术。路口是典型复杂的交通环境之一，也是交通安全重点考虑场景，因此路口预警是保证车辆安全的重要手段。
[0003]目前多数研究采用车联网或者智能交通技术实现路口预警和辅助通行，需要特定的设备和交通基础设施要求，不是依靠车辆自身单方面来实现，较难在短时间内推广。

技术实现思路

[0004]有鉴于此，为解决上述问题，本专利技术提供一种路口预警方法及装置，技术方案如下：
[0005]一种路口预警方法，所述方法包括：
[0006]获取基础数据，所述基础数据包括本车的几何参数和运动信息、以及本车与目标车辆的相对位置信息，所述目标车辆为路口潜在危险目标；
[0007]根据本车的几何参数和运动信息确定本车当前的行驶行为，并结合所述相对位置信息确定与本车当前的行驶行为相对应的本车的行驶路径和所述目标车辆的行驶路径；
[0008]基于本车的行驶路径和所述目标车辆的行驶路径，确定本车与所述目标车辆间的碰撞参数，所述碰撞参数包括碰撞时间和碰撞点的横向位移；
[0009]从所述目标车辆中选取碰撞时间最小的危险目标车辆，并依据所述危险目标车辆对应的碰撞时间和碰撞点的横向位移进行路口预警。
[0010]优选的，本车的几何参数包括本车的后轴与前端距离d，本车的运动信息包括本车的车速v0、横摆角速度ω0、横摆角θ、转向角D
steer
、转向角速率ω
steer
；
[0011]所述根据本车的几何参数和运动信息确定本车当前的行驶行为，包括：
[0012]计算本车的曲率半径
[0013]如果本车的曲率半径ROC大于等于对应的曲率半径阈值R
lowthresh
、或者本车的曲率半径ROC小于所述曲率半径阈值R
lowthresh
且持续时间小于对应的持续时间阈值latchtime，确定本车当前的行驶行为为转弯或者直行，并调取本车上一时刻的行驶行为；
[0014]在本车上一时刻的行驶行为为非转弯的情况下，计算本车在固定时间t内的横向位移Δy＝(v0*sinθ+d*ω0*cosθ)*t；按照如下公式确定本车当前的行驶行为：
[0015][0016]其中，y
thresh
为横向位移阈值；
[0017]在本车上一时刻的行驶行为为转弯的情况下，按照如下公式确定本车当前的行驶行为：
[0018][0019]其中，换道直行和正常直行均属于直行的行驶行为。
[0020]优选的，所述结合所述相对位置信息确定与本车当前的行驶行为相对应的本车的行驶路径和所述目标车辆的行驶路径，包括：
[0021]按照如下公式确定本车的行驶路径：
[0022][0023]按照如下公式确定所述目标车辆i的行驶路径：
[0024][0025]其中，x
i
为所述目标车辆i在本车坐标系下的纵向位移、y
i
为所述目标车辆i在本车坐标系下的横向位移、a
i
和b
i
分别为所述目标车辆i为对向目标车辆时的行驶路径参数、c
i
和d
i
分别为所述目标车辆i为横穿目标车辆时的行驶路径参数，a
i
和b
i
是采用最小二乘法对对向目标车辆i的多个历史位移点拟合得到的，c
i
和d
i
是采用最小二乘法对横穿目标车辆i的多个历史位移点拟合得到的，所述多个历史位移点是从所属目标车辆的相对位置信息中获得的。
[0026]优选的，本车的运动信息还包括本车纵向加速度a(x)；
[0027]所述基于本车的行驶路径和所述目标车辆的行驶路径，确定本车与所述目标车辆间的碰撞参数，包括：
[0028]按照如下公式确定本车与所述目标车辆i的碰撞点(x
i
,y
i
)：
[0029][0030]其中，x
i
为本车到达碰撞点的纵向距离，y
i
为本车到达碰撞点的横向距离；
[0031]基于碰撞点(x
i
,y
i
)，按照如下公式确定碰撞时间TTC
i
：
[0032][0033]其中，β
i
为本车转弯到达碰撞点的圆心角，v0(x)为本车的车速v0在纵向上的分速度。
[0034]优选的，本车的几何参数还包括本车的车宽w，所述基础数据还包括所述目标车辆i的运动信息和长度L
i
，所述目标车辆i的运动信息包括所述目标车辆i的车速v
i
在纵向上的分速度v
i
(x)、以及所述目标车辆i在纵向上的加速度a
i
(x)，所述方法还包括：
[0035]按照如下公式分别计算目标车辆i的碰撞区域进入时间t
i
(entry)和碰撞区域离开时间t
i
(leave)：
[0036][0037]其中，x
i
(t arg et)为目标车辆i到达碰撞点的纵向距离，x
i
(t arg et)可以根据目标车辆i在本车坐标系下的纵向位移、以及本车到达碰撞点的纵向距离所确定；
[0038]按照如下公式对碰撞时间TTC
i
进行有效性校验：
[0039][0040]其中，t(buff)为预留的时间间隔。
[0041]优选的，所述依据所述危险目标车辆对应的碰撞时间和碰撞点的横向位移进行路口预警，包括：
[0042]满足如下公式时，执行路口预警：
[0043][0044]其中，TTC
select
为所述危险目标车辆对应的碰撞时间，TTC
threshold
为预警触发的碰撞时间阈值，y0为本车的横向位移，y
avail
为预警触发的横向可用空间、且y
avail
＝|y
collision
|
‑
y
brake
‑
y
threshold
，y
collision
为所述危险目标车辆对应的碰撞点的横向位移，y
brake
为假定本车以0.6g减速度刹车到静止的横向移动距离，y
threshold
为预警触发的横向位移阈值。
[0045]一种路口预警装置，所述装置包括：
[0046]数据获取模块，用于获取基础数据，所述基础数据包括本车的几何参数和运动信息、以及本车与目标车辆的相对位置信息，所述目标车辆为路口潜在危险目标；...

【技术保护点】

【技术特征摘要】
1.一种路口预警方法，其特征在于，所述方法包括：获取基础数据，所述基础数据包括本车的几何参数和运动信息、以及本车与目标车辆的相对位置信息，所述目标车辆为路口潜在危险目标；根据本车的几何参数和运动信息确定本车当前的行驶行为，并结合所述相对位置信息确定与本车当前的行驶行为相对应的本车的行驶路径和所述目标车辆的行驶路径；基于本车的行驶路径和所述目标车辆的行驶路径，确定本车与所述目标车辆间的碰撞参数，所述碰撞参数包括碰撞时间和碰撞点的横向位移；从所述目标车辆中选取碰撞时间最小的危险目标车辆，并依据所述危险目标车辆对应的碰撞时间和碰撞点的横向位移进行路口预警。2.根据权利要求1所述的方法，其特征在于，本车的几何参数包括本车的后轴与前端距离d，本车的运动信息包括本车的车速v0、横摆角速度ω0、横摆角θ、转向角D
steer
、转向角速率ω
steer
；所述根据本车的几何参数和运动信息确定本车当前的行驶行为，包括：计算本车的曲率半径如果本车的曲率半径ROC大于等于对应的曲率半径阈值R
lowthresh
、或者本车的曲率半径ROC小于所述曲率半径阈值R
lowthresh
且持续时间小于对应的持续时间阈值latchtime，确定本车当前的行驶行为为转弯或者直行，并调取本车上一时刻的行驶行为；在本车上一时刻的行驶行为为非转弯的情况下，计算本车在固定时间t内的横向位移Δy＝(v0*sinθ+d*ω0*cosθ)*t；按照如下公式确定本车当前的行驶行为：其中，y
thresh
为横向位移阈值；在本车上一时刻的行驶行为为转弯的情况下，按照如下公式确定本车当前的行驶行为：其中，换道直行和正常直行均属于直行的行驶行为。3.根据权利要求2所述的方法，其特征在于，所述结合所述相对位置信息确定与本车当前的行驶行为相对应的本车的行驶路径和所述目标车辆的行驶路径，包括：按照如下公式确定本车的行驶路径：按照如下公式确定所述目标车辆i的行驶路径：
其中，x
i
为所述目标车辆i在本车坐标系下的纵向位移、y
i
为所述目标车辆i在本车坐标系下的横向位移、a
i
和b
i
分别为所述目标车辆i为对向目标车辆时的行驶路径参数、c
i
和d
i
分别为所述目标车辆i为横穿目标车辆时的行驶路径参数，a
i
和b
i
是采用最小二乘法对对向目标车辆i的多个历史位移点拟合得到的，c
i
和d
i
是采用最小二乘法对横穿目标车辆i的多个历史位移点拟合得到的，所述多个历史位移点是从所属目标车辆的相对位置信息中获得的。4.根据权利要求3所述的方法，其特征在于，本车的运动信息还包括本车纵向加速度a(x)；所述基于本车的行驶路径和所述目标车辆的行驶路径，确定本车与所述目标车辆间的碰撞参数，包括：按照如下公式确定本车与所述目标车辆i的碰撞点(x
i
，y
i
)：其中，x
i
为本车到达碰撞点的纵向距离，y
i
为本车到达碰撞点的横向距离；基于碰撞点(x
i
，y
i
)，按照如下公式确定碰撞时间TTC
i
：其中，β
i
为本车转弯到达碰撞点的圆心角，v0(x)为本车的车速v0在纵向上的分速度。5.根据权利要求4所述的方法，其特征在于，本车的几何参数还包括本车的车宽w，所述基础数据还包括所述目标车辆i的运动信息和长度L
i
，所述目标车辆i的运动信息包括所述目标车辆i的车速v
i
在纵向上的分速度v
i
(x)、以及所述目标车辆i在纵向上的加速度a
i
(x)，所述方法还包括：按照如下公式分别计算目标车辆i的碰撞区域进入时间t
i
(entry)和碰撞区域离开时间t
i
(leave)：其中，x
i
(target)为目标车辆i到达碰撞点的纵向距离，x
i
(target)可以根据目标车辆i在本车坐标系下的纵向位移、以及本车到达碰撞点的纵向距离所确定；
按照如下公式对碰撞时间TTC
i
进行有效性校验：其中，t(buff)为预留的时间间隔。6.根据权利要求4所述的方法，其特征在于，所述依据所述危险目标车辆对应的碰撞时间和碰...

【专利技术属性】
技术研发人员：程鹏，王斌，
申请(专利权)人：上海汽车工业集团有限公司，
类型：发明
国别省市：