自己用java实现的A星寻路算法，不敢保证完全正确，但是希望对你有一定的帮助。