i/rtabmap_ros
1
0
Fork 0
mirror of https://github.com/introlab/rtabmap_ros.git synced 2026-10-12 04:29:49 +08:00
Code Issues Packages Projects Releases Wiki Activity
Files
82f0754bf76afb6642157ee907a5db5e15decea9
rtabmap_ros/rtabmap_demos/test/golden/robot_mapping.tum
T
matlabbe 82f0754bf7 rtabmap_demos tests and docs (#1462) 
* rtabmap_demos tests and docs

* added bag testing

* added rtabmap_examples launch tests

* updating demo bag download paths

* added netherdrone demo

* Fixed rgb-only callback with lidar rejected.  Updated lidar params

* Added back OrbitOriented rviz view to ros2, with optional octomap wll clipping

* fixing ci

* lidar demo added intermediate_nodes option

* added netherdrone as demo test

* running rtabmap_demos tests on ci

* added rtabmap_launch tests, fixed ground_truth_base_frame_id usage

* ficing rolling

* updating demo test harnest

* densify golden trajectories to avoid tf missing

* fixing tf steps

* updated min icp ratio for netherdrone demo

* fixing image_transport arg->params

* export pose opt=0

* lets process all frames

* updated netherdrone golden

* fixing publishers queue size just for tests

* added playdback demo doc

* Adding more logs to debug ci

* Fixing QOS for CI to reliable, added find-object demo test

* name threads

* fixing camera info expected transient on lyrical/rolling. Fixing find_object not appearing idle

* 30 Hz polling backward comp

* fixing test tf sim lock

* fixing lyrical qos bag parsing

* faster replay

* lockstep

* fixing clock deadlock

* Added test on shutdown

* updated netherdrone golden poses

* Extended stereo outdoor test

* updated shutdown test

* updated test

* multi-thread flaky test

* adding backtrace when test fails

* increased closure slack for netherdrone

* g2o gauss newton on stereo

* adjusted maximum optimizer iterations

* updated default iterations

* Added netherdrone in list of demos
2026-10-10 12:23:49 -07:00

212 lines
17 KiB
Plaintext
Raw Blame History

#timestamp x y z qx qy qz qw
1368730003.896619 5.432196 0.254602 0.000000 0.000000 0.000000 -0.114412 0.993433
1368730006.071224 5.436132 0.259603 0.000000 0.000000 0.000000 -0.045272 0.998975
1368730007.096577 5.438802 0.270577 0.000000 0.000000 0.000000 0.070892 0.997484
1368730008.170692 5.434921 0.273598 0.000000 0.000000 0.000000 0.195394 0.980725
1368730009.270713 5.430181 0.280426 0.000000 0.000000 0.000000 0.357805 0.933796
1368730010.295340 5.420730 0.283825 0.000000 0.000000 0.000000 0.509533 0.860451
1368730011.420115 5.412755 0.284431 0.000000 0.000000 0.000000 0.660922 0.750455
1368730012.519620 5.406191 0.288904 0.000000 0.000000 0.000000 0.742618 0.669715
1368730014.669347 5.388476 0.531291 0.000000 0.000000 0.000000 0.747003 0.664821
1368730015.718884 5.366087 0.740713 0.000000 0.000000 0.000000 0.755411 0.655251
1368730016.793799 5.342164 0.970643 0.000000 0.000000 0.000000 0.758955 0.651143
1368730017.893205 5.306243 1.258806 0.000000 0.000000 0.000000 0.763320 0.646020
1368730019.017871 5.261275 1.564467 0.000000 0.000000 0.000000 0.768587 0.639746
1368730020.167420 5.217079 1.868440 0.000000 0.000000 0.000000 0.769557 0.638578
1368730021.267000 5.160835 2.167500 0.000000 0.000000 0.000000 0.753567 0.657371
1368730022.391565 5.136338 2.476868 0.000000 0.000000 0.000000 0.740138 0.672455
1368730023.491180 5.125064 2.777562 0.000000 0.000000 0.000000 0.735285 0.677758
1368730024.540761 5.098618 3.064319 0.000000 0.000000 0.000000 0.730867 0.682520
1368730025.565609 5.073434 3.312468 0.000000 0.000000 0.000000 0.725968 0.687728
1368730026.590074 5.060552 3.506781 0.000000 0.000000 0.000000 0.722598 0.691269
1368730028.689257 5.053852 3.508774 0.000000 0.000000 0.000000 0.840049 0.542511
1368730029.838911 5.045956 3.500682 0.000000 0.000000 0.000000 0.930050 0.367433
1368730030.963418 5.040254 3.488856 0.000000 0.000000 0.000000 0.981657 0.190658
1368730032.012846 5.030965 3.478173 0.000000 0.000000 0.000000 0.998950 0.045813
1368730035.111594 4.821219 3.471471 0.000000 0.000000 0.000000 0.999992 -0.004116
1368730036.161155 4.617237 3.472014 0.000000 0.000000 0.000000 0.999992 -0.004036
1368730037.260479 4.292758 3.481774 0.000000 0.000000 0.000000 0.999954 -0.009604
1368730038.285127 3.978209 3.470673 0.000000 0.000000 0.000000 0.999658 -0.026140
1368730039.434539 3.462369 3.445687 0.000000 0.000000 0.000000 0.999269 -0.038243
1368730040.558989 2.955282 3.419361 0.000000 0.000000 0.000000 0.999502 -0.031562
1368730041.683513 2.437344 3.408195 0.000000 0.000000 0.000000 0.999833 -0.018260
1368730042.757891 1.958812 3.406995 0.000000 0.000000 0.000000 0.999973 -0.007293
1368730043.832604 1.478481 3.413563 0.000000 0.000000 0.000000 0.999993 0.003667
1368730044.931829 0.989493 3.419495 0.000000 0.000000 0.000000 1.000000 -0.000856
1368730046.031182 0.483726 3.418069 0.000000 0.000000 0.000000 0.999979 -0.006525
1368730047.130669 -0.010636 3.411338 0.000000 0.000000 0.000000 0.999894 -0.014546
1368730048.230182 -0.506099 3.401712 0.000000 0.000000 0.000000 0.999802 -0.019891
1368730049.230434 -0.948010 3.400599 0.000000 0.000000 0.000000 0.999970 -0.007772
1368730050.230572 -1.395774 3.394989 0.000000 0.000000 0.000000 0.999996 0.002897
1368730051.328367 -1.893319 3.406191 0.000000 0.000000 0.000000 0.999895 0.014503
1368730052.427879 -2.346568 3.426152 0.000000 0.000000 0.000000 0.999633 0.027081
1368730053.530609 -2.685722 3.458398 0.000000 0.000000 0.000000 0.999323 0.036780
1368730054.551471 -2.987529 3.469844 0.000000 0.000000 0.000000 0.999921 0.012565
1368730055.575992 -3.285272 3.457978 0.000000 0.000000 0.000000 0.999988 0.004870
1368730056.700291 -3.421365 3.456553 0.000000 0.000000 0.000000 0.999985 0.005418
1368730057.824627 -3.431216 3.459015 0.000000 0.000000 0.000000 0.994885 0.101011
1368730058.948929 -3.423334 3.469413 0.000000 0.000000 0.000000 0.969067 0.246797
1368730060.023773 -3.407681 3.487920 0.000000 0.000000 0.000000 0.917974 0.396641
1368730061.047842 -3.391379 3.495983 0.000000 0.000000 0.000000 0.846220 0.532833
1368730062.096967 -3.373933 3.503381 0.000000 0.000000 0.000000 0.764462 0.644669
1368730064.270127 -3.387845 3.696378 0.000000 0.000000 0.000000 0.740609 0.671936
1368730065.369161 -3.412396 3.940190 0.000000 0.000000 0.000000 0.739923 0.672691
1368730066.418362 -3.440662 4.190451 0.000000 0.000000 0.000000 0.739031 0.673672
1368730067.467306 -3.466992 4.488984 0.000000 0.000000 0.000000 0.738257 0.674520
1368730068.591353 -3.498523 4.884151 0.000000 0.000000 0.000000 0.738055 0.674741
1368730069.665419 -3.536703 5.306705 0.000000 0.000000 0.000000 0.732025 0.681278
1368730070.764244 -3.544082 5.744429 0.000000 0.000000 0.000000 0.718606 0.695418
1368730071.888379 -3.552909 6.231499 0.000000 0.000000 0.000000 0.711133 0.703057
1368730072.987315 -3.540674 6.715886 0.000000 0.000000 0.000000 0.703415 0.710779
1368730074.086378 -3.533940 7.214649 0.000000 0.000000 0.000000 0.719794 0.694188
1368730075.235260 -3.549573 7.725758 0.000000 0.000000 0.000000 0.723033 0.690813
1368730076.285548 -3.559353 8.209032 0.000000 0.000000 0.000000 0.720371 0.693589
1368730077.293558 -3.559980 8.662723 0.000000 0.000000 0.000000 0.718345 0.695687
1368730078.432269 -3.567099 9.174342 0.000000 0.000000 0.000000 0.714427 0.699710
1368730079.506308 -3.564889 9.663434 0.000000 0.000000 0.000000 0.712431 0.701742
1368730080.580478 -3.554269 10.158614 0.000000 0.000000 0.000000 0.710681 0.703514
1368730081.584796 -3.541150 10.605854 0.000000 0.000000 0.000000 0.708751 0.705459
1368730082.703468 -3.525074 11.106726 0.000000 0.000000 0.000000 0.706603 0.707610
1368730083.802348 -3.518447 11.603410 0.000000 0.000000 0.000000 0.706587 0.707626
1368730084.851368 -3.518632 12.074003 0.000000 0.000000 0.000000 0.711907 0.702274
1368730085.900411 -3.517830 12.549440 0.000000 0.000000 0.000000 0.718625 0.695398
1368730086.949412 -3.528774 13.018722 0.000000 0.000000 0.000000 0.722492 0.691379
1368730087.973518 -3.540092 13.491566 0.000000 0.000000 0.000000 0.717792 0.696257
1368730089.047454 -3.541854 13.974113 0.000000 0.000000 0.000000 0.709473 0.704733
1368730090.146260 -3.533107 14.464190 0.000000 0.000000 0.000000 0.700939 0.713221
1368730091.270360 -3.517027 14.983357 0.000000 0.000000 0.000000 0.704638 0.709567
1368730092.344140 -3.529217 15.473991 0.000000 0.000000 0.000000 0.707520 0.706693
1368730093.368319 -3.512295 15.947618 0.000000 0.000000 0.000000 0.710711 0.703484
1368730094.442214 -3.502701 16.431015 0.000000 0.000000 0.000000 0.713427 0.700729
1368730095.466060 -3.501361 16.830746 0.000000 0.000000 0.000000 0.715634 0.698475
1368730096.540025 -3.495208 17.030264 0.000000 0.000000 0.000000 0.717122 0.696947
1368730098.737993 -3.490642 17.021646 0.000000 0.000000 0.000000 0.848077 0.529873
1368730099.811838 -3.489643 17.012506 0.000000 0.000000 0.000000 0.951621 0.307274
1368730100.910816 -3.482613 16.997498 0.000000 0.000000 0.000000 0.994235 0.107224
1368730102.059582 -3.482227 16.989279 0.000000 0.000000 0.000000 0.999868 -0.016246
1368730104.307391 -3.904314 16.982765 0.000000 0.000000 0.000000 0.999850 -0.017342
1368730105.381117 -4.350773 16.975651 0.000000 0.000000 0.000000 0.999831 -0.018381
1368730106.454965 -4.810039 16.976845 0.000000 0.000000 0.000000 0.999823 -0.018835
1368730107.503895 -5.263825 16.979422 0.000000 0.000000 0.000000 0.999791 -0.020458
1368730108.577911 -5.717861 16.970819 0.000000 0.000000 0.000000 0.999803 -0.019840
1368730109.676817 -6.173687 16.960958 0.000000 0.000000 0.000000 0.999806 -0.019678
1368730110.751092 -6.628410 16.955450 0.000000 0.000000 0.000000 0.999810 -0.019506
1368730111.874748 -7.116731 16.950577 0.000000 0.000000 0.000000 0.999824 -0.018749
1368730112.973603 -7.580166 16.941347 0.000000 0.000000 0.000000 0.999844 -0.017669
1368730113.997687 -8.027169 16.933388 0.000000 0.000000 0.000000 0.999849 -0.017351
1368730115.021649 -8.472034 16.926374 0.000000 0.000000 0.000000 0.999850 -0.017344
1368730116.095489 -8.926731 16.920912 0.000000 0.000000 0.000000 0.999849 -0.017355
1368730117.169447 -9.225541 16.917139 0.000000 0.000000 0.000000 0.999848 -0.017432
1368730118.268395 -9.475166 16.909079 0.000000 0.000000 0.000000 0.999867 -0.016312
1368730120.491288 -9.484236 16.920771 0.000000 0.000000 0.000000 0.994655 0.103253
1368730121.590045 -9.473295 16.936926 0.000000 0.000000 0.000000 0.957236 0.289308
1368730122.638938 -9.469715 16.947279 0.000000 0.000000 0.000000 0.861767 0.507304
1368730123.737758 -9.455665 16.948864 0.000000 0.000000 0.000000 0.733427 0.679768
1368730124.861432 -9.458348 16.941019 0.000000 0.000000 0.000000 0.569971 0.821665
1368730125.935427 -9.460509 16.918827 0.000000 0.000000 0.000000 0.403427 0.915012
1368730126.984383 -9.455755 16.905418 0.000000 0.000000 0.000000 0.215284 0.976551
1368730128.108295 -9.457547 16.883947 0.000000 0.000000 0.000000 0.039421 0.999223
1368730131.230269 -9.277041 16.886208 0.000000 0.000000 0.000000 0.022947 0.999737
1368730132.329361 -8.986329 16.896406 0.000000 0.000000 0.000000 0.021728 0.999764
1368730133.353194 -8.728965 16.900934 0.000000 0.000000 0.000000 0.020630 0.999787
1368730134.502119 -8.371084 16.905918 0.000000 0.000000 0.000000 0.019516 0.999810
1368730135.601206 -7.967924 16.918070 0.000000 0.000000 0.000000 0.018707 0.999825
1368730136.700136 -7.555351 16.926100 0.000000 0.000000 0.000000 0.017411 0.999848
1368730137.799108 -7.103616 16.935326 0.000000 0.000000 0.000000 0.016761 0.999860
1368730138.897897 -6.644004 16.942846 0.000000 0.000000 0.000000 0.015473 0.999880
1368730139.971933 -6.188236 16.942419 0.000000 0.000000 0.000000 0.015179 0.999885
1368730141.048516 -5.722981 16.950218 0.000000 0.000000 0.000000 0.014071 0.999901
1368730142.095132 -5.263544 16.965281 0.000000 0.000000 0.000000 0.013068 0.999915
1368730143.143947 -4.863196 16.973597 0.000000 0.000000 0.000000 0.012678 0.999920
1368730144.192939 -4.463703 16.983418 0.000000 0.000000 0.000000 0.011886 0.999929
1368730145.217007 -4.094602 16.985535 0.000000 0.000000 0.000000 0.011725 0.999931
1368730146.340841 -3.781827 16.991592 0.000000 0.000000 0.000000 0.009510 0.999955
1368730147.415115 -3.540430 16.994059 0.000000 0.000000 0.000000 0.009554 0.999954
1368730149.512934 -3.529014 16.984921 0.000000 0.000000 0.000000 -0.142749 0.989759
1368730150.562012 -3.539508 16.960062 0.000000 0.000000 0.000000 -0.330574 0.943780
1368730151.611006 -3.552583 16.951082 0.000000 0.000000 0.000000 -0.509306 0.860585
1368730152.685398 -3.567989 16.943043 0.000000 0.000000 0.000000 -0.645466 0.763789
1368730153.759215 -3.547411 16.940498 0.000000 0.000000 0.000000 -0.687554 0.726133
1368730154.808295 -3.542971 16.815336 0.000000 0.000000 0.000000 -0.687953 0.725755
1368730155.857295 -3.530093 16.437319 0.000000 0.000000 0.000000 -0.688409 0.725323
1368730156.906408 -3.509643 15.991532 0.000000 0.000000 0.000000 -0.689189 0.724582
1368730157.980413 -3.490628 15.530376 0.000000 0.000000 0.000000 -0.693831 0.720138
1368730159.054481 -3.484817 15.057600 0.000000 0.000000 0.000000 -0.704285 0.709917
1368730160.103443 -3.488762 14.582988 0.000000 0.000000 0.000000 -0.713826 0.700323
1368730161.128455 -3.508281 14.118348 0.000000 0.000000 0.000000 -0.723087 0.690757
1368730162.258562 -3.550539 13.620258 0.000000 0.000000 0.000000 -0.727436 0.686175
1368730163.325650 -3.575471 13.133912 0.000000 0.000000 0.000000 -0.718528 0.695498
1368730164.349760 -3.587972 12.663317 0.000000 0.000000 0.000000 -0.711121 0.703070
1368730165.423718 -3.592584 12.182328 0.000000 0.000000 0.000000 -0.704263 0.709939
1368730166.474588 -3.585702 11.701101 0.000000 0.000000 0.000000 -0.697702 0.716388
1368730167.621899 -3.575045 11.181039 0.000000 0.000000 0.000000 -0.689999 0.723811
1368730168.720974 -3.571074 10.682849 0.000000 0.000000 0.000000 -0.701098 0.713065
1368730169.744944 -3.582154 10.210915 0.000000 0.000000 0.000000 -0.709590 0.704615
1368730170.844144 -3.602424 9.707085 0.000000 0.000000 0.000000 -0.714032 0.700114
1368730171.943191 -3.596236 9.217596 0.000000 0.000000 0.000000 -0.704702 0.709504
1368730173.017248 -3.593774 8.738595 0.000000 0.000000 0.000000 -0.696693 0.717369
1368730174.041087 -3.576385 8.277225 0.000000 0.000000 0.000000 -0.691337 0.722532
1368730175.140222 -3.561893 7.791842 0.000000 0.000000 0.000000 -0.684112 0.729377
1368730176.164451 -3.533117 7.338616 0.000000 0.000000 0.000000 -0.678017 0.735046
1368730177.213535 -3.499608 6.862405 0.000000 0.000000 0.000000 -0.669750 0.742587
1368730178.262651 -3.453408 6.390543 0.000000 0.000000 0.000000 -0.660723 0.750629
1368730179.361627 -3.397997 5.891155 0.000000 0.000000 0.000000 -0.661223 0.750190
1368730180.410494 -3.354053 5.420840 0.000000 0.000000 0.000000 -0.677510 0.735514
1368730181.534637 -3.339693 4.906298 0.000000 0.000000 0.000000 -0.689161 0.724609
1368730182.583603 -3.325072 4.424062 0.000000 0.000000 0.000000 -0.698663 0.715451
1368730183.682676 -3.328049 4.136955 0.000000 0.000000 0.000000 -0.704973 0.709234
1368730184.781721 -3.322577 3.729138 0.000000 0.000000 0.000000 -0.711147 0.703043
1368730185.880802 -3.319728 3.490264 0.000000 0.000000 0.000000 -0.697921 0.716175
1368730186.979755 -3.323636 3.500852 0.000000 0.000000 0.000000 -0.585404 0.810742
1368730188.103821 -3.329754 3.513758 0.000000 0.000000 0.000000 -0.338112 0.941106
1368730189.202850 -3.325271 3.540545 0.000000 0.000000 0.000000 -0.071627 0.997432
1368730190.276746 -3.319020 3.529299 0.000000 0.000000 -0.000000 -0.010157 0.999948
1368730191.400758 -2.964609 3.513731 0.000000 0.000000 -0.000000 -0.009981 0.999950
1368730192.499877 -2.470369 3.497379 0.000000 0.000000 -0.000000 -0.009486 0.999955
1368730193.623868 -1.955809 3.494789 0.000000 0.000000 0.000000 0.022841 0.999739
1368730194.698032 -1.482962 3.514132 0.000000 0.000000 0.000000 0.033100 0.999452
1368730195.747044 -1.014611 3.543930 0.000000 0.000000 0.000000 0.042915 0.999079
1368730196.846036 -0.518372 3.580777 0.000000 0.000000 0.000000 0.045831 0.998949
1368730197.970107 -0.010465 3.602128 0.000000 0.000000 0.000000 0.020556 0.999789
1368730199.094106 0.489931 3.595727 0.000000 0.000000 0.000000 -0.008150 0.999967
1368730200.168682 0.976889 3.575978 0.000000 0.000000 0.000000 -0.029732 0.999558
1368730201.242715 1.455418 3.532911 0.000000 0.000000 0.000000 -0.040428 0.999182
1368730202.267271 1.912617 3.488330 0.000000 0.000000 0.000000 -0.035821 0.999358
1368730203.367170 2.410408 3.462518 0.000000 0.000000 0.000000 -0.009359 0.999956
1368730204.467129 2.899761 3.458181 0.000000 0.000000 0.000000 0.005274 0.999986
1368730205.491596 3.364675 3.460949 0.000000 0.000000 0.000000 0.015375 0.999882
1368730206.566978 3.850313 3.476933 0.000000 0.000000 0.000000 0.026219 0.999656
1368730207.641165 4.338786 3.507058 0.000000 0.000000 0.000000 0.036592 0.999330
1368730208.715898 4.739137 3.526931 0.000000 0.000000 0.000000 0.032366 0.999476
1368730209.790626 5.078024 3.520674 0.000000 0.000000 0.000000 -0.018583 0.999827
1368730210.815335 5.176995 3.512674 0.000000 0.000000 0.000000 -0.022795 0.999740
1368730211.940073 5.179369 3.500028 0.000000 0.000000 0.000000 -0.214540 0.976715
1368730213.089775 5.165793 3.495121 0.000000 0.000000 0.000000 -0.461193 0.887300
1368730214.214648 5.149818 3.489748 0.000000 0.000000 0.000000 -0.655193 0.755462
1368730215.289216 5.130979 3.488077 0.000000 0.000000 0.000000 -0.714669 0.699463
1368730217.463810 5.123966 3.198531 0.000000 0.000000 0.000000 -0.716251 0.697843
1368730218.538785 5.123187 2.868127 0.000000 0.000000 0.000000 -0.717396 0.696666
1368730219.663556 5.128421 2.492212 0.000000 0.000000 0.000000 -0.688068 0.725647
1368730220.763114 5.198148 2.080047 0.000000 0.000000 0.000000 -0.622132 0.782912
1368730221.813083 5.291132 1.676067 0.000000 0.000000 0.000000 -0.608422 0.793614
1368730222.862984 5.391319 1.266329 0.000000 0.000000 0.000000 -0.600288 0.799784
1368730223.937508 5.493961 0.874165 0.000000 0.000000 0.000000 -0.646689 0.762754
1368730224.962062 5.527710 0.559425 0.000000 0.000000 0.000000 -0.673459 0.739224
1368730226.036952 5.541363 0.322834 0.000000 0.000000 0.000000 -0.690220 0.723600
1368730227.136890 5.544460 0.214535 0.000000 0.000000 0.000000 -0.694768 0.719234
1368730230.386015 5.544261 0.221155 0.000000 0.000000 0.000000 -0.583322 0.812241
1368730231.411018 5.548012 0.218679 0.000000 0.000000 0.000000 -0.483390 0.875405
1368730232.486427 5.549489 0.214053 0.000000 0.000000 0.000000 -0.370834 0.928699
1368730233.585319 5.552839 0.212687 0.000000 0.000000 0.000000 -0.241409 0.970424
1368730234.710040 5.559639 0.222143 0.000000 0.000000 0.000000 -0.091155 0.995837
1368730235.810076 5.561359 0.236229 0.000000 0.000000 0.000000 0.071596 0.997434
1368730236.909555 5.559348 0.245119 0.000000 0.000000 0.000000 0.239996 0.970774
1368730237.984134 5.555472 0.246451 0.000000 0.000000 0.000000 0.388177 0.921585
1368730239.008957 5.551507 0.247803 0.000000 0.000000 0.000000 0.519422 0.854518
1368730240.058951 5.542851 0.253104 0.000000 0.000000 0.000000 0.640537 0.767927
1368730241.083391 5.535200 0.250922 0.000000 0.000000 0.000000 0.711700 0.702483
1368730245.432388 5.534797 0.251065 0.000000 0.000000 0.000000 0.749619 0.661869
1368730246.532059 5.533773 0.253265 0.000000 0.000000 0.000000 0.821876 0.569667
1368730247.556567 5.521491 0.247170 0.000000 0.000000 0.000000 0.867997 0.496570
1368730248.656215 5.509952 0.242342 0.000000 0.000000 0.000000 0.906894 0.421359
Reference in New Issue View Git Blame Copy Permalink