#ifndef _M68KNOMMU_SYSTEM_H
#define _M68KNOMMU_SYSTEM_H

#include <linux/linkage.h>
#include <asm/segment.h>
#include <asm/entry.h>

/*
 * 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, offset of tss in d1, and whether
 * the mm structures are shared in d2 (to avoid atc flushing).
 */
asmlinkage void resume(void);
#define switch_to(prev,next,last)                               \
{                                                               \
  void *_last;                                                  \
  __asm__ __volatile__(                                         \
        "movel  %1, %%a0\n\t"                                   \
        "movel  %2, %%a1\n\t"                                   \
        "jbsr resume\n\t"                                       \
        "movel  %%d1, %0\n\t"                                   \
       : "=d" (_last)                                           \
       : "d" (prev), "d" (next)                                 \
       : "cc", "d0", "d1", "d2", "d3", "d4", "d5", "a0", "a1"); \
  (last) = _last;                                               \
}

#ifdef CONFIG_COLDFIRE
#define local_irq_enable() __asm__ __volatile__ (               \
        "move %/sr,%%d0\n\t"                                    \
        "andi.l #0xf8ff,%%d0\n\t"                               \
        "move %%d0,%/sr\n"                                      \
        : /* no outputs */                                      \
        :                                                       \
        : "cc", "%d0", "memory")
#define local_irq_disable() __asm__ __volatile__ (              \
        "move %/sr,%%d0\n\t"                                    \
        "ori.l #0x0700,%%d0\n\t"                                \
        "move %%d0,%/sr\n"                                      \
        : /* no outputs */                                      \
        :                                                       \
        : "cc", "%d0", "memory")
/* For spinlocks etc */
#define local_irq_save(x) __asm__ __volatile__ (                \
        "movew %%sr,%0\n\t"                                     \
        "movew #0x0700,%%d0\n\t"                                \
        "or.l  %0,%%d0\n\t"                                     \
        "movew %%d0,%/sr"                                       \
        : "=d" (x)                                              \
        :                                                       \
        : "cc", "%d0", "memory")
#else

/* portable version */ /* FIXME - see entry.h*/
#define ALLOWINT 0xf8ff

#define local_irq_enable() asm volatile ("andiw %0,%%sr": : "i" (ALLOWINT) : "memory")
#define local_irq_disable() asm volatile ("oriw  #0x0700,%%sr": : : "memory")
#endif

#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")

/* For spinlocks etc */
#ifndef local_irq_save
#define local_irq_save(x) do { local_save_flags(x); local_irq_disable(); } while (0)
#endif

#define irqs_disabled()                 \
({                                      \
        unsigned long flags;            \
        local_save_flags(flags);        \
        ((flags & 0x0700) == 0x0700);   \
})

#define iret() __asm__ __volatile__ ("rte": : :"memory", "sp", "cc")

/*
 * Force strict CPU ordering.
 * Not really required on m68k...
 */
#define nop()  asm volatile ("nop"::)
#define mb()   asm volatile (""   : : :"memory")
#define rmb()  asm volatile (""   : : :"memory")
#define wmb()  asm volatile (""   : : :"memory")
#define set_mb(var, value) do { xchg(&var, value); } while (0)

#ifdef CONFIG_SMP
#define smp_mb()        mb()
#define smp_rmb()       rmb()
#define smp_wmb()       wmb()
#define smp_read_barrier_depends()      read_barrier_depends()
#else
#define smp_mb()        barrier()
#define smp_rmb()       barrier()
#define smp_wmb()       barrier()
#define smp_read_barrier_depends()      do { } while(0)
#endif

#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 tmp, flags;

  local_irq_save(flags);

  switch (size) {
  case 1:
    __asm__ __volatile__
    ("moveb %2,%0\n\t"
     "moveb %1,%2"
    : "=&d" (tmp) : "d" (x), "m" (*__xg(ptr)) : "memory");
    break;
  case 2:
    __asm__ __volatile__
    ("movew %2,%0\n\t"
     "movew %1,%2"
    : "=&d" (tmp) : "d" (x), "m" (*__xg(ptr)) : "memory");
    break;
  case 4:
    __asm__ __volatile__
    ("movel %2,%0\n\t"
     "movel %1,%2"
    : "=&d" (tmp) : "d" (x), "m" (*__xg(ptr)) : "memory");
    break;
  }
  local_irq_restore(flags);
  return tmp;
}
#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

/*
 * 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.
 */
#define __HAVE_ARCH_CMPXCHG     1

static __inline__ unsigned long
cmpxchg(volatile int *p, int old, int new)
{
        unsigned long flags;
        int prev;

        local_irq_save(flags);
        if ((prev = *p) == old)
                *p = new;
        local_irq_restore(flags);
        return(prev);
}


