Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_InertialSensor: revert AP_Math class change

This commit is contained in:
Andrew Tridgell 2015-05-05 12:35:25 +10:00
parent 015fce5183
commit e6a8a6da07
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
libraries/AP_InertialSensor/AP_InertialSensor.cpp
View File

@ -989,7 +989,7 @@ void AP_InertialSensor::_calibrate_find_delta(float dS[6], float JS[6][6], float
//eliminate all nonzero entries below JS[i][i] //eliminate all nonzero entries below JS[i][i]
for( j=i+1; j<6; j++ ) { for( j=i+1; j<6; j++ ) {
mu = JS[i][j]/JS[i][i]; mu = JS[i][j]/JS[i][i];
if( !AP_Math::is_zero(mu) ) { if( !is_zero(mu) ) {
dS[j] -= mu*dS[i]; dS[j] -= mu*dS[i];
for( k=j; k<6; k++ ) { for( k=j; k<6; k++ ) {
JS[k][j] -= mu*JS[k][i]; JS[k][j] -= mu*JS[k][i];