From 572e1664938c7ce6c308b36779f6a412959e03f1 Mon Sep 17 00:00:00 2001 From: Keith Packard Date: Wed, 27 Jun 2012 23:11:27 -0700 Subject: [PATCH] altos: Track missed HMC5883 interrupts When it fails to signal conversion complete to the CPU, keep track of that and report it with the rest of the current data. Signed-off-by: Keith Packard --- src/drivers/ao_hmc5883.c | 10 ++++++++-- 1 file changed, 8 insertions(+), 2 deletions(-) diff --git a/src/drivers/ao_hmc5883.c b/src/drivers/ao_hmc5883.c index 64663ea6..dbeb66b8 100644 --- a/src/drivers/ao_hmc5883.c +++ b/src/drivers/ao_hmc5883.c @@ -63,6 +63,8 @@ ao_hmc5883_isr(void) ao_wakeup(&ao_hmc5883_done); } +static uint32_t ao_hmc5883_missed_irq; + void ao_hmc5883_sample(struct ao_hmc5883_sample *sample) { @@ -74,10 +76,13 @@ ao_hmc5883_sample(struct ao_hmc5883_sample *sample) ao_exti_enable(AO_HMC5883_INT_PORT, AO_HMC5883_INT_PIN); ao_hmc5883_reg_write(HMC5883_MODE, HMC5883_MODE_SINGLE); + ao_alarm(AO_MS_TO_TICKS(10)); cli(); while (!ao_hmc5883_done) - ao_sleep(&ao_hmc5883_done); + if (ao_sleep(&ao_hmc5883_done)) + ++ao_hmc5883_missed_irq; sei(); + ao_clear_alarm(); ao_hmc5883_read(HMC5883_X_MSB, (uint8_t *) sample, sizeof (struct ao_hmc5883_sample)); #if __BYTE_ORDER == __LITTLE_ENDIAN @@ -144,7 +149,8 @@ ao_hmc5883_show(void) struct ao_hmc5883_sample sample; sample = ao_hmc5883_current; - printf ("X: %d Y: %d Z: %d\n", sample.x, sample.y, sample.z); + printf ("X: %d Y: %d Z: %d missed irq: %lu\n", + sample.x, sample.y, sample.z, ao_hmc5883_missed_irq); } static const struct ao_cmds ao_hmc5883_cmds[] = { -- 2.30.2