当前位置：文档之家 › 陀螺仪传感器原理及姿态解算

陀螺仪传感器原理及姿态解算

  • 格式：pdf
  • 大小：1.93 MB
  • 文档页数：11

Mini AHRS 姿态解算说明本章旨在讲解以下内容1.加速度 2.陀螺仪3.磁力计

MiniIMU AHRS姿态板销售网址：Http://chiplab7.taobao.com/

作者：lisn31880序言

一直想写篇文章关于姿态解算原理的，使用尽量通俗的语句说明如何从加速度计和陀螺仪的数据，融合得到载体的姿态角。无奈自己的水平有限，一直搁置。 淡泊以明志,宁静以致远.人总是要逼自己做些事，才过得心安理得。那就拿点时间把这方面的资料整合一下吧。这篇文章的大部分内容都不是本人原创的,感谢网络上无私奉献的人.

在此介绍一下实验的姿态板 ,新一代的mini AHRS,采用STM32F103单片机进行姿态解算，板子上集成有1.MPU6050，三轴的加速度和陀螺仪2.HMC5883 三轴的磁力计3.BMP180 高精度气压高度计这些传感器都通过I2C接口连接到主控制器STM32.不需要额外的ADC电路,直接通过数字接口就可以读取传感器的当前输出.

SDASCL

3.3VVDD

MPU6050HMC5883BMP180

STM32F103T8

.K2

47x

3轴陀螺仪3轴加速器3轴

地磁传感器气压高度计

UART数据输出SWD调试接口LED状态指示

Mini AHRS硬件框图

Mini AHRS是一个九轴的姿态仪模块，使用的都是数字器件，每一个传感器内部都集成有ADC，只需要通过I2C总线，就可以读取传感器当前输出。现在我们不着急了解如何读出这些数据，先来认识一下这些传感器都是做什么，它们主要是测量哪些物理量，从加速度计开始。

7chiplab7.taobao.comPowered By 第七实验室1加速度计

加速度计顾名思义,就是测量加速度的.那么,我们如何认识这个加速度呢?在此用一个盒子形状的立方体来做模型，认识加速度,如下,盒子内的图像。

如果我们把盒子形状的立方体 放在一个没引力场的地方,球会保持在盒子的中间.你可以想象，这个盒子是在外太空，远离任何天体，很难找到这样的地方,就想象飞船轨道围绕地球飞，一切都是在失重状态下。那么六个壁面感受到的压力都是0.如果我们突然将立方体向左侧移动（我们加快加速，1G =9.8米/ S ^ 2），皮球打在了墙上X-。然后，我们测量球适用于在X轴上的壁和输出-1g值的压力。如下图

失重状态

请注意，加速度计反应的加速向量与当前的受力方向是相反的.如上图所示,受力方向向左,但是加速度的向量方向为右.

7chiplab7.taobao.comPowered By 第七实验室如果我们把这个小盒子拿来放在地球上,那么小球会落在Z-壁面上，并会为1G的底壁施加一个力，在下面的图片所示：

在这种情况下，框不动，但我们仍然可以得到Z轴的读数-1G。球在墙壁上的压力造成的引力场。

到目前为止，我们已经分析了单个轴加速度计的输出，这是你会得到一个单轴加速度计。三轴加速度计的真正价值，即是他们可以同时检测到所有三个轴的惯性力。让我们回到我们的盒模型，并让旋转45度在右边的框中。球会触及两面墙：Z和X-在下面的图片所示：

7chiplab7.taobao.comPowered By 第七实验室x 和 z 轴受到值的0.71是不是任意的? 它们实际上是一个近似SQRT（1/2）.要知道当盒子只受重力场时，x^2+Y^2+z^2 =1g 这将变得更加清晰，为大家介绍一下我们的下一个样子的加速度计。

在之前的盒子模型中，我们有固定的引力场及旋转。在刚刚说明的两个例子中，我们分析了2个不同的输出框位置，而力矢量保持不变。这更有利于了解加速度计如何与外部交互，并显示当前读数。

请看一下上面的模型，这是一个新的模型代替刚刚的盒子立方体。试想一下，在新模型中的每个轴是垂直于盒子的壁面。向量R是加速度计测量（从上面的例子或这两者的组合，它可以是引力场或惯性力）的力矢量。接收时，Ry，R Z与上的X，Y，Z轴的R矢量投影。请注意下面的关系式：

