Commit | Line | Data |
---|---|---|
c587e4a6 RP |
1 | /* |
2 | * machine_kexec.c - handle transition of Linux booting another kernel | |
3 | */ | |
4 | ||
5 | #include <linux/mm.h> | |
6 | #include <linux/kexec.h> | |
7 | #include <linux/delay.h> | |
8 | #include <linux/reboot.h> | |
fced80c7 | 9 | #include <linux/io.h> |
9141a003 | 10 | #include <linux/irq.h> |
c564df4d | 11 | #include <linux/memblock.h> |
c587e4a6 | 12 | #include <asm/pgtable.h> |
4cabd1d9 | 13 | #include <linux/of_fdt.h> |
c587e4a6 RP |
14 | #include <asm/pgalloc.h> |
15 | #include <asm/mmu_context.h> | |
c587e4a6 | 16 | #include <asm/cacheflush.h> |
e2ccba49 | 17 | #include <asm/fncpy.h> |
c587e4a6 | 18 | #include <asm/mach-types.h> |
2103f6cb | 19 | #include <asm/smp_plat.h> |
9f97da78 | 20 | #include <asm/system_misc.h> |
c587e4a6 | 21 | |
e2ccba49 | 22 | extern void relocate_new_kernel(void); |
e0fc4f97 | 23 | extern const unsigned int relocate_new_kernel_size; |
c587e4a6 | 24 | |
c587e4a6 RP |
25 | extern unsigned long kexec_start_address; |
26 | extern unsigned long kexec_indirection_page; | |
27 | extern unsigned long kexec_mach_type; | |
4cd9d6f7 | 28 | extern unsigned long kexec_boot_atags; |
c587e4a6 | 29 | |
b2306531 PF |
30 | static atomic_t waiting_for_crash_ipi; |
31 | ||
42d720d1 | 32 | static unsigned long dt_mem; |
c587e4a6 RP |
33 | /* |
34 | * Provide a dummy crash_notes definition while crash dump arrives to arm. | |
35 | * This prevents breakage of crash_notes attribute in kernel/ksysfs.c. | |
36 | */ | |
37 | ||
38 | int machine_kexec_prepare(struct kimage *image) | |
39 | { | |
4cabd1d9 ML |
40 | struct kexec_segment *current_segment; |
41 | __be32 header; | |
42 | int i, err; | |
43 | ||
2103f6cb SW |
44 | /* |
45 | * Validate that if the current HW supports SMP, then the SW supports | |
46 | * and implements CPU hotplug for the current HW. If not, we won't be | |
47 | * able to kexec reliably, so fail the prepare operation. | |
48 | */ | |
fee3fd4f GU |
49 | if (num_possible_cpus() > 1 && platform_can_secondary_boot() && |
50 | !platform_can_cpu_hotplug()) | |
2103f6cb SW |
51 | return -EINVAL; |
52 | ||
4cabd1d9 ML |
53 | /* |
54 | * No segment at default ATAGs address. try to locate | |
55 | * a dtb using magic. | |
56 | */ | |
57 | for (i = 0; i < image->nr_segments; i++) { | |
58 | current_segment = &image->segment[i]; | |
59 | ||
0719392a | 60 | if (!memblock_is_region_memory(idmap_to_phys(current_segment->mem), |
2456f44d AK |
61 | current_segment->memsz)) |
62 | return -EINVAL; | |
c564df4d | 63 | |
4cabd1d9 ML |
64 | err = get_user(header, (__be32*)current_segment->buf); |
65 | if (err) | |
66 | return err; | |
67 | ||
68 | if (be32_to_cpu(header) == OF_DT_HEADER) | |
42d720d1 | 69 | dt_mem = current_segment->mem; |
4cabd1d9 | 70 | } |
c587e4a6 RP |
71 | return 0; |
72 | } | |
73 | ||
74 | void machine_kexec_cleanup(struct kimage *image) | |
75 | { | |
76 | } | |
77 | ||
b2306531 PF |
78 | void machine_crash_nonpanic_core(void *unused) |
79 | { | |
80 | struct pt_regs regs; | |
81 | ||
82 | crash_setup_regs(®s, NULL); | |
83 | printk(KERN_DEBUG "CPU %u will stop doing anything useful since another CPU has crashed\n", | |
84 | smp_processor_id()); | |
85 | crash_save_cpu(®s, smp_processor_id()); | |
86 | flush_cache_all(); | |
87 | ||
4f9b4fb7 | 88 | set_cpu_online(smp_processor_id(), false); |
b2306531 PF |
89 | atomic_dec(&waiting_for_crash_ipi); |
90 | while (1) | |
91 | cpu_relax(); | |
92 | } | |
93 | ||
9141a003 WD |
94 | static void machine_kexec_mask_interrupts(void) |
95 | { | |
96 | unsigned int i; | |
97 | struct irq_desc *desc; | |
98 | ||
99 | for_each_irq_desc(i, desc) { | |
100 | struct irq_chip *chip; | |
101 | ||
102 | chip = irq_desc_get_chip(desc); | |
103 | if (!chip) | |
104 | continue; | |
105 | ||
106 | if (chip->irq_eoi && irqd_irq_inprogress(&desc->irq_data)) | |
107 | chip->irq_eoi(&desc->irq_data); | |
108 | ||
109 | if (chip->irq_mask) | |
110 | chip->irq_mask(&desc->irq_data); | |
111 | ||
112 | if (chip->irq_disable && !irqd_irq_disabled(&desc->irq_data)) | |
113 | chip->irq_disable(&desc->irq_data); | |
114 | } | |
115 | } | |
116 | ||
c587e4a6 RP |
117 | void machine_crash_shutdown(struct pt_regs *regs) |
118 | { | |
b2306531 PF |
119 | unsigned long msecs; |
120 | ||
c6383620 | 121 | local_irq_disable(); |
b2306531 PF |
122 | |
123 | atomic_set(&waiting_for_crash_ipi, num_online_cpus() - 1); | |
124 | smp_call_function(machine_crash_nonpanic_core, NULL, false); | |
125 | msecs = 1000; /* Wait at most a second for the other cpus to stop */ | |
126 | while ((atomic_read(&waiting_for_crash_ipi) > 0) && msecs) { | |
127 | mdelay(1); | |
128 | msecs--; | |
129 | } | |
130 | if (atomic_read(&waiting_for_crash_ipi) > 0) | |
4ed89f22 | 131 | pr_warn("Non-crashing CPUs did not react to IPI\n"); |
b2306531 | 132 | |
c6383620 | 133 | crash_save_cpu(regs, smp_processor_id()); |
9141a003 | 134 | machine_kexec_mask_interrupts(); |
c6383620 | 135 | |
4ed89f22 | 136 | pr_info("Loading crashdump kernel...\n"); |
c587e4a6 RP |
137 | } |
138 | ||
868d172b EC |
139 | /* |
140 | * Function pointer to optional machine-specific reinitialization | |
141 | */ | |
142 | void (*kexec_reinit)(void); | |
143 | ||
c587e4a6 RP |
144 | void machine_kexec(struct kimage *image) |
145 | { | |
4138323e RK |
146 | unsigned long page_list, reboot_entry_phys; |
147 | void (*reboot_entry)(void); | |
c587e4a6 RP |
148 | void *reboot_code_buffer; |
149 | ||
2103f6cb SW |
150 | /* |
151 | * This can only happen if machine_shutdown() failed to disable some | |
152 | * CPU, and that can only happen if the checks in | |
153 | * machine_kexec_prepare() were not correct. If this fails, we can't | |
154 | * reliably kexec anyway, so BUG_ON is appropriate. | |
155 | */ | |
156 | BUG_ON(num_online_cpus() > 1); | |
abf015f0 RK |
157 | |
158 | page_list = image->head & PAGE_MASK; | |
159 | ||
c587e4a6 RP |
160 | reboot_code_buffer = page_address(image->control_code_page); |
161 | ||
abf015f0 | 162 | /* Prepare parameters for reboot_code_buffer*/ |
80d6b0c2 | 163 | set_kernel_text_rw(); |
abf015f0 RK |
164 | kexec_start_address = image->start; |
165 | kexec_indirection_page = page_list; | |
166 | kexec_mach_type = machine_arch_type; | |
42d720d1 NB |
167 | kexec_boot_atags = dt_mem ?: image->start - KEXEC_ARM_ZIMAGE_OFFSET |
168 | + KEXEC_ARM_ATAGS_OFFSET; | |
abf015f0 RK |
169 | |
170 | /* copy our kernel relocation code to the control code page */ | |
e2ccba49 | 171 | reboot_entry = fncpy(reboot_code_buffer, |
4138323e | 172 | &relocate_new_kernel, |
e2ccba49 | 173 | relocate_new_kernel_size); |
4138323e RK |
174 | |
175 | /* get the identity mapping physical address for the reboot code */ | |
176 | reboot_entry_phys = virt_to_idmap(reboot_entry); | |
abf015f0 | 177 | |
4ed89f22 | 178 | pr_info("Bye!\n"); |
c587e4a6 | 179 | |
868d172b EC |
180 | if (kexec_reinit) |
181 | kexec_reinit(); | |
3bdc3484 | 182 | |
e2ccba49 | 183 | soft_restart(reboot_entry_phys); |
c587e4a6 | 184 | } |
56b700fd LH |
185 | |
186 | void arch_crash_save_vmcoreinfo(void) | |
187 | { | |
188 | #ifdef CONFIG_ARM_LPAE | |
189 | VMCOREINFO_CONFIG(ARM_LPAE); | |
190 | #endif | |
191 | } |