123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228 |
- /* bitops.h: bit operations for the Fujitsu FR-V CPUs
- *
- * For an explanation of how atomic ops work in this arch, see:
- * Documentation/frv/atomic-ops.txt
- *
- * Copyright (C) 2004 Red Hat, Inc. All Rights Reserved.
- * Written by David Howells (dhowells@redhat.com)
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License
- * as published by the Free Software Foundation; either version
- * 2 of the License, or (at your option) any later version.
- */
- #ifndef _ASM_BITOPS_H
- #define _ASM_BITOPS_H
- #include <linux/compiler.h>
- #include <asm/byteorder.h>
- #ifdef __KERNEL__
- #ifndef _LINUX_BITOPS_H
- #error only <linux/bitops.h> can be included directly
- #endif
- #include <asm-generic/bitops/ffz.h>
- /*
- * clear_bit() doesn't provide any barrier for the compiler.
- */
- #define smp_mb__before_clear_bit() barrier()
- #define smp_mb__after_clear_bit() barrier()
- #ifndef CONFIG_FRV_OUTOFLINE_ATOMIC_OPS
- static inline
- unsigned long atomic_test_and_ANDNOT_mask(unsigned long mask, volatile unsigned long *v)
- {
- unsigned long old, tmp;
- asm volatile(
- "0: \n"
- " orcc gr0,gr0,gr0,icc3 \n" /* set ICC3.Z */
- " ckeq icc3,cc7 \n"
- " ld.p %M0,%1 \n" /* LD.P/ORCR are atomic */
- " orcr cc7,cc7,cc3 \n" /* set CC3 to true */
- " and%I3 %1,%3,%2 \n"
- " cst.p %2,%M0 ,cc3,#1 \n" /* if store happens... */
- " corcc gr29,gr29,gr0 ,cc3,#1 \n" /* ... clear ICC3.Z */
- " beq icc3,#0,0b \n"
- : "+U"(*v), "=&r"(old), "=r"(tmp)
- : "NPr"(~mask)
- : "memory", "cc7", "cc3", "icc3"
- );
- return old;
- }
- static inline
- unsigned long atomic_test_and_OR_mask(unsigned long mask, volatile unsigned long *v)
- {
- unsigned long old, tmp;
- asm volatile(
- "0: \n"
- " orcc gr0,gr0,gr0,icc3 \n" /* set ICC3.Z */
- " ckeq icc3,cc7 \n"
- " ld.p %M0,%1 \n" /* LD.P/ORCR are atomic */
- " orcr cc7,cc7,cc3 \n" /* set CC3 to true */
- " or%I3 %1,%3,%2 \n"
- " cst.p %2,%M0 ,cc3,#1 \n" /* if store happens... */
- " corcc gr29,gr29,gr0 ,cc3,#1 \n" /* ... clear ICC3.Z */
- " beq icc3,#0,0b \n"
- : "+U"(*v), "=&r"(old), "=r"(tmp)
- : "NPr"(mask)
- : "memory", "cc7", "cc3", "icc3"
- );
- return old;
- }
- static inline
- unsigned long atomic_test_and_XOR_mask(unsigned long mask, volatile unsigned long *v)
- {
- unsigned long old, tmp;
- asm volatile(
- "0: \n"
- " orcc gr0,gr0,gr0,icc3 \n" /* set ICC3.Z */
- " ckeq icc3,cc7 \n"
- " ld.p %M0,%1 \n" /* LD.P/ORCR are atomic */
- " orcr cc7,cc7,cc3 \n" /* set CC3 to true */
- " xor%I3 %1,%3,%2 \n"
- " cst.p %2,%M0 ,cc3,#1 \n" /* if store happens... */
- " corcc gr29,gr29,gr0 ,cc3,#1 \n" /* ... clear ICC3.Z */
- " beq icc3,#0,0b \n"
- : "+U"(*v), "=&r"(old), "=r"(tmp)
- : "NPr"(mask)
- : "memory", "cc7", "cc3", "icc3"
- );
- return old;
- }
- #else
- extern unsigned long atomic_test_and_ANDNOT_mask(unsigned long mask, volatile unsigned long *v);
- extern unsigned long atomic_test_and_OR_mask(unsigned long mask, volatile unsigned long *v);
- extern unsigned long atomic_test_and_XOR_mask(unsigned long mask, volatile unsigned long *v);
- #endif
- #define atomic_clear_mask(mask, v) atomic_test_and_ANDNOT_mask((mask), (v))
- #define atomic_set_mask(mask, v) atomic_test_and_OR_mask((mask), (v))
- static inline int test_and_clear_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *ptr = addr;
- unsigned long mask = 1UL << (nr & 31);
- ptr += nr >> 5;
- return (atomic_test_and_ANDNOT_mask(mask, ptr) & mask) != 0;
- }
- static inline int test_and_set_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *ptr = addr;
- unsigned long mask = 1UL << (nr & 31);
- ptr += nr >> 5;
- return (atomic_test_and_OR_mask(mask, ptr) & mask) != 0;
- }
- static inline int test_and_change_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *ptr = addr;
- unsigned long mask = 1UL << (nr & 31);
- ptr += nr >> 5;
- return (atomic_test_and_XOR_mask(mask, ptr) & mask) != 0;
- }
- static inline void clear_bit(unsigned long nr, volatile void *addr)
- {
- test_and_clear_bit(nr, addr);
- }
- static inline void set_bit(unsigned long nr, volatile void *addr)
- {
- test_and_set_bit(nr, addr);
- }
- static inline void change_bit(unsigned long nr, volatile void *addr)
- {
- test_and_change_bit(nr, addr);
- }
- static inline void __clear_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *a = addr;
- int mask;
- a += nr >> 5;
- mask = 1 << (nr & 31);
- *a &= ~mask;
- }
- static inline void __set_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *a = addr;
- int mask;
- a += nr >> 5;
- mask = 1 << (nr & 31);
- *a |= mask;
- }
- static inline void __change_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *a = addr;
- int mask;
- a += nr >> 5;
- mask = 1 << (nr & 31);
- *a ^= mask;
- }
- static inline int __test_and_clear_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *a = addr;
- int mask, retval;
- a += nr >> 5;
- mask = 1 << (nr & 31);
- retval = (mask & *a) != 0;
- *a &= ~mask;
- return retval;
- }
- static inline int __test_and_set_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *a = addr;
- int mask, retval;
- a += nr >> 5;
- mask = 1 << (nr & 31);
- retval = (mask & *a) != 0;
- *a |= mask;
- return retval;
- }
- static inline int __test_and_change_bit(unsigned long nr, volatile void *addr)
- {
- volatile unsigned long *a = addr;
- int mask, retval;
- a += nr >> 5;
- mask = 1 << (nr & 31);
- retval = (mask & *a) != 0;
- *a ^= mask;
- return retval;
- }
- /*
- * This routine doesn't need to be atomic.
- */
- static inline int
- __constant_test_bit(unsigned long nr, const volatile void *addr)
- {
- return ((1UL << (nr & 31)) & (((const volatile unsigned int *) addr)[nr >> 5])) != 0;
- }
|