Added support for vibration power on modulino Vibro

Author: Rocketct

src/Modulino.h

@@ -18,6 +18,16 @@
 #define HardwareI2C   TwoWire
 #endif
 
+typedef enum {
+  STOP = 0,
+  GENTLE = 25,
+  MODERATE = 30,
+  MEDIUM = 35,
+  INTENSE = 40,
+  POWERFUL = 45,
+  MAXIMUM = 50
+} VibroPowerLevel;
+
 void __increaseI2CPriority();
 
 class ModulinoClass {
@@ -226,28 +236,39 @@ 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;
+  void on(size_t len_ms, bool block, VibroPowerLevel power = MAXIMUM ) {
+    uint8_t buf[12];
+    uint32_t freq = 1000;
     memcpy(&buf[0], &freq, 4);
     memcpy(&buf[4], &len_ms, 4);
-    write(buf, 8);
+    memcpy(&buf[8], &power, 4);
+    write(buf, 12);
+    if (block) {
+      delay(len_ms);
+      off();
+    }
+  }
+  void on(size_t len_ms) {
+    on(len_ms, false);
+  }
+  void on(size_t len_ms, VibroPowerLevel power) {
+    on(len_ms, false, power);
   }
   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++) {
+    for (int i = 0; i < match.size(); i++) {
       if (scan(match[i])) {
         return match[i];
       }
     }
     return 0xFF;
   }
 protected:
-  uint8_t match[1] = { 0x70 };  // same as fw main.c
+  std::vector<uint8_t> match = { 0x70 };  // same as fw main.c
 };
 
 class ModulinoColor {