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