用A*算法实现了自动寻路,有复杂障碍,求高手给优化