From 1000125395e3bf4be5a9026650074e8fedbeb24b Mon Sep 17 00:00:00 2001 From: Damjan Marion Date: Fri, 26 May 2023 19:08:38 +0000 Subject: vppinfra: add bit_extract_u32 and bit_extract_u64 Type: improvement Change-Id: Icfaa856aa4b50ad5c6828f1690ce3fb6ba08ec00 Signed-off-by: Damjan Marion --- src/vppinfra/bitops.h | 42 ++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 42 insertions(+) (limited to 'src') diff --git a/src/vppinfra/bitops.h b/src/vppinfra/bitops.h index d19046e1d24..3d17f0d5ace 100644 --- a/src/vppinfra/bitops.h +++ b/src/vppinfra/bitops.h @@ -273,6 +273,48 @@ uword_bitmap_find_first_set (uword *bmp) return (b - bmp) * uword_bits + get_lowest_set_bit_index (b[0]); } +static_always_inline u32 +bit_extract_u32 (u32 v, u32 mask) +{ +#ifdef __BMI2__ + return _pext_u32 (v, mask); +#else + u32 rv = 0; + u32 bit = 1; + + while (mask) + { + u32 lowest_mask_bit = get_lowest_set_bit (mask); + mask ^= lowest_mask_bit; + rv |= (v & lowest_mask_bit) ? bit : 0; + bit <<= 1; + } + + return rv; +#endif +} + +static_always_inline u64 +bit_extract_u64 (u64 v, u64 mask) +{ +#ifdef __BMI2__ + return _pext_u64 (v, mask); +#else + u64 rv = 0; + u64 bit = 1; + + while (mask) + { + u64 lowest_mask_bit = get_lowest_set_bit (mask); + mask ^= lowest_mask_bit; + rv |= (v & lowest_mask_bit) ? bit : 0; + bit <<= 1; + } + + return rv; +#endif +} + #else #warning "already included" #endif /* included_clib_bitops_h */ -- cgit 1.2.3-korg