坐标系统的介绍 1.1 WGS—84坐标系统 WGS—84坐标系是目前GPS所采用的坐标系统，是由美国国防部制图局建立，于1987年取代了当时GPS所采用的坐标系统(WGS—72坐标系统)而成为GPS目前所使用的坐标系统。 WGS—84坐标系的坐标原点位于地球的质心，Z轴指向BIHl984.0定义的协议地球极方向，X轴指向BIHl984.0的起始子午面和赤道的交点，Y轴与X轴和Z轴构成右手系。WGS—84系所采用椭球参数为：a=6378138m；f=1／298.257223563。

姿态信息是飞行控制中最关键的参数之一,因此姿态测量成为飞行控制系统首要解决的问题。利用多MEMS传感器研制了一种微型姿态测量系统。利用三轴MEMS加速度计和三轴MEMS陀螺数据,由方向余弦矩阵的姿态表示形式推导了扩展Kalman滤波方程,解算出飞行器的俯仰角和横滚角 设计专家系统判断飞行器的运动状态,并根据该状态调整滤波算法中的测量噪声矩阵,使系统可同时满足静态情况和动态情况的使用 利用空速和高度数据对俯仰角进行修正,利用GPS解算航向角。将实验结果与国外最新 的商用自动驾驶仪的姿态结果进行

Recover original mean motion (xnodp) and semimajor axis (aodp)