diff --git a/src/modules/navigator/follow_target.h b/src/modules/navigator/follow_target.h index 51f1e39d94..540c6994b2 100644 --- a/src/modules/navigator/follow_target.h +++ b/src/modules/navigator/follow_target.h @@ -82,31 +82,11 @@ private: }; static constexpr float _follow_position_matricies[4][9] = { - { - 1.0F, -1.0F, 0.0F, - 1.0F, 1.0F, 0.0F, - 0.0F, 0.0F, 1.0F - }, // follow right - - { - -1.0F, 0.0F, 0.0F, - 0.0F, -1.0F, 0.0F, - 0.0F, 0.0F, 1.0F - }, // follow behind - - { - 1.0F, 0.0F, 0.0F, - 0.0F, 1.0F, 0.0F, - 0.0F, 0.0F, 1.0F - }, // follow front - - { - 1.0F, 1.0F, 0.0F, - -1.0F, 1.0F, 0.0F, - 0.0F, 0.0F, 1.0F - } - }; // follow left side - + { 1.0F, -1.0F, 0.0F, 1.0F, 1.0F, 0.0F, 0.0F, 0.0F, 1.0F}, // follow right + {-1.0F, 0.0F, 0.0F, 0.0F, -1.0F, 0.0F, 0.0F, 0.0F, 1.0F}, // follow behind + { 1.0F, 0.0F, 0.0F, 0.0F, 1.0F, 0.0F, 0.0F, 0.0F, 1.0F}, // follow front + { 1.0F, 1.0F, 0.0F, -1.0F, 1.0F, 0.0F, 0.0F, 0.0F, 1.0F} // follow left side + }; DEFINE_PARAMETERS( (ParamFloat) _param_min_alt, diff --git a/src/systemcmds/tests/test_matrix.cpp b/src/systemcmds/tests/test_matrix.cpp index 59f5f26048..d4aabc81a9 100644 --- a/src/systemcmds/tests/test_matrix.cpp +++ b/src/systemcmds/tests/test_matrix.cpp @@ -363,11 +363,10 @@ bool MatrixTest::inverseTests() 4, 5, 6, 7, 8, 10 }; - float data_check[9] = { - -0.4f, -0.8f, 0.6f, - -0.4f, 4.2f, -2.4f, - 0.6f, -2.8f, 1.6f - }; + float data_check[9] = {-0.4f, -0.8f, 0.6f, + -0.4f, 4.2f, -2.4f, + 0.6f, -2.8f, 1.6f + }; SquareMatrix A(data); SquareMatrix A_I = inv(A);