Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

/camera/color/image_raw topic not publishing messages when pointcloud is enabled #1962

Closed
Nick-Kou opened this issue Jul 1, 2021 · 28 comments
Labels

Comments

@Nick-Kou
Copy link

Nick-Kou commented Jul 1, 2021

For the current project I am working on I am using a Raspberry Pi 3B+ with the Ros Noetic Image taken from: https://emanual.robotis.com/docs/en/platform/turtlebot3/sbc_setup/

Details are:

  • Operating System: Ubuntu 20.04.2 LTS
  • Kernel: Linux 5.4.0-1039-raspi
  • Architecture: arm64

After successfully the SDK:

cd ~/librealsense
mkdir  build  && cd build
cmake .. -DBUILD_EXAMPLES=true -DCMAKE_BUILD_TYPE=Release -DFORCE_LIBUVC=true
make -j1
sudo make install

And then: sudo apt-get install ros-$ROS_DISTRO-realsense2-camera

I managed to operate the Intel Realsense D435i camera.

When I do a simple launch:
roslaunch realsense2_camera rs_camera.launch
The /camera/color/image_raw topic seems to be publishing fine at the desired FPS shown in rviz.

However, when I to run with point cloud enabled for example:
roslaunch realsense2_camera rs_camera.launch filters:=pointcloud depth_width:=424 color_width:=424 depth_height:=240 color_height:=240 depth_fps:=15 color_fps:=15 pointcloud_texture_stream:=RS2_STREAM_ANY

The pointcloud2 messages are being published, however, the /camera/color/image_raw topic doesn't seem to be publishing anymore as shown in the image below

Rviz

I was wondering why the topics (point cloud and camera image) can't be published together.

roslaunch realsense2_camera rs_camera.launch filters:=pointcloud depth_width:=424 color_width:=424 depth_height:=240 color_height:=240 depth_fps:=15 color_fps:=15 pointcloud_texture_stream:=RS2_STREAM_ANY
... logging to /home/ubuntu/.ros/log/de7d655e-da4a-11eb-9870-b92bd22f468a/roslaunch-ubuntu-3539.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.

started roslaunch server http://192.168.2.144:41675/

SUMMARY

PARAMETERS

  • /camera/realsense2_camera/accel_fps: -1
  • /camera/realsense2_camera/accel_frame_id: camera_accel_frame
  • /camera/realsense2_camera/accel_optical_frame_id: camera_accel_opti...
  • /camera/realsense2_camera/align_depth: False
  • /camera/realsense2_camera/aligned_depth_to_color_frame_id: camera_aligned_de...
  • /camera/realsense2_camera/aligned_depth_to_fisheye1_frame_id: camera_aligned_de...
  • /camera/realsense2_camera/aligned_depth_to_fisheye2_frame_id: camera_aligned_de...
  • /camera/realsense2_camera/aligned_depth_to_fisheye_frame_id: camera_aligned_de...
  • /camera/realsense2_camera/aligned_depth_to_infra1_frame_id: camera_aligned_de...
  • /camera/realsense2_camera/aligned_depth_to_infra2_frame_id: camera_aligned_de...
  • /camera/realsense2_camera/allow_no_texture_points: False
  • /camera/realsense2_camera/base_frame_id: camera_link
  • /camera/realsense2_camera/calib_odom_file:
  • /camera/realsense2_camera/clip_distance: -2.0
  • /camera/realsense2_camera/color_fps: 15
  • /camera/realsense2_camera/color_frame_id: camera_color_frame
  • /camera/realsense2_camera/color_height: 240
  • /camera/realsense2_camera/color_optical_frame_id: camera_color_opti...
  • /camera/realsense2_camera/color_width: 424
  • /camera/realsense2_camera/confidence_fps: -1
  • /camera/realsense2_camera/confidence_height: -1
  • /camera/realsense2_camera/confidence_width: -1
  • /camera/realsense2_camera/depth_fps: 15
  • /camera/realsense2_camera/depth_frame_id: camera_depth_frame
  • /camera/realsense2_camera/depth_height: 240
  • /camera/realsense2_camera/depth_optical_frame_id: camera_depth_opti...
  • /camera/realsense2_camera/depth_width: 424
  • /camera/realsense2_camera/device_type:
  • /camera/realsense2_camera/enable_accel: False
  • /camera/realsense2_camera/enable_color: True
  • /camera/realsense2_camera/enable_confidence: True
  • /camera/realsense2_camera/enable_depth: True
  • /camera/realsense2_camera/enable_fisheye1: False
  • /camera/realsense2_camera/enable_fisheye2: False
  • /camera/realsense2_camera/enable_fisheye: False
  • /camera/realsense2_camera/enable_gyro: False
  • /camera/realsense2_camera/enable_infra1: False
  • /camera/realsense2_camera/enable_infra2: False
  • /camera/realsense2_camera/enable_infra: False
  • /camera/realsense2_camera/enable_pointcloud: False
  • /camera/realsense2_camera/enable_pose: False
  • /camera/realsense2_camera/enable_sync: False
  • /camera/realsense2_camera/filters: pointcloud
  • /camera/realsense2_camera/fisheye1_frame_id: camera_fisheye1_f...
  • /camera/realsense2_camera/fisheye1_optical_frame_id: camera_fisheye1_o...
  • /camera/realsense2_camera/fisheye2_frame_id: camera_fisheye2_f...
  • /camera/realsense2_camera/fisheye2_optical_frame_id: camera_fisheye2_o...
  • /camera/realsense2_camera/fisheye_fps: -1
  • /camera/realsense2_camera/fisheye_frame_id: camera_fisheye_frame
  • /camera/realsense2_camera/fisheye_height: -1
  • /camera/realsense2_camera/fisheye_optical_frame_id: camera_fisheye_op...
  • /camera/realsense2_camera/fisheye_width: -1
  • /camera/realsense2_camera/gyro_fps: -1
  • /camera/realsense2_camera/gyro_frame_id: camera_gyro_frame
  • /camera/realsense2_camera/gyro_optical_frame_id: camera_gyro_optic...
  • /camera/realsense2_camera/imu_optical_frame_id: camera_imu_optica...
  • /camera/realsense2_camera/infra1_frame_id: camera_infra1_frame
  • /camera/realsense2_camera/infra1_optical_frame_id: camera_infra1_opt...
  • /camera/realsense2_camera/infra2_frame_id: camera_infra2_frame
  • /camera/realsense2_camera/infra2_optical_frame_id: camera_infra2_opt...
  • /camera/realsense2_camera/infra_fps: 30
  • /camera/realsense2_camera/infra_height: 480
  • /camera/realsense2_camera/infra_rgb: False
  • /camera/realsense2_camera/infra_width: 848
  • /camera/realsense2_camera/initial_reset: False
  • /camera/realsense2_camera/json_file_path:
  • /camera/realsense2_camera/linear_accel_cov: 0.01
  • /camera/realsense2_camera/odom_frame_id: camera_odom_frame
  • /camera/realsense2_camera/ordered_pc: False
  • /camera/realsense2_camera/pointcloud_texture_index: 0
  • /camera/realsense2_camera/pointcloud_texture_stream: RS2_STREAM_ANY
  • /camera/realsense2_camera/pose_frame_id: camera_pose_frame
  • /camera/realsense2_camera/pose_optical_frame_id: camera_pose_optic...
  • /camera/realsense2_camera/publish_odom_tf: True
  • /camera/realsense2_camera/publish_tf: True
  • /camera/realsense2_camera/rosbag_filename:
  • /camera/realsense2_camera/serial_no:
  • /camera/realsense2_camera/stereo_module/exposure/1: 7500
  • /camera/realsense2_camera/stereo_module/exposure/2: 1
  • /camera/realsense2_camera/stereo_module/gain/1: 16
  • /camera/realsense2_camera/stereo_module/gain/2: 16
  • /camera/realsense2_camera/tf_publish_rate: 0.0
  • /camera/realsense2_camera/topic_odom_in: odom_in
  • /camera/realsense2_camera/unite_imu_method:
  • /camera/realsense2_camera/usb_port_id:
  • /rosdistro: noetic
  • /rosversion: 1.15.11

