These are my Isaac Ros VSlam parameters. I am getting the below error and the odometry drifts or the robot suddenly teleports to some other place. I am using nvblox and running the nvblox_realsense example launch file.
/visual_slam_node:
ros__parameters:
accel_noise_density: 0.002
accel_random_walk: 0.0035
base_frame: base_footprint
calibration_frequency: 200.0
camera_optical_frames:
- camera0_infra1_optical_frame
- camera0_infra2_optical_frame
debug_dump_path: /tmp/cuvslam
debug_imu_mode: false
enable_debug_mode: false
enable_ground_constraint_in_odometry: true
enable_ground_constraint_in_slam: true
enable_image_denoising: false
enable_imu_fusion: true
enable_landmarks_view: false
enable_localization_n_mapping: true
enable_observations_view: false
enable_request_hint: true
enable_slam_visualization: false
gyro_noise_density: 0.0003
gyro_random_walk: 2.0e-05
image_buffer_size: 10
image_jitter_threshold_ms: 40.0
image_qos: SYSTEM_DEFAULT
image_qos_depth: 0
img_mask_bottom: 0
img_mask_left: 0
img_mask_right: 0
img_mask_top: 0
imu_buffer_size: 50
imu_frame: camera0_gyro_optical_frame
imu_jitter_threshold_ms: 200.0
imu_qos: SYSTEM_DEFAULT
imu_qos_depth: 0
invert_map_to_odom_tf: false
invert_odom_to_base_tf: false
load_map_folder_path: /home/nvidia/shared/vslam
localize_on_startup: false
localizer_angular_step: 0.1745000034570694
localizer_horizontal_radius: 1.5
localizer_horizontal_step: 0.5
localizer_vertical_radius: 0.5
localizer_vertical_step: 0.25
map_frame: map
min_num_images: 2
multicam_mode: 1
num_cameras: 2
odom_frame: odom
override_publishing_stamp: false
path_max_size: 200
publish_map_to_odom_tf: true
publish_odom_to_base_tf: true
qos_overrides:
/parameter_events:
publisher:
depth: 1000
durability: volatile
history: keep_last
reliability: reliable
/tf:
publisher:
depth: 100
durability: volatile
history: keep_last
reliability: reliable
/tf_static:
publisher:
depth: 1
history: keep_last
reliability: reliable
rectified_images: true
save_map_folder_path: /home/nvidia/shared/vslam
slam_max_map_size: 300
slam_throttling_time_ms: 500
sync_matching_threshold_ms: 5.0
use_sim_time: false
verbosity: 2
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033391 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033391 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033392 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033390 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 4, Frame time delta = 0.033392 [s], drop ratio = 66.666672 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 1, Frame time delta = 0.033384 [s], drop ratio = 16.666668 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033384 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033385 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 1, Frame time delta = 0.033383 [s], drop ratio = 16.666668 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033384 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 3, Frame time delta = 0.033387 [s], drop ratio = 50.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033388 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 2, Frame time delta = 0.033388 [s], drop ratio = 33.333336 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 2, Frame time delta = 0.033389 [s], drop ratio = 33.333336 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033386 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033387 [s], drop ratio = 100.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 3, Frame time delta = 0.033386 [s], drop ratio = 50.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 3, Frame time delta = 0.033385 [s], drop ratio = 50.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 3, Frame time delta = 0.033386 [s], drop ratio = 50.000000 [%]
[component_container_mt-5] [WARNING] Lost IMU msgs: 6, Frame time delta = 0.033387 [s], drop ratio = 100.000000 [%]