A* arreglado, sólo falta incluir las restricciones de terreno.