route_speeds.cpp File Reference

#include <swri_route_util/route_speeds.h>
#include <unordered_map>
#include <swri_geometry_util/geometry_util.h>
#include <swri_roscpp/swri_roscpp.h>
#include <swri_route_util/util.h>

Include dependency graph for route_speeds.cpp:

Go to the source code of this file.

Namespaces
	swri_route_util

Functions
static void	swri_route_util::addItem (mcm::KeyValueArray &m, const std::string &key, const std::string &value)
static double	swri_route_util::estimateCurvature (const Route &route, const size_t index, double filter_size)
void	swri_route_util::generateObstacleData (std::vector< ObstacleData > &obstacle_data, const stu::Transform g_route_from_obs, const mnm::ObstacleArray &obstacles_msg)
static double	swri_route_util::maxSpeedForCurvature (double curvature, const SpeedForCurvatureParameters &params)
void	swri_route_util::speedsForCurvature (mnm::RouteSpeedArray &speeds, const Route &route, const SpeedForCurvatureParameters &parameters)
void	swri_route_util::speedsForObstacles (mnm::RouteSpeedArray &speeds, std::vector< DistanceReport > &reports, const Route &route, const mnm::RoutePosition &route_position, const std::vector< ObstacleData > &obstacles, const SpeedForObstaclesParameters &p)