lvlh.dat

自己写的matlab的EKF算法

-0.096502345451     0.052438328079     0.167792839788           0.000027218820           0.000200373136          -0.000044592586
-0.094684347372     0.064343453075     0.164797743276           0.000033398348           0.000196600811          -0.000055338693
-0.092499556867     0.075999308573     0.161164971839           0.000039448486           0.000192066699          -0.000065871014
-0.089956439810     0.087360751578     0.156908561554           0.000045345810           0.000186788341          -0.000076148770
-0.087064854667     0.098383750578     0.152045005550           0.000051067454           0.000180786172          -0.000086132159
-0.083835999695     0.109025630646     0.146593112698           0.000056591281           0.000174083423          -0.000095782520
-0.080282385379     0.119245143613     0.140573970947           0.000061895870           0.000166706048          -0.000105062476
-0.076417774357     0.129002704122     0.134010908822           0.000066960675           0.000158682614          -0.000113936082
-0.072257142050     0.138260516740     0.126929263924           0.000071766079           0.000150044200          -0.000122368964
-0.067816607034     0.146982713311     0.119356495009           0.000076293463           0.000140824272          -0.000130328453
-0.063113360147     0.155135512202     0.111321869312           0.000080525295           0.000131058537          -0.000137783712
-0.058165639351     0.162687330176     0.102856493310           0.000084445180           0.000120784853          -0.000144705856
-0.052992597502     0.169608903832     0.093993125548           0.000088037924           0.000110043015          -0.000151068064
-0.047614283741     0.175873442303     0.084766070447           0.000091289631           0.000098874660          -0.000156845684
-0.042051531883     0.181456650929     0.075211004647           0.000094187678           0.000087323071          -0.000162016327
-0.036325889481     0.186336922766     0.065364910440           0.000096720858           0.000075433017          -0.000166559958
-0.030459525943     0.190495343100     0.055265904074           0.000098879348           0.000063250572          -0.000170458968
-0.024475189927     0.193915807388     0.044953051771           0.000100654790           0.000050822982          -0.000173698249
-0.018396038950     0.196585075878     0.034466268625           0.000102040317           0.000038198393          -0.000176265250
-0.012245643304     0.198492790409     0.023846103016           0.000103030541           0.000025425763          -0.000178150023
-0.006047821098     0.199631592184     0.013133678094           0.000103621658           0.000012554597          -0.000179345268
 0.000173427034     0.199997039030     0.002370431472           0.000103811346          -0.000000365220          -0.000179846355
 0.006393980518     0.199587733809    -0.008401972671           0.000103598888          -0.000013283584          -0.000179651346
 0.012589764008     0.198405271709    -0.019141891562           0.000102985116          -0.000026150440          -0.000178761002
 0.018736757408     0.196454225252    -0.029807715204           0.000101972397          -0.000038915890          -0.000177178766
 0.024811161763     0.193742149154    -0.040358240251           0.000100564652          -0.000051530479          -0.000174910841
 0.030789444966     0.190279566573    -0.050752584569           0.000098767349          -0.000063945288          -0.000171965909
 0.036648440709     0.186079874076    -0.060950536201           0.000096587433          -0.000076112196          -0.000168355440
 0.042365459441     0.181159357609    -0.070912695888           0.000094033365          -0.000087984064          -0.000164093462
 0.047918349040     0.175537070062    -0.080600431261           0.000091115031          -0.000099514869          -0.000159196471
 0.053285604938     0.169234806876    -0.089976343097           0.000087843751          -0.000110659931          -0.000153683449
 0.058446434163     0.162276965438    -0.099004088057           0.000084232179          -0.000121376061          -0.000147575765
 0.063380844326     0.154690502953    -0.107648758907           0.000080294310          -0.000131621736          -0.000140897088
 0.068069711363     0.146504820332    -0.115876934428           0.000076045412          -0.000141357251          -0.000133673300
 0.072494885220     0.137751617831    -0.123656729594           0.000071501933          -0.000150544905          -0.000125932389
 0.076639225214     0.128464805232    -0.130958089139           0.000066681475          -0.000159149109          -0.000117704348
 0.080486664507     0.118680356971    -0.137752729632           0.000061602712          -0.000167136526          -0.000109021053
 0.084022325532     0.108436179304    -0.144014387760           0.000056285321          -0.000174476253          -0.000099916139
 0.087232471931     0.097771956589    -0.149718819603           0.000050749902          -0.000181139830          -0.000090424871
 0.090104700915     0.086728987939    -0.154843954601           0.000045017884          -0.000187101496          -0.000080584008
 0.092627874821     0.075350066718    -0.159369969077           0.000039111490          -0.000192338165          -0.000070431658
 0.094792209243     0.063679264172    -0.163279360898           0.000033053592          -0.000196829566          -0.000060007131
 0.096589348266     0.051761788579    -0.166556986907           0.000026867654          -0.000200558358          -0.000049350785
 0.098012307828     0.039643803766    -0.169190163640           0.000020577639          -0.000203510101          -0.000038503873
 0.099055579256     0.027372257120    -0.171168730269           0.000014207919          -0.000205673396          -0.000027508380
 0.099715128670     0.014994672154    -0.172485016663           0.000007783155          -0.000207039904          -0.000016406861
 0.099988394481     0.002559005163    -0.173133907210           0.000001328245          -0.000207604358          -0.000005242278
 0.099874313195    -0.009886568223    -0.173112938767          -0.000005131804          -0.000207364600           0.000005942170
 0.099373347736    -0.022293846313    -0.172422153569          -0.000011571975          -0.000206321614           0.000017103211
 0.098487417253    -0.034614766116    -0.171064227760          -0.000017967320          -0.000204479452           0.000028197668
 0.097219958326    -0.046801602983    -0.169044434263          -0.000024293069          -0.000201845285           0.000039182626
 0.095575886610    -0.058807139796    -0.166370581426          -0.000030524707          -0.000198429354           0.000050015600
 0.093561566537    -0.070584876654    -0.163052996960          -0.000036638102          -0.000194244916           0.000060654696
 0.091184806041    -0.082089200057    -0.159104541231          -0.000042609581          -0.000189308209           0.000071058773
 0.088454803464    -0.093275524998    -0.154540467057          -0.000048415993          -0.000183638375           0.000081187607
 0.085382149793    -0.104100546985    -0.149378444897          -0.000054034873          -0.000177257390           0.000091002023
 0.081978727551    -0.114522295668    -0.143638473037          -0.000059444418          -0.000170190006           0.000100464108
 0.078257727608    -0.124500438324    -0.137342715083          -0.000064623711          -0.000162463600           0.000109537275
 0.074233570512    -0.133996291728    -0.130515546980          -0.000069552659          -0.000154108107           0.000118186447
 0.069921834854    -0.142973088962    -0.123183380735          -0.000074212186          -0.000145155895           0.000126378203
 0.065339224325    -0.151396048682    -0.115374606503          -0.000078584235          -0.000135641643           0.000134080886
 0.060503507702    -0.159232538895    -0.107119414450          -0.000082651866          -0.000125602219           0.000141264728
 0.055433393889    -0.166452221424    -0.098449749568          -0.000086399343          -0.000115076480           0.000147901972
 0.050148535754    -0.173027094165    -0.089399157221          -0.000089812112          -0.000104105199           0.000153966971
 0.044669400259    -0.178931722022    -0.080002649367          -0.000092876991          -0.000092730855           0.000159436293
 0.039017219930    -0.184143201249    -0.070296608321          -0.000095582075          -0.000080997496           0.000164288804
 0.033213883044    -0.188641363939    -0.060318555086          -0.000097916908          -0.000068950545           0.000168505757
 0.027281868074    -0.192408763304    -0.050107122028          -0.000099872423          -0.000056636639           0.000172070860
 0.021244154881    -0.195430818895    -0.039701803561          -0.000101441059          -0.000044103453           0.000174970337
 0.015124142770    -0.197695820805    -0.029142865610          -0.000102616739          -0.000031399515           0.000177192987
 0.008945534246    -0.199194983361    -0.018471171597          -0.000103394896          -0.000018574003           0.000178730218
 0.002732252657    -0.199922512552    -0.007728006967          -0.000103772532          -0.000005676553           0.000179576091
