[发明专利]一种组合导航滤波方法在审
申请号: | 202110249805.X | 申请日: | 2021-03-08 |
公开(公告)号: | CN113048979A | 公开(公告)日: | 2021-06-29 |
发明(设计)人: | 蔡逸豪;李帅;王潜心;胡永锋 | 申请(专利权)人: | 中国矿业大学 |
主分类号: | G01C21/20 | 分类号: | G01C21/20 |
代理公司: | 湖南天地人律师事务所 43221 | 代理人: | 杨萍 |
地址: | 221116 江苏*** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 组合 导航 滤波 方法 | ||
1.一种组合导航滤波方法,其特征在于,包括以下步骤:
步骤1、针对非线性环境,建立组合导航模型,包括组合导航系统的状态方程及量测方程,其中状态函数和量测函数均为非线性函数;
步骤2、运用改进的强跟踪UKF算法对组合导航模型的参数进行滤波,其中改进的强跟踪UKF算法基于输出残差序列的协方差矩阵、非线性状态函数和量测函数的雅克比矩阵计算渐消因子τk;再结合渐消因子τk更新增益矩阵Kk,状态向量的估计值和协方差矩阵Pk。
2.根据权利要求1所述的组合导航滤波方法,其特征在于:所述步骤2中,渐消因子τk计算公式如下:
其中,Vk为输出残差序列Δk/k-1的协方差矩阵,输出残差序列其中zk为组合导航系统的量测向量,为量测向量的估计值;Φk/k-1和Hk分别为非线性状态函数和量测函数的雅克比矩阵,tr[]为矩阵的迹,Rk为量测噪声的正定方差矩阵;τ0,k为中间变量。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国矿业大学,未经中国矿业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110249805.X/1.html,转载请声明来源钻瓜专利网。