Browse Source

Sub: integrate ahrs::get_variances change

offset is no longer returned
c415-sdk
Randy Mackay 4 years ago
parent
commit
4bf4872504
  1. 3
      ArduSub/failsafe.cpp

3
ArduSub/failsafe.cpp

@ -110,10 +110,9 @@ void Sub::failsafe_ekf_check() @@ -110,10 +110,9 @@ void Sub::failsafe_ekf_check()
float posVar, hgtVar, tasVar;
Vector3f magVar;
Vector2f offset;
float compass_variance;
float vel_variance;
ahrs.get_variances(vel_variance, posVar, hgtVar, magVar, tasVar, offset);
ahrs.get_variances(vel_variance, posVar, hgtVar, magVar, tasVar);
compass_variance = magVar.length();
if (compass_variance < g.fs_ekf_thresh && vel_variance < g.fs_ekf_thresh) {

Loading…
Cancel
Save