| /* | |
| * Copyright (C) 2014 Stefan Kristiansson <stefan.kristiansson@saunalahti.fi> | |
| * | |
| * This file is licensed under the terms of the GNU General Public License | |
| * version 2. This program is licensed "as is" without any warranty of any | |
| * kind, whether express or implied. | |
| */ | |
| #ifndef __ASM_OPENRISC_BITOPS_ATOMIC_H | |
| #define __ASM_OPENRISC_BITOPS_ATOMIC_H | |
| static inline void set_bit(int nr, volatile unsigned long *addr) | |
| { | |
| unsigned long mask = BIT_MASK(nr); | |
| unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); | |
| unsigned long tmp; | |
| __asm__ __volatile__( | |
| "1: l.lwa %0,0(%1) \n" | |
| " l.or %0,%0,%2 \n" | |
| " l.swa 0(%1),%0 \n" | |
| " l.bnf 1b \n" | |
| " l.nop \n" | |
| : "=&r"(tmp) | |
| : "r"(p), "r"(mask) | |
| : "cc", "memory"); | |
| } | |
| static inline void clear_bit(int nr, volatile unsigned long *addr) | |
| { | |
| unsigned long mask = BIT_MASK(nr); | |
| unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); | |
| unsigned long tmp; | |
| __asm__ __volatile__( | |
| "1: l.lwa %0,0(%1) \n" | |
| " l.and %0,%0,%2 \n" | |
| " l.swa 0(%1),%0 \n" | |
| " l.bnf 1b \n" | |
| " l.nop \n" | |
| : "=&r"(tmp) | |
| : "r"(p), "r"(~mask) | |
| : "cc", "memory"); | |
| } | |
| static inline void change_bit(int nr, volatile unsigned long *addr) | |
| { | |
| unsigned long mask = BIT_MASK(nr); | |
| unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); | |
| unsigned long tmp; | |
| __asm__ __volatile__( | |
| "1: l.lwa %0,0(%1) \n" | |
| " l.xor %0,%0,%2 \n" | |
| " l.swa 0(%1),%0 \n" | |
| " l.bnf 1b \n" | |
| " l.nop \n" | |
| : "=&r"(tmp) | |
| : "r"(p), "r"(mask) | |
| : "cc", "memory"); | |
| } | |
| static inline int test_and_set_bit(int nr, volatile unsigned long *addr) | |
| { | |
| unsigned long mask = BIT_MASK(nr); | |
| unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); | |
| unsigned long old; | |
| unsigned long tmp; | |
| __asm__ __volatile__( | |
| "1: l.lwa %0,0(%2) \n" | |
| " l.or %1,%0,%3 \n" | |
| " l.swa 0(%2),%1 \n" | |
| " l.bnf 1b \n" | |
| " l.nop \n" | |
| : "=&r"(old), "=&r"(tmp) | |
| : "r"(p), "r"(mask) | |
| : "cc", "memory"); | |
| return (old & mask) != 0; | |
| } | |
| static inline int test_and_clear_bit(int nr, volatile unsigned long *addr) | |
| { | |
| unsigned long mask = BIT_MASK(nr); | |
| unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); | |
| unsigned long old; | |
| unsigned long tmp; | |
| __asm__ __volatile__( | |
| "1: l.lwa %0,0(%2) \n" | |
| " l.and %1,%0,%3 \n" | |
| " l.swa 0(%2),%1 \n" | |
| " l.bnf 1b \n" | |
| " l.nop \n" | |
| : "=&r"(old), "=&r"(tmp) | |
| : "r"(p), "r"(~mask) | |
| : "cc", "memory"); | |
| return (old & mask) != 0; | |
| } | |
| static inline int test_and_change_bit(int nr, volatile unsigned long *addr) | |
| { | |
| unsigned long mask = BIT_MASK(nr); | |
| unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); | |
| unsigned long old; | |
| unsigned long tmp; | |
| __asm__ __volatile__( | |
| "1: l.lwa %0,0(%2) \n" | |
| " l.xor %1,%0,%3 \n" | |
| " l.swa 0(%2),%1 \n" | |
| " l.bnf 1b \n" | |
| " l.nop \n" | |
| : "=&r"(old), "=&r"(tmp) | |
| : "r"(p), "r"(mask) | |
| : "cc", "memory"); | |
| return (old & mask) != 0; | |
| } | |
| #endif /* __ASM_OPENRISC_BITOPS_ATOMIC_H */ |