Scores trajectories based on whether the robot ends up pointing toward the eventual goal. More...

#include <nav2_dwb_controller/dwb_critics/include/dwb_critics/goal_align.hpp>

Inheritance diagram for dwb_critics::GoalAlignCritic:

[legend]

Collaboration diagram for dwb_critics::GoalAlignCritic:

[legend]

Public Member Functions
void	onInit () override

bool	prepare (const geometry_msgs::msg::Pose &pose, const nav_2d_msgs::msg::Twist2D &vel, const geometry_msgs::msg::Pose &goal, const nav_msgs::msg::Path &global_plan) override
	Prior to evaluating any trajectories, look at contextual information constant across all trajectories. More...

double	scorePose (const geometry_msgs::msg::Pose &pose) override
	Retrieve the score for a single pose. More...

Public Member Functions inherited from dwb_critics::GoalDistCritic
bool	prepare (const geometry_msgs::msg::Pose &pose, const nav_2d_msgs::msg::Twist2D &vel, const geometry_msgs::msg::Pose &goal, const nav_msgs::msg::Path &global_plan) override
	Prior to evaluating any trajectories, look at contextual information constant across all trajectories. More...

Public Member Functions inherited from dwb_critics::MapGridCritic
void	onInit () override

double	scoreTrajectory (const dwb_msgs::msg::Trajectory2D &traj) override
	Return a raw score for the given trajectory. More...

void	addCriticVisualization (std::vector< std::pair< std::string, std::vector< float >>> &cost_channels) override
	Add information to the given pointcloud for debugging costmap-grid based scores. More...

double	getScale () const override

double	getScore (unsigned int x, unsigned int y)
	Retrieve the score for a particular cell of the costmap. More...

void	setAsObstacle (unsigned int index)
	Sets the score of a particular cell to the obstacle cost. More...

Public Member Functions inherited from dwb_core::TrajectoryCritic
void	initialize (const nav2::LifecycleNode::SharedPtr &nh, const std::string &name, const std::string &ns, std::shared_ptr< nav2_costmap_2d::Costmap2DROS > costmap_ros)
	Initialize the critic with appropriate pointers and parameters. More...

virtual void	debrief (const nav_2d_msgs::msg::Twist2D &)
	debrief informs the critic what the chosen cmd_vel was (if it cares)

std::string	getName ()

void	setScale (const double scale)

Protected Attributes
double	forward_point_distance_

Protected Attributes inherited from dwb_critics::MapGridCritic
std::shared_ptr< MapGridQueue >	queue_

nav2_costmap_2d::Costmap2D *	costmap_

std::vector< double >	cell_values_

double	obstacle_score_

double	unreachable_score_
	Special cell_values.

bool	stop_on_failure_

ScoreAggregationType	aggregationType_

Protected Attributes inherited from dwb_core::TrajectoryCritic
std::string	name_

std::string	dwb_plugin_name_

std::shared_ptr< nav2_costmap_2d::Costmap2DROS >	costmap_ros_

double	scale_

nav2::LifecycleNode::WeakPtr	node_

Additional Inherited Members
Public Types inherited from dwb_core::TrajectoryCritic
using	Ptr = std::shared_ptr< dwb_core::TrajectoryCritic >

Protected Types inherited from dwb_critics::MapGridCritic
enum class	ScoreAggregationType { Last , Sum , Product }
	Separate modes for aggregating scores across the multiple poses in a trajectory. More...

Protected Member Functions inherited from dwb_critics::GoalDistCritic
bool	getLastPoseOnCostmap (const nav_msgs::msg::Path &global_plan, unsigned int &x, unsigned int &y)

Protected Member Functions inherited from dwb_critics::MapGridCritic
void	reset () override
	Clear the queueDWB_CRITICS_MAP_GRID_He and set cell_values_ to the appropriate number of unreachableCellScore.

void	propagateManhattanDistances ()
	Go through the queue and set the cells to the Manhattan distance from their parents.

Detailed Description

Scores trajectories based on whether the robot ends up pointing toward the eventual goal.

Similar to GoalDistCritic, this critic finds the pose from the global path farthest from the robot that is still on the costmap and then evaluates how far the front of the robot is from that point. This works as a proxy to calculating which way the robot should be pointing.

Definition at line 52 of file goal_align.hpp.

Member Function Documentation

◆ prepare()

bool dwb_critics::GoalAlignCritic::prepare	(	const geometry_msgs::msg::Pose &	,
		const nav_2d_msgs::msg::Twist2D &	,
		const geometry_msgs::msg::Pose &	,
		const nav_msgs::msg::Path &
	)

overridevirtual

Prior to evaluating any trajectories, look at contextual information constant across all trajectories.

Subclasses may overwrite. Return false in case there is any error.

Parameters

pose	Current pose (costmap frame)
vel	Current velocity
goal	The final goal (costmap frame)
global_plan	Transformed global plan in costmap frame, possibly cropped to nearby points

Reimplemented from dwb_core::TrajectoryCritic.

Definition at line 58 of file goal_align.cpp.

References dwb_critics::GoalDistCritic::prepare().

Here is the call graph for this function: