diff --git a/Marlin/src/libs/softspi.h b/Marlin/src/libs/softspi.h index e3a28fdc73..8b3b671455 100644 --- a/Marlin/src/libs/softspi.h +++ b/Marlin/src/libs/softspi.h @@ -19,11 +19,10 @@ bool fastDigitalRead(uint8_t pin) { */ static inline __attribute__((always_inline)) void fastDigitalWrite(uint8_t pin, bool value) { - if (value) { + if (value) *portSetRegister(pin) = 1; - } else { + else *portClearRegister(pin) = 1; - } } #else // CORE_TEENSY //------------------------------------------------------------------------------ @@ -42,17 +41,16 @@ bool fastDigitalRead(uint8_t pin){ */ static inline __attribute__((always_inline)) void fastDigitalWrite(uint8_t pin, bool value){ - if(value) { + if (value) g_APinDescription[pin].pPort->PIO_SODR = g_APinDescription[pin].ulPin; - } else { + else g_APinDescription[pin].pPort->PIO_CODR = g_APinDescription[pin].ulPin; - } } #endif // CORE_TEENSY //------------------------------------------------------------------------------ inline void fastDigitalToggle(uint8_t pin) { - fastDigitalWrite(pin, !fastDigitalRead(pin)); - } + fastDigitalWrite(pin, !fastDigitalRead(pin)); +} //------------------------------------------------------------------------------ inline void fastPinMode(uint8_t pin, bool mode) {pinMode(pin, mode);} #else // __arm__