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

Fix Handle::createGrasp

parent f65015da
No related branches found
No related tags found
No related merge requests found
...@@ -140,15 +140,18 @@ namespace hpp { ...@@ -140,15 +140,18 @@ namespace hpp {
} else { } else {
// TODO handle cases where rotations or translation are allowed. // TODO handle cases where rotations or translation are allowed.
std::vector<bool> Cmask = complementMask(mask_); std::vector<bool> Cmask = complementMask(mask_);
return NumericalConstraintPtr_t RelativeTransformationPtr_t function = RelativeTransformation::create
(NumericalConstraint::create (RelativeTransformation::create ("Transformation_" + maskToStr(Cmask) + "_" + name ()
("Transformation_" + maskToStr(Cmask) + "_" + name () + "_" + gripper->name (),
+ "_" + gripper->name (), gripper->joint()->robot(),
gripper->joint()->robot(), gripper->joint (), joint (),
gripper->joint (), joint (), gripper->objectPositionInJoint (),
gripper->objectPositionInJoint (), localPosition(), Cmask);
localPosition(), Cmask), return NumericalConstraintPtr_t (NumericalConstraint::create
core::Equality::create ())); (function,
core::ComparisonTypes::create(function->outputSize(),
core::ComparisonType::Equality)
));
} }
} }
......
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