A星算法的实现及简单应用