This ros package converts voxel maps generated by the UFOMap mapping solution into 2D occupancy maps for unmanned aerial vehicles (UAVs) and unmanned ground vehicles (UGV). The package also provides a method to convert 2D paths to 3D path for UAVs and UAVs.
The method uses free space in the voxel map to find navigable space in the voxel map, as well as extracting a height map to create a traversability slope map, which is used to detect obstacles in the environment and include them in the map generated for the UGVs.
The Height map can also be used to convert paths from 2D to 3D using the path_converter_node provided by the package.
This ROS package is based on the following article:
3D Voxel Maps to 2D Occupancy Maps for Efficient Path Planning for Aerial and Ground Robots [ArXiv]
@misc{fredriksson20243d,
title={3D Voxel Maps to 2D Occupancy Maps for Efficient Path Planning for Aerial and Ground Robots},
author={Scott Fredriksson and Akshit Saradagi and George Nikolakopoulos},
year={2024},
eprint={2406.07270},
archivePrefix={arXiv},
primaryClass={cs.RO}
}
If you use this ROS package in a scientific publication, please cite the paper.
- Install UFOMap for ros
- Navigate to src folder in workspace
cd ~/catkin_ws/src - Clone the GitHub to ros workspace:
git clone https://github.com/LTU-RAI/3D-Voxel-Map-to-2D-Occupancy-Map-Conversion-Using-Free-Space-Representation cd ..- Build project:
catkin build mapconversion
map_conversion.launch: Example launch file for launching map conversion node
path_conversion.launch: Example launch file for launching map path conversion node
A node that converts the input 3D voxel map to a 2D occupancy map and a height map with the height of the floor and ceiling.
map_frame: Name of frame map.
map_position_z: Z position used for the outputted 2D maps.
minimum_z: Minimum height of free space the robot can traverse.
max_slope_ugv: Maximum slope ground robot can climb, used to detect and represent obstacles in the 2D occupancy map
ufomap: Input voxel map.
mapUGV: Map for ground robot, includes obstacles detected using max_slope_ugv.
mapUAV: Map for aerial robot, containing free space and bounding walls.
heightMap: 2D map containing the height of the floor and ceiling of the environment.
slopeMap: 2D map containing the slope value for the floor in the environment.
visualization_floor_map: Rviz cost map, for showing a heat map of the floor height in the heightMap. This is only for visualization.
visualization_ceiling_map: Rviz cost map, for showing a heat map of the ceiling height in the heightMap. This is only for visualization.
visualization_slope_map: Rviz cost map, for showing a heat map of the slope of the map in the range 0 to 2*max_slope_ugv. This is only for visualization.
A node that converts inputed path generated using a 2D planer to a 3D path using heightMap generated by map_conversion_node.
use_collision_sphere: Add collision sphere around robot, use true for aerial robots and false for ground robot. If a collision with either the floor or ceiling is detected during path conversion, the path will be adjusted so that no collision occurs.
collision_radius: Radius for collision sphere, only used if use_collision_sphere is true.
path_offset: Desired height above ground for the robot.
path_smothing_length: The amount of step before and after robot used for path smoothing.
heightMap: Hight map used for 2D to 3D conversion generated by map_conversion_node.
pathIn: 2D path that will be converted into 3D.
pathOut: 3D path converted from 2D using the heightMap.