added support for deadzone on joystick due to rest position drift

Author: Rocketct

src/Modulino.h

@@ -167,11 +167,17 @@ class ModulinoJoystick : public Module {
     uint8_t buf[3];
     auto res = read((uint8_t*)buf, 3);
     auto ret = res && (buf[0] != last_status[0] || buf[1] != last_status[1] || buf[2] != last_status[2]);
-    last_status[0] = buf[0];
-    last_status[1] = buf[1];
+    auto x = buf[0];
+    auto y =  buf[1];
+    map_value(x, y);
+    last_status[0] = x;
+    last_status[1] = y;
     last_status[2] = buf[2];
     return ret;
   }
+  void setDeadZone(uint8_t dz_th) {
+    _dz_threshold = dz_th;
+  }
   PinStatus isPressed() {
     return last_status[2] ? HIGH : LOW;
   }
@@ -182,13 +188,19 @@ class ModulinoJoystick : public Module {
     return (last_status[1] < 128 ? (128 - last_status[1]) : -(last_status[1] - 128));
   }
   virtual uint8_t discover() {
-    for (unsigned int i = 0; i < sizeof(match)/sizeof(match[0]); i++) {
+    for (int i = 0; i < match.size(); i++) {
       if (scan(match[i])) {
         return match[i];
       }
     }
     return 0xFF;
   }
+  void map_value(uint8_t &x, uint8_t &y) {
+    if (x > 128 - _dz_threshold &&  x < 128 + _dz_threshold && y > 128 - _dz_threshold && y < 128 + _dz_threshold) {
+        x = 128;
+        y = 128;
+    }
+  }
 private:
   uint8_t last_status[3];
 protected: