Increase I2C priority if LED Matrix is used

The distance sensor doesn't like to be interrupted in the middle of a transaction.
Changing the priority of the IIC peripheral to be higher than the timer one will prevent it from getting stuck

Author: facchinm

src/Modulino.cpp

@@ -11,4 +11,19 @@ ModulinoColor RED(255, 0, 0);
 ModulinoColor BLUE(0, 0, 255);
 ModulinoColor GREEN(0, 255, 0);
 ModulinoColor VIOLET(255, 0, 255);
-ModulinoColor WHITE(255, 255, 255);
+ModulinoColor WHITE(255, 255, 255);
+
+#if __has_include("Arduino_LED_Matrix.h")
+void __increaseI2CPriority() {
+    for (int i = 0; i < 96; i++) {
+        if (R_ICU->IELSR[i] == BSP_PRV_IELS_ENUM(EVENT_IIC0_TXI)) {
+            NVIC_SetPriority(IRQn_Type(i), 6);
+            NVIC_SetPriority(IRQn_Type(i+1), 6);
+            NVIC_SetPriority(IRQn_Type(i+2), 6);
+            NVIC_SetPriority(IRQn_Type(i+3), 6);
+        }
+    }
+}
+#else
+void __increaseI2CPriority() {}
+#endif

src/Modulino.h

@@ -14,6 +14,8 @@
 #define HardwareI2C   TwoWire
 #endif
 
+void __increaseI2CPriority();
+
 class ModulinoClass {
 public:
 #ifdef ARDUINO_UNOR4_WIFI
@@ -33,6 +35,7 @@ class ModulinoClass {
     _wire = &wire;
     _wire->begin();
     _wire->setClock(100000);
+    __increaseI2CPriority();
   }
   friend class Module;
 protected:
@@ -298,6 +301,7 @@ class ModulinoMovement : public Module {
       _imu = new LSM6DSOXClass(*((TwoWire*)getWire()), 0x6A);
     }
     initialized = _imu->begin();
+    __increaseI2CPriority();
     return initialized != 0;
   }
   operator bool() {
@@ -331,6 +335,7 @@ class ModulinoThermo: public Module {
       _sensor = new HS300xClass(*((TwoWire*)getWire()));
     }
     initialized = _sensor->begin();
+    __increaseI2CPriority();
     return initialized;
   }
   operator bool() {
@@ -364,6 +369,7 @@ class ModulinoPressure : public Module {
       // unfortunately LPS22HBClass calles Wire.end() on failure, restart it
       getWire()->begin();
     }
+    __increaseI2CPriority();
     return initialized != 0;
   }
   operator bool() {
@@ -400,6 +406,7 @@ class ModulinoDistance : public Module {
     }
     tof_sensor = new VL53L4CD((TwoWire*)getWire(), -1);
     auto ret = tof_sensor->InitSensor();
+    __increaseI2CPriority();
     if (ret == VL53L4CD_ERROR_NONE) {
       tof_sensor->VL53L4CD_SetRangeTiming(20, 0);
       tof_sensor->VL53L4CD_StartRanging();