【技术实现步骤摘要】
一种基于地磁场自适应修正的航姿系统姿态解算方法
本专利技术涉及一种基于地球重力场与地磁场自适应修正的姿态解算方法，属于定位导航
技术介绍
MEMS传感器(陀螺仪，加速度计，磁力计)在移动设备领域使用越来越普及，具有成本低、集成度高以及体积小等优点，但是在进行姿态解算时，却存在输出噪声过大、零点漂移无法完全消除、角速率输出易受干扰等问题。因此，通常情况下，需要采用多个传感器通过信息融合算法实现高精度的姿态解算。航姿系统(AHRS)传感器在姿态解算过程中，一般采用基于四元数的互补滤波算法和扩展卡尔曼滤波算法来解决上述问题，但目前在基于四元数的互补滤波算法和扩展卡尔曼滤波算法中，对于环境中的软磁干扰问题都是直接利用世界地磁模型进行修正，忽略了实际中可能会出现的磁异常对姿态解算的影响。
技术实现思路
针对现有技术存在的：(1)当仅仅使用陀螺仪与加速度数据时，解算的姿态角存在累积误差；(2)引入磁力计数据时，由于环境中的磁干扰会对磁测量产生影响，出现航向姿态输出噪声过大、姿态解算精度降低等问题。本专利技术提出一种基于地磁场自适应修正的航姿系统姿态解算方法，在引入地磁场...
【技术保护点】
1.一种基于地磁场自适应修正的航姿系统姿态解算方法，其特征在于：采用自适应扩展卡尔曼滤波算法进行航姿系统姿态解算，其中状态方程为：Xk＝Φk/k‑1αXk‑1+Wk‑1量测方程为：Zk＝HkXk+Vk其中Xk为tk时刻的状态向量，Zk为tk时刻的量测向量，Φk/k‑1为tk‑1时刻至tk时刻的状态转移矩阵，Hk为量测矩阵，Vk为量测噪声，Wk‑1为系统噪声，系统噪声协方差矩阵为Qk‑1，量测噪声协方差矩阵为Rk；α为自适应矩阵；采用以下步骤计算状态转移矩阵、量测矩阵、系统噪声协方差矩阵、量测噪声协方差矩阵和自适应矩阵：状态转移矩阵采用公式
【技术特征摘要】
1.一种基于地磁场自适应修正的航姿系统姿态解算方法，其特征在于：采用自适应扩展卡尔曼滤波算法进行航姿系统姿态解算，其中状态方程为：Xk＝Φk/k-1αXk-1+Wk-1量测方程为：Zk＝HkXk+Vk其中Xk为tk时刻的状态向量，Zk为tk时刻的量测向量，Φk/k-1为tk-1时刻至tk时刻的状态转移矩阵，Hk为量测矩阵，Vk为量测噪声，Wk-1为系统噪声，系统噪声协方差矩阵为Qk-1，量测噪声协方差矩阵为Rk；α为自适应矩阵；采用以下步骤计算状态转移矩阵、量测矩阵、系统噪声协方差矩阵、量测噪声协方差矩阵和自适应矩阵：状态转移矩阵采用公式计算得到，其中I为单位矩阵，Δθ根据公式确定，ΔΘ根据公式得到，其中为航姿系统中传感器输出的载体坐标系B下的载体角速度信息；量测矩阵采用公式计算得到，其中a为在载体坐标系B中测量的重力加速度矢量，g为在全局坐标系G中测量的重力加速度矢量，并采用零标量的四元数方式表示矢量g与a...
【专利技术属性】
技术研发人员：刘明雍，宋保维，郭娇娇，牛云，刘禄，王梦凡，雷罡，李赛楠，杨扬，向举苗，王录，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西,61
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。