/SLAM-Hive/slam_hive_results/mapping_results/3187/2392_vins-fusion-stereo-imu+MH_03_medium+Image_comb_test-22.yamlERROR: Unable to communicate with master!
[31m[ERROR] [1720556873.224001028]: [registerPublisher] Failed to contact master at [localhost:11311].  Retrying...[0m
[0m[ INFO] [1720556873.225521656]: init begins[0m
[31m[ERROR] [1720556873.226608072]: [registerPublisher] Failed to contact master at [localhost:11311].  Retrying...[0m
... logging to /root/.ros/log/b7f9fd72-3e31-11ef-b64e-0242ac110005/roslaunch-be9c50de5155-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;roscore
[1mstarted roslaunch server http://be9c50de5155:38989/[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 [154][0m
[0m[ INFO] [1720556874.330851212]: Connected to master at [localhost:11311][0m
[0m[ INFO] [1720556874.331420683]: 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] [1720556874.337236531]:  fix extrinsic param [0m
camera number 2
[0m[ INFO] [1720556874.337449176]: Synchronized sensors, fix time offset: 0[0m
[0m[ INFO] [1720556874.337471869]: ROW: 192 COL: 300 [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] [1720556874.337678002]: reading paramerter of camera /slamhive/cam0_pinhole.yaml[0m
[0m[ INFO] [1720556874.337898894]: reading paramerter of camera /slamhive/cam1_pinhole.yaml[0m
MULTIPLE_THREAD is 1
[33m[ WARN] [1720556874.338067282]: 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
[1mROS_MASTER_URI=http://be9c50de5155:11311/[0m
]2;roscore http://be9c50de5155:11311/
[1msetting /run_id to b7f9fd72-3e31-11ef-b64e-0242ac110005[0m
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 [247][0m
started core service [/rosout]
rosbag play /slamhive/dataset/MH_03_medium.bag  --clock 
[0m[ INFO] [1720556883.392391937]: 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: 316919753.05 
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! 
feature tracking not enough, please slowly move you device! 
feature tracking not enough, please slowly move you device! 
[33m[ WARN] [1720556894.278065450]: gyroscope bias initial calibration -0.119593 0.0691012 0.0690598[0m
[0m[ INFO] [1720556894.331177925]: Initialization finish![0m
time: 1403637141.038319, t: 41.145254 -16.391684 -40.728889 q: -0.455344 0.787486 0.087003 0.406151 
time: 1403637142.038319, t: 60.240677 -35.825241 -58.120311 q: 0.518701 -0.708669 -0.016510 -0.477981 
time: 1403637143.038319, t: 74.509000 -99.693103 -34.921077 q: 0.578290 -0.631672 -0.408558 -0.315676 
time: 1403637144.038319, t: 91.753471 -116.571714 -37.076255 q: 0.607105 -0.597687 -0.438175 -0.286698 
time: 1403637145.038319, t: -10.401558 -172.386525 -29.467021 q: 0.657540 -0.457461 -0.481048 -0.356321 
time: 1403637146.038319, t: -6.336804 -205.067190 -32.266369 q: 0.679553 -0.411135 -0.506719 -0.335278 
time: 1403637147.038319, t: -0.747590 -241.864177 -35.747477 q: 0.698952 -0.362835 -0.530839 -0.313093 
time: 1403637148.038319, t: 6.585660 -282.981207 -40.052123 q: 0.715830 -0.313343 -0.552645 -0.289806 
time: 1403637149.038319, t: -139.840670 -298.137211 -37.170469 q: 0.671827 -0.145504 -0.626740 -0.366980 
time: 1403637150.038319, t: -155.851747 -352.727745 -46.941124 q: 0.629023 -0.083902 -0.691197 -0.345742 
time: 1403637151.038319, t: -145.698190 -423.251917 -52.952040 q: 0.672047 0.094823 -0.642358 -0.356003 
time: 1403637152.038319, t: -115.645860 -505.132305 -69.377009 q: 0.676659 0.230378 -0.617194 -0.328832 
time: 1403637153.038319, t: -54.125849 -592.083583 -94.905582 q: 0.690215 0.370039 -0.555549 -0.279356 
time: 1403637154.038319, t: 477.874048 27.231070 -179.097018 q: 0.609605 0.758864 -0.076915 0.215850 
time: 1403637155.038319, t: 53.777351 -743.257859 -171.257446 q: 0.583670 0.508495 -0.562216 -0.290991 
time: 1403637156.038319, t: -18.422533 -852.680169 -182.005281 q: 0.731638 0.440408 -0.380057 -0.355392 
time: 1403637157.038319, t: 137.998300 -929.822850 -246.344921 q: 0.852129 0.257310 -0.270625 -0.366647 
time: 1403637158.038319, t: 197.005638 -1029.138460 -325.778850 q: 0.842587 0.274755 -0.247924 -0.391267 
time: 1403637159.038319, t: -82.322357 -1210.609335 -410.789367 q: 0.814893 -0.351302 -0.123350 -0.444208 
time: 1403637160.038319, t: -102.715015 -1335.546159 -502.164943 q: 0.832741 -0.401223 -0.178650 -0.337115 
time: 1403637161.038319, t: 313.150118 -1349.376425 -596.140089 q: 0.789004 -0.513525 -0.039949 -0.334918 
time: 1403637162.038319, t: 542.244330 -1372.212247 -700.881192 q: 0.788397 -0.465289 0.064631 -0.397188 
time: 1403637163.038319, t: 670.276072 -1465.490500 -814.463995 q: 0.771081 -0.475694 0.114148 -0.407578 
time: 1403637164.038319, t: 767.529988 -1592.748146 -936.409782 q: 0.677870 -0.622412 0.226787 -0.318846 
time: 1403637165.038319, t: 881.193828 -1716.600084 -1066.077118 q: 0.646982 -0.622525 0.190095 -0.397166 
time: 1403637166.038319, t: 1001.250702 -1843.407031 -1202.724653 q: 0.550522 -0.704337 0.177387 -0.411544 
time: 1403637168.038319, t: 1239.187300 -2120.204733 -1493.088903 q: 0.614623 -0.602899 0.064007 -0.504633 
time: 1403637169.038319, t: 1355.571520 -2270.931446 -1647.312539 q: 0.606209 -0.562602 0.045142 -0.560315 
time: 1403637170.038319, t: 1468.964820 -2430.869852 -1807.897693 q: 0.633229 -0.357748 -0.125531 -0.674744 
time: 1403637171.038319, t: 1578.255824 -2599.977161 -1976.363474 q: 0.675248 -0.062080 -0.315662 -0.663735 
time: 1403637172.038319, t: 1683.105091 -2780.084517 -2154.447751 q: 0.629897 0.037479 -0.340716 -0.696949 
time: 1403637173.038319, t: 1787.589850 -2967.739547 -2342.788681 q: 0.648334 -0.066348 -0.379736 -0.656553 
time: 1403637174.038319, t: 1889.497963 -3163.905867 -2540.226095 q: 0.672865 -0.201212 -0.216086 -0.678287 
time: 1403637175.038319, t: 1990.999258 -3367.106629 -2746.761659 q: 0.661223 -0.206535 -0.041031 -0.720031 
time: 1403637176.038319, t: 2090.602070 -3576.956432 -2963.441285 q: 0.634914 -0.210821 0.020828 -0.742970 
time: 1403637177.038319, t: 2245.022820 -3755.814509 -3186.297924 q: -0.490174 0.267929 0.251151 0.790485 
time: 1403637178.038319, t: 2387.571525 -3942.778372 -3414.877181 q: -0.466198 0.357706 -0.006498 0.809113 
time: 1403637179.038319, t: 2548.344204 -4121.471804 -3653.500503 q: -0.459142 0.302353 -0.044840 0.834122 
time: 1403637180.038319, t: 2886.779644 -4183.614147 -3904.025759 q: -0.484945 0.114618 0.327244 0.802871 
time: 1403637181.038319, t: 3264.560016 -4194.855891 -4152.223747 q: 0.641978 -0.137663 -0.428539 -0.620699 
time: 1403637182.038319, t: 2833.231187 -4814.271767 -4399.773647 q: 0.825952 -0.082488 -0.251202 -0.497892 
time: 1403637183.038319, t: 4179.817428 -3627.201503 -4666.647781 q: 0.917746 0.287610 -0.269352 -0.049725 
time: 1403637184.038319, t: 391.253829 -4726.774993 -4938.428185 q: 0.621602 -0.301348 -0.161378 -0.704810 
time: 1403637185.038319, t: 3943.673329 -4630.145969 -5215.040445 q: 0.793741 0.214298 -0.450859 -0.347532 
time: 1403637186.038319, t: 4488.027045 -4216.334994 -5509.931186 q: 0.502103 0.710116 -0.485832 -0.087157 
time: 1403637187.038319, t: 4261.139676 -5091.913699 -5812.443175 q: 0.011206 0.939321 -0.333641 0.078956 
time: 1403637188.038319, t: 3648.058379 -5872.893908 -6092.489877 q: 0.262635 0.830836 -0.463589 0.160686 
time: 1403637190.038319, t: 5343.111212 -4740.505612 -6641.561699 q: 0.308507 0.907793 0.175505 0.223456 
time: 1403637191.038319, t: 5611.450298 -4781.403629 -6924.217930 q: 0.120965 0.964183 0.173635 0.159907 
time: 1403637192.038319, t: 5856.832677 -4881.994717 -7235.206742 q: 0.157408 0.945218 0.235072 0.162869 
time: 1403637193.038319, t: 5676.418425 -2454.543829 -7534.184498 q: 0.052933 0.827929 0.351903 0.433469 
time: 1403637194.038319, t: 6460.229863 -3769.506775 -7838.764873 q: 0.237623 0.834757 0.366211 0.335566 
time: 1403637195.038319, t: 6545.138637 -3089.060546 -8174.807730 q: 0.103007 0.837675 0.458792 0.277848 
time: 1403637196.038319, t: 6704.954281 -2839.246589 -8521.806085 q: 0.263712 0.792434 0.454724 0.309403 
time: 1403637197.038319, t: 6891.376430 -2636.576002 -8881.364941 q: 0.194373 0.782754 0.566649 0.168594 
time: 1403637198.038319, t: 7074.143314 -2443.923273 -9248.629353 q: -0.106970 0.695381 0.683043 -0.196099 
time: 1403637199.038319, t: 7251.149105 -2247.129008 -9616.596622 q: -0.302920 0.596777 0.664385 -0.332699 
time: 1403637200.038319, t: 7434.507657 -2057.319452 -9984.250514 q: 0.508291 -0.445387 -0.485628 0.554469 
time: 1403637201.038319, t: 7637.764754 -1879.966296 -10354.030585 q: 0.581021 -0.255271 -0.438596 0.636305 
time: 1403637202.038319, t: 7875.119695 -1728.468308 -10729.703020 q: 0.548248 -0.261639 -0.439539 0.661645 
time: 1403637203.038319, t: 8385.546894 -2053.111501 -11139.084878 q: 0.748019 -0.109333 -0.372686 0.538163 
time: 1403637204.038319, t: 8713.230982 -2034.612934 -11518.071615 q: 0.684250 -0.081636 -0.483351 0.539916 
time: 1403637205.038319, t: 9039.377188 -1996.581938 -11905.784444 q: 0.716421 -0.051134 -0.433639 0.544135 
time: 1403637206.038319, t: 9346.401769 -1866.029411 -12307.268399 q: 0.744412 0.017686 -0.430599 0.510022 
time: 1403637207.038319, t: 9686.027081 -1793.945166 -12712.941447 q: 0.777055 0.066708 -0.411116 0.471931 
time: 1403637208.038319, t: 9704.666050 -1091.545385 -13131.282065 q: 0.683088 -0.017577 -0.491331 0.540070 
time: 1403637209.038319, t: 10100.634198 -1058.572995 -13599.149854 q: 0.856346 0.012363 -0.310226 0.412647 
time: 1403637210.038319, t: 10205.214808 -553.457917 -14075.695609 q: 0.849623 0.099243 -0.315335 0.410919 
time: 1403637211.038319, t: 10372.815964 -152.348571 -14538.213271 q: 0.825087 -0.010642 -0.320074 0.465478 
time: 1403637212.038319, t: 10859.465196 -206.517875 -15041.232215 q: 0.865491 -0.062109 -0.314997 0.384506 
time: 1403637213.038319, t: 11030.230714 231.229201 -15500.581513 q: 0.842796 -0.052812 -0.388665 0.368572 
time: 1403637214.038319, t: 11585.694125 152.526190 -15950.293437 q: 0.822292 0.014850 -0.474091 0.314409 
time: 1403637215.038319, t: 12077.196390 144.475200 -16392.899062 q: 0.863921 0.242702 -0.365666 0.247030 
time: 1403637216.038319, t: 12215.646937 784.737825 -16858.543378 q: 0.810495 0.285632 -0.372008 0.350888 
time: 1403637217.038319, t: 12558.228001 1057.627900 -17297.763989 q: 0.827416 0.250074 -0.361162 0.349869 
time: 1403637218.038319, t: 12485.504103 1833.181843 -17782.383533 q: 0.885102 0.256255 -0.234974 0.309378 
time: 1403637219.038319, t: 13021.050329 1913.775385 -18264.768033 q: 0.870834 0.257818 -0.310802 0.280321 
time: 1403637220.038319, t: 13496.016900 2066.196564 -18757.654960 q: 0.842000 0.295102 -0.375423 0.251017 
time: 1403637221.038319, t: 14280.930482 1722.037192 -19257.684505 q: 0.811958 0.390991 -0.374461 0.218241 
time: 1403637223.038319, t: 15160.388694 2251.763148 -20337.414989 q: 0.868067 0.236384 -0.424565 0.101619 
time: 1403637224.038319, t: 15374.825308 2950.099463 -20893.484228 q: 0.898143 0.197786 -0.382812 0.087607 
time: 1403637225.038319, t: 15631.328031 3491.461716 -21470.829098 q: 0.934926 0.268931 -0.217650 0.078851 
time: 1403637226.038319, t: 16458.586846 3129.328422 -22069.846142 q: 0.911805 0.267829 -0.311247 0.002133 
time: 1403637227.038319, t: 16992.473187 3267.829693 -22678.720530 q: 0.889811 0.242327 -0.384826 -0.037735 
time: 1403637228.038319, t: 17033.768965 4326.494595 -23294.318918 q: 0.873059 0.430986 -0.227060 -0.021521 
time: 1403637229.038319, t: 17969.840458 3761.211393 -23949.189374 q: 0.885526 0.373528 -0.251922 -0.113381 
time: 1403637230.038319, t: 18268.500267 4504.452334 -24609.573633 q: 0.880992 0.242656 -0.375355 -0.155175 
time: 1403637231.038319, t: 19136.871927 3939.570439 -25280.462736 q: 0.905118 -0.031230 -0.359866 -0.224238 
time: 1403637232.038319, t: 19086.687716 5370.768563 -25964.458186 q: 0.924824 -0.277616 -0.238034 -0.104740 
time: 1403637233.038319, t: 20082.233706 4606.924861 -26670.153554 q: 0.872102 -0.476229 -0.112377 -0.003984 
time: 1403637234.038319, t: 20244.720308 5628.465370 -27386.792981 q: 0.827898 -0.449334 -0.223125 -0.250796 
time: 1403637235.038319, t: 20651.999420 6059.584581 -28111.644701 q: 0.938994 -0.190068 -0.216523 -0.187836 
time: 1403637236.038319, t: 21559.364694 5452.335767 -28853.260807 q: 0.939167 -0.013636 -0.187659 -0.287338 
time: 1403637237.038319, t: 21816.211322 6270.411610 -29607.932970 q: 0.916687 0.145137 -0.225481 -0.296275 
time: 1403637238.038319, t: 22638.441496 5712.396065 -30381.594326 q: 0.904060 0.247605 -0.216609 -0.272851 
time: 1403637239.038319, t: 22881.474415 6632.999664 -31172.296073 q: 0.893837 -0.095566 -0.395579 -0.188255 
time: 1403637240.038319, t: 23753.553335 5766.123337 -31973.995101 q: 0.916628 -0.199155 -0.096918 -0.332773 
time: 1403637241.038319, t: 23994.969289 6845.650808 -32786.230451 q: 0.834896 -0.340723 -0.170005 -0.397436 
time: 1403637242.038319, t: 24791.396924 6030.440229 -33604.611032 q: 0.849531 -0.266912 -0.068268 -0.449882 
time: 1403637243.038319, t: 25136.494010 6866.261550 -34433.846580 q: 0.854244 -0.052637 -0.144144 -0.496708 
time: 1403637244.038319, t: 25839.899675 6179.700057 -35301.083117 q: 0.826639 -0.160437 -0.201214 -0.500441 
time: 1403637245.038319, t: 26306.197130 6415.943017 -36151.655517 q: 0.734376 -0.211538 -0.350765 -0.541210 
time: 1403637246.038319, t: 26858.763179 5925.821240 -37009.521172 q: 0.719811 -0.057992 -0.369807 -0.584596 
time: 1403637247.038319, t: 27317.412633 5267.625672 -37876.988679 q: 0.596639 0.271451 -0.524204 -0.543641 
time: 1403637248.038319, t: 27555.534833 4147.845569 -38757.639145 q: 0.585922 0.310687 -0.456686 -0.592965 
time: 1403637249.038319, t: 27595.617887 3110.703636 -39665.877693 q: 0.546540 0.286175 -0.344617 -0.707557 
time: 1403637250.038319, t: 27846.222337 2714.010279 -40571.231021 q: 0.566397 0.227330 -0.234193 -0.756749 
time: 1403637251.038319, t: 28311.643929 2575.664529 -41519.453451 q: 0.572539 0.213095 -0.340597 -0.714691 
time: 1403637252.038319, t: 28492.680280 2067.131948 -42469.365974 q: 0.517699 0.274835 -0.392306 -0.708908 
time: 1403637253.038319, t: 28832.167866 1750.481833 -43468.704295 q: 0.518365 0.226857 -0.370542 -0.736568 
time: 1403637254.038319, t: 29201.125641 1494.162969 -44486.059058 q: 0.517242 0.215128 -0.292728 -0.774914 
time: 1403637255.038319, t: 29449.871181 1101.776731 -45534.002265 q: -0.468909 -0.272307 0.317608 0.777881 
time: 1403637256.038319, t: 29696.335995 718.315225 -46610.385365 q: -0.357448 -0.358312 0.351345 0.787655 
time: 1403637257.038319, t: 29808.342545 233.423702 -47720.755236 q: -0.329911 -0.362581 0.378483 0.785140 
time: 1403637258.038319, t: 30081.663546 -99.277579 -48860.086267 q: -0.244842 -0.413283 0.410683 0.774977 
time: 1403637259.038319, t: 30189.890373 -566.179562 -50030.120546 q: -0.189019 -0.471632 0.446750 0.736376 
time: 1403637260.038319, t: 30024.716193 -1188.184407 -51213.935755 q: -0.198872 -0.540102 0.487434 0.656619 
time: 1403637261.038319, t: 29276.315550 -1986.630250 -52436.365612 q: -0.168124 -0.479153 0.459160 0.728916 
time: 1403637262.038319, t: 28969.517605 -2483.499011 -53681.273688 q: -0.271182 -0.451036 0.577813 0.623826 
time: 1403637263.038319, t: 29229.614987 -2894.421550 -54952.511594 q: -0.374376 -0.408395 0.610490 0.566002 
time: 1403637264.038319, t: 30511.499858 -2945.698043 -56182.467486 q: -0.319324 -0.524879 0.558972 0.556853 
time: 1403637265.038319, t: 29542.708178 -3874.861026 -57571.672865 q: -0.195636 -0.384016 0.545075 0.719133 

Done.
killing:
 * /loop_fusion
 * /rosout
 * /vins_estimator
[33m[ WARN] [1720557020.198935173]: Shutdown request received.[0m
[33m[ WARN] [1720557020.198972533]: Reason given for shutdown: [user request][0m
[33m[ WARN] [1720557020.199902856]: Shutdown request received.[0m
[33m[ WARN] [1720557020.199929639]: Reason given for shutdown: [user request][0m
killed
