Initial commit: TXW82x FPV v2.7.0.7-42229 SDK + project sources

2026-07-06 11:30:13 +08:00
commit e76462eeb7
3451 changed files with 1415300 additions and 0 deletions
--- a/sdk/osal/ohos/msgqueue.c
+++ b/sdk/osal/ohos/msgqueue.c
@@ -0,0 +1,97 @@
+#include "typesdef.h"
+#include "errno.h"
+#include "list.h"
+#include "osal/event.h"
+
+#ifdef OHOS
+#include "los_event.h"
+#include "los_membox.h"
+#include "los_memory.h"
+#include "los_interrupt.h"
+#include "los_mux.h"
+#include "los_queue.h"
+#include "los_sem.h"
+#include "los_swtmr.h"
+#include "los_task.h"
+#include "los_timer.h"
+#include "los_debug.h"
+#if (LOSCFG_MUTEX_CREATE_TRACE == 1)
+#include "los_arch.h"
+#endif
+#include "osal/string.h"
+#include "osal/msgqueue.h"
+
+#define MSGQ_MAGIC (0x4a8b1c9d)
+
+int32 os_msgq_init(os_msgqueue_t *msgq, int32 size)
+{
+    UINT32 hdl = 0;
+
+    if(msgq->magic == MSGQ_MAGIC){
+        os_printf(KERN_WARNING"msgq repeat initialization ????\r\n");
+    }
+    
+    if (LOS_OK == LOS_QueueCreate("msgq", size, &hdl, 0, sizeof(uint32))) {
+        msgq->hdl = (void *)(hdl + 1);
+        msgq->magic = MSGQ_MAGIC;
+    }
+    return (msgq->hdl ? RET_OK : RET_ERR);
+}
+
+uint32 os_msgq_get(os_msgqueue_t *msgq, int32 tmo_ms)
+{
+    UINT32 val = 0;
+    UINT32 hdl = (UINT32)msgq->hdl;
+    ASSERT(msgq->hdl);
+    LOS_QueueRead(hdl - 1, &val, sizeof(uint32), LOS_MS2Tick(tmo_ms));
+    return val;
+}
+
+uint32 os_msgq_get2(struct os_msgqueue *msgq, int32 tmo_ms, int32 *err)
+{
+    UINT32 ret;
+    UINT32 val = 0;
+    UINT32 hdl = (UINT32)msgq->hdl;
+    ASSERT(msgq->hdl);
+    ret = LOS_QueueRead(hdl - 1, &val, sizeof(uint32), LOS_MS2Tick(tmo_ms));
+    if(err) *err = ret;
+    return val;
+}
+
+int32 os_msgq_put(os_msgqueue_t *msgq, uint32 data, int32 tmo_ms)
+{
+    UINT32 hdl = (UINT32)msgq->hdl;
+    ASSERT(msgq->hdl);
+    return LOS_QueueWrite(hdl - 1, (void *)data, sizeof(uint32), LOS_MS2Tick(tmo_ms));
+}
+
+int32 os_msgq_put_head(os_msgqueue_t *msgq, uint32 data, int32 tmo_ms)
+{
+    UINT32 hdl = (UINT32)msgq->hdl;
+    ASSERT(msgq->hdl);
+    return LOS_QueueWriteHead(hdl - 1, (void *)data, sizeof(uint32), LOS_MS2Tick(tmo_ms));
+}
+
+int32 os_msgq_del(os_msgqueue_t *msgq)
+{
+    ASSERT(msgq->hdl);
+    UINT32 hdl = (UINT32)msgq->hdl;
+    ASSERT(msgq->hdl);
+    LOS_QueueDelete(hdl - 1);
+    msgq->hdl = NULL;
+    msgq->magic = 0;
+    return RET_OK;
+}
+
+int32 os_msgq_cnt(os_msgqueue_t *msgq)
+{
+    QUEUE_INFO_S queueInfo;
+    UINT32 hdl = (UINT32)msgq->hdl;
+    ASSERT(msgq->hdl);
+    memset(&queueInfo, 0, sizeof(queueInfo));
+    LOS_QueueInfoGet(hdl - 1, &queueInfo);
+    return queueInfo.readableCnt;
+}
+
+#endif
+