Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2)  * Definitions and wrapper functions for kernel decompressor
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *   (C) 2017 Helge Deller <deller@gmx.de>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/elf.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <asm/unaligned.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <asm/page.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include "sizes.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  * gzip declarations
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #define STATIC static
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #undef memmove
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #define memmove memmove
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #define memzero(s, n) memset((s), 0, (n))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #define malloc	malloc_gzip
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #define free	free_gzip
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) /* Symbols defined by linker scripts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) extern char input_data[];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) extern int input_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) /* output_len is inserted by the linker possibly at an unaligned address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) extern __le32 output_len __aligned(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) extern char _text, _end;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) extern char _bss, _ebss;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) extern char _startcode_end;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) extern void startup_continue(void *entry, unsigned long cmdline,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	unsigned long rd_start, unsigned long rd_end) __noreturn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) void error(char *m) __noreturn;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) static unsigned long free_mem_ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) static unsigned long free_mem_end_ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) #ifdef CONFIG_KERNEL_GZIP
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) #include "../../../../lib/decompress_inflate.c"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) #ifdef CONFIG_KERNEL_BZIP2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) #include "../../../../lib/decompress_bunzip2.c"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) #ifdef CONFIG_KERNEL_LZ4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) #include "../../../../lib/decompress_unlz4.c"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) #ifdef CONFIG_KERNEL_LZMA
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) #include "../../../../lib/decompress_unlzma.c"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) #ifdef CONFIG_KERNEL_LZO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) #include "../../../../lib/decompress_unlzo.c"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) #ifdef CONFIG_KERNEL_XZ
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) #include "../../../../lib/decompress_unxz.c"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) void *memmove(void *dest, const void *src, size_t n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	const char *s = src;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	char *d = dest;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	if (d <= s) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 		while (n--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 			*d++ = *s++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 		d += n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 		s += n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 		while (n--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 			*--d = *--s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	return dest;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) void *memset(void *s, int c, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	char *xs = (char *)s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 	while (count--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 		*xs++ = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	return s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) void *memcpy(void *d, const void *s, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	char *dest = (char *)d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	const char *source = (const char *)s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	while (len--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 		*dest++ = *source++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	return d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) size_t strlen(const char *s)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	const char *sc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 	for (sc = s; *sc != '\0'; ++sc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 		;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	return sc - s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) char *strchr(const char *s, int c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	while (*s) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 		if (*s == (char)c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 			return (char *)s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 		++s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) int puts(const char *s)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	const char *nuline = s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	while ((nuline = strchr(s, '\n')) != NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 		if (nuline != s)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 			pdc_iodc_print(s, nuline - s);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 		pdc_iodc_print("\r\n", 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 		s = nuline + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	if (*s != '\0')
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 		pdc_iodc_print(s, strlen(s));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) static int putchar(int c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	char buf[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	buf[0] = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	buf[1] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	puts(buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	return c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) void __noreturn error(char *x)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	if (x) puts(x);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	puts("\n -- System halted\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 	while (1)	/* wait forever */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 		;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) static int print_num(unsigned long num, int base)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	const char hex[] = "0123456789abcdef";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	char str[40];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	int i = sizeof(str)-1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	str[i--] = '\0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		str[i--] = hex[num % base];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		num = num / base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	} while (num);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	if (base == 16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 		str[i--] = 'x';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 		str[i] = '0';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	} else i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	puts(&str[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) int printf(const char *fmt, ...)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	va_list args;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	int i = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	va_start(args, fmt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	while (fmt[i]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		if (fmt[i] != '%') {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) put:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 			putchar(fmt[i++]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 		if (fmt[++i] == '%')
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 			goto put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 		print_num(va_arg(args, unsigned long),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 			fmt[i] == 'x' ? 16:10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 		++i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	va_end(args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) /* helper functions for libgcc */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) void abort(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	error("aborted.");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) #undef malloc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) void *malloc(size_t size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	return malloc_gzip(size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) #undef free
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) void free(void *ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	return free_gzip(ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) static void flush_data_cache(char *start, unsigned long length)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 	char *end = start + length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 	do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 		asm volatile("fdc 0(%0)" : : "r" (start));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 		asm volatile("fic 0(%%sr0,%0)" : : "r" (start));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 		start += 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	} while (start < end);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	asm volatile("fdc 0(%0)" : : "r" (end));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 	asm ("sync");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) static void parse_elf(void *output)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) #ifdef CONFIG_64BIT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 	Elf64_Ehdr ehdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 	Elf64_Phdr *phdrs, *phdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 	Elf32_Ehdr ehdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 	Elf32_Phdr *phdrs, *phdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 	void *dest;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 	memcpy(&ehdr, output, sizeof(ehdr));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 	if (ehdr.e_ident[EI_MAG0] != ELFMAG0 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	   ehdr.e_ident[EI_MAG1] != ELFMAG1 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 	   ehdr.e_ident[EI_MAG2] != ELFMAG2 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 	   ehdr.e_ident[EI_MAG3] != ELFMAG3) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 		error("Kernel is not a valid ELF file");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 	printf("Parsing ELF... ");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	phdrs = malloc(sizeof(*phdrs) * ehdr.e_phnum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 	if (!phdrs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 		error("Failed to allocate space for phdrs");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	memcpy(phdrs, output + ehdr.e_phoff, sizeof(*phdrs) * ehdr.e_phnum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	for (i = 0; i < ehdr.e_phnum; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 		phdr = &phdrs[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 		switch (phdr->p_type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 		case PT_LOAD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 			dest = (void *)((unsigned long) phdr->p_paddr &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 					(__PAGE_OFFSET_DEFAULT-1));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 			memmove(dest, output + phdr->p_offset, phdr->p_filesz);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 		default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 	free(phdrs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) unsigned long decompress_kernel(unsigned int started_wide,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 		unsigned int command_line,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 		const unsigned int rd_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 		const unsigned int rd_end)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) 	char *output;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 	unsigned long vmlinux_addr, vmlinux_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 	unsigned long kernel_addr, kernel_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) #ifdef CONFIG_64BIT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	parisc_narrow_firmware = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 	set_firmware_width_unlocked();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 	putchar('D');	/* if you get this D and no more, string storage */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 			/* in $GLOBAL$ is wrong or %dp is wrong */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 	puts("ecompressing Linux... ");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 	/* where the final bits are stored */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	kernel_addr = KERNEL_BINARY_TEXT_START;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 	kernel_len = __pa(SZ_end) - __pa(SZparisc_kernel_start);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	if ((unsigned long) &_startcode_end > kernel_addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 		error("Bootcode overlaps kernel code");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 	 * Calculate addr to where the vmlinux ELF file shall be decompressed.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	 * Assembly code in head.S positioned the stack directly behind bss, so
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 	 * leave 2 MB for the stack.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) 	vmlinux_addr = (unsigned long) &_ebss + 2*1024*1024;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 	vmlinux_len = get_unaligned_le32(&output_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) 	output = (char *) vmlinux_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	 * Initialize free_mem_ptr and free_mem_end_ptr.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 	free_mem_ptr = vmlinux_addr + vmlinux_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 	/* Limit memory for bootoader to 1GB */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 	#define ARTIFICIAL_LIMIT (1*1024*1024*1024)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 	free_mem_end_ptr = PAGE0->imm_max_mem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 	if (free_mem_end_ptr > ARTIFICIAL_LIMIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 		free_mem_end_ptr = ARTIFICIAL_LIMIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) #ifdef CONFIG_BLK_DEV_INITRD
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 	/* if we have ramdisk this is at end of memory */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 	if (rd_start && rd_start < free_mem_end_ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 		free_mem_end_ptr = rd_start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 	if (free_mem_ptr >= free_mem_end_ptr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 		int free_ram;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 		free_ram = (free_mem_ptr >> 20) + 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 		if (free_ram < 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) 			free_ram = 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 		printf("\nKernel requires at least %d MB RAM.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) 			free_ram);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) 		error(NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) #ifdef DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	printf("\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	printf("startcode_end = %x\n", &_startcode_end);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 	printf("commandline   = %x\n", command_line);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 	printf("rd_start      = %x\n", rd_start);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 	printf("rd_end        = %x\n", rd_end);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	printf("free_ptr      = %x\n", free_mem_ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	printf("free_ptr_end  = %x\n", free_mem_end_ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 	printf("input_data    = %x\n", input_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	printf("input_len     = %x\n", input_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 	printf("output        = %x\n", output);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	printf("output_len    = %x\n", vmlinux_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 	printf("kernel_addr   = %x\n", kernel_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	printf("kernel_len    = %x\n", kernel_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	__decompress(input_data, input_len, NULL, NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 			output, 0, NULL, error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 	parse_elf(output);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 	output = (char *) kernel_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 	flush_data_cache(output, kernel_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 	printf("done.\nBooting the kernel.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 	return (unsigned long) output;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) }