CN113511194A - 一种纵向避撞预警方法及相关装置 - Google Patents

一种纵向避撞预警方法及相关装置 Download PDF

Info

Publication number
CN113511194A
CN113511194A CN202110474284.8A CN202110474284A CN113511194A CN 113511194 A CN113511194 A CN 113511194A CN 202110474284 A CN202110474284 A CN 202110474284A CN 113511194 A CN113511194 A CN 113511194A
Authority
CN
China
Prior art keywords
measurement data
target vehicle
collision avoidance
early warning
sensor
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.)
Pending
Application number
CN202110474284.8A
Other languages
English (en)
Inventor
章军辉
郭晓满
付宗杰
王静贤
陈大鹏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuxi Internet Of Things Innovation Center Co ltd
Jiangsu IoT Research and Development Center
Original Assignee
Wuxi Internet Of Things Innovation Center Co ltd
Jiangsu IoT Research and Development Center
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Wuxi Internet Of Things Innovation Center Co ltd, Jiangsu IoT Research and Development Center filed Critical Wuxi Internet Of Things Innovation Center Co ltd
Priority to CN202110474284.8A priority Critical patent/CN113511194A/zh
Publication of CN113511194A publication Critical patent/CN113511194A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Traffic Control Systems (AREA)

Abstract

本申请公开了一种纵向避撞预警方法及相关装置,包括:对各异构传感器的量测数据进行时间配准与空间融合;从完成时间配准与空间融合后的量测数据中筛选出有效量测数据,并将有效量测数据与目标车辆的运动轨迹进行关联;其中,将有效量测数据与目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;根据多源异构传感器多目标观测模型以及有效量测数据,采用MSJPDA算法对相应的目标车辆的运动状态进行滤波估计得到目标车辆的状态估计;根据目标车辆的状态估计与预设的威胁估计模型进行避撞预警。该方法能够实现多源异构传感器量测数据的有效关联,增强融合感知的鲁棒能力,可靠的进行纵向避撞预警。

Description

