Merge pull request #9559 from mluessi/ml_fix_pionio_inverted

PINIO: Fix inverted pin handling
iNavFlight · Mar 22, 2024 · 2b1df9e · 2b1df9e
2 parents 6ca2878 + f4ab90d
commit 2b1df9e
Show file tree

Hide file tree

Showing 2 changed files with 3 additions and 5 deletions.
diff --git a/src/main/drivers/pinio.c b/src/main/drivers/pinio.c
@@ -100,16 +100,14 @@ void pinioInit(void)
     }
 }
 
-void pinioSet(int index, bool on)
+void pinioSet(int index, bool newState)
 {
-    const bool newState = on ^ pinioRuntime[index].inverted;
-
     if (!pinioRuntime[index].io) {
         return;
     }
 
     if (newState != pinioRuntime[index].state) {
-        IOWrite(pinioRuntime[index].io, newState);
+        IOWrite(pinioRuntime[index].io, newState ^ pinioRuntime[index].inverted);
         pinioRuntime[index].state = newState;
     }
 }

diff --git a/src/main/drivers/pinio.h b/src/main/drivers/pinio.h
@@ -38,4 +38,4 @@ extern const pinioHardware_t pinioHardware[];
 extern const int pinioHardwareCount;
 
 void pinioInit(void);
-void pinioSet(int index, bool on);
+void pinioSet(int index, bool newState);