Support modulino joystick

Author: facchinm

examples/Utilities/AddressChanger/AddressChanger.ino

@@ -228,6 +228,8 @@ String pinstrapToName(uint8_t pinstrap) {
   switch (pinstrap) {
     case 0x3C:
       return "Buzzer";
+    case 0x58:
+      return "Joystick";
     case 0x7C:
       return "Buttons";
     case 0x76:

examples/Utilities/Modulino_PlugNPlay/Modulino_PlugNPlay.ino

@@ -16,6 +16,7 @@ ModulinoKnob encoder;
 ModulinoDistance distance;
 ModulinoMovement imu;
 ModulinoThermo thermo;
+ModulinoJoystick joystick;
 
 void setup() {
 
@@ -30,6 +31,7 @@ void setup() {
   leds.begin();
   imu.begin();
   thermo.begin();
+  joystick.begin();
 }
 
 int skip = 0;
@@ -67,6 +69,10 @@ void loop() {
     Serial.println("\tTemperature: " + String(thermo.getTemperature()));
   }
 
+  if (joystick.update()) {
+    Serial.println("x: " + String(joystick.getX()) + " // y: " + String(joystick.getY()) + " // pressed: " + String(joystick.isPressed()));
+  }
+
   // Check for button presses
   if (buttons.update()) {
     // Button A: Red LED and 440Hz tone

src/Modulino.h

@@ -9,6 +9,7 @@
   #error "Learn more at: https://support.arduino.cc/hc/en-us/articles/10483225565980-Select-pin-numbering-for-Nano-ESP32-in-Arduino-IDE"
 #endif
 
+#include "Arduino.h"
 #include "Wire.h"
 #include <vl53l4cd_class.h>  // from stm32duino
 #include <vl53l4ed_class.h>  // from stm32duino
@@ -182,6 +183,42 @@ class ModulinoButtons : public Module {
   uint8_t match[1] = { 0x7C };  // same as fw main.c
 };
 
+class ModulinoJoystick : public Module {
+public:
+  ModulinoJoystick(uint8_t address = 0xFF)
+    : Module(address, "JOYSTICK") {}
+  bool update() {
+    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];
+    last_status[2] = buf[2];
+    return ret;
+  }
+  PinStatus isPressed() {
+    return last_status[2] ? HIGH : LOW;
+  }
+  int8_t getX() {
+    return (last_status[0] < 128 ? (128 - last_status[0]) : -(last_status[0] - 128));
+  }
+  int8_t getY() {
+    return (last_status[1] < 128 ? (128 - last_status[1]) : -(last_status[1] - 128));
+  }
+  virtual uint8_t discover() {
+    for (int i = 0; i < match.size(); i++) {
+      if (scan(match[i])) {
+        return match[i];
+      }
+    }
+    return 0xFF;
+  }
+private:
+  uint8_t last_status[3];
+protected:
+  std::vector<uint8_t> match = { 0x58 };  // same as fw main.c
+};
+
 class ModulinoBuzzer : public Module {
 public:
   ModulinoBuzzer(uint8_t address = 0xFF)