Split up Pathfinder into some other classes
Removed duplicate waypoints in pathfinder