一种基于磁传感器和加表的航姿系统陀螺误差补偿方法技术方案

本发明专利技术公开了一种基于磁传感器和加表的航姿系统陀螺误差补偿方法，其特征在于，包括如下步骤：(1)根据磁强计的输出信息计算陀螺漂移误差补偿量；(2)根据加表实时测得的载体加速度信息获得陀螺漂移误差量；(3)建立陀螺误差补偿量求取模型，求取陀螺补偿误差；(4)建立陀螺输出误差补偿模型对陀螺输出数据进行误差补偿。本发明专利技术解决了由陀螺精度低、姿态解算随时间漂移，不能满足系统稳定应用的问题，可以有效抑制陀螺漂移，提高航姿系统姿态稳定性；具有较高的工程化应用价值和推广价值。

A gyro error compensation method of attitude system based on magnetic sensor and adding table

【技术实现步骤摘要】
一种基于磁传感器和加表的航姿系统陀螺误差补偿方法
本专利技术属于惯性导航
，具体涉及一种基于磁传感器和加表的航姿系统陀螺误差补偿方法。
技术介绍
在惯性导航系统中，陀螺和加速度计(加表)的信息的漂移处理直接关系到载体导航的姿态的精度和稳定性，而姿态精度是反映载体运动的一个重要参数，其精度和稳定性对载体的速度、位置结算、目标识别跟踪、等有重要影响。通常姿态解算是根据陀螺的数据和载体的速度、位置信息实时计算载体姿态矩阵更新和姿态解算。但是由于陀螺的漂移误差会随着时间的增加不断的积累增大，尤其是低成本的MEMS陀螺漂移误差更大，使系统的姿态解算精度越来越低，因此陀螺误差漂移补偿在实际工程应用中起着重要作用。
技术实现思路
针对现有技术以上缺陷或改进需求中的至少一种，本专利技术提供了一种基于磁传感器和加表的航姿系统陀螺误差补偿方法，旨在解决现有技术中由于中低精度陀螺精度低、漂移误差大导致姿态解算精度差的技术问题，可以有效抑制陀螺漂移，提高航姿系统姿态稳定性；具有较高的工程化应用价值和推广价值。为实现上述目的，按照本专利本文档来自技高网...

【技术保护点】
1.一种基于磁传感器和加表的航姿系统陀螺误差补偿方法，其特征在于，包括如下步骤：/n(1)根据磁强计的输出信息计算陀螺漂移误差补偿量Δω(t)

【技术特征摘要】
1.一种基于磁传感器和加表的航姿系统陀螺误差补偿方法，其特征在于，包括如下步骤：
(1)根据磁强计的输出信息计算陀螺漂移误差补偿量Δω(t)h；
(2)根据加表实时测得的载体加速度信息获得陀螺漂移误差量Δω(t)a；
(3)求取陀螺陀螺漂移总误差Δω(t)g＝Δω(t)h+Δω(t)a，根据Δω(t)g求取第一误差补偿调节量ΔωP(t)和第二误差补偿调节量ΔωI(t)；建立陀螺误差补偿量求取模型Δω(t)PI＝ΔωP(t)+ΔωI(t)，从而获得陀螺误差漂移补偿量Δω(t)PI；
(4)建立陀螺输出误差补偿模型ω(t)＝ωg(t)+Δω(t)PI，根据所述陀螺误差补偿量对陀螺输出数据进行误差补偿。


2.如权利要求1所述的基于磁传感器和加表的航姿系统陀螺误差补偿方法，其特征在于：
步骤(1)具体包括：
(1.1)选择东北天地理坐标系作为导航坐标系，通过磁强计获得载体系下的磁场强度信息其中分别为载体在X轴、Y轴、Z轴的磁场强度信息；
(1.2)根据公式求取地理坐标系下的磁场强度信息，为初始化得到的姿态矩阵；
(1.3)根据公式对地理坐标系下的磁场强度信息进行标准化；
(1.4)根据公式求取地理坐标系下的磁场强度信息在载体坐标系下的标准投影，为初始化得到的姿态矩阵；
(1.5)将步骤(1.1)中的载体磁场强度信息与步骤(1.4)中的标准磁场强度投影进行叉乘后，获得磁传感器求取的陀螺漂移误差量其中Δω(t)t为根据磁场强度求取的陀螺漂移误差量；为磁强计获得载体系下的磁场强度信息为；ht地理坐标系下的磁场强度信息在载体坐标系下的标准投影。


3.如权利要求1-2任一项所述的基于磁传感器和加表的航姿系统陀螺误差补偿方法，其特征在于：
步骤(2)具体包括：
(2.1)选择东北天地理坐标系作为导航坐标系并获得载体加速度信息其中axayaz分别为东北天地理坐标系下载体在X轴、Y轴、Z轴的加速度；
(2.2)根据公式将所述载体的三维加速度信息转换为单位向量，其中|fib|获得所述载体的三维加速度的模值；
(2.3)根据公式将重力在东北天地理坐标系下的投...

【专利技术属性】
技术研发人员：翁海诠，陈薇，余俊延，潘静，郑磊，陈哲，彭宏韬，
申请(专利权)人：湖北三江航天红峰控制有限公司，
类型：发明
国别省市：湖北;42