add memory wrapper and errno util

5 files changed, 897 insertions, 247 deletions

diff --git a/common/usb_errno.h b/common/usb_errno.h
new file mode 100644
index 00000000..7ccadb6c
--- /dev/null
+++ b/common/usb_errno.h
@@ -0,0 +1,340 @@
+/****************************************************************************
+ * include/errno.h
+ *
+ * Licensed to the Apache Software Foundation (ASF) under one or more
+ * contributor license agreements.  See the NOTICE file distributed with
+ * this work for additional information regarding copyright ownership.  The
+ * ASF licenses this file to you under the Apache License, Version 2.0 (the
+ * "License"); you may not use this file except in compliance with the
+ * License.  You may obtain a copy of the License at
+ *
+ *   http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
+ * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.  See the
+ * License for the specific language governing permissions and limitations
+ * under the License.
+ *
+ ****************************************************************************/
+
+#ifndef __INCLUDE_ERRNO_H
+#define __INCLUDE_ERRNO_H
+
+/****************************************************************************
+ * Included Files
+ ****************************************************************************/
+
+/****************************************************************************
+ * Pre-processor Definitions
+ ****************************************************************************/
+
+/* Convenience/compatibility definition.  If the errno is accessed from the
+ * internal OS code, then the OS code should use the set_errno() and
+ * get_errno().  Currently, those are just placeholders but would be needed
+ * in the KERNEL mode build in order to instantiate the process address
+ * environment as necessary to access the TLS-based errno variable.
+ */
+
+#define errno *__errno()
+#define set_errno(e) \
+  do \
+    { \
+       errno = (int)(e); \
+    } \
+  while (0)
+#define get_errno() errno
+
+/* Definitions of error numbers and the string that would be
+ * returned by strerror().
+ */
+
+#define EPERM               1
+#define EPERM_STR           "Operation not permitted"
+#define ENOENT              2
+#define ENOENT_STR          "No such file or directory"
+#define ESRCH               3
+#define ESRCH_STR           "No such process"
+#define EINTR               4
+#define EINTR_STR           "Interrupted system call"
+#define EIO                 5
+#define EIO_STR             "I/O error"
+#define ENXIO               6
+#define ENXIO_STR           "No such device or address"
+#define E2BIG               7
+#define E2BIG_STR           "Arg list too long"
+#define ENOEXEC             8
+#define ENOEXEC_STR         "Exec format error"
+#define EBADF               9
+#define EBADF_STR           "Bad file number"
+#define ECHILD              10
+#define ECHILD_STR          "No child processes"
+#define EAGAIN              11
+#define EWOULDBLOCK         EAGAIN
+#define EAGAIN_STR          "Try again"
+#define ENOMEM              12
+#define ENOMEM_STR          "Out of memory"
+#define EACCES              13
+#define EACCES_STR          "Permission denied"
+#define EFAULT              14                         /* Linux errno extension */
+#define EFAULT_STR          "Bad address"
+#define ENOTBLK             15
+#define ENOTBLK_STR         "Block device required"
+#define EBUSY               16
+#define EBUSY_STR           "Device or resource busy"
+#define EEXIST              17
+#define EEXIST_STR          "File exists"
+#define EXDEV               18
+#define EXDEV_STR           "Cross-device link"
+#define ENODEV              19
+#define ENODEV_STR          "No such device"
+#define ENOTDIR             20
+#define ENOTDIR_STR         "Not a directory"
+#define EISDIR              21
+#define EISDIR_STR          "Is a directory"
+#define EINVAL              22
+#define EINVAL_STR          "Invalid argument"
+#define ENFILE              23
+#define ENFILE_STR          "File table overflow"
+#define EMFILE              24
+#define EMFILE_STR          "Too many open files"
+#define ENOTTY              25
+#define ENOTTY_STR          "Not a typewriter"
+#define ETXTBSY             26
+#define ETXTBSY_STR         "Text file busy"
+#define EFBIG               27
+#define EFBIG_STR           "File too large"
+#define ENOSPC              28
+#define ENOSPC_STR          "No space left on device"
+#define ESPIPE              29
+#define ESPIPE_STR          "Illegal seek"
+#define EROFS               30
+#define EROFS_STR           "Read-only file system"
+#define EMLINK              31
+#define EMLINK_STR          "Too many links"
+#define EPIPE               32
+#define EPIPE_STR           "Broken pipe"
+#define EDOM                33
+#define EDOM_STR            "Math argument out of domain of func"
+#define ERANGE              34
+#define ERANGE_STR          "Math result not representable"
+#define ENOMSG              35
+#define ENOMSG_STR          "No message of desired type"
+#define EIDRM               36
+#define EIDRM_STR           "Identifier removed"
+#define ECHRNG              37                         /* Linux errno extension */
+#define ECHRNG_STR          "Channel number out of range"
+#define EL2NSYNC            38                         /* Linux errno extension */
+#define EL2NSYNC_STR        "Level 2 not synchronized"
+#define EL3HLT              39                         /* Linux errno extension */
+#define EL3HLT_STR          "Level 3 halted"
+#define EL3RST              40                         /* Linux errno extension */
+#define EL3RST_STR          "Level 3 reset"
+#define ELNRNG              41                         /* Linux errno extension */
+#define ELNRNG_STR          "Link number out of range"
+#define EUNATCH             42                         /* Linux errno extension */
+#define EUNATCH_STR         "Protocol driver not attached"
+#define ENOCSI              43                         /* Linux errno extension */
+#define ENOCSI_STR          "No CSI structure available"
+#define EL2HLT              44                         /* Linux errno extension */
+#define EL2HLT_STR          "Level 2 halted"
+#define EDEADLK             45
+#define EDEADLK_STR         "Resource deadlock would occur"
+#define ENOLCK              46
+#define ENOLCK_STR          "No record locks available"
+
+#define EBADE               50                         /* Linux errno extension */
+#define EBADE_STR           "Invalid exchange"
+#define EBADR               51                         /* Linux errno extension */
+#define EBADR_STR           "Invalid request descriptor"
+#define EXFULL              52                         /* Linux errno extension */
+#define EXFULL_STR          "Exchange full"
+#define ENOANO              53                         /* Linux errno extension */
+#define ENOANO_STR          "No anode"
+#define EBADRQC             54                         /* Linux errno extension */
+#define EBADRQC_STR         "Invalid request code"
+#define EBADSLT             55                         /* Linux errno extension */
+#define EBADSLT_STR         "Invalid slot"
+#define EDEADLOCK           56                         /* Linux errno extension */
+#define EDEADLOCK_STR       "File locking deadlock error"
+#define EBFONT              57                         /* Linux errno extension */
+#define EBFONT_STR          "Bad font file format"
+
+#define ENOSTR              60
+#define ENOSTR_STR          "Device not a stream"
+#define ENODATA             61
+#define ENODATA_STR         "No data available"
+#define ETIME               62
+#define ETIME_STR           "Timer expired"
+#define ENOSR               63
+#define ENOSR_STR           "Out of streams resources"
+#define ENONET              64                         /* Linux errno extension */
+#define ENONET_STR          "Machine is not on the network"
+#define ENOPKG              65                         /* Linux errno extension */
+#define ENOPKG_STR          "Package not installed"
+#define EREMOTE             66                         /* Linux errno extension */
+#define EREMOTE_STR         "Object is remote"
+#define ENOLINK             67
+#define ENOLINK_STR         "Link has been severed"
+#define EADV                68                         /* Linux errno extension */
+#define EADV_STR            "Advertise error"
+#define ESRMNT              69                         /* Linux errno extension */
+#define ESRMNT_STR          "Srmount error"
+#define ECOMM               70                         /* Linux errno extension */
+#define ECOMM_STR           "Communication error on send"
+#define EPROTO              71
+#define EPROTO_STR          "Protocol error"
+
+#define EMULTIHOP           74
+#define EMULTIHOP_STR       "Multihop attempted"
+#define ELBIN               75                         /* Linux errno extension */
+#define ELBIN_STR           "Inode is remote"
+#define EDOTDOT             76                         /* Linux errno extension */
+#define EDOTDOT_STR         "RFS specific error"
+#define EBADMSG             77
+#define EBADMSG_STR         "Not a data message"
+
+#define EFTYPE              79
+#define EFTYPE_STR          "Inappropriate file type or format"
+#define ENOTUNIQ            80                         /* Linux errno extension */
+#define ENOTUNIQ_STR        "Name not unique on network"
+#define EBADFD              81                         /* Linux errno extension */
+#define EBADFD_STR          "File descriptor in bad state"
+#define EREMCHG             82                         /* Linux errno extension */
+#define EREMCHG_STR         "Remote address changed"
+#define ELIBACC             83                         /* Linux errno extension */
+#define ELIBACC_STR         "Can not access a needed shared library"
+#define ELIBBAD             84                         /* Linux errno extension */
+#define ELIBBAD_STR         "Accessing a corrupted shared library"
+#define ELIBSCN             85                         /* Linux errno extension */
+#define ELIBSCN_STR         ".lib section in a.out corrupted"
+#define ELIBMAX             86                         /* Linux errno extension */
+#define ELIBMAX_STR         "Attempting to link in too many shared libraries"
+#define ELIBEXEC            87                         /* Linux errno extension */
+#define ELIBEXEC_STR        "Cannot exec a shared library directly"
+#define ENOSYS              88
+#define ENOSYS_STR          "Function not implemented"
+#define ENMFILE             89                         /* Cygwin */
+#define ENMFILE_STR         "No more files"
+#define ENOTEMPTY           90
+#define ENOTEMPTY_STR       "Directory not empty"
+#define ENAMETOOLONG        91
+#define ENAMETOOLONG_STR    "File name too long"
+#define ELOOP               92
+#define ELOOP_STR           "Too many symbolic links encountered"
+
+#define EOPNOTSUPP          95
+#define EOPNOTSUPP_STR      "Operation not supported on transport endpoint"
+#define EPFNOSUPPORT        96
+#define EPFNOSUPPORT_STR    "Protocol family not supported"
+
+#define ECONNRESET          104
+#define ECONNRESET_STR      "Connection reset by peer"
+#define ENOBUFS             105
+#define ENOBUFS_STR         "No buffer space available"
+#define EAFNOSUPPORT        106
+#define EAFNOSUPPORT_STR    "Address family not supported by protocol"
+#define EPROTOTYPE          107
+#define EPROTOTYPE_STR      "Protocol wrong type for socket"
+#define ENOTSOCK            108
+#define ENOTSOCK_STR        "Socket operation on non-socket"
+#define ENOPROTOOPT         109
+#define ENOPROTOOPT_STR     "Protocol not available"
+#define ESHUTDOWN           110                         /* Linux errno extension */
+#define ESHUTDOWN_STR       "Cannot send after transport endpoint shutdown"
+#define ECONNREFUSED        111
+#define ECONNREFUSED_STR    "Connection refused"
+#define EADDRINUSE          112
+#define EADDRINUSE_STR      "Address already in use"
+#define ECONNABORTED        113
+#define ECONNABORTED_STR    "Software caused connection abort"
+#define ENETUNREACH         114
+#define ENETUNREACH_STR     "Network is unreachable"
+#define ENETDOWN            115
+#define ENETDOWN_STR        "Network is down"
+#define ETIMEDOUT           116
+#define ETIMEDOUT_STR       "Connection timed out"
+#define EHOSTDOWN           117
+#define EHOSTDOWN_STR       "Host is down"
+#define EHOSTUNREACH        118
+#define EHOSTUNREACH_STR    "No route to host"
+#define EINPROGRESS         119
+#define EINPROGRESS_STR     "Operation now in progress"
+#define EALREADY            120
+#define EALREADY_STR        "Socket already connected"
+#define EDESTADDRREQ        121
+#define EDESTADDRREQ_STR    "Destination address required"
+#define EMSGSIZE            122
+#define EMSGSIZE_STR        "Message too long"
+#define EPROTONOSUPPORT     123
+#define EPROTONOSUPPORT_STR "Protocol not supported"
+#define ESOCKTNOSUPPORT     124                         /* Linux errno extension */
+#define ESOCKTNOSUPPORT_STR "Socket type not supported"
+#define EADDRNOTAVAIL       125
+#define EADDRNOTAVAIL_STR   "Cannot assign requested address"
+#define ENETRESET           126
+#define ENETRESET_STR       "Network dropped connection because of reset"
+#define EISCONN             127
+#define EISCONN_STR         "Transport endpoint is already connected"
+#define ENOTCONN            128
+#define ENOTCONN_STR        "Transport endpoint is not connected"
+#define ETOOMANYREFS        129
+#define ETOOMANYREFS_STR    "Too many references: cannot splice"
+#define EPROCLIM            130
+#define EPROCLIM_STR        "Limit would be exceeded by attempted fork"
+#define EUSERS              131
+#define EUSERS_STR          "Too many users"
+#define EDQUOT              132
+#define EDQUOT_STR          "Quota exceeded"
+#define ESTALE              133
+#define ESTALE_STR          "Stale NFS file handle"
+#define ENOTSUP             134
+#define ENOTSUP_STR         "Not supported"
+#define ENOMEDIUM           135                         /* Linux errno extension */
+#define ENOMEDIUM_STR       "No medium found"
+#define ENOSHARE            136                         /* Cygwin */
+#define ENOSHARE_STR        "No such host or network path"
+#define ECASECLASH          137                         /* Cygwin */
+#define ECASECLASH_STR      "Filename exists with different case"
+#define EILSEQ              138
+#define EILSEQ_STR          "Illegal byte sequence"
+#define EOVERFLOW           139
+#define EOVERFLOW_STR       "Value too large for defined data type"
+#define ECANCELED           140
+#define ECANCELED_STR       "Operation cancelled"
+#define ENOTRECOVERABLE     141
+#define ENOTRECOVERABLE_STR "State not recoverable"
+#define EOWNERDEAD          142
+#define EOWNERDEAD_STR      "Previous owner died"
+#define ESTRPIPE            143                         /* Linux errno extension */
+#define ESTRPIPE_STR        "Streams pipe error"
+
+#define __ELASTERROR        2000                        /* Users can add values starting here */
+
+/****************************************************************************
+ * Public Type Definitions
+ ****************************************************************************/
+
+/****************************************************************************
+ * Public Function Prototypes
+ ****************************************************************************/
+
+#undef EXTERN
+#if defined(__cplusplus)
+#define EXTERN extern "C"
+extern "C"
+{
+#else
+#define EXTERN extern
+#endif
+
+/* Return a pointer to the thread specific errno. */
+
+int *__errno(void);
+
+#undef EXTERN
+#if defined(__cplusplus)
+}
+#endif
+
+#endif /* __INCLUDE_ERRNO_H */
diff --git a/common/usb_list.h b/common/usb_list.h
new file mode 100644
index 00000000..55111fda
--- /dev/null
+++ b/common/usb_list.h
@@ -0,0 +1,473 @@
+/**
+ * @file usb_list.h
+ * @brief
+ *
+ * Copyright (c) 2022 sakumisu
+ *
+ * Licensed to the Apache Software Foundation (ASF) under one or more
+ * contributor license agreements.  See the NOTICE file distributed with
+ * this work for additional information regarding copyright ownership.  The
+ * ASF licenses this file to you under the Apache License, Version 2.0 (the
+ * "License"); you may not use this file except in compliance with the
+ * License.  You may obtain a copy of the License at
+ *
+ *   http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
+ * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.  See the
+ * License for the specific language governing permissions and limitations
+ * under the License.
+ *
+ */
+#ifndef __USB_LIST_H__
+#define __USB_LIST_H__
+
+#include <string.h>
+#include <stdint.h>
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+/**
+ * usb_container_of - return the member address of ptr, if the type of ptr is the
+ * struct type.
+ */
+#define usb_container_of(ptr, type, member) \
+    ((type *)((char *)(ptr) - (unsigned long)(&((type *)0)->member)))
+
+/**
+ * Single List structure
+ */
+struct usb_slist_node {
+    struct usb_slist_node *next; /**< point to next node. */
+};
+typedef struct usb_slist_node usb_slist_t; /**< Type for single list. */
+
+/**
+ * @brief initialize a single list
+ *
+ * @param l the single list to be initialized
+ */
+static inline void usb_slist_init(usb_slist_t *l)
+{
+    l->next = NULL;
+}
+
+static inline void usb_slist_add_head(usb_slist_t *l, usb_slist_t *n)
+{
+    n->next = l->next;
+    l->next = n;
+}
+
+static inline void usb_slist_add_tail(usb_slist_t *l, usb_slist_t *n)
+{
+    while (l->next) {
+        l = l->next;
+    }
+
+    /* append the node to the tail */
+    l->next = n;
+    n->next = NULL;
+}
+
+static inline void usb_slist_insert(usb_slist_t *l, usb_slist_t *next, usb_slist_t *n)
+{
+    if (!next) {
+        usb_slist_add_tail(next, l);
+        return;
+    }
+
+    while (l->next) {
+        if (l->next == next) {
+            l->next = n;
+            n->next = next;
+        }
+
+        l = l->next;
+    }
+}
+
+static inline usb_slist_t *usb_slist_remove(usb_slist_t *l, usb_slist_t *n)
+{
+    /* remove slist head */
+    while (l->next && l->next != n) {
+        l = l->next;
+    }
+
+    /* remove node */
+    if (l->next != (usb_slist_t *)0) {
+        l->next = l->next->next;
+    }
+
+    return l;
+}
+
+static inline unsigned int usb_slist_len(const usb_slist_t *l)
+{
+    unsigned int len = 0;
+    const usb_slist_t *list = l->next;
+
+    while (list != NULL) {
+        list = list->next;
+        len++;
+    }
+
+    return len;
+}
+
+static inline unsigned int usb_slist_contains(usb_slist_t *l, usb_slist_t *n)
+{
+    while (l->next) {
+        if (l->next == n) {
+            return 0;
+        }
+
+        l = l->next;
+    }
+
+    return 1;
+}
+
+static inline usb_slist_t *usb_slist_head(usb_slist_t *l)
+{
+    return l->next;
+}
+
+static inline usb_slist_t *usb_slist_tail(usb_slist_t *l)
+{
+    while (l->next) {
+        l = l->next;
+    }
+
+    return l;
+}
+
+static inline usb_slist_t *usb_slist_next(usb_slist_t *n)
+{
+    return n->next;
+}
+
+static inline int usb_slist_isempty(usb_slist_t *l)
+{
+    return l->next == NULL;
+}
+
+/**
+ * @brief initialize a slist object
+ */
+#define USB_SLIST_OBJECT_INIT(object) \
+    {                                 \
+        NULL                          \
+    }
+
+/**
+ * @brief initialize a slist object
+ */
+#define USB_SLIST_DEFINE(slist) \
+    usb_slist_t slist = { NULL }
+
+/**
+ * @brief get the struct for this single list node
+ * @param node the entry point
+ * @param type the type of structure
+ * @param member the name of list in structure
+ */
+#define usb_slist_entry(node, type, member) \
+    usb_container_of(node, type, member)
+
+/**
+ * usb_slist_first_entry - get the first element from a slist
+ * @ptr:    the slist head to take the element from.
+ * @type:   the type of the struct this is embedded in.
+ * @member: the name of the slist_struct within the struct.
+ *
+ * Note, that slist is expected to be not empty.
+ */
+#define usb_slist_first_entry(ptr, type, member) \
+    usb_slist_entry((ptr)->next, type, member)
+
+/**
+ * usb_slist_tail_entry - get the tail element from a slist
+ * @ptr:    the slist head to take the element from.
+ * @type:   the type of the struct this is embedded in.
+ * @member: the name of the slist_struct within the struct.
+ *
+ * Note, that slist is expected to be not empty.
+ */
+#define usb_slist_tail_entry(ptr, type, member) \
+    usb_slist_entry(usb_slist_tail(ptr), type, member)
+
+/**
+ * usb_slist_first_entry_or_null - get the first element from a slist
+ * @ptr:    the slist head to take the element from.
+ * @type:   the type of the struct this is embedded in.
+ * @member: the name of the slist_struct within the struct.
+ *
+ * Note, that slist is expected to be not empty.
+ */
+#define usb_slist_first_entry_or_null(ptr, type, member) \
+    (usb_slist_isempty(ptr) ? NULL : usb_slist_first_entry(ptr, type, member))
+
+/**
+ * usb_slist_for_each - iterate over a single list
+ * @pos:    the usb_slist_t * to use as a loop cursor.
+ * @head:   the head for your single list.
+ */
+#define usb_slist_for_each(pos, head) \
+    for (pos = (head)->next; pos != NULL; pos = pos->next)
+
+#define usb_slist_for_each_safe(pos, next, head)    \
+    for (pos = (head)->next, next = pos->next; pos; \
+         pos = next, next = pos->next)
+
+/**
+ * usb_slist_for_each_entry  -   iterate over single list of given type
+ * @pos:    the type * to use as a loop cursor.
+ * @head:   the head for your single list.
+ * @member: the name of the list_struct within the struct.
+ */
+#define usb_slist_for_each_entry(pos, head, member)                 \
+    for (pos = usb_slist_entry((head)->next, typeof(*pos), member); \
+         &pos->member != (NULL);                                    \
+         pos = usb_slist_entry(pos->member.next, typeof(*pos), member))
+
+#define usb_slist_for_each_entry_safe(pos, n, head, member)          \
+    for (pos = usb_slist_entry((head)->next, typeof(*pos), member),  \
+        n = usb_slist_entry(pos->member.next, typeof(*pos), member); \
+         &pos->member != (NULL);                                     \
+         pos = n, n = usb_slist_entry(pos->member.next, typeof(*pos), member))
+
+/**
+ * Double List structure
+ */
+struct usb_dlist_node {
+    struct usb_dlist_node *next; /**< point to next node. */
+    struct usb_dlist_node *prev; /**< point to prev node. */
+};
+typedef struct usb_dlist_node usb_dlist_t; /**< Type for lists. */
+
+/**
+ * @brief initialize a list
+ *
+ * @param l list to be initialized
+ */
+static inline void usb_dlist_init(usb_dlist_t *l)
+{
+    l->next = l->prev = l;
+}
+
+/**
+ * @brief insert a node after a list
+ *
+ * @param l list to insert it
+ * @param n new node to be inserted
+ */
+static inline void usb_dlist_insert_after(usb_dlist_t *l, usb_dlist_t *n)
+{
+    l->next->prev = n;
+    n->next = l->next;
+
+    l->next = n;
+    n->prev = l;
+}
+
+/**
+ * @brief insert a node before a list
+ *
+ * @param n new node to be inserted
+ * @param l list to insert it
+ */
+static inline void usb_dlist_insert_before(usb_dlist_t *l, usb_dlist_t *n)
+{
+    l->prev->next = n;
+    n->prev = l->prev;
+
+    l->prev = n;
+    n->next = l;
+}
+
+/**
+ * @brief remove node from list.
+ * @param n the node to remove from the list.
+ */
+static inline void usb_dlist_remove(usb_dlist_t *n)
+{
+    n->next->prev = n->prev;
+    n->prev->next = n->next;
+
+    n->next = n->prev = n;
+}
+
+/**
+ * @brief move node from list.
+ * @param n the node to remove from the list.
+ */
+static inline void usb_dlist_move_head(usb_dlist_t *l, usb_dlist_t *n)
+{
+    usb_dlist_remove(n);
+    usb_dlist_insert_after(l, n);
+}
+
+/**
+ * @brief move node from list.
+ * @param n the node to remove from the list.
+ */
+static inline void usb_dlist_move_tail(usb_dlist_t *l, usb_dlist_t *n)
+{
+    usb_dlist_remove(n);
+    usb_dlist_insert_before(l, n);
+}
+
+/**
+ * @brief tests whether a list is empty
+ * @param l the list to test.
+ */
+static inline int usb_dlist_isempty(const usb_dlist_t *l)
+{
+    return l->next == l;
+}
+
+/**
+ * @brief get the list length
+ * @param l the list to get.
+ */
+static inline unsigned int usb_dlist_len(const usb_dlist_t *l)
+{
+    unsigned int len = 0;
+    const usb_dlist_t *p = l;
+
+    while (p->next != l) {
+        p = p->next;
+        len++;
+    }
+
+    return len;
+}
+
+/**
+ * @brief initialize a dlist object
+ */
+#define USB_DLIST_OBJECT_INIT(object) \
+    {                             \
+        &(object), &(object)      \
+    }
+/**
+ * @brief initialize a dlist object
+ */
+#define USB_DLIST_DEFINE(list) \
+    usb_dlist_t list = { &(list), &(list) }
+
+/**
+ * @brief get the struct for this entry
+ * @param node the entry point
+ * @param type the type of structure
+ * @param member the name of list in structure
+ */
+#define usb_dlist_entry(node, type, member) \
+    usb_container_of(node, type, member)
+
+/**
+ * dlist_first_entry - get the first element from a list
+ * @ptr:    the list head to take the element from.
+ * @type:   the type of the struct this is embedded in.
+ * @member: the name of the list_struct within the struct.
+ *
+ * Note, that list is expected to be not empty.
+ */
+#define usb_dlist_first_entry(ptr, type, member) \
+    usb_dlist_entry((ptr)->next, type, member)
+/**
+ * dlist_first_entry_or_null - get the first element from a list
+ * @ptr:    the list head to take the element from.
+ * @type:   the type of the struct this is embedded in.
+ * @member: the name of the list_struct within the struct.
+ *
+ * Note, that list is expected to be not empty.
+ */
+#define usb_dlist_first_entry_or_null(ptr, type, member) \
+    (usb_dlist_isempty(ptr) ? NULL : usb_dlist_first_entry(ptr, type, member))
+
+/**
+ * usb_dlist_for_each - iterate over a list
+ * @pos:    the usb_dlist_t * to use as a loop cursor.
+ * @head:   the head for your list.
+ */
+#define usb_dlist_for_each(pos, head) \
+    for (pos = (head)->next; pos != (head); pos = pos->next)
+
+/**
+ * usb_dlist_for_each_prev - iterate over a list
+ * @pos:    the dlist_t * to use as a loop cursor.
+ * @head:   the head for your list.
+ */
+#define usb_dlist_for_each_prev(pos, head) \
+    for (pos = (head)->prev; pos != (head); pos = pos->prev)
+
+/**
+ * usb_dlist_for_each_safe - iterate over a list safe against removal of list entry
+ * @pos:    the dlist_t * to use as a loop cursor.
+ * @n:      another dlist_t * to use as temporary storage
+ * @head:   the head for your list.
+ */
+#define usb_dlist_for_each_safe(pos, n, head)                  \
+    for (pos = (head)->next, n = pos->next; pos != (head); \
+         pos = n, n = pos->next)
+
+#define usb_dlist_for_each_prev_safe(pos, n, head)             \
+    for (pos = (head)->prev, n = pos->prev; pos != (head); \
+         pos = n, n = pos->prev)
+/**
+ * usb_dlist_for_each_entry  -   iterate over list of given type
+ * @pos:    the type * to use as a loop cursor.
+ * @head:   the head for your list.
+ * @member: the name of the list_struct within the struct.
+ */
+#define usb_dlist_for_each_entry(pos, head, member)                 \
+    for (pos = usb_dlist_entry((head)->next, typeof(*pos), member); \
+         &pos->member != (head);                                \
+         pos = usb_dlist_entry(pos->member.next, typeof(*pos), member))
+
+/**
+ * usb_usb_dlist_for_each_entry_reverse  -   iterate over list of given type
+ * @pos:    the type * to use as a loop cursor.
+ * @head:   the head for your list.
+ * @member: the name of the list_struct within the struct.
+ */
+#define usb_dlist_for_each_entry_reverse(pos, head, member)         \
+    for (pos = usb_dlist_entry((head)->prev, typeof(*pos), member); \
+         &pos->member != (head);                                \
+         pos = usb_dlist_entry(pos->member.prev, typeof(*pos), member))
+
+/**
+ * usb_usb_dlist_for_each_entry_safe - iterate over list of given type safe against removal of list entry
+ * @pos:    the type * to use as a loop cursor.
+ * @n:      another type * to use as temporary storage
+ * @head:   the head for your list.
+ * @member: the name of the list_struct within the struct.
+ */
+#define usb_dlist_for_each_entry_safe(pos, n, head, member)          \
+    for (pos = usb_dlist_entry((head)->next, typeof(*pos), member),  \
+        n = usb_dlist_entry(pos->member.next, typeof(*pos), member); \
+         &pos->member != (head);                                 \
+         pos = n, n = usb_dlist_entry(n->member.next, typeof(*n), member))
+
+/**
+ * usb_usb_dlist_for_each_entry_safe - iterate over list of given type safe against removal of list entry
+ * @pos:    the type * to use as a loop cursor.
+ * @n:      another type * to use as temporary storage
+ * @head:   the head for your list.
+ * @member: the name of the list_struct within the struct.
+ */
+#define usb_dlist_for_each_entry_safe_reverse(pos, n, head, member)  \
+    for (pos = usb_dlist_entry((head)->prev, typeof(*pos), field),   \
+        n = usb_dlist_entry(pos->member.prev, typeof(*pos), member); \
+         &pos->member != (head);                                 \
+         pos = n, n = usb_dlist_entry(pos->member.prev, typeof(*pos), member))
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
diff --git a/common/usb_mem.h b/common/usb_mem.h
new file mode 100644
index 00000000..776786b0
--- /dev/null
+++ b/common/usb_mem.h
@@ -0,0 +1,74 @@
+/**
+ * @file usb_mem.h
+ * @brief
+ *
+ * Copyright (c) 2022 sakumisu
+ *
+ * Licensed to the Apache Software Foundation (ASF) under one or more
+ * contributor license agreements.  See the NOTICE file distributed with
+ * this work for additional information regarding copyright ownership.  The
+ * ASF licenses this file to you under the Apache License, Version 2.0 (the
+ * "License"); you may not use this file except in compliance with the
+ * License.  You may obtain a copy of the License at
+ *
+ *   http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
+ * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.  See the
+ * License for the specific language governing permissions and limitations
+ * under the License.
+ *
+ */
+#ifndef _USB_MEM_H
+
+//#include <stdint.h>
+//#include <stdio.h>
+//#include <stdlib.h>
+//#include <malloc.h>
+
+#define DCACHE_LINE_SIZE 32
+#define DCACHE_LINEMASK (DCACHE_LINE_SIZE -1)
+
+#ifdef CONFIG_USB_DCACHE_ENABLE
+#define USB_NOCACHE_RAM_SECTION __attribute__((section(".nocache_ram")))
+#else
+#define USB_NOCACHE_RAM_SECTION
+#endif
+
+static inline void *usb_malloc(size_t size)
+{
+    return malloc(size);
+}
+
+static inline void usb_free(void *ptr)
+{
+    free(ptr);
+}
+
+#ifdef CONFIG_USB_DCACHE_ENABLE
+static inline void *usb_iomalloc(size_t size)
+{
+    size  = (size + DCACHE_LINEMASK) & ~DCACHE_LINEMASK;
+    uint32_t no_cache_addr = (uint32_t)(uintptr_t)memalign(DCACHE_LINE_SIZE, size) & ~(1 << 30);
+    return (void *)no_cache_addr;
+}
+
+static inline void usb_iofree(void *addr)
+{
+    uint32_t cache_addr = (uint32_t)(uintptr_t)addr | (1 << 30);
+    free((void *)cache_addr);
+}
+#else
+static inline void *usb_iomalloc(size_t size)
+{
+    return malloc(size);
+}
+
+static inline void usb_iofree(void *ptr)
+{
+    free(ptr);
+}
+#endif
+
+#endif
\ No newline at end of file
diff --git a/common/usb_slist.h b/common/usb_slist.h
deleted file mode 100644
index 30b08538..00000000
--- a/common/usb_slist.h
+++ /dev/null
@@ -1,246 +0,0 @@
-/**

- * @file usb_slist.h

- * @brief

- *

- * Copyright (c) 2022 sakumisu

- *

- * Licensed to the Apache Software Foundation (ASF) under one or more

- * contributor license agreements.  See the NOTICE file distributed with

- * this work for additional information regarding copyright ownership.  The

- * ASF licenses this file to you under the Apache License, Version 2.0 (the

- * "License"); you may not use this file except in compliance with the

- * License.  You may obtain a copy of the License at

- *

- *   http://www.apache.org/licenses/LICENSE-2.0

- *

- * Unless required by applicable law or agreed to in writing, software

- * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT

- * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.  See the

- * License for the specific language governing permissions and limitations

- * under the License.

- *

- */

