88 lines
1.8 KiB
C
88 lines
1.8 KiB
C
/* SPDX-License-Identifier: GPL-2.0 */
|
|
#ifndef __ASM_METAG_CMPXCHG_LNKGET_H
|
|
#define __ASM_METAG_CMPXCHG_LNKGET_H
|
|
|
|
static inline unsigned long xchg_u32(volatile u32 *m, unsigned long val)
|
|
{
|
|
int temp, old;
|
|
|
|
smp_mb();
|
|
|
|
asm volatile (
|
|
"1: LNKGETD %1, [%2]\n"
|
|
" LNKSETD [%2], %3\n"
|
|
" DEFR %0, TXSTAT\n"
|
|
" ANDT %0, %0, #HI(0x3f000000)\n"
|
|
" CMPT %0, #HI(0x02000000)\n"
|
|
" BNZ 1b\n"
|
|
#ifdef CONFIG_METAG_LNKGET_AROUND_CACHE
|
|
" DCACHE [%2], %0\n"
|
|
#endif
|
|
: "=&d" (temp), "=&d" (old)
|
|
: "da" (m), "da" (val)
|
|
: "cc"
|
|
);
|
|
|
|
smp_mb();
|
|
|
|
return old;
|
|
}
|
|
|
|
static inline unsigned long xchg_u8(volatile u8 *m, unsigned long val)
|
|
{
|
|
int temp, old;
|
|
|
|
smp_mb();
|
|
|
|
asm volatile (
|
|
"1: LNKGETD %1, [%2]\n"
|
|
" LNKSETD [%2], %3\n"
|
|
" DEFR %0, TXSTAT\n"
|
|
" ANDT %0, %0, #HI(0x3f000000)\n"
|
|
" CMPT %0, #HI(0x02000000)\n"
|
|
" BNZ 1b\n"
|
|
#ifdef CONFIG_METAG_LNKGET_AROUND_CACHE
|
|
" DCACHE [%2], %0\n"
|
|
#endif
|
|
: "=&d" (temp), "=&d" (old)
|
|
: "da" (m), "da" (val & 0xff)
|
|
: "cc"
|
|
);
|
|
|
|
smp_mb();
|
|
|
|
return old;
|
|
}
|
|
|
|
static inline unsigned long __cmpxchg_u32(volatile int *m, unsigned long old,
|
|
unsigned long new)
|
|
{
|
|
__u32 retval, temp;
|
|
|
|
smp_mb();
|
|
|
|
asm volatile (
|
|
"1: LNKGETD %1, [%2]\n"
|
|
" CMP %1, %3\n"
|
|
" LNKSETDEQ [%2], %4\n"
|
|
" BNE 2f\n"
|
|
" DEFR %0, TXSTAT\n"
|
|
" ANDT %0, %0, #HI(0x3f000000)\n"
|
|
" CMPT %0, #HI(0x02000000)\n"
|
|
" BNZ 1b\n"
|
|
#ifdef CONFIG_METAG_LNKGET_AROUND_CACHE
|
|
" DCACHE [%2], %0\n"
|
|
#endif
|
|
"2:\n"
|
|
: "=&d" (temp), "=&d" (retval)
|
|
: "da" (m), "bd" (old), "da" (new)
|
|
: "cc"
|
|
);
|
|
|
|
smp_mb();
|
|
|
|
return retval;
|
|
}
|
|
|
|
#endif /* __ASM_METAG_CMPXCHG_LNKGET_H */
|