Fix: Clean-up previous state when alternating between GPIO and PWM functionality.

This fixes #613.

Author: aentinger

cores/arduino/wiring_analog.cpp

@@ -68,6 +68,17 @@ void analogWrite(pin_size_t pin, int val)
 #endif
   float percent = (float)val/(float)((1 << write_resolution)-1);
   mbed::PwmOut* pwm = digitalPinToPwm(pin);
+
+  /* Check if this pin has been previously configured as a GPIO pin.
+   * If it has, delete the GPIO allocation as well as the PWM allocation
+   * to enforce a full re-initialisation of the PWM module.
+   */
+  mbed::DigitalInOut * gpio = digitalPinToGpio(pin);
+  if ((gpio != NULL) && (pwm != NULL)) {
+    delete gpio; gpio = NULL; digitalPinToGpio(pin) = NULL;
+    delete pwm; pwm = NULL; digitalPinToPwm(pin) = NULL;
+  }
+
   if (pwm == NULL) {
     pwm = new mbed::PwmOut(digitalPinToPinName(pin));
     digitalPinToPwm(pin) = pwm;

cores/arduino/wiring_digital.cpp

@@ -94,6 +94,17 @@ void digitalWrite(pin_size_t pin, PinStatus val)
     return;
   }
   mbed::DigitalInOut* gpio = digitalPinToGpio(pin);
+
+  /* Check if this pin has been previously configured as a PWM pin.
+   * If it has, delete the GPIO allocation as well as the PWM allocation
+   * to enforce a full re-initialisation of the GPIO module.
+   */
+  mbed::PwmOut * pwm = digitalPinToPwm(pin);
+  if ((gpio != NULL) && (pwm != NULL)) {
+    delete gpio; gpio = NULL; digitalPinToGpio(pin) = NULL;
+    delete pwm; pwm = NULL; digitalPinToPwm(pin) = NULL;
+  }
+
   if (gpio == NULL) {
     gpio = new mbed::DigitalInOut(digitalPinToPinName(pin), PIN_OUTPUT, PullNone, val);
     digitalPinToGpio(pin) = gpio;