-#ifndef __USB_SLIST_H__

-#define __USB_SLIST_H__

-

-#include <string.h>

-#include <stdint.h>

-

-#ifdef __cplusplus

-extern "C" {

-#endif

-

-/**

- * usb_container_of - return the member address of ptr, if the type of ptr is the

- * struct type.

- */

-#define usb_container_of(ptr, type, member) \

-    ((type *)((char *)(ptr) - (unsigned long)(&((type *)0)->member)))

-

-/**

- * Single List structure

- */

-struct usb_slist_node {

-    struct usb_slist_node *next; /**< point to next node. */

-};

-typedef struct usb_slist_node usb_slist_t; /**< Type for single list. */

-

-/**

- * @brief initialize a single list

- *

- * @param l the single list to be initialized

- */

-static inline void usb_slist_init(usb_slist_t *l)

-{

-    l->next = NULL;

-}

-

-static inline void usb_slist_add_head(usb_slist_t *l, usb_slist_t *n)

-{

-    n->next = l->next;

-    l->next = n;

-}

-

-static inline void usb_slist_add_tail(usb_slist_t *l, usb_slist_t *n)

-{

-    while (l->next) {

-        l = l->next;

-    }

-

-    /* append the node to the tail */

-    l->next = n;

-    n->next = NULL;

-}

-

-static inline void usb_slist_insert(usb_slist_t *l, usb_slist_t *next, usb_slist_t *n)

-{

-    if (!next) {

-        usb_slist_add_tail(next, l);

-        return;

-    }

-

-    while (l->next) {

-        if (l->next == next) {

-            l->next = n;

-            n->next = next;

-        }

-

-        l = l->next;

-    }

-}

-

-static inline usb_slist_t *usb_slist_remove(usb_slist_t *l, usb_slist_t *n)

-{

-    /* remove slist head */

-    while (l->next && l->next != n) {

-        l = l->next;

-    }

-

-    /* remove node */

-    if (l->next != (usb_slist_t *)0) {

-        l->next = l->next->next;

-    }

-

-    return l;

-}

-

-static inline unsigned int usb_slist_len(const usb_slist_t *l)

-{

-    unsigned int len = 0;

-    const usb_slist_t *list = l->next;

-

-    while (list != NULL) {

-        list = list->next;

-        len++;

-    }

-

-    return len;

-}

-

-static inline unsigned int usb_slist_contains(usb_slist_t *l, usb_slist_t *n)

-{

-    while (l->next) {

-        if (l->next == n) {

-            return 0;

-        }

-

-        l = l->next;

-    }

-

-    return 1;

-}

-

-static inline usb_slist_t *usb_slist_head(usb_slist_t *l)

-{

-    return l->next;

-}

-

-static inline usb_slist_t *usb_slist_tail(usb_slist_t *l)

-{

-    while (l->next) {

-        l = l->next;

-    }

-

-    return l;

-}

-

-static inline usb_slist_t *usb_slist_next(usb_slist_t *n)

-{

-    return n->next;

-}

-

-static inline int usb_slist_isempty(usb_slist_t *l)

-{

-    return l->next == NULL;

-}

-

-/**

- * @brief initialize a slist object

- */

-#define USB_SLIST_OBJECT_INIT(object) \

-    {                                 \

-        NULL                          \

-    }

-

-/**

- * @brief initialize a slist object

- */

-#define USB_SLIST_DEFINE(slist) \

-    usb_slist_t slist = { NULL }

-

-/**

- * @brief get the struct for this single list node

- * @param node the entry point

- * @param type the type of structure

- * @param member the name of list in structure

- */

-#define usb_slist_entry(node, type, member) \

-    usb_container_of(node, type, member)

-

-/**

- * usb_slist_first_entry - get the first element from a slist

- * @ptr:    the slist head to take the element from.

- * @type:   the type of the struct this is embedded in.

- * @member: the name of the slist_struct within the struct.

- *

- * Note, that slist is expected to be not empty.

- */

-#define usb_slist_first_entry(ptr, type, member) \

-    usb_slist_entry((ptr)->next, type, member)

-

-/**

- * usb_slist_tail_entry - get the tail element from a slist

- * @ptr:    the slist head to take the element from.

- * @type:   the type of the struct this is embedded in.

- * @member: the name of the slist_struct within the struct.

- *

- * Note, that slist is expected to be not empty.

- */

-#define usb_slist_tail_entry(ptr, type, member) \

-    usb_slist_entry(usb_slist_tail(ptr), type, member)

-

-/**

- * usb_slist_first_entry_or_null - get the first element from a slist

- * @ptr:    the slist head to take the element from.

- * @type:   the type of the struct this is embedded in.

- * @member: the name of the slist_struct within the struct.

- *

- * Note, that slist is expected to be not empty.

- */

-#define usb_slist_first_entry_or_null(ptr, type, member) \

-    (usb_slist_isempty(ptr) ? NULL : usb_slist_first_entry(ptr, type, member))

-

-/**

- * usb_slist_for_each - iterate over a single list

- * @pos:    the usb_slist_t * to use as a loop cursor.

- * @head:   the head for your single list.

- */

-#define usb_slist_for_each(pos, head) \

-    for (pos = (head)->next; pos != NULL; pos = pos->next)

-

-#define usb_slist_for_each_safe(pos, next, head)    \

-    for (pos = (head)->next, next = pos->next; pos; \

-         pos = next, next = pos->next)

-

-/**

- * usb_slist_for_each_entry  -   iterate over single list of given type

- * @pos:    the type * to use as a loop cursor.

- * @head:   the head for your single list.

- * @member: the name of the list_struct within the struct.

- */

-#define usb_slist_for_each_entry(pos, head, member)                 \

-    for (pos = usb_slist_entry((head)->next, typeof(*pos), member); \

-         &pos->member != (NULL);                                    \

-         pos = usb_slist_entry(pos->member.next, typeof(*pos), member))

-

-#define usb_slist_for_each_entry_safe(pos, n, head, member)          \

-    for (pos = usb_slist_entry((head)->next, typeof(*pos), member),  \

-        n = usb_slist_entry(pos->member.next, typeof(*pos), member); \

-         &pos->member != (NULL);                                     \

-         pos = n, n = usb_slist_entry(pos->member.next, typeof(*pos), member))

-

-#ifdef __cplusplus

-}

-#endif

-

-#endif

diff --git a/common/usb_util.h b/common/usb_util.h
index 441d0a3f..ab4eb693 100644
--- a/common/usb_util.h
+++ b/common/usb_util.h
@@ -28,7 +28,9 @@
 #include <stdint.h>

 #include <stdio.h>

 #include <stdlib.h>

-#include "usb_slist.h"

+#include "usb_errno.h"

+#include "usb_list.h"

+#include "usb_mem.h"

 

 #if defined(__CC_ARM)

 #ifndef __USED

@@ -288,4 +290,11 @@
 #define USB_LOG_ERR(...)

 #endif

 

+void usb_assert(const char *filename, int linenum);

+#define USB_ASSERT(f)                       \

+    do {                                    \

+        if (!(f))                           \

+            usb_assert(__FILE__, __LINE__); \

+    } while (0)

+

 #endif