NODES
/camera/
realsense2_camera (nodelet/nodelet)
realsense2_camera_manager (nodelet/nodelet)

ROS_MASTER_URI=http://192.168.2.64:11311

process[camera/realsense2_camera_manager-1]: started with pid [3548]
process[camera/realsense2_camera-2]: started with pid [3549]
[ INFO] [1625130099.784038928]: Initializing nodelet with 4 worker threads.
[ INFO] [1625130100.359931146]: RealSense ROS v2.3.0
[ INFO] [1625130100.360102500]: Built with LibRealSense v2.45.0
[ INFO] [1625130100.360197344]: Running with LibRealSense v2.45.0
[ INFO] [1625130100.459219170]:
[ INFO] [1625130100.777955941]: Device with serial number 102122071816 was found.

[ INFO] [1625130100.778154274]: Device with physical ID 1-1.3-6 was found.
[ INFO] [1625130100.778241930]: Device with name Intel RealSense D435I was found.
[ INFO] [1625130100.781179064]: Device with port number 1-1.3 was found.
[ INFO] [1625130100.781414845]: Device USB type: 2.1
[ WARN] [1625130100.781563908]: Device 102122071816 is connected using a 2.1 port. Reduced performance is expected.
[ INFO] [1625130100.789421612]: getParameters...
[ INFO] [1625130101.092074328]: setupDevice...
[ INFO] [1625130101.092231307]: JSON file is not provided
[ INFO] [1625130101.092343442]: ROS Node Namespace: camera
[ INFO] [1625130101.092432505]: Device Name: Intel RealSense D435I
[ INFO] [1625130101.092510942]: Device Serial No: 102122071816
[ INFO] [1625130101.092587765]: Device physical port: 1-1.3-6
[ INFO] [1625130101.092663130]: Device FW version: 05.12.14.50
[ INFO] [1625130101.092739328]: Device Product ID: 0x0B3A
[ INFO] [1625130101.092820630]: Enable PointCloud: On
[ INFO] [1625130101.092896880]: Align Depth: Off
[ INFO] [1625130101.092969588]: Sync Mode: On
[ INFO] [1625130101.093232452]: Device Sensors:
[ INFO] [1625130101.127821758]: Stereo Module was found.
[ INFO] [1625130101.154911016]: RGB Camera was found.
[ INFO] [1625130101.155694713]: Motion Module was found.
[ INFO] [1625130101.155912890]: (Confidence, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1625130101.156086640]: Add Filter: pointcloud
[ INFO] [1625130101.159371014]: num_filters: 1
[ INFO] [1625130101.159627420]: Setting Dynamic reconfig parameters.
[ WARN] [1625130101.620750058]: Param '/camera/stereo_module/auto_exposure_limit' has value 0 that is not in range [1, 165000]. Removing this parameter from dynamic reconfigure options.
[ WARN] [1625130101.634526926]: Param '/camera/stereo_module/auto_gain_limit' has value 0 that is not in range [16, 248]. Removing this parameter from dynamic reconfigure options.
[ INFO] [1625130101.816659754]: Done Setting Dynamic reconfig parameters.
[ WARN] [1625130101.817328555]: Given stream configuration is not supported by the device! Stream: Depth, Stream Index: 0, Width: 424, Height: 240, FPS: 15, Format: Z16
[ WARN] [1625130101.817485482]: Using default profile instead.
[ INFO] [1625130101.819077929]: depth stream is enabled - width: 640, height: 480, fps: 15, Format: Z16
[ INFO] [1625130101.820159023]: color stream is enabled - width: 424, height: 240, fps: 15, Format: RGB8
[ INFO] [1625130101.820398970]: setupPublishers...
[ INFO] [1625130101.830058862]: Expected frequency for depth = 15.00000
[ INFO] [1625130101.845519062]: Expected frequency for color = 15.00000
[ INFO] [1625130101.854709735]: setupStreams...
[ INFO] [1625130101.866893531]: insert Depth to Stereo Module
[ INFO] [1625130101.867145093]: insert Color to RGB Camera
01/07 09:01:41,988 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
[ INFO] [1625130102.039215582]: SELECTED BASE:Depth, 0
[ INFO] [1625130102.087559152]: RealSense Node Is Up!
[ WARN] [1625130102.228498353]:
01/07 09:01:42,230 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,280 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,331 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,381 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,432 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,483 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,533 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,585 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,636 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,686 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,737 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,788 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,838 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,889 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,940 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:42,990 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:43,041 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:43,092 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:43,142 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
01/07 09:01:43,193 WARNING [281472158134640] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
^C[camera/realsense2_camera-2] killing on exit
[camera/realsense2_camera_manager-1] killing on exit
shutting down processing monitor...
... shutting down processing monitor complete
done

@Nick-Kou
Copy link
Author

Nick-Kou commented Jul 1, 2021

Also on this specific image that I have on the SD card realsense-viewer doesn't open anything, i'm assuming this image doesn't contain the drivers for display.

realsense-viewer

However, we can still confirm the camera works through ROS wrapper when running:
roslaunch realsense2_camera rs_camera.launch

And the point cloud messages are being published when running:
roslaunch realsense2_camera rs_camera.launch filters:=pointcloud depth_width:=424 color_width:=424 depth_height:=240 color_height:=240 depth_fps:=15 color_fps:=15 pointcloud_texture_stream:=RS2_STREAM_ANY

But when running: roslaunch realsense2_camera rs_camera.launch filters:=pointcloud depth_width:=424 color_width:=424 depth_height:=240 color_height:=240 depth_fps:=15 color_fps:=15 pointcloud_texture_stream:=RS2_STREAM_ANY

No camera images are being published at from the /camera/color/image_raw topic.

@MartyG-RealSense
Copy link
Collaborator

Hi @Nick-Kou Could you try using RS2_STREAM_COLOR instead of RS2_STREAM_ANY please and check whether doing so makes a positive difference?

@Nick-Kou
Copy link
Author

Nick-Kou commented Jul 2, 2021

#1938 (comment). With RS2_STREAM_COLOR the same issue 1938 persists where there is no pointcloud in rviz and the color transformation options are blank.

@MartyG-RealSense
Copy link
Collaborator

MartyG-RealSense commented Jul 3, 2021

The RealSense ROS wrapper's documentation states that using the pointcloud filter should cause a topic called /camera/depth/color/points to be added. Are you able to obtain any data from that topic if you perform a rostopic echo of it or add it in RViz?

@Nick-Kou
Copy link
Author

Nick-Kou commented Jul 4, 2021

After running: roslaunch realsense2_camera rs_camera.launch camera:=camera1 filters:=pointcloud depth_width:=424 color_width:=424 depth_height:=240 color_height:=240 depth_fps:=30 color_fps:=30 pointcloud_texture_stream:=RS2_STREAM_COLOR

A [ WARN] [1625357506.310201328]: No stream match for pointcloud chosen texture Process - Color was shown in the output summary as shown below towards the end of the log:

ubuntu@ubuntu:~$ roslaunch realsense2_camera rs_camera.launch camera:=camera1 filters:=pointcloud depth_width:=424 color_width:=424 depth_height:=240 color_height:=240 depth_fps:=30 color_fps:=30 pointcloud_texture_stream:=RS2_STREAM_COLOR
... logging to /home/ubuntu/.ros/log/a6c9be4c-dc5b-11eb-bf11-afe8a803aefa/roslaunch-ubuntu-2578.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.

started roslaunch server http://192.168.2.144:36579/

SUMMARY

PARAMETERS

  • /camera1/realsense2_camera/accel_fps: -1
  • /camera1/realsense2_camera/accel_frame_id: camera1_accel_frame
  • /camera1/realsense2_camera/accel_optical_frame_id: camera1_accel_opt...
  • /camera1/realsense2_camera/align_depth: False
  • /camera1/realsense2_camera/aligned_depth_to_color_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye1_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye2_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_infra1_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_infra2_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/allow_no_texture_points: False
  • /camera1/realsense2_camera/base_frame_id: camera1_link
  • /camera1/realsense2_camera/calib_odom_file:
  • /camera1/realsense2_camera/clip_distance: -2.0
  • /camera1/realsense2_camera/color_fps: 30
  • /camera1/realsense2_camera/color_frame_id: camera1_color_frame
  • /camera1/realsense2_camera/color_height: 240
  • /camera1/realsense2_camera/color_optical_frame_id: camera1_color_opt...
  • /camera1/realsense2_camera/color_width: 424
  • /camera1/realsense2_camera/confidence_fps: -1
  • /camera1/realsense2_camera/confidence_height: -1
  • /camera1/realsense2_camera/confidence_width: -1
  • /camera1/realsense2_camera/depth_fps: 30
  • /camera1/realsense2_camera/depth_frame_id: camera1_depth_frame
  • /camera1/realsense2_camera/depth_height: 240
  • /camera1/realsense2_camera/depth_optical_frame_id: camera1_depth_opt...
  • /camera1/realsense2_camera/depth_width: 424
  • /camera1/realsense2_camera/device_type:
  • /camera1/realsense2_camera/enable_accel: False
  • /camera1/realsense2_camera/enable_color: True
  • /camera1/realsense2_camera/enable_confidence: True
  • /camera1/realsense2_camera/enable_depth: True
  • /camera1/realsense2_camera/enable_fisheye1: False
  • /camera1/realsense2_camera/enable_fisheye2: False
  • /camera1/realsense2_camera/enable_fisheye: False
  • /camera1/realsense2_camera/enable_gyro: False
  • /camera1/realsense2_camera/enable_infra1: False
  • /camera1/realsense2_camera/enable_infra2: False
  • /camera1/realsense2_camera/enable_infra: False
  • /camera1/realsense2_camera/enable_pointcloud: False
  • /camera1/realsense2_camera/enable_pose: False
  • /camera1/realsense2_camera/enable_sync: False
  • /camera1/realsense2_camera/filters: pointcloud
  • /camera1/realsense2_camera/fisheye1_frame_id: camera1_fisheye1_...
  • /camera1/realsense2_camera/fisheye1_optical_frame_id: camera1_fisheye1_...
  • /camera1/realsense2_camera/fisheye2_frame_id: camera1_fisheye2_...
  • /camera1/realsense2_camera/fisheye2_optical_frame_id: camera1_fisheye2_...
  • /camera1/realsense2_camera/fisheye_fps: -1
  • /camera1/realsense2_camera/fisheye_frame_id: camera1_fisheye_f...
  • /camera1/realsense2_camera/fisheye_height: -1
  • /camera1/realsense2_camera/fisheye_optical_frame_id: camera1_fisheye_o...
  • /camera1/realsense2_camera/fisheye_width: -1
  • /camera1/realsense2_camera/gyro_fps: -1
  • /camera1/realsense2_camera/gyro_frame_id: camera1_gyro_frame
  • /camera1/realsense2_camera/gyro_optical_frame_id: camera1_gyro_opti...
  • /camera1/realsense2_camera/imu_optical_frame_id: camera1_imu_optic...
  • /camera1/realsense2_camera/infra1_frame_id: camera1_infra1_frame
  • /camera1/realsense2_camera/infra1_optical_frame_id: camera1_infra1_op...
  • /camera1/realsense2_camera/infra2_frame_id: camera1_infra2_frame
  • /camera1/realsense2_camera/infra2_optical_frame_id: camera1_infra2_op...
  • /camera1/realsense2_camera/infra_fps: 30
  • /camera1/realsense2_camera/infra_height: 480
  • /camera1/realsense2_camera/infra_rgb: False
  • /camera1/realsense2_camera/infra_width: 848
  • /camera1/realsense2_camera/initial_reset: False
  • /camera1/realsense2_camera/json_file_path:
  • /camera1/realsense2_camera/linear_accel_cov: 0.01
  • /camera1/realsense2_camera/odom_frame_id: camera1_odom_frame
  • /camera1/realsense2_camera/ordered_pc: False
  • /camera1/realsense2_camera/pointcloud_texture_index: 0
  • /camera1/realsense2_camera/pointcloud_texture_stream: RS2_STREAM_COLOR
  • /camera1/realsense2_camera/pose_frame_id: camera1_pose_frame
  • /camera1/realsense2_camera/pose_optical_frame_id: camera1_pose_opti...
  • /camera1/realsense2_camera/publish_odom_tf: True
  • /camera1/realsense2_camera/publish_tf: True
  • /camera1/realsense2_camera/rosbag_filename:
  • /camera1/realsense2_camera/serial_no:
  • /camera1/realsense2_camera/stereo_module/exposure/1: 7500
  • /camera1/realsense2_camera/stereo_module/exposure/2: 1
  • /camera1/realsense2_camera/stereo_module/gain/1: 16
  • /camera1/realsense2_camera/stereo_module/gain/2: 16
  • /camera1/realsense2_camera/tf_publish_rate: 0.0
  • /camera1/realsense2_camera/topic_odom_in: odom_in
  • /camera1/realsense2_camera/unite_imu_method:
  • /camera1/realsense2_camera/usb_port_id:
  • /rosdistro: noetic
  • /rosversion: 1.15.11

NODES
/camera1/
realsense2_camera (nodelet/nodelet)
realsense2_camera_manager (nodelet/nodelet)

ROS_MASTER_URI=http://192.168.2.64:11311

process[camera1/realsense2_camera_manager-1]: started with pid [2586]
process[camera1/realsense2_camera-2]: started with pid [2587]
[ INFO] [1625357490.490386172]: Initializing nodelet with 4 worker threads.
[ INFO] [1625357491.060999056]: RealSense ROS v2.3.0
[ INFO] [1625357491.061164629]: Built with LibRealSense v2.45.0
[ INFO] [1625357491.061259524]: Running with LibRealSense v2.45.0
[ INFO] [1625357491.168846669]:
[ INFO] [1625357491.534720358]: Device with serial number 102422071443 was found.

[ INFO] [1625357491.534924420]: Device with physical ID 1-1.2-7 was found.
[ INFO] [1625357491.535030202]: Device with name Intel RealSense D435I was found.
[ INFO] [1625357491.537856605]: Device with port number 1-1.2 was found.
[ INFO] [1625357491.538076970]: Device USB type: 2.1
[ WARN] [1625357491.538282022]: Device 102422071443 is connected using a 2.1 port. Reduced performance is expected.
[ INFO] [1625357491.546263629]: getParameters...
[ INFO] [1625357491.867204910]: setupDevice...
[ INFO] [1625357491.867362930]: JSON file is not provided
[ INFO] [1625357491.867502097]: ROS Node Namespace: camera1
[ INFO] [1625357491.867590795]: Device Name: Intel RealSense D435I
[ INFO] [1625357491.867669128]: Device Serial No: 102422071443
[ INFO] [1625357491.867745222]: Device physical port: 1-1.2-7
[ INFO] [1625357491.867821732]: Device FW version: 05.12.14.50
[ INFO] [1625357491.867897669]: Device Product ID: 0x0B3A
[ INFO] [1625357491.867979544]: Enable PointCloud: On
[ INFO] [1625357491.868054753]: Align Depth: Off
[ INFO] [1625357491.868127773]: Sync Mode: On
[ INFO] [1625357491.870228709]: Device Sensors:
[ INFO] [1625357491.905120918]: Stereo Module was found.
[ INFO] [1625357491.939229950]: RGB Camera was found.
[ INFO] [1625357491.940042085]: Motion Module was found.
[ INFO] [1625357491.940263804]: (Confidence, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1625357491.940455783]: Add Filter: pointcloud
[ INFO] [1625357491.945317081]: num_filters: 1
[ INFO] [1625357491.945531612]: Setting Dynamic reconfig parameters.
[ WARN] [1625357492.429154884]: Param '/camera1/stereo_module/auto_exposure_limit' has value 0 that is not in range [1, 165000]. Removing this parameter from dynamic reconfigure options.
[ WARN] [1625357492.443235549]: Param '/camera1/stereo_module/auto_gain_limit' has value 0 that is not in range [16, 248]. Removing this parameter from dynamic reconfigure options.
[ INFO] [1625357492.644822559]: Done Setting Dynamic reconfig parameters.
[ WARN] [1625357492.645439121]: Given stream configuration is not supported by the device! Stream: Depth, Stream Index: 0, Width: 424, Height: 240, FPS: 30, Format: Z16
[ WARN] [1625357492.645589486]: Using default profile instead.
[ INFO] [1625357492.653698281]: depth stream is enabled - width: 640, height: 480, fps: 15, Format: Z16
[ INFO] [1625357492.654815988]: color stream is enabled - width: 424, height: 240, fps: 30, Format: RGB8
[ INFO] [1625357492.655217863]: setupPublishers...
[ INFO] [1625357492.669239257]: Expected frequency for depth = 15.00000
[ INFO] [1625357492.695196473]: Expected frequency for color = 30.00000
[ INFO] [1625357492.705030788]: setupStreams...
[ INFO] [1625357492.717277339]: insert Depth to Stereo Module
[ INFO] [1625357492.717523381]: insert Color to RGB Camera
04/07 00:11:32,853 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
[ INFO] [1625357492.904370769]: SELECTED BASE:Depth, 0
[ INFO] [1625357492.954087131]: RealSense Node Is Up!
[ WARN] [1625357493.092979874]:
04/07 00:11:33,094 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,145 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,195 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,246 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,446 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,496 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,547 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,597 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,647 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,698 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,750 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,800 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,850 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:33,954 ERROR [281471990346096] (ds5-options.cpp:88) Asic Temperature value is not valid!
04/07 00:11:34,002 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:34,052 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:34,204 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:34,255 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:34,406 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
04/07 00:11:34,456 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
[ INFO] [1625357505.758857334]: publishing unordered pointcloud.
[ WARN] [1625357506.310201328]: No stream match for pointcloud chosen texture Process - Color
04/07 00:12:14,156 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: Resource temporarily unavailable, number: 11
04/07 00:12:14,206 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: Resource temporarily unavailable, number: 11
04/07 00:12:15,258 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: Resource temporarily unavailable, number: 11
04/07 00:12:15,309 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: Resource temporarily unavailable, number: 11
04/07 00:12:15,359 WARNING [281472640098672] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: Resource temporarily unavailable, number: 11

The Camera was initially publishing image in rviz but then as I was waving my hand in in front of it, the frame eventually froze and a Status: No image frame received showed up in rviz as shown in the image below. The message is shown in yellow on the left panel underneath the "Image" drop down section in rviz :

rviz1

As for the pointcloud2 message there isn't any warning other than the one " [WARN] [1625357506.310201328]: No stream match for pointcloud chosen texture Process - Color " shown in the summary which I am not sure if it effects anything.

rostopic echo /camera1/depth/color/points shown in the image below shows no PointCloud2 messages are being published.
rostopic echo
The reason it's /camera1 is becasue I changed the namespace when I called the:

roslaunch realsense2_camera rs_camera.launch camera:=camera1 filters:=pointcloud depth_width:=424 color_width:=424 depth_height:=240 color_height:=240 depth_fps:=30 color_fps:=30 pointcloud_texture_stream:=RS2_STREAM_COLOR

in the camera:=camera1 parameter which also shouldn't have any effect.

@MartyG-RealSense
Copy link
Collaborator

MartyG-RealSense commented Jul 4, 2021

So in summary, when you launch with roslaunch realsense2_camera rs_camera.launch then the /camera/color/image_raw topic is published correctly.

But the /camera/color/image_raw topic is not published when you perform a pointcloud-equipped launch with the roslaunch instruction below:

roslaunch realsense2_camera rs_camera.launch filters:=pointcloud depth_width:=424 color_width:=424 depth_height:=240 color_height:=240 depth_fps:=15 color_fps:=15 pointcloud_texture_stream:=RS2_STREAM_ANY

However, pointcloud2 messages are publishing correctly.

Going through the launch log, I note that the launch decided that setting depth to 424x240 at 30 FPS was invalid and instead set it to 640x480 at 15 FPS (whilst color remained at the 424x240 set by the custom-resolution roslaunch instruction). So you now had a mismatch of both resolution and FPS between depth and color.

image

This was likely caused because the camera is on a USB 2 connection due to the use of a Raspberry Pi 3B+ (Pi models before Pi 4 only had USB 2 instead of USB 3).

image

RealSense cameras on a USB 2 connection have a limited range of supported resolution and FPS modes compared to the full range of capabilities on a USB 3 connection. This is described in Intel's document about USB 2 operation at the link below.

https://www.intelrealsense.com/usb2-support-for-intel-realsense-technology/

The list of depth and color resolution and FPS modes currently supported on USB 2 with a D435i at the time of writing this is shown in the image below, which illustrates that whilst 424x240 color is supported, 424x240 depth is not. I would therefore suggest trying a roslaunch with both color and depth set to 640x480 at 30 FPS.

image

@MartyG-RealSense
Copy link
Collaborator

MartyG-RealSense commented Jul 5, 2021

A common factor that I identified between this case and two other cases that had no Color Transformer options available was that they were on computing boards with Arm processors (your one on Pi 3B+, and the other two on Nvidia Jetson Xavier NX).

