This source file includes following definitions.
- scroll
- serial_putchar
- __putstr
- __puthex
- handle_relocations
- handle_relocations
- parse_elf
- extract_kernel
- fortify_panic
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15 #include "misc.h"
16 #include "error.h"
17 #include "pgtable.h"
18 #include "../string.h"
19 #include "../voffset.h"
20 #include <asm/bootparam_utils.h>
21
22
23
24
25
26
27
28
29
30 #define STATIC static
31
32
33
34
35
36
37 #undef memcpy
38 #undef memset
39 #define memzero(s, n) memset((s), 0, (n))
40 #define memmove memmove
41
42
43 void *memmove(void *dest, const void *src, size_t n);
44
45
46
47
48 struct boot_params *boot_params;
49
50 memptr free_mem_ptr;
51 memptr free_mem_end_ptr;
52
53 static char *vidmem;
54 static int vidport;
55 static int lines, cols;
56
57 #ifdef CONFIG_KERNEL_GZIP
58 #include "../../../../lib/decompress_inflate.c"
59 #endif
60
61 #ifdef CONFIG_KERNEL_BZIP2
62 #include "../../../../lib/decompress_bunzip2.c"
63 #endif
64
65 #ifdef CONFIG_KERNEL_LZMA
66 #include "../../../../lib/decompress_unlzma.c"
67 #endif
68
69 #ifdef CONFIG_KERNEL_XZ
70 #include "../../../../lib/decompress_unxz.c"
71 #endif
72
73 #ifdef CONFIG_KERNEL_LZO
74 #include "../../../../lib/decompress_unlzo.c"
75 #endif
76
77 #ifdef CONFIG_KERNEL_LZ4
78 #include "../../../../lib/decompress_unlz4.c"
79 #endif
80
81
82
83
84
85 static void scroll(void)
86 {
87 int i;
88
89 memmove(vidmem, vidmem + cols * 2, (lines - 1) * cols * 2);
90 for (i = (lines - 1) * cols * 2; i < lines * cols * 2; i += 2)
91 vidmem[i] = ' ';
92 }
93
94 #define XMTRDY 0x20
95
96 #define TXR 0
97 #define LSR 5
98 static void serial_putchar(int ch)
99 {
100 unsigned timeout = 0xffff;
101
102 while ((inb(early_serial_base + LSR) & XMTRDY) == 0 && --timeout)
103 cpu_relax();
104
105 outb(ch, early_serial_base + TXR);
106 }
107
108 void __putstr(const char *s)
109 {
110 int x, y, pos;
111 char c;
112
113 if (early_serial_base) {
114 const char *str = s;
115 while (*str) {
116 if (*str == '\n')
117 serial_putchar('\r');
118 serial_putchar(*str++);
119 }
120 }
121
122 if (lines == 0 || cols == 0)
123 return;
124
125 x = boot_params->screen_info.orig_x;
126 y = boot_params->screen_info.orig_y;
127
128 while ((c = *s++) != '\0') {
129 if (c == '\n') {
130 x = 0;
131 if (++y >= lines) {
132 scroll();
133 y--;
134 }
135 } else {
136 vidmem[(x + cols * y) * 2] = c;
137 if (++x >= cols) {
138 x = 0;
139 if (++y >= lines) {
140 scroll();
141 y--;
142 }
143 }
144 }
145 }
146
147 boot_params->screen_info.orig_x = x;
148 boot_params->screen_info.orig_y = y;
149
150 pos = (x + cols * y) * 2;
151 outb(14, vidport);
152 outb(0xff & (pos >> 9), vidport+1);
153 outb(15, vidport);
154 outb(0xff & (pos >> 1), vidport+1);
155 }
156
157 void __puthex(unsigned long value)
158 {
159 char alpha[2] = "0";
160 int bits;
161
162 for (bits = sizeof(value) * 8 - 4; bits >= 0; bits -= 4) {
163 unsigned long digit = (value >> bits) & 0xf;
164
165 if (digit < 0xA)
166 alpha[0] = '0' + digit;
167 else
168 alpha[0] = 'a' + (digit - 0xA);
169
170 __putstr(alpha);
171 }
172 }
173
174 #if CONFIG_X86_NEED_RELOCS
175 static void handle_relocations(void *output, unsigned long output_len,
176 unsigned long virt_addr)
177 {
178 int *reloc;
179 unsigned long delta, map, ptr;
180 unsigned long min_addr = (unsigned long)output;
181 unsigned long max_addr = min_addr + (VO___bss_start - VO__text);
182
183
184
185
186
187 delta = min_addr - LOAD_PHYSICAL_ADDR;
188
189
190
191
192
193
194
195
196 map = delta - __START_KERNEL_map;
197
198
199
200
201
202
203 if (IS_ENABLED(CONFIG_X86_64))
204 delta = virt_addr - LOAD_PHYSICAL_ADDR;
205
206 if (!delta) {
207 debug_putstr("No relocation needed... ");
208 return;
209 }
210 debug_putstr("Performing relocations... ");
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231 for (reloc = output + output_len - sizeof(*reloc); *reloc; reloc--) {
232 long extended = *reloc;
233 extended += map;
234
235 ptr = (unsigned long)extended;
236 if (ptr < min_addr || ptr > max_addr)
237 error("32-bit relocation outside of kernel!\n");
238
239 *(uint32_t *)ptr += delta;
240 }
241 #ifdef CONFIG_X86_64
242 while (*--reloc) {
243 long extended = *reloc;
244 extended += map;
245
246 ptr = (unsigned long)extended;
247 if (ptr < min_addr || ptr > max_addr)
248 error("inverse 32-bit relocation outside of kernel!\n");
249
250 *(int32_t *)ptr -= delta;
251 }
252 for (reloc--; *reloc; reloc--) {
253 long extended = *reloc;
254 extended += map;
255
256 ptr = (unsigned long)extended;
257 if (ptr < min_addr || ptr > max_addr)
258 error("64-bit relocation outside of kernel!\n");
259
260 *(uint64_t *)ptr += delta;
261 }
262 #endif
263 }
264 #else
265 static inline void handle_relocations(void *output, unsigned long output_len,
266 unsigned long virt_addr)
267 { }
268 #endif
269
270 static void parse_elf(void *output)
271 {
272 #ifdef CONFIG_X86_64
273 Elf64_Ehdr ehdr;
274 Elf64_Phdr *phdrs, *phdr;
275 #else
276 Elf32_Ehdr ehdr;
277 Elf32_Phdr *phdrs, *phdr;
278 #endif
279 void *dest;
280 int i;
281
282 memcpy(&ehdr, output, sizeof(ehdr));
283 if (ehdr.e_ident[EI_MAG0] != ELFMAG0 ||
284 ehdr.e_ident[EI_MAG1] != ELFMAG1 ||
285 ehdr.e_ident[EI_MAG2] != ELFMAG2 ||
286 ehdr.e_ident[EI_MAG3] != ELFMAG3) {
287 error("Kernel is not a valid ELF file");
288 return;
289 }
290
291 debug_putstr("Parsing ELF... ");
292
293 phdrs = malloc(sizeof(*phdrs) * ehdr.e_phnum);
294 if (!phdrs)
295 error("Failed to allocate space for phdrs");
296
297 memcpy(phdrs, output + ehdr.e_phoff, sizeof(*phdrs) * ehdr.e_phnum);
298
299 for (i = 0; i < ehdr.e_phnum; i++) {
300 phdr = &phdrs[i];
301
302 switch (phdr->p_type) {
303 case PT_LOAD:
304 #ifdef CONFIG_X86_64
305 if ((phdr->p_align % 0x200000) != 0)
306 error("Alignment of LOAD segment isn't multiple of 2MB");
307 #endif
308 #ifdef CONFIG_RELOCATABLE
309 dest = output;
310 dest += (phdr->p_paddr - LOAD_PHYSICAL_ADDR);
311 #else
312 dest = (void *)(phdr->p_paddr);
313 #endif
314 memmove(dest, output + phdr->p_offset, phdr->p_filesz);
315 break;
316 default: break;
317 }
318 }
319
320 free(phdrs);
321 }
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340 asmlinkage __visible void *extract_kernel(void *rmode, memptr heap,
341 unsigned char *input_data,
342 unsigned long input_len,
343 unsigned char *output,
344 unsigned long output_len)
345 {
346 const unsigned long kernel_total_size = VO__end - VO__text;
347 unsigned long virt_addr = LOAD_PHYSICAL_ADDR;
348 unsigned long needed_size;
349
350
351 boot_params = rmode;
352
353
354 boot_params->hdr.loadflags &= ~KASLR_FLAG;
355
356 sanitize_boot_params(boot_params);
357
358 if (boot_params->screen_info.orig_video_mode == 7) {
359 vidmem = (char *) 0xb0000;
360 vidport = 0x3b4;
361 } else {
362 vidmem = (char *) 0xb8000;
363 vidport = 0x3d4;
364 }
365
366 lines = boot_params->screen_info.orig_video_lines;
367 cols = boot_params->screen_info.orig_video_cols;
368
369 console_init();
370
371
372
373
374
375
376 boot_params->acpi_rsdp_addr = get_rsdp_addr();
377
378 debug_putstr("early console in extract_kernel\n");
379
380 free_mem_ptr = heap;
381 free_mem_end_ptr = heap + BOOT_HEAP_SIZE;
382
383
384
385
386
387
388
389
390
391
392
393
394 needed_size = max(output_len, kernel_total_size);
395 #ifdef CONFIG_X86_64
396 needed_size = ALIGN(needed_size, MIN_KERNEL_ALIGN);
397 #endif
398
399
400 debug_putaddr(input_data);
401 debug_putaddr(input_len);
402 debug_putaddr(output);
403 debug_putaddr(output_len);
404 debug_putaddr(kernel_total_size);
405 debug_putaddr(needed_size);
406
407 #ifdef CONFIG_X86_64
408
409 debug_putaddr(trampoline_32bit);
410 #endif
411
412 choose_random_location((unsigned long)input_data, input_len,
413 (unsigned long *)&output,
414 needed_size,
415 &virt_addr);
416
417
418 if ((unsigned long)output & (MIN_KERNEL_ALIGN - 1))
419 error("Destination physical address inappropriately aligned");
420 if (virt_addr & (MIN_KERNEL_ALIGN - 1))
421 error("Destination virtual address inappropriately aligned");
422 #ifdef CONFIG_X86_64
423 if (heap > 0x3fffffffffffUL)
424 error("Destination address too large");
425 if (virt_addr + max(output_len, kernel_total_size) > KERNEL_IMAGE_SIZE)
426 error("Destination virtual address is beyond the kernel mapping area");
427 #else
428 if (heap > ((-__PAGE_OFFSET-(128<<20)-1) & 0x7fffffff))
429 error("Destination address too large");
430 #endif
431 #ifndef CONFIG_RELOCATABLE
432 if ((unsigned long)output != LOAD_PHYSICAL_ADDR)
433 error("Destination address does not match LOAD_PHYSICAL_ADDR");
434 if (virt_addr != LOAD_PHYSICAL_ADDR)
435 error("Destination virtual address changed when not relocatable");
436 #endif
437
438 debug_putstr("\nDecompressing Linux... ");
439 __decompress(input_data, input_len, NULL, NULL, output, output_len,
440 NULL, error);
441 parse_elf(output);
442 handle_relocations(output, output_len, virt_addr);
443 debug_putstr("done.\nBooting the kernel.\n");
444 return output;
445 }
446
447 void fortify_panic(const char *name)
448 {
449 error("detected buffer overflow");
450 }