R ^ 2 = RX ^ 2 + RY ^ 2 + RZ ^ 2 （公式1）请记住，早一点我告诉你，SQRT（1/2）的值不是随机的〜0.71。如果您将上述公式中，回顾我们的引力场为1 g后，我们可以验证：

1 ^ 2 =（-SQRT（1/2））^ 2 + 0 ^ 2 +（-SQRT（1/2））^ 2简单地通过代以R = 1时，接收= SQRT（1/2）时，Ry = 0，RZ = SQRT（1/2）在方程经过以上的理论分析我们越来越接近现实生活中的加速度计。值RX，RY，RZ实际上是呈线性关系对应到真正的现实加速度计的x轴 y轴 z轴.

在此提出一个问题， 加速度计如何将这些信息告诉我们？目前市面上的加速度计从输出上区分为两种，一种是数字的，另一种是模拟的.miniAHRS 使用的是MPU6050三轴加速度计，是I2C接口的数字传感器.通过特定的命令可以配置加速度的量程,并将内部ADC的转换结果读出来.现在，我们有我们的加速度计的读数，以LSB为单位的，它仍然不是g（9.8米/秒^ 2），需要最后的转换，我们要知道加速度计灵敏度，通常表示为LSB /g。比方说当我们选择2g的量程时，对应的灵敏度= 16384 LSB/ G 。为了得到最终的力值，单位为g，我们用下面的公式：

RX = ADCRx /灵敏度也就是说 当x轴的计数为ADCRx 时，那么对应的加速度值就是 (ADCRx/16384)g.

7chiplab7.taobao.comPowered By 第七实验室回到加速度向量模型，将相关角度符号补上，如下图

我们感兴趣的是向量R 和 X、Y、Z轴之间的角度，将它们定义为 Axr Ayr Azr. 可以看到由R 和Rx 组成的直角三角形：COS（Axr）= RX / R 依此类推：COS（Ayr）= RY / RCOS（Azr）= RZ / R可以得到 R = SQRT（RX ^ 2 + RY ^ 2 + RZ ^ 2）我们发现 当使用 arccos() 反余弦 :Axr = arccos(RX / R)Ayr = arccos(RY / R)Azr = arccos(RZ / R)已以通过很多公式解释加速度计模型。我们也会很快解释陀螺仪 以及如何用加速度计和陀螺仪的数据进行整合，以得到更精确的角度估计。

在这之前 我们先来看看更有用的公式：cosX = cos(Axr) = Rx / R cosY = cos(Ayr) = Ry / R cosZ = cos(Azr) = Rz / R这三个公式通常被称为方向余弦。你可以轻松地验证：SQRT（cosX ^ 2 + COSY ^ 2 + cosZ ^ 2）= 1

这个属性可以避免监视R矢量的模（长度）。很多时候，我们只对惯性矢量方向感兴趣，对矢量进行规范化对简化程序运算很有意义。

我们暂且从理论分析回到现实的传感器输出中,当水平放置MPU6050,只有Z轴感受到重力向量，它将输出1g。对应的ADC值就是16384 (2g的量程)。此时,R就是重力向量,Rx=0. Ry=0. Rz = R =1g.满足 R ^ 2 = RX ^ 2 + RY ^ 2 + RZ ^ 2 得到重力向量与各个轴的夹角Axr = arccos(RX / R) = 90度Ayr = arccos(RY / R) = 90度Azr = arccos(RZ / R) = 0 度

重力向量

方向余弦2陀螺仪

陀螺仪是测试角速度的传感器，也有人把角速度说成角速率，说的是一样的物理量。拿电机做例子，当我们说一个电机10转每秒。一转是360度,那么它的主轴在一秒内转过3600度。也就是说这个电机在转动时的角速度是3600dps.dps 就是dergee per second 度每秒(或者写成 deg/s).MPU6050 集成了三轴的陀螺仪.角速度全格感测范围为±250、±500、±1000与±2000°/sec (dps).当选择量程为±250dps的时候，将会得到分辩率为131LSB/(º/s).也就是当载体在X+轴转动1dps时，ADC将输出131.

当MPU6050水平放置时，理论上Z轴感受到重力 将读出16384。同时X 轴和Y轴的读数将是0.可实际并不是这样的。这是由于每个芯片在制作时都不一样，数据手册上的都是理论的值，真正的芯片在水平时Z轴可能并不是16384.我们需要找到当各个轴在0g重力时的计数，1g时的读数，以及-1g时的读数，得到一个补偿值，在每次读取ADC结果后都进行补偿。这个过程我们称之为标定。用数学公式表示为:ADCx = K*Gx + OffsetADCx 传感器输出Gx 真实的加速值Offset 加速度为0g时传感器的输出K 标度因数

加速度计的标定7chiplab7.taobao.comPowered By 第七实验室

合集下载

自己整理的MPU6050中文资料

自己整理的MPU6050中文资料

《自己整理的MPU6050中文资料》一、MPU6050简介MPU6050是一款集成了加速度计和陀螺仪的六轴运动处理传感器。

它采用小巧的封装，具有高精度、低功耗的特点，广泛应用于无人机、智能穿戴设备、智能手机等领域。

通过测量物体在三维空间中的加速度和角速度，MPU6050可以帮助我们实现对运动状态的实时监测和分析。

二、MPU6050核心特点1. 六轴运动处理：MPU6050将加速度计和陀螺仪集成在一个芯片上，实现六轴运动处理。

2. 数字输出：采用数字输出接口，方便与微控制器（如Arduino、STM32等）进行通信。

3. 高精度：加速度计精度为±16g，陀螺仪精度为±2000°/s，满足大多数应用场景的需求。

4. 低功耗：在低功耗模式下，功耗仅为5μA，适用于长时间运行的设备。

5. 小巧封装：采用QFN封装，尺寸仅为4mm×4mm×0.9mm，便于集成到各种产品中。

6. 宽工作电压范围：2.5V至3.5V，适应不同电压需求的场景。

三、MPU6050应用场景1. 无人机：通过MPU6050实时监测飞行器的姿态，实现自主悬停、定高、平稳飞行等功能。

2. 智能穿戴设备：监测用户运动状态，如步数、步频、跌倒检测等，为健康管理提供数据支持。

3. 智能手机：辅机实现重力感应、游戏控制等功能。

4. VR/AR设备：实时监测头部姿态，为虚拟现实体验提供精准的交互。

5. 车载导航：辅助车辆进行姿态检测，提高导航精度。

6. 工业自动化：用于监测设备运行状态，实现故障预警和自动调节。

四、MPU6050接口说明1. SDA：I2C数据线，用于与微控制器通信。

2. SCL：I2C时钟线，与SDA配合实现数据传输。

3. AD0：I2C地址选择线，通过改变AD0的电平，可以设置MPU6050的I2C地址。

4. INT：中断输出，当MPU6050检测到特定事件时，通过INT脚输出中断信号。

MEMS陀螺仪工作原理

MEMS陀螺仪工作原理

陀螺仪是用来测量角速率的器件，在加速度功能基础上，可以进一步发展，构建陀螺仪。

陀螺仪的内部原理是这样的：对固定指施加电压，并交替改变电压，让一个质量块做振荡式来回运动，当旋转时，会产生科里奥利加速度，此时就可以对其进行测量；这有点类似于加速度计，解码方法大致相同，都会用到放大器。

角速率由科氏加速度测量结果决定- 科氏加速度 = 2 × (w ×质量块速度)- w是施加的角速率(w = 2 πf)通过14 kHz共振结构施加的速度（周期性运动）快速耦合到加速度计框架- 科氏加速度与谐振器具有相同的频率和相位，因此可以抵消低速外部振动该机械系统的结构与加速度计相似（微加工多晶硅）信号调理（电压转换偏移）采用与加速度计类似的技术施加变化的电压来回移动器件，此时器件只有水平运动没有垂直运动。

如果施加旋转，可以看到器件会上下移动，外部指将感知该运动，从而就能拾取到与旋转相关的信号。

上面的动画，只是抽象展示了陀螺仪的工作原理，而真实的陀螺仪内部构造是下面这个样子。

PS：陀螺仪可以三个一起设计，分别对应于所谓滚动、俯仰和偏航。

任何了解航空器的人都知道，俯仰是指航空器的上下方向，偏航是指左右方向，滚动是指向左或向右翻滚。

要正确控制任何类型的航空器或导弹，都需要知道这三个参数，这就会用到陀螺仪。

它们还常常用于汽车导航，当汽车进入隧道而失去GPS信号时，这些器件会记录您的行踪。

无人机在飞行作业时，获取的无人机影像通常会携带配套的POS数据。

从而在处理中可以更加方便的处理影像。

