/* * Copyright (C) EdgeTX * * Based on code named * opentx - https://github.com/opentx/opentx * th9x - http://code.google.com/p/th9x * er9x - http://code.google.com/p/er9x * gruvin9x - http://code.google.com/p/gruvin9x * * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include "stm32_hal_ll.h" #include "stm32_exti_driver.h" #include "hal.h" #define _EXTI_HANDLERS(irq_name) _handlers_ ## irq_name #define _PR_MASK(first, last) (((1 << (last - first + 1))-1)) #define _DEFINE_EXTI_IRQ_HANDLER(irq_name, first, last) \ static stm32_exti_handler_t _EXTI_HANDLERS(irq_name) [last - first + 1] = { 0 }; \ extern "C" void irq_name ## Handler() \ { \ /* Read Pending register */ \ /* (shifted by start line) */ \ uint32_t pr = LL_EXTI_ReadReg(PR) >> first; \ pr &= _PR_MASK(first,last); \ while (pr) { \ uint32_t i = POSITION_VAL(pr); \ /* Clear Pending Flag */ \ LL_EXTI_ClearFlag_0_31(1 << (first + i)); \ pr &= ~(1 << i); \ /* ... and trigger handler */ \ stm32_exti_handler_t h_fct = _EXTI_HANDLERS(irq_name) [i]; \ if (h_fct) h_fct(); \ } \ } #define _SET_EXTI_IRQ_HANDLER(irq_name, first, last, line_pos, cb) \ if (line_pos >= first && line_pos <= last) { \ _EXTI_HANDLERS(irq_name)[line_pos - first] = cb; \ NVIC_SetPriority(irq_name ## n, irq_name ## _Priority); \ NVIC_EnableIRQ(irq_name ## n); \ return; \ } #define _CLEAR_EXTI_IRQ_HANDLER(irq_name, first, last, line_pos) \ if (line_pos >= first && line_pos <= last) { \ _EXTI_HANDLERS(irq_name)[line_pos - first] = nullptr; \ if (!_has_handler(_EXTI_HANDLERS(irq_name), last - first + 1)) { \ NVIC_DisableIRQ(irq_name ## n); \ } \ return; \ } #if defined(USE_EXTI1_IRQ) _DEFINE_EXTI_IRQ_HANDLER(EXTI1_IRQ, 1, 1); #endif #if defined(USE_EXTI2_IRQ) _DEFINE_EXTI_IRQ_HANDLER(EXTI2_IRQ, 2, 2); #endif #if defined(USE_EXTI3_IRQ) _DEFINE_EXTI_IRQ_HANDLER(EXTI3_IRQ, 3, 3); #endif #if defined(USE_EXTI4_IRQ) _DEFINE_EXTI_IRQ_HANDLER(EXTI4_IRQ, 4, 4); #endif #if defined(USE_EXTI9_5_IRQ) _DEFINE_EXTI_IRQ_HANDLER(EXTI9_5_IRQ, 5, 9); #endif #if defined(USE_EXTI15_10_IRQ) _DEFINE_EXTI_IRQ_HANDLER(EXTI15_10_IRQ, 10, 15); #endif static bool _has_handler(stm32_exti_handler_t* _handlers, uint8_t len) { for (uint8_t i = 0; i < len; i++) if (_handlers[i]) return true; return false; } void stm32_exti_enable(uint32_t line, uint8_t trigger, stm32_exti_handler_t cb) { if (line > LL_EXTI_LINE_15) return; LL_EXTI_InitTypeDef EXTI_init; LL_EXTI_StructInit(&EXTI_init); EXTI_init.Line_0_31 = line; EXTI_init.Mode = LL_EXTI_MODE_IT; EXTI_init.Trigger = trigger; EXTI_init.LineCommand = ENABLE; LL_EXTI_Init(&EXTI_init); uint32_t line_pos = POSITION_VAL(line); #if defined(USE_EXTI1_IRQ) _SET_EXTI_IRQ_HANDLER(EXTI1_IRQ, 1, 1, line_pos, cb); #endif #if defined(USE_EXTI2_IRQ) _SET_EXTI_IRQ_HANDLER(EXTI2_IRQ, 2, 2, line_pos, cb); #endif #if defined(USE_EXTI3_IRQ) _SET_EXTI_IRQ_HANDLER(EXTI3_IRQ, 3, 3, line_pos, cb); #endif #if defined(USE_EXTI4_IRQ) _SET_EXTI_IRQ_HANDLER(EXTI4_IRQ, 4, 4, line_pos, cb); #endif #if defined(USE_EXTI9_5_IRQ) _SET_EXTI_IRQ_HANDLER(EXTI9_5_IRQ, 5, 9, line_pos, cb); #endif #if defined(USE_EXTI15_10_IRQ) _SET_EXTI_IRQ_HANDLER(EXTI15_10_IRQ, 10, 15, line_pos, cb); #endif } void stm32_exti_disable(uint32_t line) { uint32_t line_pos = POSITION_VAL(line); #if defined(USE_EXTI1_IRQ) _CLEAR_EXTI_IRQ_HANDLER(EXTI1_IRQ, 1, 1, line_pos); #endif #if defined(USE_EXTI2_IRQ) _CLEAR_EXTI_IRQ_HANDLER(EXTI2_IRQ, 2, 2, line_pos); #endif #if defined(USE_EXTI3_IRQ) _CLEAR_EXTI_IRQ_HANDLER(EXTI3_IRQ, 3, 3, line_pos); #endif #if defined(USE_EXTI4_IRQ) _CLEAR_EXTI_IRQ_HANDLER(EXTI4_IRQ, 4, 4, line_pos); #endif #if defined(USE_EXTI9_5_IRQ) _CLEAR_EXTI_IRQ_HANDLER(EXTI9_5_IRQ, 5, 9, line_pos); #endif #if defined(USE_EXTI15_10_IRQ) _CLEAR_EXTI_IRQ_HANDLER(EXTI15_10_IRQ, 10, 15, line_pos); #endif LL_EXTI_DisableIT_0_31(line); }