163 lines
		
	
	
		
			4.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			163 lines
		
	
	
		
			4.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * machine_kexec.c - handle transition of Linux booting another kernel
 | |
|  * Copyright (C) 2002-2003 Eric Biederman  <ebiederm@xmission.com>
 | |
|  *
 | |
|  * GameCube/ppc32 port Copyright (C) 2004 Albert Herranz
 | |
|  * LANDISK/sh4 supported by kogiidena
 | |
|  *
 | |
|  * This source code is licensed under the GNU General Public License,
 | |
|  * Version 2.  See the file COPYING for more details.
 | |
|  */
 | |
| 
 | |
| #include <linux/mm.h>
 | |
| #include <linux/kexec.h>
 | |
| #include <linux/delay.h>
 | |
| #include <linux/reboot.h>
 | |
| #include <linux/numa.h>
 | |
| #include <linux/ftrace.h>
 | |
| #include <linux/suspend.h>
 | |
| #include <asm/pgtable.h>
 | |
| #include <asm/pgalloc.h>
 | |
| #include <asm/mmu_context.h>
 | |
| #include <asm/io.h>
 | |
| #include <asm/cacheflush.h>
 | |
| 
 | |
| typedef void (*relocate_new_kernel_t)(unsigned long indirection_page,
 | |
| 				      unsigned long reboot_code_buffer,
 | |
| 				      unsigned long start_address);
 | |
| 
 | |
| extern const unsigned char relocate_new_kernel[];
 | |
| extern const unsigned int relocate_new_kernel_size;
 | |
| extern void *gdb_vbr_vector;
 | |
| extern void *vbr_base;
 | |
| 
 | |
| void machine_shutdown(void)
 | |
| {
 | |
| }
 | |
| 
 | |
| void machine_crash_shutdown(struct pt_regs *regs)
 | |
| {
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Do what every setup is needed on image and the
 | |
|  * reboot code buffer to allow us to avoid allocations
 | |
|  * later.
 | |
|  */
 | |
| int machine_kexec_prepare(struct kimage *image)
 | |
| {
 | |
| 	/* older versions of kexec-tools are passing
 | |
| 	 * the zImage entry point as a virtual address.
 | |
| 	 */
 | |
| 	if (image->start != PHYSADDR(image->start))
 | |
| 		return -EINVAL; /* upgrade your kexec-tools */
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| void machine_kexec_cleanup(struct kimage *image)
 | |
| {
 | |
| }
 | |
| 
 | |
| static void kexec_info(struct kimage *image)
 | |
| {
 | |
|         int i;
 | |
| 	printk("kexec information\n");
 | |
| 	for (i = 0; i < image->nr_segments; i++) {
 | |
| 	        printk("  segment[%d]: 0x%08x - 0x%08x (0x%08x)\n",
 | |
| 		       i,
 | |
| 		       (unsigned int)image->segment[i].mem,
 | |
| 		       (unsigned int)image->segment[i].mem +
 | |
| 				     image->segment[i].memsz,
 | |
| 		       (unsigned int)image->segment[i].memsz);
 | |
| 	}
 | |
| 	printk("  start     : 0x%08x\n\n", (unsigned int)image->start);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Do not allocate memory (or fail in any way) in machine_kexec().
 | |
|  * We are past the point of no return, committed to rebooting now.
 | |
|  */
 | |
| void machine_kexec(struct kimage *image)
 | |
| {
 | |
| 	unsigned long page_list;
 | |
| 	unsigned long reboot_code_buffer;
 | |
| 	relocate_new_kernel_t rnk;
 | |
| 	unsigned long entry;
 | |
| 	unsigned long *ptr;
 | |
| 	int save_ftrace_enabled;
 | |
| 
 | |
| 	/*
 | |
| 	 * Nicked from the mips version of machine_kexec():
 | |
| 	 * The generic kexec code builds a page list with physical
 | |
| 	 * addresses. Use phys_to_virt() to convert them to virtual.
 | |
| 	 */
 | |
| 	for (ptr = &image->head; (entry = *ptr) && !(entry & IND_DONE);
 | |
| 	     ptr = (entry & IND_INDIRECTION) ?
 | |
| 	       phys_to_virt(entry & PAGE_MASK) : ptr + 1) {
 | |
| 		if (*ptr & IND_SOURCE || *ptr & IND_INDIRECTION ||
 | |
| 		    *ptr & IND_DESTINATION)
 | |
| 			*ptr = (unsigned long) phys_to_virt(*ptr);
 | |
| 	}
 | |
| 
 | |
| #ifdef CONFIG_KEXEC_JUMP
 | |
| 	if (image->preserve_context)
 | |
| 		save_processor_state();
 | |
| #endif
 | |
| 
 | |
| 	save_ftrace_enabled = __ftrace_enabled_save();
 | |
| 
 | |
| 	/* Interrupts aren't acceptable while we reboot */
 | |
| 	local_irq_disable();
 | |
| 
 | |
| 	page_list = image->head;
 | |
| 
 | |
| 	/* we need both effective and real address here */
 | |
| 	reboot_code_buffer =
 | |
| 			(unsigned long)page_address(image->control_code_page);
 | |
| 
 | |
| 	/* copy our kernel relocation code to the control code page */
 | |
| 	memcpy((void *)reboot_code_buffer, relocate_new_kernel,
 | |
| 						relocate_new_kernel_size);
 | |
| 
 | |
| 	kexec_info(image);
 | |
| 	flush_cache_all();
 | |
| 
 | |
| #if defined(CONFIG_SH_STANDARD_BIOS)
 | |
| 	asm volatile("ldc %0, vbr" :
 | |
| 		     : "r" (((unsigned long) gdb_vbr_vector) - 0x100)
 | |
| 		     : "memory");
 | |
| #endif
 | |
| 
 | |
| 	/* now call it */
 | |
| 	rnk = (relocate_new_kernel_t) reboot_code_buffer;
 | |
| 	(*rnk)(page_list, reboot_code_buffer,
 | |
| 	       (unsigned long)phys_to_virt(image->start));
 | |
| 
 | |
| #ifdef CONFIG_KEXEC_JUMP
 | |
| 	asm volatile("ldc %0, vbr" : : "r" (&vbr_base) : "memory");
 | |
| 
 | |
| 	if (image->preserve_context)
 | |
| 		restore_processor_state();
 | |
| 
 | |
| 	/* Convert page list back to physical addresses, what a mess. */
 | |
| 	for (ptr = &image->head; (entry = *ptr) && !(entry & IND_DONE);
 | |
| 	     ptr = (*ptr & IND_INDIRECTION) ?
 | |
| 	       phys_to_virt(*ptr & PAGE_MASK) : ptr + 1) {
 | |
| 		if (*ptr & IND_SOURCE || *ptr & IND_INDIRECTION ||
 | |
| 		    *ptr & IND_DESTINATION)
 | |
| 			*ptr = virt_to_phys(*ptr);
 | |
| 	}
 | |
| #endif
 | |
| 
 | |
| 	__ftrace_enabled_restore(save_ftrace_enabled);
 | |
| }
 | |
| 
 | |
| void arch_crash_save_vmcoreinfo(void)
 | |
| {
 | |
| #ifdef CONFIG_NUMA
 | |
| 	VMCOREINFO_SYMBOL(node_data);
 | |
| 	VMCOREINFO_LENGTH(node_data, MAX_NUMNODES);
 | |
| #endif
 | |
| }
 |