Blame view

kernel/kexec.c 39.5 KB
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1
2
3
4
5
6
7
  /*
   * kexec.c - kexec system call
   * Copyright (C) 2002-2004 Eric Biederman  <ebiederm@xmission.com>
   *
   * This source code is licensed under the GNU General Public License,
   * Version 2.  See the file COPYING for more details.
   */
c59ede7b7   Randy.Dunlap   [PATCH] move capa...
8
  #include <linux/capability.h>
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
9
10
11
12
13
  #include <linux/mm.h>
  #include <linux/file.h>
  #include <linux/slab.h>
  #include <linux/fs.h>
  #include <linux/kexec.h>
8c5a1cf0a   Andrew Morton   kexec: use a mute...
14
  #include <linux/mutex.h>
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
15
16
17
18
  #include <linux/list.h>
  #include <linux/highmem.h>
  #include <linux/syscalls.h>
  #include <linux/reboot.h>
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
19
  #include <linux/ioport.h>
6e274d144   Alexander Nyberg   [PATCH] kdump: Us...
20
  #include <linux/hardirq.h>
85916f816   Magnus Damm   [PATCH] Kexec / K...
21
22
  #include <linux/elf.h>
  #include <linux/elfcore.h>
273b281fa   Sam Ravnborg   kbuild: move utsr...
23
  #include <generated/utsrelease.h>
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
24
25
  #include <linux/utsname.h>
  #include <linux/numa.h>
3ab835213   Huang Ying   kexec jump
26
27
  #include <linux/suspend.h>
  #include <linux/device.h>
89081d17f   Huang Ying   kexec jump: save/...
28
29
30
31
  #include <linux/freezer.h>
  #include <linux/pm.h>
  #include <linux/cpu.h>
  #include <linux/console.h>
5f41b8cdc   Tony Luck   kexec: fix crash_...
32
  #include <linux/vmalloc.h>
06a7f7112   Amerigo Wang   kexec: premit red...
33
  #include <linux/swap.h>
19234c081   Rafael J. Wysocki   PM: Add missing s...
34
  #include <linux/syscore_ops.h>
6e274d144   Alexander Nyberg   [PATCH] kdump: Us...
35

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
36
37
38
39
  #include <asm/page.h>
  #include <asm/uaccess.h>
  #include <asm/io.h>
  #include <asm/system.h>
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
40
  #include <asm/sections.h>
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
41

cc5716587   Vivek Goyal   [PATCH] kdump: dy...
42
  /* Per cpu memory for storing cpu states in case of system crash. */
43cf38eb5   Tejun Heo   percpu: add __per...
43
  note_buf_t __percpu *crash_notes;
cc5716587   Vivek Goyal   [PATCH] kdump: dy...
44

fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
45
  /* vmcoreinfo stuff */
edb79a213   Dmitri Vorobiev   kexec: vmcoreinfo...
46
  static unsigned char vmcoreinfo_data[VMCOREINFO_BYTES];
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
47
  u32 vmcoreinfo_note[VMCOREINFO_NOTE_SIZE/4];
d768281e9   Ken'ichi Ohmichi   add-vmcore: clean...
48
49
  size_t vmcoreinfo_size;
  size_t vmcoreinfo_max_size = sizeof(vmcoreinfo_data);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
50

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
51
52
53
54
55
56
57
  /* Location of the reserved area for the crash kernel */
  struct resource crashk_res = {
  	.name  = "Crash kernel",
  	.start = 0,
  	.end   = 0,
  	.flags = IORESOURCE_BUSY | IORESOURCE_MEM
  };
6e274d144   Alexander Nyberg   [PATCH] kdump: Us...
58
59
  int kexec_should_crash(struct task_struct *p)
  {
b460cbc58   Serge E. Hallyn   pid namespaces: d...
60
  	if (in_interrupt() || !p->pid || is_global_init(p) || panic_on_oops)
6e274d144   Alexander Nyberg   [PATCH] kdump: Us...
61
62
63
  		return 1;
  	return 0;
  }
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
  /*
   * When kexec transitions to the new kernel there is a one-to-one
   * mapping between physical and virtual addresses.  On processors
   * where you can disable the MMU this is trivial, and easy.  For
   * others it is still a simple predictable page table to setup.
   *
   * In that environment kexec copies the new kernel to its final
   * resting place.  This means I can only support memory whose
   * physical address can fit in an unsigned long.  In particular
   * addresses where (pfn << PAGE_SHIFT) > ULONG_MAX cannot be handled.
   * If the assembly stub has more restrictive requirements
   * KEXEC_SOURCE_MEMORY_LIMIT and KEXEC_DEST_MEMORY_LIMIT can be
   * defined more restrictively in <asm/kexec.h>.
   *
   * The code for the transition from the current kernel to the
   * the new kernel is placed in the control_code_buffer, whose size
163f6876f   Huang Ying   kexec jump: renam...
80
   * is given by KEXEC_CONTROL_PAGE_SIZE.  In the best case only a single
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
   * page of memory is necessary, but some architectures require more.
   * Because this memory must be identity mapped in the transition from
   * virtual to physical addresses it must live in the range
   * 0 - TASK_SIZE, as only the user space mappings are arbitrarily
   * modifiable.
   *
   * The assembly stub in the control code buffer is passed a linked list
   * of descriptor pages detailing the source pages of the new kernel,
   * and the destination addresses of those source pages.  As this data
   * structure is not used in the context of the current OS, it must
   * be self-contained.
   *
   * The code has been made to work with highmem pages and will use a
   * destination page in its final resting place (if it happens
   * to allocate it).  The end product of this is that most of the
   * physical address space, and most of RAM can be used.
   *
   * Future directions include:
   *  - allocating a page table with the control code buffer identity
   *    mapped, to simplify machine_kexec and make kexec_on_panic more
   *    reliable.
   */
  
  /*
   * KIMAGE_NO_DEST is an impossible destination address..., for
   * allocating pages whose destination address we do not care about.
   */
  #define KIMAGE_NO_DEST (-1UL)
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
109
110
111
  static int kimage_is_destination_range(struct kimage *image,
  				       unsigned long start, unsigned long end);
  static struct page *kimage_alloc_page(struct kimage *image,
9796fdd82   Al Viro   [PATCH] gfp_t: ke...
112
  				       gfp_t gfp_mask,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
113
  				       unsigned long dest);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
114
115
  
  static int do_kimage_alloc(struct kimage **rimage, unsigned long entry,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
116
117
  	                    unsigned long nr_segments,
                              struct kexec_segment __user *segments)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
118
119
120
121
122
123
124
125
  {
  	size_t segment_bytes;
  	struct kimage *image;
  	unsigned long i;
  	int result;
  
  	/* Allocate a controlling structure */
  	result = -ENOMEM;
4668edc33   Burman Yan   [PATCH] kernel co...
126
  	image = kzalloc(sizeof(*image), GFP_KERNEL);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
127
  	if (!image)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
128
  		goto out;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
129

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
130
131
132
133
134
135
136
137
138
139
140
141
  	image->head = 0;
  	image->entry = &image->head;
  	image->last_entry = &image->head;
  	image->control_page = ~0; /* By default this does not apply */
  	image->start = entry;
  	image->type = KEXEC_TYPE_DEFAULT;
  
  	/* Initialize the list of control pages */
  	INIT_LIST_HEAD(&image->control_pages);
  
  	/* Initialize the list of destination pages */
  	INIT_LIST_HEAD(&image->dest_pages);
25985edce   Lucas De Marchi   Fix common misspe...
142
  	/* Initialize the list of unusable pages */
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
143
144
145
146
147
148
  	INIT_LIST_HEAD(&image->unuseable_pages);
  
  	/* Read in the segments */
  	image->nr_segments = nr_segments;
  	segment_bytes = nr_segments * sizeof(*segments);
  	result = copy_from_user(image->segment, segments, segment_bytes);
f65a03f6a   Dan Carpenter   kexec: return -EF...
149
150
  	if (result) {
  		result = -EFAULT;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
151
  		goto out;
f65a03f6a   Dan Carpenter   kexec: return -EF...
152
  	}
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
153
154
155
156
157
158
159
160
  
  	/*
  	 * Verify we have good destination addresses.  The caller is
  	 * responsible for making certain we don't attempt to load
  	 * the new image into invalid or reserved areas of RAM.  This
  	 * just verifies it is an address we can use.
  	 *
  	 * Since the kernel does everything in page size chunks ensure
b595076a1   Uwe Kleine-König   tree-wide: fix co...
161
  	 * the destination addresses are page aligned.  Too many
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
162
163
164
165
166
167
168
169
  	 * special cases crop of when we don't do this.  The most
  	 * insidious is getting overlapping destination addresses
  	 * simply because addresses are changed to page size
  	 * granularity.
  	 */
  	result = -EADDRNOTAVAIL;
  	for (i = 0; i < nr_segments; i++) {
  		unsigned long mstart, mend;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
170

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
171
172
173
174
175
176
177
178
179
180
181
182
183
184
  		mstart = image->segment[i].mem;
  		mend   = mstart + image->segment[i].memsz;
  		if ((mstart & ~PAGE_MASK) || (mend & ~PAGE_MASK))
  			goto out;
  		if (mend >= KEXEC_DESTINATION_MEMORY_LIMIT)
  			goto out;
  	}
  
  	/* Verify our destination addresses do not overlap.
  	 * If we alloed overlapping destination addresses
  	 * through very weird things can happen with no
  	 * easy explanation as one segment stops on another.
  	 */
  	result = -EINVAL;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
185
  	for (i = 0; i < nr_segments; i++) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
186
187
  		unsigned long mstart, mend;
  		unsigned long j;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
188

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
189
190
  		mstart = image->segment[i].mem;
  		mend   = mstart + image->segment[i].memsz;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
191
  		for (j = 0; j < i; j++) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
  			unsigned long pstart, pend;
  			pstart = image->segment[j].mem;
  			pend   = pstart + image->segment[j].memsz;
  			/* Do the segments overlap ? */
  			if ((mend > pstart) && (mstart < pend))
  				goto out;
  		}
  	}
  
  	/* Ensure our buffer sizes are strictly less than
  	 * our memory sizes.  This should always be the case,
  	 * and it is easier to check up front than to be surprised
  	 * later on.
  	 */
  	result = -EINVAL;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
207
  	for (i = 0; i < nr_segments; i++) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
208
209
210
  		if (image->segment[i].bufsz > image->segment[i].memsz)
  			goto out;
  	}
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
211
  	result = 0;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
212
213
  out:
  	if (result == 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
214
  		*rimage = image;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
215
  	else
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
216
  		kfree(image);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
217

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
218
219
220
221
222
  	return result;
  
  }
  
  static int kimage_normal_alloc(struct kimage **rimage, unsigned long entry,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
223
224
  				unsigned long nr_segments,
  				struct kexec_segment __user *segments)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
225
226
227
228
229
230
231
  {
  	int result;
  	struct kimage *image;
  
  	/* Allocate and initialize a controlling structure */
  	image = NULL;
  	result = do_kimage_alloc(&image, entry, nr_segments, segments);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
232
  	if (result)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
233
  		goto out;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
234

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
235
236
237
238
239
240
241
242
243
  	*rimage = image;
  
  	/*
  	 * Find a location for the control code buffer, and add it
  	 * the vector of segments so that it's pages will also be
  	 * counted as destination pages.
  	 */
  	result = -ENOMEM;
  	image->control_code_page = kimage_alloc_control_pages(image,
163f6876f   Huang Ying   kexec jump: renam...
244
  					   get_order(KEXEC_CONTROL_PAGE_SIZE));
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
245
246
247
248
249
  	if (!image->control_code_page) {
  		printk(KERN_ERR "Could not allocate control_code_buffer
  ");
  		goto out;
  	}
3ab835213   Huang Ying   kexec jump
250
251
252
253
254
255
  	image->swap_page = kimage_alloc_control_pages(image, 0);
  	if (!image->swap_page) {
  		printk(KERN_ERR "Could not allocate swap buffer
  ");
  		goto out;
  	}
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
256
257
  	result = 0;
   out:
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
258
  	if (result == 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
259
  		*rimage = image;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
260
  	else
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
261
  		kfree(image);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
262

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
263
264
265
266
  	return result;
  }
  
  static int kimage_crash_alloc(struct kimage **rimage, unsigned long entry,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
267
  				unsigned long nr_segments,
314b6a4d8   Alexey Dobriyan   [PATCH] kexec: fi...
268
  				struct kexec_segment __user *segments)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
269
270
271
272
273
274
275
276
277
278
279
280
281
282
  {
  	int result;
  	struct kimage *image;
  	unsigned long i;
  
  	image = NULL;
  	/* Verify we have a valid entry point */
  	if ((entry < crashk_res.start) || (entry > crashk_res.end)) {
  		result = -EADDRNOTAVAIL;
  		goto out;
  	}
  
  	/* Allocate and initialize a controlling structure */
  	result = do_kimage_alloc(&image, entry, nr_segments, segments);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
283
  	if (result)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
284
  		goto out;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
  
  	/* Enable the special crash kernel control page
  	 * allocation policy.
  	 */
  	image->control_page = crashk_res.start;
  	image->type = KEXEC_TYPE_CRASH;
  
  	/*
  	 * Verify we have good destination addresses.  Normally
  	 * the caller is responsible for making certain we don't
  	 * attempt to load the new image into invalid or reserved
  	 * areas of RAM.  But crash kernels are preloaded into a
  	 * reserved area of ram.  We must ensure the addresses
  	 * are in the reserved area otherwise preloading the
  	 * kernel could corrupt things.
  	 */
  	result = -EADDRNOTAVAIL;
  	for (i = 0; i < nr_segments; i++) {
  		unsigned long mstart, mend;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
304

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
305
  		mstart = image->segment[i].mem;
50cccc699   Vivek Goyal   [PATCH] Kexec on ...
306
  		mend = mstart + image->segment[i].memsz - 1;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
307
308
309
310
  		/* Ensure we are within the crash kernel limits */
  		if ((mstart < crashk_res.start) || (mend > crashk_res.end))
  			goto out;
  	}
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
311
312
313
314
315
316
317
  	/*
  	 * Find a location for the control code buffer, and add
  	 * the vector of segments so that it's pages will also be
  	 * counted as destination pages.
  	 */
  	result = -ENOMEM;
  	image->control_code_page = kimage_alloc_control_pages(image,
163f6876f   Huang Ying   kexec jump: renam...
318
  					   get_order(KEXEC_CONTROL_PAGE_SIZE));
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
319
320
321
322
323
324
325
  	if (!image->control_code_page) {
  		printk(KERN_ERR "Could not allocate control_code_buffer
  ");
  		goto out;
  	}
  
  	result = 0;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
326
327
  out:
  	if (result == 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
328
  		*rimage = image;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
329
  	else
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
330
  		kfree(image);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
331

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
332
333
  	return result;
  }
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
334
335
336
  static int kimage_is_destination_range(struct kimage *image,
  					unsigned long start,
  					unsigned long end)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
337
338
339
340
341
  {
  	unsigned long i;
  
  	for (i = 0; i < image->nr_segments; i++) {
  		unsigned long mstart, mend;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
342

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
343
  		mstart = image->segment[i].mem;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
344
345
  		mend = mstart + image->segment[i].memsz;
  		if ((end > mstart) && (start < mend))
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
346
  			return 1;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
347
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
348

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
349
350
  	return 0;
  }
9796fdd82   Al Viro   [PATCH] gfp_t: ke...
351
  static struct page *kimage_alloc_pages(gfp_t gfp_mask, unsigned int order)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
352
353
  {
  	struct page *pages;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
354

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
355
356
357
358
  	pages = alloc_pages(gfp_mask, order);
  	if (pages) {
  		unsigned int count, i;
  		pages->mapping = NULL;
4c21e2f24   Hugh Dickins   [PATCH] mm: split...
359
  		set_page_private(pages, order);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
360
  		count = 1 << order;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
361
  		for (i = 0; i < count; i++)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
362
  			SetPageReserved(pages + i);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
363
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
364

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
365
366
367
368
369
370
  	return pages;
  }
  
  static void kimage_free_pages(struct page *page)
  {
  	unsigned int order, count, i;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
371

4c21e2f24   Hugh Dickins   [PATCH] mm: split...
372
  	order = page_private(page);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
373
  	count = 1 << order;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
374
  	for (i = 0; i < count; i++)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
375
  		ClearPageReserved(page + i);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
376
377
378
379
380
381
  	__free_pages(page, order);
  }
  
  static void kimage_free_page_list(struct list_head *list)
  {
  	struct list_head *pos, *next;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
382

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
383
384
385
386
387
  	list_for_each_safe(pos, next, list) {
  		struct page *page;
  
  		page = list_entry(pos, struct page, lru);
  		list_del(&page->lru);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
388
389
390
  		kimage_free_pages(page);
  	}
  }
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
391
392
  static struct page *kimage_alloc_normal_control_pages(struct kimage *image,
  							unsigned int order)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
  {
  	/* Control pages are special, they are the intermediaries
  	 * that are needed while we copy the rest of the pages
  	 * to their final resting place.  As such they must
  	 * not conflict with either the destination addresses
  	 * or memory the kernel is already using.
  	 *
  	 * The only case where we really need more than one of
  	 * these are for architectures where we cannot disable
  	 * the MMU and must instead generate an identity mapped
  	 * page table for all of the memory.
  	 *
  	 * At worst this runs in O(N) of the image size.
  	 */
  	struct list_head extra_pages;
  	struct page *pages;
  	unsigned int count;
  
  	count = 1 << order;
  	INIT_LIST_HEAD(&extra_pages);
  
  	/* Loop while I can allocate a page and the page allocated
  	 * is a destination page.
  	 */
  	do {
  		unsigned long pfn, epfn, addr, eaddr;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
419

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
420
421
422
423
424
425
426
427
  		pages = kimage_alloc_pages(GFP_KERNEL, order);
  		if (!pages)
  			break;
  		pfn   = page_to_pfn(pages);
  		epfn  = pfn + count;
  		addr  = pfn << PAGE_SHIFT;
  		eaddr = epfn << PAGE_SHIFT;
  		if ((epfn >= (KEXEC_CONTROL_MEMORY_LIMIT >> PAGE_SHIFT)) ||
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
428
  			      kimage_is_destination_range(image, addr, eaddr)) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
429
430
431
  			list_add(&pages->lru, &extra_pages);
  			pages = NULL;
  		}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
432
  	} while (!pages);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
433
434
435
436
437
438
439
440
441
442
443
444
445
446
  	if (pages) {
  		/* Remember the allocated page... */
  		list_add(&pages->lru, &image->control_pages);
  
  		/* Because the page is already in it's destination
  		 * location we will never allocate another page at
  		 * that address.  Therefore kimage_alloc_pages
  		 * will not return it (again) and we don't need
  		 * to give it an entry in image->segment[].
  		 */
  	}
  	/* Deal with the destination pages I have inadvertently allocated.
  	 *
  	 * Ideally I would convert multi-page allocations into single
25985edce   Lucas De Marchi   Fix common misspe...
447
  	 * page allocations, and add everything to image->dest_pages.
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
448
449
450
451
  	 *
  	 * For now it is simpler to just free the pages.
  	 */
  	kimage_free_page_list(&extra_pages);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
452

72414d3f1   Maneesh Soni   [PATCH] kexec cod...
453
  	return pages;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
454
  }
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
455
456
  static struct page *kimage_alloc_crash_control_pages(struct kimage *image,
  						      unsigned int order)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
  {
  	/* Control pages are special, they are the intermediaries
  	 * that are needed while we copy the rest of the pages
  	 * to their final resting place.  As such they must
  	 * not conflict with either the destination addresses
  	 * or memory the kernel is already using.
  	 *
  	 * Control pages are also the only pags we must allocate
  	 * when loading a crash kernel.  All of the other pages
  	 * are specified by the segments and we just memcpy
  	 * into them directly.
  	 *
  	 * The only case where we really need more than one of
  	 * these are for architectures where we cannot disable
  	 * the MMU and must instead generate an identity mapped
  	 * page table for all of the memory.
  	 *
  	 * Given the low demand this implements a very simple
  	 * allocator that finds the first hole of the appropriate
  	 * size in the reserved memory region, and allocates all
  	 * of the memory up to and including the hole.
  	 */
  	unsigned long hole_start, hole_end, size;
  	struct page *pages;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
481

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
482
483
484
485
  	pages = NULL;
  	size = (1 << order) << PAGE_SHIFT;
  	hole_start = (image->control_page + (size - 1)) & ~(size - 1);
  	hole_end   = hole_start + size - 1;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
486
  	while (hole_end <= crashk_res.end) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
487
  		unsigned long i;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
488

3d214faea   Michael Holzheu   [S390] kdump: Add...
489
  		if (hole_end > KEXEC_CRASH_CONTROL_MEMORY_LIMIT)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
490
  			break;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
491
  		if (hole_end > crashk_res.end)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
492
  			break;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
493
  		/* See if I overlap any of the segments */
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
494
  		for (i = 0; i < image->nr_segments; i++) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
495
  			unsigned long mstart, mend;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
496

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
  			mstart = image->segment[i].mem;
  			mend   = mstart + image->segment[i].memsz - 1;
  			if ((hole_end >= mstart) && (hole_start <= mend)) {
  				/* Advance the hole to the end of the segment */
  				hole_start = (mend + (size - 1)) & ~(size - 1);
  				hole_end   = hole_start + size - 1;
  				break;
  			}
  		}
  		/* If I don't overlap any segments I have found my hole! */
  		if (i == image->nr_segments) {
  			pages = pfn_to_page(hole_start >> PAGE_SHIFT);
  			break;
  		}
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
512
  	if (pages)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
513
  		image->control_page = hole_end;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
514

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
515
516
  	return pages;
  }
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
517
518
  struct page *kimage_alloc_control_pages(struct kimage *image,
  					 unsigned int order)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
519
520
  {
  	struct page *pages = NULL;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
521
522
  
  	switch (image->type) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
523
524
525
526
527
528
529
  	case KEXEC_TYPE_DEFAULT:
  		pages = kimage_alloc_normal_control_pages(image, order);
  		break;
  	case KEXEC_TYPE_CRASH:
  		pages = kimage_alloc_crash_control_pages(image, order);
  		break;
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
530

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
531
532
533
534
535
  	return pages;
  }
  
  static int kimage_add_entry(struct kimage *image, kimage_entry_t entry)
  {
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
536
  	if (*image->entry != 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
537
  		image->entry++;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
538

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
539
540
541
  	if (image->entry == image->last_entry) {
  		kimage_entry_t *ind_page;
  		struct page *page;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
542

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
543
  		page = kimage_alloc_page(image, GFP_KERNEL, KIMAGE_NO_DEST);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
544
  		if (!page)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
545
  			return -ENOMEM;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
546

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
547
548
549
  		ind_page = page_address(page);
  		*image->entry = virt_to_phys(ind_page) | IND_INDIRECTION;
  		image->entry = ind_page;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
550
551
  		image->last_entry = ind_page +
  				      ((PAGE_SIZE/sizeof(kimage_entry_t)) - 1);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
552
553
554
555
  	}
  	*image->entry = entry;
  	image->entry++;
  	*image->entry = 0;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
556

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
557
558
  	return 0;
  }
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
559
560
  static int kimage_set_destination(struct kimage *image,
  				   unsigned long destination)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
561
562
563
564
565
  {
  	int result;
  
  	destination &= PAGE_MASK;
  	result = kimage_add_entry(image, destination | IND_DESTINATION);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
566
  	if (result == 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
567
  		image->destination = destination;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
568

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
569
570
571
572
573
574
575
576
577
578
  	return result;
  }
  
  
  static int kimage_add_page(struct kimage *image, unsigned long page)
  {
  	int result;
  
  	page &= PAGE_MASK;
  	result = kimage_add_entry(image, page | IND_SOURCE);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
579
  	if (result == 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
580
  		image->destination += PAGE_SIZE;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
581

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
582
583
584
585
586
587
588
589
  	return result;
  }
  
  
  static void kimage_free_extra_pages(struct kimage *image)
  {
  	/* Walk through and free any extra destination pages I may have */
  	kimage_free_page_list(&image->dest_pages);
25985edce   Lucas De Marchi   Fix common misspe...
590
  	/* Walk through and free any unusable pages I have cached */
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
591
592
593
  	kimage_free_page_list(&image->unuseable_pages);
  
  }
7fccf0326   WANG Cong   kernel/kexec.c: m...
594
  static void kimage_terminate(struct kimage *image)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
595
  {
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
596
  	if (*image->entry != 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
597
  		image->entry++;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
598

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
599
  	*image->entry = IND_DONE;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
  }
  
  #define for_each_kimage_entry(image, ptr, entry) \
  	for (ptr = &image->head; (entry = *ptr) && !(entry & IND_DONE); \
  		ptr = (entry & IND_INDIRECTION)? \
  			phys_to_virt((entry & PAGE_MASK)): ptr +1)
  
  static void kimage_free_entry(kimage_entry_t entry)
  {
  	struct page *page;
  
  	page = pfn_to_page(entry >> PAGE_SHIFT);
  	kimage_free_pages(page);
  }
  
  static void kimage_free(struct kimage *image)
  {
  	kimage_entry_t *ptr, entry;
  	kimage_entry_t ind = 0;
  
  	if (!image)
  		return;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
622

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
623
624
625
626
  	kimage_free_extra_pages(image);
  	for_each_kimage_entry(image, ptr, entry) {
  		if (entry & IND_INDIRECTION) {
  			/* Free the previous indirection page */
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
627
  			if (ind & IND_INDIRECTION)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
628
  				kimage_free_entry(ind);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
629
630
631
632
633
  			/* Save this indirection page until we are
  			 * done with it.
  			 */
  			ind = entry;
  		}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
634
  		else if (entry & IND_SOURCE)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
635
  			kimage_free_entry(entry);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
636
637
  	}
  	/* Free the final indirection page */
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
638
  	if (ind & IND_INDIRECTION)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
639
  		kimage_free_entry(ind);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
640
641
642
643
644
645
646
647
  
  	/* Handle any machine specific cleanup */
  	machine_kexec_cleanup(image);
  
  	/* Free the kexec control pages... */
  	kimage_free_page_list(&image->control_pages);
  	kfree(image);
  }
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
648
649
  static kimage_entry_t *kimage_dst_used(struct kimage *image,
  					unsigned long page)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
650
651
652
653
654
  {
  	kimage_entry_t *ptr, entry;
  	unsigned long destination = 0;
  
  	for_each_kimage_entry(image, ptr, entry) {
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
655
  		if (entry & IND_DESTINATION)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
656
  			destination = entry & PAGE_MASK;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
657
  		else if (entry & IND_SOURCE) {
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
658
  			if (page == destination)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
659
  				return ptr;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
660
661
662
  			destination += PAGE_SIZE;
  		}
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
663

314b6a4d8   Alexey Dobriyan   [PATCH] kexec: fi...
664
  	return NULL;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
665
  }
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
666
  static struct page *kimage_alloc_page(struct kimage *image,
9796fdd82   Al Viro   [PATCH] gfp_t: ke...
667
  					gfp_t gfp_mask,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
668
  					unsigned long destination)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
  {
  	/*
  	 * Here we implement safeguards to ensure that a source page
  	 * is not copied to its destination page before the data on
  	 * the destination page is no longer useful.
  	 *
  	 * To do this we maintain the invariant that a source page is
  	 * either its own destination page, or it is not a
  	 * destination page at all.
  	 *
  	 * That is slightly stronger than required, but the proof
  	 * that no problems will not occur is trivial, and the
  	 * implementation is simply to verify.
  	 *
  	 * When allocating all pages normally this algorithm will run
  	 * in O(N) time, but in the worst case it will run in O(N^2)
  	 * time.   If the runtime is a problem the data structures can
  	 * be fixed.
  	 */
  	struct page *page;
  	unsigned long addr;
  
  	/*
  	 * Walk through the list of destination pages, and see if I
  	 * have a match.
  	 */
  	list_for_each_entry(page, &image->dest_pages, lru) {
  		addr = page_to_pfn(page) << PAGE_SHIFT;
  		if (addr == destination) {
  			list_del(&page->lru);
  			return page;
  		}
  	}
  	page = NULL;
  	while (1) {
  		kimage_entry_t *old;
  
  		/* Allocate a page, if we run out of memory give up */
  		page = kimage_alloc_pages(gfp_mask, 0);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
708
  		if (!page)
314b6a4d8   Alexey Dobriyan   [PATCH] kexec: fi...
709
  			return NULL;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
710
  		/* If the page cannot be used file it away */
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
711
712
  		if (page_to_pfn(page) >
  				(KEXEC_SOURCE_MEMORY_LIMIT >> PAGE_SHIFT)) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
713
714
715
716
717
718
719
720
721
722
  			list_add(&page->lru, &image->unuseable_pages);
  			continue;
  		}
  		addr = page_to_pfn(page) << PAGE_SHIFT;
  
  		/* If it is the destination page we want use it */
  		if (addr == destination)
  			break;
  
  		/* If the page is not a destination page use it */
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
723
724
  		if (!kimage_is_destination_range(image, addr,
  						  addr + PAGE_SIZE))
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
  			break;
  
  		/*
  		 * I know that the page is someones destination page.
  		 * See if there is already a source page for this
  		 * destination page.  And if so swap the source pages.
  		 */
  		old = kimage_dst_used(image, addr);
  		if (old) {
  			/* If so move it */
  			unsigned long old_addr;
  			struct page *old_page;
  
  			old_addr = *old & PAGE_MASK;
  			old_page = pfn_to_page(old_addr >> PAGE_SHIFT);
  			copy_highpage(page, old_page);
  			*old = addr | (*old & ~PAGE_MASK);
  
  			/* The old page I have found cannot be a
f9092f358   Jonathan Steel   kexec: fix segmen...
744
745
  			 * destination page, so return it if it's
  			 * gfp_flags honor the ones passed in.
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
746
  			 */
f9092f358   Jonathan Steel   kexec: fix segmen...
747
748
749
750
751
  			if (!(gfp_mask & __GFP_HIGHMEM) &&
  			    PageHighMem(old_page)) {
  				kimage_free_pages(old_page);
  				continue;
  			}
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
752
753
754
755
756
757
758
759
760
761
762
  			addr = old_addr;
  			page = old_page;
  			break;
  		}
  		else {
  			/* Place the page on the destination list I
  			 * will use it later.
  			 */
  			list_add(&page->lru, &image->dest_pages);
  		}
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
763

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
764
765
766
767
  	return page;
  }
  
  static int kimage_load_normal_segment(struct kimage *image,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
768
  					 struct kexec_segment *segment)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
769
770
771
772
  {
  	unsigned long maddr;
  	unsigned long ubytes, mbytes;
  	int result;
314b6a4d8   Alexey Dobriyan   [PATCH] kexec: fi...
773
  	unsigned char __user *buf;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
774
775
776
777
778
779
780
781
  
  	result = 0;
  	buf = segment->buf;
  	ubytes = segment->bufsz;
  	mbytes = segment->memsz;
  	maddr = segment->mem;
  
  	result = kimage_set_destination(image, maddr);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
782
  	if (result < 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
783
  		goto out;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
784
785
  
  	while (mbytes) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
786
787
788
  		struct page *page;
  		char *ptr;
  		size_t uchunk, mchunk;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
789

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
790
  		page = kimage_alloc_page(image, GFP_HIGHUSER, maddr);
c80544dc0   Stephen Hemminger   sparse pointer us...
791
  		if (!page) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
792
793
794
  			result  = -ENOMEM;
  			goto out;
  		}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
795
796
797
  		result = kimage_add_page(image, page_to_pfn(page)
  								<< PAGE_SHIFT);
  		if (result < 0)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
798
  			goto out;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
799

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
800
801
  		ptr = kmap(page);
  		/* Start with a clear page */
3ecb01df3   Jan Beulich   use clear_page()/...
802
  		clear_page(ptr);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
803
804
  		ptr += maddr & ~PAGE_MASK;
  		mchunk = PAGE_SIZE - (maddr & ~PAGE_MASK);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
805
  		if (mchunk > mbytes)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
806
  			mchunk = mbytes;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
807

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
808
  		uchunk = mchunk;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
809
  		if (uchunk > ubytes)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
810
  			uchunk = ubytes;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
811

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
812
813
814
  		result = copy_from_user(ptr, buf, uchunk);
  		kunmap(page);
  		if (result) {
f65a03f6a   Dan Carpenter   kexec: return -EF...
815
  			result = -EFAULT;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
816
817
818
819
820
821
822
  			goto out;
  		}
  		ubytes -= uchunk;
  		maddr  += mchunk;
  		buf    += mchunk;
  		mbytes -= mchunk;
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
823
  out:
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
824
825
826
827
  	return result;
  }
  
  static int kimage_load_crash_segment(struct kimage *image,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
828
  					struct kexec_segment *segment)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
829
830
831
832
833
834
835
836
  {
  	/* For crash dumps kernels we simply copy the data from
  	 * user space to it's destination.
  	 * We do things a page at a time for the sake of kmap.
  	 */
  	unsigned long maddr;
  	unsigned long ubytes, mbytes;
  	int result;
314b6a4d8   Alexey Dobriyan   [PATCH] kexec: fi...
837
  	unsigned char __user *buf;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
838
839
840
841
842
843
  
  	result = 0;
  	buf = segment->buf;
  	ubytes = segment->bufsz;
  	mbytes = segment->memsz;
  	maddr = segment->mem;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
844
  	while (mbytes) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
845
846
847
  		struct page *page;
  		char *ptr;
  		size_t uchunk, mchunk;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
848

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
849
  		page = pfn_to_page(maddr >> PAGE_SHIFT);
c80544dc0   Stephen Hemminger   sparse pointer us...
850
  		if (!page) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
851
852
853
854
855
856
  			result  = -ENOMEM;
  			goto out;
  		}
  		ptr = kmap(page);
  		ptr += maddr & ~PAGE_MASK;
  		mchunk = PAGE_SIZE - (maddr & ~PAGE_MASK);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
857
  		if (mchunk > mbytes)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
858
  			mchunk = mbytes;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
859

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
860
861
862
863
864
865
866
  		uchunk = mchunk;
  		if (uchunk > ubytes) {
  			uchunk = ubytes;
  			/* Zero the trailing part of the page */
  			memset(ptr + uchunk, 0, mchunk - uchunk);
  		}
  		result = copy_from_user(ptr, buf, uchunk);
a79561134   Zou Nan hai   [IA64] IA64 Kexec...
867
  		kexec_flush_icache_page(page);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
868
869
  		kunmap(page);
  		if (result) {
f65a03f6a   Dan Carpenter   kexec: return -EF...
870
  			result = -EFAULT;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
871
872
873
874
875
876
877
  			goto out;
  		}
  		ubytes -= uchunk;
  		maddr  += mchunk;
  		buf    += mchunk;
  		mbytes -= mchunk;
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
878
  out:
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
879
880
881
882
  	return result;
  }
  
  static int kimage_load_segment(struct kimage *image,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
883
  				struct kexec_segment *segment)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
884
885
  {
  	int result = -ENOMEM;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
886
887
  
  	switch (image->type) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
888
889
890
891
892
893
894
  	case KEXEC_TYPE_DEFAULT:
  		result = kimage_load_normal_segment(image, segment);
  		break;
  	case KEXEC_TYPE_CRASH:
  		result = kimage_load_crash_segment(image, segment);
  		break;
  	}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
895

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
896
897
898
899
900
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
  	return result;
  }
  
  /*
   * Exec Kernel system call: for obvious reasons only root may call it.
   *
   * This call breaks up into three pieces.
   * - A generic part which loads the new kernel from the current
   *   address space, and very carefully places the data in the
   *   allocated pages.
   *
   * - A generic part that interacts with the kernel and tells all of
   *   the devices to shut down.  Preventing on-going dmas, and placing
   *   the devices in a consistent state so a later kernel can
   *   reinitialize them.
   *
   * - A machine specific part that includes the syscall number
   *   and the copies the image to it's final destination.  And
   *   jumps into the image at entry.
   *
   * kexec does not sync, or unmount filesystems so if you need
   * that to happen you need to do that yourself.
   */
c330dda90   Jeff Moyer   [PATCH] Add a sys...
919
920
  struct kimage *kexec_image;
  struct kimage *kexec_crash_image;
8c5a1cf0a   Andrew Morton   kexec: use a mute...
921
922
  
  static DEFINE_MUTEX(kexec_mutex);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
923

754fe8d29   Heiko Carstens   [CVE-2009-0029] S...
924
925
  SYSCALL_DEFINE4(kexec_load, unsigned long, entry, unsigned long, nr_segments,
  		struct kexec_segment __user *, segments, unsigned long, flags)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
926
927
  {
  	struct kimage **dest_image, *image;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
  	int result;
  
  	/* We only trust the superuser with rebooting the system. */
  	if (!capable(CAP_SYS_BOOT))
  		return -EPERM;
  
  	/*
  	 * Verify we have a legal set of flags
  	 * This leaves us room for future extensions.
  	 */
  	if ((flags & KEXEC_FLAGS) != (flags & ~KEXEC_ARCH_MASK))
  		return -EINVAL;
  
  	/* Verify we are on the appropriate architecture */
  	if (((flags & KEXEC_ARCH_MASK) != KEXEC_ARCH) &&
  		((flags & KEXEC_ARCH_MASK) != KEXEC_ARCH_DEFAULT))
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
944
  		return -EINVAL;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
945
946
947
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
  
  	/* Put an artificial cap on the number
  	 * of segments passed to kexec_load.
  	 */
  	if (nr_segments > KEXEC_SEGMENT_MAX)
  		return -EINVAL;
  
  	image = NULL;
  	result = 0;
  
  	/* Because we write directly to the reserved memory
  	 * region when loading crash kernels we need a mutex here to
  	 * prevent multiple crash  kernels from attempting to load
  	 * simultaneously, and to prevent a crash kernel from loading
  	 * over the top of a in use crash kernel.
  	 *
  	 * KISS: always take the mutex.
  	 */
8c5a1cf0a   Andrew Morton   kexec: use a mute...
963
  	if (!mutex_trylock(&kexec_mutex))
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
964
  		return -EBUSY;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
965

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
966
  	dest_image = &kexec_image;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
967
  	if (flags & KEXEC_ON_CRASH)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
968
  		dest_image = &kexec_crash_image;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
969
970
  	if (nr_segments > 0) {
  		unsigned long i;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
971

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
972
  		/* Loading another kernel to reboot into */
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
973
974
975
  		if ((flags & KEXEC_ON_CRASH) == 0)
  			result = kimage_normal_alloc(&image, entry,
  							nr_segments, segments);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
976
977
978
979
980
981
  		/* Loading another kernel to switch to if this one crashes */
  		else if (flags & KEXEC_ON_CRASH) {
  			/* Free any current crash dump kernel before
  			 * we corrupt it.
  			 */
  			kimage_free(xchg(&kexec_crash_image, NULL));
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
982
983
  			result = kimage_crash_alloc(&image, entry,
  						     nr_segments, segments);
558df7209   Michael Holzheu   [S390] kdump: Add...
984
  			crash_map_reserved_pages();
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
985
  		}
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
986
  		if (result)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
987
  			goto out;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
988

3ab835213   Huang Ying   kexec jump
989
990
  		if (flags & KEXEC_PRESERVE_CONTEXT)
  			image->preserve_context = 1;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
991
  		result = machine_kexec_prepare(image);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
992
  		if (result)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
993
  			goto out;
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
994
995
  
  		for (i = 0; i < nr_segments; i++) {
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
996
  			result = kimage_load_segment(image, &image->segment[i]);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
997
  			if (result)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
998
  				goto out;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
999
  		}
7fccf0326   WANG Cong   kernel/kexec.c: m...
1000
  		kimage_terminate(image);
558df7209   Michael Holzheu   [S390] kdump: Add...
1001
1002
  		if (flags & KEXEC_ON_CRASH)
  			crash_unmap_reserved_pages();
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1003
1004
1005
  	}
  	/* Install the new kernel, and  Uninstall the old */
  	image = xchg(dest_image, image);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
1006
  out:
8c5a1cf0a   Andrew Morton   kexec: use a mute...
1007
  	mutex_unlock(&kexec_mutex);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1008
  	kimage_free(image);
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
1009

dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1010
1011
  	return result;
  }
558df7209   Michael Holzheu   [S390] kdump: Add...
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022
  /*
   * Add and remove page tables for crashkernel memory
   *
   * Provide an empty default implementation here -- architecture
   * code may override this
   */
  void __weak crash_map_reserved_pages(void)
  {}
  
  void __weak crash_unmap_reserved_pages(void)
  {}
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1023
1024
  #ifdef CONFIG_COMPAT
  asmlinkage long compat_sys_kexec_load(unsigned long entry,
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
1025
1026
1027
  				unsigned long nr_segments,
  				struct compat_kexec_segment __user *segments,
  				unsigned long flags)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1028
1029
1030
1031
1032
1033
1034
1035
  {
  	struct compat_kexec_segment in;
  	struct kexec_segment out, __user *ksegments;
  	unsigned long i, result;
  
  	/* Don't allow clients that don't understand the native
  	 * architecture to do anything.
  	 */
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
1036
  	if ((flags & KEXEC_ARCH_MASK) == KEXEC_ARCH_DEFAULT)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1037
  		return -EINVAL;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1038

72414d3f1   Maneesh Soni   [PATCH] kexec cod...
1039
  	if (nr_segments > KEXEC_SEGMENT_MAX)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1040
  		return -EINVAL;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1041
1042
1043
1044
  
  	ksegments = compat_alloc_user_space(nr_segments * sizeof(out));
  	for (i=0; i < nr_segments; i++) {
  		result = copy_from_user(&in, &segments[i], sizeof(in));
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
1045
  		if (result)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1046
  			return -EFAULT;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1047
1048
1049
1050
1051
1052
1053
  
  		out.buf   = compat_ptr(in.buf);
  		out.bufsz = in.bufsz;
  		out.mem   = in.mem;
  		out.memsz = in.memsz;
  
  		result = copy_to_user(&ksegments[i], &out, sizeof(out));
72414d3f1   Maneesh Soni   [PATCH] kexec cod...
1054
  		if (result)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1055
  			return -EFAULT;
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1056
1057
1058
1059
1060
  	}
  
  	return sys_kexec_load(entry, nr_segments, ksegments, flags);
  }
  #endif
6e274d144   Alexander Nyberg   [PATCH] kdump: Us...
1061
  void crash_kexec(struct pt_regs *regs)
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1062
  {
8c5a1cf0a   Andrew Morton   kexec: use a mute...
1063
  	/* Take the kexec_mutex here to prevent sys_kexec_load
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1064
1065
1066
1067
1068
1069
1070
  	 * running on one cpu from replacing the crash kernel
  	 * we are using after a panic on a different cpu.
  	 *
  	 * If the crash kernel was not located in a fixed area
  	 * of memory the xchg(&kexec_crash_image) would be
  	 * sufficient.  But since I reuse the memory...
  	 */
8c5a1cf0a   Andrew Morton   kexec: use a mute...
1071
  	if (mutex_trylock(&kexec_mutex)) {
c0ce7d088   David Wilder   [POWERPC] Add the...
1072
  		if (kexec_crash_image) {
e996e5813   Vivek Goyal   [PATCH] kdump: sa...
1073
  			struct pt_regs fixed_regs;
0f4bd46ec   KOSAKI Motohiro   kmsg_dump: Dump o...
1074

e996e5813   Vivek Goyal   [PATCH] kdump: sa...
1075
  			crash_setup_regs(&fixed_regs, regs);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1076
  			crash_save_vmcoreinfo();
e996e5813   Vivek Goyal   [PATCH] kdump: sa...
1077
  			machine_crash_shutdown(&fixed_regs);
c0ce7d088   David Wilder   [POWERPC] Add the...
1078
  			machine_kexec(kexec_crash_image);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1079
  		}
8c5a1cf0a   Andrew Morton   kexec: use a mute...
1080
  		mutex_unlock(&kexec_mutex);
dc009d924   Eric W. Biederman   [PATCH] kexec: ad...
1081
1082
  	}
  }
cc5716587   Vivek Goyal   [PATCH] kdump: dy...
1083

06a7f7112   Amerigo Wang   kexec: premit red...
1084
1085
  size_t crash_get_memory_size(void)
  {
e05bd3367   Pavan Naregundi   kexec: fix Oops i...
1086
  	size_t size = 0;
06a7f7112   Amerigo Wang   kexec: premit red...
1087
  	mutex_lock(&kexec_mutex);
e05bd3367   Pavan Naregundi   kexec: fix Oops i...
1088
  	if (crashk_res.end != crashk_res.start)
28f65c11f   Joe Perches   treewide: Convert...
1089
  		size = resource_size(&crashk_res);
06a7f7112   Amerigo Wang   kexec: premit red...
1090
1091
1092
  	mutex_unlock(&kexec_mutex);
  	return size;
  }
c0bb9e45f   Anton Blanchard   kdump: Allow shri...
1093
1094
  void __weak crash_free_reserved_phys_range(unsigned long begin,
  					   unsigned long end)
06a7f7112   Amerigo Wang   kexec: premit red...
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
  {
  	unsigned long addr;
  
  	for (addr = begin; addr < end; addr += PAGE_SIZE) {
  		ClearPageReserved(pfn_to_page(addr >> PAGE_SHIFT));
  		init_page_count(pfn_to_page(addr >> PAGE_SHIFT));
  		free_page((unsigned long)__va(addr));
  		totalram_pages++;
  	}
  }
  
  int crash_shrink_memory(unsigned long new_size)
  {
  	int ret = 0;
  	unsigned long start, end;
bec013c40   Michael Holzheu   kdump: crashk_res...
1110
  	unsigned long old_size;
6480e5a09   Michael Holzheu   kdump: add missin...
1111
  	struct resource *ram_res;
06a7f7112   Amerigo Wang   kexec: premit red...
1112
1113
1114
1115
1116
1117
1118
1119
1120
  
  	mutex_lock(&kexec_mutex);
  
  	if (kexec_crash_image) {
  		ret = -ENOENT;
  		goto unlock;
  	}
  	start = crashk_res.start;
  	end = crashk_res.end;
bec013c40   Michael Holzheu   kdump: crashk_res...
1121
1122
1123
  	old_size = (end == 0) ? 0 : end - start + 1;
  	if (new_size >= old_size) {
  		ret = (new_size == old_size) ? 0 : -EINVAL;
06a7f7112   Amerigo Wang   kexec: premit red...
1124
1125
  		goto unlock;
  	}
6480e5a09   Michael Holzheu   kdump: add missin...
1126
1127
1128
1129
1130
  	ram_res = kzalloc(sizeof(*ram_res), GFP_KERNEL);
  	if (!ram_res) {
  		ret = -ENOMEM;
  		goto unlock;
  	}
558df7209   Michael Holzheu   [S390] kdump: Add...
1131
1132
  	start = roundup(start, KEXEC_CRASH_MEM_ALIGN);
  	end = roundup(start + new_size, KEXEC_CRASH_MEM_ALIGN);
06a7f7112   Amerigo Wang   kexec: premit red...
1133

558df7209   Michael Holzheu   [S390] kdump: Add...
1134
  	crash_map_reserved_pages();
c0bb9e45f   Anton Blanchard   kdump: Allow shri...
1135
  	crash_free_reserved_phys_range(end, crashk_res.end);
06a7f7112   Amerigo Wang   kexec: premit red...
1136

e05bd3367   Pavan Naregundi   kexec: fix Oops i...
1137
  	if ((start == end) && (crashk_res.parent != NULL))
06a7f7112   Amerigo Wang   kexec: premit red...
1138
  		release_resource(&crashk_res);
6480e5a09   Michael Holzheu   kdump: add missin...
1139
1140
1141
1142
1143
  
  	ram_res->start = end;
  	ram_res->end = crashk_res.end;
  	ram_res->flags = IORESOURCE_BUSY | IORESOURCE_MEM;
  	ram_res->name = "System RAM";
475f9aa6a   Vitaly Mayatskikh   kexec: fix OOPS i...
1144
  	crashk_res.end = end - 1;
6480e5a09   Michael Holzheu   kdump: add missin...
1145
1146
  
  	insert_resource(&iomem_resource, ram_res);
558df7209   Michael Holzheu   [S390] kdump: Add...
1147
  	crash_unmap_reserved_pages();
06a7f7112   Amerigo Wang   kexec: premit red...
1148
1149
1150
1151
1152
  
  unlock:
  	mutex_unlock(&kexec_mutex);
  	return ret;
  }
85916f816   Magnus Damm   [PATCH] Kexec / K...
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
  static u32 *append_elf_note(u32 *buf, char *name, unsigned type, void *data,
  			    size_t data_len)
  {
  	struct elf_note note;
  
  	note.n_namesz = strlen(name) + 1;
  	note.n_descsz = data_len;
  	note.n_type   = type;
  	memcpy(buf, &note, sizeof(note));
  	buf += (sizeof(note) + 3)/4;
  	memcpy(buf, name, note.n_namesz);
  	buf += (note.n_namesz + 3)/4;
  	memcpy(buf, data, note.n_descsz);
  	buf += (note.n_descsz + 3)/4;
  
  	return buf;
  }
  
  static void final_note(u32 *buf)
  {
  	struct elf_note note;
  
  	note.n_namesz = 0;
  	note.n_descsz = 0;
  	note.n_type   = 0;
  	memcpy(buf, &note, sizeof(note));
  }
  
  void crash_save_cpu(struct pt_regs *regs, int cpu)
  {
  	struct elf_prstatus prstatus;
  	u32 *buf;
4f4b6c1a9   Rusty Russell   cpumask: prepare ...
1185
  	if ((cpu < 0) || (cpu >= nr_cpu_ids))
85916f816   Magnus Damm   [PATCH] Kexec / K...
1186
1187
1188
1189
1190
1191
1192
1193
1194
1195
1196
1197
1198
1199
  		return;
  
  	/* Using ELF notes here is opportunistic.
  	 * I need a well defined structure format
  	 * for the data I pass, and I need tags
  	 * on the data to indicate what information I have
  	 * squirrelled away.  ELF notes happen to provide
  	 * all of that, so there is no need to invent something new.
  	 */
  	buf = (u32*)per_cpu_ptr(crash_notes, cpu);
  	if (!buf)
  		return;
  	memset(&prstatus, 0, sizeof(prstatus));
  	prstatus.pr_pid = current->pid;
6cd61c0ba   Tejun Heo   elf: add ELF_CORE...
1200
  	elf_core_copy_kernel_regs(&prstatus.pr_reg, regs);
6672f76a5   Simon Horman   kdump/kexec: calc...
1201
1202
  	buf = append_elf_note(buf, KEXEC_CORE_NOTE_NAME, NT_PRSTATUS,
  		      	      &prstatus, sizeof(prstatus));
85916f816   Magnus Damm   [PATCH] Kexec / K...
1203
1204
  	final_note(buf);
  }
cc5716587   Vivek Goyal   [PATCH] kdump: dy...
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
  static int __init crash_notes_memory_init(void)
  {
  	/* Allocate memory for saving cpu registers. */
  	crash_notes = alloc_percpu(note_buf_t);
  	if (!crash_notes) {
  		printk("Kexec: Memory allocation for saving cpu register"
  		" states failed
  ");
  		return -ENOMEM;
  	}
  	return 0;
  }
  module_init(crash_notes_memory_init)
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1218

cba63c308   Bernhard Walle   Extended crashker...
1219
1220
1221
1222
1223
1224
1225
1226
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279
1280
1281
1282
1283
1284
1285
1286
1287
1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
  
  /*
   * parsing the "crashkernel" commandline
   *
   * this code is intended to be called from architecture specific code
   */
  
  
  /*
   * This function parses command lines in the format
   *
   *   crashkernel=ramsize-range:size[,...][@offset]
   *
   * The function returns 0 on success and -EINVAL on failure.
   */
  static int __init parse_crashkernel_mem(char 			*cmdline,
  					unsigned long long	system_ram,
  					unsigned long long	*crash_size,
  					unsigned long long	*crash_base)
  {
  	char *cur = cmdline, *tmp;
  
  	/* for each entry of the comma-separated list */
  	do {
  		unsigned long long start, end = ULLONG_MAX, size;
  
  		/* get the start of the range */
  		start = memparse(cur, &tmp);
  		if (cur == tmp) {
  			pr_warning("crashkernel: Memory value expected
  ");
  			return -EINVAL;
  		}
  		cur = tmp;
  		if (*cur != '-') {
  			pr_warning("crashkernel: '-' expected
  ");
  			return -EINVAL;
  		}
  		cur++;
  
  		/* if no ':' is here, than we read the end */
  		if (*cur != ':') {
  			end = memparse(cur, &tmp);
  			if (cur == tmp) {
  				pr_warning("crashkernel: Memory "
  						"value expected
  ");
  				return -EINVAL;
  			}
  			cur = tmp;
  			if (end <= start) {
  				pr_warning("crashkernel: end <= start
  ");
  				return -EINVAL;
  			}
  		}
  
  		if (*cur != ':') {
  			pr_warning("crashkernel: ':' expected
  ");
  			return -EINVAL;
  		}
  		cur++;
  
  		size = memparse(cur, &tmp);
  		if (cur == tmp) {
  			pr_warning("Memory value expected
  ");
  			return -EINVAL;
  		}
  		cur = tmp;
  		if (size >= system_ram) {
  			pr_warning("crashkernel: invalid size
  ");
  			return -EINVAL;
  		}
  
  		/* match ? */
be089d79c   Michael Ellerman   kexec: make exten...
1298
  		if (system_ram >= start && system_ram < end) {
cba63c308   Bernhard Walle   Extended crashker...
1299
1300
1301
1302
1303
1304
  			*crash_size = size;
  			break;
  		}
  	} while (*cur++ == ',');
  
  	if (*crash_size > 0) {
11c7da4b0   Hidetoshi Seto   kexec: fix omitti...
1305
  		while (*cur && *cur != ' ' && *cur != '@')
cba63c308   Bernhard Walle   Extended crashker...
1306
1307
1308
1309
1310
1311
1312
1313
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335
1336
1337
1338
1339
1340
1341
1342
1343
1344
1345
1346
1347
1348
1349
1350
1351
1352
1353
1354
1355
1356
1357
1358
1359
1360
1361
1362
1363
1364
1365
1366
1367
1368
1369
1370
1371
1372
1373
1374
1375
1376
1377
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387
1388
1389
1390
  			cur++;
  		if (*cur == '@') {
  			cur++;
  			*crash_base = memparse(cur, &tmp);
  			if (cur == tmp) {
  				pr_warning("Memory value expected "
  						"after '@'
  ");
  				return -EINVAL;
  			}
  		}
  	}
  
  	return 0;
  }
  
  /*
   * That function parses "simple" (old) crashkernel command lines like
   *
   * 	crashkernel=size[@offset]
   *
   * It returns 0 on success and -EINVAL on failure.
   */
  static int __init parse_crashkernel_simple(char 		*cmdline,
  					   unsigned long long 	*crash_size,
  					   unsigned long long 	*crash_base)
  {
  	char *cur = cmdline;
  
  	*crash_size = memparse(cmdline, &cur);
  	if (cmdline == cur) {
  		pr_warning("crashkernel: memory value expected
  ");
  		return -EINVAL;
  	}
  
  	if (*cur == '@')
  		*crash_base = memparse(cur+1, &cur);
  
  	return 0;
  }
  
  /*
   * That function is the entry point for command line parsing and should be
   * called from the arch-specific code.
   */
  int __init parse_crashkernel(char 		 *cmdline,
  			     unsigned long long system_ram,
  			     unsigned long long *crash_size,
  			     unsigned long long *crash_base)
  {
  	char 	*p = cmdline, *ck_cmdline = NULL;
  	char	*first_colon, *first_space;
  
  	BUG_ON(!crash_size || !crash_base);
  	*crash_size = 0;
  	*crash_base = 0;
  
  	/* find crashkernel and use the last one if there are more */
  	p = strstr(p, "crashkernel=");
  	while (p) {
  		ck_cmdline = p;
  		p = strstr(p+1, "crashkernel=");
  	}
  
  	if (!ck_cmdline)
  		return -EINVAL;
  
  	ck_cmdline += 12; /* strlen("crashkernel=") */
  
  	/*
  	 * if the commandline contains a ':', then that's the extended
  	 * syntax -- if not, it must be the classic syntax
  	 */
  	first_colon = strchr(ck_cmdline, ':');
  	first_space = strchr(ck_cmdline, ' ');
  	if (first_colon && (!first_space || first_colon < first_space))
  		return parse_crashkernel_mem(ck_cmdline, system_ram,
  				crash_size, crash_base);
  	else
  		return parse_crashkernel_simple(ck_cmdline, crash_size,
  				crash_base);
  
  	return 0;
  }
fa8ff292b   Michael Holzheu   [S390] kdump: Ini...
1391
  static void update_vmcoreinfo_note(void)
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1392
  {
fa8ff292b   Michael Holzheu   [S390] kdump: Ini...
1393
  	u32 *buf = vmcoreinfo_note;
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1394
1395
1396
  
  	if (!vmcoreinfo_size)
  		return;
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1397
1398
  	buf = append_elf_note(buf, VMCOREINFO_NOTE_NAME, 0, vmcoreinfo_data,
  			      vmcoreinfo_size);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1399
1400
  	final_note(buf);
  }
fa8ff292b   Michael Holzheu   [S390] kdump: Ini...
1401
1402
1403
1404
1405
  void crash_save_vmcoreinfo(void)
  {
  	vmcoreinfo_append_str("CRASHTIME=%ld", get_seconds());
  	update_vmcoreinfo_note();
  }
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1406
1407
1408
1409
1410
1411
1412
1413
1414
1415
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431
1432
1433
1434
1435
1436
1437
  void vmcoreinfo_append_str(const char *fmt, ...)
  {
  	va_list args;
  	char buf[0x50];
  	int r;
  
  	va_start(args, fmt);
  	r = vsnprintf(buf, sizeof(buf), fmt, args);
  	va_end(args);
  
  	if (r + vmcoreinfo_size > vmcoreinfo_max_size)
  		r = vmcoreinfo_max_size - vmcoreinfo_size;
  
  	memcpy(&vmcoreinfo_data[vmcoreinfo_size], buf, r);
  
  	vmcoreinfo_size += r;
  }
  
  /*
   * provide an empty default implementation here -- architecture
   * code may override this
   */
  void __attribute__ ((weak)) arch_crash_save_vmcoreinfo(void)
  {}
  
  unsigned long __attribute__ ((weak)) paddr_vmcoreinfo_note(void)
  {
  	return __pa((unsigned long)(char *)&vmcoreinfo_note);
  }
  
  static int __init crash_save_vmcoreinfo_init(void)
  {
bba1f603b   Ken'ichi Ohmichi   vmcoreinfo: add "...
1438
1439
  	VMCOREINFO_OSRELEASE(init_uts_ns.name.release);
  	VMCOREINFO_PAGESIZE(PAGE_SIZE);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1440

bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1441
1442
1443
1444
  	VMCOREINFO_SYMBOL(init_uts_ns);
  	VMCOREINFO_SYMBOL(node_online_map);
  	VMCOREINFO_SYMBOL(swapper_pg_dir);
  	VMCOREINFO_SYMBOL(_stext);
acd99dbf5   Ken'ichi Ohmichi   kdump: add vmlist...
1445
  	VMCOREINFO_SYMBOL(vmlist);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1446
1447
  
  #ifndef CONFIG_NEED_MULTIPLE_NODES
bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1448
1449
  	VMCOREINFO_SYMBOL(mem_map);
  	VMCOREINFO_SYMBOL(contig_page_data);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1450
1451
  #endif
  #ifdef CONFIG_SPARSEMEM
bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1452
1453
  	VMCOREINFO_SYMBOL(mem_section);
  	VMCOREINFO_LENGTH(mem_section, NR_SECTION_ROOTS);
c76f860c4   Ken'ichi Ohmichi   vmcoreinfo: renam...
1454
  	VMCOREINFO_STRUCT_SIZE(mem_section);
bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1455
  	VMCOREINFO_OFFSET(mem_section, section_mem_map);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1456
  #endif
c76f860c4   Ken'ichi Ohmichi   vmcoreinfo: renam...
1457
1458
1459
1460
1461
1462
  	VMCOREINFO_STRUCT_SIZE(page);
  	VMCOREINFO_STRUCT_SIZE(pglist_data);
  	VMCOREINFO_STRUCT_SIZE(zone);
  	VMCOREINFO_STRUCT_SIZE(free_area);
  	VMCOREINFO_STRUCT_SIZE(list_head);
  	VMCOREINFO_SIZE(nodemask_t);
bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1463
1464
1465
1466
1467
1468
  	VMCOREINFO_OFFSET(page, flags);
  	VMCOREINFO_OFFSET(page, _count);
  	VMCOREINFO_OFFSET(page, mapping);
  	VMCOREINFO_OFFSET(page, lru);
  	VMCOREINFO_OFFSET(pglist_data, node_zones);
  	VMCOREINFO_OFFSET(pglist_data, nr_zones);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1469
  #ifdef CONFIG_FLAT_NODE_MEM_MAP
bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1470
  	VMCOREINFO_OFFSET(pglist_data, node_mem_map);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1471
  #endif
bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1472
1473
1474
1475
1476
1477
1478
1479
1480
  	VMCOREINFO_OFFSET(pglist_data, node_start_pfn);
  	VMCOREINFO_OFFSET(pglist_data, node_spanned_pages);
  	VMCOREINFO_OFFSET(pglist_data, node_id);
  	VMCOREINFO_OFFSET(zone, free_area);
  	VMCOREINFO_OFFSET(zone, vm_stat);
  	VMCOREINFO_OFFSET(zone, spanned_pages);
  	VMCOREINFO_OFFSET(free_area, free_list);
  	VMCOREINFO_OFFSET(list_head, next);
  	VMCOREINFO_OFFSET(list_head, prev);
acd99dbf5   Ken'ichi Ohmichi   kdump: add vmlist...
1481
  	VMCOREINFO_OFFSET(vm_struct, addr);
bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1482
  	VMCOREINFO_LENGTH(zone.free_area, MAX_ORDER);
04d491ab2   Neil Horman   kexec: add dmesg ...
1483
  	log_buf_kexec_setup();
83a08e7c6   Ken'ichi Ohmichi   vmcoreinfo: add t...
1484
  	VMCOREINFO_LENGTH(free_area.free_list, MIGRATE_TYPES);
bcbba6c10   Ken'ichi Ohmichi   add-vmcore: add a...
1485
  	VMCOREINFO_NUMBER(NR_FREE_PAGES);
122c7a590   Ken'ichi Ohmichi   vmcoreinfo: add p...
1486
1487
1488
  	VMCOREINFO_NUMBER(PG_lru);
  	VMCOREINFO_NUMBER(PG_private);
  	VMCOREINFO_NUMBER(PG_swapcache);
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1489
1490
  
  	arch_crash_save_vmcoreinfo();
fa8ff292b   Michael Holzheu   [S390] kdump: Ini...
1491
  	update_vmcoreinfo_note();
fd59d231f   Ken'ichi Ohmichi   Add vmcoreinfo
1492
1493
1494
1495
1496
  
  	return 0;
  }
  
  module_init(crash_save_vmcoreinfo_init)
3ab835213   Huang Ying   kexec jump
1497

7ade3fcc1   Huang Ying   kexec jump: clean...
1498
1499
1500
  /*
   * Move into place and start executing a preloaded standalone
   * executable.  If nothing was preloaded return an error.
3ab835213   Huang Ying   kexec jump
1501
1502
1503
1504
   */
  int kernel_kexec(void)
  {
  	int error = 0;
8c5a1cf0a   Andrew Morton   kexec: use a mute...
1505
  	if (!mutex_trylock(&kexec_mutex))
3ab835213   Huang Ying   kexec jump
1506
1507
1508
1509
1510
  		return -EBUSY;
  	if (!kexec_image) {
  		error = -EINVAL;
  		goto Unlock;
  	}
3ab835213   Huang Ying   kexec jump
1511
  #ifdef CONFIG_KEXEC_JUMP
7ade3fcc1   Huang Ying   kexec jump: clean...
1512
  	if (kexec_image->preserve_context) {
bcda53faf   Srivatsa S. Bhat   PM / Sleep: Repla...
1513
  		lock_system_sleep();
89081d17f   Huang Ying   kexec jump: save/...
1514
1515
1516
1517
1518
1519
1520
  		pm_prepare_console();
  		error = freeze_processes();
  		if (error) {
  			error = -EBUSY;
  			goto Restore_console;
  		}
  		suspend_console();
d16163029   Alan Stern   PM core: rename s...
1521
  		error = dpm_suspend_start(PMSG_FREEZE);
89081d17f   Huang Ying   kexec jump: save/...
1522
1523
  		if (error)
  			goto Resume_console;
d16163029   Alan Stern   PM core: rename s...
1524
1525
1526
  		/* At this point, dpm_suspend_start() has been called,
  		 * but *not* dpm_suspend_noirq(). We *must* call
  		 * dpm_suspend_noirq() now.  Otherwise, drivers for
89081d17f   Huang Ying   kexec jump: save/...
1527
1528
1529
1530
  		 * some devices (e.g. interrupt controllers) become
  		 * desynchronized with the actual state of the
  		 * hardware at resume time, and evil weirdness ensues.
  		 */
d16163029   Alan Stern   PM core: rename s...
1531
  		error = dpm_suspend_noirq(PMSG_FREEZE);
89081d17f   Huang Ying   kexec jump: save/...
1532
  		if (error)
749b0afc3   Rafael J. Wysocki   kexec: Change kex...
1533
1534
1535
1536
  			goto Resume_devices;
  		error = disable_nonboot_cpus();
  		if (error)
  			goto Enable_cpus;
2ed8d2b3a   Rafael J. Wysocki   PM: Rework handli...
1537
  		local_irq_disable();
2e711c04d   Rafael J. Wysocki   PM: Remove sysdev...
1538
  		error = syscore_suspend();
770824bdc   Rafael J. Wysocki   PM: Split up sysd...
1539
  		if (error)
749b0afc3   Rafael J. Wysocki   kexec: Change kex...
1540
  			goto Enable_irqs;
7ade3fcc1   Huang Ying   kexec jump: clean...
1541
  	} else
3ab835213   Huang Ying   kexec jump
1542
  #endif
7ade3fcc1   Huang Ying   kexec jump: clean...
1543
  	{
ca195b7f6   Huang Ying   kexec jump: remov...
1544
  		kernel_restart_prepare(NULL);
3ab835213   Huang Ying   kexec jump
1545
1546
1547
1548
1549
1550
  		printk(KERN_EMERG "Starting new kernel
  ");
  		machine_shutdown();
  	}
  
  	machine_kexec(kexec_image);
3ab835213   Huang Ying   kexec jump
1551
  #ifdef CONFIG_KEXEC_JUMP
7ade3fcc1   Huang Ying   kexec jump: clean...
1552
  	if (kexec_image->preserve_context) {
19234c081   Rafael J. Wysocki   PM: Add missing s...
1553
  		syscore_resume();
749b0afc3   Rafael J. Wysocki   kexec: Change kex...
1554
   Enable_irqs:
3ab835213   Huang Ying   kexec jump
1555
  		local_irq_enable();
749b0afc3   Rafael J. Wysocki   kexec: Change kex...
1556
   Enable_cpus:
89081d17f   Huang Ying   kexec jump: save/...
1557
  		enable_nonboot_cpus();
d16163029   Alan Stern   PM core: rename s...
1558
  		dpm_resume_noirq(PMSG_RESTORE);
89081d17f   Huang Ying   kexec jump: save/...
1559
   Resume_devices:
d16163029   Alan Stern   PM core: rename s...
1560
  		dpm_resume_end(PMSG_RESTORE);
89081d17f   Huang Ying   kexec jump: save/...
1561
1562
1563
1564
1565
   Resume_console:
  		resume_console();
  		thaw_processes();
   Restore_console:
  		pm_restore_console();
bcda53faf   Srivatsa S. Bhat   PM / Sleep: Repla...
1566
  		unlock_system_sleep();
3ab835213   Huang Ying   kexec jump
1567
  	}
7ade3fcc1   Huang Ying   kexec jump: clean...
1568
  #endif
3ab835213   Huang Ying   kexec jump
1569
1570
  
   Unlock:
8c5a1cf0a   Andrew Morton   kexec: use a mute...
1571
  	mutex_unlock(&kexec_mutex);
3ab835213   Huang Ying   kexec jump
1572
1573
  	return error;
  }