From 7533853c576c21bb37575be97a90812e9ed01157 Mon Sep 17 00:00:00 2001 From: awenisko Date: Thu, 3 Sep 2015 18:32:28 +0200 Subject: [PATCH] Update wiring_digital.c Implemented INPUT_PULLUP digital pin mode. --- digistump-avr/cores/tiny/wiring_digital.c | 13 ++++++++++--- 1 file changed, 10 insertions(+), 3 deletions(-) diff --git a/digistump-avr/cores/tiny/wiring_digital.c b/digistump-avr/cores/tiny/wiring_digital.c index 48ee476..eac34a1 100644 --- a/digistump-avr/cores/tiny/wiring_digital.c +++ b/digistump-avr/cores/tiny/wiring_digital.c @@ -35,21 +35,28 @@ void pinMode(uint8_t pin, uint8_t mode) { uint8_t bit = digitalPinToBitMask(pin); uint8_t port = digitalPinToPort(pin); - volatile uint8_t *reg; + volatile uint8_t *reg, *out; if (port == NOT_A_PIN) return; // JWS: can I let the optimizer do this? reg = portModeRegister(port); + out = portOutputRegister(port); if (mode == INPUT) { uint8_t oldSREG = SREG; - cli(); + cli(); *reg &= ~bit; SREG = oldSREG; + } else if (mode == INPUT_PULLUP) { + uint8_t oldSREG = SREG; + cli(); + *reg &= ~bit; + *out |= bit; + SREG = oldSREG; } else { uint8_t oldSREG = SREG; - cli(); + cli(); *reg |= bit; SREG = oldSREG; }