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 RP |
16 | #include <asm/cacheflush.h> |
17 | #include <asm/mach-types.h> | |
9f97da78 | 18 | #include <asm/system_misc.h> |
c587e4a6 | 19 | |
e0fc4f97 TK |
20 | extern const unsigned char relocate_new_kernel[]; |
21 | extern const unsigned int relocate_new_kernel_size; | |
c587e4a6 | 22 | |
c587e4a6 RP |
23 | extern unsigned long kexec_start_address; |
24 | extern unsigned long kexec_indirection_page; | |
25 | extern unsigned long kexec_mach_type; | |
4cd9d6f7 | 26 | extern unsigned long kexec_boot_atags; |
c587e4a6 | 27 | |
b2306531 PF |
28 | static atomic_t waiting_for_crash_ipi; |
29 | ||
c587e4a6 RP |
30 | /* |
31 | * Provide a dummy crash_notes definition while crash dump arrives to arm. | |
32 | * This prevents breakage of crash_notes attribute in kernel/ksysfs.c. | |
33 | */ | |
34 | ||
35 | int machine_kexec_prepare(struct kimage *image) | |
36 | { | |
4cabd1d9 ML |
37 | struct kexec_segment *current_segment; |
38 | __be32 header; | |
39 | int i, err; | |
40 | ||
41 | /* | |
42 | * No segment at default ATAGs address. try to locate | |
43 | * a dtb using magic. | |
44 | */ | |
45 | for (i = 0; i < image->nr_segments; i++) { | |
46 | current_segment = &image->segment[i]; | |
47 | ||
2456f44d AK |
48 | if (!memblock_is_region_memory(current_segment->mem, |
49 | current_segment->memsz)) | |
50 | return -EINVAL; | |
c564df4d | 51 | |
4cabd1d9 ML |
52 | err = get_user(header, (__be32*)current_segment->buf); |
53 | if (err) | |
54 | return err; | |
55 | ||
56 | if (be32_to_cpu(header) == OF_DT_HEADER) | |
57 | kexec_boot_atags = current_segment->mem; | |
58 | } | |
c587e4a6 RP |
59 | return 0; |
60 | } | |
61 | ||
62 | void machine_kexec_cleanup(struct kimage *image) | |
63 | { | |
64 | } | |
65 | ||
b2306531 PF |
66 | void machine_crash_nonpanic_core(void *unused) |
67 | { | |
68 | struct pt_regs regs; | |
69 | ||
70 | crash_setup_regs(®s, NULL); | |
71 | printk(KERN_DEBUG "CPU %u will stop doing anything useful since another CPU has crashed\n", | |
72 | smp_processor_id()); | |
73 | crash_save_cpu(®s, smp_processor_id()); | |
74 | flush_cache_all(); | |
75 | ||
76 | atomic_dec(&waiting_for_crash_ipi); | |
77 | while (1) | |
78 | cpu_relax(); | |
79 | } | |
80 | ||
9141a003 WD |
81 | static void machine_kexec_mask_interrupts(void) |
82 | { | |
83 | unsigned int i; | |
84 | struct irq_desc *desc; | |
85 | ||
86 | for_each_irq_desc(i, desc) { | |
87 | struct irq_chip *chip; | |
88 | ||
89 | chip = irq_desc_get_chip(desc); | |
90 | if (!chip) | |
91 | continue; | |
92 | ||
93 | if (chip->irq_eoi && irqd_irq_inprogress(&desc->irq_data)) | |
94 | chip->irq_eoi(&desc->irq_data); | |
95 | ||
96 | if (chip->irq_mask) | |
97 | chip->irq_mask(&desc->irq_data); | |
98 | ||
99 | if (chip->irq_disable && !irqd_irq_disabled(&desc->irq_data)) | |
100 | chip->irq_disable(&desc->irq_data); | |
101 | } | |
102 | } | |
103 | ||
c587e4a6 RP |
104 | void machine_crash_shutdown(struct pt_regs *regs) |
105 | { | |
b2306531 PF |
106 | unsigned long msecs; |
107 | ||
c6383620 | 108 | local_irq_disable(); |
b2306531 PF |
109 | |
110 | atomic_set(&waiting_for_crash_ipi, num_online_cpus() - 1); | |
111 | smp_call_function(machine_crash_nonpanic_core, NULL, false); | |
112 | msecs = 1000; /* Wait at most a second for the other cpus to stop */ | |
113 | while ((atomic_read(&waiting_for_crash_ipi) > 0) && msecs) { | |
114 | mdelay(1); | |
115 | msecs--; | |
116 | } | |
117 | if (atomic_read(&waiting_for_crash_ipi) > 0) | |
118 | printk(KERN_WARNING "Non-crashing CPUs did not react to IPI\n"); | |
119 | ||
c6383620 | 120 | crash_save_cpu(regs, smp_processor_id()); |
9141a003 | 121 | machine_kexec_mask_interrupts(); |
c6383620 MW |
122 | |
123 | printk(KERN_INFO "Loading crashdump kernel...\n"); | |
c587e4a6 RP |
124 | } |
125 | ||
868d172b EC |
126 | /* |
127 | * Function pointer to optional machine-specific reinitialization | |
128 | */ | |
129 | void (*kexec_reinit)(void); | |
130 | ||
c587e4a6 RP |
131 | void machine_kexec(struct kimage *image) |
132 | { | |
abf015f0 | 133 | unsigned long page_list; |
c587e4a6 RP |
134 | unsigned long reboot_code_buffer_phys; |
135 | void *reboot_code_buffer; | |
136 | ||
19ab428f SW |
137 | if (num_online_cpus() > 1) { |
138 | pr_err("kexec: error: multiple CPUs still online\n"); | |
139 | return; | |
140 | } | |
abf015f0 RK |
141 | |
142 | page_list = image->head & PAGE_MASK; | |
143 | ||
c587e4a6 RP |
144 | /* we need both effective and real address here */ |
145 | reboot_code_buffer_phys = | |
146 | page_to_pfn(image->control_code_page) << PAGE_SHIFT; | |
147 | reboot_code_buffer = page_address(image->control_code_page); | |
148 | ||
abf015f0 RK |
149 | /* Prepare parameters for reboot_code_buffer*/ |
150 | kexec_start_address = image->start; | |
151 | kexec_indirection_page = page_list; | |
152 | kexec_mach_type = machine_arch_type; | |
4cabd1d9 ML |
153 | if (!kexec_boot_atags) |
154 | kexec_boot_atags = image->start - KEXEC_ARM_ZIMAGE_OFFSET + KEXEC_ARM_ATAGS_OFFSET; | |
155 | ||
abf015f0 RK |
156 | |
157 | /* copy our kernel relocation code to the control code page */ | |
158 | memcpy(reboot_code_buffer, | |
159 | relocate_new_kernel, relocate_new_kernel_size); | |
160 | ||
161 | ||
162 | flush_icache_range((unsigned long) reboot_code_buffer, | |
163 | (unsigned long) reboot_code_buffer + KEXEC_CONTROL_PAGE_SIZE); | |
c587e4a6 RP |
164 | printk(KERN_INFO "Bye!\n"); |
165 | ||
868d172b EC |
166 | if (kexec_reinit) |
167 | kexec_reinit(); | |
3bdc3484 WD |
168 | |
169 | soft_restart(reboot_code_buffer_phys); | |
c587e4a6 | 170 | } |