ROS Resources: Documentation | Support | Discussion Forum | Index | Service Status | ros @ Robotics Stack Exchange
Ask Your Question

How to get the clearance of a motion path?

asked 2012-09-05 01:11:44 -0500

tor gravatar image

updated 2012-09-05 01:25:22 -0500

Hi All,

Having a motion path (trajectory) using ompl as in here, how to get the clearance of it?

I found a perfect function for it in the ompl-pkg API here.

How to use it?

How could we put it somewhere inside this?

    motion_planning_msgs::GetMotionPlan::Request request;
    motion_planning_msgs::GetMotionPlan::Response response;
    ros::ServiceClient service_client = nh.serviceClient<motion_planning_msgs::GetMotionPlan ("ompl_planning/plan_kinematic_path");
          if(response.error_code.val != response.error_code.SUCCESS)
            ROS_ERROR("Motion planning failed");
            ROS_INFO("Motion planning succeeded");
            // !!!!! Compute the clearance here !!!!! (?)

Given a response (motion_planning_msgs::GetMotionPlan::Response), how to spawn an instance of ompl::geometric::PathGeometric? See the constructor here.

Thanks a lot.

edit retag flag offensive close merge delete



isucan gravatar image isucan  ( 2012-09-05 06:12:34 -0500 )edit

1 Answer

Sort by ยป oldest newest most voted

answered 2012-09-05 06:11:34 -0500

isucan gravatar image

Unfortunately the API in arm_navigation does not offer the means to compute distance. The collision checker used (ODE) does not offer this information. So unfortunately, there is no way to perform this computation easily. The replacement for arm_navigation (MoveIt) does include this computation. Depending on the timeline for your project, you may want to switch to using MoveIt. We plan to release with groovy, but things are still under heavy development.

edit flag offensive delete link more

Question Tools


Asked: 2012-09-05 01:11:44 -0500

Seen: 350 times

Last updated: Sep 05 '12