Actionlib server for footstep planning. More...

#include <footstep_planner.h>

Public Types
typedef FootstepPlannerConfig	Config
typedef boost::shared_ptr < FootstepPlanner >	Ptr
Public Member Functions
	FootstepPlanner (ros::NodeHandle &nh)
Protected Member Functions
virtual void	buildGraph ()
virtual void	configCallback (Config &config, uint32_t level)
virtual void	planCB (const jsk_footstep_msgs::PlanFootstepsGoal::ConstPtr &goal)
virtual void	pointcloudCallback (const sensor_msgs::PointCloud2::ConstPtr &msg)
virtual void	profile (FootstepAStarSolver< FootstepGraph > &solver, FootstepGraph::Ptr graph)
virtual bool	projectFootPrint (const Eigen::Affine3f &center_pose, const Eigen::Affine3f &left_pose_trans, const Eigen::Affine3f &right_pose_trans, geometry_msgs::Pose &pose)
virtual bool	projectFootPrintService (jsk_interactive_marker::SnapFootPrint::Request &req, jsk_interactive_marker::SnapFootPrint::Response &res)
virtual bool	projectFootPrintWithLocalSearchService (jsk_interactive_marker::SnapFootPrint::Request &req, jsk_interactive_marker::SnapFootPrint::Response &res)
virtual void	publishPointCloud (const pcl::PointCloud< pcl::PointNormal > &cloud, ros::Publisher &pub, const std_msgs::Header &header)
virtual void	publishText (ros::Publisher &pub, const std::string &text, PlanningStatus status)
virtual bool	readSuccessors (ros::NodeHandle &nh)
virtual double	stepCostHeuristic (SolverNode< FootstepState, FootstepGraph >::Ptr node, FootstepGraph::Ptr graph)
virtual double	straightHeuristic (SolverNode< FootstepState, FootstepGraph >::Ptr node, FootstepGraph::Ptr graph)
virtual double	straightRotationHeuristic (SolverNode< FootstepState, FootstepGraph >::Ptr node, FootstepGraph::Ptr graph)
virtual double	zeroHeuristic (SolverNode< FootstepState, FootstepGraph >::Ptr node, FootstepGraph::Ptr graph)
Protected Attributes
actionlib::SimpleActionServer < jsk_footstep_msgs::PlanFootstepsAction >	as_
int	close_list_theta_num_
int	close_list_x_num_
int	close_list_y_num_
double	cost_weight_
double	footstep_size_x_
double	footstep_size_y_
double	goal_pos_thr_
double	goal_rot_thr_
FootstepGraph::Ptr	graph_
std::string	heuristic_
double	heuristic_first_rotation_weight_
double	heuristic_second_rotation_weight_
double	heuristic_weight_
std_msgs::Header	latest_header_
double	local_move_theta_
int	local_move_theta_num_
double	local_move_x_
int	local_move_x_num_
double	local_move_y_
int	local_move_y_num_
boost::mutex	mutex_
int	plane_estimation_max_iterations_
int	plane_estimation_min_inliers_
double	plane_estimation_outlier_threshold_
pcl::PointCloud < pcl::PointNormal >::Ptr	pointcloud_model_
int	profile_period_
bool	project_goal_state_
bool	project_start_state_
ros::Publisher	pub_close_list_
ros::Publisher	pub_open_list_
ros::Publisher	pub_text_
double	resolution_theta_
double	resolution_x_
double	resolution_y_
jsk_footstep_msgs::PlanFootstepsResult	result_
bool	rich_profiling_
boost::shared_ptr < dynamic_reconfigure::Server < Config > >	srv_
ros::ServiceServer	srv_project_footprint_
ros::ServiceServer	srv_project_footprint_with_local_search_
ros::Subscriber	sub_pointcloud_model_
std::vector< Eigen::Affine3f >	successors_
double	support_check_vertex_neighbor_threshold_
int	support_check_x_sampling_
int	support_check_y_sampling_
double	transition_limit_pitch_
double	transition_limit_roll_
double	transition_limit_x_
double	transition_limit_y_
double	transition_limit_yaw_
double	transition_limit_z_
bool	use_lazy_perception_
bool	use_local_movement_
bool	use_pointcloud_model_
bool	use_transition_limit_

Detailed Description

Actionlib server for footstep planning.

Definition at line 69 of file footstep_planner.h.

Member Typedef Documentation

typedef FootstepPlannerConfig jsk_footstep_planner::FootstepPlanner::Config