#ifdef CONFIG_M68332
#define HARD_RESET_NOW() ({             \
        local_irq_disable();            \
        asm("                           \
        movew   #0x0000, 0xfffa6a;      \
        reset;                          \
        /*movew #0x1557, 0xfffa44;*/    \
        /*movew #0x0155, 0xfffa46;*/    \
        moveal #0, %a0;                 \
        movec %a0, %vbr;                \
        moveal 0, %sp;                  \
        moveal 4, %a0;                  \
        jmp (%a0);                      \
        ");                             \
})
#endif

#if defined( CONFIG_M68328 ) || defined( CONFIG_M68EZ328 ) || \
        defined (CONFIG_M68360) || defined( CONFIG_M68VZ328 )
#define HARD_RESET_NOW() ({             \
        local_irq_disable();            \
        asm("                           \
        moveal #0x10c00000, %a0;        \
        moveb #0, 0xFFFFF300;           \
        moveal 0(%a0), %sp;             \
        moveal 4(%a0), %a0;             \
        jmp (%a0);                      \
        ");                             \
})
#endif

#ifdef CONFIG_COLDFIRE
#if defined(CONFIG_M5272) && defined(CONFIG_NETtel)
/*
 * Need to account for broken early mask of 5272 silicon. So don't
 * jump through the original start address. Jump strait into the
 * known start of the FLASH code.
 */
#define HARD_RESET_NOW() ({             \
        asm("                           \
        movew #0x2700, %sr;             \
        jmp 0xf0000400;                 \
        ");                             \
})
#elif defined(CONFIG_NETtel) || defined(CONFIG_eLIA) || \
      defined(CONFIG_SECUREEDGEMP3) || defined(CONFIG_CLEOPATRA)
#define HARD_RESET_NOW() ({             \
        asm("                           \
        movew #0x2700, %sr;             \
        moveal #0x10000044, %a0;        \
        movel #0xffffffff, (%a0);       \
        moveal #0x10000001, %a0;        \
        moveb #0x00, (%a0);             \
        moveal #0xf0000004, %a0;        \
        moveal (%a0), %a0;              \
        jmp (%a0);                      \
        ");                             \
})
#elif defined(CONFIG_M5272)
/*
 * Retrieve the boot address in flash using CSBR0 and CSOR0
 * find the reset vector at flash_address + 4 (e.g. 0x400)
 * remap it in the flash's current location (e.g. 0xf0000400)
 * and jump there.
 */ 
#define HARD_RESET_NOW() ({             \
        asm("                           \
        movew #0x2700, %%sr;            \
        move.l  %0+0x40,%%d0;           \
        and.l   %0+0x44,%%d0;           \
        andi.l  #0xfffff000,%%d0;       \
        mov.l   %%d0,%%a0;              \
        or.l    4(%%a0),%%d0;           \
        mov.l   %%d0,%%a0;              \
        jmp (%%a0);"                    \
        : /* No output */               \
        : "o" (*(char *)MCF_MBAR) );    \
})
#elif defined(CONFIG_M528x)
/*
 * The MCF528x has a bit (SOFTRST) in memory (Reset Control Register RCR),
 * that when set, resets the MCF528x.
 */
#define HARD_RESET_NOW() \
({                                              \
        unsigned char volatile *reset;          \
        asm("move.w     #0x2700, %sr");         \
        reset = ((volatile unsigned char *)(MCF_IPSBAR + 0x110000));    \
        while(1)                                \
        *reset |= (0x01 << 7);\
})
#elif defined(CONFIG_M523x)
#define HARD_RESET_NOW() ({             \
        asm("                           \
        movew #0x2700, %sr;             \
        movel #0x01000000, %sp;         \
        moveal #0x40110000, %a0;        \
        moveb #0x80, (%a0);             \
        ");                             \
})
#elif defined(CONFIG_M520x)
        /*
         * The MCF5208 has a bit (SOFTRST) in memory (Reset Control Register 
         * RCR), that when set, resets the MCF5208.
         */
#define HARD_RESET_NOW()                \
({                                      \
        unsigned char volatile *reset;  \
        asm("move.w     #0x2700, %sr"); \
        reset = ((volatile unsigned char *)(MCF_IPSBAR + 0xA0000));     \
        while(1)                        \
                *reset |= 0x80;         \
})
#else
#define HARD_RESET_NOW() ({             \
        asm("                           \
        movew #0x2700, %sr;             \
        moveal #0x4, %a0;               \
        moveal (%a0), %a0;              \
        jmp (%a0);                      \
        ");                             \
})
#endif
#endif
#define arch_align_stack(x) (x)

#endif /* _M68KNOMMU_SYSTEM_H */