一种多扩展目标雷达量测集划分方法和装置

摘要

本发明涉及了一种多扩展目标雷达量测集划分方法和装置，该方法包括：获取待量测目标的原始雷达量测集和原始视觉量测集；对原始视觉量测集中的视觉量测数据按照视觉量测距离进行排序，得到第一视觉量测集；按照预设的视觉量测距离区间和预设的方位角区间，设定扇环区域；提取与扇环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集；对雷达量测子集中的雷达量测数据按照预设距离规则进行聚类，得到多个第一雷达量测单元；将所有的雷达量测单元作为原始雷达量测集的划分结果。在上述方法中，以视觉量测数据作为引导，将雷达量测数据预先划分为不同量测子集，提高了对紧邻目标的区分能力；同时减少了量测划分数，降低计算量。

权利要求

1.一种多扩展目标雷达量测集划分方法，其特征在于，所述方法包括：获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉量测集；所述雷达量测数据中包括雷达量测距离和方位角信息，所述视觉量测数据中包括视觉量测距离；

对所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离进行排序，得到第一视觉量测集；

按照预设的视觉量测距离区间和预设的方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域；

从所述原始雷达量测集中提取与所述扇环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集；

对所述雷达量测子集中的雷达量测数据按照预设距离规则进行聚类，得到多个第一雷达量测单元；

对不属于任何一个所述第一雷达量测单元的雷达量测数据按照所述预设距离规则进行聚类，得到多个第二雷达量测单元；

将所有的所述第一雷达量测单元和所述第二雷达量测单元作为所述原始雷达量测集的划分结果。

2.根据权利要求1所述的方法，其特征在于，所述视觉量测距离为图像中所述待量测目标的中心在车辆坐标系中的第一坐标和所述车辆坐标系的原点之间的欧式距离，所述视觉量测数据还包括：所述待量测目标在图像中的检测框对应的第二坐标和长宽尺寸；所述雷达量测距离为雷达传感器与待量测目标的距离，所述方位角为所述雷达传感器的法线方向与所述待量测目标之间的方位角。

3.根据权利要求2所述的方法，其特征在于，所述对所述原始视觉量测集中的视觉量测数据按照视觉量测距离进行排序，包括：计算所述第一坐标与所述车辆坐标系原点的欧式距离，得到视觉量测距离；

将所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离的升序进行排序，得到第一视觉量测集。

4.根据权利要求3所述的方法，其特征在于，在按照预设距离区间和预设方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域之前，还包括：根据每一个所述视觉量测数据对应的视觉量测距离与预设的测量误差阈值，确定每一个所述视觉量测数据对应的预设距离区间；

获取视觉传感器的光心横坐标、焦距，并确定预设的方位角扩大角度；

根据每一个所述视觉量测数据中的所述第二坐标的横坐标、所述长宽尺寸中的长度、所述光心横坐标、焦距、方位角扩大角度，确定预设方位角区间。

5.根据权利要求1所述的方法，其特征在于，所述对每个所述雷达量测子集中的雷达量测数据分别按照预设距离规则进行聚类，包括：计算所述雷达量测子集中每两个元素之间的马氏距离；

将所述马氏距离小于预设门限值的两个元素聚类到同一个雷达量测单元中，得到多个第一雷达量测单元。

6.根据权利要求5所述的方法，其特征在于，所述预设门限值为三维卡方分布中0.95的概率对应的取值。

7.一种多扩展目标雷达量测集划分装置，其特征在于，所述装置包括：量测集获取模块，用于获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉量测集；所述雷达量测数据中包括雷达量测距离和方位角信息，所述视觉量测数据中包括视觉量测距离；

排序模块，用于对所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离进行排序，得到第一视觉量测集；

扇环设定模块，用于按照预设的视觉量测距离区间和预设的方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域；

子集提取模块，用于从所述原始雷达量测集中提取与所述扇环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集；

第一聚类模块，用于对所述雷达量测子集中的雷达量测数据按照预设距离规则进行聚类，得到多个第一雷达量测单元；

第二聚类模块，用于对不属于任何一个所述第一雷达量测单元的雷达量测数据按照所述预设距离规则进行聚类，得到多个第二雷达量测单元；