-0.003491624010    -0.199875565929     0.003045079157          -0.000103748159           0.000007242896           0.000179727334
-0.009701974317    -0.199054351121     0.013806352694          -0.000103321900           0.000020134319           0.000179183358
-0.015874759984    -0.197462023173     0.024514222326          -0.000102495380           0.000032947830           0.000177946259
-0.021986058912    -0.195104760322     0.035127240112          -0.000101271811           0.000045633814           0.000176020813
-0.028012190890    -0.191991688620     0.045604316655          -0.000099655930           0.000058143151           0.000173414452
-0.033929827538    -0.188134873666     0.055904947653          -0.000097654002           0.000070427427           0.000170137240
-0.039716038627    -0.183549240099     0.065989268140          -0.000095273767           0.000082439075           0.000166201831
-0.045348399357    -0.178252561705     0.075818242324          -0.000092524457           0.000094131576           0.000161623424
-0.050805100474    -0.172265350503     0.085353849590          -0.000089416715           0.000105459665           0.000156419703
-0.056065007745    -0.165610802926     0.094559184868          -0.000085962586           0.000116379479           0.000150610767
-0.061107722866    -0.158314698155     0.103398613138          -0.000082175449           0.000126848706           0.000144219058
-0.065913741694    -0.150405288109     0.111837966826          -0.000078069965           0.000136826829           0.000137269268
-0.070464421021    -0.141913219955     0.119844560617          -0.000073662044           0.000146275178           0.000129788257
-0.074742136987    -0.132871381696     0.127387430532          -0.000068968753           0.000155157126           0.000121804896
-0.078730329106    -0.123314816883     0.134437367268          -0.000064008291           0.000163438324           0.000113350097
-0.082413544986    -0.113280534950     0.140967113576          -0.000058799862           0.000171086661           0.000104456507
-0.085777500260    -0.102807411704     0.146951388848          -0.000053363647           0.000178072459           0.000095158489
-0.088809179476    -0.091936020309     0.152367032854          -0.000047720708           0.000184368673           0.000085491998
-0.091496835542    -0.080708462061     0.157193102391          -0.000041892889           0.000189950887           0.000075494404
-0.093830041724    -0.069168244507     0.161410914677          -0.000035902781           0.000194797437           0.000065204364
-0.095799781853    -0.057360069393     0.165004149040          -0.000029773584           0.000198889547           0.000054661666
-0.097398409054    -0.045329685116     0.167958882734          -0.000023529047           0.000202211319           0.000043907083
-0.098619746533    -0.033123700741     0.170263734832          -0.000017193365           0.000204749870           0.000032982213
-0.099459042437    -0.020789384143     0.171909722140          -0.000010791064           0.000206495314           0.000021929313
-0.099913054212    -0.008374527042     0.172890522517          -0.000004346954           0.000207440864           0.000010791145
-0.099980027027     0.004072755493     0.173202307613           0.000002113977           0.000207582828          -0.000000389198
-0.099659686091     0.016504279551     0.172843898418           0.000008566740           0.000206920607          -0.000011568452
-0.098953296050     0.028871850547     0.171816667579           0.000014986300           0.000205456756          -0.000022703355
-0.