一种纵向避撞预警方法及相关装置
技术领域
本申请涉及智能车辆技术领域,特别涉及一种纵向避撞预警方法;还涉及一种纵向避撞预警装置、设备以及计算机可读存储介质。
背景技术
随着汽车保有量持续增加以及城市交通规模快速增长,拥堵、安全、污染等已成为全球性交通困扰,从而大力发展汽车主动安全技术,实现车辆智能化网联化显得愈发重要。作为智能车辆与道路环境交互的关键—感知层,通过多源传感器融合技术精准辨识车辆周围环境,将为决策规划层提供更可靠的决策依据,多源传感器协同融合感知成为近年来目标跟踪领域的研究热点。目标跟踪问题包括单目标跟踪与多目标跟踪。无论是单目标跟踪还是多目标跟踪,有效可靠的进行避撞预警是目标跟踪过程中的一个关键,如何将多源传感器量测数据有效关联,可靠的进行纵向避撞预警已成为本领域技术人员亟待解决的技术问题。
发明内容
本申请的目的是提供一种纵向避撞预警方法,能够将多源传感器量测数据有效关联,可靠的进行纵向避撞预警。本申请的另一个目的是提供一种纵向避撞的预警装置、设备以及计算机可读存储介质,均具有上述技术效果。
为解决上述技术问题,本申请提供了一种纵向避撞预警方法,包括:
对各异构传感器的量测数据进行时间配准与空间融合;
从完成时间配准与空间融合后的所述量测数据中筛选出有效量测数据,并将所述有效量测数据与目标车辆的运动轨迹进行关联;其中,将所述有效量测数据与所述目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;
根据多源异构传感器多目标观测模型以及所述有效量测数据,采用MSJPDA算法对相应的所述目标车辆的运动状态进行滤波估计得到所述目标车辆的状态估计;
根据所述目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
可选的,所述异构传感器包括雷达传感器与视觉传感器。
可选的,对个异构传感器的量测数据进行时间配准包括:
通过内插外推的方式对雷达传感器与视觉传感器的量测数据进行时间配准。
可选的,对各异构传感器的量测数据进行空间融合包括:
在雷达坐标系与世界坐标系的二维水平面平行的条件下,建立相机像素坐标系与所述世界坐标系的映射关系;
根据所述相机像素坐标系与所述世界坐标系的映射关系对所述雷达传感器与所述视觉传感器的量测数据进行空间融合。
可选的,所述从完成时间配准与空间融合后的量测数据中筛选出有效量测数据包括:
计算所述量测数据与相应的预测值的马氏距离;
判断所述马氏距离是否小于或等于预设门限;
若所述马氏距离小于或等于所述预设门限,则所述量测数据为有效量测数据。
可选的,所述多源异构传感器多目标观测模型为
Figure BDA0003046467540000021
其中,xi(k)表示状态向量,且xi(k)=[di,y(k),vi,y(k),di,x(k),vi,x(k)]T
Figure BDA0003046467540000022
表示模型预测输出,且
Figure BDA0003046467540000023
di,y(k)表示第i个目标车辆的纵向距离,vi,y(k)表示第i个目标车辆纵向速度,di,x(k)表示第i个目标车辆的横向距离,vi,x(k)表示第i个目标车辆横向速度,i表示第i个目标车辆,ξ表示第ξ个传感器,xi(k+1|k)表示对k+1时刻第i个目标的状态预测,
Figure BDA0003046467540000024
表示第ξ个传感器对第i个目标的量测预测,Fi表示目标车辆i的状态转移矩阵,Ci表示状态校正项,Hξ表示第ξ个传感器的量测矩阵,wi(k)是过程噪声,vξ(k)是第ξ个传感器的量测噪声。
可选的,所述威胁估计模型为dsafe=dlim+D0+Δv·Tresp;其中,dsafe表示安全车距,dlim表示临界安全车距,D0表示零速度车距,Δv表示自车相对前车的速度差,Tresp表示驾驶人反应时间。
为解决上述技术问题,本申请还提供了一种纵向避撞预警装置,包括:
配准与融合模块,用于对各异构传感器的量测数据进行时间配准与空间融合;
筛选与关联模块,用于从完成时间配准与空间融合后的所述量测数据中筛选出有效量测数据,并将所述有效量测数据与目标车辆的运动轨迹进行关联;其中,将所述有效量测数据与所述目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;
状态估计模块,用于根据多源异构传感器多目标观测模型以及所述有效量测数据,采用MSJPDA算法对相应的所述目标车辆的运动状态进行滤波估计得到所述目标车辆的状态估计;
避撞预警模块,用于根据所述目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
为解决上述技术问题,本申请还提供了一种纵向避撞预警设备,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序时实现如上任一项所述的纵向避撞预警方法的步骤。
为解决上述技术问题,本申请还提供了一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如上任一项所述的纵向避撞预警方法的步骤。
本申请所提供的纵向避撞预警方法,包括:对各异构传感器的量测数据进行时间配准与空间融合;从完成时间配准与空间融合后的所述量测数据中筛选出有效量测数据,并将所述有效量测数据与目标车辆的运动轨迹进行关联;其中,将所述有效量测数据与所述目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;根据多源异构传感器多目标观测模型以及所述有效量测数据,采用MSJPDA算法对相应的所述目标车辆的运动状态进行滤波估计得到所述得到目标车辆的状态估计;根据所述目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
可见,本申请所提供的纵向避撞预警方法,对多源异构传感器量测数据进行时间配准与空间融合,以此解决多源传感器的观测序列的采样周期、采样起始时刻、通信时延差异而引起的时间异步,以及空间上存在不同维度不同坐标系的问题。在将有效量测数据与目标车辆的运动轨迹进行关联的过程中,本申请引入参考阈值,通过参考阈值来忽略关联概率接近于零的事件,实现对观测确认矩阵的稀疏化处理,减少可行联合事件的拆分次数。另外,本申请采用MSJPDA算法对目标车辆的运动状态进行滤波估计,可以有效提升量测数据关联的可靠程度,充分发挥出单一传感器各自的性能优势,增强了融合感知的鲁棒性,能够可靠的进行纵向避撞预警。
本申请所提供的纵向避撞预警装置、设备以及计算机可读存储介质均具有上述技术效果。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对现有技术和实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请实施例所提供的一种纵向避撞预警方法的流程示意图;
图2为本申请实施例所提供的一种多目标跟踪下坐标系的示意图;
图3为本申请实施例所提供的一种采样序列的示意图;
图4为本申请实施例所提供的一种坐标系映射关系的示意图;
图5为本申请实施例所提供的一种关联流程示意图;
图6为本申请实施例所提供的一种MSJPDA算法流程示意图。
具体实施方式
本申请的核心是提供一种纵向避撞预警方法,能够将多源传感器量测数据有效关联,可靠的进行纵向避撞预警。本申请的另一个核心是提供一种纵向避撞的预警装置、设备以及计算机可读存储介质,均具有上述技术效果。
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
请参考图1,图1为本申请实施例所提供的一种纵向避撞预警方法的流程示意图,参考图1所示,该方法包括:
S101:对个异构传感器的量测数据进行时间配准与空间融合;
本申请采用多源异构传感器量测数据相融合的方案对目标车辆的运动状态进行在线滚动估计,并在此基础上进行纵向避撞预警。其中,异构传感器可以包括雷达传感器与视觉传感器。
具体而言,多车道车辆跟踪过程中的OOI(object of interest,感兴趣目标)是位于本车道与邻车道且离本车最近的前方的目标车辆,其相对本车来说,危险系数较高,引发车辆追尾的隐患相对较大。
参考图2所示,针对多车道多目标跟踪问题,本申请建立多源异构传感器多目标观测模型的离散状态空间方程的方式为:假设雷达坐标系与世界坐标系的二维水平面平行,忽略目标车辆的法向运动。令第i个目标车辆的纵向距离为di,y(k),纵向速度为vi,y(k),横向距离为di,x(k),横向速度为vi,x(k),以xi(k)=[di,y(k),vi,y(k),di,x(k),vi,x(k)]T作为状态向量,
Figure BDA0003046467540000051
作为模型预测输出,建立多源异构传感器多目标观测模型的离散状态空间方程:
Figure BDA0003046467540000052
上式中,下标i表示第i个目标车辆,上标ξ表示第ξ个传感器,xi(k+1|k)表示对k+1时刻第i个目标车辆的状态预测,
Figure BDA0003046467540000053
是第ξ个传感器对第i个目标车辆的量测预测,Fi是目标车辆i的状态转移矩阵,Ci是状态校正项,Hξ是第ξ个传感器的量测矩阵,wi(k)是过程噪声,vξ(k)是第ξ个传感器的量测噪声。
其中,下标i∈[1,3],即最多3个目标车辆,下标ξ∈[1,2],可令ξ=1代表雷达传感器,ξ=2代表视觉传感器。
另外,为兼顾目标车辆的机动特性与本地实时计算的需求,本申请定义目标运动模型为CV(Constant Velocity,匀速运动)模型,并通过雷达传感器的量测数据来动态校正CV模型中机动目标的速度。假设过程噪声wi(k)服从N(0,Q)分布,量测噪声vξ(k)服从N(0,Rξ)分布,多目标观测模型中各系数矩阵满足:
Figure BDA0003046467540000061
其中,Ts表示采样周期,Δvi,y、Δvi,x分别表示通过雷达传感器量测得到的纵向与横向相对速度,忽略Δvi,x变化,并通过Δvi,y定期校正CV模型。
多类传感器所提供的多源信息往往是不同时空、不同维度、不同数据结构的,因此,为了提高源自各传感器的量测数据关联的可靠程度,实现多源传感器量测数据的有效关联与多目标的快速跟踪,本申请在获取到雷达传感器与视觉传感器的量测数据的基础上,首先对对雷达传感器与视觉传感器的量测数据进行时间配准与空间融合。
在一种具体的实施方式中,对各异构传感器的量测数据进行时间配准的方式为:
通过内插外推的方式对雷达传感器与视觉传感器的量测数据进行时间配准。
具体而言,为了保障时间配准的精度以及实时性,本实施例采用内插外推的方式进行时间配准。以X轴为例:将相机即视觉传感器的采样序列配准到雷达传感器的采样时刻上,对应的时间配准公式为:
Figure BDA0003046467540000062
上式中,
Figure BDA0003046467540000063
表示相机的采样序列的X轴分量,
Figure BDA0003046467540000064
表示将相机的第m个采样点
Figure BDA0003046467540000065
配准至雷达的第n个采样时刻上,T1表示雷达传感器的采样周期,T2表示相机的采样周期,
Figure BDA0003046467540000071
表示雷达传感器的采样时刻,
Figure BDA0003046467540000072
表示相机的采样时刻。以雷达传感器的采样周期为60ms,相机的采样周期为33ms为例,二者的采样序列如图3所示。
可以明白的是,依照上述针对X轴分量的配准方式,可以类比的得到Y轴分量的配准方式,将上式中X替换成为Y即可,本申请在此不做赘述。
在一种具体的实施方式中,对各异构传感器的量测数据进行空间融合包括:在雷达坐标系与世界坐标系的二维水平面平行的条件下,建立相机像素坐标系与世界坐标系的映射关系;根据相机像素坐标系与世界坐标系的映射关系对雷达传感器与视觉传感器的量测数据进行空间融合。
具体而言,在建立多源异构传感器目标观测模型的离散状态空间方程时,假设雷达坐标系与世界坐标系的二维水平面是平行的,因此仅需建立相机像素坐标系与世界坐标系的映射关系。
参考图4所示,三维世界点P与其在像平面上投影点p的映射关系满足:
λp=ψ[R3×3|t3×1]P;
上式中,λ为比例系数,p=[u,v,1]T是二维图像中投影点的齐次坐标,P=[Xw,Yw,Zw,1]T是三维世界中某点的齐次坐标,
Figure BDA0003046467540000073
是相机的内参矩阵,[R3×3|t3×1]是相机的外参矩阵,R3×3是旋转矩阵,t3×1是平移向量,(u0,v0)是投影中心点,f是焦距。
S102:从完成时间配准与空间融合后的量测数据中筛选出有效量测数据,并将有效量测数据与目标车辆的运动轨迹进行关联;其中,将有效量测数据与目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;
本步骤旨在进行数据关联,包括有效量测数据的筛选与有效量测数据与目标车辆的运动轨迹进行关联两步。
从量测数据中筛选出有效量测数据的方式可以为:计算量测数据与相应的预测值的马氏距离;判断马氏距离是否小于或等于预设门限;若马氏距离小于或等于预设门限,则量测数据为有效量测数据。
具体而言,马氏距离是一种用于计算两个未知样本集相似度的度量方法。为了弱化不同特征数据之间量纲的影响,定义模型预测与实际量测之间的马氏距离为
Figure BDA0003046467540000081
式中,zξ表示本周期内第ξ个传感器的实际量测,yξ表示基于第ξ个传感器的观测模型的预测,Σξ表示协方差矩阵,dM表示马氏距离。如果计算所得马氏距离小于或等于预设门限,则表明相应的量测数据为有效量测数据。即若量测数据落入有效观测集所描述的区域,则表明量测数据为有效量测数据。有效观测集表示如下:
Figure BDA0003046467540000082
上式中,
Figure BDA0003046467540000083
表示第ξ个传感器的有效观测集,ε表示门限。
另外,将有效量测数据与目标车辆的运动轨迹进行关联的方式可以为:根据有效量测数据生成观测确认矩阵,将观测确认矩阵拆分为多个可行矩阵,进而计算有效量测数据与目标车辆的运动轨迹的目标关联概率,根据计算所得目标关联概率将有效量测数据与目标车辆的运动轨迹关联。
具体而言,在某个采样周期内,将mk个有效量测数据与nk个目标车辆之间的一种匹配可能的事件定义为联合事件,并用矩阵形式来描述联合事件,
Figure BDA0003046467540000084
式中,ωi,j表示在联合事件中量测j与目标i的布尔关系,即当量测j落入目标i的跟踪门内时,ωi,j=1,反之,ωi,j=0。Ω为观测确认矩阵,该观测确认矩阵的第一列表示量测j源于杂波或虚警,其中,目标i∈[0,1,…,nk],量测j∈[1,2,…,mk]。
对于量测落入跟踪门相交区域的情形,即某些量测可能源自于多个目标,定义目标关联概率,用以表示不确定性量测与其可能的源目标的关联程度。假设:每个量测只能源自于一个目标或杂波;每个目标最多只能产生一个回波。由此上式所表示的联合事件将被拆分成多个不相关的可行关联事件的组合。
目标关联概率为:
Figure BDA0003046467540000091
其中,式中,βi,j(k)表示量测j与目标i关联的概率,属于后验概率,θi,j(k)表示量测j源自于目标i的事件,
Figure BDA0003046467540000094
表示第
Figure BDA0003046467540000095
个可行关联事件,
Figure BDA0003046467540000096
Zk表示前k次的量测集,属于先验知识。
其中,在数据关联过程中,对观测确认矩阵Ω进行拆分,应遵循:逐行扫描,每行仅选出一个1作为可行矩阵在该行的非0元素;除第一列外,每列只能有一个1。当目标密集或回波较多时,尤其是在强杂波环境下,拆分复杂度将会剧增,计算实时性不太理想,并且由于关联概率较大的可行关联事件将会在跟踪过程中起着主导作用,因此本实施例设置了一个参考阈值,用来忽略关联概率接近于0的事件,以实现对确认矩阵的稀疏化处理,进而减少可行联合事件的拆分次数。对式(6)观测确认矩阵进行重构,即Ω′=[ω′i,j]。
式中,
Figure BDA0003046467540000092
其中ρ是设计参数,当ρ越小时,拆分次数越多,计算负荷越大,反之,实时性变好,跟踪效果变差,优选的ρ选取10-2数量级,βi,j为Cheap JPDA算法中聚概率矩阵的元素。
数据关联流程可参考图5所示,其中,
Figure BDA0003046467540000093
表示雷达传感器或视觉传感器的有效观测集,x1(k)代表左车道感兴趣目标车辆,x2(k)代表本车道感兴趣目标车辆,x3(k)代表右车道感兴趣目标车辆。
当有新的机动目标进入观测视野时,根据最临近原则,距离本车最近的目标所构成的威胁较为明显,从而更新感兴趣目标序列,否则维持当前感兴趣目标序列。当机动目标超出雷达的观测范围或连续数个周期内皆无有效量测,则舍弃该目标。
S103:根据多源异构传感器多目标观测模型以及有效量测数据,采用MSJPDA算法对相应的目标车辆的运动状态进行滤波估计得到目标车辆的状态估计;
具体的,考虑到传感器数量以及应用场景,本申请采用MSJPDA(multi-sensorjoint probability data association,多源传感器联合概率数据融合)算法对目标车辆的运动状态进行序贯更新。参考图6所示,该算法是将单一传感器JPDA(joint probabilitydata association,联合概率数据关联)算法结构串联起来,在当前时刻依次处理各传感器的量测数据,对目标车辆的运动状态进行序贯更新,最后一级的输出将作为融合中心的最终状态估计。
针对单一传感器JPDA算法的解释如下:JPDA是一种通过对各有效量测值按关联概率加权平均进而对目标轨迹进行滤波估计的算法。先通过计算当前时刻有效观测集内每一个量测与其可能的源目标相关联的后验概率,即对组合量测求加权平均时的权值,再基于标准卡尔曼滤波框架,利用组合量测对相应目标的运动状态进行联合预测,在下一采样时刻重复该过程,从而实现各目标运动状态的在线滚动估计。
对于单一传感器,忽略掉标识符ξ,一步迭代算式如下:
时间更新过程为:
Figure BDA0003046467540000101
式中,xi(k|k-1)表示基于k-1时刻目标i的状态对k时刻的状态进行预测,Pi(k|k-1)是对目标i状态预测的协方差,Q是过程噪声的协方差。
关联概率更新过程为:
根据式(5)所示的跟踪门规则生成观测确认矩阵,接着将其拆分成Lk个可行矩阵,再根据式(7)对关联概率进行更新。
量测更新过程为:
Figure BDA0003046467540000102
式中,Si(k)表示量测协方差,Gi(k)表示卡尔曼增益,δi,j(k)表示量测新息,δi(k)表示组合新息,βi,j(k)表示量测j源于目标i的概率,
Figure BDA0003046467540000103
表示k时刻没有量测与目标i关联,xi,j(k)表示利用第j个量测对目标i的卡尔曼滤波估计,xi(k)、Pi(k)是k时刻的最优估计,被用作下一步迭代的输入。
S104:根据目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
本步骤旨在根据目标车辆的状态估计以及威胁估计模型判断是否存在碰撞风险,并当存在碰撞风险时进行避撞预警。
其中,威胁估计模型为dsafe=dlim+D0+Δv·Tresp;其中,dsafe表示安全车距,dlim表示临界安全车距,D0表示零速度车距,且D0与路面附着系数有关,Δv表示自车相对前车的速度差,Tresp表示驾驶人反应时间。
在进行避撞预警时,可以对追尾危险的发展态势进行评估与分级,进而采取各级对应的预警措施,以更加符合人体工程学方法论,并在一定程度上改善驾乘体验。
进一步,有鉴于传感器本身的局限性,为了避免有效目标短暂丢失、噪声量测等扰动因素的影响,在关联过程中还可增加有效目标的存续性判定策略,即对于某个跟踪目标i,
Figure BDA0003046467540000111
当l∈[0,L]时,有βi,j(k+l)≤σ恒成立,则该目标不再有效,反之,则认为该目标的生命周期是存续的,该目标有效。其中σ、L皆是设计参数。
综上所述,本申请所提供的纵向避撞预警方法,对多源异构传感器量测数据进行时间配准与空间融合,以此解决多源传感器的观测序列的采样周期、采样起始时刻、通信时延差异而引起的时间异步,以及空间上存在不同维度不同坐标系的问题。在将有效量测数据与目标车辆的运动轨迹进行关联的过程中,本申请引入参考阈值,通过参考阈值来忽略关联概率接近于零的事件,实现对观测确认矩阵的稀疏化处理,减少可行联合事件的拆分次数。另外,本申请采用MSJPDA算法对目标车辆的运动状态进行状态估计,可以有效提升量测数据关联的可靠程度,充分发挥出单一传感器各自的性能优势,增强了融合感知的鲁棒性,能够可靠的进行纵向避撞预警。
本申请还提供了一种纵向避撞预警装置,下文描述的该装置可以与上文描述的方法相互对应参照。该装置主要包括:
配准与融合模块,用于对各异构传感器的量测数据进行时间配准与空间融合;
筛选与关联模块,用于从完成时间配准与空间融合后的所述量测数据中筛选出有效量测数据,并将所述有效量测数据与目标车辆的运动轨迹进行关联;其中,将所述有效量测数据与所述目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;
状态估计模块,用于根据多源异构传感器多目标观测模型以及所述有效量测数据,采用MSJPDA算法对相应的所述目标车辆的运动状态进行滤波估计得到所述目标车辆的状态估计;
避撞预警模块,用于根据所述目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
本申请还提供了一种纵向避撞预警设备,该设备包括存储器和处理器。
存储器,用于存储计算机程序;
处理器,用于执行计算机程序实现如下的步骤:
对各异构传感器的量测数据进行时间配准与空间融合;从完成时间配准与空间融合后的所述量测数据中筛选出有效量测数据,并将所述有效量测数据与目标车辆的运动轨迹进行关联;其中,将所述有效量测数据与所述目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;根据多源异构传感器多目标观测模型以及所述有效量测数据,采用MSJPDA算法对相应的所述目标车辆的运动状态进行滤波估计得到所述目标车辆的状态估计;根据所述目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
对于本申请所提供的设备的介绍请参照上述方法实施例,本申请在此不做赘述。
本申请还提供了一种计算机可读存储介质,该计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时可实现如下的步骤:
对各异构传感器的量测数据进行时间配准与空间融合;从完成时间配准与空间融合后的所述量测数据中筛选出有效量测数据,并将所述有效量测数据与目标车辆的运动轨迹进行关联;其中,将所述有效量测数据与所述目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;根据多源异构传感器多目标观测模型以及所述有效量测数据,采用MSJPDA算法对相应的所述目标车辆的运动状态进行滤波估计得到所述目标车辆的状态估计;根据所述目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
该计算机可读存储介质可以包括:U盘、移动硬盘、只读存储器(Read-OnlyMemory,ROM)、随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
对于本申请所提供的计算机可读存储介质的介绍请参照上述方法实施例,本申请在此不做赘述。
说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置、设备以及计算机可读存储介质而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以直接用硬件、处理器执行的软件模块,或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其它形式的存储介质中。
以上对本申请所提供的纵向避撞预警方法、装置、设备以及计算机可读存储介质进行了详细介绍。本文中应用了具体个例对本申请的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本申请的方法及其核心思想。应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以对本申请进行若干改进和修饰,这些改进和修饰也落入本申请权利要求的保护范围。

