This repository contains the implementation of our IROS2023 paper:
Hybrid Map-Based Path Planning for Robot Navigation in Unstructured Environments [pdf, IEEE]
Jiayang Liu, Xieyuanli Chen, Junhao Xiao, Sichao Lin, Zhiqiang Zheng, Huimin Lu
If you use our code in your work, please star our repo and cite our paper.
@inproceedings{liu2023iros,
title={{Hybrid Map-Based Path Planning for Robot Navigation in Unstructured Environments}},
author={Liu, Jiayang and Chen, Xieyuanli and Xiao, Junhao and Lin, Sichao and Zheng, Zhiqiang and Lu, Huimin},
booktitle={IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS)},
pages={2216-2223},
year={2023}
}
Comparison of path planning in a Mars-like surface dataset. The color map is a hybrid map generated by our terrain assessment. The color represents traversability, which gradually increases from warm to cool colors. The red-colored area represents impassable 2D map areas, and the rest belongs to the 2.5D map. The black path is generated by our method, while the yellow and green paths are from a 2D map-based and a 2.5D map-based baseline methods, respectively. The corresponding path lengths are listed below. As can be seen, our method generates a shorter path across safer areas.
Overview of our framework. The framework consists of three main components:
- Segmentation of the raw 3D point clouds.
- Terrain assessment and the hybrid map generation.
- 3D pose projection and T-Hybrid A* path planning.
The Canadian Planetary Emulation Terrain 3D mapping dataset](http://asrl.utias.utoronto.ca/datasets/3dmap/).
-
Get the 3D global point clouds: Note that our terrain assessment starts from the origin of the map, so you may need to translate or rotate the point clouds, and then you need to obtain the entire length and width of the map area that needs to be assessed.
There are some tools here:
rosrun terrain_analysis cloud_process ## Tool for transforming the point clouds
rosrun terrain_analysis find_location ## Tool for getting the points' location by clicking the mouse.
- Terrain assessment: Once you get the transformed point clouds, please modify the corresponding parameters in
terrain_analysis.cpp. Run the following command after compilation:
rosrun terrain_analysis terrain_analysis
- Display the hybrid map: Layer of static terrain traversability
rosrun read_pcd read_pcd
- Plan the path in the hybrid map: Our path planner is inspired by Kurzer' Hybrid A* algorithm, and some improvements are made based on this algorithm. Please modify the corresponding parameters in
constants.h, and run the following command after compilation:
roslaunch Thybrid_astar path_plan_nubot.launch
Please contact us with any questions or suggestions!
Jiayang Liu: jyliu1998@163.com and Xieyuanli Chen: xieyuanli.chen@nudt.edu.cn
This project is free software made available under the MIT License. For details see the LICENSE file.