1272343Sngie/*	$NetBSD: t_bitops.c,v 1.16 2012/12/07 02:28:19 christos Exp $ */
2272343Sngie
3272343Sngie/*-
4272343Sngie * Copyright (c) 2011, 2012 The NetBSD Foundation, Inc.
5272343Sngie * All rights reserved.
6272343Sngie *
7272343Sngie * This code is derived from software contributed to The NetBSD Foundation
8272343Sngie * by Christos Zoulas and Jukka Ruohonen.
9272343Sngie *
10272343Sngie * Redistribution and use in source and binary forms, with or without
11272343Sngie * modification, are permitted provided that the following conditions
12272343Sngie * are met:
13272343Sngie * 1. Redistributions of source code must retain the above copyright
14272343Sngie *    notice, this list of conditions and the following disclaimer.
15272343Sngie * 2. Redistributions in binary form must reproduce the above copyright
16272343Sngie *    notice, this list of conditions and the following disclaimer in the
17272343Sngie *    documentation and/or other materials provided with the distribution.
18272343Sngie *
19272343Sngie * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20272343Sngie * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21272343Sngie * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22272343Sngie * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23272343Sngie * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24272343Sngie * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25272343Sngie * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26272343Sngie * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27272343Sngie * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28272343Sngie * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29272343Sngie * POSSIBILITY OF SUCH DAMAGE.
30272343Sngie */
31272343Sngie#include <sys/cdefs.h>
32272343Sngie__RCSID("$NetBSD: t_bitops.c,v 1.16 2012/12/07 02:28:19 christos Exp $");
33272343Sngie
34272343Sngie#include <atf-c.h>
35272343Sngie
36272343Sngie#include <sys/cdefs.h>
37272343Sngie#include <sys/bitops.h>
38272343Sngie
39272343Sngie#include <math.h>
40272343Sngie#include <inttypes.h>
41272343Sngie#include <stdlib.h>
42272343Sngie#include <string.h>
43272343Sngie
44272343Sngiestatic const struct {
45272343Sngie	uint32_t	val;
46272343Sngie	int		ffs;
47272343Sngie	int		fls;
48272343Sngie} bits[] = {
49272343Sngie
50272343Sngie	{ 0x00, 0, 0 }, { 0x01, 1, 1 },	{ 0x02, 2, 2 },	{ 0x03, 1, 2 },
51272343Sngie	{ 0x04, 3, 3 }, { 0x05, 1, 3 },	{ 0x06, 2, 3 },	{ 0x07, 1, 3 },
52272343Sngie	{ 0x08, 4, 4 }, { 0x09, 1, 4 },	{ 0x0A, 2, 4 },	{ 0x0B, 1, 4 },
53272343Sngie	{ 0x0C, 3, 4 }, { 0x0D, 1, 4 },	{ 0x0E, 2, 4 },	{ 0x0F, 1, 4 },
54272343Sngie
55272343Sngie	{ 0x10, 5, 5 },	{ 0x11, 1, 5 },	{ 0x12, 2, 5 },	{ 0x13, 1, 5 },
56272343Sngie	{ 0x14, 3, 5 },	{ 0x15, 1, 5 },	{ 0x16, 2, 5 },	{ 0x17, 1, 5 },
57272343Sngie	{ 0x18, 4, 5 },	{ 0x19, 1, 5 },	{ 0x1A, 2, 5 },	{ 0x1B, 1, 5 },
58272343Sngie	{ 0x1C, 3, 5 },	{ 0x1D, 1, 5 },	{ 0x1E, 2, 5 },	{ 0x1F, 1, 5 },
59272343Sngie
60272343Sngie	{ 0xF0, 5, 8 },	{ 0xF1, 1, 8 },	{ 0xF2, 2, 8 },	{ 0xF3, 1, 8 },
61272343Sngie	{ 0xF4, 3, 8 },	{ 0xF5, 1, 8 },	{ 0xF6, 2, 8 },	{ 0xF7, 1, 8 },
62272343Sngie	{ 0xF8, 4, 8 },	{ 0xF9, 1, 8 },	{ 0xFA, 2, 8 },	{ 0xFB, 1, 8 },
63272343Sngie	{ 0xFC, 3, 8 },	{ 0xFD, 1, 8 },	{ 0xFE, 2, 8 },	{ 0xFF, 1, 8 },
64272343Sngie
65272343Sngie};
66272343Sngie
67272343SngieATF_TC(bitmap_basic);
68272343SngieATF_TC_HEAD(bitmap_basic, tc)
69272343Sngie{
70272343Sngie        atf_tc_set_md_var(tc, "descr", "A basic test of __BITMAP_*");
71272343Sngie}
72272343Sngie
73272343SngieATF_TC_BODY(bitmap_basic, tc)
74272343Sngie{
75272343Sngie	__BITMAP_TYPE(, uint32_t, 65536) bm;
76272343Sngie	__BITMAP_ZERO(&bm);
77272343Sngie
78272343Sngie	ATF_REQUIRE(__BITMAP_SIZE(uint32_t, 65536) == 2048);
79272343Sngie
80272343Sngie	ATF_REQUIRE(__BITMAP_SHIFT(uint32_t) == 5);
81272343Sngie
82272343Sngie	ATF_REQUIRE(__BITMAP_MASK(uint32_t) == 31);
83272343Sngie
84272343Sngie	for (size_t i = 0; i < 65536; i += 2)
85272343Sngie		__BITMAP_SET(i, &bm);
86272343Sngie
87272343Sngie	for (size_t i = 0; i < 2048; i++)
88272343Sngie		ATF_REQUIRE(bm._b[i] == 0x55555555);
89272343Sngie
90272343Sngie	for (size_t i = 0; i < 65536; i++)
91272343Sngie		if (i & 1)
92272343Sngie			ATF_REQUIRE(!__BITMAP_ISSET(i, &bm));
93272343Sngie		else {
94272343Sngie			ATF_REQUIRE(__BITMAP_ISSET(i, &bm));
95272343Sngie			__BITMAP_CLR(i, &bm);
96272343Sngie		}
97272343Sngie
98272343Sngie	for (size_t i = 0; i < 65536; i += 2)
99272343Sngie		ATF_REQUIRE(!__BITMAP_ISSET(i, &bm));
100272343Sngie}
101272343Sngie
102272343SngieATF_TC(fast_divide32);
103272343SngieATF_TC_HEAD(fast_divide32, tc)
104272343Sngie{
105272343Sngie	atf_tc_set_md_var(tc, "descr", "A basic test of fast_divide32(3)");
106272343Sngie}
107272343Sngie
108272343SngieATF_TC_BODY(fast_divide32, tc)
109272343Sngie{
110272343Sngie	uint32_t a, b, q, r, m;
111272343Sngie	uint8_t i, s1, s2;
112272343Sngie
113272343Sngie	a = 0xFFFF;
114272343Sngie	b = 0x000F;
115272343Sngie
116272343Sngie	fast_divide32_prepare(b, &m, &s1, &s2);
117272343Sngie
118272343Sngie	q = fast_divide32(a, b, m, s1, s2);
119272343Sngie	r = fast_remainder32(a, b, m, s1, s2);
120272343Sngie
121272343Sngie	ATF_REQUIRE(q == 0x1111 && r == 0);
122272343Sngie
123272343Sngie	for (i = 1; i < __arraycount(bits); i++) {
124272343Sngie
125272343Sngie		a = bits[i].val;
126272343Sngie		b = bits[i].ffs;
127272343Sngie
128272343Sngie		fast_divide32_prepare(b, &m, &s1, &s2);
129272343Sngie
130272343Sngie		q = fast_divide32(a, b, m, s1, s2);
131272343Sngie		r = fast_remainder32(a, b, m, s1, s2);
132272343Sngie
133272343Sngie		ATF_REQUIRE(q == a / b);
134272343Sngie		ATF_REQUIRE(r == a % b);
135272343Sngie	}
136272343Sngie}
137272343Sngie
138272343SngieATF_TC(ffsfls);
139272343SngieATF_TC_HEAD(ffsfls, tc)
140272343Sngie{
141272343Sngie	atf_tc_set_md_var(tc, "descr", "Test ffs32(3)-family for correctness");
142272343Sngie}
143272343Sngie
144272343SngieATF_TC_BODY(ffsfls, tc)
145272343Sngie{
146272343Sngie	uint8_t i;
147272343Sngie
148272343Sngie	ATF_REQUIRE(ffs32(0) == 0x00);
149272343Sngie	ATF_REQUIRE(fls32(0) == 0x00);
150272343Sngie	ATF_REQUIRE(ffs64(0) == 0x00);
151272343Sngie	ATF_REQUIRE(fls64(0) == 0x00);
152272343Sngie
153272343Sngie	ATF_REQUIRE(ffs32(UINT32_MAX) == 0x01);
154272343Sngie	ATF_REQUIRE(fls32(UINT32_MAX) == 0x20);
155272343Sngie	ATF_REQUIRE(ffs64(UINT64_MAX) == 0x01);
156272343Sngie	ATF_REQUIRE(fls64(UINT64_MAX) == 0x40);
157272343Sngie
158272343Sngie	for (i = 1; i < __arraycount(bits); i++) {
159272343Sngie
160272343Sngie		ATF_REQUIRE(ffs32(bits[i].val) == bits[i].ffs);
161272343Sngie		ATF_REQUIRE(fls32(bits[i].val) == bits[i].fls);
162272343Sngie		ATF_REQUIRE(ffs64(bits[i].val) == bits[i].ffs);
163272343Sngie		ATF_REQUIRE(fls64(bits[i].val) == bits[i].fls);
164272343Sngie
165272343Sngie		ATF_REQUIRE(ffs32(bits[i].val << 1) == bits[i].ffs + 1);
166272343Sngie		ATF_REQUIRE(fls32(bits[i].val << 1) == bits[i].fls + 1);
167272343Sngie		ATF_REQUIRE(ffs64(bits[i].val << 1) == bits[i].ffs + 1);
168272343Sngie		ATF_REQUIRE(fls64(bits[i].val << 1) == bits[i].fls + 1);
169272343Sngie
170272343Sngie		ATF_REQUIRE(ffs32(bits[i].val << 9) == bits[i].ffs + 9);
171272343Sngie		ATF_REQUIRE(fls32(bits[i].val << 9) == bits[i].fls + 9);
172272343Sngie		ATF_REQUIRE(ffs64(bits[i].val << 9) == bits[i].ffs + 9);
173272343Sngie		ATF_REQUIRE(fls64(bits[i].val << 9) == bits[i].fls + 9);
174272343Sngie	}
175272343Sngie}
176272343Sngie
177272343SngieATF_TC(ilog2_basic);
178272343SngieATF_TC_HEAD(ilog2_basic, tc)
179272343Sngie{
180272343Sngie	atf_tc_set_md_var(tc, "descr", "Test ilog2(3) for correctness");
181272343Sngie}
182272343Sngie
183272343SngieATF_TC_BODY(ilog2_basic, tc)
184272343Sngie{
185272343Sngie	uint64_t i, x;
186272343Sngie
187272343Sngie	for (i = x = 0; i < 64; i++) {
188272343Sngie
189272343Sngie		x = (uint64_t)1 << i;
190272343Sngie
191272343Sngie		ATF_REQUIRE(i == (uint64_t)ilog2(x));
192272343Sngie	}
193272343Sngie}
194272343Sngie
195272343SngieATF_TC(ilog2_log2);
196272343SngieATF_TC_HEAD(ilog2_log2, tc)
197272343Sngie{
198272343Sngie	atf_tc_set_md_var(tc, "descr", "Test log2(3) vs. ilog2(3)");
199272343Sngie}
200272343Sngie
201272343SngieATF_TC_BODY(ilog2_log2, tc)
202272343Sngie{
203272343Sngie#ifdef __vax__
204272343Sngie	atf_tc_skip("Test is unavailable on vax because of lack of log2()");
205272343Sngie#else
206272343Sngie	double  x, y;
207272343Sngie	uint64_t i;
208272343Sngie
209272343Sngie	/*
210272343Sngie	 * This may fail under QEMU; see PR misc/44767.
211272343Sngie	 */
212272343Sngie	for (i = 1; i < UINT32_MAX; i += UINT16_MAX) {
213272343Sngie
214272343Sngie		x = log2(i);
215272343Sngie		y = (double)(ilog2(i));
216272343Sngie
217272343Sngie		ATF_REQUIRE(ceil(x) >= y);
218272343Sngie
219272343Sngie		if (fabs(floor(x) - y) > 1.0e-40) {
220272343Sngie			atf_tc_expect_fail("PR misc/44767");
221272343Sngie			atf_tc_fail("log2(%"PRIu64") != "
222272343Sngie			    "ilog2(%"PRIu64")", i, i);
223272343Sngie		}
224272343Sngie	}
225272343Sngie#endif
226272343Sngie}
227272343Sngie
228272343SngieATF_TP_ADD_TCS(tp)
229272343Sngie{
230272343Sngie
231272343Sngie        ATF_TP_ADD_TC(tp, bitmap_basic);
232272343Sngie	ATF_TP_ADD_TC(tp, fast_divide32);
233272343Sngie	ATF_TP_ADD_TC(tp, ffsfls);
234272343Sngie	ATF_TP_ADD_TC(tp, ilog2_basic);
235272343Sngie	ATF_TP_ADD_TC(tp, ilog2_log2);
236272343Sngie
237272343Sngie	return atf_no_error();
238272343Sngie}
239