[deliverable/linux.git] / arch / x86_64 / boot / compressed / misc.c

/*
 * 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
 * puts by Nick Holloway 1993, better puts by Martin Mares 1995
 * High loaded stuff by Hans Lermen & Werner Almesberger, Feb. 1996
 */

#include <linux/screen_info.h>
#include <asm/io.h>
#include <asm/page.h>

/*
 * gzip declarations
 */

#define OF(args)  args
#define STATIC static

#undef memset
#undef memcpy
#define memzero(s, n)     memset ((s), 0, (n))

typedef unsigned char  uch;
typedef unsigned short ush;
typedef unsigned long  ulg;

#define WSIZE 0x8000		/* Window size must be at least 32k, */
				/* and a power of two */

static uch *inbuf;	     /* input buffer */
static uch window[WSIZE];    /* Sliding window buffer */

static unsigned insize = 0;  /* valid bytes in inbuf */
static unsigned inptr = 0;   /* index of next byte to be processed in inbuf */
static unsigned outcnt = 0;  /* bytes in output buffer */

/* gzip flag byte */
#define ASCII_FLAG   0x01 /* bit 0 set: file probably ASCII text */
#define CONTINUATION 0x02 /* bit 1 set: continuation of multi-part gzip file */
#define EXTRA_FIELD  0x04 /* bit 2 set: extra field present */
#define ORIG_NAME    0x08 /* bit 3 set: original file name present */
#define COMMENT      0x10 /* bit 4 set: file comment present */
#define ENCRYPTED    0x20 /* bit 5 set: file is encrypted */
#define RESERVED     0xC0 /* bit 6,7:   reserved */

#define get_byte()  (inptr < insize ? inbuf[inptr++] : fill_inbuf())
		
/* Diagnostic functions */
#ifdef DEBUG
#  define Assert(cond,msg) {if(!(cond)) error(msg);}
#  define Trace(x) fprintf x
#  define Tracev(x) {if (verbose) fprintf x ;}
#  define Tracevv(x) {if (verbose>1) fprintf x ;}
#  define Tracec(c,x) {if (verbose && (c)) fprintf x ;}
#  define Tracecv(c,x) {if (verbose>1 && (c)) fprintf x ;}
#else
#  define Assert(cond,msg)
#  define Trace(x)
#  define Tracev(x)
#  define Tracevv(x)
#  define Tracec(c,x)
#  define Tracecv(c,x)
#endif

static int  fill_inbuf(void);
static void flush_window(void);
static void error(char *m);
static void gzip_mark(void **);
static void gzip_release(void **);
  
/*
 * This is set up by the setup-routine at boot-time
 */
static unsigned char *real_mode; /* Pointer to real-mode data */

#define EXT_MEM_K   (*(unsigned short *)(real_mode + 0x2))
#ifndef STANDARD_MEMORY_BIOS_CALL
#define ALT_MEM_K   (*(unsigned long *)(real_mode + 0x1e0))
#endif
#define SCREEN_INFO (*(struct screen_info *)(real_mode+0))

extern unsigned char input_data[];
extern int input_len;

static long bytes_out = 0;
static uch *output_data;
static unsigned long output_ptr = 0;

static void *malloc(int size);
static void free(void *where);
 
void* memset(void* s, int c, unsigned n);
void* memcpy(void* dest, const void* src, unsigned n);

static void putstr(const char *);

extern int end;
static long free_mem_ptr = (long)&end;
static long free_mem_end_ptr;

#define INPLACE_MOVE_ROUTINE  0x1000
#define LOW_BUFFER_START      0x2000
#define LOW_BUFFER_MAX       0x90000
#define HEAP_SIZE             0x3000
static unsigned int low_buffer_end, low_buffer_size;
static int high_loaded =0;
static uch *high_buffer_start /* = (uch *)(((ulg)&end) + HEAP_SIZE)*/;

static char *vidmem = (char *)0xb8000;
static int vidport;
static int lines, cols;

#include "../../../../lib/inflate.c"

