X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fdrivers%2Fao_adxl375.c;h=66d39ff915b625c6f87acac828594ff1f8a6ad4b;hp=778c214b6e49b637a0ebd0be74b65c5de1120b68;hb=0d472ab07224a21abfa83da8336439d7844f9aa8;hpb=4fb00afc9018c6179c4aff897fcbb330588d02a2 diff --git a/src/drivers/ao_adxl375.c b/src/drivers/ao_adxl375.c index 778c214b..66d39ff9 100644 --- a/src/drivers/ao_adxl375.c +++ b/src/drivers/ao_adxl375.c @@ -172,7 +172,6 @@ ao_adxl375_setup(void) (0 << AO_ADXL375_POWER_CTL_SLEEP) | (AO_ADXL375_POWER_CTL_WAKEUP_8 << AO_ADXL375_POWER_CTL_WAKEUP)); - (void) ao_adxl375_total_value; /* Perform self-test */ struct ao_adxl375_total self_test_off, self_test_on; @@ -204,9 +203,16 @@ ao_adxl375_setup(void) self_test_value = z_change; - if (z_change < MIN_SELF_TEST || MAX_SELF_TEST < z_change) + if (z_change < MIN_SELF_TEST) ao_sensor_errors = 1; + /* This check is commented out as maximum self test is unreliable + + if (z_change > MAX_SELF_TEST) + ao_sensor_errors = 1; + + */ + /* Discard some samples to let it settle down */ ao_adxl375_total_value(&self_test_off, AO_ADXL375_SELF_TEST_SETTLE); }