1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/kexec.h>
14#include <linux/smp.h>
15#include <linux/thread_info.h>
16#include <linux/init_task.h>
17#include <linux/errno.h>
18#include <linux/kernel.h>
19#include <linux/cpu.h>
20#include <linux/hardirq.h>
21
22#include <asm/page.h>
23#include <asm/current.h>
24#include <asm/machdep.h>
25#include <asm/cacheflush.h>
26#include <asm/paca.h>
27#include <asm/mmu.h>
28#include <asm/sections.h>
29#include <asm/prom.h>
30#include <asm/smp.h>
31#include <asm/hw_breakpoint.h>
32
33int default_machine_kexec_prepare(struct kimage *image)
34{
35 int i;
36 unsigned long begin, end;
37 unsigned long low, high;
38 struct device_node *node;
39 const unsigned long *basep;
40 const unsigned int *sizep;
41
42 if (!ppc_md.hpte_clear_all)
43 return -ENOENT;
44
45
46
47
48
49
50 for (i = 0; i < image->nr_segments; i++)
51 if (image->segment[i].mem < __pa(_end))
52 return -ETXTBSY;
53
54
55
56
57
58
59
60
61
62
63
64 if (htab_address) {
65 low = __pa(htab_address);
66 high = low + htab_size_bytes;
67
68 for (i = 0; i < image->nr_segments; i++) {
69 begin = image->segment[i].mem;
70 end = begin + image->segment[i].memsz;
71
72 if ((begin < high) && (end > low))
73 return -ETXTBSY;
74 }
75 }
76
77
78 for_each_node_by_type(node, "pci") {
79 basep = of_get_property(node, "linux,tce-base", NULL);
80 sizep = of_get_property(node, "linux,tce-size", NULL);
81 if (basep == NULL || sizep == NULL)
82 continue;
83
84 low = *basep;
85 high = low + (*sizep);
86
87 for (i = 0; i < image->nr_segments; i++) {
88 begin = image->segment[i].mem;
89 end = begin + image->segment[i].memsz;
90
91 if ((begin < high) && (end > low))
92 return -ETXTBSY;
93 }
94 }
95
96 return 0;
97}
98
99#define IND_FLAGS (IND_DESTINATION | IND_INDIRECTION | IND_DONE | IND_SOURCE)
100
101static void copy_segments(unsigned long ind)
102{
103 unsigned long entry;
104 unsigned long *ptr;
105 void *dest;
106 void *addr;
107
108
109
110
111
112
113
114 ptr = NULL;
115 dest = NULL;
116
117 for (entry = ind; !(entry & IND_DONE); entry = *ptr++) {
118 addr = __va(entry & PAGE_MASK);
119
120 switch (entry & IND_FLAGS) {
121 case IND_DESTINATION:
122 dest = addr;
123 break;
124 case IND_INDIRECTION:
125 ptr = addr;
126 break;
127 case IND_SOURCE:
128 copy_page(dest, addr);
129 dest += PAGE_SIZE;
130 }
131 }
132}
133
134void kexec_copy_flush(struct kimage *image)
135{
136 long i, nr_segments = image->nr_segments;
137 struct kexec_segment ranges[KEXEC_SEGMENT_MAX];
138
139
140 memcpy(ranges, image->segment, sizeof(ranges));
141
142
143
144
145
146
147
148 copy_segments(image->head);
149
150
151
152
153
154 for (i = 0; i < nr_segments; i++)
155 flush_icache_range((unsigned long)__va(ranges[i].mem),
156 (unsigned long)__va(ranges[i].mem + ranges[i].memsz));
157}
158
159#ifdef CONFIG_SMP
160
161static int kexec_all_irq_disabled = 0;
162
163static void kexec_smp_down(void *arg)
164{
165 local_irq_disable();
166 hard_irq_disable();
167
168 mb();
169 get_paca()->kexec_state = KEXEC_STATE_IRQS_OFF;
170 while(kexec_all_irq_disabled == 0)
171 cpu_relax();
172 mb();
173 hw_breakpoint_disable();
174
175
176
177
178 if (ppc_md.kexec_cpu_down)
179 ppc_md.kexec_cpu_down(0, 1);
180
181 kexec_smp_wait();
182
183}
184
185static void kexec_prepare_cpus_wait(int wait_state)
186{
187 int my_cpu, i, notified=-1;
188
189 hw_breakpoint_disable();
190 my_cpu = get_cpu();
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205 for_each_online_cpu(i) {
206 if (i == my_cpu)
207 continue;
208
209 while (paca[i].kexec_state < wait_state) {
210 barrier();
211 if (i != notified) {
212 printk(KERN_INFO "kexec: waiting for cpu %d "
213 "(physical %d) to enter %i state\n",
214 i, paca[i].hw_cpu_id, wait_state);
215 notified = i;
216 }
217 }
218 }
219 mb();
220}
221
222
223
224
225
226
227
228
229
230
231
232static void wake_offline_cpus(void)
233{
234 int cpu = 0;
235
236 for_each_present_cpu(cpu) {
237 if (!cpu_online(cpu)) {
238 printk(KERN_INFO "kexec: Waking offline cpu %d.\n",
239 cpu);
240 cpu_up(cpu);
241 }
242 }
243}
244
245static void kexec_prepare_cpus(void)
246{
247 wake_offline_cpus();
248 smp_call_function(kexec_smp_down, NULL, 0);
249 local_irq_disable();
250 hard_irq_disable();
251
252 mb();
253 get_paca()->kexec_state = KEXEC_STATE_IRQS_OFF;
254
255 kexec_prepare_cpus_wait(KEXEC_STATE_IRQS_OFF);
256
257 kexec_all_irq_disabled = 1;
258
259
260 if (ppc_md.kexec_cpu_down)
261 ppc_md.kexec_cpu_down(0, 0);
262
263
264
265
266
267 kexec_prepare_cpus_wait(KEXEC_STATE_REAL_MODE);
268
269 put_cpu();
270}
271
272#else
273
274static void kexec_prepare_cpus(void)
275{
276
277
278
279
280
281
282
283
284
285 smp_release_cpus();
286 if (ppc_md.kexec_cpu_down)
287 ppc_md.kexec_cpu_down(0, 0);
288 local_irq_disable();
289 hard_irq_disable();
290}
291
292#endif
293
294
295
296
297
298
299
300
301
302
303
304
305
306static union thread_union kexec_stack __init_task_data =
307 { };
308
309
310
311
312
313struct paca_struct kexec_paca;
314
315
316extern void kexec_sequence(void *newstack, unsigned long start,
317 void *image, void *control,
318 void (*clear_all)(void)) __noreturn;
319
320
321void default_machine_kexec(struct kimage *image)
322{
323
324
325
326
327
328
329
330
331
332
333 if (crashing_cpu == -1)
334 kexec_prepare_cpus();
335
336 pr_debug("kexec: Starting switchover sequence.\n");
337
338
339
340
341
342 kexec_stack.thread_info.task = current_thread_info()->task;
343 kexec_stack.thread_info.flags = 0;
344 kexec_stack.thread_info.preempt_count = HARDIRQ_OFFSET;
345 kexec_stack.thread_info.cpu = current_thread_info()->cpu;
346
347
348
349
350
351 memcpy(&kexec_paca, get_paca(), sizeof(struct paca_struct));
352 kexec_paca.data_offset = 0xedeaddeadeeeeeeeUL;
353 paca = (struct paca_struct *)RELOC_HIDE(&kexec_paca, 0) -
354 kexec_paca.paca_index;
355 setup_paca(&kexec_paca);
356
357
358
359
360
361
362
363
364 kexec_sequence(&kexec_stack, image->start, image,
365 page_address(image->control_code_page),
366 ppc_md.hpte_clear_all);
367
368}
369
370
371static unsigned long htab_base;
372
373static struct property htab_base_prop = {
374 .name = "linux,htab-base",
375 .length = sizeof(unsigned long),
376 .value = &htab_base,
377};
378
379static struct property htab_size_prop = {
380 .name = "linux,htab-size",
381 .length = sizeof(unsigned long),
382 .value = &htab_size_bytes,
383};
384
385static int __init export_htab_values(void)
386{
387 struct device_node *node;
388 struct property *prop;
389
390
391 if (!htab_address)
392 return -ENODEV;
393
394 node = of_find_node_by_path("/chosen");
395 if (!node)
396 return -ENODEV;
397
398
399 prop = of_find_property(node, htab_base_prop.name, NULL);
400 if (prop)
401 of_remove_property(node, prop);
402 prop = of_find_property(node, htab_size_prop.name, NULL);
403 if (prop)
404 of_remove_property(node, prop);
405
406 htab_base = __pa(htab_address);
407 of_add_property(node, &htab_base_prop);
408 of_add_property(node, &htab_size_prop);
409
410 of_node_put(node);
411 return 0;
412}
413late_initcall(export_htab_values);
414