Skip to content

D555 not publishing aligned_depth_to_color #3546

Description

@peterkappelt

Hi everyone,

I'm currently trying to set up a new D555 camera we just got. We are coming from a setup with a D455, where we used this config and start the wrapper with ros2 launch realsense2_camera rs_launch.py config_file:=./realsense_d455.yaml:

realsense_d455.yaml
camera_name: "realsense_d455"
device_type: "d455"
camera_namespace: ""
initial_reset: false
accelerate_gpu_with_glsl: false
log_level: "info"
output: "screen"
enable_color: true
rgb_camera.color_profile: "848x480x30"
rgb_camera.color_format: "BGR8"
rgb_camera.enable_auto_exposure: true
enable_infra: false
enable_infra1: true
enable_infra2: true
enable_depth: true
depth_module.depth_profile: "848x480x30"
depth_module.depth_format: "Z16"
depth_module.infra_profile: "848x480x30"
depth_module.infra_format: "RGB8"
depth_module.infra1_format: "Y8"
depth_module.infra2_format: "Y8"
depth_module.emitter_enabled: 0
depth_module.exposure: 8500
depth_module.gain: 16
depth_module.hdr_enabled: false
depth_module.enable_auto_exposure: true
depth_module.exposure.1: 7500
depth_module.gain.1: 16
depth_module.exposure.2: 1
depth_module.gain.2: 16
enable_sync: true
enable_rgbd: true
enable_gyro: true
enable_accel: true
gyro_fps: 200
accel_fps: 200
unite_imu_method: 2
clip_distance: -2.0
angular_velocity_cov: 0.01
linear_accel_cov: 0.01
diagnostics_period: 0.0
publish_tf: true
tf_publish_rate: 0.0
pointcloud.enable: false
pointcloud.stream_filter: 2
pointcloud.stream_index_filter: 0
pointcloud.ordered_pc: false
pointcloud.allow_no_texture_points: false
align_depth.enable: true
colorizer.enable: false
decimation_filter.enable: false
spatial_filter.enable: false
temporal_filter.enable: false
disparity_filter.enable: false
hole_filling_filter.enable: false
hdr_merge.enable: false
wait_for_device_timeout: -1.0
reconnect_timeout: 6.0

This works as expected and we get some output:

# ros2 topic hz /camera/camera/aligned_depth_to_color/image_raw
average rate: 30.575
        min: 0.013s max: 0.052s std dev: 0.00775s window: 29
average rate: 30.260
        min: 0.013s max: 0.052s std dev: 0.00545s window: 59
average rate: 30.159
        min: 0.013s max: 0.052s std dev: 0.00444s window: 89
average rate: 30.112
        min: 0.013s max: 0.052s std dev: 0.00512s window: 119

I tweaked the config slightly to work with a D555, only by changing the stream resolution to a supported value and the device_type filter:

realsense_d555.yaml
camera_name: "realsense_d555"
device_type: "d555"
camera_namespace: ""
initial_reset: false
accelerate_gpu_with_glsl: false
log_level: "info"
output: "screen"
enable_color: true
rgb_camera.color_profile: "896x504x30"
rgb_camera.color_format: "BGR8"
rgb_camera.enable_auto_exposure: true
enable_infra: false
enable_infra1: true
enable_infra2: true
enable_depth: true
depth_module.depth_profile: "896x504x30"
depth_module.depth_format: "Z16"
depth_module.infra_profile: "896x504x30"
depth_module.infra_format: "RGB8"
depth_module.infra1_format: "Y8"
depth_module.infra2_format: "Y8"
depth_module.emitter_enabled: 0
depth_module.exposure: 8500
depth_module.gain: 16
depth_module.hdr_enabled: false
depth_module.enable_auto_exposure: true
depth_module.exposure.1: 7500
depth_module.gain.1: 16
depth_module.exposure.2: 1
depth_module.gain.2: 16
enable_sync: true
enable_rgbd: true
enable_gyro: true
enable_accel: true
gyro_fps: 200
accel_fps: 200
unite_imu_method: 2
clip_distance: -2.0
angular_velocity_cov: 0.01
linear_accel_cov: 0.01
diagnostics_period: 0.0
publish_tf: true
tf_publish_rate: 0.0
pointcloud.enable: false
pointcloud.stream_filter: 2
pointcloud.stream_index_filter: 0
pointcloud.ordered_pc: false
pointcloud.allow_no_texture_points: false
align_depth.enable: true
colorizer.enable: false
decimation_filter.enable: false
spatial_filter.enable: false
temporal_filter.enable: false
disparity_filter.enable: false
hole_filling_filter.enable: false
hdr_merge.enable: false
wait_for_device_timeout: -1.0
reconnect_timeout: 6.0

