v1.0.3

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

@@ -0,0 +1,159 @@
+/*
+ * Copyright (c) 2006-2018, RT-Thread Development Team
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author         Notes
+ * 2018-11-11     heyuanjie87    the first version
+ */
+
+#include "adb.h"
+#include <adb_service.h>
+
+#define DBG_ENABLE
+#define DBG_SECTION_NAME  "ADB ser"
+#define DBG_LEVEL         DBG_INFO
+#define DBG_COLOR
+#include <rtdbg.h>
+
+static rt_list_t _shr_list = RT_LIST_OBJECT_INIT(_shr_list);
+
+struct adb_service* adb_service_find(struct adb *d, unsigned localid, unsigned remoteid)
+{
+    struct rt_list_node *node, *head;
+    struct adb_service *ret = 0;
+
+    head = &d->s_list;
+    for (node = head->next; node != head; node = node->next)
+    {
+        struct adb_service *ser;
+
+        ser = rt_list_entry(node, struct adb_service, list);
+        if (ser->localid == localid)
+        {
+            ret = ser;
+            goto _ok;
+        }
+    }
+    LOG_D("service: no id [%X][%X]", localid, remoteid);
+_ok:
+    return ret;
+}
+
+bool adb_service_sendpacket(struct adb_service *ser, 
+                             struct adb_packet *p, int ms)
+{
+    p->msg.command = A_WRTE;
+    p->msg.arg0 = ser->localid;
+    p->msg.arg1 = ser->remoteid;
+    p->msg.data_crc32 = adb_packet_checksum(p);
+    p->msg.magic = p->msg.command ^ 0xffffffff;
+
+    return adb_packet_enqueue(&ser->d->send_que, p, ms);
+}
+
+static unsigned _service_init(struct adb_service_handler *h, 
+                              struct adb_service *ser, 
+                              struct adb *d, unsigned rid, char *args)
+{
+    if (!ser)
+    {
+        return 0;
+    }
+    if (ser->ops->open(ser, args) != 0)
+    {
+        h->destroy(h, ser);
+        return 0;
+    }
+
+    ser->h = h;
+    ser->d = d;
+    ser->localid = rt_tick_get();
+    ser->remoteid = rid;
+    rt_list_init(&ser->list);
+    rt_list_insert_after(&d->s_list, &ser->list);
+
+    return ser->localid;
+}
+
+void adb_service_destroy(struct adb *d, unsigned localid, unsigned remoteid)
+{
+    struct adb_service *ser;
+
+    ser = adb_service_find(d, localid, remoteid);
+    if (ser)
+    {
+        struct adb_service_handler *h = ser->h;
+
+        rt_list_remove(&ser->list);
+        ser->ops->close(ser);
+        h->destroy(h, ser);
+    }
+}
+
+unsigned adb_service_create(struct adb *d, char *name, unsigned remoteid)
+{
+    struct rt_list_node *node, *head;
+    struct adb_service_handler *h;
+
+    head = &_shr_list;
+    for (node = head->next; node != head; node = node->next)
+    {
+        int n;
+
+        h = rt_list_entry(node, struct adb_service_handler, list);
+        n = rt_strlen(h->name);
+        if (rt_strncmp(h->name, name, n) == 0)
+        {
+            struct adb_service *ser;
+
+            ser = h->create(h);
+            return _service_init(h, ser, d, remoteid, &name[n]);
+        }
+    }
+
+    return 0;    
+}
+
+int adb_service_handler_register(struct adb_service_handler *h)
+{
+    struct rt_list_node *node, *head;
+    struct adb_service_handler *entry;
+
+    if (!h->name || !h->create || !h->destroy)
+        return -1;
+
+    head = &_shr_list;
+    for (node = head->next; node != head; node = node->next)
+    {
+        entry = rt_list_entry(node, struct adb_service_handler, list);
+        if (rt_strcmp(h->name, entry->name) == 0)
+            return -1;
+    }
+
+    rt_list_init(&h->list);
+    rt_list_insert_after(head, &h->list);
+
+    return 0;
+}
+
+struct adb_service* adb_service_alloc(const struct adb_service_ops *ops, 
+                                       int extsize)
+{
+    struct adb_service* ser;
+
+    ser = rt_calloc(sizeof(*ser) + extsize, 1);
+    if (ser && extsize)
+    {
+        ser->ops = ops;
+        ser->extptr = (char*)ser + sizeof(*ser);
+    }
+
+    return ser;
+}
+
+void adb_service_close_report(struct adb_service *ser)
+{
+    adb_send_close(ser->d, ser->localid, ser->remoteid);
+}