#1967 (comment)

@chrisdalke
Copy link

chrisdalke commented Jul 8, 2021

Posted this on #1967 as well since these seem to be related:

I've encountered this same issue with a D415 on a RPI 4; I'm able to view the depth image but the RGB image and color point clouds do not get published. Inspecting the /camera/color/image_raw and /camera/depth/color/points topics shows nothing being published on either topic.

This issue showed up recently, so I reverted to a manually-built earlier version of librealsense and realsense-ros which fixed the issue. Maybe there's a regression or incompatibility with the recent libraries on ARM?

I reverted to v2.41.0 of librealsense, and version 2.2.21 of realsense-ros and rebuilt from git on the Raspberry Pi. This combination does not exhibit this issue.

There's likely some issue with the resolution/bit depth, USB type, etc. since I'm getting the same warning messages as others above, but the camera still works with no configuration changes on the older version of the software libraries.

@Nick-Kou
Copy link
Author

Nick-Kou commented Jul 8, 2021

@MartyG-RealSense Thanks for the response. However, I will only be in the lab on Saturday again to try this.
@chrisdalke Thanks, will definitely give this a try. Does it also take you several hours to cmake build the librealsense library on the Raspberry Pi?

@chrisdalke
Copy link

@Nick-Kou Yeah, it certainly takes a while, about ~1hr for me on a RPi 4B, but that seems typical for a large project. You could probably reduce the compile time by not compiling any of the examples/tools.

Make sure you're using a decent SD card, good power supply, sufficient cooling, just to eliminate any potential throttling. I just left the compilation running in the background and came back later :)

@MartyG-RealSense
Copy link
Collaborator

Thanks again for your advice @chrisdalke :)

@Nick-Kou I look forward to your update about your lab results after Saturday. Good luck!

@Nick-Kou
Copy link
Author

@MartyG-RealSense

After setting 640x480 and 30fps for each I obtain the following summary:

roslaunch realsense2_camera rs_camera.launch camera:=camera1 filters:=pointcloud depth_width:=640 color_width:=640 depth_height:=480 color_height:=480 depth_fps:=30 color_fps:=30 pointcloud_texture_stream:=RS2_STREAM_ANY
... logging to /home/ubuntu/.ros/log/e1423ed6-e1ca-11eb-969a-d38632247d1a/roslaunch-ubuntu-2239.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.

started roslaunch server http://192.168.0.113:45327/

SUMMARY

PARAMETERS

  • /camera1/realsense2_camera/accel_fps: -1
  • /camera1/realsense2_camera/accel_frame_id: camera1_accel_frame
  • /camera1/realsense2_camera/accel_optical_frame_id: camera1_accel_opt...
  • /camera1/realsense2_camera/align_depth: False
  • /camera1/realsense2_camera/aligned_depth_to_color_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye1_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye2_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_infra1_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_infra2_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/allow_no_texture_points: False
  • /camera1/realsense2_camera/base_frame_id: camera1_link
  • /camera1/realsense2_camera/calib_odom_file:
  • /camera1/realsense2_camera/clip_distance: -2.0
  • /camera1/realsense2_camera/color_fps: 30
  • /camera1/realsense2_camera/color_frame_id: camera1_color_frame
  • /camera1/realsense2_camera/color_height: 480
  • /camera1/realsense2_camera/color_optical_frame_id: camera1_color_opt...
  • /camera1/realsense2_camera/color_width: 640
  • /camera1/realsense2_camera/confidence_fps: -1
  • /camera1/realsense2_camera/confidence_height: -1
  • /camera1/realsense2_camera/confidence_width: -1
  • /camera1/realsense2_camera/depth_fps: 30
  • /camera1/realsense2_camera/depth_frame_id: camera1_depth_frame
  • /camera1/realsense2_camera/depth_height: 480
  • /camera1/realsense2_camera/depth_optical_frame_id: camera1_depth_opt...
  • /camera1/realsense2_camera/depth_width: 640
  • /camera1/realsense2_camera/device_type:
  • /camera1/realsense2_camera/enable_accel: False
  • /camera1/realsense2_camera/enable_color: True
  • /camera1/realsense2_camera/enable_confidence: True
  • /camera1/realsense2_camera/enable_depth: True
  • /camera1/realsense2_camera/enable_fisheye1: False
  • /camera1/realsense2_camera/enable_fisheye2: False
  • /camera1/realsense2_camera/enable_fisheye: False
  • /camera1/realsense2_camera/enable_gyro: False
  • /camera1/realsense2_camera/enable_infra1: False
  • /camera1/realsense2_camera/enable_infra2: False
  • /camera1/realsense2_camera/enable_infra: False
  • /camera1/realsense2_camera/enable_pointcloud: False
  • /camera1/realsense2_camera/enable_pose: False
  • /camera1/realsense2_camera/enable_sync: False
  • /camera1/realsense2_camera/filters: pointcloud
  • /camera1/realsense2_camera/fisheye1_frame_id: camera1_fisheye1_...
  • /camera1/realsense2_camera/fisheye1_optical_frame_id: camera1_fisheye1_...
  • /camera1/realsense2_camera/fisheye2_frame_id: camera1_fisheye2_...
  • /camera1/realsense2_camera/fisheye2_optical_frame_id: camera1_fisheye2_...
  • /camera1/realsense2_camera/fisheye_fps: -1
  • /camera1/realsense2_camera/fisheye_frame_id: camera1_fisheye_f...
  • /camera1/realsense2_camera/fisheye_height: -1
  • /camera1/realsense2_camera/fisheye_optical_frame_id: camera1_fisheye_o...
  • /camera1/realsense2_camera/fisheye_width: -1
  • /camera1/realsense2_camera/gyro_fps: -1
  • /camera1/realsense2_camera/gyro_frame_id: camera1_gyro_frame
  • /camera1/realsense2_camera/gyro_optical_frame_id: camera1_gyro_opti...
  • /camera1/realsense2_camera/imu_optical_frame_id: camera1_imu_optic...
  • /camera1/realsense2_camera/infra1_frame_id: camera1_infra1_frame
  • /camera1/realsense2_camera/infra1_optical_frame_id: camera1_infra1_op...
  • /camera1/realsense2_camera/infra2_frame_id: camera1_infra2_frame
  • /camera1/realsense2_camera/infra2_optical_frame_id: camera1_infra2_op...
  • /camera1/realsense2_camera/infra_fps: 30
  • /camera1/realsense2_camera/infra_height: 480
  • /camera1/realsense2_camera/infra_rgb: False
  • /camera1/realsense2_camera/infra_width: 848
  • /camera1/realsense2_camera/initial_reset: False
  • /camera1/realsense2_camera/json_file_path:
  • /camera1/realsense2_camera/linear_accel_cov: 0.01
  • /camera1/realsense2_camera/odom_frame_id: camera1_odom_frame
  • /camera1/realsense2_camera/ordered_pc: False
  • /camera1/realsense2_camera/pointcloud_texture_index: 0
  • /camera1/realsense2_camera/pointcloud_texture_stream: RS2_STREAM_ANY
  • /camera1/realsense2_camera/pose_frame_id: camera1_pose_frame
  • /camera1/realsense2_camera/pose_optical_frame_id: camera1_pose_opti...
  • /camera1/realsense2_camera/publish_odom_tf: True
  • /camera1/realsense2_camera/publish_tf: True
  • /camera1/realsense2_camera/rosbag_filename:
  • /camera1/realsense2_camera/serial_no:
  • /camera1/realsense2_camera/stereo_module/exposure/1: 7500
  • /camera1/realsense2_camera/stereo_module/exposure/2: 1
  • /camera1/realsense2_camera/stereo_module/gain/1: 16
  • /camera1/realsense2_camera/stereo_module/gain/2: 16
  • /camera1/realsense2_camera/tf_publish_rate: 0.0
  • /camera1/realsense2_camera/topic_odom_in: odom_in
  • /camera1/realsense2_camera/unite_imu_method:
  • /camera1/realsense2_camera/usb_port_id:
  • /rosdistro: melodic
  • /rosversion: 1.14.10

