Open tosa-no-onchan opened 2 years ago
I found some correct code.
eband_local_planner_ros.cpp
// set global plan to wrapper and pass it to eband
bool EBandPlannerROS::setPlan(const std::vector<geometry_msgs::PoseStamped>& orig_global_plan)
{
....
// set goal as not reached
// changed by nishi
//goal_reached_ = false;
return true;
}
bool EBandPlannerROS::isGoalReached()
{
// check if plugin initialized
if(!initialized_)
{
ROS_ERROR("This planner has not been initialized, please call initialize() before using this planner");
return false;
}
// added by nishi
//ROS_INFO("GOAL Reached!");
//std::cout << "BandPlannerROS::isGoalReached() :#9 goal_reached_=" << goal_reached_ << std::endl;
if(goal_reached_==true){
goal_reached_=false;
return true;
}
return false;
//return goal_reached_;
....
The flowing code(return goalreached;) dosen't work correctly.
Why did you comment out next lines? from here // nav_msgs::Odometry base_odom; //... to here //return is_goal_reached;