Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-01 19:07:45 +08:00
Code Issues Actions 5 Packages Projects Releases Wiki Activity

matrix: update submodule (improves matrix inversion)

Browse Source
This commit is contained in:
Beat Küng
2021-08-31 15:21:21 +02:00
committed by Daniel Agar
parent 73ab153fe0
commit 291ca246d2
4 changed files with 10 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/matrix
+1 -1
Submodule src/lib/matrix updated: 3d1c9b988d...007a7f78ae
src/modules/control_allocator/ControlAllocation/ControlAllocationPseudoInverse.cpp
+1 -1
View File
@@ -54,7 +54,7 @@ void
ControlAllocationPseudoInverse::updatePseudoInverse() ControlAllocationPseudoInverse::updatePseudoInverse()
{ {
if (_mix_update_needed) { if (_mix_update_needed) {
_mix = matrix::geninv(_effectiveness); matrix::geninv(_effectiveness, _mix);
_mix_update_needed = false; _mix_update_needed = false;
} }
} }
src/systemcmds/microbench/test_microbench_matrix.cpp
+2 -2
View File
@@ -170,8 +170,8 @@ bool MicroBenchMatrix::time_matrix_dcm()
bool MicroBenchMatrix::time_matrix_pseduo_inverse() bool MicroBenchMatrix::time_matrix_pseduo_inverse()
{ {
PERF("matrix 6x16 pseudo inverse (all non-zero columns)", A16 = matrix::geninv(B16), 100); PERF("matrix 6x16 pseudo inverse (all non-zero columns)", matrix::geninv(B16, A16), 100);
PERF("matrix 6x16 pseudo inverse (4 non-zero columns)", A16 = matrix::geninv(B16_4), 100); PERF("matrix 6x16 pseudo inverse (4 non-zero columns)", matrix::geninv(B16_4, A16), 100);
return true; return true;
} }
src/systemcmds/tests/test_matrix.cpp
+6 -3
View File
@@ -776,7 +776,8 @@ bool MatrixTest::pseudoInverseTests()
}; };
Matrix<float, 3, 4> A0(data0); Matrix<float, 3, 4> A0(data0);
Matrix<float, 4, 3> A0_I = geninv(A0); Matrix<float, 4, 3> A0_I;
geninv(A0, A0_I);
Matrix<float, 4, 3> A0_I_check(data0_check); Matrix<float, 4, 3> A0_I_check(data0_check);
ut_test((A0_I - A0_I_check).abs().max() < 1e-5); ut_test((A0_I - A0_I_check).abs().max() < 1e-5);
@@ -795,7 +796,8 @@ bool MatrixTest::pseudoInverseTests()
}; };
Matrix<float, 4, 3> A1(data1); Matrix<float, 4, 3> A1(data1);
Matrix<float, 3, 4> A1_I = geninv(A1); Matrix<float, 3, 4> A1_I;
geninv(A1, A1_I);
Matrix<float, 3, 4> A1_I_check(data1_check); Matrix<float, 3, 4> A1_I_check(data1_check);
ut_test((A1_I - A1_I_check).abs().max() < 1e-5); ut_test((A1_I - A1_I_check).abs().max() < 1e-5);
@@ -845,7 +847,8 @@ bool MatrixTest::pseudoInverseTests()
{ 0.0f, 0.0f, 0.0f, 0.0f, 0.0f, 0.0f} { 0.0f, 0.0f, 0.0f, 0.0f, 0.0f, 0.0f}
}; };
Matrix<float, 16, 6> A_check(A_quad_w); Matrix<float, 16, 6> A_check(A_quad_w);
Matrix<float, 16, 6> A = geninv(B); Matrix<float, 16, 6> A;
geninv(B, A);
ut_test((A - A_check).abs().max() < 1e-5); ut_test((A - A_check).abs().max() < 1e-5);
return true; return true;