A class implementing a local planner using the Dynamic Window Approach. More...

#include <dwa_planner.h>

Public Member Functions
bool	checkTrajectory (const Eigen::Vector3f pos, const Eigen::Vector3f vel, const Eigen::Vector3f vel_samples)
	Check if a trajectory is legal for a position/velocity pair.
	DWAPlanner (std::string name, base_local_planner::LocalPlannerUtil *planner_util)
	Constructor for the planner.
base_local_planner::Trajectory	findBestPath (tf::Stamped< tf::Pose > global_pose, tf::Stamped< tf::Pose > global_vel, tf::Stamped< tf::Pose > &drive_velocities)
	Given the current position and velocity of the robot, find the best trajectory to exectue.
bool	getCellCosts (int cx, int cy, float &path_cost, float &goal_cost, float &occ_cost, float &total_cost)
	Compute the components and total cost for a map grid cell.
double	getSimPeriod ()
	Get the period at which the local planner is expected to run.
void	reconfigure (DWAPlannerConfig &cfg)
	Reconfigures the trajectory planner.
bool	setPlan (const std::vector< geometry_msgs::PoseStamped > &orig_global_plan)
void	updatePlanAndLocalCosts (tf::Stamped< tf::Pose > global_pose, const std::vector< geometry_msgs::PoseStamped > &new_plan, const std::vector< geometry_msgs::Point > &footprint_spec)
	Update the cost functions before planning.
	~DWAPlanner ()
	Destructor for the planner.
Private Attributes
base_local_planner::MapGridCostFunction	alignment_costs_
double	cheat_factor_
boost::mutex	configuration_mutex_
double	forward_point_distance_
double	gdist_scale_
base_local_planner::SimpleTrajectoryGenerator	generator_
std::vector < geometry_msgs::PoseStamped >	global_plan_
base_local_planner::MapGridCostFunction	goal_costs_
base_local_planner::MapGridCostFunction	goal_front_costs_
base_local_planner::MapGridVisualizer	map_viz_
	The map grid visualizer for outputting the potential field generated by the cost function.
base_local_planner::ObstacleCostFunction	obstacle_costs_
double	occdist_scale_
base_local_planner::OscillationCostFunction	oscillation_costs_
base_local_planner::MapGridCostFunction	path_costs_
double	pdist_scale_
base_local_planner::LocalPlannerUtil *	planner_util_
bool	publish_cost_grid_pc_
	Whether or not to build and publish a PointCloud.
bool	publish_traj_pc_
base_local_planner::Trajectory	result_traj_
base_local_planner::SimpleScoredSamplingPlanner	scored_sampling_planner_
double	sim_period_
	The number of seconds to use to compute max/min vels for dwa.
double	stop_time_buffer_
	How long before hitting something we're going to enforce that the robot stop.
pcl::PointCloud < base_local_planner::MapGridCostPoint > *	traj_cloud_
pcl_ros::Publisher < base_local_planner::MapGridCostPoint >	traj_cloud_pub_
Eigen::Vector3f	vsamples_

Detailed Description

A class implementing a local planner using the Dynamic Window Approach.

Definition at line 70 of file dwa_planner.h.

Constructor & Destructor Documentation

dwa_local_planner::DWAPlanner::DWAPlanner	(	std::string	name,
		base_local_planner::LocalPlannerUtil *	planner_util
	)

Constructor for the planner.

Parameters:

name	The name of the planner
costmap_ros	A pointer to the costmap instance the planner should use
global_frame	the frame id of the tf frame to use

Definition at line 116 of file dwa_planner.cpp.

dwa_local_planner::DWAPlanner::~DWAPlanner ( ) [inline]

Destructor for the planner.

Definition at line 83 of file dwa_planner.h.

Member Function Documentation

bool dwa_local_planner::DWAPlanner::checkTrajectory	(	const Eigen::Vector3f	pos,
		const Eigen::Vector3f	vel,
		const Eigen::Vector3f	vel_samples
	)

Check if a trajectory is legal for a position/velocity pair.

Parameters:

pos	The robot's position
vel	The robot's velocity
vel_samples	The desired velocity

Returns:: True if the trajectory is valid, false otherwise

This function is used when other strategies are to be applied, but the cost functions for obstacles are to be reused.

Definition at line 213 of file dwa_planner.cpp.

base_local_planner::Trajectory dwa_local_planner::DWAPlanner::findBestPath	(	tf::Stamped< tf::Pose >	global_pose,
		tf::Stamped< tf::Pose >	global_vel,
		tf::Stamped< tf::Pose > &	drive_velocities
	)

Given the current position and velocity of the robot, find the best trajectory to exectue.

Parameters:

global_pose	The current position of the robot
global_vel	The current velocity of the robot
drive_velocities	The velocities to send to the robot base

Returns:: The highest scoring trajectory. A cost >= 0 means the trajectory is legal to execute.

Definition at line 295 of file dwa_planner.cpp.

bool dwa_local_planner::DWAPlanner::getCellCosts	(	int	cx,
		int	cy,
		float &	path_cost,
		float &	goal_cost,
		float &	occ_cost,
		float &	total_cost
	)

Compute the components and total cost for a map grid cell.

Parameters:

cx	The x coordinate of the cell in the map grid
cy	The y coordinate of the cell in the map grid
path_cost	Will be set to the path distance component of the cost function
goal_cost	Will be set to the goal distance component of the cost function
occ_cost	Will be set to the costmap value of the cell
total_cost	Will be set to the value of the overall cost function, taking into account the scaling parameters

Returns:: True if the cell is traversible and therefore a legal location for the robot to move to

Definition at line 185 of file dwa_planner.cpp.

double dwa_local_planner::DWAPlanner::getSimPeriod ( ) [inline]

Get the period at which the local planner is expected to run.

Returns:: The simulation period

Definition at line 133 of file dwa_planner.h.

void dwa_local_planner::DWAPlanner::reconfigure ( DWAPlannerConfig & cfg )

Reconfigures the trajectory planner.

Definition at line 52 of file dwa_planner.cpp.

bool dwa_local_planner::DWAPlanner::setPlan ( const std::vector< geometry_msgs::PoseStamped > & orig_global_plan )

sets new plan and resets state

Definition at line 204 of file dwa_planner.cpp.

void dwa_local_planner::DWAPlanner::updatePlanAndLocalCosts	(	tf::Stamped< tf::Pose >	global_pose,
		const std::vector< geometry_msgs::PoseStamped > &	new_plan,
		const std::vector< geometry_msgs::Point > &	footprint_spec
	)

Update the cost functions before planning.

Parameters:

global_pose	The robot's current pose
new_plan	The new global plan
footprint_spec	The robot's footprint

The obstacle cost function gets the footprint. The path and goal cost functions get the global_plan The alignment cost functions get a version of the global plan that is modified based on the global_pose

Definition at line 240 of file dwa_planner.cpp.