[FL-2591] Furi: remove CMSIS thread api, migrate to FuriThread, remove unused CMSIS APIs (#1333)

* Furi: remove CMSIS thread api, migrate to FuriThread, remove unused CMSIS APIs * Furi: magic thread catcher validating thread completion; backtrace improver * Furi: allow furi_thread_get_current_id outside of thread context * Furi: use IRQ instead of ISR for core primitives
2022-06-20 17:54:48 +03:00
parent 7618c8ba6f
commit 839e52ac32
61 changed files with 1467 additions and 2784 deletions
@@ -0,0 +1,190 @@
+#include "semaphore.h"
+#include "check.h"
+#include "common_defines.h"
+
+#include <semphr.h>
+
+osSemaphoreId_t
+    osSemaphoreNew(uint32_t max_count, uint32_t initial_count, const osSemaphoreAttr_t* attr) {
+    SemaphoreHandle_t hSemaphore;
+    int32_t mem;
+
+    hSemaphore = NULL;
+
+    if((FURI_IS_IRQ_MODE() == 0U) && (max_count > 0U) && (initial_count <= max_count)) {
+        mem = -1;
+
+        if(attr != NULL) {
+            if((attr->cb_mem != NULL) && (attr->cb_size >= sizeof(StaticSemaphore_t))) {
+                /* The memory for control block is provided, use static object */
+                mem = 1;
+            } else {
+                if((attr->cb_mem == NULL) && (attr->cb_size == 0U)) {
+                    /* Control block will be allocated from the dynamic pool */
+                    mem = 0;
+                }
+            }
+        } else {
+            mem = 0;
+        }
+
+        if(mem != -1) {
+            if(max_count == 1U) {
+                if(mem == 1) {
+#if(configSUPPORT_STATIC_ALLOCATION == 1)
+                    hSemaphore = xSemaphoreCreateBinaryStatic((StaticSemaphore_t*)attr->cb_mem);
+#endif
+                } else {
+#if(configSUPPORT_DYNAMIC_ALLOCATION == 1)
+                    hSemaphore = xSemaphoreCreateBinary();
+#endif
+                }
+
+                if((hSemaphore != NULL) && (initial_count != 0U)) {
+                    if(xSemaphoreGive(hSemaphore) != pdPASS) {
+                        vSemaphoreDelete(hSemaphore);
+                        hSemaphore = NULL;
+                    }
+                }
+            } else {
+                if(mem == 1) {
+#if(configSUPPORT_STATIC_ALLOCATION == 1)
+                    hSemaphore = xSemaphoreCreateCountingStatic(
+                        max_count, initial_count, (StaticSemaphore_t*)attr->cb_mem);
+#endif
+                } else {
+#if(configSUPPORT_DYNAMIC_ALLOCATION == 1)
+                    hSemaphore = xSemaphoreCreateCounting(max_count, initial_count);
+#endif
+                }
+            }
+
+#if(configQUEUE_REGISTRY_SIZE > 0)
+            if(hSemaphore != NULL) {
+                if((attr != NULL) && (attr->name != NULL)) {
+                    /* Only non-NULL name objects are added to the Queue Registry */
+                    vQueueAddToRegistry(hSemaphore, attr->name);
+                }
+            }
+#endif
+        }
+    }
+
+    /* Return semaphore ID */
+    return ((osSemaphoreId_t)hSemaphore);
+}
+
+/*
+    Acquire a Semaphore token or timeout if no tokens are available.
+*/
+osStatus_t osSemaphoreAcquire(osSemaphoreId_t semaphore_id, uint32_t timeout) {
+    SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
+    osStatus_t stat;
+    BaseType_t yield;
+
+    stat = osOK;
+
+    if(hSemaphore == NULL) {
+        stat = osErrorParameter;
+    } else if(FURI_IS_IRQ_MODE() != 0U) {
+        if(timeout != 0U) {
+            stat = osErrorParameter;
+        } else {
+            yield = pdFALSE;
+
+            if(xSemaphoreTakeFromISR(hSemaphore, &yield) != pdPASS) {
+                stat = osErrorResource;
+            } else {
+                portYIELD_FROM_ISR(yield);
+            }
+        }
+    } else {
+        if(xSemaphoreTake(hSemaphore, (TickType_t)timeout) != pdPASS) {
+            if(timeout != 0U) {
+                stat = osErrorTimeout;
+            } else {
+                stat = osErrorResource;
+            }
+        }
+    }
+
+    /* Return execution status */
+    return (stat);
+}
+
+/*
+    Release a Semaphore token up to the initial maximum count.
+*/
+osStatus_t osSemaphoreRelease(osSemaphoreId_t semaphore_id) {
+    SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
+    osStatus_t stat;
+    BaseType_t yield;
+
+    stat = osOK;
+
+    if(hSemaphore == NULL) {
+        stat = osErrorParameter;
+    } else if(FURI_IS_IRQ_MODE() != 0U) {
+        yield = pdFALSE;
+
+        if(xSemaphoreGiveFromISR(hSemaphore, &yield) != pdTRUE) {
+            stat = osErrorResource;
+        } else {
+            portYIELD_FROM_ISR(yield);
+        }
+    } else {
+        if(xSemaphoreGive(hSemaphore) != pdPASS) {
+            stat = osErrorResource;
+        }
+    }
+
+    /* Return execution status */
+    return (stat);
+}
+
+/*
+    Get current Semaphore token count.
+*/
+uint32_t osSemaphoreGetCount(osSemaphoreId_t semaphore_id) {
+    SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
+    uint32_t count;
+
+    if(hSemaphore == NULL) {
+        count = 0U;
+    } else if(FURI_IS_IRQ_MODE() != 0U) {
+        count = (uint32_t)uxSemaphoreGetCountFromISR(hSemaphore);
+    } else {
+        count = (uint32_t)uxSemaphoreGetCount(hSemaphore);
+    }
+
+    /* Return number of tokens */
+    return (count);
+}
+
+/*
+    Delete a Semaphore object.
+*/
+osStatus_t osSemaphoreDelete(osSemaphoreId_t semaphore_id) {
+    SemaphoreHandle_t hSemaphore = (SemaphoreHandle_t)semaphore_id;
+    osStatus_t stat;
+
+#ifndef USE_FreeRTOS_HEAP_1
+    if(FURI_IS_IRQ_MODE() != 0U) {
+        stat = osErrorISR;
+    } else if(hSemaphore == NULL) {
+        stat = osErrorParameter;
+    } else {
+#if(configQUEUE_REGISTRY_SIZE > 0)
+        vQueueUnregisterQueue(hSemaphore);
+#endif
+
+        stat = osOK;
+        vSemaphoreDelete(hSemaphore);
+    }
+#else
+    stat = osError;
+#endif
+
+    /* Return execution status */
+    return (stat);
+}