arch/ia64/kernel/mca_asm.S

   1 //
   2 // assembly portion of the IA64 MCA handling
   3 //
   4 // Mods by cfleck to integrate into kernel build
   5 // 00/03/15 davidm Added various stop bits to get a clean compile
   6 //
   7 // 00/03/29 cfleck Added code to save INIT handoff state in pt_regs format, switch to temp
   8 //                 kstack, switch modes, jump to C INIT handler
   9 //
  10 // 02/01/04 J.Hall <jenna.s.hall@intel.com>
  11 //                 Before entering virtual mode code:
  12 //                 1. Check for TLB CPU error
  13 //                 2. Restore current thread pointer to kr6
  14 //                 3. Move stack ptr 16 bytes to conform to C calling convention
  15 //
  16 // 04/11/12 Russ Anderson <rja@sgi.com>
  17 //                 Added per cpu MCA/INIT stack save areas.
  18 //
  19 // 12/08/05 Keith Owens <kaos@sgi.com>
  20 //                 Use per cpu MCA/INIT stacks for all data.
  21 //
  22 #include <linux/config.h>
  23 #include <linux/threads.h>
  24
  25 #include <asm/asmmacro.h>
  26 #include <asm/pgtable.h>
  27 #include <asm/processor.h>
  28 #include <asm/mca_asm.h>
  29 #include <asm/mca.h>
  30
  31 #include "entry.h"
  32
  33 #define GET_IA64_MCA_DATA(reg)                                          \
  34         GET_THIS_PADDR(reg, ia64_mca_data)                              \
  35         ;;                                                              \
  36         ld8 reg=[reg]
  37
  38         .global ia64_do_tlb_purge
  39         .global ia64_os_mca_dispatch
  40         .global ia64_os_init_dispatch_monarch
  41         .global ia64_os_init_dispatch_slave
  42
  43         .text
  44         .align 16
  45
  46 //StartMain////////////////////////////////////////////////////////////////////
  47
  48 /*
  49  * Just the TLB purge part is moved to a separate function
  50  * so we can re-use the code for cpu hotplug code as well
  51  * Caller should now setup b1, so we can branch once the
  52  * tlb flush is complete.
  53  */
  54
  55 ia64_do_tlb_purge:
  56 #define O(member)       IA64_CPUINFO_##member##_OFFSET
  57
  58         GET_THIS_PADDR(r2, cpu_info)    // load phys addr of cpu_info into r2
  59         ;;
  60         addl r17=O(PTCE_STRIDE),r2
  61         addl r2=O(PTCE_BASE),r2
  62         ;;
  63         ld8 r18=[r2],(O(PTCE_COUNT)-O(PTCE_BASE));;     // r18=ptce_base
  64         ld4 r19=[r2],4                                  // r19=ptce_count[0]
  65         ld4 r21=[r17],4                                 // r21=ptce_stride[0]
  66         ;;
  67         ld4 r20=[r2]                                    // r20=ptce_count[1]
  68         ld4 r22=[r17]                                   // r22=ptce_stride[1]
  69         mov r24=0
  70         ;;
  71         adds r20=-1,r20
  72         ;;
  73 #undef O
  74
  75 2:
  76         cmp.ltu p6,p7=r24,r19
  77 (p7)    br.cond.dpnt.few 4f
  78         mov ar.lc=r20
  79 3:
  80         ptc.e r18
  81         ;;
  82         add r18=r22,r18
  83         br.cloop.sptk.few 3b
  84         ;;
  85         add r18=r21,r18
  86         add r24=1,r24
  87         ;;
  88         br.sptk.few 2b
  89 4:
  90         srlz.i                  // srlz.i implies srlz.d
  91         ;;
  92
  93         // Now purge addresses formerly mapped by TR registers
  94         // 1. Purge ITR&DTR for kernel.
  95         movl r16=KERNEL_START
  96         mov r18=KERNEL_TR_PAGE_SHIFT<<2
  97         ;;
  98         ptr.i r16, r18
  99         ptr.d r16, r18
 100         ;;
 101         srlz.i
 102         ;;
 103         srlz.d
 104         ;;
 105         // 2. Purge DTR for PERCPU data.
 106         movl r16=PERCPU_ADDR
 107         mov r18=PERCPU_PAGE_SHIFT<<2
 108         ;;
 109         ptr.d r16,r18
 110         ;;
 111         srlz.d
 112         ;;
 113         // 3. Purge ITR for PAL code.
 114         GET_THIS_PADDR(r2, ia64_mca_pal_base)
 115         ;;
 116         ld8 r16=[r2]
 117         mov r18=IA64_GRANULE_SHIFT<<2
 118         ;;
 119         ptr.i r16,r18
 120         ;;
 121         srlz.i
 122         ;;
 123         // 4. Purge DTR for stack.
 124         mov r16=IA64_KR(CURRENT_STACK)
 125         ;;
 126         shl r16=r16,IA64_GRANULE_SHIFT
 127         movl r19=PAGE_OFFSET
 128         ;;
 129         add r16=r19,r16
 130         mov r18=IA64_GRANULE_SHIFT<<2
 131         ;;
 132         ptr.d r16,r18
 133         ;;
 134         srlz.i
 135         ;;
 136         // Now branch away to caller.
 137         br.sptk.many b1
 138         ;;
 139
 140 //EndMain//////////////////////////////////////////////////////////////////////
 141
 142 //StartMain////////////////////////////////////////////////////////////////////
 143
 144 ia64_os_mca_dispatch:
 145         // Serialize all MCA processing
 146         mov     r3=1;;
 147         LOAD_PHYSICAL(p0,r2,ia64_mca_serialize);;
 148 ia64_os_mca_spin:
 149         xchg4   r4=[r2],r3;;
 150         cmp.ne  p6,p0=r4,r0
 151 (p6)    br ia64_os_mca_spin
 152
 153         mov r3=IA64_MCA_CPU_MCA_STACK_OFFSET    // use the MCA stack
 154         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 155         mov r19=1                               // All MCA events are treated as monarch (for now)
 156         br.sptk ia64_state_save                 // save the state that is not in minstate
 157 1:
 158
 159         GET_IA64_MCA_DATA(r2)
 160         // Using MCA stack, struct ia64_sal_os_state, variable proc_state_param
 161         ;;
 162         add r3=IA64_MCA_CPU_MCA_STACK_OFFSET+MCA_SOS_OFFSET+SOS(PROC_STATE_PARAM), r2
 163         ;;
 164         ld8 r18=[r3]                            // Get processor state parameter on existing PALE_CHECK.
 165         ;;
 166         tbit.nz p6,p7=r18,60
 167 (p7)    br.spnt done_tlb_purge_and_reload
 168
 169         // The following code purges TC and TR entries. Then reload all TC entries.
 170         // Purge percpu data TC entries.
 171 begin_tlb_purge_and_reload:
 172         movl r18=ia64_reload_tr;;
 173         LOAD_PHYSICAL(p0,r18,ia64_reload_tr);;
 174         mov b1=r18;;
 175         br.sptk.many ia64_do_tlb_purge;;
 176
 177 ia64_reload_tr:
 178         // Finally reload the TR registers.
 179         // 1. Reload DTR/ITR registers for kernel.
 180         mov r18=KERNEL_TR_PAGE_SHIFT<<2
 181         movl r17=KERNEL_START
 182         ;;
 183         mov cr.itir=r18
 184         mov cr.ifa=r17
 185         mov r16=IA64_TR_KERNEL
 186         mov r19=ip
 187         movl r18=PAGE_KERNEL
 188         ;;
 189         dep r17=0,r19,0, KERNEL_TR_PAGE_SHIFT
 190         ;;
 191         or r18=r17,r18
 192         ;;
 193         itr.i itr[r16]=r18
 194         ;;
 195         itr.d dtr[r16]=r18
 196         ;;
 197         srlz.i
 198         srlz.d
 199         ;;
 200         // 2. Reload DTR register for PERCPU data.
 201         GET_THIS_PADDR(r2, ia64_mca_per_cpu_pte)
 202         ;;
 203         movl r16=PERCPU_ADDR            // vaddr
 204         movl r18=PERCPU_PAGE_SHIFT<<2
 205         ;;
 206         mov cr.itir=r18
 207         mov cr.ifa=r16
 208         ;;
 209         ld8 r18=[r2]                    // load per-CPU PTE
 210         mov r16=IA64_TR_PERCPU_DATA;
 211         ;;
 212         itr.d dtr[r16]=r18
 213         ;;
 214         srlz.d
 215         ;;
 216         // 3. Reload ITR for PAL code.
 217         GET_THIS_PADDR(r2, ia64_mca_pal_pte)
 218         ;;
 219         ld8 r18=[r2]                    // load PAL PTE
 220         ;;
 221         GET_THIS_PADDR(r2, ia64_mca_pal_base)
 222         ;;
 223         ld8 r16=[r2]                    // load PAL vaddr
 224         mov r19=IA64_GRANULE_SHIFT<<2
 225         ;;
 226         mov cr.itir=r19
 227         mov cr.ifa=r16
 228         mov r20=IA64_TR_PALCODE
 229         ;;
 230         itr.i itr[r20]=r18
 231         ;;
 232         srlz.i
 233         ;;
 234         // 4. Reload DTR for stack.
 235         mov r16=IA64_KR(CURRENT_STACK)
 236         ;;
 237         shl r16=r16,IA64_GRANULE_SHIFT
 238         movl r19=PAGE_OFFSET
 239         ;;
 240         add r18=r19,r16
 241         movl r20=PAGE_KERNEL
 242         ;;
 243         add r16=r20,r16
 244         mov r19=IA64_GRANULE_SHIFT<<2
 245         ;;
 246         mov cr.itir=r19
 247         mov cr.ifa=r18
 248         mov r20=IA64_TR_CURRENT_STACK
 249         ;;
 250         itr.d dtr[r20]=r16
 251         ;;
 252         srlz.d
 253
 254 done_tlb_purge_and_reload:
 255
 256         // switch to per cpu MCA stack
 257         mov r3=IA64_MCA_CPU_MCA_STACK_OFFSET    // use the MCA stack
 258         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 259         br.sptk ia64_new_stack
 260 1:
 261
 262         // everything saved, now we can set the kernel registers
 263         mov r3=IA64_MCA_CPU_MCA_STACK_OFFSET    // use the MCA stack
 264         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 265         br.sptk ia64_set_kernel_registers
 266 1:
 267
 268         // This must be done in physical mode
 269         GET_IA64_MCA_DATA(r2)
 270         ;;
 271         mov r7=r2
 272
 273         // Enter virtual mode from physical mode
 274         VIRTUAL_MODE_ENTER(r2, r3, ia64_os_mca_virtual_begin, r4)
 275
 276         // This code returns to SAL via SOS r2, in general SAL has no unwind
 277         // data.  To get a clean termination when backtracing the C MCA/INIT
 278         // handler, set a dummy return address of 0 in this routine.  That
 279         // requires that ia64_os_mca_virtual_begin be a global function.
 280 ENTRY(ia64_os_mca_virtual_begin)
 281         .prologue
 282         .save rp,r0
 283         .body
 284
 285         mov ar.rsc=3                            // set eager mode for C handler
 286         mov r2=r7                               // see GET_IA64_MCA_DATA above
 287         ;;
 288
 289         // Call virtual mode handler
 290         alloc r14=ar.pfs,0,0,3,0
 291         ;;
 292         DATA_PA_TO_VA(r2,r7)
 293         ;;
 294         add out0=IA64_MCA_CPU_MCA_STACK_OFFSET+MCA_PT_REGS_OFFSET, r2
 295         add out1=IA64_MCA_CPU_MCA_STACK_OFFSET+MCA_SWITCH_STACK_OFFSET, r2
 296         add out2=IA64_MCA_CPU_MCA_STACK_OFFSET+MCA_SOS_OFFSET, r2
 297         br.call.sptk.many    b0=ia64_mca_handler
 298
 299         // Revert back to physical mode before going back to SAL
 300         PHYSICAL_MODE_ENTER(r2, r3, ia64_os_mca_virtual_end, r4)
 301 ia64_os_mca_virtual_end:
 302
 303 END(ia64_os_mca_virtual_begin)
 304
 305         // switch back to previous stack
 306         alloc r14=ar.pfs,0,0,0,0                // remove the MCA handler frame
 307         mov r3=IA64_MCA_CPU_MCA_STACK_OFFSET    // use the MCA stack
 308         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 309         br.sptk ia64_old_stack
 310 1:
 311
 312         mov r3=IA64_MCA_CPU_MCA_STACK_OFFSET    // use the MCA stack
 313         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 314         br.sptk ia64_state_restore              // restore the SAL state
 315 1:
 316
 317         mov             b0=r12                  // SAL_CHECK return address
 318
 319         // release lock
 320         LOAD_PHYSICAL(p0,r3,ia64_mca_serialize);;
 321         st4.rel         [r3]=r0
 322
 323         br              b0
 324
 325 //EndMain//////////////////////////////////////////////////////////////////////
 326
 327 //StartMain////////////////////////////////////////////////////////////////////
 328
 329 //
 330 // SAL to OS entry point for INIT on all processors.  This has been defined for
 331 // registration purposes with SAL as a part of ia64_mca_init.  Monarch and
 332 // slave INIT have identical processing, except for the value of the
 333 // sos->monarch flag in r19.
 334 //
 335
 336 ia64_os_init_dispatch_monarch:
 337         mov r19=1                               // Bow, bow, ye lower middle classes!
 338         br.sptk ia64_os_init_dispatch
 339
 340 ia64_os_init_dispatch_slave:
 341         mov r19=0                               // <igor>yeth, mathter</igor>
 342
 343 ia64_os_init_dispatch:
 344
 345         mov r3=IA64_MCA_CPU_INIT_STACK_OFFSET   // use the INIT stack
 346         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 347         br.sptk ia64_state_save                 // save the state that is not in minstate
 348 1:
 349
 350         // switch to per cpu INIT stack
 351         mov r3=IA64_MCA_CPU_INIT_STACK_OFFSET   // use the INIT stack
 352         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 353         br.sptk ia64_new_stack
 354 1:
 355
 356         // everything saved, now we can set the kernel registers
 357         mov r3=IA64_MCA_CPU_INIT_STACK_OFFSET   // use the INIT stack
 358         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 359         br.sptk ia64_set_kernel_registers
 360 1:
 361
 362         // This must be done in physical mode
 363         GET_IA64_MCA_DATA(r2)
 364         ;;
 365         mov r7=r2
 366
 367         // Enter virtual mode from physical mode
 368         VIRTUAL_MODE_ENTER(r2, r3, ia64_os_init_virtual_begin, r4)
 369
 370         // This code returns to SAL via SOS r2, in general SAL has no unwind
 371         // data.  To get a clean termination when backtracing the C MCA/INIT
 372         // handler, set a dummy return address of 0 in this routine.  That
 373         // requires that ia64_os_init_virtual_begin be a global function.
 374 ENTRY(ia64_os_init_virtual_begin)
 375         .prologue
 376         .save rp,r0
 377         .body
 378
 379         mov ar.rsc=3                            // set eager mode for C handler
 380         mov r2=r7                               // see GET_IA64_MCA_DATA above
 381         ;;
 382
 383         // Call virtual mode handler
 384         alloc r14=ar.pfs,0,0,3,0
 385         ;;
 386         DATA_PA_TO_VA(r2,r7)
 387         ;;
 388         add out0=IA64_MCA_CPU_INIT_STACK_OFFSET+MCA_PT_REGS_OFFSET, r2
 389         add out1=IA64_MCA_CPU_INIT_STACK_OFFSET+MCA_SWITCH_STACK_OFFSET, r2
 390         add out2=IA64_MCA_CPU_INIT_STACK_OFFSET+MCA_SOS_OFFSET, r2
 391         br.call.sptk.many    b0=ia64_init_handler
 392
 393         // Revert back to physical mode before going back to SAL
 394         PHYSICAL_MODE_ENTER(r2, r3, ia64_os_init_virtual_end, r4)
 395 ia64_os_init_virtual_end:
 396
 397 END(ia64_os_init_virtual_begin)
 398
 399         mov r3=IA64_MCA_CPU_INIT_STACK_OFFSET   // use the INIT stack
 400         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 401         br.sptk ia64_state_restore              // restore the SAL state
 402 1:
 403
 404         // switch back to previous stack
 405         alloc r14=ar.pfs,0,0,0,0                // remove the INIT handler frame
 406         mov r3=IA64_MCA_CPU_INIT_STACK_OFFSET   // use the INIT stack
 407         LOAD_PHYSICAL(p0,r2,1f)                 // return address
 408         br.sptk ia64_old_stack
 409 1:
 410
 411         mov             b0=r12                  // SAL_CHECK return address
 412         br              b0
 413
 414 //EndMain//////////////////////////////////////////////////////////////////////
 415
 416 // common defines for the stubs
 417 #define ms              r4
 418 #define regs            r5
 419 #define temp1           r2      /* careful, it overlaps with input registers */
 420 #define temp2           r3      /* careful, it overlaps with input registers */
 421 #define temp3           r7
 422 #define temp4           r14
 423
 424
 425 //++
 426 // Name:
 427 //      ia64_state_save()
 428 //
 429 // Stub Description:
 430 //
 431 //      Save the state that is not in minstate.  This is sensitive to the layout of
 432 //      struct ia64_sal_os_state in mca.h.
 433 //
 434 //      r2 contains the return address, r3 contains either
 435 //      IA64_MCA_CPU_MCA_STACK_OFFSET or IA64_MCA_CPU_INIT_STACK_OFFSET.
 436 //
 437 //      The OS to SAL section of struct ia64_sal_os_state is set to a default
 438 //      value of cold boot (MCA) or warm boot (INIT) and return to the same
 439 //      context.  ia64_sal_os_state is also used to hold some registers that
 440 //      need to be saved and restored across the stack switches.
 441 //
 442 //      Most input registers to this stub come from PAL/SAL
 443 //      r1  os gp, physical
 444 //      r8  pal_proc entry point
 445 //      r9  sal_proc entry point
 446 //      r10 sal gp
 447 //      r11 MCA - rendevzous state, INIT - reason code
 448 //      r12 sal return address
 449 //      r17 pal min_state
 450 //      r18 processor state parameter
 451 //      r19 monarch flag, set by the caller of this routine
 452 //
 453 //      In addition to the SAL to OS state, this routine saves all the
 454 //      registers that appear in struct pt_regs and struct switch_stack,
 455 //      excluding those that are already in the PAL minstate area.  This
 456 //      results in a partial pt_regs and switch_stack, the C code copies the
 457 //      remaining registers from PAL minstate to pt_regs and switch_stack.  The
 458 //      resulting structures contain all the state of the original process when
 459 //      MCA/INIT occurred.
 460 //
 461 //--
 462
 463 ia64_state_save:
 464         add regs=MCA_SOS_OFFSET, r3
 465         add ms=MCA_SOS_OFFSET+8, r3
 466         mov b0=r2               // save return address
 467         cmp.eq p1,p2=IA64_MCA_CPU_MCA_STACK_OFFSET, r3
 468         ;;
 469         GET_IA64_MCA_DATA(temp2)
 470         ;;
 471         add temp1=temp2, regs   // struct ia64_sal_os_state on MCA or INIT stack
 472         add temp2=temp2, ms     // struct ia64_sal_os_state+8 on MCA or INIT stack
 473         ;;
 474         mov regs=temp1          // save the start of sos
 475         st8 [temp1]=r1,16       // os_gp
 476         st8 [temp2]=r8,16       // pal_proc
 477         ;;
 478         st8 [temp1]=r9,16       // sal_proc
 479         st8 [temp2]=r11,16      // rv_rc
 480         mov r11=cr.iipa
 481         ;;
 482         st8 [temp1]=r18         // proc_state_param
 483         st8 [temp2]=r19         // monarch
 484         mov r6=IA64_KR(CURRENT)
 485         add temp1=SOS(SAL_RA), regs
 486         add temp2=SOS(SAL_GP), regs
 487         ;;
 488         st8 [temp1]=r12,16      // sal_ra
 489         st8 [temp2]=r10,16      // sal_gp
 490         mov r12=cr.isr
 491         ;;
 492         st8 [temp1]=r17,16      // pal_min_state
 493         st8 [temp2]=r6,16       // prev_IA64_KR_CURRENT
 494         mov r6=IA64_KR(CURRENT_STACK)
 495         ;;
 496         st8 [temp1]=r6,16       // prev_IA64_KR_CURRENT_STACK
 497         st8 [temp2]=r0,16       // prev_task, starts off as NULL
 498         mov r6=cr.ifa
 499         ;;
 500         st8 [temp1]=r12,16      // cr.isr
 501         st8 [temp2]=r6,16       // cr.ifa
 502         mov r12=cr.itir
 503         ;;
 504         st8 [temp1]=r12,16      // cr.itir
 505         st8 [temp2]=r11,16      // cr.iipa
 506         mov r12=cr.iim
 507         ;;
 508         st8 [temp1]=r12         // cr.iim
 509 (p1)    mov r12=IA64_MCA_COLD_BOOT
 510 (p2)    mov r12=IA64_INIT_WARM_BOOT
 511         mov r6=cr.iha
 512         add temp1=SOS(OS_STATUS), regs
 513         ;;
 514         st8 [temp2]=r6          // cr.iha
 515         add temp2=SOS(CONTEXT), regs
 516         st8 [temp1]=r12         // os_status, default is cold boot
 517         mov r6=IA64_MCA_SAME_CONTEXT
 518         ;;
 519         st8 [temp2]=r6          // context, default is same context
 520
 521         // Save the pt_regs data that is not in minstate.  The previous code
 522         // left regs at sos.
 523         add regs=MCA_PT_REGS_OFFSET-MCA_SOS_OFFSET, regs
 524         ;;
 525         add temp1=PT(B6), regs
 526         mov temp3=b6
 527         mov temp4=b7
 528         add temp2=PT(B7), regs
 529         ;;
 530         st8 [temp1]=temp3,PT(AR_CSD)-PT(B6)             // save b6
 531         st8 [temp2]=temp4,PT(AR_SSD)-PT(B7)             // save b7
 532         mov temp3=ar.csd
 533         mov temp4=ar.ssd
 534         cover                                           // must be last in group
 535         ;;
 536         st8 [temp1]=temp3,PT(AR_UNAT)-PT(AR_CSD)        // save ar.csd
 537         st8 [temp2]=temp4,PT(AR_PFS)-PT(AR_SSD)         // save ar.ssd
 538         mov temp3=ar.unat
 539         mov temp4=ar.pfs
 540         ;;
 541         st8 [temp1]=temp3,PT(AR_RNAT)-PT(AR_UNAT)       // save ar.unat
 542         st8 [temp2]=temp4,PT(AR_BSPSTORE)-PT(AR_PFS)    // save ar.pfs
 543         mov temp3=ar.rnat
 544         mov temp4=ar.bspstore
 545         ;;
 546         st8 [temp1]=temp3,PT(LOADRS)-PT(AR_RNAT)        // save ar.rnat
 547         st8 [temp2]=temp4,PT(AR_FPSR)-PT(AR_BSPSTORE)   // save ar.bspstore
 548         mov temp3=ar.bsp
 549         ;;
 550         sub temp3=temp3, temp4  // ar.bsp - ar.bspstore
 551         mov temp4=ar.fpsr
 552         ;;
 553         shl temp3=temp3,16      // compute ar.rsc to be used for "loadrs"
 554         ;;
 555         st8 [temp1]=temp3,PT(AR_CCV)-PT(LOADRS)         // save loadrs
 556         st8 [temp2]=temp4,PT(F6)-PT(AR_FPSR)            // save ar.fpsr
 557         mov temp3=ar.ccv
 558         ;;
 559         st8 [temp1]=temp3,PT(F7)-PT(AR_CCV)             // save ar.ccv
 560         stf.spill [temp2]=f6,PT(F8)-PT(F6)
 561         ;;
 562         stf.spill [temp1]=f7,PT(F9)-PT(F7)
 563         stf.spill [temp2]=f8,PT(F10)-PT(F8)
 564         ;;
 565         stf.spill [temp1]=f9,PT(F11)-PT(F9)
 566         stf.spill [temp2]=f10
 567         ;;
 568         stf.spill [temp1]=f11
 569
 570         // Save the switch_stack data that is not in minstate nor pt_regs.  The
 571         // previous code left regs at pt_regs.
 572         add regs=MCA_SWITCH_STACK_OFFSET-MCA_PT_REGS_OFFSET, regs
 573         ;;
 574         add temp1=SW(F2), regs
 575         add temp2=SW(F3), regs
 576         ;;
 577         stf.spill [temp1]=f2,32
 578         stf.spill [temp2]=f3,32
 579         ;;
 580         stf.spill [temp1]=f4,32
 581         stf.spill [temp2]=f5,32
 582         ;;
 583         stf.spill [temp1]=f12,32
 584         stf.spill [temp2]=f13,32
 585         ;;
 586         stf.spill [temp1]=f14,32
 587         stf.spill [temp2]=f15,32
 588         ;;
 589         stf.spill [temp1]=f16,32
 590         stf.spill [temp2]=f17,32
 591         ;;
 592         stf.spill [temp1]=f18,32
 593         stf.spill [temp2]=f19,32
 594         ;;
 595         stf.spill [temp1]=f20,32
 596         stf.spill [temp2]=f21,32
 597         ;;
 598         stf.spill [temp1]=f22,32
 599         stf.spill [temp2]=f23,32
 600         ;;
 601         stf.spill [temp1]=f24,32
 602         stf.spill [temp2]=f25,32
 603         ;;
 604         stf.spill [temp1]=f26,32
 605         stf.spill [temp2]=f27,32
 606         ;;
 607         stf.spill [temp1]=f28,32
 608         stf.spill [temp2]=f29,32
 609         ;;
 610         stf.spill [temp1]=f30,SW(B2)-SW(F30)
 611         stf.spill [temp2]=f31,SW(B3)-SW(F31)
 612         mov temp3=b2
 613         mov temp4=b3
 614         ;;
 615         st8 [temp1]=temp3,16    // save b2
 616         st8 [temp2]=temp4,16    // save b3
 617         mov temp3=b4
 618         mov temp4=b5
 619         ;;
 620         st8 [temp1]=temp3,SW(AR_LC)-SW(B4)      // save b4
 621         st8 [temp2]=temp4       // save b5
 622         mov temp3=ar.lc
 623         ;;
 624         st8 [temp1]=temp3       // save ar.lc
 625
 626         // FIXME: Some proms are incorrectly accessing the minstate area as
 627         // cached data.  The C code uses region 6, uncached virtual.  Ensure
 628         // that there is no cache data lying around for the first 1K of the
 629         // minstate area.
 630         // Remove this code in September 2006, that gives platforms a year to
 631         // fix their proms and get their customers updated.
 632
 633         add r1=32*1,r17
 634         add r2=32*2,r17
 635         add r3=32*3,r17
 636         add r4=32*4,r17
 637         add r5=32*5,r17
 638         add r6=32*6,r17
 639         add r7=32*7,r17
 640         ;;
 641         fc r17
 642         fc r1
 643         fc r2
 644         fc r3
 645         fc r4
 646         fc r5
 647         fc r6
 648         fc r7
 649         add r17=32*8,r17
 650         add r1=32*8,r1
 651         add r2=32*8,r2
 652         add r3=32*8,r3
 653         add r4=32*8,r4
 654         add r5=32*8,r5
 655         add r6=32*8,r6
 656         add r7=32*8,r7
 657         ;;
 658         fc r17
 659         fc r1
 660         fc r2
 661         fc r3
 662         fc r4
 663         fc r5
 664         fc r6
 665         fc r7
 666         add r17=32*8,r17
 667         add r1=32*8,r1
 668         add r2=32*8,r2
 669         add r3=32*8,r3
 670         add r4=32*8,r4
 671         add r5=32*8,r5
 672         add r6=32*8,r6
 673         add r7=32*8,r7
 674         ;;
 675         fc r17
 676         fc r1
 677         fc r2
 678         fc r3
 679         fc r4
 680         fc r5
 681         fc r6
 682         fc r7
 683         add r17=32*8,r17
 684         add r1=32*8,r1
 685         add r2=32*8,r2
 686         add r3=32*8,r3
 687         add r4=32*8,r4
 688         add r5=32*8,r5
 689         add r6=32*8,r6
 690         add r7=32*8,r7
 691         ;;
 692         fc r17
 693         fc r1
 694         fc r2
 695         fc r3
 696         fc r4
 697         fc r5
 698         fc r6
 699         fc r7
 700
 701         br.sptk b0
 702
 703 //EndStub//////////////////////////////////////////////////////////////////////
 704
 705
 706 //++
 707 // Name:
 708 //      ia64_state_restore()
 709 //
 710 // Stub Description:
 711 //
 712 //      Restore the SAL/OS state.  This is sensitive to the layout of struct
 713 //      ia64_sal_os_state in mca.h.
 714 //
 715 //      r2 contains the return address, r3 contains either
 716 //      IA64_MCA_CPU_MCA_STACK_OFFSET or IA64_MCA_CPU_INIT_STACK_OFFSET.
 717 //
 718 //      In addition to the SAL to OS state, this routine restores all the
 719 //      registers that appear in struct pt_regs and struct switch_stack,
 720 //      excluding those in the PAL minstate area.
 721 //
 722 //--
 723
 724 ia64_state_restore:
 725         // Restore the switch_stack data that is not in minstate nor pt_regs.
 726         add regs=MCA_SWITCH_STACK_OFFSET, r3
 727         mov b0=r2               // save return address
 728         ;;
 729         GET_IA64_MCA_DATA(temp2)
 730         ;;
 731         add regs=temp2, regs
 732         ;;
 733         add temp1=SW(F2), regs
 734         add temp2=SW(F3), regs
 735         ;;
 736         ldf.fill f2=[temp1],32
 737         ldf.fill f3=[temp2],32
 738         ;;
 739         ldf.fill f4=[temp1],32
 740         ldf.fill f5=[temp2],32
 741         ;;
 742         ldf.fill f12=[temp1],32
 743         ldf.fill f13=[temp2],32
 744         ;;
 745         ldf.fill f14=[temp1],32
 746         ldf.fill f15=[temp2],32
 747         ;;
 748         ldf.fill f16=[temp1],32
 749         ldf.fill f17=[temp2],32
 750         ;;
 751         ldf.fill f18=[temp1],32
 752         ldf.fill f19=[temp2],32
 753         ;;
 754         ldf.fill f20=[temp1],32
 755         ldf.fill f21=[temp2],32
 756         ;;
 757         ldf.fill f22=[temp1],32
 758         ldf.fill f23=[temp2],32
 759         ;;
 760         ldf.fill f24=[temp1],32
 761         ldf.fill f25=[temp2],32
 762         ;;
 763         ldf.fill f26=[temp1],32
 764         ldf.fill f27=[temp2],32
 765         ;;
 766         ldf.fill f28=[temp1],32
 767         ldf.fill f29=[temp2],32
 768         ;;
 769         ldf.fill f30=[temp1],SW(B2)-SW(F30)
 770         ldf.fill f31=[temp2],SW(B3)-SW(F31)
 771         ;;
 772         ld8 temp3=[temp1],16    // restore b2
 773         ld8 temp4=[temp2],16    // restore b3
 774         ;;
 775         mov b2=temp3
 776         mov b3=temp4
 777         ld8 temp3=[temp1],SW(AR_LC)-SW(B4)      // restore b4
 778         ld8 temp4=[temp2]       // restore b5
 779         ;;
 780         mov b4=temp3
 781         mov b5=temp4
 782         ld8 temp3=[temp1]       // restore ar.lc
 783         ;;
 784         mov ar.lc=temp3
 785
 786         // Restore the pt_regs data that is not in minstate.  The previous code
 787         // left regs at switch_stack.
 788         add regs=MCA_PT_REGS_OFFSET-MCA_SWITCH_STACK_OFFSET, regs
 789         ;;
 790         add temp1=PT(B6), regs
 791         add temp2=PT(B7), regs
 792         ;;
 793         ld8 temp3=[temp1],PT(AR_CSD)-PT(B6)             // restore b6
 794         ld8 temp4=[temp2],PT(AR_SSD)-PT(B7)             // restore b7
 795         ;;
 796         mov b6=temp3
 797         mov b7=temp4
 798         ld8 temp3=[temp1],PT(AR_UNAT)-PT(AR_CSD)        // restore ar.csd
 799         ld8 temp4=[temp2],PT(AR_PFS)-PT(AR_SSD)         // restore ar.ssd
 800         ;;
 801         mov ar.csd=temp3
 802         mov ar.ssd=temp4
 803         ld8 temp3=[temp1]                               // restore ar.unat
 804         add temp1=PT(AR_CCV)-PT(AR_UNAT), temp1
 805         ld8 temp4=[temp2],PT(AR_FPSR)-PT(AR_PFS)        // restore ar.pfs
 806         ;;
 807         mov ar.unat=temp3
 808         mov ar.pfs=temp4
 809         // ar.rnat, ar.bspstore, loadrs are restore in ia64_old_stack.
 810         ld8 temp3=[temp1],PT(F6)-PT(AR_CCV)             // restore ar.ccv
 811         ld8 temp4=[temp2],PT(F7)-PT(AR_FPSR)            // restore ar.fpsr
 812         ;;
 813         mov ar.ccv=temp3
 814         mov ar.fpsr=temp4
 815         ldf.fill f6=[temp1],PT(F8)-PT(F6)
 816         ldf.fill f7=[temp2],PT(F9)-PT(F7)
 817         ;;
 818         ldf.fill f8=[temp1],PT(F10)-PT(F8)
 819         ldf.fill f9=[temp2],PT(F11)-PT(F9)
 820         ;;
 821         ldf.fill f10=[temp1]
 822         ldf.fill f11=[temp2]
 823
 824         // Restore the SAL to OS state. The previous code left regs at pt_regs.
 825         add regs=MCA_SOS_OFFSET-MCA_PT_REGS_OFFSET, regs
 826         ;;
 827         add temp1=SOS(SAL_RA), regs
 828         add temp2=SOS(SAL_GP), regs
 829         ;;
 830         ld8 r12=[temp1],16      // sal_ra
 831         ld8 r9=[temp2],16       // sal_gp
 832         ;;
 833         ld8 r22=[temp1],16      // pal_min_state, virtual
 834         ld8 r13=[temp2],16      // prev_IA64_KR_CURRENT
 835         ;;
 836         ld8 r16=[temp1],16      // prev_IA64_KR_CURRENT_STACK
 837         ld8 r20=[temp2],16      // prev_task
 838         ;;
 839         ld8 temp3=[temp1],16    // cr.isr
 840         ld8 temp4=[temp2],16    // cr.ifa
 841         ;;
 842         mov cr.isr=temp3
 843         mov cr.ifa=temp4
 844         ld8 temp3=[temp1],16    // cr.itir
 845         ld8 temp4=[temp2],16    // cr.iipa
 846         ;;
 847         mov cr.itir=temp3
 848         mov cr.iipa=temp4
 849         ld8 temp3=[temp1]       // cr.iim
 850         ld8 temp4=[temp2]               // cr.iha
 851         add temp1=SOS(OS_STATUS), regs
 852         add temp2=SOS(CONTEXT), regs
 853         ;;
 854         mov cr.iim=temp3
 855         mov cr.iha=temp4
 856         dep r22=0,r22,62,1      // pal_min_state, physical, uncached
 857         mov IA64_KR(CURRENT)=r13
 858         ld8 r8=[temp1]          // os_status
 859         ld8 r10=[temp2]         // context
 860
 861         /* Wire IA64_TR_CURRENT_STACK to the stack that we are resuming to.  To
 862          * avoid any dependencies on the algorithm in ia64_switch_to(), just
 863          * purge any existing CURRENT_STACK mapping and insert the new one.
 864          *
 865          * r16 contains prev_IA64_KR_CURRENT_STACK, r13 contains
 866          * prev_IA64_KR_CURRENT, these values may have been changed by the C
 867          * code.  Do not use r8, r9, r10, r22, they contain values ready for
 868          * the return to SAL.
 869          */
 870
 871         mov r15=IA64_KR(CURRENT_STACK)          // physical granule mapped by IA64_TR_CURRENT_STACK
 872         ;;
 873         shl r15=r15,IA64_GRANULE_SHIFT
 874         ;;
 875         dep r15=-1,r15,61,3                     // virtual granule
 876         mov r18=IA64_GRANULE_SHIFT<<2           // for cr.itir.ps
 877         ;;
 878         ptr.d r15,r18
 879         ;;
 880         srlz.d
 881
 882         extr.u r19=r13,61,3                     // r13 = prev_IA64_KR_CURRENT
 883         shl r20=r16,IA64_GRANULE_SHIFT          // r16 = prev_IA64_KR_CURRENT_STACK
 884         movl r21=PAGE_KERNEL                    // page properties
 885         ;;
 886         mov IA64_KR(CURRENT_STACK)=r16
 887         cmp.ne p6,p0=RGN_KERNEL,r19             // new stack is in the kernel region?
 888         or r21=r20,r21                          // construct PA | page properties
 889 (p6)    br.spnt 1f                              // the dreaded cpu 0 idle task in region 5:(
 890         ;;
 891         mov cr.itir=r18
 892         mov cr.ifa=r13
 893         mov r20=IA64_TR_CURRENT_STACK
 894         ;;
 895         itr.d dtr[r20]=r21
 896         ;;
 897         srlz.d
 898 1:
 899
 900         br.sptk b0
 901
 902 //EndStub//////////////////////////////////////////////////////////////////////
 903
 904
 905 //++
 906 // Name:
 907 //      ia64_new_stack()
 908 //
 909 // Stub Description:
 910 //
 911 //      Switch to the MCA/INIT stack.
 912 //
 913 //      r2 contains the return address, r3 contains either
 914 //      IA64_MCA_CPU_MCA_STACK_OFFSET or IA64_MCA_CPU_INIT_STACK_OFFSET.
 915 //
 916 //      On entry RBS is still on the original stack, this routine switches RBS
 917 //      to use the MCA/INIT stack.
 918 //
 919 //      On entry, sos->pal_min_state is physical, on exit it is virtual.
 920 //
 921 //--
 922
 923 ia64_new_stack:
 924         add regs=MCA_PT_REGS_OFFSET, r3
 925         add temp2=MCA_SOS_OFFSET+SOS(PAL_MIN_STATE), r3
 926         mov b0=r2                       // save return address
 927         GET_IA64_MCA_DATA(temp1)
 928         invala
 929         ;;
 930         add temp2=temp2, temp1          // struct ia64_sal_os_state.pal_min_state on MCA or INIT stack
 931         add regs=regs, temp1            // struct pt_regs on MCA or INIT stack
 932         ;;
 933         // Address of minstate area provided by PAL is physical, uncacheable.
 934         // Convert to Linux virtual address in region 6 for C code.
 935         ld8 ms=[temp2]                  // pal_min_state, physical
 936         ;;
 937         dep temp1=-1,ms,62,2            // set region 6
 938         mov temp3=IA64_RBS_OFFSET-MCA_PT_REGS_OFFSET
 939         ;;
 940         st8 [temp2]=temp1               // pal_min_state, virtual
 941
 942         add temp4=temp3, regs           // start of bspstore on new stack
 943         ;;
 944         mov ar.bspstore=temp4           // switch RBS to MCA/INIT stack
 945         ;;
 946         flushrs                         // must be first in group
 947         br.sptk b0
 948
 949 //EndStub//////////////////////////////////////////////////////////////////////
 950
 951
 952 //++
 953 // Name:
 954 //      ia64_old_stack()
 955 //
 956 // Stub Description:
 957 //
 958 //      Switch to the old stack.
 959 //
 960 //      r2 contains the return address, r3 contains either
 961 //      IA64_MCA_CPU_MCA_STACK_OFFSET or IA64_MCA_CPU_INIT_STACK_OFFSET.
 962 //
 963 //      On entry, pal_min_state is virtual, on exit it is physical.
 964 //
 965 //      On entry RBS is on the MCA/INIT stack, this routine switches RBS
 966 //      back to the previous stack.
 967 //
 968 //      The psr is set to all zeroes.  SAL return requires either all zeroes or
 969 //      just psr.mc set.  Leaving psr.mc off allows INIT to be issued if this
 970 //      code does not perform correctly.
 971 //
 972 //      The dirty registers at the time of the event were flushed to the
 973 //      MCA/INIT stack in ia64_pt_regs_save().  Restore the dirty registers
 974 //      before reverting to the previous bspstore.
 975 //--
 976
 977 ia64_old_stack:
 978         add regs=MCA_PT_REGS_OFFSET, r3
 979         mov b0=r2                       // save return address
 980         GET_IA64_MCA_DATA(temp2)
 981         LOAD_PHYSICAL(p0,temp1,1f)
 982         ;;
 983         mov cr.ipsr=r0
 984         mov cr.ifs=r0
 985         mov cr.iip=temp1
 986         ;;
 987         invala
 988         rfi
 989 1:
 990
 991         add regs=regs, temp2            // struct pt_regs on MCA or INIT stack
 992         ;;
 993         add temp1=PT(LOADRS), regs
 994         ;;
 995         ld8 temp2=[temp1],PT(AR_BSPSTORE)-PT(LOADRS)    // restore loadrs
 996         ;;
 997         ld8 temp3=[temp1],PT(AR_RNAT)-PT(AR_BSPSTORE)   // restore ar.bspstore
 998         mov ar.rsc=temp2
 999         ;;
