基于四元数和卡尔曼滤波的姿态角估计算法研究与应用

被引量 : 0次 | 上传用户:chinetman
下载到本地 , 更方便阅读
声明 : 本文档内容版权归属内容提供方 , 如果您对本文有版权争议 , 可与客服联系进行内容授权或下架
论文部分内容阅读
姿态估计最早应用于军事航天领域,并在该领域的研究比较成熟,但由于传统惯性传感器(陀螺仪和加速度计)体积较大、成本高、携带不便等原因影响了姿态估计在其他领域的应用。近年来,随着MEMS(Micro Electro Mechanical System,微机械电子系统)技术的发展,特别是MEMS惯性传感器和MEMS磁强计的出现,扩展了姿态估计在其他领域的应用,例如在医学领域中的内窥镜姿态定位技术,虚拟与现实领域中的情景交互、手势识别等。姿态指的是一个坐标系和另外一个坐标系之间的位置关系,常用一组姿态角:俯仰角、横滚角和偏航角来描述。里面涉及到姿态角的求解,即姿态解算问题和姿态角的精度问题,本文应用姿态角检测跌倒事件的发生,就是以姿态角计算的准确性为前提。描述姿态的方法有很多,包括欧拉角法、方向余弦法和四元数法等。欧拉角描述姿态会出现奇异性问题,方向余弦法计算量较大,目前广泛采用四元数法,本文基于四元数法,利用四阶龙格库塔法求解四元数微分方程得到姿态角,实现姿态解算。由于MEMS陀螺仪自身的特性,静态情况下其输出的信号中包含常值误差和随机漂移误差,这就会造成在采用陀螺仪计算角度时会产生角度漂移,无法实现长时间的精确测量;同样,加速度计根据重力场计算出水平倾角(俯仰角和横滚角),而实际应用中载体都是运动的,势必会引入线性加速度,造成水平倾角计算的不准确,磁强计根据地球磁场计算出偏航角,但由于地磁场容易受到干扰,那么计算的偏航角也不会太准确。为解决以上问题,目前广泛采用多传感器信息融合的方式进行姿态角估计,本文在参考前人融合算法的基础上,提出了自己的融合方案:采用卡尔曼滤波算法对三轴陀螺仪、三轴加速度计和三轴磁强计进行信息融合,得到最优估计角度。首先,根据传感器输出的数据建立随机漂移AR误差模型,对原始数据进误差补偿和滤波,然后将陀螺仪计算的角度作为估计角度,将加速度计和磁强计计算的角度作为测量角度,利用卡尔曼滤波算法融合估计角度和测量角度,得到最优的姿态角估计。并对提出的融合算法进行实际验证,达到预期效果。最后,按照设计的算法,利用九轴传感器MPU-9150和Arduino Pro mini设计了可佩戴于腰部的姿态角检测装置,实现对人体跌倒姿态的检测,通过实际测试证明了其可靠性并提出了改进的意见。本文作为一篇工程应用文,将姿态角估计应用于人体跌倒姿态的检测中,为姿态估计在其他领域的应用起到了推动作用,有一定的应用价值和实际意义。
其他文献
混凝土芯水泥土搅拌桩是在水泥土搅拌桩施工完毕后,水泥土初凝之前,利用静压机械将预制的混凝土芯桩压入水泥土搅拌桩中而形成的一种复合桩型。混凝土芯水泥土搅拌桩结合了预
目的:通过对大鼠进行8周“电击跳跃法”训练建立大鼠跟腱末端病模型;观察比较火针治疗组与对照组在一次火针治疗、四次治疗后末端区组织的病理变化和末端止点部位IL-1β、IL-6
顾客抱怨被看作是企业正常运行的一面镜子,能最真实、直接的反应企业市场运行状况的好坏和市场占有率的高低。本文以中国商业银行抱怨行为模型为研究主题,选用工行银行唐山分
随着时代的进步和发展,我国用人单位为了保证生产经营活动的正常进行,一般均会设立单位内部的管理规章制度。而在相应的规章制度中,劳动纪律是其中重要的组成部分,对劳动者的
医院最宝贵并最具战略性的资源是人力资源,要想提升医院诊断效率、提高患者满意度,首先要加强人力资源管理。人力资源管理的核心是绩效管理,而绩效评价又是绩效管理的关键,所
作为社会保险制度的执行者和社会保险服务的提供者,社会保险经办机构是社会保险体系能够平稳有序运作的主要承担者,和公众能够参加社会保险和享受社会保险待遇的关键一环。同
<正> 1.观察色泽识真伪不同的蜂蜜色泽也不同、如紫云英蜜、刺柁蜜为水白色;荆条蜜、龙眼蜜、柿花蜜、草木蓿蜜、狼牙刺蜜为乳白
期刊
目的探讨支气管镜下气道炎症评估对慢性咳痰患儿的临床价值。方法回顾性分析58例慢性咳嗽患儿临床资料,按照支气管镜检查气道炎症状态评估结果将患儿分为脓性支气管炎组19例,
随着科学技术与通信网络的快速发展,人们对于身份识别技术的要求也越来越高,稳定性、实用性、安全性越来越被人们所重视,一些传统的身份识别方法已经不能满足人类的需求,所以
党的“十八大”以来,中央大力推进政府职能转变,深化改革要求,主张推行政府及其职能部门开展绩效管理,以实现政府提质增效。税务部门积极响应落实党中央要求,主动探索实践绩效管理,从2014年开始研发组织绩效管理软件,于2015年底由国家税务总局面向全国各地税务部门推行了“数字人事”系统,旨在改进税务系统内部的干部个人绩效管理的流程和效果。本文以N省税务系统运用“数字人事”软件实施个人绩效管理为案例,介绍