Skip to content
Snippets Groups Projects
Commit 6673aad4 authored by Joseph Mirabel's avatar Joseph Mirabel Committed by Joseph Mirabel
Browse files

Update ManipulationPlanner

parent 9fb2b54f
No related branches found
No related tags found
No related merge requests found
......@@ -17,10 +17,7 @@
#ifndef HPP_MANIPULATION_MANIPULATION_PLANNER_HH
# define HPP_MANIPULATION_MANIPULATION_PLANNER_HH
#include <hpp/model/configuration.hh>
#include <hpp/core/basic-configuration-shooter.hh>
#include <hpp/core/path-planner.hh>
#include <hpp/core/roadmap.hh>
#include <hpp/statistics/success-bin.hh>
......
......@@ -23,11 +23,15 @@
#include <hpp/util/timer.hh>
#include <hpp/util/assertion.hh>
#include <hpp/pinocchio/configuration.hh>
#include <hpp/core/path-validation.hh>
#include <hpp/core/connected-component.hh>
#include <hpp/core/path-projector.hh>
#include <hpp/core/projection-error.hh>
#include <hpp/core/nearest-neighbor.hh>
#include <hpp/core/roadmap.hh>
#include <hpp/core/basic-configuration-shooter.hh>
#include "hpp/manipulation/graph/statistics.hh"
#include "hpp/manipulation/device.hh"
......@@ -220,7 +224,7 @@ namespace hpp {
{
graph::GraphPtr_t graph = problem_.constraintGraph ();
PathProjectorPtr_t pathProjector = problem_.pathProjector ();
model::DevicePtr_t robot (problem_.robot ());
pinocchio::DevicePtr_t robot (problem_.robot ());
value_type eps (graph->errorThreshold ());
// Select next node in the constraint graph.
const ConfigurationPtr_t q_near = n_near->configuration ();
......@@ -239,7 +243,7 @@ namespace hpp {
es.addFailure (reasons_[PROJECTION]);
return false;
}
if (model::isApprox (robot, qProj_, *q_near, eps)) {
if (pinocchio::isApprox (robot, qProj_, *q_near, eps)) {
es.addFailure (reasons_[FAILURE]);
es.addFailure (reasons_[PATH_PROJECTION_ZERO]);
return false;
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment