/SLAM-Hive/slam_hive_results/mapping_results/692/344_orb-slam3-ros-stereo-inertial+MH_01_easy+comb_test_2-32.yamlERROR: Unable to communicate with master!
... logging to /root/.ros/log/35a97cde-173b-11ef-9265-0242ac110005/roslaunch-4949dc314fd4-70.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://4949dc314fd4:34755/[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 [85][0m
[1mROS_MASTER_URI=http://localhost:11311[0m
]2;/slamhive/stereo-inertial.launch http://localhost:11311
[1msetting /run_id to 35a97cde-173b-11ef-9265-0242ac110005[0m
[1mprocess[rosout-1]: started with pid [96][0m
started core service [/rosout]
[1mprocess[orb_node-2]: started with pid [102][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: 435.205
- fy: 435.205
- cx: 367.452
- cy: 252.201
- k1: 0
- k2: 0
- p1: 0
- p2: 0
- fps: 5
- color order: RGB (ignored if grayscale)

Depth Threshold (Close/Far Points): 3.85272

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: 50 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] [1716272874.380628222]: 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 272 points
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
3 Frames set to lost
not IMU meas
First KF:2; Map init KF:0
New Map created with 537 points
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 = 5
mnInitialFrameId = 3
8 Frames set to lost
not IMU meas
First KF:5; Map init KF:2
New Map created with 540 points
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 = 11
mnInitialFrameId = 9
12 Frames set to lost
not IMU meas
First KF:8; Map init KF:5
New Map created with 338 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()
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 = 16
mnInitialFrameId = 14
16 Frames set to lost
not IMU meas
First KF:10; Map init KF:8
New Map created with 375 points
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 = 21
mnInitialFrameId = 19
21 Frames set to lost
not IMU meas
First KF:14; Map init KF:10
New Map created with 318 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()
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 = 27
mnInitialFrameId = 25
34 Frames set to lost
not IMU meas
First KF:21; Map init KF:14
New Map created with 353 points
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 = 41
mnInitialFrameId = 39
46 Frames set to lost
not IMU meas
First KF:27; Map init KF:21
New Map created with 382 points
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 = 54
mnInitialFrameId = 52
49 Frames set to lost
not IMU meas
First KF:30; Map init KF:27
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()
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()
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 = 58
mnInitialFrameId = 56
52 Frames set to lost
not IMU meas
First KF:32; Map init KF:30
New Map created with 261 points
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 = 62
mnInitialFrameId = 60
55 Frames set to lost
not IMU meas
First KF:34; Map init KF:32
New Map created with 174 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
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 = 66
mnInitialFrameId = 64
146 Frames set to lost
not IMU meas
First KF:74; Map init KF:34
New Map created with 206 points
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 = 158
mnInitialFrameId = 156
163 Frames set to lost
not IMU meas
First KF:86; Map init KF:74
New Map created with 504 points
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 = 176
mnInitialFrameId = 174
172 Frames set to lost
not IMU meas
First KF:93; Map init KF:86
New Map created with 603 points
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 = 186
mnInitialFrameId = 184
183 Frames set to lost
not IMU meas
First KF:100; Map init KF:93
New Map created with 589 points
start VIBA 1
end VIBA 1
start VIBA 2
end VIBA 2
Timestamp jump detected. State set to LOST. Reseting IMU integration...
Creation of new map with id: 1
Stored map with ID: 0
Creation of new map with last KF id: 224
not IMU meas
not IMU meas
not enough acceleration
First KF:224; Map init KF:224
New Map created with 549 points
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 = 198
mnInitialFrameId = 341
90 Frames set to lost
not IMU meas
First KF:228; Map init KF:224
New Map created with 565 points
start VIBA 1
end VIBA 1
Timestamp jump detected. State set to LOST. Reseting IMU integration...
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 = 198
mnInitialFrameId = 349
100 Frames set to lost
not IMU meas
First KF:240; Map init KF:228
New Map created with 441 points
start VIBA 1
end VIBA 1
Timestamp jump detected. State set to LOST. Reseting IMU integration...
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 = 198
mnInitialFrameId = 369
110 Frames set to lost
not IMU meas
First KF:265; Map init KF:240
New Map created with 619 points
start VIBA 1
end VIBA 1
Timestamp jump detected. State set to LOST. Reseting IMU integration...
LM: Active map reset recieved
LM: Active map reset, waiting...
mnFirstFrameId = 198
mnInitialFrameId = 401
111 Frames set to lost
not IMU meas
First KF:292; Map init KF:265
New Map created with 577 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()
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()
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 = 198
mnInitialFrameId = 436
79 Frames set to lost
not IMU meas
not enough acceleration
First KF:294; Map init KF:292
New Map created with 580 points
start VIBA 1
end VIBA 1
start VIBA 2
end VIBA 2
Fail to track local map!
Fail to track local map!
Fail to track local map!
Fail to track local map!
Fail to track local map!

Done.
killing:
 * /orb_node
 * /rosout
[33m[ WARN] [1716273067.942357823, 1403636766.693473892]: Shutdown request received.[0m
[33m[ WARN] [1716273067.943334081, 1403636766.693473892]: Reason given for shutdown: [user request][0m
[33m[ WARN] [1716273067.961033924, 1403636766.693473892]: Shutdown request received.[0m
[33m[ WARN] [1716273067.961071164, 1403636766.693473892]: 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/35a97cde-173b-11ef-9265-0242ac110005/rosout-1*.log[0m
[31m[orb_node-2] process has died [pid 102, 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/35a97cde-173b-11ef-9265-0242ac110005/orb_node-2.log].
log file: /root/.ros/log/35a97cde-173b-11ef-9265-0242ac110005/orb_node-2*.log[0m
[rosout-1] restarting process
[1mprocess[rosout-1]: started with pid [1417][0m
