MARG姿态测量系统抗干扰算法研究

来源 :中北大学 | 被引量 : 0次 | 上传用户:aspbasicer
下载到本地 , 更方便阅读
声明 : 本文档内容版权归属内容提供方 , 如果您对本文有版权争议 , 可与客服联系进行内容授权或下架
论文部分内容阅读
近年来,姿态测量系统在导弹、无人机、航空等军用领域以及车载、人体姿态跟踪、室内机器人等民用领域都得到了广泛应用。基于MARG(Magnetic,Angular Rate,andGravity)传感器多源信息组合姿态测量系统由于其小体积、低功耗、低成本的优点受到越来越多的关注。MARG传感器是由三轴加速度计传感器、三轴陀螺仪传感器和三轴磁传感器组合而成,用于对载体的姿态信息进行测量。加速度计和磁传感器组合可以补偿陀螺仪零漂累积误差。但是在传感器测量过程中会受到载体的有害加速度以及周围局部磁场等恶劣环境的干扰。如何利用算法有效地减小有害加速度和磁场干扰对姿态角解算精度影响是本文研究的主要问题。同时,传感器系统误差以及安装误差都会直接影响解算精度。由于传感器较多,会存在三种传感器坐标不统一的问题,因此如何实现传感器误差统一标定,解决传感器坐标轴统一的问题是本文研究的另一个内容。针对MARG传感器存在的零偏、灵敏度和不正交角误差,本文提出了基于椭球拟合的系统误差标定方法,利用该方法可以实现对三轴加速度计、三轴陀螺仪和三轴磁传感器的零偏、灵敏度和不正交角误差的统一标定。针对三种传感器坐标系不统一的问题,本文提出在椭球拟合标定结果的基础上,采用四位置法将三轴传感器坐标系转换到封装壳体坐标系下,实现坐标系的统一。最后以MPU6050传感器模块和HMC5883L组成的MARG传感器测量系统为平台,对三轴加速度计、三轴陀螺仪以及三轴磁传感器进行了标定和相关的实验验证。实验表明,利用该方法进行误差标定,加速度计、磁传感器、陀螺仪误差减小了至少一个数量级,满足标定精度的要求。该方法极大地减小了对精密标定设备的依赖,同时该方法标定步骤简单、易于操作;在传感器测量过程中会受到有害加速度和周围局部磁场等恶劣环境干扰,从而导致传感器测量不准,最终导致姿态角解算不准确。针对该问题,本文提出对加速度计和磁传感器测量信号进行判断,当超过某阈值时,认为该传感器信号无效,进而在融合算法中舍去该传感器的信息,即去除有害信息,保留有效信息。之后再进行算法重构从而提高系统抗干扰能力。在此基础上分别提出了自适应卡尔曼滤波算法、自适应互补滤波算法和自适应梯度下降法。为了验证算法的有效性,以车载环境为例分别设计了不同干扰环境下的仿真实验。比较了传统的扩展卡尔曼滤波、互补滤波以及梯度下降法与本文提出的三种自适应抗干扰算法的解算效果。仿真实验表明,三种自适应算法均能有效减小有害加速度和周围局部磁场的干扰。同时,通过进一步比较表明,自适应互补滤波算法比自适应卡尔曼滤波以及梯度下降法抗干扰性好,四种情况下偏航角误差最大值在0.8°以内,俯仰角和滚转角误差最大值在0.5°以内,且单次采样解算时间小于采样时间2.5ms,满足实际解算要求。因此最终选取自适应互补滤波算法作为加速度和磁场干扰环境下的姿态解算算法;最后,为了验证算法的实用性。分别设计了静态无磁转台实验和动态车载实验。将传统的只用陀螺仪解算姿态、由三轴加速度计和三轴磁传感器组成的电子罗盘姿态解算以及本文提出的自适应互补滤波算法三种姿态解算算法进行对比。结果表明自适应互补滤波算法在补偿陀螺仪零漂累积误差的同时有效地抑制了有害加速度和周围局部磁场干扰对姿态角解算精度的影响。静态环境下,加入有害加速度和磁场干扰,三个姿态角解算误差的均值和标准差小于0.4°。相比于电子罗盘解算,误差分别减小了74.6%,93.8%,74.2%。动态车载环境下,加入相应的干扰,三个姿态角误差均值分别为:偏航角3.25°,俯仰角0.58°,滚转角0.48°。相比于电子罗盘解算,误差分别减小了77.5%,95%,46.6%。实验表明该算法可用于有害加速度和周围局部磁场干扰较大的车载、无人机、人体姿态测量等应用领域。
其他文献
随着计算机技术水平的提高和人民生活信息化程度的加深,工业控制系统也逐步向工业信息化方向迈进。最初的完全封闭的工业控制系统越来越不能满足管理控制一体化的生产需求,所
目前中国与美国正在进行双边投资协定的谈判。本文从四个方面研究谈判中的中美双边投资条约国民待遇原则问题。首先研究谈判过程中遇到的分歧,包括一般分歧与主要分歧。一般
笔者认为,考虑'妇女要不要回家'这一问题,应从当前社会发展的大背景出发,从中国国情、社会经济以及妇女成长等三个角度来讨论,只有这样才能使问题的讨论具有实际的意
目的 探讨心力衰竭超声指数联合血清半乳糖凝集素-3(Galactose lectin-3, Gal-3)、亲环素A检测在评估慢性心力衰竭(chronic heart failure, CHF)心功能中的价值。方法 我院于
在产品设计过程中,传统的手工建模烦琐、重复、效率低。建立一个完善的三维零件库不仅可以节约产品的设计时间,更有益于零件的标准化。通过Creo提供的Pro/TOOLKIT接口,SQL数据库技术,MFC及阿里云对象存储技术,在VS2012开发环境下,对Creo模型库插件进行了设计,实现了用户直接通过Creo插件获取到各种型号的三维模型。
在我国中学范围内推行的新课改已有十余年,就高中物理教学方面而言,涌现出了大量教学疑难问题,这些教学疑难问题涵盖范围比较广,包括对一些重要的物理概念和定律的理解、实验
一、财务管理哲学与哲学的关系财务管理哲学与哲学既有区别,又有联系.其区别表现在:哲学是理论化、系统化的世界观和方法论,又称元哲学,它是一个大系统,包括许多分支哲学。
院前急救是作为院内急诊科的外延,肩负着争分夺秒挽救病人生命的责任,它是急诊医疗服务的最前沿,是患者未到达医院前实施的现场救治和途中监护的医疗活动。随着人们生活水平的不
<正> 泰国旅游业自本世纪60年代起步,以后不断地发展。1991年赴泰国旅游的外国人约达600万,旅游业收入约为1440亿铢(约25铢合1美元),已成为世界十大旅游市场之一。泰国旅游业