Claims (10)

1.一种纵向避撞预警方法,其特征在于,包括:
对各异构传感器的量测数据进行时间配准与空间融合;
从完成时间配准与空间融合后的所述量测数据中筛选出有效量测数据,并将所述有效量测数据与目标车辆的运动轨迹进行关联;其中,将所述有效量测数据与所述目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;
根据多源异构传感器多目标观测模型以及所述有效量测数据,采用MSJPDA算法对相应的所述目标车辆的运动状态进行滤波估计得到所述目标车辆的状态估计;
根据所述目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
2.根据权利要求1所述的纵向避撞预警方法,其特征在于,所述异构传感器包括雷达传感器与视觉传感器。
3.根据权利要求2所述的纵向避撞预警方法,其特征在于,对个异构传感器的量测数据进行时间配准包括:
通过内插外推的方式对雷达传感器与视觉传感器的量测数据进行时间配准。
4.根据权利要求2所述的纵向避撞预警方法,其特征在于,对各异构传感器的量测数据进行空间融合包括:
在雷达坐标系与世界坐标系的二维水平面平行的条件下,建立相机像素坐标系与所述世界坐标系的映射关系;
根据所述相机像素坐标系与所述世界坐标系的映射关系对所述雷达传感器与所述视觉传感器的量测数据进行空间融合。
5.根据权利要求1所述的纵向避撞预警方法,其特征在于,所述从完成时间配准与空间融合后的量测数据中筛选出有效量测数据包括:
计算所述量测数据与相应的预测值的马氏距离;
判断所述马氏距离是否小于或等于预设门限;
若所述马氏距离小于或等于所述预设门限,则所述量测数据为有效量测数据。
6.根据权利要求1所述的纵向避撞预警方法,其特征在于,所述多源异构传感器多目标观测模型为
Figure FDA0003046467530000021
其中,xi(k)表示状态向量,且xi(k)=[di,y(k),vi,y(k),di,x(k),vi,x(k)]T
Figure FDA0003046467530000022
表示模型预测输出,且
Figure FDA0003046467530000023
di,y(k)表示第i个目标车辆的纵向距离,vi,y(k)表示第i个目标车辆的纵向速度,di,x(k)表示第i个目标车辆的横向距离,vi,x(k)表示第i个目标车辆的横向速度,i表示第i个目标车辆,ξ表示第ξ个传感器,xi(k+1|k)表示对k+1时刻第i个目标的状态预测,
Figure FDA0003046467530000024
表示第ξ个传感器对第i个目标的量测预测,Fi表示目标车辆i的状态转移矩阵,Ci表示状态校正项,Hξ表示第ξ个传感器的量测矩阵,wi(k)是过程噪声,vξ(k)是第ξ个传感器的量测噪声。
7.根据权利要求1所述的纵向避撞预警方法,其特征在于,所述威胁估计模型为dsafe=dlim+D0+Δv·Tresp;其中,dsafe表示安全车距,dlim表示临界安全车距,D0表示零速度车距,Δv表示自车相对前车的速度差,Tresp表示驾驶人反应时间。
8.一种纵向避撞预警装置,其特征在于,包括:
配准与融合模块,用于对各异构传感器的量测数据进行时间配准与空间融合;
筛选与关联模块,用于从完成时间配准与空间融合后的所述量测数据中筛选出有效量测数据,并将所述有效量测数据与目标车辆的运动轨迹进行关联;其中,将所述有效量测数据与所述目标车辆的运动轨迹进行关联时去除关联概率小于预设参考阈值的事件;
状态估计模块,用于根据多源异构传感器多目标观测模型以及所述有效量测数据,采用MSJPDA算法对相应的所述目标车辆的运动状态进行滤波估计得到所述目标车辆的状态估计;
避撞预警模块,用于根据所述目标车辆的状态估计与预设的威胁估计模型进行避撞预警。
9.一种纵向避撞预警设备,其特征在于,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序时实现如权利要求1至7任一项所述的纵向避撞预警方法的步骤。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至7任一项所述的纵向避撞预警方法的步骤。
CN202110474284.8A 2021-04-29 2021-04-29 一种纵向避撞预警方法及相关装置 Pending CN113511194A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110474284.8A CN113511194A (zh) 2021-04-29 2021-04-29 一种纵向避撞预警方法及相关装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110474284.8A CN113511194A (zh) 2021-04-29 2021-04-29 一种纵向避撞预警方法及相关装置

