How to get the clearance of a motion path?

Question

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");
          service_client.call(request,response);
          if(response.error_code.val != response.error_code.SUCCESS)
          {
            ROS_ERROR("Motion planning failed");
          }
          else
          {
            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.

---

Originally posted by tor on ROS Answers with karma: 277 on 2012-09-05

Post score: 0

---

Original comments

Comment by isucan on 2012-09-05:
[]

Answer 1

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.

---

Originally posted by isucan with karma: 1055 on 2012-09-05

This answer was ACCEPTED on the original site

Post score: 1