基于磁传感器的航姿系统的实现与补偿技术

学校代码： 10289分类号： V249.3密 级： 公开 学 号： 062030049 江 苏 科 技 大 学硕 士 学 位 论 文基于磁传感器的航姿系统的实现与补偿技术研 究 生 姓 名 袁 勇 导 师 姓 名 朱 志 宇 申请学位类别 工 学 硕 士 学位授予单位 江 苏 科 技 大 学 学 科 专 业控制理论与控制工程 论文提交日期 2008 年 12 月 22 日 研 究 方 向 导航、制导与控制 论文答辩日期 2009 年 3 月 14 日 答辩委员会主席 评 阅 人 2008 年 12 月 22 日基于磁传感器的航姿系统的实现与补偿技术 袁 勇 江苏科技大学分类号： V249.3 密 级： 公开 学 号： 062030049 工学硕士学位论文基 于 磁 传 感 器 的 航 姿 系 统 的 实 现 与 补 偿 技 术学 生 姓 名 袁 勇指 导 教 师 朱 志 宇 教 授江苏科技大学二 OO 八年十二月 A Thesis Submitted in Fulfillment of the Requirementsfor the Degree of Master of EngineeringThe Implementation and Calibration Algorithm for AHRS with Magnetic SensorsSubmitted byYuan YongSupervised byProfessor Zhu ZhiyuJiangsu University of Science and TechnologyDecember, 2008论 文 独 创 性 声 明 本人声明所呈交的学位论文是我本人在导师指导下进行的研究工作及取得的研究成果。尽我所知，除了文中特别加以标注和致谢的地方外，论文中不包含其他人已经发表或撰写过的研究成果，也不包含为获得江苏科技大学或其它教育机构的学位或证书而使用过的材料。与我一同工作的同志对本研究所做的任何贡献均已在论文中作了明确的说明并表示谢意。 学位论文作者签名： 日 期：学 位 论 文 使 用 授 权 声 明 江苏科技大学有权保存本人所送交的学位论文的复印件和电子文稿，可以将学位论文的全部或部分上网公布，有权向国家有关部门或机构送交并授权其保存、上网公布本学位论文的复印件或电子文稿。本人电子文稿的内容和纸质论文的内容一致。除在保密期内的保密论文外，允许论文被查阅和借阅。 研究生签名： 导师签名：日 期： 日 期：摘要I摘 要姿态与航向参考系统(AHRS)是一种能在任意姿态下测量飞机、车辆或船舰等载体航向、姿态的装置。考虑到成本、体积、性能等因素，目前，以 MEMS 器件为基础的磁阻传感器、角速度陀螺和加速度计等器件等一直都被广泛地应用在航姿参考系统中。MEMS 角速度陀螺短时精度高，但是解算后的姿态长时漂移比较大。磁阻传感器虽然能够寻北，并且在加速度计的配合下能够提供航姿信息，但是其航向的输出极易受外界干扰磁场的影响而使精度降低，且其提供航向的动态精度较差。因此，做到优势互补，基于 MEMS 器件，研制出一种成本低、体积小、精度高的航姿系统，对于飞行器、车辆及船舶的姿态与航向辅助控制研究是很有意义的。本文以低精度 MEMS 传感器元件为基础，基于 ARM 处理器，研究与设计了一种微型 MEMS 姿态与航向参考系统。首先，分别介绍了利用磁阻传感器与陀螺仪，计算载体姿态的理论基础。其次，基于 ARM 处理器，针对某型号微小型直升机，作者搭建了姿态与航向系统的系统框架，并根据实际应用，进行了系统的工程化设计，基于信息融合理论，将陀螺仪数据、加速度数据、磁传感器数据进行融合，基于状态方程，进行了扩展卡尔曼滤波，提高了系统的精度与可靠性。然后，详细介绍了系统具体的开发流程，对陀螺进行了温度补偿，同时对磁罗盘进行了软硬铁补偿。随后，作者使用 matlab 利用实际采集数据，进行了温度补偿算法的仿真与验证。论文的最后，对全文进行了总结，指出了今后应该继续开展研究的方向。论文基于具体型号的应用，设计并实现了微小型姿态航向系统，并将其工程化，已经得到了推广。基于该系统，作者对实际应用中出现的问题进行了分析，并尝试多种算法提高系统精度。本文对于微小型姿态航向系统的开发具有极强的参考价值。关键词： AHRS；MEMS；扩展卡尔曼滤波；温度补偿；ARMAbstractIIAbstractThe Attitude and Heading Reference System (AHRS) is an equipment that can measure the heading and the attitude of the carrier such as planes, vehicle or ships in any attitude conditions. Concerning the factors of cost, size and performance, the MEMS-based magnetoresistive (MR) sensors, gyroscopes and accelerometers are always widely used in the AHRS. As the strapdown matrix can hold high precision after initial alignment of AHRS in short time for the gyros short-term precision, it could not keep the accuracy for a long period of time because of the gyros drifting. The magnetoresistive (MR) sensors can find the north immediately and automatically with the aidding of accelerometers. The precision of heading output is affected by the distortion of outside magnetic field. And its dynamic quality is weak. It is meaningful to develop an Attitude and Heading Reference System based on MEMS parts, and it could avail to carrier control with attitude aidded. This paper is based on the MEMS parts, research and implement an AHRS on the ARM platform. First, we will introduce the theory background of strapdown system. Second, we will develop the system architecture of AHRS on ARM platform aim at some types of mini-helicopter. We will carry out the system integration and data fusion with the concern of practical application with the extended kalman filter. Third, we will give the temperature compensation method of the gyroscopes and the soft iron/hard iron calibration method of magnetoresistive (MR) sensors. The real testing data analysis is done via the matlab computation and simulation. In the end, we will conclude the paper and we will give the direction of future work.The whole research work of the paper is founded on the real model. We design and implement the mini-AHRS and it comes with a board application. The author has analyzed all kinds of problems in practice and tried different methods to improve the system pe