mirror of
https://github.com/DarkFlippers/unleashed-firmware.git
synced 2024-12-24 22:07:14 +03:00
acc39a4bc0
* Api Symbols: replace asserts with checks * Api Symbols: replace asserts with checks part 2 * Update no args function signatures with void, to help compiler to track incorrect usage * More unavoidable void * Update PVS config and code to make it happy * Format sources * nfc: fix checks * dead code cleanup & include fixes Co-authored-by: gornekich <n.gorbadey@gmail.com> Co-authored-by: hedger <hedger@users.noreply.github.com> Co-authored-by: hedger <hedger@nanode.su>
206 lines
4.7 KiB
C
206 lines
4.7 KiB
C
#include "kernel.h"
|
|
#include "base.h"
|
|
#include "check.h"
|
|
#include "common_defines.h"
|
|
|
|
#include <furi_hal.h>
|
|
|
|
#include <FreeRTOS.h>
|
|
#include <task.h>
|
|
|
|
#include CMSIS_device_header
|
|
|
|
bool furi_kernel_is_irq_or_masked(void) {
|
|
bool irq = false;
|
|
BaseType_t state;
|
|
|
|
if(FURI_IS_IRQ_MODE()) {
|
|
/* Called from interrupt context */
|
|
irq = true;
|
|
} else {
|
|
/* Get FreeRTOS scheduler state */
|
|
state = xTaskGetSchedulerState();
|
|
|
|
if(state != taskSCHEDULER_NOT_STARTED) {
|
|
/* Scheduler was started */
|
|
if(FURI_IS_IRQ_MASKED()) {
|
|
/* Interrupts are masked */
|
|
irq = true;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Return context, 0: thread context, 1: IRQ context */
|
|
return (irq);
|
|
}
|
|
|
|
bool furi_kernel_is_running(void) {
|
|
return xTaskGetSchedulerState() != taskSCHEDULER_RUNNING;
|
|
}
|
|
|
|
int32_t furi_kernel_lock(void) {
|
|
furi_check(!furi_kernel_is_irq_or_masked());
|
|
|
|
int32_t lock;
|
|
|
|
switch(xTaskGetSchedulerState()) {
|
|
case taskSCHEDULER_SUSPENDED:
|
|
lock = 1;
|
|
break;
|
|
|
|
case taskSCHEDULER_RUNNING:
|
|
vTaskSuspendAll();
|
|
lock = 0;
|
|
break;
|
|
|
|
case taskSCHEDULER_NOT_STARTED:
|
|
default:
|
|
lock = (int32_t)FuriStatusError;
|
|
break;
|
|
}
|
|
|
|
/* Return previous lock state */
|
|
return (lock);
|
|
}
|
|
|
|
int32_t furi_kernel_unlock(void) {
|
|
furi_check(!furi_kernel_is_irq_or_masked());
|
|
|
|
int32_t lock;
|
|
|
|
switch(xTaskGetSchedulerState()) {
|
|
case taskSCHEDULER_SUSPENDED:
|
|
lock = 1;
|
|
|
|
if(xTaskResumeAll() != pdTRUE) {
|
|
if(xTaskGetSchedulerState() == taskSCHEDULER_SUSPENDED) {
|
|
lock = (int32_t)FuriStatusError;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case taskSCHEDULER_RUNNING:
|
|
lock = 0;
|
|
break;
|
|
|
|
case taskSCHEDULER_NOT_STARTED:
|
|
default:
|
|
lock = (int32_t)FuriStatusError;
|
|
break;
|
|
}
|
|
|
|
/* Return previous lock state */
|
|
return (lock);
|
|
}
|
|
|
|
int32_t furi_kernel_restore_lock(int32_t lock) {
|
|
furi_check(!furi_kernel_is_irq_or_masked());
|
|
|
|
switch(xTaskGetSchedulerState()) {
|
|
case taskSCHEDULER_SUSPENDED:
|
|
case taskSCHEDULER_RUNNING:
|
|
if(lock == 1) {
|
|
vTaskSuspendAll();
|
|
} else {
|
|
if(lock != 0) {
|
|
lock = (int32_t)FuriStatusError;
|
|
} else {
|
|
if(xTaskResumeAll() != pdTRUE) {
|
|
if(xTaskGetSchedulerState() != taskSCHEDULER_RUNNING) {
|
|
lock = (int32_t)FuriStatusError;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
break;
|
|
|
|
case taskSCHEDULER_NOT_STARTED:
|
|
default:
|
|
lock = (int32_t)FuriStatusError;
|
|
break;
|
|
}
|
|
|
|
/* Return new lock state */
|
|
return (lock);
|
|
}
|
|
|
|
uint32_t furi_kernel_get_tick_frequency(void) {
|
|
/* Return frequency in hertz */
|
|
return (configTICK_RATE_HZ_RAW);
|
|
}
|
|
|
|
void furi_delay_tick(uint32_t ticks) {
|
|
furi_check(!furi_kernel_is_irq_or_masked());
|
|
if(ticks == 0U) {
|
|
taskYIELD();
|
|
} else {
|
|
vTaskDelay(ticks);
|
|
}
|
|
}
|
|
|
|
FuriStatus furi_delay_until_tick(uint32_t tick) {
|
|
furi_check(!furi_kernel_is_irq_or_masked());
|
|
|
|
TickType_t tcnt, delay;
|
|
FuriStatus stat;
|
|
|
|
stat = FuriStatusOk;
|
|
tcnt = xTaskGetTickCount();
|
|
|
|
/* Determine remaining number of tick to delay */
|
|
delay = (TickType_t)tick - tcnt;
|
|
|
|
/* Check if target tick has not expired */
|
|
if((delay != 0U) && (0 == (delay >> (8 * sizeof(TickType_t) - 1)))) {
|
|
if(xTaskDelayUntil(&tcnt, delay) == pdFALSE) {
|
|
/* Did not delay */
|
|
stat = FuriStatusError;
|
|
}
|
|
} else {
|
|
/* No delay or already expired */
|
|
stat = FuriStatusErrorParameter;
|
|
}
|
|
|
|
/* Return execution status */
|
|
return (stat);
|
|
}
|
|
|
|
uint32_t furi_get_tick(void) {
|
|
TickType_t ticks;
|
|
|
|
if(furi_kernel_is_irq_or_masked() != 0U) {
|
|
ticks = xTaskGetTickCountFromISR();
|
|
} else {
|
|
ticks = xTaskGetTickCount();
|
|
}
|
|
|
|
return ticks;
|
|
}
|
|
|
|
uint32_t furi_ms_to_ticks(uint32_t milliseconds) {
|
|
#if configTICK_RATE_HZ_RAW == 1000
|
|
return milliseconds;
|
|
#else
|
|
return (uint32_t)((float)configTICK_RATE_HZ_RAW) / 1000.0f * (float)milliseconds;
|
|
#endif
|
|
}
|
|
|
|
void furi_delay_ms(uint32_t milliseconds) {
|
|
if(!FURI_IS_ISR() && xTaskGetSchedulerState() == taskSCHEDULER_RUNNING) {
|
|
if(milliseconds > 0 && milliseconds < portMAX_DELAY - 1) {
|
|
milliseconds += 1;
|
|
}
|
|
#if configTICK_RATE_HZ_RAW == 1000
|
|
furi_delay_tick(milliseconds);
|
|
#else
|
|
furi_delay_tick(furi_ms_to_ticks(milliseconds));
|
|
#endif
|
|
} else if(milliseconds > 0) {
|
|
furi_delay_us(milliseconds * 1000);
|
|
}
|
|
}
|
|
|
|
void furi_delay_us(uint32_t microseconds) {
|
|
furi_hal_cortex_delay_us(microseconds);
|
|
}
|