GeoYolo-SLAM/Result/Geo_Dyna/TUM/walking_rpy/KeyFrameTrajectory1.txt
2025-04-09 17:51:00 +08:00

120 lines
11 KiB
Plaintext

1341846647.934224 0.0000000 0.0000000 0.0000000 0.0000000 0.0000000 0.0000000 1.0000000
1341846648.370216 0.0282272 0.0033449 -0.0181545 -0.0202567 -0.0468567 -0.0116829 0.9986279
1341846648.706058 0.0888638 -0.0020188 -0.0136495 -0.0357723 -0.1177748 -0.0124194 0.9923181
1341846648.906165 0.1362705 -0.0098541 0.0114499 -0.0388567 -0.1570301 -0.0058923 0.9868115
1341846648.942154 0.1555470 -0.0667209 -0.0065771 -0.0488273 -0.1725986 0.0026546 0.9837777
1341846649.616167 0.2542276 -0.0144662 0.0885246 -0.0715414 -0.2395789 -0.0286075 0.9678147
1341846649.778019 0.2807066 -0.0286707 0.0885330 -0.0668232 -0.2604711 -0.0353057 0.9625191
1341846649.810257 0.2854536 -0.0388937 0.0701043 -0.0675882 -0.2672957 -0.0343743 0.9606265
1341846649.846059 0.3000141 -0.0176862 0.0673226 -0.0658130 -0.2775030 -0.0370687 0.9577508
1341846650.382075 0.3990819 -0.0377018 0.1878790 -0.0578752 -0.3046338 -0.0283653 0.9502863
1341846652.662152 -0.2862680 -0.0751869 -0.0950001 0.0319800 0.1142684 -0.0025936 0.9929317
1341846652.694113 -0.2606595 -0.0735425 -0.1147515 0.0311054 0.1351012 -0.0041924 0.9903346
1341846652.726378 -0.2421967 -0.0885536 -0.1072099 0.0312665 0.1607780 -0.0042084 0.9864863
1341846652.762129 -0.2548219 -0.0722414 -0.1104432 0.0327345 0.1897270 -0.0074935 0.9812624
1341846652.794152 -0.2216350 -0.0754822 -0.1421482 0.0303943 0.2130683 -0.0056122 0.9765483
1341846652.830250 -0.2292382 -0.0784982 -0.0996777 0.0293636 0.2461234 -0.0074918 0.9687647
1341846652.862014 -0.2860711 -0.0743900 -0.0668286 0.0285627 0.2743609 -0.0050266 0.9611893
1341846652.894426 -0.2794597 -0.0795532 -0.0717373 0.0270093 0.2910778 -0.0018025 0.9563164
1341846652.930346 -0.2771719 -0.0868925 -0.0644538 0.0280853 0.3099002 0.0035886 0.9503474
1341846653.030292 -0.2857789 -0.0880559 -0.0513184 0.0215011 0.3572740 0.0060482 0.9337325
1341846653.062672 -0.2934712 -0.0875578 -0.0466930 0.0253078 0.3721595 0.0103705 0.9277657
1341846653.162620 -0.2906300 -0.0856618 -0.0457439 0.0206644 0.4189861 0.0134358 0.9076580
1341846653.198437 -0.3399642 -0.0840768 -0.0323721 0.0209094 0.4366123 0.0170042 0.8992460
1341846653.330162 -0.3284474 -0.0904627 -0.0242042 0.0201575 0.4853963 0.0284977 0.8735971
1341846653.366319 -0.3369570 -0.0869114 -0.0349757 0.0193207 0.4942818 0.0319256 0.8685004
1341846653.430060 -0.3382043 -0.0850535 -0.0375879 0.0230140 0.5109429 0.0378710 0.8584716
1341846653.734313 -0.3833067 -0.0508156 -0.0679437 0.0248013 0.5110606 0.0343275 0.8585008
1341846656.146158 -0.0581923 -0.0383231 -0.1340383 0.0114257 -0.2700152 0.0247810 0.9624693
1341846656.519461 -0.0248656 -0.0279891 -0.1561064 0.0004911 -0.3316448 0.0205759 0.9431798
1341846656.682076 -0.0139014 -0.0255040 -0.1688788 -0.0068592 -0.3447956 0.0200375 0.9384388
1341846656.749974 -0.0060742 -0.0180257 -0.1600388 -0.0102871 -0.3513575 0.0202423 0.9359660
1341846656.782653 -0.0049415 -0.0244984 -0.1573409 -0.0110812 -0.3536178 0.0208746 0.9350914
1341846657.024108 -0.0099880 -0.0077310 -0.1380938 -0.0171507 -0.3394249 0.0199198 0.9402658
1341846657.056121 -0.0093488 -0.0025079 -0.1148202 -0.0175489 -0.3351687 0.0216970 0.9417447
1341846657.092006 -0.0183008 -0.0075756 -0.0640200 -0.0147508 -0.3255044 0.0252956 0.9450870
1341846657.155973 -0.0100522 -0.0051498 -0.0750890 -0.0035865 -0.3055091 0.0293598 0.9517297
1341846657.354367 0.0003486 -0.0155696 -0.1009506 0.0012541 -0.2391205 0.0186547 0.9708099
1341846657.418105 0.0160408 -0.0230005 -0.0884746 0.0036321 -0.2179581 0.0183855 0.9757782
1341846657.486117 0.0400384 -0.0275981 -0.0676921 0.0045614 -0.1972375 0.0184658 0.9801712
1341846657.522092 0.0166715 -0.0169910 -0.0606823 0.0102172 -0.1814503 0.0152441 0.9832289
1341846657.554062 0.0076782 -0.0112236 -0.0725248 0.0135035 -0.1727963 0.0129929 0.9847793
1341846657.586078 0.0660055 -0.0020577 -0.0407686 0.0142899 -0.1687335 0.0135486 0.9854650
1341846657.622205 0.0171311 -0.0200708 -0.0722252 0.0123330 -0.1490636 0.0093810 0.9887062
1341846657.654161 0.0083030 -0.0217314 -0.0768178 0.0138003 -0.1407224 0.0086000 0.9899155
1341846657.822089 0.0398600 -0.0535753 -0.0530442 0.0084777 -0.0795343 0.0012102 0.9967954
1341846657.889993 0.0912778 -0.0240567 -0.0289129 0.0143687 -0.0642501 0.0031250 0.9978255
1341846658.894170 0.0129582 0.0249983 -0.0085244 -0.1106987 0.0018876 -0.0021134 0.9938500
1341846662.010311 -0.0462273 -0.1169469 -0.0115939 0.0921460 -0.0076718 -0.0079939 0.9956838
1341846662.314144 -0.0448621 -0.1224212 -0.0258359 0.1608851 -0.0070575 -0.0029641 0.9869435
1341846663.722109 -0.0478588 -0.0907232 -0.0093857 0.1241664 -0.0243121 0.0034741 0.9919574
1341846663.755694 -0.0463064 -0.0867298 -0.0134245 0.1197294 -0.0230042 0.0031093 0.9925351
1341846665.430162 -0.0508812 0.0253712 -0.0813220 -0.1922933 0.0219623 -0.0144021 0.9809860
1341846665.898073 -0.0484089 0.0371740 -0.1139936 -0.2466782 0.0340399 -0.0118333 0.9684271
1341846666.234319 -0.0511524 0.0331130 -0.1300030 -0.2766641 0.0381849 -0.0064294 0.9601862
1341846666.302195 -0.0706712 -0.0268256 -0.1239007 -0.3045292 0.0416800 -0.0053034 0.9515759
1341846666.502190 -0.0682577 0.0170747 -0.1369690 -0.3325249 0.0390299 0.0070974 0.9422598
1341846666.570131 -0.0512846 0.0448723 -0.1489719 -0.3448389 0.0384765 0.0087710 0.9378319
1341846666.738266 -0.0642168 0.0462914 -0.1613045 -0.3641410 0.0377793 0.0125675 0.9304924
1341846666.906019 -0.0665899 0.0632879 -0.1735253 -0.3716650 0.0312868 0.0198726 0.9276267
1341846667.074153 -0.0340620 0.0872318 -0.2055659 -0.3844893 0.0179229 0.0158014 0.9228202
1341846667.106156 -0.0653241 0.0694102 -0.1917764 -0.3944398 0.0248880 0.0109663 0.9185192
1341846667.138108 -0.0685176 0.0598342 -0.1818735 -0.3967176 0.0214274 0.0099744 0.9176364
1341846667.238075 -0.0709149 0.0431718 -0.1869745 -0.3912110 0.0229690 0.0008461 0.9200140
1341846667.306189 -0.0820490 0.0831053 -0.2133697 -0.3657420 0.0271018 -0.0078707 0.9302883
1341846667.442109 -0.0831781 0.0879725 -0.2082425 -0.3265845 0.0238770 -0.0156211 0.9447372
1341846667.474109 -0.1135241 0.0744256 -0.2164342 -0.3147389 0.0271474 -0.0168369 0.9486406
1341846667.542298 -0.1446145 -0.0270299 -0.1618298 -0.3081719 0.0298702 -0.0237084 0.9505661
1341846667.674072 -0.1341486 0.0708251 -0.2134016 -0.2522235 0.0276349 -0.0219750 0.9670247
1341846667.842103 -0.1699256 0.0545142 -0.1903629 -0.2345289 0.0411249 -0.0270104 0.9708632
1341846668.078111 -0.1949333 0.0221016 -0.1587668 -0.1883349 0.0561348 -0.0270423 0.9801263
1341846668.178208 -0.2009866 0.0205014 -0.1490917 -0.1617558 0.0597023 -0.0267610 0.9846596
1341846668.211262 -0.1921627 -0.0090320 -0.1373068 -0.1556661 0.0582039 -0.0257230 0.9857579
1341846668.478153 -0.2220330 -0.0843834 -0.0975991 -0.0879951 0.0607319 -0.0132123 0.9941800
1341846670.022242 -0.1509310 0.0756812 -0.1512005 -0.1292157 0.0355751 -0.2844953 0.9492630
1341846670.222197 -0.1435244 0.0769908 -0.1694230 -0.1501148 0.0577573 -0.3430217 0.9254544
1341846670.358377 -0.1522754 0.0715952 -0.1796845 -0.1518938 0.0804327 -0.3748410 0.9110176
1341846670.464003 -0.1532549 0.0590519 -0.1898433 -0.1410266 0.1033694 -0.3985490 0.9003249
1341846670.596103 -0.1462800 0.0570634 -0.1875250 -0.1287035 0.1243784 -0.4202731 0.8895707
1341846670.728093 -0.1562048 0.0425823 -0.2079408 -0.1110479 0.1417978 -0.4420299 0.8787328
1341846670.764128 -0.1521986 0.0368067 -0.2146738 -0.1074884 0.1467738 -0.4462196 0.8762373
1341846670.796059 -0.1572769 0.0269876 -0.2202988 -0.1034705 0.1536702 -0.4525772 0.8722690
1341846670.832246 -0.1542066 0.0330032 -0.2291459 -0.0944210 0.1574295 -0.4526046 0.8726109
1341846670.896139 -0.1706024 0.0148755 -0.1943005 -0.0870943 0.1655844 -0.4523119 0.8720151
1341846671.101398 -0.1638110 0.0153787 -0.2218761 -0.0341454 0.1811147 -0.4524110 0.8725571
1341846671.132289 -0.1538246 0.0334423 -0.2300412 -0.0208665 0.1828286 -0.4582373 0.8695728
1341846671.200149 -0.1491340 0.0119074 -0.2244200 0.0003780 0.1742734 -0.4639342 0.8685584
1341846671.368236 -0.1560808 -0.0199031 -0.2135219 0.0385265 0.1702659 -0.4840793 0.8574336
1341846671.504294 -0.1558986 -0.0234359 -0.2083190 0.0560155 0.1556979 -0.5006637 0.8496801
1341846671.536197 -0.1688997 -0.0338883 -0.2202374 0.0588656 0.1482647 -0.5123036 0.8438587
1341846671.636057 -0.1414082 -0.0396294 -0.2355275 0.0801654 0.1263188 -0.5312546 0.8338978
1341846671.672157 -0.1857397 -0.0412398 -0.2280649 0.0871842 0.1229004 -0.5381027 0.8293009
1341846671.804605 -0.1787536 -0.0387051 -0.2325485 0.0927996 0.1059327 -0.5561836 0.8190399
1341846671.840252 -0.1890612 -0.0481898 -0.2422135 0.0907122 0.1022833 -0.5615399 0.8160774
1341846673.070235 -0.1825990 -0.0240281 -0.1924246 0.0833097 0.0343518 -0.5031217 0.8595045
1341846673.338187 -0.1934818 -0.0328223 -0.1786153 0.0958242 0.0052211 -0.4211443 0.9019024
1341846673.438267 -0.1952606 -0.0369549 -0.1692452 0.1048996 -0.0041150 -0.3860499 0.9164850
1341846674.052060 -0.2011146 -0.0041434 -0.1514114 0.0771641 -0.0789320 -0.1694898 0.9793307
1341846674.210322 -0.1807234 0.0152260 -0.1578252 0.0653044 -0.0783323 -0.1279795 0.9865195
1341846674.246217 -0.1965460 0.0070898 -0.1563868 0.0595286 -0.0768232 -0.1219986 0.9877605
1341846675.251951 -0.1948234 0.0830428 -0.1365322 -0.0250798 -0.0760301 0.0463075 0.9957138
1341846675.282406 -0.1880194 0.0762783 -0.1442060 -0.0287596 -0.0751683 0.0480880 0.9955954
1341846675.318078 -0.1889402 0.0798808 -0.1632958 -0.0323925 -0.0714038 0.0506343 0.9956347
1341846675.350149 -0.1826358 0.0928724 -0.1713839 -0.0394287 -0.0697220 0.0544613 0.9952980
1341846675.382271 -0.2001627 0.0776685 -0.1669783 -0.0517924 -0.0640604 0.0518853 0.9952496
1341846675.450238 -0.2397433 0.0475124 -0.1545182 -0.0624101 -0.0482749 0.0621739 0.9949417
1341846675.486165 -0.2379756 0.0334084 -0.1542975 -0.0547766 -0.0464472 0.0714912 0.9948524
1341846675.518083 -0.2459150 0.0400250 -0.1488298 -0.0447444 -0.0441366 0.0790016 0.9948913
1341846675.550092 -0.2524899 0.0538362 -0.1480391 -0.0348526 -0.0438808 0.0874548 0.9945911
1341846675.686118 -0.2031268 0.0690590 -0.1270376 -0.0142548 -0.0486322 0.0954597 0.9941424
1341846675.718055 -0.2027038 0.0649655 -0.1299461 -0.0098294 -0.0456424 0.0929050 0.9945797
1341846675.854095 -0.1911748 0.0519064 -0.1213661 0.0070321 -0.0380051 0.0890008 0.9952814
1341846675.922346 -0.1831063 0.0537456 -0.1262243 0.0238590 -0.0393470 0.0912301 0.9947661
1341846675.961651 -0.1881802 0.0472917 -0.1280187 0.0313971 -0.0378135 0.0887348 0.9948419
1341846676.028080 -0.1562451 0.0393157 -0.1315527 0.0535225 -0.0441159 0.0889697 0.9936164
1341846676.154447 -0.1465063 0.0489979 -0.1547357 0.0571596 -0.0484842 0.0788816 0.9940622
1341846676.322689 -0.0852495 0.0724675 -0.2340864 0.0415570 -0.0500754 0.0753797 0.9950293
1341846676.360815 -0.0896439 0.0931202 -0.2266624 0.0310450 -0.0427408 0.0708602 0.9960865
1341846676.424250 -0.0620138 0.0637343 -0.2114461 0.0227747 -0.0399663 0.0713562 0.9963896
1341846677.966256 0.1218852 0.0641187 -0.2420351 0.0390687 0.0074033 0.0609514 0.9973484