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/kernel.h>
  15 #include <asm/types.h>
  16 #include <asm/ptrace.h>
  17 #include <asm/setup.h>
  18 #include <asm/processor.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 /*
 107  * On SMP systems, when the scheduler does migration-cost autodetection,
 108  * it needs a way to flush as much of the CPU's caches as possible.
 109  *
 110  * TODO: fill this in!
 111  */
 112 static inline void sched_cacheflush(void)
 113 {
 114 }
 115
 116 #ifdef CONFIG_VIRT_CPU_ACCOUNTING
 117 extern void account_vtime(struct task_struct *);
 118 extern void account_tick_vtime(struct task_struct *);
 119 extern void account_system_vtime(struct task_struct *);
 120 #else
 121 #define account_vtime(x) do { /* empty */ } while (0)
 122 #endif
 123
 124 #define finish_arch_switch(prev) do {                                        \
 125         set_fs(current->thread.mm_segment);                                  \
 126         account_vtime(prev);                                                 \
 127 } while (0)
 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 __ctl_load(array, low, high) ({ \
 335         typedef struct { char _[sizeof(array)]; } addrtype; \
 336         __asm__ __volatile__ ( \
 337                 "   bras  1,0f\n" \
 338                 "   lctlg 0,0,0(%0)\n" \
 339                 "0: ex    %1,0(1)" \
 340                 : : "a" (&array), "a" (((low)<<4)+(high)), \
 341                     "m" (*(addrtype *)(array)) : "1" ); \
 342         })
 343
 344 #define __ctl_store(array, low, high) ({ \
 345         typedef struct { char _[sizeof(array)]; } addrtype; \
 346         __asm__ __volatile__ ( \
 347                 "   bras  1,0f\n" \
 348                 "   stctg 0,0,0(%1)\n" \
 349                 "0: ex    %2,0(1)" \
 350                 : "=m" (*(addrtype *)(array)) \
 351                 : "a" (&array), "a" (((low)<<4)+(high)) : "1" ); \
 352         })
 353
 354 #define __ctl_set_bit(cr, bit) ({ \
 355         __u8 __dummy[24]; \
 356         __asm__ __volatile__ ( \
 357                 "    bras  1,0f\n"       /* skip indirect insns */ \
 358                 "    stctg 0,0,0(%1)\n" \
 359                 "    lctlg 0,0,0(%1)\n" \
 360                 "0:  ex    %2,0(1)\n"    /* execute stctl */ \
 361                 "    lg    0,0(%1)\n" \
 362                 "    ogr   0,%3\n"       /* set the bit */ \
 363                 "    stg   0,0(%1)\n" \
 364                 "1:  ex    %2,6(1)"      /* execute lctl */ \
 365                 : "=m" (__dummy) \
 366                 : "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
 367                   "a" (cr*17), "a" (1L<<(bit)) \
 368                 : "cc", "0", "1" ); \
 369         })
 370
 371 #define __ctl_clear_bit(cr, bit) ({ \
 372         __u8 __dummy[16]; \
 373         __asm__ __volatile__ ( \
 374                 "    bras  1,0f\n"       /* skip indirect insns */ \
 375                 "    stctg 0,0,0(%1)\n" \
 376                 "    lctlg 0,0,0(%1)\n" \
 377                 "0:  ex    %2,0(1)\n"    /* execute stctl */ \
 378                 "    lg    0,0(%1)\n" \
 379                 "    ngr   0,%3\n"       /* set the bit */ \
 380                 "    stg   0,0(%1)\n" \
 381                 "1:  ex    %2,6(1)"      /* execute lctl */ \
 382                 : "=m" (__dummy) \
 383                 : "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
 384                   "a" (cr*17), "a" (~(1L<<(bit))) \
 385                 : "cc", "0", "1" ); \
 386         })
 387
 388 #else /* __s390x__ */
 389
 390 #define __ctl_load(array, low, high) ({ \
 391         typedef struct { char _[sizeof(array)]; } addrtype; \
 392         __asm__ __volatile__ ( \
 393                 "   bras  1,0f\n" \
 394                 "   lctl 0,0,0(%0)\n" \
 395                 "0: ex    %1,0(1)" \
 396                 : : "a" (&array), "a" (((low)<<4)+(high)), \
 397                     "m" (*(addrtype *)(array)) : "1" ); \
 398         })
 399
 400 #define __ctl_store(array, low, high) ({ \
 401         typedef struct { char _[sizeof(array)]; } addrtype; \
 402         __asm__ __volatile__ ( \
 403                 "   bras  1,0f\n" \
 404                 "   stctl 0,0,0(%1)\n" \
 405                 "0: ex    %2,0(1)" \
 406                 : "=m" (*(addrtype *)(array)) \
 407                 : "a" (&array), "a" (((low)<<4)+(high)): "1" ); \
 408         })
 409
 410 #define __ctl_set_bit(cr, bit) ({ \
 411         __u8 __dummy[16]; \
 412         __asm__ __volatile__ ( \
 413                 "    bras  1,0f\n"       /* skip indirect insns */ \
 414                 "    stctl 0,0,0(%1)\n" \
 415                 "    lctl  0,0,0(%1)\n" \
 416                 "0:  ex    %2,0(1)\n"    /* execute stctl */ \
 417                 "    l     0,0(%1)\n" \
 418                 "    or    0,%3\n"       /* set the bit */ \
 419                 "    st    0,0(%1)\n" \
 420                 "1:  ex    %2,4(1)"      /* execute lctl */ \
 421                 : "=m" (__dummy) \
 422                 : "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
 423                   "a" (cr*17), "a" (1<<(bit)) \
 424                 : "cc", "0", "1" ); \
 425         })
 426
 427 #define __ctl_clear_bit(cr, bit) ({ \
 428         __u8 __dummy[16]; \
 429         __asm__ __volatile__ ( \
 430                 "    bras  1,0f\n"       /* skip indirect insns */ \
 431                 "    stctl 0,0,0(%1)\n" \
 432                 "    lctl  0,0,0(%1)\n" \
 433                 "0:  ex    %2,0(1)\n"    /* execute stctl */ \
 434                 "    l     0,0(%1)\n" \
 435                 "    nr    0,%3\n"       /* set the bit */ \
 436                 "    st    0,0(%1)\n" \
 437                 "1:  ex    %2,4(1)"      /* execute lctl */ \
 438                 : "=m" (__dummy) \
 439                 : "a" ((((unsigned long) &__dummy) + 7) & ~7UL), \
 440                   "a" (cr*17), "a" (~(1<<(bit))) \
 441                 : "cc", "0", "1" ); \
 442         })
 443 #endif /* __s390x__ */
 444
 445 /* For spinlocks etc */
 446 #define local_irq_save(x)       ((x) = local_irq_disable())
 447
 448 /*
 449  * Use to set psw mask except for the first byte which
 450  * won't be changed by this function.
 451  */
 452 static inline void
 453 __set_psw_mask(unsigned long mask)
 454 {
 455         local_save_flags(mask);
 456         __load_psw_mask(mask);
 457 }
 458
 459 #define local_mcck_enable()  __set_psw_mask(PSW_KERNEL_BITS)
 460 #define local_mcck_disable() __set_psw_mask(PSW_KERNEL_BITS & ~PSW_MASK_MCHECK)
 461
 462 #ifdef CONFIG_SMP
 463
 464 extern void smp_ctl_set_bit(int cr, int bit);
 465 extern void smp_ctl_clear_bit(int cr, int bit);
 466 #define ctl_set_bit(cr, bit) smp_ctl_set_bit(cr, bit)
 467 #define ctl_clear_bit(cr, bit) smp_ctl_clear_bit(cr, bit)
 468
 469 #else
 470
 471 #define ctl_set_bit(cr, bit) __ctl_set_bit(cr, bit)
 472 #define ctl_clear_bit(cr, bit) __ctl_clear_bit(cr, bit)
 473
 474 #endif /* CONFIG_SMP */
 475
 476 extern void (*_machine_restart)(char *command);
 477 extern void (*_machine_halt)(void);
 478 extern void (*_machine_power_off)(void);
 479
 480 #define arch_align_stack(x) (x)
 481
 482 #endif /* __KERNEL__ */
 483
 484 #endif
 485