Nav2 Navigation Stack - jazzy
jazzy
ROS 2 Navigation Stack
|
A table of motion primitives and related functions. More...
#include <nav2_smac_planner/include/nav2_smac_planner/node_lattice.hpp>
Public Member Functions | |
LatticeMotionTable () | |
A constructor for nav2_smac_planner::LatticeMotionTable. | |
void | initMotionModel (unsigned int &size_x_in, SearchInfo &search_info) |
Initializing state lattice planner's motion model. More... | |
MotionPrimitivePtrs | getMotionPrimitives (const NodeLattice *node, unsigned int &direction_change_index) |
Get projections of motion models. More... | |
unsigned int | getClosestAngularBin (const double &theta) |
Get the angular bin to use from a raw orientation. More... | |
float & | getAngleFromBin (const unsigned int &bin_idx) |
Get the raw orientation from an angular bin. More... | |
double | getAngle (const double &theta) |
Get the angular bin to use from a raw orientation. More... | |
Static Public Member Functions | |
static LatticeMetadata | getLatticeMetadata (const std::string &lattice_filepath) |
Get file metadata needed. More... | |
Public Attributes | |
unsigned int | size_x |
unsigned int | num_angle_quantization |
float | change_penalty |
float | non_straight_penalty |
float | cost_penalty |
float | reverse_penalty |
float | travel_distance_reward |
float | rotation_penalty |
float | min_turning_radius |
bool | allow_reverse_expansion |
std::vector< std::vector< MotionPrimitive > > | motion_primitives |
ompl::base::StateSpacePtr | state_space |
std::vector< TrigValues > | trig_values |
std::string | current_lattice_filepath |
LatticeMetadata | lattice_metadata |
MotionModel | motion_model = MotionModel::UNKNOWN |
A table of motion primitives and related functions.
Definition at line 51 of file node_lattice.hpp.
double nav2_smac_planner::LatticeMotionTable::getAngle | ( | const double & | theta | ) |
Get the angular bin to use from a raw orientation.
theta | Angle in radians |
Definition at line 183 of file node_lattice.cpp.
float & nav2_smac_planner::LatticeMotionTable::getAngleFromBin | ( | const unsigned int & | bin_idx | ) |
Get the raw orientation from an angular bin.
bin_idx | Index of the bin |
Definition at line 178 of file node_lattice.cpp.
Referenced by nav2_smac_planner::NodeLattice::getDistanceHeuristic(), and nav2_smac_planner::NodeLattice::isNodeValid().
unsigned int nav2_smac_planner::LatticeMotionTable::getClosestAngularBin | ( | const double & | theta | ) |
Get the angular bin to use from a raw orientation.
theta | Angle in radians |
Definition at line 163 of file node_lattice.cpp.
|
static |
Get file metadata needed.
lattice_filepath | Filepath to the lattice file |
Definition at line 149 of file node_lattice.cpp.
Referenced by nav2_smac_planner::SmacPlannerLattice::configure(), and nav2_smac_planner::SmacPlannerLattice::dynamicParametersCallback().
MotionPrimitivePtrs nav2_smac_planner::LatticeMotionTable::getMotionPrimitives | ( | const NodeLattice * | node, |
unsigned int & | direction_change_index | ||
) |
Get projections of motion models.
node | Ptr to NodeLattice |
Reference | direction change index |
Definition at line 117 of file node_lattice.cpp.
Referenced by nav2_smac_planner::NodeLattice::getNeighbors().
void nav2_smac_planner::LatticeMotionTable::initMotionModel | ( | unsigned int & | size_x_in, |
SearchInfo & | search_info | ||
) |
Initializing state lattice planner's motion model.
size_x_in | Size of costmap in X |
search_info | Parameters for searching |
Definition at line 48 of file node_lattice.cpp.