Awesome
dyn_small_obs_avoidance
Avoiding dynamic small obstacles with onboard sensing and computating on aerial robots
This repository is used for UAV dynamic small obstacles avoidance. It is a complete system for lidar-based UAV, including FAST-LIO slam, time-accumulated KD-Tree mapping and kinodynamic A* search modules. It is able to avoid dynamic small obstacles (down to 20mm diameter bars) by running at 50Hz.
Related paper: "Avoiding dynamic small obstacles with onboard sensing and computating on aerial robots", available on arxiv now https://arxiv.org/abs/2103.00406.
Related video: https://youtu.be/pBHbQ_J1Qhc
1. Prerequisites
As the same as the prerequisites as FAST-LIO.
1.1 Ubuntu and ROS
Ubuntu >= 18.04.
ROS >= Melodic. ROS Installation
1.2. PCL && Eigen
PCL >= 1.8, Follow PCL Installation.
Eigen >= 3.3.4, Follow Eigen Installation.
2. Build
Clone the repository and catkin_make:
cd ~/catkin_ws/src
git clone https://github.com/hku-mars/dyn_small_obs_avoidance.git
cd ..
catkin_make
3.Run demo
3.1 Start program
source devel/setup.bash
roslaunch path_planning demo.launch
3.2 Run rosbag or directly fly
You can download our demos rosbag from https://drive.google.com/drive/folders/1knQwnrbwunGIvXzOL6wWKkCtOkGE22bG?usp=sharing And play the bag by:
rosbag play XXX.bag
3.3 Set target point
rostopic pub /goal geometry_msgs/PoseStamped '{header: {stamp: now, frame_id: "camera_init"}, pose: {position: {x: 5.0, y: 0.0, z: 1.0}, orientation: {w: 1.0}}}'
You can change the target point by setting different value of 'x','y','z' in the above command.
4.Run with other equipments
You can also run this planning program as a module with other point cloud input from other sensors (like depth camera D435i). But we have not yet test it on depth cameras. First, change the point cloud topic to your point cloud topic name in path_planning/launch/demo_withNOlidar.launch
<remap from='/your_pointcloud_topic' to='/cloud_registered'/>
Then, start the program:
source devel/setup.bash
roslaunch path_planning demo_withNOlidar.launch
5.Acknowledgments
Thanks for FAST-PLANNER(Zhou, Boyu and Gao, Fei and Wang, Luqi and Liu, Chuhao and Shen, Shaojie. Robust and efficient quadrotor trajectory generation for fast autonomous flight), FAST-PLANNER.