gpio.cpp

Go to the documentation of this file.

#ifdef USE_ZEPHYR
#include "gpio.h"
#include "esphome/core/hal.h"
#include <zephyr/drivers/gpio.h>
#include <zephyr/sys/util.h>
#include "esphome/core/log.h"
 
namespace esphome {
namespace zephyr {
 
ESPHOME_LOG_TAG(TAG, "zephyr");
 
static gpio_flags_t flags_to_mode(gpio::Flags flags, bool inverted, bool value) {
  gpio_flags_t ret = 0;
  if (flags & gpio::FLAG_INPUT) {
    ret |= GPIO_INPUT;
  }
  if (flags & gpio::FLAG_OUTPUT) {
    ret |= GPIO_OUTPUT;
    if (value != inverted) {
      ret |= GPIO_OUTPUT_INIT_HIGH;
    } else {
      ret |= GPIO_OUTPUT_INIT_LOW;
    }
  }
  if (flags & gpio::FLAG_PULLUP) {
    ret |= GPIO_PULL_UP;
  }
  if (flags & gpio::FLAG_PULLDOWN) {
    ret |= GPIO_PULL_DOWN;
  }
  if (flags & gpio::FLAG_OPEN_DRAIN) {
    ret |= GPIO_OPEN_DRAIN;
  }
  return ret;
}
 
// ESPHome's InterruptType is expressed in logical levels, but the pin is configured active-high in Zephyr (inversion is
// applied in software by digital_read()/digital_write(), see the `!= inverted_` convention below). So when the pin is
// inverted we must swap the physical edge/level the interrupt arms on: a logical rising edge is a physical falling
// edge, etc. GPIO_INT_EDGE_BOTH is symmetric and needs no swap.
static gpio_flags_t interrupt_type_to_flags(gpio::InterruptType type, bool inverted) {
  switch (type) {
    case gpio::INTERRUPT_RISING_EDGE:
      return inverted ? GPIO_INT_EDGE_FALLING : GPIO_INT_EDGE_RISING;
    case gpio::INTERRUPT_FALLING_EDGE:
      return inverted ? GPIO_INT_EDGE_RISING : GPIO_INT_EDGE_FALLING;
    case gpio::INTERRUPT_ANY_EDGE:
      return GPIO_INT_EDGE_BOTH;
    case gpio::INTERRUPT_LOW_LEVEL:
      return inverted ? GPIO_INT_LEVEL_HIGH : GPIO_INT_LEVEL_LOW;
    case gpio::INTERRUPT_HIGH_LEVEL:
      return inverted ? GPIO_INT_LEVEL_LOW : GPIO_INT_LEVEL_HIGH;
  }
  return inverted ? GPIO_INT_EDGE_FALLING : GPIO_INT_EDGE_RISING;
}
 
// Zephyr calls this with a pointer to the gpio_callback the interrupt fired on.
// Recover the owning ZephyrGPIOInterrupt and dispatch to the ESPHome ISR.
static void gpio_interrupt_handler(const device * /*dev*/, gpio_callback *cb, uint32_t /*pins*/) {
  auto *interrupt = CONTAINER_OF(cb, ZephyrGPIOInterrupt, callback);
  if (interrupt->func != nullptr) {
    interrupt->func(interrupt->arg);
  }
}
 
struct ISRPinArg {
  const device *gpio;
  uint8_t pin;
  uint8_t gpio_size;
  bool inverted;
};
 
ISRInternalGPIOPin ZephyrGPIOPin::to_isr() const {
  auto *arg = new ISRPinArg{};  // NOLINT(cppcoreguidelines-owning-memory)
  arg->gpio = this->gpio_;
  arg->pin = this->pin_;
  arg->gpio_size = this->gpio_size_;
  arg->inverted = this->inverted_;
  return ISRInternalGPIOPin((void *) arg);
}
 
void ZephyrGPIOPin::attach_interrupt_(void (*func)(void *), void *arg, gpio::InterruptType type) const {
  if (!device_is_ready(this->gpio_)) {
    ESP_LOGE(TAG, "Cannot attach interrupt: GPIO device not ready");
    return;
  }
 
  // Drop any interrupt previously attached to this pin before re-registering.
  this->detach_interrupt();
 
  this->interrupt_.func = func;
  this->interrupt_.arg = arg;
 
  uint8_t port_pin = this->pin_ % this->gpio_size_;
  gpio_init_callback(&this->interrupt_.callback, gpio_interrupt_handler, BIT(port_pin));
 
  int ret = gpio_add_callback(this->gpio_, &this->interrupt_.callback);
  if (ret != 0) {
    ESP_LOGE(TAG, "gpio_add_callback failed for pin %u: %d", this->pin_, ret);
    return;
  }
 
  ret = gpio_pin_interrupt_configure(this->gpio_, port_pin, interrupt_type_to_flags(type, this->inverted_));
  if (ret != 0) {
    ESP_LOGE(TAG, "gpio_pin_interrupt_configure failed for pin %u: %d", this->pin_, ret);
    gpio_remove_callback(this->gpio_, &this->interrupt_.callback);
    return;
  }
 
  ESP_LOGD(TAG, "Interrupt attached to pin %u (type=%d)", this->pin_, (int) type);
}
 
void ZephyrGPIOPin::setup() {
  if (!device_is_ready(this->gpio_)) {
    ESP_LOGE(TAG, "gpio %u is not ready.", this->pin_);
    return;
  }
  this->pin_mode(this->flags_);
}
 
void ZephyrGPIOPin::pin_mode(gpio::Flags flags) {
  if (nullptr == this->gpio_) {
    return;
  }
  auto ret = gpio_pin_configure(this->gpio_, this->pin_ % this->gpio_size_,
                                flags_to_mode(flags, this->inverted_, this->value_));
  if (ret != 0) {
    ESP_LOGE(TAG, "gpio %u cannot be configured %d.", this->pin_, ret);
  }
}
 
size_t ZephyrGPIOPin::dump_summary(char *buffer, size_t len) const {
  return snprintf(buffer, len, "GPIO%u, %s%u", this->pin_, this->pin_name_prefix_, this->pin_ % this->gpio_size_);
}
 
bool ZephyrGPIOPin::digital_read() {
  if (nullptr == this->gpio_) {
    return false;
  }
  return bool(gpio_pin_get(this->gpio_, this->pin_ % this->gpio_size_) != this->inverted_);
}
 
void ZephyrGPIOPin::digital_write(bool value) {
  // make sure that value is not ignored since it can be inverted e.g. on switch side
  // that way init state should be correct
  this->value_ = value;
  if (nullptr == this->gpio_) {
    return;
  }
  gpio_pin_set(this->gpio_, this->pin_ % this->gpio_size_, value != this->inverted_ ? 1 : 0);
}
 
void ZephyrGPIOPin::detach_interrupt() const {
  if (this->gpio_ == nullptr) {
    return;
  }
 
  uint8_t port_pin = this->pin_ % this->gpio_size_;
  gpio_pin_interrupt_configure(this->gpio_, port_pin, GPIO_INT_DISABLE);
  gpio_remove_callback(this->gpio_, &this->interrupt_.callback);
 
  this->interrupt_.func = nullptr;
  this->interrupt_.arg = nullptr;
}
 
}  // namespace zephyr
 
bool IRAM_ATTR ISRInternalGPIOPin::digital_read() {
  auto *arg = (zephyr::ISRPinArg *) this->arg_;
  if (arg == nullptr || arg->gpio == nullptr) {
    return false;
  }
  return bool(gpio_pin_get(arg->gpio, arg->pin % arg->gpio_size) != arg->inverted);
}
 
void IRAM_ATTR ISRInternalGPIOPin::digital_write(bool value) {
  auto *arg = (zephyr::ISRPinArg *) this->arg_;
  if (arg == nullptr || arg->gpio == nullptr) {
    return;
  }
  gpio_pin_set(arg->gpio, arg->pin % arg->gpio_size, value != arg->inverted ? 1 : 0);
}
 
}  // namespace esphome
 
#endif