结果获取模块，用于将所有的所述第一雷达量测单元和所述第二雷达量测单元作为所述原始雷达量测集的划分结果。

8.根据权利要求7所述的装置，其特征在于，所述排序模块具体用于：计算第一坐标与车辆坐标系原点的欧式距离，得到视觉量测距离；所述第一坐标为图像中所述待量测目标的中心在所述车辆坐标系中的坐标；

将所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离的升序进行排序，得到第一视觉量测集。

9.一种电子设备，其特征在于，包括：处理器；

用于存储所述处理器可执行指令的存储器;其中，所述处理器被配置为执行所述指令，以实现如权利要求1至6中任一项所述的多扩展目标雷达量测集划分方法。

10.一种计算机可读存储介质，当所述计算机可读存储介质中的指令由服务器的处理器执行时，使得服务器能够执行如权利要求1至6中任一项所述的多扩展目标雷达量测集划分方法。

说明书

一种多扩展目标雷达量测集划分方法和装置

技术领域

[0001] 本发明涉及多扩展目标检测跟踪领域，尤其涉及一种多扩展目标雷达量测集划分方法和装置。

背景技术

[0002] 传统的雷达目标跟踪通常假设一个目标一个时刻最多产生一个传感器量测，被称之为点目标跟踪。随着现代高分辨率传感器技术的发展，传感器分辨率小于目标尺寸时，目
标占据传感器多个分辨单元，传感器每次探测能获取目标的多个等效散射中心产生的量
测，使用这类传感器对多目标进行探测和跟踪，称为多扩展目标跟踪。

[0003] 扩展目标概率假设密度滤波器是多扩展目标跟踪领域的重要研究方向。在扩展目标概率假设密度滤波器框架下，量测数据集需要被提前划分为多个不同单元，使每个单元
中的量测来自同一目标或杂波。划分准确度直接影响跟踪算法的估计性能，同时划分单元
数量是影响跟踪算法速度的重要因素。

[0004] 现有的距离划分法，依据同一目标产生量测距离相近的原理进行划分量测集，虽然通过缩小距离阈值范围降减少了部分划分数，但总体划分数仍然较多，计算量较大；并
且，该方法对邻近距离目标无法准确区分，导致目标个数低估，跟踪精度下降。

[0005] 因此，现有的量测集划分方法存在总体划分数较多导致计算量较大、对邻近距离目标无法准确区分导致跟踪精度下降的问题。

发明内容

[0006] 本发明旨在至少解决现有技术中存在的技术问题之一。为此，本发明第一方面提出一种多扩展目标雷达量测集划分方法，所述方法包括：

[0007] 获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉量测集；所述雷达量测数据中包括雷达量测距离和方位角信
息，所述视觉量测数据中包括视觉量测距离；

[0008] 对所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离进行排序，得到第一视觉量测集；

[0009] 按照预设的视觉量测距离区间和预设的方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域；

[0010] 从所述原始雷达量测集中提取与所述扇环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集；

[0011] 对所述雷达量测子集中的雷达量测数据按照预设距离规则进行聚类，得到多个第一雷达量测单元；

[0012] 对不属于任何一个所述第一雷达量测单元的雷达量测数据按照所述预设距离规则进行聚类，得到多个第二雷达量测单元；

[0013] 将所有的所述第一雷达量测单元和所述第二雷达量测单元作为所述原始雷达量测集的划分结果。

[0014] 可选的，所述视觉量测距离为图像中所述待量测目标的中心在车辆坐标系中的第一坐标，所述视觉量测数据还包括：所述待量测目标在图像中的检测框对应的第二坐标和
长宽尺寸；所述雷达量测距离为所述雷达传感器与待量测目标的距离，所述方位角为所述
雷达传感器的法线方向与所述待量测目标之间的方位角。

[0015] 可选的，所述对所述原始视觉量测集中的视觉量测数据按照视觉量测距离进行排序，包括：

[0016] 计算所述第一坐标与所述车辆坐标系原点的欧式距离，得到视觉量测距离；

[0017] 将所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离的升序进行排序，得到第一视觉量测集。

[0018] 可选的，在按照预设距离区间和预设方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域之前，还包括：