NODES
/camera1/
realsense2_camera (nodelet/nodelet)
realsense2_camera_manager (nodelet/nodelet)

ROS_MASTER_URI=http://192.168.0.107:11311

process[camera1/realsense2_camera_manager-1]: started with pid [2248]
process[camera1/realsense2_camera-2]: started with pid [2249]
[ INFO] [1625954841.253483590]: Initializing nodelet with 4 worker threads.
[ INFO] [1625954844.342227568]: RealSense ROS v2.3.0
[ INFO] [1625954844.342369547]: Built with LibRealSense v2.45.0
[ INFO] [1625954844.342465068]: Running with LibRealSense v2.45.0
[ INFO] [1625954844.422478704]:
[ INFO] [1625954844.737846947]: Device with serial number 102422071443 was found.

[ INFO] [1625954844.738227467]: Device with physical ID 1-1.3-6 was found.
[ INFO] [1625954844.738422155]: Device with name Intel RealSense D435I was found.
[ INFO] [1625954844.744775956]: Device with port number 1-1.3 was found.
[ INFO] [1625954844.745069914]: Device USB type: 2.1
[ WARN] [1625954844.745294498]: Device 102422071443 is connected using a 2.1 port. Reduced performance is expected.
[ INFO] [1625954844.754165434]: getParameters...
[ INFO] [1625954845.066105032]: setupDevice...
[ INFO] [1625954845.066344250]: JSON file is not provided
[ INFO] [1625954845.066526542]: ROS Node Namespace: camera1
[ INFO] [1625954845.066817740]: Device Name: Intel RealSense D435I
[ INFO] [1625954845.067009979]: Device Serial No: 102422071443
[ INFO] [1625954845.067197323]: Device physical port: 1-1.3-6
[ INFO] [1625954845.067395188]: Device FW version: 05.12.14.50
[ INFO] [1625954845.067624458]: Device Product ID: 0x0B3A
[ INFO] [1625954845.067818521]: Enable PointCloud: On
[ INFO] [1625954845.068190188]: Align Depth: Off
[ INFO] [1625954845.068391698]: Sync Mode: On
[ INFO] [1625954845.068841750]: Device Sensors:
[ INFO] [1625954845.100699559]: Stereo Module was found.
[ INFO] [1625954845.125072212]: RGB Camera was found.
[ INFO] [1625954845.125874399]: Motion Module was found.
[ INFO] [1625954845.126226639]: (Confidence, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1625954845.126418670]: Add Filter: pointcloud
[ INFO] [1625954845.129502472]: num_filters: 1
[ INFO] [1625954845.129694191]: Setting Dynamic reconfig parameters.
[ WARN] [1625954845.620924653]: Param '/camera1/stereo_module/auto_exposure_limit' has value 0 that is not in range [1, 165000]. Removing this parameter from dynamic reconfigure options.
[ WARN] [1625954845.635880328]: Param '/camera1/stereo_module/auto_gain_limit' has value 0 that is not in range [16, 248]. Removing this parameter from dynamic reconfigure options.
[ INFO] [1625954845.861711134]: Done Setting Dynamic reconfig parameters.
[ INFO] [1625954845.873012696]: depth stream is enabled - width: 640, height: 480, fps: 30, Format: Z16
[ INFO] [1625954845.875924414]: color stream is enabled - width: 640, height: 480, fps: 30, Format: RGB8
[ INFO] [1625954845.876345404]: setupPublishers...
[ INFO] [1625954845.886944465]: Expected frequency for depth = 30.00000
[ INFO] [1625954845.916337534]: Expected frequency for color = 30.00000
[ INFO] [1625954845.925305919]: setupStreams...
[ INFO] [1625954845.938526386]: insert Depth to Stereo Module
[ INFO] [1625954845.938916594]: insert Color to RGB Camera
10/07 22:07:26,049 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
[ INFO] [1625954846.100850012]: SELECTED BASE:Depth, 0
[ INFO] [1625954846.154896569]: RealSense Node Is Up!
[ WARN] [1625954846.195683543]:
10/07 22:07:26,198 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:07:26,248 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:07:26,300 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:07:26,455 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:07:26,505 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:07:26,557 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:07:26,607 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:07:26,658 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:07:26,708 WARNING [281472493678976] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
[ INFO] [1625954893.215535785]: publishing unordered pointcloud.
10/07 22:09:08,570 ERROR [281472241996160] (uvc-streamer.cpp:106) uvc streamer watchdog triggered on endpoint: 132

rviz3

Point Cloud Message appears in rviz however image_raw topic is still not received, however, the image_rect_raw topic is received.

@Nick-Kou
Copy link
Author

After trying the same except the RS2_STREAM_COLOR, the pointcloud message status is fine however is not displaying anything in rviz as mentioned before. Also the color/image_raw topic is still not being received as shown in the left panel of rviz.
roslaunch realsense2_camera rs_camera.launch camera:=camera1 filters:=pointcloud depth_width:=640 color_width:=640 depth_height:=480 color_height:=480 depth_fps:=30 color_fps:=30 pointcloud_texture_stream:=RS2_STREAM_COLOR
... logging to /home/ubuntu/.ros/log/e1423ed6-e1ca-11eb-969a-d38632247d1a/roslaunch-ubuntu-2446.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.

started roslaunch server http://192.168.0.113:37785/

SUMMARY

