485 lines
13 KiB
C
485 lines
13 KiB
C
/*
|
|
* include/asm-s390/system.h
|
|
*
|
|
* S390 version
|
|
* Copyright (C) 1999 IBM Deutschland Entwicklung GmbH, IBM Corporation
|
|
* Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
|
|
*
|
|
* Derived from "include/asm-i386/system.h"
|
|
*/
|
|
|
|
#ifndef __ASM_SYSTEM_H
|
|
#define __ASM_SYSTEM_H
|
|
|
|
#include <linux/kernel.h>
|
|
#include <asm/types.h>
|
|
#include <asm/ptrace.h>
|
|
#include <asm/setup.h>
|
|
#include <asm/processor.h>
|
|
|
|
#ifdef __KERNEL__
|
|
|
|
struct task_struct;
|
|
|
|
extern struct task_struct *__switch_to(void *, void *);
|
|
|
|
#ifdef __s390x__
|
|
#define __FLAG_SHIFT 56
|
|
#else /* ! __s390x__ */
|
|
#define __FLAG_SHIFT 24
|
|
#endif /* ! __s390x__ */
|
|
|
|
static inline void save_fp_regs(s390_fp_regs *fpregs)
|
|
{
|
|
asm volatile (
|
|
" std 0,8(%1)\n"
|
|
" std 2,24(%1)\n"
|
|
" std 4,40(%1)\n"
|
|
" std 6,56(%1)"
|
|
: "=m" (*fpregs) : "a" (fpregs), "m" (*fpregs) : "memory" );
|
|
if (!MACHINE_HAS_IEEE)
|
|
return;
|
|
asm volatile(
|
|
" stfpc 0(%1)\n"
|
|
" std 1,16(%1)\n"
|
|
" std 3,32(%1)\n"
|
|
" std 5,48(%1)\n"
|
|
" std 7,64(%1)\n"
|
|
" std 8,72(%1)\n"
|
|
" std 9,80(%1)\n"
|
|
" std 10,88(%1)\n"
|
|
" std 11,96(%1)\n"
|
|
" std 12,104(%1)\n"
|
|
" std 13,112(%1)\n"
|
|
" std 14,120(%1)\n"
|
|
" std 15,128(%1)\n"
|
|
: "=m" (*fpregs) : "a" (fpregs), "m" (*fpregs) : "memory" );
|
|
}
|
|
|
|
static inline void restore_fp_regs(s390_fp_regs *fpregs)
|
|
{
|
|
asm volatile (
|
|
" ld 0,8(%0)\n"
|
|
" ld 2,24(%0)\n"
|
|
" ld 4,40(%0)\n"
|
|
" ld 6,56(%0)"
|
|
: : "a" (fpregs), "m" (*fpregs) );
|
|
if (!MACHINE_HAS_IEEE)
|
|
return;
|
|
asm volatile(
|
|
" lfpc 0(%0)\n"
|
|
" ld 1,16(%0)\n"
|
|
" ld 3,32(%0)\n"
|
|
" ld 5,48(%0)\n"
|
|
" ld 7,64(%0)\n"
|
|
" ld 8,72(%0)\n"
|
|
" ld 9,80(%0)\n"
|
|
" ld 10,88(%0)\n"
|
|
" ld 11,96(%0)\n"
|
|
" ld 12,104(%0)\n"
|
|
" ld 13,112(%0)\n"
|
|
" ld 14,120(%0)\n"
|
|
" ld 15,128(%0)\n"
|
|
: : "a" (fpregs), "m" (*fpregs) );
|
|
}
|
|
|
|
static inline void save_access_regs(unsigned int *acrs)
|
|
{
|
|
asm volatile ("stam 0,15,0(%0)" : : "a" (acrs) : "memory" );
|
|
}
|
|
|
|
static inline void restore_access_regs(unsigned int *acrs)
|
|
{
|
|
asm volatile ("lam 0,15,0(%0)" : : "a" (acrs) );
|
|
}
|
|
|
|
#define switch_to(prev,next,last) do { \
|
|
if (prev == next) \
|
|
break; \
|
|
save_fp_regs(&prev->thread.fp_regs); \
|
|
restore_fp_regs(&next->thread.fp_regs); \
|
|
save_access_regs(&prev->thread.acrs[0]); \
|
|
restore_access_regs(&next->thread.acrs[0]); \
|
|
prev = __switch_to(prev,next); \
|
|
} while (0)
|
|
|
|
/*
|
|
* On SMP systems, when the scheduler does migration-cost autodetection,
|
|
* it needs a way to flush as much of the CPU's caches as possible.
|
|
*
|
|
* TODO: fill this in!
|
|
*/
|
|
static inline void sched_cacheflush(void)
|
|
{
|
|
}
|
|
|
|
#ifdef CONFIG_VIRT_CPU_ACCOUNTING
|
|
extern void account_vtime(struct task_struct *);
|
|
extern void account_tick_vtime(struct task_struct *);
|
|
extern void account_system_vtime(struct task_struct *);
|
|
#else
|
|
#define account_vtime(x) do { /* empty */ } while (0)
|
|
#endif
|
|
|
|
#define finish_arch_switch(prev) do { \
|
|
set_fs(current->thread.mm_segment); \
|
|
account_vtime(prev); \
|
|
} while (0)
|
|
|
|
#define nop() __asm__ __volatile__ ("nop")
|
|
|
|
#define xchg(ptr,x) \
|
|
((__typeof__(*(ptr)))__xchg((unsigned long)(x),(void *)(ptr),sizeof(*(ptr))))
|
|
|
|
static inline unsigned long __xchg(unsigned long x, void * ptr, int size)
|
|
{
|
|
unsigned long addr, old;
|
|
int shift;
|
|
|
|
switch (size) {
|
|
case 1:
|
|
addr = (unsigned long) ptr;
|
|
shift = (3 ^ (addr & 3)) << 3;
|
|
addr ^= addr & 3;
|
|
asm volatile(
|
|
" l %0,0(%4)\n"
|
|
"0: lr 0,%0\n"
|
|
" nr 0,%3\n"
|
|
" or 0,%2\n"
|
|
" cs %0,0,0(%4)\n"
|
|
" jl 0b\n"
|
|
: "=&d" (old), "=m" (*(int *) addr)
|
|
: "d" (x << shift), "d" (~(255 << shift)), "a" (addr),
|
|
"m" (*(int *) addr) : "memory", "cc", "0" );
|
|
x = old >> shift;
|
|
break;
|
|
case 2:
|
|
addr = (unsigned long) ptr;
|
|
shift = (2 ^ (addr & 2)) << 3;
|
|
addr ^= addr & 2;
|
|
asm volatile(
|
|
" l %0,0(%4)\n"
|
|
"0: lr 0,%0\n"
|
|
" nr 0,%3\n"
|
|
" or 0,%2\n"
|
|
" cs %0,0,0(%4)\n"
|
|
" jl 0b\n"
|
|
: "=&d" (old), "=m" (*(int *) addr)
|
|
: "d" (x << shift), "d" (~(65535 << shift)), "a" (addr),
|
|
"m" (*(int *) addr) : "memory", "cc", "0" );
|
|
x = old >> shift;
|
|
break;
|
|
case 4:
|
|
asm volatile (
|
|
" l %0,0(%3)\n"
|
|
"0: cs %0,%2,0(%3)\n"
|
|
" jl 0b\n"
|
|
: "=&d" (old), "=m" (*(int *) ptr)
|
|
: "d" (x), "a" (ptr), "m" (*(int *) ptr)
|
|
: "memory", "cc" );
|
|
x = old;
|
|
break;
|
|
#ifdef __s390x__
|
|
case 8:
|
|
asm volatile (
|
|
" lg %0,0(%3)\n"
|
|
"0: csg %0,%2,0(%3)\n"
|
|
" jl 0b\n"
|
|
: "=&d" (old), "=m" (*(long *) ptr)
|
|
: "d" (x), "a" (ptr), "m" (*(long *) ptr)
|
|
: "memory", "cc" );
|
|
x = old;
|
|
break;
|
|
#endif /* __s390x__ */
|
|
}
|
|
return x;
|
|
}
|
|
|
|
/*
|
|
* 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
|
|
|
|
#define cmpxchg(ptr,o,n)\
|
|
((__typeof__(*(ptr)))__cmpxchg((ptr),(unsigned long)(o),\
|
|
(unsigned long)(n),sizeof(*(ptr))))
|
|
|
|
static inline unsigned long
|
|
__cmpxchg(volatile void *ptr, unsigned long old, unsigned long new, int size)
|
|
{
|
|
unsigned long addr, prev, tmp;
|
|
int shift;
|
|
|
|
switch (size) {
|
|
case 1:
|
|
addr = (unsigned long) ptr;
|
|
shift = (3 ^ (addr & 3)) << 3;
|
|
addr ^= addr & 3;
|
|
asm volatile(
|
|
" l %0,0(%4)\n"
|
|
"0: nr %0,%5\n"
|
|
" lr %1,%0\n"
|
|
" or %0,%2\n"
|
|
" or %1,%3\n"
|
|
" cs %0,%1,0(%4)\n"
|
|
" jnl 1f\n"
|
|
" xr %1,%0\n"
|
|
" nr %1,%5\n"
|
|
" jnz 0b\n"
|
|
"1:"
|
|
: "=&d" (prev), "=&d" (tmp)
|
|
: "d" (old << shift), "d" (new << shift), "a" (ptr),
|
|
"d" (~(255 << shift))
|
|
: "memory", "cc" );
|
|
return prev >> shift;
|
|
case 2:
|
|
addr = (unsigned long) ptr;
|
|
shift = (2 ^ (addr & 2)) << 3;
|
|
addr ^= addr & 2;
|
|
asm volatile(
|
|
" l %0,0(%4)\n"
|
|
"0: nr %0,%5\n"
|
|
" lr %1,%0\n"
|
|
" or %0,%2\n"
|
|
" or %1,%3\n"
|
|
" cs %0,%1,0(%4)\n"
|
|
" jnl 1f\n"
|
|
" xr %1,%0\n"
|
|
" nr %1,%5\n"
|
|
" jnz 0b\n"
|
|
"1:"
|
|
: "=&d" (prev), "=&d" (tmp)
|
|
: "d" (old << shift), "d" (new << shift), "a" (ptr),
|
|
"d" (~(65535 << shift))
|
|
: "memory", "cc" );
|
|
return prev >> shift;
|
|
case 4:
|
|
asm volatile (
|
|
" cs %0,%2,0(%3)\n"
|
|
: "=&d" (prev) : "0" (old), "d" (new), "a" (ptr)
|
|
: "memory", "cc" );
|
|
return prev;
|
|
#ifdef __s390x__
|
|
case 8:
|
|
asm volatile (
|
|
" csg %0,%2,0(%3)\n"
|
|
: "=&d" (prev) : "0" (old), "d" (new), "a" (ptr)
|
|
: "memory", "cc" );
|
|
return prev;
|
|
#endif /* __s390x__ */
|
|
}
|
|
return old;
|
|
}
|
|
|
|
/*
|
|
* Force strict CPU ordering.
|
|
* And yes, this is required on UP too when we're talking
|
|
* to devices.
|
|
*
|
|
* This is very similar to the ppc eieio/sync instruction in that is
|
|
* does a checkpoint syncronisation & makes sure that
|
|
* all memory ops have completed wrt other CPU's ( see 7-15 POP DJB ).
|
|
*/
|
|
|
|
#define eieio() __asm__ __volatile__ ( "bcr 15,0" : : : "memory" )
|
|
# define SYNC_OTHER_CORES(x) eieio()
|
|
#define mb() eieio()
|
|
#define rmb() eieio()
|
|
#define wmb() eieio()
|
|
#define read_barrier_depends() do { } while(0)
|
|
#define smp_mb() mb()
|
|
#define smp_rmb() rmb()
|
|
#define smp_wmb() wmb()
|
|
#define smp_read_barrier_depends() read_barrier_depends()
|
|
#define smp_mb__before_clear_bit() smp_mb()
|
|
#define smp_mb__after_clear_bit() smp_mb()
|
|
|
|
|
|
#define set_mb(var, value) do { var = value; mb(); } while (0)
|
|
#define set_wmb(var, value) do { var = value; wmb(); } while (0)
|
|
|
|
/* interrupt control.. */
|
|
#define local_irq_enable() ({ \
|
|
unsigned long __dummy; \
|
|
__asm__ __volatile__ ( \
|
|
"stosm 0(%1),0x03" \
|
|
: "=m" (__dummy) : "a" (&__dummy) : "memory" ); \
|
|
})
|
|
|
|
#define local_irq_disable() ({ \
|
|
unsigned long __flags; \
|
|
__asm__ __volatile__ ( \
|
|
"stnsm 0(%1),0xfc" : "=m" (__flags) : "a" (&__flags) ); \
|
|
__flags; \
|
|
})
|
|
|
|
#define local_save_flags(x) \
|
|
__asm__ __volatile__("stosm 0(%1),0" : "=m" (x) : "a" (&x), "m" (x) )
|
|
|
|
#define local_irq_restore(x) \
|
|
__asm__ __volatile__("ssm 0(%0)" : : "a" (&x), "m" (x) : "memory")
|
|
|
|
#define irqs_disabled() \
|
|
({ \
|
|
unsigned long flags; \
|
|
local_save_flags(flags); \
|
|
!((flags >> __FLAG_SHIFT) & 3); \
|
|
})
|
|
|
|
#ifdef __s390x__
|
|
|
|
#define __ctl_load(array, low, high) ({ \
|
|
typedef struct { char _[sizeof(array)]; } addrtype; \
|
|
__asm__ __volatile__ ( \
|
|
" bras 1,0f\n" \
|
|
" lctlg 0,0,0(%0)\n" \
|
|
"0: ex %1,0(1)" \
|
|
: : "a" (&array), "a" (((low)<<4)+(high)), \
|
|
"m" (*(addrtype *)(array)) : "1" ); \
|
|
})
|
|
|
|
#define __ctl_store(array, low, high) ({ \
|
|
typedef struct { char _[sizeof(array)]; } addrtype; \
|
|
__asm__ __volatile__ ( \
|
|
" bras 1,0f\n" \
|
|
" stctg 0,0,0(%1)\n" \
|
|
"0: ex %2,0(1)" \
|
|
: "=m" (*(addrtype *)(array)) \
|
|
: "a" (&array), "a" (((low)<<4)+(high)) : "1" ); \
|
|
})
|
|
|
|
#define __ctl_set_bit(cr, bit) ({ \
|
|
__u8 __dummy[24]; \
|
|
__asm__ __volatile__ ( \
|
|
" bras 1,0f\n" /* skip indirect insns */ \
|
|
" stctg 0,0,0(%1)\n" \
|
|
" lctlg 0,0,0(%1)\n" \
|
|
"0: ex %2,0(1)\n" /* execute stctl */ \
|
|
" lg 0,0(%1)\n" \
|
|
" ogr 0,%3\n" /* set the bit */ \
|
|
" stg 0,0(%1)\n" \
|
|
"1: ex %2,6(1)" /* execute lctl */ \
|
|
: "=m" (__dummy) \
|
|
: "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
|
|
"a" (cr*17), "a" (1L<<(bit)) \
|
|
: "cc", "0", "1" ); \
|
|
})
|
|
|
|
#define __ctl_clear_bit(cr, bit) ({ \
|
|
__u8 __dummy[16]; \
|
|
__asm__ __volatile__ ( \
|
|
" bras 1,0f\n" /* skip indirect insns */ \
|
|
" stctg 0,0,0(%1)\n" \
|
|
" lctlg 0,0,0(%1)\n" \
|
|
"0: ex %2,0(1)\n" /* execute stctl */ \
|
|
" lg 0,0(%1)\n" \
|
|
" ngr 0,%3\n" /* set the bit */ \
|
|
" stg 0,0(%1)\n" \
|
|
"1: ex %2,6(1)" /* execute lctl */ \
|
|
: "=m" (__dummy) \
|
|
: "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
|
|
"a" (cr*17), "a" (~(1L<<(bit))) \
|
|
: "cc", "0", "1" ); \
|
|
})
|
|
|
|
#else /* __s390x__ */
|
|
|
|
#define __ctl_load(array, low, high) ({ \
|
|
typedef struct { char _[sizeof(array)]; } addrtype; \
|
|
__asm__ __volatile__ ( \
|
|
" bras 1,0f\n" \
|
|
" lctl 0,0,0(%0)\n" \
|
|
"0: ex %1,0(1)" \
|
|
: : "a" (&array), "a" (((low)<<4)+(high)), \
|
|
"m" (*(addrtype *)(array)) : "1" ); \
|
|
})
|
|
|
|
#define __ctl_store(array, low, high) ({ \
|
|
typedef struct { char _[sizeof(array)]; } addrtype; \
|
|
__asm__ __volatile__ ( \
|
|
" bras 1,0f\n" \
|
|
" stctl 0,0,0(%1)\n" \
|
|
"0: ex %2,0(1)" \
|
|
: "=m" (*(addrtype *)(array)) \
|
|
: "a" (&array), "a" (((low)<<4)+(high)): "1" ); \
|
|
})
|
|
|
|
#define __ctl_set_bit(cr, bit) ({ \
|
|
__u8 __dummy[16]; \
|
|
__asm__ __volatile__ ( \
|
|
" bras 1,0f\n" /* skip indirect insns */ \
|
|
" stctl 0,0,0(%1)\n" \
|
|
" lctl 0,0,0(%1)\n" \
|
|
"0: ex %2,0(1)\n" /* execute stctl */ \
|
|
" l 0,0(%1)\n" \
|
|
" or 0,%3\n" /* set the bit */ \
|
|
" st 0,0(%1)\n" \
|
|
"1: ex %2,4(1)" /* execute lctl */ \
|
|
: "=m" (__dummy) \
|
|
: "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
|
|
"a" (cr*17), "a" (1<<(bit)) \
|
|
: "cc", "0", "1" ); \
|
|
})
|
|
|
|
#define __ctl_clear_bit(cr, bit) ({ \
|
|
__u8 __dummy[16]; \
|
|
__asm__ __volatile__ ( \
|
|
" bras 1,0f\n" /* skip indirect insns */ \
|
|
" stctl 0,0,0(%1)\n" \
|
|
" lctl 0,0,0(%1)\n" \
|
|
"0: ex %2,0(1)\n" /* execute stctl */ \
|
|
" l 0,0(%1)\n" \
|
|
" nr 0,%3\n" /* set the bit */ \
|
|
" st 0,0(%1)\n" \
|
|
"1: ex %2,4(1)" /* execute lctl */ \
|
|
: "=m" (__dummy) \
|
|
: "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
|
|
"a" (cr*17), "a" (~(1<<(bit))) \
|
|
: "cc", "0", "1" ); \
|
|
})
|
|
#endif /* __s390x__ */
|
|
|
|
/* For spinlocks etc */
|
|
#define local_irq_save(x) ((x) = local_irq_disable())
|
|
|
|
/*
|
|
* Use to set psw mask except for the first byte which
|
|
* won't be changed by this function.
|
|
*/
|
|
static inline void
|
|
__set_psw_mask(unsigned long mask)
|
|
{
|
|
local_save_flags(mask);
|
|
__load_psw_mask(mask);
|
|
}
|
|
|
|
#define local_mcck_enable() __set_psw_mask(PSW_KERNEL_BITS)
|
|
#define local_mcck_disable() __set_psw_mask(PSW_KERNEL_BITS & ~PSW_MASK_MCHECK)
|
|
|
|
#ifdef CONFIG_SMP
|
|
|
|
extern void smp_ctl_set_bit(int cr, int bit);
|
|
extern void smp_ctl_clear_bit(int cr, int bit);
|
|
#define ctl_set_bit(cr, bit) smp_ctl_set_bit(cr, bit)
|
|
#define ctl_clear_bit(cr, bit) smp_ctl_clear_bit(cr, bit)
|
|
|
|
#else
|
|
|
|
#define ctl_set_bit(cr, bit) __ctl_set_bit(cr, bit)
|
|
#define ctl_clear_bit(cr, bit) __ctl_clear_bit(cr, bit)
|
|
|
|
#endif /* CONFIG_SMP */
|
|
|
|
extern void (*_machine_restart)(char *command);
|
|
extern void (*_machine_halt)(void);
|
|
extern void (*_machine_power_off)(void);
|
|
|
|
#define arch_align_stack(x) (x)
|
|
|
|
#endif /* __KERNEL__ */
|
|
|
|
#endif
|
|
|