一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

一种用于多雷达的车辆跟踪方法、设备及介质

2022-05-21 03:51:36 来源:中国专利 TAG:


1.本技术涉及车辆跟踪技术领域,尤其涉及一种用于多雷达的车辆跟踪方法、设备及介质。


背景技术:

2.智能交通系统是缓解交通问题和保证交通安全的重要技术手段,而交通信息采集是智能交通系统发挥作用的基础和保障。随着交通检测技术的不断进步,各种进行交通信息采集的方式日益增多。目前,道路交通检测主要是在道路设置线圈或摄像头,采集道路交通信息。但是,道路安装线圈,将会对道路造成损坏,而摄像头也存在对于车辆行驶速度的检测不够精确、视线易被遮挡等问题。
3.毫米波雷达由于其设置方式简便、波长短、频带宽、穿透力强等特点,可用于道路交通检测,对车辆的行驶轨迹进行跟踪。发明人发现,毫米波雷达对车辆进行轨迹跟踪时,存在多个毫米波雷达无法对同一车辆的轨迹进行精确拼接的问题,从而导致多个毫米波雷达检测同一车辆目标时,车辆轨迹数据不连续。
4.基于此,亟需一种能够使多个毫米波雷达对同一车辆目标的行驶轨迹进行准确跟踪的技术方案。


技术实现要素:

