惯性导航 四轴陀螺仪算法

已知，x，y，z轴的姿态角，三轴角速度，三轴线加速，求地面水平速度。

通过姿态角把线加速变换到水平方向，然后对水平方向的加速度积分就得到水平方向速度了