/SLAM-Hive/slam_hive_results/mapping_results/3186/2391_vins-fusion-stereo-imu+MH_03_medium+Image_comb_test-21.yamlERROR: Unable to communicate with master!
[31m[ERROR] [1720556701.763729992]: [registerPublisher] Failed to contact master at [localhost:11311].  Retrying...[0m
[0m[ INFO] [1720556701.765557812]: init begins[0m
[31m[ERROR] [1720556701.766700186]: [registerPublisher] Failed to contact master at [localhost:11311].  Retrying...[0m
... logging to /root/.ros/log/51c91894-3e31-11ef-bfb6-0242ac110005/roslaunch-ca4e11b6c90c-118.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;roscore
[1mstarted roslaunch server http://ca4e11b6c90c:42539/[0m
ros_comm version 1.12.17


SUMMARY
========

PARAMETERS
 * /rosdistro: kinetic
 * /rosversion: 1.12.17

NODES

auto-starting new master
[1mprocess[master]: started with pid [155][0m
[1mROS_MASTER_URI=http://ca4e11b6c90c:11311/[0m
]2;roscore http://ca4e11b6c90c:11311/
[1msetting /run_id to 51c91894-3e31-11ef-bfb6-0242ac110005[0m
[0m[ INFO] [1720556702.919546510]: Connected to master at [localhost:11311][0m
[0m[ INFO] [1720556702.922283153]: Connected to master at [localhost:11311][0m
config_file: /slamhive/mappingtask.yaml
USE_IMU: 1
IMU_TOPIC: /imu0
result path /home/output/vio.csv
[33m[ WARN] [1720556702.928797902]:  fix extrinsic param [0m
camera number 2
[0m[ INFO] [1720556702.928993430]: Synchronized sensors, fix time offset: 0[0m
[0m[ INFO] [1720556702.929020734]: ROW: 240 COL: 376 [0m
 exitrinsic cam 0
 0.0148655  -0.999881  0.0041403
  0.999557  0.0149672  0.0257155
-0.0257744 0.00375619   0.999661
-0.0216401  -0.064677 0.00981073
 exitrinsic cam 1
 0.0125553  -0.999755  0.0182238
  0.999599  0.0130119  0.0251588
-0.0253898  0.0179006   0.999517
-0.0198436  0.0453689 0.00786212
set g       0       0 9.81007
[0m[ INFO] [1720556702.929274699]: reading paramerter of camera /slamhive/cam0_pinhole.yaml[0m
[0m[ INFO] [1720556702.929471922]: reading paramerter of camera /slamhive/cam1_pinhole.yaml[0m
MULTIPLE_THREAD is 1
[33m[ WARN] [1720556702.929636278]: waiting for image and imu...[0m
config_file: /slamhive/mappingtask.yaml
vocabulary_file/home/catkin_ws/src/VINS-Fusion/loop_fusion/../support_files/brief_k10L6.bin
loop start load vocabulary
BRIEF_PATTERN_FILE/home/catkin_ws/src/VINS-Fusion/loop_fusion/../support_files/brief_pattern.yml
cam calib path: /slamhive/cam0_pinhole.yaml
VIO input, perfrom 4 DoF (x, y, z, yaw) pose graph optimization
no previous pose graph
[1mprocess[rosout-1]: started with pid [222][0m
started core service [/rosout]
rosbag play /slamhive/dataset/MH_03_medium.bag  --clock 
[0m[ INFO] [1720556711.919888109]: Opening /slamhive/dataset/MH_03_medium.bag[0m

Waiting 0.2 seconds after advertising topics... done.

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

 [DELAYED]  Bag Time: 1403637130.549401   Duration: 0.000000 / 135.914059   Delay: 316919581.59 
init first imu pose
averge acc 9.442349 -0.663823 -2.451513
init R0 
    0.259747     0.252397     0.932109
-6.16298e-33    -0.965239     0.261368
    0.965677   -0.0678897    -0.250718
feature tracking not enough, please slowly move you device! 
feature tracking not enough, please slowly move you device! 
feature tracking not enough, please slowly move you device! 
feature tracking not enough, please slowly move you device! 
feature tracking not enough, please slowly move you device! 
[33m[ WARN] [1720556722.781042635]: gyroscope bias initial calibration 0.0176483 0.0153156 0.0317592[0m
[0m[ INFO] [1720556722.819607901]: Initialization finish![0m
time: 1403637141.038319, t: -22.599375 -8.512643 -1.952839 q: -0.012539 0.718968 -0.115140 0.685325 
time: 1403637142.038319, t: -32.328039 -11.908787 -2.866011 q: -0.012003 0.709477 -0.126187 0.693235 
time: 1403637143.038319, t: -44.429867 -16.073728 -4.091811 q: -0.011501 0.699660 -0.137127 0.701099 
time: 1403637144.038319, t: -59.149688 -21.082437 -5.697929 q: -0.011179 0.689636 -0.147894 0.708805 
time: 1403637145.038319, t: -45.980196 -8.444833 -4.487326 q: 0.259914 0.603166 -0.457897 0.599138 
time: 1403637146.038319, t: -58.050341 -9.277879 -5.509430 q: 0.283123 0.575786 -0.495611 0.585390 
time: 1403637147.038319, t: -72.028431 -10.029596 -6.727875 q: 0.303291 0.548595 -0.529361 0.571695 
time: 1403637148.038319, t: -87.910274 -10.978721 -8.175728 q: -0.321305 -0.521470 0.560138 -0.557743 
time: 1403637149.038319, t: -88.943979 -5.614473 -8.201361 q: -0.403538 -0.437465 0.643564 -0.481256 
time: 1403637150.038319, t: -8.325377 -0.619147 -1.395853 q: -0.425609 -0.462234 0.691580 -0.356250 
time: 1403637151.038319, t: 10.037959 -10.501390 -0.827500 q: -0.389961 -0.560450 0.586555 -0.435637 
time: 1403637152.038319, t: 14.237068 -15.136264 -1.116621 q: -0.455007 -0.457992 0.683249 -0.341148 
time: 1403637153.038319, t: 20.857583 -23.084914 -2.021599 q: 0.517315 0.348488 -0.739149 0.254164 
time: 1403637154.038319, t: 13.999664 -29.733953 -3.464354 q: 0.548593 0.296010 -0.761174 0.178991 
time: 1403637155.038319, t: -20.485185 -19.255437 -8.952545 q: 0.592200 -0.075589 -0.783543 -0.172181 
time: 1403637156.038319, t: -33.520637 -46.945191 -6.192675 q: 0.606984 -0.177896 -0.751093 -0.189165 
time: 1403637157.038319, t: -63.179290 -12.808600 -7.846657 q: 0.553391 -0.396381 -0.663152 -0.311240 
time: 1403637158.038319, t: -45.480617 -23.401868 -4.036784 q: -0.489033 0.554928 0.523502 0.422903 
time: 1403637159.038319, t: -28.480372 -5.664159 -2.321700 q: -0.462907 0.583418 0.541292 0.390311 
time: 1403637160.038319, t: -15.357888 -6.629481 -3.179772 q: -0.439923 0.596163 0.542947 0.395306 
time: 1403637161.038319, t: -14.109020 -3.197451 -3.835759 q: -0.299534 0.722554 0.392933 0.483527 
time: 1403637162.038319, t: -13.311616 1.142825 -5.590227 q: -0.248524 0.743744 0.256920 0.564866 
time: 1403637163.038319, t: -6.482992 4.833196 -7.651443 q: -0.161323 0.784828 0.126161 0.584896 
time: 1403637164.038319, t: 5.802552 2.940256 -9.671122 q: -0.006446 0.823987 -0.138124 0.549478 
time: 1403637165.038319, t: 20.366470 -10.558740 -11.608412 q: 0.093849 0.815589 -0.176550 0.542989 
time: 1403637166.038319, t: 27.997834 -40.085850 -13.860878 q: 0.271578 0.788768 -0.305657 0.458982 
time: 1403637167.038319, t: 12.315618 -81.097315 -16.646224 q: 0.326797 0.776186 -0.297589 0.449645 
time: 1403637168.038319, t: -32.511732 -110.138529 -19.289860 q: 0.318469 0.727965 -0.424647 0.433958 
time: 1403637169.038319, t: -89.830501 -110.548135 -21.836751 q: 0.401151 0.655574 -0.494042 0.406476 
time: 1403637170.038319, t: -151.424357 -45.131754 -23.701211 q: 0.359351 0.715915 -0.351602 0.484466 
time: 1403637171.038319, t: -131.848465 53.135140 -23.355149 q: 0.213829 0.752047 -0.184334 0.595587 
time: 1403637172.038319, t: -55.284382 85.460188 -23.276603 q: 0.262200 0.755537 -0.170328 0.575676 
time: 1403637173.038319, t: 0.212516 54.952057 -24.986186 q: 0.231494 0.771724 -0.346605 0.480330 
time: 1403637174.038319, t: 14.901702 -12.864885 -29.125157 q: 0.349915 0.655988 -0.537055 0.398512 
time: 1403637175.038319, t: -30.813765 -78.074962 -32.367619 q: -0.480852 -0.514150 0.599925 -0.380159 
time: 1403637176.038319, t: -126.332185 -83.765507 -34.129596 q: 0.530986 0.407975 -0.657442 0.345515 
time: 1403637177.038319, t: -139.644116 -79.197027 -18.186349 q: 0.595552 0.207362 -0.757221 0.170105 
time: 1403637178.038319, t: -194.510293 -12.776079 -25.200717 q: 0.602420 0.126953 -0.786653 0.046367 
time: 1403637179.038319, t: -202.137799 53.338424 -22.274069 q: 0.668133 -0.034370 -0.743186 -0.009562 
time: 1403637180.038319, t: -187.460993 29.078423 -2.732288 q: 0.600603 -0.381905 -0.642053 -0.284942 
time: 1403637181.038319, t: -169.816440 -16.695910 -23.041049 q: -0.492284 0.544883 0.562950 0.379271 
time: 1403637182.038319, t: -162.864850 -16.475578 -7.923055 q: 0.538823 -0.526704 -0.557458 -0.348560 
time: 1403637183.038319, t: -190.129450 -31.109156 -22.470125 q: 0.518480 -0.640692 -0.394100 -0.406665 
time: 1403637184.038319, t: -177.510965 -22.066090 -12.886147 q: 0.512345 -0.692729 -0.359715 -0.358098 
time: 1403637185.038319, t: -157.299094 -14.947614 -11.817014 q: -0.363935 0.765031 0.351007 0.398841 
time: 1403637186.038319, t: -125.065361 -25.456921 -10.445526 q: -0.259432 0.794532 0.231078 0.498013 
time: 1403637187.038319, t: -95.796014 -31.180114 -13.895156 q: -0.245684 0.827240 0.179097 0.472479 
time: 1403637188.038319, t: -139.617838 106.424162 -65.105071 q: -0.153633 0.824456 0.247867 0.485007 
time: 1403637189.038319, t: -53.289714 118.227216 -124.141575 q: -0.198646 0.817685 0.215555 0.495447 
time: 1403637190.038319, t: 6.187946 63.938860 -131.539923 q: -0.170142 0.816706 0.207748 0.510768 
time: 1403637191.038319, t: 146.768280 245.943782 -82.074186 q: -0.090774 0.800256 0.150820 0.573239 
time: 1403637192.038319, t: 314.630449 -20.828796 -75.124568 q: -0.093150 0.795726 0.221191 0.556073 
time: 1403637193.038319, t: -66.252793 504.769108 -149.028789 q: -0.316382 0.658225 0.474965 0.490969 
time: 1403637194.038319, t: 417.469259 132.162458 -182.781126 q: -0.080190 0.777737 0.241092 0.574951 
time: 1403637195.038319, t: 753.930113 269.014333 -157.207360 q: 0.043522 0.781971 0.054684 0.619384 
time: 1403637196.038319, t: 870.004650 235.816492 -174.795060 q: 0.117993 0.759181 0.043108 0.638642 
time: 1403637197.038319, t: 869.740946 -411.414737 -19.954870 q: 0.388470 0.756065 -0.183013 0.493926 
time: 1403637198.038319, t: 965.232098 -423.444179 -44.551827 q: 0.158540 0.782634 -0.029766 0.601217 
time: 1403637199.038319, t: 1110.420312 -336.967939 -45.604555 q: 0.127585 0.774587 0.005734 0.619439 
time: 1403637200.038319, t: 1188.656324 -369.708237 -42.017874 q: -0.014160 0.772266 0.043486 0.633651 
time: 1403637201.038319, t: 1223.697809 -493.496240 -34.951124 q: -0.014169 0.810508 0.074509 0.580797 
time: 1403637202.038319, t: 1332.819938 -488.953419 -33.721604 q: 0.050297 0.824701 -0.105907 0.553283 
time: 1403637203.038319, t: 1397.184624 -566.354554 -24.353101 q: 0.184886 0.820767 -0.100909 0.531014 
time: 1403637204.038319, t: 1597.192605 54.609724 -201.158600 q: 0.061270 0.820706 -0.023217 0.567581 
time: 1403637205.038319, t: 1709.589633 12.865642 -182.918082 q: 0.060416 0.756293 0.139041 0.636426 
time: 1403637206.038319, t: 1727.782283 277.262003 -234.100338 q: 0.006671 0.716353 0.203356 0.667413 
time: 1403637207.038319, t: 1924.965331 26.228587 -336.926426 q: 0.050511 0.836448 0.252139 0.483972 
time: 1403637208.038319, t: 2012.693412 -322.063081 -440.947512 q: 0.235448 0.845582 0.193480 0.438316 
time: 1403637209.038319, t: 2145.729115 -388.127297 -457.292252 q: 0.188862 0.810973 0.205887 0.514067 
time: 1403637210.038319, t: 734.080068 539.756013 -486.151376 q: -0.398522 0.311219 0.775490 0.378072 
time: 1403637211.038319, t: 1549.066605 710.482566 -703.841293 q: -0.180180 0.433957 0.686700 0.554671 
time: 1403637212.038319, t: 1215.003685 779.279533 -716.879618 q: -0.137736 0.004194 0.954678 0.263821 
time: 1403637213.038319, t: 846.022622 656.111151 -829.292791 q: -0.096773 0.027186 0.935937 0.337516 
time: 1403637214.038319, t: 999.491380 866.309989 -1049.029812 q: -0.079219 -0.001821 0.957800 0.276299 
time: 1403637215.038319, t: 921.647606 859.678234 -1151.539787 q: -0.114993 -0.129065 0.967241 0.185914 
time: 1403637216.038319, t: 819.816811 847.971385 -1274.276995 q: -0.123544 -0.100003 0.981853 0.103446 
time: 1403637217.038319, t: 737.026273 511.675886 -1453.931344 q: -0.001298 -0.291383 0.930242 -0.223033 
time: 1403637218.038319, t: 705.948810 252.649003 -1601.891312 q: -0.088408 -0.285901 0.948190 -0.106678 
time: 1403637219.038319, t: 888.377699 3.346752 -1723.764082 q: -0.094408 -0.474503 0.814962 -0.319017 
time: 1403637220.038319, t: 1030.229769 -208.443517 -1847.810076 q: 0.093188 -0.495317 0.784221 -0.361905 
time: 1403637221.038319, t: 1043.728070 -336.672971 -1982.439397 q: 0.115603 -0.539993 0.689612 -0.468485 
time: 1403637222.038319, t: 1087.165032 -494.802942 -2070.437547 q: 0.061588 -0.600325 0.657291 -0.451426 
time: 1403637223.038319, t: 1326.301165 -700.935882 -2136.695491 q: -0.034115 -0.635266 0.650620 -0.414689 
time: 1403637224.038319, t: 1407.929908 -942.869477 -2201.527528 q: -0.024493 -0.630231 0.659855 -0.408411 
time: 1403637225.038319, t: 1688.992776 -933.623360 -2280.383175 q: 0.051318 0.706055 -0.503480 0.495339 
time: 1403637226.038319, t: 1516.077818 -1210.664618 -2403.172417 q: -0.034438 0.744749 -0.428126 0.510755 
time: 1403637227.038319, t: 1757.025514 -1309.826089 -2492.721623 q: -0.034989 0.755499 -0.429665 0.493341 
time: 1403637228.038319, t: 1830.445523 -1395.261389 -2583.401202 q: -0.078367 0.779564 -0.331437 0.525631 
time: 1403637229.038319, t: 2000.433028 -1435.012280 -2672.680092 q: -0.087603 0.797753 -0.281116 0.526203 
time: 1403637230.038319, t: 2001.025098 -1608.270578 -2714.457906 q: -0.039028 0.802211 -0.399050 0.442372 
time: 1403637231.038319, t: 2041.152450 -1523.834808 -2822.022943 q: 0.027609 0.810178 -0.413351 0.414718 
time: 1403637232.038319, t: 2246.963866 -1358.501123 -2854.478411 q: 0.241030 0.671405 -0.645583 0.272660 
time: 1403637233.038319, t: 2432.076216 -1019.131773 -2880.268581 q: -0.319565 -0.558150 0.740480 -0.195027 
time: 1403637234.038319, t: 2424.525174 -507.212617 -2901.002441 q: 0.369661 0.701550 -0.561918 0.235429 
time: 1403637235.038319, t: 1442.281632 182.702154 -2765.457146 q: 0.073141 0.805697 -0.179574 0.559693 
time: 1403637236.038319, t: 682.584761 19.509874 -2781.035931 q: -0.101875 0.829863 0.084868 0.541984 
time: 1403637237.038319, t: 348.861596 -2.445371 -2758.534508 q: -0.268344 0.782592 0.185599 0.530184 
time: 1403637238.038319, t: 1076.087549 748.151983 -2757.355538 q: -0.253929 0.845395 0.146656 0.446452 
time: 1403637239.038319, t: 856.314561 -2738.102020 -2765.239530 q: -0.484379 0.391033 0.782591 0.004594 
time: 1403637240.038319, t: -438.984818 -134.686354 -2768.534644 q: -0.157645 0.914476 0.307880 0.209978 
time: 1403637241.038319, t: -850.464634 -275.825745 -2658.420647 q: -0.013106 0.890957 0.293426 0.346303 
time: 1403637242.038319, t: -1037.697496 100.485452 -2599.715986 q: -0.101764 0.888622 0.354052 0.273206 
time: 1403637243.038319, t: -1236.635684 412.962794 -2604.156231 q: -0.195430 0.854098 0.431773 0.214235 
time: 1403637244.038319, t: -1795.189277 173.057975 -2532.208901 q: -0.172732 0.843492 0.477578 0.174942 
time: 1403637245.038319, t: -2165.075931 307.727818 -2483.860822 q: -0.322987 0.764115 0.558180 0.015591 
time: 1403637246.038319, t: -2231.477492 944.153344 -2476.053999 q: 0.514041 -0.621211 -0.585353 0.084973 
time: 1403637247.038319, t: -2544.623853 1193.414107 -2390.427240 q: 0.669901 -0.316007 -0.645899 0.184894 
time: 1403637248.038319, t: -3018.591577 1278.185387 -2245.661172 q: 0.683874 -0.204204 -0.659417 0.236192 
time: 1403637249.038319, t: -3444.417929 1431.605811 -2063.700955 q: 0.664935 -0.073605 -0.681875 0.295788 
time: 1403637250.038319, t: -4163.495547 836.314976 -1943.315911 q: 0.661079 0.075408 -0.680508 0.306915 
time: 1403637251.038319, t: -4734.894807 -228.669124 -1715.026318 q: 0.614752 0.311175 -0.631188 0.356163 
time: 1403637252.038319, t: -4934.065710 -1198.317306 -1504.130484 q: 0.609289 0.574320 -0.432468 0.334508 
time: 1403637253.038319, t: -4925.273941 -1966.122379 -1317.538751 q: 0.578977 0.680557 -0.351087 0.279939 
time: 1403637254.038319, t: -4654.429536 -2664.957959 -1044.668376 q: 0.596021 0.739157 -0.251422 0.187598 
time: 1403637255.038319, t: -4185.832909 -3352.340376 -897.902858 q: 0.552209 0.817044 -0.119683 0.114810 
time: 1403637256.038319, t: -3640.851563 -3915.798911 -880.456310 q: 0.403629 0.910533 0.087454 0.019088 
time: 1403637257.038319, t: -2738.985904 -4216.133903 -832.606274 q: 0.395007 0.880131 0.236731 -0.115319 
time: 1403637258.038319, t: -2045.215052 -4161.798408 -777.030652 q: 0.377353 0.812373 0.316021 -0.312707 
time: 1403637259.038319, t: -1936.087606 -3775.021659 -742.413518 q: 0.336441 0.858713 0.256328 -0.289337 
time: 1403637260.038319, t: -1974.587464 -3771.777763 -944.141971 q: 0.344588 0.879038 0.213349 -0.251067 
time: 1403637261.038319, t: -2056.194663 -3547.617574 -1170.584249 q: 0.312329 0.907607 0.190470 -0.205965 
time: 1403637262.038319, t: -2180.241580 -3537.996816 -1310.440188 q: 0.189961 0.917115 0.237473 -0.257723 
time: 1403637263.038319, t: -2348.402603 -3439.846173 -1512.765932 q: 0.163535 0.937614 0.233535 -0.198991 
time: 1403637264.038319, t: -2623.646084 -3100.286358 -1534.239016 q: 0.055074 0.930205 0.271914 -0.240308 
time: 1403637265.038319, t: -2770.840040 -3102.724567 -1703.357371 q: -0.060920 0.906071 0.294907 -0.297245 

Done.
killing:
 * /loop_fusion
 * /rosout
 * /vins_estimator
[33m[ WARN] [1720556848.750220688]: Shutdown request received.[0m
[33m[ WARN] [1720556848.750259963]: Reason given for shutdown: [user request][0m
[33m[ WARN] [1720556848.751157352]: Shutdown request received.[0m
[33m[ WARN] [1720556848.751179556]: Reason given for shutdown: [user request][0m
killed
