update
This commit is contained in:
@@ -976,12 +976,6 @@ bool move_base::MoveBase::moveTo( const robot_geometry_msgs::PoseStamped &goal,
|
|||||||
|
|
||||||
robot::log_info("[MoveBase::moveTo] Processing goal through action server...");
|
robot::log_info("[MoveBase::moveTo] Processing goal through action server...");
|
||||||
as_->processGoal(action_goal);
|
as_->processGoal(action_goal);
|
||||||
|
|
||||||
setTwistLinear(old_linear_fwd_);
|
|
||||||
setTwistLinear(old_linear_bwd_);
|
|
||||||
setTwistAngular(old_angular_fwd_);
|
|
||||||
setTwistAngular(old_angular_rev_);
|
|
||||||
|
|
||||||
robot::log_info("[MoveBase::moveTo] Goal processed successfully by action server");
|
robot::log_info("[MoveBase::moveTo] Goal processed successfully by action server");
|
||||||
}
|
}
|
||||||
catch (const std::exception &e)
|
catch (const std::exception &e)
|
||||||
@@ -1124,11 +1118,6 @@ bool move_base::MoveBase::moveTo(const robot_protocol_msgs::Order &msg,
|
|||||||
}
|
}
|
||||||
|
|
||||||
as_->processGoal(action_goal);
|
as_->processGoal(action_goal);
|
||||||
|
|
||||||
setTwistLinear(old_linear_fwd_);
|
|
||||||
setTwistLinear(old_linear_bwd_);
|
|
||||||
setTwistAngular(old_angular_fwd_);
|
|
||||||
setTwistAngular(old_angular_rev_);
|
|
||||||
}
|
}
|
||||||
catch (const std::exception &e)
|
catch (const std::exception &e)
|
||||||
{
|
{
|
||||||
@@ -1290,10 +1279,6 @@ bool move_base::MoveBase::dockTo(const std::string &marker, const robot_geometry
|
|||||||
|
|
||||||
robot::log_info("[MoveBase::moveTo] Processing goal through action server...");
|
robot::log_info("[MoveBase::moveTo] Processing goal through action server...");
|
||||||
as_->processGoal(action_goal);
|
as_->processGoal(action_goal);
|
||||||
setTwistLinear(old_linear_fwd_);
|
|
||||||
setTwistLinear(old_linear_bwd_);
|
|
||||||
setTwistAngular(old_angular_fwd_);
|
|
||||||
setTwistAngular(old_angular_rev_);
|
|
||||||
robot::log_info("[MoveBase::moveTo] Goal processed successfully by action server");
|
robot::log_info("[MoveBase::moveTo] Goal processed successfully by action server");
|
||||||
}
|
}
|
||||||
catch (const std::exception &e)
|
catch (const std::exception &e)
|
||||||
@@ -1440,10 +1425,6 @@ bool move_base::MoveBase::dockTo(const robot_protocol_msgs::Order &msg,
|
|||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
as_->processGoal(action_goal);
|
as_->processGoal(action_goal);
|
||||||
setTwistLinear(old_linear_fwd_);
|
|
||||||
setTwistLinear(old_linear_bwd_);
|
|
||||||
setTwistAngular(old_angular_fwd_);
|
|
||||||
setTwistAngular(old_angular_rev_);
|
|
||||||
}
|
}
|
||||||
catch (const std::exception &e)
|
catch (const std::exception &e)
|
||||||
{
|
{
|
||||||
|
|||||||
Reference in New Issue
Block a user