SteveMacenski / spatio_temporal_voxel_layer

A new voxel layer leveraging modern 3D graphics tools to modernize navigation environmental representations
http://wiki.ros.org/spatio_temporal_voxel_layer
GNU Lesser General Public License v2.1
616 stars 183 forks source link

Does the STVL provides the ability to identify the obstacle infromations (height, width and distance from the robot) #268

Closed hmpcjayaweera closed 1 year ago

hmpcjayaweera commented 1 year ago

Does the STVL provides the ability to identify the obstacle information such as distance to obstacles from the robot, obstacle height, width and length. If yes, please can you give me some information about it. In addition, can we use the STVL for obstacle avoidance in NAV2. When I use the STVL plugins, it shows the 3D obstacle in Rviz2, but the robot is not avoiding it in point to point navigation (I only use STVL layer and inflation layer for the local costmap). Thank you.

SteveMacenski commented 1 year ago

You have the coordinates of the voxels in the voxel layer; so of course you can compute the distance from your robot's pose to any particular voxel or find its height. Simply use the voxel information and your robot pose information to compute the distance or look at the Z height of the voxel of interest.

Please file that on ROS Answers with alot more detail and configuration files of relevant systems.

hmpcjayaweera commented 1 year ago

When I check the "ros2 topic info /local_costmap/voxel_grid", it it shows that "Type: sensor_msgs/msg/PointCloud2", since it is not in the voxel grid format is it possible to get the obstacle coordinate from voxel layer. thanks

SteveMacenski commented 1 year ago

That is the voxel grid.

hmpcjayaweera commented 1 year ago

Thank you very much for your quick reply, Please can I know the format of this voxel grid (sensor_msgs/msg/PointCloud2), because these are just pixel values. How can i convert this point2 data to world coordinate. Thank you.