e3c7201a20
* Furi: rename and move core * Furi: drop CMSIS_OS header and unused api, partially refactor and cleanup the rest * Furi: CMSIS_OS drop and refactoring. * Furi: refactoring, remove cmsis legacy * Furi: fix incorrect assert on queue deallocation, cleanup timer * Furi: improve delay api, get rid of floats * hal: dropped furi_hal_crc * Furi: move DWT based delay to cortex HAL * Furi: update core documentation Co-authored-by: hedger <hedger@nanode.su>
103 lines
2.9 KiB
C
103 lines
2.9 KiB
C
#include "stdglue.h"
|
|
#include "check.h"
|
|
#include "memmgr.h"
|
|
|
|
#include <FreeRTOS.h>
|
|
#include <task.h>
|
|
|
|
#include <furi_hal.h>
|
|
#include <m-dict.h>
|
|
|
|
DICT_DEF2(
|
|
FuriStdglueCallbackDict,
|
|
uint32_t,
|
|
M_DEFAULT_OPLIST,
|
|
FuriStdglueWriteCallback,
|
|
M_PTR_OPLIST)
|
|
|
|
typedef struct {
|
|
FuriMutex* mutex;
|
|
FuriStdglueCallbackDict_t thread_outputs;
|
|
} FuriStdglue;
|
|
|
|
static FuriStdglue* furi_stdglue = NULL;
|
|
|
|
static ssize_t stdout_write(void* _cookie, const char* data, size_t size) {
|
|
furi_assert(furi_stdglue);
|
|
bool consumed = false;
|
|
FuriThreadId task_id = furi_thread_get_current_id();
|
|
if(xTaskGetSchedulerState() == taskSCHEDULER_RUNNING && task_id &&
|
|
furi_mutex_acquire(furi_stdglue->mutex, FuriWaitForever) == FuriStatusOk) {
|
|
// We are in the thread context
|
|
// Handle thread callbacks
|
|
FuriStdglueWriteCallback* callback_ptr =
|
|
FuriStdglueCallbackDict_get(furi_stdglue->thread_outputs, (uint32_t)task_id);
|
|
if(callback_ptr) {
|
|
(*callback_ptr)(_cookie, data, size);
|
|
consumed = true;
|
|
}
|
|
furi_check(furi_mutex_release(furi_stdglue->mutex) == FuriStatusOk);
|
|
}
|
|
// Flush
|
|
if(data == 0) {
|
|
/*
|
|
* This means that we should flush internal buffers. Since we
|
|
* don't we just return. (Remember, "handle" == -1 means that all
|
|
* handles should be flushed.)
|
|
*/
|
|
return 0;
|
|
}
|
|
// Debug uart
|
|
if(!consumed) furi_hal_console_tx((const uint8_t*)data, size);
|
|
// All data consumed
|
|
return size;
|
|
}
|
|
|
|
void furi_stdglue_init() {
|
|
furi_stdglue = malloc(sizeof(FuriStdglue));
|
|
// Init outputs structures
|
|
furi_stdglue->mutex = furi_mutex_alloc(FuriMutexTypeNormal);
|
|
furi_check(furi_stdglue->mutex);
|
|
FuriStdglueCallbackDict_init(furi_stdglue->thread_outputs);
|
|
// Prepare and set stdout descriptor
|
|
FILE* fp = fopencookie(
|
|
NULL,
|
|
"w",
|
|
(cookie_io_functions_t){
|
|
.read = NULL,
|
|
.write = stdout_write,
|
|
.seek = NULL,
|
|
.close = NULL,
|
|
});
|
|
setvbuf(fp, NULL, _IOLBF, 0);
|
|
stdout = fp;
|
|
}
|
|
|
|
bool furi_stdglue_set_thread_stdout_callback(FuriStdglueWriteCallback callback) {
|
|
furi_assert(furi_stdglue);
|
|
FuriThreadId task_id = furi_thread_get_current_id();
|
|
if(task_id) {
|
|
furi_check(furi_mutex_acquire(furi_stdglue->mutex, FuriWaitForever) == FuriStatusOk);
|
|
if(callback) {
|
|
FuriStdglueCallbackDict_set_at(
|
|
furi_stdglue->thread_outputs, (uint32_t)task_id, callback);
|
|
} else {
|
|
FuriStdglueCallbackDict_erase(furi_stdglue->thread_outputs, (uint32_t)task_id);
|
|
}
|
|
furi_check(furi_mutex_release(furi_stdglue->mutex) == FuriStatusOk);
|
|
return true;
|
|
} else {
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void __malloc_lock(struct _reent* REENT) {
|
|
UNUSED(REENT);
|
|
vTaskSuspendAll();
|
|
}
|
|
|
|
void __malloc_unlock(struct _reent* REENT) {
|
|
UNUSED(REENT);
|
|
xTaskResumeAll();
|
|
}
|