专利名称：一种基于陀螺、地磁传感器的惯性测量装置的制作方法
技术领域：
本发明属于高速旋转弹姿态测量领域，具体涉及一种基于陀螺、地磁传感器的惯性测量装置。
背景技术：
在现代战争中，精确打击是大势所趋，世界各国一方面努力发展新的制导弹药，一 方面也在努力将大量的常规弹药改造成灵巧弹药，使其具有精确打击能力。高速旋转是常 规弹药最常用的稳定方式之一，获得高速旋转弹丸的姿态信息是对其进行改造的必由之 路。因此，设计适用于高速旋转、小体积的惯性测量系统就显得尤为重要，在传统惯性测量 系统中，常利用线加速度计测量物体的加速度，利用陀螺测量物体的角速度。但由于传统的 加速度计存在安装复杂、安装精度要求高、解算复杂等问题，这里舍弃了加速度计作为惯性 器件，采用大量程MEMS陀螺。陀螺虽然能连续输出角速度信息，但存在漂移，长期应用会产 生较大的偏差；而薄膜线圈传感器的短期精度不如惯性器件，但它具有不随飞行时间而累 积误差，高精度、高响应度、微小体积等、可靠性高诸多优点，是其成为目前研究比较多的导 航器件，与其它惯性器件组合能准确地确定飞行体的姿态角信息，可以提高系统的整体导 航精度及导航性能。因此本发明采用状态估计法，姿态确定系统以薄膜线圈传感器的输出 做为姿态基准，以薄膜线圈传感器的输出对陀螺漂移进行校正，并采用较精确的广义卡尔 曼滤波算法提高姿态确定的精度，最后对其效果进行了仿真、分析。本发明提出了一种适用于高速旋转、小体积的惯性导航系统的姿态测量，其目的 在于充分利用薄膜线圈、陀螺传感器的优点，克服单一方法算法解算姿态角所存在的不足 之处，提出了一种全新的三维姿态测量方法，并采用较精确的广义卡尔曼滤波算法提高姿 态确定的精度，本发明满足小尺寸姿态测量的需要，又该方法设计出的三维姿态测量系统 具有可靠性高、成本低、操作方便等特点。

发明内容
本发明提供了一种基于陀螺、地磁传感器的惯性测量装置，解决了传统惯性测量 利用加速度计存在的安装复杂、安装精度要求高、解算复杂和单独利用陀螺仪测量存在精 度受陀螺角速率漂移的影响以及单独利用薄膜式地磁传感器不能连续三轴定姿的问题，并 在此基础上结合了广义卡尔曼滤波估计算法，对于研究惯性组合导航系统，提高高速旋转 弹的姿态信息具有重要意义和实际应用价值。本发明可通过以下技术方案实现一种基于陀螺、地磁传感器的惯性测量装置，包 括陀螺和地磁传感器，陀螺采用三轴MEMS陀螺，地磁传感器采用两个薄膜式地磁传感器。 薄膜式地磁传感器采用薄膜线圈传感器，薄膜线圈传感器为一个η匝线圈的电磁感应薄膜 式线圈。一种基于陀螺、地磁传感器的惯性测量装置设在圆柱形非铁质性材料的金属筒 内，金属筒内设有三轴MEMS陀螺，三轴MEMS陀螺由陀螺面1、陀螺面3和陀螺面4组成，金属筒的外壁上设有薄膜式地磁传感器，薄膜式地磁传感器由薄膜线圈传感器2和薄膜线圈 传感器5组成，薄膜线圈传感器2垂直于薄膜线圈传感器5。—种基于陀螺、地磁传感器的惯性测量装置测量的姿态参数解算方法采用广义卡 尔曼滤波姿态估计算法，将精度较高的薄膜式地磁传感器的输出作为姿态测量基准，用来 修正三轴MEMS陀螺的误差，利用三轴MEMS陀螺弥补薄膜式地磁传感器定姿存在实时性差 的缺点，同时为了避免由非线性和小角度引起的计算误差，采用四元数法代替通常的欧拉 角法进行计算，经分析得到该系统状态模型和观测模型。本发明与现有技术相比具有以下有益效果1、本发明舍弃了传统的惯性导航系统采用加速度计作为惯性器件的作法，而是采 用了三轴MEMS陀螺进行角速度测量，三轴MEMS陀螺可以连续输出角速度信号，它具有动 态范围高、可靠性高、启动时间短、低成本等优点。2、本发明首先将薄膜式地磁传感器引入姿态测量，作为辅助手段，将精度较高的 薄膜式地磁传感器的输出作为姿态测量基准，用来修正三轴MEMS陀螺的误差，同时利用三 轴MEMS陀螺弥补薄膜式地磁传感器定姿存在实时性差的缺点。薄膜式地磁传感器结构简 单、尺寸小、能抗高过载和冲击，信号检测电路灵敏度高，工作稳定、可靠、性能价格比高。3、本发明结合了广义卡尔曼滤波姿态估计算法，在不增加硬件成本的情况下，提 高系统精度和可靠性。4、本发明提出的这种适用于高速旋转、小体积的惯性测量装置，具有可靠性高、成 本低、操作方便的特点。
四

