2 * Copyright IBM Corp. 1999, 2009
4 * Author(s): Martin Schwidefsky <schwidefsky@de.ibm.com>
10 #include <linux/kernel.h>
11 #include <linux/errno.h>
12 #include <asm/types.h>
13 #include <asm/ptrace.h>
14 #include <asm/setup.h>
15 #include <asm/processor.h>
16 #include <asm/lowcore.h>
22 extern struct task_struct
*__switch_to(void *, void *);
24 static inline void save_fp_regs(s390_fp_regs
*fpregs
)
31 : "=m" (*fpregs
) : "a" (fpregs
), "m" (*fpregs
) : "memory");
32 if (!MACHINE_HAS_IEEE
)
48 : "=m" (*fpregs
) : "a" (fpregs
), "m" (*fpregs
) : "memory");
51 static inline void restore_fp_regs(s390_fp_regs
*fpregs
)
58 : : "a" (fpregs
), "m" (*fpregs
));
59 if (!MACHINE_HAS_IEEE
)
75 : : "a" (fpregs
), "m" (*fpregs
));
78 static inline void save_access_regs(unsigned int *acrs
)
80 asm volatile("stam 0,15,0(%0)" : : "a" (acrs
) : "memory");
83 static inline void restore_access_regs(unsigned int *acrs
)
85 asm volatile("lam 0,15,0(%0)" : : "a" (acrs
));
88 #define switch_to(prev,next,last) do { \
91 save_fp_regs(&prev->thread.fp_regs); \
92 restore_fp_regs(&next->thread.fp_regs); \
93 save_access_regs(&prev->thread.acrs[0]); \
94 restore_access_regs(&next->thread.acrs[0]); \
95 prev = __switch_to(prev,next); \
98 extern void account_vtime(struct task_struct
*, struct task_struct
*);
99 extern void account_tick_vtime(struct task_struct
*);
102 extern void pfault_irq_init(void);
103 extern int pfault_init(void);
104 extern void pfault_fini(void);
105 #else /* CONFIG_PFAULT */
106 #define pfault_irq_init() do { } while (0)
107 #define pfault_init() ({-1;})
108 #define pfault_fini() do { } while (0)
109 #endif /* CONFIG_PFAULT */
111 extern void cmma_init(void);
113 #define finish_arch_switch(prev) do { \
114 set_fs(current->thread.mm_segment); \
115 account_vtime(prev, current); \
118 #define nop() asm volatile("nop")
120 #define xchg(ptr,x) \
122 __typeof__(*(ptr)) __ret; \
123 __ret = (__typeof__(*(ptr))) \
124 __xchg((unsigned long)(x), (void *)(ptr),sizeof(*(ptr))); \
128 extern void __xchg_called_with_bad_pointer(void);
130 static inline unsigned long __xchg(unsigned long x
, void * ptr
, int size
)
132 unsigned long addr
, old
;
137 addr
= (unsigned long) ptr
;
138 shift
= (3 ^ (addr
& 3)) << 3;
147 : "=&d" (old
), "=m" (*(int *) addr
)
148 : "d" (x
<< shift
), "d" (~(255 << shift
)), "a" (addr
),
149 "m" (*(int *) addr
) : "memory", "cc", "0");
152 addr
= (unsigned long) ptr
;
153 shift
= (2 ^ (addr
& 2)) << 3;
162 : "=&d" (old
), "=m" (*(int *) addr
)
163 : "d" (x
<< shift
), "d" (~(65535 << shift
)), "a" (addr
),
164 "m" (*(int *) addr
) : "memory", "cc", "0");
169 "0: cs %0,%2,0(%3)\n"
171 : "=&d" (old
), "=m" (*(int *) ptr
)
172 : "d" (x
), "a" (ptr
), "m" (*(int *) ptr
)
179 "0: csg %0,%2,0(%3)\n"
181 : "=&d" (old
), "=m" (*(long *) ptr
)
182 : "d" (x
), "a" (ptr
), "m" (*(long *) ptr
)
185 #endif /* __s390x__ */
187 __xchg_called_with_bad_pointer();
192 * Atomic compare and exchange. Compare OLD with MEM, if identical,
193 * store NEW in MEM. Return the initial value in MEM. Success is
194 * indicated by comparing RETURN with OLD.
197 #define __HAVE_ARCH_CMPXCHG 1
199 #define cmpxchg(ptr, o, n) \
200 ((__typeof__(*(ptr)))__cmpxchg((ptr), (unsigned long)(o), \
201 (unsigned long)(n), sizeof(*(ptr))))
203 extern void __cmpxchg_called_with_bad_pointer(void);
205 static inline unsigned long
206 __cmpxchg(volatile void *ptr
, unsigned long old
, unsigned long new, int size
)
208 unsigned long addr
, prev
, tmp
;
213 addr
= (unsigned long) ptr
;
214 shift
= (3 ^ (addr
& 3)) << 3;
228 : "=&d" (prev
), "=&d" (tmp
)
229 : "d" (old
<< shift
), "d" (new << shift
), "a" (ptr
),
230 "d" (~(255 << shift
))
232 return prev
>> shift
;
234 addr
= (unsigned long) ptr
;
235 shift
= (2 ^ (addr
& 2)) << 3;
249 : "=&d" (prev
), "=&d" (tmp
)
250 : "d" (old
<< shift
), "d" (new << shift
), "a" (ptr
),
251 "d" (~(65535 << shift
))
253 return prev
>> shift
;
257 : "=&d" (prev
) : "0" (old
), "d" (new), "a" (ptr
)
264 : "=&d" (prev
) : "0" (old
), "d" (new), "a" (ptr
)
267 #endif /* __s390x__ */
269 __cmpxchg_called_with_bad_pointer();
274 * Force strict CPU ordering.
275 * And yes, this is required on UP too when we're talking
278 * This is very similar to the ppc eieio/sync instruction in that is
279 * does a checkpoint syncronisation & makes sure that
280 * all memory ops have completed wrt other CPU's ( see 7-15 POP DJB ).
283 #define eieio() asm volatile("bcr 15,0" : : : "memory")
284 #define SYNC_OTHER_CORES(x) eieio()
286 #define rmb() eieio()
287 #define wmb() eieio()
288 #define read_barrier_depends() do { } while(0)
289 #define smp_mb() mb()
290 #define smp_rmb() rmb()
291 #define smp_wmb() wmb()
292 #define smp_read_barrier_depends() read_barrier_depends()
293 #define smp_mb__before_clear_bit() smp_mb()
294 #define smp_mb__after_clear_bit() smp_mb()
297 #define set_mb(var, value) do { var = value; mb(); } while (0)
301 #define __ctl_load(array, low, high) ({ \
302 typedef struct { char _[sizeof(array)]; } addrtype; \
304 " lctlg %1,%2,0(%0)\n" \
305 : : "a" (&array), "i" (low), "i" (high), \
306 "m" (*(addrtype *)(&array))); \
309 #define __ctl_store(array, low, high) ({ \
310 typedef struct { char _[sizeof(array)]; } addrtype; \
312 " stctg %2,%3,0(%1)\n" \
313 : "=m" (*(addrtype *)(&array)) \
314 : "a" (&array), "i" (low), "i" (high)); \
317 #else /* __s390x__ */
319 #define __ctl_load(array, low, high) ({ \
320 typedef struct { char _[sizeof(array)]; } addrtype; \
322 " lctl %1,%2,0(%0)\n" \
323 : : "a" (&array), "i" (low), "i" (high), \
324 "m" (*(addrtype *)(&array))); \
327 #define __ctl_store(array, low, high) ({ \
328 typedef struct { char _[sizeof(array)]; } addrtype; \
330 " stctl %2,%3,0(%1)\n" \
331 : "=m" (*(addrtype *)(&array)) \
332 : "a" (&array), "i" (low), "i" (high)); \
335 #endif /* __s390x__ */
337 #define __ctl_set_bit(cr, bit) ({ \
338 unsigned long __dummy; \
339 __ctl_store(__dummy, cr, cr); \
340 __dummy |= 1UL << (bit); \
341 __ctl_load(__dummy, cr, cr); \
344 #define __ctl_clear_bit(cr, bit) ({ \
345 unsigned long __dummy; \
346 __ctl_store(__dummy, cr, cr); \
347 __dummy &= ~(1UL << (bit)); \
348 __ctl_load(__dummy, cr, cr); \
351 #include <linux/irqflags.h>
353 #include <asm-generic/cmpxchg-local.h>
355 static inline unsigned long __cmpxchg_local(volatile void *ptr
,
357 unsigned long new, int size
)
366 return __cmpxchg(ptr
, old
, new, size
);
368 return __cmpxchg_local_generic(ptr
, old
, new, size
);
375 * cmpxchg_local and cmpxchg64_local are atomic wrt current CPU. Always make
378 #define cmpxchg_local(ptr, o, n) \
379 ((__typeof__(*(ptr)))__cmpxchg_local((ptr), (unsigned long)(o), \
380 (unsigned long)(n), sizeof(*(ptr))))
382 #define cmpxchg64_local(ptr, o, n) \
384 BUILD_BUG_ON(sizeof(*(ptr)) != 8); \
385 cmpxchg_local((ptr), (o), (n)); \
388 #define cmpxchg64_local(ptr, o, n) __cmpxchg64_local_generic((ptr), (o), (n))
392 * Use to set psw mask except for the first byte which
393 * won't be changed by this function.
396 __set_psw_mask(unsigned long mask
)
398 __load_psw_mask(mask
| (__raw_local_irq_stosm(0x00) & ~(-1UL >> 8)));
401 #define local_mcck_enable() __set_psw_mask(psw_kernel_bits)
402 #define local_mcck_disable() __set_psw_mask(psw_kernel_bits & ~PSW_MASK_MCHECK)
406 extern void smp_ctl_set_bit(int cr
, int bit
);
407 extern void smp_ctl_clear_bit(int cr
, int bit
);
408 #define ctl_set_bit(cr, bit) smp_ctl_set_bit(cr, bit)
409 #define ctl_clear_bit(cr, bit) smp_ctl_clear_bit(cr, bit)
413 #define ctl_set_bit(cr, bit) __ctl_set_bit(cr, bit)
414 #define ctl_clear_bit(cr, bit) __ctl_clear_bit(cr, bit)
416 #endif /* CONFIG_SMP */
418 static inline unsigned int stfl(void)
421 " .insn s,0xb2b10000,0(0)\n" /* stfl */
424 return S390_lowcore
.stfl_fac_list
;
427 static inline int __stfle(unsigned long long *list
, int doublewords
)
429 typedef struct { unsigned long long _
[doublewords
]; } addrtype
;
430 register unsigned long __nr
asm("0") = doublewords
- 1;
432 asm volatile(".insn s,0xb2b00000,%0" /* stfle */
433 : "=m" (*(addrtype
*) list
), "+d" (__nr
) : : "cc");
437 static inline int stfle(unsigned long long *list
, int doublewords
)
439 if (!(stfl() & (1UL << 24)))
441 return __stfle(list
, doublewords
);
444 static inline unsigned short stap(void)
446 unsigned short cpu_address
;
448 asm volatile("stap %0" : "=m" (cpu_address
));
452 extern void (*_machine_restart
)(char *command
);
453 extern void (*_machine_halt
)(void);
454 extern void (*_machine_power_off
)(void);
456 #define arch_align_stack(x) (x)
458 #ifdef CONFIG_TRACE_IRQFLAGS
459 extern psw_t sysc_restore_trace_psw
;
460 extern psw_t io_restore_trace_psw
;
463 static inline int tprot(unsigned long addr
)
473 : "+d" (rc
) : "a" (addr
) : "cc");
477 #endif /* __KERNEL__ */