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