411 lines · 9.7 KB · C
RawDownload
#ifndef _M68K_BITOPS_H#define _M68K_BITOPS_H/* * Copyright 1992, Linus Torvalds. * * This file is subject to the terms and conditions of the GNU General Public * License.  See the file COPYING in the main directory of this archive * for more details. */ #include <linux/compiler.h> /* * Require 68020 or better. * * They use the standard big-endian m680x0 bit ordering. */ #define test_and_set_bit(nr,vaddr) \  (__builtin_constant_p(nr) ? \   __constant_test_and_set_bit(nr, vaddr) : \   __generic_test_and_set_bit(nr, vaddr)) #define __test_and_set_bit(nr,vaddr) test_and_set_bit(nr,vaddr) static inline int __constant_test_and_set_bit(int nr, unsigned long *vaddr){	char *p = (char *)vaddr + (nr ^ 31) / 8;	char retval; 	__asm__ __volatile__ ("bset %2,%1; sne %0"			: "=d" (retval), "+m" (*p)			: "di" (nr & 7)); 	return retval;} static inline int __generic_test_and_set_bit(int nr, unsigned long *vaddr){	char retval; 	__asm__ __volatile__ ("bfset %2{%1:#1}; sne %0"			: "=d" (retval) : "d" (nr^31), "o" (*vaddr) : "memory"); 	return retval;} #define set_bit(nr,vaddr) \  (__builtin_constant_p(nr) ? \   __constant_set_bit(nr, vaddr) : \   __generic_set_bit(nr, vaddr)) #define __set_bit(nr,vaddr) set_bit(nr,vaddr) static inline void __constant_set_bit(int nr, volatile unsigned long *vaddr){	char *p = (char *)vaddr + (nr ^ 31) / 8;	__asm__ __volatile__ ("bset %1,%0"			: "+m" (*p) : "di" (nr & 7));} static inline void __generic_set_bit(int nr, volatile unsigned long *vaddr){	__asm__ __volatile__ ("bfset %1{%0:#1}"			: : "d" (nr^31), "o" (*vaddr) : "memory");} #define test_and_clear_bit(nr,vaddr) \  (__builtin_constant_p(nr) ? \   __constant_test_and_clear_bit(nr, vaddr) : \   __generic_test_and_clear_bit(nr, vaddr)) #define __test_and_clear_bit(nr,vaddr) test_and_clear_bit(nr,vaddr) static inline int __constant_test_and_clear_bit(int nr, unsigned long *vaddr){	char *p = (char *)vaddr + (nr ^ 31) / 8;	char retval; 	__asm__ __volatile__ ("bclr %2,%1; sne %0"			: "=d" (retval), "+m" (*p)			: "di" (nr & 7)); 	return retval;} static inline int __generic_test_and_clear_bit(int nr, unsigned long *vaddr){	char retval; 	__asm__ __volatile__ ("bfclr %2{%1:#1}; sne %0"			: "=d" (retval) : "d" (nr^31), "o" (*vaddr) : "memory"); 	return retval;} /* * clear_bit() doesn't provide any barrier for the compiler. */#define smp_mb__before_clear_bit()	barrier()#define smp_mb__after_clear_bit()	barrier() #define clear_bit(nr,vaddr) \  (__builtin_constant_p(nr) ? \   __constant_clear_bit(nr, vaddr) : \   __generic_clear_bit(nr, vaddr))#define __clear_bit(nr,vaddr) clear_bit(nr,vaddr) static inline void __constant_clear_bit(int nr, volatile unsigned long *vaddr){	char *p = (char *)vaddr + (nr ^ 31) / 8;	__asm__ __volatile__ ("bclr %1,%0"			: "+m" (*p) : "di" (nr & 7));} static inline void __generic_clear_bit(int nr, volatile unsigned long *vaddr){	__asm__ __volatile__ ("bfclr %1{%0:#1}"			: : "d" (nr^31), "o" (*vaddr) : "memory");} #define test_and_change_bit(nr,vaddr) \  (__builtin_constant_p(nr) ? \   __constant_test_and_change_bit(nr, vaddr) : \   __generic_test_and_change_bit(nr, vaddr)) #define __test_and_change_bit(nr,vaddr) test_and_change_bit(nr,vaddr)#define __change_bit(nr,vaddr) change_bit(nr,vaddr) static inline int __constant_test_and_change_bit(int nr, unsigned long *vaddr){	char *p = (char *)vaddr + (nr ^ 31) / 8;	char retval; 	__asm__ __volatile__ ("bchg %2,%1; sne %0"			: "=d" (retval), "+m" (*p)			: "di" (nr & 7)); 	return retval;} static inline int __generic_test_and_change_bit(int nr, unsigned long *vaddr){	char retval; 	__asm__ __volatile__ ("bfchg %2{%1:#1}; sne %0"			: "=d" (retval) : "d" (nr^31), "o" (*vaddr) : "memory"); 	return retval;} #define change_bit(nr,vaddr) \  (__builtin_constant_p(nr) ? \   __constant_change_bit(nr, vaddr) : \   __generic_change_bit(nr, vaddr)) static inline void __constant_change_bit(int nr, unsigned long *vaddr){	char *p = (char *)vaddr + (nr ^ 31) / 8;	__asm__ __volatile__ ("bchg %1,%0"			: "+m" (*p) : "di" (nr & 7));} static inline void __generic_change_bit(int nr, unsigned long *vaddr){	__asm__ __volatile__ ("bfchg %1{%0:#1}"			: : "d" (nr^31), "o" (*vaddr) : "memory");} static inline int test_bit(int nr, const unsigned long *vaddr){	return (vaddr[nr >> 5] & (1UL << (nr & 31))) != 0;} static inline int find_first_zero_bit(const unsigned long *vaddr,				      unsigned size){	const unsigned long *p = vaddr;	int res = 32;	unsigned long num; 	if (!size)		return 0; 	size = (size + 31) >> 5;	while (!(num = ~*p++)) {		if (!--size)			goto out;	} 	__asm__ __volatile__ ("bfffo %1{#0,#0},%0"			      : "=d" (res) : "d" (num & -num));	res ^= 31;out:	return ((long)p - (long)vaddr - 4) * 8 + res;} static inline int find_next_zero_bit(const unsigned long *vaddr, int size,				     int offset){	const unsigned long *p = vaddr + (offset >> 5);	int bit = offset & 31UL, res; 	if (offset >= size)		return size; 	if (bit) {		unsigned long num = ~*p++ & (~0UL << bit);		offset -= bit; 		/* Look for zero in first longword */		__asm__ __volatile__ ("bfffo %1{#0,#0},%0"				      : "=d" (res) : "d" (num & -num));		if (res < 32)			return offset + (res ^ 31);		offset += 32;	}	/* No zero yet, search remaining full bytes for a zero */	res = find_first_zero_bit(p, size - ((long)p - (long)vaddr) * 8);	return offset + res;} static inline int find_first_bit(const unsigned long *vaddr, unsigned size){	const unsigned long *p = vaddr;	int res = 32;	unsigned long num; 	if (!size)		return 0; 	size = (size + 31) >> 5;	while (!(num = *p++)) {		if (!--size)			goto out;	} 	__asm__ __volatile__ ("bfffo %1{#0,#0},%0"			      : "=d" (res) : "d" (num & -num));	res ^= 31;out:	return ((long)p - (long)vaddr - 4) * 8 + res;} static inline int find_next_bit(const unsigned long *vaddr, int size,				int offset){	const unsigned long *p = vaddr + (offset >> 5);	int bit = offset & 31UL, res; 	if (offset >= size)		return size; 	if (bit) {		unsigned long num = *p++ & (~0UL << bit);		offset -= bit; 		/* Look for one in first longword */		__asm__ __volatile__ ("bfffo %1{#0,#0},%0"				      : "=d" (res) : "d" (num & -num));		if (res < 32)			return offset + (res ^ 31);		offset += 32;	}	/* No one yet, search remaining full bytes for a one */	res = find_first_bit(p, size - ((long)p - (long)vaddr) * 8);	return offset + res;} /* * ffz = Find First Zero in word. Undefined if no zero exists, * so code should check against ~0UL first.. */static inline unsigned long ffz(unsigned long word){	int res; 	__asm__ __volatile__ ("bfffo %1{#0,#0},%0"			      : "=d" (res) : "d" (~word & -~word));	return res ^ 31;} #ifdef __KERNEL__ /* * ffs: find first bit set. This is defined the same way as * the libc and compiler builtin ffs routines, therefore * differs in spirit from the above ffz (man ffs). */ static inline int ffs(int x){	int cnt; 	asm ("bfffo %1{#0:#0},%0" : "=d" (cnt) : "dm" (x & -x)); 	return 32 - cnt;}#define __ffs(x) (ffs(x) - 1) /* * fls: find last bit set. */ static inline int fls(int x){	int cnt; 	asm ("bfffo %1{#0,#0},%0" : "=d" (cnt) : "dm" (x)); 	return 32 - cnt;} #include <asm-generic/bitops/fls64.h>#include <asm-generic/bitops/sched.h>#include <asm-generic/bitops/hweight.h> /* Bitmap functions for the minix filesystem */ static inline int minix_find_first_zero_bit(const void *vaddr, unsigned size){	const unsigned short *p = vaddr, *addr = vaddr;	int res;	unsigned short num; 	if (!size)		return 0; 	size = (size >> 4) + ((size & 15) > 0);	while (*p++ == 0xffff)	{		if (--size == 0)			return (p - addr) << 4;	} 	num = ~*--p;	__asm__ __volatile__ ("bfffo %1{#16,#16},%0"			      : "=d" (res) : "d" (num & -num));	return ((p - addr) << 4) + (res ^ 31);} #define minix_test_and_set_bit(nr, addr)	__test_and_set_bit((nr) ^ 16, (unsigned long *)(addr))#define minix_set_bit(nr,addr)			__set_bit((nr) ^ 16, (unsigned long *)(addr))#define minix_test_and_clear_bit(nr, addr)	__test_and_clear_bit((nr) ^ 16, (unsigned long *)(addr)) static inline int minix_test_bit(int nr, const void *vaddr){	const unsigned short *p = vaddr;	return (p[nr >> 4] & (1U << (nr & 15))) != 0;} /* Bitmap functions for the ext2 filesystem. */ #define ext2_set_bit(nr, addr)			__test_and_set_bit((nr) ^ 24, (unsigned long *)(addr))#define ext2_set_bit_atomic(lock, nr, addr)	test_and_set_bit((nr) ^ 24, (unsigned long *)(addr))#define ext2_clear_bit(nr, addr)		__test_and_clear_bit((nr) ^ 24, (unsigned long *)(addr))#define ext2_clear_bit_atomic(lock, nr, addr)	test_and_clear_bit((nr) ^ 24, (unsigned long *)(addr)) static inline int ext2_test_bit(int nr, const void *vaddr){	const unsigned char *p = vaddr;	return (p[nr >> 3] & (1U << (nr & 7))) != 0;} static inline int ext2_find_first_zero_bit(const void *vaddr, unsigned size){	const unsigned long *p = vaddr, *addr = vaddr;	int res; 	if (!size)		return 0; 	size = (size >> 5) + ((size & 31) > 0);	while (*p++ == ~0UL)	{		if (--size == 0)			return (p - addr) << 5;	} 	--p;	for (res = 0; res < 32; res++)		if (!ext2_test_bit (res, p))			break;	return (p - addr) * 32 + res;} static inline int ext2_find_next_zero_bit(const void *vaddr, unsigned size,					  unsigned offset){	const unsigned long *addr = vaddr;	const unsigned long *p = addr + (offset >> 5);	int bit = offset & 31UL, res; 	if (offset >= size)		return size; 	if (bit) {		/* Look for zero in first longword */		for (res = bit; res < 32; res++)			if (!ext2_test_bit (res, p))				return (p - addr) * 32 + res;		p++;	}	/* No zero yet, search remaining full bytes for a zero */	res = ext2_find_first_zero_bit (p, size - 32 * (p - addr));	return (p - addr) * 32 + res;} #endif /* __KERNEL__ */ #endif /* _M68K_BITOPS_H */