internal/priorityqueue: Actually just make our own priority queue

1 files changed, 13 insertions, 0 deletions

diff --git a/internal/priorityqueue/sift_up.go b/internal/priorityqueue/sift_up.go
new file mode 100644
index 00000000..7ff4453f
--- /dev/null
+++ b/internal/priorityqueue/sift_up.go
@@ -0,0 +1,13 @@
+package priorityqueue
+
+func (queue *Queue[T]) siftUp(idx int) {
+	for idx > 0 {
+		parent := (idx - 1) / 2
+		if !queue.less(queue.items[idx], queue.items[parent]) {
+			return
+		}
+
+		queue.items[idx], queue.items[parent] = queue.items[parent], queue.items[idx]
+		idx = parent
+	}
+}