关于使用扩展卡尔曼滤波测量姿态的算法,包括计算航向角等