14#ifndef ZEPHYR_INCLUDE_SYS_UTIL_H_
15#define ZEPHYR_INCLUDE_SYS_UTIL_H_
34#define NUM_BITS(t) (sizeof(t) * BITS_PER_BYTE)
49#define POINTER_TO_UINT(x) ((uintptr_t)(x))
51#define UINT_TO_POINTER(x) ((void *)(uintptr_t)(x))
53#define POINTER_TO_INT(x) ((intptr_t)(x))
55#define INT_TO_POINTER(x) ((void *)(intptr_t)(x))
57#if !(defined(__CHAR_BIT__) && defined(__SIZEOF_LONG__) && defined(__SIZEOF_LONG_LONG__))
58#error Missing required predefined macros for BITS_PER_LONG calculation
62#define BITS_PER_BYTE (__CHAR_BIT__)
65#define BITS_PER_NIBBLE (__CHAR_BIT__ / 2)
68#define NIBBLES_PER_BYTE (BITS_PER_BYTE / BITS_PER_NIBBLE)
71#define BITS_PER_LONG (__CHAR_BIT__ * __SIZEOF_LONG__)
74#define BITS_PER_LONG_LONG (__CHAR_BIT__ * __SIZEOF_LONG_LONG__)
80#define GENMASK(h, l) (((~0UL) - (1UL << (l)) + 1) & (~0UL >> (BITS_PER_LONG - 1 - (h))))
86#define GENMASK64(h, l) (((~0ULL) - (1ULL << (l)) + 1) & (~0ULL >> (BITS_PER_LONG_LONG - 1 - (h))))
89#define ZERO_OR_COMPILE_ERROR(cond) ((int)sizeof(char[1 - (2 * !(cond))]) - 1)
91#if defined(__cplusplus)
96#define ARRAY_SIZE(array) (sizeof(array) / sizeof((array)[0]))
105#define IS_ARRAY(array) \
106 ZERO_OR_COMPILE_ERROR( \
107 !__builtin_types_compatible_p(__typeof__(array), __typeof__(&(array)[0])))
118#define ARRAY_SIZE(array) ((size_t)(IS_ARRAY(array) + (sizeof(array) / sizeof((array)[0]))))
139#define FLEXIBLE_ARRAY_DECLARE(type, name) \
160#define IS_ARRAY_ELEMENT(array, ptr) \
161 ((ptr) && POINTER_TO_UINT(array) <= POINTER_TO_UINT(ptr) && \
162 POINTER_TO_UINT(ptr) < POINTER_TO_UINT(&(array)[ARRAY_SIZE(array)]) && \
163 (POINTER_TO_UINT(ptr) - POINTER_TO_UINT(array)) % sizeof((array)[0]) == 0)
179#define ARRAY_INDEX(array, ptr) \
181 __ASSERT_NO_MSG(IS_ARRAY_ELEMENT(array, ptr)); \
182 (__typeof__((array)[0]) *)(ptr) - (array); \
195#define PART_OF_ARRAY(array, ptr) \
196 ((ptr) && POINTER_TO_UINT(array) <= POINTER_TO_UINT(ptr) && \
197 POINTER_TO_UINT(ptr) < POINTER_TO_UINT(&(array)[ARRAY_SIZE(array)]))
216#define ARRAY_INDEX_FLOOR(array, ptr) \
218 __ASSERT_NO_MSG(PART_OF_ARRAY(array, ptr)); \
219 (POINTER_TO_UINT(ptr) - POINTER_TO_UINT(array)) / sizeof((array)[0]); \
228#define ARRAY_FOR_EACH(array, idx) for (size_t idx = 0; (idx) < ARRAY_SIZE(array); ++(idx))
236#define ARRAY_FOR_EACH_PTR(array, ptr) \
237 for (__typeof__(*(array)) *ptr = (array); (size_t)((ptr) - (array)) < ARRAY_SIZE(array); \
247#define SAME_TYPE(a, b) __builtin_types_compatible_p(__typeof__(a), __typeof__(b))
253#define CONTAINER_OF_VALIDATE(ptr, type, field) \
254 BUILD_ASSERT(SAME_TYPE(*(ptr), ((type *)0)->field) || SAME_TYPE(*(ptr), void), \
255 "pointer type mismatch in CONTAINER_OF");
257#define CONTAINER_OF_VALIDATE(ptr, type, field)
281#define CONTAINER_OF(ptr, type, field) \
283 CONTAINER_OF_VALIDATE(ptr, type, field) \
284 ((type *)(((char *)(ptr)) - offsetof(type, field))); \
295#define SIZEOF_FIELD(type, member) sizeof((((type *)0)->member))
308#define CONCAT(...) UTIL_CAT(_CONCAT_, NUM_VA_ARGS_LESS_1(__VA_ARGS__))(__VA_ARGS__)
313#define IS_ALIGNED(ptr, align) (((uintptr_t)(ptr)) % (align) == 0)
318#define ROUND_UP(x, align) \
319 ((((unsigned long)(x) + ((unsigned long)(align) - 1)) / (unsigned long)(align)) * \
320 (unsigned long)(align))
325#define ROUND_DOWN(x, align) \
326 (((unsigned long)(x) / (unsigned long)(align)) * (unsigned long)(align))
329#define WB_UP(x) ROUND_UP(x, sizeof(void *))
332#define WB_DN(x) ROUND_DOWN(x, sizeof(void *))
348#define DIV_ROUND_UP(n, d) (((n) + (d) - 1) / (d))
365#define DIV_ROUND_CLOSEST(n, d) \
366 (((((__typeof__(n))-1) < 0) && (((__typeof__(d))-1) < 0) && ((n) < 0) ^ ((d) < 0)) \
367 ? ((n) - ((d) / 2)) / (d) \
368 : ((n) + ((d) / 2)) / (d))
373#define Z_INTERNAL_MAX(a, b) (((a) > (b)) ? (a) : (b))
374#define Z_INTERNAL_MIN(a, b) (((a) < (b)) ? (a) : (b))
376#define _minmax_unique(op, a, b, ua, ub) ({ \
377 __typeof__(a) ua = (a); \
378 __typeof__(b) ub = (b); \
382#define _minmax_cnt(op, a, b, cnt) \
383 _minmax_unique(op, a, b, UTIL_CAT(_value_a_, cnt), UTIL_CAT(_value_b_, cnt))
385#define _minmax3_unique(op, a, b, c, ua, ub, uc) ({ \
386 __typeof__(a) ua = (a); \
387 __typeof__(b) ub = (b); \
388 __typeof__(c) uc = (c); \
389 op(ua, op(ub, uc)); \
392#define _minmax3_cnt(op, a, b, c, cnt) \
393 _minmax3_unique(op, a, b, c, \
394 UTIL_CAT(_value_a_, cnt), \
395 UTIL_CAT(_value_b_, cnt), \
396 UTIL_CAT(_value_c_, cnt))
413#define MAX(a, b) Z_INTERNAL_MAX(a, b)
426#define max(a, b) _minmax_cnt(Z_INTERNAL_MAX, a, b, __COUNTER__)
434#define max3(a, b, c) _minmax3_cnt(Z_INTERNAL_MAX, a, b, c, __COUNTER__)
448#define MIN(a, b) Z_INTERNAL_MIN(a, b)
457#define min(a, b) _minmax_cnt(Z_INTERNAL_MIN, a, b, __COUNTER__)
465#define min3(a, b, c) _minmax3_cnt(Z_INTERNAL_MIN, a, b, c, __COUNTER__)
485#define Z_MAX_2(a, b) ((a) > (b) ? (a) : (b))
495#define Z_MAX_3(a, b, c) Z_MAX_2(a, Z_MAX_2(b, c))
506#define Z_MAX_4(a, b, c, d) Z_MAX_2(Z_MAX_2(a, b), Z_MAX_2(c, d))
512#define Z_MAX_5(a, b, c, d, e) Z_MAX_2(Z_MAX_4(a, b, c, d), e)
518#define Z_MAX_6(a, b, c, d, e, f) Z_MAX_2(Z_MAX_5(a, b, c, d, e), f)
524#define Z_MAX_7(a, b, c, d, e, f, g) Z_MAX_2(Z_MAX_6(a, b, c, d, e, f), g)
530#define Z_MAX_8(a, b, c, d, e, f, g, h) Z_MAX_2(Z_MAX_7(a, b, c, d, e, f, g), h)
536#define Z_MAX_9(a, b, c, d, e, f, g, h, i) Z_MAX_2(Z_MAX_8(a, b, c, d, e, f, g, h), i)
542#define Z_MAX_10(a, b, c, d, e, f, g, h, i, j) Z_MAX_2(Z_MAX_9(a, b, c, d, e, f, g, h, i), j)
566#define Z_GET_MAX_MACRO(_1, _2, _3, _4, _5, _6, _7, _8, _9, _10, NAME, ...) NAME
584#define MAX_FROM_LIST(...) \
585 Z_GET_MAX_MACRO(__VA_ARGS__, Z_MAX_10, Z_MAX_9, Z_MAX_8, Z_MAX_7, Z_MAX_6, Z_MAX_5, \
586 Z_MAX_4, Z_MAX_3, Z_MAX_2, Z_MAX_1)(__VA_ARGS__)
602#define CLAMP(val, low, high) (((val) <= (low)) ? (low) : Z_INTERNAL_MIN(val, high))
611#define clamp(val, low, high) ({ \
613 __typeof__(val) _value_val_ = (val); \
614 __typeof__(low) _value_low_ = (low); \
615 __typeof__(high) _value_high_ = (high); \
616 (_value_val_ < _value_low_) ? _value_low_ : \
617 (_value_val_ > _value_high_) ? _value_high_ : \
634#define IN_RANGE(val, min, max) ((val) >= (min) && (val) <= (max))
702 sign_ext = (value >> 63) & 1;
705 sign_ext = -sign_ext;
708 return (value >> shift) | (sign_ext << (64 - shift));
720static inline void bytecpy(
void *dst,
const void *src,
size_t size)
724 for (i = 0; i < size; ++i) {
725 ((
volatile uint8_t *)dst)[i] = ((
volatile const uint8_t *)src)[i];
739static inline void byteswp(
void *a,
void *b,
size_t size)
745 for (; size > 0; --size) {
805 return ((10 * (bcd >> 4)) + (bcd & 0x0F));
817 return (((bin / 10) << 4) | (bin % 10));
843 __ASSERT_NO_MSG(index <= 31);
847 return (
int32_t)(value << shift) >> shift;
858 __ASSERT_NO_MSG(index <= 63);
862 return (
int64_t)(value << shift) >> shift;
865#define __z_log2d(x) (32 - __builtin_clz(x) - 1)
866#define __z_log2q(x) (64 - __builtin_clzll(x) - 1)
867#define __z_log2(x) (sizeof(__typeof__(x)) > 4 ? __z_log2q(x) : __z_log2d(x))
879#define LOG2(x) ((x) < 1 ? -1 : __z_log2(x))
891#define LOG2CEIL(x) ((x) <= 1 ? 0 : __z_log2((x) - 1) + 1)
905#define NHPOT(x) ((x) < 1 ? 1 : ((x) > (1ULL << 63) ? 0 : 1ULL << LOG2CEIL(x)))
919#define Z_DETECT_POINTER_OVERFLOW(addr, buflen) \
920 (((buflen) != 0) && ((UINTPTR_MAX - (uintptr_t)(addr)) <= ((uintptr_t)((buflen) - 1))))
933 *dst++ = *src1++ ^ *src2++;
972static inline bool util_memeq(
const void *m1,
const void *m2,
size_t n)
974 return memcmp(m1, m2, n) == 0;
990static inline bool util_eq(
const void *m1,
size_t len1,
const void *m2,
size_t len2)
992 return len1 == len2 && (m1 == m2 ||
util_memeq(m1, m2, len1));
1007 for (; i < len /
sizeof(
unsigned int); i++) {
1009 (void)
memcpy(&val, (
const uint8_t *)value + i *
sizeof(
unsigned int),
1010 sizeof(
unsigned int));
1012 cnt += POPCOUNT(val);
1014 i *=
sizeof(
unsigned int);
1017 for (; i < len; i++) {
1022 value_u8 &= (value_u8 - 1);
1044#define KB(x) ((x) << 10)
1046#define KB(x) (((size_t)(x)) << 10)
1049#define MB(x) (KB(x) << 10)
1051#define GB(x) (MB(x) << 10)
1054#define KHZ(x) ((x) * 1000)
1056#define MHZ(x) (KHZ(x) * 1000)
1070#if defined(CONFIG_ARCH_POSIX)
1071#define Z_SPIN_DELAY(t) k_busy_wait(t)
1073#define Z_SPIN_DELAY(t)
1091#define WAIT_FOR(expr, timeout, delay_stmt) \
1093 uint32_t _wf_cycle_count = k_us_to_cyc_ceil32(timeout); \
1094 uint32_t _wf_start = k_cycle_get_32(); \
1095 while (!(expr) && (_wf_cycle_count > (k_cycle_get_32() - _wf_start))) { \
irp nz macro MOVR cc s mov cc s endm endr irp aa
Definition asm-macro-32-bit-gnu.h:16
static int64_t sign_extend_64(uint64_t value, uint8_t index)
Sign extend a 64 bit value using the index bit as sign bit.
Definition util.h:856
static int64_t arithmetic_shift_right(int64_t value, uint8_t shift)
Arithmetic shift right.
Definition util.h:693
static size_t sys_count_bits(const void *value, size_t len)
Returns the number of bits set in a value.
Definition util.h:1001
size_t hex2bin(const char *hex, size_t hexlen, uint8_t *buf, size_t buflen)
Convert a hexadecimal string into a binary array.
static void bytecpy(void *dst, const void *src, size_t size)
byte by byte memcpy.
Definition util.h:720
#define IS_POWER_OF_TWO(x)
Check if a x is a power of two.
Definition util_macro.h:77
static ALWAYS_INLINE bool is_null_no_warn(void *p)
Is p equal to NULL?
Definition util.h:681
static void mem_xor_128(uint8_t dst[16], const uint8_t src1[16], const uint8_t src2[16])
XOR 128 bits.
Definition util.h:956
static uint8_t bin2bcd(uint8_t bin)
Convert a binary value to binary coded decimal (BCD 8421).
Definition util.h:815
static void mem_xor_32(uint8_t dst[4], const uint8_t src1[4], const uint8_t src2[4])
XOR 32 bits.
Definition util.h:944
static void byteswp(void *a, void *b, size_t size)
byte by byte swap.
Definition util.h:739
static void mem_xor_n(uint8_t *dst, const uint8_t *src1, const uint8_t *src2, size_t len)
XOR n bytes.
Definition util.h:930
int hex2char(uint8_t x, char *c)
Convert a single hexadecimal nibble into a character.
static uint8_t bcd2bin(uint8_t bcd)
Convert a binary coded decimal (BCD 8421) value to binary.
Definition util.h:803
int char2hex(char c, uint8_t *x)
Convert a single character into a hexadecimal nibble.
int bitmask_find_gap(uint32_t mask, size_t num_bits, size_t total_bits, bool first_match)
Find number of contiguous bits which are not set in the bit mask (32 bits).
uint8_t u8_to_dec(char *buf, uint8_t buflen, uint8_t value)
Convert a uint8_t into a decimal string representation.
static bool util_eq(const void *m1, size_t len1, const void *m2, size_t len2)
Compare memory areas and their length.
Definition util.h:990
static bool util_memeq(const void *m1, const void *m2, size_t n)
Compare memory areas.
Definition util.h:972
static bool is_power_of_two(unsigned int x)
Is x a power of two?
Definition util.h:657
static int32_t sign_extend(uint32_t value, uint8_t index)
Sign extend an 8, 16 or 32 bit value using the index bit as sign bit.
Definition util.h:841
size_t bin2hex(const uint8_t *buf, size_t buflen, char *hex, size_t hexlen)
Convert a binary array into string representation.
#define NULL
Definition iar_missing_defs.h:20
__UINT32_TYPE__ uint32_t
Definition stdint.h:90
__INT32_TYPE__ int32_t
Definition stdint.h:74
__UINT64_TYPE__ uint64_t
Definition stdint.h:91
__UINT8_TYPE__ uint8_t
Definition stdint.h:88
__INT64_TYPE__ int64_t
Definition stdint.h:75
int memcmp(const void *m1, const void *m2, size_t n)
void * memcpy(void *ZRESTRICT d, const void *ZRESTRICT s, size_t n)