Browse Source

Blimp: move error logging of sensor health into AP_Baro

apm_2208
Peter Barker 3 years ago committed by Peter Barker
parent
commit
8783bb9638
  1. 1
      Blimp/Blimp.cpp
  2. 1
      Blimp/Blimp.h
  3. 9
      Blimp/Log.cpp

1
Blimp/Blimp.cpp

@ -278,7 +278,6 @@ Blimp::Blimp(void) @@ -278,7 +278,6 @@ Blimp::Blimp(void)
flightmode(&mode_manual)
{
// init sensor error logging flags
sensor_health.baro = true;
sensor_health.compass = true;
}

1
Blimp/Blimp.h

@ -189,7 +189,6 @@ private: @@ -189,7 +189,6 @@ private:
// sensor health for logging
struct {
uint8_t baro : 1; // true if baro is healthy
uint8_t compass : 1; // true if compass is healthy
} sensor_health;

9
Blimp/Log.cpp

@ -232,20 +232,13 @@ tuning_max : tune_max @@ -232,20 +232,13 @@ tuning_max : tune_max
logger.WriteBlock(&pkt_tune, sizeof(pkt_tune));
}
// logs when baro or compass becomes unhealthy
// logs when compass becomes unhealthy
void Blimp::Log_Sensor_Health()
{
if (!should_log(MASK_LOG_ANY)) {
return;
}
// check baro
if (sensor_health.baro != barometer.healthy()) {
sensor_health.baro = barometer.healthy();
AP::logger().Write_Error(LogErrorSubsystem::BARO,
(sensor_health.baro ? LogErrorCode::ERROR_RESOLVED : LogErrorCode::UNHEALTHY));
}
// check compass
if (sensor_health.compass != compass.healthy()) {
sensor_health.compass = compass.healthy();

Loading…
Cancel
Save