arch/sparc/power/hibernate_asm.S

   1 /*
   2  * hibernate_asm.S:  Hibernaton support specific for sparc64.
   3  *
   4  * Copyright (C) 2013 Kirill V Tkhai (tkhai@yandex.ru)
   5  */
   6
   7 #include <linux/linkage.h>
   8
   9 #include <asm/asm-offsets.h>
  10 #include <asm/cpudata.h>
  11 #include <asm/page.h>
  12
  13 ENTRY(swsusp_arch_suspend)
  14         save    %sp, -128, %sp
  15         save    %sp, -128, %sp
  16         flushw
  17
  18         setuw   saved_context, %g3
  19
  20         /* Save window regs */
  21         rdpr    %cwp, %g2
  22         stx     %g2, [%g3 + SC_REG_CWP]
  23         rdpr    %wstate, %g2
  24         stx     %g2, [%g3 + SC_REG_WSTATE]
  25         stx     %fp, [%g3 + SC_REG_FP]
  26
  27         /* Save state regs */
  28         rdpr    %tick, %g2
  29         stx     %g2, [%g3 + SC_REG_TICK]
  30         rdpr    %pstate, %g2
  31         stx     %g2, [%g3 + SC_REG_PSTATE]
  32
  33         /* Save global regs */
  34         stx     %g4, [%g3 + SC_REG_G4]
  35         stx     %g5, [%g3 + SC_REG_G5]
  36         stx     %g6, [%g3 + SC_REG_G6]
  37
  38         call    swsusp_save
  39          nop
  40
  41         mov     %o0, %i0
  42         restore
  43
  44         mov     %o0, %i0
  45         ret
  46          restore
  47
  48 ENTRY(swsusp_arch_resume)
  49         /* Write restore_pblist to %l0 */
  50         sethi   %hi(restore_pblist), %l0
  51         ldx     [%l0 + %lo(restore_pblist)], %l0
  52
  53         call    __flush_tlb_all
  54          nop
  55
  56         /* Write PAGE_OFFSET to %g7 */
  57         sethi   %hi(PAGE_OFFSET), %g7
  58         ldx     [%g7 + %lo(PAGE_OFFSET)], %g7
  59
  60         setuw   (PAGE_SIZE-8), %g3
  61
  62         /* Use MMU Bypass */
  63         rd      %asi, %g1
  64         wr      %g0, ASI_PHYS_USE_EC, %asi
  65
  66         ba      fill_itlb
  67          nop
  68
  69 pbe_loop:
  70         cmp     %l0, %g0
  71         be      restore_ctx
  72          sub    %l0, %g7, %l0
  73
  74         ldxa    [%l0    ] %asi, %l1 /* address */
  75         ldxa    [%l0 + 8] %asi, %l2 /* orig_address */
  76
  77         /* phys addr */
  78         sub     %l1, %g7, %l1
  79         sub     %l2, %g7, %l2
  80
  81         mov     %g3, %l3 /* PAGE_SIZE-8 */
  82 copy_loop:
  83         ldxa    [%l1 + %l3] ASI_PHYS_USE_EC, %g2
  84         stxa    %g2, [%l2 + %l3] ASI_PHYS_USE_EC
  85         cmp     %l3, %g0
  86         bne     copy_loop
  87          sub    %l3, 8, %l3
  88
  89         /* next pbe */
  90         ba      pbe_loop
  91          ldxa   [%l0 + 16] %asi, %l0
  92
  93 restore_ctx:
  94         setuw   saved_context, %g3
  95
  96         /* Restore window regs */
  97         wrpr    %g0, 0, %canrestore
  98         wrpr    %g0, 0, %otherwin
  99         wrpr    %g0, 6, %cansave
 100         wrpr    %g0, 0, %cleanwin
 101
 102         ldxa    [%g3 + SC_REG_CWP] %asi, %g2
 103         wrpr    %g2, %cwp
 104         ldxa    [%g3 + SC_REG_WSTATE] %asi, %g2
 105         wrpr    %g2, %wstate
 106         ldxa    [%g3 + SC_REG_FP] %asi, %fp
 107
 108         /* Restore state regs */
 109         ldxa    [%g3 + SC_REG_PSTATE] %asi, %g2
 110         wrpr    %g2, %pstate
 111         ldxa    [%g3 + SC_REG_TICK] %asi, %g2
 112         wrpr    %g2, %tick
 113
 114         /* Restore global regs */
 115         ldxa    [%g3 + SC_REG_G4] %asi, %g4
 116         ldxa    [%g3 + SC_REG_G5] %asi, %g5
 117         ldxa    [%g3 + SC_REG_G6] %asi, %g6
 118
 119         wr      %g1, %g0, %asi
 120
 121         restore
 122         restore
 123
 124         wrpr    %g0, 14, %pil
 125
 126         retl
 127          mov    %g0, %o0
 128
 129 fill_itlb:
 130         ba      pbe_loop
 131          wrpr   %g0, 15, %pil