[opensbi] create opensbi from T-Head official:
repo: https://github.com/T-head-Semi/opensbi commit: 89182b257c8798e15e4c685c1af0c2862d528d2a Change-Id: I7b39d66729e0108661a6f4c9e28acbdb303684ea
This commit is contained in:
77
opensbi/lib/sbi/riscv_locks.c
Normal file
77
opensbi/lib/sbi/riscv_locks.c
Normal file
@ -0,0 +1,77 @@
|
||||
/*
|
||||
* SPDX-License-Identifier: BSD-2-Clause
|
||||
*
|
||||
* Copyright (c) 2019 Western Digital Corporation or its affiliates.
|
||||
* Copyright (c) 2021 Christoph Müllner <cmuellner@linux.com>
|
||||
*/
|
||||
|
||||
#include <sbi/riscv_barrier.h>
|
||||
#include <sbi/riscv_locks.h>
|
||||
|
||||
static inline int spin_lock_unlocked(spinlock_t lock)
|
||||
{
|
||||
return lock.owner == lock.next;
|
||||
}
|
||||
|
||||
bool spin_lock_check(spinlock_t *lock)
|
||||
{
|
||||
RISCV_FENCE(r, rw);
|
||||
return !spin_lock_unlocked(*lock);
|
||||
}
|
||||
|
||||
int spin_trylock(spinlock_t *lock)
|
||||
{
|
||||
unsigned long inc = 1u << TICKET_SHIFT;
|
||||
unsigned long mask = 0xffffu << TICKET_SHIFT;
|
||||
u32 l0, tmp1, tmp2;
|
||||
|
||||
__asm__ __volatile__(
|
||||
/* Get the current lock counters. */
|
||||
"1: lr.w.aq %0, %3\n"
|
||||
" slli %2, %0, %6\n"
|
||||
" and %2, %2, %5\n"
|
||||
" and %1, %0, %5\n"
|
||||
/* Is the lock free right now? */
|
||||
" bne %1, %2, 2f\n"
|
||||
" add %0, %0, %4\n"
|
||||
/* Acquire the lock. */
|
||||
" sc.w.rl %0, %0, %3\n"
|
||||
" bnez %0, 1b\n"
|
||||
"2:"
|
||||
: "=&r"(l0), "=&r"(tmp1), "=&r"(tmp2), "+A"(*lock)
|
||||
: "r"(inc), "r"(mask), "I"(TICKET_SHIFT)
|
||||
: "memory");
|
||||
|
||||
return !l0;
|
||||
}
|
||||
|
||||
void spin_lock(spinlock_t *lock)
|
||||
{
|
||||
unsigned long inc = 1u << TICKET_SHIFT;
|
||||
unsigned long mask = 0xffffu;
|
||||
u32 l0, tmp1, tmp2;
|
||||
|
||||
__asm__ __volatile__(
|
||||
/* Atomically increment the next ticket. */
|
||||
" amoadd.w.aqrl %0, %4, %3\n"
|
||||
|
||||
/* Did we get the lock? */
|
||||
" srli %1, %0, %6\n"
|
||||
" and %1, %1, %5\n"
|
||||
"1: and %2, %0, %5\n"
|
||||
" beq %1, %2, 2f\n"
|
||||
|
||||
/* If not, then spin on the lock. */
|
||||
" lw %0, %3\n"
|
||||
RISCV_ACQUIRE_BARRIER
|
||||
" j 1b\n"
|
||||
"2:"
|
||||
: "=&r"(l0), "=&r"(tmp1), "=&r"(tmp2), "+A"(*lock)
|
||||
: "r"(inc), "r"(mask), "I"(TICKET_SHIFT)
|
||||
: "memory");
|
||||
}
|
||||
|
||||
void spin_unlock(spinlock_t *lock)
|
||||
{
|
||||
__smp_store_release(&lock->owner, lock->owner + 1);
|
||||
}
|
||||
Reference in New Issue
Block a user