而POS数据主要包括GPS数据和IMU数据，即倾斜摄影测量中的外方位元素：（纬度、经度、高程、航向角（Phi）、俯仰角（Omega）及翻滚角（Kappa））。

GPS数据一般用X、Y、Z表示，代表了飞机在飞行中曝光点时刻的地理位置。

飞控是由主控MCU和惯性测量模块（IMU，Inertial Measurement Unit）组成。

惯导姿态解算天向发散

惯导姿态解算天向发散

惯导姿态解算天向发散
惯导姿态解算（即姿态估计）是指通过传感器测量数据（如陀螺仪、加速度计等）以及相应的算法，推算出飞行器或其他运动物体的姿态信息（如航向、俯仰、横滚等）。

而天向发散是指天向（即竖直方向）上的误差逐渐累积扩大的现象。

在惯导姿态解算中，由于传感器存在精度限制和测量误差，以及算法本身的近似和不确定性，会导致估计的姿态信息存在一定的误差。

而这些误差会随着时间的推移逐渐累积，尤其是在天向。

这是因为惯导解算是基于传感器测量数据积分得到的，而测量误差的积分会导致姿态估计的漂移和误差逐渐增大。

天向发散的主要原因是重力测量误差。

传感器对于重力的测量可能存在一定的误差，这个误差会通过姿态解算中的积分操作而逐渐累积起来。

另外，其他因素如传感器漂移、机动加速度等也会进一步加速天向误差的发散。

为了解决天向发散的问题，可以采用一些姿态校正算法或传感器融合技术。

姿态校正算法可以根据其他可靠的测量信息对惯导解算的结果进行修正，以减小误差的发散。

传感器融合技术则可以综合利用多个传感器的信息，通过优化算法对姿态进行估计，以提高解算的准确性和稳定性。

总之，惯导姿态解算中的天向发散是一个常见的问题，需要采用合理的算法和技术手段进行校正和修正，以提高姿态解算的精度和稳定性。

九轴传感器 姿态解算 实现方法

九轴传感器 姿态解算 实现方法

九轴传感器姿态解算实现方法全文共四篇示例，供读者参考第一篇示例：九轴传感器是一种集成了加速度计、陀螺仪和磁力计传感器的传感器，可以通过测量物体在空间中的加速度、角速度和磁场强度来获取物体的姿态信息。

在很多应用领域中，九轴传感器被广泛应用于姿态解算技术中，用于实现对物体姿态的精确测量和跟踪。

本文将介绍九轴传感器的原理和姿态解算的实现方法。

一、九轴传感器的原理1. 加速度计：加速度计可以测量物体在三维空间中的加速度，通过测量物体的加速度，可以获得物体相对于重力场的方向信息。

通过这三种传感器的联合测量，九轴传感器可以获得物体在空间中的姿态信息，从而实现对物体姿态的精确测量和跟踪。

二、姿态解算的实现方法姿态解算是将九轴传感器测得的加速度、角速度和磁场强度数据转化为物体在空间中的姿态信息的过程。

在实际应用中，姿态解算技术通常包括传感器数据的采集、数据预处理、姿态估计和姿态滤波等步骤。

1. 数据采集：需要使用九轴传感器对物体进行测量，获取物体在空间中的加速度、角速度和磁场强度数据。

2. 数据预处理：接下来，对传感器采集的数据进行预处理，包括噪声滤除、数据对齐和数据校准等步骤，以提高测量数据的准确性和稳定性。

3. 姿态估计：在数据预处理之后，使用姿态解算算法对传感器测得的数据进行处理，估计出物体在空间中的姿态信息，包括物体的姿态角度和旋转矩阵等参数。

4. 姿态滤波：对姿态估计结果进行滤波处理，以减少姿态解算过程中的误差和漂移，从而提高姿态解算的精确性和稳定性。

姿态解算技术通过九轴传感器测得的加速度、角速度和磁场强度数据，实现了对物体姿态的精确测量和跟踪。

在很多应用领域中，姿态解算技术已经成为了不可或缺的技术手段，为实现各种复杂动作和姿态控制提供了重要的支持。

第二篇示例：九轴传感器是一种集成了加速度计、陀螺仪和磁力计等传感器的综合传感器，可以用于测量物体的运动轨迹和姿态变化。

姿态解算是指通过九轴传感器采集到的数据，计算出物体在三维空间中的姿态信息，包括俯仰角、偏航角和横滚角等参数。