#include <pose_follower.h>
Public Member Functions | |
bool | computeVelocityCommands (geometry_msgs::Twist &cmd_vel) |
void | initialize (std::string name, tf::TransformListener *tf, costmap_2d::Costmap2DROS *costmap_ros) |
bool | isGoalReached () |
PoseFollower () | |
bool | setPlan (const std::vector< geometry_msgs::PoseStamped > &global_plan) |
Private Member Functions | |
geometry_msgs::Twist | diff2D (const tf::Pose &pose1, const tf::Pose &pose2) |
double | headingDiff (double pt_x, double pt_y, double x, double y, double heading) |
geometry_msgs::Twist | limitTwist (const geometry_msgs::Twist &twist) |
void | odomCallback (const nav_msgs::Odometry::ConstPtr &msg) |
void | publishPlan (const std::vector< geometry_msgs::PoseStamped > &path, const ros::Publisher &pub) |
double | sign (double n) |
bool | stopped () |
bool | transformGlobalPlan (const tf::TransformListener &tf, const std::vector< geometry_msgs::PoseStamped > &global_plan, const costmap_2d::Costmap2DROS &costmap, const std::string &global_frame, std::vector< geometry_msgs::PoseStamped > &transformed_plan) |
Private Attributes | |
bool | allow_backwards_ |
nav_msgs::Odometry | base_odom_ |
base_local_planner::TrajectoryPlannerROS | collision_planner_ |
costmap_2d::Costmap2DROS * | costmap_ros_ |
unsigned int | current_waypoint_ |
std::vector < geometry_msgs::PoseStamped > | global_plan_ |
ros::Publisher | global_plan_pub_ |
ros::Time | goal_reached_time_ |
bool | holonomic_ |
double | in_place_trans_vel_ |
double | K_rot_ |
double | K_trans_ |
double | max_heading_diff_before_moving_ |
double | max_vel_lin_ |
double | max_vel_th_ |
double | min_in_place_vel_th_ |
double | min_vel_lin_ |
double | min_vel_th_ |
boost::mutex | odom_lock_ |
ros::Subscriber | odom_sub_ |
double | rot_stopped_velocity_ |
int | samples_ |
tf::TransformListener * | tf_ |
double | tolerance_rot_ |
double | tolerance_timeout_ |
double | tolerance_trans_ |
double | trans_stopped_velocity_ |
bool | turn_in_place_first_ |
ros::Publisher | vel_pub_ |
Definition at line 51 of file pose_follower.h.
Definition at line 44 of file pose_follower.cpp.
bool pose_follower::PoseFollower::computeVelocityCommands | ( | geometry_msgs::Twist & | cmd_vel | ) | [virtual] |
Implements nav_core::BaseLocalPlanner.
Definition at line 167 of file pose_follower.cpp.
geometry_msgs::Twist pose_follower::PoseFollower::diff2D | ( | const tf::Pose & | pose1, |
const tf::Pose & | pose2 | ||
) | [private] |
Definition at line 273 of file pose_follower.cpp.
double pose_follower::PoseFollower::headingDiff | ( | double | pt_x, |
double | pt_y, | ||
double | x, | ||
double | y, | ||
double | heading | ||
) | [private] |
Definition at line 119 of file pose_follower.cpp.
void pose_follower::PoseFollower::initialize | ( | std::string | name, |
tf::TransformListener * | tf, | ||
costmap_2d::Costmap2DROS * | costmap_ros | ||
) | [virtual] |
Implements nav_core::BaseLocalPlanner.
Definition at line 46 of file pose_follower.cpp.
bool pose_follower::PoseFollower::isGoalReached | ( | ) | [virtual] |
Implements nav_core::BaseLocalPlanner.
Definition at line 266 of file pose_follower.cpp.
geometry_msgs::Twist pose_follower::PoseFollower::limitTwist | ( | const geometry_msgs::Twist & | twist | ) | [private] |
Definition at line 318 of file pose_follower.cpp.
void pose_follower::PoseFollower::odomCallback | ( | const nav_msgs::Odometry::ConstPtr & | msg | ) | [private] |
Definition at line 109 of file pose_follower.cpp.
void pose_follower::PoseFollower::publishPlan | ( | const std::vector< geometry_msgs::PoseStamped > & | path, |
const ros::Publisher & | pub | ||
) | [private] |
Definition at line 148 of file pose_follower.cpp.
bool pose_follower::PoseFollower::setPlan | ( | const std::vector< geometry_msgs::PoseStamped > & | global_plan | ) | [virtual] |
Implements nav_core::BaseLocalPlanner.
Definition at line 253 of file pose_follower.cpp.
double pose_follower::PoseFollower::sign | ( | double | n | ) | [inline, private] |
Definition at line 60 of file pose_follower.h.
bool pose_follower::PoseFollower::stopped | ( | ) | [private] |
Definition at line 135 of file pose_follower.cpp.
bool pose_follower::PoseFollower::transformGlobalPlan | ( | const tf::TransformListener & | tf, |
const std::vector< geometry_msgs::PoseStamped > & | global_plan, | ||
const costmap_2d::Costmap2DROS & | costmap, | ||
const std::string & | global_frame, | ||
std::vector< geometry_msgs::PoseStamped > & | transformed_plan | ||
) | [private] |
Definition at line 372 of file pose_follower.cpp.
bool pose_follower::PoseFollower::allow_backwards_ [private] |
Definition at line 85 of file pose_follower.h.
nav_msgs::Odometry pose_follower::PoseFollower::base_odom_ [private] |
Definition at line 91 of file pose_follower.h.
Definition at line 96 of file pose_follower.h.
Definition at line 77 of file pose_follower.h.
unsigned int pose_follower::PoseFollower::current_waypoint_ [private] |
Definition at line 94 of file pose_follower.h.
std::vector<geometry_msgs::PoseStamped> pose_follower::PoseFollower::global_plan_ [private] |
Definition at line 95 of file pose_follower.h.
Definition at line 79 of file pose_follower.h.
Definition at line 93 of file pose_follower.h.
bool pose_follower::PoseFollower::holonomic_ [private] |
Definition at line 88 of file pose_follower.h.
double pose_follower::PoseFollower::in_place_trans_vel_ [private] |
Definition at line 84 of file pose_follower.h.
double pose_follower::PoseFollower::K_rot_ [private] |
Definition at line 80 of file pose_follower.h.
double pose_follower::PoseFollower::K_trans_ [private] |
Definition at line 80 of file pose_follower.h.
double pose_follower::PoseFollower::max_heading_diff_before_moving_ [private] |
Definition at line 87 of file pose_follower.h.
double pose_follower::PoseFollower::max_vel_lin_ [private] |
Definition at line 82 of file pose_follower.h.
double pose_follower::PoseFollower::max_vel_th_ [private] |
Definition at line 82 of file pose_follower.h.
double pose_follower::PoseFollower::min_in_place_vel_th_ [private] |
Definition at line 84 of file pose_follower.h.
double pose_follower::PoseFollower::min_vel_lin_ [private] |
Definition at line 83 of file pose_follower.h.
double pose_follower::PoseFollower::min_vel_th_ [private] |
Definition at line 83 of file pose_follower.h.
boost::mutex pose_follower::PoseFollower::odom_lock_ [private] |
Definition at line 89 of file pose_follower.h.
Definition at line 90 of file pose_follower.h.
double pose_follower::PoseFollower::rot_stopped_velocity_ [private] |
Definition at line 92 of file pose_follower.h.
int pose_follower::PoseFollower::samples_ [private] |
Definition at line 97 of file pose_follower.h.
Definition at line 76 of file pose_follower.h.
double pose_follower::PoseFollower::tolerance_rot_ [private] |
Definition at line 80 of file pose_follower.h.
double pose_follower::PoseFollower::tolerance_timeout_ [private] |
Definition at line 81 of file pose_follower.h.
double pose_follower::PoseFollower::tolerance_trans_ [private] |
Definition at line 80 of file pose_follower.h.
double pose_follower::PoseFollower::trans_stopped_velocity_ [private] |
Definition at line 92 of file pose_follower.h.
bool pose_follower::PoseFollower::turn_in_place_first_ [private] |
Definition at line 86 of file pose_follower.h.
Definition at line 78 of file pose_follower.h.