[发明专利]一种用于着陆雷达的高精度不敏卡尔曼滤波方法在审
申请号: | 202211449714.1 | 申请日: | 2022-11-18 |
公开(公告)号: | CN115712103A | 公开(公告)日: | 2023-02-24 |
发明(设计)人: | 王颖;孙武;刘佳;刘海欣;贾学振;王怡;陈睿容;丁凯生 | 申请(专利权)人: | 北京遥感设备研究所 |
主分类号: | G01S7/41 | 分类号: | G01S7/41 |
代理公司: | 中国航天科工集团公司专利中心 11024 | 代理人: | 张国虹 |
地址: | 100854*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 用于 着陆 雷达 高精度 不敏 卡尔 滤波 方法 | ||
1.一种用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,包括:
确定初始时刻的不敏卡尔曼滤波参数;
根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量;
根据当前采样点的状态参量,计算状态更新结果;所述状态更新结果为:状态更新方程非线性传递后的采样点的均值和协方差;
根据状态更新结果,计算观测更新结果;所述观测更新结果为:观测更新方程传递后的采样点的均值和协方差;
基于状态更新结果和观测更新结果,计算下一时刻的不敏卡尔曼滤波参数。
2.根据权利要求1所述的用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,所述不敏卡尔曼滤波参数包括:状态估计值和状态估计协方差矩阵;
确定初始时刻的不敏卡尔曼滤波参数,具体包括如下步骤:
初始时刻的状态估计值为其中x0是初始状态向量估计值;
初始时刻的状态估计协方差矩阵为
定义增广状态向量为则其中Pv是过程噪声协方差、Pn为观测噪声协方差。
3.根据权利要求1所述的用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量,包括:
当前采样点的状态参量为
其中,L是增广状态向量的维度,W0为权重。
4.根据权利要求1-3任一项所述的用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,根据当前采样点的状态参量,计算状态更新结果,具体包括如下步骤:
将当前采样点的状态参量代入状态更新方程进行计算,获得状态更新结果。
5.根据权利要求4所述的用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,所述状态更新方程为:
其中F[]为状态更新方程,上标x、v分别表示系统状态和过程噪声;
其中,
6.根据权利要求5所述的用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,Wi和χi满足如下关系:
7.根据权利要求5所述的用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,根据状态更新结果,计算观测更新结果,具体包括如下步骤:
将状态更新结果代入观测更新方程进行计算,获得观测更新结果。
8.根据权利要求7所述的用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,所述观测更新方程为:
9.根据权利要求8所述的用于着陆雷达的高精度不敏卡尔曼滤波方法,其特征在于,基于状态更新结果和观测更新结果,计算下一时刻的不敏卡尔曼滤波参数,具体包括如下步骤:
卡尔曼增益为
状态估计值为
状态估计协方差矩阵为
10.一种用于着陆雷达的高精度不敏卡尔曼滤波系统,其特征在于,包括:
初始化模块,用于确定初始时刻的不敏卡尔曼滤波参数;
采样点计算模块,用于根据当前时刻的不敏卡尔曼滤波参数计算当前采样点的状态参量;
状态更新模块,用于根据当前采样点的状态参量,计算状态更新结果;所述状态更新结果为:状态更新方程非线性传递后的采样点的均值和协方差;
观测更新模块,用于根据状态更新结果,计算观测更新结果;所述观测更新结果为:观测更新方程传递后的采样点的均值和协方差;
数据同化模块,用于基于状态更新结果和观测更新结果,计算下一时刻的不敏卡尔曼滤波参数。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京遥感设备研究所,未经北京遥感设备研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202211449714.1/1.html,转载请声明来源钻瓜专利网。