Path plan algorithm, include: A*, APF(Artificial Potential Field)
We use the hybrid a start to search a initial path for the optimization-based method to find a optimal trajectory in the automated parking scenario
A*进行路径规划,Minimum-Snap进行路径优化,在ubuntu20.04上进行操作
We fork the code from https://github.com/i2Nav-WHU/KF-GINS and add a new branch 'for_vs' to support debug in visual studio 2017 tool