1
0

memchr.c 639 B

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