@@ -163,12 +163,9 @@ DifferentiableFunctionPtr_t buildGenericFunc(
163
163
164
164
if (relative) {
165
165
// Both joints are provided
166
- return constraints::GenericTransformation<
167
- PositionOrientationFlag | constraints::RelativeBit>::create (name, robot,
168
- joint1,
169
- joint2,
170
- ref1, ref2,
171
- mask);
166
+ return constraints::GenericTransformation < PositionOrientationFlag |
167
+ constraints::RelativeBit >
168
+ ::create (name, robot, joint1, joint2, ref1, ref2, mask);
172
169
} else {
173
170
return constraints::GenericTransformation<PositionOrientationFlag>::create (
174
171
name, robot, joint2, ref2, ref1, mask);
@@ -581,10 +578,10 @@ void Problem::createTransformationConstraint(const char* constraintName,
581
578
Transform3f ref (toTransform3f (p));
582
579
std::string name (constraintName);
583
580
DifferentiableFunctionPtr_t func =
584
- buildGenericFunc< constraints::PositionBit |
585
- constraints::OrientationBit>(
586
- problemSolver ()-> robot (), name, joint1Name, joint2Name, ref, Id,
587
- boolSeqToVector (mask, 6 ));
581
+ buildGenericFunc < constraints::PositionBit |
582
+ constraints::OrientationBit > ( problemSolver ()-> robot (), name,
583
+ joint1Name, joint2Name, ref, Id,
584
+ boolSeqToVector (mask, 6 ));
588
585
589
586
problemSolver ()->addNumericalConstraint (
590
587
name,
@@ -606,11 +603,11 @@ void Problem::createTransformationConstraint2(const char* constraintName,
606
603
if (!problemSolver ()->robot ()) throw hpp::Error (" No robot loaded" );
607
604
std::string name (constraintName);
608
605
DifferentiableFunctionPtr_t func =
609
- buildGenericFunc< constraints::PositionBit |
610
- constraints::OrientationBit>(
611
- problemSolver ()->robot (), name, joint1Name, joint2Name,
612
- toTransform3f (frame1), toTransform3f (frame2),
613
- boolSeqToVector (mask, 6 ));
606
+ buildGenericFunc < constraints::PositionBit |
607
+ constraints::OrientationBit >
608
+ ( problemSolver ()->robot (), name, joint1Name, joint2Name,
609
+ toTransform3f (frame1), toTransform3f (frame2),
610
+ boolSeqToVector (mask, 6 ));
614
611
615
612
problemSolver ()->addNumericalConstraint (
616
613
name,
@@ -632,12 +629,12 @@ void Problem::createTransformationR3xSO3Constraint(const char* constraintName,
632
629
if (!problemSolver ()->robot ()) throw hpp::Error (" No robot loaded" );
633
630
std::string name (constraintName);
634
631
DifferentiableFunctionPtr_t func =
635
- buildGenericFunc< constraints::OutputR3xSO3Bit |
636
- constraints::PositionBit |
637
- constraints::OrientationBit>(
638
- problemSolver ()->robot (), name, joint1Name, joint2Name,
639
- toTransform3f (frame1), toTransform3f (frame2),
640
- boolSeqToVector (mask, 6 ));
632
+ buildGenericFunc < constraints::OutputR3xSO3Bit |
633
+ constraints::PositionBit |
634
+ constraints::OrientationBit >
635
+ ( problemSolver ()->robot (), name, joint1Name, joint2Name,
636
+ toTransform3f (frame1), toTransform3f (frame2),
637
+ boolSeqToVector (mask, 6 ));
641
638
642
639
problemSolver ()->addNumericalConstraint (
643
640
name,
0 commit comments