Mirrors/unleashed-firmware
2
0
Fork 0
mirror of https://github.com/DarkFlippers/unleashed-firmware synced 2024-11-26 22:40:25 +00:00
Code Issues Projects Releases Packages Wiki Activity

[FL-1274] Interrupt manager: cleaned version (#490)

Browse source 
* HAL interrupl manager: cleaned version
* HAL interrupt manager: mem barriers
* HAL interrupt manager: volatile interrupt list

Co-authored-by: あく <alleteam@gmail.com>
This commit is contained in:
SG 2021-05-25 20:56:27 +10:00 committed by GitHub
parent 84f46e670a
commit f49f30f8a7
No known key found for this signature in database
GPG key ID: 4AEE18F83AFDEB23
4 changed files with 36 additions and 105 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

128
core/api-hal/api-interrupt-mgr.c
View file

@ -1,123 +1,65 @@
#include "api-interrupt-mgr.h"
#include "mlib/m-dict.h"
#include <m-list.h>
#include <cmsis_os2.h>
#include <furi.h>
LIST_DEF(list_interrupt, InterruptCallbackItem, M_POD_OPLIST);
DICT_DEF2(dict_interrupt, uint32_t, M_DEFAULT_OPLIST, list_interrupt_t, M_A1_OPLIST);
dict_interrupt_t interrupts_dict;
osMutexId_t interrupt_mutex;
static volatile InterruptCallbackItem callback_list[InterruptTypeLast];
bool api_interrupt_init() {
dict_interrupt_init(interrupts_dict);
interrupt_mutex = osMutexNew(NULL);
return (interrupt_mutex != NULL);
for(uint8_t i = 0; i < InterruptTypeLast; i++) {
callback_list[i].callback = NULL;
callback_list[i].context = NULL;
callback_list[i].ready = false;
}
return true;
}
void api_interrupt_add(InterruptCallback callback, InterruptType type, void* context) {
if(osMutexAcquire(interrupt_mutex, osWaitForever) == osOK) {
list_interrupt_t* list = dict_interrupt_get(interrupts_dict, (uint32_t)type);
furi_assert(type < InterruptTypeLast);
furi_check(callback_list[type].callback == NULL);
if(list == NULL) {
list_interrupt_t new_list;
list_interrupt_init(new_list);
dict_interrupt_set_at(interrupts_dict, (uint32_t)type, new_list);
list = dict_interrupt_get(interrupts_dict, (uint32_t)type);
}
// put uninitialized item to the list
// M_POD_OPLIST provide memset(&(a), 0, sizeof (a)) constructor
// so item will not be ready until we set ready flag
InterruptCallbackItem* item = list_interrupt_push_new(*list);
// initialize item
item->callback = callback;
item->type = type;
item->context = context;
asm volatile("dmb" : : : "memory");
item->ready = true;
osMutexRelease(interrupt_mutex);
}
callback_list[type].callback = callback;
callback_list[type].context = context;
__DMB();
callback_list[type].ready = true;
}
void api_interrupt_remove(InterruptCallback callback, InterruptType type) {
if(osMutexAcquire(interrupt_mutex, osWaitForever) == osOK) {
list_interrupt_t* list = dict_interrupt_get(interrupts_dict, (uint32_t)type);
if(list != NULL) {
// iterate over items
list_interrupt_it_t it;
list_interrupt_it(it, *list);
while(!list_interrupt_end_p(it)) {
if(it->current->data.callback == callback) {
list_interrupt_remove(*list, it);
} else {
list_interrupt_next(it);
}
}
}
osMutexRelease(interrupt_mutex);
furi_assert(type < InterruptTypeLast);
if(callback_list[type].callback != NULL) {
furi_check(callback_list[type].callback == callback);
}
callback_list[type].ready = false;
__DMB();
callback_list[type].callback = NULL;
callback_list[type].context = NULL;
}
void api_interrupt_enable(InterruptCallback callback, InterruptType type) {
if(osMutexAcquire(interrupt_mutex, osWaitForever) == osOK) {
list_interrupt_t* list = dict_interrupt_get(interrupts_dict, (uint32_t)type);
furi_assert(type < InterruptTypeLast);
furi_check(callback_list[type].callback == callback);
if(list != NULL) {
// iterate over items
list_interrupt_it_t it;
for(list_interrupt_it(it, *list); !list_interrupt_end_p(it); list_interrupt_next(it)) {
// if the iterator is equal to our element
if(it->current->data.callback == callback) {
it->current->data.ready = true;
asm volatile("dmb" : : : "memory");
}
}
}
osMutexRelease(interrupt_mutex);
}
callback_list[type].ready = true;
__DMB();
}
void api_interrupt_disable(InterruptCallback callback, InterruptType type) {
if(osMutexAcquire(interrupt_mutex, osWaitForever) == osOK) {
list_interrupt_t* list = dict_interrupt_get(interrupts_dict, (uint32_t)type);
furi_assert(type < InterruptTypeLast);
furi_check(callback_list[type].callback == callback);
if(list != NULL) {
// iterate over items
list_interrupt_it_t it;
for(list_interrupt_it(it, *list); !list_interrupt_end_p(it); list_interrupt_next(it)) {
// if the iterator is equal to our element
if(it->current->data.callback == callback) {
it->current->data.ready = false;
asm volatile("dmb" : : : "memory");
}
}
}
osMutexRelease(interrupt_mutex);
}
callback_list[type].ready = false;
__DMB();
}
void api_interrupt_call(InterruptType type, void* hw) {
// that executed in interrupt ctx so mutex don't needed
// but we need to check ready flag
furi_assert(type < InterruptTypeLast);
list_interrupt_t* list = dict_interrupt_get(interrupts_dict, (uint32_t)type);
if(list != NULL) {
// iterate over items
list_interrupt_it_t it;
for(list_interrupt_it(it, *list); !list_interrupt_end_p(it); list_interrupt_next(it)) {
// if the iterator is equal to our element
if(it->current->data.ready) {
it->current->data.callback(hw, it->current->data.context);
}
if(callback_list[type].callback != NULL) {
if(callback_list[type].ready) {
callback_list[type].callback(hw, callback_list[type].context);
}
}
}

3
core/api-hal/api-interrupt-mgr.h
View file

@ -12,14 +12,13 @@ typedef void (*InterruptCallback)(void*, void*);
/** Interupt type */
typedef enum {
InterruptTypeComparatorTrigger,
InterruptTypeTimerOutputCompare,
InterruptTypeTimerUpdate,
InterruptTypeLast,
} InterruptType;
/** Interrupt callback type */
typedef struct {
InterruptCallback callback;
InterruptType type;
void* context;
bool ready;
} InterruptCallbackItem;

5
firmware/targets/f5/api-hal/api-interrupts.c
View file

@ -10,11 +10,6 @@ void HAL_COMP_TriggerCallback(COMP_HandleTypeDef* hcomp) {
api_interrupt_call(InterruptTypeComparatorTrigger, hcomp);
}
/* Output compare event */
void HAL_TIM_OC_DelayElapsedCallback(TIM_HandleTypeDef* htim) {
api_interrupt_call(InterruptTypeTimerOutputCompare, htim);
}
/* Timer update event */
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef* htim) {
api_interrupt_call(InterruptTypeTimerUpdate, htim);

5
firmware/targets/f6/api-hal/api-interrupts.c
View file

@ -10,11 +10,6 @@ void HAL_COMP_TriggerCallback(COMP_HandleTypeDef* hcomp) {
api_interrupt_call(InterruptTypeComparatorTrigger, hcomp);
}
/* Output compare event */
void HAL_TIM_OC_DelayElapsedCallback(TIM_HandleTypeDef* htim) {
api_interrupt_call(InterruptTypeTimerOutputCompare, htim);
}
/* Timer update event */
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef* htim) {
api_interrupt_call(InterruptTypeTimerUpdate, htim);