A light-weighted stair detection algorithm using 2D correlation analysis on real-time LiDAR scans that searches for a similar pattern of a manually generated kernel.
A video shows a result of this stair detector here.
git clone https://github.com/MichaelFYang/Real_Time_Stair_Detector.git
cd Real_Time_Stair_Detector/
catkin build
source devel/setup.bash
Before launch the stair detector, make sure you have the correct topics of odom and registered poincloud in the config file
Open the config file as the way you like
gedit <<YOUR WORKSPACE>>/src/stair_detector/config/default.yaml
roslaunch stair_detector stair_detector.launch
python <<YOUR WORKSPACE>>/src/stair_detector/src/kernal_generation.py
The python script "kernel_generation.py" generates a normalized 2D kernel that used to find stairs. You can modify the kernel and use it to seach for the pattern you want from the real-time LiDAR scans.
This is a research project that strongly depends on and ties to the certain platforms and frameworks used by CMU-OSU team for DARPA SubT Challenge. It is not well generalized for integration into other platforms. Intentions of using this code for you own researches may require works of code modifications.
Questions asked in "Issues" for integrations will be answered with best availabilities.
Fan Yang ([email protected], [email protected], [email protected])