diff --git a/include/boilerplate/compiler.h b/include/boilerplate/compiler.h index 0fcc17be145d333b097806f4f61df63cf232416d..0cd71b80a84df80c248343cdb51020824c9c8f8a 100644 --- a/include/boilerplate/compiler.h +++ b/include/boilerplate/compiler.h @@ -71,27 +71,16 @@ #ifdef __cplusplus extern "C" { #endif - + void __invalid_operand_size(void); -#define __ctz(__v) \ - ({ \ - int __ret; \ - if (!__v) \ - __ret = sizeof(__v) * 8; \ - else \ - switch (sizeof(__v)) { \ - case sizeof(int): \ - __ret = __builtin_ctz((unsigned int)__v); \ - break; \ - case sizeof(long long): \ - __ret = __builtin_ctzll(__v); \ - break; \ - default: \ - __invalid_operand_size(); \ - } \ - __ret; \ - }) +#define xenomai_count_trailing_zeros(x) \ + ((x) == 0 ? (int)(sizeof(x) * __CHAR_BIT__) \ + : sizeof(x) <= sizeof(unsigned int) ? \ + __builtin_ctz((unsigned int)x) \ + : sizeof(x) <= sizeof(unsigned long) ? \ + __builtin_ctzl((unsigned long)x) \ + : __builtin_ctzll(x)) #define xenomai_count_leading_zeros(__v) \ ({ \ @@ -111,9 +100,9 @@ void __invalid_operand_size(void); } \ __ret; \ }) - + #ifdef __cplusplus } #endif - + #endif /* _BOILERPLATE_COMPILER_H */ diff --git a/lib/boilerplate/heapmem.c b/lib/boilerplate/heapmem.c index 8728e0d15720c014c6be2bb5c3fabc4a3b063a43..e6369c715474e2944a6bee7dd8d8a13a6a3eaf9e 100644 --- a/lib/boilerplate/heapmem.c +++ b/lib/boilerplate/heapmem.c @@ -476,7 +476,7 @@ void *heapmem_alloc(struct heap_memory *heap, size_t size) bmask = ext->pagemap[pg].map; if (bmask == -1U) break; - b = __ctz(~bmask); + b = xenomai_count_trailing_zeros(~bmask); /* * Got one block from the heading per-bucket diff --git a/lib/copperplate/heapobj-pshared.c b/lib/copperplate/heapobj-pshared.c index 5310d90925264f0e33b8c30dd0dcd6eb00930659..d6cc51ae9e69e975c04bd3927a893edb6776539b 100644 --- a/lib/copperplate/heapobj-pshared.c +++ b/lib/copperplate/heapobj-pshared.c @@ -529,7 +529,7 @@ static void *sheapmem_alloc(struct shared_heap_memory *heap, size_t size) bmask = ext->pagemap[pg].map; if (bmask == -1U) break; - b = __ctz(~bmask); + b = xenomai_count_trailing_zeros(~bmask); /* * Got one block from the heading per-bucket