专利名称：一种基于微磁传感的定姿监测系统的制作方法
技术领域：
本实用新型涉及一种适用于任意运动微小型系统的定姿系统，尤其涉及一种基于 微磁传感的定姿监测系统。
背景技术：
磁传感器能够测量三个正交方向的磁场强度，为了换算为三维姿态信息，还必须 依赖其他手段，在微小型系统任意运动状态下确定三维磁传感器测量方向与当地水平面之 间的坐标转换关系，即必须预先确定横滚角和俯仰角。目前多数磁传感器定姿系统都依赖 加速度计或倾角传感器给出静态和勻速直线运动状态下的横滚角和俯仰角，而在其他机械 运动状态下磁传感器基本不能用。加速度计和倾角传感器是目前测量微小型系统横滚角和俯仰角最常用的方式，但 由于两种传感器均无法很好地区别微小型系统运动加速度和重力加速度，因此不能给出微 小型系统任意运动情况下的横滚角和俯仰角，只适合于静止和勻速直线运动的情况，而且 上述两种传感器均不能给出航向角。
实用新型内容针对上述技术中存在的不足之处，本实用新型提供一种保证了长时间工作情况下 微惯性测量单元MIMU模块的测量精度以及分解重力加速度在载体坐标系投影的精度，并 且提高了微小型系统位置、速度的测量精度的一种基于微磁传感的定姿监测系统。为实现上述目的，本实用新型提供一种基于微磁传感的定姿监测系统，系统本体 由微磁传感器匪S模块、微惯性测量单元MIMU模块、GPS模块、Kalman滤波信息融合算法 模块、定姿算法模块、CFAR滤波模块构成，所述GPS模块及所述微磁传感器MMS模块均与所 述Kalman滤波信息融合算法模块连接，所述微惯性测量单元MIMU模块分别与所述定姿算 法模块、所述CFAR滤波模块及所述Kalman滤波信息融合算法模块连接。所述GPS模块与所述CFAR滤波模块相连接。所述Kalman滤波信息融合算法模块与所述微惯性测量单元MIMU模块相连接，所 述GPS模块与所述所述微磁传感器MMS模块将信息及数据通过所述Kalman滤波信息融合 算法模块处理后再传给所述微惯性测量单元MIMU模块。所述GPS模块将信息将信息传给所述CFAR滤波模块，经过滤波处理，在传送给所 述微惯性测量单元MIMU模块。所述定姿算法模块与所述微磁传感器MMS模块相连接，所述微惯性测量单元MIMU 模块及捷联惯性导航算法将处理后的重力加速度分量信息传送给所述微磁传感器MMS模 块。与现有技术相比，本实用新型具有以下优点本实用新型提供的一种基于微磁传感的定姿监测系统，微惯性测量单元MIMU模 块结合捷联导航算法不断实时分解出加速度计测量值中重力加速度的分量，并给出重力加速度在载体坐标系的投影，解决了由于加速度计测量值无法分辨运动加速度和重力加速度 的问题，从而得到载体坐标系与当地水平坐标系之间的转换关系，即横滚角和俯仰角，并且 本实用新型采用CFAR滤波模块抑制GPS模块输出数据的噪声，提高了微小型系统的位置、 速度的测量精度。
[0012]图1为本实用新型的结构框图。[0013]主要元件符号说明如下[0014]UKalman滤波信息融合算法模块2、微磁传感器MMS模块[0015]3、定姿算法模块4、GPS模块[0016]5、微惯性测量单元MIMU模块6、CFAR滤波模块
具体实施方式
为了更清楚地表述本实用新型，
以下结合附图对本实用新型作进一步的描述。如图1所示为一种基于微磁传感的定姿监测系统，系统本体由微磁传感器MMS模 块2、微惯性测量单元MIMU模块5、GPS模块4、Kalman滤波信息融合算法模块1、定姿算法 模块3、CFAR滤波模块6构成，GPS模块4及微磁传感器匪S模块2均与Kalman滤波信息 融合算法模块1相连接，微惯性测量单元MIMU模块5分别于定姿算法模块3、CFAR滤波模 块6及Kalman滤波信息融合算法模块1相连接，GPS模块4与CFAR滤波模块6相连接，定 姿算法模块3与微磁传感器MMS模块2相连接，Kalman滤波信息融合算法模块1与微惯性 测量单元MIMU模块5相连接。工作原理GPS模块将运动体的位置和速度信息传送给Kalman滤波信息融合算法模块，并且 GPS模块将运动体的速度和加速度信息传送给CFAR滤波模块，微惯性测量单元MIMU模块 根据输出数据通过捷联导航算法分解出微小型系统的重力加速度，微磁传感器MMS模块利 用的重力加速度通过定姿算法实时解算微小型系统的横滚角、俯仰角和航向角三维姿态信 息，利用CFAR滤波模块平滑掉GPS模块输出的速度和加速度信息中的噪声，三维姿态信息 一方面送至Kalman滤波信息融合算法模块，与GPS模块给出的位置和速度信息一道通过 Kalman滤波信息融合算法模块间歇校正微惯性测量单元MIMU误差，另一方面利用三维姿 态信息实时更新坐标转换矩阵，坐标转换矩阵将被送给微惯性测量单元MIMU模块和GPS模 块，将水平坐标系的信息转换到载体坐标系下。以上公开的仅为本实用新型的几个具体实施例，但是，本实用新型并非局限于此， 任何本领域的技术人员能思之的变化都应落入本实用新型的保护范围。
权利要求一种基于微磁传感的定姿监测系统，其特征在于，系统本体由微磁传感器MMS模块、微惯性测量单元MIMU模块、GPS模块、Kalman滤波信息融合算法模块、定姿算法模块、CFAR滤波模块构成，所述GPS模块及所述微磁传感器MMS模块均与所述Kalman滤波信息融合算法模块连接，所述微惯性测量单元MIMU模块分别与所述定姿算法模块、所述CFAR滤波模块及所述Kalman滤波信息融合算法模块连接。
2.根据权利要求1所述的一种基于微磁传感的定姿监测系统，其特征在于，所述GPS模 块与所述CFAR滤波模块相连接。
3.根据权利要求1所述的一种基于微磁传感的定姿监测系统，其特征在于，所述定姿 算法模块与所述微磁传感器MMS模块相连接。
4.根据权利要求1所述的一种基于微磁传感的定姿监测系统，其特征在于，所述 Kalman滤波信息融合算法模块与所述微惯性测量单元MIMU模块相连接。
专利摘要本实用新型涉及一种基于微磁传感的定姿监测系统，系统本体由微磁传感器MMS模块、微惯性测量单元MIMU模块、GPS模块、Kalman滤波信息融合算法模块、定姿算法模块、CFAR滤波模块构成，GPS模块及微磁传感器MMS模块均与Kalman滤波信息融合算法模块相连接，微惯性测量单元MIMU模块分别与定姿算法模块、CFAR滤波模块及Kalman滤波信息融合算法模块相连接。本实用新型保证了长时间工作情况下微惯性测量单元MIMU模块的测量精度以及分解重力加速度在载体坐标系投影的精度，并且提高了微小型系统位置、速度的测量精度。
文档编号G01C21/16GK201757786SQ20102024543
公开日2011年3月9日 申请日期2010年7月2日 优先权日2010年7月2日
发明者方维 申请人:方维