stereolabs / zed-ros2-wrapper

ROS 2 wrapper for the ZED SDK
https://www.stereolabs.com/docs/ros2/
Apache License 2.0
161 stars 165 forks source link

Spatial Mapping Fused Point Cloud Not Populating #267

Open liamcarlos opened 1 month ago

liamcarlos commented 1 month ago

Preliminary Checks

Description

Hello there, I've trying to use the spatial mapping feature with my ZED One by making a service call to ~/enable_mapping but it doesn't seem to be working.

Steps to Reproduce

  1. Run rviz display launch file:
    ros2 launch zed_display_rviz2 display_zed_cam.launch.py camera_model:=zed
  2. Make service call to enable mapping:
    ros2 service call /zed/zed_node/enable_mapping std_srvs/srv/SetBool data:\ true\

Expected Result

I expected to see the ~/fused_cloud pointcloud topic populate and show feedback in RViz

Actual Result

Instead, nothing appears in RViz, the service call responds with:

waiting for service to become available...
requester: making request: std_srvs.srv.SetBool_Request(data=True)

response:
std_srvs.srv.SetBool_Response(success=True, message='Spatial Mapping started')

and when ~/fused_cloud is echoed the data field remains empty:

---
header:
  stamp:
    sec: 0
    nanosec: 0
  frame_id: map
height: 1
width: 0
fields:
- name: x
  offset: 0
  datatype: 7
  count: 1
- name: y
  offset: 4
  datatype: 7
  count: 1
- name: z
  offset: 8
  datatype: 7
  count: 1
- name: rgb
  offset: 12
  datatype: 7
  count: 1
is_bigendian: false
point_step: 16
row_step: 0
data: []
is_dense: false
---

ZED Camera model

ZED

Environment

OS: Ubuntu 22.04 Jammy
CPU: x86_64
GPU: Nvidia GA106 [RTX A2000 12GB]
ZED SDK version: v4.2.1
Other info: ROS Iron

Anything else?

The spatial_mapping.py sample that comes with the ZED SDK works fine.

github-actions[bot] commented 1 day ago

This issue is stale because it has been open 30 days with no activity. Remove stale label or comment otherwise it will be automatically closed in 5 days