Added Pathfinding stuff (Not implemented)