381 lines
8.8 KiB
C
381 lines
8.8 KiB
C
|
#ifndef _ASM_M32R_SPINLOCK_H
|
||
|
|
#define _ASM_M32R_SPINLOCK_H
|
||
|
|
|
||
|
|
/*
|
||
|
|
* linux/include/asm-m32r/spinlock.h
|
||
|
|
*
|
||
|
|
* M32R version:
|
||
|
|
* Copyright (C) 2001, 2002 Hitoshi Yamamoto
|
||
|
|
* Copyright (C) 2004 Hirokazu Takata <takata at linux-m32r.org>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/config.h> /* CONFIG_DEBUG_SPINLOCK, CONFIG_SMP */
|
||
|
|
#include <linux/compiler.h>
|
||
|
|
#include <asm/atomic.h>
|
||
|
|
#include <asm/page.h>
|
||
|
|
|
||
|
|
extern int printk(const char * fmt, ...)
|
||
|
|
__attribute__ ((format (printf, 1, 2)));
|
||
|
|
|
||
|
|
#define RW_LOCK_BIAS 0x01000000
|
||
|
|
#define RW_LOCK_BIAS_STR "0x01000000"
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Your basic SMP spinlocks, allowing only a single CPU anywhere
|
||
|
|
*/
|
||
|
|
|
||
|
|
typedef struct {
|
||
|
|
volatile int slock;
|
||
|
|
#ifdef CONFIG_DEBUG_SPINLOCK
|
||
|
|
unsigned magic;
|
||
|
|
#endif
|
||
|
|
#ifdef CONFIG_PREEMPT
|
||
|
|
unsigned int break_lock;
|
||
|
|
#endif
|
||
|
|
} spinlock_t;
|
||
|
|
|
||
|
|
#define SPINLOCK_MAGIC 0xdead4ead
|
||
|
|
|
||
|
|
#ifdef CONFIG_DEBUG_SPINLOCK
|
||
|
|
#define SPINLOCK_MAGIC_INIT , SPINLOCK_MAGIC
|
||
|
|
#else
|
||
|
|
#define SPINLOCK_MAGIC_INIT /* */
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#define SPIN_LOCK_UNLOCKED (spinlock_t) { 1 SPINLOCK_MAGIC_INIT }
|
||
|
|
|
||
|
|
#define spin_lock_init(x) do { *(x) = SPIN_LOCK_UNLOCKED; } while(0)
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Simple spin lock operations. There are two variants, one clears IRQ's
|
||
|
|
* on the local processor, one does not.
|
||
|
|
*
|
||
|
|
* We make no fairness assumptions. They have a cost.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#define spin_is_locked(x) (*(volatile int *)(&(x)->slock) <= 0)
|
||
|
|
#define spin_unlock_wait(x) do { barrier(); } while(spin_is_locked(x))
|
||
|
|
#define _raw_spin_lock_flags(lock, flags) _raw_spin_lock(lock)
|
||
|
|
|
||
|
|
/**
|
||
|
|
* _raw_spin_trylock - Try spin lock and return a result
|
||
|
|
* @lock: Pointer to the lock variable
|
||
|
|
*
|
||
|
|
* _raw_spin_trylock() tries to get the lock and returns a result.
|
||
|
|
* On the m32r, the result value is 1 (= Success) or 0 (= Failure).
|
||
|
|
*/
|
||
|
|
static inline int _raw_spin_trylock(spinlock_t *lock)
|
||
|
|
{
|
||
|
|
int oldval;
|
||
|
|
unsigned long tmp1, tmp2;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* lock->slock : =1 : unlock
|
||
|
|
* : <=0 : lock
|
||
|
|
* {
|
||
|
|
* oldval = lock->slock; <--+ need atomic operation
|
||
|
|
* lock->slock = 0; <--+
|
||
|
|
* }
|
||
|
|
*/
|
||
|
|
__asm__ __volatile__ (
|
||
|
|
"# spin_trylock \n\t"
|
||
|
|
"ldi %1, #0; \n\t"
|
||
|
|
"mvfc %2, psw; \n\t"
|
||
|
|
"clrpsw #0x40 -> nop; \n\t"
|
||
|
|
DCACHE_CLEAR("%0", "r6", "%3")
|
||
|
|
"lock %0, @%3; \n\t"
|
||
|
|
"unlock %1, @%3; \n\t"
|
||
|
|
"mvtc %2, psw; \n\t"
|
||
|
|
: "=&r" (oldval), "=&r" (tmp1), "=&r" (tmp2)
|
||
|
|
: "r" (&lock->slock)
|
||
|
|
: "memory"
|
||
|
|
#ifdef CONFIG_CHIP_M32700_TS1
|
||
|
|
, "r6"
|
||
|
|
#endif /* CONFIG_CHIP_M32700_TS1 */
|
||
|
|
);
|
||
|
|
|
||
|
|
return (oldval > 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void _raw_spin_lock(spinlock_t *lock)
|
||
|
|
{
|
||
|
|
unsigned long tmp0, tmp1;
|
||
|
|
|
||
|
|
#ifdef CONFIG_DEBUG_SPINLOCK
|
||
|
|
if (unlikely(lock->magic != SPINLOCK_MAGIC)) {
|
||
|
|
printk("pc: %p\n", __builtin_return_address(0));
|
||
|
|
BUG();
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
/*
|
||
|
|
* lock->slock : =1 : unlock
|
||
|
|
* : <=0 : lock
|
||
|
|
*
|
||
|
|
* for ( ; ; ) {
|
||
|
|
* lock->slock -= 1; <-- need atomic operation
|
||
|
|
* if (lock->slock == 0) break;
|
||
|
|
* for ( ; lock->slock <= 0 ; );
|
||
|
|
* }
|
||
|
|
*/
|
||
|
|
__asm__ __volatile__ (
|
||
|
|
"# spin_lock \n\t"
|
||
|
|
".fillinsn \n"
|
||
|
|
"1: \n\t"
|
||
|
|
"mvfc %1, psw; \n\t"
|
||
|
|
"clrpsw #0x40 -> nop; \n\t"
|
||
|
|
DCACHE_CLEAR("%0", "r6", "%2")
|
||
|
|
"lock %0, @%2; \n\t"
|
||
|
|
"addi %0, #-1; \n\t"
|
||
|
|
"unlock %0, @%2; \n\t"
|
||
|
|
"mvtc %1, psw; \n\t"
|
||
|
|
"bltz %0, 2f; \n\t"
|
||
|
|
LOCK_SECTION_START(".balign 4 \n\t")
|
||
|
|
".fillinsn \n"
|
||
|
|
"2: \n\t"
|
||
|
|
"ld %0, @%2; \n\t"
|
||
|
|
"bgtz %0, 1b; \n\t"
|
||
|
|
"bra 2b; \n\t"
|
||
|
|
LOCK_SECTION_END
|
||
|
|
: "=&r" (tmp0), "=&r" (tmp1)
|
||
|
|
: "r" (&lock->slock)
|
||
|
|
: "memory"
|
||
|
|
#ifdef CONFIG_CHIP_M32700_TS1
|
||
|
|
, "r6"
|
||
|
|
#endif /* CONFIG_CHIP_M32700_TS1 */
|
||
|
|
);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void _raw_spin_unlock(spinlock_t *lock)
|
||
|
|
{
|
||
|
|
#ifdef CONFIG_DEBUG_SPINLOCK
|
||
|
|
BUG_ON(lock->magic != SPINLOCK_MAGIC);
|
||
|
|
BUG_ON(!spin_is_locked(lock));
|
||
|
|
#endif
|
||
|
|
mb();
|
||
|
|
lock->slock = 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Read-write spinlocks, allowing multiple readers
|
||
|
|
* but only one writer.
|
||
|
|
*
|
||
|
|
* NOTE! it is quite common to have readers in interrupts
|
||
|
|
* but no interrupt writers. For those circumstances we
|
||
|
|
* can "mix" irq-safe locks - any writer needs to get a
|
||
|
|
* irq-safe write-lock, but readers can get non-irqsafe
|
||
|
|
* read-locks.
|
||
|
|
*/
|
||
|
|
typedef struct {
|
||
|
|
volatile int lock;
|
||
|
|
#ifdef CONFIG_DEBUG_SPINLOCK
|
||
|
|
unsigned magic;
|
||
|
|
#endif
|
||
|
|
#ifdef CONFIG_PREEMPT
|
||
|
|
unsigned int break_lock;
|
||
|
|
#endif
|
||
|
|
} rwlock_t;
|
||
|
|
|
||
|
|
#define RWLOCK_MAGIC 0xdeaf1eed
|
||
|
|
|
||
|
|
#ifdef CONFIG_DEBUG_SPINLOCK
|
||
|
|
#define RWLOCK_MAGIC_INIT , RWLOCK_MAGIC
|
||
|
|
#else
|
||
|
|
#define RWLOCK_MAGIC_INIT /* */
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#define RW_LOCK_UNLOCKED (rwlock_t) { RW_LOCK_BIAS RWLOCK_MAGIC_INIT }
|
||
|
|
|
||
|
|
#define rwlock_init(x) do { *(x) = RW_LOCK_UNLOCKED; } while(0)
|
||
|
|
|
||
|
|
/**
|
||
|
|
* read_can_lock - would read_trylock() succeed?
|
||
|
|
* @lock: the rwlock in question.
|
||
|
|
*/
|
||
|
|
#define read_can_lock(x) ((int)(x)->lock > 0)
|
||
|
|
|
||
|
|
/**
|
||
|
|
* write_can_lock - would write_trylock() succeed?
|
||
|
|
* @lock: the rwlock in question.
|
||
|
|
*/
|
||
|
|
#define write_can_lock(x) ((x)->lock == RW_LOCK_BIAS)
|
||
|
|
|
||
|
|
/*
|
||
|
|
* On x86, we implement read-write locks as a 32-bit counter
|
||
|
|
* with the high bit (sign) being the "contended" bit.
|
||
|
|
*
|
||
|
|
* The inline assembly is non-obvious. Think about it.
|
||
|
|
*
|
||
|
|
* Changed to use the same technique as rw semaphores. See
|
||
|
|
* semaphore.h for details. -ben
|
||
|
|
*/
|
||
|
|
/* the spinlock helpers are in arch/i386/kernel/semaphore.c */
|
||
|
|
|
||
|
|
static inline void _raw_read_lock(rwlock_t *rw)
|
||
|
|
{
|
||
|
|
unsigned long tmp0, tmp1;
|
||
|
|
|
||
|
|
#ifdef CONFIG_DEBUG_SPINLOCK
|
||
|
|
BUG_ON(rw->magic != RWLOCK_MAGIC);
|
||
|
|
#endif
|
||
|
|
/*
|
||
|
|
* rw->lock : >0 : unlock
|
||
|
|
* : <=0 : lock
|
||
|
|
*
|
||
|
|
* for ( ; ; ) {
|
||
|
|
* rw->lock -= 1; <-- need atomic operation
|
||
|
|
* if (rw->lock >= 0) break;
|
||
|
|
* rw->lock += 1; <-- need atomic operation
|
||
|
|
* for ( ; rw->lock <= 0 ; );
|
||
|
|
* }
|
||
|
|
*/
|
||
|
|
__asm__ __volatile__ (
|
||
|
|
"# read_lock \n\t"
|
||
|
|
".fillinsn \n"
|
||
|
|
"1: \n\t"
|
||
|
|
"mvfc %1, psw; \n\t"
|
||
|
|
"clrpsw #0x40 -> nop; \n\t"
|
||
|
|
DCACHE_CLEAR("%0", "r6", "%2")
|
||
|
|
"lock %0, @%2; \n\t"
|
||
|
|
"addi %0, #-1; \n\t"
|
||
|
|
"unlock %0, @%2; \n\t"
|
||
|
|
"mvtc %1, psw; \n\t"
|
||
|
|
"bltz %0, 2f; \n\t"
|
||
|
|
LOCK_SECTION_START(".balign 4 \n\t")
|
||
|
|
".fillinsn \n"
|
||
|
|
"2: \n\t"
|
||
|
|
"clrpsw #0x40 -> nop; \n\t"
|
||
|
|
DCACHE_CLEAR("%0", "r6", "%2")
|
||
|
|
"lock %0, @%2; \n\t"
|
||
|
|
"addi %0, #1; \n\t"
|
||
|
|
"unlock %0, @%2; \n\t"
|
||
|
|
"mvtc %1, psw; \n\t"
|
||
|
|
".fillinsn \n"
|
||
|
|
"3: \n\t"
|
||
|
|
"ld %0, @%2; \n\t"
|
||
|
|
"bgtz %0, 1b; \n\t"
|
||
|
|
"bra 3b; \n\t"
|
||
|
|
LOCK_SECTION_END
|
||
|
|
: "=&r" (tmp0), "=&r" (tmp1)
|
||
|
|
: "r" (&rw->lock)
|
||
|
|
: "memory"
|
||
|
|
#ifdef CONFIG_CHIP_M32700_TS1
|
||
|
|
, "r6"
|
||
|
|
#endif /* CONFIG_CHIP_M32700_TS1 */
|
||
|
|
);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void _raw_write_lock(rwlock_t *rw)
|
||
|
|
{
|
||
|
|
unsigned long tmp0, tmp1, tmp2;
|
||
|
|
|
||
|
|
#ifdef CONFIG_DEBUG_SPINLOCK
|
||
|
|
BUG_ON(rw->magic != RWLOCK_MAGIC);
|
||
|
|
#endif
|
||
|
|
/*
|
||
|
|
* rw->lock : =RW_LOCK_BIAS_STR : unlock
|
||
|
|
* : !=RW_LOCK_BIAS_STR : lock
|
||
|
|
*
|
||
|
|
* for ( ; ; ) {
|
||
|
|
* rw->lock -= RW_LOCK_BIAS_STR; <-- need atomic operation
|
||
|
|
* if (rw->lock == 0) break;
|
||
|
|
* rw->lock += RW_LOCK_BIAS_STR; <-- need atomic operation
|
||
|
|
* for ( ; rw->lock != RW_LOCK_BIAS_STR ; ) ;
|
||
|
|
* }
|
||
|
|
*/
|
||
|
|
__asm__ __volatile__ (
|
||
|
|
"# write_lock \n\t"
|
||
|
|
"seth %1, #high(" RW_LOCK_BIAS_STR "); \n\t"
|
||
|
|
"or3 %1, %1, #low(" RW_LOCK_BIAS_STR "); \n\t"
|
||
|
|
".fillinsn \n"
|
||
|
|
"1: \n\t"
|
||
|
|
"mvfc %2, psw; \n\t"
|
||
|
|
"clrpsw #0x40 -> nop; \n\t"
|
||
|
|
DCACHE_CLEAR("%0", "r7", "%3")
|
||
|
|
"lock %0, @%3; \n\t"
|
||
|
|
"sub %0, %1; \n\t"
|
||
|
|
"unlock %0, @%3; \n\t"
|
||
|
|
"mvtc %2, psw; \n\t"
|
||
|
|
"bnez %0, 2f; \n\t"
|
||
|
|
LOCK_SECTION_START(".balign 4 \n\t")
|
||
|
|
".fillinsn \n"
|
||
|
|
"2: \n\t"
|
||
|
|
"clrpsw #0x40 -> nop; \n\t"
|
||
|
|
DCACHE_CLEAR("%0", "r7", "%3")
|
||
|
|
"lock %0, @%3; \n\t"
|
||
|
|
"add %0, %1; \n\t"
|
||
|
|
"unlock %0, @%3; \n\t"
|
||
|
|
"mvtc %2, psw; \n\t"
|
||
|
|
".fillinsn \n"
|
||
|
|
"3: \n\t"
|
||
|
|
"ld %0, @%3; \n\t"
|
||
|
|
"beq %0, %1, 1b; \n\t"
|
||
|
|
"bra 3b; \n\t"
|
||
|
|
LOCK_SECTION_END
|
||
|
|
: "=&r" (tmp0), "=&r" (tmp1), "=&r" (tmp2)
|
||
|
|
: "r" (&rw->lock)
|
||
|
|
: "memory"
|
||
|
|
#ifdef CONFIG_CHIP_M32700_TS1
|
||
|
|
, "r7"
|
||
|
|
#endif /* CONFIG_CHIP_M32700_TS1 */
|
||
|
|
);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void _raw_read_unlock(rwlock_t *rw)
|
||
|
|
{
|
||
|
|
unsigned long tmp0, tmp1;
|
||
|
|
|
||
|
|
__asm__ __volatile__ (
|
||
|
|
"# read_unlock \n\t"
|
||
|
|
"mvfc %1, psw; \n\t"
|
||
|
|
"clrpsw #0x40 -> nop; \n\t"
|
||
|
|
DCACHE_CLEAR("%0", "r6", "%2")
|
||
|
|
"lock %0, @%2; \n\t"
|
||
|
|
"addi %0, #1; \n\t"
|
||
|
|
"unlock %0, @%2; \n\t"
|
||
|
|
"mvtc %1, psw; \n\t"
|
||
|
|
: "=&r" (tmp0), "=&r" (tmp1)
|
||
|
|
: "r" (&rw->lock)
|
||
|
|
: "memory"
|
||
|
|
#ifdef CONFIG_CHIP_M32700_TS1
|
||
|
|
, "r6"
|
||
|
|
#endif /* CONFIG_CHIP_M32700_TS1 */
|
||
|
|
);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void _raw_write_unlock(rwlock_t *rw)
|
||
|
|
{
|
||
|
|
unsigned long tmp0, tmp1, tmp2;
|
||
|
|
|
||
|
|
__asm__ __volatile__ (
|
||
|
|
"# write_unlock \n\t"
|
||
|
|
"seth %1, #high(" RW_LOCK_BIAS_STR "); \n\t"
|
||
|
|
"or3 %1, %1, #low(" RW_LOCK_BIAS_STR "); \n\t"
|
||
|
|
"mvfc %2, psw; \n\t"
|
||
|
|
"clrpsw #0x40 -> nop; \n\t"
|
||
|
|
DCACHE_CLEAR("%0", "r7", "%3")
|
||
|
|
"lock %0, @%3; \n\t"
|
||
|
|
"add %0, %1; \n\t"
|
||
|
|
"unlock %0, @%3; \n\t"
|
||
|
|
"mvtc %2, psw; \n\t"
|
||
|
|
: "=&r" (tmp0), "=&r" (tmp1), "=&r" (tmp2)
|
||
|
|
: "r" (&rw->lock)
|
||
|
|
: "memory"
|
||
|
|
#ifdef CONFIG_CHIP_M32700_TS1
|
||
|
|
, "r7"
|
||
|
|
#endif /* CONFIG_CHIP_M32700_TS1 */
|
||
|
|
);
|
||
|
|
}
|
||
|
|
|
||
|
|
#define _raw_read_trylock(lock) generic_raw_read_trylock(lock)
|
||
|
|
|
||
|
|
static inline int _raw_write_trylock(rwlock_t *lock)
|
||
|
|
{
|
||
|
|
atomic_t *count = (atomic_t *)lock;
|
||
|
|
if (atomic_sub_and_test(RW_LOCK_BIAS, count))
|
||
|
|
return 1;
|
||
|
|
atomic_add(RW_LOCK_BIAS, count);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif /* _ASM_M32R_SPINLOCK_H */
|