Учитывая что у тебя pathfinding в 3д пространстве, ты можешь веса сопостовлять которые будут максимально точно описывать ситуацию, разница будет невероятно большая
Да я просто хз есть ли смысл его реализовывать,мне просто от одной точки до другой нужно построить маршрут,чем короче тем лучше в 2д пространтсве,не учитывая диагональ,что бы вернул лист точек,думал просто перебором пройтись