CN113327458B - 车辆碰撞预测方法、车辆碰撞预测系统及电子装置 - Google Patents
车辆碰撞预测方法、车辆碰撞预测系统及电子装置 Download PDFInfo
- Publication number
- CN113327458B CN113327458B CN202110774229.0A CN202110774229A CN113327458B CN 113327458 B CN113327458 B CN 113327458B CN 202110774229 A CN202110774229 A CN 202110774229A CN 113327458 B CN113327458 B CN 113327458B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- collision
- time
- target vehicle
- lane
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/166—Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
Abstract
本申请公开车辆碰撞预测方法、车辆碰撞预测系统及电子装置。在本车和目标车辆之间的距离小于预设的距离阈值,且两车未处于同一车道的情况下,确定出两车均位于碰撞危险区域内的预计碰撞时间集合;若该集合非空,目标车辆相较于本车,是除先进入碰撞危险区域且先离开碰撞危险区域之外的情况,确定存在交叉碰撞风险;若该集合非空,目标车辆先于本车进入碰撞危险区域,且先于本车离开碰撞危险区域,比较目标车辆在本车行进方向上的投影速度和本车的速度,以确定是否存在交叉碰撞风险,能够降低安全冗余;之后,通过比较交叉碰撞距离和交叉碰撞安全距离,和/或,比较预计交叉碰撞时间和交叉碰撞安全时间,能够准确地预测两车是否会发生交叉碰撞。
Description
技术领域
本申请属于车辆安全技术领域,尤其涉及一种车辆碰撞预测方法、车辆碰撞预测系统及电子装置。
背景技术
随着车辆保有量的持续增加,交通路况越来越复杂。智能驾驶技术的一个重要方向是车辆碰撞预测,该技术用于判断本车是否与附近行驶的车辆存在碰撞风险。
对于本领域技术人员来说,如何提高车辆碰撞预测的准确性,是亟待解决的问题。
发明内容
有鉴于此,本申请的目的在于提供一种车辆碰撞预测方法及系统,以便准确地确定出本车与附近行驶的车辆是否存在碰撞风险,从而提高行车安全性。
为实现上述目的,本申请提供如下技术方案:
本申请提供一种车辆碰撞预测方法,包括:
获得本车的车辆定位信息和车辆状态信息,获得目标车辆的车辆定位信息和车辆状态信息,其中,所述车辆状态信息包括速度、加速度、航向角、车长、以及车宽;
根据本车的车辆定位信息与所述目标车辆的车辆定位信息确定本车与所述目标车辆之间的距离;
如果本车与所述目标车辆之间的距离小于预设的距离阈值,则确定本车与所述目标车辆是否处于同一车道;
如果本车与所述目标车辆未处于同一车道,则根据本车和所述目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开所述碰撞危险区域的第二时刻,确定出所述目标车辆进入所述碰撞危险区域的第三时刻以及离开所述碰撞危险区域的第四时刻;
取第一时间区间和第二时间区间的交集作为预计碰撞时间集合,其中,所述第一时间区间为闭区间,所述第一时间区间的下边界为所述第一时刻、上边界为所述第二时刻,所述第二时间区域为闭区间,所述第二时间区间的下边界为所述第三时刻、上边界为所述第四时刻;
如果所述预计碰撞时间集合的下边界为所述第一时刻、上边界为所述第四时刻,则确定出所述目标车辆在所述第一时刻的速度在本车行进方向上的投影速度,如果本车的速度大于所述投影速度,则确定存在交叉碰撞风险,否则,确定不存在交叉碰撞风险;
如果所述预计碰撞时间集合为除下边界为所述第一时刻且上边界为所述第四时刻之外的非空集合,则确定存在交叉碰撞风险;
在确定存在交叉碰撞风险的情况下,确定出本车与所述目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,和/或,确定出本车与所述目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间;
如果所述交叉碰撞距离小于或等于所述交叉碰撞安全距离,或者,所述预计交叉碰撞时间小于或等于所述交叉碰撞安全时间,则进行碰撞预警。
可选的,还包括:
如果本车与所述目标车辆处于同一车道,则确定本车与所述目标车辆的同车道同向距离;
根据本车与所述目标车辆的同车道同向距离、本车的速度、本车的加速度、本车的车长、所述目标车辆的速度、所述目标车辆的加速度、以及所述目标车辆的车长,求解本车与所述目标车辆的预计同车道碰撞时间,并根据求解结果确定是否存在同车道碰撞风险;
在确定存在同车道碰撞风险的情况下,确定出本车与所述目标车辆之间的同车道碰撞安全距离和/或同车道碰撞安全时间;
如果所述同车道同向距离小于或等于所述同车道碰撞安全距离,或者,所述预计同车道碰撞时间小于或等于所述同车道碰撞安全时间,则进行碰撞预警。
可选的,所述根据本车和所述目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开所述碰撞危险区域的第二时刻,确定出所述目标车辆进入所述碰撞危险区域的第三时刻以及离开所述碰撞危险区域的第四时刻,包括:
根据本车的航向角和所述目标车辆的航向角确定出本车和所述目标车辆之间的航向差;
根据本车的车宽、所述目标车辆的车宽、以及所述航向差确定出本车的碰撞角和所述目标车辆的碰撞角;
根据本车的车宽和本车的碰撞角确定出本车的碰撞危险长度,根据所述目标车辆的车宽和所述目标车辆的碰撞角确定出所述目标车辆的碰撞危险长度;
根据第一方程和第二方程求解出所述第一时刻和所述第二时刻,根据第三方程和第四方程求解出所述第三时刻和所述第四时刻;
其中,tH_1为第一时刻,tH_2为第二时刻,tR_1为第三时刻,tR_2为第四时刻,xH为本车的中心点在预设坐标系中的横坐标,yH为本车的中心点在所述预设坐标系中的纵坐标,DC_H为本车的碰撞危险长度,LHV为本车的车长,vH为本车的速度,aH为本车的加速度,xR为所述目标车辆的中心在所述预设坐标系中的横坐标,yR为所述目标车辆的中心在所述预设坐标系中的纵坐标,DC_R为所述目标车辆的碰撞危险长度,LRV为所述目标车辆的车长,vR为所述目标车辆的速度,aR为所述目标车辆的加速度,xO为本车与所述目标车辆的运动轨迹交叉点在所述预设坐标系中的横坐标,yO为本车与所述目标车辆的运动轨迹交叉点在所述预设坐标系中的纵坐标。
可选的,所述根据求解结果确定是否存在同车道碰撞风险,包括:
如果求解结果包括唯一正解,则确定存在同车道碰撞风险,将所述唯一正解作为本车与所述目标车辆的预计同车道碰撞时间;
如果求解结果包括两个正解,则确定存在同车道碰撞风险,将所述两个正解中的较小者作为本车与所述目标车辆的预计同车道碰撞时间;
如果所述求解结果为负解或者无解,则确定不存在同车道碰撞风险。
可选的,确定本车与所述目标车辆之间的同车道碰撞安全距离和同车道碰撞安全时间,包括:
按照第一公式计算出本车与所述目标车辆之间的同车道碰撞安全时间;
按照第二公式计算出本车与所述目标车辆之间的同车道碰撞安全距离;
第一公式为:
第二公式为:
其中,TP_S为同车道碰撞安全时间,LP_S为同车道碰撞安全距离,vH为本车的速度,aH为本车的加速度,vR为所述目标车辆的速度,aR为所述目标车辆的加速度,aH_0为本车的最小制动减速度,T1为本车在制动反应阶段的最大制动反应时间,T2为本车做出减速策略后加速度降至目标加速度所需的时间,LHV为本车的车长,LRV为所述目标车辆的车长。
可选的,所述确定本车与所述目标车辆是否处于同一车道,包括:
确定本车与所述目标车辆之间的垂向偏移量;
根据本车的车宽和所述目标车辆的车宽确定本车和所述目标车辆之间的危险垂向距离;
如果所述垂向偏移量小于或等于所述危险垂向距离,则确定本车与所述目标车辆处于同一车道,否则,确定本车与所述目标车辆未处于同一车道。
本申请还提供一种车辆碰撞预测系统,包括:
信息获取单元,用于获得本车的车辆定位信息和车辆状态信息,获得目标车辆的车辆定位信息和车辆状态信息,其中,所述车辆状态信息包括速度、加速度、航向角、车长、以及车宽;
车辆距离确定单元,用于根据本车的车辆定位信息与所述目标车辆的车辆定位信息确定本车与所述目标车辆之间的距离;
车道确定单元,用于在本车与所述目标车辆之间的距离小于预设的距离阈值的情况下,确定本车与所述目标车辆是否处于同一车道;
时间确定单元,用于在本车与所述目标车辆未处于同一车道的情况下,根据本车和所述目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开所述碰撞危险区域的第二时刻,确定出所述目标车辆进入所述碰撞危险区域的第三时刻以及离开所述碰撞危险区域的第四时刻;
碰撞时间集合确定单元,用于取第一时间区间和第二时间区间的交集作为预计碰撞时间集合,其中,所述第一时间区间为闭区间,所述第一时间区间的下边界为所述第一时刻、上边界为所述第二时刻,所述第二时间区域为闭区间,所述第二时间区间的下边界为所述第三时刻、上边界为所述第四时刻;
第一处理单元,用于在所述预计碰撞时间集合的下边界为所述第一时刻、上边界为所述第四时刻的情况下,确定出所述目标车辆在所述第一时刻的速度在本车行进方向上的投影速度,如果本车的速度大于所述投影速度,则确定存在交叉碰撞风险,否则,确定不存在交叉碰撞风险;
第二处理单元,用于在所述预计碰撞时间集合为除下边界为所述第一时刻且上边界为所述第四时刻之外的非空集合的情况下,确定存在交叉碰撞风险;
第一预测数据确定单元,用于在确定存在交叉碰撞风险的情况下,确定出本车与所述目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,和/或,确定出本车与所述目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间;
第一预警决策单元,用于在所述交叉碰撞距离小于或等于所述交叉碰撞安全距离,或者,所述预计交叉碰撞时间小于或等于所述交叉碰撞安全时间的情况下,进行碰撞预警。
可选的,在上述系统的基础上,还包括:
同向距离确定单元,用于在本车与所述目标车辆处于同一车道的情况下,确定本车与所述目标车辆的同车道同向距离;
第三处理单元,用于根据本车与所述目标车辆的同车道同向距离、本车的速度、本车的加速度、本车的车长、所述目标车辆的速度、所述目标车辆的加速度、以及所述目标车辆的车长,求解本车与所述目标车辆的预计同车道碰撞时间,并根据求解结果确定是否存在同车道碰撞风险;
第二预测数据确定单元,用于在确定存在同车道碰撞风险的情况下,确定出本车与所述目标车辆之间的同车道碰撞安全距离和/或同车道碰撞安全时间;
第二预警决策单元,用于在所述同车道同向距离小于或等于所述同车道碰撞安全距离,或者,所述预计同车道碰撞时间小于或等于所述同车道碰撞安全时间的情况下,进行碰撞预警。
可选的,所述车道确定单元确定本车与所述目标车辆是否处于同一车道,具体为:
确定本车与所述目标车辆之间的垂向偏移量;根据本车的车宽和所述目标车辆的车宽确定本车和所述目标车辆之间的危险垂向距离;如果所述垂向偏移量小于或等于所述危险垂向距离,则确定本车与所述目标车辆处于同一车道,否则,确定本车与所述目标车辆未处于同一车道。
本申请还提供一种电子装置,包括处理器、存储器和通信接口;
所述存储器用于存储程序;
所述处理器用于调用并执行所述存储器中存储的程序,以执行如上述任意一种车辆碰撞预测方法。
由此可见,本申请的有益效果为:
本申请公开的车辆碰撞预测方法和系统,获得本车和目标车辆的车辆定位信息和车辆状态信息,其中,车辆状态信息包括速度、加速度、航向角、车长和车宽;如果本车和目标车辆之间的距离小于预设的距离阈值,且本车和目标车辆未处于同一车道,那么根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽确定出本车和目标车辆进入碰撞危险区域和离开碰撞危险区域的时刻,并据此确定出两车均处于碰撞危险区域内的预计碰撞时间集合;如果预计碰撞时间集合非空,且表明目标车辆先于本车进入碰撞危险区域,且先于本车离开碰撞危险区域,则比较目标车辆在本车行进方向上的投影速度和本车的速度,以确定是否存在交叉碰撞风险;如果预计碰撞时间集合非空,且目标车辆相较于本车,是除先进入碰撞危险区域且先离开碰撞危险区域之外的情况,则确定存在交叉碰撞风险;在确定存在交叉碰撞风险的情况下,如果两车的交叉碰撞距离小于或等于两车的交叉碰撞安全距离,或者,两车的预计交叉碰撞时间小于或等于两车的交叉碰撞安全时间,则进行碰撞预警。
可以看到,本申请公开的车辆碰撞预测方法和系统,在本车和目标车辆之间的距离小于预设的距离阈值,且本车和目标车辆未处于同一车道的情况下,根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,能够准确地确定出本车和目标车辆进入碰撞危险区域和离开碰撞危险区域的时刻,从而准确地确定出两车均位于碰撞危险区域内的预计碰撞时间集合;如果预计碰撞时间集合非空,目标车辆相较于本车,是除先进入碰撞危险区域且先离开碰撞危险区域之外的情况,则确定存在交叉碰撞风险;在预计碰撞时间集合非空,目标车辆先于本车进入碰撞危险区域,且先于本车离开碰撞危险区域的情况下,比较目标车辆在本车行进方向上的投影速度和本车的速度,以确定是否存在交叉碰撞风险,能够降低安全冗余;之后,再通过比较交叉碰撞距离和交叉碰撞安全距离,和/或,比较预计交叉碰撞时间和交叉碰撞安全时间,能够准确地预测出两车是否会发生交叉碰撞。
附图说明
为了更清楚地说明本申请实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请公开的一种车辆碰撞预测方法的流程图;
图2为本申请公开的交叉碰撞模型示意图;
图3为本申请公开的速度投影分析原理图;
图4为本申请公开的另一种车辆碰撞预测方法的流程图;
图5为本申请公开的同车道车辆模型示意图;
图6为本申请公开的一种车辆碰撞预测系统的结构示意图;
图7为本申请公开的另一种车辆碰撞预测系统的结构示意图。
具体实施方式
本申请公开一种车辆碰撞预测方法及系统,以便准确地确定出本车与附近行驶的车辆是否存在碰撞风险,从而提高行车安全性。
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
参见图1,图1为本申请公开的一种车辆碰撞预测方法的流程图。
该方法由车辆中的控制器执行。需要说明的是,将执行本申请公开的车辆碰撞预测方法的车辆称为本车,将行驶于本车附近,需要判断是否有碰撞风险的其他车辆称为目标车辆,目标车辆可能有多个。如果目标车辆有多个,那么针对每个目标车辆分别执行本申请所公开的车辆碰撞预测方法,以分别确定本车与各个目标车辆是否有碰撞风险。
该方法包括:
S101:获得本车的车辆定位信息和车辆状态信息,获得目标车辆的车辆定位信息和车辆状态信息。其中,车辆状态信息包括速度、加速度、航向角、车长、以及车宽。
可选的,本车通过V2V(车对车通信)获取目标车辆的车辆定位信息和车辆状态信息。满足《合作式智能运输系统车用通信系统应用层及应用数据交互标准》的车辆,需具备短程无线通信能力,因此,本车可以通过V2V获取目标车辆的车辆定位信息和车辆状态信息。
当然,本车也可以通过其他途径获取目标车辆的车辆定位信息和车辆状态信息。
S102:根据本车的车辆定位信息与目标车辆的车辆定位信息确定本车与目标车辆之间的距离。
在获取本车和目标车辆的车辆定位信息后,就可以根据获取到的车辆定位信息确定出两车之间的距离,该距离是指本车与目标车辆之间的直线距离。
在具体实施中,车辆定位信息通常用于指示车辆的中心点所处的位置。那么步骤S102中确定出的距离具体是:本车的中心点与目标车辆的中心点之间的直线距离。
另外,车辆定位信息可能为经纬度信息,那么可以将本车的车辆定位信息和目标车辆的车辆定位信息转换至预设坐标系下,得到本车和目标车辆在该预设坐标系中的坐标位置,进而根据两车的坐标位置确定出本车与目标车辆之间的距离。
S103:如果本车与目标车辆之间的距离小于预设的距离阈值,则确定本车与目标车辆是否处于同一车道。
如果本车与目标车辆之间的距离小于预设的距离阈值,则执行后续操作。如果本车与目标车辆之间的距离大于或等于预设的距离阈值,那么本车与目标车辆不存在碰撞风险,不再执行后续操作,以降低控制器的运算量。
该距离阈值为经验值,例如将距离阈值设置为300米。当然,距离阈值为300米仅是一个举例。
S104:如果本车与目标车辆未处于同一车道,则根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开碰撞危险区域的第二时刻,确定出目标车辆进入碰撞危险区域的第三时刻以及离开碰撞危险区域的第四时刻。
S105:取第一时间区间和第二时间区间的交集作为预计碰撞时间集合。其中,第一时间区间为闭区间,第一时间区间的下边界为第一时刻、上边界为第二时刻,第二时间区域为闭区间,第二时间区间的下边界为第三时刻、上边界为第四时刻。
S106:如果预计碰撞时间集合的下边界为第一时刻、上边界为第四时刻,则确定出目标车辆在第一时刻的速度在本车行进方向上的投影速度。
S107:如果本车的速度大于投影速度,则确定存在交叉碰撞风险,否则,确定不存在交叉碰撞风险。
实施中,按照VR_P=VR·cosΔψ计算目标车辆在第一时刻的速度在本车行进方向上的投影速度。其中,VR为目标车辆在第一时刻的速度,Δψ为本车与目标车辆之间的航向差,也就是本车的航向角与目标车辆的航向角之间的差值,VR_P为投影速度。
S108:如果预计碰撞时间集合为除下边界为第一时刻且上边界为第四时刻之外的非空集合,则确定存在交叉碰撞风险。
也就是说,如果预计碰撞时间集合的下边界为第一时刻、上边界为第二时刻,表明目标车辆先于本车进入碰撞危险区域,且晚于本车离开碰撞危险区域,则确定存在交叉碰撞风险。如果预计碰撞时间集合的下边界为第三时刻、上边界为第四时刻,表明目标车辆晚于本车进入碰撞危险区域,且先于本车离开碰撞危险区域,则确定存在交叉碰撞风险。如果预计碰撞时间集合的下边界为第三时刻、上边界为第二时刻,表明目标车辆晚于本车进入碰撞危险区域,且晚于本车离开碰撞危险区域,则确定存在交叉碰撞风险。
如果本车与目标车辆之间的距离小于预设的距离阈值,那么本车与目标车辆之间可能会发生碰撞,在这种情况下,需要进一步确定两车发生碰撞的可能性大小。
如果本车与目标车辆未处于同一车道,也就是本车和目标车辆处于交叉行驶状态,那么根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开碰撞危险区域的第二时刻,确定出目标车辆进入碰撞危险区域的第三时刻以及离开碰撞危险区域的第四时刻。
需要说明的是,在现有技术中,通常将车辆视为一个质点,或者将车辆视为一个以车长为直径的圆。这两种方案都会导致车辆的碰撞预测结果出现问题。具体的:将车辆视为一个质点,会导致碰撞风险的漏报;将车辆视为一个以车长为直径的圆,会导致出现较大的安全冗余,也就是说,在两车存在较大距离时得到会发生碰撞的预测结果。
而本申请中,是根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开碰撞危险区域的第二时刻,确定出目标车辆进入碰撞危险区域的第三时刻以及离开碰撞危险区域的第四时刻。既不是将车辆视为一个质点来确定前述四个时刻,也不是将车辆视为一个以车长为直径的圆来确定前述四个时刻,而是基于两车的实际尺寸并结合两车的车辆定位信息、速度、加速度和航向角确定前述四个时刻,得到的四个时刻的值更加接近实际情况。
之后,根据本车和目标车辆进入碰撞危险区域的时刻以及离开碰撞危险区域的时刻确定出预计碰撞时间集合,也就是,确定出处于交叉行驶状态的两车都处于碰撞危险区域内的时间段。如果预计碰撞时间集合为空,表明本车与目标车辆经过碰撞危险区域的时间没有重合,本车和目标车辆之间不存在交叉碰撞风险,不再执行后续操作。如果预计碰撞时间集合不为空,那么表明本车和目标车辆之间可能存在交叉碰撞风险。
在预计碰撞时间集合为除下边界为第一时刻且上边界为第四时刻之外的非空集合的情况下,确定本车和目标车辆存在交叉碰撞风险。
在预计碰撞时间集合不为空的情况下,如果预计碰撞时间集合的下边界为第一时刻、上边界为第四时刻,这表明目标车辆与本车相比先进入碰撞危险区域,且先离开碰撞危险区域。这种情况下,比较目标车辆在本车行进方向上的投影速度与本车的速度,如果本车的速度大于目标车辆在本车行进方向上的投影速度,则确定存在交叉碰撞风险,如果本车的速度小于或等于目标车辆在本车行进方向上的投影速度,则确定不存在交叉碰撞风险,不再执行后续操作。在确定目标车辆相较于本车先进入碰撞危险区域,且先离开碰撞危险区域的情况下,通过比较目标车辆在本车行进方向上的投影速度和本车的速度,以确定本车和目标车辆存在交叉碰撞风险,能够降低安全冗余。
S109:在确定存在交叉碰撞风险的情况下,确定出本车与目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,和/或,确定出本车与目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间。
S110:如果交叉碰撞距离小于或等于交叉碰撞安全距离,或者,预计交叉碰撞时间小于或等于交叉碰撞安全时间,则进行碰撞预警。
在步骤S109中,如果仅确定出本车与目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,那么比较交叉碰撞距离和交叉碰撞安全距离。如果交叉碰撞距离小于或等于交叉碰撞安全距离,则进行碰撞预警。
在步骤S109中,如果仅确定出本车与目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间,那么比较本车与目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间。如果预计交叉碰撞时间小于或等于交叉碰撞安全时间,则进行碰撞预警。
在步骤S109中,如果确定出本车与目标车辆之间的交叉碰撞距离和预计交叉碰撞时间,以及本车与目标车辆之间的交叉碰撞安全距离和交叉碰撞安全时间,那么比较本车与目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,比较本车与目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间。如果满足交叉碰撞距离小于或等于交叉碰撞安全距离、以及预计交叉碰撞时间小于或等于交叉碰撞安全时间这两者中至少一个,那么进行碰撞预警。
可选的,本车进行碰撞预警具体为:向驾驶人员发送碰撞提示。可选的,本车进行碰撞预测还包括:向监控平台发送碰撞提示。
本申请公开的车辆碰撞预测方法,获得本车和目标车辆的车辆定位信息和车辆状态信息,其中,车辆状态信息包括速度、加速度、航向角、车长和车宽;如果本车和目标车辆之间的距离小于预设的距离阈值,且本车和目标车辆未处于同一车道,那么根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽确定出本车和目标车辆进入碰撞危险区域和离开碰撞危险区域的时刻,并据此确定出两车均处于碰撞危险区域内的预计碰撞时间集合;如果预计碰撞时间集合非空,且表明目标车辆先于本车进入碰撞危险区域,且先于本车离开碰撞危险区域,则比较目标车辆在本车行进方向上的投影速度和本车的速度,以确定是否存在交叉碰撞风险;如果预计碰撞时间集合非空,且目标车辆相较于本车,是除先进入碰撞危险区域且先离开碰撞危险区域之外的情况,则确定存在交叉碰撞风险;在确定存在交叉碰撞风险的情况下,如果两车的交叉碰撞距离小于或等于两车的交叉碰撞安全距离,或者,两车的预计交叉碰撞时间小于或等于两车的交叉碰撞安全时间,则进行碰撞预警。
可以看到,本申请公开的车辆碰撞预测方法,在本车和目标车辆之间的距离小于预设的距离阈值,且本车和目标车辆未处于同一车道的情况下,根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,能够准确地确定出本车和目标车辆进入碰撞危险区域和离开碰撞危险区域的时刻,从而准确地确定出两车均位于碰撞危险区域内的预计碰撞时间集合;如果预计碰撞时间集合非空,目标车辆相较于本车,是除先进入碰撞危险区域且先离开碰撞危险区域之外的情况,则确定存在交叉碰撞风险;在预计碰撞时间集合非空,目标车辆先于本车进入碰撞危险区域,且先于本车离开碰撞危险区域的情况下,比较目标车辆在本车行进方向上的投影速度和本车的速度,以确定是否存在交叉碰撞风险,能够降低安全冗余;之后,再通过比较交叉碰撞距离和交叉碰撞安全距离,和/或,比较预计交叉碰撞时间和交叉碰撞安全时间,能够准确地预测出两车是否会发生交叉碰撞。
下面结合图2,对根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开碰撞危险区域的第二时刻,确定出目标车辆进入碰撞危险区域的第三时刻以及离开碰撞危险区域的第四时刻的一个方案进行说明。
在图2中,HV表示本车,也可称为主车,RV表示目标车辆,也可称为远车。在图2中,O点表示两车运动轨迹的交叉点,C点表示两车可能发生碰撞的碰撞危险初始点,当两车在C点发生碰撞时,本车的中心点所在的点记为C_H点,目标车辆的中心点所在的点记为C_R点,C2点表示两车可能发生碰撞的碰撞危险结束点,当两车在C2点发生碰撞时,本车的中心点所在的点记为C2_H点,目标车辆的中心点所在的点记为C2_R点。
该方案具体包括:
1)、根据本车的航向角和目标车辆的航向角确定出本车和目标车辆之间的航向差。
本车的航向角为ψH,目标车辆的航向角为ψR,两车之间的航向差Δψ=|ψH-ψR|。
2)、根据本车的车宽、目标车辆的车宽、以及航向差确定出本车的碰撞角和目标车辆的碰撞角。
其中,ΔψH为本车的碰撞角,ΔψR为目标车辆的碰撞角,WHV为本车的车宽,WRV为目标车辆的车宽,Δψ为本车和目标车辆之间的航向差。
3)、根据本车的车宽和本车的碰撞角确定出本车的碰撞危险长度,根据目标车辆的车宽和目标车辆的碰撞角确定出目标车辆的碰撞危险长度。
按照公式DC_H=WHVcotΔψH计算本车的碰撞危险长度。
按照公式DC_R=WRVcotΔψR计算目标车辆的碰撞危险长度。
其中,DC_H为本车的碰撞危险长度,WHV为本车的车宽,ΔψH为本车的碰撞角,DC_R为目标车辆的碰撞危险长度,WRV为目标车辆的车宽,ΔψR为目标车辆的碰撞角。
本车的碰撞危险长度DC_H是指:本车的中心点位于C_H点时车辆前端到本车的中心点位于C2_H点时车辆后端之间的距离。目标车辆的碰撞危险长度DC_R是指:目标车辆的中心点位于C_R点时车辆前端到目标车辆的中心点位于C2_R点时车辆后端之间的距离。
4)、根据第一方程和第二方程求解出第一时刻和第二时刻,根据第三方程和第四方程求解出第三时刻和第四时刻。
其中,tH_1为第一时刻,tH_2为第二时刻,tR_1为第三时刻,tR_2为第四时刻,xH为本车的中心点在预设坐标系中的横坐标,yH为本车的中心点在预设坐标系中的纵坐标,DC_H为本车的碰撞危险长度,LHV为本车的车长,vH为本车的速度,aH为本车的加速度,xR为目标车辆的中心点在预设坐标系中的横坐标,yR为目标车辆的中心点在预设坐标系中的纵坐标,DC_R为目标车辆的碰撞危险长度,LRV为目标车辆的车长,vR为目标车辆的速度,aR为目标车辆的加速度,xO为本车与目标车辆的运动轨迹交叉点在预设坐标系中的横坐标,yO为本车与目标车辆的运动轨迹交叉点在预设坐标系中的纵坐标。
需要说明的是,根据本车的车辆位置信息和本车的航向角,就可以确定出本车的运动轨迹。根据目标车辆的车辆位置信息和目标车辆的航向角,就可以确定出目标车辆的运动轨迹。之后,根据本车和目标车辆的运动轨迹,确定出本车与目标车辆的运动轨迹交叉点。
在确定出第一时刻tH_1、第二时刻tH_2、第三时刻tR_1和第四时刻tR_2后,就可以确定出本车与目标车辆的预计碰撞时间集合[tH_1,tH_2]∩[tR_1,tR_2]。
如果本车与目标车辆的预计碰撞时间集合为空,表明本车与目标车辆经过碰撞危险区域的时间没有重合,本车和目标车辆之间不存在交叉碰撞风险。如果本车与目标车辆的预计碰撞时间集合为[tH_1,tR_2],表明本车与目标车辆经过碰撞危险区域的时间有重合,且目标车辆与本车相比先进入碰撞危险区域,且先离开碰撞危险区域,这种情况下,通过比较目标车辆在本车行进方向上投影速度和本车的速度,确定两车是否存在交叉碰撞风险,原理如图3所示。如果本车与目标车辆的预计碰撞时间集合为除[tH_1,tR_2]之外的非空集合,则确定两车存在交叉碰撞风险。
下面对确定本车与目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,确定本车与目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间的一个方案进行说明。
本车与目标车辆之间的预计交叉碰撞时间为本车进入碰撞危险区域的第一时刻tH_1。
按照以下公式计算本车与目标车辆之间的交叉碰撞安全距离:
按照以下公式计算本车与目标车辆之间的交叉碰撞安全时间:
在以上公式中,LCross_C为本车与目标车辆之间的交叉碰撞距离,LCross_S为本车与目标车辆之间的交叉碰撞安全距离,TCross_S为本车与目标车辆之间的交叉碰撞安全时间,xH为本车的中心点在预设坐标系中的横坐标,yH为本车的中心点在预设坐标系中的纵坐标,xO为本车与目标车辆的运动轨迹交叉点在预设坐标系中的横坐标,yO为本车与目标车辆的运动轨迹交叉点在预设坐标系中的纵坐标,DC_H为本车的碰撞危险长度,LHV为本车的车长,vH为本车的速度,aH为本车的加速度,aH_0为本车的最小制动减速度,T1为本车在制动反应阶段的最大制动反应时间,T2为本车做出减速策略后加速度降至目标加速度所需的时间。关于aH_0、T1和T2,在下文中有详细说明。
下面对确定本车与目标车辆是否处于同一车道的一个方案进行说明。具体包括:
1)、确定本车与目标车辆之间的垂向偏移量。
根据本车的车辆位置信息和航向角确定出本车的运动轨迹,也就是确定出运动轨迹方程Ax+By+C=0中A、B和C的取值。根据目标车辆的车辆位置信息和航向角确定出目标车辆的运动轨迹,也就是确定出运动轨迹方程Dx+Ey+F=0中D、E和F的取值。
2)、根据本车的车宽和目标车辆的车宽确定本车和目标车辆之间的危险垂向距离。
3)、如果该垂向偏移量小于或等于危险垂向距离,则确定本车与目标车辆处于同一车道,否则,确定本车与目标车辆未处于同一车道。
当然,在具体实施中,也可以通过其他方案确定本车和目标车辆是否处于同一车道。例如,采集包含目标车辆和路面的环境图像,通过对环境图像进行分析,确定目标车辆与本车是否处于同一车道。
参见图4,图4为本申请公开的另一种车辆碰撞预测方法的流程图。该方法包括:
S101:获得本车的车辆定位信息和车辆状态信息,获得目标车辆的车辆定位信息和车辆状态信息。其中,车辆状态信息包括速度、加速度、航向角、车长、以及车宽。
S102:根据本车的车辆定位信息与目标车辆的车辆定位信息确定本车与目标车辆之间的距离。
S103:如果本车与目标车辆之间的距离小于预设的距离阈值,则确定本车与目标车辆是否处于同一车道。
如果本车与目标车辆之间的距离小于预设的距离阈值,则执行后续操作。如果本车与目标车辆之间的距离大于预设的距离阈值,那么本车与目标车辆不存在碰撞风险,不再执行后续操作,以降低控制器的运算量。
需要说明的是,图4中着重对本车与目标车辆之间的距离小于预设的距离阈值,且本车与目标车辆处于同一车道情况下的处理过程进行说明。如果本车与目标车辆之间的距离小于预设的距离阈值,且本车与目标车辆未处于同一车道,那么执行图1中的相应步骤即可。
S111:如果本车与目标车辆处于同一车道,则确定本车与目标车辆的同车道同向距离。
其中,lP_C为本车与目标车辆的同车道同向距离,xH为本车的中心点在预设坐标系中的横坐标,yH为本车的中心点在预设坐标系中的纵坐标,xR为目标车辆的中心点在预设坐标系中的横坐标,yR为目标车辆的中心点在预设坐标系中的纵坐标,lV为本车与目标车辆之间的垂向偏移量。可参见图5。
S112:根据本车与目标车辆的同车道同向距离、本车的速度、本车的加速度、本车的车长、目标车辆的速度、目标车辆的加速度、以及目标车辆的车长,求解本车与目标车辆的预计同车道碰撞时间,并根据求解结果确定是否存在同车道碰撞风险。
可选的,根据求解结果确定是否存在同车道碰撞风险,包括:
如果求解结果包括唯一正解,则确定存在同车道碰撞风险,将唯一正解作为本车与目标车辆的预计同车道碰撞时间;如果求解结果包括两个正解,则确定存在同车道碰撞风险,将两个正解中的较小者作为本车与目标车辆的预计同车道碰撞时间;如果求解结果为负解或者无解,则确定不存在同车道碰撞风险。
当本车与目标车辆发生前向碰撞时满足以下公式:
在该公式中,除tP_C之外的参数均为已知量,将各已知量的数值代入该公式,求解tP_C的取值。如果求解出唯一的正解,则确定存在同车道碰撞风险,并将求解出的唯一正解作为本车与目标车辆的预计同车道碰撞时间。如果求解出两个正解,则确定存在同车道碰撞风险,并将两个正解中的较小者作为本车与目标车辆的预计同车道碰撞时间。如果无解或者求解出负解,则确定不存在同车道碰撞风险,不再执行后续操作。
S113:在确定存在同车道碰撞风险的情况下,确定出本车与目标车辆之间的同车道碰撞安全距离和/或同车道碰撞安全时间。
实施中,按照第一公式计算出本车与目标车辆之间的同车道碰撞安全时间,按照第二公式计算出本车与目标车辆之间的同车道碰撞安全距离。
第一公式为:
第二公式为:
其中,TP_S为同车道碰撞安全时间,LP_S为同车道碰撞安全距离,vH为本车的速度,aH为本车的加速度,vR为目标车辆的速度,aR为目标车辆的加速度,aH_0为本车的最小制动减速度,T1为本车在制动反应阶段的最大制动反应时间,T2为本车做出减速策略后加速度降至目标加速度所需的时间,LHV为本车的车长,LRV为目标车辆的车长。
这里对T1和T2进行说明。
车辆的制动过程包含三个阶段:
第一阶段:制动反应阶段。在收到碰撞预警信号后,车辆会生成减速策略,该段时间为制动反应时间。可以依据GB/T3357描述,将本车在制动反应阶段的最大制动反应时间T1设置为1.5秒。当然,也可以将T1设置为其他数值。
第二阶段:加速度变化阶段。车辆做出减速策略后,车辆的加速度由当前时刻的加速度变化至减速策略所指示的目标加速度,此段时间为车辆做出减速策略后加速度降至目标加速度所需的时间。可以依据GB/T3357描述,将最小制动减速度aH_0设置为-3.6m/s2,将本车做出减速策略后加速度降至目标加速度所需的时间T2设置为0.4秒。当然,也可以将aH_0和T2设置为其他数值。
第三阶段:持续制动阶段。当达到减速策略所指示的目标加速度后,会以此目标加速度持续运行,直至车辆的速度等于设定值。
S114:如果同车道同向距离小于或等于同车道碰撞安全距离,或者,预计同车道碰撞时间小于或等于同车道碰撞安全时间,则进行碰撞预警。
在步骤S113中,如果仅确定出本车与目标车辆之间的同车道碰撞安全距离,那么比较同车道同向距离和同车道碰撞安全距离。如果同车道同向距离小于或等于同车道碰撞安全距离,则进行碰撞预警。
在步骤S113中,如果仅确定出本车与目标车辆之间的同车道碰撞安全时间,那么比较预计同车道碰撞时间和同车道碰撞安全时间。如果预计同车道碰撞时间小于或等于同车道碰撞安全时间,则进行碰撞预警。
在步骤S113中,如果确定出本车与目标车辆之间的同车道碰撞安全距离和同车道碰撞安全时间,那么比较同车道同向距离和同车道碰撞安全距离,比较求解出的预计同车道碰撞时间和同车道碰撞安全时间。如果满足同车道同向距离小于或等于同车道碰撞安全距离、以及预计同车道碰撞时间小于或等于同车道碰撞安全时间这两者中的至少一个,则本车进行碰撞预警。
本申请公开的车辆碰撞预测方法,在本车和目标车辆之间的距离小于预设的距离阈值,且本车和目标车辆处于同一车道的情况下,根据本车与目标车辆的同车道同向距离、本车的速度、本车的加速度、本车的车长、目标车辆的速度、目标车辆的加速度、以及目标车辆的车长,求解本车与目标车辆的预计同车道碰撞时间,在该过程中考虑了两车的车长,因此求解出的预计同车道碰撞时间更加准确,之后,比较同车道同向距离和同车道碰撞安全距离,和/或,比较求解出的预计同车道碰撞时间和同车道碰撞安全时间,能够准确地预测出两车是否会发生同车道碰撞。
本申请上述公开了车辆碰撞预测方法,相应的,本申请还公开车辆碰撞预测系统。说明书中关于两者的描述可以相互参考。
参见图6,图6为本申请公开的一种车辆碰撞预测系统的结构示意图。该车辆碰撞预测系统包括信息获取单元601、车辆距离确定单元602、车道确定单元603、时间确定单元604、碰撞时间集合确定单元605、第一处理单元606、第二处理单元607、第一预测数据确定单元608和第一预警决策单元609。
其中:
信息获取单元601,用于获得本车的车辆定位信息和车辆状态信息,获得目标车辆的车辆定位信息和车辆状态信息。其中,车辆状态信息包括速度、加速度、航向角、车长、以及车宽。
车辆距离确定单元602,用于根据本车的车辆定位信息与目标车辆的车辆定位信息确定本车与目标车辆之间的距离。
车道确定单元603,用于在本车与目标车辆之间的距离小于预设的距离阈值的情况下,确定本车与目标车辆是否处于同一车道。
时间确定单元604,用于在本车与目标车辆未处于同一车道的情况下,根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开碰撞危险区域的第二时刻,确定出目标车辆进入碰撞危险区域的第三时刻以及离开碰撞危险区域的第四时刻。
碰撞时间集合确定单元605,用于取第一时间区间和第二时间区间的交集作为预计碰撞时间集合。其中,第一时间区间为闭区间,第一时间区间的下边界为第一时刻、上边界为第二时刻,第二时间区域为闭区间,第二时间区间的下边界为第三时刻、上边界为第四时刻。
第一处理单元606,用于在预计碰撞时间集合的下边界为第一时刻、上边界为第四时刻的情况下,确定出目标车辆在第一时刻的速度在本车行进方向上的投影速度,如果本车的速度大于投影速度,则确定存在交叉碰撞风险,否则,确定不存在交叉碰撞风险。
第二处理单元607,用于在预计碰撞时间集合为除下边界为所述第一时刻且上边界为所述第四时刻之外的非空集合的情况下,确定存在交叉碰撞风险。
第一预测数据确定单元608,用于在确定存在交叉碰撞风险的情况下,确定出本车与目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,和/或,确定出本车与目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间;
第一预警决策单元609,用于在交叉碰撞距离小于或等于交叉碰撞安全距离,或者,预计交叉碰撞时间小于或等于交叉碰撞安全时间的情况下,进行碰撞预警。
可选的,车道确定单元603确定本车与所述目标车辆是否处于同一车道,具体为:确定本车与所述目标车辆之间的垂向偏移量;根据本车的车宽和所述目标车辆的车宽确定本车和所述目标车辆之间的危险垂向距离;如果所述垂向偏移量小于或等于所述危险垂向距离,则确定本车与所述目标车辆处于同一车道,否则,确定本车与所述目标车辆未处于同一车道。
本申请图6所示的车辆碰撞预测系统,在本车和目标车辆之间的距离小于预设的距离阈值,且本车和目标车辆未处于同一车道的情况下,根据本车和目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,能够准确地确定出本车和目标车辆进入碰撞危险区域和离开碰撞危险区域的时刻,从而准确地确定出两车均位于碰撞危险区域内的预计碰撞时间集合;如果预计碰撞时间集合非空,目标车辆相较于本车,是除先进入碰撞危险区域且先离开碰撞危险区域之外的情况,则确定存在交叉碰撞风险;在预计碰撞时间集合非空,目标车辆先于本车进入碰撞危险区域,且先于本车离开碰撞危险区域的情况下,比较目标车辆在本车行进方向上的投影速度和本车的速度,以确定是否存在交叉碰撞风险,能够降低安全冗余;之后,再通过比较交叉碰撞距离和交叉碰撞安全距离,和/或,比较预计交叉碰撞时间和交叉碰撞安全时间,能够准确地预测出两车是否会发生交叉碰撞。
参见图7,图7为本申请公开的另一种车辆碰撞预测系统的结构示意图。与图6所示的车辆碰撞预测系统相比,进一步设置同向距离确定单元610、第三处理单元611、第二预测数据确定单元612和第二预警决策单元613。
其中:
同向距离确定单元610,用于在本车与目标车辆处于同一车道的情况下,确定本车与目标车辆的同车道同向距离。
第三处理单元611,用于根据本车与目标车辆的同车道同向距离、本车的速度、本车的加速度、本车的车长、目标车辆的速度、目标车辆的加速度、以及目标车辆的车长,求解本车与目标车辆的预计同车道碰撞时间,并根据求解结果确定是否存在同车道碰撞风险。
第二预测数据确定单元612,用于在确定存在同车道碰撞风险的情况下,确定出本车与目标车辆之间的同车道碰撞安全距离和/或同车道碰撞安全时间。
第二预警决策单元613,用于在同车道同向距离小于或等于同车道碰撞安全距离,或者,预计同车道碰撞时间小于或等于同车道碰撞安全时间的情况下,进行碰撞预警。
本申请图7所示的车辆碰撞预测系统,在本车和目标车辆之间的距离小于预设的距离阈值,且本车和目标车辆处于同一车道的情况下,根据本车与目标车辆的同车道同向距离、本车的速度、本车的加速度、本车的车长、目标车辆的速度、目标车辆的加速度、以及目标车辆的车长,求解本车与目标车辆的预计同车道碰撞时间,在该过程中考虑了两车的车长,因此求解出的预计同车道碰撞时间更加准确,之后,比较同车道同向距离和同车道碰撞安全距离,和/或,比较求解出的预计同车道碰撞时间和同车道碰撞安全时间,能够准确地预测出两车是否会发生同车道碰撞。
需要说明的是,本申请图6和图7所示的车辆碰撞预测系统中,各单元的具体实现可以前文中的相应描述,这里不再进行赘述。
本申请还公开一种电子装置。
该电子装置包括处理器、存储器和通信接口。存储器用于存放一个或一个以上程序,程序可以包括程序代码,所述程序代码包括计算机操作指令。处理器用于调用并执行存储器中存储的程序,以执行本申请上述公开的任意一种车辆碰撞预测方法。
最后,还需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的车辆碰撞预测系统和电子装置而言,由于其与实施例公开的车辆碰撞预测方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本申请。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本申请的精神或范围的情况下,在其它实施例中实现。因此,本申请将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (10)
1.一种车辆碰撞预测方法,其特征在于,包括:
获得本车的车辆定位信息和车辆状态信息,获得目标车辆的车辆定位信息和车辆状态信息,其中,所述车辆状态信息包括速度、加速度、航向角、车长、以及车宽;
根据本车的车辆定位信息与所述目标车辆的车辆定位信息确定本车与所述目标车辆之间的距离;
如果本车与所述目标车辆之间的距离小于预设的距离阈值,则确定本车与所述目标车辆是否处于同一车道;
如果本车与所述目标车辆未处于同一车道,则根据本车和所述目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开所述碰撞危险区域的第二时刻,确定出所述目标车辆进入所述碰撞危险区域的第三时刻以及离开所述碰撞危险区域的第四时刻;
取第一时间区间和第二时间区间的交集作为预计碰撞时间集合,其中,所述第一时间区间为闭区间,所述第一时间区间的下边界为所述第一时刻、上边界为所述第二时刻,所述第二时间区域为闭区间,所述第二时间区间的下边界为所述第三时刻、上边界为所述第四时刻;
如果所述预计碰撞时间集合的下边界为所述第一时刻、上边界为所述第四时刻,则确定出所述目标车辆在所述第一时刻的速度在本车行进方向上的投影速度,如果本车的速度大于所述投影速度,则确定存在交叉碰撞风险,否则,确定不存在交叉碰撞风险;
如果所述预计碰撞时间集合为除下边界为所述第一时刻且上边界为所述第四时刻之外的非空集合,则确定存在交叉碰撞风险;
在确定存在交叉碰撞风险的情况下,确定出本车与所述目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,和/或,确定出本车与所述目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间;
如果所述交叉碰撞距离小于或等于所述交叉碰撞安全距离,或者,所述预计交叉碰撞时间小于或等于所述交叉碰撞安全时间,则进行碰撞预警。
2.根据权利要求1所述的方法,其特征在于,还包括:
如果本车与所述目标车辆处于同一车道,则确定本车与所述目标车辆的同车道同向距离;
根据本车与所述目标车辆的同车道同向距离、本车的速度、本车的加速度、本车的车长、所述目标车辆的速度、所述目标车辆的加速度、以及所述目标车辆的车长,求解本车与所述目标车辆的预计同车道碰撞时间,并根据求解结果确定是否存在同车道碰撞风险;
在确定存在同车道碰撞风险的情况下,确定出本车与所述目标车辆之间的同车道碰撞安全距离和/或同车道碰撞安全时间;
如果所述同车道同向距离小于或等于所述同车道碰撞安全距离,或者,所述预计同车道碰撞时间小于或等于所述同车道碰撞安全时间,则进行碰撞预警。
3.根据权利要求1或2所述的方法,其特征在于,所述根据本车和所述目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开所述碰撞危险区域的第二时刻,确定出所述目标车辆进入所述碰撞危险区域的第三时刻以及离开所述碰撞危险区域的第四时刻,包括:
根据本车的航向角和所述目标车辆的航向角确定出本车和所述目标车辆之间的航向差;
根据本车的车宽、所述目标车辆的车宽、以及所述航向差确定出本车的碰撞角和所述目标车辆的碰撞角;
根据本车的车宽和本车的碰撞角确定出本车的碰撞危险长度,根据所述目标车辆的车宽和所述目标车辆的碰撞角确定出所述目标车辆的碰撞危险长度;
根据第一方程和第二方程求解出所述第一时刻和所述第二时刻,根据第三方程和第四方程求解出所述第三时刻和所述第四时刻;
其中,tH_1为第一时刻,tH_2为第二时刻,tR_1为第三时刻,tR_2为第四时刻,xH为本车的中心点在预设坐标系中的横坐标,yH为本车的中心点在所述预设坐标系中的纵坐标,D C_H为本车的碰撞危险长度,LHV为本车的车长,vH为本车的速度,aH为本车的加速度,xR为所述目标车辆的中心在所述预设坐标系中的横坐标,yR为所述目标车辆的中心在所述预设坐标系中的纵坐标,DC_R为所述目标车辆的碰撞危险长度,LRV为所述目标车辆的车长,vR为所述目标车辆的速度,aR为所述目标车辆的加速度,xO为本车与所述目标车辆的运动轨迹交叉点在所述预设坐标系中的横坐标,yO为本车与所述目标车辆的运动轨迹交叉点在所述预设坐标系中的纵坐标。
4.根据权利要求2所述的方法,其特征在于,所述根据求解结果确定是否存在同车道碰撞风险,包括:
如果求解结果包括唯一正解,则确定存在同车道碰撞风险,将所述唯一正解作为本车与所述目标车辆的预计同车道碰撞时间;
如果求解结果包括两个正解,则确定存在同车道碰撞风险,将所述两个正解中的较小者作为本车与所述目标车辆的预计同车道碰撞时间;
如果所述求解结果为负解或者无解,则确定不存在同车道碰撞风险。
5.根据权利要求2所述的方法,其特征在于,确定本车与所述目标车辆之间的同车道碰撞安全距离和同车道碰撞安全时间,包括:
按照第一公式计算出本车与所述目标车辆之间的同车道碰撞安全时间;
按照第二公式计算出本车与所述目标车辆之间的同车道碰撞安全距离;
第一公式为:
第二公式为:
其中,TP_S为同车道碰撞安全时间,LP_S为同车道碰撞安全距离,vH为本车的速度,aH为本车的加速度,vR为所述目标车辆的速度,aR为所述目标车辆的加速度,aH_0为本车的最小制动减速度,T1为本车在制动反应阶段的最大制动反应时间,T2为本车做出减速策略后加速度降至目标加速度所需的时间,LHV为本车的车长,LRV为所述目标车辆的车长。
6.根据权利要求1或2所述的方法,其特征在于,所述确定本车与所述目标车辆是否处于同一车道,包括:
确定本车与所述目标车辆之间的垂向偏移量;
根据本车的车宽和所述目标车辆的车宽确定本车和所述目标车辆之间的危险垂向距离;
如果所述垂向偏移量小于或等于所述危险垂向距离,则确定本车与所述目标车辆处于同一车道,否则,确定本车与所述目标车辆未处于同一车道。
7.一种车辆碰撞预测系统,其特征在于,包括:
信息获取单元,用于获得本车的车辆定位信息和车辆状态信息,获得目标车辆的车辆定位信息和车辆状态信息,其中,所述车辆状态信息包括速度、加速度、航向角、车长、以及车宽;
车辆距离确定单元,用于根据本车的车辆定位信息与所述目标车辆的车辆定位信息确定本车与所述目标车辆之间的距离;
车道确定单元,用于在本车与所述目标车辆之间的距离小于预设的距离阈值的情况下,确定本车与所述目标车辆是否处于同一车道;
时间确定单元,用于在本车与所述目标车辆未处于同一车道的情况下,根据本车和所述目标车辆的车辆定位信息、速度、加速度、航向角、车长和车宽,确定出本车进入碰撞危险区域的第一时刻以及离开所述碰撞危险区域的第二时刻,确定出所述目标车辆进入所述碰撞危险区域的第三时刻以及离开所述碰撞危险区域的第四时刻;
碰撞时间集合确定单元,用于取第一时间区间和第二时间区间的交集作为预计碰撞时间集合,其中,所述第一时间区间为闭区间,所述第一时间区间的下边界为所述第一时刻、上边界为所述第二时刻,所述第二时间区域为闭区间,所述第二时间区间的下边界为所述第三时刻、上边界为所述第四时刻;
第一处理单元,用于在所述预计碰撞时间集合的下边界为所述第一时刻、上边界为所述第四时刻的情况下,确定出所述目标车辆在所述第一时刻的速度在本车行进方向上的投影速度,如果本车的速度大于所述投影速度,则确定存在交叉碰撞风险,否则,确定不存在交叉碰撞风险;
第二处理单元,用于在所述预计碰撞时间集合为除下边界为所述第一时刻且上边界为所述第四时刻之外的非空集合的情况下,确定存在交叉碰撞风险;
第一预测数据确定单元,用于在确定存在交叉碰撞风险的情况下,确定出本车与所述目标车辆之间的交叉碰撞距离和交叉碰撞安全距离,和/或,确定出本车与所述目标车辆之间的预计交叉碰撞时间和交叉碰撞安全时间;
第一预警决策单元,用于在所述交叉碰撞距离小于或等于所述交叉碰撞安全距离,或者,所述预计交叉碰撞时间小于或等于所述交叉碰撞安全时间的情况下,进行碰撞预警。
8.根据权利要求7所述的系统,其特征在于,还包括:
同向距离确定单元,用于在本车与所述目标车辆处于同一车道的情况下,确定本车与所述目标车辆的同车道同向距离;
第三处理单元,用于根据本车与所述目标车辆的同车道同向距离、本车的速度、本车的加速度、本车的车长、所述目标车辆的速度、所述目标车辆的加速度、以及所述目标车辆的车长,求解本车与所述目标车辆的预计同车道碰撞时间,并根据求解结果确定是否存在同车道碰撞风险;
第二预测数据确定单元,用于在确定存在同车道碰撞风险的情况下,确定出本车与所述目标车辆之间的同车道碰撞安全距离和/或同车道碰撞安全时间;
第二预警决策单元,用于在所述同车道同向距离小于或等于所述同车道碰撞安全距离,或者,所述预计同车道碰撞时间小于或等于所述同车道碰撞安全时间的情况下,进行碰撞预警。
9.根据权利要求7或8所述的系统,其特征在于,所述车道确定单元确定本车与所述目标车辆是否处于同一车道,具体为:
确定本车与所述目标车辆之间的垂向偏移量;根据本车的车宽和所述目标车辆的车宽确定本车和所述目标车辆之间的危险垂向距离;如果所述垂向偏移量小于或等于所述危险垂向距离,则确定本车与所述目标车辆处于同一车道,否则,确定本车与所述目标车辆未处于同一车道。
10.一种电子装置,其特征在于,包括处理器、存储器和通信接口;
所述存储器用于存储程序;
所述处理器用于调用并执行所述存储器中存储的程序,以执行如上述权利要求1至6中任一项所述的车辆碰撞预测方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110774229.0A CN113327458B (zh) | 2021-07-08 | 2021-07-08 | 车辆碰撞预测方法、车辆碰撞预测系统及电子装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110774229.0A CN113327458B (zh) | 2021-07-08 | 2021-07-08 | 车辆碰撞预测方法、车辆碰撞预测系统及电子装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113327458A CN113327458A (zh) | 2021-08-31 |
CN113327458B true CN113327458B (zh) | 2023-01-06 |
Family
ID=77426045
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110774229.0A Active CN113327458B (zh) | 2021-07-08 | 2021-07-08 | 车辆碰撞预测方法、车辆碰撞预测系统及电子装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113327458B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113778108B (zh) * | 2021-10-09 | 2023-07-21 | 招商局检测车辆技术研究院有限公司 | 一种基于路侧感知单元的数据采集系统及数据处理方法 |
CN113947947A (zh) * | 2021-10-19 | 2022-01-18 | 中国第一汽车股份有限公司 | 车辆碰撞预警方法、装置、电子设备及存储介质 |
CN113911111B (zh) * | 2021-10-19 | 2024-03-26 | 中国第一汽车股份有限公司 | 车辆碰撞检测方法、系统、电子设备以及存储介质 |
CN114895670A (zh) * | 2022-04-21 | 2022-08-12 | 北京京东乾石科技有限公司 | 机器人碰撞预测方法及装置、电子设备和存储介质 |
CN114898558A (zh) * | 2022-05-23 | 2022-08-12 | 东风悦享科技有限公司 | 车辆协作通行的方法、系统、电子设备和存储介质 |
DE102022123474A1 (de) | 2022-09-14 | 2024-03-14 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum Berechnen einer prognostizierten Zeit bis zu einer möglichen Kollision zweier Kraftfahrzeuge, Computerprogramm und Fahrerassistenzsystem |
CN117719500B (zh) * | 2024-02-07 | 2024-05-28 | 北京易控智驾科技有限公司 | 车辆碰撞检测方法、装置、电子设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105799700A (zh) * | 2015-01-20 | 2016-07-27 | 丰田自动车株式会社 | 避免碰撞控制系统和控制方法 |
CN106023652A (zh) * | 2016-07-29 | 2016-10-12 | 重庆长安汽车股份有限公司 | 车辆交叉口碰撞预警方法 |
CN106056972A (zh) * | 2016-06-29 | 2016-10-26 | 江苏科技大学 | 一种基于车辆行驶速度和位置信息融合的安全防撞预警方法 |
CN108986461A (zh) * | 2018-07-13 | 2018-12-11 | 西安理工大学 | 一种基于时间的交叉路口车辆碰撞概率分析方法 |
CN110310481A (zh) * | 2019-06-28 | 2019-10-08 | 浙江吉利控股集团有限公司 | 一种车辆碰撞预警方法、装置及设备 |
CN111508274A (zh) * | 2020-03-17 | 2020-08-07 | 东软集团股份有限公司 | 一种碰撞预警方法、装置及设备 |
Family Cites Families (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8639437B2 (en) * | 2010-06-09 | 2014-01-28 | Toyota Motor Engineering & Manufacturing North America, Inc. | Computationally efficient intersection collision avoidance system |
US8706393B2 (en) * | 2012-01-10 | 2014-04-22 | Ford Global Technologies, Llc | Intersection collision avoidance with adaptable vehicle dimensions |
CN104908743A (zh) * | 2015-06-03 | 2015-09-16 | 奇瑞汽车股份有限公司 | 汽车防撞预警系统及其控制方法 |
CN105118329B (zh) * | 2015-08-24 | 2017-06-13 | 西安电子科技大学 | 一种消解无信号交叉口两车交通冲突的方法 |
US9751506B2 (en) * | 2015-10-27 | 2017-09-05 | GM Global Technology Operations LLC | Algorithms for avoiding automotive crashes at left and right turn intersections |
US10026321B2 (en) * | 2016-10-31 | 2018-07-17 | Delphi Technologies, Inc. | Automated vehicle cross-traffic detection system |
CN107248320A (zh) * | 2017-06-21 | 2017-10-13 | 深圳市金溢科技股份有限公司 | 危险预警方法、系统、v2x车载终端及存储器 |
CN108198461A (zh) * | 2018-02-28 | 2018-06-22 | 奇瑞汽车股份有限公司 | 车辆追尾预警方法及装置 |
CN108447308A (zh) * | 2018-05-17 | 2018-08-24 | 中交信息技术国家工程实验室有限公司 | 一种基于车路协同的交叉口车辆碰撞风险预测方法及系统 |
CN108877268B (zh) * | 2018-08-07 | 2021-05-25 | 南京大学 | 一种面向无人驾驶的无红绿灯十字路口智能调度方法 |
US10829113B2 (en) * | 2018-09-17 | 2020-11-10 | Ford Global Technologies, Llc | Vehicle collision avoidance |
CN109515435A (zh) * | 2018-12-04 | 2019-03-26 | 湖北文理学院 | 车辆防撞提醒的方法及装置 |
CN111816003B (zh) * | 2019-04-12 | 2022-05-06 | 广州汽车集团股份有限公司 | 车辆预警方法、装置和计算机设备 |
CN111833648A (zh) * | 2019-04-18 | 2020-10-27 | 上海汽车集团股份有限公司 | 一种车辆碰撞预警方法及装置 |
CN112349141B (zh) * | 2019-08-09 | 2022-01-18 | 广州汽车集团股份有限公司 | 一种前碰撞控制方法、前碰撞预警装置及汽车 |
US11420630B2 (en) * | 2019-10-24 | 2022-08-23 | Zoox, Inc. | Trajectory modifications based on a collision zone |
CN111127950A (zh) * | 2019-12-27 | 2020-05-08 | 北京万集智能网联技术有限公司 | 一种车辆碰撞预警处理方法及装置 |
CN111469837B (zh) * | 2020-04-13 | 2024-04-19 | 中国联合网络通信集团有限公司 | 车辆碰撞预测方法及装置 |
CN113002539B (zh) * | 2021-02-01 | 2022-09-23 | 潍柴动力股份有限公司 | 车辆碰撞预警方法、车辆预警系统及车辆 |
CN113071482B (zh) * | 2021-04-28 | 2023-03-21 | 江苏大学 | 一种基于通行时间区间的智能车辆防碰撞方法 |
-
2021
- 2021-07-08 CN CN202110774229.0A patent/CN113327458B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105799700A (zh) * | 2015-01-20 | 2016-07-27 | 丰田自动车株式会社 | 避免碰撞控制系统和控制方法 |
CN106056972A (zh) * | 2016-06-29 | 2016-10-26 | 江苏科技大学 | 一种基于车辆行驶速度和位置信息融合的安全防撞预警方法 |
CN106023652A (zh) * | 2016-07-29 | 2016-10-12 | 重庆长安汽车股份有限公司 | 车辆交叉口碰撞预警方法 |
CN108986461A (zh) * | 2018-07-13 | 2018-12-11 | 西安理工大学 | 一种基于时间的交叉路口车辆碰撞概率分析方法 |
CN110310481A (zh) * | 2019-06-28 | 2019-10-08 | 浙江吉利控股集团有限公司 | 一种车辆碰撞预警方法、装置及设备 |
CN111508274A (zh) * | 2020-03-17 | 2020-08-07 | 东软集团股份有限公司 | 一种碰撞预警方法、装置及设备 |
Non-Patent Citations (1)
Title |
---|
基于交通冲突分析方法的全无控制交叉口行车路权分析研究;袁黎等;《交通运输工程与信息学报》;20130915(第03期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113327458A (zh) | 2021-08-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113327458B (zh) | 车辆碰撞预测方法、车辆碰撞预测系统及电子装置 | |
JP6003349B2 (ja) | 車両挙動予測装置 | |
CN110809790B (zh) | 车辆用信息存储方法、车辆的行驶控制方法、以及车辆用信息存储装置 | |
CN108263383B (zh) | 在协同自适应巡航控制系统中控制速度的装置和方法 | |
US9937860B1 (en) | Method for detecting forward collision | |
JP6822752B2 (ja) | アクティブ車両制御のための運転支援技術 | |
CN111994071B (zh) | 后向追尾主动避让方法、系统、存储介质 | |
CN112208533B (zh) | 车辆控制系统、车辆控制方法及存储介质 | |
JP2016212872A (ja) | 対象物体の将来状態を計算により予測する方法の性能を向上するための方法、運転者支援システム、そのような運転者支援システムを備える車両、並びに対応するプログラムの記憶媒体及びプログラム | |
CN113192331B (zh) | 一种网联环境下面向骑行安全的智能预警系统及预警方法 | |
JP2009003650A (ja) | 車両走行推定装置 | |
JP2016511183A (ja) | 制動のための始動基準を求めるための方法及びこの方法を実行するための緊急ブレーキシステム | |
CN111661061B (zh) | 一种车辆行驶意图识别方法及装置 | |
US11753013B2 (en) | Method for operating a driving assistance system, and driving assistance system | |
CN114291116B (zh) | 周围车辆轨迹预测方法、装置、车辆及存储介质 | |
JP5852480B2 (ja) | 移動体管制装置および移動体搭載装置 | |
CN110979277B (zh) | 基于前方车辆状态的防追尾系统及方法 | |
EP4397554A1 (en) | Vehicle safety control method and apparatus, electronic device, and storage medium | |
CN113335311B (zh) | 一种车辆碰撞检测方法、装置、车辆及存储介质 | |
JP7474352B2 (ja) | 車両制御装置、および、車両制御方法 | |
CN117246321A (zh) | 一种多场景下的前方危险目标检测方法及aeb控制策略 | |
CN113548049A (zh) | 一种基于有限状态机的智能车辆驾驶行为决策方法及系统 | |
JP2010146489A (ja) | 車両用の情報提供装置及び情報提供方法 | |
JP2020042340A (ja) | 移動体検知システム | |
JP2006178674A (ja) | 走行支援装置 |
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 |