#include <swri_route_util/plan_util.h>#include <swri_transform_util/frames.h>#include <swri_transform_util/transform_util.h>#include <swri_geometry_util/geometry_util.h>
Include dependency graph for plan_util.cpp:
Go to the source code of this file.
Namespaces | |
| swri_route_util | |
Functions | |
| void | swri_route_util::fillOrientations (marti_nav_msgs::Plan &path) |
| bool | swri_route_util::findLocalNearestDistanceForward (const marti_nav_msgs::Plan &path, const double x, const double y, marti_nav_msgs::PlanPosition &nearest_position, double &nearest_separation) |
| void | swri_route_util::getPlanPosition (const marti_nav_msgs::Plan &path, const marti_nav_msgs::PlanPosition position, tf::Vector3 &tf, bool extrapolate=false) |
| static double | swri_route_util::interpolateAngle (double from, double to, double t) |
| void | swri_route_util::interpolatePlanPosition (const marti_nav_msgs::Plan &path, const marti_nav_msgs::PlanPosition position, marti_nav_msgs::PlanPoint &pt, bool extrapolate=false) |
| static void | swri_route_util::nearestDistanceToLineSegment (double &min_distance_from_line, double &min_distance_on_line, const tf::Vector3 &p0, const tf::Vector3 &p1, const tf::Vector3 &p, bool extrapolate_start, bool extrapolate_end) |
| void | swri_route_util::normalizePlanPosition (marti_nav_msgs::PlanPosition &position, const marti_nav_msgs::Plan &path) |
| bool | swri_route_util::planDistance (double &distance, const marti_nav_msgs::PlanPosition &start, const marti_nav_msgs::PlanPosition &end, const mnm::Plan &route) |
| bool | swri_route_util::projectOntoPlan (mnm::PlanPosition &position, const mnm::Plan &route, const tf::Vector3 &point, bool extrapolate_before_start, bool extrapolate_past_end) |
| bool | swri_route_util::projectOntoPlanWindow (marti_nav_msgs::PlanPosition &position, const marti_nav_msgs::Plan &route, const tf::Vector3 &point, const marti_nav_msgs::PlanPosition &window_start, const marti_nav_msgs::PlanPosition &window_end) |
| void | swri_route_util::projectToXY (marti_nav_msgs::Plan &route) |
| void | swri_route_util::transform (marti_nav_msgs::Plan &path, const swri_transform_util::Transform &transform, const std::string &target_frame) |