133 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			133 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| #include "record.h"
 | |
| #include "check.h"
 | |
| #include "memmgr.h"
 | |
| 
 | |
| #include <cmsis_os2.h>
 | |
| #include <m-string.h>
 | |
| #include <m-dict.h>
 | |
| 
 | |
| #define FURI_RECORD_FLAG_UPDATED 0x00000001U
 | |
| 
 | |
| DICT_SET_DEF(osThreadIdSet, uint32_t)
 | |
| 
 | |
| typedef struct {
 | |
|     void* data;
 | |
|     osThreadId_t owner;
 | |
|     osThreadIdSet_t holders;
 | |
| } FuriRecord;
 | |
| 
 | |
| DICT_DEF2(FuriRecordDict, string_t, STRING_OPLIST, FuriRecord, M_POD_OPLIST)
 | |
| 
 | |
| typedef struct {
 | |
|     osMutexId_t records_mutex;
 | |
|     FuriRecordDict_t records;
 | |
| } FuriRecordData;
 | |
| 
 | |
| static FuriRecordData* furi_record_data = NULL;
 | |
| 
 | |
| void furi_record_init() {
 | |
|     furi_record_data = furi_alloc(sizeof(FuriRecordData));
 | |
|     furi_record_data->records_mutex = osMutexNew(NULL);
 | |
|     furi_check(furi_record_data->records_mutex);
 | |
|     FuriRecordDict_init(furi_record_data->records);
 | |
| }
 | |
| 
 | |
| FuriRecord* furi_record_get_or_create(string_t name_str) {
 | |
|     furi_assert(furi_record_data);
 | |
|     FuriRecord* record = FuriRecordDict_get(furi_record_data->records, name_str);
 | |
|     if(!record) {
 | |
|         FuriRecord new_record;
 | |
|         new_record.data = NULL;
 | |
|         new_record.owner = NULL;
 | |
|         osThreadIdSet_init(new_record.holders);
 | |
|         FuriRecordDict_set_at(furi_record_data->records, name_str, new_record);
 | |
|         record = FuriRecordDict_get(furi_record_data->records, name_str);
 | |
|     }
 | |
|     return record;
 | |
| }
 | |
| 
 | |
| void furi_record_create(const char* name, void* data) {
 | |
|     furi_assert(furi_record_data);
 | |
|     osThreadId_t thread_id = osThreadGetId();
 | |
| 
 | |
|     string_t name_str;
 | |
|     string_init_set_str(name_str, name);
 | |
| 
 | |
|     // Acquire mutex
 | |
|     furi_check(osMutexAcquire(furi_record_data->records_mutex, osWaitForever) == osOK);
 | |
|     FuriRecord* record = furi_record_get_or_create(name_str);
 | |
|     record->data = data;
 | |
|     record->owner = thread_id;
 | |
| 
 | |
|     // For each holder set event flag
 | |
|     osThreadIdSet_it_t it;
 | |
|     for(osThreadIdSet_it(it, record->holders); !osThreadIdSet_end_p(it); osThreadIdSet_next(it)) {
 | |
|         osThreadFlagsSet((osThreadId_t)*osThreadIdSet_ref(it), FURI_RECORD_FLAG_UPDATED);
 | |
|     }
 | |
|     // Release mutex
 | |
|     furi_check(osMutexRelease(furi_record_data->records_mutex) == osOK);
 | |
| 
 | |
|     string_clear(name_str);
 | |
| }
 | |
| 
 | |
| bool furi_record_destroy(const char* name) {
 | |
|     furi_assert(furi_record_data);
 | |
|     osThreadId_t thread_id = osThreadGetId();
 | |
| 
 | |
|     string_t name_str;
 | |
|     string_init_set_str(name_str, name);
 | |
| 
 | |
|     bool destroyed = false;
 | |
|     furi_check(osMutexAcquire(furi_record_data->records_mutex, osWaitForever) == osOK);
 | |
|     FuriRecord* record = FuriRecordDict_get(furi_record_data->records, name_str);
 | |
|     if(record && record->owner == thread_id && osThreadIdSet_size(record->holders) == 0) {
 | |
|         osThreadIdSet_clear(record->holders);
 | |
|         FuriRecordDict_erase(furi_record_data->records, name_str);
 | |
|         destroyed = true;
 | |
|     }
 | |
|     furi_check(osMutexRelease(furi_record_data->records_mutex) == osOK);
 | |
| 
 | |
|     string_clear(name_str);
 | |
|     return destroyed;
 | |
| }
 | |
| 
 | |
| void* furi_record_open(const char* name) {
 | |
|     furi_assert(furi_record_data);
 | |
|     osThreadId_t thread_id = osThreadGetId();
 | |
| 
 | |
|     string_t name_str;
 | |
|     string_init_set_str(name_str, name);
 | |
| 
 | |
|     FuriRecord* record = NULL;
 | |
|     while(1) {
 | |
|         furi_check(osMutexAcquire(furi_record_data->records_mutex, osWaitForever) == osOK);
 | |
|         record = furi_record_get_or_create(name_str);
 | |
|         osThreadIdSet_push(record->holders, (uint32_t)thread_id);
 | |
|         furi_check(osMutexRelease(furi_record_data->records_mutex) == osOK);
 | |
|         // Check if owner is already arrived
 | |
|         if(record->owner) {
 | |
|             break;
 | |
|         }
 | |
|         // Wait for thread flag to appear
 | |
|         osThreadFlagsWait(FURI_RECORD_FLAG_UPDATED, osFlagsWaitAny, osWaitForever);
 | |
|     }
 | |
| 
 | |
|     string_clear(name_str);
 | |
|     return record->data;
 | |
| }
 | |
| 
 | |
| void furi_record_close(const char* name) {
 | |
|     furi_assert(furi_record_data);
 | |
|     osThreadId_t thread_id = osThreadGetId();
 | |
| 
 | |
|     string_t name_str;
 | |
|     string_init_set_str(name_str, name);
 | |
| 
 | |
|     furi_check(osMutexAcquire(furi_record_data->records_mutex, osWaitForever) == osOK);
 | |
|     FuriRecord* record = FuriRecordDict_get(furi_record_data->records, name_str);
 | |
|     osThreadIdSet_erase(record->holders, (uint32_t)thread_id);
 | |
|     furi_check(osMutexRelease(furi_record_data->records_mutex) == osOK);
 | |
| 
 | |
|     string_clear(name_str);
 | |
| }
 | 
