Merge git://git.kernel.org/pub/scm/linux/kernel/git/jejb/scsi-misc-2.6
[pandora-kernel.git] / kernel / kexec.c
1 /*
2  * kexec.c - kexec system call
3  * Copyright (C) 2002-2004 Eric Biederman  <ebiederm@xmission.com>
4  *
5  * This source code is licensed under the GNU General Public License,
6  * Version 2.  See the file COPYING for more details.
7  */
8
9 #include <linux/capability.h>
10 #include <linux/mm.h>
11 #include <linux/file.h>
12 #include <linux/slab.h>
13 #include <linux/fs.h>
14 #include <linux/kexec.h>
15 #include <linux/mutex.h>
16 #include <linux/list.h>
17 #include <linux/highmem.h>
18 #include <linux/syscalls.h>
19 #include <linux/reboot.h>
20 #include <linux/ioport.h>
21 #include <linux/hardirq.h>
22 #include <linux/elf.h>
23 #include <linux/elfcore.h>
24 #include <linux/utsrelease.h>
25 #include <linux/utsname.h>
26 #include <linux/numa.h>
27 #include <linux/suspend.h>
28 #include <linux/device.h>
29 #include <linux/freezer.h>
30 #include <linux/pm.h>
31 #include <linux/cpu.h>
32 #include <linux/console.h>
33 #include <linux/vmalloc.h>
34
35 #include <asm/page.h>
36 #include <asm/uaccess.h>
37 #include <asm/io.h>
38 #include <asm/system.h>
39 #include <asm/sections.h>
40
41 /* Per cpu memory for storing cpu states in case of system crash. */
42 note_buf_t* crash_notes;
43
44 /* vmcoreinfo stuff */
45 unsigned char vmcoreinfo_data[VMCOREINFO_BYTES];
46 u32 vmcoreinfo_note[VMCOREINFO_NOTE_SIZE/4];
47 size_t vmcoreinfo_size;
48 size_t vmcoreinfo_max_size = sizeof(vmcoreinfo_data);
49
50 /* Location of the reserved area for the crash kernel */
51 struct resource crashk_res = {
52         .name  = "Crash kernel",
53         .start = 0,
54         .end   = 0,
55         .flags = IORESOURCE_BUSY | IORESOURCE_MEM
56 };
57
58 int kexec_should_crash(struct task_struct *p)
59 {
60         if (in_interrupt() || !p->pid || is_global_init(p) || panic_on_oops)
61                 return 1;
62         return 0;
63 }
64
65 /*
66  * When kexec transitions to the new kernel there is a one-to-one
67  * mapping between physical and virtual addresses.  On processors
68  * where you can disable the MMU this is trivial, and easy.  For
69  * others it is still a simple predictable page table to setup.
70  *
71  * In that environment kexec copies the new kernel to its final
72  * resting place.  This means I can only support memory whose
73  * physical address can fit in an unsigned long.  In particular
74  * addresses where (pfn << PAGE_SHIFT) > ULONG_MAX cannot be handled.
75  * If the assembly stub has more restrictive requirements
76  * KEXEC_SOURCE_MEMORY_LIMIT and KEXEC_DEST_MEMORY_LIMIT can be
77  * defined more restrictively in <asm/kexec.h>.
78  *
79  * The code for the transition from the current kernel to the
80  * the new kernel is placed in the control_code_buffer, whose size
81  * is given by KEXEC_CONTROL_PAGE_SIZE.  In the best case only a single
82  * page of memory is necessary, but some architectures require more.
83  * Because this memory must be identity mapped in the transition from
84  * virtual to physical addresses it must live in the range
85  * 0 - TASK_SIZE, as only the user space mappings are arbitrarily
86  * modifiable.
87  *
88  * The assembly stub in the control code buffer is passed a linked list
89  * of descriptor pages detailing the source pages of the new kernel,
90  * and the destination addresses of those source pages.  As this data
91  * structure is not used in the context of the current OS, it must
92  * be self-contained.
93  *
94  * The code has been made to work with highmem pages and will use a
95  * destination page in its final resting place (if it happens
96  * to allocate it).  The end product of this is that most of the
97  * physical address space, and most of RAM can be used.
98  *
99  * Future directions include:
100  *  - allocating a page table with the control code buffer identity
101  *    mapped, to simplify machine_kexec and make kexec_on_panic more
102  *    reliable.
103  */
104
105 /*
106  * KIMAGE_NO_DEST is an impossible destination address..., for
107  * allocating pages whose destination address we do not care about.
108  */
109 #define KIMAGE_NO_DEST (-1UL)
110
111 static int kimage_is_destination_range(struct kimage *image,
112                                        unsigned long start, unsigned long end);
113 static struct page *kimage_alloc_page(struct kimage *image,
114                                        gfp_t gfp_mask,
115                                        unsigned long dest);
116
117 static int do_kimage_alloc(struct kimage **rimage, unsigned long entry,
118                             unsigned long nr_segments,
119                             struct kexec_segment __user *segments)
120 {
121         size_t segment_bytes;
122         struct kimage *image;
123         unsigned long i;
124         int result;
125
126         /* Allocate a controlling structure */
127         result = -ENOMEM;
128         image = kzalloc(sizeof(*image), GFP_KERNEL);
129         if (!image)
130                 goto out;
131
132         image->head = 0;
133         image->entry = &image->head;
134         image->last_entry = &image->head;
135         image->control_page = ~0; /* By default this does not apply */
136         image->start = entry;
137         image->type = KEXEC_TYPE_DEFAULT;
138
139         /* Initialize the list of control pages */
140         INIT_LIST_HEAD(&image->control_pages);
141
142         /* Initialize the list of destination pages */
143         INIT_LIST_HEAD(&image->dest_pages);
144
145         /* Initialize the list of unuseable pages */
146         INIT_LIST_HEAD(&image->unuseable_pages);
147
148         /* Read in the segments */
149         image->nr_segments = nr_segments;
150         segment_bytes = nr_segments * sizeof(*segments);
151         result = copy_from_user(image->segment, segments, segment_bytes);
152         if (result)
153                 goto out;
154
155         /*
156          * Verify we have good destination addresses.  The caller is
157          * responsible for making certain we don't attempt to load
158          * the new image into invalid or reserved areas of RAM.  This
159          * just verifies it is an address we can use.
160          *
161          * Since the kernel does everything in page size chunks ensure
162          * the destination addreses are page aligned.  Too many
163          * special cases crop of when we don't do this.  The most
164          * insidious is getting overlapping destination addresses
165          * simply because addresses are changed to page size
166          * granularity.
167          */
168         result = -EADDRNOTAVAIL;
169         for (i = 0; i < nr_segments; i++) {
170                 unsigned long mstart, mend;
171
172                 mstart = image->segment[i].mem;
173                 mend   = mstart + image->segment[i].memsz;
174                 if ((mstart & ~PAGE_MASK) || (mend & ~PAGE_MASK))
175                         goto out;
176                 if (mend >= KEXEC_DESTINATION_MEMORY_LIMIT)
177                         goto out;
178         }
179
180         /* Verify our destination addresses do not overlap.
181          * If we alloed overlapping destination addresses
182          * through very weird things can happen with no
183          * easy explanation as one segment stops on another.
184          */
185         result = -EINVAL;
186         for (i = 0; i < nr_segments; i++) {
187                 unsigned long mstart, mend;
188                 unsigned long j;
189
190                 mstart = image->segment[i].mem;
191                 mend   = mstart + image->segment[i].memsz;
192                 for (j = 0; j < i; j++) {
193                         unsigned long pstart, pend;
194                         pstart = image->segment[j].mem;
195                         pend   = pstart + image->segment[j].memsz;
196                         /* Do the segments overlap ? */
197                         if ((mend > pstart) && (mstart < pend))
198                                 goto out;
199                 }
200         }
201
202         /* Ensure our buffer sizes are strictly less than
203          * our memory sizes.  This should always be the case,
204          * and it is easier to check up front than to be surprised
205          * later on.
206          */
207         result = -EINVAL;
208         for (i = 0; i < nr_segments; i++) {
209                 if (image->segment[i].bufsz > image->segment[i].memsz)
210                         goto out;
211         }
212
213         result = 0;
214 out:
215         if (result == 0)
216                 *rimage = image;
217         else
218                 kfree(image);
219
220         return result;
221
222 }
223
224 static int kimage_normal_alloc(struct kimage **rimage, unsigned long entry,
225                                 unsigned long nr_segments,
226                                 struct kexec_segment __user *segments)
227 {
228         int result;
229         struct kimage *image;
230
231         /* Allocate and initialize a controlling structure */
232         image = NULL;
233         result = do_kimage_alloc(&image, entry, nr_segments, segments);
234         if (result)
235                 goto out;
236
237         *rimage = image;
238
239         /*
240          * Find a location for the control code buffer, and add it
241          * the vector of segments so that it's pages will also be
242          * counted as destination pages.
243          */
244         result = -ENOMEM;
245         image->control_code_page = kimage_alloc_control_pages(image,
246                                            get_order(KEXEC_CONTROL_PAGE_SIZE));
247         if (!image->control_code_page) {
248                 printk(KERN_ERR "Could not allocate control_code_buffer\n");
249                 goto out;
250         }
251
252         image->swap_page = kimage_alloc_control_pages(image, 0);
253         if (!image->swap_page) {
254                 printk(KERN_ERR "Could not allocate swap buffer\n");
255                 goto out;
256         }
257
258         result = 0;
259  out:
260         if (result == 0)
261                 *rimage = image;
262         else
263                 kfree(image);
264
265         return result;
266 }
267
268 static int kimage_crash_alloc(struct kimage **rimage, unsigned long entry,
269                                 unsigned long nr_segments,
270                                 struct kexec_segment __user *segments)
271 {
272         int result;
273         struct kimage *image;
274         unsigned long i;
275
276         image = NULL;
277         /* Verify we have a valid entry point */
278         if ((entry < crashk_res.start) || (entry > crashk_res.end)) {
279                 result = -EADDRNOTAVAIL;
280                 goto out;
281         }
282
283         /* Allocate and initialize a controlling structure */
284         result = do_kimage_alloc(&image, entry, nr_segments, segments);
285         if (result)
286                 goto out;
287
288         /* Enable the special crash kernel control page
289          * allocation policy.
290          */
291         image->control_page = crashk_res.start;
292         image->type = KEXEC_TYPE_CRASH;
293
294         /*
295          * Verify we have good destination addresses.  Normally
296          * the caller is responsible for making certain we don't
297          * attempt to load the new image into invalid or reserved
298          * areas of RAM.  But crash kernels are preloaded into a
299          * reserved area of ram.  We must ensure the addresses
300          * are in the reserved area otherwise preloading the
301          * kernel could corrupt things.
302          */
303         result = -EADDRNOTAVAIL;
304         for (i = 0; i < nr_segments; i++) {
305                 unsigned long mstart, mend;
306
307                 mstart = image->segment[i].mem;
308                 mend = mstart + image->segment[i].memsz - 1;
309                 /* Ensure we are within the crash kernel limits */
310                 if ((mstart < crashk_res.start) || (mend > crashk_res.end))
311                         goto out;
312         }
313
314         /*
315          * Find a location for the control code buffer, and add
316          * the vector of segments so that it's pages will also be
317          * counted as destination pages.
318          */
319         result = -ENOMEM;
320         image->control_code_page = kimage_alloc_control_pages(image,
321                                            get_order(KEXEC_CONTROL_PAGE_SIZE));
322         if (!image->control_code_page) {
323                 printk(KERN_ERR "Could not allocate control_code_buffer\n");
324                 goto out;
325         }
326
327         result = 0;
328 out:
329         if (result == 0)
330                 *rimage = image;
331         else
332                 kfree(image);
333
334         return result;
335 }
336
337 static int kimage_is_destination_range(struct kimage *image,
338                                         unsigned long start,
339                                         unsigned long end)
340 {
341         unsigned long i;
342
343         for (i = 0; i < image->nr_segments; i++) {
344                 unsigned long mstart, mend;
345
346                 mstart = image->segment[i].mem;
347                 mend = mstart + image->segment[i].memsz;
348                 if ((end > mstart) && (start < mend))
349                         return 1;
350         }
351
352         return 0;
353 }
354
355 static struct page *kimage_alloc_pages(gfp_t gfp_mask, unsigned int order)
356 {
357         struct page *pages;
358
359         pages = alloc_pages(gfp_mask, order);
360         if (pages) {
361                 unsigned int count, i;
362                 pages->mapping = NULL;
363                 set_page_private(pages, order);
364                 count = 1 << order;
365                 for (i = 0; i < count; i++)
366                         SetPageReserved(pages + i);
367         }
368
369         return pages;
370 }
371
372 static void kimage_free_pages(struct page *page)
373 {
374         unsigned int order, count, i;
375
376         order = page_private(page);
377         count = 1 << order;
378         for (i = 0; i < count; i++)
379                 ClearPageReserved(page + i);
380         __free_pages(page, order);
381 }
382
383 static void kimage_free_page_list(struct list_head *list)
384 {
385         struct list_head *pos, *next;
386
387         list_for_each_safe(pos, next, list) {
388                 struct page *page;
389
390                 page = list_entry(pos, struct page, lru);
391                 list_del(&page->lru);
392                 kimage_free_pages(page);
393         }
394 }
395
396 static struct page *kimage_alloc_normal_control_pages(struct kimage *image,
397                                                         unsigned int order)
398 {
399         /* Control pages are special, they are the intermediaries
400          * that are needed while we copy the rest of the pages
401          * to their final resting place.  As such they must
402          * not conflict with either the destination addresses
403          * or memory the kernel is already using.
404          *
405          * The only case where we really need more than one of
406          * these are for architectures where we cannot disable
407          * the MMU and must instead generate an identity mapped
408          * page table for all of the memory.
409          *
410          * At worst this runs in O(N) of the image size.
411          */
412         struct list_head extra_pages;
413         struct page *pages;
414         unsigned int count;
415
416         count = 1 << order;
417         INIT_LIST_HEAD(&extra_pages);
418
419         /* Loop while I can allocate a page and the page allocated
420          * is a destination page.
421          */
422         do {
423                 unsigned long pfn, epfn, addr, eaddr;
424
425                 pages = kimage_alloc_pages(GFP_KERNEL, order);
426                 if (!pages)
427                         break;
428                 pfn   = page_to_pfn(pages);
429                 epfn  = pfn + count;
430                 addr  = pfn << PAGE_SHIFT;
431                 eaddr = epfn << PAGE_SHIFT;
432                 if ((epfn >= (KEXEC_CONTROL_MEMORY_LIMIT >> PAGE_SHIFT)) ||
433                               kimage_is_destination_range(image, addr, eaddr)) {
434                         list_add(&pages->lru, &extra_pages);
435                         pages = NULL;
436                 }
437         } while (!pages);
438
439         if (pages) {
440                 /* Remember the allocated page... */
441                 list_add(&pages->lru, &image->control_pages);
442
443                 /* Because the page is already in it's destination
444                  * location we will never allocate another page at
445                  * that address.  Therefore kimage_alloc_pages
446                  * will not return it (again) and we don't need
447                  * to give it an entry in image->segment[].
448                  */
449         }
450         /* Deal with the destination pages I have inadvertently allocated.
451          *
452          * Ideally I would convert multi-page allocations into single
453          * page allocations, and add everyting to image->dest_pages.
454          *
455          * For now it is simpler to just free the pages.
456          */
457         kimage_free_page_list(&extra_pages);
458
459         return pages;
460 }
461
462 static struct page *kimage_alloc_crash_control_pages(struct kimage *image,
463                                                       unsigned int order)
464 {
465         /* Control pages are special, they are the intermediaries
466          * that are needed while we copy the rest of the pages
467          * to their final resting place.  As such they must
468          * not conflict with either the destination addresses
469          * or memory the kernel is already using.
470          *
471          * Control pages are also the only pags we must allocate
472          * when loading a crash kernel.  All of the other pages
473          * are specified by the segments and we just memcpy
474          * into them directly.
475          *
476          * The only case where we really need more than one of
477          * these are for architectures where we cannot disable
478          * the MMU and must instead generate an identity mapped
479          * page table for all of the memory.
480          *
481          * Given the low demand this implements a very simple
482          * allocator that finds the first hole of the appropriate
483          * size in the reserved memory region, and allocates all
484          * of the memory up to and including the hole.
485          */
486         unsigned long hole_start, hole_end, size;
487         struct page *pages;
488
489         pages = NULL;
490         size = (1 << order) << PAGE_SHIFT;
491         hole_start = (image->control_page + (size - 1)) & ~(size - 1);
492         hole_end   = hole_start + size - 1;
493         while (hole_end <= crashk_res.end) {
494                 unsigned long i;
495
496                 if (hole_end > KEXEC_CONTROL_MEMORY_LIMIT)
497                         break;
498                 if (hole_end > crashk_res.end)
499                         break;
500                 /* See if I overlap any of the segments */
501                 for (i = 0; i < image->nr_segments; i++) {
502                         unsigned long mstart, mend;
503
504                         mstart = image->segment[i].mem;
505                         mend   = mstart + image->segment[i].memsz - 1;
506                         if ((hole_end >= mstart) && (hole_start <= mend)) {
507                                 /* Advance the hole to the end of the segment */
508                                 hole_start = (mend + (size - 1)) & ~(size - 1);
509                                 hole_end   = hole_start + size - 1;
510                                 break;
511                         }
512                 }
513                 /* If I don't overlap any segments I have found my hole! */
514                 if (i == image->nr_segments) {
515                         pages = pfn_to_page(hole_start >> PAGE_SHIFT);
516                         break;
517                 }
518         }
519         if (pages)
520                 image->control_page = hole_end;
521
522         return pages;
523 }
524
525
526 struct page *kimage_alloc_control_pages(struct kimage *image,
527                                          unsigned int order)
528 {
529         struct page *pages = NULL;
530
531         switch (image->type) {
532         case KEXEC_TYPE_DEFAULT:
533                 pages = kimage_alloc_normal_control_pages(image, order);
534                 break;
535         case KEXEC_TYPE_CRASH:
536                 pages = kimage_alloc_crash_control_pages(image, order);
537                 break;
538         }
539
540         return pages;
541 }
542
543 static int kimage_add_entry(struct kimage *image, kimage_entry_t entry)
544 {
545         if (*image->entry != 0)
546                 image->entry++;
547
548         if (image->entry == image->last_entry) {
549                 kimage_entry_t *ind_page;
550                 struct page *page;
551
552                 page = kimage_alloc_page(image, GFP_KERNEL, KIMAGE_NO_DEST);
553                 if (!page)
554                         return -ENOMEM;
555
556                 ind_page = page_address(page);
557                 *image->entry = virt_to_phys(ind_page) | IND_INDIRECTION;
558                 image->entry = ind_page;
559                 image->last_entry = ind_page +
560                                       ((PAGE_SIZE/sizeof(kimage_entry_t)) - 1);
561         }
562         *image->entry = entry;
563         image->entry++;
564         *image->entry = 0;
565
566         return 0;
567 }
568
569 static int kimage_set_destination(struct kimage *image,
570                                    unsigned long destination)
571 {
572         int result;
573
574         destination &= PAGE_MASK;
575         result = kimage_add_entry(image, destination | IND_DESTINATION);
576         if (result == 0)
577                 image->destination = destination;
578
579         return result;
580 }
581
582
583 static int kimage_add_page(struct kimage *image, unsigned long page)
584 {
585         int result;
586
587         page &= PAGE_MASK;
588         result = kimage_add_entry(image, page | IND_SOURCE);
589         if (result == 0)
590                 image->destination += PAGE_SIZE;
591
592         return result;
593 }
594
595
596 static void kimage_free_extra_pages(struct kimage *image)
597 {
598         /* Walk through and free any extra destination pages I may have */
599         kimage_free_page_list(&image->dest_pages);
600
601         /* Walk through and free any unuseable pages I have cached */
602         kimage_free_page_list(&image->unuseable_pages);
603
604 }
605 static void kimage_terminate(struct kimage *image)
606 {
607         if (*image->entry != 0)
608                 image->entry++;
609
610         *image->entry = IND_DONE;
611 }
612
613 #define for_each_kimage_entry(image, ptr, entry) \
614         for (ptr = &image->head; (entry = *ptr) && !(entry & IND_DONE); \
615                 ptr = (entry & IND_INDIRECTION)? \
616                         phys_to_virt((entry & PAGE_MASK)): ptr +1)
617
618 static void kimage_free_entry(kimage_entry_t entry)
619 {
620         struct page *page;
621
622         page = pfn_to_page(entry >> PAGE_SHIFT);
623         kimage_free_pages(page);
624 }
625
626 static void kimage_free(struct kimage *image)
627 {
628         kimage_entry_t *ptr, entry;
629         kimage_entry_t ind = 0;
630
631         if (!image)
632                 return;
633
634         kimage_free_extra_pages(image);
635         for_each_kimage_entry(image, ptr, entry) {
636                 if (entry & IND_INDIRECTION) {
637                         /* Free the previous indirection page */
638                         if (ind & IND_INDIRECTION)
639                                 kimage_free_entry(ind);
640                         /* Save this indirection page until we are
641                          * done with it.
642                          */
643                         ind = entry;
644                 }
645                 else if (entry & IND_SOURCE)
646                         kimage_free_entry(entry);
647         }
648         /* Free the final indirection page */
649         if (ind & IND_INDIRECTION)
650                 kimage_free_entry(ind);
651
652         /* Handle any machine specific cleanup */
653         machine_kexec_cleanup(image);
654
655         /* Free the kexec control pages... */
656         kimage_free_page_list(&image->control_pages);
657         kfree(image);
658 }
659
660 static kimage_entry_t *kimage_dst_used(struct kimage *image,
661                                         unsigned long page)
662 {
663         kimage_entry_t *ptr, entry;
664         unsigned long destination = 0;
665
666         for_each_kimage_entry(image, ptr, entry) {
667                 if (entry & IND_DESTINATION)
668                         destination = entry & PAGE_MASK;
669                 else if (entry & IND_SOURCE) {
670                         if (page == destination)
671                                 return ptr;
672                         destination += PAGE_SIZE;
673                 }
674         }
675
676         return NULL;
677 }
678
679 static struct page *kimage_alloc_page(struct kimage *image,
680                                         gfp_t gfp_mask,
681                                         unsigned long destination)
682 {
683         /*
684          * Here we implement safeguards to ensure that a source page
685          * is not copied to its destination page before the data on
686          * the destination page is no longer useful.
687          *
688          * To do this we maintain the invariant that a source page is
689          * either its own destination page, or it is not a
690          * destination page at all.
691          *
692          * That is slightly stronger than required, but the proof
693          * that no problems will not occur is trivial, and the
694          * implementation is simply to verify.
695          *
696          * When allocating all pages normally this algorithm will run
697          * in O(N) time, but in the worst case it will run in O(N^2)
698          * time.   If the runtime is a problem the data structures can
699          * be fixed.
700          */
701         struct page *page;
702         unsigned long addr;
703
704         /*
705          * Walk through the list of destination pages, and see if I
706          * have a match.
707          */
708         list_for_each_entry(page, &image->dest_pages, lru) {
709                 addr = page_to_pfn(page) << PAGE_SHIFT;
710                 if (addr == destination) {
711                         list_del(&page->lru);
712                         return page;
713                 }
714         }
715         page = NULL;
716         while (1) {
717                 kimage_entry_t *old;
718
719                 /* Allocate a page, if we run out of memory give up */
720                 page = kimage_alloc_pages(gfp_mask, 0);
721                 if (!page)
722                         return NULL;
723                 /* If the page cannot be used file it away */
724                 if (page_to_pfn(page) >
725                                 (KEXEC_SOURCE_MEMORY_LIMIT >> PAGE_SHIFT)) {
726                         list_add(&page->lru, &image->unuseable_pages);
727                         continue;
728                 }
729                 addr = page_to_pfn(page) << PAGE_SHIFT;
730
731                 /* If it is the destination page we want use it */
732                 if (addr == destination)
733                         break;
734
735                 /* If the page is not a destination page use it */
736                 if (!kimage_is_destination_range(image, addr,
737                                                   addr + PAGE_SIZE))
738                         break;
739
740                 /*
741                  * I know that the page is someones destination page.
742                  * See if there is already a source page for this
743                  * destination page.  And if so swap the source pages.
744                  */
745                 old = kimage_dst_used(image, addr);
746                 if (old) {
747                         /* If so move it */
748                         unsigned long old_addr;
749                         struct page *old_page;
750
751                         old_addr = *old & PAGE_MASK;
752                         old_page = pfn_to_page(old_addr >> PAGE_SHIFT);
753                         copy_highpage(page, old_page);
754                         *old = addr | (*old & ~PAGE_MASK);
755
756                         /* The old page I have found cannot be a
757                          * destination page, so return it if it's
758                          * gfp_flags honor the ones passed in.
759                          */
760                         if (!(gfp_mask & __GFP_HIGHMEM) &&
761                             PageHighMem(old_page)) {
762                                 kimage_free_pages(old_page);
763                                 continue;
764                         }
765                         addr = old_addr;
766                         page = old_page;
767                         break;
768                 }
769                 else {
770                         /* Place the page on the destination list I
771                          * will use it later.
772                          */
773                         list_add(&page->lru, &image->dest_pages);
774                 }
775         }
776
777         return page;
778 }
779
780 static int kimage_load_normal_segment(struct kimage *image,
781                                          struct kexec_segment *segment)
782 {
783         unsigned long maddr;
784         unsigned long ubytes, mbytes;
785         int result;
786         unsigned char __user *buf;
787
788         result = 0;
789         buf = segment->buf;
790         ubytes = segment->bufsz;
791         mbytes = segment->memsz;
792         maddr = segment->mem;
793
794         result = kimage_set_destination(image, maddr);
795         if (result < 0)
796                 goto out;
797
798         while (mbytes) {
799                 struct page *page;
800                 char *ptr;
801                 size_t uchunk, mchunk;
802
803                 page = kimage_alloc_page(image, GFP_HIGHUSER, maddr);
804                 if (!page) {
805                         result  = -ENOMEM;
806                         goto out;
807                 }
808                 result = kimage_add_page(image, page_to_pfn(page)
809                                                                 << PAGE_SHIFT);
810                 if (result < 0)
811                         goto out;
812
813                 ptr = kmap(page);
814                 /* Start with a clear page */
815                 memset(ptr, 0, PAGE_SIZE);
816                 ptr += maddr & ~PAGE_MASK;
817                 mchunk = PAGE_SIZE - (maddr & ~PAGE_MASK);
818                 if (mchunk > mbytes)
819                         mchunk = mbytes;
820
821                 uchunk = mchunk;
822                 if (uchunk > ubytes)
823                         uchunk = ubytes;
824
825                 result = copy_from_user(ptr, buf, uchunk);
826                 kunmap(page);
827                 if (result) {
828                         result = (result < 0) ? result : -EIO;
829                         goto out;
830                 }
831                 ubytes -= uchunk;
832                 maddr  += mchunk;
833                 buf    += mchunk;
834                 mbytes -= mchunk;
835         }
836 out:
837         return result;
838 }
839
840 static int kimage_load_crash_segment(struct kimage *image,
841                                         struct kexec_segment *segment)
842 {
843         /* For crash dumps kernels we simply copy the data from
844          * user space to it's destination.
845          * We do things a page at a time for the sake of kmap.
846          */
847         unsigned long maddr;
848         unsigned long ubytes, mbytes;
849         int result;
850         unsigned char __user *buf;
851
852         result = 0;
853         buf = segment->buf;
854         ubytes = segment->bufsz;
855         mbytes = segment->memsz;
856         maddr = segment->mem;
857         while (mbytes) {
858                 struct page *page;
859                 char *ptr;
860                 size_t uchunk, mchunk;
861
862                 page = pfn_to_page(maddr >> PAGE_SHIFT);
863                 if (!page) {
864                         result  = -ENOMEM;
865                         goto out;
866                 }
867                 ptr = kmap(page);
868                 ptr += maddr & ~PAGE_MASK;
869                 mchunk = PAGE_SIZE - (maddr & ~PAGE_MASK);
870                 if (mchunk > mbytes)
871                         mchunk = mbytes;
872
873                 uchunk = mchunk;
874                 if (uchunk > ubytes) {
875                         uchunk = ubytes;
876                         /* Zero the trailing part of the page */
877                         memset(ptr + uchunk, 0, mchunk - uchunk);
878                 }
879                 result = copy_from_user(ptr, buf, uchunk);
880                 kexec_flush_icache_page(page);
881                 kunmap(page);
882                 if (result) {
883                         result = (result < 0) ? result : -EIO;
884                         goto out;
885                 }
886                 ubytes -= uchunk;
887                 maddr  += mchunk;
888                 buf    += mchunk;
889                 mbytes -= mchunk;
890         }
891 out:
892         return result;
893 }
894
895 static int kimage_load_segment(struct kimage *image,
896                                 struct kexec_segment *segment)
897 {
898         int result = -ENOMEM;
899
900         switch (image->type) {
901         case KEXEC_TYPE_DEFAULT:
902                 result = kimage_load_normal_segment(image, segment);
903                 break;
904         case KEXEC_TYPE_CRASH:
905                 result = kimage_load_crash_segment(image, segment);
906                 break;
907         }
908
909         return result;
910 }
911
912 /*
913  * Exec Kernel system call: for obvious reasons only root may call it.
914  *
915  * This call breaks up into three pieces.
916  * - A generic part which loads the new kernel from the current
917  *   address space, and very carefully places the data in the
918  *   allocated pages.
919  *
920  * - A generic part that interacts with the kernel and tells all of
921  *   the devices to shut down.  Preventing on-going dmas, and placing
922  *   the devices in a consistent state so a later kernel can
923  *   reinitialize them.
924  *
925  * - A machine specific part that includes the syscall number
926  *   and the copies the image to it's final destination.  And
927  *   jumps into the image at entry.
928  *
929  * kexec does not sync, or unmount filesystems so if you need
930  * that to happen you need to do that yourself.
931  */
932 struct kimage *kexec_image;
933 struct kimage *kexec_crash_image;
934
935 static DEFINE_MUTEX(kexec_mutex);
936
937 asmlinkage long sys_kexec_load(unsigned long entry, unsigned long nr_segments,
938                                 struct kexec_segment __user *segments,
939                                 unsigned long flags)
940 {
941         struct kimage **dest_image, *image;
942         int result;
943
944         /* We only trust the superuser with rebooting the system. */
945         if (!capable(CAP_SYS_BOOT))
946                 return -EPERM;
947
948         /*
949          * Verify we have a legal set of flags
950          * This leaves us room for future extensions.
951          */
952         if ((flags & KEXEC_FLAGS) != (flags & ~KEXEC_ARCH_MASK))
953                 return -EINVAL;
954
955         /* Verify we are on the appropriate architecture */
956         if (((flags & KEXEC_ARCH_MASK) != KEXEC_ARCH) &&
957                 ((flags & KEXEC_ARCH_MASK) != KEXEC_ARCH_DEFAULT))
958                 return -EINVAL;
959
960         /* Put an artificial cap on the number
961          * of segments passed to kexec_load.
962          */
963         if (nr_segments > KEXEC_SEGMENT_MAX)
964                 return -EINVAL;
965
966         image = NULL;
967         result = 0;
968
969         /* Because we write directly to the reserved memory
970          * region when loading crash kernels we need a mutex here to
971          * prevent multiple crash  kernels from attempting to load
972          * simultaneously, and to prevent a crash kernel from loading
973          * over the top of a in use crash kernel.
974          *
975          * KISS: always take the mutex.
976          */
977         if (!mutex_trylock(&kexec_mutex))
978                 return -EBUSY;
979
980         dest_image = &kexec_image;
981         if (flags & KEXEC_ON_CRASH)
982                 dest_image = &kexec_crash_image;
983         if (nr_segments > 0) {
984                 unsigned long i;
985
986                 /* Loading another kernel to reboot into */
987                 if ((flags & KEXEC_ON_CRASH) == 0)
988                         result = kimage_normal_alloc(&image, entry,
989                                                         nr_segments, segments);
990                 /* Loading another kernel to switch to if this one crashes */
991                 else if (flags & KEXEC_ON_CRASH) {
992                         /* Free any current crash dump kernel before
993                          * we corrupt it.
994                          */
995                         kimage_free(xchg(&kexec_crash_image, NULL));
996                         result = kimage_crash_alloc(&image, entry,
997                                                      nr_segments, segments);
998                 }
999                 if (result)
1000                         goto out;
1001
1002                 if (flags & KEXEC_PRESERVE_CONTEXT)
1003                         image->preserve_context = 1;
1004                 result = machine_kexec_prepare(image);
1005                 if (result)
1006                         goto out;
1007
1008                 for (i = 0; i < nr_segments; i++) {
1009                         result = kimage_load_segment(image, &image->segment[i]);
1010                         if (result)
1011                                 goto out;
1012                 }
1013                 kimage_terminate(image);
1014         }
1015         /* Install the new kernel, and  Uninstall the old */
1016         image = xchg(dest_image, image);
1017
1018 out:
1019         mutex_unlock(&kexec_mutex);
1020         kimage_free(image);
1021
1022         return result;
1023 }
1024
1025 #ifdef CONFIG_COMPAT
1026 asmlinkage long compat_sys_kexec_load(unsigned long entry,
1027                                 unsigned long nr_segments,
1028                                 struct compat_kexec_segment __user *segments,
1029                                 unsigned long flags)
1030 {
1031         struct compat_kexec_segment in;
1032         struct kexec_segment out, __user *ksegments;
1033         unsigned long i, result;
1034
1035         /* Don't allow clients that don't understand the native
1036          * architecture to do anything.
1037          */
1038         if ((flags & KEXEC_ARCH_MASK) == KEXEC_ARCH_DEFAULT)
1039                 return -EINVAL;
1040
1041         if (nr_segments > KEXEC_SEGMENT_MAX)
1042                 return -EINVAL;
1043
1044         ksegments = compat_alloc_user_space(nr_segments * sizeof(out));
1045         for (i=0; i < nr_segments; i++) {
1046                 result = copy_from_user(&in, &segments[i], sizeof(in));
1047                 if (result)
1048                         return -EFAULT;
1049
1050                 out.buf   = compat_ptr(in.buf);
1051                 out.bufsz = in.bufsz;
1052                 out.mem   = in.mem;
1053                 out.memsz = in.memsz;
1054
1055                 result = copy_to_user(&ksegments[i], &out, sizeof(out));
1056                 if (result)
1057                         return -EFAULT;
1058         }
1059
1060         return sys_kexec_load(entry, nr_segments, ksegments, flags);
1061 }
1062 #endif
1063
1064 void crash_kexec(struct pt_regs *regs)
1065 {
1066         /* Take the kexec_mutex here to prevent sys_kexec_load
1067          * running on one cpu from replacing the crash kernel
1068          * we are using after a panic on a different cpu.
1069          *
1070          * If the crash kernel was not located in a fixed area
1071          * of memory the xchg(&kexec_crash_image) would be
1072          * sufficient.  But since I reuse the memory...
1073          */
1074         if (mutex_trylock(&kexec_mutex)) {
1075                 if (kexec_crash_image) {
1076                         struct pt_regs fixed_regs;
1077                         crash_setup_regs(&fixed_regs, regs);
1078                         crash_save_vmcoreinfo();
1079                         machine_crash_shutdown(&fixed_regs);
1080                         machine_kexec(kexec_crash_image);
1081                 }
1082                 mutex_unlock(&kexec_mutex);
1083         }
1084 }
1085
1086 static u32 *append_elf_note(u32 *buf, char *name, unsigned type, void *data,
1087                             size_t data_len)
1088 {
1089         struct elf_note note;
1090
1091         note.n_namesz = strlen(name) + 1;
1092         note.n_descsz = data_len;
1093         note.n_type   = type;
1094         memcpy(buf, &note, sizeof(note));
1095         buf += (sizeof(note) + 3)/4;
1096         memcpy(buf, name, note.n_namesz);
1097         buf += (note.n_namesz + 3)/4;
1098         memcpy(buf, data, note.n_descsz);
1099         buf += (note.n_descsz + 3)/4;
1100
1101         return buf;
1102 }
1103
1104 static void final_note(u32 *buf)
1105 {
1106         struct elf_note note;
1107
1108         note.n_namesz = 0;
1109         note.n_descsz = 0;
1110         note.n_type   = 0;
1111         memcpy(buf, &note, sizeof(note));
1112 }
1113
1114 void crash_save_cpu(struct pt_regs *regs, int cpu)
1115 {
1116         struct elf_prstatus prstatus;
1117         u32 *buf;
1118
1119         if ((cpu < 0) || (cpu >= nr_cpu_ids))
1120                 return;
1121
1122         /* Using ELF notes here is opportunistic.
1123          * I need a well defined structure format
1124          * for the data I pass, and I need tags
1125          * on the data to indicate what information I have
1126          * squirrelled away.  ELF notes happen to provide
1127          * all of that, so there is no need to invent something new.
1128          */
1129         buf = (u32*)per_cpu_ptr(crash_notes, cpu);
1130         if (!buf)
1131                 return;
1132         memset(&prstatus, 0, sizeof(prstatus));
1133         prstatus.pr_pid = current->pid;
1134         elf_core_copy_regs(&prstatus.pr_reg, regs);
1135         buf = append_elf_note(buf, KEXEC_CORE_NOTE_NAME, NT_PRSTATUS,
1136                               &prstatus, sizeof(prstatus));
1137         final_note(buf);
1138 }
1139
1140 static int __init crash_notes_memory_init(void)
1141 {
1142         /* Allocate memory for saving cpu registers. */
1143         crash_notes = alloc_percpu(note_buf_t);
1144         if (!crash_notes) {
1145                 printk("Kexec: Memory allocation for saving cpu register"
1146                 " states failed\n");
1147                 return -ENOMEM;
1148         }
1149         return 0;
1150 }
1151 module_init(crash_notes_memory_init)
1152
1153
1154 /*
1155  * parsing the "crashkernel" commandline
1156  *
1157  * this code is intended to be called from architecture specific code
1158  */
1159
1160
1161 /*
1162  * This function parses command lines in the format
1163  *
1164  *   crashkernel=ramsize-range:size[,...][@offset]
1165  *
1166  * The function returns 0 on success and -EINVAL on failure.
1167  */
1168 static int __init parse_crashkernel_mem(char                    *cmdline,
1169                                         unsigned long long      system_ram,
1170                                         unsigned long long      *crash_size,
1171                                         unsigned long long      *crash_base)
1172 {
1173         char *cur = cmdline, *tmp;
1174
1175         /* for each entry of the comma-separated list */
1176         do {
1177                 unsigned long long start, end = ULLONG_MAX, size;
1178
1179                 /* get the start of the range */
1180                 start = memparse(cur, &tmp);
1181                 if (cur == tmp) {
1182                         pr_warning("crashkernel: Memory value expected\n");
1183                         return -EINVAL;
1184                 }
1185                 cur = tmp;
1186                 if (*cur != '-') {
1187                         pr_warning("crashkernel: '-' expected\n");
1188                         return -EINVAL;
1189                 }
1190                 cur++;
1191
1192                 /* if no ':' is here, than we read the end */
1193                 if (*cur != ':') {
1194                         end = memparse(cur, &tmp);
1195                         if (cur == tmp) {
1196                                 pr_warning("crashkernel: Memory "
1197                                                 "value expected\n");
1198                                 return -EINVAL;
1199                         }
1200                         cur = tmp;
1201                         if (end <= start) {
1202                                 pr_warning("crashkernel: end <= start\n");
1203                                 return -EINVAL;
1204                         }
1205                 }
1206
1207                 if (*cur != ':') {
1208                         pr_warning("crashkernel: ':' expected\n");
1209                         return -EINVAL;
1210                 }
1211                 cur++;
1212
1213                 size = memparse(cur, &tmp);
1214                 if (cur == tmp) {
1215                         pr_warning("Memory value expected\n");
1216                         return -EINVAL;
1217                 }
1218                 cur = tmp;
1219                 if (size >= system_ram) {
1220                         pr_warning("crashkernel: invalid size\n");
1221                         return -EINVAL;
1222                 }
1223
1224                 /* match ? */
1225                 if (system_ram >= start && system_ram < end) {
1226                         *crash_size = size;
1227                         break;
1228                 }
1229         } while (*cur++ == ',');
1230
1231         if (*crash_size > 0) {
1232                 while (*cur != ' ' && *cur != '@')
1233                         cur++;
1234                 if (*cur == '@') {
1235                         cur++;
1236                         *crash_base = memparse(cur, &tmp);
1237                         if (cur == tmp) {
1238                                 pr_warning("Memory value expected "
1239                                                 "after '@'\n");
1240                                 return -EINVAL;
1241                         }
1242                 }
1243         }
1244
1245         return 0;
1246 }
1247
1248 /*
1249  * That function parses "simple" (old) crashkernel command lines like
1250  *
1251  *      crashkernel=size[@offset]
1252  *
1253  * It returns 0 on success and -EINVAL on failure.
1254  */
1255 static int __init parse_crashkernel_simple(char                 *cmdline,
1256                                            unsigned long long   *crash_size,
1257                                            unsigned long long   *crash_base)
1258 {
1259         char *cur = cmdline;
1260
1261         *crash_size = memparse(cmdline, &cur);
1262         if (cmdline == cur) {
1263                 pr_warning("crashkernel: memory value expected\n");
1264                 return -EINVAL;
1265         }
1266
1267         if (*cur == '@')
1268                 *crash_base = memparse(cur+1, &cur);
1269
1270         return 0;
1271 }
1272
1273 /*
1274  * That function is the entry point for command line parsing and should be
1275  * called from the arch-specific code.
1276  */
1277 int __init parse_crashkernel(char                *cmdline,
1278                              unsigned long long system_ram,
1279                              unsigned long long *crash_size,
1280                              unsigned long long *crash_base)
1281 {
1282         char    *p = cmdline, *ck_cmdline = NULL;
1283         char    *first_colon, *first_space;
1284
1285         BUG_ON(!crash_size || !crash_base);
1286         *crash_size = 0;
1287         *crash_base = 0;
1288
1289         /* find crashkernel and use the last one if there are more */
1290         p = strstr(p, "crashkernel=");
1291         while (p) {
1292                 ck_cmdline = p;
1293                 p = strstr(p+1, "crashkernel=");
1294         }
1295
1296         if (!ck_cmdline)
1297                 return -EINVAL;
1298
1299         ck_cmdline += 12; /* strlen("crashkernel=") */
1300
1301         /*
1302          * if the commandline contains a ':', then that's the extended
1303          * syntax -- if not, it must be the classic syntax
1304          */
1305         first_colon = strchr(ck_cmdline, ':');
1306         first_space = strchr(ck_cmdline, ' ');
1307         if (first_colon && (!first_space || first_colon < first_space))
1308                 return parse_crashkernel_mem(ck_cmdline, system_ram,
1309                                 crash_size, crash_base);
1310         else
1311                 return parse_crashkernel_simple(ck_cmdline, crash_size,
1312                                 crash_base);
1313
1314         return 0;
1315 }
1316
1317
1318
1319 void crash_save_vmcoreinfo(void)
1320 {
1321         u32 *buf;
1322
1323         if (!vmcoreinfo_size)
1324                 return;
1325
1326         vmcoreinfo_append_str("CRASHTIME=%ld", get_seconds());
1327
1328         buf = (u32 *)vmcoreinfo_note;
1329
1330         buf = append_elf_note(buf, VMCOREINFO_NOTE_NAME, 0, vmcoreinfo_data,
1331                               vmcoreinfo_size);
1332
1333         final_note(buf);
1334 }
1335
1336 void vmcoreinfo_append_str(const char *fmt, ...)
1337 {
1338         va_list args;
1339         char buf[0x50];
1340         int r;
1341
1342         va_start(args, fmt);
1343         r = vsnprintf(buf, sizeof(buf), fmt, args);
1344         va_end(args);
1345
1346         if (r + vmcoreinfo_size > vmcoreinfo_max_size)
1347                 r = vmcoreinfo_max_size - vmcoreinfo_size;
1348
1349         memcpy(&vmcoreinfo_data[vmcoreinfo_size], buf, r);
1350
1351         vmcoreinfo_size += r;
1352 }
1353
1354 /*
1355  * provide an empty default implementation here -- architecture
1356  * code may override this
1357  */
1358 void __attribute__ ((weak)) arch_crash_save_vmcoreinfo(void)
1359 {}
1360
1361 unsigned long __attribute__ ((weak)) paddr_vmcoreinfo_note(void)
1362 {
1363         return __pa((unsigned long)(char *)&vmcoreinfo_note);
1364 }
1365
1366 static int __init crash_save_vmcoreinfo_init(void)
1367 {
1368         VMCOREINFO_OSRELEASE(init_uts_ns.name.release);
1369         VMCOREINFO_PAGESIZE(PAGE_SIZE);
1370
1371         VMCOREINFO_SYMBOL(init_uts_ns);
1372         VMCOREINFO_SYMBOL(node_online_map);
1373         VMCOREINFO_SYMBOL(swapper_pg_dir);
1374         VMCOREINFO_SYMBOL(_stext);
1375         VMCOREINFO_SYMBOL(vmlist);
1376
1377 #ifndef CONFIG_NEED_MULTIPLE_NODES
1378         VMCOREINFO_SYMBOL(mem_map);
1379         VMCOREINFO_SYMBOL(contig_page_data);
1380 #endif
1381 #ifdef CONFIG_SPARSEMEM
1382         VMCOREINFO_SYMBOL(mem_section);
1383         VMCOREINFO_LENGTH(mem_section, NR_SECTION_ROOTS);
1384         VMCOREINFO_STRUCT_SIZE(mem_section);
1385         VMCOREINFO_OFFSET(mem_section, section_mem_map);
1386 #endif
1387         VMCOREINFO_STRUCT_SIZE(page);
1388         VMCOREINFO_STRUCT_SIZE(pglist_data);
1389         VMCOREINFO_STRUCT_SIZE(zone);
1390         VMCOREINFO_STRUCT_SIZE(free_area);
1391         VMCOREINFO_STRUCT_SIZE(list_head);
1392         VMCOREINFO_SIZE(nodemask_t);
1393         VMCOREINFO_OFFSET(page, flags);
1394         VMCOREINFO_OFFSET(page, _count);
1395         VMCOREINFO_OFFSET(page, mapping);
1396         VMCOREINFO_OFFSET(page, lru);
1397         VMCOREINFO_OFFSET(pglist_data, node_zones);
1398         VMCOREINFO_OFFSET(pglist_data, nr_zones);
1399 #ifdef CONFIG_FLAT_NODE_MEM_MAP
1400         VMCOREINFO_OFFSET(pglist_data, node_mem_map);
1401 #endif
1402         VMCOREINFO_OFFSET(pglist_data, node_start_pfn);
1403         VMCOREINFO_OFFSET(pglist_data, node_spanned_pages);
1404         VMCOREINFO_OFFSET(pglist_data, node_id);
1405         VMCOREINFO_OFFSET(zone, free_area);
1406         VMCOREINFO_OFFSET(zone, vm_stat);
1407         VMCOREINFO_OFFSET(zone, spanned_pages);
1408         VMCOREINFO_OFFSET(free_area, free_list);
1409         VMCOREINFO_OFFSET(list_head, next);
1410         VMCOREINFO_OFFSET(list_head, prev);
1411         VMCOREINFO_OFFSET(vm_struct, addr);
1412         VMCOREINFO_LENGTH(zone.free_area, MAX_ORDER);
1413         VMCOREINFO_LENGTH(free_area.free_list, MIGRATE_TYPES);
1414         VMCOREINFO_NUMBER(NR_FREE_PAGES);
1415         VMCOREINFO_NUMBER(PG_lru);
1416         VMCOREINFO_NUMBER(PG_private);
1417         VMCOREINFO_NUMBER(PG_swapcache);
1418
1419         arch_crash_save_vmcoreinfo();
1420
1421         return 0;
1422 }
1423
1424 module_init(crash_save_vmcoreinfo_init)
1425
1426 /*
1427  * Move into place and start executing a preloaded standalone
1428  * executable.  If nothing was preloaded return an error.
1429  */
1430 int kernel_kexec(void)
1431 {
1432         int error = 0;
1433
1434         if (!mutex_trylock(&kexec_mutex))
1435                 return -EBUSY;
1436         if (!kexec_image) {
1437                 error = -EINVAL;
1438                 goto Unlock;
1439         }
1440
1441 #ifdef CONFIG_KEXEC_JUMP
1442         if (kexec_image->preserve_context) {
1443                 mutex_lock(&pm_mutex);
1444                 pm_prepare_console();
1445                 error = freeze_processes();
1446                 if (error) {
1447                         error = -EBUSY;
1448                         goto Restore_console;
1449                 }
1450                 suspend_console();
1451                 error = device_suspend(PMSG_FREEZE);
1452                 if (error)
1453                         goto Resume_console;
1454                 error = disable_nonboot_cpus();
1455                 if (error)
1456                         goto Resume_devices;
1457                 device_pm_lock();
1458                 local_irq_disable();
1459                 /* At this point, device_suspend() has been called,
1460                  * but *not* device_power_down(). We *must*
1461                  * device_power_down() now.  Otherwise, drivers for
1462                  * some devices (e.g. interrupt controllers) become
1463                  * desynchronized with the actual state of the
1464                  * hardware at resume time, and evil weirdness ensues.
1465                  */
1466                 error = device_power_down(PMSG_FREEZE);
1467                 if (error)
1468                         goto Enable_irqs;
1469         } else
1470 #endif
1471         {
1472                 kernel_restart_prepare(NULL);
1473                 printk(KERN_EMERG "Starting new kernel\n");
1474                 machine_shutdown();
1475         }
1476
1477         machine_kexec(kexec_image);
1478
1479 #ifdef CONFIG_KEXEC_JUMP
1480         if (kexec_image->preserve_context) {
1481                 device_power_up(PMSG_RESTORE);
1482  Enable_irqs:
1483                 local_irq_enable();
1484                 device_pm_unlock();
1485                 enable_nonboot_cpus();
1486  Resume_devices:
1487                 device_resume(PMSG_RESTORE);
1488  Resume_console:
1489                 resume_console();
1490                 thaw_processes();
1491  Restore_console:
1492                 pm_restore_console();
1493                 mutex_unlock(&pm_mutex);
1494         }
1495 #endif
1496
1497  Unlock:
1498         mutex_unlock(&kexec_mutex);
1499         return error;
1500 }