325 lines
8.4 KiB
C
325 lines
8.4 KiB
C
/**
|
|
* @file usb_util.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_UTIL_H
|
|
#define _USB_UTIL_H
|
|
|
|
#include <stdbool.h>
|
|
#include <string.h>
|
|
#include <stdint.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include "usb_errno.h"
|
|
#include "usb_list.h"
|
|
#include "usb_mem.h"
|
|
|
|
#if defined(__CC_ARM)
|
|
#ifndef __USED
|
|
#define __USED __attribute__((used))
|
|
#endif
|
|
#ifndef __WEAK
|
|
#define __WEAK __attribute__((weak))
|
|
#endif
|
|
#ifndef __PACKED
|
|
#define __PACKED __attribute__((packed))
|
|
#endif
|
|
#ifndef __PACKED_STRUCT
|
|
#define __PACKED_STRUCT __packed struct
|
|
#endif
|
|
#ifndef __PACKED_UNION
|
|
#define __PACKED_UNION __packed union
|
|
#endif
|
|
#ifndef __ALIGNED
|
|
#define __ALIGNED(x) __attribute__((aligned(x)))
|
|
#endif
|
|
#elif defined(__GNUC__)
|
|
#ifndef __USED
|
|
#define __USED __attribute__((used))
|
|
#endif
|
|
#ifndef __WEAK
|
|
#define __WEAK __attribute__((weak))
|
|
#endif
|
|
#ifndef __PACKED
|
|
#define __PACKED __attribute__((packed, aligned(1)))
|
|
#endif
|
|
#ifndef __PACKED_STRUCT
|
|
#define __PACKED_STRUCT struct __attribute__((packed, aligned(1)))
|
|
#endif
|
|
#ifndef __PACKED_UNION
|
|
#define __PACKED_UNION union __attribute__((packed, aligned(1)))
|
|
#endif
|
|
#ifndef __ALIGNED
|
|
#define __ALIGNED(x) __attribute__((aligned(x)))
|
|
#endif
|
|
#elif defined(__ICCARM__)
|
|
#ifndef __USED
|
|
#if __ICCARM_V8
|
|
#define __USED __attribute__((used))
|
|
#else
|
|
#define __USED _Pragma("__root")
|
|
#endif
|
|
#endif
|
|
|
|
#ifndef __WEAK
|
|
#if __ICCARM_V8
|
|
#define __WEAK __attribute__((weak))
|
|
#else
|
|
#define __WEAK _Pragma("__weak")
|
|
#endif
|
|
#endif
|
|
|
|
#ifndef __PACKED
|
|
#if __ICCARM_V8
|
|
#define __PACKED __attribute__((packed, aligned(1)))
|
|
#else
|
|
/* Needs IAR language extensions */
|
|
#define __PACKED __packed
|
|
#endif
|
|
#endif
|
|
|
|
#ifndef __PACKED_STRUCT
|
|
#if __ICCARM_V8
|
|
#define __PACKED_STRUCT struct __attribute__((packed, aligned(1)))
|
|
#else
|
|
/* Needs IAR language extensions */
|
|
#define __PACKED_STRUCT __packed struct
|
|
#endif
|
|
#endif
|
|
|
|
#ifndef __PACKED_UNION
|
|
#if __ICCARM_V8
|
|
#define __PACKED_UNION union __attribute__((packed, aligned(1)))
|
|
#else
|
|
/* Needs IAR language extensions */
|
|
#define __PACKED_UNION __packed union
|
|
#endif
|
|
#endif
|
|
|
|
#ifndef __ALIGNED
|
|
#if __ICCARM_V8
|
|
#define __ALIGNED(x) __attribute__((aligned(x)))
|
|
#elif (__VER__ >= 7080000)
|
|
/* Needs IAR language extensions */
|
|
#define __ALIGNED(x) __attribute__((aligned(x)))
|
|
#else
|
|
#warning No compiler specific solution for __ALIGNED.__ALIGNED is ignored.
|
|
#define __ALIGNED(x)
|
|
#endif
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#ifndef __ALIGN_BEGIN
|
|
#define __ALIGN_BEGIN
|
|
#endif
|
|
#ifndef __ALIGN_END
|
|
#define __ALIGN_END __attribute__((aligned(4)))
|
|
#endif
|
|
|
|
#ifndef ARG_UNUSED
|
|
#define ARG_UNUSED(x) (void)(x)
|
|
#endif
|
|
|
|
#ifndef LO_BYTE
|
|
#define LO_BYTE(x) ((uint8_t)(x & 0x00FF))
|
|
#endif
|
|
|
|
#ifndef HI_BYTE
|
|
#define HI_BYTE(x) ((uint8_t)((x & 0xFF00) >> 8))
|
|
#endif
|
|
|
|
/**
|
|
* @def MAX
|
|
* @brief The larger value between @p a and @p b.
|
|
* @note Arguments are evaluated twice.
|
|
*/
|
|
#ifndef MAX
|
|
/* Use Z_MAX for a GCC-only, single evaluation version */
|
|
#define MAX(a, b) (((a) > (b)) ? (a) : (b))
|
|
#endif
|
|
|
|
/**
|
|
* @def MIN
|
|
* @brief The smaller value between @p a and @p b.
|
|
* @note Arguments are evaluated twice.
|
|
*/
|
|
#ifndef MIN
|
|
/* Use Z_MIN for a GCC-only, single evaluation version */
|
|
#define MIN(a, b) (((a) < (b)) ? (a) : (b))
|
|
#endif
|
|
|
|
#ifndef BCD
|
|
#define BCD(x) ((((x) / 10) << 4) | ((x) % 10))
|
|
#endif
|
|
|
|
#ifdef BIT
|
|
#undef BIT
|
|
#define BIT(n) (1UL << (n))
|
|
#else
|
|
#define BIT(n) (1UL << (n))
|
|
#endif
|
|
|
|
#ifndef ARRAY_SIZE
|
|
#define ARRAY_SIZE(array) \
|
|
((int)((sizeof(array) / sizeof((array)[0]))))
|
|
#endif
|
|
|
|
#ifndef BSWAP16
|
|
#define BSWAP16(u16) (__builtin_bswap16(u16))
|
|
#endif
|
|
#ifndef BSWAP32
|
|
#define BSWAP32(u32) (__builtin_bswap32(u32))
|
|
#endif
|
|
|
|
#define GET_BE16(field) \
|
|
(((uint16_t)(field)[0] << 8) | ((uint16_t)(field)[1]))
|
|
|
|
#define GET_BE32(field) \
|
|
(((uint32_t)(field)[0] << 24) | ((uint32_t)(field)[1] << 16) | ((uint32_t)(field)[2] << 8) | ((uint32_t)(field)[3] << 0))
|
|
|
|
#define SET_BE16(field, value) \
|
|
do { \
|
|
(field)[0] = (uint8_t)((value) >> 8); \
|
|
(field)[1] = (uint8_t)((value) >> 0); \
|
|
} while (0)
|
|
|
|
#define SET_BE24(field, value) \
|
|
do { \
|
|
(field)[0] = (uint8_t)((value) >> 16); \
|
|
(field)[1] = (uint8_t)((value) >> 8); \
|
|
(field)[2] = (uint8_t)((value) >> 0); \
|
|
} while (0)
|
|
|
|
#define SET_BE32(field, value) \
|
|
do { \
|
|
(field)[0] = (uint8_t)((value) >> 24); \
|
|
(field)[1] = (uint8_t)((value) >> 16); \
|
|
(field)[2] = (uint8_t)((value) >> 8); \
|
|
(field)[3] = (uint8_t)((value) >> 0); \
|
|
} while (0)
|
|
|
|
#define REQTYPE_GET_DIR(x) (((x) >> 7) & 0x01)
|
|
#define REQTYPE_GET_TYPE(x) (((x) >> 5) & 0x03U)
|
|
#define REQTYPE_GET_RECIP(x) ((x)&0x1F)
|
|
|
|
#define GET_DESC_TYPE(x) (((x) >> 8) & 0xFFU)
|
|
#define GET_DESC_INDEX(x) ((x)&0xFFU)
|
|
|
|
#define WBVAL(x) (x & 0xFF), ((x >> 8) & 0xFF)
|
|
#define DBVAL(x) (x & 0xFF), ((x >> 8) & 0xFF), ((x >> 16) & 0xFF), ((x >> 24) & 0xFF)
|
|
|
|
#define PP_NARG(...) \
|
|
PP_NARG_(__VA_ARGS__, PP_RSEQ_N())
|
|
#define PP_NARG_(...) \
|
|
PP_ARG_N(__VA_ARGS__)
|
|
#define PP_ARG_N( \
|
|
_1, _2, _3, _4, _5, _6, _7, _8, _9, _10, \
|
|
_11, _12, _13, _14, _15, _16, _17, _18, _19, _20, \
|
|
_21, _22, _23, _24, _25, _26, _27, _28, _29, _30, \
|
|
_31, _32, _33, _34, _35, _36, _37, _38, _39, _40, \
|
|
_41, _42, _43, _44, _45, _46, _47, _48, _49, _50, \
|
|
_51, _52, _53, _54, _55, _56, _57, _58, _59, _60, \
|
|
_61, _62, _63, N, ...) N
|
|
#define PP_RSEQ_N() \
|
|
63, 62, 61, 60, \
|
|
59, 58, 57, 56, 55, 54, 53, 52, 51, 50, \
|
|
49, 48, 47, 46, 45, 44, 43, 42, 41, 40, \
|
|
39, 38, 37, 36, 35, 34, 33, 32, 31, 30, \
|
|
29, 28, 27, 26, 25, 24, 23, 22, 21, 20, \
|
|
19, 18, 17, 16, 15, 14, 13, 12, 11, 10, \
|
|
9, 8, 7, 6, 5, 4, 3, 2, 1, 0
|
|
|
|
#define USB_DESC_SECTION __attribute__((section("usb_desc"))) __USED __ALIGNED(1)
|
|
|
|
/* DEBUG level */
|
|
#define USB_DBG_ERROR 0
|
|
#define USB_DBG_WARNING 1
|
|
#define USB_DBG_INFO 2
|
|
#define USB_DBG_LOG 3
|
|
|
|
#ifndef USB_DBG_LEVEL
|
|
#define USB_DBG_LEVEL USB_DBG_INFO
|
|
#endif
|
|
|
|
#ifndef USB_DBG_TAG
|
|
#define USB_DBG_TAG "USB"
|
|
#endif
|
|
/*
|
|
* The color for terminal (foreground)
|
|
* BLACK 30
|
|
* RED 31
|
|
* GREEN 32
|
|
* YELLOW 33
|
|
* BLUE 34
|
|
* PURPLE 35
|
|
* CYAN 36
|
|
* WHITE 37
|
|
*/
|
|
#define _USB_PRINTF printf
|
|
#define _USB_DBG_COLOR(n) _USB_PRINTF("\033[" #n "m")
|
|
#define _USB_DBG_LOG_HDR(lvl_name, color_n) \
|
|
_USB_PRINTF("\033[" #color_n "m[" lvl_name "/" USB_DBG_TAG "] ")
|
|
#define _USB_DBG_LOG_X_END \
|
|
_USB_PRINTF("\033[0m")
|
|
|
|
#define usb_dbg_log_line(lvl, color_n, fmt, ...) \
|
|
do { \
|
|
_USB_DBG_LOG_HDR(lvl, color_n); \
|
|
_USB_PRINTF(fmt, ##__VA_ARGS__); \
|
|
_USB_DBG_LOG_X_END; \
|
|
} while (0)
|
|
|
|
#if (USB_DBG_LEVEL >= USB_DBG_LOG)
|
|
#define USB_LOG_DBG(fmt, ...) usb_dbg_log_line("D", 0, fmt, ##__VA_ARGS__)
|
|
#else
|
|
#define USB_LOG_DBG(...)
|
|
#endif
|
|
|
|
#if (USB_DBG_LEVEL >= USB_DBG_INFO)
|
|
#define USB_LOG_INFO(fmt, ...) usb_dbg_log_line("I", 32, fmt, ##__VA_ARGS__)
|
|
#else
|
|
#define USB_LOG_INFO(...)
|
|
#endif
|
|
|
|
#if (USB_DBG_LEVEL >= USB_DBG_WARNING)
|
|
#define USB_LOG_WRN(fmt, ...) usb_dbg_log_line("W", 33, fmt, ##__VA_ARGS__)
|
|
#else
|
|
#define USB_LOG_WRN(...)
|
|
#endif
|
|
|
|
#if (USB_DBG_LEVEL >= USB_DBG_ERROR)
|
|
#define USB_LOG_ERR(fmt, ...) usb_dbg_log_line("E", 31, fmt, ##__VA_ARGS__)
|
|
#else
|
|
#define USB_LOG_ERR(...)
|
|
#endif
|
|
|
|
#define USB_LOG_RAW _USB_PRINTF
|
|
|
|
void usb_assert(const char *filename, int linenum);
|
|
#define USB_ASSERT(f) \
|
|
do { \
|
|
if (!(f)) \
|
|
usb_assert(__FILE__, __LINE__); \
|
|
} while (0)
|
|
|
|
#endif
|