Started on the Pathfinding Thing, It needs work