/SLAM-Hive/slam_hive_results/mapping_results/2652/1863_vins-mono+MH_01_easy+Image_comb_test-8.yamlERROR: Unable to communicate with master!
... logging to /root/.ros/log/e5aa7ac2-3c3c-11ef-9ec2-0242ac110004/roslaunch-97e28ea0e2b0-117.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
]2;/home/catkin_ws/src/VINS-Mono/vins_estimator/launch/euroc.launch
[1mstarted roslaunch server http://97e28ea0e2b0:42981/[0m

SUMMARY
========

PARAMETERS
 * /feature_tracker/config_file: /slamhive/mapping...
 * /feature_tracker/vins_folder: /home/catkin_ws/s...
 * /pose_graph/config_file: /slamhive/mapping...
 * /pose_graph/skip_cnt: 0
 * /pose_graph/skip_dis: 0.0
 * /pose_graph/visualization_shift_x: 0
 * /pose_graph/visualization_shift_y: 0
 * /rosdistro: kinetic
 * /rosversion: 1.12.17
 * /vins_estimator/config_file: /slamhive/mapping...
 * /vins_estimator/vins_folder: /home/catkin_ws/s...

NODES
  /
    feature_tracker (feature_tracker/feature_tracker)
    pose_graph (pose_graph/pose_graph)
    vins_estimator (vins_estimator/vins_estimator)

auto-starting new master
[1mprocess[master]: started with pid [128][0m
[1mROS_MASTER_URI=http://localhost:11311[0m
]2;/home/catkin_ws/src/VINS-Mono/vins_estimator/launch/euroc.launch http://localhost:11311
[1msetting /run_id to e5aa7ac2-3c3c-11ef-9ec2-0242ac110004[0m
[1mprocess[rosout-1]: started with pid [141][0m
started core service [/rosout]
[1mprocess[feature_tracker-2]: started with pid [155][0m
[1mprocess[vins_estimator-3]: started with pid [159][0m
[0m[ INFO] [1720341774.927827077]: init begins[0m
[0m[ INFO] [1720341774.932641222]: Loaded config_file: /slamhive/mappingtask.yaml[0m
result path /home/shaozu/output//vins_result_no_loop.csv
/home/shaozu/output/ not exists, trying to create it 
/home/shaozu not exists, trying to create it 
[0m[ INFO] [1720341774.933193732]: ROW: 288.000000 COL: 451.000000 [0m
[33m[ WARN] [1720341774.933214664]:  fix extrinsic param [0m
[0m[ INFO] [1720341774.933372670]: Extrinsic_R : 
 0.0148655  -0.999881  0.0041403
  0.999557  0.0149672  0.0257155
-0.0257744 0.00375619   0.999661[0m
[0m[ INFO] [1720341774.933420278]: Extrinsic_T : 
-0.0216401   0.064677 0.00981073[0m
[0m[ INFO] [1720341774.933495104]: Synchronized sensors, fix time offset: 0[0m
[33m[ WARN] [1720341774.933552361]: waiting for image and imu...[0m
[1mprocess[pose_graph-4]: started with pid [180][0m
vocabulary_file/home/catkin_ws/src/VINS-Mono/pose_graph/../support_files/brief_k10L6.bin
loop start load vocabulary
BRIEF_PATTERN_FILE/home/catkin_ws/src/VINS-Mono/pose_graph/../support_files/brief_pattern.yml
/home/shaozu/output/pose_graph/ not exists, trying to create it 
no previous pose graph
rosbag play /slamhive/dataset/MH_01_easy.bag  --clock 
[0m[ INFO] [1720341782.181057131]: Opening /slamhive/dataset/MH_01_easy.bag[0m

Waiting 0.2 seconds after advertising topics... done.

Hit space to toggle paused, or 's' to step.

 [DELAYED]  Bag Time: 1403636578.946206   Duration: 0.000000 / 187.749443   Delay: 316705203.47 
[0m[ INFO] [1720341784.703828444]: Not enough features or parallax; Move device around[0m
[0m[ INFO] [1720341784.903703886]: Not enough features or parallax; Move device around[0m
unstable features tracking, please slowly move you device!
unstable features tracking, please slowly move you device!
unstable features tracking, please slowly move you device!
unstable features tracking, please slowly move you device!
unstable features tracking, please slowly move you device!
unstable features tracking, please slowly move you device!
unstable features tracking, please slowly move you device!
unstable features tracking, please slowly move you device!
[33m[ WARN] [1720341785.628361855]: gyroscope bias initial calibration 0.000534498   0.0253422   0.0811632[0m
[0m[ INFO] [1720341785.647768339]: Initialization finish![0m
position: -0.010820, -0.001969, -0.006125
position: -0.014862, -0.002006, -0.065543
position: -0.005920, -0.005361, -0.108399
position: -0.007338, -0.003466, -0.119131
position: -0.005069, -0.001136, -0.088796
position: -0.003053, 0.001745, -0.027871
position: 0.000875, 0.003179, 0.036947
position: 0.004344, 0.002341, 0.103987
position: 0.008825, -0.000028, 0.170023
position: 0.013995, -0.004674, 0.234838
position: 0.016643, -0.008809, 0.290969
position: 0.016120, -0.011028, 0.325817
position: 0.015573, -0.012728, 0.328943
position: 0.015814, -0.012872, 0.299533
position: 0.016444, -0.013759, 0.249154
position: 0.015170, -0.016230, 0.186067
position: 0.013860, -0.018372, 0.117118
position: 0.013028, -0.019249, 0.045987
position: 0.010269, -0.020099, -0.017955
position: 0.005299, -0.021260, -0.070713
position: 0.001501, -0.021371, -0.109203
position: -0.004128, -0.019228, -0.126579
position: -0.005073, -0.017345, -0.114147
position: -0.002851, -0.015469, -0.074081
position: 0.002076, -0.014438, -0.017976
position: 0.010756, -0.015733, 0.049771
position: 0.019836, -0.016416, 0.122716
position: 0.028152, -0.016777, 0.196310
position: 0.032603, -0.016659, 0.261795
position: 0.032244, -0.014953, 0.314196
position: 0.030973, -0.012653, 0.343782
position: 0.032782, -0.012039, 0.343020
position: 0.034658, -0.012218, 0.316752
position: 0.038903, -0.015323, 0.273954
position: 0.040447, -0.019445, 0.221367
position: 0.042727, -0.023338, 0.167780
position: 0.039426, -0.024351, 0.117333
position: 0.028600, -0.024715, 0.078516
position: 0.016444, -0.026290, 0.054734
position: 0.000352, -0.025068, 0.046729
position: -0.012915, -0.026457, 0.049559
position: -0.018171, -0.026525, 0.054103
position: -0.021537, -0.023581, 0.059103
position: -0.027183, -0.018947, 0.063664
position: -0.035031, -0.016633, 0.067114
position: -0.045741, -0.016774, 0.069096
position: -0.055156, -0.020588, 0.071855
position: -0.059316, -0.028426, 0.076221
position: -0.059088, -0.037623, 0.079694
position: -0.055829, -0.046588, 0.081064
position: -0.052411, -0.050315, 0.080333
position: -0.047698, -0.052443, 0.080582
position: -0.042540, -0.056518, 0.080299
position: -0.036671, -0.066232, 0.079868
position: -0.028786, -0.083916, 0.079403
position: -0.021377, -0.107587, 0.079527
position: -0.014738, -0.138630, 0.080521
position: -0.007977, -0.174342, 0.082606
position: -0.000896, -0.212682, 0.086213
position: 0.005848, -0.251655, 0.088359
position: 0.010203, -0.288034, 0.086372
position: 0.012961, -0.320185, 0.082550
position: 0.015729, -0.344288, 0.077861
position: 0.017263, -0.359117, 0.073382
position: 0.017135, -0.364820, 0.070552
position: 0.014730, -0.362479, 0.069437
position: 0.012153, -0.352455, 0.071383
position: 0.008403, -0.333870, 0.075284
position: 0.002336, -0.308353, 0.076768
position: -0.003373, -0.277155, 0.076555
position: -0.009209, -0.239541, 0.077956
position: -0.016187, -0.197955, 0.081445
position: -0.022682, -0.153933, 0.085967
position: -0.028973, -0.107419, 0.089935
position: -0.035718, -0.059484, 0.091167
position: -0.041553, -0.011881, 0.090763
position: -0.047474, 0.035929, 0.089487
position: -0.053268, 0.083939, 0.087823
position: -0.058333, 0.129946, 0.084797
position: -0.063502, 0.172264, 0.079724
position: -0.067671, 0.207668, 0.074262
position: -0.070922, 0.235178, 0.071990
position: -0.073601, 0.252375, 0.073039
position: -0.078753, 0.258610, 0.076230
position: -0.081932, 0.251603, 0.078668
position: -0.082998, 0.231010, 0.080963
position: -0.083603, 0.200438, 0.084675
position: -0.083134, 0.162986, 0.088147
position: -0.081235, 0.120846, 0.089495
position: -0.077546, 0.075406, 0.088936
position: -0.072874, 0.026748, 0.087951
position: -0.067197, -0.021148, 0.086972
position: -0.060935, -0.066853, 0.086288
position: -0.055151, -0.108804, 0.084792
position: -0.050130, -0.144075, 0.080964
position: -0.045100, -0.168576, 0.074531
position: -0.037492, -0.187087, 0.067065
position: -0.027723, -0.200504, 0.059976
position: -0.018607, -0.207557, 0.055591
position: -0.009510, -0.212502, 0.054147
position: -0.000448, -0.218804, 0.054013
position: 0.013973, -0.229586, 0.052967
position: 0.035053, -0.243542, 0.051520
position: 0.059269, -0.257472, 0.050434
position: 0.087139, -0.266032, 0.050012
position: 0.119073, -0.265835, 0.050670
position: 0.152973, -0.255415, 0.052285
position: 0.184850, -0.235329, 0.052041
position: 0.211312, -0.205023, 0.050079
position: 0.227911, -0.162082, 0.046458
position: 0.231030, -0.109000, 0.041256
position: 0.218120, -0.048611, 0.037154
position: 0.190400, 0.014258, 0.035242
position: 0.151073, 0.074578, 0.035747
position: 0.104590, 0.122793, 0.036347
position: 0.054187, 0.152789, 0.034916
position: 0.002058, 0.163822, 0.031626
position: -0.047276, 0.158159, 0.027175
position: -0.090911, 0.135236, 0.022283
position: -0.127761, 0.097554, 0.019706
position: -0.155135, 0.050221, 0.020938
position: -0.170538, -0.003743, 0.024355
position: -0.171721, -0.059423, 0.026855
position: -0.155942, -0.116772, 0.027521
position: -0.122404, -0.174255, 0.026996
position: -0.077288, -0.229861, 0.026476
position: -0.030257, -0.277627, 0.027062
position: 0.019304, -0.303365, 0.027227
position: 0.063998, -0.301518, 0.026078
position: 0.102868, -0.273338, 0.022021
position: 0.130908, -0.217195, 0.016064
position: 0.144684, -0.142531, 0.009428
position: 0.144842, -0.062951, 0.001912
position: 0.130525, 0.009948, -0.004231
position: 0.105600, 0.065271, -0.008431
position: 0.074708, 0.095468, -0.010346
position: 0.040183, 0.097585, -0.011393
position: 0.005482, 0.073656, -0.010770
position: -0.026167, 0.029217, -0.012849
position: -0.052903, -0.027664, -0.016121
position: -0.079976, -0.084831, -0.019381
position: -0.110293, -0.130986, -0.021087
position: -0.141173, -0.154706, -0.020825
position: -0.169968, -0.149928, -0.016246
position: -0.201959, -0.119904, -0.007010
position: -0.236430, -0.080877, 0.005106
position: -0.267870, -0.043580, 0.013214
position: -0.292016, -0.013944, 0.018321
position: -0.302275, 0.003374, 0.019259
position: -0.294776, 0.008835, 0.017463
position: -0.267785, 0.004367, 0.014417
position: -0.218597, -0.011893, 0.009494
position: -0.159380, -0.030942, 0.005785
position: -0.093999, -0.049521, 0.008202
position: -0.026035, -0.064023, 0.013013
position: 0.038670, -0.072603, 0.016703
position: 0.090307, -0.071311, 0.017950
position: 0.120827, -0.057831, 0.016026
position: 0.125488, -0.034991, 0.013106
position: 0.101471, -0.010970, 0.009005
position: 0.057155, 0.005110, 0.005502
position: 0.010564, 0.016002, 0.001335
position: -0.036287, 0.020297, -0.005173
position: -0.074521, 0.017220, -0.016287
position: -0.096315, 0.008827, -0.030144
position: -0.097337, -0.002408, -0.045637
position: -0.079026, -0.013668, -0.059871
position: -0.048341, -0.024718, -0.073973
position: -0.012993, -0.035142, -0.091186
position: 0.021211, -0.044890, -0.112812
position: 0.051230, -0.054697, -0.137136
position: 0.074996, -0.062084, -0.159835
position: 0.092476, -0.066356, -0.175422
position: 0.107386, -0.069581, -0.185291
position: 0.118696, -0.072459, -0.193916
position: 0.127982, -0.074440, -0.203304
position: 0.133155, -0.075592, -0.21optimize pose graph 
2838
position: 0.133517, -0.074892, -0.222213
position: 0.133603, -0.076004, -0.225536
position: 0.132348, -0.077112, -0.225550
position: 0.131137, -0.078213, -0.225337
position: 0.130448, -0.079638, -0.225913
position: 0.129417, -0.081165, -0.225260
position: 0.128996, -0.080616, -0.224800
position: 0.128644, -0.080429, -0.224394
position: 0.128568, -0.080277, -0.224203
position: 0.128671, -0.080441, -0.224291
position: 0.128638, -0.080359, -0.224258
position: 0.128646, -0.080296, -0.224193
position: 0.128626, -0.080302, -0.224204
position: 0.128654, -0.080277, -0.224204
position: 0.128653, -0.080282, -0.224210
position: 0.128641, -0.080301, -0.224236
position: 0.128668, -0.080295, -0.224252
position: 0.128702, -0.080347, -0.224312
position: 0.128714, -0.080339, -0.224332
position: 0.128715, -0.080377, -0.224337
position: 0.128739, -0.080397, -0.224404
position: 0.128748, -0.080411, -0.224449
position: 0.128809, -0.080432, -0.224453
position: 0.128807, -0.080457, -0.224467
position: 0.128749, -0.080510, -0.224483
position: 0.128794, -0.080512, -0.224516
position: 0.128809, -0.080524, -0.224543
position: 0.128811, -0.080510, -0.224531
position: 0.128817, -0.080516, -0.224532
position: 0.128796, -0.080516, -0.224520
position: 0.128829, -0.080530, -0.224550
position: 0.128812, -0.080522, -0.224535
position: 0.128791, -0.080520, -0.224548
position: 0.128785, -0.080524, -0.224569
position: 0.128798, -0.080512, -0.224591
position: 0.128746, -0.080499, -0.224572
position: 0.128743, -0.080521, -0.224579
position: 0.128745, -0.080517, -0.224623
position: 0.128747, -0.080513, -0.224636
position: 0.128736, -0.080517, -0.224621
position: 0.128726, -0.080502, -0.224621
position: 0.128706, -0.080496, -0.224603
position: 0.128735, -0.080507, -0.224623
position: 0.128715, -0.080527, -0.224647
position: 0.128706, -0.080535, -0.224656
position: 0.128677, -0.080542, -0.224678
position: 0.128677, -0.080539, -0.224663
position: 0.128671, -0.080536, -0.224660
position: 0.128655, -0.080547, -0.224677
position: 0.128685, -0.080532, -0.224689
position: 0.128677, -0.080531, -0.224693
position: 0.128685, -0.080527, -0.224698
position: 0.128655, -0.080511, -0.224687
position: 0.128649, -0.080527, -0.224675
position: 0.128646, -0.080520, -0.224668
position: 0.128659, -0.080527, -0.224684
position: 0.128650, -0.080519, -0.224689
position: 0.128659, -0.080522, -0.224693
position: 0.128634, -0.080531, -0.224671
position: 0.128631, -0.080506, -0.224671
position: 0.128621, -0.080527, -0.224667
position: 0.128604, -0.080515, -0.224671
position: 0.128608, -0.080516, -0.224681
position: 0.128607, -0.080524, -0.224684
position: 0.128619, -0.080526, -0.224697
position: 0.128616, -0.080518, -0.224705
position: 0.128622, -0.080507, -0.224713
position: 0.128612, -0.080498, -0.224714
position: 0.128611, -0.080508, -0.224711
position: 0.128611, -0.080508, -0.224718
position: 0.128600, -0.080499, -0.224738
position: 0.128590, -0.080500, -0.224728
position: 0.128594, -0.080517, -0.224733
position: 0.128581, -0.080501, -0.224715
position: 0.128570, -0.080505, -0.224709
position: 0.128550, -0.080508, -0.224697
position: 0.128556, -0.080498, -0.224698
position: 0.128549, -0.080501, -0.224680
position: 0.128537, -0.080513, -0.224674
position: 0.128532, -0.080504, -0.224688
position: 0.128521, -0.080487, -0.224679
position: 0.128527, -0.080487, -0.224656
position: 0.128546, -0.080492, -0.224674
position: 0.128521, -0.080478, -0.224662
position: 0.128537, -0.080474, -0.224667
position: 0.128531, -0.080485, -0.224662
position: 0.128547, -0.080497, -0.224678
position: 0.128549, -0.080497, -0.224678
position: 0.128557, -0.080503, -0.224685
position: 0.128550, -0.080503, -0.224704
position: 0.128544, -0.080493, -0.224704
position: 0.128543, -0.080487, -0.224708
position: 0.128555, -0.080489, -0.224708
position: 0.128560, -0.080494, -0.224694
position: 0.128571, -0.080495, -0.224697
position: 0.128543, -0.080495, -0.224706
position: 0.128570, -0.080506, -0.224732
position: 0.128560, -0.080508, -0.224727
position: 0.128551, -0.080497, -0.224701
position: 0.128565, -0.080496, -0.224715
position: 0.128537, -0.080486, -0.224713
position: 0.128553, -0.080504, -0.224691
position: 0.128579, -0.080512, -0.224684
position: 0.128577, -0.080511, -0.224690
position: 0.128941, -0.080220, -0.224888
position: 0.128953, -0.080246, -0.224883
position: 0.128987, -0.080273, -0.224884
position: 0.128950, -0.080270, -0.224868
position: 0.128982, -0.080286, -0.224848
position: 0.128987, -0.080289, -0.224872
position: 0.128967, -0.080292, -0.224859
position: 0.128996, -0.080282, -0.224852
position: 0.128953, -0.080311, -0.224869
position: 0.128953, -0.080330, -0.224873
position: 0.128962, -0.080338, -0.224901
position: 0.128981, -0.080322, -0.224868
position: 0.129036, -0.080278, -0.224827
position: 0.128903, -0.080015, -0.224676
position: 0.129059, -0.080538, -0.224866
position: 0.129145, -0.080797, -0.225067
position: 0.129096, -0.080711, -0.224956
position: 0.129125, -0.080725, -0.224989
position: 0.129204, -0.080960, -0.225107
position: 0.129035, -0.080689, -0.224952
position: 0.129187, -0.080898, -0.225131
position: 0.129185, -0.080519, -0.224759
position: 0.129350, -0.081302, -0.225577
position: 0.129209, -0.081269, -0.225413
position: 0.129215, -0.081194, -0.225406
position: 0.129205, -0.081104, -0.225275
position: 0.129185, -0.081078, -0.225231
position: 0.129135, -0.081052, -0.225212
position: 0.129051, -0.080933, -0.225064
position: 0.129028, -0.080913, -0.225014
position: 0.129047, -0.080855, -0.225013
position: 0.129046, -0.080796, -0.224963
position: 0.129060, -0.080822, -0.225063
position: 0.129088, -0.080797, -0.225024
position: 0.129070, -0.080794, -0.225057
position: 0.129095, -0.080820, -0.225069
position: 0.129090, -0.080835, -0.225082
position: 0.129086, -0.080856, -0.225118
position: 0.129089, -0.080858, -0.225113
position: 0.129086, -0.080877, -0.225120
position: 0.129071, -0.080877, -0.225129
position: 0.129086, -0.080867, -0.225138
position: 0.129117, -0.080880, -0.225165
position: 0.129097, -0.080892, -0.225123
position: 0.129067, -0.080894, -0.225165
position: 0.129106, -0.080887, -0.225164
position: 0.129102, -0.080878, -0.225144
position: 0.129080, -0.080866, -0.225139
position: 0.129082, -0.080864, -0.225134
position: 0.129079, -0.080854, -0.225136
position: 0.129098, -0.080858, -0.225107
position: 0.129070, -0.080860, -0.225125
position: 0.129087, -0.080840, -0.225105
position: 0.129072, -0.080831, -0.225104
position: 0.129083, -0.080847, -0.225113
position: 0.129073, -0.080833, -0.225105
position: 0.129061, -0.080841, -0.225093
position: 0.129083, -0.080859, -0.225117
position: 0.129092, -0.080824, -0.225109
position: 0.129068, -0.080844, -0.225104
position: 0.129091, -0.080847, -0.225124
position: 0.129080, -0.080842, -0.225117
position: 0.129076, -0.080835, -0.225118
position: 0.129106, -0.080844, -0.225123
position: 0.129089, -0.080854, -0.225120
position: 0.129081, -0.080836, -0.225109
position: 0.129090, -0.080860, -0.225119
position: 0.129097, -0.080858, -0.225116
position: 0.129093, -0.080854, -0.225116
position: 0.129070, -0.080847, -0.225115
position: 0.129097, -0.080839, -0.225129
position: 0.129072, -0.080854, -0.225122
position: 0.129108, -0.080843, -0.225142
position: 0.129080, -0.080849, -0.225123
position: 0.129059, -0.080855, -0.225106
position: 0.129095, -0.080837, -0.225111
position: 0.129079, -0.080858, -0.225115
position: 0.129109, -0.080849, -0.225126
position: 0.129091, -0.080832, -0.225114
position: 0.129092, -0.080850, -0.225114
position: 0.129067, -0.080839, -0.225100
position: 0.129073, -0.080846, -0.225114
position: 0.129081, -0.080850, -0.225115
position: 0.129065, -0.080849, -0.225104
position: 0.129076, -0.080851, -0.225127
position: 0.128973, -0.080841, -0.225131
position: 0.128978, -0.080823, -0.225110
position: 0.128998, -0.080849, -0.225098
position: 0.128989, -0.080831, -0.225097
position: 0.128926, -0.080783, -0.225065
position: 0.128967, -0.080797, -0.225078
position: 0.129032, -0.080822, -0.225070
position: 0.129059, -0.080817, -0.225065
position: 0.128962, -0.080790, -0.225086
position: 0.128968, -0.080752, -0.225089
position: 0.128934, -0.080835, -0.225037
position: 0.128953, -0.080858, -0.225073
position: 0.128949, -0.080873, -0.225056
position: 0.128974, -0.080876, -0.225070
position: 0.128948, -0.080882, -0.225077
position: 0.128966, -0.080888, -0.225102
position: 0.128948, -0.080882, -0.225122
position: 0.128960, -0.080894, -0.225107
position: 0.128956, -0.080895, -0.225111
position: 0.128975, -0.080899, -0.225121
position: 0.128990, -0.080893, -0.225103
position: 0.128982, -0.080895, -0.225120
position: 0.128973, -0.080888, -0.225103
position: 0.128957, -0.080891, -0.225099
position: 0.128990, -0.080892, -0.225107
position: 0.129055, -0.080992, -0.225197
position: 0.129028, -0.080997, -0.225198
position: 0.129033, -0.080963, -0.225178
position: 0.129044, -0.080965, -0.225155
position: 0.129014, -0.080948, -0.225152
position: 0.128996, -0.080951, -0.225143
position: 0.129027, -0.080931, -0.225149
position: 0.129017, -0.080946, -0.225141
position: 0.128991, -0.080935, -0.225115
position: 0.128980, -0.080919, -0.225092
position: 0.129011, -0.080910, -0.225101
position: 0.129019, -0.080926, -0.225106
position: 0.128991, -0.080939, -0.225106
position: 0.129014, -0.080936, -0.225114
position: 0.128997, -0.080938, -0.225117
position: 0.129020, -0.080932, -0.225135
position: 0.129004, -0.080948, -0.225113
position: 0.129038, -0.080963, -0.225107
position: 0.129056, -0.080985, -0.225053
position: 0.129092, -0.081015, -0.224928
position: 0.129105, -0.081064, -0.224943
position: 0.129137, -0.081106, -0.224881
position: 0.129146, -0.081098, -0.224873
position: 0.129185, -0.081148, -0.224864
position: 0.129166, -0.081178, -0.224876
position: 0.129234, -0.081197, -0.224831
position: 0.129310, -0.081189, -0.224860
position: 0.129428, -0.081253, -0.224846
position: 0.129526, -0.081306, -0.224777
position: 0.129744, -0.081501, -0.224835
position: 0.129767, -0.081628, -0.224789
position: 0.129881, -0.081518, -0.224675
position: 0.129850, -0.081680, -0.224623
position: 0.129514, -0.083293, -0.225245
position: 0.126472, -0.088410, -0.225118
position: 0.122239, -0.095453, -0.224821
position: 0.117396, -0.105288, -0.224888
position: 0.111364, -0.118224, -0.226782
position: 0.101539, -0.134733, -0.225976
position: 0.088606, -0.151105, -0.217710
position: 0.074981, -0.164251, -0.201378
position: 0.062114, -0.171579, -0.179276
position: 0.056466, -0.172761, -0.152522
position: 0.058082, -0.169527, -0.137557
position: 0.060315, -0.170100, -0.140226
position: 0.064330, -0.170510, -0.146797
position: 0.073350, -0.167555, -0.147066
position: 0.075289, -0.162060, -0.124528
position: 0.089523, -0.152549, -0.088968
position: 0.102989, -0.141701, -0.041394
position: 0.116004, -0.130318, 0.006750
position: 0.127365, -0.119900, 0.051469
position: 0.136028, -0.113470, 0.087851
position: 0.143448, -0.111906, 0.110545
position: 0.149802, -0.113852, 0.120971
position: 0.155546, -0.124179, 0.125529
position: 0.158189, -0.132594, 0.125670
position: 0.163869, -0.145501, 0.113236
position: 0.159376, -0.156817, 0.106765
position: 0.152400, -0.168053, 0.096327
position: 0.145723, -0.179096, 0.08optimize pose graph 
3010
position: 0.140282, -0.189063, 0.078084
position: 0.136082, -0.197464, 0.085650
position: 0.130988, -0.205209, 0.102245
position: 0.125296, -0.213258, 0.127533
position: 0.120973, -0.221884, 0.150142
position: 0.114037, -0.233279, 0.157472
position: 0.107000, -0.245399, 0.149942
position: 0.105111, -0.259102, 0.138013
position: 0.106674, -0.274053, 0.130086
position: 0.115324, -0.287330, 0.132761
position: 0.129769, -0.296975, 0.147364
position: 0.145565, -0.305247, 0.168442
position: 0.159659, -0.314751, 0.192922
position: 0.171957, -0.326249, 0.216486
position: 0.183027, -0.341346, 0.234227
position: 0.192423, -0.359563, 0.244608
position: 0.200279, -0.382814, 0.248854
position: 0.207246, -0.409311, 0.247405
position: 0.213288, -0.436483, 0.250828
position: 0.215469, -0.462952, 0.264081
position: 0.216380, -0.490233, 0.282272
position: 0.220671, -0.518497, 0.296447
position: 0.227702, -0.547244, 0.305759
position: 0.236317, -0.577133, 0.309483
position: 0.245609, -0.610357, 0.305629
position: 0.255907,optimize pose graph 
 -0.648034, 0.294239
position: 0.266771, -0.688894, 0.277244
position: 0.282406, -0.732696, 0.256391
position: 0.302032, -0.775444, 0.237002
position: 0.322278, -0.815726, 0.224642
position: 0.347459, -0.855416, 0.220970
position: 0.375604, -0.895664, 0.225331
position: 0.403689, -0.934862, 0.234595
position: 0.432365, -0.971855, 0.249230
position: 0.450238, -1.009131, 0.268879
position: 0.486812, -1.037837, 0.291049
position: 0.508585, -1.071934, 0.304384
position: 0.531790, -1.103317, 0.312332
position: 0.580523, -1.126306, 0.316508
position: 0.609882, -1.155685, 0.313460
position: 0.640702, -1.183350, 0.308625
position: 0.671075, -1.209975, 0.302790
position: 0.754127, -1.223608, 0.294006
position: 0.794830, -1.249401, 0.280039
position: 0.837341, -1.277788, 0.262475
position: 0.909047, -1.319949, 0.247260
position: 0.951384, -1.350290, 0.235694
position: 0.994384, -1.380416, 0.231882
position: 1.034337, -1.407683, 0.231175
position: 1.089091, -1.439744, 0.233044
position: 1.124793, -1.459964, 0.235770
position: 1.160474, -1.478340, 0.235974
position: 1.204280, -1.498870, 0.228581
position: 1.240189, -1.512960, 0.216902
position: 1.276758, -1.524458, 0.200504
position: 1.314384, -1.536045, 0.182182
position: 1.358238, -1.550387, 0.163941
position: 1.402278, -1.564919, 0.152308
position: 1.444891, -1.580345, 0.147952
position: 1.491624, -1.599348, 0.149570
position: 1.536789, -1.615565, 0.149732
position: 1.581141, -1.629819, 0.143443
position: 1.625906, -1.643847, 0.130621
position: 1.673060, -1.657717, 0.114222
position: 1.729446, -1.673835, 0.098637
position: 1.784204, -1.689209, 0.080184
position: 1.847407, -1.705526, 0.073899
position: 1.908039, -1.722300, 0.070070
position: 1.974605, -1.738995, 0.075334
position: 2.040383, -1.758885, 0.074310
position: 2.113080, -1.779397, 0.076794
position: 2.188249, -1.806167, 0.082824
position: 2.272169, -1.831869, 0.097156
position: 2.350939, -1.861696, 0.106526
position: 2.438491, -1.889664, 0.107179
position: 2.520903, -1.916540, 0.101804
position: 2.598580, -1.942267, 0.094992
position: 2.669203, -1.965735, 0.093813
position: 2.740113, -1.988223, 0.096495
position: 2.810969, -2.007858, 0.105917
position: 2.875588, -2.026386, 0.108817
position: 2.946178, -2.044235, 0.107688
position: 3.010309, -2.059375, 0.101025
position: 3.084607, -2.076449, 0.098352
position: 3.153176, -2.091719, 0.101866
position: 3.229433, -2.110611, 0.111080
position: 3.304834, -2.130713, 0.126113
position: 3.387438, -2.153245, 0.149894
position: 3.467445, -2.178394, 0.180303
position: 3.547955, -2.206851, 0.208980
position: 3.634128, -2.240405, 0.233193
position: 3.715232, -2.270839, 0.266733
position: 3.801600, -2.300562, 0.305644
position: 3.886544, -2.331117, 0.341193
position: 3.965389, -2.360546, 0.368448
position: 4.032948, -2.386096, 0.388188
position: 4.093137, -2.409088, 0.398555
position: 4.153112, -2.429491, 0.398409
position: 4.200976, -2.440172, 0.391470
position: 4.253620, -2.448759, 0.380456
position: 4.304250, -2.455287, 0.366068
position: 4.352434, -2.460208, 0.352602
position: 4.401505, -2.462827, 0.342140
position: 4.455983, -2.463341, 0.345821
position: 4.501056, -2.461902, 0.350993
position: 4.547681, -2.459986, 0.363731
position: 4.596948, -2.457691, 0.386876
position: 4.654625, -2.455178, 0.415218
position: 4.701276, -2.448968, 0.447660
position: 4.762178, -2.446289, 0.463315
position: 4.811271, -2.442027, 0.464914
position: 4.869220, -2.439130, 0.458293
position: 4.912551, -2.434980, 0.441436
position: 4.963565, -2.433274, 0.420471
position: 4.992079, -2.433146, 0.395027
position: 5.033941, -2.439264, 0.381559
position: 5.090469, -2.446475, 0.380453
position: 5.159675, -2.454172, 0.390835
position: 5.215981, -2.461004, 0.401606
position: 5.279224, -2.468968, 0.416803
position: 5.346092, -2.481191, 0.423148
position: 5.414532, -2.498494, 0.414832
position: 5.489703, -2.521980, 0.396392
position: 5.562396, -2.547070, 0.373843
position: 5.638043, -2.573971, 0.347898
position: 5.712285, -2.599339, 0.318811
position: 5.788562, -2.621821, 0.292943
position: 5.861653, -2.643014, 0.275690
position: 5.928995, -2.663147, 0.267585
position: 5.994686, -2.683077, 0.265639
position: 6.060205, -2.701663, 0.273392
position: 6.119866, -2.721134, 0.288630
position: 6.180255, -2.739841, 0.301658
position: 6.239051, -2.762073, 0.305679
position: 6.294363, -2.781096, 0.306869
position: 6.345609, -2.802566, 0.298021
position: 6.394513, -2.819912, 0.291668
position: 6.441730, -2.836120, 0.290689
position: 6.488789, -2.850771, 0.296962
position: 6.528713, -2.869796, 0.292513
position: 6.573965, -2.882749, 0.294468
position: 6.615695, -2.894912, 0.289875
position: 6.653293, -2.906556, 0.278969
position: 6.684299, -2.919307, 0.246086
position: 6.717152, -2.932735, 0.231368
position: 6.748328, -2.946697, 0.220117
position: 6.778465, -2.961205, 0.217116
position: 6.809063, -2.972207, 0.214538
position: 6.842580, -2.985743, 0.226069
position: 6.874550, -2.999695, 0.243280
position: 6.897550, -3.009900, 0.256349
position: 6.921218, -3.019790, 0.263479
position: 6.951200, -3.032876, 0.261716
position: 6.973025, -3.045809, 0.255728
position: 6.990015, -3.057397, 0.243402
position: 7.001219, -3.068329, 0.225711
position: 7.012001, -3.079459, 0.207810
position: 7.024365, -3.089194, 0.198820
position: 7.041312, -3.100154, 0.194471
position: 7.047588, -3.110195, 0.202603
position: 7.070329, -3.121820, 0.205279
position: 7.091591, -3.135225, 0.202154
position: 7.102667, -3.152701, 0.199576
position: 7.124796, -3.168739, 0.198520
position: 7.150269, -3.185680, 0.203686
position: 7.180196, -3.203585, 0.213410
position: 7.205138, -3.224524, 0.235013
position: 7.243653, -3.241680, 0.252426
position: 7.286832, -3.259582, 0.264688
position: 7.328731, -3.278222, 0.274457
position: 7.382451, -3.295012, 0.276327
position: 7.442730, -3.310527, 0.274904
position: 7.508617, -3.326546, 0.268383
position: 7.567071, -3.345581, 0.264665
position: 7.627497, -3.369080, 0.246900
position: 7.682687, -3.396917, 0.220553
position: 7.736598, -3.431334, 0.184939
position: 7.784365, -3.466905, 0.145293
position: 7.825150, -3.499853, 0.106330
position: 7.860576, -3.531267, 0.073953
position: 7.902778, -3.567458, 0.051311
position: 7.941814, -3.596307, 0.036839
position: 7.996143, -3.625313, 0.029449
position: 8.059861, -3.653863, 0.022284
position: 8.132592, -3.684476, 0.012557
position: 8.212406, -3.710495, -0.007849
position: 8.295090, -3.735331, -0.020829
position: 8.381263, -3.761011, -0.022526
position: 8.473636, -3.783813, -0.014037
position: 8.565984, -3.811762, 0.003740
position: 8.660784, -3.839881, 0.022676
position: 8.755741, -3.871772, 0.039071
position: 8.848316, -3.908343, 0.049607
position: 8.933862, -3.948876, 0.054329
position: 9.014606, -3.991364, 0.060140
position: 9.091804, -4.034084, 0.068334
position: 9.163773, -4.076417, 0.087162
position: 9.235604, -4.117940, 0.112756
position: 9.303678, -4.157514, 0.141013
position: 9.363375, -4.195002, 0.164788
position: 9.415942, -4.233330, 0.180461
position: 9.469872, -4.270779, 0.193717
position: 9.520307, -4.308358, 0.201107
position: 9.569534, -4.346736, 0.204137
position: 9.617872, -4.385516, 0.207779
position: 9.659705, -4.426690, 0.212166
position: 9.700239, -4.472178, 0.224570
position: 9.732438, -4.516334, 0.232656
position: 9.759891, -4.563130, 0.236329
position: 9.780781, -4.610868, 0.229998
position: 9.800766, -4.661660, 0.216410
position: 9.820846, -4.714469, 0.199445
position: 9.837378, -4.768297, 0.179299
position: 9.853020, -4.824195, 0.155776
position: 9.864290, -4.878628, 0.132752
position: 9.867690, -4.928447, 0.113576
position: 9.870258, -4.978103, 0.100336
position: 9.875532, -5.027767, 0.094298
position: 9.884635, -5.078423, 0.098758
position: 9.897992, -5.129933, 0.114202
position: 9.917028, -5.180601, 0.138631
position: 9.925242, -5.226780, 0.166914
position: 9.937130, -5.274956, 0.201292
position: 9.943893, -5.320678, 0.240123
position: 9.946680, -5.362500, 0.285498
position: 9.947578, -5.402946, 0.335037
position: 9.944274, -5.444890, 0.377762
position: 9.937181, -5.484567, 0.413307
position: 9.927292, -5.520368, 0.441377
position: 9.913863, -5.554228, 0.458949
position: 9.896816, -5.587736, 0.467707
position: 9.876243, -5.621134, 0.469284
position: 9.852702, -5.654620, 0.466381
position: 9.826740, -5.688745, 0.460876
position: 9.798143, -5.718821, 0.452488
position: 9.770822, -5.748379, 0.439674
position: 9.743321, -5.775827, 0.425725
position: 9.716828, -5.802073, 0.419810
position: 9.691976, -5.827866, 0.421822
position: 9.667631, -5.852120, 0.429143
position: 9.642103, -5.873486, 0.441608
position: 9.609240, -5.886055, 0.459396
position: 9.580528, -5.901307, 0.478677
position: 9.546722, -5.910178, 0.495123
position: 9.512506, -5.917462, 0.504389
position: 9.483055, -5.925481, 0.505223
position: 9.445844, -5.928269, 0.503178
position: 9.409383, -5.930564, 0.495726
position: 9.362885, -5.931816, 0.486137
position: 9.310964, -5.931898, 0.470931
position: 9.250590, -5.930076, 0.451619
position: 9.185048, -5.925277, 0.427425
position: 9.113320, -5.915543, 0.397046
position: 9.040202, -5.908817, 0.367563
position: 8.967645, -5.905011, 0.343119
position: 8.895937, -5.907158, 0.326947
position: 8.827200, -5.915802, 0.321428
position: 8.762539, -5.931616, 0.325393
position: 8.703198, -5.954718, 0.338029
position: 8.645850, -5.975112, 0.347698
position: 8.596142, -6.010274, 0.347901
position: 8.542015, -6.038963, 0.338678
position: 8.498925, -6.075559, 0.340903
position: 8.456136, -6.107520, 0.349363
position: 8.408752, -6.131561, 0.362343
position: 8.373000, -6.158239, 0.385391
position: 8.329191, -6.178369, 0.400277
position: 8.285915, -6.194091, 0.408376
position: 8.254076, -6.208486, 0.412023
position: 8.210419, -6.216593, 0.404675
position: 8.167717, -6.220757, 0.395305
position: 8.122309, -6.222109, 0.390357
position: 8.087181, -6.218900, 0.392975
position: 8.046198, -6.212458, 0.403336
position: 8.002825, -6.203982, 0.421255
position: 7.959240, -6.193984, 0.439131
position: 7.915956, -6.183540, 0.450352
position: 7.870927, -6.176312, 0.454420
position: 7.828985, -6.169055, 0.450688
position: 7.793001, -6.159990, 0.440904
position: 7.753826, -6.149800, 0.429365
position: 7.715653, -6.136059, 0.417278
position: 7.676809, -6.116969, 0.403756
position: 7.639183, -6.089505, 0.394709
position: 7.600650, -6.054128, 0.392838
position: 7.560117, -6.011424, 0.389999
position: 7.518486, -5.967369, 0.377434
position: 7.471445, -5.923655, 0.351648
position: 7.420582, -5.881004, 0.318630
position: 7.367116, -5.839912, 0.290567
position: 7.310631, -5.798949, 0.271335
position: 7.251523, -5.757971, 0.263756
position: 7.189895, -5.720110, 0.266463
position: 7.126842, -5.688527, 0.279370
position: 7.066707, -5.663794, 0.299592
position: 7.005900, -5.636899, 0.316849
position: 6.947067, -5.617900, 0.332587
position: 6.881911, -5.588348, 0.336213
position: 6.822053, -5.564637, 0.336007
position: 6.764058, -5.538058, 0.326895
position: 6.704979, -5.498776, 0.311902
position: 6.650448, -5.461412, 0.301939
position: 6.590846, -5.411659, 0.296739
position: 6.536924, -5.363768, 0.292134
position: 6.480952, -5.313454, 0.283061
position: 6.422987, -5.262792, 0.270096
position: 6.364477, -5.214052, 0.252893
position: 6.295700, -5.163888, 0.230325
position: 6.227766, -5.112218, 0.208227
position: 6.152900, -5.061137, 0.194842
position: 6.069908, -5.008309, 0.189742
position: 5.981791, -4.956314, 0.187953
position: 5.897181, -4.908987, 0.181513
position: 5.812941, -4.865365, 0.171028
position: 5.728854, -4.824104, 0.158644
position: 5.646048, -4.787120, 0.144271
position: 5.565984, -4.754858, 0.127863
position: 5.493137, -4.729714, 0.109386
position: 5.426667, -4.709138, 0.087844
position: 5.364530, -4.689971, 0.062152
position: 5.305929, -4.669934, 0.033187
position: 5.250295, -4.642575, 0.001491
position: 5.201321, -4.620189, -0.023845
position: 5.153579, -4.591962, -0.046286
position: 5.111392, -4.569580, -0.059359
position: 5.069692, -4.546480, -0.073683
position: 5.031062, -4.522024, -0.094199
position: 4.998558, -4.499309, -0.119319
position: 4.967638, -4.473639, -0.151608
position: 4.942938, -4.451072, -0.186979
position: 4.921178, -4.429415, -0.224626
position: 4.902305, -4.411792, -0.263644
position: 4.885803, -4.398769, -0.299964
position: 4.869662, -4.391507, -0.328637
position: 4.853681, -4.392731, -0.352526
position: 4.839280, -4.404617, -0.377398
position: 4.827441, -4.420159, -0.408065
position: 4.820849, -4.440897, -0.443547
position: 4.820029, -4.461637, -0.484548
position: 4.826081, -4.478048, -0.530248
position: 4.835599, -4.499174, -0.579769
position: 4.851672, -4.513309, -0.625237
position: 4.869545, -4.529795, -0.664062
position: 4.893172, -4.538569, -0.694697
position: 4.917993, -4.551870, -0.717400
position: 4.947522, -4.555561, -0.732521
position: 4.976950, -4.563625, -0.738788
position: 5.008327, -4.563357, -0.738238
position: 5.036040, -4.563695, -0.728435
position: 5.064971, -4.556598, -0.715013
position: 5.090738, -4.549269, -0.699173
position: 5.119201, -4.535181, -0.691037
position: 5.148925, -4.518857, -0.689284
position: 5.180816, -4.504323, -0.696453
position: 5.215017, -4.487484, -0.703447
position: 5.251371, -4.474324, -0.718235
position: 5.286734, -4.461918, -0.732779
position: 5.318185, -4.449511, -0.751226
position: 5.345274, -4.436597, -0.774842
position: 5.366857, -4.426519, -0.796845
position: 5.381747, -4.418332, -0.812248
position: 5.387582, -4.411680, -0.824348
position: 5.387214, -4.408387, -0.841588
position: 5.384793, -4.410135, -0.868068
position: 5.380992, -4.419592, -0.897129
position: 5.379532, -4.437711, -0.929514
position: 5.380504, -4.465352, -0.958463
position: 5.382589, -4.503928, -0.982098
position: 5.395864, -4.550404, -0.997088
position: 5.414338, -4.605071, -1.006812
position: 5.443175, -4.665958, -1.011029
position: 5.480251, -4.730310, -1.010721
position: 5.522993, -4.793080, -1.021339
position: 5.571284, -4.855072, -1.048317
position: 5.623664, -4.915466, -1.080221
position: 5.681418, -4.972401, -1.108051
position: 5.740945, -5.026060, -1.128604
position: 5.802027, -5.075961, -1.140156
position: 5.864876, -5.124547, -1.145588
position: 5.930151, -5.171822, -1.144183
position: 5.996868, -5.216704, -1.135622
position: 6.063555, -5.262217, -1.123066
position: 6.128112, -5.311118, -1.108963
position: 6.189392, -5.359303, -1.095720
position: 6.250287, -5.405873, -1.084091
position: 6.312831, -5.447575, -1.070462
position: 6.378503, -5.497517, -1.058310
position: 6.446176, -5.539836, -1.041987
position: 6.514417, -5.590085, -1.027146
position: 6.580470, -5.637430, -1.016489
position: 6.643287, -5.681860, -1.010118
position: 6.704065, -5.723547, -1.007862
position: 6.767579, -5.757559, -1.013240
position: 6.826263, -5.792421, -1.015286
position: 6.884295, -5.820890, -1.012454
position: 6.937848, -5.844995, -1.004361
position: 6.988052, -5.864208, -0.989819
position: 7.043177, -5.884578, -0.973824
position: 7.096487, -5.906663, -0.965541
position: 7.142643, -5.932918, -0.961737
position: 7.180570, -5.962197, -0.960404
position: 7.216926, -5.993748, -0.964246
position: 7.254305, -6.024358, -0.974739
position: 7.293871, -6.053061, -0.990438
position: 7.333557, -6.078601, -1.005336
position: 7.375510, -6.104971, -1.014450
position: 7.417883, -6.134180, -1.017975
position: 7.455414, -6.166874, -1.015643
position: 7.489766, -6.196478, -1.011971
position: 7.520890, -6.230685, -1.016330
position: 7.550273, -6.263070, -1.026635
position: 7.579641, -6.297727, -1.042931
position: 7.609474, -6.335252, -1.062786
position: 7.640673, -6.375998, -1.084897
position: 7.669506, -6.422812, -1.113030
position: 7.701718, -6.465677, -1.137228
position: 7.736465, -6.511086, -1.161741
position: 7.773732, -6.557382, -1.183568
position: 7.820759, -6.609311, -1.202412
position: 7.873153, -6.653806, -1.209023
position: 7.928893, -6.697901, -1.212409
position: 7.984278, -6.736070, -1.215513
position: 8.044917, -6.773164, -1.227372
position: 8.105164, -6.805810, -1.237231
position: 8.171003, -6.840199, -1.256990
position: 8.237015, -6.871693, -1.269973
position: 8.306678, -6.901447, -1.279187
position: 8.379681, -6.923880, -1.282971
position: 8.451347, -6.934414, -1.279473
position: 8.511691, -6.934730, -1.268030
position: 8.560019, -6.925170, -1.248754
position: 8.600717, -6.909003, -1.229550
position: 8.631884, -6.883680, -1.219676
position: 8.645032, -6.844033, -1.213796
position: 8.642505, -6.793780, -1.204660
position: 8.627343, -6.735936, -1.188157
position: 8.592522, -6.669710, -1.165903
position: 8.542331, -6.596367, -1.145347
position: 8.475068, -6.514352, -1.126703
position: 8.384224, -6.424163, -1.099949
position: 8.267447, -6.326725, -1.063068
position: 8.126938, -6.224789, -1.020376
position: 7.966426, -6.118641, -0.977958
position: 7.796438, -6.012770, -0.938551
position: 7.625498, -5.908596, -0.906022
position: 7.456306, -5.808888, -0.880862
position: 7.291463, -5.716251, -0.861145
position: 7.132566, -5.634197, -0.845094
position: 6.980981, -5.565943, -0.826146
position: 6.839373, -5.513805, -0.797510
position: 6.711386, -5.477059, -0.759131
position: 6.599966, -5.454642, -0.715257
position: 6.505442, -5.445935, -0.673501
position: 6.428420, -5.446927, -0.639729
position: 6.369121, -5.452888, -0.619190
position: 6.324182, -5.463381, -0.617962
position: 6.286266, -5.472681, -0.637064
position: 6.249668, -5.476741, -0.662461
position: 6.215250, -5.477792, -0.684896
position: 6.190105, -5.479808, -0.696325
position: 6.170058, -5.481963, -0.701303
position: 6.156120, -5.485992, -0.699201
position: 6.148369, -5.493419, -0.691417
position: 6.147254, -5.506918, -0.682715
position: 6.153509, -5.526173, -0.679656
position: 6.175316, -5.554899, -0.679065
position: 6.201204, -5.578285, -0.684476
position: 6.231429, -5.597346, -0.687922
position: 6.268816, -5.618970, -0.688443
position: 6.313985, -5.641258, -0.690351
position: 6.362934, -5.662682, -0.694210
position: 6.415406, -5.681927, -0.705029
position: 6.470160, -5.698541, -0.722644
position: 6.528249, -5.714873, -0.747915
position: 6.586125, -5.733371, -0.777228
position: 6.640105, -5.752658, -0.810008
position: 6.689589, -5.772429, -0.848956
position: 6.734560, -5.792889, -0.886818
position: 6.775215, -5.816812, -0.918411
position: 6.816180, -5.848598, -0.939721
position: 6.859949, -5.889807, -0.951683
position: 6.912697, -5.941229, -0.956434
position: 6.973585, -5.998683, -0.953338
position: 7.047635, -6.059066, -0.954018
position: 7.127255, -6.119108, -0.959181
position: 7.211219, -6.175454, -0.969483
position: 7.299098, -6.226299, -0.984136
position: 7.389353, -6.270122, -1.004658
position: 7.478877, -6.309358, -1.031674
position: 7.564698, -6.347497, -1.061582
position: 7.645786, -6.386760, -1.092993
position: 7.722239, -6.423662, -1.124562
position: 7.799019, -6.458030, -1.156432
position: 7.878812, -6.486249, -1.183536
position: 7.961095, -6.505840, -1.204953
position: 8.048755, -6.521252, -1.217754
position: 8.137898, -6.533894, -1.221982
position: 8.226703, -6.546413, -1.219180
position: 8.310093, -6.559149, -1.214486
position: 8.389841, -6.572369, -1.220975
position: 8.468611, -6.586063, -1.240529
position: 8.554074, -6.603242, -1.272791
position: 8.633815, -6.611561, -1.295800
position: 8.716948, -6.620294, -1.315609
position: 8.790952, -6.618553, -1.321539
position: 8.855616, -6.611823, -1.320942
position: 8.912442, -6.602004, -1.315017
position: 8.959584, -6.590251, -1.306211
position: 9.001781, -6.581898, -1.294398
position: 9.040435, -6.579102, -1.282639
position: 9.074782, -6.582486, -1.274463
position: 9.110534, -6.590024, -1.271858
position: 9.144942, -6.597852, -1.267963
position: 9.179944, -6.605069, -1.259561
position: 9.215206, -6.612088, -1.245072
position: 9.247976, -6.618564, -1.227326
position: 9.282503, -6.625377, -1.214613
position: 9.315748, -6.630176, -1.210006
position: 9.347024, -6.629877, -1.213051
position: 9.377289, -6.621626, -1.221067
position: 9.403372, -6.606162, -1.232437
position: 9.427837, -6.585864, -1.243567
position: 9.448184, -6.563786, -1.249404
position: 9.464479, -6.542365, -1.247213
position: 9.476798, -6.522857, -1.237600
position: 9.485966, -6.506023, -1.221024
position: 9.490272, -6.494817, -1.197507
position: 9.494096, -6.486450, -1.164197
position: 9.498941, -6.477134, -1.123839
position: 9.500575, -6.466295, -1.079395
position: 9.493787, -6.455247, -1.035472
position: 9.478647, -6.440269, -0.998419
position: 9.454335, -6.426386, -0.968365
position: 9.422010, -6.403708, -0.946102
position: 9.380206, -6.378174, -0.929264
position: 9.330804, -6.339456, -0.919445
position: 9.273435, -6.299682, -0.913538
position: 9.210873, -6.255901, -0.909395
position: 9.145983, -6.204599, -0.912211
position: 9.083974, -6.154479, -0.921327
position: 9.026702, -6.105661, -0.933069
position: 8.975361, -6.057053, -0.943620
position: 8.926378, -6.006812, -0.949941
position: 8.876189, -5.955439, -0.949167
position: 8.824962, -5.902712, -0.943356
position: 8.771618, -5.849890, -0.939186
position: 8.717894, -5.797339, -0.940166
position: 8.662926, -5.744901, -0.942591
position: 8.605345, -5.691837, -0.941530
position: 8.546270, -5.638879, -0.932553
position: 8.484327, -5.588293, -0.915291
position: 8.420556, -5.539869, -0.899065
position: 8.357887, -5.490635, -0.890747
position: 8.296742, -5.442183, -0.883896
position: 8.239195, -5.392546, -0.880033
position: 8.181903, -5.342451, -0.882818
position: 8.123182, -5.292017, -0.883568
position: 8.064166, -5.243490, -0.879628
position: 8.002379, -5.195160, -0.870514
position: 7.937450, -5.146944, -0.857953
position: 7.868821, -5.098564, -0.851767
position: 7.799470, -5.049899, -0.850498
position: 7.727426, -5.002334, -0.855310
position: 7.655454, -4.956217, -0.863820
position: 7.584373, -4.912734, -0.876186
position: 7.512126, -4.871307, -0.892566
position: 7.442355, -4.827212, -0.908322
position: 7.372939, -4.785584, -0.918642
position: 7.306932, -4.743995, -0.921276
position: 7.240696, -4.701865, -0.913533
position: 7.176081, -4.656327, -0.898542
position: 7.105369, -4.615755, -0.878117
position: 7.029893, -4.574447, -0.859093
position: 6.956112, -4.535348, -0.846069
position: 6.882502, -4.499850, -0.838717
position: 6.818423, -4.465856, -0.836347
position: 6.746499, -4.438843, -0.841409
position: 6.680487, -4.413498, -0.852048
position: 6.610106, -4.399027, -0.867336
position: 6.542448, -4.381643, -0.877167
position: 6.471380, -4.370218, -0.880860
position: 6.398592, -4.354649, -0.876450
position: 6.323628, -4.336658, -0.869701
position: 6.249644, -4.315701, -0.861179
position: 6.173034, -4.291617, -0.861822
position: 6.098580, -4.268492, -0.864885
position: 6.020847, -4.244290, -0.875671
position: 5.947272, -4.220055, -0.888074
position: 5.870271, -4.196823, -0.906172
position: 5.791876, -4.171589, -0.920688
position: 5.717292, -4.146676, -0.928311
position: 5.645834, -4.121678, -0.929310
position: 5.572589, -4.095412, -0.923476
position: 5.505204, -4.069758, -0.915714
position: 5.437550, -4.042618, -0.913053
position: 5.368203, -4.016960, -0.918057
position: 5.306617, -3.991292, -0.925154
position: 5.241563, -3.963124, -0.930068
position: 5.184676, -3.937394, -0.927184
position: 5.121991, -3.911623, -0.917519
position: 5.067006, -3.887685, -0.902866
position: 5.007654, -3.864244, -0.892019
position: 4.952787, -3.842019, -0.886167
position: 4.896367, -3.821523, -0.888319
position: 4.844803, -3.803162, -0.895389
position: 4.790748, -3.788532, -0.914376
position: 4.739401, -3.775180, -0.935122
position: 4.688679, -3.762750, -0.964906
position: 4.640296, -3.752699, -0.996298
position: 4.597093, -3.743913, -1.033478
position: 4.550598, -3.735132, -1.064537
position: 4.508643, -3.726989, -1.091126
position: 4.456193, -3.716318, -1.109701
position: 4.407042, -3.704779, -1.131643
position: 4.356218, -3.693992, -1.157232
position: 4.305506, -3.683433, -1.187457
position: 4.252949, -3.670282, -1.218718
position: 4.203256, -3.654531, -1.248149
position: 4.149633, -3.635249, -1.270530
position: 4.095075, -3.613429, -1.283500
position: 4.042549, -3.590131, -1.288480
position: 3.987905, -3.565458, -1.286291
position: 3.936617, -3.538844, -1.276667
position: 3.885547, -3.509710, -1.260554
position: 3.838610, -3.481044, -1.236397
position: 3.795158, -3.453279, -1.207555
position: 3.758053, -3.424585, -1.182584
position: 3.729147, -3.394622, -1.161342
position: 3.709246, -3.364072, -1.143249
position: 3.699439, -3.334290, -1.129577
position: 3.697546, -3.305265, -1.120685
position: 3.697581, -3.278227, -1.106907
position: 3.705943, -3.249238, -1.087128
position: 3.725753, -3.212401, -1.070491
position: 3.745225, -3.180370, -1.051380
position: 3.773797, -3.142750, -1.042043
position: 3.806663, -3.109684, -1.039373
position: 3.846026, -3.082549, -1.050683
position: 3.892676, -3.064820, -1.066275
position: 3.946826, -3.060160, -1.075731
position: 4.002802, -3.073063, -1.077080
position: 4.059254, -3.103327, -1.069919
position: 4.107968, -3.151648, -1.056429
position: 4.150744, -3.209437, -1.038023
position: 4.190427, -3.272833, -1.011473
position: 4.230405, -3.339400, -0.977265
position: 4.268573, -3.408451, -0.943972
position: 4.303591, -3.477760, -0.918590
position: 4.337859, -3.547282, -0.901246
position: 4.373069, -3.616018, -0.886999
position: 4.408328, -3.685205, -0.870556
position: 4.440112, -3.754000, -0.846767
position: 4.463729, -3.823968, -0.812640
position: 4.485179, -3.893604, -0.771949
position: 4.506276, -3.962092, -0.725363
position: 4.524466, -4.028560, -0.672698
position: 4.538875, -4.093128, -0.620120
position: 4.553044, -4.155663, -0.574064
position: 4.562012, -4.207843, -0.529970
position: 4.567248, -4.251116, -0.489488
position: 4.572709, -4.289043, -0.456331
position: 4.575587, -4.319224, -0.428555
position: 4.579037, -4.347386, -0.408497
position: 4.584413, -4.371484, -0.391944
position: 4.592216, -4.390017, -0.377250
position: 4.605681, -4.403625, -0.366934
position: 4.624945, -4.411271, -0.353093
position: 4.651292, -4.412181, -0.345669
position: 4.682130, -4.407880, -0.341192
position: 4.713132, -4.402760, -0.337463
position: 4.742987, -4.397333, -0.337522
position: 4.770591, -4.395682, -0.331858
position: 4.798145, -4.394833, -0.321106
position: 4.823524, -4.394761, -0.308048
position: 4.849884, -4.393865, -0.299533
position: 4.875389, -4.392078, -0.296986
position: 4.897769, -4.390129, -0.297320
position: 4.921784, -4.388266, -0.305288
position: 4.946658, -4.387067, -0.317479
position: 4.968684, -4.389541, -0.329447
position: 4.995328, -4.393636, -0.339143
position: 5.023289, -4.398271, -0.341472
position: 5.051886, -4.403720, -0.335688
position: 5.079736, -4.410322, -0.324738
position: 5.106816, -4.414858, -0.313787
position: 5.130528, -4.420699, -0.308358
position: 5.152363, -4.422719, -0.307163
position: 5.170160, -4.427547, -0.311466
position: 5.187284, -4.431874, -0.319758
position: 5.205116, -4.432182, -0.331018
position: 5.218495, -4.435940, -0.345830
position: 5.238895, -4.434487, -0.360209
position: 5.254297, -4.430033, -0.376871
position: 5.270483, -4.423068, -0.388601
position: 5.283300, -4.418029, -0.396527
position: 5.289611, -4.416471, -0.399422
position: 5.291135, -4.418285, -0.399230
position: 5.291294, -4.421867, -0.403331
position: 5.289228, -4.426185, -0.412213
position: 5.285095, -4.429765, -0.423845
position: 5.275146, -4.431395, -0.430761
position: 5.270021, -4.420179, -0.429125
position: 5.242447, -4.408718, -0.418861
position: 5.215269, -4.387372, -0.399619
position: 5.181669, -4.368627, -0.371476
position: 5.152048, -4.344153, -0.339324
position: 5.120797, -4.322185, -0.317265
position: 5.088762, -4.298402, -0.300700
position: 5.060064, -4.267758, -0.285613
position: 5.029670, -4.236335, -0.279496
position: 4.998387, -4.202491, -0.278547
position: 4.967263, -4.167989, -0.283075
position: 4.934463, -4.134917, -0.292692
position: 4.904751, -4.100521, -0.306701
position: 4.877210, -4.067111, -0.321937
position: 4.851149, -4.033729, -0.339591
position: 4.824904, -3.996811, -0.363606
position: 4.799594, -3.959291, -0.391103
position: 4.775708, -3.920567, -0.415641
position: 4.753026, -3.880965, -0.433581
position: 4.731583, -3.841109, -0.443294
position: 4.711143, -3.803263, -0.446272
position: 4.695640, -3.768498, -0.443011
position: 4.683821, -3.739886, -0.435157
position: 4.674620, -3.717127, -0.428343
position: 4.666195, -3.700575, -0.427375
position: 4.657467, -3.690877, -0.430807
position: 4.649184, -3.686072, -0.438764
position: 4.639568, -3.686467, -0.446969
position: 4.629006, -3.690293, -0.459071
position: 4.615686, -3.696529, -0.475387
position: 4.606007, -3.703444, -0.496422
position: 4.589994, -3.717296, -0.525134
position: 4.578179, -3.731956, -0.558499
position: 4.562313, -3.752108, -0.596917
position: 4.544459, -3.774767, -0.636484
position: 4.525671, -3.798327, -0.674457
position: 4.505497, -3.820562, -0.706318
position: 4.483337, -3.842304, -0.730015
position: 4.462194, -3.863610, -0.747190
position: 4.443502, -3.886484, -0.756389
position: 4.428127, -3.912306, -0.756271
position: 4.416036, -3.939413, -0.749382
position: 4.403369, -3.969910, -0.743665
position: 4.396009, -4.000224, -0.733744
position: 4.389536, -4.031083, -0.726191
position: 4.380284, -4.063035, -0.723879
position: 4.374476, -4.092783, -0.722842
position: 4.368356, -4.123490, -0.727644
position: 4.359168, -4.156354, -0.739257
position: 4.350123, -4.190921, -0.754866
position: 4.340678, -4.225802, -0.774895
position: 4.332088, -4.259870, -0.799855
position: 4.325623, -4.293838, -0.828629
position: 4.322475, -4.326824, -0.861945
position: 4.323084, -4.358786, -0.900417
position: 4.328522, -4.388325, -0.943093
position: 4.339554, -4.419689, -0.989217
position: 4.351522, -4.451961, -1.030948
position: 4.371967, -4.482646, -1.067809
position: 4.391714, -4.516822, -1.093867
position: 4.412217, -4.553025, -1.112462
position: 4.431758, -4.588227, -1.126895
position: 4.444959, -4.626306, -1.133998
position: 4.456070, -4.667043, -1.135535
position: 4.465812, -4.708022, -1.132060
position: 4.472813, -4.746851, -1.132293
position: 4.483374, -4.784662, -1.132691
position: 4.493286, -4.821981, -1.137372
position: 4.501699, -4.858620, -1.145816
position: 4.506108, -4.895352, -1.162762
position: 4.512343, -4.931814, -1.180782
position: 4.520053, -4.970687, -1.196275
position: 4.528834, -5.012411, -1.206004
position: 4.540761, -5.052311, -1.205123
position: 4.558522, -5.097542, -1.206080
position: 4.577521, -5.140105, -1.209307
position: 4.605012, -5.188964, -1.223009
position: 4.634280, -5.235099, -1.236522
position: 4.675572, -5.290552, -1.257607
position: 4.721913, -5.343967, -1.275342
position: 4.780467, -5.402378, -1.293311
position: 4.842255, -5.458539, -1.305452
position: 4.905672, -5.513222, -1.312929
position: 4.971256, -5.563800, -1.322999
position: 5.038955, -5.614409, -1.336507
position: 5.111851, -5.665769, -1.356013
position: 5.187243, -5.718231, -1.372657
position: 5.264713, -5.771382, -1.383981
position: 5.338529, -5.823106, -1.386132
position: 5.409096, -5.878838, -1.384149
position: 5.475760, -5.936563, -1.388292
position: 5.538939, -5.993350, -1.400959
position: 5.600757, -6.047488, -1.418869
position: 5.661627, -6.099880, -1.433517
position: 5.725346, -6.149601, -1.439975
position: 5.789264, -6.198209, -1.442085
position: 5.860139, -6.246575, -1.435985
position: 5.931811, -6.294301, -1.432474
position: 6.012135, -6.342753, -1.421104
position: 6.093583, -6.389963, -1.410647
position: 6.175214, -6.437074, -1.404650
position: 6.261677, -6.482561, -1.386810
position: 6.353271, -6.528841, -1.366463
position: 6.447993, -6.570834, -1.333071
position: 6.545631, -6.613522, -1.306492
position: 6.642786, -6.655725, -1.285014
position: 6.741970, -6.700375, -1.278367
position: 6.839448, -6.744615, -1.278797
position: 6.936072, -6.791103, -1.292419
position: 7.026873, -6.835354, -1.309516
position: 7.120147, -6.880340, -1.331615
position: 7.204773, -6.922262, -1.356967
position: 7.285104, -6.966201, -1.378513
position: 7.360835, -7.016116, -1.391888
position: 7.431369, -7.070226, -1.400580
position: 7.505273, -7.127475, -1.412199
position: 7.565444, -7.177226, -1.430536
position: 7.630644, -7.225288, -1.447951
position: 7.690561, -7.266339, -1.459275
position: 7.755174, -7.303993, -1.462189
position: 7.815929, -7.333424, -1.461433
position: 7.879824, -7.357637, -1.454657
position: 7.942258, -7.377180, -1.453764
position: 8.005882, -7.391973, -1.460835
position: 8.072615, -7.404756, -1.475231
position: 8.140690, -7.412488, -1.489711
position: 8.215813, -7.418855, -1.504798
position: 8.288644, -7.418216, -1.511029
position: 8.372023, -7.419141, -1.514706
position: 8.446328, -7.409073, -1.515978
position: 8.529527, -7.402720, -1.528322
position: 8.605571, -7.384460, -1.546461
position: 8.688228, -7.371113, -1.568941
position: 8.769748, -7.355910, -1.593314
position: 8.844537, -7.340506, -1.619643
position: 8.914312, -7.326571, -1.647666
position: 8.976220, -7.314451, -1.670043
position: 9.033224, -7.303752, -1.687112
position: 9.086883, -7.292060, -1.699569
position: 9.137489, -7.277751, -1.708349
position: 9.187199, -7.258308, -1.717200
position: 9.235125, -7.233392, -1.724212
position: 9.281599, -7.204890, -1.724186
position: 9.323708, -7.173409, -1.720666
position: 9.362638, -7.137070, -1.714751
position: 9.397054, -7.095250, -1.707247
position: 9.424420, -7.047378, -1.698993
position: 9.445564, -6.995846, -1.686582
position: 9.460235, -6.943410, -1.668780
position: 9.466267, -6.895462, -1.641657
position: 9.467837, -6.849773, -1.612189
position: 9.472711, -6.799775, -1.581688
position: 9.462924, -6.751934, -1.546336
position: 9.453267, -6.700260, -1.507882
position: 9.441647, -6.643512, -1.472267
position: 9.423554, -6.583621, -1optimize pose graph 
.443744
position: 9.398349, -6.522250, -1.422195
position: 9.366953, -6.459451, -1.405167
position: 9.331442, -6.394643, -1.389879
position: 9.290362, -6.326107, -1.368644
position: 9.247854, -6.256984, -1.338631
position: 9.201380, -6.188046, -1.301251
position: 9.154733, -6.119851, -1.257851
position: 9.105641, -6.052801, -1.211670
position: 9.053120, -5.987538, -1.169787
position: 9.000945, -5.926744, -1.133875
position: 8.945353, -5.868798, -1.104449
position: 8.890123, -5.818376, -1.079879
position: 8.831411, -5.769693, -1.061591
position: 8.774010, -5.726876, -1.049181
position: 8.715021, -5.682169, -1.038456
position: 8.659809, -5.646508, -1.036557
position: 8.598595, -5.607925, -1.035232
position: 8.538939, -5.573262, -1.037873
position: 8.488019, -5.547781, -1.047399
position: 8.440369, -5.526116, -1.052085
position: 8.392707, -5.504304, -1.047052
position: 8.347129, -5.483843, -1.034793
position: 8.304140, -5.463809, -1.016021
position: 8.263291, -5.443868, -0.993415
position: 8.227111, -5.424231, -0.970342
position: 8.194435, -5.404255, -0.950847
position: 8.170545, -5.386720, -0.937874
position: 8.150273, -5.370876, -0.932717
position: 8.129521, -5.358928, -0.932683
position: 8.109462, -5.350968, -0.933257
position: 8.087226, -5.344174, -0.933782
position: 8.061753, -5.339228, -0.924864
position: 8.030219, -5.334743, -0.915241
position: 7.995651, -5.330445, -0.899996
position: 7.952607, -5.325693, -0.881108
position: 7.907801, -5.322179, -0.867775
position: 7.866707, -5.319941, -0.862484
position: 7.823947, -5.318736, -0.860729
position: 7.785109, -5.316777, -0.869964
position: 7.742711, -5.314040, -0.879628
position: 7.700357, -5.311035, -0.892464
position: 7.660020, -5.309649, -0.905599
position: 7.615693, -5.308076, -0.910163
position: 7.569902, -5.306293, -0.907812
position: 7.523537, -5.305486, -0.902411
position: 7.470285, -5.305537, -0.896961
position: 7.412826, -5.304636, -0.893148
position: 7.357821, -5.298933, -0.894252
position: 7.309066, -5.286669, -0.898438
position: 7.250998, -5.272333, -0.909972
position: 7.197337, -5.252399, -0.920450
position: 7.140977, -5.227261, -0.925968
position: 7.079313, -5.196904, -0.923145
position: 7.015390, -5.159870, -0.916300
position: 6.949707, -5.120207, -0.913780
position: 6.880666, -5.079003, -0.919576
position: 6.813775, -5.035804, -0.931442
position: 6.750731, -4.992204, -0.948230
position: 6.689784, -4.949074, -0.968049
position: 6.629460, -4.908620, -0.991429
position: 6.571409, -4.873549, -1.017129
position: 6.521853, -4.843817, -1.037699
position: 6.476762, -4.816141, -1.049823
position: 6.429131, -4.783735, -1.051269
position: 6.383536, -4.756126, -1.052737
position: 6.333445, -4.725278, -1.055721
position: 6.282445, -4.699430, -1.072003
position: 6.231460, -4.674605, -1.087458
position: 6.177226, -4.653651, -1.106641
position: 6.122327, -4.633561, -1.112320
position: 6.067358, -4.614655, -1.113510
position: 6.012620, -4.597362, -1.107499
position: 5.958564, -4.582545, -1.109771
position: 5.907278, -4.567726, -1.114354
position: 5.860071, -4.554443, -1.124411
position: 5.814435, -4.543033, -1.143725
position: 5.772315, -4.532757, -1.159017
position: 5.733532, -4.527738, -1.174639
position: 5.694771, -4.521395, -1.179424
position: 5.657406, -4.518849, -1.180015
position: 5.623751, -4.514786, -1.174925
position: 5.592425, -4.512839, -1.173816
position: 5.562747, -4.512044, -1.178160
position: 5.537381, -4.517984, -1.189508
position: 5.509034, -4.523902, -1.198248
position: 5.479384, -4.531634, -1.199630
position: 5.448203, -4.541019, -1.194500
position: 5.419040, -4.552825, -1.187801
position: 5.389168, -4.565019, -1.185947
position: 5.357905, -4.576387, -1.190218
position: 5.326167, -4.587341, -1.200529
position: 5.295145, -4.598114, -1.214046
position: 5.262889, -4.608369, -1.225827
position: 5.229290, -4.616748, -1.228670
position: 5.194223, -4.623945, -1.224368
position: 5.156607, -4.631133, -1.221520
position: 5.120618, -4.637807, -1.221963
position: 5.084603, -4.643685, -1.227132
position: 5.048464, -4.648890, -1.236015
position: 5.012218, -4.654176, -1.245058
position: 4.974638, -4.656969, -1.251010
position: 4.937078, -4.658253, -1.249710
position: 4.897182, -4.658552, -1.242324
position: 4.859938, -4.658263, -1.233104
position: 4.822579, -4.658077, -1.228626
position: 4.785151, -4.657708, -1.229074
position: 4.756200, -4.654965, -1.225879
position: 4.718048, -4.652776, -1.230213
position: 4.690203, -4.645719, -1.217720
position: 4.659376, -4.638765, -1.204683
position: 4.625322, -4.631413, -1.193442
position: 4.590296, -4.624621, -1.186884
position: 4.553909, -4.617956, -1.187419
position: 4.519502, -4.612859, -1.192742
position: 4.484507, -4.609470, -1.201149
position: 4.450880, -4.606995, -1.211088
position: 4.417932, -4.604196, -1.216867
position: 4.387126, -4.600364, -1.216833
position: 4.358667, -4.595177, -1.210265
position: 4.331084, -4.587916, -1.194856
position: 4.304270, -4.578029, -1.173355
position: 4.278690, -4.567941, -1.143256
position: 4.253610, -4.557056, -1.107137
position: 4.228176, -4.548365, -1.066057
position: 4.203418, -4.541825, -1.026299
position: 4.177729, -4.538742, -0.991689
position: 4.156664, -4.534943, -0.963962
position: 4.137552, -4.532187, -0.942581
position: 4.120816, -4.529722, -0.927067
position: 4.105600, -4.527342, -0.917446
position: 4.087095, -4.524339, -0.912145
position: 4.072178, -4.521452, -0.912540
position: 4.057141, -4.519125, -0.916184
position: 4.041723, -4.516870, -0.923353
position: 4.026118, -4.513940, -0.933337
position: 4.011417, -4.510500, -0.940222
position: 3.998479, -4.507495, -0.939181
position: 3.986855, -4.504518, -0.931388
position: 3.949556, -4.495061, -0.897569
position: 3.940587, -4.499085, -0.877920
position: 3.912835, -4.502869, -0.845306
position: 3.898585, -4.511744, -0.816704
position: 3.882115, -4.521208, -0.780508
position: 3.848275, -4.526952, -0.743992
position: 3.830843, -4.535119, -0.717846
position: 3.812889, -4.540654, -0.696939
position: 3.773105, -4.540895, -0.677135
position: 3.752110, -4.540119, -0.658953
position: 3.729290, -4.537273, -0.636121
position: 3.705935, -4.531974, -0.606800
position: 3.682081, -4.523837, -0.570537
position: 3.658582, -4.513744, -0.534422
position: 3.604891, -4.497488, -0.502030
position: 3.576074, -4.481266, -0.478524
position: 3.546672, -4.462272, -0.459875
position: 3.515500, -4.441298, -0.447259
position: 3.456994, -4.416874, -0.432133
position: 3.424454, -4.396836, -0.428845
position: 3.388474, -4.378506, -0.426693
position: 3.333469, -4.358781, -0.417832
position: 3.297473, -4.341642, -0.409410
position: 3.246654, -4.322217, -0.395090
position: 3.191137, -4.299450, -0.382768
position: 3.134015, -4.276225, -0.374778
position: 3.081405, -4.255017, -0.373105
position: 3.028735, -4.233513, -0.373933
position: 2.979790, -4.210805, -0.376760
position: 2.923758, -4.187876, -0.373410
position: 2.865772, -4.161524, -0.361457
position: 2.807532, -4.137931, -0.347208
position: 2.748200, -4.113754, -0.334561
position: 2.690647, -4.085566, -0.328306
position: 2.631450, -4.060818, -0.326290
position: 2.576520, -4.031578, -0.326730
position: 2.519909, -4.004994, -0.334054
position: 2.469928, -3.976433, -0.343555
position: 2.416539, -3.950047, -0.354124
position: 2.371582, -3.923252, -0.358003
position: 2.326588, -3.896381, -0.352685
position: 2.295534, -3.868658, -0.336190
position: 2.261804, -3.839677, -0.313417
position: 2.235526, -3.812385, -0.291828
position: 2.213487, -3.785948, -0.273190
position: 2.198309, -3.765960, -0.260631
position: 2.181044, -3.748579, -0.252282
position: 2.168996, -3.739704, -0.249597
position: 2.152915, -3.729517, -0.251423
position: 2.140663, -3.725545, -0.259679
position: 2.126888, -3.722178, -0.269290
position: 2.114825, -3.724435, -0.284063
position: 2.103709, -3.729885, -0.303339
position: 2.095338, -3.736981, -0.325676
position: 2.085465, -3.744626, -0.350225
position: 2.073137, -3.751494, -0.379165
position: 2.070142, -3.763352, -0.411428
position: 2.052986, -3.771773, -0.432851
position: 2.034318, -3.780230, -0.444205
position: 2.010454, -3.786834, -0.448672
position: 1.984519, -3.787406, -0.449731
position: 1.950119, -3.782428, -0.443289
position: 1.907670, -3.773534, -0.430066
position: 1.860219, -3.762942, -0.422120
position: 1.812381, -3.751509, -0.419686
position: 1.757305, -3.737075, -0.413682
position: 1.707746, -3.719628, -0.398919
position: 1.648133, -3.700941, -0.379759
position: 1.589752, -3.680551, -0.354303
position: 1.539296, -3.658157, -0.327429
position: 1.481221, -3.635821, -0.305467
position: 1.434700, -3.613255, -0.288886
position: 1.378872, -3.589781, -0.279629
position: 1.324266, -3.565807, -0.274242
position: 1.274117, -3.541039, -0.270127
position: 1.220232, -3.514289, -0.268028
position: 1.169165, -3.486277, -0.260003
position: 1.113193, -3.456982, -0.246444
position: 1.058035, -3.428921, -0.225097
position: 1.008287, -3.402799, -0.201545
position: 0.954915, -3.374000, -0.187050
position: 0.905398, -3.349187, -0.173861
position: 0.855759, -3.320668, -0.171867
position: 0.808316, -3.293248, -0.173868
position: 0.761084, -3.268709, -0.177186
position: 0.719035, -3.240977, -0.182950
position: 0.680327, -3.214219, -0.182625
position: 0.649007, -3.191627, -0.171745
position: 0.617042, -3.164956, -0.148044
position: 0.586057, -3.139654, -0.118354
position: 0.556307, -3.114332, -0.084747
position: 0.528230, -3.090253, -0.056149
position: 0.500152, -3.070391, -0.036616
position: 0.474272, -3.047518, -0.017633
position: 0.450685, -3.025261, 0.000859
position: 0.426540, -3.002714, 0.026198
position: 0.394620, -2.980072, 0.047743
position: 0.369052, -2.957142, 0.069645
position: 0.345868, -2.935335, 0.088066
position: 0.319510, -2.912966, 0.099982
position: 0.295353, -2.890646, 0.108718
position: 0.267057, -2.867122, 0.108831
position: 0.238948, -2.839084, 0.109292
position: 0.209209, -2.808454, 0.106565
position: 0.175447, -2.777551, 0.098774
position: 0.140874, -2.742423, 0.090186
position: 0.101859, -2.705807, 0.077980
position: 0.063843, -2.671376, 0.064486
position: 0.027336, -2.633798, 0.057768
position: -0.011132, -2.599538, 0.059399
position: -0.041643, -2.561659, 0.068501
position: -0.080447, -2.531702, 0.0829optimize pose graph 
14
position: -0.106584, -2.497821, 0.106575
position: -0.137287, -2.477045, 0.133850
position: -0.150926, -2.456897, 0.177870
position: -0.174563, -2.444049, 0.214075
position: -0.195251, -2.432036, 0.245015
position: -0.181365, -2.426844, 0.279386
position: -0.199239, -2.416850, 0.298177
position: -0.212153, -2.408735, 0.310960
position: -0.221629, -2.403881, 0.317242
position: -0.162739, -2.413088, 0.326529
position: -0.119494, -2.422562, 0.322457
position: -0.091570, -2.429910, 0.307127
position: -0.069510, -2.443049, 0.286354
position: -0.050380, -2.461668, 0.261081
position: -0.034356, -2.483342, 0.232098
position: -0.020580, -2.505820, 0.200561
position: -0.008332, -2.530469, 0.174106
position: 0.003451, -2.554072, 0.161380
position: 0.015975, -2.575040, 0.155575
position: 0.028669, -2.594873, 0.152321
position: 0.041364, -2.615016, 0.143917
position: 0.053218, -2.636414, 0.130659
position: 0.063952, -2.658159, 0.112499
position: 0.070066, -2.680291, 0.090271
position: 0.081108, -2.701005, 0.064773
position: 0.091379, -2.718690, 0.036495
position: 0.086809, -2.734002, 0.001091
position: 0.094404, -2.749029, -0.030874
position: 0.098523, -2.763767, -0.057038
position: 0.100918, -2.779175, -0.077300
position: 0.078003, -2.793132, -0.096000
position: 0.075892, -2.808563, -0.120464
position: 0.071896, -2.822576, -0.151189
position: 0.065070, -2.832131, -0.189467
position: 0.037897, -2.834761, -0.232333
position: 0.029244, -2.842461, -0.281022
position: 0.011080, -2.846666, -0.326706
position: -0.005847, -2.853757, -0.366476
position: -0.019637, -2.862843, -0.399487
position: -0.027807, -2.873727, -0.423742
position: -0.033439, -2.884082, -0.442530
position: -0.037377, -2.894884, -0.467956
position: -0.039409, -2.904310, -0.499711
position: -0.033581, -2.914552, -0.534175
position: -0.029911, -2.920280, -0.555613
position: -0.015184, -2.931998, -0.579071
position: -0.004114, -2.939074, -0.584572
position: 0.018992, -2.948609, -0.593921
position: 0.033367, -2.956008, -0.597602
position: 0.051983, -2.968837, -0.611636
position: 0.064645, -2.977603, -0.632138
position: 0.074773, -2.985909, -0.658655
position: 0.081605, -2.996194, -0.691249
position: 0.090818, -3.005938, -0.732620
position: 0.100451, -3.018025, -0.762247
position: 0.115801, -3.032371, -0.783759
position: 0.139886, -3.050637, -0.796543
position: 0.170233, -3.071416, -0.810634
position: 0.205683, -3.094572, -0.830806
position: 0.244112, -3.121514, -0.856804
position: 0.284868, -3.147928, -0.887790
position: 0.326361, -3.172858, -0.925154
position: 0.367275, -3.196187, -0.969659
position: 0.407917, -3.220096, -1.019084
position: 0.446013, -3.240602, -1.074388
position: 0.486625, -3.262825, -1.137803
position: 0.522447, -3.281098, -1.204395
position: 0.557958, -3.303168, -1.277387
position: 0.586783, -3.324349, -1.352315
position: 0.609780, -3.347839, -1.429545
position: 0.628402, -3.375936, -1.503776
position: 0.640055, -3.397774, -1.567983
position: 0.650833, -3.422490, -1.623542
position: 0.661970, -3.445849, -1.671102
position: 0.674391, -3.469859, -1.712974
position: 0.687786, -3.494324, -1.748624
position: 0.701273, -3.516708, -1.773220
position: 0.713581, -3.537498, -1.790594
position: 0.721804, -3.557856, -1.799629
position: 0.731450, -3.574000, -1.803758
position: 0.740986, -3.588431, -1.799704
position: 0.752578, -3.601310, -1.788252
position: 0.760003, -3.607347, -1.772390
position: 0.770763, -3.610743, -1.747246
position: 0.778243, -3.605233, -1.718935
position: 0.790217, -3.594430, -1.688808
position: 0.798862, -3.577932, -1.668816
position: 0.804668, -3.556186, -1.660119
position: 0.805988, -3.528658, -1.658356
position: 0.815087, -3.505871, -1.661628
position: 0.827195, -3.485886, -1.665364
position: 0.841867, -3.471016, -1.668054
position: 0.857019, -3.460748, -1.661609
position: 0.875533, -3.453691, -1.645967
position: 0.899766, -3.446912, -1.621907
position: 0.924274, -3.437876, -1.589063
position: 0.953788, -3.429191, -1.556729
position: 0.979240, -3.411819, -1.533251
position: 1.010802, -3.399222, -1.508346
position: 1.042326, -3.383246, -1.478045
position: 1.076304, -3.365347, -1.438246
position: 1.112929, -3.347601, -1.390668
position: 1.133612, -3.314571, -1.350710
position: 1.156043, -3.293583, -1.314327
position: 1.185546, -3.283287, -1.282968
position: 1.207123, -3.272381, -1.258328
position: 1.236044, -3.266436, -1.234367
position: 1.258283, -3.257857, -1.208782
position: 1.285335, -3.249967, -1.173960
position: 1.310336, -3.243147, -1.138936
position: 1.328595, -3.240334, -1.113996
position: 1.350995, -3.236308, -1.087685
position: 1.367615, -3.242090, -1.070872
position: 1.383278, -3.246402, -1.052077
position: 1.393725, -3.256397, -1.033107
position: 1.401860, -3.274683, -1.012772
position: 1.404816, -3.285687, -0.979088
position: 1.407060, -3.306217, -0.953282
position: 1.408881, -3.315618, -0.919505
position: 1.414108, -3.334462, -0.903004
position: 1.417376, -3.338245, -0.881716
position: 1.424882, -3.349673, -0.873337
position: 1.427746, -3.354891, -0.867923
position: 1.421734, -3.349925, -0.860629
position: 1.412222, -3.345438, -0optimize pose graph 
.851237
position: 1.400074, -3.334513, -0.830600
position: 1.387572, -3.323578, -0.801804
position: 1.374071, -3.309681, -0.759818
position: 1.358342, -3.296282, -0.712657
position: 1.346281, -3.283620, -0.654630
position: 1.327196, -3.266791, -0.594584
position: 1.312634, -3.250642, -0.526098
position: 1.297380, -3.232688, -0.460744
position: 1.273776, -3.206439, -0.406119
position: 1.262449, -3.185080, -0.352925
position: 1.251847, -3.161506, -0.301794
position: 1.244279, -3.137789, -0.251062
position: 1.238378, -3.116123, -0.200996
position: 1.220991, -3.088703, -0.157395
position: 1.206742, -3.068806, -0.116023
position: 1.197137, -3.059420, -0.075265
position: 1.184303, -3.051525, -0.037612
position: 1.180429, -3.052451, 0.001696
position: 1.179401, -3.054331, 0.033271
position: 1.181973, -3.058099, 0.069394
position: 1.188747, -3.063966, 0.098033
position: 1.196195, -3.068636, 0.132829
position: 1.202159, -3.073074, 0.169773
position: 1.206058, -3.076557, 0.204488
position: 1.206115, -3.079695, 0.235773optimize pose graph 

position: 1.205185, -3.082055, 0.258779
position: 1.202441, -3.082770, 0.275895
position: 1.197981, -3.081593, 0.285758
position: 1.192213, -3.076532, 0.289598
position: 1.185630, -3.067927, 0.286764
position: 1.177789, -3.055917, 0.277205
position: 1.169842, -3.040741, 0.269661
position: 1.161458, -3.022927, 0.269180
position: 1.151113, -3.002504, 0.277119
position: 1.140951, -2.980708, 0.285944
position: 1.130942, -2.957401, 0.289731
position: 1.118795, -2.933772, 0.287778
position: 1.105992, -2.908851, 0.287259
position: 1.092580, -2.882550, 0.293299
position: 1.075298, -2.855069, 0.303751
position: 1.061729, -2.820853, 0.319444
position: 1.036217, -2.790214, 0.340874
position: 1.006780, -2.756462, 0.359087
position: 0.973159, -2.719478, 0.369583
position: 0.942945, -2.674832, 0.374221
position: 0.908711, -2.631299, 0.373575
position: 0.872317, -2.589385, 0.368002
position: 0.834115, -2.549654, 0.359489
position: 0.790187, -2.510093, 0.353386
position: 0.740620, -2.469882, 0.352895
position: 0.689069, -2.optimize pose graph 
429024, 0.359402
position: 0.639941, -2.382631, 0.372456
position: 0.589028, -2.339321, 0.388681
position: 0.543564, -2.295536, 0.400469
position: 0.501016, -2.243536, 0.403333
position: 0.459141, -2.189924, 0.401954
position: 0.418561, -2.142736, 0.403050
position: 0.378068, -2.087229, 0.403553
position: 0.339220, -2.035690, 0.416248
position: 0.298653, -1.979214, 0.428702
position: 0.253132, -1.923859, 0.443665
position: 0.209666, -1.865176, 0.449212
position: 0.156181, -1.807630, 0.451499
position: 0.113822, -1.750447, 0.447632
position: 0.056744, -1.695345, 0.447931
position: 0.007627, -1.639748, 0.452604
position: -0.056271, -1.588157, 0.464714
position: -0.110917, -1.535049, 0.478135
position: -0.182034, -1.484389, 0.488863
position: -0.241097, -1.433145, 0.491775
position: -0.317896, -1.386968, 0.490986
position: -0.379808, -1.335902, 0.483542
position: -0.454712, -1.286514, 0.480865
position: -0.518626, -1.232998, 0.482887
position: -0.592549, -1.177062, 0.492501
position: -0.657884, -1.119151, 0.512868
position: -0.717754, -1.060779, 0.544565
position: -0.768885, -0.999099, 0.578527
position: -0.821072, -0.933314, 0.606385
position: -0.880726, -0.863272, 0.626249
position: -0.932536, -0.798518, 0.636832
position: -0.982888, -0.737100, 0.637009
position: -1.029467, -0.678006, 0.632102
position: -1.068761, -0.621026, 0.627347
position: -1.097129, -0.567448, 0.624871
position: -1.116512, -0.519347, 0.619932
position: -1.137028, -0.478799, 0.608974
position: -1.155995, -0.442517, 0.593539
position: -1.169933, -0.406638, 0.575704
position: -1.182779, -0.372893, 0.558735
position: -1.192832, -0.351697, 0.535796
position: -1.199425, -0.340894, 0.508009
position: -1.206211, -0.338860, 0.476441
position: -1.210023, -0.339755, 0.448193
position: -1.221180, -0.336962, 0.430055
position: -1.232917, -0.335158, 0.422007
position: -1.248946, -0.336658, 0.414282
position: -1.262634, -0.337492, 0.404997
position: -1.275638, -0.338706, 0.395813
position: -1.285185, -0.338298, 0.387470
position: -1.294244, -0.339089, 0.375optimize pose graph 
768
position: -1.303838, -0.341027, 0.359751
position: -1.314581, -0.344687, 0.343486
position: -1.326667, -0.346804, 0.326021
position: -1.338595, -0.347118, 0.312489
position: -1.351001, -0.346013, 0.299446
position: -1.364607, -0.343142, 0.287373
position: -1.379323, -0.337299, 0.273685
position: -1.393112, -0.329259, 0.259382
position: -1.404710, -0.318292, 0.246572
position: -1.411145, -0.304020, 0.237983
position: -1.413548, -0.287070, 0.232915
position: -1.412424, -0.267985, 0.231532
position: -1.410330, -0.248946, 0.233958
position: -1.409454, -0.231151, 0.238231
position: -1.408046, -0.216247, 0.245005
position: -1.404798, -0.206076, 0.253769
position: -1.402342, -0.198983, 0.263698
position: -1.405112, -0.192470, 0.272074
position: -1.411617, -0.179455, 0.276584
position: -1.416052, -0.164546, 0.276565
position: -1.416453, -0.144517, 0.266923
position: -1.412189, -0.119768, 0.253991
position: -1.405463, -0.096883, 0.235318
position: -1.393379, -0.082530, 0.206890
position: -1.384584, -0.077393, 0.18
Done.
killing:
 * /feature_tracker
 * /pose_graph
 * /rosout
 * /vins_estimator
[33m[ WARN] [1720341970.758380071]: Shutdown request received.[0m
[33m[ WARN] [1720341970.758427695]: Reason given for shutdown: [user request][0m
8664
position: -1.392820, -0.087688, 0.184686
position: -1.401348, -0.103982, 0.174591
position: -1.406385, -0.112929, 0.174152
position: -1.405366, -0.114006, 0.163458
position: -1.406050, -0.115102, 0.159799
position: -1.405352, -0.121292, 0.157568
position: -1.408332, -0.120919, 0.151054
position: -1.411592, -0.121474, 0.145164
position: -1.414954, -0.122178, 0.139219
[33m[ WARN] [1720341970.759230940]: Shutdown request received.[0m
[33m[ WARN] [1720341970.759264253]: Reason given for shutdown: [user request][0m
killed