1000         loadrs
1001         ld8 temp4=[temp1]               // restore ar.rnat
1002         ;;
1003         mov ar.bspstore=temp3           // back to old stack
1004         ;;
1005         mov ar.rnat=temp4
1006         ;;
1007
1008         br.sptk b0
1009
1010 //EndStub//////////////////////////////////////////////////////////////////////
1011
1012
1013 //++
1014 // Name:
1015 //      ia64_set_kernel_registers()
1016 //
1017 // Stub Description:
1018 //
1019 //      Set the registers that are required by the C code in order to run on an
1020 //      MCA/INIT stack.
1021 //
1022 //      r2 contains the return address, r3 contains either
1023 //      IA64_MCA_CPU_MCA_STACK_OFFSET or IA64_MCA_CPU_INIT_STACK_OFFSET.
1024 //
1025 //--
1026
1027 ia64_set_kernel_registers:
1028         add temp3=MCA_SP_OFFSET, r3
1029         add temp4=MCA_SOS_OFFSET+SOS(OS_GP), r3
1030         mov b0=r2               // save return address
1031         GET_IA64_MCA_DATA(temp1)
1032         ;;
1033         add temp4=temp4, temp1  // &struct ia64_sal_os_state.os_gp
1034         add r12=temp1, temp3    // kernel stack pointer on MCA/INIT stack
1035         add r13=temp1, r3       // set current to start of MCA/INIT stack
1036         add r20=temp1, r3       // physical start of MCA/INIT stack
1037         ;;
1038         ld8 r1=[temp4]          // OS GP from SAL OS state
1039         ;;
1040         DATA_PA_TO_VA(r1,temp1)
1041         DATA_PA_TO_VA(r12,temp2)
1042         DATA_PA_TO_VA(r13,temp3)
1043         ;;
1044         mov IA64_KR(CURRENT)=r13
1045
1046         /* Wire IA64_TR_CURRENT_STACK to the MCA/INIT handler stack.  To avoid
1047          * any dependencies on the algorithm in ia64_switch_to(), just purge
1048          * any existing CURRENT_STACK mapping and insert the new one.
1049          */
1050
1051         mov r16=IA64_KR(CURRENT_STACK)          // physical granule mapped by IA64_TR_CURRENT_STACK
1052         ;;
1053         shl r16=r16,IA64_GRANULE_SHIFT
1054         ;;
1055         dep r16=-1,r16,61,3                     // virtual granule
1056         mov r18=IA64_GRANULE_SHIFT<<2           // for cr.itir.ps
1057         ;;
1058         ptr.d r16,r18
1059         ;;
1060         srlz.d
1061
1062         shr.u r16=r20,IA64_GRANULE_SHIFT        // r20 = physical start of MCA/INIT stack
1063         movl r21=PAGE_KERNEL                    // page properties
1064         ;;
1065         mov IA64_KR(CURRENT_STACK)=r16
1066         or r21=r20,r21                          // construct PA | page properties
1067         ;;
1068         mov cr.itir=r18
1069         mov cr.ifa=r13
1070         mov r20=IA64_TR_CURRENT_STACK
1071         ;;
1072         itr.d dtr[r20]=r21
1073         ;;
1074         srlz.d
1075
1076         br.sptk b0
1077
1078 //EndStub//////////////////////////////////////////////////////////////////////
1079
1080 #undef  ms
1081 #undef  regs
1082 #undef  temp1
1083 #undef  temp2
1084 #undef  temp3
1085 #undef  temp4
1086
1087
1088 // Support function for mca.c, it is here to avoid using inline asm.  Given the
1089 // address of an rnat slot, if that address is below the current ar.bspstore
1090 // then return the contents of that slot, otherwise return the contents of
1091 // ar.rnat.
1092 GLOBAL_ENTRY(ia64_get_rnat)
1093         alloc r14=ar.pfs,1,0,0,0
1094         mov ar.rsc=0
1095         ;;
1096         mov r14=ar.bspstore
1097         ;;
1098         cmp.lt p6,p7=in0,r14
1099         ;;
1100 (p6)    ld8 r8=[in0]
1101 (p7)    mov r8=ar.rnat
1102         mov ar.rsc=3
1103         br.ret.sptk.many rp
1104 END(ia64_get_rnat)