traffic_incident_parser Namespace Reference

Classes
class	TrafficIncidentParserNode
	The class responsible for processing incoming MobilityOperation messages with strategy "carma3/Incident_Use_Case". More...
class	TrafficIncidentParserWorker

Functions
size_t	getNearestPointIndex (const lanelet::ConstLineString3d &points, const lanelet::BasicPoint2d &point)
	Helper method to get the nearest point index of a point and a linestring. More...

Function Documentation

getNearestPointIndex()

size_t traffic_incident_parser::getNearestPointIndex	(	const lanelet::ConstLineString3d &	points,
		const lanelet::BasicPoint2d &	point
	)

Helper method to get the nearest point index of a point and a linestring.

Definition at line 163 of file traffic_incident_parser_worker.cpp.

    {
        double min_distance = std::numeric_limits<double>::max();
        size_t i = 0;
        size_t best_index = 0;
        for (const auto& p : points)
        {
            double distance = lanelet::geometry::distance2d(p, point);
            if (distance < min_distance)
            {
                best_index = i;
                min_distance = distance;
            }
            i++;
        }
 
        return best_index;
    }

References process_bag::i, and process_traj_logs::point.

Referenced by traffic_incident_parser::TrafficIncidentParserWorker::getAdjacentForwardCenterlines(), and traffic_incident_parser::TrafficIncidentParserWorker::getAdjacentReverseCenterlines().

Here is the caller graph for this function: