168 lines
		
	
	
		
			3.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			168 lines
		
	
	
		
			3.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0
 | |
| /*
 | |
|  * misc.c
 | |
|  * 
 | |
|  * This is a collection of several routines from gzip-1.0.3 
 | |
|  * adapted for Linux.
 | |
|  *
 | |
|  * malloc by Hannu Savolainen 1993 and Matthias Urlichs 1994
 | |
|  *
 | |
|  * Modified for ARM Linux by Russell King
 | |
|  *
 | |
|  * Nicolas Pitre <nico@visuaide.com>  1999/04/14 :
 | |
|  *  For this code to run directly from Flash, all constant variables must
 | |
|  *  be marked with 'const' and all other variables initialized at run-time 
 | |
|  *  only.  This way all non constant variables will end up in the bss segment,
 | |
|  *  which should point to addresses in RAM and cleared to 0 on start.
 | |
|  *  This allows for a much quicker boot time.
 | |
|  */
 | |
| 
 | |
| unsigned int __machine_arch_type;
 | |
| 
 | |
| #include <linux/compiler.h>	/* for inline */
 | |
| #include <linux/types.h>
 | |
| #include <linux/linkage.h>
 | |
| #include "misc.h"
 | |
| 
 | |
| static void putstr(const char *ptr);
 | |
| 
 | |
| #include CONFIG_UNCOMPRESS_INCLUDE
 | |
| 
 | |
| #ifdef CONFIG_DEBUG_ICEDCC
 | |
| 
 | |
| #if defined(CONFIG_CPU_V6) || defined(CONFIG_CPU_V6K) || defined(CONFIG_CPU_V7)
 | |
| 
 | |
| static void icedcc_putc(int ch)
 | |
| {
 | |
| 	int status, i = 0x4000000;
 | |
| 
 | |
| 	do {
 | |
| 		if (--i < 0)
 | |
| 			return;
 | |
| 
 | |
| 		asm volatile ("mrc p14, 0, %0, c0, c1, 0" : "=r" (status));
 | |
| 	} while (status & (1 << 29));
 | |
| 
 | |
| 	asm("mcr p14, 0, %0, c0, c5, 0" : : "r" (ch));
 | |
| }
 | |
| 
 | |
| 
 | |
| #elif defined(CONFIG_CPU_XSCALE)
 | |
| 
 | |
| static void icedcc_putc(int ch)
 | |
| {
 | |
| 	int status, i = 0x4000000;
 | |
| 
 | |
| 	do {
 | |
| 		if (--i < 0)
 | |
| 			return;
 | |
| 
 | |
| 		asm volatile ("mrc p14, 0, %0, c14, c0, 0" : "=r" (status));
 | |
| 	} while (status & (1 << 28));
 | |
| 
 | |
| 	asm("mcr p14, 0, %0, c8, c0, 0" : : "r" (ch));
 | |
| }
 | |
| 
 | |
| #else
 | |
| 
 | |
| static void icedcc_putc(int ch)
 | |
| {
 | |
| 	int status, i = 0x4000000;
 | |
| 
 | |
| 	do {
 | |
| 		if (--i < 0)
 | |
| 			return;
 | |
| 
 | |
| 		asm volatile ("mrc p14, 0, %0, c0, c0, 0" : "=r" (status));
 | |
| 	} while (status & 2);
 | |
| 
 | |
| 	asm("mcr p14, 0, %0, c1, c0, 0" : : "r" (ch));
 | |
| }
 | |
| 
 | |
| #endif
 | |
| 
 | |
| #define putc(ch)	icedcc_putc(ch)
 | |
| #endif
 | |
| 
 | |
| static void putstr(const char *ptr)
 | |
| {
 | |
| 	char c;
 | |
| 
 | |
| 	while ((c = *ptr++) != '\0') {
 | |
| 		if (c == '\n')
 | |
| 			putc('\r');
 | |
| 		putc(c);
 | |
| 	}
 | |
| 
 | |
| 	flush();
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * gzip declarations
 | |
|  */
 | |
| extern char input_data[];
 | |
| extern char input_data_end[];
 | |
| 
 | |
| unsigned char *output_data;
 | |
| 
 | |
| unsigned long free_mem_ptr;
 | |
| unsigned long free_mem_end_ptr;
 | |
| 
 | |
| #ifndef arch_error
 | |
| #define arch_error(x)
 | |
| #endif
 | |
| 
 | |
| void error(char *x)
 | |
| {
 | |
| 	arch_error(x);
 | |
| 
 | |
| 	putstr("\n\n");
 | |
| 	putstr(x);
 | |
| 	putstr("\n\n -- System halted");
 | |
| 
 | |
| 	while(1);	/* Halt */
 | |
| }
 | |
| 
 | |
| asmlinkage void __div0(void)
 | |
| {
 | |
| 	error("Attempting division by 0!");
 | |
| }
 | |
| 
 | |
| const unsigned long __stack_chk_guard = 0x000a0dff;
 | |
| 
 | |
| void __stack_chk_fail(void)
 | |
| {
 | |
| 	error("stack-protector: Kernel stack is corrupted\n");
 | |
| }
 | |
| 
 | |
| extern int do_decompress(u8 *input, int len, u8 *output, void (*error)(char *x));
 | |
| 
 | |
| 
 | |
| void
 | |
| decompress_kernel(unsigned long output_start, unsigned long free_mem_ptr_p,
 | |
| 		unsigned long free_mem_ptr_end_p,
 | |
| 		int arch_id)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	output_data		= (unsigned char *)output_start;
 | |
| 	free_mem_ptr		= free_mem_ptr_p;
 | |
| 	free_mem_end_ptr	= free_mem_ptr_end_p;
 | |
| 	__machine_arch_type	= arch_id;
 | |
| 
 | |
| 	arch_decomp_setup();
 | |
| 
 | |
| 	putstr("Uncompressing Linux...");
 | |
| 	ret = do_decompress(input_data, input_data_end - input_data,
 | |
| 			    output_data, error);
 | |
| 	if (ret)
 | |
| 		error("decompressor returned an error");
 | |
| 	else
 | |
| 		putstr(" done, booting the kernel.\n");
 | |
| }
 | |
| 
 | |
| void fortify_panic(const char *name)
 | |
| {
 | |
| 	error("detected buffer overflow");
 | |
| }
 |