测试A start 算法