88 lines
1.2 KiB
ArmAsm
88 lines
1.2 KiB
ArmAsm
|
/* SPDX-License-Identifier: GPL-2.0 */
|
||
|
|
// Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
|
||
|
|
|
||
|
|
#include <linux/linkage.h>
|
||
|
|
#include <abi/entry.h>
|
||
|
|
|
||
|
|
.text
|
||
|
|
|
||
|
|
/*
|
||
|
|
* int csky_cmpxchg(int oldval, int newval, int *ptr)
|
||
|
|
*
|
||
|
|
* If *ptr != oldval && return 1,
|
||
|
|
* else *ptr = newval return 0.
|
||
|
|
*/
|
||
|
|
#ifdef CONFIG_CPU_HAS_LDSTEX
|
||
|
|
ENTRY(csky_cmpxchg)
|
||
|
|
USPTOKSP
|
||
|
|
mfcr a3, epc
|
||
|
|
INCTRAP a3
|
||
|
|
|
||
|
|
subi sp, 8
|
||
|
|
stw a3, (sp, 0)
|
||
|
|
mfcr a3, epsr
|
||
|
|
stw a3, (sp, 4)
|
||
|
|
|
||
|
|
psrset ee
|
||
|
|
1:
|
||
|
|
ldex a3, (a2)
|
||
|
|
cmpne a0, a3
|
||
|
|
bt16 2f
|
||
|
|
mov a3, a1
|
||
|
|
stex a3, (a2)
|
||
|
|
bez a3, 1b
|
||
|
|
2:
|
||
|
|
sync.is
|
||
|
|
mvc a0
|
||
|
|
ldw a3, (sp, 0)
|
||
|
|
mtcr a3, epc
|
||
|
|
ldw a3, (sp, 4)
|
||
|
|
mtcr a3, epsr
|
||
|
|
addi sp, 8
|
||
|
|
KSPTOUSP
|
||
|
|
rte
|
||
|
|
END(csky_cmpxchg)
|
||
|
|
#else
|
||
|
|
ENTRY(csky_cmpxchg)
|
||
|
|
USPTOKSP
|
||
|
|
mfcr a3, epc
|
||
|
|
INCTRAP a3
|
||
|
|
|
||
|
|
subi sp, 8
|
||
|
|
stw a3, (sp, 0)
|
||
|
|
mfcr a3, epsr
|
||
|
|
stw a3, (sp, 4)
|
||
|
|
|
||
|
|
psrset ee
|
||
|
|
1:
|
||
|
|
ldw a3, (a2)
|
||
|
|
cmpne a0, a3
|
||
|
|
bt16 3f
|
||
|
|
2:
|
||
|
|
stw a1, (a2)
|
||
|
|
3:
|
||
|
|
mvc a0
|
||
|
|
ldw a3, (sp, 0)
|
||
|
|
mtcr a3, epc
|
||
|
|
ldw a3, (sp, 4)
|
||
|
|
mtcr a3, epsr
|
||
|
|
addi sp, 8
|
||
|
|
KSPTOUSP
|
||
|
|
rte
|
||
|
|
END(csky_cmpxchg)
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Called from tlbmodified exception
|
||
|
|
*/
|
||
|
|
ENTRY(csky_cmpxchg_fixup)
|
||
|
|
mfcr a0, epc
|
||
|
|
lrw a1, 2b
|
||
|
|
cmpne a1, a0
|
||
|
|
bt 1f
|
||
|
|
subi a1, (2b - 1b)
|
||
|
|
stw a1, (sp, LSAVE_PC)
|
||
|
|
1:
|
||
|
|
rts
|
||
|
|
END(csky_cmpxchg_fixup)
|
||
|
|
#endif
|