Possibly implemented A*
stuff
stuff
Pathfinding works