cleanup

astar.go

@@ -21,13 +21,14 @@ func NewPathfinder(weights Grid[int]) Pathfinder {
 
 // Find returns a path from start to end. If no path is found, an empty slice.
 func (p Pathfinder) Find(start, end Vec2) []Vec2 {
-	open := newMinHeap(p.weights.Width, p.weights.Height)
-	searchSpace := newSearchSpace(p.weights) // tracks the open, closed and f values of each node
+	searchSpace := newSearchSpace(p.weights)                  // tracks the open, closed and f values of each node
+	open := newMinHeap(searchSpace.Width, searchSpace.Height) // prioritised queue of f
 
 	origin := searchSpace.Get(start)
 	origin.f = 0
+	origin.open = true
 
-	open.push(heapNode{pos: start})
+	open.push(heapNode{pos: start, f: origin.f})
 	searchSpace.Set(start, origin)
 
 	for open.len() > 0 {
@@ -59,22 +60,24 @@ func (p Pathfinder) Find(start, end Vec2) []Vec2 {
 				return path
 			}
 
+			// check if more optimal path to successor was already encountered
 			existingSuccessor := searchSpace.Get(succPos)
-
 			if existingSuccessor.open && existingSuccessor.f < successor.f {
 				continue
 			}
-
 			if existingSuccessor.closed && existingSuccessor.f < successor.f {
 				continue
 			}
 
 			searchSpace.Set(succPos, successor)
 			open.push(heapNode{pos: succPos, f: successor.f})
 		}
+
 		q.closed = true
 		searchSpace.Set(qPos, q)
 	}
+
+	// not found
 	return []Vec2{}
 }