v1.0.3

packages/third-party/adbd/core/adb_pque.c

@@ -0,0 +1,96 @@
+/*
+ * Copyright (c) 2006-2018, RT-Thread Development Team
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author         Notes
+ * 2018-11-30     heyuanjie87    the first version
+ */
+
+#include <adb_pque.h>
+
+#define DBG_ENABLE
+#define DBG_SECTION_NAME  "ADB pque"
+#define DBG_LEVEL         DBG_INFO
+#define DBG_COLOR
+#include <rtdbg.h>
+
+#ifdef DBG_ENABLE
+#define LOG_CON(c, fmt, ...) \
+    if (c)   \
+        LOG_E(fmt, ##__VA_ARGS__)
+#else
+#define LOG_CON(...)
+#endif
+
+struct adb_packet* adb_packet_new(int datlen)
+{
+    struct adb_packet *p;
+
+    p = rt_malloc(sizeof(struct adb_packet) + datlen);
+    if (p)
+    {
+        p->msg.data_length = datlen;
+        p->split = 0;
+    }
+
+    LOG_CON(!p, "no mem to new packet");
+
+    return p;
+}
+
+void adb_packet_delete(struct adb_packet *p)
+{
+    if (!p)
+        return;
+
+    rt_free(p);
+}
+
+bool adb_packet_enqueue(adb_queue_t *q, struct adb_packet *p, int ms)
+{
+    int ret;
+    int tick;
+
+    tick = rt_tick_from_millisecond(ms);
+    ret = rt_mb_send_wait(q, (rt_ubase_t)p, tick);
+    LOG_CON(ret, "enqueue fail");
+
+    return ret == 0;
+}
+
+bool adb_packet_dequeue(adb_queue_t *q, struct adb_packet **p, int ms)
+{
+    int ret;
+    int tick;
+
+    *p = 0;
+    tick = rt_tick_from_millisecond(ms);
+    ret = rt_mb_recv(q, (rt_ubase_t*)p, tick);
+
+    return ret == 0;
+}
+
+void adb_packet_clear(adb_queue_t *q)
+{
+    struct adb_packet *p;
+
+    while (rt_mb_recv(q, (rt_ubase_t*)&p, 0) == 0)
+    {
+        adb_packet_delete(p);
+    }
+}
+
+unsigned adb_packet_checksum(struct adb_packet *p)
+{
+    unsigned sum = 0;
+    int i;
+
+    for (i = 0; i < p->msg.data_length; ++i)
+    {
+        sum += (unsigned char)(p->payload[i]);
+    }
+
+    return sum;
+}