find_base_pose.cpp File Reference

#include <ros/ros.h>
#include <eigen_conversions/eigen_msg.h>
#include <tf/tf.h>
#include <actionlib/server/simple_action_server.h>
#include <find_base_pose/FindBasePoseAction.h>
#include <tf/transform_listener.h>
#include <kinematics_msgs/GetPositionIK.h>
#include <kinematics_msgs/GetPositionFK.h>
#include <pr2_arm_kinematics/pr2_arm_kinematics.h>
#include <pr2_arm_kinematics/pr2_arm_ik.h>
#include <pr2_arm_kinematics/pr2_arm_kinematics_utils.h>
#include <pr2_arm_kinematics/pr2_arm_ik_solver.h>
#include <pr2_arm_kinematics/pr2_arm_kinematics_plugin.h>
#include <kinematics_base/kinematics_base.h>
#include <urdf/model.h>
#include <algorithm>
#include <laser_geometry/laser_geometry.h>
#include <visualization_msgs/Marker.h>
#include <nav_msgs/OccupancyGrid.h>

Include dependency graph for find_base_pose.cpp:

Go to the source code of this file.

Classes
class	FindBasePoseAction
	end: exlude unknown and occupied space from map More...
Functions
int	main (int argc, char **argv)
void	mapCallback (const nav_msgs::OccupancyGrid &msg)
bool	mapFreeCoarse (tf::Stamped< tf::Pose > absPose)
bool	mapFreeCoarseCircumscribed (tf::Stamped< tf::Pose > absPose)
bool	mapFreeFine (tf::Stamped< tf::Pose > absPose)
void	mapToWorld (unsigned int mx, unsigned int my, double &wx, double &wy)
bool	worldToMap (double wx, double wy, unsigned int &mx, unsigned int &my)
void	worldToMapNoBounds (double wx, double wy, int &mx, int &my)
Variables
nav_msgs::OccupancyGrid	coarsemap
pr2_arm_kinematics::PR2ArmIK *	ik_r
pr2_arm_kinematics::PR2ArmKinematics *	kinemal
pr2_arm_kinematics::PR2ArmKinematics *	kinemar
nav_msgs::OccupancyGrid	map
nav_msgs::OccupancyGrid	map_circumscribed
nav_msgs::OccupancyGrid	map_inscribed
bool	map_processed = false
ros::Publisher	occ_pub
float	origin_x_ = 0
float	origin_y_ = 0
float	resolution_ = 0
int	size_x_ = 0
int	size_y_ = 0
pr2_arm_kinematics::PR2ArmIKSolver *	solver
bool	we_have_a_map = false
	exlude unknown and occupied space from map