Fix dead lock with pin above NUM_DIGITAL_PINS (#2629)

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

Signed-off-by: Frederic Pillon <[email protected]>
Co-authored-by: Frederic Pillon <[email protected]>

Author: VitorBoss

cores/arduino/wiring_digital.c

@@ -78,17 +78,25 @@ 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);
+
+  return (p == NC) ? 0 : digitalReadFast(p);
 }
 
 void digitalToggle(uint32_t ulPin)
 {
-  digitalToggleFast(digitalPinToPinName(ulPin));
+  PinName p = digitalPinToPinName(ulPin);
+  if (p != NC) {
+    digitalToggleFast(digitalPinToPinName(ulPin));
+  }
 }
 
 #ifdef __cplusplus