基于ICP点云的多源信息数据融合研判方法与流程

基于icp点云的多源信息数据融合研判方法
技术领域
1.本发明涉及检测数据处理技术领域，尤其涉及基于icp点云的多源信息数据融合研判方法。


背景技术：

2.近年来，民用无人机技术日渐成熟，在应用越来越广泛的同时，由民用无人机引发的控制事故与相关安全问题日益常态化，民用无人机飞行器在许多有益应用场景的同时，也可能被越来越多的恶意使用。
3.对于低小慢的无人机反制系统就此产生了。对于低小慢无人机反制系统主要分为侦测和反制两部分，侦测识别真实目标是整个系统中的重要部分。通常一个系统中具有不止一个侦测设备，例如无线电破解设备，雷达，光电探头，不同设备探测目标的时候都是独立的探测，不同的设备间发现目标的能力以及识别真假目标的能力也不尽相同，不同的设备探测到的目标也是相互独立展示的，因此不同探测设备之间联动显得尤为重要；如何提高不同设备数据之间的耦合性和联动性，并保证融合的精确度往往是目前需要解决的问题。


技术实现要素：

4.本发明的目的在于克服现有技术的不足，提供基于icp点云的多源信息数据融合研判方法。
5.本发明的目的是通过以下技术方案来实现的：
6.基于icp点云的多源信息数据融合研判方法，包括以下步骤：
7.步骤1：采集多源信息，包括雷达源信息和无线电源信息；
8.步骤2：采用icp算法对雷达源信息和无线电源信息的数据分别进行点云匹配变换，通过计算旋转矩阵r和平移矩阵t对坐标系的点云数据坐标进行调整，再对调整后的坐标进行畸形矫正，实现雷达源和无线电源的数据到地球坐标系的转换；从而得到雷达源和无线电源数据到地球坐标系的映射矩阵
9.步骤3：获取所有的无线电源的数据，将其映射到地球坐标系中，对于每个无线电源的数据均进行空间特征和运动特征的提取，并将得到的空间特征和运动特征整合记录到点的特征中；
10.步骤4：获取所有的雷达源的数据，将其映射到地球坐标系中，对于每个雷达源的目标数据均进行空间特征和运动特征的提取，并将得到的空间特征和运动特征整合记录到点的特征中；
11.步骤5：对每个雷达源的目标数据与在点云中的无线电源的数据进行对比，根据雷达源和无线电源的时间差，以及目标源的速度粗估算在相同时间点的经纬度和高度，判断雷达源和无线电源数据得到的距离、高低和速度是否在偏差内；
12.步骤6：若所有对比结果均在偏差内，则认为是同一个目标，并将2个目标进行融合
处理；随着时间推移关注这两个目标的时候，如果出现目标判断时连续3次不满足对比结果在均偏差内的条件，则认为融合失败，解除融合状态。
13.进一步的，所述雷达源的信息包括距离、方位角、高度、反射面、物体的运动速度、经纬度以及海拔。
14.进一步的，所述无线电源的信息包括无人机的无人机名称编号、经纬度、海拔高度、速度、相对飞手距离和飞手经纬度。
15.进一步的，所述步骤2具体包括：
16.步骤201：根据无线电源信息和雷达源信息分别得到对应的三维直角坐标数据，形成无线电数据目标点集q和雷达数据点集p；
17.步骤202：将点集q和点集p中的点一一对应
18.步骤203：将无线电源信息和雷达源信息分别得到对应的三维直角坐标数据通过icp算法进行点云匹配变换，形成点云数据；
19.步骤204：计算旋转矩阵r和平移矩阵t，判断在所述旋转矩阵r和平移矩阵t的误差函数是否最小；若否，则返回步骤202；若是，则icp算法结束；
20.步骤205：计算畸形矩阵，通过畸形矩阵对转换后的源坐标系进行矫正；
21.步骤206：得到最终的雷达源和无线电源数据到地球坐标系的映射矩阵。
22.进一步的，所述点云匹配变换公式为：其中，r3×3表示旋转矩阵，t3×1表示平移向量，s表示整体比例因子，o1×3为零向量，地球坐标系和源坐标系都是基于真实世界的比例，因此s＝1；
[0023][0024]
其中，t3×1＝[t
x t
y tz]
t
；
[0025]
其中，α、β、γ分别表示点沿x、y、z轴的旋转角度，t
x
、ty、tz分别表示点沿x、y、z轴的平移量；其中，
[0026]
r3×3进一步表示为
[0027]
进一步的，所述旋转矩阵r和平移矩阵t的误差函数为：
[0028][0029]
其中，f(r，t)表示源点集p在变换矩阵(r，t)下与目标点集q之间的误差，r为旋转矩阵，t为平移矩阵；pi为源点集中的点集元素；qi为目标点集中的点集元素；n表示点集的规模。
[0030]
进一步的，所述步骤204具体为：
[0031]
步骤2041：根据计算得到旋转矩阵r和平移矩阵t对源点集p进行旋转平移变换，得
到新的点集p’＝{p
i’＝rpi+t，pi∈p}；
[0032]
步骤2042：计算p
i’与对应点集qi的平均距离，如果小于给定的阈值或者大于预设的迭代次数，则停止迭代计算；否则返回第203步，直到误差函数满足收敛条件为止。
[0033]
进一步的，所述畸形矩阵的计算公式为：
[0034][0035]
其中，x0，y0，z0为目标坐标系的坐标，x1，y1，z1为源坐标系的坐标；k
11
，k
12
，
…
，k
30
为通过线性回归方程拟合计算得到的数值。
[0036]
本发明的有益效果：本发明通过多源信息判断目标在多个系统中是否具有相同或类似的空间特征以及物理运动特征，进而将多源的信息整合成单一目标，使研判真实目标的状态更真实，避免过多的虚假目标的干扰，能提高目标的可靠性，为以后更多源的系统中目标的研判提供理论和实际基础，在多站点的布局上形成统一的研判平台，提升用户体验。
附图说明
[0037]
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图示出的结构获得其他的附图。
[0038]
图1为本发明的方法流程图。
[0039]
图2为icp点云匹配变换流程图。
[0040]
图3为数据融合研判流程图。
具体实施方式
[0041]
应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。
[0042]
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
[0043]
在本实施例中，如图1所示，基于icp点云的多源信息数据融合研判方法，包括以下步骤：
[0044]
步骤1：采集多源信息，包括雷达源信息和无线电源信息；
[0045]
步骤2：采用icp算法对雷达源信息和无线电源信息的数据分别进行点云匹配变换，通过计算旋转矩阵r和平移矩阵t对坐标系的点云数据坐标进行调整，再对调整后的坐标进行畸形矫正，实现雷达源和无线电源的数据到地球坐标系的转换；从而得到雷达源和无线电源数据到地球坐标系的映射矩阵；
[0046]
步骤3：获取所有的无线电源的数据，将其映射到地球坐标系中，对于每个无线电源的数据均进行空间特征和运动特征的提取，并将得到的空间特征和运动特征整合记录到点的特征中；
[0047]
步骤4：获取所有的雷达源的数据，将其映射到地球坐标系中，对于每个雷达源的目标数据均进行空间特征和运动特征的提取，并将得到的空间特征和运动特征整合记录到点的特征中；
[0048]
步骤5：对每个雷达源的目标数据与在点云中的无线电源的数据进行对比，根据雷达源和无线电源的时间差，以及目标源的速度粗估算在相同时间点的经纬度和高度，判断雷达源和无线电源数据得到的距离、高低和速度是否在偏差内；
[0049]
步骤6：若所有对比结果均在偏差内，则认为是同一个目标，并将2个目标进行融合处理；随着时间推移关注这两个目标的时候，如果出现目标判断时连续3次不满足对比结果在均偏差内的条件，则认为融合失败，解除融合状态。
[0050]
本发明的目的在于通过多源信息判断目标在多个系统中是否具有相同或类似的空间特征以及物理运动特征，进而将多源的信息整合成单一目标，提供精准的目标研判，为后续的处置流程提供基础。
[0051]
多源信息在本方案中包括雷达数据源，无线电破解设备源，无线电破解设备源以下统称为无线电源。雷达源的目标信息结构包括距离，方位角，高度，反射面，物体的运动速度(包括大小和方向)以及根据以上特征推理出来的经纬度，海拔等信息。无线电源的目标信息结构包括无人机的无人机名称编号，经纬度，海拔高度，速度，相对飞手距离，飞手经纬度等信息。无线电源具有精度高，定位准确的特点，因此可以认为由无线电源得到的数据就是真实的地球坐标系中的真实数据，因此融合的时候需要先将雷达数据转到地球坐标系中再进行融合的研判。
[0052]
将雷达源转到地球坐标系中的时候用到的是icp点云配对原理，通过icp算法将雷达源的数据通过旋转平移矩阵转换后，再通过一个畸形矫正矩阵变换到地球坐标系中。然后通过对比物体的空间特征以及运动特征，判断是否可能是同一个目标。
[0053]
如图2所示，icp算法原理以及流程如下：
[0054]
(1)可以设定设备所在的位置为其坐标的原点位置，那么现在就有2组坐标数据，一组无线电对应的三维直角坐标系(简称地球坐标系)，一组是雷达对应的三维直角坐标系(简称源坐标系)。
[0055]
(2)点云匹配的变换公式由以下公式来表示：
[0056][0057]
其中r
3x3
代表旋转矩阵，t
3x1
代表平移向量，s代表整体比例因子，o
1x3
为零向量，地球坐标系和源坐标系都是基于真实世界的比例，因此此处s＝1。
[0058]
展开r
3x3
和t
3x1
[0059][0060]
t3×1＝[t
x t
y tz]
t
[0061]
其中α、β、γ分别表示点沿x、y、z轴的旋转角度，t
x
、ty、tz分别表示点沿x、y、z轴的
平移量。
[0062]
上述公式中r
3x3
可以进一步表示为：
[0063][0064]
刚性变换矩阵中涉及到6个未知数α、β、γ、tx、ty、tz。需要唯一确定这六个未知参数需要6个线性方程，才可以得到这几个位置数的值，进而完成刚性矩阵的参数估计。
[0065]
(3)根据上述公式以及点云数据，那么就可以开始求解这两个点云数据的旋转矩阵和平移向量。此处，需要确定目标函数来求解，在待匹配的两组点云数据的重叠区域内，分别选取两个点集来表示源点集和目标点集，其中p＝{pi|pi∈r3，i＝1,2，
……
n}为源点集，q＝{qj|qj∈r3，j＝1,2，
……
m}为目标点集，m和n分别代码两个点集的规模。设旋转矩阵为r，平移矩阵为t，用f(r，t)来表示源点集p在变换矩阵(r，t)下与目标点集q之间的误差。则求解最优变换矩阵的问题就可以转化为求满足min(f(r，t))的最优解(r，t)
[0066][0067]
(4)由于知道点云的点配对情况因此只需要通过计算旋转矩阵r和平移矩阵t,使得误差函数最小，对于取得的r和t对点集p进行旋转平移变换，得到新的点集p’＝{p
i’＝rpi+t,pi∈p}；计算p
i’与对应点集qi的平均距离，如果小于某一给定的阈值或者大于预设的迭代次数，则停止迭代计算。否则返回第3步，直到满足收敛条件为止。
[0068]
通过观察旋转平移点云匹配的情况后，发现在不同方位角的时候地球坐标系和源坐标系的高度差是不相同的。也就是说无线电的坐标系和雷达源的坐标系之间并不是严格的直角坐标系，它们各自的坐标系中存在坐标系形变，因此需要在icp点云配对模型的基础上增加形变处理。
[0069]
形变通过对坐标进行线性拟合达到消除形变的效果，针对实验结果的观察，发现误差量基本都是在z方向上，因此对z方向的偏置进行3次方拟合，拟合公式如下：
[0070]
其中x0,y0,z0为目标坐标系的坐标，x1,y1,z1为源坐标系的坐标，通过线性回归方程的计算可以计算出k：{k
11
，k
12
，
……
，k
30
}的值。
[0071]
那么最终的坐标转换关系则是先将原坐标通过旋转平移矩阵转换成新的坐标(x1,y1,z1)然后再通过上述的方程转化到目标坐标系中，即可。
[0072]
通过以上方法完成了地球坐标系中坐标到源坐标系中的转换，无线电源数据和雷达源数据点集经过处理为三维坐标点之后，首先通过icp算法进行旋转平移矩阵的计算，通过旋转平移后的矩阵计算畸形形变矩阵，结合起来成为无线电映射到光电探头的坐标系中，经过实际测试，仅通过一次数据采集就完成了数据标定，大大提高了数据的不同设备之间的耦合性和联动性，为后续更精准的处置流程提供保证。以上方法通过测试，需要在各个方向上都有数据才能保证转换才能保证最后一步中的畸形转换公式的效果，否则会出现欠拟合的现象。
[0073]
根据以上的算法算出旋转平移矩阵和畸形矫正矩阵之后，就可以进行下一步的融合研判。
[0074]
如图3所示，融合研判的步骤如下：
[0075]
1.获取所有的无线电源的数据，对于每个无线电源进行如下处理：
[0076]
a)空间特征处理：取最近时间点的无线电数据的中的经度，纬度，高度，时间点。
[0077]
b)运动特征处理：取最近3个点的无线电数据(如果不够则取对应所有点)，计算出平均速度，和方向，平均加速度。
[0078]
c)将a,b中得到的特征整合记录到点的特征中。
[0079]
2.获取所有的雷达源的数据，对每个雷达源的目标数据进行一下特征提取处理：
[0080]
a)空间特征处理：取最近时间点的无线电数据的中的经度，纬度，高度，时间点，将经纬度和高度通过上一步中获得的旋转平移矩阵和畸形矩阵进行进行平移旋转，并通过最终的畸形矩阵进行变换得到变换后的经度纬度高度。
[0081]
b)运动特征处理：取最近的3个点的目标雷达数据(如果不够则取对应所有点),计算出平均速度，和方向，平均加速度。
[0082]
c)将a,b中得到的特征整合记录到点的特征中。
[0083]
3.对于每个雷达源目标数据首先在无线电源的数据中进行对比，在空间特征中由于雷达探测原理距离雷达越远的目标在空间范围内误差越大，因此根据雷达源目标距离雷达的距离跟误差应该成正相关，距离雷达越远则空间判定阈值应该越大，因此假定空间阈值为πr/36。
[0084]
4.由于目标探测的时间并不是同时的，因此需要在判断目标源的是否一致的时候需要增加时间推算，根据雷达源和无线电源的时间差，和目标源的速度进行粗估算在相同时间点的经纬度和高度。
[0085]
a)通过经纬度算出无线电源和雷达源之间的距离则再根据空间阈值计算公式计算偏差是否在偏差内，如果是则进行下一步判断。
[0086]
b)同理对高度也进行同样的计算，如果都在偏差以内，则进行下一步判断。
[0087]
c)对雷达源和无线电源的速度进行判断，如果误差在15％以内，则可以认定两个源的信息是基本相符的。
[0088]
5.通过以上结果对比之后如果都满足，则可以认为是同一个目标，可以将2个目标进行融合处理。随着时间推移关注这两个目标的时候，如果出现目标判断时连续3次不满足4中的条件，则认为融合失败，解除融合状态。
[0089]
需要说明的是，对于前述的各个方法实施例，为了简单描述，故将其都表述为一系列的动作组合，但是本领域技术人员应该知悉，本技术并不受所描述的动作顺序的限制，因为依据本技术，某一些步骤可以采用其他顺序或者同时进行。其次，本领域技术人员也应该知悉，说明书中所描述的实施例均属于优选实施例，所涉及的动作和单元并不一定是本技术所必须的。
[0090]
在上述实施例中，对各个实施例的描述都各有侧重，某个实施例中没有详细描述的部分，可以参见其他实施例的相关描述。
[0091]
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程，是可以通过计算机程序来指令相关的硬件来完成，所述的程序可存储于计算机可读取存储介质
中，该程序在执行时，可包括如上述各方法的实施例的流程。其中，所述的存储介质可为磁碟、光盘、rom、ram等。
[0092]
以上所揭露的仅为本发明较佳实施例而已，当然不能以此来限定本发明之权利范围，因此依本发明权利要求所作的等同变化，仍属本发明所涵盖的范围。