Add IRQ handling functionality to GPIO_Pin and GPIO_Pin_STM32

Core/Src/Components/GPIO_Pin.hpp

@@ -9,8 +9,9 @@
 #define SRC_COMPONENTS_GPIO_PIN_HPP_
 
 #include <inttypes.h>
+#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_ */

Core/Src/Components/GPIO_Pin_STM32.cpp

@@ -6,9 +6,14 @@
  */
 
 #include "GPIO_Pin_STM32.hpp"
+#include <cstdio>
 
-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;
+}

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_ */