用matlab编写了不同姿态之间的相互转换函数，导航系N为北东地坐标系，依此绕Z、Y、X旋转得到载体系B，选用欧拉角、四元数和方向余弦阵进行描述，得到了dcm2eul、eul2dcm、eul2qua和qua2dcm函数。