a_star :: Node :: path_to_alts
destination
or a node accepted by alt_targets
# Find a path to a possible `destination` or a node accepted by `alt_targets`
fun path_to_alts(destination: nullable N, max_cost: Int, context: PathContext,
alt_targets: nullable TargetCondition[N]): nullable AStarPath[N]
do
var cost = 0
var nbr_buckets = context.worst_cost + context.worst_heuristic_cost + 1
var buckets = new Array[List[N]].with_capacity(nbr_buckets)
for i in [0 .. nbr_buckets[ do
buckets.add(new List[N])
end
graph.pathfinding_current_evocation += 1
# open source node
buckets[0].add(self)
open = true
self.last_pathfinding_evocation = graph.pathfinding_current_evocation
self.best_cost_up_to = 0
loop
var frontier_node: nullable N = null
var bucket_searched = 0
# find next valid node in frontier/buckets
loop
var current_bucket = buckets[cost % nbr_buckets]
if current_bucket.is_empty then # move to next bucket
cost += 1
if cost > max_cost then return null
bucket_searched += 1
if bucket_searched > nbr_buckets then break
else # found a node
frontier_node = current_bucket.pop
if frontier_node.open then break
end
end
# no path possible
if frontier_node == null then
return null
# at destination
else if frontier_node == destination or
(alt_targets != null and alt_targets.accept(frontier_node)) then
var path = new AStarPath[N](cost)
while frontier_node != self do
path.nodes.unshift(frontier_node)
frontier_node = frontier_node.best_source
assert frontier_node != null
end
return path
# adds all next nodes to frontier/buckets
else
frontier_node.open = false
for link in frontier_node.links do
var peek_node = link.to
if not context.is_blocked(link) and
(peek_node.last_pathfinding_evocation != graph.pathfinding_current_evocation or
(peek_node.open and
peek_node.best_cost_up_to > cost + context.cost(link)))
then
peek_node.open = true
peek_node.last_pathfinding_evocation = graph.pathfinding_current_evocation
peek_node.best_cost_up_to = cost + context.cost(link)
peek_node.best_source = frontier_node
var est_cost
if destination != null then
est_cost = peek_node.best_cost_up_to + context.heuristic_cost(peek_node, destination)
else if alt_targets != null then
est_cost = peek_node.best_cost_up_to + alt_targets.heuristic_cost(peek_node, link)
else est_cost = 0
var at_bucket = buckets[est_cost % nbr_buckets]
at_bucket.add(peek_node)
end
end
end
end
end
lib/a_star/a_star.nit:99,2--189,4