Adding Pathfinding class
Merging changes into game state, created a new gamestate for pathfinding for easy debugging. More pathfinding work.
Finished Rough Pathfinding, needs to be implemented better