diff --git a/Core/Src/Components/GPIO_Pin.hpp b/Core/Src/Components/GPIO_Pin.hpp index 9d0dc45..a17affc 100644 --- a/Core/Src/Components/GPIO_Pin.hpp +++ b/Core/Src/Components/GPIO_Pin.hpp @@ -9,8 +9,9 @@ #define SRC_COMPONENTS_GPIO_PIN_HPP_ #include +#include "Interruptible.hpp" -class GPIO_Pin { +class GPIO_Pin : public InterruptReason { public: virtual int32_t init() = 0; virtual int32_t read(uint8_t* state) = 0; @@ -18,6 +19,10 @@ public: virtual int32_t set() = 0; virtual int32_t reset() = 0; virtual int32_t toggle() = 0; + virtual int32_t registerExtiCallback(Interruptible* object) = 0; + virtual int32_t deregisterExtiCallback() = 0; +protected: + Interruptible* irqObject = nullptr; }; #endif /* SRC_COMPONENTS_GPIO_PIN_HPP_ */ diff --git a/Core/Src/Components/GPIO_Pin_STM32.cpp b/Core/Src/Components/GPIO_Pin_STM32.cpp index 76188ec..1a36c87 100644 --- a/Core/Src/Components/GPIO_Pin_STM32.cpp +++ b/Core/Src/Components/GPIO_Pin_STM32.cpp @@ -6,9 +6,14 @@ */ #include "GPIO_Pin_STM32.hpp" +#include -GPIO_Pin_STM32::GPIO_Pin_STM32(GPIO_TypeDef *gpio_port, uint16_t gpio_pin) : - gpio_port(gpio_port), gpio_pin(gpio_pin){ +void HAL_GPIO_EXTI_Callback(uint16_t GPIO_Pin){ + GPIO_Pin_STM32::extiDispatch(GPIO_Pin); +} + +GPIO_Pin_STM32::GPIO_Pin_STM32(GPIO_TypeDef *gpio_port, uint16_t gpio_pin) : gpio_port(gpio_port), gpio_pin(gpio_pin) { + pinNumber = gpioPinToPinNumber(gpio_pin); } GPIO_Pin_STM32::~GPIO_Pin_STM32() { @@ -51,3 +56,73 @@ GPIO_TypeDef* GPIO_Pin_STM32::getPort() { uint16_t GPIO_Pin_STM32::getPin() { return gpio_pin; } + +void GPIO_Pin_STM32::extiDispatch(uint16_t GPIO_Pin){ + // TODO Protect array with mutex + GPIO_Pin_STM32* object = pinObjects[gpioPinToPinNumber(GPIO_Pin)]; + if(!object){ + printf("EXTI called for uninitialized GPIO_Pin_STM32 %u\n", gpioPinToPinNumber(GPIO_Pin)); + return; + } + if(!object->irqObject){ + printf("EXTI called for GPIO_Pin_STM32 %u without callback registered\n", object->pinNumber); + return; + } + object->irqObject->irqHandler(object); +} + +int32_t GPIO_Pin_STM32::registerExtiCallback(Interruptible* object){ + if(pinObjects[pinNumber] || irqObject){ + // Already registered + return -1; + } + pinObjects[pinNumber] = this; + irqObject = object; + return 0; +} + +int32_t GPIO_Pin_STM32::deregisterExtiCallback(){ + pinObjects[pinNumber] = nullptr; + irqObject = nullptr; + return 0; +} + +int8_t GPIO_Pin_STM32::gpioPinToPinNumber(uint16_t GPIO_Pin) { + assert_param(IS_GPIO_PIN(GPIO_Pin)); + switch(GPIO_Pin){ + case GPIO_PIN_0: + return 0; + case GPIO_PIN_1: + return 1; + case GPIO_PIN_2: + return 2; + case GPIO_PIN_3: + return 3; + case GPIO_PIN_4: + return 4; + case GPIO_PIN_5: + return 5; + case GPIO_PIN_6: + return 6; + case GPIO_PIN_7: + return 7; + case GPIO_PIN_8: + return 8; + case GPIO_PIN_9: + return 9; + case GPIO_PIN_10: + return 10; + case GPIO_PIN_11: + return 11; + case GPIO_PIN_12: + return 12; + case GPIO_PIN_13: + return 13; + case GPIO_PIN_14: + return 14; + case GPIO_PIN_15: + return 15; + } + // TODO implement error handling here + return -1; +} diff --git a/Core/Src/Components/GPIO_Pin_STM32.hpp b/Core/Src/Components/GPIO_Pin_STM32.hpp index 3492618..8740443 100644 --- a/Core/Src/Components/GPIO_Pin_STM32.hpp +++ b/Core/Src/Components/GPIO_Pin_STM32.hpp @@ -15,17 +15,23 @@ class GPIO_Pin_STM32 : public GPIO_Pin { public: GPIO_Pin_STM32(GPIO_TypeDef* gpio_port, uint16_t gpio_pin); virtual ~GPIO_Pin_STM32(); + static void extiDispatch(uint16_t GPIO_Pin); int32_t init(); int32_t read(uint8_t* state); int32_t write(uint8_t state); int32_t set(); int32_t reset(); int32_t toggle(); + int32_t registerExtiCallback(Interruptible* object); + int32_t deregisterExtiCallback(); GPIO_TypeDef* getPort(); uint16_t getPin(); private: + static int8_t gpioPinToPinNumber(uint16_t GPIO_Pin); + static inline GPIO_Pin_STM32* pinObjects[16]; GPIO_TypeDef* gpio_port; uint16_t gpio_pin; + int8_t pinNumber = -1; }; #endif /* SRC_COMPONENTS_GPIO_PIN_STM32_HPP_ */