2 * Definitions and wrapper functions for kernel decompressor
4 * (C) 2017 Helge Deller <deller@gmx.de>
7 #include <linux/uaccess.h>
9 #include <asm/unaligned.h>
19 #define memmove memmove
20 #define memzero(s, n) memset((s), 0, (n))
22 #define malloc malloc_gzip
23 #define free free_gzip
25 /* Symbols defined by linker scripts */
26 extern char input_data[];
28 /* output_len is inserted by the linker possibly at an unaligned address */
29 extern __le32 output_len __aligned(1);
30 extern char _text, _end;
31 extern char _bss, _ebss;
32 extern char _startcode_end;
33 extern void startup_continue(void *entry, unsigned long cmdline,
34 unsigned long rd_start, unsigned long rd_end) __noreturn;
36 void error(char *m) __noreturn;
38 static unsigned long free_mem_ptr;
39 static unsigned long free_mem_end_ptr;
41 #ifdef CONFIG_KERNEL_GZIP
42 #include "../../../../lib/decompress_inflate.c"
45 #ifdef CONFIG_KERNEL_BZIP2
46 #include "../../../../lib/decompress_bunzip2.c"
49 #ifdef CONFIG_KERNEL_LZ4
50 #include "../../../../lib/decompress_unlz4.c"
53 #ifdef CONFIG_KERNEL_LZMA
54 #include "../../../../lib/decompress_unlzma.c"
57 #ifdef CONFIG_KERNEL_LZO
58 #include "../../../../lib/decompress_unlzo.c"
61 #ifdef CONFIG_KERNEL_XZ
62 #include "../../../../lib/decompress_unxz.c"
65 void *memmove(void *dest, const void *src, size_t n)
82 void *memset(void *s, int c, size_t count)
91 void *memcpy(void *d, const void *s, size_t len)
93 char *dest = (char *)d;
94 const char *source = (const char *)s;
101 size_t strlen(const char *s)
105 for (sc = s; *sc != '\0'; ++sc)
110 char *strchr(const char *s, int c)
120 int puts(const char *s)
122 const char *nuline = s;
124 while ((nuline = strchr(s, '\n')) != NULL) {
126 pdc_iodc_print(s, nuline - s);
127 pdc_iodc_print("\r\n", 2);
131 pdc_iodc_print(s, strlen(s));
136 static int putchar(int c)
146 void __noreturn error(char *x)
150 puts("\n\n -- System halted");
151 while (1) /* wait forever */
155 static int print_hex(unsigned long num)
157 const char hex[] = "0123456789abcdef";
159 int i = sizeof(str)-1;
163 str[i--] = hex[num & 0x0f];
174 int printf(const char *fmt, ...)
191 print_hex(va_arg(args, unsigned long));
198 /* helper functions for libgcc */
205 void *malloc(size_t size)
207 return malloc_gzip(size);
213 return free_gzip(ptr);
217 static void flush_data_cache(char *start, unsigned long length)
219 char *end = start + length;
222 asm volatile("fdc 0(%0)" : : "r" (start));
223 asm volatile("fic 0(%%sr0,%0)" : : "r" (start));
225 } while (start < end);
226 asm volatile("fdc 0(%0)" : : "r" (end));
231 static void parse_elf(void *output)
235 Elf64_Phdr *phdrs, *phdr;
238 Elf32_Phdr *phdrs, *phdr;
243 memcpy(&ehdr, output, sizeof(ehdr));
244 if (ehdr.e_ident[EI_MAG0] != ELFMAG0 ||
245 ehdr.e_ident[EI_MAG1] != ELFMAG1 ||
246 ehdr.e_ident[EI_MAG2] != ELFMAG2 ||
247 ehdr.e_ident[EI_MAG3] != ELFMAG3) {
248 error("Kernel is not a valid ELF file");
253 printf("Parsing ELF... ");
256 phdrs = malloc(sizeof(*phdrs) * ehdr.e_phnum);
258 error("Failed to allocate space for phdrs");
260 memcpy(phdrs, output + ehdr.e_phoff, sizeof(*phdrs) * ehdr.e_phnum);
262 for (i = 0; i < ehdr.e_phnum; i++) {
265 switch (phdr->p_type) {
267 dest = (void *)((unsigned long) phdr->p_paddr &
268 (__PAGE_OFFSET_DEFAULT-1));
269 memmove(dest, output + phdr->p_offset, phdr->p_filesz);
279 unsigned long decompress_kernel(unsigned int started_wide,
280 unsigned int command_line,
281 const unsigned int rd_start,
282 const unsigned int rd_end)
285 unsigned long vmlinux_addr, vmlinux_len;
286 unsigned long kernel_addr, kernel_len;
289 parisc_narrow_firmware = 0;
292 set_firmware_width_unlocked();
294 putchar('D'); /* if you get this D and no more, string storage */
295 /* in $GLOBAL$ is wrong or %dp is wrong */
296 puts("ecompressing Linux... ");
298 /* where the final bits are stored */
299 kernel_addr = KERNEL_BINARY_TEXT_START;
300 kernel_len = __pa(SZ_end) - __pa(SZparisc_kernel_start);
301 if ((unsigned long) &_startcode_end > kernel_addr)
302 error("Bootcode overlaps kernel code");
305 * Calculate addr to where the vmlinux ELF file shall be decompressed.
306 * Assembly code in head.S positioned the stack directly behind bss, so
307 * leave 2 MB for the stack.
309 vmlinux_addr = (unsigned long) &_ebss + 2*1024*1024;
310 vmlinux_len = get_unaligned_le32(&output_len);
311 output = (char *) vmlinux_addr;
314 * Initialize free_mem_ptr and free_mem_end_ptr.
316 free_mem_ptr = vmlinux_addr + vmlinux_len;
318 /* Limit memory for bootoader to 1GB */
319 #define ARTIFICIAL_LIMIT (1*1024*1024*1024)
320 free_mem_end_ptr = PAGE0->imm_max_mem;
321 if (free_mem_end_ptr > ARTIFICIAL_LIMIT)
322 free_mem_end_ptr = ARTIFICIAL_LIMIT;
324 #ifdef CONFIG_BLK_DEV_INITRD
325 /* if we have ramdisk this is at end of memory */
326 if (rd_start && rd_start < free_mem_end_ptr)
327 free_mem_end_ptr = rd_start;
330 if (free_mem_ptr >= free_mem_end_ptr)
331 error("Kernel too big for machine.");
335 printf("startcode_end = %x\n", &_startcode_end);
336 printf("commandline = %x\n", command_line);
337 printf("rd_start = %x\n", rd_start);
338 printf("rd_end = %x\n", rd_end);
340 printf("free_ptr = %x\n", free_mem_ptr);
341 printf("free_ptr_end = %x\n", free_mem_end_ptr);
343 printf("input_data = %x\n", input_data);
344 printf("input_len = %x\n", input_len);
345 printf("output = %x\n", output);
346 printf("output_len = %x\n", vmlinux_len);
347 printf("kernel_addr = %x\n", kernel_addr);
348 printf("kernel_len = %x\n", kernel_len);
351 __decompress(input_data, input_len, NULL, NULL,
352 output, 0, NULL, error);
355 output = (char *) kernel_addr;
356 flush_data_cache(output, kernel_len);
358 printf("done.\nBooting the kernel.\n");
360 return (unsigned long) output;