一种基于变分迭代卡尔曼滤波的李群重尾干扰噪声动态飞行器姿态估计方法

基本信息

申请号 CN202110982644.5 申请日 -
公开(公告)号 CN113670315A 公开(公告)日 2021-11-19
申请公布号 CN113670315A 申请公布日 2021-11-19
分类号 G01C21/20(2006.01)I;G06F17/15(2006.01)I;G06F17/16(2006.01)I 分类 测量;测试;
发明人 李文荣;曲金慧;王蛟龙;韩楚楚;段一铭 申请(专利权)人 无锡北微传感科技有限公司
代理机构 哈尔滨市阳光惠远知识产权代理有限公司 代理人 张勇
地址 214000 江苏省无锡市滨湖区绣溪路58-30
法律状态 -

摘要

摘要 本发明提供一种基于变分迭代卡尔曼滤波的李群重尾干扰噪声动态飞行器姿态估计方法。包括以下步骤:步骤一、建立系统在李群特殊正交群上的姿态动力学模型;步骤二、将系统李群动态模型映射到欧氏几何空间;步骤三、基于观测数据定义重尾噪声中个参数的先验分布函数;步骤四、对重尾噪声的概率密度函数进行变分贝叶斯近似;步骤五、定点迭代求解系统状态与概率密度函数的分布参数;步骤六、将步骤五中的各个参数带入步骤四中进行计算,得到噪声的后验概率密度函数近似值。该方法很好地解决了系统在重尾噪声干扰下的李群姿态估计问题。