219 lines
5.6 KiB
C
219 lines
5.6 KiB
C
|
#ifndef _M68K_SYSTEM_H
|
||
|
#define _M68K_SYSTEM_H
|
||
|
|
||
|
#include <linux/linkage.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <asm/segment.h>
|
||
|
#include <asm/entry.h>
|
||
|
|
||
|
#ifdef __KERNEL__
|
||
|
|
||
|
/*
|
||
|
* switch_to(n) should switch tasks to task ptr, first checking that
|
||
|
* ptr isn't the current task, in which case it does nothing. This
|
||
|
* also clears the TS-flag if the task we switched to has used the
|
||
|
* math co-processor latest.
|
||
|
*/
|
||
|
/*
|
||
|
* switch_to() saves the extra registers, that are not saved
|
||
|
* automatically by SAVE_SWITCH_STACK in resume(), ie. d0-d5 and
|
||
|
* a0-a1. Some of these are used by schedule() and its predecessors
|
||
|
* and so we might get see unexpected behaviors when a task returns
|
||
|
* with unexpected register values.
|
||
|
*
|
||
|
* syscall stores these registers itself and none of them are used
|
||
|
* by syscall after the function in the syscall has been called.
|
||
|
*
|
||
|
* Beware that resume now expects *next to be in d1 and the offset of
|
||
|
* tss to be in a1. This saves a few instructions as we no longer have
|
||
|
* to push them onto the stack and read them back right after.
|
||
|
*
|
||
|
* 02/17/96 - Jes Sorensen (jds@kom.auc.dk)
|
||
|
*
|
||
|
* Changed 96/09/19 by Andreas Schwab
|
||
|
* pass prev in a0, next in a1
|
||
|
*/
|
||
|
asmlinkage void resume(void);
|
||
|
#define switch_to(prev,next,last) do { \
|
||
|
register void *_prev __asm__ ("a0") = (prev); \
|
||
|
register void *_next __asm__ ("a1") = (next); \
|
||
|
register void *_last __asm__ ("d1"); \
|
||
|
__asm__ __volatile__("jbsr resume" \
|
||
|
: "=a" (_prev), "=a" (_next), "=d" (_last) \
|
||
|
: "0" (_prev), "1" (_next) \
|
||
|
: "d0", "d2", "d3", "d4", "d5"); \
|
||
|
(last) = _last; \
|
||
|
} while (0)
|
||
|
|
||
|
|
||
|
/*
|
||
|
* Force strict CPU ordering.
|
||
|
* Not really required on m68k...
|
||
|
*/
|
||
|
#define nop() do { asm volatile ("nop"); barrier(); } while (0)
|
||
|
#define mb() barrier()
|
||
|
#define rmb() barrier()
|
||
|
#define wmb() barrier()
|
||
|
#define read_barrier_depends() ((void)0)
|
||
|
#define set_mb(var, value) ({ (var) = (value); wmb(); })
|
||
|
|
||
|
#define smp_mb() barrier()
|
||
|
#define smp_rmb() barrier()
|
||
|
#define smp_wmb() barrier()
|
||
|
#define smp_read_barrier_depends() ((void)0)
|
||
|
|
||
|
/* interrupt control.. */
|
||
|
#if 0
|
||
|
#define local_irq_enable() asm volatile ("andiw %0,%%sr": : "i" (ALLOWINT) : "memory")
|
||
|
#else
|
||
|
#include <linux/hardirq.h>
|
||
|
#define local_irq_enable() ({ \
|
||
|
if (MACH_IS_Q40 || !hardirq_count()) \
|
||
|
asm volatile ("andiw %0,%%sr": : "i" (ALLOWINT) : "memory"); \
|
||
|
})
|
||
|
#endif
|
||
|
#define local_irq_disable() asm volatile ("oriw #0x0700,%%sr": : : "memory")
|
||
|
#define local_save_flags(x) asm volatile ("movew %%sr,%0":"=d" (x) : : "memory")
|
||
|
#define local_irq_restore(x) asm volatile ("movew %0,%%sr": :"d" (x) : "memory")
|
||
|
|
||
|
static inline int irqs_disabled(void)
|
||
|
{
|
||
|
unsigned long flags;
|
||
|
local_save_flags(flags);
|
||
|
return flags & ~ALLOWINT;
|
||
|
}
|
||
|
|
||
|
/* For spinlocks etc */
|
||
|
#define local_irq_save(x) ({ local_save_flags(x); local_irq_disable(); })
|
||
|
|
||
|
#define xchg(ptr,x) ((__typeof__(*(ptr)))__xchg((unsigned long)(x),(ptr),sizeof(*(ptr))))
|
||
|
|
||
|
struct __xchg_dummy { unsigned long a[100]; };
|
||
|
#define __xg(x) ((volatile struct __xchg_dummy *)(x))
|
||
|
|
||
|
#ifndef CONFIG_RMW_INSNS
|
||
|
static inline unsigned long __xchg(unsigned long x, volatile void * ptr, int size)
|
||
|
{
|
||
|
unsigned long flags, tmp;
|
||
|
|
||
|
local_irq_save(flags);
|
||
|
|
||
|
switch (size) {
|
||
|
case 1:
|
||
|
tmp = *(u8 *)ptr;
|
||
|
*(u8 *)ptr = x;
|
||
|
x = tmp;
|
||
|
break;
|
||
|
case 2:
|
||
|
tmp = *(u16 *)ptr;
|
||
|
*(u16 *)ptr = x;
|
||
|
x = tmp;
|
||
|
break;
|
||
|
case 4:
|
||
|
tmp = *(u32 *)ptr;
|
||
|
*(u32 *)ptr = x;
|
||
|
x = tmp;
|
||
|
break;
|
||
|
default:
|
||
|
BUG();
|
||
|
}
|
||
|
|
||
|
local_irq_restore(flags);
|
||
|
return x;
|
||
|
}
|
||
|
#else
|
||
|
static inline unsigned long __xchg(unsigned long x, volatile void * ptr, int size)
|
||
|
{
|
||
|
switch (size) {
|
||
|
case 1:
|
||
|
__asm__ __volatile__
|
||
|
("moveb %2,%0\n\t"
|
||
|
"1:\n\t"
|
||
|
"casb %0,%1,%2\n\t"
|
||
|
"jne 1b"
|
||
|
: "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
|
||
|
break;
|
||
|
case 2:
|
||
|
__asm__ __volatile__
|
||
|
("movew %2,%0\n\t"
|
||
|
"1:\n\t"
|
||
|
"casw %0,%1,%2\n\t"
|
||
|
"jne 1b"
|
||
|
: "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
|
||
|
break;
|
||
|
case 4:
|
||
|
__asm__ __volatile__
|
||
|
("movel %2,%0\n\t"
|
||
|
"1:\n\t"
|
||
|
"casl %0,%1,%2\n\t"
|
||
|
"jne 1b"
|
||
|
: "=&d" (x) : "d" (x), "m" (*__xg(ptr)) : "memory");
|
||
|
break;
|
||
|
}
|
||
|
return x;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
#include <asm-generic/cmpxchg-local.h>
|
||
|
|
||
|
#define cmpxchg64_local(ptr, o, n) __cmpxchg64_local_generic((ptr), (o), (n))
|
||
|
|
||
|
/*
|
||
|
* 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.
|
||
|
*/
|
||
|
#ifdef CONFIG_RMW_INSNS
|
||
|
#define __HAVE_ARCH_CMPXCHG 1
|
||
|
|
||
|
static inline unsigned long __cmpxchg(volatile void *p, unsigned long old,
|
||
|
unsigned long new, int size)
|
||
|
{
|
||
|
switch (size) {
|
||
|
case 1:
|
||
|
__asm__ __volatile__ ("casb %0,%2,%1"
|
||
|
: "=d" (old), "=m" (*(char *)p)
|
||
|
: "d" (new), "0" (old), "m" (*(char *)p));
|
||
|
break;
|
||
|
case 2:
|
||
|
__asm__ __volatile__ ("casw %0,%2,%1"
|
||
|
: "=d" (old), "=m" (*(short *)p)
|
||
|
: "d" (new), "0" (old), "m" (*(short *)p));
|
||
|
break;
|
||
|
case 4:
|
||
|
__asm__ __volatile__ ("casl %0,%2,%1"
|
||
|
: "=d" (old), "=m" (*(int *)p)
|
||
|
: "d" (new), "0" (old), "m" (*(int *)p));
|
||
|
break;
|
||
|
}
|
||
|
return old;
|
||
|
}
|
||
|
|
||
|
#define cmpxchg(ptr, o, n) \
|
||
|
((__typeof__(*(ptr)))__cmpxchg((ptr), (unsigned long)(o), \
|
||
|
(unsigned long)(n), sizeof(*(ptr))))
|
||
|
#define cmpxchg_local(ptr, o, n) \
|
||
|
((__typeof__(*(ptr)))__cmpxchg((ptr), (unsigned long)(o), \
|
||
|
(unsigned long)(n), sizeof(*(ptr))))
|
||
|
#else
|
||
|
|
||
|
/*
|
||
|
* 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))))
|
||
|
|
||
|
#ifndef CONFIG_SMP
|
||
|
#include <asm-generic/cmpxchg.h>
|
||
|
#endif
|
||
|
|
||
|
#endif
|
||
|
|
||
|
#define arch_align_stack(x) (x)
|
||
|
|
||
|
#endif /* __KERNEL__ */
|
||
|
|
||
|
#endif /* _M68K_SYSTEM_H */
|