xref: /freebsd/lib/libc/string/memchr.c (revision 61ba55bcf70f2340f9c943c9571113b3fd8eda69)
1 /*-
2  * SPDX-License-Identifier: MIT
3  *
4  * Copyright (c) 2005-2014 Rich Felker, et al.
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining
7  * a copy of this software and associated documentation files (the
8  * "Software"), to deal in the Software without restriction, including
9  * without limitation the rights to use, copy, modify, merge, publish,
10  * distribute, sublicense, and/or sell copies of the Software, and to
11  * permit persons to whom the Software is furnished to do so, subject to
12  * the following conditions:
13  *
14  * The above copyright notice and this permission notice shall be
15  * included in all copies or substantial portions of the Software.
16  *
17  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
18  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
19  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
20  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
21  * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
22  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
23  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
24  */
25 #include <sys/cdefs.h>
26 #include <limits.h>
27 #include <stdint.h>
28 #include <string.h>
29 
30 #define SS (sizeof(size_t))
31 #define ALIGN (sizeof(size_t) - 1)
32 #define ONES ((size_t)-1 / UCHAR_MAX)
33 #define HIGHS (ONES * (UCHAR_MAX / 2 + 1))
34 #define HASZERO(x) (((x)-ONES) & ~(x)&HIGHS)
35 
36 void *
37 memchr(const void *src, int c, size_t n)
38 {
39 	const unsigned char *s = src;
40 	c = (unsigned char)c;
41 #ifdef __GNUC__
42 	for (; ((uintptr_t)s & ALIGN) && n && *s != c; s++, n--)
43 		;
44 	if (n && *s != c) {
45 		typedef size_t __attribute__((__may_alias__)) word;
46 		const word *w;
47 		size_t k = ONES * c;
48 		for (w = (const void *)s; n >= SS && !HASZERO(*w ^ k);
49 		     w++, n -= SS)
50 			;
51 		s = (const void *)w;
52 	}
53 #endif
54 	for (; n && *s != c; s++, n--)
55 		;
56 	return n ? (void *)s : 0;
57 }
58