5.本技术实施例提供了一种用于多雷达的车辆跟踪方法、设备及介质,用于使多个毫米波雷达对车辆目标进行准确跟踪,得到车辆目标的完整道路轨迹。
6.一方面,本技术实施例提供了一种用于多雷达的车辆跟踪方法,该方法包括:获取多个毫米波雷达采集的车辆轨迹信息。其中,车辆轨迹信息至少包括:车辆标识、车辆速度、车辆位置。根据各毫米波雷达的采集位置及采集区域,确定各毫米波雷达之间的轨迹拼接属性。其中,轨迹拼接属性用于匹配轨迹拼接的预设条件。预设条件用于判断至少两个车辆轨迹的匹配程度。基于各车辆轨迹信息及预设的轨迹预测模型,确定相应的待跟踪车辆的轨迹预测信息。根据轨迹拼接属性匹配的预设条件以及轨迹预测信息、车辆轨迹信息,将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹。其中,至少两个待拼接轨迹来自不同的毫米波雷达。
7.在本技术的一种实现方式中,确定各毫米波雷达的采集位置,以得到各毫米波雷达的间隔距离。根据采集区域以及间隔距离,确定各采集区域的边界属性。其中,边界属性至少包括:相离、相切、相交。将边界属性,作为轨迹拼接属性。
8.在本技术的一种实现方式中,根据电子地图,确定采集位置的道路信息。道路信息包括:道路车道、道路走向。根据毫米波雷达的可覆盖范围以及道路信息,确定可覆盖范围内的道路路段,为采集区域。
9.在本技术的一种实现方式中,以采集位置为原点,生成毫米波雷达的雷达坐标系。根据雷达坐标系,确定车辆位置的车辆轨迹坐标。以及确定采集区域的各角坐标。其中,角
坐标为采集区域的至少两条不平行的边的相交点的坐标。根据车辆轨迹坐标、相邻的各角坐标以及预设匹配公式,依次确定车辆轨迹坐标的各第一匹配结果。将各第一匹配结果中匹配成功的次数相加,得到第二匹配结果。根据第二匹配结果,确定车辆轨迹坐标是否位于采集区域,以将位于采集区域的车辆轨迹坐标,输入轨迹预测模型。
10.在本技术的一种实现方式中,获取若干车辆轨迹样本。其中,车辆轨迹样本包括:车辆横向距离、车辆径向距离、车辆径向速度。将车辆轨迹样本分别输入轨迹预测模型的多个预测子模型,以对各预测子模型进行训练,直至轨迹预测模型的判定系数大于预设阈值。其中,轨迹预测模型的多个预测子模型至少包括:横向距离预测模型、径向距离预测模型、径向速度预测模型。预测子模型为长短时记忆神经网络模型。
11.在本技术的一种实现方式中,在轨迹拼接属性为相离的情况下,确定各毫米波雷达中的上游雷达相应的轨迹预测信息,为第一轨迹预测信息以及下游雷达相应的车辆轨迹信息,为第一车辆轨迹信息。基于第一轨迹预测信息中的径向距离、上游雷达与下游雷达之间的间隔距离及相应的采集区域、第一轨迹预测信息中的横向距离、第一车辆轨迹信息中的径向距离及横向距离、第一轨迹预测信息中的径向速度与第一车辆轨迹信息中的径向速度,确定第一轨迹预测信息与第一车辆轨迹信息是否为待拼接轨迹。在确定第一轨迹预测信息与第一车辆轨迹信息为待拼接轨迹,将第一轨迹预测信息相应的待拼接轨迹与第一车辆轨迹信息相应的待拼接轨迹进行拼接,以得到跟踪目标轨迹。
12.在轨迹拼接属性为相切的情况下,确定上游雷达相应的轨迹预测信息,为第二轨迹预测信息以及下游雷达相应的车辆轨迹信息,为第二车辆轨迹信息。基于第二轨迹预测信息中的径向距离及横向距离、第二车辆轨迹信息中的径向距离及横向距离、第二轨迹预测信息中的径向速度与第二车辆轨迹信息中的径向速度,确定第二轨迹预测信息与第二车辆轨迹信息是否为待拼接轨迹。在确定第二轨迹预测信息与第二车辆轨迹信息为待拼接轨迹,将第二轨迹预测信息相应的待拼接轨迹与第二车辆轨迹信息相应的待拼接轨迹进行拼接,以得到跟踪目标轨迹。
13.在轨迹拼接属性为相交的情况下,确定上游雷达相应的车辆轨迹信息为第三车辆轨迹信息以及下游雷达相应的车辆轨迹信息,为第四车辆轨迹信息。基于第三车辆轨迹信息中的径向距离及横向距离、上游雷达与下游雷达之间的间隔距离及相应的采集区域、第四车辆轨迹信息中的径向距离及横向距离、第三车辆轨迹信息中的径向速度与第四车辆轨迹信息中的径向速度,确定第三车辆轨迹信息与第四车辆轨迹信息是否为待拼接轨迹。确定第三车辆轨迹信息与第四车辆轨迹信息为待拼接轨迹的情况下,将第三车辆轨迹信息相应的轨迹预测信息,作为第三轨迹预测信息,以及将第四车辆轨迹信息相应的轨迹预测信息,作为第四轨迹预测信息。根据预设的权重数据库,分别将第三轨迹预测信息的横向距离、径向距离、径向速度与第四轨迹预测信息的横向距离、径向距离、径向速度进行加权拼接,以得到跟踪目标轨迹。
14.在本技术的一种实现方式中,确定各待拼接轨迹相应的毫米波雷达的采集位置。通过预设坐标转换公式,确定各毫米波雷达相应的雷达坐标系,对应的世界坐标系。根据世界坐标系,分别确定各待拼接轨迹中的至少一个拼接轨迹点坐标。根据各拼接轨迹点坐标,拼接各待拼接轨迹,以得到跟踪目标轨迹。
15.在本技术的一种实现方式中,确定各车辆轨迹信息的车辆标识。根据各毫米波雷
达的采集位置,生成上游雷达相应的车辆标识的目标跟踪标识,并将目标跟踪标识存储至预设数据库。在确定至少两个待拼接轨迹的情况下,将目标跟踪标识与下游雷达相应的车辆标识进行关联,以将至少两个待拼接轨迹进行拼接,得到跟踪目标轨迹。
16.另一方面,本技术实施例还提供了一种用于多雷达的车辆跟踪设备,该设备包括:至少一个处理器;以及,与至少一个处理器通信连接的存储器。其中,存储器存储有能够被至少一个处理器执行的指令,指令被至少一个处理器执行,以使至少一个处理器能够:获取多个毫米波雷达采集的车辆轨迹信息。其中,车辆轨迹信息至少包括:车辆标识、车辆速度、车辆位置。根据各毫米波雷达的采集位置及采集区域,确定各毫米波雷达之间的轨迹拼接属性。其中,轨迹拼接属性用于匹配轨迹拼接的预设条件。预设条件用于判断至少两个车辆轨迹的匹配程度。基于各车辆轨迹信息及预设的轨迹预测模型,确定相应的待跟踪车辆的轨迹预测信息。根据轨迹拼接属性匹配的预设条件以及轨迹预测信息、车辆轨迹信息,将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹。其中,至少两个待拼接轨迹来自不同的毫米波雷达。
17.再一方面,本技术实施例还提供了一种用于多雷达的车辆跟踪的溯源非易失性计算机存储介质,存储有计算机可执行指令,计算机可执行指令设置为:获取多个毫米波雷达采集的车辆轨迹信息。其中,车辆轨迹信息至少包括:车辆标识、车辆速度、车辆位置。根据各毫米波雷达的采集位置及采集区域,确定各毫米波雷达之间的轨迹拼接属性。其中,轨迹拼接属性用于匹配轨迹拼接的预设条件。预设条件用于判断至少两个车辆轨迹的匹配程度。基于各车辆轨迹信息及预设的轨迹预测模型,确定相应的待跟踪车辆的轨迹预测信息。根据轨迹拼接属性匹配的预设条件以及轨迹预测信息、车辆轨迹信息,将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹。其中,至少两个待拼接轨迹来自不同的毫米波雷达。
18.通过上述方案,利用毫米波雷达采集道路通行车辆的行驶轨迹,并通过轨迹预测模型,将车辆的行驶轨迹进行准确地拼接,从而保证车辆出现在不同的多个雷达采集区域内时,车辆轨迹与上一雷达的车辆轨迹进行轨迹拼接,得到准确、完整的跟踪目标轨迹。
附图说明
19.此处所说明的附图用来提供对本技术的进一步理解,构成本技术的一部分,本技术的示意性实施例及其说明用于解释本技术,并不构成对本技术的不当限定。在附图中:图1为本技术实施例中一种用于多雷达的车辆跟踪方法的一种流程示意图;图2为本技术实施例中一种用于多雷达的车辆跟踪方法中的一种示意图;图3为本技术实施例中一种用于多雷达的车辆跟踪方法中的另一种示意图;图4为本技术实施例中一种用于多雷达的车辆跟踪方法中的再一种示意图;图5为本技术实施例中一种用于多雷达的车辆跟踪设备的结构示意图。
具体实施方式
20.为使本技术的目的、技术方案和优点更加清楚,下面将结合本技术具体实施例及相应的附图对本技术技术方案进行清楚、完整地描述。显然,所描述的实施例仅是本技术一
部分实施例,而不是全部的实施例。基于本技术中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本技术保护的范围。
21.毫米波雷达相比于现有道路安装的线圈、摄像头等传感器,具有安装方便、不损坏道路、采集信息量丰富、目标数据即时输出、数据可溯性强等特点。同时毫米波雷达对多车道排队长度、车流量、实时车速、实时坐标、车型等信息能够实现精确检测,具有非常良好的效果。并且毫米波雷达对雾、烟、灰尘的穿透能力强,有效检测距离远,可同时识别多个目标,抗干扰能力强,检测精度高,因此当前毫米波雷达可在交通检测过程中广泛的应用。
22.但是毫米波雷达的检测覆盖范围是有限的,且毫米波雷达无法识别车辆的身份信息(车型、车牌号等),因此,车辆在多个毫米波雷达的检测覆盖范围之间穿梭时,多个毫米波雷达在检测到该车辆时,可能无法将该车辆作为同一车辆进行跟踪处理,导致车辆跟踪的轨迹缺失,或车辆误识别。进而使得毫米波雷达得到的车辆轨迹数据不连续、不完整,毫米波雷达无法对雷达全覆盖道路的车辆目标轨迹进行准确地长距离连续跟踪。
23.基于此,本技术实施例提供了一种用于多雷达的车辆跟踪方法及设备,用来使多个毫米波雷达对车辆目标进行准确跟踪,得到车辆目标的完整道路轨迹。
24.以下结合附图,详细说明本技术的各个实施例。
25.本技术实施例提供了一种用于多雷达的车辆跟踪方法,如图1所示,该方法可以包括步骤s101-s104:s101,服务器获取多个毫米波雷达采集的车辆轨迹信息。
26.其中,车辆轨迹信息至少包括:车辆标识、车辆速度、车辆位置。
27.需要说明的是,服务器作为用于多雷达的车辆跟踪方法的执行主体,仅为示例性存在,执行主体不仅限于服务器,本技术对此不作具体限定。
28.在本技术实施例中,毫米波雷达的设置方式可以如图2所示,毫米波雷达相对设置,也可以是采取同向设置的方式,本技术对于毫米波雷达的设置方式不作具体限定。
29.毫米波雷达在采集道路的原始数据时,原始数据组成包括:,其中,表示目标车辆的采集时刻,表示毫米波雷达赋予目标车辆的车辆标识,表示目标车辆与毫米波雷达的径向距离(沿道路行驶方向),单位为米;表示目标车辆与毫米波雷达的横向距离(垂直于道路行驶方向),单位为米;表示目标车辆与毫米波雷达的径向速度(沿道路行驶方向),单位为米每秒(m/s);:表示目标车辆与毫米波雷达的横向速度(垂直于道路行驶方向),单位为米每秒(m/s)。表示雷达模块根据检测到的车辆运动状态给分配的一个状态标志位;:表示毫米波雷达散射截面。
30.接着,本技术的服务器确定各毫米波雷达之间的轨迹拼接属性之前,可以:首先,服务器根据电子地图,确定采集位置的道路信息。
31.道路信息包括:道路车道、道路走向。
32.服务器通过电子地图,可以根据设置毫米波雷达的采集位置,所对应的道路车道以及道路走向,如图2所示,上游的毫米波雷达有三条车道,道路走向沿箭头方向。
33.其次,服务器根据毫米波雷达的可覆盖范围以及道路信息,确定可覆盖范围内的道路路段,为采集区域。
34.在本技术实施例中,毫米波雷达的可覆盖范围如图2中的扇形区域,在扇形区域内部的道路,即为毫米波雷达的采集区域。
35.s102,服务器根据各毫米波雷达的采集位置及采集区域,确定各毫米波雷达之间的轨迹拼接属性。
36.其中,轨迹拼接属性用于匹配轨迹拼接的预设条件。预设条件用于判断至少两个车辆轨迹的匹配程度。
37.在本技术实施例中,服务器根据各毫米波雷达的采集位置及采集区域,确定各毫米波雷达之间的轨迹拼接属性,具体包括:首先,服务器确定各毫米波雷达的采集位置,以得到各毫米波雷达的间隔距离。
38.服务器可以通过电子地图,得到各采集位置之间的距离,在本技术实施例中,服务器一般确定相邻设置的毫米波雷达的间隔距离,如图2中的同一道路上相对设置的毫米波雷达的间隔距离。服务器也可以确定各个毫米波雷达之间的间隔距离,例如,在毫米波雷达a相邻的下游毫米波雷达b发生故障,不能正常使用,毫米波雷达a可以确定与毫米波雷达b的相邻下游毫米波雷达c的间隔距离。
39.接着,服务器根据采集区域以及间隔距离,确定各采集区域的边界属性。
40.其中,边界属性至少包括:相离、相切、相交。
41.如图2所示,201为边界属性相切时,202为边界属性相离时,203为边界属性相交时。
42.然后,服务器将边界属性,作为轨迹拼接属性。
43.通过上述方案,可以得到毫米波雷达的采集区域不同拼接属性,从而根据该属性,对车辆轨迹采用不同的拼接方式,进而保证车辆轨迹的拼接完整、拼接可信度。
44.此外,不同的轨迹拼接属性对应有不同的预设条件,预设条件可以用来确定来自不同毫米波雷达的至少两个车辆轨迹的是否匹配。
45.s103,服务器基于各车辆轨迹信息及预设的轨迹预测模型,确定相应的待跟踪车辆的轨迹预测信息。
46.在本技术实施例中,在进行待跟踪车辆的轨迹预测前,需要进行待跟踪车辆的轨迹是否处于毫米波雷达的采集区域内,因此服务器基于各车辆轨迹信息及预设的轨迹预测模型,确定相应的待跟踪车辆的轨迹预测信息之前,还包括:首先,服务器以采集位置为原点,生成毫米波雷达的雷达坐标系。
47.服务器可以以毫米波雷达所在的采集位置为原点,建立该毫米波雷达的雷达坐标系,雷达坐标系如图3所示,,为毫米波雷达的采集位置,、为两毫米波雷达检测目标方位角,、为两毫米波雷达检测目标俯仰角,、为两毫米波雷达检测目标距离。、表示两个毫米波雷达的横向距离坐标轴,、为两个毫米波雷达径向距离坐标轴,、为竖坐标轴。
48.其次,服务器根据雷达坐标系,确定车辆位置的车辆轨迹坐标。
49.例如车辆位置为点,服务器可以确定该车辆位置在第一个雷达坐标系中的车辆轨迹坐标,具体地:
其中,为车辆位置点的横坐标,为车辆位置点的纵坐标,为车辆位置点的竖坐标。
50.再次,服务器确定采集区域的各角坐标。
51.其中,角坐标为采集区域的至少两条不平行的边的相交点的坐标。
52.服务器还可以确定采集区域的各角坐标,采集区域如图4所示,采集区域为一多边形区域,该采集区域根据道路的实际情况,存在n个点,n为自然数。图4中为有4个点的采集区域,即d1,d2,d3,d4四个点,角坐标即为该四个点的坐标。
53.接着,服务器根据车辆轨迹坐标、相邻的各角坐标以及预设匹配公式,依次确定车辆轨迹坐标的各第一匹配结果。
54.在本技术实施例中,预测匹配公式如下:其中,为车辆轨迹坐标的横坐标及纵坐标。、为采集区域的相邻点的角坐标,例如d1与d2。
55.通过上述预设匹配公式,依次确定车辆轨迹坐标是否与各相邻点角坐标,满足预设匹配公式。具体地,服务器可以将车辆轨迹坐标依次与d1、d2,或d1、d4,或d2、d3,或d3、d4,确定是否满足预设匹配公式,从而分别得到第一匹配结果。
56.随后,服务器将各第一匹配结果中匹配成功的次数相加,得到第二匹配结果。
57.在本技术实施例中,服务器可以将各相邻点的角坐标满足上述预设匹配公式的次数进行相加,进而得到预设匹配公式匹配成功的个数。例如某坐标x,与采集区域的若干相邻点的角坐标,匹配成功的个数为n。第二匹配结果可以是匹配成功的个数是奇数,还是偶数。
58.随后,服务器根据第二匹配结果,确定车辆轨迹坐标是否位于采集区域,以将位于采集区域的车辆轨迹坐标,输入轨迹预测模型。
59.在本技术实施例中,第二匹配结果若为奇数,那么车辆轨迹坐标位于采集区域内;若第二匹配结果为偶数,那么车辆轨迹坐标不位于采集区域内。在本技术实施例中,毫米波雷达采集的数据中,包含有大量的噪声信息,通过上述方案,可以去除毫米波雷达采集的车辆轨迹信息的噪声信息,(如雷达旁瓣干扰、虚警噪声、道路护栏等金属物体干扰目标)。
60.此外,服务器为了更好地去除噪声信息,还可以根据车辆的行驶速度,设定检测速度的速度区间,将行驶速度不在速度区间内的车辆剔除,获取车辆轨迹信息。
61.在本技术实施例中,基于各车辆轨迹信息及预设的轨迹预测模型,确定相应的待跟踪车辆的轨迹预测信息之前,还包括:首先,服务器获取若干车辆轨迹样本。
62.其中,车辆轨迹样本包括:车辆横向距离、车辆径向距离、车辆径向速度。
63.车辆轨迹样本可以预先存储于数据库中,用于训练轨迹预测模型,也可以是服务器通过互联网获取的样本。
64.然后,服务器将车辆轨迹样本分别输入轨迹预测模型的多个预测子模型,以对各预测子模型进行训练,直至轨迹预测模型的判定系数大于预设阈值。
65.其中,轨迹预测模型的多个预测子模型至少包括:横向距离预测模型、径向距离预测模型、径向速度预测模型。预测子模型为长短时记忆神经网络模型。
66.车辆横向距离为垂直与道路行驶方向的车辆与雷达的距离,车辆径向距离为车辆沿道路行驶方向与雷达的距离,横向距离与径向距离为在雷达坐标系中国的车辆坐标如(a,b),a为横向距离,b为纵向距离。本技术将车辆横向距离、车辆径向距离、车辆径向速度作为模型输入,可以将车辆横向距离、车辆径向距离、车辆径向速度输入横向距离预测模型,对横向距离预测模型进行训练;再将车辆横向距离、车辆径向距离、车辆径向速度输入径向距离预测模型,对径向距离预测模型进行训练;再将车辆横向距离、车辆径向距离、车辆径向速度输入径向速度预测模型,对径向速度预测模型进行训练。
67.直至三个预测子模型的判定系数大于预设阈值,训练完成上述轨迹预测模型。
68.在本技术实施例中,轨迹预测模型可以使用均方根误差函数作为损失函数,并选用随机梯度下降算法作为优化算法,从而得到准确且计算高效的轨迹预测模型。轨迹预测模型的判定系数的公式如下,模型的判定系数的公式如下,其中,为预测模型的评价指标,为调整评价指标,二者的值越接近1,表征模型的预测效果越好,为车辆轨迹实际值,为预测值,为实际值的平均值,表示数据集中数据点数量,表示自变量的个数。
69.通过长短时记忆神经网络模型以及随机梯度下降算法,可以更为高效地获得车辆在行驶过程中的预测轨迹,及时获取车辆在下一时刻或下一时间段的轨迹,能够在车辆跟踪时保证车辆轨迹完整性以及保证轨迹的真实可信度。
70.s104,服务器根据轨迹拼接属性匹配的预设条件以及轨迹预测信息、车辆轨迹信息,将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹。
71.其中,至少两个待拼接轨迹来自不同的毫米波雷达。
72.在本技术实施例中,服务器根据轨迹拼接属性匹配的预设条件以及轨迹预测信息、车辆轨迹信息,将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹,具体包括:服务器在轨迹拼接属性为相离的情况下,确定各毫米波雷达中的上游雷达相应的轨迹预测信息,为第一轨迹预测信息以及下游雷达相应的车辆轨迹信息,为第一车辆轨迹信息。
73.接着,服务器基于第一轨迹预测信息中的径向距离、上游雷达与下游雷达之间的间隔距离及相应的采集区域、第一轨迹预测信息中的横向距离、第一车辆轨迹信息中的径向距离及横向距离、第一轨迹预测信息中的径向速度与第一车辆轨迹信息中的径向速度,
确定第一轨迹预测信息与第一车辆轨迹信息是否为待拼接轨迹。
74.具体地,服务器根据以下公式确定待拼接轨迹:其中,为第一轨迹预测信息中第时刻的径向距离,为上游雷达与下游雷达之间的间隔距离,为采集区域的最远距离,为第一轨迹预测信息中第时刻的横向距离,为第一车辆轨迹信息中第时刻的径向距离,为第一车辆轨迹信息中第时刻的横向距离,为预设的一极小值,单位为米,为第一轨迹预测信息中第时刻的径向速度,为第一车辆轨迹信息中第时刻的径向速度,为一预设的极小值,单位为米/秒,为第时刻第一车辆轨迹信息至第一轨迹预测信息的车辆状态变化量。其中,,可以是下游雷达采集得到的。,可以是有上游雷达采集的车辆轨迹信息预测得到的第时刻的距离。
75.若第时刻第一车辆轨迹信息与第一轨迹预测信息满足上述公式,则第一车辆轨迹信息与第一轨迹预测信息对应的车辆为待拼接轨迹。
76.服务器在确定第一轨迹预测信息与第一车辆轨迹信息为待拼接轨迹的情况下,将第一轨迹预测信息相应的待拼接轨迹与第一车辆轨迹信息相应的待拼接轨迹进行拼接,以得到跟踪目标轨迹。
77.服务器在轨迹拼接属性为相切的情况下,确定上游雷达相应的轨迹预测信息,为第二轨迹预测信息以及下游雷达相应的车辆轨迹信息,为第二车辆轨迹信息。
78.基于第二轨迹预测信息中的径向距离及横向距离、第二车辆轨迹信息中的径向距离及横向距离、第二轨迹预测信息中的径向速度与第二车辆轨迹信息中的径向速度,确定第二轨迹预测信息与第二车辆轨迹信息是否为待拼接轨迹。
79.具体地:若满足上述关系,确定第二轨迹预测信息与第二车辆轨迹信息为待拼接轨迹。
80.服务器在确定第二轨迹预测信息与第二车辆轨迹信息为待拼接轨迹的情况下,将第二轨迹预测信息相应的待拼接轨迹与第二车辆轨迹信息相应的待拼接轨迹进行拼接,以得到跟踪目标轨迹。
81.服务器在轨迹拼接属性为相交的情况下,确定上游雷达相应的车辆轨迹信息为第三车辆轨迹信息以及下游雷达相应的车辆轨迹信息,为第四车辆轨迹信息。
82.服务器基于第三车辆轨迹信息中的径向距离及横向距离、上游雷达与下游雷达之间的间隔距离及相应的采集区域、第四车辆轨迹信息中的径向距离及横向距离、第三车辆轨迹信息中的径向速度与第四车辆轨迹信息中的径向速度,确定第三车辆轨迹信息与第四
车辆轨迹信息是否为待拼接轨迹。
83.具体如下:其中,,分别为第时刻,上游雷达采集的车辆轨迹信息的径向距离及横向距离,、分别为第时刻,下游雷达采集的车辆轨迹信息的径向距离及横向距离,与分别为第时刻,上游雷达与下游雷达采集的车辆轨迹信息的径向速度。
84.服务器确定第三车辆轨迹信息与第四车辆轨迹信息为待拼接轨迹的情况下,将第三车辆轨迹信息相应的轨迹预测信息,作为第三轨迹预测信息,以及将第四车辆轨迹信息相应的轨迹预测信息,作为第四轨迹预测信息。
85.服务器根据预设的权重数据库,分别将第三轨迹预测信息的横向距离、径向距离、径向速度与第四轨迹预测信息的横向距离、径向距离、径向速度进行加权拼接,以得到跟踪目标轨迹。
86.具体地,服务器通过上述公式,在轨迹拼接属性为相交(图2中203)时,确定第三车辆轨迹信息与第四车辆轨迹信息为待拼接轨迹,接着,服务器将通过轨迹预测模型,分别确定第三车辆轨迹信息对应的第三轨迹预测信息,第四车辆轨迹信息对应的第四轨迹预测信息。权重数据库可以是根据实际轨迹处理过程中,进行求平均值得到。
87.例如拼接第三轨迹预测信息的车辆轨迹点t1,与第四轨迹预测信息的车辆轨迹点t2时,t1的横向距离权重为0.3,t1的径向距离权重为0.7;t2的横向距离权重为0.3,t2的径向距离权重为0.7;t1的径向速度权重为0.5,t2的径向速度权重为0.5。
88.再例如,拼接第三轨迹预测信息的车辆轨迹点t1,与第四轨迹预测信息的车辆轨迹点t2时,t1的横向距离权重为0.5,t1的径向距离权重为0.5;t2的横向距离权重为0.5,t2的径向距离权重为0.5;t1的径向速度权重为0.4,t2的径向速度权重为0.6。
89.在实际使用过程中,权重可以进行优化,例如第一次t1的横向距离权重为0.3,第二次tt1的横向距离权重为0.5,那么服务器可以将平均值0.4作为新的t1的横向距离权重。在本技术实施例中,权重数据库中权重的具体获取方式以及数值,本技术对此不作具体限定。权重与轨迹拼接的效果相关,在实际使用过程中,可以进行自行设定。
90.通过上述方案,可以将相离、相切、相交的采集区域,进行完整的车辆轨迹拼接,实现利用雷达,识别同一车辆行驶轨迹,对车辆目标进行准确跟踪。
91.在本技术实施例中,服务器将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹,具体包括:首先,服务器确定各待拼接轨迹相应的毫米波雷达的采集位置。
92.接着,服务器通过预设坐标转换公式,确定各毫米波雷达相应的雷达坐标系,对应的世界坐标系。
93.预设坐标转换公式:
其中,为世界坐标系下车辆位置点的横坐标,为世界坐标系下车辆位置点的纵坐标,为世界坐标系下车辆位置点的竖坐标。
94.然后,服务器根据世界坐标系,分别确定各待拼接轨迹中的至少一个拼接轨迹点坐标。
95.在本技术实施例中,待拼接轨迹包含至少一个轨迹点,进行轨迹拼接,得到跟踪目标轨迹,需要得到待拼接轨迹中能够重合拼接的轨迹点,将轨迹点通过上述方案拼接后,即可得到跟踪目标轨迹。
96.在本技术的另一个实施例中,服务器可以在毫米波雷达设置后,将各毫米波雷达通过上述预设坐标转换公式,将各毫米波雷达的雷达坐标系转换至世界坐标系,在毫米波雷达获取车辆位置时,直接获取车辆在世界坐标系下的车辆位置。
97.随后,服务器根据各拼接轨迹点坐标,拼接各待拼接轨迹,以得到跟踪目标轨迹。
98.在本技术实施例中,服务器将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹,具体包括:首先,服务器确定各车辆轨迹信息的车辆标识。
99.在本技术实施例中,车辆出现在各毫米波雷达的采集区域内时,毫米波雷达将提供给车辆一车辆标识,例如编号1,编号2
……
但是各雷达可提供给车辆的编号无法得到统一,例如车辆i在上游雷达的车辆编号为1,而当车辆i逃离上游雷达的车辆编号1,将更换为其他新出现在上游雷达的采集区域内的车辆,而下游雷达的车辆编号1可能被其他处于下游雷达的采集区域内的车辆使用,也可能未被使用,编号1未提供给任意车辆,下游雷达提供给车辆i的编号为编号3。
100.因此,服务器通过雷达提供的车辆标识,不能真正地代表唯一车辆,本技术提供以下方案进行解决上述问题。
101.服务器根据各毫米波雷达的采集位置,生成上游雷达相应的车辆标识的目标跟踪标识,并将目标跟踪标识存储至预设数据库。
102.目标跟踪标识可以唯一标识一车辆,例如在道路的第一个毫米波雷达检测到车辆i时,雷达提供给该车辆的标识为编号2,服务器同时将提供对应该时刻的编号2的车辆一目标跟踪标识如car001001,目标跟踪标识也可以采用二维码或一维码的方式,也可以采用任意长度的字符及数字编码。
103.然后,服务器在确定至少两个待拼接轨迹的情况下,将目标跟踪标识与下游雷达相应的车辆标识进行关联,以将至少两个待拼接轨迹进行拼接,得到跟踪目标轨迹。
104.例如,在根据上游雷达与下游雷达的车辆轨迹信息得到车辆i出现在两个雷达之间,并产生待拼接轨迹的情况下,服务器将上游雷达的car001001的目标跟踪标识提供给下游雷达的待拼接轨迹的车辆,如下游雷达对应的车辆i的编号为10,服务器将该编号10关联一跟踪目标标识car001001。并将上游雷达的车辆i的轨迹与下游雷达的车辆i的轨迹进行
拼接,得到car001001的跟踪目标轨迹。
105.再者,在车辆逃离雷达的监测时,编号将会重置,以提供给其他车辆,因此,本技术可以对车辆的连续轨迹点进行监测,为避免编号在车辆未逃离雷达采集区域时便重置编号。本技术可以对车辆的连续轨迹点进行监测,在连续轨迹点大于预设值如5个,那么将确定车辆为同一车辆,编号将不会重置,直至车辆逃离雷达的采集区域。
106.通过上述方案,本技术可以将利用多个毫米波雷达采集的车辆轨迹,进行车辆轨迹的准确拼接,并能够在车辆逃离了毫米波雷达的监测区域或同时出现在多个毫米波雷达的监测区域时,仍能够准确地跟踪车辆的轨迹,从而在道路中得到车辆目标的完整道路轨迹。
107.图5为本技术实施例提供的一种用于多雷达的车辆跟踪设备500的结构示意图,该设备500包括:至少一个处理器501;以及,与至少一个处理器通信连接的存储器502。其中,存储器502存储有能够被至少一个处理器501执行的指令,指令被至少一个处理器501执行,以使至少一个处理器501能够:获取多个毫米波雷达采集的车辆轨迹信息。其中,车辆轨迹信息至少包括:车辆标识、车辆速度、车辆位置。根据各毫米波雷达的采集位置及采集区域,确定各毫米波雷达之间的轨迹拼接属性。其中,轨迹拼接属性用于匹配轨迹拼接的预设条件。预设条件用于判断至少两个车辆轨迹的匹配程度。基于各车辆轨迹信息及预设的轨迹预测模型,确定相应的待跟踪车辆的轨迹预测信息。根据轨迹拼接属性匹配的预设条件以及轨迹预测信息、车辆轨迹信息,将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹。其中,至少两个待拼接轨迹来自不同的毫米波雷达。
108.本技术实施例还提供了一种用于多雷达的车辆跟踪的溯源非易失性计算机存储介质,存储有计算机可执行指令,计算机可执行指令设置为:获取多个毫米波雷达采集的车辆轨迹信息。其中,车辆轨迹信息至少包括:车辆标识、车辆速度、车辆位置。根据各毫米波雷达的采集位置及采集区域,确定各毫米波雷达之间的轨迹拼接属性。其中,轨迹拼接属性用于匹配轨迹拼接的预设条件。预设条件用于判断至少两个车辆轨迹的匹配程度。基于各车辆轨迹信息及预设的轨迹预测模型,确定相应的待跟踪车辆的轨迹预测信息。根据轨迹拼接属性匹配的预设条件以及轨迹预测信息、车辆轨迹信息,将至少两个待拼接轨迹进行拼接,以得到跟踪目标轨迹。其中,至少两个待拼接轨迹来自不同的毫米波雷达。
109.本技术中的各个实施例均采用递进的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于设备、介质实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。
110.本技术实施例提供的设备、介质与方法是一一对应的,因此,设备、介质也具有与其对应的方法类似的有益技术效果,由于上面已经对方法的有益技术效果进行了详细说明,因此,这里不再赘述设备、介质的有益技术效果。
111.还需要说明的是,术语“包括”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、商品或者设备不仅包括那些要素,而且还包括没有明
确列出的其他要素,或者是还包括为这种过程、方法、商品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个
……”
限定的要素,并不排除在包括所述要素的过程、方法、商品或者设备中还存在另外的相同要素。
112.以上所述仅为本技术的实施例而已,并不用于限制本技术。对于本领域技术人员来说,本技术可以有各种更改和变化。凡在本技术的精神和原理之内所作的任何修改、等同替换、改进等,均应包含在本技术的权利要求范围之内。
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献