Template Function lanelet::geometry::curvature2d

Function Documentation

template<typename Point2dT>
double lanelet::geometry::curvature2d(const Point2dT &p1, const Point2dT &p2, const Point2dT &p3)

Calculate the curvature value given 3 consecutive points. The curvature value is always positive.

If any 2 of the 3 points duplicate, return infinity.

Parameters:

p1, p2, p3 – are the points

Returns:

curvature value.