[0019] 根据每一个所述视觉量测数据对应的视觉量测距离与预设的测量误差阈值，确定每一个所述视觉量测数据对应的预设距离区间；

[0020] 获取所述视觉传感器的光心横坐标、焦距，并确定预设的方位角扩大角度；

[0021] 根据每一个所述视觉量测数据中的所述第二坐标的横坐标、所述长宽尺寸中的长度、所述光心横坐标、焦距、方位角扩大角度，确定预设方位角区间。

[0022] 可选的，所述对每个所述雷达量测子集中的雷达量测数据分别按照预设距离规则进行聚类，包括：

[0023] 计算所述雷达量测子集中每两个元素之间的马氏距离；

[0024] 将所述马氏距离小于预设门限值的两个元素聚类到同一个雷达量测单元中，得到多个第一雷达量测单元。

[0025] 可选的，所述预设门限值为三维卡方分布中0.95的概率对应的取值。

[0026] 本发明第二方面提出一种多扩展目标雷达量测集划分装置，所述装置包括：

[0027] 量测集获取模块，用于获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉量测集；所述雷达量测数据中包括雷达
量测距离和方位角信息，所述视觉量测数据中包括视觉量测距离；

[0028] 排序模块，用于对所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离进行排序，得到第一视觉量测集；

[0029] 扇环设定模块，用于按照预设的视觉量测距离区间和预设的方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域；

[0030] 子集提取模块，用于从所述原始雷达量测集中提取与所述扇环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集；

[0031] 第一聚类模块，用于对所述雷达量测子集中的雷达量测数据按照预设距离规则进行聚类，得到多个第一雷达量测单元；

[0032] 第二聚类模块，用于对不属于任何一个所述第一雷达量测单元的雷达量测数据按照所述预设距离规则进行聚类，得到多个第二雷达量测单元；

[0033] 结果获取模块，用于将所有的所述第一雷达量测单元和所述第二雷达量测单元作为所述原始雷达量测集的划分结果。

[0034] 可选的，所述排序模块具体用于：

[0035] 计算所述第一坐标与所述车辆坐标系原点的欧式距离，得到视觉量测距离；

[0036] 将所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离的升序进行排序，得到第一视觉量测集。

[0037] 可选的，所述装置还包括：

[0038] 距离区间确定模块，用于根据每一个所述视觉量测数据对应的视觉量测距离与预设的测量误差阈值，确定每一个所述视觉量测数据对应的预设距离区间；

[0039] 数据获取模块，用于获取所述视觉传感器的光心横坐标、焦距，并确定预设的方位角扩大角度；

[0040] 方位角区间确定模块，用于根据每一个所述视觉量测数据中的所述第二坐标的横坐标、所述长宽尺寸中的长度、所述光心横坐标、焦距、方位角扩大角度，确定预设方位角区
间。

[0041] 可选的，所述第一聚类模块具体用于：

[0042] 计算所述雷达量测子集中每两个元素之间的马氏距离；

[0043] 将所述马氏距离小于预设门限值的两个元素聚类到同一个雷达量测单元中，得到多个第一雷达量测单元。

[0044] 本发明第三方面提出一种电子设备，包括：

[0045] 处理器；

[0046] 用于存储所述处理器可执行指令的存储器;

[0047] 其中，所述处理器被配置为执行所述指令，以实现如第一方面所述的多扩展目标雷达量测集划分方法。

[0048] 本发明第四方面提出一种计算机可读存储介质，当所述计算机可读存储介质中的指令由服务器的处理器执行时，使得服务器能够执行如第一方面所述的多扩展目标雷达量
测集划分方法。

[0049] 根据本发明提供的具体实施例，本发明具有以下技术效果：

[0050] 本发明实施例提供的多扩展目标雷达量测集划分方法，包括：获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉
量测集；对所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离进行排序，得到
第一视觉量测集；按照预设的视觉量测距离区间和预设的方位角区间，设定所述第一视觉
量测集中的每一个视觉量测数据对应的扇环区域；从所述原始雷达量测集中提取与所述扇
环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集；对所述雷
达量测子集中的雷达量测数据按照预设距离规则进行聚类，得到多个第一雷达量测单元；
对不属于任何一个所述第一雷达量测单元的雷达量测数据按照所述预设距离规则进行聚
类，得到多个第二雷达量测单元；将所有的所述第一雷达量测单元和所述第二雷达量测单
元作为所述原始雷达量测集的划分结果。在上述方法中，利用视觉量测数据分辨率高、目标
分辨能力强的特点，以视觉量测数据作为引导，将雷达量测数据预先划分为不同量测子集，
提高了对紧邻目标的区分能力，对目标数的估计更为准确，提高了跟踪精度；同时只采用一
种距离度量进行划分，大幅减少量测划分数，降低计算量。

附图说明

[0051] 为了更清楚地说明本发明的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单的介绍。显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对
于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还能够根据这些附图获得其
它附图。

[0052] 图1为本发明实施例提供的一种多扩展目标雷达量测集划分方法的步骤流程图；

[0053] 图2为本发明实施例提供的另一种多扩展目标雷达量测集划分方法的步骤流程图；

[0054] 图3为本发明实施例提供的一种多扩展目标雷达量测集划分装置的结构框图。

具体实施方式

[0055] 下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于
本发明中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其
他实施例，都属于本发明保护的范围。

[0056] 为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。

[0057] 图1为本发明实施例提供的一种多扩展目标雷达量测集划分方法的步骤流程图。所述方法包括以下步骤：

[0058] 步骤101、获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉量测集；所述雷达量测数据中包括雷达量测距离和
方位角信息，所述视觉量测数据中包括视觉量测距离。

[0059] 在智能汽车领域，视觉与毫米波雷达融合感知成为主流方案，各感知平台均同时搭载视觉传感器与毫米波雷达传感器，在获取毫米波雷达量测集的同时可以得到视觉量测
集。

[0060] 具体地，利用视觉传感器获取待量测目标在当前时刻的视觉量测数据，得到原始视觉量测集，利用雷达传感器获取待量测目标在当前时刻的雷达量测数据，得到原始雷达
量测集。

[0061] 视觉量测距离为视觉传感器与待量测目标之间的距离，雷达量测距离为雷达传感器与待量测目标之间的距离，方位角为雷达传感器法线与待量测目标之间的夹角。

[0062] 步骤102、对所述原始视觉量测集中的视觉量测数据按照视觉量测距离进行排序，得到第一视觉量测集；所述视觉量测距离根据待量测目标在图像中的坐标确定。

[0063] 根据视觉量测距离排序，可以使得位置接近的待量测目标在量测集中的排列序号更接近。视觉量测数据相对于雷达量测数据分辨率高、对目标的分辨能力强，以视觉量测距
离排序作为引导，后续根据该排序将雷达量测数据划分为不同量测子集，可以提高对紧邻
目标的区分能力。

[0064] 步骤103、按照预设的视觉量测距离区间和预设的方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域。

[0065] 视觉量测数据中包括视觉量测距离，可以根据该视觉量测距离和量测的误差预先设定一个距离区间 ，根据视觉传感器的参数和视觉量测数据预先设定一个方位角
区间 。

[0066] 根据预设距离区间确定大半径 和小半径 ，根据预设方位角区间确定起始角度和终止角度 ，从而得到一个扇环区域。

[0067] 第一视觉量测集中的每一个视觉量测数据都可以确定一个对应的扇环区域。

[0068] 步骤104、从所述雷达量测集中提取与所述扇环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集。

[0069] 雷达量测数据中包括雷达量测距离和方位角信息，将雷达量测数据中的雷达量测距离和方位角信息与扇环区域对应的距离区间和方位角区间进行匹配，可以得到每一个扇
环区域对应的多个雷达量测数据。

[0070] 将每一个扇环区域对应的多个雷达量测数据的集合，作为一个雷达量测子集。

[0071] 一个扇环区域对应一个雷达量测子集，则从原始雷达量测集中可以得到多个雷达量测子集。

[0072] 步骤105、对每个所述雷达量测子集中的雷达量测数据分别按照预设距离规则进行聚类，得到多个雷达量测单元。

[0073] 量测数据集划分的目标是使每个单元中的量测来自同一目标或杂波。