static void *malloc(int size)
{
	void *p;

	if (size <0) error("Malloc error");
	if (free_mem_ptr <= 0) error("Memory error");

	free_mem_ptr = (free_mem_ptr + 3) & ~3;	/* Align */

	p = (void *)free_mem_ptr;
	free_mem_ptr += size;

	if (free_mem_ptr >= free_mem_end_ptr)
		error("Out of memory");

	return p;
}

static void free(void *where)
{	/* Don't care */
}

static void gzip_mark(void **ptr)
{
	*ptr = (void *) free_mem_ptr;
}

static void gzip_release(void **ptr)
{
	free_mem_ptr = (long) *ptr;
}
 
static void scroll(void)
{
	int i;

	memcpy ( vidmem, vidmem + cols * 2, ( lines - 1 ) * cols * 2 );
	for ( i = ( lines - 1 ) * cols * 2; i < lines * cols * 2; i += 2 )
		vidmem[i] = ' ';
}

static void putstr(const char *s)
{
	int x,y,pos;
	char c;

	x = SCREEN_INFO.orig_x;
	y = SCREEN_INFO.orig_y;

	while ( ( c = *s++ ) != '\0' ) {
		if ( c == '\n' ) {
			x = 0;
			if ( ++y >= lines ) {
				scroll();
				y--;
			}
		} else {
			vidmem [ ( x + cols * y ) * 2 ] = c; 
			if ( ++x >= cols ) {
				x = 0;
				if ( ++y >= lines ) {
					scroll();
					y--;
				}
			}
		}
	}

	SCREEN_INFO.orig_x = x;
	SCREEN_INFO.orig_y = y;

	pos = (x + cols * y) * 2;	/* Update cursor position */
	outb_p(14, vidport);
	outb_p(0xff & (pos >> 9), vidport+1);
	outb_p(15, vidport);
	outb_p(0xff & (pos >> 1), vidport+1);
}

void* memset(void* s, int c, unsigned n)
{
	int i;
	char *ss = (char*)s;

	for (i=0;i<n;i++) ss[i] = c;
	return s;
}

void* memcpy(void* dest, const void* src, unsigned n)
{
	int i;
	char *d = (char *)dest, *s = (char *)src;

	for (i=0;i<n;i++) d[i] = s[i];
	return dest;
}

/* ===========================================================================
 * Fill the input buffer. This is called only when the buffer is empty
 * and at least one byte is really needed.
 */
static int fill_inbuf(void)
{
	if (insize != 0) {
		error("ran out of input data");
	}

	inbuf = input_data;
	insize = input_len;
	inptr = 1;
	return inbuf[0];
}

/* ===========================================================================
 * Write the output window window[0..outcnt-1] and update crc and bytes_out.
 * (Used for the decompressed data only.)
 */
static void flush_window_low(void)
{
    ulg c = crc;         /* temporary variable */
    unsigned n;
    uch *in, *out, ch;
    
    in = window;
    out = &output_data[output_ptr]; 
    for (n = 0; n < outcnt; n++) {
	    ch = *out++ = *in++;
	    c = crc_32_tab[((int)c ^ ch) & 0xff] ^ (c >> 8);
    }
    crc = c;
    bytes_out += (ulg)outcnt;
    output_ptr += (ulg)outcnt;
    outcnt = 0;
}

static void flush_window_high(void)
{
    ulg c = crc;         /* temporary variable */
    unsigned n;
    uch *in,  ch;
    in = window;
    for (n = 0; n < outcnt; n++) {
	ch = *output_data++ = *in++;
	if ((ulg)output_data == low_buffer_end) output_data=high_buffer_start;
	c = crc_32_tab[((int)c ^ ch) & 0xff] ^ (c >> 8);
    }
    crc = c;
    bytes_out += (ulg)outcnt;
    outcnt = 0;
}

static void flush_window(void)
{
	if (high_loaded) flush_window_high();
	else flush_window_low();
}

static void error(char *x)
{
	putstr("\n\n");
	putstr(x);
	putstr("\n\n -- System halted");

	while(1);
}

