162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci#include <linux/bitops.h> 362306a36Sopenharmony_ci#include <asm/types.h> 462306a36Sopenharmony_ci 562306a36Sopenharmony_ci/** 662306a36Sopenharmony_ci * hweightN - returns the hamming weight of a N-bit word 762306a36Sopenharmony_ci * @x: the word to weigh 862306a36Sopenharmony_ci * 962306a36Sopenharmony_ci * The Hamming Weight of a number is the total number of bits set in it. 1062306a36Sopenharmony_ci */ 1162306a36Sopenharmony_ci 1262306a36Sopenharmony_ciunsigned int __sw_hweight32(unsigned int w) 1362306a36Sopenharmony_ci{ 1462306a36Sopenharmony_ci#ifdef CONFIG_ARCH_HAS_FAST_MULTIPLIER 1562306a36Sopenharmony_ci w -= (w >> 1) & 0x55555555; 1662306a36Sopenharmony_ci w = (w & 0x33333333) + ((w >> 2) & 0x33333333); 1762306a36Sopenharmony_ci w = (w + (w >> 4)) & 0x0f0f0f0f; 1862306a36Sopenharmony_ci return (w * 0x01010101) >> 24; 1962306a36Sopenharmony_ci#else 2062306a36Sopenharmony_ci unsigned int res = w - ((w >> 1) & 0x55555555); 2162306a36Sopenharmony_ci res = (res & 0x33333333) + ((res >> 2) & 0x33333333); 2262306a36Sopenharmony_ci res = (res + (res >> 4)) & 0x0F0F0F0F; 2362306a36Sopenharmony_ci res = res + (res >> 8); 2462306a36Sopenharmony_ci return (res + (res >> 16)) & 0x000000FF; 2562306a36Sopenharmony_ci#endif 2662306a36Sopenharmony_ci} 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_ciunsigned int __sw_hweight16(unsigned int w) 2962306a36Sopenharmony_ci{ 3062306a36Sopenharmony_ci unsigned int res = w - ((w >> 1) & 0x5555); 3162306a36Sopenharmony_ci res = (res & 0x3333) + ((res >> 2) & 0x3333); 3262306a36Sopenharmony_ci res = (res + (res >> 4)) & 0x0F0F; 3362306a36Sopenharmony_ci return (res + (res >> 8)) & 0x00FF; 3462306a36Sopenharmony_ci} 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ciunsigned int __sw_hweight8(unsigned int w) 3762306a36Sopenharmony_ci{ 3862306a36Sopenharmony_ci unsigned int res = w - ((w >> 1) & 0x55); 3962306a36Sopenharmony_ci res = (res & 0x33) + ((res >> 2) & 0x33); 4062306a36Sopenharmony_ci return (res + (res >> 4)) & 0x0F; 4162306a36Sopenharmony_ci} 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_ciunsigned long __sw_hweight64(__u64 w) 4462306a36Sopenharmony_ci{ 4562306a36Sopenharmony_ci#if BITS_PER_LONG == 32 4662306a36Sopenharmony_ci return __sw_hweight32((unsigned int)(w >> 32)) + 4762306a36Sopenharmony_ci __sw_hweight32((unsigned int)w); 4862306a36Sopenharmony_ci#elif BITS_PER_LONG == 64 4962306a36Sopenharmony_ci#ifdef CONFIG_ARCH_HAS_FAST_MULTIPLIER 5062306a36Sopenharmony_ci w -= (w >> 1) & 0x5555555555555555ul; 5162306a36Sopenharmony_ci w = (w & 0x3333333333333333ul) + ((w >> 2) & 0x3333333333333333ul); 5262306a36Sopenharmony_ci w = (w + (w >> 4)) & 0x0f0f0f0f0f0f0f0ful; 5362306a36Sopenharmony_ci return (w * 0x0101010101010101ul) >> 56; 5462306a36Sopenharmony_ci#else 5562306a36Sopenharmony_ci __u64 res = w - ((w >> 1) & 0x5555555555555555ul); 5662306a36Sopenharmony_ci res = (res & 0x3333333333333333ul) + ((res >> 2) & 0x3333333333333333ul); 5762306a36Sopenharmony_ci res = (res + (res >> 4)) & 0x0F0F0F0F0F0F0F0Ful; 5862306a36Sopenharmony_ci res = res + (res >> 8); 5962306a36Sopenharmony_ci res = res + (res >> 16); 6062306a36Sopenharmony_ci return (res + (res >> 32)) & 0x00000000000000FFul; 6162306a36Sopenharmony_ci#endif 6262306a36Sopenharmony_ci#endif 6362306a36Sopenharmony_ci} 64