Automatically set ALTERNATE pin mode when setting alternate function

[fw/altos] / src / stm / stm32l.h

diff --git a/src/stm/stm32l.h b/src/stm/stm32l.h
index 50e5cc346a9ee0f404f06729a68ab6cc18f53182..531a4fb9488c026e899ea48375bc4ca6c3048660 100644 (file)
--- a/src/stm/stm32l.h
+++ b/src/stm/stm32l.h
@@ -133,6 +133,10 @@ stm_pupdr_get(struct stm_gpio *gpio, int pin) {
 
 static inline void
 stm_afr_set(struct stm_gpio *gpio, int pin, uint32_t value) {
+       /*
+        * Set alternate pin mode too
+        */
+       stm_moder_set(gpio, pin, STM_MODER_ALTERNATE);
        if (pin < 8)
                gpio->afrl = ((gpio->afrl &
                               ~(STM_AFR_MASK << STM_AFR_SHIFT(pin))) |