81514d76edcf3d1d498cfc5e53dfa14803c24fd3
[firefly-linux-kernel-4.4.55.git] / include / asm-s390 / system.h
1 /*
2  *  include/asm-s390/system.h
3  *
4  *  S390 version
5  *    Copyright (C) 1999 IBM Deutschland Entwicklung GmbH, IBM Corporation
6  *    Author(s): Martin Schwidefsky (schwidefsky@de.ibm.com),
7  *
8  *  Derived from "include/asm-i386/system.h"
9  */
10
11 #ifndef __ASM_SYSTEM_H
12 #define __ASM_SYSTEM_H
13
14 #include <linux/config.h>
15 #include <linux/kernel.h>
16 #include <asm/types.h>
17 #include <asm/ptrace.h>
18 #include <asm/setup.h>
19
20 #ifdef __KERNEL__
21
22 struct task_struct;
23
24 extern struct task_struct *__switch_to(void *, void *);
25
26 #ifdef __s390x__
27 #define __FLAG_SHIFT 56
28 #else /* ! __s390x__ */
29 #define __FLAG_SHIFT 24
30 #endif /* ! __s390x__ */
31
32 static inline void save_fp_regs(s390_fp_regs *fpregs)
33 {
34         asm volatile (
35                 "   std   0,8(%1)\n"
36                 "   std   2,24(%1)\n"
37                 "   std   4,40(%1)\n"
38                 "   std   6,56(%1)"
39                 : "=m" (*fpregs) : "a" (fpregs), "m" (*fpregs) : "memory" );
40         if (!MACHINE_HAS_IEEE)
41                 return;
42         asm volatile(
43                 "   stfpc 0(%1)\n"
44                 "   std   1,16(%1)\n"
45                 "   std   3,32(%1)\n"
46                 "   std   5,48(%1)\n"
47                 "   std   7,64(%1)\n"
48                 "   std   8,72(%1)\n"
49                 "   std   9,80(%1)\n"
50                 "   std   10,88(%1)\n"
51                 "   std   11,96(%1)\n"
52                 "   std   12,104(%1)\n"
53                 "   std   13,112(%1)\n"
54                 "   std   14,120(%1)\n"
55                 "   std   15,128(%1)\n"
56                 : "=m" (*fpregs) : "a" (fpregs), "m" (*fpregs) : "memory" );
57 }
58
59 static inline void restore_fp_regs(s390_fp_regs *fpregs)
60 {
61         asm volatile (
62                 "   ld    0,8(%0)\n"
63                 "   ld    2,24(%0)\n"
64                 "   ld    4,40(%0)\n"
65                 "   ld    6,56(%0)"
66                 : : "a" (fpregs), "m" (*fpregs) );
67         if (!MACHINE_HAS_IEEE)
68                 return;
69         asm volatile(
70                 "   lfpc  0(%0)\n"
71                 "   ld    1,16(%0)\n"
72                 "   ld    3,32(%0)\n"
73                 "   ld    5,48(%0)\n"
74                 "   ld    7,64(%0)\n"
75                 "   ld    8,72(%0)\n"
76                 "   ld    9,80(%0)\n"
77                 "   ld    10,88(%0)\n"
78                 "   ld    11,96(%0)\n"
79                 "   ld    12,104(%0)\n"
80                 "   ld    13,112(%0)\n"
81                 "   ld    14,120(%0)\n"
82                 "   ld    15,128(%0)\n"
83                 : : "a" (fpregs), "m" (*fpregs) );
84 }
85
86 static inline void save_access_regs(unsigned int *acrs)
87 {
88         asm volatile ("stam 0,15,0(%0)" : : "a" (acrs) : "memory" );
89 }
90
91 static inline void restore_access_regs(unsigned int *acrs)
92 {
93         asm volatile ("lam 0,15,0(%0)" : : "a" (acrs) );
94 }
95
96 #define switch_to(prev,next,last) do {                                       \
97         if (prev == next)                                                    \
98                 break;                                                       \
99         save_fp_regs(&prev->thread.fp_regs);                                 \
100         restore_fp_regs(&next->thread.fp_regs);                              \
101         save_access_regs(&prev->thread.acrs[0]);                             \
102         restore_access_regs(&next->thread.acrs[0]);                          \
103         prev = __switch_to(prev,next);                                       \
104 } while (0)
105
106 #define prepare_arch_switch(rq, next)   do { } while(0)
107 #define task_running(rq, p)             ((rq)->curr == (p))
108
109 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
110 extern void account_user_vtime(struct task_struct *);
111 extern void account_system_vtime(struct task_struct *);
112
113 #define finish_arch_switch(rq, prev) do {                                    \
114         set_fs(current->thread.mm_segment);                                  \
115         spin_unlock(&(rq)->lock);                                            \
116         account_system_vtime(prev);                                          \
117         local_irq_enable();                                                  \
118 } while (0)
119
120 #else
121
122 #define finish_arch_switch(rq, prev) do {                                    \
123         set_fs(current->thread.mm_segment);                                  \
124         spin_unlock_irq(&(rq)->lock);                                        \
125 } while (0)
126
127 #endif
128
129 #define nop() __asm__ __volatile__ ("nop")
130
131 #define xchg(ptr,x) \
132   ((__typeof__(*(ptr)))__xchg((unsigned long)(x),(void *)(ptr),sizeof(*(ptr))))
133
134 static inline unsigned long __xchg(unsigned long x, void * ptr, int size)
135 {
136         unsigned long addr, old;
137         int shift;
138
139         switch (size) {
140         case 1:
141                 addr = (unsigned long) ptr;
142                 shift = (3 ^ (addr & 3)) << 3;
143                 addr ^= addr & 3;
144                 asm volatile(
145                         "    l   %0,0(%4)\n"
146                         "0:  lr  0,%0\n"
147                         "    nr  0,%3\n"
148                         "    or  0,%2\n"
149                         "    cs  %0,0,0(%4)\n"
150                         "    jl  0b\n"
151                         : "=&d" (old), "=m" (*(int *) addr)
152                         : "d" (x << shift), "d" (~(255 << shift)), "a" (addr),
153                           "m" (*(int *) addr) : "memory", "cc", "0" );
154                 x = old >> shift;
155                 break;
156         case 2:
157                 addr = (unsigned long) ptr;
158                 shift = (2 ^ (addr & 2)) << 3;
159                 addr ^= addr & 2;
160                 asm volatile(
161                         "    l   %0,0(%4)\n"
162                         "0:  lr  0,%0\n"
163                         "    nr  0,%3\n"
164                         "    or  0,%2\n"
165                         "    cs  %0,0,0(%4)\n"
166                         "    jl  0b\n"
167                         : "=&d" (old), "=m" (*(int *) addr)
168                         : "d" (x << shift), "d" (~(65535 << shift)), "a" (addr),
169                           "m" (*(int *) addr) : "memory", "cc", "0" );
170                 x = old >> shift;
171                 break;
172         case 4:
173                 asm volatile (
174                         "    l   %0,0(%3)\n"
175                         "0:  cs  %0,%2,0(%3)\n"
176                         "    jl  0b\n"
177                         : "=&d" (old), "=m" (*(int *) ptr)
178                         : "d" (x), "a" (ptr), "m" (*(int *) ptr)
179                         : "memory", "cc" );
180                 x = old;
181                 break;
182 #ifdef __s390x__
183         case 8:
184                 asm volatile (
185                         "    lg  %0,0(%3)\n"
186                         "0:  csg %0,%2,0(%3)\n"
187                         "    jl  0b\n"
188                         : "=&d" (old), "=m" (*(long *) ptr)
189                         : "d" (x), "a" (ptr), "m" (*(long *) ptr)
190                         : "memory", "cc" );
191                 x = old;
192                 break;
193 #endif /* __s390x__ */
194         }
195         return x;
196 }
197
198 /*
199  * Atomic compare and exchange.  Compare OLD with MEM, if identical,
200  * store NEW in MEM.  Return the initial value in MEM.  Success is
201  * indicated by comparing RETURN with OLD.
202  */
203
204 #define __HAVE_ARCH_CMPXCHG 1
205
206 #define cmpxchg(ptr,o,n)\
207         ((__typeof__(*(ptr)))__cmpxchg((ptr),(unsigned long)(o),\
208                                         (unsigned long)(n),sizeof(*(ptr))))
209
210 static inline unsigned long
211 __cmpxchg(volatile void *ptr, unsigned long old, unsigned long new, int size)
212 {
213         unsigned long addr, prev, tmp;
214         int shift;
215
216         switch (size) {
217         case 1:
218                 addr = (unsigned long) ptr;
219                 shift = (3 ^ (addr & 3)) << 3;
220                 addr ^= addr & 3;
221                 asm volatile(
222                         "    l   %0,0(%4)\n"
223                         "0:  nr  %0,%5\n"
224                         "    lr  %1,%0\n"
225                         "    or  %0,%2\n"
226                         "    or  %1,%3\n"
227                         "    cs  %0,%1,0(%4)\n"
228                         "    jnl 1f\n"
229                         "    xr  %1,%0\n"
230                         "    nr  %1,%5\n"
231                         "    jnz 0b\n"
232                         "1:"
233                         : "=&d" (prev), "=&d" (tmp)
234                         : "d" (old << shift), "d" (new << shift), "a" (ptr),
235                           "d" (~(255 << shift))
236                         : "memory", "cc" );
237                 return prev >> shift;
238         case 2:
239                 addr = (unsigned long) ptr;
240                 shift = (2 ^ (addr & 2)) << 3;
241                 addr ^= addr & 2;
242                 asm volatile(
243                         "    l   %0,0(%4)\n"
244                         "0:  nr  %0,%5\n"
245                         "    lr  %1,%0\n"
246                         "    or  %0,%2\n"
247                         "    or  %1,%3\n"
248                         "    cs  %0,%1,0(%4)\n"
249                         "    jnl 1f\n"
250                         "    xr  %1,%0\n"
251                         "    nr  %1,%5\n"
252                         "    jnz 0b\n"
253                         "1:"
254                         : "=&d" (prev), "=&d" (tmp)
255                         : "d" (old << shift), "d" (new << shift), "a" (ptr),
256                           "d" (~(65535 << shift))
257                         : "memory", "cc" );
258                 return prev >> shift;
259         case 4:
260                 asm volatile (
261                         "    cs  %0,%2,0(%3)\n"
262                         : "=&d" (prev) : "0" (old), "d" (new), "a" (ptr)
263                         : "memory", "cc" );
264                 return prev;
265 #ifdef __s390x__
266         case 8:
267                 asm volatile (
268                         "    csg %0,%2,0(%3)\n"
269                         : "=&d" (prev) : "0" (old), "d" (new), "a" (ptr)
270                         : "memory", "cc" );
271                 return prev;
272 #endif /* __s390x__ */
273         }
274         return old;
275 }
276
277 /*
278  * Force strict CPU ordering.
279  * And yes, this is required on UP too when we're talking
280  * to devices.
281  *
282  * This is very similar to the ppc eieio/sync instruction in that is
283  * does a checkpoint syncronisation & makes sure that 
284  * all memory ops have completed wrt other CPU's ( see 7-15 POP  DJB ).
285  */
286
287 #define eieio()  __asm__ __volatile__ ( "bcr 15,0" : : : "memory" ) 
288 # define SYNC_OTHER_CORES(x)   eieio() 
289 #define mb()    eieio()
290 #define rmb()   eieio()
291 #define wmb()   eieio()
292 #define read_barrier_depends() do { } while(0)
293 #define smp_mb()       mb()
294 #define smp_rmb()      rmb()
295 #define smp_wmb()      wmb()
296 #define smp_read_barrier_depends()    read_barrier_depends()
297 #define smp_mb__before_clear_bit()     smp_mb()
298 #define smp_mb__after_clear_bit()      smp_mb()
299
300
301 #define set_mb(var, value)      do { var = value; mb(); } while (0)
302 #define set_wmb(var, value)     do { var = value; wmb(); } while (0)
303
304 /* interrupt control.. */
305 #define local_irq_enable() ({ \
306         unsigned long  __dummy; \
307         __asm__ __volatile__ ( \
308                 "stosm 0(%1),0x03" \
309                 : "=m" (__dummy) : "a" (&__dummy) : "memory" ); \
310         })
311
312 #define local_irq_disable() ({ \
313         unsigned long __flags; \
314         __asm__ __volatile__ ( \
315                 "stnsm 0(%1),0xfc" : "=m" (__flags) : "a" (&__flags) ); \
316         __flags; \
317         })
318
319 #define local_save_flags(x) \
320         __asm__ __volatile__("stosm 0(%1),0" : "=m" (x) : "a" (&x), "m" (x) )
321
322 #define local_irq_restore(x) \
323         __asm__ __volatile__("ssm   0(%0)" : : "a" (&x), "m" (x) : "memory")
324
325 #define irqs_disabled()                 \
326 ({                                      \
327         unsigned long flags;            \
328         local_save_flags(flags);        \
329         !((flags >> __FLAG_SHIFT) & 3); \
330 })
331
332 #ifdef __s390x__
333
334 #define __load_psw(psw) \
335         __asm__ __volatile__("lpswe 0(%0)" : : "a" (&psw), "m" (psw) : "cc" );
336
337 #define __ctl_load(array, low, high) ({ \
338         typedef struct { char _[sizeof(array)]; } addrtype; \
339         __asm__ __volatile__ ( \
340                 "   bras  1,0f\n" \
341                 "   lctlg 0,0,0(%0)\n" \
342                 "0: ex    %1,0(1)" \
343                 : : "a" (&array), "a" (((low)<<4)+(high)), \
344                     "m" (*(addrtype *)(array)) : "1" ); \
345         })
346
347 #define __ctl_store(array, low, high) ({ \
348         typedef struct { char _[sizeof(array)]; } addrtype; \
349         __asm__ __volatile__ ( \
350                 "   bras  1,0f\n" \
351                 "   stctg 0,0,0(%1)\n" \
352                 "0: ex    %2,0(1)" \
353                 : "=m" (*(addrtype *)(array)) \
354                 : "a" (&array), "a" (((low)<<4)+(high)) : "1" ); \
355         })
356
357 #define __ctl_set_bit(cr, bit) ({ \
358         __u8 __dummy[24]; \
359         __asm__ __volatile__ ( \
360                 "    bras  1,0f\n"       /* skip indirect insns */ \
361                 "    stctg 0,0,0(%1)\n" \
362                 "    lctlg 0,0,0(%1)\n" \
363                 "0:  ex    %2,0(1)\n"    /* execute stctl */ \
364                 "    lg    0,0(%1)\n" \
365                 "    ogr   0,%3\n"       /* set the bit */ \
366                 "    stg   0,0(%1)\n" \
367                 "1:  ex    %2,6(1)"      /* execute lctl */ \
368                 : "=m" (__dummy) \
369                 : "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
370                   "a" (cr*17), "a" (1L<<(bit)) \
371                 : "cc", "0", "1" ); \
372         })
373
374 #define __ctl_clear_bit(cr, bit) ({ \
375         __u8 __dummy[16]; \
376         __asm__ __volatile__ ( \
377                 "    bras  1,0f\n"       /* skip indirect insns */ \
378                 "    stctg 0,0,0(%1)\n" \
379                 "    lctlg 0,0,0(%1)\n" \
380                 "0:  ex    %2,0(1)\n"    /* execute stctl */ \
381                 "    lg    0,0(%1)\n" \
382                 "    ngr   0,%3\n"       /* set the bit */ \
383                 "    stg   0,0(%1)\n" \
384                 "1:  ex    %2,6(1)"      /* execute lctl */ \
385                 : "=m" (__dummy) \
386                 : "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
387                   "a" (cr*17), "a" (~(1L<<(bit))) \
388                 : "cc", "0", "1" ); \
389         })
390
391 #else /* __s390x__ */
392
393 #define __load_psw(psw) \
394         __asm__ __volatile__("lpsw 0(%0)" : : "a" (&psw) : "cc" );
395
396 #define __ctl_load(array, low, high) ({ \
397         typedef struct { char _[sizeof(array)]; } addrtype; \
398         __asm__ __volatile__ ( \
399                 "   bras  1,0f\n" \
400                 "   lctl 0,0,0(%0)\n" \
401                 "0: ex    %1,0(1)" \
402                 : : "a" (&array), "a" (((low)<<4)+(high)), \
403                     "m" (*(addrtype *)(array)) : "1" ); \
404         })
405
406 #define __ctl_store(array, low, high) ({ \
407         typedef struct { char _[sizeof(array)]; } addrtype; \
408         __asm__ __volatile__ ( \
409                 "   bras  1,0f\n" \
410                 "   stctl 0,0,0(%1)\n" \
411                 "0: ex    %2,0(1)" \
412                 : "=m" (*(addrtype *)(array)) \
413                 : "a" (&array), "a" (((low)<<4)+(high)): "1" ); \
414         })
415
416 #define __ctl_set_bit(cr, bit) ({ \
417         __u8 __dummy[16]; \
418         __asm__ __volatile__ ( \
419                 "    bras  1,0f\n"       /* skip indirect insns */ \
420                 "    stctl 0,0,0(%1)\n" \
421                 "    lctl  0,0,0(%1)\n" \
422                 "0:  ex    %2,0(1)\n"    /* execute stctl */ \
423                 "    l     0,0(%1)\n" \
424                 "    or    0,%3\n"       /* set the bit */ \
425                 "    st    0,0(%1)\n" \
426                 "1:  ex    %2,4(1)"      /* execute lctl */ \
427                 : "=m" (__dummy) \
428                 : "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
429                   "a" (cr*17), "a" (1<<(bit)) \
430                 : "cc", "0", "1" ); \
431         })
432
433 #define __ctl_clear_bit(cr, bit) ({ \
434         __u8 __dummy[16]; \
435         __asm__ __volatile__ ( \
436                 "    bras  1,0f\n"       /* skip indirect insns */ \
437                 "    stctl 0,0,0(%1)\n" \
438                 "    lctl  0,0,0(%1)\n" \
439                 "0:  ex    %2,0(1)\n"    /* execute stctl */ \
440                 "    l     0,0(%1)\n" \
441                 "    nr    0,%3\n"       /* set the bit */ \
442                 "    st    0,0(%1)\n" \
443                 "1:  ex    %2,4(1)"      /* execute lctl */ \
444                 : "=m" (__dummy) \
445                 : "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
446                   "a" (cr*17), "a" (~(1<<(bit))) \
447                 : "cc", "0", "1" ); \
448         })
449 #endif /* __s390x__ */
450
451 /* For spinlocks etc */
452 #define local_irq_save(x)       ((x) = local_irq_disable())
453
454 #ifdef CONFIG_SMP
455
456 extern void smp_ctl_set_bit(int cr, int bit);
457 extern void smp_ctl_clear_bit(int cr, int bit);
458 #define ctl_set_bit(cr, bit) smp_ctl_set_bit(cr, bit)
459 #define ctl_clear_bit(cr, bit) smp_ctl_clear_bit(cr, bit)
460
461 #else
462
463 #define ctl_set_bit(cr, bit) __ctl_set_bit(cr, bit)
464 #define ctl_clear_bit(cr, bit) __ctl_clear_bit(cr, bit)
465
466 #endif /* CONFIG_SMP */
467
468 extern void (*_machine_restart)(char *command);
469 extern void (*_machine_halt)(void);
470 extern void (*_machine_power_off)(void);
471
472 #define arch_align_stack(x) (x)
473
474 #endif /* __KERNEL__ */
475
476 #endif
477