惯性导航卡尔曼滤波仿真,包括姿态解算,扩展卡尔曼滤波应用等