From deb8c83c8142a06bd360494d50d97de75b025841 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Mon, 10 May 2010 23:55:04 +0200 Subject: digital/io/src: skip faulty sensors --- digital/io/src/usdist.c | 6 ++++-- 1 file changed, 4 insertions(+), 2 deletions(-) diff --git a/digital/io/src/usdist.c b/digital/io/src/usdist.c index 6c35ad64..df26ea79 100644 --- a/digital/io/src/usdist.c +++ b/digital/io/src/usdist.c @@ -93,8 +93,10 @@ usdist_update (void) ; uint16_t v = adc_read (); /* Our sensors return a value between 1 and 5 V proportional to - * the distance between calibrated values. */ - if (v <= 1024 / 5) + * the distance between calibrated values. Ignore faulty sensors. */ + if (v <= 1024 / 5 / 4) + usdist_mm[current] = 0xffff; + else if (v <= 1024 / 5) usdist_mm[current] = USDIST_MM_MIN; else usdist_mm[current] = USDIST_MM_MIN -- cgit v1.2.3