diff --git a/include/core/state_block/state_homogeneous_3d.h b/include/core/state_block/state_homogeneous_3d.h index 84011a2b8cce60be106c564abf75ad4ee593851c..f47c6c6990a03bda7968cb665359aff0d8d9523c 100644 --- a/include/core/state_block/state_homogeneous_3d.h +++ b/include/core/state_block/state_homogeneous_3d.h @@ -38,7 +38,7 @@ class StateHomogeneous3d : public StateBlock Eigen::VectorXd identity() const override; Eigen::Vector3d point() const; - void setStatePoint(const Eigen::Vector3d&); + void setStatePoint(const Eigen::Vector3d&); virtual void transform(const VectorComposite& _transformation) override; }; diff --git a/test/gtest_state_block.cpp b/test/gtest_state_block.cpp index 9f657911b7d5b729e1add83e62a2bbc097e17619..8a5de1ae92a8b350b99e9087c41efa10ed16182e 100644 --- a/test/gtest_state_block.cpp +++ b/test/gtest_state_block.cpp @@ -170,7 +170,7 @@ TEST(StatePoint3d, non_transformable_translation_rotation) TEST(StateQuaternion, transform_identity) { - Vector4d x0(0.5, 0.5, 0.5, 0.5); // Euler XYZ : 90º, 90º, 0º + Vector4d x0(0.5, 0.5, 0.5, 0.5); // Euler XYZ : 90º, 90º, 0º StateQuaternion sb(x0); VectorComposite trf({{'P', Vector3d::Zero()}, {'O', Quaterniond::Identity().coeffs()}}); @@ -181,7 +181,7 @@ TEST(StateQuaternion, transform_identity) TEST(StateQuaternion, transform_translation) { - Vector4d x0(0.5, 0.5, 0.5, 0.5); // Euler XYZ : 90º, 90º, 0º + Vector4d x0(0.5, 0.5, 0.5, 0.5); // Euler XYZ : 90º, 90º, 0º StateQuaternion sb(x0); VectorComposite trf({{'P', Vector3d(4, 5, 6)}, {'O', Quaterniond::Identity().coeffs()}}); @@ -192,7 +192,7 @@ TEST(StateQuaternion, transform_translation) TEST(StateQuaternion, transform_rotation_90x) { - Vector4d x0(0.5, 0.5, 0.5, 0.5); // Euler XYZ : 90º, 90º, 0º + Vector4d x0(0.5, 0.5, 0.5, 0.5); // Euler XYZ : 90º, 90º, 0º StateQuaternion sb(x0); VectorComposite trf({{'P', Vector3d::Zero()}, {'O', (Vector4d() << sqrt(2) / 2, 0, 0, sqrt(2) / 2).finished()}}); @@ -205,7 +205,7 @@ TEST(StateQuaternion, transform_rotation_90x) TEST(StateQuaternion, transform_translation_1y_rotation_90x) { - Vector4d x0(0.5, 0.5, 0.5, 0.5); // Euler XYZ : 90º, 90º, 0º + Vector4d x0(0.5, 0.5, 0.5, 0.5); // Euler XYZ : 90º, 90º, 0º StateQuaternion sb(x0); VectorComposite trf({{'P', Vector3d(0, 1, 0)}, {'O', (Vector4d() << sqrt(2) / 2, 0, 0, sqrt(2) / 2).finished()}}); @@ -218,7 +218,7 @@ TEST(StateQuaternion, transform_translation_1y_rotation_90x) TEST(StateHomogeneous3d, transform_identity) { - Vector4d x0(1, 2, 3, 1); + Vector4d x0(1, 2, 3, 1); StateHomogeneous3d sb(x0); VectorComposite trf({{'P', Vector3d::Zero()}, {'O', Quaterniond::Identity().coeffs()}}); @@ -229,7 +229,7 @@ TEST(StateHomogeneous3d, transform_identity) TEST(StateHomogeneous3d, transform_translation_4x5y6z) { - Vector4d x0(1, 2, 3, 1); + Vector4d x0(1, 2, 3, 1); StateHomogeneous3d sb(x0); VectorComposite trf({{'P', Vector3d(4, 5, 6)}, {'O', Quaterniond::Identity().coeffs()}}); @@ -242,7 +242,7 @@ TEST(StateHomogeneous3d, transform_translation_4x5y6z) TEST(StateHomogeneous3d, transform_rotation_90x) { - Vector4d x0(1, 2, 3, 1); + Vector4d x0(1, 2, 3, 1); StateHomogeneous3d sb(x0); VectorComposite trf({{'P', Vector3d::Zero()}, {'O', (Vector4d() << sqrt(2) / 2, 0, 0, sqrt(2) / 2).finished()}}); @@ -255,7 +255,7 @@ TEST(StateHomogeneous3d, transform_rotation_90x) TEST(StateHomogeneous3d, transform_translation_1y_rotation_90x) { - Vector4d x0(1, 2, 3, 1); + Vector4d x0(1, 2, 3, 1); StateHomogeneous3d sb(x0); VectorComposite trf({{'P', Vector3d(0, 1, 0)}, {'O', (Vector4d() << sqrt(2) / 2, 0, 0, sqrt(2) / 2).finished()}}); @@ -320,7 +320,7 @@ TEST(StateParams4, transform_translation_1y_rotation_90x) TEST(StateHomogeneous3d, point) { - Vector4d x0(1, 2, 3, 1); + Vector4d x0(1, 2, 3, 1); StateHomogeneous3d sb(x0); ASSERT_MATRIX_APPROX(sb.point(), x0.head<3>() / x0(3), 1e-15);