xref: /openbmc/u-boot/arch/mips/include/asm/bitops.h (revision 83d290c56fab2d38cd1ab4c4cc7099559c1d5046)
1*83d290c5STom Rini /* SPDX-License-Identifier: GPL-2.0 */
2819833afSPeter Tyser /*
3819833afSPeter Tyser  * Copyright (c) 1994 - 1997, 1999, 2000  Ralf Baechle (ralf@gnu.org)
4819833afSPeter Tyser  * Copyright (c) 2000  Silicon Graphics, Inc.
5819833afSPeter Tyser  */
6819833afSPeter Tyser #ifndef _ASM_BITOPS_H
7819833afSPeter Tyser #define _ASM_BITOPS_H
8819833afSPeter Tyser 
9819833afSPeter Tyser #include <linux/types.h>
10819833afSPeter Tyser #include <asm/byteorder.h>		/* sigh ... */
11819833afSPeter Tyser 
12819833afSPeter Tyser #ifdef __KERNEL__
13819833afSPeter Tyser 
14819833afSPeter Tyser #include <asm/sgidefs.h>
15819833afSPeter Tyser #include <asm/system.h>
16819833afSPeter Tyser 
17b810aa1dSFabio Estevam #include <asm-generic/bitops/fls.h>
18b810aa1dSFabio Estevam #include <asm-generic/bitops/__fls.h>
19b810aa1dSFabio Estevam #include <asm-generic/bitops/fls64.h>
20b810aa1dSFabio Estevam #include <asm-generic/bitops/__ffs.h>
21b810aa1dSFabio Estevam 
22819833afSPeter Tyser /*
23819833afSPeter Tyser  * clear_bit() doesn't provide any barrier for the compiler.
24819833afSPeter Tyser  */
25819833afSPeter Tyser #define smp_mb__before_clear_bit()	barrier()
26819833afSPeter Tyser #define smp_mb__after_clear_bit()	barrier()
27819833afSPeter Tyser 
28819833afSPeter Tyser /*
29819833afSPeter Tyser  * Only disable interrupt for kernel mode stuff to keep usermode stuff
30819833afSPeter Tyser  * that dares to use kernel include files alive.
31819833afSPeter Tyser  */
32819833afSPeter Tyser #define __bi_flags unsigned long flags
33819833afSPeter Tyser #define __bi_cli() __cli()
34819833afSPeter Tyser #define __bi_save_flags(x) __save_flags(x)
35819833afSPeter Tyser #define __bi_save_and_cli(x) __save_and_cli(x)
36819833afSPeter Tyser #define __bi_restore_flags(x) __restore_flags(x)
37819833afSPeter Tyser #else
38819833afSPeter Tyser #define __bi_flags
39819833afSPeter Tyser #define __bi_cli()
40819833afSPeter Tyser #define __bi_save_flags(x)
41819833afSPeter Tyser #define __bi_save_and_cli(x)
42819833afSPeter Tyser #define __bi_restore_flags(x)
43819833afSPeter Tyser #endif /* __KERNEL__ */
44819833afSPeter Tyser 
45819833afSPeter Tyser #ifdef CONFIG_CPU_HAS_LLSC
46819833afSPeter Tyser 
47819833afSPeter Tyser #include <asm/mipsregs.h>
48819833afSPeter Tyser 
49819833afSPeter Tyser /*
50819833afSPeter Tyser  * These functions for MIPS ISA > 1 are interrupt and SMP proof and
51819833afSPeter Tyser  * interrupt friendly
52819833afSPeter Tyser  */
53819833afSPeter Tyser 
54819833afSPeter Tyser /*
55819833afSPeter Tyser  * set_bit - Atomically set a bit in memory
56819833afSPeter Tyser  * @nr: the bit to set
57819833afSPeter Tyser  * @addr: the address to start counting from
58819833afSPeter Tyser  *
59819833afSPeter Tyser  * This function is atomic and may not be reordered.  See __set_bit()
60819833afSPeter Tyser  * if you do not require the atomic guarantees.
61819833afSPeter Tyser  * Note that @nr may be almost arbitrarily large; this function is not
62819833afSPeter Tyser  * restricted to acting on a single-word quantity.
63819833afSPeter Tyser  */
64819833afSPeter Tyser static __inline__ void
set_bit(int nr,volatile void * addr)65819833afSPeter Tyser set_bit(int nr, volatile void *addr)
66819833afSPeter Tyser {
67819833afSPeter Tyser 	unsigned long *m = ((unsigned long *) addr) + (nr >> 5);
68819833afSPeter Tyser 	unsigned long temp;
69819833afSPeter Tyser 
70819833afSPeter Tyser 	__asm__ __volatile__(
71819833afSPeter Tyser 		"1:\tll\t%0, %1\t\t# set_bit\n\t"
72819833afSPeter Tyser 		"or\t%0, %2\n\t"
73819833afSPeter Tyser 		"sc\t%0, %1\n\t"
74819833afSPeter Tyser 		"beqz\t%0, 1b"
75819833afSPeter Tyser 		: "=&r" (temp), "=m" (*m)
76819833afSPeter Tyser 		: "ir" (1UL << (nr & 0x1f)), "m" (*m));
77819833afSPeter Tyser }
78819833afSPeter Tyser 
79819833afSPeter Tyser /*
80819833afSPeter Tyser  * __set_bit - Set a bit in memory
81819833afSPeter Tyser  * @nr: the bit to set
82819833afSPeter Tyser  * @addr: the address to start counting from
83819833afSPeter Tyser  *
84819833afSPeter Tyser  * Unlike set_bit(), this function is non-atomic and may be reordered.
85819833afSPeter Tyser  * If it's called on the same region of memory simultaneously, the effect
86819833afSPeter Tyser  * may be that only one operation succeeds.
87819833afSPeter Tyser  */
__set_bit(int nr,volatile void * addr)88819833afSPeter Tyser static __inline__ void __set_bit(int nr, volatile void * addr)
89819833afSPeter Tyser {
90819833afSPeter Tyser 	unsigned long * m = ((unsigned long *) addr) + (nr >> 5);
91819833afSPeter Tyser 
92819833afSPeter Tyser 	*m |= 1UL << (nr & 31);
93819833afSPeter Tyser }
94819833afSPeter Tyser #define PLATFORM__SET_BIT
95819833afSPeter Tyser 
96819833afSPeter Tyser /*
97819833afSPeter Tyser  * clear_bit - Clears a bit in memory
98819833afSPeter Tyser  * @nr: Bit to clear
99819833afSPeter Tyser  * @addr: Address to start counting from
100819833afSPeter Tyser  *
101819833afSPeter Tyser  * clear_bit() is atomic and may not be reordered.  However, it does
102819833afSPeter Tyser  * not contain a memory barrier, so if it is used for locking purposes,
103819833afSPeter Tyser  * you should call smp_mb__before_clear_bit() and/or smp_mb__after_clear_bit()
104819833afSPeter Tyser  * in order to ensure changes are visible on other processors.
105819833afSPeter Tyser  */
106819833afSPeter Tyser static __inline__ void
clear_bit(int nr,volatile void * addr)107819833afSPeter Tyser clear_bit(int nr, volatile void *addr)
108819833afSPeter Tyser {
109819833afSPeter Tyser 	unsigned long *m = ((unsigned long *) addr) + (nr >> 5);
110819833afSPeter Tyser 	unsigned long temp;
111819833afSPeter Tyser 
112819833afSPeter Tyser 	__asm__ __volatile__(
113819833afSPeter Tyser 		"1:\tll\t%0, %1\t\t# clear_bit\n\t"
114819833afSPeter Tyser 		"and\t%0, %2\n\t"
115819833afSPeter Tyser 		"sc\t%0, %1\n\t"
116819833afSPeter Tyser 		"beqz\t%0, 1b\n\t"
117819833afSPeter Tyser 		: "=&r" (temp), "=m" (*m)
118819833afSPeter Tyser 		: "ir" (~(1UL << (nr & 0x1f))), "m" (*m));
119819833afSPeter Tyser }
120819833afSPeter Tyser 
121819833afSPeter Tyser /*
122819833afSPeter Tyser  * change_bit - Toggle a bit in memory
123819833afSPeter Tyser  * @nr: Bit to clear
124819833afSPeter Tyser  * @addr: Address to start counting from
125819833afSPeter Tyser  *
126819833afSPeter Tyser  * change_bit() is atomic and may not be reordered.
127819833afSPeter Tyser  * Note that @nr may be almost arbitrarily large; this function is not
128819833afSPeter Tyser  * restricted to acting on a single-word quantity.
129819833afSPeter Tyser  */
130819833afSPeter Tyser static __inline__ void
change_bit(int nr,volatile void * addr)131819833afSPeter Tyser change_bit(int nr, volatile void *addr)
132819833afSPeter Tyser {
133819833afSPeter Tyser 	unsigned long *m = ((unsigned long *) addr) + (nr >> 5);
134819833afSPeter Tyser 	unsigned long temp;
135819833afSPeter Tyser 
136819833afSPeter Tyser 	__asm__ __volatile__(
137819833afSPeter Tyser 		"1:\tll\t%0, %1\t\t# change_bit\n\t"
138819833afSPeter Tyser 		"xor\t%0, %2\n\t"
139819833afSPeter Tyser 		"sc\t%0, %1\n\t"
140819833afSPeter Tyser 		"beqz\t%0, 1b"
141819833afSPeter Tyser 		: "=&r" (temp), "=m" (*m)
142819833afSPeter Tyser 		: "ir" (1UL << (nr & 0x1f)), "m" (*m));
143819833afSPeter Tyser }
144819833afSPeter Tyser 
145819833afSPeter Tyser /*
146819833afSPeter Tyser  * __change_bit - Toggle a bit in memory
147819833afSPeter Tyser  * @nr: the bit to set
148819833afSPeter Tyser  * @addr: the address to start counting from
149819833afSPeter Tyser  *
150819833afSPeter Tyser  * Unlike change_bit(), this function is non-atomic and may be reordered.
151819833afSPeter Tyser  * If it's called on the same region of memory simultaneously, the effect
152819833afSPeter Tyser  * may be that only one operation succeeds.
153819833afSPeter Tyser  */
__change_bit(int nr,volatile void * addr)154819833afSPeter Tyser static __inline__ void __change_bit(int nr, volatile void * addr)
155819833afSPeter Tyser {
156819833afSPeter Tyser 	unsigned long * m = ((unsigned long *) addr) + (nr >> 5);
157819833afSPeter Tyser 
158819833afSPeter Tyser 	*m ^= 1UL << (nr & 31);
159819833afSPeter Tyser }
160819833afSPeter Tyser 
161819833afSPeter Tyser /*
162819833afSPeter Tyser  * test_and_set_bit - Set a bit and return its old value
163819833afSPeter Tyser  * @nr: Bit to set
164819833afSPeter Tyser  * @addr: Address to count from
165819833afSPeter Tyser  *
166819833afSPeter Tyser  * This operation is atomic and cannot be reordered.
167819833afSPeter Tyser  * It also implies a memory barrier.
168819833afSPeter Tyser  */
169819833afSPeter Tyser static __inline__ int
test_and_set_bit(int nr,volatile void * addr)170819833afSPeter Tyser test_and_set_bit(int nr, volatile void *addr)
171819833afSPeter Tyser {
172819833afSPeter Tyser 	unsigned long *m = ((unsigned long *) addr) + (nr >> 5);
173819833afSPeter Tyser 	unsigned long temp, res;
174819833afSPeter Tyser 
175819833afSPeter Tyser 	__asm__ __volatile__(
176819833afSPeter Tyser 		".set\tnoreorder\t\t# test_and_set_bit\n"
177819833afSPeter Tyser 		"1:\tll\t%0, %1\n\t"
178819833afSPeter Tyser 		"or\t%2, %0, %3\n\t"
179819833afSPeter Tyser 		"sc\t%2, %1\n\t"
180819833afSPeter Tyser 		"beqz\t%2, 1b\n\t"
181819833afSPeter Tyser 		" and\t%2, %0, %3\n\t"
182819833afSPeter Tyser 		".set\treorder"
183819833afSPeter Tyser 		: "=&r" (temp), "=m" (*m), "=&r" (res)
184819833afSPeter Tyser 		: "r" (1UL << (nr & 0x1f)), "m" (*m)
185819833afSPeter Tyser 		: "memory");
186819833afSPeter Tyser 
187819833afSPeter Tyser 	return res != 0;
188819833afSPeter Tyser }
189819833afSPeter Tyser 
190819833afSPeter Tyser /*
191819833afSPeter Tyser  * __test_and_set_bit - Set a bit and return its old value
192819833afSPeter Tyser  * @nr: Bit to set
193819833afSPeter Tyser  * @addr: Address to count from
194819833afSPeter Tyser  *
195819833afSPeter Tyser  * This operation is non-atomic and can be reordered.
196819833afSPeter Tyser  * If two examples of this operation race, one can appear to succeed
197819833afSPeter Tyser  * but actually fail.  You must protect multiple accesses with a lock.
198819833afSPeter Tyser  */
__test_and_set_bit(int nr,volatile void * addr)199819833afSPeter Tyser static __inline__ int __test_and_set_bit(int nr, volatile void * addr)
200819833afSPeter Tyser {
201819833afSPeter Tyser 	int mask, retval;
202819833afSPeter Tyser 	volatile int *a = addr;
203819833afSPeter Tyser 
204819833afSPeter Tyser 	a += nr >> 5;
205819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
206819833afSPeter Tyser 	retval = (mask & *a) != 0;
207819833afSPeter Tyser 	*a |= mask;
208819833afSPeter Tyser 
209819833afSPeter Tyser 	return retval;
210819833afSPeter Tyser }
211819833afSPeter Tyser 
212819833afSPeter Tyser /*
213819833afSPeter Tyser  * test_and_clear_bit - Clear a bit and return its old value
214819833afSPeter Tyser  * @nr: Bit to set
215819833afSPeter Tyser  * @addr: Address to count from
216819833afSPeter Tyser  *
217819833afSPeter Tyser  * This operation is atomic and cannot be reordered.
218819833afSPeter Tyser  * It also implies a memory barrier.
219819833afSPeter Tyser  */
220819833afSPeter Tyser static __inline__ int
test_and_clear_bit(int nr,volatile void * addr)221819833afSPeter Tyser test_and_clear_bit(int nr, volatile void *addr)
222819833afSPeter Tyser {
223819833afSPeter Tyser 	unsigned long *m = ((unsigned long *) addr) + (nr >> 5);
224819833afSPeter Tyser 	unsigned long temp, res;
225819833afSPeter Tyser 
226819833afSPeter Tyser 	__asm__ __volatile__(
227819833afSPeter Tyser 		".set\tnoreorder\t\t# test_and_clear_bit\n"
228819833afSPeter Tyser 		"1:\tll\t%0, %1\n\t"
229819833afSPeter Tyser 		"or\t%2, %0, %3\n\t"
230819833afSPeter Tyser 		"xor\t%2, %3\n\t"
231819833afSPeter Tyser 		"sc\t%2, %1\n\t"
232819833afSPeter Tyser 		"beqz\t%2, 1b\n\t"
233819833afSPeter Tyser 		" and\t%2, %0, %3\n\t"
234819833afSPeter Tyser 		".set\treorder"
235819833afSPeter Tyser 		: "=&r" (temp), "=m" (*m), "=&r" (res)
236819833afSPeter Tyser 		: "r" (1UL << (nr & 0x1f)), "m" (*m)
237819833afSPeter Tyser 		: "memory");
238819833afSPeter Tyser 
239819833afSPeter Tyser 	return res != 0;
240819833afSPeter Tyser }
241819833afSPeter Tyser 
242819833afSPeter Tyser /*
243819833afSPeter Tyser  * __test_and_clear_bit - Clear a bit and return its old value
244819833afSPeter Tyser  * @nr: Bit to set
245819833afSPeter Tyser  * @addr: Address to count from
246819833afSPeter Tyser  *
247819833afSPeter Tyser  * This operation is non-atomic and can be reordered.
248819833afSPeter Tyser  * If two examples of this operation race, one can appear to succeed
249819833afSPeter Tyser  * but actually fail.  You must protect multiple accesses with a lock.
250819833afSPeter Tyser  */
__test_and_clear_bit(int nr,volatile void * addr)251819833afSPeter Tyser static __inline__ int __test_and_clear_bit(int nr, volatile void * addr)
252819833afSPeter Tyser {
253819833afSPeter Tyser 	int	mask, retval;
254819833afSPeter Tyser 	volatile int	*a = addr;
255819833afSPeter Tyser 
256819833afSPeter Tyser 	a += nr >> 5;
257819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
258819833afSPeter Tyser 	retval = (mask & *a) != 0;
259819833afSPeter Tyser 	*a &= ~mask;
260819833afSPeter Tyser 
261819833afSPeter Tyser 	return retval;
262819833afSPeter Tyser }
263819833afSPeter Tyser 
264819833afSPeter Tyser /*
265819833afSPeter Tyser  * test_and_change_bit - Change a bit and return its new value
266819833afSPeter Tyser  * @nr: Bit to set
267819833afSPeter Tyser  * @addr: Address to count from
268819833afSPeter Tyser  *
269819833afSPeter Tyser  * This operation is atomic and cannot be reordered.
270819833afSPeter Tyser  * It also implies a memory barrier.
271819833afSPeter Tyser  */
272819833afSPeter Tyser static __inline__ int
test_and_change_bit(int nr,volatile void * addr)273819833afSPeter Tyser test_and_change_bit(int nr, volatile void *addr)
274819833afSPeter Tyser {
275819833afSPeter Tyser 	unsigned long *m = ((unsigned long *) addr) + (nr >> 5);
276819833afSPeter Tyser 	unsigned long temp, res;
277819833afSPeter Tyser 
278819833afSPeter Tyser 	__asm__ __volatile__(
279819833afSPeter Tyser 		".set\tnoreorder\t\t# test_and_change_bit\n"
280819833afSPeter Tyser 		"1:\tll\t%0, %1\n\t"
281819833afSPeter Tyser 		"xor\t%2, %0, %3\n\t"
282819833afSPeter Tyser 		"sc\t%2, %1\n\t"
283819833afSPeter Tyser 		"beqz\t%2, 1b\n\t"
284819833afSPeter Tyser 		" and\t%2, %0, %3\n\t"
285819833afSPeter Tyser 		".set\treorder"
286819833afSPeter Tyser 		: "=&r" (temp), "=m" (*m), "=&r" (res)
287819833afSPeter Tyser 		: "r" (1UL << (nr & 0x1f)), "m" (*m)
288819833afSPeter Tyser 		: "memory");
289819833afSPeter Tyser 
290819833afSPeter Tyser 	return res != 0;
291819833afSPeter Tyser }
292819833afSPeter Tyser 
293819833afSPeter Tyser /*
294819833afSPeter Tyser  * __test_and_change_bit - Change a bit and return its old value
295819833afSPeter Tyser  * @nr: Bit to set
296819833afSPeter Tyser  * @addr: Address to count from
297819833afSPeter Tyser  *
298819833afSPeter Tyser  * This operation is non-atomic and can be reordered.
299819833afSPeter Tyser  * If two examples of this operation race, one can appear to succeed
300819833afSPeter Tyser  * but actually fail.  You must protect multiple accesses with a lock.
301819833afSPeter Tyser  */
__test_and_change_bit(int nr,volatile void * addr)302819833afSPeter Tyser static __inline__ int __test_and_change_bit(int nr, volatile void * addr)
303819833afSPeter Tyser {
304819833afSPeter Tyser 	int	mask, retval;
305819833afSPeter Tyser 	volatile int	*a = addr;
306819833afSPeter Tyser 
307819833afSPeter Tyser 	a += nr >> 5;
308819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
309819833afSPeter Tyser 	retval = (mask & *a) != 0;
310819833afSPeter Tyser 	*a ^= mask;
311819833afSPeter Tyser 
312819833afSPeter Tyser 	return retval;
313819833afSPeter Tyser }
314819833afSPeter Tyser 
315819833afSPeter Tyser #else /* MIPS I */
316819833afSPeter Tyser 
317819833afSPeter Tyser /*
318819833afSPeter Tyser  * set_bit - Atomically set a bit in memory
319819833afSPeter Tyser  * @nr: the bit to set
320819833afSPeter Tyser  * @addr: the address to start counting from
321819833afSPeter Tyser  *
322819833afSPeter Tyser  * This function is atomic and may not be reordered.  See __set_bit()
323819833afSPeter Tyser  * if you do not require the atomic guarantees.
324819833afSPeter Tyser  * Note that @nr may be almost arbitrarily large; this function is not
325819833afSPeter Tyser  * restricted to acting on a single-word quantity.
326819833afSPeter Tyser  */
set_bit(int nr,volatile void * addr)327819833afSPeter Tyser static __inline__ void set_bit(int nr, volatile void * addr)
328819833afSPeter Tyser {
329819833afSPeter Tyser 	int	mask;
330819833afSPeter Tyser 	volatile int	*a = addr;
331819833afSPeter Tyser 	__bi_flags;
332819833afSPeter Tyser 
333819833afSPeter Tyser 	a += nr >> 5;
334819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
335819833afSPeter Tyser 	__bi_save_and_cli(flags);
336819833afSPeter Tyser 	*a |= mask;
337819833afSPeter Tyser 	__bi_restore_flags(flags);
338819833afSPeter Tyser }
339819833afSPeter Tyser 
340819833afSPeter Tyser /*
341819833afSPeter Tyser  * __set_bit - Set a bit in memory
342819833afSPeter Tyser  * @nr: the bit to set
343819833afSPeter Tyser  * @addr: the address to start counting from
344819833afSPeter Tyser  *
345819833afSPeter Tyser  * Unlike set_bit(), this function is non-atomic and may be reordered.
346819833afSPeter Tyser  * If it's called on the same region of memory simultaneously, the effect
347819833afSPeter Tyser  * may be that only one operation succeeds.
348819833afSPeter Tyser  */
__set_bit(int nr,volatile void * addr)349819833afSPeter Tyser static __inline__ void __set_bit(int nr, volatile void * addr)
350819833afSPeter Tyser {
351819833afSPeter Tyser 	int	mask;
352819833afSPeter Tyser 	volatile int	*a = addr;
353819833afSPeter Tyser 
354819833afSPeter Tyser 	a += nr >> 5;
355819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
356819833afSPeter Tyser 	*a |= mask;
357819833afSPeter Tyser }
358819833afSPeter Tyser 
359819833afSPeter Tyser /*
360819833afSPeter Tyser  * clear_bit - Clears a bit in memory
361819833afSPeter Tyser  * @nr: Bit to clear
362819833afSPeter Tyser  * @addr: Address to start counting from
363819833afSPeter Tyser  *
364819833afSPeter Tyser  * clear_bit() is atomic and may not be reordered.  However, it does
365819833afSPeter Tyser  * not contain a memory barrier, so if it is used for locking purposes,
366819833afSPeter Tyser  * you should call smp_mb__before_clear_bit() and/or smp_mb__after_clear_bit()
367819833afSPeter Tyser  * in order to ensure changes are visible on other processors.
368819833afSPeter Tyser  */
clear_bit(int nr,volatile void * addr)369819833afSPeter Tyser static __inline__ void clear_bit(int nr, volatile void * addr)
370819833afSPeter Tyser {
371819833afSPeter Tyser 	int	mask;
372819833afSPeter Tyser 	volatile int	*a = addr;
373819833afSPeter Tyser 	__bi_flags;
374819833afSPeter Tyser 
375819833afSPeter Tyser 	a += nr >> 5;
376819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
377819833afSPeter Tyser 	__bi_save_and_cli(flags);
378819833afSPeter Tyser 	*a &= ~mask;
379819833afSPeter Tyser 	__bi_restore_flags(flags);
380819833afSPeter Tyser }
381819833afSPeter Tyser 
382819833afSPeter Tyser /*
383819833afSPeter Tyser  * change_bit - Toggle a bit in memory
384819833afSPeter Tyser  * @nr: Bit to clear
385819833afSPeter Tyser  * @addr: Address to start counting from
386819833afSPeter Tyser  *
387819833afSPeter Tyser  * change_bit() is atomic and may not be reordered.
388819833afSPeter Tyser  * Note that @nr may be almost arbitrarily large; this function is not
389819833afSPeter Tyser  * restricted to acting on a single-word quantity.
390819833afSPeter Tyser  */
change_bit(int nr,volatile void * addr)391819833afSPeter Tyser static __inline__ void change_bit(int nr, volatile void * addr)
392819833afSPeter Tyser {
393819833afSPeter Tyser 	int	mask;
394819833afSPeter Tyser 	volatile int	*a = addr;
395819833afSPeter Tyser 	__bi_flags;
396819833afSPeter Tyser 
397819833afSPeter Tyser 	a += nr >> 5;
398819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
399819833afSPeter Tyser 	__bi_save_and_cli(flags);
400819833afSPeter Tyser 	*a ^= mask;
401819833afSPeter Tyser 	__bi_restore_flags(flags);
402819833afSPeter Tyser }
403819833afSPeter Tyser 
404819833afSPeter Tyser /*
405819833afSPeter Tyser  * __change_bit - Toggle a bit in memory
406819833afSPeter Tyser  * @nr: the bit to set
407819833afSPeter Tyser  * @addr: the address to start counting from
408819833afSPeter Tyser  *
409819833afSPeter Tyser  * Unlike change_bit(), this function is non-atomic and may be reordered.
410819833afSPeter Tyser  * If it's called on the same region of memory simultaneously, the effect
411819833afSPeter Tyser  * may be that only one operation succeeds.
412819833afSPeter Tyser  */
__change_bit(int nr,volatile void * addr)413819833afSPeter Tyser static __inline__ void __change_bit(int nr, volatile void * addr)
414819833afSPeter Tyser {
415819833afSPeter Tyser 	unsigned long * m = ((unsigned long *) addr) + (nr >> 5);
416819833afSPeter Tyser 
417819833afSPeter Tyser 	*m ^= 1UL << (nr & 31);
418819833afSPeter Tyser }
419819833afSPeter Tyser 
420819833afSPeter Tyser /*
421819833afSPeter Tyser  * test_and_set_bit - Set a bit and return its old value
422819833afSPeter Tyser  * @nr: Bit to set
423819833afSPeter Tyser  * @addr: Address to count from
424819833afSPeter Tyser  *
425819833afSPeter Tyser  * This operation is atomic and cannot be reordered.
426819833afSPeter Tyser  * It also implies a memory barrier.
427819833afSPeter Tyser  */
test_and_set_bit(int nr,volatile void * addr)428819833afSPeter Tyser static __inline__ int test_and_set_bit(int nr, volatile void * addr)
429819833afSPeter Tyser {
430819833afSPeter Tyser 	int	mask, retval;
431819833afSPeter Tyser 	volatile int	*a = addr;
432819833afSPeter Tyser 	__bi_flags;
433819833afSPeter Tyser 
434819833afSPeter Tyser 	a += nr >> 5;
435819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
436819833afSPeter Tyser 	__bi_save_and_cli(flags);
437819833afSPeter Tyser 	retval = (mask & *a) != 0;
438819833afSPeter Tyser 	*a |= mask;
439819833afSPeter Tyser 	__bi_restore_flags(flags);
440819833afSPeter Tyser 
441819833afSPeter Tyser 	return retval;
442819833afSPeter Tyser }
443819833afSPeter Tyser 
444819833afSPeter Tyser /*
445819833afSPeter Tyser  * __test_and_set_bit - Set a bit and return its old value
446819833afSPeter Tyser  * @nr: Bit to set
447819833afSPeter Tyser  * @addr: Address to count from
448819833afSPeter Tyser  *
449819833afSPeter Tyser  * This operation is non-atomic and can be reordered.
450819833afSPeter Tyser  * If two examples of this operation race, one can appear to succeed
451819833afSPeter Tyser  * but actually fail.  You must protect multiple accesses with a lock.
452819833afSPeter Tyser  */
__test_and_set_bit(int nr,volatile void * addr)453819833afSPeter Tyser static __inline__ int __test_and_set_bit(int nr, volatile void * addr)
454819833afSPeter Tyser {
455819833afSPeter Tyser 	int	mask, retval;
456819833afSPeter Tyser 	volatile int	*a = addr;
457819833afSPeter Tyser 
458819833afSPeter Tyser 	a += nr >> 5;
459819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
460819833afSPeter Tyser 	retval = (mask & *a) != 0;
461819833afSPeter Tyser 	*a |= mask;
462819833afSPeter Tyser 
463819833afSPeter Tyser 	return retval;
464819833afSPeter Tyser }
465819833afSPeter Tyser 
466819833afSPeter Tyser /*
467819833afSPeter Tyser  * test_and_clear_bit - Clear a bit and return its old value
468819833afSPeter Tyser  * @nr: Bit to set
469819833afSPeter Tyser  * @addr: Address to count from
470819833afSPeter Tyser  *
471819833afSPeter Tyser  * This operation is atomic and cannot be reordered.
472819833afSPeter Tyser  * It also implies a memory barrier.
473819833afSPeter Tyser  */
test_and_clear_bit(int nr,volatile void * addr)474819833afSPeter Tyser static __inline__ int test_and_clear_bit(int nr, volatile void * addr)
475819833afSPeter Tyser {
476819833afSPeter Tyser 	int	mask, retval;
477819833afSPeter Tyser 	volatile int	*a = addr;
478819833afSPeter Tyser 	__bi_flags;
479819833afSPeter Tyser 
480819833afSPeter Tyser 	a += nr >> 5;
481819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
482819833afSPeter Tyser 	__bi_save_and_cli(flags);
483819833afSPeter Tyser 	retval = (mask & *a) != 0;
484819833afSPeter Tyser 	*a &= ~mask;
485819833afSPeter Tyser 	__bi_restore_flags(flags);
486819833afSPeter Tyser 
487819833afSPeter Tyser 	return retval;
488819833afSPeter Tyser }
489819833afSPeter Tyser 
490819833afSPeter Tyser /*
491819833afSPeter Tyser  * __test_and_clear_bit - Clear a bit and return its old value
492819833afSPeter Tyser  * @nr: Bit to set
493819833afSPeter Tyser  * @addr: Address to count from
494819833afSPeter Tyser  *
495819833afSPeter Tyser  * This operation is non-atomic and can be reordered.
496819833afSPeter Tyser  * If two examples of this operation race, one can appear to succeed
497819833afSPeter Tyser  * but actually fail.  You must protect multiple accesses with a lock.
498819833afSPeter Tyser  */
__test_and_clear_bit(int nr,volatile void * addr)499819833afSPeter Tyser static __inline__ int __test_and_clear_bit(int nr, volatile void * addr)
500819833afSPeter Tyser {
501819833afSPeter Tyser 	int	mask, retval;
502819833afSPeter Tyser 	volatile int	*a = addr;
503819833afSPeter Tyser 
504819833afSPeter Tyser 	a += nr >> 5;
505819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
506819833afSPeter Tyser 	retval = (mask & *a) != 0;
507819833afSPeter Tyser 	*a &= ~mask;
508819833afSPeter Tyser 
509819833afSPeter Tyser 	return retval;
510819833afSPeter Tyser }
511819833afSPeter Tyser 
512819833afSPeter Tyser /*
513819833afSPeter Tyser  * test_and_change_bit - Change a bit and return its new value
514819833afSPeter Tyser  * @nr: Bit to set
515819833afSPeter Tyser  * @addr: Address to count from
516819833afSPeter Tyser  *
517819833afSPeter Tyser  * This operation is atomic and cannot be reordered.
518819833afSPeter Tyser  * It also implies a memory barrier.
519819833afSPeter Tyser  */
test_and_change_bit(int nr,volatile void * addr)520819833afSPeter Tyser static __inline__ int test_and_change_bit(int nr, volatile void * addr)
521819833afSPeter Tyser {
522819833afSPeter Tyser 	int	mask, retval;
523819833afSPeter Tyser 	volatile int	*a = addr;
524819833afSPeter Tyser 	__bi_flags;
525819833afSPeter Tyser 
526819833afSPeter Tyser 	a += nr >> 5;
527819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
528819833afSPeter Tyser 	__bi_save_and_cli(flags);
529819833afSPeter Tyser 	retval = (mask & *a) != 0;
530819833afSPeter Tyser 	*a ^= mask;
531819833afSPeter Tyser 	__bi_restore_flags(flags);
532819833afSPeter Tyser 
533819833afSPeter Tyser 	return retval;
534819833afSPeter Tyser }
535819833afSPeter Tyser 
536819833afSPeter Tyser /*
537819833afSPeter Tyser  * __test_and_change_bit - Change a bit and return its old value
538819833afSPeter Tyser  * @nr: Bit to set
539819833afSPeter Tyser  * @addr: Address to count from
540819833afSPeter Tyser  *
541819833afSPeter Tyser  * This operation is non-atomic and can be reordered.
542819833afSPeter Tyser  * If two examples of this operation race, one can appear to succeed
543819833afSPeter Tyser  * but actually fail.  You must protect multiple accesses with a lock.
544819833afSPeter Tyser  */
__test_and_change_bit(int nr,volatile void * addr)545819833afSPeter Tyser static __inline__ int __test_and_change_bit(int nr, volatile void * addr)
546819833afSPeter Tyser {
547819833afSPeter Tyser 	int	mask, retval;
548819833afSPeter Tyser 	volatile int	*a = addr;
549819833afSPeter Tyser 
550819833afSPeter Tyser 	a += nr >> 5;
551819833afSPeter Tyser 	mask = 1 << (nr & 0x1f);
552819833afSPeter Tyser 	retval = (mask & *a) != 0;
553819833afSPeter Tyser 	*a ^= mask;
554819833afSPeter Tyser 
555819833afSPeter Tyser 	return retval;
556819833afSPeter Tyser }
557819833afSPeter Tyser 
558819833afSPeter Tyser #undef __bi_flags
559819833afSPeter Tyser #undef __bi_cli
560819833afSPeter Tyser #undef __bi_save_flags
561819833afSPeter Tyser #undef __bi_restore_flags
562819833afSPeter Tyser 
563819833afSPeter Tyser #endif /* MIPS I */
564819833afSPeter Tyser 
565819833afSPeter Tyser /*
566819833afSPeter Tyser  * test_bit - Determine whether a bit is set
567819833afSPeter Tyser  * @nr: bit number to test
568819833afSPeter Tyser  * @addr: Address to start counting from
569819833afSPeter Tyser  */
test_bit(int nr,const volatile void * addr)570ea40a054SDaniel Schwierzeck static __inline__ int test_bit(int nr, const volatile void *addr)
571819833afSPeter Tyser {
572819833afSPeter Tyser 	return ((1UL << (nr & 31)) & (((const unsigned int *) addr)[nr >> 5])) != 0;
573819833afSPeter Tyser }
574819833afSPeter Tyser 
575819833afSPeter Tyser #ifndef __MIPSEB__
576819833afSPeter Tyser 
577819833afSPeter Tyser /* Little endian versions. */
578819833afSPeter Tyser 
579819833afSPeter Tyser /*
580819833afSPeter Tyser  * find_first_zero_bit - find the first zero bit in a memory region
581819833afSPeter Tyser  * @addr: The address to start the search at
582819833afSPeter Tyser  * @size: The maximum size to search
583819833afSPeter Tyser  *
584819833afSPeter Tyser  * Returns the bit-number of the first zero bit, not the number of the byte
585819833afSPeter Tyser  * containing a bit.
586819833afSPeter Tyser  */
find_first_zero_bit(void * addr,unsigned size)587819833afSPeter Tyser static __inline__ int find_first_zero_bit (void *addr, unsigned size)
588819833afSPeter Tyser {
589819833afSPeter Tyser 	unsigned long dummy;
590819833afSPeter Tyser 	int res;
591819833afSPeter Tyser 
592819833afSPeter Tyser 	if (!size)
593819833afSPeter Tyser 		return 0;
594819833afSPeter Tyser 
595819833afSPeter Tyser 	__asm__ (".set\tnoreorder\n\t"
596819833afSPeter Tyser 		".set\tnoat\n"
597819833afSPeter Tyser 		"1:\tsubu\t$1,%6,%0\n\t"
598819833afSPeter Tyser 		"blez\t$1,2f\n\t"
599819833afSPeter Tyser 		"lw\t$1,(%5)\n\t"
600819833afSPeter Tyser 		"addiu\t%5,4\n\t"
601819833afSPeter Tyser #if (_MIPS_ISA == _MIPS_ISA_MIPS2 ) || (_MIPS_ISA == _MIPS_ISA_MIPS3 ) || \
602819833afSPeter Tyser     (_MIPS_ISA == _MIPS_ISA_MIPS4 ) || (_MIPS_ISA == _MIPS_ISA_MIPS5 ) || \
603819833afSPeter Tyser     (_MIPS_ISA == _MIPS_ISA_MIPS32) || (_MIPS_ISA == _MIPS_ISA_MIPS64)
604819833afSPeter Tyser 		"beql\t%1,$1,1b\n\t"
605819833afSPeter Tyser 		"addiu\t%0,32\n\t"
606819833afSPeter Tyser #else
607819833afSPeter Tyser 		"addiu\t%0,32\n\t"
608819833afSPeter Tyser 		"beq\t%1,$1,1b\n\t"
609819833afSPeter Tyser 		"nop\n\t"
610819833afSPeter Tyser 		"subu\t%0,32\n\t"
611819833afSPeter Tyser #endif
612819833afSPeter Tyser #ifdef __MIPSEB__
613819833afSPeter Tyser #error "Fix this for big endian"
614819833afSPeter Tyser #endif /* __MIPSEB__ */
615819833afSPeter Tyser 		"li\t%1,1\n"
616819833afSPeter Tyser 		"1:\tand\t%2,$1,%1\n\t"
617819833afSPeter Tyser 		"beqz\t%2,2f\n\t"
618819833afSPeter Tyser 		"sll\t%1,%1,1\n\t"
619819833afSPeter Tyser 		"bnez\t%1,1b\n\t"
620819833afSPeter Tyser 		"add\t%0,%0,1\n\t"
621819833afSPeter Tyser 		".set\tat\n\t"
622819833afSPeter Tyser 		".set\treorder\n"
623819833afSPeter Tyser 		"2:"
624819833afSPeter Tyser 		: "=r" (res), "=r" (dummy), "=r" (addr)
625819833afSPeter Tyser 		: "0" ((signed int) 0), "1" ((unsigned int) 0xffffffff),
626819833afSPeter Tyser 		  "2" (addr), "r" (size)
627819833afSPeter Tyser 		: "$1");
628819833afSPeter Tyser 
629819833afSPeter Tyser 	return res;
630819833afSPeter Tyser }
631819833afSPeter Tyser 
632819833afSPeter Tyser /*
633819833afSPeter Tyser  * find_next_zero_bit - find the first zero bit in a memory region
634819833afSPeter Tyser  * @addr: The address to base the search on
635819833afSPeter Tyser  * @offset: The bitnumber to start searching at
636819833afSPeter Tyser  * @size: The maximum size to search
637819833afSPeter Tyser  */
find_next_zero_bit(void * addr,int size,int offset)638819833afSPeter Tyser static __inline__ int find_next_zero_bit (void * addr, int size, int offset)
639819833afSPeter Tyser {
640819833afSPeter Tyser 	unsigned int *p = ((unsigned int *) addr) + (offset >> 5);
641819833afSPeter Tyser 	int set = 0, bit = offset & 31, res;
642819833afSPeter Tyser 	unsigned long dummy;
643819833afSPeter Tyser 
644819833afSPeter Tyser 	if (bit) {
645819833afSPeter Tyser 		/*
646819833afSPeter Tyser 		 * Look for zero in first byte
647819833afSPeter Tyser 		 */
648819833afSPeter Tyser #ifdef __MIPSEB__
649819833afSPeter Tyser #error "Fix this for big endian byte order"
650819833afSPeter Tyser #endif
651819833afSPeter Tyser 		__asm__(".set\tnoreorder\n\t"
652819833afSPeter Tyser 			".set\tnoat\n"
653819833afSPeter Tyser 			"1:\tand\t$1,%4,%1\n\t"
654819833afSPeter Tyser 			"beqz\t$1,1f\n\t"
655819833afSPeter Tyser 			"sll\t%1,%1,1\n\t"
656819833afSPeter Tyser 			"bnez\t%1,1b\n\t"
657819833afSPeter Tyser 			"addiu\t%0,1\n\t"
658819833afSPeter Tyser 			".set\tat\n\t"
659819833afSPeter Tyser 			".set\treorder\n"
660819833afSPeter Tyser 			"1:"
661819833afSPeter Tyser 			: "=r" (set), "=r" (dummy)
662819833afSPeter Tyser 			: "0" (0), "1" (1 << bit), "r" (*p)
663819833afSPeter Tyser 			: "$1");
664819833afSPeter Tyser 		if (set < (32 - bit))
665819833afSPeter Tyser 			return set + offset;
666819833afSPeter Tyser 		set = 32 - bit;
667819833afSPeter Tyser 		p++;
668819833afSPeter Tyser 	}
669819833afSPeter Tyser 	/*
670819833afSPeter Tyser 	 * No zero yet, search remaining full bytes for a zero
671819833afSPeter Tyser 	 */
672819833afSPeter Tyser 	res = find_first_zero_bit(p, size - 32 * (p - (unsigned int *) addr));
673819833afSPeter Tyser 	return offset + set + res;
674819833afSPeter Tyser }
675819833afSPeter Tyser 
676819833afSPeter Tyser #endif /* !(__MIPSEB__) */
677819833afSPeter Tyser 
678819833afSPeter Tyser /*
679819833afSPeter Tyser  * ffz - find first zero in word.
680819833afSPeter Tyser  * @word: The word to search
681819833afSPeter Tyser  *
682819833afSPeter Tyser  * Undefined if no zero exists, so code should check against ~0UL first.
683819833afSPeter Tyser  */
ffz(unsigned long word)684819833afSPeter Tyser static __inline__ unsigned long ffz(unsigned long word)
685819833afSPeter Tyser {
686819833afSPeter Tyser 	unsigned int	__res;
687819833afSPeter Tyser 	unsigned int	mask = 1;
688819833afSPeter Tyser 
689819833afSPeter Tyser 	__asm__ (
690819833afSPeter Tyser 		".set\tnoreorder\n\t"
691819833afSPeter Tyser 		".set\tnoat\n\t"
692819833afSPeter Tyser 		"move\t%0,$0\n"
693819833afSPeter Tyser 		"1:\tand\t$1,%2,%1\n\t"
694819833afSPeter Tyser 		"beqz\t$1,2f\n\t"
695819833afSPeter Tyser 		"sll\t%1,1\n\t"
696819833afSPeter Tyser 		"bnez\t%1,1b\n\t"
697819833afSPeter Tyser 		"addiu\t%0,1\n\t"
698819833afSPeter Tyser 		".set\tat\n\t"
699819833afSPeter Tyser 		".set\treorder\n"
700819833afSPeter Tyser 		"2:\n\t"
701819833afSPeter Tyser 		: "=&r" (__res), "=r" (mask)
702819833afSPeter Tyser 		: "r" (word), "1" (mask)
703819833afSPeter Tyser 		: "$1");
704819833afSPeter Tyser 
705819833afSPeter Tyser 	return __res;
706819833afSPeter Tyser }
707819833afSPeter Tyser 
708819833afSPeter Tyser #ifdef __KERNEL__
709819833afSPeter Tyser 
710819833afSPeter Tyser /*
711819833afSPeter Tyser  * hweightN - returns the hamming weight of a N-bit word
712819833afSPeter Tyser  * @x: the word to weigh
713819833afSPeter Tyser  *
714819833afSPeter Tyser  * The Hamming Weight of a number is the total number of bits set in it.
715819833afSPeter Tyser  */
716819833afSPeter Tyser 
717819833afSPeter Tyser #define hweight32(x) generic_hweight32(x)
718819833afSPeter Tyser #define hweight16(x) generic_hweight16(x)
719819833afSPeter Tyser #define hweight8(x) generic_hweight8(x)
720819833afSPeter Tyser 
721819833afSPeter Tyser #endif /* __KERNEL__ */
722819833afSPeter Tyser 
723819833afSPeter Tyser #ifdef __MIPSEB__
724819833afSPeter Tyser /*
725819833afSPeter Tyser  * find_next_zero_bit - find the first zero bit in a memory region
726819833afSPeter Tyser  * @addr: The address to base the search on
727819833afSPeter Tyser  * @offset: The bitnumber to start searching at
728819833afSPeter Tyser  * @size: The maximum size to search
729819833afSPeter Tyser  */
find_next_zero_bit(void * addr,int size,int offset)730819833afSPeter Tyser static __inline__ int find_next_zero_bit(void *addr, int size, int offset)
731819833afSPeter Tyser {
732819833afSPeter Tyser 	unsigned long *p = ((unsigned long *) addr) + (offset >> 5);
733819833afSPeter Tyser 	unsigned long result = offset & ~31UL;
734819833afSPeter Tyser 	unsigned long tmp;
735819833afSPeter Tyser 
736819833afSPeter Tyser 	if (offset >= size)
737819833afSPeter Tyser 		return size;
738819833afSPeter Tyser 	size -= result;
739819833afSPeter Tyser 	offset &= 31UL;
740819833afSPeter Tyser 	if (offset) {
741819833afSPeter Tyser 		tmp = *(p++);
742819833afSPeter Tyser 		tmp |= ~0UL >> (32-offset);
743819833afSPeter Tyser 		if (size < 32)
744819833afSPeter Tyser 			goto found_first;
745819833afSPeter Tyser 		if (~tmp)
746819833afSPeter Tyser 			goto found_middle;
747819833afSPeter Tyser 		size -= 32;
748819833afSPeter Tyser 		result += 32;
749819833afSPeter Tyser 	}
750819833afSPeter Tyser 	while (size & ~31UL) {
751819833afSPeter Tyser 		if (~(tmp = *(p++)))
752819833afSPeter Tyser 			goto found_middle;
753819833afSPeter Tyser 		result += 32;
754819833afSPeter Tyser 		size -= 32;
755819833afSPeter Tyser 	}
756819833afSPeter Tyser 	if (!size)
757819833afSPeter Tyser 		return result;
758819833afSPeter Tyser 	tmp = *p;
759819833afSPeter Tyser 
760819833afSPeter Tyser found_first:
761819833afSPeter Tyser 	tmp |= ~0UL << size;
762819833afSPeter Tyser found_middle:
763819833afSPeter Tyser 	return result + ffz(tmp);
764819833afSPeter Tyser }
765819833afSPeter Tyser 
766819833afSPeter Tyser /* Linus sez that gcc can optimize the following correctly, we'll see if this
767819833afSPeter Tyser  * holds on the Sparc as it does for the ALPHA.
768819833afSPeter Tyser  */
769819833afSPeter Tyser 
770819833afSPeter Tyser #if 0 /* Fool kernel-doc since it doesn't do macros yet */
771819833afSPeter Tyser /*
772819833afSPeter Tyser  * find_first_zero_bit - find the first zero bit in a memory region
773819833afSPeter Tyser  * @addr: The address to start the search at
774819833afSPeter Tyser  * @size: The maximum size to search
775819833afSPeter Tyser  *
776819833afSPeter Tyser  * Returns the bit-number of the first zero bit, not the number of the byte
777819833afSPeter Tyser  * containing a bit.
778819833afSPeter Tyser  */
779819833afSPeter Tyser static int find_first_zero_bit (void *addr, unsigned size);
780819833afSPeter Tyser #endif
781819833afSPeter Tyser 
782819833afSPeter Tyser #define find_first_zero_bit(addr, size) \
783819833afSPeter Tyser 	find_next_zero_bit((addr), (size), 0)
784819833afSPeter Tyser 
785819833afSPeter Tyser #endif /* (__MIPSEB__) */
786819833afSPeter Tyser 
787819833afSPeter Tyser /* Now for the ext2 filesystem bit operations and helper routines. */
788819833afSPeter Tyser 
789819833afSPeter Tyser #ifdef __MIPSEB__
ext2_set_bit(int nr,void * addr)790819833afSPeter Tyser static __inline__ int ext2_set_bit(int nr, void * addr)
791819833afSPeter Tyser {
792819833afSPeter Tyser 	int		mask, retval, flags;
793819833afSPeter Tyser 	unsigned char	*ADDR = (unsigned char *) addr;
794819833afSPeter Tyser 
795819833afSPeter Tyser 	ADDR += nr >> 3;
796819833afSPeter Tyser 	mask = 1 << (nr & 0x07);
797819833afSPeter Tyser 	save_and_cli(flags);
798819833afSPeter Tyser 	retval = (mask & *ADDR) != 0;
799819833afSPeter Tyser 	*ADDR |= mask;
800819833afSPeter Tyser 	restore_flags(flags);
801819833afSPeter Tyser 	return retval;
802819833afSPeter Tyser }
803819833afSPeter Tyser 
ext2_clear_bit(int nr,void * addr)804819833afSPeter Tyser static __inline__ int ext2_clear_bit(int nr, void * addr)
805819833afSPeter Tyser {
806819833afSPeter Tyser 	int		mask, retval, flags;
807819833afSPeter Tyser 	unsigned char	*ADDR = (unsigned char *) addr;
808819833afSPeter Tyser 
809819833afSPeter Tyser 	ADDR += nr >> 3;
810819833afSPeter Tyser 	mask = 1 << (nr & 0x07);
811819833afSPeter Tyser 	save_and_cli(flags);
812819833afSPeter Tyser 	retval = (mask & *ADDR) != 0;
813819833afSPeter Tyser 	*ADDR &= ~mask;
814819833afSPeter Tyser 	restore_flags(flags);
815819833afSPeter Tyser 	return retval;
816819833afSPeter Tyser }
817819833afSPeter Tyser 
ext2_test_bit(int nr,const void * addr)818819833afSPeter Tyser static __inline__ int ext2_test_bit(int nr, const void * addr)
819819833afSPeter Tyser {
820819833afSPeter Tyser 	int			mask;
821819833afSPeter Tyser 	const unsigned char	*ADDR = (const unsigned char *) addr;
822819833afSPeter Tyser 
823819833afSPeter Tyser 	ADDR += nr >> 3;
824819833afSPeter Tyser 	mask = 1 << (nr & 0x07);
825819833afSPeter Tyser 	return ((mask & *ADDR) != 0);
826819833afSPeter Tyser }
827819833afSPeter Tyser 
828819833afSPeter Tyser #define ext2_find_first_zero_bit(addr, size) \
829819833afSPeter Tyser 	ext2_find_next_zero_bit((addr), (size), 0)
830819833afSPeter Tyser 
ext2_find_next_zero_bit(void * addr,unsigned long size,unsigned long offset)831819833afSPeter Tyser static __inline__ unsigned long ext2_find_next_zero_bit(void *addr, unsigned long size, unsigned long offset)
832819833afSPeter Tyser {
833819833afSPeter Tyser 	unsigned long *p = ((unsigned long *) addr) + (offset >> 5);
834819833afSPeter Tyser 	unsigned long result = offset & ~31UL;
835819833afSPeter Tyser 	unsigned long tmp;
836819833afSPeter Tyser 
837819833afSPeter Tyser 	if (offset >= size)
838819833afSPeter Tyser 		return size;
839819833afSPeter Tyser 	size -= result;
840819833afSPeter Tyser 	offset &= 31UL;
841819833afSPeter Tyser 	if(offset) {
842819833afSPeter Tyser 		/* We hold the little endian value in tmp, but then the
843819833afSPeter Tyser 		 * shift is illegal. So we could keep a big endian value
844819833afSPeter Tyser 		 * in tmp, like this:
845819833afSPeter Tyser 		 *
846819833afSPeter Tyser 		 * tmp = __swab32(*(p++));
847819833afSPeter Tyser 		 * tmp |= ~0UL >> (32-offset);
848819833afSPeter Tyser 		 *
849819833afSPeter Tyser 		 * but this would decrease preformance, so we change the
850819833afSPeter Tyser 		 * shift:
851819833afSPeter Tyser 		 */
852819833afSPeter Tyser 		tmp = *(p++);
853819833afSPeter Tyser 		tmp |= __swab32(~0UL >> (32-offset));
854819833afSPeter Tyser 		if(size < 32)
855819833afSPeter Tyser 			goto found_first;
856819833afSPeter Tyser 		if(~tmp)
857819833afSPeter Tyser 			goto found_middle;
858819833afSPeter Tyser 		size -= 32;
859819833afSPeter Tyser 		result += 32;
860819833afSPeter Tyser 	}
861819833afSPeter Tyser 	while(size & ~31UL) {
862819833afSPeter Tyser 		if(~(tmp = *(p++)))
863819833afSPeter Tyser 			goto found_middle;
864819833afSPeter Tyser 		result += 32;
865819833afSPeter Tyser 		size -= 32;
866819833afSPeter Tyser 	}
867819833afSPeter Tyser 	if(!size)
868819833afSPeter Tyser 		return result;
869819833afSPeter Tyser 	tmp = *p;
870819833afSPeter Tyser 
871819833afSPeter Tyser found_first:
872819833afSPeter Tyser 	/* tmp is little endian, so we would have to swab the shift,
873819833afSPeter Tyser 	 * see above. But then we have to swab tmp below for ffz, so
874819833afSPeter Tyser 	 * we might as well do this here.
875819833afSPeter Tyser 	 */
876819833afSPeter Tyser 	return result + ffz(__swab32(tmp) | (~0UL << size));
877819833afSPeter Tyser found_middle:
878819833afSPeter Tyser 	return result + ffz(__swab32(tmp));
879819833afSPeter Tyser }
880819833afSPeter Tyser #else /* !(__MIPSEB__) */
881819833afSPeter Tyser 
882819833afSPeter Tyser /* Native ext2 byte ordering, just collapse using defines. */
883819833afSPeter Tyser #define ext2_set_bit(nr, addr) test_and_set_bit((nr), (addr))
884819833afSPeter Tyser #define ext2_clear_bit(nr, addr) test_and_clear_bit((nr), (addr))
885819833afSPeter Tyser #define ext2_test_bit(nr, addr) test_bit((nr), (addr))
886819833afSPeter Tyser #define ext2_find_first_zero_bit(addr, size) find_first_zero_bit((addr), (size))
887819833afSPeter Tyser #define ext2_find_next_zero_bit(addr, size, offset) \
888819833afSPeter Tyser 		find_next_zero_bit((addr), (size), (offset))
889819833afSPeter Tyser 
890819833afSPeter Tyser #endif /* !(__MIPSEB__) */
891819833afSPeter Tyser 
892819833afSPeter Tyser /*
893819833afSPeter Tyser  * Bitmap functions for the minix filesystem.
894819833afSPeter Tyser  * FIXME: These assume that Minix uses the native byte/bitorder.
895819833afSPeter Tyser  * This limits the Minix filesystem's value for data exchange very much.
896819833afSPeter Tyser  */
897819833afSPeter Tyser #define minix_test_and_set_bit(nr,addr) test_and_set_bit(nr,addr)
898819833afSPeter Tyser #define minix_set_bit(nr,addr) set_bit(nr,addr)
899819833afSPeter Tyser #define minix_test_and_clear_bit(nr,addr) test_and_clear_bit(nr,addr)
900819833afSPeter Tyser #define minix_test_bit(nr,addr) test_bit(nr,addr)
901819833afSPeter Tyser #define minix_find_first_zero_bit(addr,size) find_first_zero_bit(addr,size)
902819833afSPeter Tyser 
903819833afSPeter Tyser #endif /* _ASM_BITOPS_H */
904