/SLAM-Hive/slam_hive_results/mapping_results/657/308_orb-slam3-ros-stereo-inertial+MH_01_easy+comb_test-5.yamlERROR: Unable to communicate with master!
... logging to /root/.ros/log/06b9eade-1480-11ef-833c-0242ac110003/roslaunch-7cf544a27288-71.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
]2;/slamhive/stereo-inertial.launch
[1mstarted roslaunch server http://7cf544a27288:41669/[0m

SUMMARY
========

PARAMETERS
 * /rosdistro: melodic
 * /rosversion: 1.14.13
 * /use_sim_time: True

NODES
  /
    orb_node (ORB_SLAM3/Stereo_Inertial)

auto-starting new master
[1mprocess[master]: started with pid [86][0m
[1mROS_MASTER_URI=http://localhost:11311[0m
]2;/slamhive/stereo-inertial.launch http://localhost:11311
[1msetting /run_id to 06b9eade-1480-11ef-833c-0242ac110003[0m
[1mprocess[rosout-1]: started with pid [97][0m
started core service [/rosout]
[1mprocess[orb_node-2]: started with pid [103][0m

ORB-SLAM3 Copyright (C) 2017-2020 Carlos Campos, Richard Elvira, Juan J. Gómez, José M.M. Montiel and Juan D. Tardós, University of Zaragoza.
ORB-SLAM2 Copyright (C) 2014-2016 Raúl Mur-Artal, José M.M. Montiel and Juan D. Tardós, University of Zaragoza.
This program comes with ABSOLUTELY NO WARRANTY;
This is free software, and you are welcome to redistribute it
under certain conditions. See LICENSE.txt.

Input sensor was set to: Stereo-Inertial

Loading ORB Vocabulary. This could take a while...
Vocabulary loaded!

Initialization of Atlas from scratch 
Creation of new map with id: 0
Creation of new map with last KF id: 0
Seq. Name: 

Camera Parameters: 
- Camera: Pinhole
- Image scale: 1
- fx: 217.602
- fy: 217.602
- cx: 183.726
- cy: 126.1
- k1: 0
- k2: 0
- p1: 0
- p2: 0
- fps: 10
- color order: RGB (ignored if grayscale)

Depth Threshold (Close/Far Points): 7.70545

ORB Extractor Parameters: 
- Number of Features: 1000
- Scale Levels: 8
- Scale Factor: 1.2
- Initial Fast Threshold: 20
- Minimum Fast Threshold: 7

Left camera to Imu Transform (Tbc): 
[0.014865543, -0.99988091, 0.004140297, -0.021640146;
 0.99955726, 0.014967213, 0.02571553, -0.064676985;
 -0.025774436, 0.0037561883, 0.99966073, 0.0098107308;
 0, 0, 0, 1]

IMU frequency: 200 Hz
IMU gyro noise: 0.00017 rad/s/sqrt(Hz)
IMU gyro walk: 1.9393e-05 rad/s^2/sqrt(Hz)
IMU accelerometer noise: 0.002 m/s^2/sqrt(Hz)
IMU accelerometer walk: 0.003 m/s^3/sqrt(Hz)
There are 1 cameras in the atlas
Camera 0 is pinhole
rosbag play /slamhive/dataset/MH_01_easy.bag /cam0/image_raw:=/camera/left/image_raw /cam1/image_raw:=/camera/right/image_raw /imu0:=/imu --clock 
[0m[ INFO] [1715972577.412792604]: Opening /slamhive/dataset/MH_01_easy.bag[0m

Waiting 0.2 seconds after advertising topics...not IMU meas
First KF:0; Map init KF:0
New Map created with 377 points
start VIBA 1
end VIBA 1
Fail to track local map!
IMU is not or recently initialized. Reseting active map...
LM: Active map reset recieved
LM: Active map reset, waiting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
LM: Active map reset, Done!!!
mnFirstFrameId = 1
mnInitialFrameId = 0
118 Frames set to lost
not IMU meas
First KF:89; Map init KF:0
New Map created with 460 points
virtual int g2o::SparseOptimizer::optimize(int, bool): 0 vertices to optimize, maybe forgot to call initializeOptimization()
virtual int g2o::SparseOptimizer::optimize(int, bool): 0 vertices to optimize, maybe forgot to call initializeOptimization()
Fail to track local map!
IMU is not or recently initialized. Reseting active map...
LM: Active map reset recieved
LM: Active map reset, waiting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
LM: Active map reset, Done!!!
mnFirstFrameId = 120
mnInitialFrameId = 118
123 Frames set to lost
not IMU meas
First KF:93; Map init KF:89
New Map created with 348 points
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
Not enough motion for initializing. Reseting...
LM: Reseting current map in Local Mapping...
LM: End reseting Local Mapping...
LM: Reset free the mutex
start VIBA 1
end VIBA 1
start VIBA 2
end VIBA 2
*Loop detected
*Loop detected
phi =  0.034910881623365107 -0.024917011698535475 -0.039151529415623228
BAD LOOP!!!
*Loop detected
phi =  0.031861718734286899 -0.031229996935228273  -0.04445430928240679
BAD LOOP!!!
*Loop detected
phi =  0.032014896356801506 -0.027649919698483336 -0.040057765514513025
BAD LOOP!!!
*Loop detected
phi =  0.030331948368921842 -0.034826663015389475 -0.043729146809151277
BAD LOOP!!!
*Loop detected
phi =  0.037842131841968739 -0.029473355596996431 -0.042021356447121114
BAD LOOP!!!
*Loop detected
phi =  0.035002039804301104 -0.033474092819114239 -0.041900617078904391
BAD LOOP!!!
*Loop detected
phi =  0.031225397708557603 -0.026199483311065842 -0.045518605387039245
BAD LOOP!!!
*Loop detected
phi =  0.041558226922824841 -0.039026550440740035 -0.046202017482465815
BAD LOOP!!!
*Loop detected
phi =  0.038935279268519488 -0.024636479135756121 -0.050041661261507574
BAD LOOP!!!

Done.
killing:
 * /orb_node
 * /rosout
[33m[ WARN] [1715972770.890386814, 1403636766.692136555]: Shutdown request received.[0m
[33m[ WARN] [1715972770.891320906, 1403636766.692136555]: Reason given for shutdown: [user request][0m
[33m[ WARN] [1715972770.907417643, 1403636766.692136555]: Shutdown request received.[0m
[33m[ WARN] [1715972770.907489369, 1403636766.692136555]: Reason given for shutdown: [user request][0m
killed
Shutdown

Saving keyframe trajectory to KeyFrameTrajectory_TUM_Format.txt ...

Saving camera trajectory to FrameTrajectory_TUM_Format.txt ...

Saving camera trajectory to FrameTrajectory_KITTI_Format.txt ...
Map Saving to Map.pcd
Map Saving Finished!
terminate called without an active exception
[1m[rosout-1] process has finished cleanly
log file: /root/.ros/log/06b9eade-1480-11ef-833c-0242ac110003/rosout-1*.log[0m
[rosout-1] restarting process
[1mprocess[rosout-1]: started with pid [2672][0m
[31m[orb_node-2] process has died [pid 103, exit code -6, cmd /home/ORB_SLAM3/Examples/ROS/ORB_SLAM3/Stereo_Inertial /home/ORB_SLAM3/Vocabulary/ORBvoc.txt /slamhive/mappingtask.yaml true /camera/left/image_raw:=/camera/left/image_raw /camera/right/image_raw:=/camera/right/image_raw /imu:=/imu __name:=orb_node __log:=/root/.ros/log/06b9eade-1480-11ef-833c-0242ac110003/orb_node-2.log].
log file: /root/.ros/log/06b9eade-1480-11ef-833c-0242ac110003/orb_node-2*.log[0m
