Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
f30c2269 | 2 | * arch/sh64/boot/compressed/misc.c |
1da177e4 LT |
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 SHmedia from sh by Stuart Menefy, May 2002 | |
10 | */ | |
11 | ||
1da177e4 LT |
12 | #include <asm/uaccess.h> |
13 | ||
14 | /* cache.c */ | |
15 | #define CACHE_ENABLE 0 | |
16 | #define CACHE_DISABLE 1 | |
17 | int cache_control(unsigned int command); | |
18 | ||
19 | /* | |
20 | * gzip declarations | |
21 | */ | |
22 | ||
23 | #define OF(args) args | |
24 | #define STATIC static | |
25 | ||
26 | #undef memset | |
27 | #undef memcpy | |
28 | #define memzero(s, n) memset ((s), 0, (n)) | |
29 | ||
30 | typedef unsigned char uch; | |
31 | typedef unsigned short ush; | |
32 | typedef unsigned long ulg; | |
33 | ||
34 | #define WSIZE 0x8000 /* Window size must be at least 32k, */ | |
35 | /* and a power of two */ | |
36 | ||
37 | static uch *inbuf; /* input buffer */ | |
38 | static uch window[WSIZE]; /* Sliding window buffer */ | |
39 | ||
40 | static unsigned insize = 0; /* valid bytes in inbuf */ | |
41 | static unsigned inptr = 0; /* index of next byte to be processed in inbuf */ | |
42 | static unsigned outcnt = 0; /* bytes in output buffer */ | |
43 | ||
44 | /* gzip flag byte */ | |
45 | #define ASCII_FLAG 0x01 /* bit 0 set: file probably ASCII text */ | |
46 | #define CONTINUATION 0x02 /* bit 1 set: continuation of multi-part gzip file */ | |
47 | #define EXTRA_FIELD 0x04 /* bit 2 set: extra field present */ | |
48 | #define ORIG_NAME 0x08 /* bit 3 set: original file name present */ | |
49 | #define COMMENT 0x10 /* bit 4 set: file comment present */ | |
50 | #define ENCRYPTED 0x20 /* bit 5 set: file is encrypted */ | |
51 | #define RESERVED 0xC0 /* bit 6,7: reserved */ | |
52 | ||
53 | #define get_byte() (inptr < insize ? inbuf[inptr++] : fill_inbuf()) | |
54 | ||
55 | /* Diagnostic functions */ | |
56 | #ifdef DEBUG | |
57 | # define Assert(cond,msg) {if(!(cond)) error(msg);} | |
58 | # define Trace(x) fprintf x | |
59 | # define Tracev(x) {if (verbose) fprintf x ;} | |
60 | # define Tracevv(x) {if (verbose>1) fprintf x ;} | |
61 | # define Tracec(c,x) {if (verbose && (c)) fprintf x ;} | |
62 | # define Tracecv(c,x) {if (verbose>1 && (c)) fprintf x ;} | |
63 | #else | |
64 | # define Assert(cond,msg) | |
65 | # define Trace(x) | |
66 | # define Tracev(x) | |
67 | # define Tracevv(x) | |
68 | # define Tracec(c,x) | |
69 | # define Tracecv(c,x) | |
70 | #endif | |
71 | ||
72 | static int fill_inbuf(void); | |
73 | static void flush_window(void); | |
74 | static void error(char *m); | |
75 | static void gzip_mark(void **); | |
76 | static void gzip_release(void **); | |
77 | ||
78 | extern char input_data[]; | |
79 | extern int input_len; | |
80 | ||
81 | static long bytes_out = 0; | |
82 | static uch *output_data; | |
83 | static unsigned long output_ptr = 0; | |
84 | ||
85 | static void *malloc(int size); | |
86 | static void free(void *where); | |
87 | static void error(char *m); | |
88 | static void gzip_mark(void **); | |
89 | static void gzip_release(void **); | |
90 | ||
91 | static void puts(const char *); | |
92 | ||
93 | extern int _text; /* Defined in vmlinux.lds.S */ | |
94 | extern int _end; | |
95 | static unsigned long free_mem_ptr; | |
96 | static unsigned long free_mem_end_ptr; | |
97 | ||
98 | #define HEAP_SIZE 0x10000 | |
99 | ||
100 | #include "../../../../lib/inflate.c" | |
101 | ||
102 | static void *malloc(int size) | |
103 | { | |
104 | void *p; | |
105 | ||
106 | if (size < 0) | |
107 | error("Malloc error\n"); | |
108 | if (free_mem_ptr == 0) | |
109 | error("Memory error\n"); | |
110 | ||
111 | free_mem_ptr = (free_mem_ptr + 3) & ~3; /* Align */ | |
112 | ||
113 | p = (void *) free_mem_ptr; | |
114 | free_mem_ptr += size; | |
115 | ||
116 | if (free_mem_ptr >= free_mem_end_ptr) | |
117 | error("\nOut of memory\n"); | |
118 | ||
119 | return p; | |
120 | } | |
121 | ||
122 | static void free(void *where) | |
123 | { /* Don't care */ | |
124 | } | |
125 | ||
126 | static void gzip_mark(void **ptr) | |
127 | { | |
128 | *ptr = (void *) free_mem_ptr; | |
129 | } | |
130 | ||
131 | static void gzip_release(void **ptr) | |
132 | { | |
133 | free_mem_ptr = (long) *ptr; | |
134 | } | |
135 | ||
136 | void puts(const char *s) | |
137 | { | |
138 | } | |
139 | ||
140 | void *memset(void *s, int c, size_t n) | |
141 | { | |
142 | int i; | |
143 | char *ss = (char *) s; | |
144 | ||
145 | for (i = 0; i < n; i++) | |
146 | ss[i] = c; | |
147 | return s; | |
148 | } | |
149 | ||
150 | void *memcpy(void *__dest, __const void *__src, size_t __n) | |
151 | { | |
152 | int i; | |
153 | char *d = (char *) __dest, *s = (char *) __src; | |
154 | ||
155 | for (i = 0; i < __n; i++) | |
156 | d[i] = s[i]; | |
157 | return __dest; | |
158 | } | |
159 | ||
160 | /* =========================================================================== | |
161 | * Fill the input buffer. This is called only when the buffer is empty | |
162 | * and at least one byte is really needed. | |
163 | */ | |
164 | static int fill_inbuf(void) | |
165 | { | |
166 | if (insize != 0) { | |
167 | error("ran out of input data\n"); | |
168 | } | |
169 | ||
170 | inbuf = input_data; | |
171 | insize = input_len; | |
172 | inptr = 1; | |
173 | return inbuf[0]; | |
174 | } | |
175 | ||
176 | /* =========================================================================== | |
177 | * Write the output window window[0..outcnt-1] and update crc and bytes_out. | |
178 | * (Used for the decompressed data only.) | |
179 | */ | |
180 | static void flush_window(void) | |
181 | { | |
182 | ulg c = crc; /* temporary variable */ | |
183 | unsigned n; | |
184 | uch *in, *out, ch; | |
185 | ||
186 | in = window; | |
187 | out = &output_data[output_ptr]; | |
188 | for (n = 0; n < outcnt; n++) { | |
189 | ch = *out++ = *in++; | |
190 | c = crc_32_tab[((int) c ^ ch) & 0xff] ^ (c >> 8); | |
191 | } | |
192 | crc = c; | |
193 | bytes_out += (ulg) outcnt; | |
194 | output_ptr += (ulg) outcnt; | |
195 | outcnt = 0; | |
196 | puts("."); | |
197 | } | |
198 | ||
199 | static void error(char *x) | |
200 | { | |
201 | puts("\n\n"); | |
202 | puts(x); | |
203 | puts("\n\n -- System halted"); | |
204 | ||
205 | while (1) ; /* Halt */ | |
206 | } | |
207 | ||
208 | #define STACK_SIZE (4096) | |
209 | long __attribute__ ((aligned(8))) user_stack[STACK_SIZE]; | |
210 | long *stack_start = &user_stack[STACK_SIZE]; | |
211 | ||
212 | void decompress_kernel(void) | |
213 | { | |
214 | output_data = (uch *) (CONFIG_MEMORY_START + 0x2000); | |
215 | free_mem_ptr = (unsigned long) &_end; | |
216 | free_mem_end_ptr = free_mem_ptr + HEAP_SIZE; | |
217 | ||
218 | makecrc(); | |
219 | puts("Uncompressing Linux... "); | |
220 | cache_control(CACHE_ENABLE); | |
221 | gunzip(); | |
222 | puts("\n"); | |
223 | ||
224 | #if 0 | |
225 | /* When booting from ROM may want to do something like this if the | |
226 | * boot loader doesn't. | |
227 | */ | |
228 | ||
229 | /* Set up the parameters and command line */ | |
230 | { | |
231 | volatile unsigned int *parambase = | |
232 | (int *) (CONFIG_MEMORY_START + 0x1000); | |
233 | ||
234 | parambase[0] = 0x1; /* MOUNT_ROOT_RDONLY */ | |
235 | parambase[1] = 0x0; /* RAMDISK_FLAGS */ | |
236 | parambase[2] = 0x0200; /* ORIG_ROOT_DEV */ | |
237 | parambase[3] = 0x0; /* LOADER_TYPE */ | |
238 | parambase[4] = 0x0; /* INITRD_START */ | |
239 | parambase[5] = 0x0; /* INITRD_SIZE */ | |
240 | parambase[6] = 0; | |
241 | ||
242 | strcpy((char *) ((int) parambase + 0x100), | |
243 | "console=ttySC0,38400"); | |
244 | } | |
245 | #endif | |
246 | ||
247 | puts("Ok, booting the kernel.\n"); | |
248 | ||
249 | cache_control(CACHE_DISABLE); | |
250 | } |