MPU6050 DMP 简明使用教程

使用 STM32F103 和 HAL。TIM2 每 10 ms 读取四元数并解算姿态角,TIM3 每 100 ms 通过 USART1 输出。

下面是从 MotionApps 2.0 版本中裁出的代码,对外保留三个函数:

函数 调用位置
mpu6050_dmp_init() 外设初始化之后、启动定时器之前
mpu6050_dmp_read_quaternion() 10 ms 定时回调,读取最新的完整四元数包
mpu6050_dmp_to_euler() 读取成功后,把四元数转换为 yaw、pitch、roll
阅读更多