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

卡尔曼滤波算法c实现 、飞行器的姿态结算，通过MPU6000/HMR5811进行数据融合处理

IMU姿态解算

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

四轴飞控板电路图 PCB图 原理图说明: 1、主控MCU采用MSP430F5438A； 2、采用25MHZ外部晶振； 3、加速度计和陀螺仪采用MPU6050； 4、磁力计采用HMC5883L； 5、添加了四个LED灯，两个按键和一个蜂鸣器； 6、集成了CP2102 USB转TTL芯片； 7、支持BSL/SBW/JTAG下载，BSL用串口下载就行，但是不能仿真~ 代码说明: 1、目前基于IAR6.1版本，但是出于最新版本没法破解，打算用回低版本的； 2、采用模拟IIC读取MPU6050和HMC5883L，还是模拟的用着顺手； 3、主频25MHZ，3ms姿态解算周期，应该够用了； 4、姿态解算用的是四元数算法，串口发送； 5、还没有添加电机控制部分，以后会不断更新

基于EKF算法(16维)的导航解算程序及数据，MATLAB实现。

一共四个文件，位置解算，位置控制流程图，姿态解算，姿态控制流程图

通过Matlab设计一个程序，实现四元数法的应用，解算滑行车体的姿态！

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

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