1 // SPDX-License-Identifier: GPL-2.0 2 3 #include <linux/kernel.h> 4 #include <linux/console.h> 5 #include <linux/kexec.h> 6 #include <linux/delay.h> 7 #include <linux/reboot.h> 8 9 #include <asm/cacheflush.h> 10 #include <asm/sections.h> 11 12 extern void relocate_new_kernel(unsigned long head, 13 unsigned long start, 14 unsigned long phys); 15 16 extern const unsigned int relocate_new_kernel_size; 17 extern unsigned int kexec_initrd_start_offset; 18 extern unsigned int kexec_initrd_end_offset; 19 extern unsigned int kexec_cmdline_offset; 20 extern unsigned int kexec_free_mem_offset; 21 22 static void kexec_show_segment_info(const struct kimage *kimage, 23 unsigned long n) 24 { 25 pr_debug(" segment[%lu]: %016lx - %016lx, 0x%lx bytes, %lu pages\n", 26 n, 27 kimage->segment[n].mem, 28 kimage->segment[n].mem + kimage->segment[n].memsz, 29 (unsigned long)kimage->segment[n].memsz, 30 (unsigned long)kimage->segment[n].memsz / PAGE_SIZE); 31 } 32 33 static void kexec_image_info(const struct kimage *kimage) 34 { 35 unsigned long i; 36 37 pr_debug("kexec kimage info:\n"); 38 pr_debug(" type: %d\n", kimage->type); 39 pr_debug(" start: %lx\n", kimage->start); 40 pr_debug(" head: %lx\n", kimage->head); 41 pr_debug(" nr_segments: %lu\n", kimage->nr_segments); 42 43 for (i = 0; i < kimage->nr_segments; i++) 44 kexec_show_segment_info(kimage, i); 45 46 #ifdef CONFIG_KEXEC_FILE 47 if (kimage->file_mode) { 48 pr_debug("cmdline: %.*s\n", (int)kimage->cmdline_buf_len, 49 kimage->cmdline_buf); 50 } 51 #endif 52 } 53 54 void machine_kexec_cleanup(struct kimage *kimage) 55 { 56 } 57 58 void machine_crash_shutdown(struct pt_regs *regs) 59 { 60 } 61 62 void machine_shutdown(void) 63 { 64 smp_send_stop(); 65 while (num_online_cpus() > 1) { 66 cpu_relax(); 67 mdelay(1); 68 } 69 } 70 71 void machine_kexec(struct kimage *image) 72 { 73 #ifdef CONFIG_64BIT 74 Elf64_Fdesc desc; 75 #endif 76 void (*reloc)(unsigned long head, 77 unsigned long start, 78 unsigned long phys); 79 80 unsigned long phys = page_to_phys(image->control_code_page); 81 void *virt = (void *)__fix_to_virt(FIX_TEXT_KEXEC); 82 struct kimage_arch *arch = &image->arch; 83 84 set_fixmap(FIX_TEXT_KEXEC, phys); 85 86 flush_cache_all(); 87 88 #ifdef CONFIG_64BIT 89 reloc = (void *)&desc; 90 desc.addr = (long long)virt; 91 #else 92 reloc = (void *)virt; 93 #endif 94 95 memcpy(virt, dereference_function_descriptor(relocate_new_kernel), 96 relocate_new_kernel_size); 97 98 *(unsigned long *)(virt + kexec_cmdline_offset) = arch->cmdline; 99 *(unsigned long *)(virt + kexec_initrd_start_offset) = arch->initrd_start; 100 *(unsigned long *)(virt + kexec_initrd_end_offset) = arch->initrd_end; 101 *(unsigned long *)(virt + kexec_free_mem_offset) = PAGE0->mem_free; 102 103 flush_cache_all(); 104 flush_tlb_all(); 105 local_irq_disable(); 106 107 reloc(image->head & PAGE_MASK, image->start, phys); 108 } 109 110 int machine_kexec_prepare(struct kimage *image) 111 { 112 kexec_image_info(image); 113 return 0; 114 } 115