具体实施方式
为使本公开实施例的目的、技术方案和优点更加清楚,下面将结合本公开实施例中的附图,对本公开实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本公开一部分实施例,而不是全部的实施例。基于本公开中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本公开保护的范围。
首先对本公开所涉及的应用场景进行介绍:
本公开实施例提供的速度确定方法,应用于雷达,以提高静态物体速度测量的准确性。
可选的,所述雷达为毫米波雷达。所述雷达至少包括天线,所述天线用于接收信号。
其中,该方法可以由毫米波雷达执行,该毫米波雷达可以设置在车辆上;或者可以由包括该毫米波雷达的车载控制设备执行。上述车辆可以是自动驾驶车辆或普通车辆。该毫米波雷达可以是后装的毫米波雷达,也可以是前装的毫米波雷达,或者,该毫米波雷达还可以集成在整车中。
本公开实施例提供的方法可由毫米波雷达如该毫米波雷达的处理器执行相应的软件代码实现,也可由该毫米波雷达在执行相应的软件代码的同时,通过和控制设备或服务器进行数据交互来实现,如控制设备执行部分操作,来控制毫米波雷达执行该速度确定方法。
由于设备硬件条件限制,PRT参数设置受限,导致单PRT快扫调频连续波测速范围难以满足实际需求,在自车速速度较大或目标车速较大的情况下,容易出现测速模糊翻折的现象。所以一般多采用双PRT快扫调频连续波方案拓展测速范围。针对双PRT快扫调频连续波方案,若在前帧中找不到对应目标,则无法进行速度测量范围的拓展。由于静态散射点较多且散射较为复杂,因此经常在前一帧无法找到与之对应的静态目标点,从而容易造成静态目标的速度估计错误。一旦速度估计偏差较大,会对目标位置及状态形成误判,严重影响驾驶判断。
本公开实施例的速度确定方法,针对上述问题进行改进,能够给提高静态目标速度估计的准确性。
下面以具体的实施例对本公开的技术方案进行详细说明。下面这几个具体的实施例可以相互结合,对于相同或相似的概念或过程可能在某些实施例不再赘述。
图1是本公开提供的速度确定方法一实施例的流程示意图。如图1所示,本实施例提供的方法,包括:
步骤101、根据雷达的相邻两帧接收信号,确定相互匹配的至少一个第一目标;至少一个第一目标中包括静态目标。
具体的,对于雷达的相邻两帧接收信号,在前一帧的所有目标中遍历,搜寻当前帧中的目标在前一帧中匹配的目标,最终确定相互匹配的至少一个第一目标。其中,至少一个第一目标中可以包括动态目标和部分静态目标。其中,静态目标为相对于车辆处于静止状态的目标,动态目标为相对于车辆处于运动状态的目标。
进一步,将根据雷达的接收信号检测到的所有目标中除去至少一个第一目标得到剩余的至少一个第二目标,这些第二目标在前一帧中搜寻不到匹配的目标,导致速度无法拓展,速度估计不准确,因此,本公开实施例中以下步骤对这些第二目标的速度进行估计。
图2为未经本公开实施例处理的距离-速度图,由于未进行速度拓展,虚线框中静态目标的速度估计有误,图3为经过步骤101处理之后有部分静态目标速度估计准确,如图3中左边虚线框中的静态目标,仍然有部分静态目标(即第二目标)速度估计错误。
步骤102、根据至少一个第二目标对应的多普勒频率,以及,至少一个第一目标中静态目标对应的多普勒频率,在至少一个第二目标中选择第三目标;至少一个第二目标为根据雷达的接收信号检测到的目标中除去至少一个第一目标的目标。
具体的,可以根据第二目标对应的多普勒频率,以及第一目标中静态目标对应的多普勒频率,筛选满足一定预设条件的第三目标。
在一个可选的实施例中,预设条件例如为|dop-dops|<dopε,其中,dop为第三目标的多普勒频率,dops为静态目标对应的多普勒频率,dopε为第二预设阈值。
步骤103、根据第三目标的测量速度,确定第三目标相对于车辆的实际速度;第三目标的测量速度为通过雷达测量的第三目标相对于车辆的速度。
具体的,根据筛选出的第三目标相对于车辆的测量速度,确定这些第三目标相对于车辆的实际速度。
在一个可选的实施例中,可以根据测量速度、速度折叠次数,以及模糊周期,得到相对于车辆的实际速度。
其中,模糊周期VT=λ/(2×PRT),λ为雷达的探测信号的波长,PRT为所述雷达的探测信号的频率变化的周期。雷达的不模糊测速范围为-λ/(4×PRT)到λ/(4×PRT)。
图4为经过步骤102、步骤103处理之后得到的示意图,左边虚线框中静态目标速度估计准确。
本实施例的方法,根据所述雷达的相邻两帧接收信号,确定相互匹配的至少一个第一目标;所述至少一个第一目标中包括静态目标;根据至少一个第二目标对应的多普勒频率,以及,所述至少一个第一目标中静态目标对应的多普勒频率,在所述至少一个第二目标中选择第三目标;所述至少一个第二目标为根据所述雷达的接收信号检测到的目标中除去所述至少一个第一目标的目标;根据所述第三目标的测量速度,确定所述第三目标相对于所述车辆的实际速度;所述第三目标的测量速度为通过所述雷达测量的所述第三目标相对于所述车辆的速度,能够较为准确的获得大量速度未拓展的静态目标相对于车辆的实际速度,保证了静态目标速度估计的准确性,从而避免了静态物体速度估计有误造成的误判。
在上述实施例的基础上,进一步的,为了避免动态目标速度模糊后与静态目标速度一致,导致其被当做静态物体,本实施例中可以优先保证动态目标速度估计准确。因此,首先通过步骤101获取到相互匹配的至少一个第一目标,这些第一目标中包括动态目标和部分静态目标。
进一步,根据相邻两帧接收信号分别对应的各个第一目标的测量速度,确定各个第一目标相对于车辆的实际速度。
其中,第一目标的测量速度为通过雷达测量的第一目标相对于车辆的速度。
在一个可选的实施例中,确定第一目标相对于车辆的实际速度可以通过如下方式实现:
根据所述相邻两帧接收信号分别对应的脉冲重复周期以及所述雷达的探测信号的波长,确定所述相邻两帧接收信号分别对应的模糊周期;所述脉冲重复周期为所述雷达的探测信号的频率变化的周期;
根据所述相邻两帧接收信号分别对应的各个所述第一目标的测量速度,以及所述相邻两帧接收信号分别对应的模糊周期,确定各个所述第一目标相对于所述车辆的实际速度。
在一个可选的实施例中,假设相邻两帧接收信号中前一帧对应的模糊周期VT1=λ/(2×PRT1),PRT1为前一帧对应的脉冲重复周期,即前一帧对应的探测信号的频率变化的周期;当前帧对应的模糊周期VT2=λ/(2×PRT2),PRT2为当前帧对应的脉冲重复周期,即当前帧对应的探测信号的频率变化的周期。
在一个可选的实施例中,根据所述相邻两帧接收信号分别对应的各个所述第一目标的测量速度、所述相邻两帧接收信号分别对应的模糊周期以及第一预设阈值,确定第一参数值和第二参数值;
根据根据所述相邻两帧接收信号分别对应的各个所述第一目标的测量速度、所述相邻两帧接收信号分别对应的模糊周期以及所述第一参数值和第二参数值,确定各个所述第一目标相对于所述车辆的实际速度。
在一个可选的实施例中,遍历所有可能的m,n(取值为整数,由于需求速度测量范围有限,因此m和n只需遍历有限的几个值),使得满足|(mVT1+vpre)-(nVT2+vcur)|<ε,ε为第一预设阈值。其中,m为第一参数值,n为第二参数值;其中,vpre为前一帧中第一目标的测量速度,vcur为当前帧中第一目标的测量速度。
第一目标相对于车辆的实际速度vreal=((mVT1+vpre)+(nVT2+vcur))/2。
在其他实施例中,第一目标相对于车辆的实际速度例如还可以依据当前帧对应的模糊周期、测量速度和速度折叠次数确定,或者还可以基于前一帧对应的模糊周期、测量速度和速度折叠次数确定,或者基于相邻两帧各自对应的模糊周期、测量速度和速度折叠次数确定,或者还可以是基于其他方式,本公开实施例对此并不限定。
在上述实施例的基础上,进一步,步骤103可以通过如下可选的实施方式实现:
根据所述第三目标的测量速度、所述雷达的模糊周期以及速度折叠次数,确定所述第三目标相对于所述车辆的实际速度;所述雷达的模糊周期为根据所述雷达的脉冲重复周期以及所述雷达的探测信号的波长确定的。
具体的,第三目标相对于车辆的实际速度v′sr=αVT+v′s,其中α为速度折叠次数,v′s为第三目标相对于车辆的测量速度(可以是当前帧或前一帧的测量速度),VT为模糊周期,若采用前一帧脉冲重复周期,则VT=VT1,否则VT=VT2。
在一个可选的实施例中,第三目标相对于车辆的实际速度例如还可以基于相邻两帧各自对应的模糊周期、测量速度和速度折叠次数确定,或者还可以是基于其他方式,本公开实施例对此并不限定。
经过上述速度确定过程,可较为准确估计出静态物体相对于车辆的实际速度,从而准确区分静态物体与动态物体。
进一步的,步骤103之前还可以进行如下操作:
根据所述车辆的速度、速度单元的间隔以及速度单元的数目,确定所述静态目标对应的多普勒频率以及所述雷达的速度折叠次数;所述速度单元为根据所述雷达的模糊周期划分的速度单元。
在一个可选的实施例中,假设车辆速度为vcar,则静态目标相对于车辆的相对速度为-vcar。静态目标对应的多普勒频率dops=round(-vcar/vstep)%Na+Na,其中,round为四舍五入取整操作,vstep为速度单元的间隔,%为取余操作,Na为速度单元的数目,满足vstep=λ/(2×PRT×Na),λ为雷达探测信号的波长。速度折叠次数α=round(round(vcar/vstep)/Na)。
在上述实施例的基础上,进一步的,步骤102之前还可以进行如下操作:
根据至少一个第二目标的测量速度,分别确定各个所述第二目标对应的多普勒频率;所述第二目标的测量速度为通过所述雷达测量的所述第二目标相对于所述车辆的速度。
在一个可选的实施例中,可以根据各个所述第二目标的测量速度、速度单元的间隔以及速度单元的数目,确定各个所述第二目标对应的多普勒频率;所述速度单元为根据所述雷达的模糊周期划分的速度单元;所述雷达的模糊周期为根据所述雷达的脉冲重复周期以及所述雷达的探测信号的波长确定的。
第二目标对应的多普勒频率可以参照静态目标的多普勒频率确定方式确定,此处不再赘述。
在一个可选的实施例中,车辆的速度可以从车辆的CAN总线获取。
具体的,可以通过车辆的车身CAN总线,将速度信息通过CAN报文传递给毫米波雷达。
在一个可选的实施例中,车辆的速度还可以通过车速估计算法得到。例如,可以利用静态物体较多且具有距离不同、多普勒差异较小的特点。根据静态目标的速度确定车辆的速度,可将该静态目标相对于所述车辆的运动速度的大小作为该车辆的速度大小,将该静态目标相对于所述车辆的运动速度的反方向作为该车辆的速度方向。其中,静态目标例如为步骤101中确定的静态目标。
本公开实施例的方法,在优先保证动态目标速度准确测量的前提下,可以较为准确的获得大量速度未拓展的静态目标相对于车辆的实际速度,保证了静态目标速度估计的准确性,从而避免了静态物体速度估计有误造成的误判。
在一个可选的实施例中,如图5所示,首先进行动态目标的速度估计,基于前一帧的目标信息以及当前帧的目标信息(距离-速度)查找两帧中相互匹配的目标(即执行步骤101),处理之前如图2所示,经过该步骤得到动态物体以及部分静态物体相对于车辆的速度,结果参见图3,进一步基于多普勒频率对静态目标进行筛选,即执行步骤102,其中,还可以基于车身CAN总线获取车辆的速度或基于车速估计算法获取车辆的速度,其中,车速估计算法还可以基于前一帧和当前帧的距离-多普勒结果估计车辆的速度,进一步基于车辆的速度、速度单元的信息确定速度折叠次数,从而基于静态物体的测量速度、速度折叠次数确定静态物体相对于车辆的实际速度,结果如图4所示。
其中,图2-图4表示的是由距离维度和速度维度构成的二维数据,所述距离维度包括多个距离单元,所述速度维度包括多个速度单元。
其中,距离-多普勒结果可以通过距离-多普勒频率图谱表示,由距离维度和多普勒频率维度构成,包括多个距离单元和多普勒频率单元。
在一个可选的实施例中,可以遍历距离-多普勒图谱上的每个多普勒单元,在相应多普勒单元上遍历每个距离单元,判断其能量是否超过设定门限。统计每个多普勒单元上超过设定门限的距离单元的数目,数目最大对应的多普勒单元为静态目标对应的多普勒频率单元,从而根据静态目标确定车辆的速度。
图6为本公开一实施例提供的毫米波雷达的结构示意图。本实施例提供的毫米波雷达,用于执行前述任一所示实施例提供的速度确定方法。如图6所示,本实施例提供的毫米波雷达,可以包括:处理器61和雷达接收天线62。雷达接收天线62用于接收信号。
所述处理器61与所述雷达接收天线62电连接,所述处理器61被配置为:
根据所述雷达的相邻两帧接收信号,确定相互匹配的至少一个第一目标;所述至少一个第一目标中包括静态目标;
根据至少一个第二目标对应的多普勒频率,以及,所述至少一个第一目标中静态目标对应的多普勒频率,在所述至少一个第二目标中选择第三目标;所述至少一个第二目标为根据所述雷达的接收信号检测到的目标中除去所述至少一个第一目标的目标;
根据所述第三目标的测量速度,确定所述第三目标相对于所述车辆的实际速度;所述第三目标的测量速度为通过所述雷达测量的所述第三目标相对于所述车辆的速度。
在一种可能的实现方式中,所述处理器61被配置为:
根据所述相邻两帧接收信号分别对应的各个所述第一目标的测量速度,确定各个所述第一目标相对于所述车辆的实际速度。
在一种可能的实现方式中,所述处理器61被配置为:
根据所述相邻两帧接收信号分别对应的脉冲重复周期以及所述雷达的探测信号的波长,确定所述相邻两帧接收信号分别对应的模糊周期;所述脉冲重复周期为所述雷达的探测信号的频率变化的周期;
根据所述相邻两帧接收信号分别对应的各个所述第一目标的测量速度,以及所述相邻两帧接收信号分别对应的模糊周期,确定各个所述第一目标相对于所述车辆的实际速度。
在一种可能的实现方式中,所述处理器61被配置为:
根据所述相邻两帧接收信号分别对应的各个所述第一目标的测量速度、所述相邻两帧接收信号分别对应的模糊周期以及第一预设阈值,确定第一参数值和第二参数值;
根据根据所述相邻两帧接收信号分别对应的各个所述第一目标的测量速度、所述相邻两帧接收信号分别对应的模糊周期以及所述第一参数值和第二参数值,确定各个所述第一目标相对于所述车辆的实际速度。
在一种可能的实现方式中,所述处理器61被配置为:
根据所述第三目标的测量速度、所述雷达的模糊周期以及速度折叠次数,确定所述第三目标相对于所述车辆的实际速度;所述雷达的模糊周期为根据所述雷达的脉冲重复周期以及所述雷达的探测信号的波长确定的。
在一种可能的实现方式中,所述处理器61被配置为:
根据所述车辆的速度、速度单元的间隔以及速度单元的数目,确定所述静态目标对应的多普勒频率以及所述雷达的速度折叠次数;所述速度单元为根据所述雷达的模糊周期划分的速度单元。
在一种可能的实现方式中,所述处理器61被配置为:
根据至少一个第二目标的测量速度,分别确定各个所述第二目标对应的多普勒频率;所述第二目标的测量速度为通过所述雷达测量的所述第二目标相对于所述车辆的速度。
在一种可能的实现方式中,所述处理器61被配置为:
根据各个所述第二目标的测量速度、速度单元的间隔以及速度单元的数目,确定各个所述第二目标对应的多普勒频率;所述速度单元为根据所述雷达的模糊周期划分的速度单元;所述雷达的模糊周期为根据所述雷达的脉冲重复周期以及所述雷达的探测信号的波长确定的。
在一种可能的实现方式中,所述第三目标对应的多普勒频率与所述静态目标对应的多普勒频率的差值小于第二预设阈值。
在一种可能的实现方式中,所述处理器61被配置为:
从所述车辆的CAN总线获取所述车辆的速度。
本实施例提供的毫米波雷达,用于执行前述任一实施例提供的速度确定方法,技术原理和技术效果相似,此处不再赘述。
本公开实施例中还提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现前述方法实施例中对应的方法,其具体实施过程可以参见前述方法实施例,其实现原理和技术效果类似,此处不再赘述。
本公开实施例中还提供一种程序产品,该程序产品包括计算机程序(即执行指令),该计算机程序存储在可读存储介质中。处理器可以从可读存储介质读取该计算机程序,处理器执行该计算机程序用于执行前述方法实施例中任一实施方式提供的速度确定方法。
本公开实施例中还提供一种车辆,包括:
车体;以及
前述任一实施例所述的毫米波雷达,所述毫米波雷达安装在所述车体上。其实现原理和技术效果与毫米波雷达类似,此处不再赘述。
本领域普通技术人员可以理解:实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于一计算机可读取存储介质中。该程序在执行时,执行包括上述各方法实施例的步骤;而前述的存储介质包括:ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
最后应说明的是:以上各实施例仅用以说明本公开实施例的技术方案,而非对其限制;尽管参照前述各实施例对本公开实施例进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本公开实施例技术方案的范围。