Publications (1)

Publication Number Publication Date
CN113511194A true CN113511194A (zh) 2021-10-19

Family

ID=78063525

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110474284.8A Pending CN113511194A (zh) 2021-04-29 2021-04-29 一种纵向避撞预警方法及相关装置

Country Status (1)

Country Link
CN (1) CN113511194A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115571156A (zh) * 2022-09-23 2023-01-06 东南大学 基于传感器融合的前车横向与纵向运动状态联合估计方法

Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070109111A1 (en) * 1997-10-22 2007-05-17 Intelligent Technologies International, Inc. Accident Avoidance Systems and Methods
CN101391589A (zh) * 2008-10-30 2009-03-25 上海大学 车载智能报警方法和装置
CN202163431U (zh) * 2011-06-30 2012-03-14 中国汽车技术研究中心 基于多传感器信息融合的碰撞及偏离预警装置
CN108280442A (zh) * 2018-02-10 2018-07-13 西安交通大学 一种基于轨迹匹配的多源目标融合方法
CN109050538A (zh) * 2018-06-20 2018-12-21 湘潭大学 一种安全车距估算装置及方法
CN109212521A (zh) * 2018-09-26 2019-01-15 同济大学 一种基于前视相机与毫米波雷达融合的目标跟踪方法
CN109633589A (zh) * 2019-01-08 2019-04-16 沈阳理工大学 目标跟踪中基于多模型优化多假设的多目标数据关联方法
CN109975798A (zh) * 2019-03-26 2019-07-05 武汉理工大学 一种基于毫米波雷达与摄像头的目标检测方法
CN110726990A (zh) * 2019-09-23 2020-01-24 江苏大学 一种基于ds-gnn算法的多传感器融合方法
CN110745128A (zh) * 2019-09-18 2020-02-04 江苏大学 一种基于最小安全距离的车辆强制减速系统及控制方法
CN111142143A (zh) * 2019-12-23 2020-05-12 西北工业大学 一种基于多源信息融合的进场段飞行技术误差估计方法
CN111860589A (zh) * 2020-06-12 2020-10-30 中山大学 一种多传感器多目标协同探测信息融合方法、系统
CN112033429A (zh) * 2020-09-14 2020-12-04 吉林大学 一种智能汽车的目标级多传感器融合方法
CN112229406A (zh) * 2020-09-29 2021-01-15 中国航空工业集团公司沈阳飞机设计研究所 一种多余度引导全自动着陆信息融合方法及系统
CN112285700A (zh) * 2020-08-24 2021-01-29 江苏大学 基于激光雷达与毫米波雷达融合的机动目标跟踪方法
CN112526521A (zh) * 2020-11-25 2021-03-19 湖北工业大学 一种汽车毫米波防撞雷达的多目标跟踪方法

