专利名称：一种基于微磁传感的定姿监测系统的制作方法
技术领域：
本实用新型涉及一种适用于任意运动微小型系统的定姿系统，尤其涉及一种基于 微磁传感的定姿监测系统。
背景技术：
磁传感器能够测量三个正交方向的磁场强度，为了换算为三维姿态信息，还必须 依赖其他手段，在微小型系统任意运动状态下确定三维磁传感器测量方向与当地水平面之 间的坐标转换关系，即必须预先确定横滚角和俯仰角。目前多数磁传感器定姿系统都依赖 加速度计或倾角传感器给出静态和勻速直线运动状态下的横滚角和俯仰角，而在其他机械 运动状态下磁传感器基本不能用。加速度计和倾角传感器是目前测量微小型系统横滚角和俯仰角最常用的方式，但 由于两种传感器均无法很好地区别微小型系统运动加速度和重力加速度，因此不能给出微 小型系统任意运动情况下的横滚角和俯仰角，只适合于静止和勻速直线运动的情况，而且 上述两种传感器均不能给出航向角。
实用新型内容针对上述技术中存在的不足之处，本实用新型提供一种保证了长时间工作情况下 微惯性测量单元MIMU�？榈牟饬烤纫约胺纸庵亓铀俣仍谠靥遄晗低队暗木龋� 且提高了微小型系统位置、速度的测量精度的一种基于微磁传感的定姿监测系统。为实现上述目的，本实用新型提供一种基于微磁传感的定姿监测系统，系统本体 由微磁传感器匪S�？�、微惯性测量单元MIMU�？�、GPS模块、Kalman滤波信息融合算法 �？�、定姿算法�？�、CFAR滤波�？楣钩桑鯣PS�？榧八鑫⒋糯衅鱉MS�？榫胨� 述Kalman滤波信息融合算法模块连接，所述微惯性测量单元MIMU�？榉直鹩胨龆ㄗ怂� 法�？�、所述CFAR滤波�？榧八鯧alman滤波信息融合算法�？榱�。所述GPS�？橛胨鯟FAR滤波模块相连接。所述Kalman滤波信息融合算法模块与所述微惯性测量单元MIMU�？橄嗔樱� 述GPS�？橛胨鏊鑫⒋糯衅鱉MS�？榻畔⒓笆萃ü鯧alman滤波信息融合 算法�？榇砗笤俅鑫⒐咝圆饬康ピ狹IMU�？�。所述GPS�？榻畔⒔畔⒋鯟FAR滤波�？椋瞬ù恚诖透� 述微惯性测量单元MIMU�？椤Ｋ龆ㄗ怂惴？橛胨鑫⒋糯衅鱉MS模块相连接，所述微惯性测量单元MIMU �？榧敖萘咝缘己剿惴ń砗蟮闹亓铀俣确至啃畔⒋透鑫⒋糯衅鱉MS模 块。与现有技术相比，本实用新型具有以下优点本实用新型提供的一种基于微磁传感的定姿监测系统，微惯性测量单元MIMU模 块结合捷联导航算法不断实时分解出加速度计测量值中重力加速度的分量，并给出重力加速度在载体坐标系的投影，解决了由于加速度计测量值无法分辨运动加速度和重力加速度 的问题，从而得到载体坐标系与当地水平坐标系之间的转换关系，即横滚角和俯仰角，并且 本实用新型采用CFAR滤波�？橐种艷PS模块输出数据的噪声，提高了微小型系统的位置、 速度的测量精度。
[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�？榻硕宓奈恢煤退俣刃畔⒋透鳮alman滤波信息融合算法�？椋⑶� GPS�？榻硕宓乃俣群图铀俣刃畔⒋透鳦FAR滤波�？椋⒐咝圆饬康ピ狹IMU模块 根据输出数据通过捷联导航算法分解出微小型系统的重力加速度，微磁传感器MMS�？槔� 用的重力加速度通过定姿算法实时解算微小型系统的横滚角、俯仰角和航向角三维姿态信 息，利用CFAR滤波�？槠交鬐PS�？槭涑龅乃俣群图铀俣刃畔⒅械脑肷颂畔� 一方面送至Kalman滤波信息融合算法�？椋隚PS�？楦龅奈恢煤退俣刃畔⒁坏劳ü� Kalman滤波信息融合算法�？榧湫Ｕ⒐咝圆饬康ピ狹IMU误差，另一方面利用三维姿 态信息实时更新坐标转换矩阵，坐标转换矩阵将被送给微惯性测量单元MIMU�？楹虶PS模 块，将水平坐标系的信息转换到载体坐标系下。以上公开的仅为本实用新型的几个具体实施例，但是，本实用新型并非局限于此， 任何本领域的技术人员能思之的变化都应落入本实用新型的保护范围。
权利要求一种基于微磁传感的定姿监测系统，其特征在于，系统本体由微磁传感器MMS�？�、微惯性测量单元MIMU�？�、GPS模块、Kalman滤波信息融合算法�？椤⒍ㄗ怂惴？椤FAR滤波�？楣钩桑鯣PS�？榧八鑫⒋糯衅鱉MS�？榫胨鯧alman滤波信息融合算法�？榱樱鑫⒐咝圆饬康ピ狹IMU�？榉直鹩胨龆ㄗ怂惴？�、所述CFAR滤波�？榧八鯧alman滤波信息融合算法�？榱印�
2.根据权利要求1所述的一种基于微磁传感的定姿监测系统，其特征在于，所述GPS模 块与所述CFAR滤波�？橄嗔�。
3.根据权利要求1所述的一种基于微磁传感的定姿监测系统，其特征在于，所述定姿 算法�？橛胨鑫⒋糯衅鱉MS�？橄嗔�。
4.根据权利要求1所述的一种基于微磁传感的定姿监测系统，其特征在于，所述 Kalman滤波信息融合算法�？橛胨鑫⒐咝圆饬康ピ狹IMU�？橄嗔�。
专利摘要本实用新型涉及一种基于微磁传感的定姿监测系统，系统本体由微磁传感器MMS模块、微惯性测量单元MIMU�？�、GPS�？�、Kalman滤波信息融合算法�？�、定姿算法�？椤FAR滤波�？楣钩桑珿PS�？榧拔⒋糯衅鱉MS�？榫隟alman滤波信息融合算法�？橄嗔樱⒐咝圆饬康ピ狹IMU模块分别与定姿算法�？�、CFAR滤波�？榧癒alman滤波信息融合算法�？橄嗔印１臼涤眯滦捅Ｖち顺な奔涔ぷ髑榭鱿挛⒐咝圆饬康ピ狹IMU�？榈牟饬烤纫约胺纸庵亓铀俣仍谠靥遄晗低队暗木龋⑶姨岣吡宋⑿⌒拖低澄恢�、速度的测量精度。
文档编号G01C21/16GK201757786SQ20102024543
公开日2011年3月9日 申请日期2010年7月2日 优先权日2010年7月2日
发明者方维 申请人:方维
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