[0074] 根据同一目标产生的量测距离相近的原理，按照预设距离规则对雷达量测子集中的数据进行聚类，可以使距离相近的雷达量测数据聚集在同一个单元中，从而准确划分雷
达量测集。

[0075] 每个雷达量测子集可以根据聚类算法划分为多个第一雷达量测单元。

[0076] 步骤106、对不属于任何一个所述第一雷达量测单元的雷达量测数据按照所述预设距离规则进行聚类，得到多个第二雷达量测单元。

[0077] 对于不属于任何一个第一雷达量测单元的雷达量测数据，依然按照距离规则进行聚类，可以得到多个第二雷达量测单元。

[0078] 步骤107、将所有的所述第一雷达量测单元和所述第二雷达量测单元作为所述原始雷达量测集的划分结果。

[0079] 将所有的雷达量测单元综合起来，得到最终的原始雷达量测集的划分结果。

[0080] 例如，步骤106中得到的雷达量测单元有M个，步骤107中得到的雷达量测单元有N个，则原始雷达量测集的划分结果为(M+N)个雷达量测单元。

[0081] 综上，在本发明实施例中，获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉量测集；对所述原始视觉量测集中
的视觉量测数据按照所述视觉量测距离进行排序，得到第一视觉量测集；按照预设的视觉
量测距离区间和预设的方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对
应的扇环区域；从所述原始雷达量测集中提取与所述扇环区域的距离区间和方位角区间对
应的雷达量测数据，得到多个雷达量测子集；对所述雷达量测子集中的雷达量测数据按照
预设距离规则进行聚类，得到多个第一雷达量测单元；对不属于任何一个所述第一雷达量
测单元的雷达量测数据按照所述预设距离规则进行聚类，得到多个第二雷达量测单元；将
所有的所述第一雷达量测单元和所述第二雷达量测单元作为所述原始雷达量测集的划分
结果。在上述方法中，利用视觉量测数据分辨率高、目标分辨能力强的特点，以视觉量测数
据作为引导，将雷达量测数据预先划分为不同量测子集，提高了对紧邻目标的区分能力，对
目标数的估计更为准确，提高了跟踪精度；同时只采用一种距离度量进行划分，大幅减少量
测划分数，降低计算量。

[0082] 图2为本发明实施例提供的另一种多扩展目标雷达量测集划分方法的步骤流程图。所述方法包括以下步骤：

[0083] 步骤201、获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉量测集；所述雷达量测数据中包括雷达量测距离和
方位角信息，所述视觉量测数据中包括视觉量测距离。

[0084] 在本发明实施例中，步骤201可以参照步骤101，此处不再赘述。

[0085] 可选的，所述视觉量测距离为图像中所述待量测目标的中心在车辆坐标系中的第一坐标，所述视觉量测数据还包括：所述待量测目标在图像中的检测框对应的第二坐标和
长宽尺寸；所述雷达量测距离为所述雷达传感器与待量测目标的距离，所述方位角为所述
雷达传感器的法线方向与所述待量测目标之间的方位角。

[0086] 在本发明实施例中，雷达传感器和视觉传感器架设在车辆上，视觉传感器获取待量测目标的图像检测数据，雷达传感器获取待量测目标的雷达检测数据。

[0087] 视觉量测集为包含 个视觉量测数据的集合，表示为 。

[0088] 表示单个视觉量测数据，其中， 为待量测目标的中心在车辆坐标系中的坐标， 为待量测目标在图像中的检测框的左上角的点的坐
标， 为检测框的长宽尺寸。

[0089] 雷达量测集为包含 个雷达量测数据的集合，表示为 。

[0090] 表示单个雷达量测数据，其中，r表示雷达传感器与待量测目标的距离， 表示雷达传感器的法线方向与待量测目标之间的方位角， 表示激光束的径向速
度。

[0091] 步骤202、计算所述第一坐标与所述车辆坐标系原点的欧式距离，得到视觉量测距离。

[0092] 第一坐标 与车辆坐标系原点(0,0)的欧式距离为 ， 为视觉量测距离。

[0093] 步骤203、将所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离的升序进行排序，得到第一视觉量测集。

