Added pathfinding
Pathfinding sorta works, but map display is bugged
It works except for edge cases but to hell with them