/SLAM-Hive/slam_hive_results/mapping_results/3148/2353_vins-fusion-stereo-imu+MH_02_easy+Image_comb_test-13.yamlERROR: Unable to communicate with master!
[31m[ERROR] [1720549826.061263715]: [registerPublisher] Failed to contact master at [localhost:11311].  Retrying...[0m
[0m[ INFO] [1720549826.063132211]: init begins[0m
[31m[ERROR] [1720549826.064314780]: [registerPublisher] Failed to contact master at [localhost:11311].  Retrying...[0m
... logging to /root/.ros/log/4f8aa274-3e21-11ef-b294-0242ac110005/roslaunch-bff1d9b52f28-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://bff1d9b52f28:43717/[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] [1720549827.167585678]: Connected to master at [localhost:11311][0m
[0m[ INFO] [1720549827.169363071]: 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] [1720549827.175487860]:  fix extrinsic param [0m
camera number 2
[0m[ INFO] [1720549827.175707205]: Synchronized sensors, fix time offset: 0[0m
[0m[ INFO] [1720549827.175732799]: ROW: 384 COL: 601 [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] [1720549827.175972130]: reading paramerter of camera /slamhive/cam0_pinhole.yaml[0m
[0m[ INFO] [1720549827.176196998]: reading paramerter of camera /slamhive/cam1_pinhole.yaml[0m
MULTIPLE_THREAD is 1
[33m[ WARN] [1720549827.176378637]: 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://bff1d9b52f28:11311/[0m
]2;roscore http://bff1d9b52f28:11311/
[1msetting /run_id to 4f8aa274-3e21-11ef-b294-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_02_easy.bag  --clock 
[0m[ INFO] [1720549836.221549072]: Opening /slamhive/dataset/MH_02_easy.bag[0m

Waiting 0.2 seconds after advertising topics... done.

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

 [DELAYED]  Bag Time: 1403636856.854208   Duration: 0.000000 / 153.782490   Delay: 316912979.58 
init first imu pose
averge acc 9.704770 -0.367023 -3.127050
init R0 
 0.308595  0.110881  0.944709
        0 -0.993182   0.11657
 0.951193 -0.035973 -0.306492
[33m[ WARN] [1720549842.626948987]: gyroscope bias initial calibration -0.00253819   0.0306506   0.0712464[0m
[0m[ INFO] [1720549842.658468278]: Initialization finish![0m
time: 1403636862.851666, t: -0.001820 -0.080206 0.411553 q: 0.006606 0.836958 0.006125 0.547192 
time: 1403636863.251667, t: -0.009926 -0.082038 0.447683 q: 0.021625 0.818116 0.007961 0.574592 
time: 1403636863.651666, t: -0.024737 -0.089072 0.184365 q: 0.066241 0.834344 -0.041548 0.545670 
time: 1403636864.051666, t: -0.044731 -0.084512 0.174828 q: 0.049389 0.851562 -0.041245 0.520289 
time: 1403636864.451667, t: -0.024380 -0.070925 0.435067 q: 0.054997 0.832850 -0.034846 0.549655 
time: 1403636864.851666, t: -0.019156 -0.062749 0.426097 q: 0.060790 0.815507 -0.031634 0.574676 
time: 1403636865.251667, t: -0.013376 -0.078147 0.194494 q: 0.033972 0.837796 -0.042615 0.543257 
time: 1403636865.651666, t: -0.013060 -0.072946 0.187628 q: 0.025983 0.852661 -0.023057 0.521309 
time: 1403636866.051666, t: -0.006718 -0.055406 0.440669 q: 0.015740 0.812747 -0.025077 0.581865 
time: 1403636866.451667, t: -0.010614 -0.056185 0.484651 q: 0.035802 0.803869 -0.019956 0.593393 
time: 1403636866.851666, t: -0.019343 -0.086234 0.289501 q: 0.031224 0.829786 -0.014046 0.557031 
time: 1403636867.251667, t: -0.050697 -0.079380 0.227591 q: -0.002854 0.853529 -0.006413 0.520999 
time: 1403636867.651666, t: -0.082640 -0.077467 0.238976 q: -0.000044 0.892129 0.001404 0.451779 
time: 1403636868.051666, t: -0.101081 -0.078074 0.233668 q: -0.008620 0.941563 -0.008154 0.336627 
time: 1403636868.451667, t: -0.123338 -0.066137 0.240145 q: -0.015845 0.936136 -0.013015 0.351039 
time: 1403636868.851666, t: -0.151361 -0.044667 0.251994 q: -0.005938 0.934916 -0.013354 0.354569 
time: 1403636869.251667, t: -0.154889 -0.031514 0.253431 q: -0.016888 0.930645 -0.002531 0.365525 
time: 1403636869.651666, t: -0.147997 -0.048340 0.250376 q: -0.016662 0.931324 -0.001800 0.363805 
time: 1403636870.051666, t: -0.112784 -0.188360 0.253680 q: -0.004469 0.928948 -0.025652 0.369293 
time: 1403636870.451667, t: -0.072099 -0.384082 0.257025 q: 0.020038 0.926675 -0.049151 0.372096 
time: 1403636870.851666, t: -0.053951 -0.498440 0.243361 q: 0.025322 0.924459 -0.070460 0.373857 
time: 1403636871.251667, t: -0.054783 -0.501766 0.233230 q: 0.021361 0.927407 -0.077234 0.365370 
time: 1403636871.651666, t: -0.059753 -0.378464 0.240689 q: 0.007825 0.928112 -0.062060 0.367009 
time: 1403636872.051666, t: -0.074511 -0.156584 0.244368 q: -0.020545 0.925627 -0.040433 0.375709 
time: 1403636872.451667, t: -0.074370 0.021757 0.225193 q: -0.037167 0.930853 -0.013795 0.363237 
time: 1403636872.851666, t: -0.051783 0.004380 0.228366 q: -0.031958 0.929029 -0.007898 0.368539 
time: 1403636873.251667, t: -0.060165 -0.170623 0.225900 q: -0.015234 0.929847 -0.032877 0.366158 
time: 1403636873.651666, t: -0.028326 -0.394668 0.216964 q: 0.006468 0.932618 -0.060814 0.355646 
time: 1403636874.451667, t: -0.030573 -0.396162 0.206153 q: -0.001779 0.935928 -0.057908 0.347394 
time: 1403636874.851666, t: -0.034182 -0.170326 0.196982 q: -0.022386 0.933651 -0.034409 0.355825 
time: 1403636875.251667, t: -0.017216 -0.027630 0.178613 q: -0.016564 0.917908 -0.060539 0.391799 
time: 1403636875.651666, t: -0.084812 0.007873 0.162005 q: -0.019169 0.912634 -0.141187 0.383143 
time: 1403636876.051666, t: -0.302610 0.008997 0.174529 q: 0.034489 0.900099 -0.212484 0.378791 
time: 1403636876.451667, t: -0.201477 -0.320626 0.156300 q: 0.084788 0.882208 -0.276491 0.371582 
time: 1403636876.851666, t: 0.007790 -0.479376 0.156281 q: 0.096225 0.882511 -0.223990 0.402173 
time: 1403636877.651666, t: 0.209380 -0.066499 0.120578 q: -0.059200 0.911520 0.025721 0.406160 
time: 1403636878.051666, t: 0.040903 0.019760 0.089222 q: -0.056627 0.927002 -0.003227 0.370743 
time: 1403636878.451667, t: -0.072087 -0.124670 0.056801 q: -0.002937 0.919161 -0.107518 0.378911 
time: 1403636878.851666, t: 0.001718 -0.368700 0.068738 q: 0.063382 0.901997 -0.174210 0.389917 
time: 1403636879.251667, t: 0.207070 -0.490061 0.075836 q: 0.061482 0.893318 -0.169557 0.411647 
time: 1403636879.651666, t: 0.381512 -0.370155 0.082375 q: 0.013810 0.896657 -0.078664 0.435462 
time: 1403636880.051666, t: 0.386938 -0.092143 0.119850 q: -0.036169 0.911024 -0.025479 0.409974 
time: 1403636880.851666, t: -0.101535 -0.111609 0.162498 q: 0.038547 0.906734 -0.120595 0.402249 
time: 1403636881.251667, t: -0.319829 -0.025627 0.257641 q: -0.008716 0.898005 -0.054962 0.436451 
time: 1403636881.651666, t: -0.083755 -0.030514 0.229139 q: -0.018862 0.891109 0.011544 0.453250 
time: 1403636882.051666, t: 0.094478 -0.217024 0.196461 q: -0.002749 0.893440 -0.005841 0.449136 
time: 1403636882.451667, t: 0.060704 -0.324808 0.138430 q: 0.004707 0.884832 -0.027627 0.465067 
time: 1403636882.851666, t: 0.071392 -0.262740 0.089632 q: -0.050867 0.846634 0.020317 0.529349 
time: 1403636883.251667, t: 0.163692 -0.190478 -0.008739 q: -0.090159 0.823612 0.088912 0.552837 
time: 1403636883.651666, t: 0.197156 -0.169974 -0.055091 q: -0.113302 0.802178 0.113730 0.575099 
time: 1403636884.051666, t: 0.210109 -0.164288 -0.069427 q: -0.128198 0.793844 0.127441 0.580634 
time: 1403636884.451667, t: 0.206807 -0.166654 -0.068840 q: -0.128414 0.785349 0.129831 0.591507 
time: 1403636884.851666, t: 0.206584 -0.167072 -0.068696 q: -0.128730 0.785649 0.129317 0.591152 
time: 1403636885.251667, t: 0.205803 -0.167907 -0.068454 q: -0.127376 0.785935 0.129114 0.591110 
time: 1403636885.651666, t: 0.205721 -0.168180 -0.068624 q: -0.126977 0.786033 0.129072 0.591075 
time: 1403636886.051666, t: 0.205714 -0.168337 -0.068758 q: -0.126813 0.786141 0.128978 0.590986 
time: 1403636886.451667, t: 0.205637 -0.168587 -0.068923 q: -0.126561 0.786239 0.128902 0.590927 
time: 1403636886.851666, t: 0.205627 -0.168678 -0.069067 q: -0.126460 0.786277 0.128903 0.590897 
time: 1403636887.251667, t: 0.205574 -0.168832 -0.069206 q: -0.126276 0.786323 0.128859 0.590885 
time: 1403636887.651666, t: 0.205567 -0.168953 -0.069312 q: -0.126049 0.786397 0.128830 0.590843 
time: 1403636888.051666, t: 0.205592 -0.169092 -0.069439 q: -0.125908 0.786500 0.128798 0.590742 
time: 1403636888.451667, t: 0.205571 -0.169248 -0.069572 q: -0.125860 0.786579 0.128656 0.590678 
time: 1403636888.851666, t: 0.205504 -0.169198 -0.069748 q: -0.125738 0.786500 0.128846 0.590768 
time: 1403636889.251667, t: 0.205607 -0.169212 -0.069860 q: -0.125865 0.786585 0.128520 0.590698 
time: 1403636889.651666, t: 0.205626 -0.169271 -0.069913 q: -0.125731 0.786440 0.128544 0.590914 
time: 1403636890.051666, t: 0.205610 -0.169442 -0.069976 q: -0.125272 0.786596 0.128368 0.590843 
time: 1403636890.451667, t: 0.205474 -0.169672 -0.069841 q: -0.125177 0.786463 0.128054 0.591108 
time: 1403636890.851666, t: 0.205465 -0.169800 -0.069794 q: -0.125083 0.786356 0.128229 0.591232 
time: 1403636891.251667, t: 0.205373 -0.169705 -0.069798 q: -0.125330 0.786353 0.128528 0.591120 
time: 1403636891.651666, t: 0.205340 -0.169846 -0.069797 q: -0.125150 0.786407 0.128465 0.591099 
time: 1403636892.051666, t: 0.205269 -0.169955 -0.069869 q: -0.125028 0.786392 0.128463 0.591146 
time: 1403636892.451667, t: 0.205364 -0.169983 -0.069869 q: -0.124799 0.786322 0.128441 0.591292 
time: 1403636892.851666, t: 0.205336 -0.170037 -0.069907 q: -0.124856 0.786440 0.128511 0.591108 
time: 1403636893.251667, t: 0.205324 -0.170074 -0.069931 q: -0.124825 0.786407 0.128532 0.591154 
time: 1403636893.651666, t: 0.205347 -0.170063 -0.069956 q: -0.124775 0.786392 0.128596 0.591170 
time: 1403636894.051666, t: 0.205352 -0.170114 -0.069973 q: -0.124890 0.786466 0.128479 0.591072 
time: 1403636894.451667, t: 0.205299 -0.170194 -0.069976 q: -0.124767 0.786515 0.128372 0.591056 
time: 1403636894.851666, t: 0.204788 -0.170462 -0.069553 q: -0.124754 0.786502 0.128415 0.591068 
time: 1403636895.251667, t: 0.205477 -0.167197 -0.068189 q: -0.127746 0.785161 0.129378 0.592001 
time: 1403636895.651666, t: 0.206037 -0.166892 -0.068651 q: -0.127766 0.785095 0.129466 0.592065 
time: 1403636896.051666, t: 0.205538 -0.167214 -0.068170 q: -0.127768 0.785275 0.129630 0.591790 
time: 1403636896.451667, t: 0.205685 -0.167283 -0.068189 q: -0.127802 0.785660 0.129868 0.591218 
time: 1403636896.851666, t: 0.206373 -0.166987 -0.068632 q: -0.128119 0.785922 0.129939 0.590786 
time: 1403636897.251667, t: 0.203723 -0.168324 -0.068568 q: -0.130423 0.785385 0.135426 0.589763 
time: 1403636897.651666, t: 0.168045 -0.211829 -0.068025 q: -0.101652 0.807505 0.130093 0.566285 
time: 1403636898.051666, t: 0.138704 -0.257455 -0.002677 q: -0.086059 0.817293 0.141084 0.552016 
time: 1403636898.451667, t: 0.156846 -0.268896 0.057142 q: -0.097638 0.810027 0.149480 0.558551 
time: 1403636898.851666, t: 0.198769 -0.255978 0.135073 q: -0.104936 0.810147 0.156177 0.555210 
time: 1403636899.251667, t: 0.284560 -0.226037 0.176452 q: -0.101511 0.807820 0.123826 0.567265 
time: 1403636899.651666, t: 0.361697 -0.272131 0.216334 q: -0.061611 0.815879 0.050837 0.572679 
time: 1403636900.051666, t: 0.447241 -0.336708 0.229118 q: -0.033545 0.814703 0.039693 0.577546 
time: 1403636900.451667, t: 0.522052 -0.414500 0.291401 q: -0.032851 0.816240 0.046774 0.574879 
time: 1403636900.851666, t: 0.592339 -0.495405 0.348795 q: -0.043642 0.827127 0.051050 0.557987 
time: 1403636901.251667, t: 0.714383 -0.599401 0.339659 q: -0.058729 0.820543 0.043741 0.566875 
time: 1403636901.651666, t: 0.853536 -0.762186 0.365745 q: -0.042999 0.816941 0.053498 0.572623 
optimize pose graph 
time: 1403636902.051666, t: 1.000284 -0.934554 0.332798 q: -0.042475 0.814973 0.055490 0.575271 
time: 1403636902.451667, t: 1.138400 -1.108570 0.304062 q: -0.043683 0.816076 0.051744 0.573964 
time: 1403636902.851666, t: 1.265437 -1.276370 0.224253 q: -0.029819 0.813919 0.051022 0.577964 
time: 1403636903.251667, t: 1.374610 -1.418881 0.259163 q: -0.037182 0.815036 0.054810 0.575613 
time: 1403636903.651666, t: 1.471070 -1.551773 0.319947 q: -0.036924 0.818709 0.061361 0.569725 
optimize pose graph 
time: 1403636904.051666, t: 1.584814 -1.669187 0.338367 q: -0.053192 0.819790 0.052227 0.567791 
time: 1403636904.451667, t: 1.722879 -1.822219 0.439949 q: -0.052210 0.816522 0.049879 0.572782 
time: 1403636904.851666, t: 1.867562 -2.004088 0.491098 q: -0.037727 0.816569 0.053073 0.573563 
time: 1403636905.251667, t: 2.011149 -2.174796 0.506234 q: -0.025378 0.816482 0.052769 0.574395 
time: 1403636905.651666, t: 2.153718 -2.304749 0.573356 q: -0.024038 0.820189 0.066114 0.567751 
time: 1403636906.051666, t: 2.306708 -2.384065 0.560102 q: -0.036509 0.824757 0.072445 0.559637 
time: 1403636906.451667, t: 2.486685 -2.424191 0.549597 q: -0.052821 0.814655 0.066193 0.573730 
time: 1403636906.851666, t: 2.669444 -2.473439 0.562582 q: -0.048300 0.817575 0.069066 0.569622 
time: 1403636907.251667, t: 2.862898 -2.522541 0.561664 q: -0.044586 0.822899 0.078662 0.560947 
time: 1403636907.651666, t: 3.087114 -2.554007 0.570649 q: -0.063784 0.826184 0.069130 0.555494 
time: 1403636908.051666, t: 3.363016 -2.617698 0.618774 q: -0.057778 0.819019 0.075489 0.565837 
time: 1403636908.451667, t: 3.649196 -2.695701 0.620917 q: -0.057533 0.815016 0.086861 0.569995 
time: 1403636908.851666, t: 3.924739 -2.765919 0.614255 q: -0.064884 0.821554 0.090797 0.559102 
time: 1403636909.251667, t: 4.230200 -2.828436 0.683477 q: -0.069827 0.824394 0.088120 0.554737 
time: 1403636909.651666, t: 4.573421 -2.896487 0.687741 q: -0.068444 0.818366 0.083419 0.564477 
time: 1403636910.051666, t: 4.917301 -2.968458 0.607117 q: -0.037197 0.801451 0.100901 0.588313 
time: 1403636910.451667, t: 5.199577 -3.004661 0.544083 q: -0.056784 0.814475 0.091727 0.570082 
time: 1403636910.851666, t: 5.468100 -3.019223 0.515536 q: -0.059833 0.815330 0.093244 0.568297 
time: 1403636911.251667, t: 5.726458 -3.035789 0.470163 q: -0.065832 0.809042 0.090048 0.577069 
time: 1403636911.651666, t: 5.946538 -3.063660 0.512262 q: -0.057178 0.813666 0.093512 0.570906 
time: 1403636912.051666, t: 6.158258 -3.090150 0.509284 q: -0.069164 0.818400 0.081662 0.564596 
time: 1403636912.451667, t: 6.389628 -3.135889 0.502855 q: -0.063440 0.815481 0.083083 0.569266 
time: 1403636912.851666, t: 6.620614 -3.203397 0.463388 q: -0.075586 0.815768 0.071076 0.568996 
time: 1403636913.251667, t: 6.849770 -3.316381 0.378735 q: -0.059225 0.806060 0.082511 0.583054 
time: 1403636913.651666, t: 7.057175 -3.446075 0.365968 q: -0.061756 0.813669 0.079438 0.572554 
time: 1403636914.051666, t: 7.253127 -3.587712 0.347035 q: -0.057287 0.812390 0.082072 0.574460 
time: 1403636914.451667, t: 7.432685 -3.740524 0.351822 q: -0.054913 0.812058 0.082613 0.575084 
time: 1403636914.851666, t: 7.594086 -3.884788 0.395501 q: -0.050284 0.810216 0.083555 0.577963 
time: 1403636915.251667, t: 7.733277 -4.009640 0.395543 q: -0.046558 0.819549 0.081995 0.565197 
time: 1403636915.651666, t: 7.892212 -4.106727 0.357073 q: -0.062348 0.816155 0.071848 0.569949 
time: 1403636916.051666, t: 8.071872 -4.220786 0.416923 q: -0.058040 0.810951 0.077532 0.577042 
time: 1403636916.451667, t: 8.225301 -4.356835 0.468473 q: -0.046584 0.810919 0.084863 0.577095 
time: 1403636916.851666, t: 8.371076 -4.476226 0.486709 q: -0.018229 0.813084 0.048523 0.579835 
time: 1403636917.251667, t: 8.491187 -4.543013 0.426475 q: -0.012843 0.813660 0.028749 0.580487 
time: 1403636917.651666, t: 8.588528 -4.599701 0.307297 q: 0.026318 0.810916 -0.026520 0.583969 
time: 1403636918.051666, t: 8.659108 -4.624449 0.268242 q: 0.045420 0.809664 -0.049430 0.583042 
time: 1403636918.851666, t: 8.784122 -4.561795 0.342187 q: 0.025497 0.819090 -0.051654 0.570766 
time: 1403636919.251667, t: 8.878221 -4.545935 0.506593 q: 0.018914 0.806003 -0.081591 0.585956 
time: 1403636919.651666, t: 8.919845 -4.615907 0.633138 q: 0.055375 0.803771 -0.077420 0.587275 
time: 1403636920.051666, t: 8.924984 -4.692255 0.654612 q: 0.047419 0.800110 -0.082831 0.592211 
time: 1403636920.451667, t: 8.871404 -4.782912 0.593718 q: 0.054855 0.801389 -0.071189 0.591353 
time: 1403636920.851666, t: 8.765439 -4.859759 0.595565 q: 0.055978 0.816431 -0.069896 0.570457 
time: 1403636921.251667, t: 8.671747 -4.909240 0.652131 q: 0.056298 0.812861 -0.071059 0.575359 
time: 1403636921.651666, t: 8.578631 -4.942278 0.620518 q: 0.037875 0.810247 -0.085080 0.578642 
time: 1403636922.051666, t: 8.491321 -4.999792 0.537478 q: 0.055794 0.816084 -0.081889 0.569376 
time: 1403636922.451667, t: 8.432308 -5.060093 0.494385 q: 0.073334 0.819433 -0.095176 0.560440 
time: 1403636922.851666, t: 8.408672 -5.101419 0.438738 q: 0.090218 0.801311 -0.128028 0.577383 
time: 1403636923.251667, t: 8.362948 -5.133088 0.408900 q: 0.096286 0.795206 -0.157657 0.577513 
time: 1403636923.651666, t: 8.291040 -5.177550 0.334458 q: 0.117935 0.816190 -0.177773 0.536956 
time: 1403636924.051666, t: 8.312719 -5.234188 0.337261 q: 0.124545 0.817426 -0.176375 0.534037 
time: 1403636924.451667, t: 8.440211 -5.303172 0.313306 q: 0.114341 0.810237 -0.177996 0.546590 
time: 1403636924.851666, t: 8.611184 -5.405674 0.332013 q: 0.090952 0.788574 -0.187047 0.578698 
time: 1403636925.251667, t: 8.715069 -5.564682 0.258377 q: 0.130508 0.793813 -0.191688 0.562213 
time: 1403636925.651666, t: 8.815393 -5.734800 0.143165 q: 0.139885 0.817973 -0.201303 0.520413 
time: 1403636926.051666, t: 9.040877 -5.912255 0.148471 q: 0.149702 0.796917 -0.195820 0.551514 
time: 1403636926.451667, t: 9.287408 -6.066697 0.114170 q: 0.127143 0.776267 -0.205300 0.582320 
time: 1403636926.851666, t: 9.441857 -6.212865 0.068483 q: 0.130347 0.788256 -0.208460 0.564098 
time: 1403636927.251667, t: 9.534410 -6.386482 0.058596 q: 0.166821 0.771013 -0.272745 0.550744 
time: 1403636927.651666, t: 9.597719 -6.581622 -0.025593 q: 0.204899 0.778608 -0.313351 0.503584 
time: 1403636928.051666, t: 9.738412 -6.823818 -0.046859 q: 0.210550 0.774225 -0.320044 0.503803 
time: 1403636928.451667, t: 9.937627 -7.105843 -0.105349 q: 0.214467 0.750286 -0.311504 0.542254 
time: 1403636928.851666, t: 10.121040 -7.362707 -0.135988 q: 0.215599 0.765590 -0.307377 0.522406 
time: 1403636929.251667, t: 10.313335 -7.604305 -0.041088 q: 0.204620 0.746046 -0.313787 0.550530 
time: 1403636929.651666, t: 10.444674 -7.840954 0.026540 q: 0.213208 0.754254 -0.303430 0.541824 
time: 1403636930.051666, t: 10.534405 -8.050309 0.026110 q: 0.211374 0.752892 -0.302945 0.544700 
time: 1403636930.451667, t: 10.591447 -8.225964 0.098423 q: 0.211158 0.755016 -0.305057 0.540651 
time: 1403636930.851666, t: 10.607867 -8.382228 0.131765 q: 0.202157 0.750193 -0.311465 0.547113 
time: 1403636931.251667, t: 10.566107 -8.555941 0.111665 q: 0.227113 0.733489 -0.330739 0.548658 
time: 1403636931.651666, t: 10.448332 -8.687770 0.168169 q: 0.268534 0.735777 -0.318817 0.533739 
time: 1403636932.051666, t: 10.323941 -8.718034 0.177135 q: 0.245466 0.737808 -0.338845 0.529688 
time: 1403636932.451667, t: 10.187846 -8.697097 0.155982 q: 0.270813 0.730500 -0.328443 0.533999 
time: 1403636932.851666, t: 10.037843 -8.577396 0.238058 q: 0.283136 0.711388 -0.374964 0.522649 
time: 1403636933.251667, t: 9.885375 -8.390351 0.263611 q: 0.289797 0.709483 -0.412371 0.492546 
time: 1403636933.651666, t: 9.760873 -8.211547 0.200952 q: 0.289005 0.708148 -0.419937 0.488523 
time: 1403636934.051666, t: 9.668366 -8.061743 0.215344 q: 0.296529 0.692377 -0.424089 0.502825 
time: 1403636934.451667, t: 9.550235 -7.899269 0.153994 q: 0.337735 0.644812 -0.493745 0.475781 
time: 1403636934.851666, t: 9.391651 -7.724669 0.157285 q: 0.376467 0.606760 -0.553692 0.428415 
time: 1403636935.651666, t: 9.078773 -7.443441 0.344119 q: 0.376824 0.600720 -0.549896 0.441310 
time: 1403636936.051666, t: 8.901063 -7.313323 0.297129 q: 0.356211 0.622222 -0.559352 0.416027 
time: 1403636936.451667, t: 8.721066 -7.262133 0.238642 q: 0.371912 0.613211 -0.551073 0.426582 
time: 1403636936.851666, t: 8.560102 -7.261974 0.233071 q: 0.383557 0.606462 -0.550145 0.427116 
time: 1403636937.251667, t: 8.413865 -7.273645 0.255555 q: 0.383994 0.604401 -0.553916 0.424766 
time: 1403636937.651666, t: 8.281936 -7.299958 0.245378 q: 0.388683 0.603577 -0.553925 0.421649 
time: 1403636938.051666, t: 8.177144 -7.309523 0.152531 q: 0.417434 0.598063 -0.538171 0.422424 
time: 1403636938.451667, t: 8.124957 -7.237118 0.031796 q: -0.390502 -0.563178 0.574548 -0.447474 
time: 1403636938.851666, t: 7.994158 -7.103008 0.015730 q: -0.383874 -0.566971 0.587379 -0.431474 
time: 1403636939.251667, t: 7.782993 -6.963220 0.009869 q: 0.397352 0.579589 -0.576931 0.416339 
time: 1403636939.651666, t: 7.562286 -6.823893 -0.016331 q: 0.405917 0.576957 -0.562021 0.431839 
time: 1403636940.051666, t: 7.332824 -6.633079 -0.019777 q: -0.403817 -0.569742 0.571325 -0.431177 
time: 1403636940.451667, t: 7.081952 -6.395251 -0.101801 q: -0.406609 -0.555888 0.590837 -0.420202 
time: 1403636940.851666, t: 6.797969 -6.143969 -0.137477 q: -0.402487 -0.564664 0.602340 -0.395406 
time: 1403636941.251667, t: 6.512058 -5.941756 -0.063785 q: -0.411027 -0.563491 0.595071 -0.399280 
time: 1403636941.651666, t: 6.247935 -5.763005 -0.015275 q: -0.413254 -0.568044 0.584385 -0.406252 
time: 1403636942.051666, t: 6.000646 -5.592682 0.014354 q: -0.403415 -0.571528 0.586023 -0.408888 
time: 1403636942.451667, t: 5.754784 -5.409009 0.052161 q: -0.398549 -0.562355 0.592593 -0.416832 
time: 1403636942.851666, t: 5.478621 -5.240811 0.011059 q: -0.398948 -0.565751 0.598295 -0.403497 
time: 1403636943.251667, t: 5.190666 -5.087180 0.036130 q: -0.414285 -0.559319 0.592694 -0.405271 
time: 1403636943.651666, t: 4.921061 -4.917651 0.016091 q: -0.423967 -0.555961 0.592123 -0.400686 
time: 1403636944.051666, t: 4.681507 -4.743866 -0.091404 q: -0.398442 -0.577493 0.594955 -0.392142 
time: 1403636944.451667, t: 4.468571 -4.627686 -0.151530 q: 0.389379 0.592615 -0.583102 0.396464 
time: 1403636944.851666, t: 4.303260 -4.579100 -0.105786 q: 0.408955 0.595258 -0.554403 0.413594 
time: 1403636945.251667, t: 4.211196 -4.499869 -0.072711 q: 0.400271 0.597586 -0.550353 0.424012 
time: 1403636945.651666, t: 4.160003 -4.384384 -0.064193 q: 0.393429 0.601140 -0.558166 0.415084 
time: 1403636946.051666, t: 4.145825 -4.279146 -0.113533 q: 0.392719 0.602039 -0.564953 0.405153 
time: 1403636946.451667, t: 4.174307 -4.219190 -0.254859 q: 0.405697 0.589156 -0.563313 0.413502 
time: 1403636946.851666, t: 4.227522 -4.136386 -0.417535 q: -0.382254 -0.571818 0.585772 -0.428693 
time: 1403636947.251667, t: 4.207903 -4.052228 -0.550440 q: -0.374988 -0.582974 0.593323 -0.409259 
time: 1403636947.651666, t: 4.123841 -4.059244 -0.585033 q: 0.382908 0.590916 -0.590122 0.394912 
time: 1403636948.051666, t: 4.063471 -4.155647 -0.594001 q: 0.398621 0.599223 -0.577158 0.385905 
time: 1403636948.451667, t: 4.066363 -4.308545 -0.668506 q: 0.401282 0.606801 -0.568244 0.384531 
time: 1403636948.851666, t: 4.185283 -4.495292 -0.746181 q: 0.412294 0.603748 -0.552886 0.399773 
time: 1403636949.251667, t: 4.392221 -4.660745 -0.780553 q: 0.397847 0.590397 -0.557194 0.427416 
time: 1403636949.651666, t: 4.576629 -4.772071 -0.868507 q: 0.386107 0.585387 -0.562893 0.437487 
time: 1403636950.051666, t: 4.716696 -4.850742 -0.886362 q: 0.371281 0.600475 -0.574131 0.414672 
time: 1403636950.451667, t: 4.826846 -4.976932 -0.899638 q: 0.386874 0.601869 -0.565633 0.410050 
time: 1403636950.851666, t: 4.952699 -5.132485 -0.927786 q: 0.398736 0.596778 -0.555693 0.419609 
time: 1403636951.251667, t: 5.099973 -5.260011 -0.876244 q: 0.380444 0.595371 -0.566934 0.423535 
time: 1403636951.651666, t: 5.226586 -5.403561 -0.887086 q: 0.378113 0.608334 -0.569703 0.402988 
time: 1403636952.051666, t: 5.365319 -5.608495 -0.880108 q: 0.399759 0.605658 -0.555534 0.405897 
time: 1403636952.451667, t: 5.539670 -5.817912 -0.922276 q: 0.395222 0.589466 -0.558346 0.429626 
time: 1403636952.851666, t: 5.715920 -5.971843 -0.997545 q: 0.395584 0.597814 -0.557174 0.419153 
time: 1403636953.251667, t: 5.883326 -6.106450 -1.079944 q: 0.372560 0.596062 -0.574888 0.418824 
time: 1403636953.651666, t: 6.009981 -6.276434 -1.141170 q: 0.389223 0.604829 -0.560407 0.410649 
time: 1403636954.051666, t: 6.152681 -6.466402 -1.093856 q: 0.388612 0.611552 -0.556408 0.406688 
time: 1403636954.451667, t: 6.345588 -6.684147 -1.051768 q: 0.383190 0.611091 -0.561939 0.404917 
time: 1403636954.851666, t: 6.580752 -6.943988 -1.037649 q: 0.396901 0.599192 -0.563121 0.407839 
time: 1403636955.251667, t: 6.779643 -7.262383 -1.153097 q: 0.404808 0.589124 -0.569056 0.406496 
time: 1403636955.651666, t: 7.119336 -7.424455 -1.158995 q: 0.416257 0.580073 -0.576483 0.397382 
time: 1403636956.051666, t: 7.420262 -7.625398 -1.172897 q: -0.403255 -0.566249 0.590365 -0.410142 
time: 1403636956.451667, t: 7.669556 -7.798043 -1.144162 q: -0.411768 -0.567532 0.589075 -0.401678 
time: 1403636956.851666, t: 7.889748 -7.930345 -1.185571 q: 0.376603 0.587610 -0.560538 0.445737 
time: 1403636957.251667, t: 8.063460 -8.024952 -1.154738 q: 0.336716 0.662595 -0.475241 0.470888 
time: 1403636957.651666, t: 8.205932 -8.098453 -1.139899 q: 0.305933 0.686545 -0.442414 0.489214 
time: 1403636958.051666, t: 8.345526 -8.147282 -1.201729 q: 0.241654 0.728881 -0.373118 0.520690 
time: 1403636958.451667, t: 8.439641 -8.203524 -1.174904 q: 0.195638 0.765616 -0.295406 0.536929 
time: 1403636958.851666, t: 8.522428 -8.282118 -1.140775 q: 0.190693 0.772508 -0.278761 0.537735 
time: 1403636959.251667, t: 8.622413 -8.362705 -1.188813 q: 0.199219 0.771316 -0.285640 0.532723 
time: 1403636960.051666, t: 8.848456 -8.448857 -1.339232 q: 0.205585 0.765324 -0.293959 0.534417 
time: 1403636960.451667, t: 8.969712 -8.464257 -1.330130 q: 0.222423 0.766609 -0.279851 0.533405 
time: 1403636961.251667, t: 9.272595 -8.334579 -1.431025 q: 0.131930 0.793194 -0.190344 0.563211 
time: 1403636961.651666, t: 9.397225 -8.230571 -1.357119 q: 0.088681 0.805298 -0.127956 0.572065 
time: 1403636962.051666, t: 9.502071 -8.127682 -1.239616 q: 0.043335 0.813615 -0.059379 0.576738 
time: 1403636962.451667, t: 9.582718 -8.016190 -1.137578 q: -0.011473 0.814587 0.024202 0.579423 
time: 1403636962.851666, t: 9.634333 -7.871074 -0.997206 q: -0.038493 0.807572 0.109940 0.578151 
time: 1403636963.251667, t: 9.647095 -7.675723 -0.947102 q: -0.063913 0.800196 0.102766 0.587401 
time: 1403636963.651666, t: 9.601953 -7.479322 -0.949315 q: -0.058233 0.807782 0.088584 0.579871 
time: 1403636964.051666, t: 9.527475 -7.283383 -0.864009 q: -0.049646 0.807697 0.081355 0.581844 
time: 1403636964.451667, t: 9.414701 -7.076549 -0.757866 q: -0.046509 0.805563 0.087226 0.584207 
time: 1403636964.851666, t: 9.252897 -6.837585 -0.738070 q: -0.057722 0.798185 0.135348 0.584166 
time: 1403636965.251667, t: 9.024965 -6.536720 -0.685065 q: -0.115090 0.791298 0.199622 0.566350 
time: 1403636965.651666, t: 8.796049 -6.191330 -0.525270 q: -0.140415 0.805557 0.201676 0.539155 
time: 1403636966.051666, t: 8.635383 -5.840977 -0.352480 q: -0.132231 0.785977 0.198117 0.570531 
time: 1403636966.451667, t: 8.450447 -5.517555 -0.297327 q: -0.144971 0.786065 0.181062 0.572977 
time: 1403636966.851666, t: 8.218054 -5.266811 -0.320611 q: -0.136603 0.785815 0.177319 0.576536 
time: 1403636967.251667, t: 7.966117 -5.076033 -0.315903 q: -0.129650 0.785857 0.177045 0.578165 
time: 1403636967.651666, t: 7.686164 -4.919714 -0.319851 q: -0.122241 0.784550 0.177949 0.581268 
time: 1403636968.051666, t: 7.367182 -4.776206 -0.406458 q: -0.121390 0.783790 0.177602 0.582577 
time: 1403636968.451667, t: 6.994513 -4.659871 -0.524988 q: -0.126181 0.786628 0.175215 0.578441 
time: 1403636968.851666, t: 6.581816 -4.555284 -0.539281 q: -0.113841 0.785716 0.182820 0.579886 
time: 1403636969.251667, t: 6.131559 -4.437911 -0.505145 q: -0.124205 0.796523 0.174608 0.565364 
time: 1403636969.651666, t: 5.695928 -4.328975 -0.407955 q: -0.116038 0.808038 0.176125 0.550082 
time: 1403636970.051666, t: 5.325240 -4.200420 -0.384144 q: -0.118723 0.802600 0.173339 0.558294 
time: 1403636970.451667, t: 4.991558 -4.061739 -0.414773 q: -0.119539 0.801063 0.175234 0.559734 
time: 1403636970.851666, t: 4.688475 -3.908978 -0.407619 q: -0.115459 0.818227 0.182068 0.532940 
time: 1403636971.251667, t: 4.476474 -3.709104 -0.407334 q: -0.147882 0.813035 0.160083 0.539888 
time: 1403636971.651666, t: 4.365462 -3.562527 -0.481316 q: -0.147021 0.801203 0.162206 0.556909 
time: 1403636972.051666, t: 4.285013 -3.489830 -0.591824 q: -0.139913 0.790843 0.170680 0.570842 
time: 1403636972.451667, t: 4.224904 -3.473580 -0.606878 q: -0.136794 0.802656 0.171385 0.554669 
time: 1403636972.851666, t: 4.186726 -3.496645 -0.539049 q: -0.129485 0.797627 0.174207 0.562741 
time: 1403636973.251667, t: 4.153866 -3.519883 -0.559378 q: -0.107531 0.807815 0.146905 0.560617 
time: 1403636973.651666, t: 4.129149 -3.537339 -0.646491 q: -0.095607 0.806501 0.133205 0.568042 
time: 1403636974.051666, t: 4.107164 -3.539793 -0.705389 q: -0.096157 0.805279 0.127930 0.570889 
time: 1403636974.451667, t: 4.085805 -3.550809 -0.747190 q: -0.041277 0.816269 0.057921 0.573277 
time: 1403636974.851666, t: 4.058765 -3.557483 -0.834000 q: 0.021455 0.820334 -0.046638 0.569575 
time: 1403636975.251667, t: 4.046729 -3.578206 -0.829728 q: 0.066872 0.812537 -0.113124 0.567904 
time: 1403636975.651666, t: 4.057467 -3.607838 -0.859289 q: 0.080664 0.813481 -0.115980 0.564172 
time: 1403636976.051666, t: 4.099426 -3.625525 -0.834130 q: 0.088477 0.812049 -0.138352 0.560006 
time: 1403636976.451667, t: 4.134795 -3.676659 -0.866538 q: 0.120524 0.778571 -0.236114 0.568815 
time: 1403636976.851666, t: 4.126690 -3.772687 -0.978689 q: 0.178028 0.773615 -0.271823 0.544003 
time: 1403636977.251667, t: 4.119401 -3.883714 -1.055112 q: 0.168182 0.777825 -0.281822 0.535985 
time: 1403636977.651666, t: 4.115434 -4.035947 -1.093909 q: 0.173318 0.770125 -0.263946 0.554257 
time: 1403636978.051666, t: 4.102533 -4.205659 -1.193503 q: 0.175074 0.767200 -0.278035 0.550863 
time: 1403636978.451667, t: 4.066322 -4.385409 -1.196937 q: 0.185221 0.777218 -0.277833 0.533324 
time: 1403636978.851666, t: 4.070965 -4.577407 -1.193073 q: 0.182193 0.789459 -0.283926 0.512783 
time: 1403636979.251667, t: 4.150352 -4.793083 -1.267301 q: 0.192163 0.771105 -0.276551 0.540361 
time: 1403636979.651666, t: 4.256541 -4.988482 -1.322985 q: 0.184639 0.786242 -0.283177 0.517245 
time: 1403636980.051666, t: 4.435371 -5.198644 -1.296435 q: 0.198650 0.775080 -0.282890 0.528926 
time: 1403636980.451667, t: 4.655952 -5.394775 -1.331096 q: 0.199858 0.763174 -0.287139 0.543299 
time: 1403636980.851666, t: 4.871104 -5.568109 -1.396199 q: 0.196196 0.764717 -0.284733 0.543730 
time: 1403636981.251667, t: 5.080023 -5.720894 -1.412718 q: 0.188101 0.764591 -0.289452 0.544276 
time: 1403636981.651666, t: 5.251153 -5.860304 -1.476546 q: 0.201069 0.767877 -0.289712 0.534793 
time: 1403636982.051666, t: 5.414086 -5.990153 -1.459061 q: 0.201922 0.783225 -0.299853 0.505841 
time: 1403636982.451667, t: 5.664350 -6.158832 -1.460179 q: 0.189063 0.771859 -0.310275 0.521746 
time: 1403636982.851666, t: 5.936322 -6.397617 -1.427504 q: 0.189456 0.770264 -0.302218 0.528643 
time: 1403636983.251667, t: 6.203223 -6.668509 -1.452300 q: 0.202748 0.766191 -0.291078 0.535834 
time: 1403636983.651666, t: 6.469694 -6.921083 -1.524333 q: 0.207859 0.768829 -0.292119 0.529493 
time: 1403636984.051666, t: 6.754601 -7.138290 -1.490989 q: 0.207799 0.776516 -0.299539 0.513924 
time: 1403636984.451667, t: 7.081782 -7.353510 -1.467989 q: 0.216924 0.765324 -0.299713 0.526683 
time: 1403636985.251667, t: 7.779419 -7.690781 -1.460542 q: 0.215193 0.761621 -0.302070 0.531393 
time: 1403636985.651666, t: 8.145344 -7.817948 -1.484041 q: 0.210695 0.771496 -0.275181 0.533551 
time: 1403636986.051666, t: 8.521467 -7.886929 -1.446358 q: 0.217826 0.750318 -0.249113 0.572292 
time: 1403636986.451667, t: 8.845779 -7.844534 -1.506640 q: 0.198750 0.773485 -0.261808 0.541919 
time: 1403636986.851666, t: 9.141012 -7.746168 -1.511919 q: 0.177776 0.769729 -0.275791 0.547587 
time: 1403636987.251667, t: 9.394786 -7.654394 -1.404713 q: 0.188506 0.766346 -0.274028 0.549625 
time: 1403636987.651666, t: 9.614810 -7.551820 -1.360908 q: 0.194695 0.760228 -0.259962 0.562643 
optimize pose graph 
time: 1403636988.051666, t: 9.762827 -7.403713 -1.315273 q: 0.173074 0.764295 -0.265339 0.561688 
time: 1403636988.451667, t: 9.836841 -7.254503 -1.273078 q: 0.163399 0.753165 -0.274210 0.575197 
time: 1403636988.851666, t: 9.777334 -7.124161 -1.193442 q: 0.167066 0.744936 -0.271264 0.586153 
time: 1403636989.251667, t: 9.564283 -7.002581 -1.173182 q: 0.167800 0.741341 -0.273189 0.589597 
time: 1403636989.651666, t: 9.212121 -6.882263 -1.113933 q: 0.183389 0.768917 -0.268019 0.550728 
optimize pose graph 
time: 1403636990.451667, t: 8.461154 -6.599582 -1.002367 q: 0.188744 0.769093 -0.260301 0.552373 
time: 1403636990.851666, t: 8.080673 -6.415534 -0.967337 q: 0.184521 0.776464 -0.256638 0.545155 
time: 1403636991.251667, t: 7.733011 -6.226355 -1.009045 q: 0.185820 0.776461 -0.256900 0.544593 
time: 1403636992.051666, t: 7.120186 -5.862067 -0.877242 q: 0.179298 0.770598 -0.280013 0.543713 
time: 1403636992.451667, t: 6.839428 -5.729236 -0.850846 q: 0.195892 0.769688 -0.277192 0.540715 
time: 1403636992.851666, t: 6.591308 -5.593464 -0.805757 q: 0.202271 0.773109 -0.281863 0.530982 
time: 1403636993.251667, t: 6.400219 -5.449468 -0.790961 q: 0.192926 0.766063 -0.277825 0.546571 
time: 1403636993.651666, t: 6.218538 -5.291107 -0.703007 q: 0.150062 0.783604 -0.221057 0.560875 
time: 1403636994.051666, t: 6.019477 -5.132713 -0.633475 q: 0.135411 0.789047 -0.188868 0.568681 
time: 1403636994.451667, t: 5.796095 -4.943484 -0.640087 q: 0.141230 0.774007 -0.181324 0.589991 
time: 1403636994.851666, t: 5.502186 -4.699793 -0.626685 q: 0.114999 0.788325 -0.203625 0.569084 
time: 1403636995.251667, t: 5.173337 -4.479575 -0.606260 q: 0.127959 0.781200 -0.193917 0.579439 
time: 1403636995.651666, t: 4.806656 -4.258066 -0.509700 q: 0.127111 0.790073 -0.190134 0.568750 
time: 1403636996.051666, t: 4.423317 -4.038122 -0.436909 q: 0.114032 0.792624 -0.201599 0.564005 
time: 1403636996.451667, t: 4.055869 -3.868841 -0.372288 q: 0.120942 0.798380 -0.185497 0.559958 
time: 1403636996.851666, t: 3.723645 -3.704333 -0.264651 q: 0.081517 0.812334 -0.125467 0.563672 
time: 1403636997.251667, t: 3.439352 -3.559828 -0.290924 q: 0.031766 0.822352 -0.060460 0.564866 
time: 1403636997.651666, t: 3.214442 -3.437923 -0.296889 q: 0.025632 0.824643 -0.047282 0.563091 
optimize pose graph 
time: 1403636998.051666, t: 3.074885 -3.340698 -0.186534 q: 0.033983 0.826035 -0.053363 0.560057 
time: 1403636998.451667, t: 3.003366 -3.253389 -0.056625 q: 0.034300 0.824548 -0.061731 0.561368 
time: 1403636998.851666, t: 2.963467 -3.177941 0.087364 q: 0.047091 0.807038 -0.057000 0.585853 
time: 1403636999.251667, t: 2.890159 -3.078305 0.194542 q: 0.057663 0.809320 -0.052628 0.582157 
time: 1403636999.651666, t: 2.811031 -2.940774 0.213725 q: 0.047382 0.806791 -0.062613 0.585595 
time: 1403637000.051666, t: 2.687938 -2.790452 0.193320 q: 0.054876 0.806302 -0.059227 0.585967 
time: 1403637000.451667, t: 2.534442 -2.606687 0.221815 q: 0.052724 0.809654 -0.060920 0.581351 
time: 1403637000.851666, t: 2.362637 -2.400726 0.256444 q: 0.051235 0.807692 -0.063427 0.583939 
time: 1403637001.251667, t: 2.167521 -2.184341 0.284976 q: 0.049847 0.807036 -0.067211 0.584543 
time: 1403637001.651666, t: 1.941289 -1.970221 0.347908 q: 0.046065 0.812550 -0.073352 0.576420 
time: 1403637002.051666, t: 1.707242 -1.773352 0.361196 q: 0.049318 0.814186 -0.073915 0.573764 
time: 1403637002.451667, t: 1.487504 -1.587353 0.327082 q: 0.052793 0.814943 -0.071744 0.572655 
time: 1403637002.851666, t: 1.280644 -1.393480 0.367671 q: 0.056671 0.814510 -0.071582 0.572920 
time: 1403637003.251667, t: 1.079036 -1.195730 0.350925 q: 0.056107 0.813733 -0.078222 0.573212 
time: 1403637003.651666, t: 0.891572 -0.996164 0.356643 q: 0.054024 0.810312 -0.083970 0.577429 
time: 1403637004.051666, t: 0.703739 -0.807006 0.375565 q: 0.055427 0.817313 -0.078570 0.568114 
time: 1403637004.451667, t: 0.541334 -0.626926 0.359940 q: 0.050367 0.816674 -0.078514 0.569510 
time: 1403637004.851666, t: 0.384875 -0.473701 0.442278 q: 0.034836 0.810148 -0.100850 0.576433 
time: 1403637005.251667, t: 0.241036 -0.377780 0.389071 q: 0.055342 0.816208 -0.092909 0.567547 
time: 1403637005.651666, t: 0.127408 -0.300203 0.310256 q: 0.054563 0.817176 -0.085716 0.567361 
time: 1403637006.051666, t: 0.030076 -0.225672 0.334120 q: 0.052621 0.815686 -0.083683 0.569986 
time: 1403637006.451667, t: -0.035884 -0.169076 0.338782 q: 0.042314 0.827136 -0.090371 0.553071 
time: 1403637006.851666, t: -0.049504 -0.140324 0.325842 q: 0.023024 0.816105 -0.058482 0.574476 
time: 1403637007.251667, t: -0.061226 -0.135917 0.286765 q: -0.008176 0.814811 0.011434 0.579556 
time: 1403637007.651666, t: -0.087097 -0.132242 0.236669 q: -0.012243 0.819336 0.026689 0.572561 
time: 1403637008.051666, t: -0.117430 -0.102544 0.197677 q: -0.017861 0.814041 0.013666 0.580373 
time: 1403637008.451667, t: -0.135915 -0.069060 0.183679 q: -0.005520 0.828550 0.010587 0.559788 
time: 1403637008.851666, t: -0.114538 -0.030703 0.184946 q: -0.031482 0.821436 -0.015739 0.569214 
time: 1403637009.251667, t: -0.078969 -0.058093 0.130901 q: 0.000913 0.822263 0.001902 0.569104 
time: 1403637009.651666, t: -0.057860 -0.094899 0.097849 q: -0.052450 0.785319 0.010440 0.616778 
time: 1403637010.051666, t: -0.069977 -0.096193 0.094800 q: -0.050099 0.791559 -0.003184 0.609027 
time: 1403637010.451667, t: -0.074186 -0.096616 0.096221 q: -0.049607 0.791854 -0.003009 0.608685 

Done.
killing:
 * /loop_fusion
 * /rosout
 * /vins_estimator
[33m[ WARN] [1720549990.928613974]: Shutdown request received.[0m
[33m[ WARN] [1720549990.928654226]: Reason given for shutdown: [user request][0m
[33m[ WARN] [1720549990.929544242]: Shutdown request received.[0m
[33m[ WARN] [1720549990.929570677]: Reason given for shutdown: [user request][0m
killed