PARAMETERS

  • /camera1/realsense2_camera/accel_fps: -1
  • /camera1/realsense2_camera/accel_frame_id: camera1_accel_frame
  • /camera1/realsense2_camera/accel_optical_frame_id: camera1_accel_opt...
  • /camera1/realsense2_camera/align_depth: False
  • /camera1/realsense2_camera/aligned_depth_to_color_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye1_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye2_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_fisheye_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_infra1_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/aligned_depth_to_infra2_frame_id: camera1_aligned_d...
  • /camera1/realsense2_camera/allow_no_texture_points: False
  • /camera1/realsense2_camera/base_frame_id: camera1_link
  • /camera1/realsense2_camera/calib_odom_file:
  • /camera1/realsense2_camera/clip_distance: -2.0
  • /camera1/realsense2_camera/color_fps: 30
  • /camera1/realsense2_camera/color_frame_id: camera1_color_frame
  • /camera1/realsense2_camera/color_height: 480
  • /camera1/realsense2_camera/color_optical_frame_id: camera1_color_opt...
  • /camera1/realsense2_camera/color_width: 640
  • /camera1/realsense2_camera/confidence_fps: -1
  • /camera1/realsense2_camera/confidence_height: -1
  • /camera1/realsense2_camera/confidence_width: -1
  • /camera1/realsense2_camera/depth_fps: 30
  • /camera1/realsense2_camera/depth_frame_id: camera1_depth_frame
  • /camera1/realsense2_camera/depth_height: 480
  • /camera1/realsense2_camera/depth_optical_frame_id: camera1_depth_opt...
  • /camera1/realsense2_camera/depth_width: 640
  • /camera1/realsense2_camera/device_type:
  • /camera1/realsense2_camera/enable_accel: False
  • /camera1/realsense2_camera/enable_color: True
  • /camera1/realsense2_camera/enable_confidence: True
  • /camera1/realsense2_camera/enable_depth: True
  • /camera1/realsense2_camera/enable_fisheye1: False
  • /camera1/realsense2_camera/enable_fisheye2: False
  • /camera1/realsense2_camera/enable_fisheye: False
  • /camera1/realsense2_camera/enable_gyro: False
  • /camera1/realsense2_camera/enable_infra1: False
  • /camera1/realsense2_camera/enable_infra2: False
  • /camera1/realsense2_camera/enable_infra: False
  • /camera1/realsense2_camera/enable_pointcloud: False
  • /camera1/realsense2_camera/enable_pose: False
  • /camera1/realsense2_camera/enable_sync: False
  • /camera1/realsense2_camera/filters: pointcloud
  • /camera1/realsense2_camera/fisheye1_frame_id: camera1_fisheye1_...
  • /camera1/realsense2_camera/fisheye1_optical_frame_id: camera1_fisheye1_...
  • /camera1/realsense2_camera/fisheye2_frame_id: camera1_fisheye2_...
  • /camera1/realsense2_camera/fisheye2_optical_frame_id: camera1_fisheye2_...
  • /camera1/realsense2_camera/fisheye_fps: -1
  • /camera1/realsense2_camera/fisheye_frame_id: camera1_fisheye_f...
  • /camera1/realsense2_camera/fisheye_height: -1
  • /camera1/realsense2_camera/fisheye_optical_frame_id: camera1_fisheye_o...
  • /camera1/realsense2_camera/fisheye_width: -1
  • /camera1/realsense2_camera/gyro_fps: -1
  • /camera1/realsense2_camera/gyro_frame_id: camera1_gyro_frame
  • /camera1/realsense2_camera/gyro_optical_frame_id: camera1_gyro_opti...
  • /camera1/realsense2_camera/imu_optical_frame_id: camera1_imu_optic...
  • /camera1/realsense2_camera/infra1_frame_id: camera1_infra1_frame
  • /camera1/realsense2_camera/infra1_optical_frame_id: camera1_infra1_op...
  • /camera1/realsense2_camera/infra2_frame_id: camera1_infra2_frame
  • /camera1/realsense2_camera/infra2_optical_frame_id: camera1_infra2_op...
  • /camera1/realsense2_camera/infra_fps: 30
  • /camera1/realsense2_camera/infra_height: 480
  • /camera1/realsense2_camera/infra_rgb: False
  • /camera1/realsense2_camera/infra_width: 848
  • /camera1/realsense2_camera/initial_reset: False
  • /camera1/realsense2_camera/json_file_path:
  • /camera1/realsense2_camera/linear_accel_cov: 0.01
  • /camera1/realsense2_camera/odom_frame_id: camera1_odom_frame
  • /camera1/realsense2_camera/ordered_pc: False
  • /camera1/realsense2_camera/pointcloud_texture_index: 0
  • /camera1/realsense2_camera/pointcloud_texture_stream: RS2_STREAM_COLOR
  • /camera1/realsense2_camera/pose_frame_id: camera1_pose_frame
  • /camera1/realsense2_camera/pose_optical_frame_id: camera1_pose_opti...
  • /camera1/realsense2_camera/publish_odom_tf: True
  • /camera1/realsense2_camera/publish_tf: True
  • /camera1/realsense2_camera/rosbag_filename:
  • /camera1/realsense2_camera/serial_no:
  • /camera1/realsense2_camera/stereo_module/exposure/1: 7500
  • /camera1/realsense2_camera/stereo_module/exposure/2: 1
  • /camera1/realsense2_camera/stereo_module/gain/1: 16
  • /camera1/realsense2_camera/stereo_module/gain/2: 16
  • /camera1/realsense2_camera/tf_publish_rate: 0.0
  • /camera1/realsense2_camera/topic_odom_in: odom_in
  • /camera1/realsense2_camera/unite_imu_method:
  • /camera1/realsense2_camera/usb_port_id:
  • /rosdistro: melodic
  • /rosversion: 1.14.10

NODES
/camera1/
realsense2_camera (nodelet/nodelet)
realsense2_camera_manager (nodelet/nodelet)

ROS_MASTER_URI=http://192.168.0.107:11311

process[camera1/realsense2_camera_manager-1]: started with pid [2456]
process[camera1/realsense2_camera-2]: started with pid [2457]
[ INFO] [1625956240.905471624]: Initializing nodelet with 4 worker threads.
[ INFO] [1625956241.421878061]: RealSense ROS v2.3.0
[ INFO] [1625956241.422048114]: Built with LibRealSense v2.45.0
[ INFO] [1625956241.422143009]: Running with LibRealSense v2.45.0
[ INFO] [1625956241.506329837]:
[ INFO] [1625956241.779379229]: Device with serial number 102422071443 was found.

[ INFO] [1625956241.779675219]: Device with physical ID 1-1.3-6 was found.
[ INFO] [1625956241.779883552]: Device with name Intel RealSense D435I was found.
[ INFO] [1625956241.786105844]: Device with port number 1-1.3 was found.
[ INFO] [1625956241.786421521]: Device USB type: 2.1
[ WARN] [1625956241.786647094]: Device 102422071443 is connected using a 2.1 port. Reduced performance is expected.
[ INFO] [1625956241.794252771]: getParameters...
[ INFO] [1625956242.138507219]: setupDevice...
[ INFO] [1625956242.138736855]: JSON file is not provided
[ INFO] [1625956242.138916698]: ROS Node Namespace: camera1
[ INFO] [1625956242.139082323]: Device Name: Intel RealSense D435I
[ INFO] [1625956242.139223678]: Device Serial No: 102422071443
[ INFO] [1625956242.139405605]: Device physical port: 1-1.3-6
[ INFO] [1625956242.139582011]: Device FW version: 05.12.14.50
[ INFO] [1625956242.139771594]: Device Product ID: 0x0B3A
[ INFO] [1625956242.139933313]: Enable PointCloud: On
[ INFO] [1625956242.140114042]: Align Depth: Off
[ INFO] [1625956242.140296126]: Sync Mode: On
[ INFO] [1625956242.140760396]: Device Sensors:
[ INFO] [1625956242.171122377]: Stereo Module was found.
[ INFO] [1625956242.193356962]: RGB Camera was found.
[ INFO] [1625956242.194144254]: Motion Module was found.
[ INFO] [1625956242.194427795]: (Confidence, 0) sensor isn't supported by current device! -- Skipping...
[ INFO] [1625956242.194589514]: Add Filter: pointcloud
[ INFO] [1625956242.197559046]: num_filters: 1
[ INFO] [1625956242.197746650]: Setting Dynamic reconfig parameters.
[ WARN] [1625956242.664738813]: Param '/camera1/stereo_module/auto_exposure_limit' has value 0 that is not in range [1, 165000]. Removing this parameter from dynamic reconfigure options.
[ WARN] [1625956242.679563918]: Param '/camera1/stereo_module/auto_gain_limit' has value 0 that is not in range [16, 248]. Removing this parameter from dynamic reconfigure options.
[ INFO] [1625956242.906208880]: Done Setting Dynamic reconfig parameters.
[ INFO] [1625956242.908910911]: depth stream is enabled - width: 640, height: 480, fps: 30, Format: Z16
[ INFO] [1625956242.911393203]: color stream is enabled - width: 640, height: 480, fps: 30, Format: RGB8
[ INFO] [1625956242.911625338]: setupPublishers...
[ INFO] [1625956242.919915755]: Expected frequency for depth = 30.00000
[ INFO] [1625956242.935631277]: Expected frequency for color = 30.00000
[ INFO] [1625956242.945658934]: setupStreams...
[ INFO] [1625956242.958820758]: insert Depth to Stereo Module
[ INFO] [1625956242.959193674]: insert Color to RGB Camera
10/07 22:30:43,068 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
[ INFO] [1625956243.120106600]: SELECTED BASE:Depth, 0
[ INFO] [1625956243.173605197]: RealSense Node Is Up!
[ WARN] [1625956243.215787179]:
10/07 22:30:43,217 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:30:43,268 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:30:43,319 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:30:43,370 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:30:43,422 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:30:43,473 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
[ INFO] [1625956243.569338241]: publishing unordered pointcloud.
10/07 22:30:43,575 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:30:43,625 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
10/07 22:30:43,676 WARNING [281472596595072] (messenger-libusb.cpp:42) control_transfer returned error, index: 768, error: No data available, number: 61
[ WARN] [1625956244.147019317]: No stream match for pointcloud chosen texture Process - Color
10/07 22:30:53,319 ERROR [281472074240384] (uvc-streamer.cpp:106) uvc streamer watchdog triggered on endpoint: 132

