summaryrefslogtreecommitdiffhomepage
path: root/digital/io/src/usdist.c
diff options
context:
space:
mode:
Diffstat (limited to 'digital/io/src/usdist.c')
-rw-r--r--digital/io/src/usdist.c6
1 files 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