arch/sparc/kernel/urtt_fill.S

   1 #include <asm/thread_info.h>
   2 #include <asm/trap_block.h>
   3 #include <asm/spitfire.h>
   4 #include <asm/ptrace.h>
   5 #include <asm/head.h>
   6
   7                 .text
   8                 .align  8
   9                 .globl  user_rtt_fill_fixup_common
  10 user_rtt_fill_fixup_common:
  11                 rdpr    %cwp, %g1
  12                 add     %g1, 1, %g1
  13                 wrpr    %g1, 0x0, %cwp
  14
  15                 rdpr    %wstate, %g2
  16                 sll     %g2, 3, %g2
  17                 wrpr    %g2, 0x0, %wstate
  18
  19                 /* We know %canrestore and %otherwin are both zero.  */
  20
  21                 sethi   %hi(sparc64_kern_pri_context), %g2
  22                 ldx     [%g2 + %lo(sparc64_kern_pri_context)], %g2
  23                 mov     PRIMARY_CONTEXT, %g1
  24
  25 661:            stxa    %g2, [%g1] ASI_DMMU
  26                 .section .sun4v_1insn_patch, "ax"
  27                 .word   661b
  28                 stxa    %g2, [%g1] ASI_MMU
  29                 .previous
  30
  31                 sethi   %hi(KERNBASE), %g1
  32                 flush   %g1
  33
  34                 mov     %g4, %l4
  35                 mov     %g5, %l5
  36                 brnz,pn %g3, 1f
  37                  mov    %g3, %l3
  38
  39                 or      %g4, FAULT_CODE_WINFIXUP, %g4
  40                 stb     %g4, [%g6 + TI_FAULT_CODE]
  41                 stx     %g5, [%g6 + TI_FAULT_ADDR]
  42 1:
  43                 mov     %g6, %l1
  44                 wrpr    %g0, 0x0, %tl
  45
  46 661:            nop
  47                 .section                .sun4v_1insn_patch, "ax"
  48                 .word                   661b
  49                 SET_GL(0)
  50                 .previous
  51
  52                 wrpr    %g0, RTRAP_PSTATE, %pstate
  53
  54                 mov     %l1, %g6
  55                 ldx     [%g6 + TI_TASK], %g4
  56                 LOAD_PER_CPU_BASE(%g5, %g6, %g1, %g2, %g3)
  57
  58                 brnz,pn %l3, 1f
  59                  nop
  60
  61                 call    do_sparc64_fault
  62                  add    %sp, PTREGS_OFF, %o0
  63                 ba,pt   %xcc, rtrap
  64                  nop
  65
  66 1:              cmp     %g3, 2
  67                 bne,pn  %xcc, 2f
  68                  nop
  69
  70                 sethi   %hi(tlb_type), %g1
  71                 lduw    [%g1 + %lo(tlb_type)], %g1
  72                 cmp     %g1, 3
  73                 bne,pt  %icc, 1f
  74                  add    %sp, PTREGS_OFF, %o0
  75                 mov     %l4, %o2
  76                 call    sun4v_do_mna
  77                  mov    %l5, %o1
  78                 ba,a,pt %xcc, rtrap
  79 1:              mov     %l4, %o1
  80                 mov     %l5, %o2
  81                 call    mem_address_unaligned
  82                  nop
  83                 ba,a,pt %xcc, rtrap
  84
  85 2:              sethi   %hi(tlb_type), %g1
  86                 mov     %l4, %o1
  87                 lduw    [%g1 + %lo(tlb_type)], %g1
  88                 mov     %l5, %o2
  89                 cmp     %g1, 3
  90                 bne,pt  %icc, 1f
  91                  add    %sp, PTREGS_OFF, %o0
  92                 call    sun4v_data_access_exception
  93                  nop
  94                 ba,a,pt %xcc, rtrap
  95
  96 1:              call    spitfire_data_access_exception
  97                  nop
  98                 ba,a,pt %xcc, rtrap