Added debug option to draw path distance calculation.