]>
Commit | Line | Data |
---|---|---|
cf13f0ea | 1 | /* |
a53c8fab | 2 | * Copyright IBM Corp. 2005, 2011 |
cf13f0ea | 3 | * |
c6b5b847 HC |
4 | * Author(s): Rolf Adelsberger, |
5 | * Heiko Carstens <heiko.carstens@de.ibm.com> | |
60a0c68d | 6 | * Michael Holzheu <holzheu@linux.vnet.ibm.com> |
cf13f0ea HC |
7 | */ |
8 | ||
cf13f0ea HC |
9 | #include <linux/device.h> |
10 | #include <linux/mm.h> | |
11 | #include <linux/kexec.h> | |
12 | #include <linux/delay.h> | |
2b67fc46 | 13 | #include <linux/reboot.h> |
6966727d | 14 | #include <linux/ftrace.h> |
3ab121ab | 15 | #include <linux/debug_locks.h> |
b66ac63e | 16 | #include <linux/suspend.h> |
a386fba2 HC |
17 | #include <asm/cio.h> |
18 | #include <asm/setup.h> | |
cf13f0ea HC |
19 | #include <asm/pgtable.h> |
20 | #include <asm/pgalloc.h> | |
a386fba2 | 21 | #include <asm/smp.h> |
15e9b586 | 22 | #include <asm/reset.h> |
9c9c1761 | 23 | #include <asm/ipl.h> |
60a0c68d | 24 | #include <asm/diag.h> |
6b563d8c | 25 | #include <asm/elf.h> |
60a0c68d | 26 | #include <asm/asm-offsets.h> |
4e042af4 | 27 | #include <asm/cacheflush.h> |
a9fbf1a5 | 28 | #include <asm/os_info.h> |
e6c7c630 | 29 | #include <asm/set_memory.h> |
a62bc073 | 30 | #include <asm/switch_to.h> |
916cda1a | 31 | #include <asm/nmi.h> |
cf13f0ea | 32 | |
c6b5b847 | 33 | typedef void (*relocate_kernel_t)(kimage_entry_t *, unsigned long); |
cf13f0ea | 34 | |
2efe55a9 TK |
35 | extern const unsigned char relocate_kernel[]; |
36 | extern const unsigned long long relocate_kernel_len; | |
cf13f0ea | 37 | |
60a0c68d MH |
38 | #ifdef CONFIG_CRASH_DUMP |
39 | ||
b66ac63e MH |
40 | /* |
41 | * PM notifier callback for kdump | |
42 | */ | |
43 | static int machine_kdump_pm_cb(struct notifier_block *nb, unsigned long action, | |
44 | void *ptr) | |
45 | { | |
46 | switch (action) { | |
47 | case PM_SUSPEND_PREPARE: | |
48 | case PM_HIBERNATION_PREPARE: | |
7a0058ec XP |
49 | if (kexec_crash_image) |
50 | arch_kexec_unprotect_crashkres(); | |
b66ac63e MH |
51 | break; |
52 | case PM_POST_SUSPEND: | |
53 | case PM_POST_HIBERNATION: | |
7a0058ec XP |
54 | if (kexec_crash_image) |
55 | arch_kexec_protect_crashkres(); | |
b66ac63e MH |
56 | break; |
57 | default: | |
58 | return NOTIFY_DONE; | |
59 | } | |
60 | return NOTIFY_OK; | |
61 | } | |
62 | ||
63 | static int __init machine_kdump_pm_init(void) | |
64 | { | |
65 | pm_notifier(machine_kdump_pm_cb, 0); | |
66 | return 0; | |
67 | } | |
68 | arch_initcall(machine_kdump_pm_init); | |
60a0c68d MH |
69 | |
70 | /* | |
1a36a39e MS |
71 | * Reset the system, copy boot CPU registers to absolute zero, |
72 | * and jump to the kdump image | |
60a0c68d MH |
73 | */ |
74 | static void __do_machine_kdump(void *image) | |
75 | { | |
1a36a39e MS |
76 | int (*start_kdump)(int); |
77 | unsigned long prefix; | |
78 | ||
79 | /* store_status() saved the prefix register to lowcore */ | |
80 | prefix = (unsigned long) S390_lowcore.prefixreg_save_area; | |
81 | ||
82 | /* Now do the reset */ | |
83 | s390_reset_system(); | |
84 | ||
85 | /* | |
86 | * Copy dump CPU store status info to absolute zero. | |
87 | * This need to be done *after* s390_reset_system set the | |
88 | * prefix register of this CPU to zero | |
89 | */ | |
90 | memcpy((void *) __LC_FPREGS_SAVE_AREA, | |
91 | (void *)(prefix + __LC_FPREGS_SAVE_AREA), 512); | |
60a0c68d | 92 | |
fa7c0043 | 93 | __load_psw_mask(PSW_MASK_BASE | PSW_DEFAULT_KEY | PSW_MASK_EA | PSW_MASK_BA); |
1a36a39e | 94 | start_kdump = (void *)((struct kimage *) image)->start; |
60a0c68d | 95 | start_kdump(1); |
1a36a39e MS |
96 | |
97 | /* Die if start_kdump returns */ | |
98 | disabled_wait((unsigned long) __builtin_return_address(0)); | |
99 | } | |
100 | ||
101 | /* | |
102 | * Start kdump: create a LGR log entry, store status of all CPUs and | |
103 | * branch to __do_machine_kdump. | |
104 | */ | |
105 | static noinline void __machine_kdump(void *image) | |
106 | { | |
916cda1a MS |
107 | struct mcesa *mcesa; |
108 | unsigned long cr2_old, cr2_new; | |
1a36a39e MS |
109 | int this_cpu, cpu; |
110 | ||
111 | lgr_info_log(); | |
112 | /* Get status of the other CPUs */ | |
113 | this_cpu = smp_find_processor_id(stap()); | |
114 | for_each_online_cpu(cpu) { | |
115 | if (cpu == this_cpu) | |
116 | continue; | |
117 | if (smp_store_status(cpu)) | |
118 | continue; | |
119 | } | |
120 | /* Store status of the boot CPU */ | |
916cda1a | 121 | mcesa = (struct mcesa *)(S390_lowcore.mcesad & MCESA_ORIGIN_MASK); |
1a36a39e | 122 | if (MACHINE_HAS_VX) |
916cda1a MS |
123 | save_vx_regs((__vector128 *) mcesa->vector_save_area); |
124 | if (MACHINE_HAS_GS) { | |
125 | __ctl_store(cr2_old, 2, 2); | |
126 | cr2_new = cr2_old | (1UL << 4); | |
127 | __ctl_load(cr2_new, 2, 2); | |
128 | save_gs_cb((struct gs_cb *) mcesa->guarded_storage_save_area); | |
129 | __ctl_load(cr2_old, 2, 2); | |
130 | } | |
1a36a39e MS |
131 | /* |
132 | * To create a good backchain for this CPU in the dump store_status | |
133 | * is passed the address of a function. The address is saved into | |
134 | * the PSW save area of the boot CPU and the function is invoked as | |
135 | * a tail call of store_status. The backchain in the dump will look | |
136 | * like this: | |
137 | * restart_int_handler -> __machine_kexec -> __do_machine_kdump | |
138 | * The call to store_status() will not return. | |
139 | */ | |
140 | store_status(__do_machine_kdump, image); | |
60a0c68d | 141 | } |
10ad34bc | 142 | #endif |
60a0c68d MH |
143 | |
144 | /* | |
145 | * Check if kdump checksums are valid: We call purgatory with parameter "0" | |
146 | */ | |
147 | static int kdump_csum_valid(struct kimage *image) | |
148 | { | |
149 | #ifdef CONFIG_CRASH_DUMP | |
150 | int (*start_kdump)(int) = (void *)image->start; | |
151 | int rc; | |
152 | ||
153 | __arch_local_irq_stnsm(0xfb); /* disable DAT */ | |
154 | rc = start_kdump(0); | |
155 | __arch_local_irq_stosm(0x04); /* enable DAT */ | |
156 | return rc ? 0 : -EINVAL; | |
157 | #else | |
158 | return -EINVAL; | |
159 | #endif | |
160 | } | |
161 | ||
7a0058ec XP |
162 | #ifdef CONFIG_CRASH_DUMP |
163 | ||
2d0af224 HC |
164 | void crash_free_reserved_phys_range(unsigned long begin, unsigned long end) |
165 | { | |
166 | unsigned long addr, size; | |
167 | ||
168 | for (addr = begin; addr < end; addr += PAGE_SIZE) | |
169 | free_reserved_page(pfn_to_page(addr >> PAGE_SHIFT)); | |
170 | size = begin - crashk_res.start; | |
171 | if (size) | |
172 | os_info_crashkernel_add(crashk_res.start, size); | |
173 | else | |
174 | os_info_crashkernel_add(0, 0); | |
175 | } | |
176 | ||
4e042af4 | 177 | static void crash_protect_pages(int protect) |
dab7a7b1 | 178 | { |
4e042af4 | 179 | unsigned long size; |
dab7a7b1 | 180 | |
4e042af4 HC |
181 | if (!crashk_res.end) |
182 | return; | |
183 | size = resource_size(&crashk_res); | |
184 | if (protect) | |
185 | set_memory_ro(crashk_res.start, size >> PAGE_SHIFT); | |
2d0af224 | 186 | else |
4e042af4 | 187 | set_memory_rw(crashk_res.start, size >> PAGE_SHIFT); |
dab7a7b1 MH |
188 | } |
189 | ||
7a0058ec | 190 | void arch_kexec_protect_crashkres(void) |
dab7a7b1 | 191 | { |
4e042af4 | 192 | crash_protect_pages(1); |
dab7a7b1 MH |
193 | } |
194 | ||
7a0058ec | 195 | void arch_kexec_unprotect_crashkres(void) |
dab7a7b1 | 196 | { |
4e042af4 | 197 | crash_protect_pages(0); |
dab7a7b1 MH |
198 | } |
199 | ||
7a0058ec XP |
200 | #endif |
201 | ||
60a0c68d MH |
202 | /* |
203 | * Give back memory to hypervisor before new kdump is loaded | |
204 | */ | |
205 | static int machine_kexec_prepare_kdump(void) | |
206 | { | |
207 | #ifdef CONFIG_CRASH_DUMP | |
208 | if (MACHINE_IS_VM) | |
209 | diag10_range(PFN_DOWN(crashk_res.start), | |
210 | PFN_DOWN(crashk_res.end - crashk_res.start + 1)); | |
211 | return 0; | |
212 | #else | |
213 | return -EINVAL; | |
214 | #endif | |
215 | } | |
216 | ||
c6b5b847 | 217 | int machine_kexec_prepare(struct kimage *image) |
cf13f0ea | 218 | { |
c6b5b847 | 219 | void *reboot_code_buffer; |
cf13f0ea | 220 | |
9c9c1761 HC |
221 | /* Can't replace kernel image since it is read-only. */ |
222 | if (ipl_flags & IPL_NSS_VALID) | |
d978386e | 223 | return -EOPNOTSUPP; |
9c9c1761 | 224 | |
60a0c68d MH |
225 | if (image->type == KEXEC_TYPE_CRASH) |
226 | return machine_kexec_prepare_kdump(); | |
227 | ||
cf13f0ea HC |
228 | /* We don't support anything but the default image type for now. */ |
229 | if (image->type != KEXEC_TYPE_DEFAULT) | |
230 | return -EINVAL; | |
231 | ||
232 | /* Get the destination where the assembler code should be copied to.*/ | |
c6b5b847 | 233 | reboot_code_buffer = (void *) page_to_phys(image->control_code_page); |
cf13f0ea HC |
234 | |
235 | /* Then copy it */ | |
c6b5b847 | 236 | memcpy(reboot_code_buffer, relocate_kernel, relocate_kernel_len); |
cf13f0ea HC |
237 | return 0; |
238 | } | |
239 | ||
c6b5b847 | 240 | void machine_kexec_cleanup(struct kimage *image) |
cf13f0ea HC |
241 | { |
242 | } | |
243 | ||
60a0c68d MH |
244 | void arch_crash_save_vmcoreinfo(void) |
245 | { | |
246 | VMCOREINFO_SYMBOL(lowcore_ptr); | |
7fe7a18c | 247 | VMCOREINFO_SYMBOL(high_memory); |
60a0c68d | 248 | VMCOREINFO_LENGTH(lowcore_ptr, NR_CPUS); |
203e9e41 | 249 | mem_assign_absolute(S390_lowcore.vmcore_info, paddr_vmcoreinfo_note()); |
60a0c68d MH |
250 | } |
251 | ||
c6b5b847 | 252 | void machine_shutdown(void) |
cf13f0ea | 253 | { |
cf13f0ea HC |
254 | } |
255 | ||
48a8ca03 HC |
256 | void machine_crash_shutdown(struct pt_regs *regs) |
257 | { | |
258 | } | |
259 | ||
60a0c68d MH |
260 | /* |
261 | * Do normal kexec | |
262 | */ | |
263 | static void __do_machine_kexec(void *data) | |
cf13f0ea | 264 | { |
cf13f0ea | 265 | relocate_kernel_t data_mover; |
2c2df118 | 266 | struct kimage *image = data; |
cf13f0ea | 267 | |
1a36a39e | 268 | s390_reset_system(); |
c6b5b847 | 269 | data_mover = (relocate_kernel_t) page_to_phys(image->control_code_page); |
cf13f0ea HC |
270 | |
271 | /* Call the moving routine */ | |
c6b5b847 | 272 | (*data_mover)(&image->head, image->start); |
1a36a39e MS |
273 | |
274 | /* Die if kexec returns */ | |
275 | disabled_wait((unsigned long) __builtin_return_address(0)); | |
cf13f0ea | 276 | } |
2c2df118 | 277 | |
60a0c68d MH |
278 | /* |
279 | * Reset system and call either kdump or normal kexec | |
280 | */ | |
281 | static void __machine_kexec(void *data) | |
282 | { | |
fa7c0043 | 283 | __arch_local_irq_stosm(0x04); /* enable DAT */ |
60a0c68d | 284 | pfault_fini(); |
3ab121ab MH |
285 | tracing_off(); |
286 | debug_locks_off(); | |
10ad34bc | 287 | #ifdef CONFIG_CRASH_DUMP |
1a36a39e MS |
288 | if (((struct kimage *) data)->type == KEXEC_TYPE_CRASH) |
289 | __machine_kdump(data); | |
10ad34bc | 290 | #endif |
1a36a39e | 291 | __do_machine_kexec(data); |
60a0c68d MH |
292 | } |
293 | ||
294 | /* | |
295 | * Do either kdump or normal kexec. In case of kdump we first ask | |
296 | * purgatory, if kdump checksums are valid. | |
297 | */ | |
2c2df118 HC |
298 | void machine_kexec(struct kimage *image) |
299 | { | |
60a0c68d MH |
300 | if (image->type == KEXEC_TYPE_CRASH && !kdump_csum_valid(image)) |
301 | return; | |
6966727d | 302 | tracer_disable(); |
2c2df118 | 303 | smp_send_stop(); |
8b646bd7 | 304 | smp_call_ipl_cpu(__machine_kexec, image); |
2c2df118 | 305 | } |