在姿态确定的四元数方程基础上,采用扩展卡尔曼滤波