惯性导航扩展卡尔曼滤波（MATLAB）

6.0773524e-03 -5.5244386e-02 -9.8276815e+00 -1.7596931e-03 1.0421860e-03 -6.3323922e-04 2.0354727e+03 2.5475931e-03 -5.6831479e-02 -9.8109455e+00 -1.2876178e-03 2.4908488e-03 7.6405559e-04 2.0354777e+03 1.8370311e-03 -8.0280900e-02 -9.8268728e+00 -6.1931647e-04 1.1752704e-03 -1.1054899e-03 2.0354827e+03 -3.0372746e-04 -6.3499868e-02 -9.8066111e+00 -1.5554787e-03 1.2461925e-03 5.9810985e-04 2.0354877e+03 3.4045879e-05 -5.7571698e-02 -9.8105440e+00 -1.4615133e-03 9.6476870e-04 -5.0908339e-04 2.0354927e+03 2.0628751e-03 -5.8736678e-02 -9.7910128e+00 -1.2156139e-03 2.3962124e-03 -4.8276832e-04 2.0354977e+03 -2.9113939e-05 -7.8637943e-02 -9.7989206e+00 -1.5266868e-03 1.8271912e-03 -3.0806905e-04 2.0355027e+03 -4.1699870e-03 -5.3719837e-02 -9.7988033e+00 -1.7732994e-03 9.8005857e-04 3.5221979e-04 2.0355077e+03 7.2803805e-03 -5.4180089e-02 -9.8006487e+00 -1.9518278e-03 1.3960198e-03 1.1166965e-03 2.0355127e+03 -3.3732632e-04 -6.7381501e-02 -9.8115950e+00 -1.2627965e-03 1.7182506e-03 3.5253324e-04 2.0355177e+03 -1.3788119e-02 -7.8651518e-02 -9.8214149e+00 -1.2873769e-03 5.8302155e-04 -7.6115341e-04 2.0355227e+03 -6.8896720e-03 -6.0339585e-02 -9.8170033e+00 -2.1781884e-03 2.3473408e-03 -3.2953356e-04 2.0355277e+03 -4.8843389e-03 -7.7204667e-02 -9.8039408e+00 -1.3720228e-03 1.7679816e-03 -5.2909047e-04 2.0355327e+03 -5.8544078e-03 -7.8391805e-02 -9.7996244e+00 -1.7421911e-03 -4.8250615e-05 -3.0693453e-05 2.0355377e+03 -9.7844759e-03 -7.2806560e-02 -9.7936897e+00 -1.2612534e-03 2.1867165e-03 -4.8313398e-04 2.0355427e+03 -1.4648805e-03 -5.5287212e-02 -9.7948284e+00 -1.9281374e-03 5.2956614e-04 4.4670390e-04 2.0355477e+03 -3.4188007e-03 -6.8136267e-02 -9.7930603e+00 -2.7347559e-03 2.3495778e-03 -4.7955869e-04 2.0355527e+03 -2.8820499e-03 -5.7577491e-02 -9.8090677e+00 8.1832230e-05 1.1275851e-03 -2.1693442e-04 2.0355577e+03 -3.5639855e-03 -6.8153732e-02 -9.8178921e+00 -2.4337322e-03 1.2116840e-03 4.1199671e-04 2.0355627e+03 -8.8834070e-04 -5.8843926e-02 -9.8068228e+00 -1.0781758e-03 1.8379197e-03 -4.5609867e-04 2.0355677e+03 -4.6936635e-04 -6.0030315e-02 -9.8127384e+00 -1.9900908e-03 1.4002660e-03 6.2040216e-04 2.0355727e+03 -2.4252450e-03 -6.1938763e-02 -9.8000021e+00 -2.0229009e-03 3.7121465e-03 5.2572298e-04 2.0355777e+03 1.6008953e-03 -4.8176803e-02 -9.8074646e+00 -1.0506108e-03 9.1052812e-04 8.5626577e-04 2.0355827e+03 -1.3260359e-02 -6.8799704e-02 -9.8029785e+00 -1.1357191e-03 1.5396451e-03 9.4833330e-04 2.0355877e+03 -1.9521756e-02 -6.7309044e-02 -9.8086004e+00 -1.6651213e-03 1.1681637e-03 4.8422022e-04 2.0355927e+03 -1.3424952e-02 -6.5513343e-02 -9.8067465e+00 -5.4186129e-04 2.6922137e-03 -2.9456741e-04 2.0355977e+03 -1.0676559e-02 -5.5953819e-02 -9.8093357e+00 -3.9118086e-04 1.5428697e-03 -9.7131613e-04 2.0356027e+03 -5.9733526e-03 -7.1947806e-02 -9.8095121e+00 -1.4187435e-03 6.2702887e-04 1.1603533e-03 2.0356077e+03 -4.7409213e-03 -7.0218846e-02 -9.8119383e+00 -1.0623754e-03 1.7661960e-03 7.0415420e-04 2.0356127e+03 5.8759283e-03 -6.0752735e-02 -9.8033209e+00 -1.3294005e-03 3.9203325e-04 4.9414748e-04 2.0356177e+03 -2.2347437e-02 -5.7305761e-02 -9.8004065e+00 -5.6971662e-04 1.5250870e-03 -6.9871545e-04 2.0356227e+03 -1.6104752e-03 -5.9960842e-02 -9.8055477e+00 -1.1269511e-03 2.9245403e-03 6.3478446e-04 2.0356277e+03 -3.1996742e-03 -6.7569472e-02 -9.7919521e+00 -1.2941752e-03 1.9466047e-03 -1.2823523e-04 2.0356327e+03 -4.4613634e-03 -6.7648105e-02 -9.8044167e+00 -1.2492845e-03 8.6464069e-04 -5.8117032e-04 2.0356377e+03 -1.0080049e-02 -5.6000881e-02 -9.8177452e+00 -7.3666387e-04 1.8826665e-03 4.6436602e-05 2.0356427e+03 -1.7687010e-02 -6.7120820e-02 -9.8066940e+00 -1.5381225e-03 1.1992395e-03 -5.1407784e-04 2.0356477e+03 -3.7367968e-03 -6.9938853e-02 -9.8069305e+00 -2.0638176e-03 5.9736375e-04 -8.7444886e-04 2.0356527e+03 -1.0249303e-03 -7.2024360e-02 -9.7978926e+00 -1.0878172e-03 2.9015527e-03 5.5146415e-04 2.0356577e+03 5.5689523e-03 -6.5851852e-02 -9.7908354e+00 -8.5533911e-04 1.8456210e-04 -3.6415755e-04 2.0356627e+03 3.8637009e-03 -8.0679975e-02 -9.7957344e+00 -3.9266379e-04 2.0591728e-03 6.6364108e-04 2.0356677e+03 -1.2046925e-02 -5.9726402e-02 -9.7983875e+00 -2.0785474e-03 1.8895881e-03 -1.4969432e-03 2.0356727e+03 -1.0951841e-02 -5.2699160e-02 -9.7976837e+00 -8.6565944e-04 2.0180820e-03 5.7903209e-05 2.0356777e+03 -1.0061285e-02 -5.6636482e-02 -9.8137083e+00 -1.9280352e-03 2.2388245e-03 1.3021468e-03 2.0356827e+03 -2.4669110e-03 -7.4486993e-02 -9.8228912e+00 -1.6036434e-03 1.6508101e-03 4.1849550e-04 2.0356877e+03 4.2337715e-03 -5.6309987e-02 -9.8215332e+00 -2.6540936e-03 1.0780578e-03 5.3406472e-04 2.0356927e+03 -3.0827455e-03 -5.1514711e-02 -9.8004713e+00 -1.0730178e-03 1.1590599e-03 -2.0449016e-04 2.0356977e+03 -1.6734240e-03 -7.0084602e-02 -9.8170319e+00 -1.4740643e-03 1.2524762e-03 6.2426411e-06 2.0357027e+03 8.6327624e-03 -5.8482550e-02 -9.8058777e+00 -2.3948434e-03 1.8838329e-03 1.1000443e-03 2.0357077e+03 -1.5291384e-03 -5.2569617e-02 -9.8028202e+00 -8.9922041e-04 2.5600730e-03 -7.2868733e-04 2.0357127e+03 -4.9238149e-03 -6.1916701e-02 -9.8018236e+00 -1.3620767e-03 5.2928744e-04 3.0936368e-04 2.0357177e+03 -1.1582501e-02 -7.4293479e-02 -9.8042364e+00 -5.1555515e-04 1.5110854e-03 -1.4144264e-04 2.0357227e+03 7.0145414e-03 -6.3558631e-02 -9.8053770e+00 -2.0775411e-03 1.5700901e-03 -6.2591943e-04 2.0357277e+03 3.3976340e-03 -6.2882103e-02 -9.8151608e+00 -1.1984556e-03 8.2052901e-04 8.0055505e-04 2.0357327e+03 -1.4073707e-02 -7.5172730e-02 -9.8120584e+00 -1.5513593e-03 1.4151396e-03 -4.0042127e-04 2.0357377e+03 -1.1598249e-03 -7.5117491e-02 -9.8066740e+00 -6.0599152e-04 1.0491029e-03 -8.5000429e-05 2.0357427e+03 -5.6239669e-03 -5.8820877e-02 -9.8245325e+00 -1.2049974e-03 1.4311601e-03 2.9393382e-04 2.0357477e+03 -5.7838857e-03 -6.0461827e-02 -9.8100176e+00 -1.9911092e-03 2.0206159e-03 1.6987702e-04 2.0357527e+03 -9.3652327e-03 -7.4899338e-02 -9.8043232e+00 -2.3368830e-03 9.9283282e-04 1.4741201e-04 2.0357577e+03 -3.3678105e-03 -6.6312268e-02 -9.8115396e+00 -1.7522265e-03 2.7254489e-04 4.9140613e-04 2.0357627e+03 3.0289874e-03 -5.2906953e-02 -9.7935305e+00 -1.4379290e-03 4.3625795e-04 8.7079119e-05 2.0357677e+03 -8.1651295e-03 -6.4936832e-02 -9.7895441e+00 -1.6176042e-03 1.0613429e-03 1.0373071e-03 2.0357727e+03 2.4823295e-03 -7.0644334e-02 -9.7932625e+00 -9.5804385e-04 2.2771147e-03 4.9120263e-04 2.0357777e+03 3.5064609e-03 -6.3284256e-02 -9.7993479e+00 -2.2574973e-03 8.1682630e-04 8.5352454e-04 2.0357827e+03 8.4245214e-03 -5.7216007e-02 -9.7953501e+00 -9.6274668e-04 2.5889364e-03 -3.0256098e-04 2.0357877e+03 -1.0640355e-02 -7.6452591e-02 -9.8070545e+00 -1.4845690e-03 1.2783682e-03 1.3564022e-03 2.0357927e+03 -1.1171835e-02 -7.0972078e-02 -9.8096390e+00 -7.3179620e-04 2.1191882e-03 -7.1190333e-04 2.0357977e+03 -8.0850469e-03 -6.9073610e-02 -9.8169155e+00 -1.2584067e-03 1.4075969e-03 9.2861702e-04 2.0358027e+03 -1.1661325e-02 -4.9883209e-02 -9.8082819e+00 -1.3567965e-03 1.8124321e-03 -3.3736406e-04 2.0358077e+03 -5.5582810e-04 -6.9571741e-02 -9.8129816e+00 -1.4274040e-03 9.5867430e-04 4.0955466e-04 2.0358127e+03 4.3949117e-03 -6.8964183e-02 -9.8019457e+00 -1.5086570e-03 1.8501218e-03 -4.0578825e-04 2.0358177e+03 3.6900411e-03 -7.