nsz Git - musl/blob - src/string/memchr.c

   1 #include <string.h>
   2 #include <stdlib.h>
   3 #include <stdint.h>
   4 #include <limits.h>
   5
   6 #define SS (sizeof(size_t))
   7 #define ALIGN (sizeof(size_t)-1)
   8 #define ONES ((size_t)-1/UCHAR_MAX)
   9 #define HIGHS (ONES * (UCHAR_MAX/2+1))
  10 #define HASZERO(x) ((x)-ONES & ~(x) & HIGHS)
  11
  12 void *memchr(const void *src, int c, size_t n)
  13 {
  14         const unsigned char *s = src;
  15         c = (unsigned char)c;
  16         for (; ((uintptr_t)s & ALIGN) && n && *s != c; s++, n--);
  17         if (n && *s != c) {
  18                 const size_t *w;
  19                 size_t k = ONES * c;
  20                 for (w = (const void *)s; n>=SS && !HASZERO(*w^k); w++, n-=SS);
  21                 for (s = (const void *)w; n && *s != c; s++, n--);
  22         }
  23         return n ? (void *)s : 0;
  24 }