Definition at line 73 of file footstep_planner.h.

typedef boost::shared_ptr<FootstepPlanner> jsk_footstep_planner::FootstepPlanner::Ptr

Definition at line 72 of file footstep_planner.h.

Constructor & Destructor Documentation

jsk_footstep_planner::FootstepPlanner::FootstepPlanner ( ros::NodeHandle & nh )

Definition at line 45 of file footstep_planner.cpp.

Member Function Documentation

void jsk_footstep_planner::FootstepPlanner::buildGraph ( ) [protected, virtual]

Definition at line 619 of file footstep_planner.cpp.

void jsk_footstep_planner::FootstepPlanner::configCallback	(	Config &	config,
		uint32_t	level
	)		`[protected, virtual]`

Definition at line 549 of file footstep_planner.cpp.

void jsk_footstep_planner::FootstepPlanner::planCB ( const jsk_footstep_msgs::PlanFootstepsGoal::ConstPtr & goal ) [protected, virtual]

Definition at line 264 of file footstep_planner.cpp.

void jsk_footstep_planner::FootstepPlanner::pointcloudCallback ( const sensor_msgs::PointCloud2::ConstPtr & msg ) [protected, virtual]

Definition at line 77 of file footstep_planner.cpp.

void jsk_footstep_planner::FootstepPlanner::profile	(	FootstepAStarSolver< FootstepGraph > &	solver,
		FootstepGraph::Ptr	graph
	)		`[protected, virtual]`

Definition at line 455 of file footstep_planner.cpp.

bool jsk_footstep_planner::FootstepPlanner::projectFootPrint	(	const Eigen::Affine3f &	center_pose,
		const Eigen::Affine3f &	left_pose_trans,
		const Eigen::Affine3f &	right_pose_trans,
		geometry_msgs::Pose &	pose
	)		`[protected, virtual]`

Definition at line 89 of file footstep_planner.cpp.

bool jsk_footstep_planner::FootstepPlanner::projectFootPrintService	(	jsk_interactive_marker::SnapFootPrint::Request &	req,
		jsk_interactive_marker::SnapFootPrint::Response &	res
	)		`[protected, virtual]`

Definition at line 189 of file footstep_planner.cpp.

bool jsk_footstep_planner::FootstepPlanner::projectFootPrintWithLocalSearchService	(	jsk_interactive_marker::SnapFootPrint::Request &	req,
		jsk_interactive_marker::SnapFootPrint::Response &	res
	)		`[protected, virtual]`

Definition at line 129 of file footstep_planner.cpp.

void jsk_footstep_planner::FootstepPlanner::publishPointCloud	(	const pcl::PointCloud< pcl::PointNormal > &	cloud,
		ros::Publisher &	pub,
		const std_msgs::Header &	header
	)		`[protected, virtual]`

Definition at line 444 of file footstep_planner.cpp.

void jsk_footstep_planner::FootstepPlanner::publishText	(	ros::Publisher &	pub,
		const std::string &	text,
		PlanningStatus	status
	)		`[protected, virtual]`

Definition at line 223 of file footstep_planner.cpp.

bool jsk_footstep_planner::FootstepPlanner::readSuccessors ( ros::NodeHandle & nh ) [protected, virtual]

format is successors:

x: 0 y: 0 theta: 0
x: 0 y: 0 theta: 0 ...

Definition at line 508 of file footstep_planner.cpp.

double jsk_footstep_planner::FootstepPlanner::stepCostHeuristic	(	SolverNode< FootstepState, FootstepGraph >::Ptr	node,
		FootstepGraph::Ptr	graph
	)		`[protected, virtual]`

Definition at line 472 of file footstep_planner.cpp.

double jsk_footstep_planner::FootstepPlanner::straightHeuristic	(	SolverNode< FootstepState, FootstepGraph >::Ptr	node,
		FootstepGraph::Ptr	graph
	)		`[protected, virtual]`

Definition at line 485 of file footstep_planner.cpp.

double jsk_footstep_planner::FootstepPlanner::straightRotationHeuristic	(	SolverNode< FootstepState, FootstepGraph >::Ptr	node,
		FootstepGraph::Ptr	graph
	)		`[protected, virtual]`

Definition at line 491 of file footstep_planner.cpp.

double jsk_footstep_planner::FootstepPlanner::zeroHeuristic	(	SolverNode< FootstepState, FootstepGraph >::Ptr	node,
		FootstepGraph::Ptr	graph
	)		`[protected, virtual]`