教程:
http://wiki.ros.org/navigation/Tutorials/Writing%20A%20Global%20Path%20Planner%20As%20Plugin%20in%20ROS
事例:
https://github.com/coins-lab/relaxed_astar