1 /* 2 * arch/sh/boot/compressed/misc.c 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 14 #include <asm/uaccess.h> 15 #include <asm/addrspace.h> 16 #include <asm/page.h> 17 #ifdef CONFIG_SH_STANDARD_BIOS 18 #include <asm/sh_bios.h> 19 #endif 20 21 /* 22 * gzip declarations 23 */ 24 25 #define OF(args) args 26 #define STATIC static 27 28 #undef memset 29 #undef memcpy 30 #define memzero(s, n) memset ((s), 0, (n)) 31 32 typedef unsigned char uch; 33 typedef unsigned short ush; 34 typedef unsigned long ulg; 35 36 #define WSIZE 0x8000 /* Window size must be at least 32k, */ 37 /* and a power of two */ 38 39 static uch *inbuf; /* input buffer */ 40 static uch window[WSIZE]; /* Sliding window buffer */ 41 42 static unsigned insize = 0; /* valid bytes in inbuf */ 43 static unsigned inptr = 0; /* index of next byte to be processed in inbuf */ 44 static unsigned outcnt = 0; /* bytes in output buffer */ 45 46 /* gzip flag byte */ 47 #define ASCII_FLAG 0x01 /* bit 0 set: file probably ASCII text */ 48 #define CONTINUATION 0x02 /* bit 1 set: continuation of multi-part gzip file */ 49 #define EXTRA_FIELD 0x04 /* bit 2 set: extra field present */ 50 #define ORIG_NAME 0x08 /* bit 3 set: original file name present */ 51 #define COMMENT 0x10 /* bit 4 set: file comment present */ 52 #define ENCRYPTED 0x20 /* bit 5 set: file is encrypted */ 53 #define RESERVED 0xC0 /* bit 6,7: reserved */ 54 55 #define get_byte() (inptr < insize ? inbuf[inptr++] : fill_inbuf()) 56 57 /* Diagnostic functions */ 58 #ifdef DEBUG 59 # define Assert(cond,msg) {if(!(cond)) error(msg);} 60 # define Trace(x) fprintf x 61 # define Tracev(x) {if (verbose) fprintf x ;} 62 # define Tracevv(x) {if (verbose>1) fprintf x ;} 63 # define Tracec(c,x) {if (verbose && (c)) fprintf x ;} 64 # define Tracecv(c,x) {if (verbose>1 && (c)) fprintf x ;} 65 #else 66 # define Assert(cond,msg) 67 # define Trace(x) 68 # define Tracev(x) 69 # define Tracevv(x) 70 # define Tracec(c,x) 71 # define Tracecv(c,x) 72 #endif 73 74 static int fill_inbuf(void); 75 static void flush_window(void); 76 static void error(char *m); 77 static void gzip_mark(void **); 78 static void gzip_release(void **); 79 80 extern char input_data[]; 81 extern int input_len; 82 83 static long bytes_out = 0; 84 static uch *output_data; 85 static unsigned long output_ptr = 0; 86 87 static void *malloc(int size); 88 static void free(void *where); 89 static void error(char *m); 90 static void gzip_mark(void **); 91 static void gzip_release(void **); 92 93 int puts(const char *); 94 95 extern int _text; /* Defined in vmlinux.lds.S */ 96 extern int _end; 97 static unsigned long free_mem_ptr; 98 static unsigned long free_mem_end_ptr; 99 100 #define HEAP_SIZE 0x10000 101 102 #include "../../../../lib/inflate.c" 103 104 static void *malloc(int size) 105 { 106 void *p; 107 108 if (size <0) error("Malloc error"); 109 if (free_mem_ptr == 0) error("Memory error"); 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("Out of memory"); 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 #ifdef CONFIG_SH_STANDARD_BIOS 137 size_t strlen(const char *s) 138 { 139 int i = 0; 140 141 while (*s++) 142 i++; 143 return i; 144 } 145 146 int puts(const char *s) 147 { 148 int len = strlen(s); 149 sh_bios_console_write(s, len); 150 return len; 151 } 152 #else 153 int puts(const char *s) 154 { 155 /* This should be updated to use the sh-sci routines */ 156 return 0; 157 } 158 #endif 159 160 void* memset(void* s, int c, size_t n) 161 { 162 int i; 163 char *ss = (char*)s; 164 165 for (i=0;i<n;i++) ss[i] = c; 166 return s; 167 } 168 169 void* memcpy(void* __dest, __const void* __src, 170 size_t __n) 171 { 172 int i; 173 char *d = (char *)__dest, *s = (char *)__src; 174 175 for (i=0;i<__n;i++) d[i] = s[i]; 176 return __dest; 177 } 178 179 /* =========================================================================== 180 * Fill the input buffer. This is called only when the buffer is empty 181 * and at least one byte is really needed. 182 */ 183 static int fill_inbuf(void) 184 { 185 if (insize != 0) { 186 error("ran out of input data"); 187 } 188 189 inbuf = input_data; 190 insize = input_len; 191 inptr = 1; 192 return inbuf[0]; 193 } 194 195 /* =========================================================================== 196 * Write the output window window[0..outcnt-1] and update crc and bytes_out. 197 * (Used for the decompressed data only.) 198 */ 199 static void flush_window(void) 200 { 201 ulg c = crc; /* temporary variable */ 202 unsigned n; 203 uch *in, *out, ch; 204 205 in = window; 206 out = &output_data[output_ptr]; 207 for (n = 0; n < outcnt; n++) { 208 ch = *out++ = *in++; 209 c = crc_32_tab[((int)c ^ ch) & 0xff] ^ (c >> 8); 210 } 211 crc = c; 212 bytes_out += (ulg)outcnt; 213 output_ptr += (ulg)outcnt; 214 outcnt = 0; 215 } 216 217 static void error(char *x) 218 { 219 puts("\n\n"); 220 puts(x); 221 puts("\n\n -- System halted"); 222 223 while(1); /* Halt */ 224 } 225 226 #define STACK_SIZE (4096) 227 long user_stack [STACK_SIZE]; 228 long* stack_start = &user_stack[STACK_SIZE]; 229 230 void decompress_kernel(void) 231 { 232 output_data = 0; 233 output_ptr = P2SEGADDR((unsigned long)&_text+PAGE_SIZE); 234 free_mem_ptr = (unsigned long)&_end; 235 free_mem_end_ptr = free_mem_ptr + HEAP_SIZE; 236 237 makecrc(); 238 puts("Uncompressing Linux... "); 239 gunzip(); 240 puts("Ok, booting the kernel.\n"); 241 } 242