| Index: fusl/src/string/memchr.c
|
| diff --git a/fusl/src/string/memchr.c b/fusl/src/string/memchr.c
|
| new file mode 100644
|
| index 0000000000000000000000000000000000000000..4daff7bbc4634c6162b0158fc3bc893c9b697d53
|
| --- /dev/null
|
| +++ b/fusl/src/string/memchr.c
|
| @@ -0,0 +1,23 @@
|
| +#include <string.h>
|
| +#include <stdint.h>
|
| +#include <limits.h>
|
| +
|
| +#define SS (sizeof(size_t))
|
| +#define ALIGN (sizeof(size_t)-1)
|
| +#define ONES ((size_t)-1/UCHAR_MAX)
|
| +#define HIGHS (ONES * (UCHAR_MAX/2+1))
|
| +#define HASZERO(x) ((x)-ONES & ~(x) & HIGHS)
|
| +
|
| +void *memchr(const void *src, int c, size_t n)
|
| +{
|
| + const unsigned char *s = src;
|
| + c = (unsigned char)c;
|
| + for (; ((uintptr_t)s & ALIGN) && n && *s != c; s++, n--);
|
| + if (n && *s != c) {
|
| + const size_t *w;
|
| + size_t k = ONES * c;
|
| + for (w = (const void *)s; n>=SS && !HASZERO(*w^k); w++, n-=SS);
|
| + for (s = (const void *)w; n && *s != c; s++, n--);
|
| + }
|
| + return n ? (void *)s : 0;
|
| +}
|
|
|