mirror of
https://github.com/drasko/codezero.git
synced 2026-01-28 10:43:14 +01:00
bda0e064af
New files are an exact copy of pb926 files, but will help in testing different configurations and compilations.
91 lines
1.4 KiB
ArmAsm
91 lines
1.4 KiB
ArmAsm
/*
|
|
* ARM v5 Binary semaphore (mutex) implementation.
|
|
*
|
|
* Copyright (C) 2007 Bahadir Balban
|
|
*
|
|
*/
|
|
|
|
#include INC_ARCH(asm.h)
|
|
|
|
/* Recap on swp:
|
|
* swp rx, ry, [rz]
|
|
* In one instruction:
|
|
* 1) Stores the value in ry into location pointed by rz.
|
|
* 2) Loads the value in the location of rz into rx.
|
|
* By doing so, in one instruction one can attempt to lock
|
|
* a word, and discover whether it was already locked.
|
|
*/
|
|
|
|
#define MUTEX_UNLOCKED 0
|
|
#define MUTEX_LOCKED 1
|
|
|
|
BEGIN_PROC(__spin_lock)
|
|
mov r1, #1
|
|
__spin:
|
|
swp r2, r1, [r0]
|
|
cmp r2, #0
|
|
bne __spin
|
|
mov pc, lr
|
|
END_PROC(__spin_lock)
|
|
|
|
BEGIN_PROC(__spin_unlock)
|
|
mov r1, #0
|
|
swp r2, r1, [r0]
|
|
cmp r2, #1 @ Debug check.
|
|
1:
|
|
bne 1b
|
|
mov pc, lr
|
|
END_PROC(__spin_unlock)
|
|
|
|
|
|
/*
|
|
* @r0: Address of mutex location.
|
|
*/
|
|
BEGIN_PROC(__mutex_lock)
|
|
mov r1, #1
|
|
swp r2, r1, [r0]
|
|
cmp r2, #0
|
|
movne r0, #0
|
|
moveq r0, #1
|
|
mov pc, lr
|
|
END_PROC(__mutex_lock)
|
|
|
|
/*
|
|
* @r0: Address of mutex location.
|
|
*/
|
|
BEGIN_PROC(__mutex_unlock)
|
|
mov r1, #0
|
|
swp r2, r1, [r0]
|
|
cmp r2, #1
|
|
1: @ Debug check.
|
|
bne 1b
|
|
mov pc, lr
|
|
END_PROC(__mutex_unlock)
|
|
|
|
/*
|
|
* @r0: Address of mutex location.
|
|
*/
|
|
BEGIN_PROC(__mutex_inc)
|
|
swp r2, r1, [r0]
|
|
mov r1, #1
|
|
swp r2, r1, [r0]
|
|
cmp r2, #0
|
|
movne r0, #0
|
|
moveq r0, #1
|
|
mov pc, lr
|
|
END_PROC(__mutex_inc)
|
|
|
|
/*
|
|
* @r0: Address of mutex location.
|
|
*/
|
|
BEGIN_PROC(__mutex_dec)
|
|
mov r1, #0
|
|
swp r2, r1, [r0]
|
|
cmp r2, #1
|
|
1: @ Debug check.
|
|
bne 1b
|
|
mov pc, lr
|
|
END_PROC(__mutex_dec)
|
|
|
|
|