rviz4

@Nick-Kou
Copy link
Author

I guess I should give @chrisdalke's suggestion a shot as it seemed to have worked for him.

Thanks for all the suggestions @MartyG-RealSense @chrisdalke

@MartyG-RealSense
Copy link
Collaborator

You are very welcome @Nick-Kou - good luck, and please do let us know how it turns out!

@lupusorina
Copy link

Hey. I have a similar issue. I have a Raspi4, running Ubuntu 20.04, kernel 5.4 connected to a D435 via USB3. ROS distribution: noetic

I'm running the following command
roslaunch realsense2_camera rs_camera.launch camera:=camera1 filters:=pointcloud depth_width:=640 color_width:=640 depth_height:=480 color_height:=480 depth_fps:=30 color_fps:=30 pointcloud_texture_stream:=RS2_STREAM_ANY

When doing so, I am able to stream in RVIZ the pointclouds, but they don't have color. In addition, streaming /camera1/color/image_raw in RVIZ shows the image for 2-3 seconds, then it freezes, and the output of the command line prints:
15/07 16:35:12,398 ERROR [281472745329008] (uvc-streamer.cpp:106) uvc streamer watchdog triggered on endpoint: 132
Although the camera1/color/image_raw freezes, the point cloud is still being published.

Screen Shot 2021-07-15 at 9 29 42 AM

I have tried to downgrade to 15 fps for the color, but nothing changed.

Also, sometimes, this printout appears, although I am not sure the issues are related:
15/07 16:49:02,888 ERROR [281471713517936] (ds5-options.cpp:88) Asic Temperature value is not valid!

I then tried to run the command with pointcloud_texture_stream:=RS2_STREAM_COLOR:

roslaunch realsense2_camera rs_camera.launch camera:=camera1 filters:=pointcloud depth_width:=640 color_width:=640 depth_height:=480 color_height:=480 depth_fps:=30 color_fps:=30 pointcloud_texture_stream:=RS2_STREAM_COLOR

Then, the pointclouds are not published at all and the following warning appears:
[ INFO] [1626367933.517223488]: publishing unordered pointcloud. [ WARN] [1626367933.948946733]: No stream match for pointcloud chosen texture Process - Color

I guess I could downgrade to an earlier version @chrisdalke suggested, but it will be great if this issue can be fixed for the latest updates and versions.

@MartyG-RealSense
Copy link
Collaborator

Hi @lupusorina Under the PointCloud2 options in RViz, do you have any Color Transformer options available or are they absent like they were for @Nick-Kou please?

#1967 (comment)

If the temperature can be read normally most of the time and the Asic Temperature value is not valid! warning only appears sometimes then it is likely just a timing hiccup where the camera was not ready to respond at that particular instance when the temperature was being polled. You can monitor Asic, Projector and Motion Module temperatures using the /diagnostics topic of the RealSense ROS wrapper.

@MartyG-RealSense
Copy link
Collaborator

Hi @Nick-Kou and @lupusorina Do either of you require further assistance with this case, please? Thanks!

@Nick-Kou
Copy link
Author

Hi @MartyG-RealSense I didn't really get a chance to try the older libraries, but I assume they should work. Thanks for all the assistance.

@lupusorina
Copy link

@MartyG-RealSense I do not have any Color Transformer, as well.

I tried the same setup using a Jetson Nano. It seems that with the RS2_STREAM_COLOR, the pointclouds are not published, but with RS2_STREAM_ANY, they are black and white, as they were on the Raspberry Pi. So same thing happens. The librealsense is OK because I tried the pointcloud example, which works.

Thank you!

@MartyG-RealSense
Copy link
Collaborator

Hi @lupusorina In another case on Jetson where there were no Color Transformer options available, Doronhi the RealSense ROs wrapper developer commented "The issue definitely seems related to the fact that no color images reach realsense2_camera driver".

#1967 (comment)

In a comment directly below the linked-to one above, a RealSense ROS user who was a Raspberry Pi user (which has an Arm processor like Jetson boards do) said that they had the same problem and solved it by manually building the earlier 2.41.0 version of librealsense and the matching 2.2.21 version of the RealSense ROS wrapper.

#1967 (comment)

@lupusorina
Copy link

@MartyG-RealSense the latest driver librealsense definitely outputs colored pointclouds. I tried to run on the Jetson nano

./pointcloud/rs-pointcloud

See the output below:

IMG_6526

So I guess the issue is on the ros driver.

@MartyG-RealSense
Copy link
Collaborator

Hi @lupusorina Do you still require assistance with the problem above, please? Thanks!

@lupusorina
Copy link

@MartyG-RealSense thank you for your help. I think the problem was not solved yet. My workaround was to use a Jetson Nano and try to use the black and white pointclouds, but it will be great if the RGB would work. "building the earlier 2.41.0 version of librealsense and the matching 2.2.21 version of the RealSense ROS wrapper" didn't really work for me, but I can try more.

@MartyG-RealSense
Copy link
Collaborator

Thanks very much @lupusorina for the update - please do post the results of further tests here. Good luck!

@MartyG-RealSense
Copy link
Collaborator

Hi @lupusorina Do you have an update about this case that you can provide, please? Thanks!

@MartyG-RealSense
Copy link
Collaborator

Case closed due to no further comments received.

@kaushal07wick
Copy link

I have a similar problem, but in sitl.

/fastplanner_ws$ rostopic info camera/depth/image_raw

Type: sensor_msgs/Image

Publishers: None

Subscribers:

no data in rviz, how to resolve it.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
Projects
None yet
Development

No branches or pull requests

5 participants