一种低空异构传感器信号融合方法、系统、终端及介质与流程
本发明属于信号滤波融合,具体涉及一种低空异构传感器信号融合方法、系统、终端及介质。
背景技术:
1、随着城市低空经济的发展,低空空域监视与多传感器数据融合技术在低空飞行服务平台中发挥着关键作用。为了实现对低空飞行目标的有效监视,系统通常会同时部署低空监视雷达与光电设备进行协同探测。其中,雷达主要提供包含径向距离的目标三维位置信息,光电传感器则常用于提供高分辨率的二维角度信息。
2、在多源传感器协同探测场景下,为了获取统一的目标航迹,通常会采用集中式融合或分布式联邦滤波等现有技术方案进行数据处理。集中式融合方案将所有传感器测量值在同一时刻集中输入卡尔曼滤波器,通过测量扩维方式构造扩维观测向量和扩维观测噪声协方差矩阵,以执行滤波更新。另一种常见的分布式联邦滤波方案则是通过设置多个局部子滤波器,让每个传感器对应的局部滤波器独立完成并产生局部状态估计,再通过主滤波器进行全局信息的汇总与融合。
3、然而,在实际应用中,雷达传感器输出三维测距感知结果,而光电传感器在测距受限时仅输出二维非测距感知结果,两者的观测维度不一致。当采用集中式融合方案时,由于要求将不同维度的观测数据在同一测量空间下执行直接扩维,导致扩维观测矩阵无法直接构造且协方差矩阵维度不匹配,数据融合过程受阻。当采用联邦滤波方案时,由于该方案强制要求各局部子滤波器必须能独立完成完整的状态估计,而光电传感器的纯角度观测无法唯一确定目标的三维空间位置,引起局部子滤波器状态发散,最终导致整体融合结构失效。
技术实现思路
1、本发明针对现有技术中的问题,提供了一种低空异构传感器信号融合方法、系统、终端及介质,以解决上述背景技术中当采用集中式融合方案时,由于要求将不同维度的观测数据在同一测量空间下执行直接扩维,导致扩维观测矩阵无法直接构造且协方差矩阵维度不匹配,数据融合过程受阻的问题;同时解决了当采用联邦滤波方案时,由于该方案强制要求各局部子滤波器必须能独立完成完整的状态估计,而光电传感器的纯角度观测无法唯一确定目标的三维空间位置,引起局部子滤波器状态发散,最终导致整体融合结构失效的问题。
2、本发明采用的技术方案如下:
3、第一方面,本技术提供了一种低空异构传感器信号融合方法,包括以下步骤:
4、步骤s1、获取雷达传感器输出的测距感知结果和光电传感器输出的非测距感知结果;
5、其中,所述测距感知结果包含目标的三维位置信息,所述非测距感知结果仅包含目标的二维角度信息,缺失距离维度;
6、步骤s2、对所述测距感知结果和所述非测距感知结果执行时间戳对齐,并将不同坐标系下的感知结果统一转换至全局地理坐标系;
7、步骤s3、将转换后的所述测距感知结果中的雷达点迹与已有航迹进行关联匹配,获得关联成功的匹配对;
8、步骤s4、基于序贯扩展卡尔曼滤波框架,利用所述匹配对中的测距感知结果对所述已有航迹执行第一步滤波更新,得到包含距离约束的临时状态估计;
9、步骤s5、将所述临时状态估计中的目标位置转换至所述光电传感器的方位坐标系,以计算非线性角度观测方程关于状态变量的雅可比矩阵;
10、基于所述雅可比矩阵,利用所述匹配对中的非测距感知结果的角度残差对所述临时状态估计执行第二步滤波更新,实现异构信息的缺维滤波融合,得到目标的最终状态估计。
11、进一步的,所述步骤s2中,对所述测距感知结果执行不同坐标系下的感知结果统一转换,并计算等效测量协方差矩阵,具体包括:
12、将所述测距感知结果中的极坐标观测值转换为笛卡尔空间坐标:
13、
14、
15、
16、其中,为径向距离,为方位角,为俯仰角,为所述雷达传感器的架设高度;
17、基于一阶泰勒展开,计算转换后在笛卡尔空间下的等效测量协方差矩阵:
18、
19、其中,为雷达原始极坐标测量噪声协方差矩阵,为极坐标向笛卡尔坐标转换方程关于极坐标变量的雅可比矩阵。
20、进一步的,所述步骤s3中,将转换后的所述测距感知结果中的雷达点迹与已有航迹进行关联匹配,具体包括:
21、针对第个雷达点迹的观测向量与第条已有航迹的预测状态,计算二者之间的马氏距离:
22、
23、其中,为雷达观测映射函数,为新息协方差矩阵,为航迹预测协方差矩阵,为观测矩阵,为所述等效测量协方差矩阵;
24、以计算得到的所有马氏距离构建关联代价矩阵,应用km二分图最优匹配算法在所述关联代价矩阵中求解全局最优匹配对;
25、对所述匹配对施加门控判决:当所述马氏距离大于预设门限时,判定对应的匹配无效。
26、进一步的,所述步骤s4与步骤s5中的两步滤波更新具体包括:
27、利用所述测距感知结果对应的笛卡尔观测执行第一步滤波更新,得到临时状态估计和临时协方差:
28、
29、其中,与分别为第一步滤波更新前的先验状态预测与先验误差协方差,为雷达观测矩阵,为雷达卡尔曼增益,为由所述笛卡尔空间坐标构成的观测向量,为所述等效测量协方差矩阵;
30、利用所述临时状态估计的空间坐标与所述光电传感器的相对位移,构建非线性角度观测方程:
31、
32、计算所述非线性角度观测方程关于状态变量的一阶偏导数,得到所述雅可比矩阵;
33、计算角度卡尔曼增益并执行第二步滤波更新,得到最终状态估计与最终协方差:
34、
35、其中,为所述非测距感知结果的二维角度观测向量,为光电角度测量噪声协方差矩阵。
36、进一步的,方法还包括针对未与雷达点迹关联但被光电传感器捕获的目标执行纯角度状态修正的步骤,具体包括:
37、提取目标上一时刻的航迹状态并预测至当前时刻,得到预测状态与预测协方差;
38、利用当前时刻光电传感器输出的二维角度观测向量执行纯角度卡尔曼滤波更新,得到更新后的协方差矩阵;
39、对所述协方差矩阵中距离方向的分量施加膨胀因子,得到修正后的协方差矩阵:
40、
41、其中,,为所述协方差矩阵中对应轴距离方向的对角元。
42、进一步的,方法还包括航迹优化与输出步骤,具体包括:
43、提取滤波周期内活跃航迹的状态向量、误差协方差矩阵,以及标记有传感器参与状态的融合源标识位掩码;
44、对预设帧数的航迹状态序列执行固定区间平滑,输出平滑后的位置序列与速度序列;
45、基于协方差矩阵的迹与残差白化检验计算航迹置信度评分,输出包含所述位置序列、所述速度序列与所述航迹置信度评分的结构化融合航迹信息。
46、进一步的,所述雷达传感器和所述光电传感器均包括多台;
47、所述步骤s4中,所述执行第一步滤波更新,具体包括:
48、将多台所述雷达传感器的测距感知结果按时间戳先后顺序依次输入滤波器,逐个独立执行测距维度的预测与更新;
49、所述步骤s5中,所述执行第二步滤波更新,具体包括:
50、将多台所述光电传感器的非测距感知结果按时间戳先后顺序依次输入滤波器,且每次执行更新前,独立将当前状态估计转换至对应光电传感器的方位坐标系并重新计算对应的雅可比矩阵,逐个独立执行角度维度的状态修正。
51、第二方面,本技术提供了一种低空异构传感器信号融合系统,用于执行第一方面所述的低空异构传感器信号融合方法,包括:
52、数据获取模块,用于获取雷达传感器输出的测距感知结果和光电传感器输出的非测距感知结果;其中,所述测距感知结果包含目标的三维位置信息,所述非测距感知结果仅包含目标的二维角度信息,缺失距离维度;
53、时空统一模块,用于对所述测距感知结果和所述非测距感知结果执行时间戳对齐,并将不同坐标系下的感知结果统一转换至全局地理坐标系;
54、关联匹配模块,用于将转换后的所述测距感知结果中的雷达点迹与已有航迹进行关联匹配,获得关联成功的匹配对;
55、第一滤波模块,用于基于序贯扩展卡尔曼滤波框架,利用所述匹配对中的测距感知结果对所述已有航迹执行第一步滤波更新,得到包含距离约束的临时状态估计;
56、第二滤波模块,用于将所述临时状态估计中的目标位置转换至所述光电传感器的方位坐标系,以计算非线性角度观测方程关于状态变量的雅可比矩阵;基于所述雅可比矩阵,利用所述匹配对中的非测距感知结果的角度残差对所述临时状态估计执行第二步滤波更新,实现异构信息的缺维滤波融合,得到目标的最终状态估计。
57、第三方面,本技术提供了一种终端,包括:
58、存储器,用于存储低空异构传感器信号融合程序;
59、处理器,用于执行所述低空异构传感器信号融合程序时实现如第一方面所述低空异构传感器信号融合方法的步骤。
60、第四方面,本技术提供了一种计算机可读存储介质,所述存储介质存储计算机指令,当计算机读取存储介质中的计算机指令后,计算机执行如第一方面所述低空异构传感器信号融合方法。
61、通过以上技术方案可以看出,本发明的优点为:
62、通过获取不同维度的异构传感器感知结果,并基于序贯扩展卡尔曼滤波框架分步执行针对测距感知结果的第一步滤波更新与针对非测距感知结果的第二步滤波更新,实现了三维距离约束与二维角度信息的协同处理,解决了异构传感器因观测维度不一致而难以直接构造扩维观测矩阵进行集中融合的技术障碍。
63、通过将雷达极坐标观测值转换为笛卡尔空间坐标,并基于一阶泰勒展开利用雅可比矩阵计算等效测量协方差矩阵,实现了测量噪声在不同坐标系转换过程中的客观传播,为后续的滤波更新提供了符合统计学特征的可靠误差协方差基准。
64、通过计算融合了航迹预测协方差与测量噪声的马氏距离,并应用km二分图最优匹配算法在关联代价矩阵中求解全局最优匹配对,实现了多目标场景下雷达点迹与已有航迹的全局最优分配,降低了目标密集或交叉时的错误关联率。
65、通过设定第一步滤波更新的具体卡尔曼增益计算公式,以及基于空间相对位移推导非线性角度观测方程雅可比矩阵的第二步更新公式,实现了异构缺维数据序贯融合在底层数学计算层面的逻辑闭环,保证了系统状态估计的具体可实施性与数值运算的稳定性。
66、通过在仅存在二维角度观测向量时执行纯角度卡尔曼滤波更新,并对更新后的协方差矩阵中对应距离方向的对角元分量施加膨胀因子,实现了目标缺失雷达测距信息时的航迹连续追踪,并合理反映了单站纯角度跟踪下距离维度不确定性的自然累积,防止了滤波器的数值发散。
67、通过对预设帧数的活跃航迹状态序列执行固定区间平滑,并基于协方差矩阵的迹与残差白化检验结果计算航迹置信度评分,实现了融合航迹输出平滑度的进一步提升,能够向上层系统输出带有明确质量量化评估结果的结构化航迹数据。
68、通过将多台雷达和多台光电传感器的感知结果按时间戳先后顺序依次输入滤波器,并逐个独立完成坐标转换与相应的维度状态修正,实现了多传感器组网环境下的分布式流水线融合,能够支持监视网络中传感器节点的动态灵活增减。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com