[0094] 在计算出每一个视觉量测数据的 之后，按照 的升序对原始视觉量测集中的元素进行排序，得到第一视觉量测集。

[0095] 按照距离的升序进行排序，比按照距离的降序排序，后续进行扇环区域划分时，误差会更小。

[0096] 在图像中，近距离目标在图像中占的面积比远距离目标更大，远距离目标也有可能被近距离目标遮挡。若按照距离的降序来排序，远距离目标被排在前面，则后续确定每个
视觉量测数据的扇环范围时，会先确定远距离目标的扇环范围，这样就可能会把与远距离
目标重叠的近距离目标提前划分出去。若按照距离的升序来排序，近距离的目标被排在前
面，则在后续确定每个视觉量测数据的扇环范围时，有可能会把与近距离目标重叠的远距
离目标提前划分出去。

[0097] 对于近距离目标，其扇形区域对应的实际距离较小，对于远距离目标，其扇形区域对应的实际距离较大；并且，视觉量测距离误差与实际距离的大小正相关，因此，视觉传感
器对近距离目标的视觉量测距离误差较小。因此，若按照距离的升序排序，则误将远距离目
标划分到近距离目标对应的扇形区域的概率较低；若按照距离的降序排序，则误将近距离
目标划分到远距离目标对应的扇形区域的概率较高。也就是说，按照距离的升序进行排序，
在后续扇环区域划分时，误差会更小。

[0098] 步骤204、根据每一个所述视觉量测数据对应的视觉量测距离与预设的测量误差阈值，确定每一个所述视觉量测数据对应的预设距离区间。

[0099] 在本发明实施例中，预先设置测量误差阈值，例如可以设置测量误差阈值为 。那么，预设距离区间为 ，其中， ， 。

[0100] 步骤205、获取所述视觉传感器的光心横坐标、焦距，并确定预设的方位角扩大角度。

[0101] 视觉传感器的光心横坐标、焦距为传感器自身的固有参数，而方位角扩大角度可以根据实际需求进行预设。方位角扩大度数可以设置为与视觉量测距离相关，例如，方位角
扩大度数与视觉量测距离成正比。

[0102] 最终，此步骤得到光心横坐标 、焦距 、方位角扩大度数 。

[0103] 步骤206、根据每一个所述视觉量测数据中的所述第二坐标的横坐标、所述长宽尺寸中的长度、所述光心横坐标、焦距、方位角扩大角度，确定预设方位角区间。

[0104] 根据视觉传感器与待量测目标之间的距离和角度关系，可以将方位角区间设置为，其中， ， 。

[0105] 步骤207、按照预设的视觉量测距离区间和预设的方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域。

[0106] 根据距离区间和方位角区间 ，可以得到每一个视觉量测数据对应的扇环区域。其中， 为扇环的小半径， 为扇环的大半径，为扇环的起始角度， 为
扇环的终止角度。

[0107] 步骤208、从所述原始雷达量测集中提取与所述扇环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集。

[0108] 在本发明实施例中，步骤208可以参照步骤104，此处不再赘述。

[0109] 步骤209、计算所述雷达量测子集中每两个元素之间的马氏距离。

[0110] 马氏距离(Mahalanobis Distance)是度量学习中的一种距离指标，可以评定数据之间的相似度指标。

[0111] 按照马氏距离的计算公式，雷达量测子集中的两个元素： 之间的马氏距离L为：

[0112] (公式1)

[0113] 其中， 表示 的转置。Σ是多维随机变量的协方差矩阵，雷达量测数据为包括距离r、方位角 、径向速度 的三维数据，因此，
。其中， 分别表示距离r、方位角 、径向速度 的误差
的标准差。

[0114] 马氏距考虑到了样本在不同类别的不同分布情况，是基于欧氏距离的一种改进，它不受量纲的影响，两点之间的马氏距离与原始数据的测量单位无关，马氏距离还可以排
除变量之间的相关性的干扰。因此，采用马氏距离作为聚类的距离规则，使得聚类结果更为
准确。

[0115] 步骤210、将所述马氏距离小于预设门限值的两个元素聚类到同一个雷达量测单元中，得到多个第一雷达量测单元。

[0116] 门限值为一个距离值，可以根据需求进行预设。

[0117] 根据该门限值对雷达量测子集中的元素按照距离进行聚类，使得距离接近的元素聚集在一个聚类簇中。

[0118] 可选的，所述预设门限值为三维卡方分布中0.95的概率对应的取值。

[0119] 若n个相互独立的随机变量均服从标准正态分布，则这n个服从标准正态分布的随机变量的平方和构成一新的随机变量，其分布规律称为卡方分布。

[0120] 因为雷达量测数据包括距离、方位角和径向速度三个维度，所以取三维的卡方分布，三维卡方分布的概率值取0.95使得这个距离可以覆盖95%的情况。

[0121] 当然，0.95是一个经验值，也可以根据需求设置其他概率值，本发明实施例对此不做具体限定。

[0122] 步骤211、对不属于任何第一雷达量测单元的雷达量测数据按照所述预设距离规则进行聚类，得到多个雷达量测单元。

[0123] 对不属于任何第一雷达量测单元的雷达量测数据，仍然按照上述步骤209、步骤210的方法进行聚类，得到多个雷达量测单元。

[0124] 步骤212、将所有的所述第一雷达量测单元和所述第二雷达量测单元作为所述原始雷达量测集的划分结果。

[0125] 在本发明实施例中，步骤212可以参照步骤107，此处不再赘述。

[0126] 综上，图2中的雷达量测集划分方法除具有图1中的方法的有益效果外，还将所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离的升序进行排序，因为近距离目
标的扇形区域对应的实际距离较小，其距离误差更小，因此，将近距离目标提前划分出去，
会比将远距离目标提前划分出去，得到的划分误差更小。也就是说，按照距离的升序进行排
序，在后续扇环区域划分时，误差会更小。并且，将马氏距离小于预设门限值的两个元素聚
类到同一个雷达量测单元中，马氏距考虑到了样本在不同类别的不同分布情况，它不受量
纲的影响，还可以排除变量之间的相关性的干扰。因此，采用马氏距离作为聚类的距离规
则，使得聚类结果更为准确。

[0127] 图3为本发明实施例提供的一种多扩展目标雷达量测集划分装置的结构框图。该装置300包括：

[0128] 量测集获取模块301，用于获取待量测目标在当前时刻的雷达量测数据的集合和视觉量测数据的集合，得到原始雷达量测集和原始视觉量测集；所述雷达量测数据中包括
雷达量测距离和方位角信息，所述视觉量测数据中包括视觉量测距离；

[0129] 排序模块302，用于对所述原始视觉量测集中的视觉量测数据按照所述视觉量测距离进行排序，得到第一视觉量测集；

[0130] 扇环设定模块303，用于按照预设的视觉量测距离区间和预设的方位角区间，设定所述第一视觉量测集中的每一个视觉量测数据对应的扇环区域；

[0131] 子集提取模块304，用于从所述原始雷达量测集中提取与所述扇环区域的距离区间和方位角区间对应的雷达量测数据，得到多个雷达量测子集；

[0132] 第一聚类模块305，用于对所述雷达量测子集中的雷达量测数据按照预设距离规则进行聚类，得到多个第一雷达量测单元；

[0133] 第二聚类模块306，用于对不属于任何一个所述第一雷达量测单元的雷达量测数据按照所述预设距离规则进行聚类，得到多个第二雷达量测单元；

[0134] 结果获取模块307，用于将所有的所述第一雷达量测单元和所述第二雷达量测单元作为所述原始雷达量测集的划分结果。

[0135] 所属领域的技术人员可以清楚地了解到，为描述的方便和简洁，上述描述的系统，装置和单元的具体工作过程，可以参考前述方法实施例中的对应过程，在此不再赘述。

[0136] 需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存
在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖
非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要
素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备
所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在
包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。

[0137] 本说明书中的各个实施例均采用相关的方式描述，各个实施例之间相同相似的部分互相参见即可，每个实施例重点说明的都是与其他实施例的不同之处。尤其，对于系统实
施例而言，由于其基本相似于方法实施例，所以描述的比较简单，相关之处参见方法实施例
的部分说明即可。

[0138] 以上所述仅为本发明的较佳实施例而已，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等，均包含在本发明的保护范围
内。