- [ ] Add a heuristic to pathfinding to make it A*-style. - [ ] Maintain a sorted list instead of sorting the list after each iteration when creating a Path.