Fix dead lock with pin above NUM_DIGITAL_PINS

Penalty for the check should be a single instruction for pin numbers below NUM_DIGITAL_PINS, 9 for pin numbers between PNUM_ANALOG_BASE and NUM_ANALOG_INTERNAL_FIRST. Tests done on a Black F407VE board
stm32duino · Jan 13, 2025 · b06ba1d · b06ba1d
1 parent cfe4962
commit b06ba1d
Showing 1 changed file with 14 additions and 3 deletions.
diff --git a/cores/arduino/wiring_digital.c b/cores/arduino/wiring_digital.c
@@ -78,17 +78,28 @@ void pinMode(uint32_t ulPin, uint32_t ulMode)
 
 void digitalWrite(uint32_t ulPin, uint32_t ulVal)
 {
-  digitalWriteFast(digitalPinToPinName(ulPin), ulVal);
+  PinName p = digitalPinToPinName(ulPin);
+  if (p != NC) {
+    digitalWriteFast(p, ulVal);
+  }
 }
 
 int digitalRead(uint32_t ulPin)
 {
-  return digitalReadFast(digitalPinToPinName(ulPin));
+  PinName p = digitalPinToPinName(ulPin);
+
+  if (p == NC) {
+    return 0;
+  }
+  return digitalReadFast(p);
 }
 
 void digitalToggle(uint32_t ulPin)
 {
-  digitalToggleFast(digitalPinToPinName(ulPin));
+  PinName p = digitalPinToPinName(ulPin);
+  if (p != NC) {
+    digitalToggleFast(digitalPinToPinName(ulPin));
+  }
 }
 
 #ifdef __cplusplus