diff --git a/modules/map/pnc_map/path.cc b/modules/map/pnc_map/path.cc index d9527c82478c37b69441d8711a0e773edf258421..08cbaeda3030ad9e2742c6962e46bf2cdfb35634 100644 --- a/modules/map/pnc_map/path.cc +++ b/modules/map/pnc_map/path.cc @@ -197,6 +197,7 @@ void Path::init_width() { if (point.lane_waypoints().empty()) { _left_width.push_back(0.0); _right_width.push_back(0.0); + AERROR << "path point:" << point.DebugString() << " has invalid width."; } else { const LaneWaypoint waypoint = point.lane_waypoints()[0]; CHECK_NOTNULL(waypoint.lane); @@ -322,6 +323,9 @@ MapPathPoint Path::get_smooth_point(const InterpolatedIndex& index) const { lane_segment.lane, lane_segment.start_s + index.offset)); } } + if (point.lane_waypoints().empty() && !ref_point.lane_waypoints().empty()) { + point.add_lane_waypoint(ref_point.lane_waypoints()[0]); + } return point; } else { return ref_point;