However, I don't get anything on the aligned_depth_to_color topic anymore:

# ros2 topic hz /camera/camera/aligned_depth_to_color/image_raw
<no output>
# ros2 topic hz /camera/camera/depth/image_rect_raw
average rate: 55.488
        min: 0.002s max: 0.035s std dev: 0.00811s window: 53
average rate: 56.760
        min: 0.002s max: 0.035s std dev: 0.00751s window: 111
# ros2 topic hz /camera/camera/color/image_raw
average rate: 30.202
        min: 0.022s max: 0.045s std dev: 0.00576s window: 29
average rate: 30.083
        min: 0.022s max: 0.045s std dev: 0.00492s window: 59

Another weird effect I'm observing is that the publishing rate of the depth stream seems higher than expected. Output from the launch looks fine to me:

Launch Log
# ros2 launch realsense2_camera rs_launch.py config_file:=./realsense_d555.yaml
[INFO] [launch]: All log files can be found below /root/.ros/log/2026-07-28-10-56-58-161993-ubuntu-53622
[INFO] [launch]: Default logging verbosity is set to INFO
Warning: Parameter 'depth_module.emitter_enabled' in config file is not supported. Supported parameters are:
['accel_fps', 'accelerate_gpu_with_glsl', 'align_depth.enable', 'angular_velocity_cov', 'base_frame_id', 'camera_name', 'camera_namespace', 'clip_distance', 'colorizer.enable', 'config_file', 'decimation_filter.enable', 'decimation_filter.filter_magnitude', 'depth_mapping_camera.labeled_point_cloud_profile', 'depth_mapping_camera.occupancy_profile', 'depth_module.color_format', 'depth_module.color_profile', 'depth_module.depth_format', 'depth_module.depth_profile', 'depth_module.enable_auto_exposure', 'depth_module.exposure', 'depth_module.exposure.1', 'depth_module.exposure.2', 'depth_module.gain', 'depth_module.gain.1', 'depth_module.gain.2', 'depth_module.hdr_enabled', 'depth_module.infra1_format', 'depth_module.infra2_format', 'depth_module.infra_format', 'depth_module.infra_profile', 'depth_module.inter_cam_sync_mode', 'device_type', 'diagnostics_period', 'disparity_filter.enable', 'enable_accel', 'enable_color', 'enable_depth', 'enable_gyro', 'enable_infra', 'enable_infra1', 'enable_infra2', 'enable_labeled_point_cloud', 'enable_motion', 'enable_occupancy', 'enable_rgbd', 'enable_safety', 'enable_sync', 'gyro_fps', 'hdr_merge.enable', 'hole_filling_filter.enable', 'initial_reset', 'json_file_path', 'linear_accel_cov', 'log_level', 'motion_fps', 'output', 'pointcloud.allow_no_texture_points', 'pointcloud.enable', 'pointcloud.ordered_pc', 'pointcloud.stream_filter', 'pointcloud.stream_index_filter', 'publish_tf', 'reconnect_timeout', 'rgb_camera.color_format', 'rgb_camera.color_profile', 'rgb_camera.enable_auto_exposure', 'rosbag_filename', 'rosbag_loop', 'rotation_filter.enable', 'rotation_filter.rotation', 'safety_camera.safety_mode', 'serial_no', 'spatial_filter.enable', 'temporal_filter.enable', 'tf_prefix', 'tf_publish_rate', 'unite_imu_method', 'usb_port_id', 'wait_for_device_timeout']
[INFO] [launch.user]: 🚀 Launching as Normal ROS Node
[INFO] [realsense2_camera_node-1]: process started with pid [53625]
[realsense2_camera_node-1] [INFO] [1785236218.323239120] [camera.camera]: RealSense ROS v4.58.2
[realsense2_camera_node-1] [INFO] [1785236218.323364112] [camera.camera]: Built with LibRealSense v2.58.2
[realsense2_camera_node-1] [INFO] [1785236218.323393008] [camera.camera]: Running with LibRealSense v2.58.2
[realsense2_camera_node-1]  28/07 10:56:58,324 WARNING [281472695001152] (context.cpp:41) No valid configuration file found at : /root/.realsense-config.json loading defaults
[realsense2_camera_node-1]  28/07 10:56:58,353 WARNING [281472695001152] (ds-motion-common.cpp:452) No HID info provided, IMU is disabled
[realsense2_camera_node-1] [INFO] [1785236218.668026992] [camera.camera]: Device with serial number 409122300454 was found.
[realsense2_camera_node-1]
[realsense2_camera_node-1] [INFO] [1785236218.668170928] [camera.camera]: Device with physical ID /sys/devices/platform/bus@0/3610000.usb/usb2/2-3/2-3.3/2-3.3:1.0/video4linux/video0 was found.
[realsense2_camera_node-1] [INFO] [1785236218.668251696] [camera.camera]: Device with name Intel RealSense D555 was found.
[realsense2_camera_node-1] [INFO] [1785236218.668857552] [camera.camera]: Device with port number 2-3.3 was found.
[realsense2_camera_node-1] [INFO] [1785236218.668953136] [camera.camera]: Device USB type: 3.2
[realsense2_camera_node-1] [INFO] [1785236218.669213552] [camera.camera]: getParameters...
[realsense2_camera_node-1] [WARN] [1785236218.669657072] [camera.camera]: For the 'unite_imu_method' param update to take effect, re-enable either gyro or accel stream.
[realsense2_camera_node-1] [INFO] [1785236218.669811472] [camera.camera]: JSON file is not provided
[realsense2_camera_node-1] [INFO] [1785236218.669871248] [camera.camera]: Device Name: Intel RealSense D555
[realsense2_camera_node-1] [INFO] [1785236218.669918384] [camera.camera]: Device Serial No: 409122300454
[realsense2_camera_node-1] [INFO] [1785236218.669959792] [camera.camera]: Device physical port: /sys/devices/platform/bus@0/3610000.usb/usb2/2-3/2-3.3/2-3.3:1.0/video4linux/video0
[realsense2_camera_node-1] [INFO] [1785236218.670011344] [camera.camera]: Device FW version: 7.56.19919.4144
[realsense2_camera_node-1] [INFO] [1785236218.670051888] [camera.camera]: Device Product ID: 0x0B56
[realsense2_camera_node-1] [INFO] [1785236218.670092720] [camera.camera]: Sync Mode: On
[realsense2_camera_node-1] [WARN] [1785236218.721959696] [camera.camera]: Could not set param: depth_module.emitter_enabled with 1 Range: [0, 1]: parameter 'depth_module.emitter_enabled' has invalid type: expected [bool] got [integer]
[realsense2_camera_node-1] [WARN] [1785236218.746978416] [camera.camera]: re-enable the color stream for the change to take effect.
[realsense2_camera_node-1] [INFO] [1785236218.872682576] [camera.camera]: Stopping Sensor: Depth Module
[realsense2_camera_node-1] [INFO] [1785236218.873083632] [camera.camera]: Stopping Sensor: RGB Camera
[realsense2_camera_node-1] [INFO] [1785236218.965504240] [camera.camera]: Starting Sensor: Depth Module
[realsense2_camera_node-1] [INFO] [1785236219.301223440] [camera.camera]: Open profile: stream_type: Infra(1), Format: Y8, Width: 896, Height: 504, FPS: 30
[realsense2_camera_node-1] [INFO] [1785236219.301381072] [camera.camera]: Open profile: stream_type: Infra(2), Format: Y8, Width: 896, Height: 504, FPS: 30
[realsense2_camera_node-1] [INFO] [1785236219.301470416] [camera.camera]: Open profile: stream_type: Depth(0), Format: Z16, Width: 896, Height: 504, FPS: 30
[realsense2_camera_node-1] [INFO] [1785236219.331604240] [camera.camera]: Starting Sensor: RGB Camera
[realsense2_camera_node-1] [INFO] [1785236219.343739120] [camera.camera]: Open profile: stream_type: Color(0), Format: BGR8, Width: 896, Height: 504, FPS: 30
[realsense2_camera_node-1] [INFO] [1785236219.372669616] [camera.camera]: RealSense Node Is Up!

We are on v4.58.2 with librealsense v2.58.2. We tried both 7.58.38448.10612 and 7.56.19919.4144 for the D555 firmware, both versions show the same effect.

Has anyone seen something similar before? I was hoping to be able to use the D555 as a drop-in replacement for the D455 in my case, at least in USB mode.

Kind regards, Peter

Metadata

Metadata

Assignees

No one assigned

    Labels

    No labels
    No labels

    Type

    No type

    Projects

    No projects

    Milestone

    No milestone

    Relationships

    None yet

    Development

    No branches or pull requests

    Issue actions