Modified map pathfinding, still working on how to save multiple paths.