LRF: filtered value 1061

refs 7956

org.fortiss.af3.platform.raspberry/trunk/lib/src/LaserRangeFinder.c

@@ -88,14 +88,18 @@ GEN_TYPE_int lrf_read() {
                 }
             } else {
                 d = atoi(value);
-                if (d != 0) {
-                    printf("%d\n", d);
-                    timeout = 0;
-                    return d;
-                } else {
+                if (d == 0) {
                     timeout++;
                     printf("-1: zero value\n");
                     return -1;
+                } else if(d == 1061) { //strange behaviour of one lrf
+                    printf("-1: 1061\n");
+                    return -1;
+                }
+                else {
+                    printf("%d\n", d);
+                    timeout = 0;
+                    return d;
                 }
             }
         }