stm32_gpio.cpp

#include "stm32_gpio.hpp"
 
#ifdef HAL_GPIO_MODULE_ENABLED
 
using namespace LibXR;
 
STM32GPIO* STM32GPIO::map[STM32_GPIO_EXTI_NUMBER] = {nullptr};
 
stm32_gpio_exti_t STM32_GPIO_EXTI_GetID(uint16_t pin)
{  // NOLINT
  uint8_t pin_num = __builtin_ctz(pin);
 
  if (pin == 0 || pin_num > 15)
  {
    ASSERT(false);
    return STM32_GPIO_EXTI_NUMBER;
  }
 
#if defined(STM32F0) || defined(STM32G0) || defined(STM32L0)
  if (pin_num <= 1)
  {
    return STM32_GPIO_EXTI_0_1;
  }
  else if (pin_num <= 3)
  {
    return STM32_GPIO_EXTI_2_3;
  }
  else
  {
    return STM32_GPIO_EXTI_4_15;
  }
 
#else
  if (pin_num <= 4)
  {
    return static_cast<stm32_gpio_exti_t>(pin_num);
  }
  else if (pin_num <= 9)
  {
    return STM32_GPIO_EXTI_5_9;
  }
  else
  {
    return STM32_GPIO_EXTI_10_15;
  }
 
#endif
 
  return STM32_GPIO_EXTI_NUMBER;
}
 
STM32GPIO::STM32GPIO(GPIO_TypeDef* port, uint16_t pin, IRQn_Type irq)
    : port_(port), pin_(pin), irq_(irq)
{
  if (irq_ != NonMaskableInt_IRQn)
  {
    map[STM32_GPIO_EXTI_GetID(pin)] = this;
  }
}
 
bool STM32GPIO::Read() { return HAL_GPIO_ReadPin(port_, pin_) == GPIO_PIN_SET; }
 
ErrorCode STM32GPIO::Write(bool value)
{
  HAL_GPIO_WritePin(port_, pin_, value ? GPIO_PIN_SET : GPIO_PIN_RESET);
  return ErrorCode::OK;
}
 
ErrorCode STM32GPIO::EnableInterrupt()
{
  ASSERT(irq_ != NonMaskableInt_IRQn);
  HAL_NVIC_EnableIRQ(irq_);
  return ErrorCode::OK;
}
 
ErrorCode STM32GPIO::DisableInterrupt()
{
  ASSERT(irq_ != NonMaskableInt_IRQn);
  HAL_NVIC_DisableIRQ(irq_);
  return ErrorCode::OK;
}
 
ErrorCode STM32GPIO::SetConfig(Configuration config)
{
  GPIO_InitTypeDef gpio_init = {};
 
  HAL_GPIO_DeInit(port_, pin_);
 
  gpio_init.Pin = pin_;
 
  switch (config.direction)
  {
    case Direction::INPUT:
      gpio_init.Mode = GPIO_MODE_INPUT;
      break;
    case Direction::OUTPUT_PUSH_PULL:
      gpio_init.Mode = GPIO_MODE_OUTPUT_PP;
      break;
    case Direction::OUTPUT_OPEN_DRAIN:
      gpio_init.Mode = GPIO_MODE_OUTPUT_OD;
      break;
    case Direction::FALL_INTERRUPT:
      gpio_init.Mode = GPIO_MODE_IT_FALLING;
      break;
    case Direction::RISING_INTERRUPT:
      gpio_init.Mode = GPIO_MODE_IT_RISING;
      break;
    case Direction::FALL_RISING_INTERRUPT:
      gpio_init.Mode = GPIO_MODE_IT_RISING_FALLING;
      break;
  }
 
  switch (config.pull)
  {
    case Pull::NONE:
      gpio_init.Pull = GPIO_NOPULL;
      break;
    case Pull::UP:
      gpio_init.Pull = GPIO_PULLUP;
      break;
    case Pull::DOWN:
      gpio_init.Pull = GPIO_PULLDOWN;
      break;
  }
 
  gpio_init.Speed = GPIO_SPEED_FREQ_HIGH;
 
  HAL_GPIO_Init(port_, &gpio_init);
 
  return ErrorCode::OK;
}
 
extern "C" void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin)
{
  auto id = STM32_GPIO_EXTI_GetID(GPIO_Pin);
  auto gpio = STM32GPIO::map[id];
 
  if (gpio)
  {
    gpio->callback_.Run(true);
  }
}
 
#endif