以STM32为硬件平台使用MPU9250来进行九轴数据融合，使用到的传感器为陀螺仪、加速度计、磁力计，姿态融合算法采用的是mahony算法，最后静止时yaw角在1度以内跳动，本文的定位是一篇惯导的入门级说明书，仅以这几天的努力为后世之人做垫脚石。第二版，调试了代码的BUG，修正一些认识上的不足

最新的imu姿态解算代码，包含陀螺仪加速度原始数据处理，以及姿态解算，获取姿态角，内含2个源文件和两个头文件，和完整的注释，代码简洁易读，效果好，可移植性高，只需提供相应的宏接口，以及原始的传感器数据，便可让精度控制在0.05，只要按照说明执行，不会出现漂移现象，超调现象，延迟现象，欢迎大家参考！该代码支持所有6轴传感器，（说明：未使用到磁力计部分，故yaw角会出现持续性漂移）

MiniIMU AHRS 姿态仪采用主控制芯片STM32F103T8，通过电路板上的8M晶体和stm32内部的PLL，控制器可以运行在72M的主频上，对于姿态解算这种需求大量数学运行的程序，更快的处理速度可以做更多的解算优化。MiniIMU AHRS 姿态仪通过I2C接口与STM32F连接，同时传感器的数据中断引脚与STM32F的IO相连。使得传感器在完成ADC转换后，STM32F在第一时间读取最新的数据，快速响应姿态的变化。MiniIMU AHRS 姿态仪预写了各个芯片的驱动和姿态解算程序，该程序有以下功能: 读取MPU-6050输出的三轴角速度和三轴加速度ADC值 读取HMC5883磁力计各个轴所感应到的磁力强度ADC值 读取气压计BPM180的温度和气压并经过校正程序得到真实的气压高度 运行一个IMU解算程序，得到当前模块的俯仰，横滚，航向，气压高度 和温度 程序将各个传感器值和解算后的姿态发送到主串口TXO输出给上位机。连接上位机将显示波形和各传感器值 以上功能提供源码，编译器为MDK:编译环境:MDK-Lite Version: 4.23 MiniIMU AHRS 姿态仪硬件组成: MPU-6050 集成3轴陀螺仪和3轴加速器 HMC5883L 3轴地磁传感器 BPM180 气压高度计 STM32F103T8 32-bit ARM CortexM3处理器运行在72M时钟 miniIMU AHRS 姿态测量系统硬件框图: 电源组成: 数字电源与模拟电源使用独立的稳压器供电，在靠近各传感器VCC端都放置有大容量电容保证 稳定的电源供应给传感器。使数据更加稳定可靠。 通信接口: miniIMUDEMO引出两个UART异步串行接口。电路板侧边的UART将用于主数据输出和命令输入。 而另外一个UART可以用于连接GPS、数传电台或者是遥控数据，使模块集成更多的功能 两个UART可以运行在115200bps，支持DMA传送。 集成硬件循环冗余校验(CRC)，更快速的数据校验，提高通信效率。 姿态数据处理: miniIMUDEMO集成了一只STM32F103T8，基于ARM Cortex-M3内核，通过板子上的8M晶体和PLL，STM32可以运行在最高72M时钟，高达20K字节的SRAM并且支持7通道的DMA。STM32具有 单周期乘法和硬件除法器，运行姿态解算sin cos atan2这些三角函数更加游刃有余。 STM32调试接口: miniIMUDEMO出于体积考虑，只引出了STM32的串行SWD调试接口，你可以使用STlink或者是Jlink等调试工具。SWD接口需要4条线连接到仿真器: 1.VCC 2.GND 3.SWCLK 4.SWDIO 输入电源: 4V - 7V 直流电源输入，运行时电流约40mA @ 5V MiniIMU AHRS 姿态仪接口定义: 可能感兴趣的项目设计: 姿态传感器IMU模块 附源码和上位机，链接:https://www.cirmall.com/circuit/1730/detail?3 上位机调试系统，如下截图: 1.显示加速度、陀螺仪和磁力计各个轴的当前值，并用波形显示 2.使用3D显示当前解算的姿态，Pitch Roll 和Yaw 3.温度计和当前气压高度值 4.使用地平仪显示俯仰和横滚角

提出了捷联惯导系统姿态解算模块的实现全过程，C++源代码附上。简单易懂

程序实现。

三轴陀螺仪和三轴加速度计来解算车辆姿态，使用算法Mahony，有MATLAB代码和C代码

MPU6050 陀螺仪 STM32卡尔曼滤波滤波源码，带有详细的中文注释。

采用Madgwick算法实现姿态解算，加速度计和磁强计采用梯度下降法用来补偿陀螺仪的误差。

MPU6050姿态解算STM32源码（DMP），非常好用，支持keil。

三维空间中的旋转可以用四元数来表达，用四元数表达三维的旋转与使用矩阵相比具有两个优点:第一,几何意义明确;第二,计算简单.因此,四元数在数学、物理学和计算机图形学中具有很高的应用价值.本文详细叙述了四元数的这一功能,讨论了四元数的定义、运算、性质、几何意义和它的3种表达形式,给出了使用四元数处理点的各种几何变换的一般结论.