使用补偿算法对陀螺仪和电子罗盘进行数据融合，计算方位角

电子罗盘如  HMC5883L或者 MPU9250的AK8963测方位角时，经常会发现测量角度抖动很厉害。即使不动，角度也在不停的小范围内变化。这时候就需要使用陀螺仪对方位角进行补偿融合，得出稳定的数据。本文只讨论2Ｄ空间的方位角，就是电子罗盘X, Y两轴数据融合陀螺仪Ｚ轴数据。

1. 电子罗盘和陀螺仪测量物理意义

电子罗盘：０－36０度的方位角，也称为 yaw 。角度为arctan2(y,x)

陀螺仪：   围绕某轴旋转的角速度，这里我们只考虑Ｚ轴，相当于方位角的变化速度速度

2. 融合算法公式

在某个时间点 Tx 上, 电子罗盘值为 YawCompassTx, 陀螺仪值为YawGyroTx, 融合后的数据为 YawFuzeTx

下一个时间点 Tx+1,  陀螺仪计算的角度变化为 delta_Yaw = YawGyroTx+1
* delta_t,  其中 delta_t =
Tx+1 - Tx

YawFuzeTx+1 = K * ( YawFuzeTx+ delta_Yaw ) + ( 1 - Ｋ ) * YawCompassTx+1

其中K的取值范围一般为 [0.9, 1), 物理意义就是对陀螺仪的信任程度。

在T0时间点， YawFuzeT0 = YawCompassT0

时间： 2024-07-31 17:07:31

使用补偿算法对陀螺仪和电子罗盘进行数据融合，计算方位角的相关文章

陀螺仪以及三轴陀螺仪和六轴陀螺仪的区别_六轴陀螺仪和九轴陀螺仪的区别

来源:电子发烧友 链接:http://www.elecfans.com/article/88/142/2017/20171201590857.html 陀螺仪,是一种用来感测与维持方向的装置,基於角动量不灭的理论设计出来的.陀螺仪主要是由一个位於轴心可以旋转的轮子构成. 陀螺仪一旦开始旋转,由於轮子的角动量,陀螺仪有抗拒方向改变的趋向.陀螺仪多用於导航.定位等系统. 1850年法国的物理学家福柯(J.Foucault)为了研究地球自转,首先发现高速转动中的转子(rotor),由于惯性作用它的旋转

1102: 零起点学算法09——继续练习简单的输入和计算（a-b)

1102: 零起点学算法09--继续练习简单的输入和计算(a-b) Time Limit: 1 Sec  Memory Limit: 520 MB   64bit IO Format: %lldSubmitted: 2810  Accepted: 2161[Submit][Status][Web Board] Description 简单吧,不用多说了 Input 输入2个整数a,b,用空格隔开 Output 输出a-b的值 Sample Input 10 5 Sample Output 5 S

算法10---二叉搜索树存在重复数据插入的实现

算法10---二叉搜索树存在重复数据插入的实现 当用TREE-INSERT将n个具有相同关键字的数据项插入到一棵初始为空的二叉查找树中时,该算法的渐近性能如何? 我们可以对TREE-INSERT做一些改进,即在第5行的前面测试key[z] = key[x],在第11行的前面测试key[z] = key[y].如果等式成立,我们对下列策略中的某一种加以实现.对每一种策略,请给出将n个具有相同关键字的数据插入一棵初始为空的二叉查找树中的渐近性能(以下的策略是针对第5行的,比较的是z和x的关键字.将x

如何写一篇论文,<一种低耗能的数据融合隐私保护算法ESPART> (计算机学报2011-5,王安琪)

这是我在研究生阶段花了一个月的时间搞出的一篇论文,纯构思和写论文花了才一个月,发稿加改稿.等发表的时间可远不止,记得2010年11月开始要写了,2010年12月写完,2010年底投的稿,2011年初数次改稿,终于5月份出版. 2010年11月份,导师说关于无线传感器网络有很多可以研究的课题,其中的数据融合隐私保护便是以个方向,让我好好研究.自此我便埋头在论文的工作上了,之前的研究生生活就是在图书馆里泡着,看各种看得懂的看不懂的技术.社会科学书籍,现在回想起来,之前的看书生活对这篇论文的创作也是有

simhash算法：海量千万级的数据去重

simhash算法:海量千万级的数据去重 simhash算法及原理参考: 简单易懂讲解simhash算法 hash 哈希:https://blog.csdn.net/le_le_name/article/details/51615931 simhash算法及原理简介:https://blog.csdn.net/lengye7/article/details/79789206 使用SimHash进行海量文本去重:https://www.cnblogs.com/maybe2030/p/5203186

多传感器数据融合算法综述

文章内容来源:https://blog.csdn.net/ZXQHBD/article/details/69389019 多传感器数据融合是一个新兴的研究领域,是针对一个系统使用多种传感器这一特定问题而展开的一种关于数据处理的研究.多传感器数据融合技术是近几年来发展起来的一门实践性较强的应用技术,是多学科交叉的新技术,涉及到信号处理.概率统计.信息论.模式识别.人工智能.模糊数学等理论. 近年来,多传感器数据融合技术无论在军事还是民事领域的应用都极为广泛.多传感器融合技术已成为军事.工业和高技术

菜鸟学四轴控制器之6：刀具半径补偿算法

为什么要有刀具补偿? 想象一下,如果我们的刀具可以理想到半径无穷小,倒是不需要考虑半径的补偿,但是实际上我们用到的是刀具的边沿在雕刻物体,如下图: 简单来看,好像是直接平行于轮廓进行移动就可以了,其实不然,单条直线的雕刻是平行,但是直线和直线,直线和圆弧,圆弧和圆弧都是不同的,并且!直线与直线的刀具补偿也分为三种情况分析.并且,在理论上有两种方法来进行补偿. 且慢,还分为三步,第一步是建立补偿,第二步 进行补偿,第三步撤销补偿. 两种方法分别为: 1.B刀具半径补偿 2.C刀具半径补偿 按照以往

iOS新加速计事件（陀螺仪和加速计）

iOS新加速计事件 [iOS新加速计事件] 1.iOS5.0以前,可以使用UIAcceleration来监听加速计事件. 2.Bug iOS5.0以后,UIAccelerometerDelegate已经被depreacated,如下: deprecated不是说不能说了,而是意味着在将来版本会删除,所以如果不想更新知识的话,就使用UIAccelerometer吧.更保险的方法是使用一个Timer来检查UIAcceleration,即不依赖于此Delegate回调. 3.针对iOS4.0以上版本,

ios中的陀螺仪和加速计

ios设备中有的加速计可以测量出加速度和重力.陀螺仪可用于确定设备的方向与每条坐标轴之间的夹角,可用于读取描述设备围绕其轴的旋转的值. 首先在工程中添加CoreMotion.framework <p style="margin-top: 0px; margin-bottom: 0px; font-size: 18px; font-family: FangSong; color: rgb(180, 38, 26); "><span style="color: