Blackfin arch: Clean oprofile build path for blackfin
[linux-2.6.git] / arch / sh / boot / compressed / misc_64.c
1 /*
2  * arch/sh/boot/compressed/misc_64.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 SHmedia from sh by Stuart Menefy, May 2002
10  */
11
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
76 extern char input_data[];
77 extern int input_len;
78
79 static long bytes_out = 0;
80 static uch *output_data;
81 static unsigned long output_ptr = 0;
82
83 static void error(char *m);
84
85 static void puts(const char *);
86
87 extern int _text;               /* Defined in vmlinux.lds.S */
88 extern int _end;
89 static unsigned long free_mem_ptr;
90 static unsigned long free_mem_end_ptr;
91
92 #define HEAP_SIZE             0x10000
93
94 #include "../../../../lib/inflate.c"
95
96 void puts(const char *s)
97 {
98 }
99
100 void *memset(void *s, int c, size_t n)
101 {
102         int i;
103         char *ss = (char *) s;
104
105         for (i = 0; i < n; i++)
106                 ss[i] = c;
107         return s;
108 }
109
110 void *memcpy(void *__dest, __const void *__src, size_t __n)
111 {
112         int i;
113         char *d = (char *) __dest, *s = (char *) __src;
114
115         for (i = 0; i < __n; i++)
116                 d[i] = s[i];
117         return __dest;
118 }
119
120 /* ===========================================================================
121  * Fill the input buffer. This is called only when the buffer is empty
122  * and at least one byte is really needed.
123  */
124 static int fill_inbuf(void)
125 {
126         if (insize != 0) {
127                 error("ran out of input data\n");
128         }
129
130         inbuf = input_data;
131         insize = input_len;
132         inptr = 1;
133         return inbuf[0];
134 }
135
136 /* ===========================================================================
137  * Write the output window window[0..outcnt-1] and update crc and bytes_out.
138  * (Used for the decompressed data only.)
139  */
140 static void flush_window(void)
141 {
142         ulg c = crc;            /* temporary variable */
143         unsigned n;
144         uch *in, *out, ch;
145
146         in = window;
147         out = &output_data[output_ptr];
148         for (n = 0; n < outcnt; n++) {
149                 ch = *out++ = *in++;
150                 c = crc_32_tab[((int) c ^ ch) & 0xff] ^ (c >> 8);
151         }
152         crc = c;
153         bytes_out += (ulg) outcnt;
154         output_ptr += (ulg) outcnt;
155         outcnt = 0;
156         puts(".");
157 }
158
159 static void error(char *x)
160 {
161         puts("\n\n");
162         puts(x);
163         puts("\n\n -- System halted");
164
165         while (1) ;             /* Halt */
166 }
167
168 #define STACK_SIZE (4096)
169 long __attribute__ ((aligned(8))) user_stack[STACK_SIZE];
170 long *stack_start = &user_stack[STACK_SIZE];
171
172 void decompress_kernel(void)
173 {
174         output_data = (uch *) (CONFIG_MEMORY_START + 0x2000);
175         free_mem_ptr = (unsigned long) &_end;
176         free_mem_end_ptr = free_mem_ptr + HEAP_SIZE;
177
178         makecrc();
179         puts("Uncompressing Linux... ");
180         cache_control(CACHE_ENABLE);
181         gunzip();
182         puts("\n");
183
184 #if 0
185         /* When booting from ROM may want to do something like this if the
186          * boot loader doesn't.
187          */
188
189         /* Set up the parameters and command line */
190         {
191                 volatile unsigned int *parambase =
192                     (int *) (CONFIG_MEMORY_START + 0x1000);
193
194                 parambase[0] = 0x1;     /* MOUNT_ROOT_RDONLY */
195                 parambase[1] = 0x0;     /* RAMDISK_FLAGS */
196                 parambase[2] = 0x0200;  /* ORIG_ROOT_DEV */
197                 parambase[3] = 0x0;     /* LOADER_TYPE */
198                 parambase[4] = 0x0;     /* INITRD_START */
199                 parambase[5] = 0x0;     /* INITRD_SIZE */
200                 parambase[6] = 0;
201
202                 strcpy((char *) ((int) parambase + 0x100),
203                        "console=ttySC0,38400");
204         }
205 #endif
206
207         puts("Ok, booting the kernel.\n");
208
209         cache_control(CACHE_DISABLE);
210 }