Я подозреваю, что у вас возникли проблемы с интерпретацией вашего подхода, потому что в этой задаче нет простой единой цели, используемой для определения «допустимого». Скорее, у вас есть небольшой TSP (Задача коммивояжера), в котором вы можете собирать предметы в любом из 4! заказы. Вы не описали , какое расстояние вы использовали в своем подходе, но упрощенные вычисления не подойдут. Добавление всех 10 расстояний (для n = 5 узлов; 5x4 / 2) - это просто перерасход, так как вы пройдете только 4 из этих ребер. Точно так же неверно добавлять расстояния от A до каждого элемента.
Вместо этого вам нужно использовать эвристику на каждом ребре пути, добавить, а затем сгенерировать эвристическую оценку для рассматриваемого пути с четырьмя ребрами. Для этой обработки евклидово расстояние допустимо, но его квадрат - нет: оно серьезно переоценивается и находится в неправильных единицах (площадь, а не расстояние). Манхэттенское расстояние, вероятно, будет лучше для вас.
Обратите внимание, что у вас есть проблемный случай в этом примере, так как преимущество 3-0 будет недооценено в 4-5 раз, в зависимости от вашей эвристики.