forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
147 lines
2.8 KiB
147 lines
2.8 KiB
/* SPDX-License-Identifier: GPL-2.0 */ |
|
#ifndef __ASM_SH_BITOPS_LLSC_H |
|
#define __ASM_SH_BITOPS_LLSC_H |
|
|
|
static inline void set_bit(int nr, volatile void *addr) |
|
{ |
|
int mask; |
|
volatile unsigned int *a = addr; |
|
unsigned long tmp; |
|
|
|
a += nr >> 5; |
|
mask = 1 << (nr & 0x1f); |
|
|
|
__asm__ __volatile__ ( |
|
"1: \n\t" |
|
"movli.l @%1, %0 ! set_bit \n\t" |
|
"or %2, %0 \n\t" |
|
"movco.l %0, @%1 \n\t" |
|
"bf 1b \n\t" |
|
: "=&z" (tmp) |
|
: "r" (a), "r" (mask) |
|
: "t", "memory" |
|
); |
|
} |
|
|
|
static inline void clear_bit(int nr, volatile void *addr) |
|
{ |
|
int mask; |
|
volatile unsigned int *a = addr; |
|
unsigned long tmp; |
|
|
|
a += nr >> 5; |
|
mask = 1 << (nr & 0x1f); |
|
|
|
__asm__ __volatile__ ( |
|
"1: \n\t" |
|
"movli.l @%1, %0 ! clear_bit \n\t" |
|
"and %2, %0 \n\t" |
|
"movco.l %0, @%1 \n\t" |
|
"bf 1b \n\t" |
|
: "=&z" (tmp) |
|
: "r" (a), "r" (~mask) |
|
: "t", "memory" |
|
); |
|
} |
|
|
|
static inline void change_bit(int nr, volatile void *addr) |
|
{ |
|
int mask; |
|
volatile unsigned int *a = addr; |
|
unsigned long tmp; |
|
|
|
a += nr >> 5; |
|
mask = 1 << (nr & 0x1f); |
|
|
|
__asm__ __volatile__ ( |
|
"1: \n\t" |
|
"movli.l @%1, %0 ! change_bit \n\t" |
|
"xor %2, %0 \n\t" |
|
"movco.l %0, @%1 \n\t" |
|
"bf 1b \n\t" |
|
: "=&z" (tmp) |
|
: "r" (a), "r" (mask) |
|
: "t", "memory" |
|
); |
|
} |
|
|
|
static inline int test_and_set_bit(int nr, volatile void *addr) |
|
{ |
|
int mask, retval; |
|
volatile unsigned int *a = addr; |
|
unsigned long tmp; |
|
|
|
a += nr >> 5; |
|
mask = 1 << (nr & 0x1f); |
|
|
|
__asm__ __volatile__ ( |
|
"1: \n\t" |
|
"movli.l @%2, %0 ! test_and_set_bit \n\t" |
|
"mov %0, %1 \n\t" |
|
"or %3, %0 \n\t" |
|
"movco.l %0, @%2 \n\t" |
|
"bf 1b \n\t" |
|
"and %3, %1 \n\t" |
|
: "=&z" (tmp), "=&r" (retval) |
|
: "r" (a), "r" (mask) |
|
: "t", "memory" |
|
); |
|
|
|
return retval != 0; |
|
} |
|
|
|
static inline int test_and_clear_bit(int nr, volatile void *addr) |
|
{ |
|
int mask, retval; |
|
volatile unsigned int *a = addr; |
|
unsigned long tmp; |
|
|
|
a += nr >> 5; |
|
mask = 1 << (nr & 0x1f); |
|
|
|
__asm__ __volatile__ ( |
|
"1: \n\t" |
|
"movli.l @%2, %0 ! test_and_clear_bit \n\t" |
|
"mov %0, %1 \n\t" |
|
"and %4, %0 \n\t" |
|
"movco.l %0, @%2 \n\t" |
|
"bf 1b \n\t" |
|
"and %3, %1 \n\t" |
|
"synco \n\t" |
|
: "=&z" (tmp), "=&r" (retval) |
|
: "r" (a), "r" (mask), "r" (~mask) |
|
: "t", "memory" |
|
); |
|
|
|
return retval != 0; |
|
} |
|
|
|
static inline int test_and_change_bit(int nr, volatile void *addr) |
|
{ |
|
int mask, retval; |
|
volatile unsigned int *a = addr; |
|
unsigned long tmp; |
|
|
|
a += nr >> 5; |
|
mask = 1 << (nr & 0x1f); |
|
|
|
__asm__ __volatile__ ( |
|
"1: \n\t" |
|
"movli.l @%2, %0 ! test_and_change_bit \n\t" |
|
"mov %0, %1 \n\t" |
|
"xor %3, %0 \n\t" |
|
"movco.l %0, @%2 \n\t" |
|
"bf 1b \n\t" |
|
"and %3, %1 \n\t" |
|
"synco \n\t" |
|
: "=&z" (tmp), "=&r" (retval) |
|
: "r" (a), "r" (mask) |
|
: "t", "memory" |
|
); |
|
|
|
return retval != 0; |
|
} |
|
|
|
#include <asm-generic/bitops/non-atomic.h> |
|
|
|
#endif /* __ASM_SH_BITOPS_LLSC_H */
|
|
|