一种用于着陆雷达的高精度不敏卡尔曼滤波方法技术

本发明专利技术公开了一种用于着陆雷达的高精度不敏卡尔曼滤波方法，该方法包括如下步骤：确定初始时刻的不敏卡尔曼滤波参数；根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量；根据当前采样点的状态参量，计算状态更新结果；根据状态更新结果，计算观测更新结果；基于状态更新结果和观测更新结果，计算下一时刻的不敏卡尔曼滤波参数。本发明专利技术对着陆过程中的类正弦非线性、高动态运动模型进行速度滤波处理，解决了高动态条件下的滤波精度变差甚至发散的问题；本发明专利技术的技术方案具有滤波精度高、高动态条件下自适应调整能力强、可靠性高和实时性强的优点。高和实时性强的优点。高和实时性强的优点。

【技术实现步骤摘要】
一种用于着陆雷达的高精度不敏卡尔曼滤波方法


[0001]本专利技术属于着陆雷达
，尤其涉及一种用于着陆雷达的高精度不敏卡尔曼滤波方法。

技术介绍

[0002]目前用于着陆雷达的数据滤波方法主要采用卡尔曼(Kalman)滤波。但Kalman滤波只适用于线性问题，对于着陆过程中周期为1～3s的速度类正弦模型等高动态、非线性问题，Kalman滤波性能明显变差，严重时会导致滤波发散。

技术实现思路

[0003](一)要解决的技术问题
[0004]本专利技术的目的在于提出一种用于着陆雷达的高精度不敏卡尔曼滤波方法，以解决目前的数据滤波方法在高动态、非线性条件下滤波性能差的技术问题。
[0005](二)技术方案
[0006]本专利技术实施例的第一方面，提出一种用于着陆雷达的高精度不敏卡尔曼滤波方法，包括：
[0007]确定初始时刻的不敏卡尔曼滤波参数；
[0008]根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量；
[0009]根据当前采样点的状态参量，计算状态更新结果；所述状态更新结果为：状态更新方程非线性传递后的采样点的均值和协方差；
[0010]根据状态更新结果，计算观测更新结果；所述观测更新结果为：观测更新方程传递后的采样点的均值和协方差；
[0011]基于状态更新结果和观测更新结果，计算下一时刻的不敏卡尔曼滤波参数。
[0012]进一步地，所述不敏卡尔曼滤波参数包括：状态估计值和状态估计协方差矩阵；
[0013]确定初始时刻的不敏卡尔曼滤波参数，具体包括如下步骤：
[0014]初始时刻的状态估计值为其中x0是初始状态向量估计值；
[0015]初始时刻的状态估计协方差矩阵为
[0016]定义增广状态向量为则其中P
v
是过程噪声协方差、P
n
为观测噪声协方差。
[0017]进一步地，根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量，包括：
[0018]当前采样点的状态参量为
[0019]其中，L是增广状态向量的维度，W0为权重。
[0020]进一步地，根据当前采样点的状态参量，计算状态更新结果，具体包括如下步骤：
[0021]将当前采样点的状态参量代入状态更新方程进行计算，获得状态更新结果。
[0022]进一步地，所述状态更新方程为：
[0023]其中F[]为状态更新方程，上标x、v分别表示系统状态和过程噪声。
[0024][0025][0026]其中，i＝1,
…
2L。
[0027]进一步地，W
i
和χ
i
满足如下关系：
[0028][0029][0030]i＝L+1,
…
,2L。
[0031]进一步地，根据状态更新结果，计算观测更新结果，具体包括如下步骤：
[0032]将状态更新结果代入观测更新方程进行计算，获得观测更新结果。
[0033]进一步地，所述观测更新方程为：
[0034][0035][0036][0037][0038]进一步地，基于状态更新结果和观测更新结果，计算下一时刻的不敏卡尔曼滤波参数，具体包括如下步骤：
[0039]卡尔曼增益为
[0040]状态估计值为
[0041]状态估计协方差矩阵为
[0042]本专利技术实施例的第二方面，提出一种用于着陆雷达的高精度不敏卡尔曼滤波系统，包括：
[0043]初始化模块，用于确定初始时刻的不敏卡尔曼滤波参数；
[0044]采样点计算模块，用于根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量；
[0045]状态更新模块，用于根据当前采样点的状态参量，计算状态更新结果；所述状态更新结果为：状态更新方程非线性传递后的采样点的均值和协方差；
[0046]观测更新模块，用于根据状态更新结果，计算观测更新结果；所述观测更新结果为：观测更新方程传递后的采样点的均值和协方差；
[0047]数据同化模块，用于基于状态更新结果和观测更新结果，计算下一时刻的不敏卡尔曼滤波参数。
[0048](三)有益效果
[0049]本专利技术提出的一种用于着陆雷达的高精度不敏卡尔曼滤波方法，对着陆过程中的类正弦非线性、高动态运动模型进行速度滤波处理，解决了高动态条件下的滤波精度变差甚至发散的问题；本专利技术的技术方案具有滤波精度高、高动态条件下自适应调整能力强、可靠性高和实时性强的优点。
附图说明
[0050]图1是本专利技术一种用于着陆雷达的高精度不敏Kalman滤波方法流程图。
[0051]图2是本专利技术一种用于着陆雷达的高精度不敏Kalman滤波系统组成示意图。
具体实施方式
[0052]为了使本专利技术的目的、技术方案及有益效果更加清晰明确，下面结合附图及实施例，对本专利技术作进一步详细说明。有必要在此指出的是，此处所描述的具体实施方式仅仅用于进一步解释本专利技术，并不限定本专利技术的保护范围，本专利技术包括但不限于下述实施例。
[0053]如图1所示，本专利技术的实施例提出一种用于着陆雷达的高精度不敏卡尔曼滤波方法，包括如下步骤：
[0054]步骤S1、确定初始时刻的不敏卡尔曼滤波参数；
[0055]步骤S2、根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量；
[0056]步骤S3、根据当前采样点的状态参量，计算状态更新结果；所述状态更新结果为：状态更新方程非线性传递后的采样点的均值和协方差；
[0057]步骤S4、根据状态更新结果，计算观测更新结果；所述观测更新结果为：观测更新方程传递后的采样点的均值和协方差；
[0058]步骤S5、基于状态更新结果和观测更新结果，计算下一时刻的不敏卡尔曼滤波参数。
[0059]本专利技术提出的一种用于着陆雷达的高精度不敏卡尔曼滤波方法，对着陆过程中的类正弦非线性、高动态运动模型进行速度滤波处理，解决了高动态条件下的滤波精度变差甚至发散的问题；本专利技术的技术方案具有滤波精度高、高动态条件下自适应调整能力强、可
靠性高和实时性强的优点。
[0060]为了更清楚地解释本专利技术的方案，下面对各个步骤的具体执行细节进行扩展说明。
[0061]首先需要搭建用于着陆雷达的高精度不敏Kalman滤波处理系统，该系统包括：初始化模块、采样点计算模块、状态更新模块、观测更新模块、数据同化模块。
[0062]初始化模块完成不敏Kalman滤波参数的初始化。
[0063]采样点计算模块完成采样点集的计算。
[0064]状态更新模块根据上一步的采样点的状态参量，使用不敏变换计算状态方程非线性传递后的采样点的均值和协方差。
[0065]观测更新模块根据状态更新模块计算的状态均值和协方差，再次使用不敏变换计算观测方程传递后的采样点的均值和协方差。
[0066]本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于着陆雷达的高精度不敏卡尔曼滤波方法，其特征在于，包括：确定初始时刻的不敏卡尔曼滤波参数；根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量；根据当前采样点的状态参量，计算状态更新结果；所述状态更新结果为：状态更新方程非线性传递后的采样点的均值和协方差；根据状态更新结果，计算观测更新结果；所述观测更新结果为：观测更新方程传递后的采样点的均值和协方差；基于状态更新结果和观测更新结果，计算下一时刻的不敏卡尔曼滤波参数。2.根据权利要求1所述的用于着陆雷达的高精度不敏卡尔曼滤波方法，其特征在于，所述不敏卡尔曼滤波参数包括：状态估计值和状态估计协方差矩阵；确定初始时刻的不敏卡尔曼滤波参数，具体包括如下步骤：初始时刻的状态估计值为其中x0是初始状态向量估计值；初始时刻的状态估计协方差矩阵为定义增广状态向量为则其中P
v
是过程噪声协方差、P
n
为观测噪声协方差。3.根据权利要求1所述的用于着陆雷达的高精度不敏卡尔曼滤波方法，其特征在于，根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量，包括：当前采样点的状态参量为其中，L是增广状态向量的维度，W0为权重。4.根据权利要求1
‑
3任一项所述的用于着陆雷达的高精度不敏卡尔曼滤波方法，其特征在于，根据当前采样点的状态参量，计算状态更新结果，具体包括如下步骤：将当前采样点的状态参量代入状态更新方程进行计算，获得状态更新结果。5.根据权利要求4所述的用于着陆雷达的高精度不敏卡尔曼滤波方...

【专利技术属性】
技术研发人员：王颖，孙武，刘佳，刘海欣，贾学振，王怡，陈睿容，丁凯生，
申请(专利权)人：北京遥感设备研究所，
类型：发明
国别省市：