Quelle  hibernate_asm.S   Sprache: Sparc

/* SPDX-License-Identifier: GPL-2.0 */
/*
 * hibernate_asm.S:  Hibernaton support specific for sparc64.
 *
 * Copyright (C) 2013 Kirill V Tkhai (tkhai@yandex.ru)
 */

#include <linux/linkage.h>

#include <asm/asm-offsets.h>
#include <asm/cpudata.h>
#include <asm/page.h>

ENTRY(swsusp_arch_suspend)
 save %sp, -128, %sp
 save %sp, -128, %sp
 flushw

 setuw saved_context, %g3

 /* Save window regs */
 rdpr %cwp, %g2
 stx %g2, [%g3 + SC_REG_CWP]
 rdpr %wstate, %g2
 stx %g2, [%g3 + SC_REG_WSTATE]
 stx %fp, [%g3 + SC_REG_FP]

 /* Save state regs */
 rdpr %tick, %g2
 stx %g2, [%g3 + SC_REG_TICK]
 rdpr %pstate, %g2
 stx %g2, [%g3 + SC_REG_PSTATE]

 /* Save global regs */
 stx %g4, [%g3 + SC_REG_G4]
 stx %g5, [%g3 + SC_REG_G5]
 stx %g6, [%g3 + SC_REG_G6]

 call swsusp_save
  nop

 mov %o0, %i0
 restore

 mov %o0, %i0
 ret
  restore

ENTRY(swsusp_arch_resume)
 /* Write restore_pblist to %l0 */
 sethi %hi(restore_pblist), %l0
 ldx [%l0 + %lo(restore_pblist)], %l0

 call __flush_tlb_all
  nop

 /* Write PAGE_OFFSET to %g7 */
 sethi %hi(PAGE_OFFSET), %g7
 ldx [%g7 + %lo(PAGE_OFFSET)], %g7

 setuw (PAGE_SIZE-8), %g3

 /* Use MMU Bypass */
 rd %asi, %g1
 wr %g0, ASI_PHYS_USE_EC, %asi

 ba fill_itlb
  nop

pbe_loop:
 cmp %l0, %g0
 be restore_ctx
  sub %l0, %g7, %l0

 ldxa [%l0    ] %asi, %l1 /* address */
 ldxa [%l0 + 8] %asi, %l2 /* orig_address */

 /* phys addr */
 sub %l1, %g7, %l1
 sub %l2, %g7, %l2

 mov %g3, %l3 /* PAGE_SIZE-8 */
copy_loop:
 ldxa [%l1 + %l3] ASI_PHYS_USE_EC, %g2
 stxa %g2, [%l2 + %l3] ASI_PHYS_USE_EC
 cmp %l3, %g0
 bne copy_loop
  sub %l3, 8, %l3

 /* next pbe */
 ba pbe_loop
  ldxa [%l0 + 16] %asi, %l0

restore_ctx:
 setuw saved_context, %g3

 /* Restore window regs */
 wrpr    %g0, 0, %canrestore
 wrpr    %g0, 0, %otherwin
 wrpr %g0, 6, %cansave
 wrpr    %g0, 0, %cleanwin

 ldxa [%g3 + SC_REG_CWP] %asi, %g2
 wrpr %g2, %cwp
 ldxa [%g3 + SC_REG_WSTATE] %asi, %g2
 wrpr %g2, %wstate
 ldxa [%g3 + SC_REG_FP] %asi, %fp

 /* Restore state regs */
 ldxa [%g3 + SC_REG_PSTATE] %asi, %g2
 wrpr %g2, %pstate
 ldxa [%g3 + SC_REG_TICK] %asi, %g2
 wrpr %g2, %tick

 /* Restore global regs */
 ldxa [%g3 + SC_REG_G4] %asi, %g4
 ldxa [%g3 + SC_REG_G5] %asi, %g5
 ldxa [%g3 + SC_REG_G6] %asi, %g6

 wr %g1, %g0, %asi

 restore
 restore

 wrpr %g0, 14, %pil

 retl
  mov %g0, %o0

fill_itlb:
 ba pbe_loop
  wrpr %g0, 15, %pil