Bugfix/fix rotationtest
Compare changes
- Jonathan Youett authored
+ 17
− 17
@@ -40,14 +40,14 @@ void testDDExp()
@@ -40,14 +40,14 @@ void testDDExp()
@@ -86,8 +86,8 @@ void testDDExp()
@@ -86,8 +86,8 @@ void testDDExp()
@@ -146,7 +146,7 @@ void testDerivativeOfInterpolatedPosition()
@@ -146,7 +146,7 @@ void testDerivativeOfInterpolatedPosition()
@@ -159,28 +159,28 @@ void testDerivativeOfInterpolatedPosition()
@@ -159,28 +159,28 @@ void testDerivativeOfInterpolatedPosition()
fdGrad[m] = Rotation<double,3>::interpolateDerivative(q[i].mult(Rotation<double,3>::exp(SkewMatrix<double,3>(variation))),
fdGrad[m] -= Rotation<double,3>::interpolateDerivative(q[i].mult(Rotation<double,3>::exp(SkewMatrix<double,3>(variation))),
fdGrad[3+m] = Rotation<double,3>::interpolateDerivative(q[i], q[j].mult(Rotation<double,3>::exp(SkewMatrix<double,3>(variation))), s);
fdGrad[3+m] -= Rotation<double,3>::interpolateDerivative(q[i], q[j].mult(Rotation<double,3>::exp(SkewMatrix<double,3>(variation))), s);
@@ -192,11 +192,11 @@ void testDerivativeOfInterpolatedPosition()
@@ -192,11 +192,11 @@ void testDerivativeOfInterpolatedPosition()
@@ -371,9 +371,9 @@ int main (int argc, char *argv[]) try
@@ -371,9 +371,9 @@ int main (int argc, char *argv[]) try