Add ModulinoVibro

Author: facchinm

examples/Utilities/AddressChanger/AddressChanger.ino

@@ -237,6 +237,8 @@ String pinstrapToName(uint8_t pinstrap) {
       return "Encoder";
     case 0x6C:
       return "Smartleds";
+    case 0x70:
+      return "Vibro";
   }
   return "UNKNOWN";
 }

src/Modulino.h

@@ -245,6 +245,35 @@ class ModulinoBuzzer : public Module {
   uint8_t match[1] = { 0x3C };  // same as fw main.c
 };
 
+class ModulinoVibro : public Module {
+public:
+  ModulinoVibro(uint8_t address = 0xFF)
+    : Module(address, "VIBRO") {}
+  void on(size_t len_ms) {
+    uint8_t buf[8];
+    uint32_t freq = 100;
+    memcpy(&buf[0], &freq, 4);
+    memcpy(&buf[4], &len_ms, 4);
+    write(buf, 8);
+  }
+  void off() {
+    uint8_t buf[8];
+    memset(&buf[0], 0, 8);
+    write(buf, 8);
+  }
+  virtual uint8_t discover() {
+    for (unsigned int i = 0; i < sizeof(match)/sizeof(match[0]); i++) {
+      if (scan(match[i])) {
+        return match[i];
+      }
+    }
+    return 0xFF;
+  }
+protected:
+  uint8_t match[1] = { 0x70 };  // same as fw main.c
+};
+
+
 class ModulinoColor {
 public:
   ModulinoColor(uint8_t r, uint8_t g, uint8_t b)