kexec.c 2.7 KB

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