wip-behaviors #3
@@ -36,7 +36,7 @@ ResultStatus SimpleRotateBehavior::onStart(
|
|||||||
const std::shared_ptr<const RotateAction::Goal> command, const geometry_msgs::msg::Pose & pose,
|
const std::shared_ptr<const RotateAction::Goal> command, const geometry_msgs::msg::Pose & pose,
|
||||||
const geometry_msgs::msg::Twist & vel)
|
const geometry_msgs::msg::Twist & vel)
|
||||||
{
|
{
|
||||||
target_angle_ = command->angle;
|
target_angle_ = angles::normalize_angle(command->angle);
|
||||||
min_turn_angle_ = abs(command->min_angle);
|
min_turn_angle_ = abs(command->min_angle);
|
||||||
initial_direction_ = (command->min_angle >= 0.0) ? 1.0 : -1.0;
|
initial_direction_ = (command->min_angle >= 0.0) ? 1.0 : -1.0;
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user