Function swri_route_util::interpolateRoutePosition

Function Documentation

bool swri_route_util::interpolateRoutePosition(RoutePoint &point, const Route &route, const marti_nav_msgs::msg::RoutePosition &position, bool allow_extrapolation)