基于高斯-牛顿四元数描述符滤波器的姿态估计算法

• 作者: 全闻捷 周绍磊 戴洪德 王瑞 贾临生
• 来源期刊: 传感技术学报
• 学科: 交通运输
• 关键词: 惯性导航 姿态估计 四元数描述符滤波器 高斯-牛顿迭代法 行人导航
• 年，卷（期）: 2020,（11）
• 所属期刊栏目: 传感器信号处理
• 页码范围: 1627-1636
• 页数: 10页
• 分类号: U666.1|V249.3
• 语种: 中文
• DOI: 10.3969/j.issn.1004-1699.2020.11.015

摘要

姿态解算是进行导航解算的基础,姿态的估计精度会直接影响最终的导航精度,在惯性行人导航中,足部的运动加速度变化剧烈,导致常见的姿态估计算法精度下降,针对这一问题,本文提出了一种改进型四元数描述符滤波器.算法采用高斯-牛顿迭代法对姿态四元数和载体运动加速度进行估计,取代了原四元数描述符滤波器中的加权最小二乘法,避免了计算加权矩阵及其求逆运算.该算法通过简化量测方程,减小状态量和状态转移矩阵的维数,使结构更加简单,运算量更小,经过实验验证,算法在计算机上运行的时间开销减小31.3％.由于该算法保留了非线性项,避免了运动加速度噪声干扰,使得姿态解算精度提高了12％.在行人导航系统中对该算法的有效性进行了实验验证.