1
2#include <linux/string.h>
3#include <linux/elf.h>
4#include <asm/sections.h>
5#include <asm/setup.h>
6#include <asm/kexec.h>
7#include <asm/sclp.h>
8#include <asm/diag.h>
9#include <asm/uv.h>
10#include "compressed/decompressor.h"
11#include "boot.h"
12
13extern char __boot_data_start[], __boot_data_end[];
14extern char __boot_data_preserved_start[], __boot_data_preserved_end[];
15unsigned long __bootdata_preserved(__kaslr_offset);
16
17
18
19
20
21
22
23
24extern char _sdma[], _edma[];
25extern char _stext_dma[], _etext_dma[];
26extern struct exception_table_entry _start_dma_ex_table[];
27extern struct exception_table_entry _stop_dma_ex_table[];
28unsigned long __bootdata_preserved(__sdma) = __pa(&_sdma);
29unsigned long __bootdata_preserved(__edma) = __pa(&_edma);
30unsigned long __bootdata_preserved(__stext_dma) = __pa(&_stext_dma);
31unsigned long __bootdata_preserved(__etext_dma) = __pa(&_etext_dma);
32struct exception_table_entry *
33 __bootdata_preserved(__start_dma_ex_table) = _start_dma_ex_table;
34struct exception_table_entry *
35 __bootdata_preserved(__stop_dma_ex_table) = _stop_dma_ex_table;
36
37int _diag210_dma(struct diag210 *addr);
38int _diag26c_dma(void *req, void *resp, enum diag26c_sc subcode);
39int _diag14_dma(unsigned long rx, unsigned long ry1, unsigned long subcode);
40void _diag0c_dma(struct hypfs_diag0c_entry *entry);
41void _diag308_reset_dma(void);
42struct diag_ops __bootdata_preserved(diag_dma_ops) = {
43 .diag210 = _diag210_dma,
44 .diag26c = _diag26c_dma,
45 .diag14 = _diag14_dma,
46 .diag0c = _diag0c_dma,
47 .diag308_reset = _diag308_reset_dma
48};
49static struct diag210 _diag210_tmp_dma __section(".dma.data");
50struct diag210 *__bootdata_preserved(__diag210_tmp_dma) = &_diag210_tmp_dma;
51void _swsusp_reset_dma(void);
52unsigned long __bootdata_preserved(__swsusp_reset_dma) = __pa(_swsusp_reset_dma);
53
54void error(char *x)
55{
56 sclp_early_printk("\n\n");
57 sclp_early_printk(x);
58 sclp_early_printk("\n\n -- System halted");
59
60 disabled_wait();
61}
62
63#ifdef CONFIG_KERNEL_UNCOMPRESSED
64unsigned long mem_safe_offset(void)
65{
66 return vmlinux.default_lma + vmlinux.image_size + vmlinux.bss_size;
67}
68#endif
69
70static void rescue_initrd(unsigned long addr)
71{
72 if (!IS_ENABLED(CONFIG_BLK_DEV_INITRD))
73 return;
74 if (!INITRD_START || !INITRD_SIZE)
75 return;
76 if (addr <= INITRD_START)
77 return;
78 memmove((void *)addr, (void *)INITRD_START, INITRD_SIZE);
79 INITRD_START = addr;
80}
81
82static void copy_bootdata(void)
83{
84 if (__boot_data_end - __boot_data_start != vmlinux.bootdata_size)
85 error(".boot.data section size mismatch");
86 memcpy((void *)vmlinux.bootdata_off, __boot_data_start, vmlinux.bootdata_size);
87 if (__boot_data_preserved_end - __boot_data_preserved_start != vmlinux.bootdata_preserved_size)
88 error(".boot.preserved.data section size mismatch");
89 memcpy((void *)vmlinux.bootdata_preserved_off, __boot_data_preserved_start, vmlinux.bootdata_preserved_size);
90}
91
92static void handle_relocs(unsigned long offset)
93{
94 Elf64_Rela *rela_start, *rela_end, *rela;
95 int r_type, r_sym, rc;
96 Elf64_Addr loc, val;
97 Elf64_Sym *dynsym;
98
99 rela_start = (Elf64_Rela *) vmlinux.rela_dyn_start;
100 rela_end = (Elf64_Rela *) vmlinux.rela_dyn_end;
101 dynsym = (Elf64_Sym *) vmlinux.dynsym_start;
102 for (rela = rela_start; rela < rela_end; rela++) {
103 loc = rela->r_offset + offset;
104 val = rela->r_addend + offset;
105 r_sym = ELF64_R_SYM(rela->r_info);
106 if (r_sym)
107 val += dynsym[r_sym].st_value;
108 r_type = ELF64_R_TYPE(rela->r_info);
109 rc = arch_kexec_do_relocs(r_type, (void *) loc, val, 0);
110 if (rc)
111 error("Unknown relocation type");
112 }
113}
114
115void startup_kernel(void)
116{
117 unsigned long random_lma;
118 unsigned long safe_addr;
119 void *img;
120
121 store_ipl_parmblock();
122 safe_addr = mem_safe_offset();
123 safe_addr = read_ipl_report(safe_addr);
124 uv_query_info();
125 rescue_initrd(safe_addr);
126 sclp_early_read_info();
127 setup_boot_command_line();
128 parse_boot_command_line();
129 setup_memory_end();
130 detect_memory();
131
132 random_lma = __kaslr_offset = 0;
133 if (IS_ENABLED(CONFIG_RANDOMIZE_BASE) && kaslr_enabled) {
134 random_lma = get_random_base(safe_addr);
135 if (random_lma) {
136 __kaslr_offset = random_lma - vmlinux.default_lma;
137 img = (void *)vmlinux.default_lma;
138 vmlinux.default_lma += __kaslr_offset;
139 vmlinux.entry += __kaslr_offset;
140 vmlinux.bootdata_off += __kaslr_offset;
141 vmlinux.bootdata_preserved_off += __kaslr_offset;
142 vmlinux.rela_dyn_start += __kaslr_offset;
143 vmlinux.rela_dyn_end += __kaslr_offset;
144 vmlinux.dynsym_start += __kaslr_offset;
145 }
146 }
147
148 if (!IS_ENABLED(CONFIG_KERNEL_UNCOMPRESSED)) {
149 img = decompress_kernel();
150 memmove((void *)vmlinux.default_lma, img, vmlinux.image_size);
151 } else if (__kaslr_offset)
152 memcpy((void *)vmlinux.default_lma, img, vmlinux.image_size);
153
154 copy_bootdata();
155 if (IS_ENABLED(CONFIG_RELOCATABLE))
156 handle_relocs(__kaslr_offset);
157
158 if (__kaslr_offset) {
159
160 if (IS_ENABLED(CONFIG_KERNEL_UNCOMPRESSED))
161 memset(img, 0, vmlinux.image_size);
162 }
163 vmlinux.entry();
164}
165