LXR linux/arch/nios2/boot/compressed/misc.c

   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
  42typedef unsigned char  uch;
  43typedef unsigned short ush;
  44typedef unsigned long  ulg;
  45#define WSIZE 0x8000            /* Window size must be at least 32k, */
  46                                /* and a power of two */
  47
  48static uch *inbuf;              /* input buffer */
  49static uch window[WSIZE];       /* Sliding window buffer */
  50
  51static unsigned insize; /* valid bytes in inbuf */
  52static unsigned inptr;  /* index of next byte to be processed in inbuf */
  53static 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
  82static int  fill_inbuf(void);
  83static void flush_window(void);
  84static void error(char *m);
  85
  86extern char input_data[];
  87extern int input_len;
  88
  89static long bytes_out;
  90static uch *output_data;
  91static unsigned long output_ptr;
  92
  93#include "console.c"
  94
  95static void error(char *m);
  96
  97int puts(const char *);
  98
  99extern int _end;
 100static unsigned long free_mem_ptr;
 101static unsigned long free_mem_end_ptr;
 102
 103#define HEAP_SIZE                       0x10000
 104
 105#include "../../../../lib/inflate.c"
 106
 107void *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
 117void *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 */
 131static 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 */
 146static 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
 164static 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
 174void 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