You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
41 lines
992 B
41 lines
992 B
/*
|
|
|
|
GPIO MODULE
|
|
|
|
Copyright (C) 2017-2018 by Xose Pérez <xose dot perez at gmail dot com>
|
|
|
|
Module key prefix: io
|
|
|
|
*/
|
|
|
|
unsigned int _gpio_locked = 0;
|
|
|
|
bool gpioValid(unsigned char gpio) {
|
|
if (gpio <= 5) return true;
|
|
if (12 <= gpio && gpio <= 15) return true;
|
|
return false;
|
|
}
|
|
|
|
bool gpioGetLock(unsigned char gpio) {
|
|
if (gpioValid(gpio)) {
|
|
unsigned int mask = 1 << gpio;
|
|
if ((_gpio_locked & mask) == 0) {
|
|
_gpio_locked |= mask;
|
|
DEBUG_MSG_P(PSTR("[GPIO] GPIO%u locked\n"), gpio);
|
|
return true;
|
|
}
|
|
}
|
|
DEBUG_MSG_P(PSTR("[GPIO] Failed getting lock for GPIO%u\n"), gpio);
|
|
return false;
|
|
}
|
|
|
|
bool gpioReleaseLock(unsigned char gpio) {
|
|
if (gpioValid(gpio)) {
|
|
unsigned int mask = 1 << gpio;
|
|
_gpio_locked &= ~mask;
|
|
DEBUG_MSG_P(PSTR("[GPIO] GPIO%u lock released\n"), gpio);
|
|
return true;
|
|
}
|
|
DEBUG_MSG_P(PSTR("[GPIO] Failed releasing lock for GPIO%u\n"), gpio);
|
|
return false;
|
|
}
|