Main MRPT website > C++ reference for MRPT 1.5.7
Functions
Motion planning geometry utility functions (`#include <mrpt/nav/nav_plan_geometry_utils.h>`)

Detailed Description

Collaboration diagram for Motion planning geometry utility functions (`#include <mrpt/nav/nav_plan_geometry_utils.h>`):

Functions

bool NAV_IMPEXP mrpt::nav::collision_free_dist_segment_circ_robot (const mrpt::math::TPoint2D &p_start, const mrpt::math::TPoint2D &p_end, const double robot_radius, const mrpt::math::TPoint2D &obstacle, double &out_col_dist)
 Computes the collision-free distance for a linear segment path between two points, for a circular robot, and a point obstacle (ox,oy). More...
 
bool NAV_IMPEXP mrpt::nav::collision_free_dist_arc_circ_robot (const double arc_radius, const double robot_radius, const mrpt::math::TPoint2D &obstacle, double &out_col_dist)
 Computes the collision-free distance for a forward path (+X) circular arc path segment from pose (0,0,0) and radius of curvature R (>0 -> +Y, <0 -> -Y), a circular robot and a point obstacle (ox,oy). More...
 

Function Documentation

◆ collision_free_dist_arc_circ_robot()

bool mrpt::nav::collision_free_dist_arc_circ_robot ( const double  arc_radius,
const double  robot_radius,
const mrpt::math::TPoint2D obstacle,
double &  out_col_dist 
)

Computes the collision-free distance for a forward path (+X) circular arc path segment from pose (0,0,0) and radius of curvature R (>0 -> +Y, <0 -> -Y), a circular robot and a point obstacle (ox,oy).

Returns
true if a collision exists, and the distance along the path will be in out_col_dist; false otherwise.

Definition at line 72 of file nav_plan_geometry_utils.cpp.

References ASSERT_ABOVE_, M_PI, min, mrpt::math::norm(), R, mrpt::math::wrapTo2Pi(), mrpt::math::TPoint2D::x, and mrpt::math::TPoint2D::y.

◆ collision_free_dist_segment_circ_robot()

bool mrpt::nav::collision_free_dist_segment_circ_robot ( const mrpt::math::TPoint2D p_start,
const mrpt::math::TPoint2D p_end,
const double  robot_radius,
const mrpt::math::TPoint2D obstacle,
double &  out_col_dist 
)

Computes the collision-free distance for a linear segment path between two points, for a circular robot, and a point obstacle (ox,oy).

Returns
true if a collision exists, and the distance along the segment will be in out_col_dist; false otherwise.
Exceptions
std::runtime_errorIf the two points are closer than an epsilon (1e-10)

Definition at line 19 of file nav_plan_geometry_utils.cpp.

References ASSERT_ABOVE_, min, mrpt::math::TPoint2D::norm(), R, mrpt::math::solve_poly2(), mrpt::math::square(), mrpt::math::TPoint2D::x, and mrpt::math::TPoint2D::y.

Referenced by TEST().




Page generated by Doxygen 1.8.14 for MRPT 1.5.7 Git: 5902e14cc Wed Apr 24 15:04:01 2019 +0200 at lun oct 28 01:39:17 CET 2019