4 * $Id: misc.c,v 1.8 2005/04/24 18:34:29 starvik Exp $
6 * This is a collection of several routines from gzip-1.0.3
9 * malloc by Hannu Savolainen 1993 and Matthias Urlichs 1994
10 * puts by Nick Holloway 1993, better puts by Martin Mares 1995
11 * adoptation for Linux/CRIS Axis Communications AB, 1999
15 /* where the piggybacked kernel image expects itself to live.
16 * it is the same address we use when we network load an uncompressed
17 * image into DRAM, and it is the address the kernel is linked to live
21 #define KERNEL_LOAD_ADR 0x40004000
24 #include <linux/types.h>
25 #include <asm/arch/hwregs/reg_rdwr.h>
26 #include <asm/arch/hwregs/reg_map.h>
27 #include <asm/arch/hwregs/ser_defs.h>
36 void* memset(void* s
, int c
, size_t n
);
37 void* memcpy(void* __dest
, __const
void* __src
,
40 #define memzero(s, n) memset ((s), 0, (n))
43 typedef unsigned char uch
;
44 typedef unsigned short ush
;
45 typedef unsigned long ulg
;
47 #define WSIZE 0x8000 /* Window size must be at least 32k, */
48 /* and a power of two */
50 static uch
*inbuf
; /* input buffer */
51 static uch window
[WSIZE
]; /* Sliding window buffer */
53 unsigned inptr
= 0; /* index of next byte to be processed in inbuf
54 * After decompression it will contain the
55 * compressed size, and head.S will read it.
58 static unsigned outcnt
= 0; /* bytes in output buffer */
61 #define ASCII_FLAG 0x01 /* bit 0 set: file probably ascii text */
62 #define CONTINUATION 0x02 /* bit 1 set: continuation of multi-part gzip file */
63 #define EXTRA_FIELD 0x04 /* bit 2 set: extra field present */
64 #define ORIG_NAME 0x08 /* bit 3 set: original file name present */
65 #define COMMENT 0x10 /* bit 4 set: file comment present */
66 #define ENCRYPTED 0x20 /* bit 5 set: file is encrypted */
67 #define RESERVED 0xC0 /* bit 6,7: reserved */
69 #define get_byte() inbuf[inptr++]
71 /* Diagnostic functions */
73 # define Assert(cond,msg) {if(!(cond)) error(msg);}
74 # define Trace(x) fprintf x
75 # define Tracev(x) {if (verbose) fprintf x ;}
76 # define Tracevv(x) {if (verbose>1) fprintf x ;}
77 # define Tracec(c,x) {if (verbose && (c)) fprintf x ;}
78 # define Tracecv(c,x) {if (verbose>1 && (c)) fprintf x ;}
80 # define Assert(cond,msg)
88 static int fill_inbuf(void);
89 static void flush_window(void);
90 static void error(char *m
);
91 static void gzip_mark(void **);
92 static void gzip_release(void **);
94 extern char *input_data
; /* lives in head.S */
96 static long bytes_out
= 0;
97 static uch
*output_data
;
98 static unsigned long output_ptr
= 0;
100 static void *malloc(int size
);
101 static void free(void *where
);
102 static void error(char *m
);
103 static void gzip_mark(void **);
104 static void gzip_release(void **);
106 static void puts(const char *);
108 /* the "heap" is put directly after the BSS ends, at end */
111 static long free_mem_ptr
= (long)&_end
;
113 #include "../../../../../lib/inflate.c"
115 static void *malloc(int size
)
119 if (size
<0) error("Malloc error");
121 free_mem_ptr
= (free_mem_ptr
+ 3) & ~3; /* Align */
123 p
= (void *)free_mem_ptr
;
124 free_mem_ptr
+= size
;
129 static void free(void *where
)
133 static void gzip_mark(void **ptr
)
135 *ptr
= (void *) free_mem_ptr
;
138 static void gzip_release(void **ptr
)
140 free_mem_ptr
= (long) *ptr
;
143 /* decompressor info and error messages to serial console */
146 serout(const char *s
, reg_scope_instances regi_ser
)
148 reg_ser_rs_stat_din rs
;
149 reg_ser_rw_dout dout
= {.data
= *s
};
152 rs
= REG_RD(ser
, regi_ser
, rs_stat_din
);
154 while (!rs
.tr_rdy
);/* Wait for tranceiver. */
156 REG_WR(ser
, regi_ser
, rw_dout
, dout
);
162 #ifndef CONFIG_ETRAX_DEBUG_PORT_NULL
164 #ifdef CONFIG_ETRAX_DEBUG_PORT0
165 serout(s
, regi_ser0
);
167 #ifdef CONFIG_ETRAX_DEBUG_PORT1
168 serout(s
, regi_ser1
);
170 #ifdef CONFIG_ETRAX_DEBUG_PORT2
171 serout(s
, regi_ser2
);
173 #ifdef CONFIG_ETRAX_DEBUG_PORT3
174 serout(s
, regi_ser3
);
178 /* CONFIG_ETRAX_DEBUG_PORT_NULL */
183 memset(void* s
, int c
, size_t n
)
188 for (i
=0;i
<n
;i
++) ss
[i
] = c
;
192 memcpy(void* __dest
, __const
void* __src
,
196 char *d
= (char *)__dest
, *s
= (char *)__src
;
198 for (i
=0;i
<__n
;i
++) d
[i
] = s
[i
];
201 /* ===========================================================================
202 * Write the output window window[0..outcnt-1] and update crc and bytes_out.
203 * (Used for the decompressed data only.)
209 ulg c
= crc
; /* temporary variable */
214 out
= &output_data
[output_ptr
];
215 for (n
= 0; n
< outcnt
; n
++) {
217 c
= crc_32_tab
[((int)c
^ ch
) & 0xff] ^ (c
>> 8);
220 bytes_out
+= (ulg
)outcnt
;
221 output_ptr
+= (ulg
)outcnt
;
230 puts("\n\n -- System halted\n");
236 setup_normal_output_buffer()
238 output_data
= (char *)KERNEL_LOAD_ADR
;
242 serial_setup(reg_scope_instances regi_ser
)
244 reg_ser_rw_xoff xoff
;
245 reg_ser_rw_tr_ctrl tr_ctrl
;
246 reg_ser_rw_rec_ctrl rec_ctrl
;
247 reg_ser_rw_tr_baud_div tr_baud
;
248 reg_ser_rw_rec_baud_div rec_baud
;
251 xoff
= REG_RD(ser
, regi_ser
, rw_xoff
);
254 xoff
.automatic
= regk_ser_no
;
256 REG_WR(ser
, regi_ser
, rw_xoff
, xoff
);
258 /* Set baudrate and stopbits. */
259 tr_ctrl
= REG_RD(ser
, regi_ser
, rw_tr_ctrl
);
260 rec_ctrl
= REG_RD(ser
, regi_ser
, rw_rec_ctrl
);
261 tr_baud
= REG_RD(ser
, regi_ser
, rw_tr_baud_div
);
262 rec_baud
= REG_RD(ser
, regi_ser
, rw_rec_baud_div
);
264 tr_ctrl
.stop_bits
= 1; /* 2 stop bits. */
267 * The baudrate setup is a bit fishy, but in the end the tranceiver is
268 * set to 4800 and the receiver to 115200. The magic value is
271 tr_ctrl
.base_freq
= regk_ser_f29_493
;
272 rec_ctrl
.base_freq
= regk_ser_f29_493
;
273 tr_baud
.div
= (29493000 / 8) / 4800;
274 rec_baud
.div
= (29493000 / 8) / 115200;
276 REG_WR(ser
, regi_ser
, rw_tr_ctrl
, tr_ctrl
);
277 REG_WR(ser
, regi_ser
, rw_tr_baud_div
, tr_baud
);
278 REG_WR(ser
, regi_ser
, rw_rec_ctrl
, rec_ctrl
);
279 REG_WR(ser
, regi_ser
, rw_rec_baud_div
, rec_baud
);
287 /* input_data is set in head.S */
290 #ifdef CONFIG_ETRAX_DEBUG_PORT0
291 serial_setup(regi_ser0
);
293 #ifdef CONFIG_ETRAX_DEBUG_PORT1
294 serial_setup(regi_ser1
);
296 #ifdef CONFIG_ETRAX_DEBUG_PORT2
297 serial_setup(regi_ser2
);
299 #ifdef CONFIG_ETRAX_DEBUG_PORT3
300 serial_setup(regi_ser3
);
303 setup_normal_output_buffer();
307 __asm__
volatile ("move $vr,%0" : "=rm" (revision
));
310 puts("You need an ETRAX FS to run Linux 2.6/crisv32.\n");
314 puts("Uncompressing Linux...\n");
316 puts("Done. Now booting the kernel.\n");