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

Fix type related problems

parent 7ccf8d76
No related branches found
No related tags found
No related merge requests found
......@@ -58,9 +58,9 @@ namespace hpp {
PathValidationPtr_t Problem::pathValidationFactory () const
{
PathValidationPtr_t pv (pvFactory_ (robot(), pvTol_));
const core::ObjectVector_t& obstacles (collisionObstacles ());
const core::ObjectStdVector_t& obstacles (collisionObstacles ());
// Insert obstacles in path validation object
for (core::ObjectVector_t::const_iterator _obs = obstacles.begin ();
for (core::ObjectStdVector_t::const_iterator _obs = obstacles.begin ();
_obs != obstacles.end (); ++_obs)
pv->addObstacle (*_obs);
return pv;
......
......@@ -23,8 +23,8 @@
#include <hpp/util/timer.hh>
#include <hpp/util/assertion.hh>
#include <hpp/model/configuration.hh>
#include <hpp/model/collision-object.hh>
#include <hpp/pinocchio/configuration.hh>
#include <hpp/pinocchio/collision-object.hh>
#include <hpp/core/roadmap.hh>
#include <hpp/core/distance.hh>
......@@ -43,6 +43,7 @@
#include "hpp/manipulation/roadmap.hh"
#include "hpp/manipulation/roadmap-node.hh"
#include "hpp/manipulation/symbolic-component.hh"
#include "hpp/manipulation/graph-path-validation.hh"
#include "hpp/manipulation/graph/edge.hh"
#include "hpp/manipulation/graph/graph.hh"
#include "hpp/manipulation/graph/node-selector.hh"
......@@ -55,7 +56,7 @@ namespace hpp {
namespace manipulation {
using core::CollisionValidationReport;
using core::CollisionValidationReportPtr_t;
using core::CollisionObjectPtr_t;
using core::CollisionObjectConstPtr_t;
typedef graph::Edge::RelativeMotion RelativeMotion;
namespace {
......@@ -566,14 +567,14 @@ namespace hpp {
colRep = HPP_DYNAMIC_PTR_CAST(CollisionValidationReport,
extend.validationReport->configurationReport);
if (colRep) {
CollisionObjectPtr_t o1 = colRep->object1, o2 = colRep->object2;
CollisionObjectConstPtr_t o1 = colRep->object1, o2 = colRep->object2;
// If it is a collision between the robot and an unactuated object,
// which cannot move in this state.
if (o1->joint() != NULL && o2->joint() != NULL) {
// TODO: Currently, the RelativeMotion matrix does not cover cases
// like ConvexShapeContact (2 function making a 6D constraints).
RelativeMotion::matrix_type m = extend.edge->relativeMotion();
size_type i0 = RelativeMotion::idx(NULL);
size_type i0 = RelativeMotion::idx(JointPtr_t());
size_type i1 = RelativeMotion::idx(o1->joint());
size_type i2 = RelativeMotion::idx(o2->joint());
if (m(i0, i1) == RelativeMotion::Parameterized
......@@ -607,14 +608,14 @@ namespace hpp {
colRep = HPP_DYNAMIC_PTR_CAST(CollisionValidationReport,
extend.validationReport->configurationReport);
if (colRep) {
CollisionObjectPtr_t o1 = colRep->object1, o2 = colRep->object2;
CollisionObjectConstPtr_t o1 = colRep->object1, o2 = colRep->object2;
// If it is a collision between the robot and an unactuated object,
// which cannot move in this state.
if (o1->joint() != NULL && o2->joint() != NULL) {
// TODO: Currently, the RelativeMotion matrix does not cover cases
// like ConvexShapeContact (2 function making a 6D constraints).
RelativeMotion::matrix_type m = extend.edge->relativeMotion();
size_type i0 = RelativeMotion::idx(NULL);
size_type i0 = RelativeMotion::idx(JointPtr_t());
size_type i1 = RelativeMotion::idx(o1->joint());
size_type i2 = RelativeMotion::idx(o2->joint());
if (m(i0, i1) == RelativeMotion::Parameterized
......
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