void setup_normal_output_buffer(void)
{
#ifdef STANDARD_MEMORY_BIOS_CALL
	if (EXT_MEM_K < 1024) error("Less than 2MB of memory");
#else
	if ((ALT_MEM_K > EXT_MEM_K ? ALT_MEM_K : EXT_MEM_K) < 1024) error("Less than 2MB of memory");
#endif
	output_data = (unsigned char *)__PHYSICAL_START; /* Normally Points to 1M */
	free_mem_end_ptr = (long)real_mode;
}

struct moveparams {
	uch *low_buffer_start;  int lcount;
	uch *high_buffer_start; int hcount;
};

void setup_output_buffer_if_we_run_high(struct moveparams *mv)
{
	high_buffer_start = (uch *)(((ulg)&end) + HEAP_SIZE);
#ifdef STANDARD_MEMORY_BIOS_CALL
	if (EXT_MEM_K < (3*1024)) error("Less than 4MB of memory");
#else
	if ((ALT_MEM_K > EXT_MEM_K ? ALT_MEM_K : EXT_MEM_K) < (3*1024)) error("Less than 4MB of memory");
#endif	
	mv->low_buffer_start = output_data = (unsigned char *)LOW_BUFFER_START;
	low_buffer_end = ((unsigned int)real_mode > LOW_BUFFER_MAX
	  ? LOW_BUFFER_MAX : (unsigned int)real_mode) & ~0xfff;
	low_buffer_size = low_buffer_end - LOW_BUFFER_START;
	high_loaded = 1;
	free_mem_end_ptr = (long)high_buffer_start;
	if ( (__PHYSICAL_START + low_buffer_size) > ((ulg)high_buffer_start)) {
		high_buffer_start = (uch *)(__PHYSICAL_START + low_buffer_size);
		mv->hcount = 0; /* say: we need not to move high_buffer */
	}
	else mv->hcount = -1;
	mv->high_buffer_start = high_buffer_start;
}

void close_output_buffer_if_we_run_high(struct moveparams *mv)
{
	if (bytes_out > low_buffer_size) {
		mv->lcount = low_buffer_size;
		if (mv->hcount)
			mv->hcount = bytes_out - low_buffer_size;
	} else {
		mv->lcount = bytes_out;
		mv->hcount = 0;
	}
}

int decompress_kernel(struct moveparams *mv, void *rmode)
{
	real_mode = rmode;

	if (SCREEN_INFO.orig_video_mode == 7) {
		vidmem = (char *) 0xb0000;
		vidport = 0x3b4;
	} else {
		vidmem = (char *) 0xb8000;
		vidport = 0x3d4;
	}

	lines = SCREEN_INFO.orig_video_lines;
	cols = SCREEN_INFO.orig_video_cols;

	if (free_mem_ptr < 0x100000) setup_normal_output_buffer();
	else setup_output_buffer_if_we_run_high(mv);

	makecrc();
	putstr(".\nDecompressing Linux...");
	gunzip();
	putstr("done.\nBooting the kernel.\n");
	if (high_loaded) close_output_buffer_if_we_run_high(mv);
	return high_loaded;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* 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	* puts by Nick Holloway 1993, better puts by Martin Mares 1995
	9	* High loaded stuff by Hans Lermen & Werner Almesberger, Feb. 1996
	10	*/
	11
7e7f358c	12	#include <linux/screen_info.h>
1da177e4	13	#include <asm/io.h>
d0537508	14	#include <asm/page.h>
1da177e4 LT	15
	16	/*
	17	* gzip declarations
	18	*/
	19
	20	#define OF(args) args
	21	#define STATIC static
	22
	23	#undef memset
	24	#undef memcpy
	25	#define memzero(s, n) memset ((s), 0, (n))
	26
	27	typedef unsigned char uch;
	28	typedef unsigned short ush;
	29	typedef unsigned long ulg;
	30
	31	#define WSIZE 0x8000 /* Window size must be at least 32k, */
	32	/* and a power of two */
	33
	34	static uch inbuf; / input buffer */
	35	static uch window[WSIZE]; /* Sliding window buffer */
	36
	37	static unsigned insize = 0; /* valid bytes in inbuf */
	38	static unsigned inptr = 0; /* index of next byte to be processed in inbuf */
	39	static unsigned outcnt = 0; /* bytes in output buffer */
	40
	41	/* gzip flag byte */
	42	#define ASCII_FLAG 0x01 /* bit 0 set: file probably ASCII text */
	43	#define CONTINUATION 0x02 /* bit 1 set: continuation of multi-part gzip file */
	44	#define EXTRA_FIELD 0x04 /* bit 2 set: extra field present */
	45	#define ORIG_NAME 0x08 /* bit 3 set: original file name present */
	46	#define COMMENT 0x10 /* bit 4 set: file comment present */
	47	#define ENCRYPTED 0x20 /* bit 5 set: file is encrypted */
	48	#define RESERVED 0xC0 /* bit 6,7: reserved */
	49
	50	#define get_byte() (inptr < insize ? inbuf[inptr++] : fill_inbuf())
	51
	52	/* Diagnostic functions */
	53	#ifdef DEBUG
	54	# define Assert(cond,msg) {if(!(cond)) error(msg);}
	55	# define Trace(x) fprintf x
	56	# define Tracev(x) {if (verbose) fprintf x ;}
	57	# define Tracevv(x) {if (verbose>1) fprintf x ;}
	58	# define Tracec(c,x) {if (verbose && (c)) fprintf x ;}
	59	# define Tracecv(c,x) {if (verbose>1 && (c)) fprintf x ;}
	60	#else
	61	# define Assert(cond,msg)
	62	# define Trace(x)
	63	# define Tracev(x)
	64	# define Tracevv(x)
	65	# define Tracec(c,x)
	66	# define Tracecv(c,x)
	67	#endif
	68
	69	static int fill_inbuf(void);
	70	static void flush_window(void);
	71	static void error(char *m);
	72	static void gzip_mark(void **);
	73	static void gzip_release(void **);
	74
	75	/*
	76	* This is set up by the setup-routine at boot-time
	77	*/
	78	static unsigned char real_mode; / Pointer to real-mode data */
79
80	#define EXT_MEM_K ((unsigned short )(real_mode + 0x2))
81	#ifndef STANDARD_MEMORY_BIOS_CALL
82	#define ALT_MEM_K ((unsigned long )(real_mode + 0x1e0))
83	#endif
84	#define SCREEN_INFO ((struct screen_info )(real_mode+0))
85
b3ab8382	86	extern unsigned char input_data[];
1da177e4 LT	87	extern int input_len;
	88
	89	static long bytes_out = 0;
	90	static uch *output_data;
	91	static unsigned long output_ptr = 0;
	92
	93	static void *malloc(int size);
	94	static void free(void *where);
	95
09dbb476	96	void* memset(void* s, int c, unsigned n);
	97	void* memcpy(void* dest, const void* src, unsigned n);
	98
1da177e4	99	static void putstr(const char *);
f4549448	100
1da177e4 LT	101	extern int end;
	102	static long free_mem_ptr = (long)&end;
	103	static long free_mem_end_ptr;
	104
	105	#define INPLACE_MOVE_ROUTINE 0x1000
	106	#define LOW_BUFFER_START 0x2000
	107	#define LOW_BUFFER_MAX 0x90000
	108	#define HEAP_SIZE 0x3000
	109	static unsigned int low_buffer_end, low_buffer_size;
	110	static int high_loaded =0;
	111	static uch high_buffer_start / = (uch )(((ulg)&end) + HEAP_SIZE)/;
	112
	113	static char vidmem = (char )0xb8000;
	114	static int vidport;
	115	static int lines, cols;
	116
	117	#include "../../../../lib/inflate.c"
	118
	119	static void *malloc(int size)
	120	{
	121	void *p;
	122
	123	if (size <0) error("Malloc error");
	124	if (free_mem_ptr <= 0) error("Memory error");
	125
	126	free_mem_ptr = (free_mem_ptr + 3) & ~3; /* Align */
	127
	128	p = (void *)free_mem_ptr;
	129	free_mem_ptr += size;
	130
	131	if (free_mem_ptr >= free_mem_end_ptr)
	132	error("Out of memory");
	133
	134	return p;
	135	}
	136
	137	static void free(void *where)
	138	{ /* Don't care */
	139	}
	140
	141	static void gzip_mark(void **ptr)
	142	{
	143	ptr = (void ) free_mem_ptr;
	144	}
	145
	146	static void gzip_release(void **ptr)
	147	{
	148	free_mem_ptr = (long) *ptr;
	149	}
	150
	151	static void scroll(void)
	152	{
	153	int i;
	154
	155	memcpy ( vidmem, vidmem + cols * 2, ( lines - 1 ) * cols * 2 );
	156	for ( i = ( lines - 1 ) * cols * 2; i < lines * cols * 2; i += 2 )
	157	vidmem[i] = ' ';
	158	}
	159
	160	static void putstr(const char *s)
	161	{
	162	int x,y,pos;
	163	char c;
	164
165	x = SCREEN_INFO.orig_x;
166	y = SCREEN_INFO.orig_y;
167
168	while ( ( c = *s++ ) != '\0' ) {
169	if ( c == '\n' ) {
170	x = 0;
171	if ( ++y >= lines ) {
172	scroll();
173	y--;
174	}
175	} else {
176	vidmem [ ( x + cols * y ) * 2 ] = c;
177	if ( ++x >= cols ) {
178	x = 0;
179	if ( ++y >= lines ) {
180	scroll();
181	y--;
182	}
183	}
184	}
185	}
186
187	SCREEN_INFO.orig_x = x;
188	SCREEN_INFO.orig_y = y;
189
190	pos = (x + cols * y) * 2; /* Update cursor position */
191	outb_p(14, vidport);
192	outb_p(0xff & (pos >> 9), vidport+1);
193	outb_p(15, vidport);
194	outb_p(0xff & (pos >> 1), vidport+1);
195	}
196
197	void* memset(void* s, int c, unsigned n)
198	{
199	int i;
200	char ss = (char)s;
201
202	for (i=0;i<n;i++) ss[i] = c;
203	return s;
204	}
205
206	void* memcpy(void* dest, const void* src, unsigned n)
207	{
208	int i;
209	char d = (char )dest, s = (char )src;
210
211	for (i=0;i<n;i++) d[i] = s[i];
212	return dest;
213	}
214
215	/* ===========================================================================
216	* Fill the input buffer. This is called only when the buffer is empty
217	* and at least one byte is really needed.
218	*/
219	static int fill_inbuf(void)
220	{
221	if (insize != 0) {
222	error("ran out of input data");
223	}
224
225	inbuf = input_data;
226	insize = input_len;
227	inptr = 1;
228	return inbuf[0];
229	}
230
231	/* ===========================================================================
232	* Write the output window window[0..outcnt-1] and update crc and bytes_out.
233	* (Used for the decompressed data only.)
234	*/
235	static void flush_window_low(void)
236	{
237	ulg c = crc; /* temporary variable */
238	unsigned n;
239	uch in, out, ch;
240
241	in = window;
242	out = &output_data[output_ptr];
243	for (n = 0; n < outcnt; n++) {
244	ch = out++ = in++;
245	c = crc_32_tab[((int)c ^ ch) & 0xff] ^ (c >> 8);
246	}
247	crc = c;
248	bytes_out += (ulg)outcnt;
249	output_ptr += (ulg)outcnt;
250	outcnt = 0;
251	}
252
253	static void flush_window_high(void)
254	{
255	ulg c = crc; /* temporary variable */
256	unsigned n;
257	uch *in, ch;
258	in = window;
259	for (n = 0; n < outcnt; n++) {
260	ch = output_data++ = in++;
261	if ((ulg)output_data == low_buffer_end) output_data=high_buffer_start;
262	c = crc_32_tab[((int)c ^ ch) & 0xff] ^ (c >> 8);
263	}
264	crc = c;
265	bytes_out += (ulg)outcnt;
266	outcnt = 0;
267	}
268
269	static void flush_window(void)
270	{
271	if (high_loaded) flush_window_high();
272	else flush_window_low();
273	}
274
275	static void error(char *x)
276	{
277	putstr("\n\n");
278	putstr(x);
279	putstr("\n\n -- System halted");
280
281	while(1);
282	}
283
284	void setup_normal_output_buffer(void)
285	{
286	#ifdef STANDARD_MEMORY_BIOS_CALL
287	if (EXT_MEM_K < 1024) error("Less than 2MB of memory");
288	#else
289	if ((ALT_MEM_K > EXT_MEM_K ? ALT_MEM_K : EXT_MEM_K) < 1024) error("Less than 2MB of memory");
290	#endif
b3ab8382	291	output_data = (unsigned char )__PHYSICAL_START; / Normally Points to 1M */
1da177e4 LT	292	free_mem_end_ptr = (long)real_mode;
	293	}
	294
	295	struct moveparams {
	296	uch *low_buffer_start; int lcount;
	297	uch *high_buffer_start; int hcount;
	298	};
	299
	300	void setup_output_buffer_if_we_run_high(struct moveparams *mv)
	301	{
	302	high_buffer_start = (uch *)(((ulg)&end) + HEAP_SIZE);
	303	#ifdef STANDARD_MEMORY_BIOS_CALL
	304	if (EXT_MEM_K < (3*1024)) error("Less than 4MB of memory");
	305	#else
	306	if ((ALT_MEM_K > EXT_MEM_K ? ALT_MEM_K : EXT_MEM_K) < (3*1024)) error("Less than 4MB of memory");
	307	#endif
b3ab8382	308	mv->low_buffer_start = output_data = (unsigned char *)LOW_BUFFER_START;
1da177e4 LT	309	low_buffer_end = ((unsigned int)real_mode > LOW_BUFFER_MAX
	310	? LOW_BUFFER_MAX : (unsigned int)real_mode) & ~0xfff;
	311	low_buffer_size = low_buffer_end - LOW_BUFFER_START;
	312	high_loaded = 1;
	313	free_mem_end_ptr = (long)high_buffer_start;
d0537508 EB	314	if ( (__PHYSICAL_START + low_buffer_size) > ((ulg)high_buffer_start)) {
d0537508 EB	315	high_buffer_start = (uch *)(__PHYSICAL_START + low_buffer_size);
1da177e4 LT	316	mv->hcount = 0; /* say: we need not to move high_buffer */
	317	}
	318	else mv->hcount = -1;
	319	mv->high_buffer_start = high_buffer_start;
	320	}
	321
	322	void close_output_buffer_if_we_run_high(struct moveparams *mv)
	323	{
	324	if (bytes_out > low_buffer_size) {
	325	mv->lcount = low_buffer_size;
	326	if (mv->hcount)
	327	mv->hcount = bytes_out - low_buffer_size;
	328	} else {
	329	mv->lcount = bytes_out;
	330	mv->hcount = 0;
	331	}
	332	}
	333
	334	int decompress_kernel(struct moveparams mv, void rmode)
	335	{
	336	real_mode = rmode;
	337
	338	if (SCREEN_INFO.orig_video_mode == 7) {
	339	vidmem = (char *) 0xb0000;
	340	vidport = 0x3b4;
	341	} else {
	342	vidmem = (char *) 0xb8000;
	343	vidport = 0x3d4;
	344	}
	345
	346	lines = SCREEN_INFO.orig_video_lines;
	347	cols = SCREEN_INFO.orig_video_cols;
	348
	349	if (free_mem_ptr < 0x100000) setup_normal_output_buffer();
	350	else setup_output_buffer_if_we_run_high(mv);
	351
	352	makecrc();
	353	putstr(".\nDecompressing Linux...");
	354	gunzip();
	355	putstr("done.\nBooting the kernel.\n");
	356	if (high_loaded) close_output_buffer_if_we_run_high(mv);
	357	return high_loaded;
	358	}