Move navigation stuff to a static class Pathfinding optimizations, forget theta* its much slower Switch OpenSet to a PriorityQueue Remove unused