Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Check the absolute angle difference when checking angular tolerance #211

Closed
wants to merge 1 commit into from

Conversation

corot
Copy link
Collaborator

@corot corot commented Jul 16, 2020

Actually, this is still not enough, as we also need to check that the robot is almost stopped. Like in the base_local_planner:

  bool stopped(const nav_msgs::Odometry& base_odom, 
      const double& rot_stopped_velocity, const double& trans_stopped_velocity){
    return fabs(base_odom.twist.twist.angular.z) <= rot_stopped_velocity 
      && fabs(base_odom.twist.twist.linear.x) <= trans_stopped_velocity
      && fabs(base_odom.twist.twist.linear.y) <= trans_stopped_velocity;
  }

But wee need to merge #189 to have actual robot speed to check that, so I'll do in another PR.

@corot corot requested a review from spuetz July 16, 2020 09:06
@corot corot added the bug label Jul 17, 2020
@corot
Copy link
Collaborator Author

corot commented Jul 17, 2020

my bad; mbf_utility::angle always returns positive angles

@corot corot closed this Jul 17, 2020
@spuetz spuetz deleted the fix_mbf_tolerance_check branch September 16, 2020 10:15
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
Projects
None yet
Development

Successfully merging this pull request may close these issues.

1 participant