|
@@ -1,123 +1,65 @@
|
|
|
#include "api-interrupt-mgr.h"
|
|
#include "api-interrupt-mgr.h"
|
|
|
-#include "mlib/m-dict.h"
|
|
|
|
|
-
|
|
|
|
|
-#include <m-list.h>
|
|
|
|
|
#include <cmsis_os2.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() {
|
|
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) {
|
|
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);
|
|
|
|
|
-
|
|
|
|
|
- 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;
|
|
|
|
|
|
|
+ furi_assert(type < InterruptTypeLast);
|
|
|
|
|
+ furi_check(callback_list[type].callback == NULL);
|
|
|
|
|
|
|
|
- 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) {
|
|
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) {
|
|
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);
|
|
|
|
|
-
|
|
|
|
|
- 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");
|
|
|
|
|
- }
|
|
|
|
|
- }
|
|
|
|
|
- }
|
|
|
|
|
|
|
+ furi_assert(type < InterruptTypeLast);
|
|
|
|
|
+ furi_check(callback_list[type].callback == callback);
|
|
|
|
|
|
|
|
- osMutexRelease(interrupt_mutex);
|
|
|
|
|
- }
|
|
|
|
|
|
|
+ callback_list[type].ready = true;
|
|
|
|
|
+ __DMB();
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void api_interrupt_disable(InterruptCallback callback, InterruptType type) {
|
|
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);
|
|
|
|
|
-
|
|
|
|
|
- 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");
|
|
|
|
|
- }
|
|
|
|
|
- }
|
|
|
|
|
- }
|
|
|
|
|
|
|
+ furi_assert(type < InterruptTypeLast);
|
|
|
|
|
+ furi_check(callback_list[type].callback == callback);
|
|
|
|
|
|
|
|
- osMutexRelease(interrupt_mutex);
|
|
|
|
|
- }
|
|
|
|
|
|
|
+ callback_list[type].ready = false;
|
|
|
|
|
+ __DMB();
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void api_interrupt_call(InterruptType type, void* hw) {
|
|
void api_interrupt_call(InterruptType type, void* hw) {
|
|
|
// that executed in interrupt ctx so mutex don't needed
|
|
// that executed in interrupt ctx so mutex don't needed
|
|
|
// but we need to check ready flag
|
|
// 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);
|
|
|
}
|
|
}
|
|
|
}
|
|
}
|
|
|
}
|
|
}
|