| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132 |
- /* SPDX-License-Identifier: GPL-2.0 */
- /*
- * hibernate_asm.S: Hibernaton support specific for sparc64.
- *
- * Copyright (C) 2013 Kirill V Tkhai ([email protected])
- */
- #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
|
