Seperated pathfinding module from main game.
Fixed a-star algorithm by using a custom list instead of TreeSet with
weird comparators.