some excellent code for SLAM,path planning - View it on GitHub