2 * S390 64-bit swsusp implementation
4 * Copyright IBM Corp. 2009
6 * Author(s): Hans-Joachim Picht <hans@linux.vnet.ibm.com>
7 * Michael Holzheu <holzheu@linux.vnet.ibm.com>
11 #include <asm/ptrace.h>
12 #include <asm/thread_info.h>
13 #include <asm/asm-offsets.h>
16 * Save register context in absolute 0 lowcore and call swsusp_save() to
17 * create in-memory kernel image. The context is saved in the designated
18 * "store status" memory locations (see POP).
19 * We return from this function twice. The first time during the suspend to
20 * disk process. The second time via the swsusp_arch_resume() function
21 * (see below) in the resume process.
22 * This function runs with disabled interrupts.
26 .globl swsusp_arch_suspend
28 stmg %r6,%r15,__SF_GPRS(%r15)
30 aghi %r15,-STACK_FRAME_OVERHEAD
31 stg %r1,__SF_BACKCHAIN(%r15)
34 stnsm __SF_EMPTY(%r15),0xfb
36 /* Store prefix register on stack */
39 /* Save prefix register contents for lowcore */
40 llgf %r4,__SF_EMPTY(%r15)
42 /* Get pointer to save area */
45 /* Save CPU address */
46 stap __LC_CPU_ADDRESS(%r1)
49 mvc 0x318(4,%r1),__SF_EMPTY(%r15) /* move prefix to lowcore */
50 stfpc 0x31c(%r1) /* store fpu control */
51 std 0,0x200(%r1) /* store f0 */
52 std 1,0x208(%r1) /* store f1 */
53 std 2,0x210(%r1) /* store f2 */
54 std 3,0x218(%r1) /* store f3 */
55 std 4,0x220(%r1) /* store f4 */
56 std 5,0x228(%r1) /* store f5 */
57 std 6,0x230(%r1) /* store f6 */
58 std 7,0x238(%r1) /* store f7 */
59 std 8,0x240(%r1) /* store f8 */
60 std 9,0x248(%r1) /* store f9 */
61 std 10,0x250(%r1) /* store f10 */
62 std 11,0x258(%r1) /* store f11 */
63 std 12,0x260(%r1) /* store f12 */
64 std 13,0x268(%r1) /* store f13 */
65 std 14,0x270(%r1) /* store f14 */
66 std 15,0x278(%r1) /* store f15 */
67 stam %a0,%a15,0x340(%r1) /* store access registers */
68 stctg %c0,%c15,0x380(%r1) /* store control registers */
69 stmg %r0,%r15,0x280(%r1) /* store general registers */
71 stpt 0x328(%r1) /* store timer */
72 stckc 0x330(%r1) /* store clock comparator */
75 stosm __SF_EMPTY(%r15),0x04
77 /* Set prefix page to zero */
78 xc __SF_EMPTY(4,%r15),__SF_EMPTY(%r15)
88 brasl %r14,swsusp_save
90 /* Restore prefix register and return */
93 lmg %r6,%r15,STACK_FRAME_OVERHEAD + __SF_GPRS(%r15)
98 * Restore saved memory image to correct place and restore register context.
99 * Then we return to the function that called swsusp_arch_suspend().
100 * swsusp_arch_resume() runs with disabled interrupts.
102 .globl swsusp_arch_resume
104 stmg %r6,%r15,__SF_GPRS(%r15)
106 aghi %r15,-STACK_FRAME_OVERHEAD
107 stg %r1,__SF_BACKCHAIN(%r15)
109 /* Make all free pages stable */
111 brasl %r14,arch_set_page_states
114 stnsm __SF_EMPTY(%r15),0xfb
116 /* Set prefix page to zero */
117 xc __SF_EMPTY(4,%r15),__SF_EMPTY(%r15)
120 /* Restore saved image */
121 larl %r1,restore_pblist
140 larl %r1,restart_entry
141 larl %r2,.Lrestart_diag308_psw
144 larl %r1,.Lnew_pgm_check_psw
147 mvc __LC_PGM_NEW_PSW(16,%r0),0(%r1)
154 larl %r1,.Lnew_pgm_check_psw
158 /* Switch to original suspend CPU */
159 larl %r1,.Lresume_cpu /* Resume CPU address: r2 */
163 llgh %r1,__LC_CPU_ADDRESS(%r3) /* Suspend CPU address: r1 */
165 je restore_registers /* r1 = r2 -> nothing to do */
166 larl %r4,.Lrestart_suspend_psw /* Set new restart PSW */
167 mvc __LC_RESTART_PSW(16,%r0),0(%r4)
169 sigp %r9,%r1,__SIGP_INITIAL_CPU_RESET
170 brc 8,4f /* accepted */
171 brc 2,3b /* busy, try again */
173 /* Suspend CPU not available -> panic */
174 larl %r15,init_thread_union
175 ahi %r15,1<<(PAGE_SHIFT+THREAD_ORDER)
176 larl %r2,.Lpanic_string
177 larl %r3,_sclp_print_early
182 larl %r3,.Ldisabled_wait_31
185 /* Switch to suspend CPU */
186 sigp %r9,%r1,__SIGP_RESTART /* start suspend CPU */
187 brc 2,4b /* busy, try again */
189 sigp %r9,%r2,__SIGP_STOP /* stop resume (current) CPU */
193 larl %r1,.Lresume_cpu
196 sigp %r9,%r2,__SIGP_SENSE /* Wait for resume CPU */
197 brc 2,7b /* busy, try again */
198 tmll %r9,0x40 /* Test if resume CPU is stopped */
202 /* Restore registers */
203 lghi %r13,0x1000 /* %r1 = pointer to save arae */
205 spt 0x328(%r13) /* reprogram timer */
206 //sckc 0x330(%r13) /* set clock comparator */
208 lctlg %c0,%c15,0x380(%r13) /* load control registers */
209 lam %a0,%a15,0x340(%r13) /* load access registers */
211 lfpc 0x31c(%r13) /* load fpu control */
212 ld 0,0x200(%r13) /* load f0 */
213 ld 1,0x208(%r13) /* load f1 */
214 ld 2,0x210(%r13) /* load f2 */
215 ld 3,0x218(%r13) /* load f3 */
216 ld 4,0x220(%r13) /* load f4 */
217 ld 5,0x228(%r13) /* load f5 */
218 ld 6,0x230(%r13) /* load f6 */
219 ld 7,0x238(%r13) /* load f7 */
220 ld 8,0x240(%r13) /* load f8 */
221 ld 9,0x248(%r13) /* load f9 */
222 ld 10,0x250(%r13) /* load f10 */
223 ld 11,0x258(%r13) /* load f11 */
224 ld 12,0x260(%r13) /* load f12 */
225 ld 13,0x268(%r13) /* load f13 */
226 ld 14,0x270(%r13) /* load f14 */
227 ld 15,0x278(%r13) /* load f15 */
232 /* Pointer to save area */
235 /* Restore prefix register */
239 stosm __SF_EMPTY(%r15),0x04
241 /* Make all free pages unstable */
243 brasl %r14,arch_set_page_states
246 lmg %r6,%r15,STACK_FRAME_OVERHEAD + __SF_GPRS(%r15)
250 .section .data.nosave,"aw",@progbits
253 .long 0x000a0000,0x00000000
255 .asciz "Resume not possible because suspend CPU is no longer available"
257 .Lrestart_diag308_psw:
258 .long 0x00080000,0x80000000
259 .Lrestart_suspend_psw:
260 .quad 0x0000000180000000,restart_suspend
262 .quad 0,pgm_check_entry