使用正点原子阿波罗F429开发板,读取mpu9250数据,矫正滤波后利用基于四元数的madgwick算法融合数据,求得航向角。四元数也可直接转化为横滚角和俯仰角。(检查了一下,均值滤波那里写的不对,大家可以改一下):)
1