Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-31 21:18:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Compass: fixed matrix inverse for new name

Browse Source
This commit is contained in:
Andrew Tridgell 2021-01-18 11:40:55 +11:00 committed by Peter Barker
parent 8278a8a00b
commit d0d480e858
1 changed files with 4 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_Compass/CompassCalibrator.cpp
View File

@ -655,11 +655,11 @@ void CompassCalibrator::run_sphere_fit()
JTJ2[i*COMPASS_CAL_NUM_SPHERE_PARAMS+i] += _sphere_lambda/lma_damping;
}
if (!inverse(JTJ, JTJ, 4)) {
if (!mat_inverse(JTJ, JTJ, 4)) {
return;
}
if (!inverse(JTJ2, JTJ2, 4)) {
if (!mat_inverse(JTJ2, JTJ2, 4)) {
return;
}
@ -771,11 +771,11 @@ void CompassCalibrator::run_ellipsoid_fit()
JTJ2[i*COMPASS_CAL_NUM_ELLIPSOID_PARAMS+i] += _ellipsoid_lambda/lma_damping;
}
if (!inverse(JTJ, JTJ, 9)) {
if (!mat_inverse(JTJ, JTJ, 9)) {
return;
}
if (!inverse(JTJ2, JTJ2, 9)) {
if (!mat_inverse(JTJ2, JTJ2, 9)) {
return;
}