/****************************************************************************** * Copyright (c) 2022 Telink Semiconductor (Shanghai) Co., Ltd. ("TELINK") * All rights reserved. * * Licensed 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. * *****************************************************************************/ #pragma once #include "types.h" #define abs(a) (((a)>0)?((a)):(-(a))) #define cat2(i,j) i##j #define cat3(i,j,k) i##j##k #ifndef min #define min(a,b) ((a) < (b) ? (a) : (b)) #endif #ifndef max #define max(a,b) ((a) > (b) ? (a): (b)) #endif #ifndef min2 #define min2(a,b) ((a) < (b) ? (a) : (b)) #endif #ifndef min3 #define min3(a,b,c) min2(min2(a, b), c) #endif #ifndef max2 #define max2(a,b) ((a) > (b) ? (a): (b)) #endif #ifndef max3 #define max3(a,b,c) max2(max2(a, b), c) #endif #define OFFSETOF(s, m) ((unsigned int) &((s *)0)->m) #define ROUND_INT(x, r) (((x) + (r) - 1) / (r) * (r)) #define ROUND_TO_POW2(x, r) (((x) + (r) - 1) & ~((r) - 1)) // direct memory access #define U8_GET(addr) (*(volatile unsigned char *)(addr)) #define U16_GET(addr) (*(volatile unsigned short *)(addr)) #define U32_GET(addr) (*(volatile unsigned int *)(addr)) #define U8_SET(addr, v) (*(volatile unsigned char *)(addr) = (unsigned char)(v)) #define U16_SET(addr, v) (*(volatile unsigned short *)(addr) = (unsigned short)(v)) #define U32_SET(addr, v) (*(volatile unsigned int *)(addr) = (v)) #define U8_INC(addr) U8_GET(addr) += 1 #define U16_INC(addr) U16_GET(addr) += 1 #define U32_INC(addr) U32_GET(addr) += 1 #define U8_DEC(addr) U8_GET(addr) -= 1 #define U16_DEC(addr) U16_GET(addr) -= 1 #define U32_DEC(addr) U32_GET(addr) -= 1 #define U8_CPY(addr1,addr2) U8_SET(addr1, U8_GET(addr2)) #define U16_CPY(addr1,addr2) U16_SET(addr1, U16_GET(addr2)) #define U32_CPY(addr1,addr2) U32_SET(addr1, U32_GET(addr2)) #define MAKE_U16(h,l) ((unsigned short)(((h) << 8) | (l))) #define MAKE_U24(a,b,c) ((unsigned int)(((a) << 16) | ((b) << 8) | (c))) #define MAKE_U32(a,b,c,d) ((unsigned int)(((a) << 24) | ((b) << 16) | ((c) << 8) | (d))) #define BOUND(x, l, m) ((x) < (l) ? (l) : ((x) > (m) ? (m) : (x))) #define SET_BOUND(x, l, m) ((x) = BOUND(x, l, m)) #define BOUND_INC(x, m) do{++(x); (x) = (x) < (m) ? (x) :0;} while(0) #define BOUND_INC_POW2(x, m) do{ \ (x) = ((x)+1) & (m-1); \ }while(0) #define IS_POWER_OF_2(x) (!(x & (x-1))) #define IS_LITTLE_ENDIAN (*(unsigned short*)"\0\xff" > 0x100) #define IS_4BYTE_ALIGN(x) (!(x & 3)) #define IMPLIES(x, y) (!(x) || (y)) // x > y ? 1 : (x ==y : 0 ? -1) #define COMPARE(x, y) (((x) > (y)) - ((x) < (y))) #define SIGN(x) COMPARE(x, 0) // better than xor swap: http://stackoverflow.com/questions/3912699/why-swap-with-xor-works-fine-in-c-but-in-java-doesnt-some-puzzle #define SWAP(x, y, T) do { T tmp = (x); (x) = (y); (y) = tmp; } while(0) #define SORT2(a, b, T) do { if ((a) > (b)) SWAP((a), (b), T); } while (0) #define foreach(i, n) for(int i = 0; i < (n); ++i) #define foreach_range(i, s, e) for(int i = (s); i < (e); ++i) #define foreach_arr(i, arr) for(int i = 0; i < ARRAY_SIZE(arr); ++i) #define ARRAY_SIZE(a) (sizeof(a) / sizeof(*a)) #define everyN(i, n) ++(i); (i)=((i) < N ? (i) : 0); if(0 == (i)) #define U16_HI(a) (((a) >> 8) & 0xFF) #define U16_LO(a) ((a) & 0xFF) #define U32_BYTE0(a) ((a) & 0xFF) #define U32_BYTE1(a) (((a) >> 8) & 0xFF) #define U32_BYTE2(a) (((a) >> 16) & 0xFF) #define U32_BYTE3(a) (((a) >> 24) & 0xFF) void swapN (unsigned char *p, int n); void swapX(const u8 *src, u8 *dst, int len); void swap24(u8 dst[3], const u8 src[3]); void swap32(u8 dst[4], const u8 src[4]); void swap48(u8 dst[6], const u8 src[6]); void swap56(u8 dst[7], const u8 src[7]); void swap64(u8 dst[8], const u8 src[8]); void swap128(u8 dst[16], const u8 src[16]); void flip_addr(u8 *dest, u8 *src); static inline u64 mul64_32x32(u32 u, u32 v) { #if 0 //Eagle HW support this process u32 u0, v0, w0; u32 u1, v1, w1, w2, t; u32 x, y; u0 = u & 0xFFFF; u1 = u >> 16; v0 = v & 0xFFFF; v1 = v >> 16; w0 = u0 * v0; t = u1 * v0 + (w0 >> 16); w1 = t & 0xFFFF; w2 = t >> 16; w1 = u0 * v1 + w1; //x is high 32 bits, y is low 32 bits x = u1 * v1 + w2 + (w1 >> 16); y = u * v; return(((u64)x << 32) | y); #else return (u64)u*v; #endif } typedef struct { u32 size; u16 num; u8 wptr; u8 rptr; u8* p; } my_fifo_t; void my_fifo_init (my_fifo_t *f, int s, u8 n, u8 *p); u8* my_fifo_wptr (my_fifo_t *f); u8* my_fifo_wptr_v2 (my_fifo_t *f); void my_fifo_next (my_fifo_t *f); int my_fifo_push (my_fifo_t *f, u8 *p, int n); void my_fifo_pop (my_fifo_t *f); u8 * my_fifo_get (my_fifo_t *f); #define MYFIFO_INIT(name,size,n) u8 name##_b[size * n]={0};my_fifo_t name = {size,n,0,0, name##_b} #define MYFIFO_INIT_IRAM(name,size,n) u8 name##_b[size * n]__attribute__((aligned(4)))/*={0}*/;my_fifo_t name = {size,n,0,0, name##_b} #define DATA_LENGTH_ALLIGN4(n) ((n + 3) / 4 * 4) #define DATA_LENGTH_ALLIGN16(n) ((n + 15) / 16 * 16)