A*算法，动态路径规划算法的一种，程序直接放到matlab即可运行。