基于四元数的卡尔曼滤波算法用于姿态估计

这段代码中运用了基于四元数的卡尔曼滤波算法，用于融合加速度计、陀螺仪和磁力计的测量数据，以估计设备在三维空间中的姿态。其中Kp和Ki分别代表比例增益和积分增益，exInt、eyInt和ezInt分别代表Ki缩放的积分误差项。具体的算法流程为：

1. 测量正常化，将加速度计的三个分量单元化，得到重力在三个方向上的分量。

2. 估计方向的重力，根据当前四元数计算重力在三个方向上的分量。

3. 计算错误的领域和方向传感器测量参考方向之间的交叉乘积的总和，得到误差项ex、ey和ez。

4. 积分误差比例积分增益，将误差项ex、ey和ez分别乘以Ki后加到exInt、eyInt和ezInt上。

5. 调整后的陀螺仪测量，将Ki缩放的积分误差项和比例增益Kp乘以误差项ex、ey和ez后加到陀螺仪测量上，得到调整后的陀螺仪测量gx、gy和gz。

6. 整合四元数，根据当前四元数和调整后的陀螺仪测量计算下一个时刻的四元数。

7. 正常化四元数，将计算得到的四元数正常化，保证其模长为1。

8. 获取欧拉角，根据计算得到的四元数计算设备在三维空间中的姿态，得到pitch、roll和yaw。

这段里面运用什么方法进行的滤波内容：这段代码中运用了基于四元数的卡尔曼滤波算法进行滤波。