mirror of https://github.com/ARMmbed/mbed-os.git
Merge pull request #7220 from melvinvdb/fix_nrf5x_interrupt_pull_mode
Fix mbed::InterruptIn.mode() in NRF5x targetspull/7299/head
commit
0b8f46763a
|
@ -21,13 +21,13 @@
|
||||||
|
|
||||||
|
|
||||||
#if defined(TARGET_MCU_NRF51822)
|
#if defined(TARGET_MCU_NRF51822)
|
||||||
#define GPIO_PIN_COUNT 31
|
#define GPIO_PIN_COUNT 31
|
||||||
#elif defined(TARGET_MCU_NRF52832)
|
#elif defined(TARGET_MCU_NRF52832)
|
||||||
#define GPIO_PIN_COUNT 32
|
#define GPIO_PIN_COUNT 32
|
||||||
#elif defined(TARGET_MCU_NRF52840)
|
#elif defined(TARGET_MCU_NRF52840)
|
||||||
#define GPIO_PIN_COUNT 48
|
#define GPIO_PIN_COUNT 48
|
||||||
#else
|
#else
|
||||||
#error not recognized gpio count for mcu
|
#error not recognized gpio count for mcu
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
typedef struct {
|
typedef struct {
|
||||||
|
@ -40,9 +40,9 @@ typedef struct {
|
||||||
} gpio_cfg_t;
|
} gpio_cfg_t;
|
||||||
|
|
||||||
#if GPIO_PIN_COUNT > 32
|
#if GPIO_PIN_COUNT > 32
|
||||||
typedef uint64_t gpio_mask_t;
|
typedef uint64_t gpio_mask_t;
|
||||||
#else
|
#else
|
||||||
typedef uint32_t gpio_mask_t;
|
typedef uint32_t gpio_mask_t;
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
static gpio_mask_t m_gpio_initialized;
|
static gpio_mask_t m_gpio_initialized;
|
||||||
|
@ -62,12 +62,12 @@ static void gpiote_irq_handler(nrf_drv_gpiote_pin_t pin, nrf_gpiote_polarity_t a
|
||||||
{
|
{
|
||||||
nrf_gpio_pin_sense_t sense = nrf_gpio_pin_sense_get(pin);
|
nrf_gpio_pin_sense_t sense = nrf_gpio_pin_sense_get(pin);
|
||||||
gpio_irq_event event = (sense == NRF_GPIO_PIN_SENSE_LOW) ? IRQ_RISE : IRQ_FALL;
|
gpio_irq_event event = (sense == NRF_GPIO_PIN_SENSE_LOW) ? IRQ_RISE : IRQ_FALL;
|
||||||
|
|
||||||
if (m_gpio_irq_enabled & ((gpio_mask_t)1 << pin)) {
|
if (m_gpio_irq_enabled & ((gpio_mask_t)1 << pin)) {
|
||||||
if (((event == IRQ_RISE) && m_gpio_cfg[pin].irq_rise)
|
if (((event == IRQ_RISE) && m_gpio_cfg[pin].irq_rise)
|
||||||
|| ((event == IRQ_FALL) && m_gpio_cfg[pin].irq_fall)) {
|
|| ((event == IRQ_FALL) && m_gpio_cfg[pin].irq_fall)) {
|
||||||
m_irq_handler(m_channel_ids[pin], event);
|
m_irq_handler(m_channel_ids[pin], event);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -80,9 +80,9 @@ void gpio_init(gpio_t *obj, PinName pin)
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
MBED_ASSERT((uint32_t)pin < GPIO_PIN_COUNT);
|
MBED_ASSERT((uint32_t)pin < GPIO_PIN_COUNT);
|
||||||
|
|
||||||
NVIC_SetVector(GPIOTE_IRQn, (uint32_t) GPIOTE_IRQHandler);
|
NVIC_SetVector(GPIOTE_IRQn, (uint32_t) GPIOTE_IRQHandler);
|
||||||
|
|
||||||
(void) nrf_drv_gpiote_init();
|
(void) nrf_drv_gpiote_init();
|
||||||
|
|
||||||
m_gpio_cfg[obj->pin].used_as_gpio = true;
|
m_gpio_cfg[obj->pin].used_as_gpio = true;
|
||||||
|
@ -111,8 +111,7 @@ static void gpiote_pin_uninit(uint8_t pin)
|
||||||
if (m_gpio_initialized & ((gpio_mask_t)1UL << pin)) {
|
if (m_gpio_initialized & ((gpio_mask_t)1UL << pin)) {
|
||||||
if ((m_gpio_cfg[pin].direction == PIN_OUTPUT) && (!m_gpio_cfg[pin].used_as_irq)) {
|
if ((m_gpio_cfg[pin].direction == PIN_OUTPUT) && (!m_gpio_cfg[pin].used_as_irq)) {
|
||||||
nrf_drv_gpiote_out_uninit(pin);
|
nrf_drv_gpiote_out_uninit(pin);
|
||||||
}
|
} else if (m_gpio_cfg[pin].used_as_irq) {
|
||||||
else if (m_gpio_cfg[pin].used_as_irq) {
|
|
||||||
nrf_drv_gpiote_in_uninit(pin);
|
nrf_drv_gpiote_in_uninit(pin);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -122,45 +121,40 @@ static void gpio_apply_config(uint8_t pin)
|
||||||
{
|
{
|
||||||
if (m_gpio_cfg[pin].used_as_gpio || m_gpio_cfg[pin].used_as_irq) {
|
if (m_gpio_cfg[pin].used_as_gpio || m_gpio_cfg[pin].used_as_irq) {
|
||||||
if ((m_gpio_cfg[pin].direction == PIN_INPUT)
|
if ((m_gpio_cfg[pin].direction == PIN_INPUT)
|
||||||
|| (m_gpio_cfg[pin].used_as_irq)) {
|
|| (m_gpio_cfg[pin].used_as_irq)) {
|
||||||
//Configure as input.
|
//Configure as input.
|
||||||
nrf_drv_gpiote_in_config_t cfg;
|
nrf_drv_gpiote_in_config_t cfg;
|
||||||
|
|
||||||
cfg.hi_accuracy = false;
|
cfg.hi_accuracy = false;
|
||||||
cfg.is_watcher = false;
|
cfg.is_watcher = false;
|
||||||
cfg.sense = NRF_GPIOTE_POLARITY_TOGGLE;
|
cfg.sense = NRF_GPIOTE_POLARITY_TOGGLE;
|
||||||
|
switch (m_gpio_cfg[pin].pull) {
|
||||||
|
case PullUp:
|
||||||
|
cfg.pull = NRF_GPIO_PIN_PULLUP;
|
||||||
|
break;
|
||||||
|
case PullDown:
|
||||||
|
cfg.pull = NRF_GPIO_PIN_PULLDOWN;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
cfg.pull = NRF_GPIO_PIN_NOPULL;
|
||||||
|
break;
|
||||||
|
}
|
||||||
if (m_gpio_cfg[pin].used_as_irq) {
|
if (m_gpio_cfg[pin].used_as_irq) {
|
||||||
cfg.pull = NRF_GPIO_PIN_PULLUP;
|
|
||||||
nrf_drv_gpiote_in_init(pin, &cfg, gpiote_irq_handler);
|
nrf_drv_gpiote_in_init(pin, &cfg, gpiote_irq_handler);
|
||||||
if ((m_gpio_irq_enabled & ((gpio_mask_t)1 << pin))
|
if ((m_gpio_irq_enabled & ((gpio_mask_t)1 << pin))
|
||||||
&& (m_gpio_cfg[pin].irq_rise || m_gpio_cfg[pin].irq_fall))
|
&& (m_gpio_cfg[pin].irq_rise || m_gpio_cfg[pin].irq_fall)) {
|
||||||
{
|
|
||||||
nrf_drv_gpiote_in_event_enable(pin, true);
|
nrf_drv_gpiote_in_event_enable(pin, true);
|
||||||
}
|
}
|
||||||
|
} else {
|
||||||
|
nrf_gpio_cfg_input(pin, cfg.pull);
|
||||||
}
|
}
|
||||||
else {
|
} else {
|
||||||
switch(m_gpio_cfg[pin].pull) {
|
|
||||||
case PullUp:
|
|
||||||
cfg.pull = NRF_GPIO_PIN_PULLUP;
|
|
||||||
break;
|
|
||||||
case PullDown:
|
|
||||||
cfg.pull = NRF_GPIO_PIN_PULLDOWN;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
cfg.pull = NRF_GPIO_PIN_NOPULL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
nrf_gpio_cfg_input(pin,cfg.pull);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
// Configure as output.
|
// Configure as output.
|
||||||
nrf_drv_gpiote_out_config_t cfg = GPIOTE_CONFIG_OUT_SIMPLE(nrf_gpio_pin_out_read(pin));
|
nrf_drv_gpiote_out_config_t cfg = GPIOTE_CONFIG_OUT_SIMPLE(nrf_gpio_pin_out_read(pin));
|
||||||
nrf_drv_gpiote_out_init(pin, &cfg);
|
nrf_drv_gpiote_out_init(pin, &cfg);
|
||||||
}
|
}
|
||||||
m_gpio_initialized |= ((gpio_mask_t)1UL << pin);
|
m_gpio_initialized |= ((gpio_mask_t)1UL << pin);
|
||||||
}
|
} else {
|
||||||
else {
|
|
||||||
m_gpio_initialized &= ~((gpio_mask_t)1UL << pin);
|
m_gpio_initialized &= ~((gpio_mask_t)1UL << pin);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -169,9 +163,9 @@ static void gpio_apply_config(uint8_t pin)
|
||||||
void gpio_mode(gpio_t *obj, PinMode mode)
|
void gpio_mode(gpio_t *obj, PinMode mode)
|
||||||
{
|
{
|
||||||
MBED_ASSERT(obj->pin != (PinName)NC);
|
MBED_ASSERT(obj->pin != (PinName)NC);
|
||||||
|
|
||||||
gpiote_pin_uninit(obj->pin); // try to uninitialize gpio before a change.
|
gpiote_pin_uninit(obj->pin); // try to uninitialize gpio before a change.
|
||||||
|
|
||||||
m_gpio_cfg[obj->pin].pull = mode;
|
m_gpio_cfg[obj->pin].pull = mode;
|
||||||
gpio_apply_config(obj->pin);
|
gpio_apply_config(obj->pin);
|
||||||
}
|
}
|
||||||
|
@ -180,9 +174,9 @@ void gpio_mode(gpio_t *obj, PinMode mode)
|
||||||
void gpio_dir(gpio_t *obj, PinDirection direction)
|
void gpio_dir(gpio_t *obj, PinDirection direction)
|
||||||
{
|
{
|
||||||
MBED_ASSERT(obj->pin != (PinName)NC);
|
MBED_ASSERT(obj->pin != (PinName)NC);
|
||||||
|
|
||||||
gpiote_pin_uninit(obj->pin); // try to uninitialize gpio before a change.
|
gpiote_pin_uninit(obj->pin); // try to uninitialize gpio before a change.
|
||||||
|
|
||||||
m_gpio_cfg[obj->pin].direction = direction;
|
m_gpio_cfg[obj->pin].direction = direction;
|
||||||
gpio_apply_config(obj->pin);
|
gpio_apply_config(obj->pin);
|
||||||
}
|
}
|
||||||
|
@ -201,8 +195,9 @@ int gpio_irq_init(gpio_irq_t *obj, PinName pin, gpio_irq_handler handler, uint32
|
||||||
(void) nrf_drv_gpiote_init();
|
(void) nrf_drv_gpiote_init();
|
||||||
|
|
||||||
gpiote_pin_uninit(pin); // try to uninitialize gpio before a change.
|
gpiote_pin_uninit(pin); // try to uninitialize gpio before a change.
|
||||||
|
|
||||||
m_gpio_cfg[pin].used_as_irq = true;
|
m_gpio_cfg[pin].used_as_irq = true;
|
||||||
|
m_gpio_cfg[pin].pull = PullNone;
|
||||||
m_channel_ids[pin] = id;
|
m_channel_ids[pin] = id;
|
||||||
obj->ch = pin;
|
obj->ch = pin;
|
||||||
m_irq_handler = handler;
|
m_irq_handler = handler;
|
||||||
|
@ -225,15 +220,14 @@ void gpio_irq_free(gpio_irq_t *obj)
|
||||||
|
|
||||||
void gpio_irq_set(gpio_irq_t *obj, gpio_irq_event event, uint32_t enable)
|
void gpio_irq_set(gpio_irq_t *obj, gpio_irq_event event, uint32_t enable)
|
||||||
{
|
{
|
||||||
gpio_cfg_t* cfg = &m_gpio_cfg[obj->ch];
|
gpio_cfg_t *cfg = &m_gpio_cfg[obj->ch];
|
||||||
bool irq_enabled_before =
|
bool irq_enabled_before =
|
||||||
(m_gpio_irq_enabled & ((gpio_mask_t)1 << obj->ch)) &&
|
(m_gpio_irq_enabled & ((gpio_mask_t)1 << obj->ch)) &&
|
||||||
(cfg->irq_rise || cfg->irq_fall);
|
(cfg->irq_rise || cfg->irq_fall);
|
||||||
|
|
||||||
if (event == IRQ_RISE) {
|
if (event == IRQ_RISE) {
|
||||||
cfg->irq_rise = enable ? true : false;
|
cfg->irq_rise = enable ? true : false;
|
||||||
}
|
} else if (event == IRQ_FALL) {
|
||||||
else if (event == IRQ_FALL) {
|
|
||||||
cfg->irq_fall = enable ? true : false;
|
cfg->irq_fall = enable ? true : false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue