Function swri_route_util::routeDistance

Function Documentation

bool swri_route_util::routeDistance(double &distance, const marti_nav_msgs::msg::RoutePosition &start, const marti_nav_msgs::msg::RoutePosition &end, const Route &route)