更新模板到最新状态

sal/esp32/kernel/os_semaphore.c

@@ -0,0 +1,105 @@
+#include "os/os.h"
+#include "os_util.h"
+#include "semphr.h"
+
+os_state os_sem_create(os_sem_t *sem, size_t init_value, size_t max_value)
+{
+    OS_ASS_HDL(!os_sem_is_valid(sem), sem->handle);
+
+    sem->handle = xSemaphoreCreateCounting(max_value, init_value);
+    if (sem->handle == NULL)
+    {
+        OS_ERR("err %p\r\n", sem->handle);
+        return OS_FAIL;
+    }
+
+    return OS_OK;
+}
+
+os_state os_sem_delete(os_sem_t *sem)
+{
+    OS_ASS_HDL(os_sem_is_valid(sem), sem->handle);
+
+    vSemaphoreDelete(sem->handle);
+    sem->handle = NULL;
+    return OS_OK;
+}
+
+os_state os_sem_take(os_sem_t *sem, os_time_t wait_ms)
+{
+    BaseType_t ret;
+    BaseType_t taskWoken;
+
+    OS_ASS_HDL(os_sem_is_valid(sem), sem->handle);
+
+    if (os_is_isr_context())
+    {
+        if (wait_ms != 0)
+        {
+            OS_ERR("%s() in ISR, wait %u ms\n", __func__, wait_ms);
+            return OS_E_ISR;
+        }
+        taskWoken = pdFALSE;
+        ret = xSemaphoreTakeFromISR(sem->handle, &taskWoken);
+        if (ret != pdPASS)
+        {
+            OS_DBG("%s() fail @ %d\n", __func__, __LINE__);
+            return OS_E_TIMEOUT;
+        }
+        portYIELD_FROM_ISR(taskWoken);
+    }
+    else
+    {
+        ret = xSemaphoreTake(sem->handle, os_calc_msec_to_ticks(wait_ms));
+        if (ret != pdPASS)
+        {
+            OS_DBG("%s() fail @ %d, %u ms\n", __func__, __LINE__, wait_ms);
+            return OS_E_TIMEOUT;
+        }
+    }
+
+    return OS_OK;
+}
+
+os_state os_sem_release(os_sem_t *sem)
+{
+    BaseType_t ret;
+    BaseType_t taskWoken;
+
+    OS_ASS_HDL(os_sem_is_valid(sem), sem->handle);
+
+    if (os_is_isr_context())
+    {
+        taskWoken = pdFALSE;
+        ret = xSemaphoreGiveFromISR(sem->handle, &taskWoken);
+        if (ret != pdPASS)
+        {
+            OS_DBG("%s() fail @ %d\n", __func__, __LINE__);
+            return OS_FAIL;
+        }
+        portYIELD_FROM_ISR(taskWoken);
+    }
+    else
+    {
+        ret = xSemaphoreGive(sem->handle);
+        if (ret != pdPASS)
+        {
+            OS_DBG("%s() fail @ %d\n", __func__, __LINE__);
+            return OS_FAIL;
+        }
+    }
+
+    return OS_OK;
+}
+
+bool os_sem_is_valid(os_sem_t *sem)
+{
+    if (sem && sem->handle)
+    {
+        return true;
+    }
+    else
+    {
+        return false;
+    }
+}