陀螺仪辅助定位方法
陀螺仪辅助定位方法
CN 103644911 A 摘要
本发明公开了一种陀螺仪辅助定位方法，包括以下步骤：首先、姿态角的测量:对加速度计的测量值和磁
传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率,
陀螺仪直接通过四元数微分方程得到姿态四元数速率,两个
加起来积分得到姿态四元数；其次、初始点的
获取：利用加速度计和陀螺仪芯片两者的数据，进行轨迹推算，以将轨迹周期提高到惯性测量单元的数据周期；第三、速度和移动距离的计算；第四、计算位置点；
第五：纠正位置。本发明针对性的解决了陀螺仪的漂移、载体的线性加速度和周围局部磁场的干扰问题，根据道路数据，对定位结果进行投影修正，并利用修正结果
计算下一个位置点，这样就有效地减小累计误差。
权利要求(1)
1.一种陀螺仪辅助定位方法，其特征在于包括以下步骤:
首先、姿态角的测量:对加速度计的测量值和磁传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率，陀螺仪直接通
过四元数微分方程得到姿态四元数速率，两
个加起来积分得到姿态四元数；其次、初始点的获取:利用加速度计和陀螺仪芯片两者的数据，进行轨迹推算，以将轨迹周期提高到惯性测量单元的数据周期；
第三、速度和移动距离的计算:根据修正过的欧拉角，计算三轴的加速度的分量，从而计算出实际的加速度；在已知初速度，加速度和时间的情况下，通过对初速度
积分和加速度二次积分，计算出移动距离；第四、计算位置点:根据移动距离和方向计算当前的位置点的经纬度；
第五:纠正位置:根据计算的位置点，在道路上进行投影，进行平滑处理，得到纠正后的位置点。
说明
陀螺仪辅助定位方法
技术领域
[0001] 本发明涉及辅助定位方法，尤其是涉及一种脱落及辅助定位及其方法。
背景技术
[0002]
现有的陀螺仪辅助导航方法是采用陀螺仪定位方式，陀螺仪定位方式是基于角速度检测的原理而设计，通过一系列的运
算，得到的定位位置是相对于上次定位的一个
相对值。现有的陀螺仪辅助导航方法虽然已经使得空中指向定位成为可能，但由于得到的定位位置只是相对于上次定位的一个相对值，指向性存在一定的偏差，当长
时间偏差得不到补偿时，偏差就会在一定程度上进行累加，以至于体验越来越差，在某些特定场合，它还不能完全满足需要，另外传统的陀螺仪辅助导航是基于最后
的位置点进行导航，在导航过程中会因为时间的增加累计误差不断的增大。
发明内容
[0003] 本发明所要解决的技术问题是针对上述现有技术的不足，提供一种精度高、误差小的陀螺仪辅助定位方法。[0004] 为解决上述技术问题，本发明采取的技术方案为:陀螺仪辅助定位方法，其特征在于包括以下步骤:
首先、姿态角的测量:对加速度计的测量值和磁传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率，陀螺仪直接通过四元数微分方程得到姿态四元数速率，两个加起来积分得到姿态四元数；
其次、初始点的获取:利用加速度计和陀螺仪芯片两者的数据，进行轨迹推算，以将轨迹周期提高到惯性测量单元的数据周期；
第三、速度和移动距离的计算:根据修正过的欧拉角，计算
三轴的加速度的分量，从而计算出实际的加速度；在已知初速度，加速度和时间的情况下，通过对初速度积分和加速度二次积分，计算出移动距离；
第四、计算位置点:根据移动距离和方向计算当前的位置点的经纬度；
第五:纠正位置:根据计算的位置点，在道路上进行投影，进行平滑处理，得到纠正后的位置点。
[0005]
陀螺仪的漂移、载体的线性加速度和周围局部磁场的干扰是制约MARG传感器姿态测量精度的主要问题。本发明基于已有的惯性测量单元，设计了一个基于四元数
的Kalman滤波器，通过建立MARG传感器模型，引入传感器偏差补偿和自适应的测量噪声协方差矩阵构造方法来提
高姿态测量精度，减小载体线性加速度和
周围局部磁场的干扰，实现三自由度的姿态测量。传统的陀螺仪辅助导航是基于最后的位置点进行导航，在导航过程中会因为时间的增加累计误差不断的增大，本发
明是根据道路数据，对定位结果进行投影修正，并利用修正结果计算下一个位置点，这样就有效地减小累计误差。总之，现有技术没有解决陀螺仪的漂移、载体的线
性加速度和周围局部磁场的干扰和长时间的累积误差问题，本发明针对性的解决了陀螺仪的漂移、载体的线性加速度和
周围局部磁场的干扰问题，并把陀螺仪的空间
定位技术和实际的导航应用相结合，解决了长时间的累积误差问题，而且根据道路数据，对定位结果进行投影修正，并利用修正结果计算下一个位置点，这样就有效
地减小累计误差。
附图说明
[0006] 图1为姿态角测量的数学式图。
[0007] 图2为惯性加速度矢量图。
[0008] 图3为纠正后的位置点图。
具体实施方式
[0009] 实施例1
本陀螺仪辅助定位方法，包括以下步骤:
首先、姿态角的测量:对加速度计的测量值和磁传感器的测量值分别经过高斯牛顿迭代得到姿态误差速率，陀螺仪直接通过四元数微分方程得到姿态四元数速率，两
个加起来积分得到姿态四元数。参见图1，本陀螺仪辅助定位方法基于已有的惯性测量单元，设计了一个基于四元数的Kalman滤波器，通过建立MARG传感
器模型，引入传感器偏差补偿和自适应的测量噪声协方差矩阵构造方法来提高姿态测量精度，减小载体线性加速度和周围局部磁场的干扰，实现三自由度的姿态测
量。
[0010]
其次、初始点的获取:利用加速度计和陀螺仪芯片两者的数据，进行轨迹推算，以将轨迹周期提高到惯性测量单元的数据周期。众所周知GPS有一定的误差，如果
GPS的误差在15米范围的话，远超过了车道的宽度，要想定位在车道上，确实是个难度。可以利用固定GPS基站的
方式来校准精度，但还有一个问题，芯片提
供的定位周期最快只有一秒。就是说，这一秒范围内的轨迹是空白的，当速度达到一定程度的时候，一秒的距离已经很远，甚至已经完成了一个快速小角度偏转动
作。那么这样的话精度将会大大降低。为了填补这一秒中的轨迹空白，于是我们利用加速度计和陀螺仪芯片，利用两者数据推算轨迹，将轨迹周期提高到惯性测量单
元的数据周期，即20毫秒。
[0011]
第三、速度和移动距离的计算:根据修正过的欧拉角，计算三轴的加速度的分量，从而计算出实际的加速度；在已知初速度，加速度和时间的情况下，通过对初速度
积分和加速度二次积分，计算出移动距离；惯性加速度矢量图如图2所示，得到了惯性加速度矢量的三个分量，根据计算得出的欧拉角即可计算出我们实际方向的加
速度。
[0012] 第四、计算位置点:根据移动距离和方向计算当前的位置点的经纬度，即在地球上已知一点，距离和方向，可以求出另一点的经纬度。
[0013] 第五:纠正位置:根据计算的位置点，在道路上进行投影，进行平滑处理，得到纠正后的位置点，如图3所示。
分类
国际分类号G01C21/16 合作分类G01C21/16, G01C21/20
测试用题，请勿“题字”。用后收回。谢谢！ 一、 （20分）以下每题各有四个答案，选择正确的答案，每题5分。 (1) 设自由陀螺的角动量为H ，已知进动角速度ω，陀螺力矩为M ，下列表示三者 之间关系的表达式正确的是（ ） （A ）H M ω=? ；（B ）M H ω=?； （C ）H M ω=? ；（D ）M H ω=? (2) 采用伺服跟踪法进行单自由度陀螺测漂，转台轴沿当地垂线方向，地球自转角速度 15/ie h ω=?，当地纬度为30?，测得转台转速为4 3.0210 -?转/分，则陀螺漂移速 度约为（传动比是1∶1）（ ） （A ）0.067 /h ；（B ）0.55/h ；（C ）1.57/h ；（D ）（A ）、(B)、(C)均错； (3) 干涉式光纤陀螺光纤长1500m ，成环半径4c m ，光纤环法向角速度 1.5/h Ω=?，光波长为1580nm 。则由Sagnac 效应引起的相位差近似为（ ） （A ）4 7.9510-?（） ；（B ）0.114（）；（C ）4 3.1410-?（）；（D ）(A)、(B)、(C) 均错； (4) 动量矩定理的向量表达式为（ ） （A ） n b nb d R d R R dt dt ω=+? ；（B ） b ib d H M H dt ω=?+ ；（C ） b n nb d R d R R dt dt ω=+?；（D ）i o o d H M dt = 二、（10分）说明运动地理坐标系相对惯性空间旋转的原因，给出该旋转角速度在地理 坐标系上的分量。 三、（20分）已知坐标系b b b ox y z （b 系）与n n n ox y z （n 系）初始时重合，b 系是 n 系以转动顺序x y z →→，转角分别为α、β 、γ得到的。试：（1）求方向余 弦矩阵n I C ，b n C 和n b C ；（2）写出b 系相对n 系的瞬时角速度在b 系上的投影表达式；（3）若向量ω在b 系中的表示为T b x y z ω ωωω??=?? ，求该向量在I I I ox y z 中 的表示I ω和n n n ox y z 中的表示n ω。 五、（10分）写出单自由度陀螺的技术方程，画出其传递函数方框图；求出当初始条件为零、输入角速度1()()t t ω δ=+时积分陀螺的响应。 六、（20分）已知二自由度陀螺技术方程为x x Y Y J H M J H M βααβ?+=?-=?，且x Y J J <。试证 明当陀螺仅受到沿内环轴幅值为 A 的脉冲力矩作用时，陀螺瞬态响应曲线（βα-曲 线）为椭圆，并给出椭圆中心坐标及长短半径；求出当() 1() x Y M t M t δ=??=? 时的响应 )(),(t t βα。 （初始条件为零）。
谈谈对陀螺仪和加速度传感器的感性认识 前几天看到官网的新规则觉得很有意思看看自己帐号注册2年多了比赛也做了2届从论坛上下了大堆资料也没给论坛贡献什么有价值的东西实在惭愧啊正好自己以前捣鼓过一段时间四轴飞行器把当时收集的一些资料发上来大家共享下吧大部分取自网络还有一部分自己的思考重要的地方用红字标明了来自网络的都用蓝字标明本人才疏学浅论坛里藏龙卧虎有不对的还请大家指正新手看看全当一个感性认识。由于时间太长就不标原文地址了大家搜搜都能搜到另外四轴飞控论坛上已经看到有人跑过去要7260 和EN—03的资料了嘿嘿数据手册其实很好找的相关资料也很多的大家多多利用搜索引擎 啊 加速度传感器测的是什么？ 我觉得很多时候大家都被它的名字给误导了我觉得准确的来说它测的不是加速度至少对于mma7260这类的片子它检测的是它受到的惯性力(包括重力！重力也是惯性力)。那又有人要问了 F=ma 惯性力不就是加速度么？差矣加速度传感器实际上是用MEMS 技术检测惯性力造成的微小形变注意检测的是微小形变所以你把加速度传感器水平静止放在桌子上它的Z轴输出的是1g的加速度因为它Z轴方向被重力向下拉出了一个形变可是你绝对不会认为它在以1g的加速度往下落吧你如果让它做自由落体它的Z轴输出应该是0 给个形象的说法可以把它看成是一块弹弹胶它检测的就是自己在三个方向被外力作用造成的形变。从刚才的分析可以发现重力这个东西实际是个很恶心的东西它能隔空打牛，在不产生加速度的情况下对加速度传感器造成形变，在产生加速度的时候不造成形变，而其他力都做不到。可惜的是，加速度传感器不会区分重力加速度与外力加 速度。 所以，当系统在三维空间做变速运动时，它的输出就不正确了或者说它的输出不能表明物体的姿态和运动状态举个例子当一个物体在空间做自由落体时在X轴受到一个外力作用产生g的加速度这时候x y z 轴的输出分别是 g,0,0 如果这个物体被x轴朝下静止放在水平面上它x y z 轴的输出也分别是 g,0,0 所以说只靠加速度传感器 来估计自己的姿态是很危险而不可取的 加速度传感器有什么用？ 加速度计,可以测量加速度,包括重力加速度,于是在静止或匀速运动（匀速直线运动）的时候,加速度计仅仅测量的是重力加速度,而重力加速度与刚才所说的R坐标系（绝对坐标系）是固连的,通过这种关系,可以得到加速度计所在平面与地面的角度关系也 就是横滚角和俯仰角计算公示如下俯仰角
最全的陀螺仪基础知识详解 陀螺仪，又叫角速度传感器，是用高速回转体的动量矩敏感壳体相对惯性空间绕正交于自转轴的一个或二个轴的角运动检测装置，同时，利用其他原理制成的角运动检测装置起同样功能的装置也称陀螺仪。 一、陀螺仪的名字由来 陀螺仪名字的来源具有悠久的历史。据考证，1850年法国的物理学家莱昂·傅科（J.Foucault）为了研究地球自转，首先发现高速转动中地的转子（rotor），由于它具有惯性，它的旋转轴永远指向一固定方向，因此傅科用希腊字gyro（旋转）和skopein（看）两字合为“gyroscopei”一字来命名该仪器仪表。 最早的陀螺仪的简易制作方式如下：即将一个高速旋转的陀螺放到一个万向支架上，靠陀螺的方向来计算角速度。 其中，中间金色的转子即为陀螺，它因为惯性作用是不会受到影响的，周边的三个“钢圈”则会因为设备的改变姿态而跟着改变，通过这样来检测设备当前的状态，而这三个“钢圈”所在的轴，也就是三轴陀螺仪里面的“三轴”，即X轴、y轴、Z轴，三个轴围成的立体空间联合检测各种动作，然后用多种方法读取轴所指示的方向，并自动将数据信号传给控制系统。因此一开始，陀螺仪的最主要的作用在于可以测量角速度。 二、陀螺仪的基本组成 当前，从力学的观点近似的分析陀螺的运动时，可以把它看成是一个刚体，刚体上有一个万向支点，而陀螺可以绕着这个支点作三个自由度的转动，所以陀螺的运动是属于刚体绕一个定点的转动运动，更确切地说，一个绕对称轴高速旋转的飞轮转子叫陀螺。将陀螺安装在框架装置上，使陀螺的自转轴有角转动的自由度，这种装置的总体叫做陀螺仪。 陀螺仪的基本部件有：陀螺转子（常采用同步电机、磁滞电机、三相交流电机等拖动方法来使陀螺转子绕自转轴高速旋转，并见其转速近似为常值）；内、外框架（或称内、外环，它是使陀螺自转轴获得所需角转动自由度的结构）；附件（是指力矩马达、信号传感器等）。 三、陀螺仪的工作原理 陀螺仪侦测的是角速度。其工作原理基于科里奥利力的原理：当一个物体在坐标系中直线移动时，假设坐标系做一个旋转，那么在旋转的过程中，物体会感受到一个垂直的力和垂直方向的加速度。 台风的形成就是基于这个原理，地球转动带动大气转动，如果大气转动时受到一个切向力，便容易形成台风，而北半球和南半球台风转动的方向是不一样的。用一个形象的比喻解释了科里奥利力的原理。
加速度计和陀螺仪指南——数学模型和基本算法 本帖转自https://www.doczj.com/doc/b93602899.html,/thread-1695-1-1.html 本帖翻译自IMU（加速度计和陀螺仪设备）在嵌入式应用中使用的指南。 这篇文章主要介绍加速度计和陀螺仪的数学模型和基本算法，以及如何融合这两者，侧重算法、思想的讨论. 介绍 本指南旨在向兴趣者介绍惯性MEMS（微机电系统）传感器，特别是加速度计和陀螺仪以及其他整合IMU（惯性测量单元）设备。 IMU单元例子：上图中MCU顶端的ACC Gyro 6DOF，名为USBThumb，支持USB/串口通信 在这篇文章中我将概括这么几个基本并且重要的话题： - 加速度计（accelerometer）检测什么 - 陀螺仪（gyroscope，也称作 gyro）检测什么 - 如何将传感器ADC读取的数据转换为物理单位（加速度传感器的单位是g，陀螺仪的单位是度/秒）
- 如何结合加速度传感器和陀螺仪的数据以得到设备和地平面之间的倾角的准 确信息 在整篇文章中我尽量将数学运算降低到最少。如果你知道什么是正弦、余弦、正切函数，那无论你的项目使用哪种平台你应该都会明白和运用这篇文章中的思想，这些平台如Arduino、Propeller、Basic Stamp、Ateml芯片、PIC芯片等等。 总有些人认为使用IMU单元需要复杂的数学运算（复杂的FIR或IIR滤波，如卡尔曼滤波，Parks-McClellan滤波等）。你如果研究这些会得到很棒且很复杂的结果。我解释事情的方式，只需要基本的数学。我非常坚信简单的原则。我认为一个简单的系统更容易操作和监控，另外许多嵌入式设备并不具备能力和资源去实现需要进行矩阵运算的复杂算法。 我会用我设计的一个新IMU模块——Acc_Gyro Accelerometer + Gyro IMU作为例子。在下面的例子中我们会使用这个设备的参数。用这个模块作为介绍非常合适，因为它由3个设备组成： - LIS331AL (datasheet) – 3轴 2G 模拟加速度计 - LPR550AL (datasheet) –双轴（俯仰、翻滚）500°/s 加速度传感器 - LY550ALH (datasheet) –单轴（偏航）陀螺仪最后这个设备在这篇介绍中不使用，不过他在DCM Matrix implementation中有重要作用 它们一起组成了一个6自由度的惯性测量单元。这是个花哨的名字！然而，在花哨的名字后面是个非常有用的设备组合，接下来我们会详细介绍之。 第一部分加速度计 要了解这个模块我们先从加速度计开始。当我们在想象一个加速度计的时候我们可以把它想作一个圆球在一个方盒子中。你可能会把它想作一个饼干或者甜圈，但我就把它当做一个球好了：
介绍 本指南旨在向兴趣者介绍惯性MEMS（微机电系统）传感器，特别是加速度计和陀螺仪以及其他整合IMU（惯性测量单元）设备。 IMU单元例子：上图中MCU顶端的ACC Gyro 6DOF，名为USBThumb，支持USB/串口 通信 在这篇文章中我将概括这么几个基本并且重要的话题： - 加速度计（accelerometer）检测什么 - 陀螺仪（gyroscope，也称作gyro）检测什么 - 如何将传感器ADC读取的数据转换为物理单位（加速度传感器的单位是g，陀螺仪的单位是度/秒） - 如何结合加速度传感器和陀螺仪的数据以得到设备和地平面之间的倾角的准确信息 在整篇文章中我尽量将数学运算降低到最少。如果你知道什么是正弦、余弦、正切函数，那无论你的项目使用哪种平台你应该都会明白和运用这篇文章中的思想，这些平台如Arduino、Propeller、Basic Stamp、Ateml芯片、PIC芯片等等。总有些人认为使用IMU单元需要复杂的数学运算（复杂的FIR或IIR滤波，如卡尔曼滤波，Parks-McClellan滤波等）。你如果研究这些会得到很棒且很复杂的结果。我解释事情的方式，只需要基本的数学。我非常坚信简单的原则。我认为一个简单的系统更容易操作和监控，另外许多嵌入式设备并不具备能力和资源去实现需要进行矩阵运算的复杂算法。 我会用我设计的一个新IMU模块——Acc_Gyro Accelerometer + Gyro IMU作为例子。在下面的例子中我们会使用这个设备的参数。用这个模块作为介绍非常合适，因为它由3个设备组成： - LIS331AL (datasheet) – 3轴2G 模拟加速度计 - LPR550AL (datasheet) –双轴（俯仰、翻滚）500°/s 加速度传感器 - LY550ALH (datasheet) –单轴（偏航）陀螺仪最后这个设备在这篇介绍中不使用，不过他在DCM Matrix implementation中有重要作用
光纤陀螺仪测试方法 1范围 本标准规定了作为姿态控制系统、角位移测量系统和角速度测量系统中敏感器使用的单轴干涉性光纤陀螺仪（以下简称光纤陀螺仪）的性能测试方法。 2规范性引用文件 下列文件中的条款通过本标准的引用而成为本标准的条款。凡是注目期的引用文件，其随后所有的修改单（不包含勘误的内容）或修订版均不适用于本标准，然而，鼓励根据本标准达成协议的各方研究是否可使用这些文件的最新版本。凡是不注日期的引用文件，其最新版本适用于本标准。 GB321-1980优先数和优先系数 CB998低压电器基本实验方法 GJB585A-1998惯性技术术语 GJB151军用设备和分系统电磁发射和敏感度要求 3术语、定义和符号 GJB585A-1998确立的以及下列术语、定义和符号适用于本标准。
3.1术语和定义 3.1.1干涉型光纤陀螺仪interferometric fiber optic gyroscope 仪萨格奈克（Sagnac）效应为基础，由光纤环圈构成的干涉仪型角速度测量装置。当绕其光纤环圈等效平面的垂线旋转时，在环圈中以相反方向传输出的两束相干光间产生相位差，其大小正比于该装置相对于惯性空间的旋转角速度，通过检测输出光干涉强度即反映出角速度的变化。 3.1.2陀螺输入轴input axis of gyro 垂直于光纤环圈等效平面的轴。当光纤陀螺仪绕该轴有旋转角速度输入时，产生光纤环圈相对于惯性空间输入角速度的输出信号。 3.1.3标度因数非线性度scale factor nonlinearity 在输入角速度范围内，光纤陀螺仪输出量相对于最小二乘法拟合直线的最大偏差值与最大输出量之比。 3.1.4零偏稳定性bias stability 当输入角速度为零时，衡量光纤陀螺仪输出量围绕其均值的离散程度。以规定时间内输出量的标准偏差相应的等效输入角速度表示，也可称为零漂。
加速度计和陀螺仪传感器原理、检测及应用 摘要：微机电系统（MEMS）在消费电子领域的应用越来越普及，移动市场的增长也带动了MEMS需求的日益旺盛。实际上，MEMS传感器正在成为消费类和移动产品差异化的关键要素，例如游戏控制器、智能手机和平板电脑。MEMS为用户提供了与其智能设备交互的全新方式。本文简要介绍MEMS的工作原理、检测架构以及各种潜在应用。本文网络版地址：http：//https://www.doczj.com/doc/b93602899.html,/article/247467.htm 关键词：MEMS；加速度计；陀螺仪；传感器 DOI：10.3969/j.issn.1005-5517.2014.5.013 引言 微机电系统（MEMS）将机械和电子元件集成在微米级的小型结构中。利用微机械加工将所有电气器件、传感器和机械元件集成至一片共用的硅基片，从而由半导体和微加工技术组合而成。MEMS系统的主要元件是机械单元、检测电路以及ASIC或微控制器。本文简要介绍MEMS加速度计传感器和陀螺仪，讨论其工作原理、检测结构以及目前市场的热点应用，对我们日常生活具有深远的影响。 1 MEMS惯性传感器 MEMS传感器在许多应用中测量沿一个或多个轴向的
线性加速度，或者环绕一个或多个轴的角速度，以作为输入控制系统（图1）。 MEMS加速度计传感器通常利用位置测量接口电路测 量物体的位移，然后利用模/数转换器（ADC）将测量值转换为数字电信号，以便进行数字处理。陀螺仪则测量物体由于科里奥利加速度而发生的位移。 2 加速度计工作原理 根据牛顿第二定律，物理加速度（m/s2）与受到的合力（N）成正比，与其质量（kg）成反比，加速度方向与合力相同。 上述过程可简单归纳为：作用力导致物体发生位移，进而发生电容变化。将多个电极并联，可获得更大的电容变化，更容易检测到位移（图4）。V1和V2连接至电容的每侧，电容分压器的中心连接到物体。 物体重心的模拟电压通过电荷放大、信号调理、解调及低通滤波，然后利用Σ-ΔADC将其转换为数字信号。将ADC输出的数字比特流送至FIFO缓存器，后者将串行信号转换为并行数据流。随后，可通过诸如I2C或SPI等串行协议读取数据流，再将其送至主机做进一步处理（图5）。 Σ-ΔADC具有信号带宽较窄，分辨率非常高，适合加速度计应用。Σ-ΔADC输出由其位数决定，很容易转换成“g”（单位），用于加速度计算。“g”为重力加速度。
陀螺仪知识整理与解析 1、陀螺仪基础知识 (2) 2、Question and answer (2) 3、陀螺仪和加速度计的区别与联系 (3) 4、常用芯片介绍 (3)
1、陀螺仪基础知识 陀螺仪：测量角速度，是角速度传感器。时间积分后得到相对角度。陀螺和加速度计是惯性器件，是用来测量相对惯性空间的角速度（或对于积分类型的陀螺来说是角增量）和加速度。 在三维空间中描述一个刚体运动要六轴，三轴加速度，三轴角速度。测量角速度大部分芯片靠的是测量科特迪奥力，也就是让排水孔的水形成涡旋的力。 角速度跟角速率：速度是矢量、有方向。而速率是标量，只有大小，帶有平均的意味。如果采样点很快的話(dt趋于0)，速度和速率的数值是一样的。 航模的陀螺仪全是角速度传感器，不管是高端还是低端。 mems陀螺仪积分很多时候造成零偏的主要原因应该是随机游走。 2、Question and answer Q：角速度传感器如果在它的测量轴上匀速转动输出是否为定值？ A：是，不过首先要保证你是在匀速转动。 用过几种角速度传感器，发现匀速转动传感器，因为加了高通滤波，传感器输出的电平和静止时的电平一样，只有加速的时候电平才变动。 Q：如果在测量轴的某一位置静态输出为A，那么匀速转过45度后静止，那么此时输出是否为A？ A：如果是静止测量，是如此的。但由于频宽，通常信号有一点点滞后。 Q:用陀螺仪测角度的话，是不是对测出的角速度积分即可？网上看到有些资料说可以用陀螺仪和加速度传感器组合测角度，这种方法具体如何实现？ A：理论上如此，但是由于bias、drift、scale和数值积分的误差，积分结果是会漂移的。 假设加速度计测量到重力加速度时，可以对陀螺仪校正角
MEMS加速度计原理 技术成熟的MEMS加速度计分为三种:压电式、容感式、热感式。压电式MEMS加速度计运用的是压电效应，在其内部有一个刚体支撑的质量块，有运动的情况下质量块会产生压力，刚体产生应变，把加速度转变成电信号输出。 容感式MEMS加速度计内部也存在一个质量块，从单个单元来看，它是标准的平板电容器。加速度的变化带动活动质量块的移动从而改变平板电容两极的间距和正对面积，通过测量电容变化量来计算加速度。Freescale的MMA7660FC这一款加速度计（3-Axis Orientation/MotionDetection Sensor），这一款芯片也是利用这一原理设计的。datasheet的第9页介绍了其工作原理：当芯片有向右的加速度时，中间的活动质量快相对于另外两块电容板向左移动，这两平行板电容器的电容就发生了变化，从而测量出芯片运动的加速度。 热感式MEMS加速度计内部没有任何质量块，它的中央有一个加热体，周边是温度传感器，里面是密闭的气腔，工作时在加热体的作用下，气体在内部形成一个热气团，热气团的比重和周围的冷气是有差异的，通过惯性热气团的移动形成的热场变化让感应器感应到加速度值。 由于压电式MEMS加速度计内部有刚体支撑的存在，通常情况下，压电式MEMS加速度计只能感应到“动态”加速度，而不能感应到“静态”加速度，也就是我们所说的重力加速度。而容感式和热感式既能感应“动态”加速度，又能感应“静态”加速度。 从上面的分析中，我们可以看到利用容感式和热感式加速度计进行定向时，加速度计测得的加速度里面包括重力加速度在各个轴上的重力分量和动态运动引起的加速度分量。因而，我觉得我们在利用这一类加速度计进行定向时，必须将动态加速度去掉（较为困难）；在进行检测芯片的运动时，必须将重力加速度的去掉。 师兄，我觉得如果我们选择用加速度计来进行定向的话，我们可以考虑ST的LSM303DLH （5*5*1mm,0.83mA）这一款芯片。这一款芯片集成了测加速度和磁场的功能，完全可以满足我们定向的需求
陀螺仪、加速度之我见 作者：茶不思 可能一个模块一个模块的讲有些啰嗦,而且这些模块的使用方法网上也有很多教程,我以后就不在说这个了.大家有问题就搜索下吧,很容易找到.我目前用到的外设有:timer,usart,iic,spi,flash,gpio,exit,暂时就这么多. 今天想跟大家谈谈加速度计和陀螺仪,不少人在问加速度计陀螺仪的数据读出来了怎么用,咱们就从这两个传感器的特点开始了解下,了解了特点,用法就很容易了. 以下仅代表个人观点,有哪里不对,还请指出.... 做个比喻吧,加速度计,以下简称加计,大家可以把它想象成一个铁块,这个铁块是个立方体,有前后左右上下六个面,每个面连接有一个弹簧,弹簧另一端假设固定在一个卡车的集装箱里面,这样这个铁块就被这六个弹簧吊在集装箱里面了,由于铁块有重力,所以汽车不动时,上面的弹簧被拉长,下面的弹簧被压缩,这里假设是通过测量弹簧的拉力来输出加速度(实际有可能是电容什么的,这里不做讨论,了解特性就好),六个弹簧,两两一组,正好3个轴,这就是3轴加速度了,静止不动时,只有Z轴也就是上下两根弹簧有读数,其他两对弹簧是平衡的.现在假设汽车在做加速运动,那么不仅仅上下两根弹簧不平衡了,前后两根弹簧也会有变化,前面的弹簧拉长,后面的弹簧压缩,就有了前后方向的加速度.左右也是一个道理. 知道了加计的大致原理,那么加计有什么特点呢?让我们大家想象一种情况,就是这辆卡车行驶在颠簸的路上,集装箱里面的铁块肯定不会稳稳的吊着了,他会随着汽车左摇右摆,上下颠簸,而且有一点大家注意,铁块的此时的摆动,不是完全和汽车同步的,由于惯性等原因,铁块会在里面"乱动",荡来荡去,此时的加速度输出会是怎么样的呢?肯定也是随着铁块"荡来荡去",所以我们得出加计的一大特点,就是对震动很"敏感",如果把飞控板放在桌子上静止不动,可以说随便一个姿态算法的输出都不错,哪怕不滤波.可以当电机一转动起来,震动来了,加计就有了很大的干扰,此时如果处理不好,姿态就乱掉了. 然后我们再说说陀螺仪,陀螺仪顾名思义,肯定和陀螺有很大关系,没错,特点也和陀螺一样.还是假设在这个车里面,我们放上一个小时候玩的陀螺,不管用了什么方法,让它高速旋转起来,大家都知道,这样陀螺是不会倒的,他会尽量保持当前的姿态,陀螺仪正是利用这个特点.我们看两段视频来了解下. 通过视频,大家可以看到,陀螺在高速旋转时,是会尽量保持转轴不变的.那么我们就可以想到陀螺仪的特点了,就是对震动是"不敏感"的,因为它会尽量保持自己不被震动改变,但是陀螺会不断累积误差,造成"漂移". 好了,这里我们知道了加计和陀螺仪的特点,再考虑怎么使用,就简单多了,
陀螺仪”和“加速度计”工作原理 2016-09-17 16:14:40 作者：没有夏天的四叶草修改：小马hoty 时间：2016/1/10 最近看到加速度计和陀螺仪比较火，而且也有很多人都在研究。于是也在网上淘了一个mpu6050模块，想用来做自平衡小车。可是使用起来就发愁了。网上关于mpu6050的资料的确不少，但是大家都是互相抄袭，然后贴出一段程序，看完之后还是不知道所以然。经过翻阅各个方面的资料，以及自己的研究在处理mpu6050数据方面有一些心得，在这里和大家分享一下。 1、加速度和陀螺仪原理 当然，在开始之前至少要弄懂什么是加速度计，什么是陀螺仪吧，否则那后边讲的都是没有意义的。简单的说，加速度计主要是测量物体运动的加速度，陀螺仪主要测量物体转动的角速度。这些理论的知识我就不多说了，都可以在网上查到。这里推荐一篇讲的比较详细的文章《AGuide To using IMU (Accelerometer and Gyroscope Devices) inEmbeddedApplications》，在网上可以直接搜索到。 2、加速度测量 在开始之前，不知大家是否还记得加速度具有合成定理？如果不记得可以先大概了解一下，其实简单的举个例子来说就是重力加速度可以理
解成是由x,y,z三个方向的加速度共同作用的结果。反过来说就是重力加速度可以分解成x,y,z三个方向的加速度。 加速度计可以测量某一时刻x,y,z三个方向的加速度值。而自平衡小车利用加速度计测出重力加速度在x,y,z轴的分量，然后利用各个方向的分量与重力加速度的比值来计算出小车大致的倾角。其实在自平衡小车上非静止的时候，加速度计测出的结果并不是非常精确。因为大家在高中物理的时候都学过，物体时刻都会受到地球的万有引力作用产生一个向下的重力加速度，而小车在动态时，受电机的作用肯定有一个前进或者后退方向的作用力，而加速度计测出的结果是，重力加速度与小车运动加速度合成得到一个总的加速度在三个方向上的分量。 不过我们暂时不考虑电机作用产生的运动加速度对测量结果的影响。因为我们要先把复杂的事情分解成一个个简单的事情来分析，这样才能看到成果，才会有信心继续。 下边我们就开始分析从加速度得到角度的方法。如下图，把加速度 计平放，分别画出xyz轴的方向。这三个轴就是我们后边分析所要用到的坐标系。如图一
加速度传感器测的是什么？ 我觉得很多时候大家都被它的名字给误导了我觉得准确的来说它测的不是加速度至少对于mma7260这类的片子它检测的是它受到的惯性力(包括重力！重力也是惯性力)。那又有人要问了F=ma 惯性力不就是加速度么？差矣加速度传感器实际上是用MEMS技术检测惯性力造成的微小形变注意检测的是微小形变所以你把加速度传感器水平静止放在桌子上它的Z轴输出的是1g的加速度因为它Z轴方向被重力向下拉出了一个形变可是你绝对不会认为它在以1g的加速度往下落吧你如果让它做自由落体它的Z轴输出应该是0 给个形象的说法可以把它看成是一块弹弹胶它检测的就是自己在三个方向被外力作用造成的形变。从刚才的分析可以发现重力这个东西实际是个很恶心的东西它能隔空打牛，在不产生加速度的情况下对加速度传感器造成形变，在产生加速度的时候不造成形变，而其他力都做不到。可惜的是，加速度传感器不会区分重力加速度与外力加速度。 所以，当系统在三维空间做变速运动时，它的输出就不正确了或者说它的输出不能表明物体的姿态和运动状态举个例子当一个物体在空间做自由落体时在X轴受到一个外力作用产生g的加速度这时候x y z 轴的输出分别是g,0,0 如果这个物体被x轴朝下静止放在水平面上它x y z 轴的输出也分别是g,0,0 所以说只靠加速度传感器来估计自己的姿态是很危险而不可取的 加速度传感器有什么用？ 加速度计,可以测量加速度,包括重力加速度,于是在静止或匀速运动（匀速直线运动）的时候,加速度计仅仅测量的是重力加速度,而重力加速度与刚才所说的R坐标系（绝对坐标系）是固连的,通过这种关系,可以得到加速度计所在平面与地面的角度关系也就是横 滚角和俯仰角计算公示如下俯仰角横滚角 陀螺仪测的是什么？ 陀螺仪可以测量角速度,具有高动态特性,但是它是一个间接测量器件,它测量的是角度的导数,角速度,显然我们要将角速度对时间积分才能得到角度看到积分我想敏感的同学马上就能发现一个致命的问题积分误差 积分误差的来源主要有两个一个是积分时间积分时间Dt越小，输出角度越准一个是器件本身的误差假设陀螺仪固定不动,理想角速度值是0dps(degree per second)，但是有一个偏置0.1dps加在上面,于是测量出来是0.1dps,积分一秒之后,得到的角度是0.1度,1分钟之后是6度,还能忍受,一小时之后是360度,转了一圈所以说陀螺仪在短时间内有很大的参考价值 陀螺仪另外一个问题是它的测量基准是自身，并没有系统外的绝对参照物重力轴是个绝好的参照物因此需要陀螺仪和加速度传感器的配合使用如果要测偏航角YAW 还需要电子罗盘感知地磁方向给出水平方向的绝对参考（当然这个在智能车上不存在吧······——！） 陀螺仪和加速度传感器的融合 除了给出绝对参考系陀螺仪和加速度传感器相互融合使用的最重要的原因是： 综合考虑，加速度计是极易受外部干扰的传感器，但是测量值随时间的变化相对较小。陀螺仪可以积分得到角度关系，动态性能好，受外部干扰小，但测量值随时间变化比较大。可以看出，它们优缺点互补，结合起来才能有好的效果 用通俗点的话来说就是无论工作多久加速度传感器如果没收到外部干扰它测的就一定是准的！陀螺仪虽不会受到外部干扰可是时间长了由于积分误差累计它的值就全错
//float gyro_m：陀螺仪测得的量（角速度） //float incAngle:加计测得的角度值 #define dt 0.0015//卡尔曼滤波采样频率 #define R_angle 0.69 //测量噪声的协方差（即是测量偏差） #define Q_angle 0.0001//过程噪声的协方差 #define Q_gyro 0.0003 //过程噪声的协方差过程噪声协方差为一个一行两列矩阵float kalmanUpdate(const float gyro_m,const float incAngle) { float K_0;//含有卡尔曼增益的另外一个函数，用于计算最优估计值 float K_1;//含有卡尔曼增益的函数，用于计算最优估计值的偏差 float Y_0; float Y_1 float Rate;//去除偏差后的角速度 float Pdot[4];//过程协方差矩阵的微分矩阵 float angle_err;//角度偏量 float E;//计算的过程量 static float angle = 0; //下时刻最优估计值角度 static float q_bias = 0; //陀螺仪的偏差 static float P[2][2] = {{ 1, 0 }, { 0, 1 }};//过程协方差矩阵 Rate = gyro_m - q_bias; //计算过程协方差矩阵的微分矩阵 Pdot[0] = Q_angle - P[0][1] - P[1][0];//？？？？？？ Pdot[1] = - P[1][1]; Pdot[2] = - P[1][1]; Pdot[3] = Q_gyro;//？？？？？？ angle += Rate * dt; //角速度积分得出角度 P[0][0] += Pdot[0] * dt; //计算协方差矩阵 P[0][1] += Pdot[1] * dt; P[1][0] += Pdot[2] * dt; P[1][1] += Pdot[3] * dt; angle_err = incAngle - angle; //计算角度偏差 E = R_angle + P[0][0]; K_0 = P[0][0] / E; //计算卡尔曼增益 K_1 = P[1][0] / E; Y_0 = P[0][0]; Y_1 = P[0][1]; P[0][0] -= K_0 * Y_0; //跟新协方差矩阵 P[0][1] -= K_0 * Y_1; P[1][0] -= K_1 * Y_0; P[1][1] -= K_1 * Y_1; angle += K_0 * angle_err; //给出最优估计值 q_bias += K_1 * angle_err;//跟新最优估计值偏差 return angle;}
本帖翻译自IMU（加速度计和陀螺仪设备）在嵌入式应用中使用的指南。 这篇文章主要介绍加速度计和陀螺仪的数学模型和基本算法，以及如何融合这两者，侧重算法、思想的讨论 介绍 本指南旨在向兴趣者介绍惯性MEMS（微机电系统）传感器，特别是加速度计和陀螺仪以及其他整合IMU（惯性测量单元）设备。 IMU单元例子：上图中MCU顶端的ACC Gyro 6DOF，名为USBThumb，支持USB/串口通信 在这篇文章中我将概括这么几个基本并且重要的话题： - 加速度计（accelerometer）检测什么 - 陀螺仪（gyroscope，也称作 gyro）检测什么 - 如何将传感器ADC读取的数据转换为物理单位（加速度传感器的单位是g，陀螺仪的单位是度/秒） - 如何结合加速度传感器和陀螺仪的数据以得到设备和地平面之间的倾角的准确信息 在整篇文章中我尽量将数学运算降低到最少。如果你知道什么是正弦、余弦、正切函数，那无论你的项目使用哪种平台你应该都会明白和运用这篇文章中的思想，这些平台如Arduino、Propeller、Basic Stamp、Ateml芯片、PIC芯片等等。总有些人认为使用IMU 单元需要复杂的数学运算（复杂的FIR或IIR滤波，如卡尔曼滤波，Parks-McClellan滤波等）。你如果研究这些会得到很棒且很复杂的结果。我解释事情的方式，只需要基本的数学。我非常坚信简单的原则。我认为一个简单的系统更容易操作和监控，另外许多嵌入式设备并不具备能力和资源去实现需要进行矩阵运算的复杂算法。 我会用我设计的一个新IMU模块——Acc_Gyro Accelerometer + Gyro IMU作为例子。在下面的例子中我们会使用这个设备的参数。用这个模块作为介绍非常合适，因为它由3个设备组成： - LIS331AL (datasheet) – 3轴 2G 模拟加速度计
SUCCESS BELONGS TO THE ONE WITH CLEAR AND LONG-TERM GOALS! 电子陀螺仪的角度获取测试 2013-06-07 16:11 by DarkHorse, 111 阅读, 0 评论, 收藏, 编辑 导航中经常用到电子陀螺。为了测试陀螺仪在静止下的零漂输出和运动情况下的输出角度值，做了2个实验。用的陀螺仪型号是：L3G4200DTR 是一个三轴输出的MEMS电子陀螺。 1 零漂测试 让陀螺仪静止不动，运行5分钟，记录串口输出数据，并解析出三个轴的角速度值。在matlab里面进行仿真。 function main clc; clear; dataFile = input('put file: ','s'); nCount = 0; fileHandle = fopen(dataFile,'r');
while ~feof(fileHandle) string = fgetl(fileHandle); nCount = nCount + 1; end nCount = nCount-2; frewind(fileHandle); i = 1; while ~feof(fileHandle) string = str2num(fgetl(fileHandle)); zData(i) = string(3); i = i + 1; if i > nCount break; end end fclose(fileHandle); figure(1); plot(zData,'b-'); hold on; meanZData = mean(zData); title('原始Z轴输出数据'); xlabel('ms'); ylabel('dps(degree per second)'); text(3500, 1.2, ['mean=',num2str(meanZData)]); figure(2); newData = runge_kutta_intergration(zData); plot(newData); xlabel('ms'); ylabel('degree'); title('积分输出的角度'); function newData = runge_kutta_intergration(rawData) samplePeriod = 0.1;%%100ms size = length(rawData); i=1; while (i <= size) %%%%%简单的积分累加获取角度 if(i == 1) Data(i) = rawData(i); else
陀螺仪的工作原理 陀螺仪的原理就是，一个旋转物体的旋转轴所指的方向在不受外力影响时，是不会改变的。人们根据这个道理，用它来保持方向，制造出来的东西就叫陀螺仪。我们骑自行车其实也是利用了这个原理。轮子转得越快越不容易倒，因为车轴有一股保持水平的力量。陀螺仪在工作时要给它一个力，使它快速旋转起来，一般能达到每分钟几十万转，可以工作很长时间。然后用多种方法读取轴所指示的方向，并自动将数据信号传给控制系统。 现代陀螺仪是一种能够精确地确定运动物体的方位的仪器，它是现代航空，航海，航天和国防工业中广泛使用的一种惯性导航仪器，它的发展对一个国家的工业，国防和其它高科技的发展具有十分重要的战略意义。传统的惯性陀螺仪主要是指机械式的陀螺仪，机械式的陀螺仪对工艺结构的要求很高，结构复杂，它的精度受到了很多方面的制约。自从上个世纪七十年代以来，现代陀螺仪的发展已经进入了一个全新的阶段。1976年等提出了现代光纤陀螺仪的基本设想，到八十年代以后，现代光纤陀螺仪就得到了非常迅速的发展，与此同时激光谐振陀螺仪也有了很大的发展。由于光纤陀螺仪具有结构紧凑，灵敏度高，工作可靠等等优点，所以目前光纤陀螺仪在很多的领域已经完全取代了机械式的传统的陀螺仪，成为现代导航仪器中的关键部件。和光纤陀螺仪同时发展的除了环式激光陀螺仪外，还有现代集成式的振动陀螺仪，集成式的振动陀螺仪具有更高的集成度，体积更小，也是现代陀螺仪的一个重要的发展方向。 现代光纤陀螺仪包括干涉式陀螺仪和谐振式陀螺仪两种，它们都是根据塞格尼克的理论发展起来的。塞格尼克理论的要点是这样的：当光束在一个环形的通道中前进时，如果环形通道本身具有一个转动速度，那么光线沿着通道转动的方向前进所需要的时间要比沿着这个通道转动相反的方向前进所需要的时间要多。也就是说当光学环路转动时，在不同的前进方向上，光学环路的光程相对于环路在静止时的光程都会产生变化。利用这种光程的变化，如果使不同方向上前进的光之间产生干涉来测量环路的转动速度，这样就可以制造出干涉式光纤陀螺仪，如果利用这种环路光程的变化来实现在环路中不断循环的光之间的干涉，也就是通过调整光纤环路的光的谐振频率进而测量环路的转动速度，就可以制造出谐振式的光纤陀螺仪。从这个简单的介绍可以看出，干涉式陀螺仪在实现干涉时的光程差小，所以它所要求的光源可以有较大的频谱宽度，而谐振式的陀螺仪在实现干涉时，它的光程差较大，所以它所要求的光源必须有很好的单色性。
常见的陀螺仪性能指标与解释 零偏 零偏，又称为零位漂移或零位偏移或零偏稳定性，也可简称零漂或漂移率，英文中称为drift或bias drift。零偏应理解为陀螺仪的输出信号围绕其均值的起伏或波动，习惯上用标准差（σ）或均方根（RMS）表示，一般折算为等效输入角速率(°/ h)。在角速度输入为零时，陀螺仪的输出是一条复合白噪声信号缓慢变化的曲线，曲线的峰-峰值就是零偏值（drift），如图2-6所示。在整个性能指标集中，零偏是评价陀螺仪性能优劣的最重要指标。 分辨率 陀螺仪中的分辨率是用白噪声定义的，如图2-6 中所示，可以用角随机游走来表示，可以简化为一定带宽下测得的零偏稳定性与监测带宽的平方根之比，其单位为°??1Hz，或简化为°?。角度随机游走表征了长时间累积的角
度误差。角随机游动系数反映了陀螺在此处键入公式。的研制水平，也反映了陀螺可检测的最小角速率能力，并间接反映了与光子、电子的散粒噪声效应所限定的检测极限的距离。据此可推算出采用现有方案和元器件构成的陀螺是否还有提高性能的潜力。 标度因子 标度因子是陀螺仪输出量与输入角速率变化的比值，通常用某一特定的直线斜率表示，该斜率是根据整个正(或负)输入角速率范围内测得的输入/输出数据，通过最小二乘法拟合求出的直线斜率。对应于正输入和负输入有不同的刻度因子称为刻度因子不对称，其表明输入输出之间的斜率关系在零输入点不连续。一般用刻度因子稳定性来衡量刻度因子存在的误差特性，它是指陀螺在不同输入角速率情况下能够通过标称刻度因子获得精确输出的能力。非线性往往与刻度因子相关，是指由实际输入输出关系确定的实际刻度因子与标称刻度因子相比存在的非线性特征，有时还会采用线性度，其指陀螺输入输出曲线与标称直线的偏离程度，通常以满量程输出的百分比表示。 动态范围 陀螺在正、反方向能检测到的输入角速率的最大值表示了陀螺的测量范围。该最大值除以阀值即为陀螺的动态范围，该值越大表示陀螺敏感速率的能力越强。 带宽 带宽是指陀螺能够精确测量输入角速度的频率范围，这个频段范围越大表明
AHRS（航姿参考系统）和IMU（惯性测量单元）的区别 分类：算法学习2014-05-28 15:12 565人阅读评论(0) 收藏举报AHRS（航姿参考系统）和IMU（惯性测量单元）的区别【转】 刚开始的时候我总是搞不清楚AHRS和 IMU的区别。。不知道这有什么区别。。后来慢慢的慢慢的，我理解了～AHRS 俗称航姿参考系统，AHRS由加速度计，磁场计，陀螺仪构成，AHRS的真正参考来自于地球的重力场和地球的磁场～～他的静态终精度取决于对磁场的测量精度和对重力的测量精度 ,而则陀螺决定了他的动态性能。 这就是AHRS～在这种前提下。说明AHRS离开了地球这种有重力和磁场环境的时候是没法正常工作的～～而且特别注意。。磁场和重力场越正交，则航姿测量效果越好～～也就是说如果磁场和重力场平行了，比如在地磁南北极。。这里的磁场是向下的，即和重量场方向相同了。。这个时候航线交是没法测出的～～这是航姿系统的缺陷所在。。在高纬度的地方航线角误差会越来越大～～ （IMU）Inertial measurement unit，（非内蒙古大学——Inner Mongolia University）学名惯性测量单元，大学的理论力学告诉我们，所有的运动都可以分解为一个直线运动和一个旋转运动，故这个惯性测量单元就是测量这两种运动，直线运动通过加速度计可以测量，旋转运动则通过陀螺。。 我假设IMU的陀螺和加速度计的测量是没有任何误差的～～那么通过陀螺则可以精确的测量物体的姿态。。通过加速度计可以二次积分得出位移，实现完整的6DOF,也就是说你带着一台这种理论型的IMU在宇宙任何位置运动。。我们都可以知道他当前的姿态和相对位移～～这将不局限于任何场。。 从上面的描述何以看出。实际上AHRS比IMU还多一个磁场传感器，而为什么AHRS 的级别却低于IMU而需要依赖于重力场和磁场呢～～这是由传感器器件架构所决定的。。AHRS的传感器通常是成本低廉的mems传感器。。这种传感器的陀螺仪和加速度计的噪声相对来说很大，以平面陀螺为例用ADI的陀螺仪进行积分一分钟会漂移2度左右，这种前提下如果没有磁场和重力场来修正三轴陀螺的话。。那么基本上3分钟以后物体的实际姿态和测量输出姿态就完全变样了～～所以在这种低价陀螺仪和加速度计的架构下必须运用场向量来进行修正～～ 而IMU实际上也是这样的。。。因为我们知道没有绝对精确的传感器，只有相对精确的传感器，IMU的陀螺仪用的是光纤陀螺或者机械陀螺～～这种陀螺的成本很高。。精度相对mems陀螺也很高～～精度高不代表准确， IMU的姿态精度参数通常是一小时飘多少度，比如xbow的低端的有一小时3度的。。 而用加速度计积分做位置的话。AHRS是不现实的（1分钟就能飘出几十米。。而且是成二次方的速度递增）。。AHRS通常要结合GPS和气压计做位置～～我听说的IMU积分做位置的是一天多少海里。。这样的一个参数数量级。。也许在海上还能用的到～～ 这就是AHRS和IMU在我的理解里的一个差异。。自己给自己梳理