xref: /openbmc/linux/arch/nios2/boot/compressed/misc.c (revision f3539c12)
1 /*
2  * Copyright (C) 2009 Thomas Chou <thomas@wytron.com.tw>
3  *
4  * This is a collection of several routines from gzip-1.0.3
5  * adapted for Linux.
6  *
7  * malloc by Hannu Savolainen 1993 and Matthias Urlichs 1994
8  *
9  * Adapted for SH by Stuart Menefy, Aug 1999
10  *
11  * Modified to use standard LinuxSH BIOS by Greg Banks 7Jul2000
12  *
13  * Based on arch/sh/boot/compressed/misc.c
14  *
15  * This program is free software; you can redistribute it and/or modify
16  * it under the terms of the GNU General Public License as published by
17  * the Free Software Foundation; either version 2 of the License, or
18  * (at your option) any later version.
19  *
20  * This program is distributed in the hope that it will be useful,
21  * but WITHOUT ANY WARRANTY; without even the implied warranty of
22  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
23  * GNU General Public License for more details.
24  *
25  * You should have received a copy of the GNU General Public License
26  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
27  *
28  */
29 
30 #include <linux/string.h>
31 
32 /*
33  * gzip declarations
34  */
35 #define OF(args)  args
36 #define STATIC static
37 
38 #undef memset
39 #undef memcpy
40 #define memzero(s, n)		memset((s), 0, (n))
41 
42 typedef unsigned char  uch;
43 typedef unsigned short ush;
44 typedef unsigned long  ulg;
45 #define WSIZE 0x8000		/* Window size must be at least 32k, */
46 				/* and a power of two */
47 
48 static uch *inbuf;		/* input buffer */
49 static uch window[WSIZE];	/* Sliding window buffer */
50 
51 static unsigned insize;	/* valid bytes in inbuf */
52 static unsigned inptr;	/* index of next byte to be processed in inbuf */
53 static unsigned outcnt;	/* bytes in output buffer */
54 
55 /* gzip flag byte */
56 #define ASCII_FLAG	0x01 /* bit 0 set: file probably ASCII text */
57 #define CONTINUATION	0x02 /* bit 1 set: continuation of multi-part gzip
58 				file */
59 #define EXTRA_FIELD	0x04 /* bit 2 set: extra field present */
60 #define ORIG_NAME	0x08 /* bit 3 set: original file name present */
61 #define COMMENT		0x10 /* bit 4 set: file comment present */
62 #define ENCRYPTED	0x20 /* bit 5 set: file is encrypted */
63 #define RESERVED	0xC0 /* bit 6,7:   reserved */
64 
65 #define get_byte()  (inptr < insize ? inbuf[inptr++] : fill_inbuf())
66 
67 #ifdef DEBUG
68 #  define Assert(cond, msg) {if (!(cond)) error(msg); }
69 #  define Trace(x) fprintf x
70 #  define Tracev(x) {if (verbose) fprintf x ; }
71 #  define Tracevv(x) {if (verbose > 1) fprintf x ; }
72 #  define Tracec(c, x) {if (verbose && (c)) fprintf x ; }
73 #  define Tracecv(c, x) {if (verbose > 1 && (c)) fprintf x ; }
74 #else
75 #  define Assert(cond, msg)
76 #  define Trace(x)
77 #  define Tracev(x)
78 #  define Tracevv(x)
79 #  define Tracec(c, x)
80 #  define Tracecv(c, x)
81 #endif
82 static int  fill_inbuf(void);
83 static void flush_window(void);
84 static void error(char *m);
85 
86 extern char input_data[];
87 extern int input_len;
88 
89 static long bytes_out;
90 static uch *output_data;
91 static unsigned long output_ptr;
92 
93 #include "console.c"
94 
95 static void error(char *m);
96 
97 int puts(const char *);
98 
99 extern int _end;
100 static unsigned long free_mem_ptr;
101 static unsigned long free_mem_end_ptr;
102 
103 #define HEAP_SIZE			0x10000
104 
105 #include "../../../../lib/inflate.c"
106 
107 void *memset(void *s, int c, size_t n)
108 {
109 	int i;
110 	char *ss = (char *)s;
111 
112 	for (i = 0; i < n; i++)
113 		ss[i] = c;
114 	return s;
115 }
116 
117 void *memcpy(void *__dest, __const void *__src, size_t __n)
118 {
119 	int i;
120 	char *d = (char *)__dest, *s = (char *)__src;
121 
122 	for (i = 0; i < __n; i++)
123 		d[i] = s[i];
124 	return __dest;
125 }
126 
127 /*
128  * Fill the input buffer. This is called only when the buffer is empty
129  * and at least one byte is really needed.
130  */
131 static int fill_inbuf(void)
132 {
133 	if (insize != 0)
134 		error("ran out of input data");
135 
136 	inbuf = input_data;
137 	insize = input_len;
138 	inptr = 1;
139 	return inbuf[0];
140 }
141 
142 /*
143  * Write the output window window[0..outcnt-1] and update crc and bytes_out.
144  * (Used for the decompressed data only.)
145  */
146 static void flush_window(void)
147 {
148 	ulg c = crc;	/* temporary variable */
149 	unsigned n;
150 	uch *in, *out, ch;
151 
152 	in = window;
153 	out = &output_data[output_ptr];
154 	for (n = 0; n < outcnt; n++) {
155 		ch = *out++ = *in++;
156 		c = crc_32_tab[((int)c ^ ch) & 0xff] ^ (c >> 8);
157 	}
158 	crc = c;
159 	bytes_out += (ulg)outcnt;
160 	output_ptr += (ulg)outcnt;
161 	outcnt = 0;
162 }
163 
164 static void error(char *x)
165 {
166 	puts("\nERROR\n");
167 	puts(x);
168 	puts("\n\n -- System halted");
169 
170 	while (1)	/* Halt */
171 		;
172 }
173 
174 void decompress_kernel(void)
175 {
176 	output_data = (void *) (CONFIG_NIOS2_MEM_BASE |
177 				CONFIG_NIOS2_KERNEL_REGION_BASE);
178 	output_ptr = 0;
179 	free_mem_ptr = (unsigned long)&_end;
180 	free_mem_end_ptr = free_mem_ptr + HEAP_SIZE;
181 
182 	console_init();
183 	makecrc();
184 	puts("Uncompressing Linux... ");
185 	gunzip();
186 	puts("Ok, booting the kernel.\n");
187 }
188