Patent Citations (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070109111A1 (en) * 1997-10-22 2007-05-17 Intelligent Technologies International, Inc. Accident Avoidance Systems and Methods
CN101391589A (zh) * 2008-10-30 2009-03-25 上海大学 车载智能报警方法和装置
CN202163431U (zh) * 2011-06-30 2012-03-14 中国汽车技术研究中心 基于多传感器信息融合的碰撞及偏离预警装置
CN108280442A (zh) * 2018-02-10 2018-07-13 西安交通大学 一种基于轨迹匹配的多源目标融合方法
CN109050538A (zh) * 2018-06-20 2018-12-21 湘潭大学 一种安全车距估算装置及方法
CN109212521A (zh) * 2018-09-26 2019-01-15 同济大学 一种基于前视相机与毫米波雷达融合的目标跟踪方法
CN109633589A (zh) * 2019-01-08 2019-04-16 沈阳理工大学 目标跟踪中基于多模型优化多假设的多目标数据关联方法
CN109975798A (zh) * 2019-03-26 2019-07-05 武汉理工大学 一种基于毫米波雷达与摄像头的目标检测方法
CN110745128A (zh) * 2019-09-18 2020-02-04 江苏大学 一种基于最小安全距离的车辆强制减速系统及控制方法
CN110726990A (zh) * 2019-09-23 2020-01-24 江苏大学 一种基于ds-gnn算法的多传感器融合方法
CN111142143A (zh) * 2019-12-23 2020-05-12 西北工业大学 一种基于多源信息融合的进场段飞行技术误差估计方法
CN111860589A (zh) * 2020-06-12 2020-10-30 中山大学 一种多传感器多目标协同探测信息融合方法、系统
CN112285700A (zh) * 2020-08-24 2021-01-29 江苏大学 基于激光雷达与毫米波雷达融合的机动目标跟踪方法
CN112033429A (zh) * 2020-09-14 2020-12-04 吉林大学 一种智能汽车的目标级多传感器融合方法
CN112229406A (zh) * 2020-09-29 2021-01-15 中国航空工业集团公司沈阳飞机设计研究所 一种多余度引导全自动着陆信息融合方法及系统
CN112526521A (zh) * 2020-11-25 2021-03-19 湖北工业大学 一种汽车毫米波防撞雷达的多目标跟踪方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
于文琪: "基于多传感器融合的目标跟踪及冲突预警策略与算法研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
杨鑫等: "面向高级辅助驾驶雷达和视觉传感器信息融合算法的研究", 《汽车实用技术》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115571156A (zh) * 2022-09-23 2023-01-06 东南大学 基于传感器融合的前车横向与纵向运动状态联合估计方法
CN115571156B (zh) * 2022-09-23 2023-12-26 东南大学 基于传感器融合的前车横向与纵向运动状态联合估计方法

Similar Documents

Publication Publication Date Title
US11946750B2 (en) Method for vehicle environment mapping, corresponding system, vehicle and computer program product
US20200216076A1 (en) Method for determining the location of an ego-vehicle
Polychronopoulos et al. Sensor fusion for predicting vehicles' path for collision avoidance systems
CN110542885B (zh) 一种复杂交通环境下的毫米波雷达目标跟踪方法
CN109975798B (zh) 一种基于毫米波雷达与摄像头的目标检测方法
CN112198503A (zh) 一种目标航迹预测优化方法、装置及雷达系统
Diehl et al. Radar-based dynamic occupancy grid mapping and object detection
CN115061139A (zh) 一种面向智能驾驶车辆的多传感器融合方法及系统
CN111007880B (zh) 一种基于汽车雷达的扩展目标跟踪方法
CN112313536B (zh) 物体状态获取方法、可移动平台及存储介质
CN113191427B (zh) 一种多目标车辆跟踪方法及相关装置
Xu et al. Dynamic vehicle pose estimation and tracking based on motion feedback for LiDARs
Lindenmaier et al. GM-PHD filter based sensor data fusion for automotive frontal perception system
CN110889862A (zh) 一种网络传输攻击环境中多目标跟踪的组合测量方法
CN113511194A (zh) 一种纵向避撞预警方法及相关装置
Ebert et al. Deep radar sensor models for accurate and robust object tracking
Song et al. Research on target tracking algorithm using millimeter-wave radar on curved road
CN113077495B (zh) 在线多目标跟踪方法、系统、计算机设备及可读存储介质
CN111612818A (zh) 新型双目视觉多目标跟踪方法及系统
Amditis et al. Fusion of infrared vision and radar for estimating the lateral dynamics of obstacles
Stellet et al. Post processing of laser scanner measurements for testing advanced driver assistance systems
CN115471526A (zh) 基于多源异构信息融合的自动驾驶目标检测与跟踪方法
Domhof et al. Multi-sensor object tracking performance limits by the cramer-rao lower bound
Jia et al. Measuring the motion of vulnerable road users relative to moving HGVs
Richter et al. Advanced occupancy grid techniques for lidar based object detection and tracking

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