finished pathfinding, not sure if working