Arduino uno + mpu6050 陀螺仪 运用卡尔曼滤波姿态解算源代码(总共4套程序)全部编译通过没有问题

本人亲测好用的MPU6050姿态解算STM32源码（卡尔曼滤波）算法，希望帮助大家

本设计是一种基于微机电（Micro-Electro-Mechanical System, MEMS）惯性测量单元（Inertial Measurement Unit, IMU）和低功耗单片机的可穿戴人体运动分析模块，可用来解决消防员火灾现场室内定位的问题。该模块通过MEMS惯性传感器测量消防员足部运动的角速度和加速度，利用Mahony互补滤波算法进行姿态解算，并将载体坐标系加速度转化成世界坐标系加速度，对世界坐标系加速度进行二重积分计算，得出消防员在火灾现场中运动的方向和步长用于定位，并通过蓝牙将消防员运动方向和位置信息发送给上位机，上位机记录消防员运动的轨迹，从而达到火灾现场消防员室内定位的目的。

基于stm32cubemx实现的卡尔曼滤波解算IMC20602六轴传感器姿态角的程序，亲测可用。ICM_KF.zip

对于大多数MPU6050的应用来说，获取到的原始数据并没有多大用处，我们需要对原始数据进行姿态融合解算，最终得到姿态数据，也就是三个欧拉角：航向角(yaw)、横滚角(roll)和俯仰角(pitch)。 MPU6050内部自带数字运动处理器(DMP)硬件加速引擎，配合运动驱动库直接输出四元数，进而很方便的计算出欧拉角，大大降低了主控MCU的负担。本篇使用MPU6050的驱动库来获取姿态数据。 1. MPU6050驱动库安装 MPU6050的驱动库有很多，我们可以在IDE中单击「项目」—「加载库」—「管理库」，在搜索栏输入”6050″，可以看到不同的驱动库。 本篇我们使用的由国外大牛Jeff R

STM32读取到MPU6050的姿态角后，把姿态角数据显示在液晶屏上。然后传输给PWM函数，以俯仰角和滚转角作为参数来分别控制舵机的转动。

姿态解算的源代码，9轴传感器，加滤波算法。实现9轴姿态的实时解算。

入门阶段必看，基本都有注释，包括速度更新，姿态更新，位置更新

PX4姿态解算流程图attitude_estimator_q_main.cpp

该实例是在STM32下，对MPU9250陀螺仪数据进行处理，利用四元数进行姿态计算，得出姿态角，该实例能够良好的获取到当前姿态信息。