使用 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 |