193 lines
5.0 KiB
C
193 lines
5.0 KiB
C
|
/*
|
||
|
* Copyright 2004-2009 Analog Devices Inc.
|
||
|
* Tony Kou (tonyko@lineo.ca)
|
||
|
*
|
||
|
* Licensed under the GPL-2 or later
|
||
|
*/
|
||
|
|
||
|
#ifndef _BLACKFIN_SYSTEM_H
|
||
|
#define _BLACKFIN_SYSTEM_H
|
||
|
|
||
|
#include <linux/linkage.h>
|
||
|
#include <linux/irqflags.h>
|
||
|
#include <mach/anomaly.h>
|
||
|
#include <asm/cache.h>
|
||
|
#include <asm/pda.h>
|
||
|
#include <asm/irq.h>
|
||
|
|
||
|
/*
|
||
|
* Force strict CPU ordering.
|
||
|
*/
|
||
|
#define nop() __asm__ __volatile__ ("nop;\n\t" : : )
|
||
|
#define mb() __asm__ __volatile__ ("" : : : "memory")
|
||
|
#define rmb() __asm__ __volatile__ ("" : : : "memory")
|
||
|
#define wmb() __asm__ __volatile__ ("" : : : "memory")
|
||
|
#define set_mb(var, value) do { (void) xchg(&var, value); } while (0)
|
||
|
#define read_barrier_depends() do { } while(0)
|
||
|
|
||
|
#ifdef CONFIG_SMP
|
||
|
asmlinkage unsigned long __raw_xchg_1_asm(volatile void *ptr, unsigned long value);
|
||
|
asmlinkage unsigned long __raw_xchg_2_asm(volatile void *ptr, unsigned long value);
|
||
|
asmlinkage unsigned long __raw_xchg_4_asm(volatile void *ptr, unsigned long value);
|
||
|
asmlinkage unsigned long __raw_cmpxchg_1_asm(volatile void *ptr,
|
||
|
unsigned long new, unsigned long old);
|
||
|
asmlinkage unsigned long __raw_cmpxchg_2_asm(volatile void *ptr,
|
||
|
unsigned long new, unsigned long old);
|
||
|
asmlinkage unsigned long __raw_cmpxchg_4_asm(volatile void *ptr,
|
||
|
unsigned long new, unsigned long old);
|
||
|
|
||
|
#ifdef __ARCH_SYNC_CORE_DCACHE
|
||
|
# define smp_mb() do { barrier(); smp_check_barrier(); smp_mark_barrier(); } while (0)
|
||
|
# define smp_rmb() do { barrier(); smp_check_barrier(); } while (0)
|
||
|
# define smp_wmb() do { barrier(); smp_mark_barrier(); } while (0)
|
||
|
#define smp_read_barrier_depends() do { barrier(); smp_check_barrier(); } while (0)
|
||
|
|
||
|
#else
|
||
|
# define smp_mb() barrier()
|
||
|
# define smp_rmb() barrier()
|
||
|
# define smp_wmb() barrier()
|
||
|
#define smp_read_barrier_depends() barrier()
|
||
|
#endif
|
||
|
|
||
|
static inline unsigned long __xchg(unsigned long x, volatile void *ptr,
|
||
|
int size)
|
||
|
{
|
||
|
unsigned long tmp;
|
||
|
|
||
|
switch (size) {
|
||
|
case 1:
|
||
|
tmp = __raw_xchg_1_asm(ptr, x);
|
||
|
break;
|
||
|
case 2:
|
||
|
tmp = __raw_xchg_2_asm(ptr, x);
|
||
|
break;
|
||
|
case 4:
|
||
|
tmp = __raw_xchg_4_asm(ptr, x);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return tmp;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Atomic compare and exchange. Compare OLD with MEM, if identical,
|
||
|
* store NEW in MEM. Return the initial value in MEM. Success is
|
||
|
* indicated by comparing RETURN with OLD.
|
||
|
*/
|
||
|
static inline unsigned long __cmpxchg(volatile void *ptr, unsigned long old,
|
||
|
unsigned long new, int size)
|
||
|
{
|
||
|
unsigned long tmp;
|
||
|
|
||
|
switch (size) {
|
||
|
case 1:
|
||
|
tmp = __raw_cmpxchg_1_asm(ptr, new, old);
|
||
|
break;
|
||
|
case 2:
|
||
|
tmp = __raw_cmpxchg_2_asm(ptr, new, old);
|
||
|
break;
|
||
|
case 4:
|
||
|
tmp = __raw_cmpxchg_4_asm(ptr, new, old);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return tmp;
|
||
|
}
|
||
|
#define cmpxchg(ptr, o, n) \
|
||
|
((__typeof__(*(ptr)))__cmpxchg((ptr), (unsigned long)(o), \
|
||
|
(unsigned long)(n), sizeof(*(ptr))))
|
||
|
|
||
|
#else /* !CONFIG_SMP */
|
||
|
|
||
|
#define smp_mb() barrier()
|
||
|
#define smp_rmb() barrier()
|
||
|
#define smp_wmb() barrier()
|
||
|
#define smp_read_barrier_depends() do { } while(0)
|
||
|
|
||
|
struct __xchg_dummy {
|
||
|
unsigned long a[100];
|
||
|
};
|
||
|
#define __xg(x) ((volatile struct __xchg_dummy *)(x))
|
||
|
|
||
|
#include <mach/blackfin.h>
|
||
|
|
||
|
static inline unsigned long __xchg(unsigned long x, volatile void *ptr,
|
||
|
int size)
|
||
|
{
|
||
|
unsigned long tmp = 0;
|
||
|
unsigned long flags;
|
||
|
|
||
|
local_irq_save_hw(flags);
|
||
|
|
||
|
switch (size) {
|
||
|
case 1:
|
||
|
__asm__ __volatile__
|
||
|
("%0 = b%2 (z);\n\t"
|
||
|
"b%2 = %1;\n\t"
|
||
|
: "=&d" (tmp) : "d" (x), "m" (*__xg(ptr)) : "memory");
|
||
|
break;
|
||
|
case 2:
|
||
|
__asm__ __volatile__
|
||
|
("%0 = w%2 (z);\n\t"
|
||
|
"w%2 = %1;\n\t"
|
||
|
: "=&d" (tmp) : "d" (x), "m" (*__xg(ptr)) : "memory");
|
||
|
break;
|
||
|
case 4:
|
||
|
__asm__ __volatile__
|
||
|
("%0 = %2;\n\t"
|
||
|
"%2 = %1;\n\t"
|
||
|
: "=&d" (tmp) : "d" (x), "m" (*__xg(ptr)) : "memory");
|
||
|
break;
|
||
|
}
|
||
|
local_irq_restore_hw(flags);
|
||
|
return tmp;
|
||
|
}
|
||
|
|
||
|
#include <asm-generic/cmpxchg-local.h>
|
||
|
|
||
|
/*
|
||
|
* cmpxchg_local and cmpxchg64_local are atomic wrt current CPU. Always make
|
||
|
* them available.
|
||
|
*/
|
||
|
#define cmpxchg_local(ptr, o, n) \
|
||
|
((__typeof__(*(ptr)))__cmpxchg_local_generic((ptr), (unsigned long)(o),\
|
||
|
(unsigned long)(n), sizeof(*(ptr))))
|
||
|
#define cmpxchg64_local(ptr, o, n) __cmpxchg64_local_generic((ptr), (o), (n))
|
||
|
|
||
|
#include <asm-generic/cmpxchg.h>
|
||
|
|
||
|
#endif /* !CONFIG_SMP */
|
||
|
|
||
|
#define xchg(ptr, x) ((__typeof__(*(ptr)))__xchg((unsigned long)(x), (ptr), sizeof(*(ptr))))
|
||
|
#define tas(ptr) ((void)xchg((ptr), 1))
|
||
|
|
||
|
#define prepare_to_switch() do { } while(0)
|
||
|
|
||
|
/*
|
||
|
* switch_to(n) should switch tasks to task ptr, first checking that
|
||
|
* ptr isn't the current task, in which case it does nothing.
|
||
|
*/
|
||
|
|
||
|
#include <asm/l1layout.h>
|
||
|
#include <asm/mem_map.h>
|
||
|
|
||
|
asmlinkage struct task_struct *resume(struct task_struct *prev, struct task_struct *next);
|
||
|
|
||
|
#ifndef CONFIG_SMP
|
||
|
#define switch_to(prev,next,last) \
|
||
|
do { \
|
||
|
memcpy (&task_thread_info(prev)->l1_task_info, L1_SCRATCH_TASK_INFO, \
|
||
|
sizeof *L1_SCRATCH_TASK_INFO); \
|
||
|
memcpy (L1_SCRATCH_TASK_INFO, &task_thread_info(next)->l1_task_info, \
|
||
|
sizeof *L1_SCRATCH_TASK_INFO); \
|
||
|
(last) = resume (prev, next); \
|
||
|
} while (0)
|
||
|
#else
|
||
|
#define switch_to(prev, next, last) \
|
||
|
do { \
|
||
|
(last) = resume(prev, next); \
|
||
|
} while (0)
|
||
|
#endif
|
||
|
|
||
|
#endif /* _BLACKFIN_SYSTEM_H */
|