图1为本发明的结构示意图，图2是高速旋转弹姿态确定系统工作图，图3是姿态解算框图。
五具体实施例方式下面结合附图通过实施例进一步详述。一种基于陀螺、地磁传感器的惯性测量装置设在圆柱形铝性材料的金属筒内，金 属筒内设有三轴MEMS陀螺，三轴MEMS陀螺由陀螺面1、陀螺面3和陀螺面4组成，金属筒的 外壁上设有薄膜式地磁传感器，薄膜式地磁传感器由薄膜线圈传感器2和薄膜线圈传感器 5组成，薄膜线圈传感器2垂直于薄膜线圈传感器5。三轴MEMS陀螺安装在姿态测试系统的正交平面上，它们的敏感轴互相垂直，组成 测量体的三维坐标系，如图1所示，GX、GY、GZ分别是MEMS陀螺仪Gl的三个敏感轴，坐标原 点0位于高速旋转弹的几何中心，GX、GY、GZ三轴的方向与高速旋转弹的弹体坐标系保持一 致，而两片薄膜线圈传感器垂直贴在金属筒的两个面上。测量弹体的速度在10r/S以上，利 用该系统可以精确地测量高速旋转弹在各个时刻的三维姿态信息。首先采样三轴MEMS陀螺输出的角速度信号，根据实际情况建立角速度数学模型，利用四元数法解算出一组四元数值；然后采样薄膜线圈传感器输出的转速信号并将其转换 成角速度信号，将薄膜线圈传感器的输出作为姿态测量基准，用来修正三轴MEMS陀螺的误差，同时利用三轴MEMS陀螺弥补薄膜线圈传感器定姿实时性差的缺点，最后采用广义卡尔曼姿态估计算法对两组四元数值进行融合融合，得到一组更为精确的四元数值。本发明在 不增加硬件成本的情况下，提高系统精度和可靠性，并且还能提供统计的姿态确定最优解， 估计出参考矢量和观测矢量中的一些不确定因素。然后通过计算机处理传感器的输出信号和运算出测量结果，并对测试系统进行仿 真、分析，最后得到所需要的姿态角。1、陀螺测量方程陀螺仪又称角速度计可以用来检测旋转的角速度和角度。利用陀螺仪测量载体旋 转的角速度，是根据牛顿惯性定律的原理进行测量的。陀螺三个轴输出随弹体各轴向角速 率变化而变化的电压信号，得到一组弹体的角速度信息。陀螺测量模型是姿态确定算法建 模中的一个重要问题，在定姿滤波设计中，通常采用的陀螺测量模型如下 (Oi为陀螺的测量输出，Coi e R3xi ； ω为高速旋转弹相对惯性空间在本体系上 的坐标，ω e R3xi，d为陀螺漂移中的指数相关部分，d e R3xi ；b为陀螺常值漂移部分， be R3X1; Iii为陀螺的测量噪声，Ili GR3xi，通常假定Ili为白噪声。2、薄膜线圈传感器测量方程薄膜线圈传感器测姿是通过安装两个平面夹角为θ的线圈(线圈平面沿飞行体 纵轴)随高速旋转弹旋转时，线圈切割地磁场磁力线，磁通量发生变化而产生感应电动势。 根据线圈初始相位，当飞行体偏离基准线时，感应电动势的大小和方向发生周期性变化，测 量电路记录下每一瞬时的感应电动势值，通过解算得到飞行体的空间姿态角。根据法拉第 电磁感应定律，线圈中产生的感应电动势 由上式可知，由薄膜线圈传感器测得的电压信息可以得到高速旋转弹的转速和角 速度信息。ω = [ωχ，coy，ωζ]τ是薄膜线圈传感器相对惯性坐标系的转动角速度。单独利 用薄膜线圈传感器不能连续三轴定姿，但可以利用轨道运动断续获取三轴姿态，但是单独 利用薄膜线圈传感器定姿应用上有一定的局限性，通常将薄膜线圈传感器与陀螺组合进行 定姿。将较高精度的薄膜线圈传感器的输出作为姿态测量基准，用来修正陀螺的误差。3、四元数微分方程求解。将步骤1、2的结果代入四元数微分方程在用姿态矩阵表示高速旋转弹姿态时，欧拉角表示法是经典的姿态描述法，但在 求解方向余弦时要引入六个约束方程，计算量较大，而且欧拉角式需要多次三角运算，并伴 有奇点问题。因此本发明采用四元数法代替欧拉角法。四元数法中的欧拉参数与方向余弦 阵相比，仅含四个变量和一个约束方程；与欧拉轴/角参数式相比，姿态矩阵的元素不含三 角函数，可以求得实现姿态向期望姿态机动的姿态机动参数，从而得出欧拉轴的方向和转 角，能更简便地得出将初始状态趋于期望姿态所需的姿态机动四元数，并避免了欧拉角法 引起的大角度奇异问题。四元数微分方程如下所示
q=1/2qw或q= bvq
(2)
(3)如、1、％、七为四个实数，利用毕卡逼近法求解(3)式可得到转动四元数q，将步骤 1、2解算到得两组角速度代入公式(3)中便可以求的两组四元数的值。4、广义卡尔曼滤波进行信息融合卡尔曼滤波器提供了一种高效可靠计算的方法来估计过程的状态，并使估计均方 误差最小。它可以估计信号的过去和当前状态，甚至能估计将来的状态，即使并不知道模型 的确切性质。在高速旋转弹姿态确定中，由于系统方程是非线性的，状态估计的非线性滤波 具有重要的地位，大部分姿态确定算法，都是基于状态估计的非线性滤波思想。广义卡尔曼 滤波(EKF)是应用最广泛的非线性估计方法，通过对非线性状态方程和测量方程的线性化 处理，然后按照线性化方程滤波的思想进行滤波。这里将姿态四元数χ = (q0, Q1, Q2, Q3)作为状态变量，将由陀螺仪的输出角速度数 据解算到得四元数作为状态方程，薄膜线圈传感器的输出角速度数据解算到得四元数作为 观测方程。然后将这组数据利用广义卡尔曼滤波方程进行信息融合，解算得到一组更为准 确的四元数值。在卡尔曼滤波实验中，由于输出数据很大程度受噪声的影响，使数据的测量 精度变低，为了有效的利用卡尔曼滤波器，使其能达到预期的效果，往往需要对状态变量做 一些事先和事后的处理，以便于更好地利用MATLAB卡尔曼滤波器。在本研究中，采用的是 利用实验，测量出一组较为精确的噪声方程，将其加载状态方程中，这样会使测量数据的精 度提高。5、姿态角求解利用步骤4所求得的四元数值可以得到姿态矩阵T，将姿态矩阵中的对应元素代 入公式⑷便可以求得姿态角，公式⑷中的Τ32、τ31、τ21和T11代表的是姿态矩阵T中的对 应元素值。
权利要求
一种基于陀螺、地磁传感器的惯性测量装置，其特征在于包括陀螺和地磁传感器，陀螺采用三轴MEMS陀螺，地磁传感器采用两个薄膜式地磁传感器。
2.根据权利要求1所述的一种基于陀螺、地磁传感器的惯性测量装置，其特征在于薄 膜式地磁传感器采用薄膜线圈传感器，薄膜线圈传感器为一个η匝线圈的电磁感应薄膜式 线圈。
3.根据权利要求1或2所述的一种基于陀螺、地磁传感器的惯性测量装置，其特征在 于一个圆柱形非铁质性材料的金属筒内设有三轴MEMS陀螺，三轴MEMS陀螺由陀螺面1、 陀螺面3和陀螺面4组成，金属筒的外壁上设有薄膜式地磁传感器，薄膜式地磁传感器由薄 膜线圈传感器2和薄膜线圈传感器5组成，薄膜线圈传感器2垂直于薄膜线圈传感器5。
全文摘要
本发明公开了一种基于陀螺、地磁传感器的惯性测量装置，该装置由一个三轴MEMS陀螺和两个薄膜式地磁传感器组成。利用薄膜式地磁传感器不随飞行时间而累积误差的特点，与惯性器件三轴MEMS陀螺进行组合设计，本发明采用状态估计法，姿态确定系统将精度较高的薄膜式地磁传感器作为姿态测量基准，对三轴MEMS陀螺漂移进行校正，并采用较精确的广义卡尔曼滤波算法提高姿态确定的精度。本发明同时具有体积小、重量轻、成本低的特点，可应用于高速旋转弹姿态测量领域。
文档编号G01C21/16GK101839719SQ20101017699
公开日2010年9月22日 申请日期2010年5月16日 优先权日2010年5月16日
发明者崔敏, 曹咏弘, 范锦彪, 马铁华 申请人:中北大学