Skip to content
Snippets Groups Projects
Commit b57642a8 authored by cont-integration's avatar cont-integration
Browse files

[skip ci] applied clang format

parent 626a8a5b
No related branches found
No related tags found
1 merge request!448Draft: Resolve "Implementation of new nodes creation"
Pipeline #20617 skipped
...@@ -38,7 +38,7 @@ class StateHomogeneous3d : public StateBlock ...@@ -38,7 +38,7 @@ class StateHomogeneous3d : public StateBlock
Eigen::VectorXd identity() const override; Eigen::VectorXd identity() const override;
Eigen::Vector3d point() const; Eigen::Vector3d point() const;
void setStatePoint(const Eigen::Vector3d&); void setStatePoint(const Eigen::Vector3d&);
virtual void transform(const VectorComposite& _transformation) override; virtual void transform(const VectorComposite& _transformation) override;
}; };
......
...@@ -170,7 +170,7 @@ TEST(StatePoint3d, non_transformable_translation_rotation) ...@@ -170,7 +170,7 @@ TEST(StatePoint3d, non_transformable_translation_rotation)
TEST(StateQuaternion, transform_identity) 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); StateQuaternion sb(x0);
VectorComposite trf({{'P', Vector3d::Zero()}, {'O', Quaterniond::Identity().coeffs()}}); VectorComposite trf({{'P', Vector3d::Zero()}, {'O', Quaterniond::Identity().coeffs()}});
...@@ -181,7 +181,7 @@ TEST(StateQuaternion, transform_identity) ...@@ -181,7 +181,7 @@ TEST(StateQuaternion, transform_identity)
TEST(StateQuaternion, transform_translation) 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); StateQuaternion sb(x0);
VectorComposite trf({{'P', Vector3d(4, 5, 6)}, {'O', Quaterniond::Identity().coeffs()}}); VectorComposite trf({{'P', Vector3d(4, 5, 6)}, {'O', Quaterniond::Identity().coeffs()}});
...@@ -192,7 +192,7 @@ TEST(StateQuaternion, transform_translation) ...@@ -192,7 +192,7 @@ TEST(StateQuaternion, transform_translation)
TEST(StateQuaternion, transform_rotation_90x) 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); StateQuaternion sb(x0);
VectorComposite trf({{'P', Vector3d::Zero()}, {'O', (Vector4d() << sqrt(2) / 2, 0, 0, sqrt(2) / 2).finished()}}); 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) ...@@ -205,7 +205,7 @@ TEST(StateQuaternion, transform_rotation_90x)
TEST(StateQuaternion, transform_translation_1y_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); StateQuaternion sb(x0);
VectorComposite trf({{'P', Vector3d(0, 1, 0)}, {'O', (Vector4d() << sqrt(2) / 2, 0, 0, sqrt(2) / 2).finished()}}); 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) ...@@ -218,7 +218,7 @@ TEST(StateQuaternion, transform_translation_1y_rotation_90x)
TEST(StateHomogeneous3d, transform_identity) TEST(StateHomogeneous3d, transform_identity)
{ {
Vector4d x0(1, 2, 3, 1); Vector4d x0(1, 2, 3, 1);
StateHomogeneous3d sb(x0); StateHomogeneous3d sb(x0);
VectorComposite trf({{'P', Vector3d::Zero()}, {'O', Quaterniond::Identity().coeffs()}}); VectorComposite trf({{'P', Vector3d::Zero()}, {'O', Quaterniond::Identity().coeffs()}});
...@@ -229,7 +229,7 @@ TEST(StateHomogeneous3d, transform_identity) ...@@ -229,7 +229,7 @@ TEST(StateHomogeneous3d, transform_identity)
TEST(StateHomogeneous3d, transform_translation_4x5y6z) TEST(StateHomogeneous3d, transform_translation_4x5y6z)
{ {
Vector4d x0(1, 2, 3, 1); Vector4d x0(1, 2, 3, 1);
StateHomogeneous3d sb(x0); StateHomogeneous3d sb(x0);
VectorComposite trf({{'P', Vector3d(4, 5, 6)}, {'O', Quaterniond::Identity().coeffs()}}); VectorComposite trf({{'P', Vector3d(4, 5, 6)}, {'O', Quaterniond::Identity().coeffs()}});
...@@ -242,7 +242,7 @@ TEST(StateHomogeneous3d, transform_translation_4x5y6z) ...@@ -242,7 +242,7 @@ TEST(StateHomogeneous3d, transform_translation_4x5y6z)
TEST(StateHomogeneous3d, transform_rotation_90x) TEST(StateHomogeneous3d, transform_rotation_90x)
{ {
Vector4d x0(1, 2, 3, 1); Vector4d x0(1, 2, 3, 1);
StateHomogeneous3d sb(x0); StateHomogeneous3d sb(x0);
VectorComposite trf({{'P', Vector3d::Zero()}, {'O', (Vector4d() << sqrt(2) / 2, 0, 0, sqrt(2) / 2).finished()}}); 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) ...@@ -255,7 +255,7 @@ TEST(StateHomogeneous3d, transform_rotation_90x)
TEST(StateHomogeneous3d, transform_translation_1y_rotation_90x) TEST(StateHomogeneous3d, transform_translation_1y_rotation_90x)
{ {
Vector4d x0(1, 2, 3, 1); Vector4d x0(1, 2, 3, 1);
StateHomogeneous3d sb(x0); StateHomogeneous3d sb(x0);
VectorComposite trf({{'P', Vector3d(0, 1, 0)}, {'O', (Vector4d() << sqrt(2) / 2, 0, 0, sqrt(2) / 2).finished()}}); 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) ...@@ -320,7 +320,7 @@ TEST(StateParams4, transform_translation_1y_rotation_90x)
TEST(StateHomogeneous3d, point) TEST(StateHomogeneous3d, point)
{ {
Vector4d x0(1, 2, 3, 1); Vector4d x0(1, 2, 3, 1);
StateHomogeneous3d sb(x0); StateHomogeneous3d sb(x0);
ASSERT_MATRIX_APPROX(sb.point(), x0.head<3>() / x0(3), 1e-15); ASSERT_MATRIX_APPROX(sb.point(), x0.head<3>() / x0(3), 1e-15);
......
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