2 * arch/ppc/boot/common/misc-common.c
4 * Misc. bootloader code (almost) all platforms can use
6 * Author: Johnnie Peters <jpeters@mvista.com>
7 * Editor: Tom Rini <trini@mvista.com>
9 * Derived from arch/ppc/boot/prep/misc.c
11 * 2000-2001 (c) MontaVista, Software, Inc. This file is licensed under
12 * the terms of the GNU General Public License version 2. This program
13 * is licensed "as is" without any warranty of any kind, whether express
17 #include <stdarg.h> /* for va_ bits */
18 #include <linux/config.h>
19 #include <linux/string.h>
23 /* If we're on a PReP, assume we have a keyboard controller
24 * Also note, if we're not PReP, we assume you are a serial
26 #if defined(CONFIG_PPC_PREP) && defined(CONFIG_VGA_CONSOLE)
27 extern void cursor(int x, int y);
28 extern void scroll(void);
30 extern int lines, cols;
31 extern int orig_x, orig_y;
32 extern int keyb_present;
33 extern int CRT_tstc(void);
34 extern int CRT_getc(void);
36 int cursor(int x, int y) {return 0;}
43 #define keyb_present 0
44 int CRT_tstc(void) {return 0;}
45 int CRT_getc(void) {return 0;}
48 extern char *avail_ram;
49 extern char *end_avail;
52 void puts(const char *);
53 void putc(const char c);
54 void puthex(unsigned long val);
55 void _bcopy(char *src, char *dst, int len);
56 void gunzip(void *, int, unsigned char *, int *);
57 static int _cvt(unsigned long val, char *buf, long radix, char *digits);
59 void _vprintk(void(*putc)(const char), const char *fmt0, va_list ap);
60 unsigned char *ISA_io = NULL;
62 #if defined(CONFIG_SERIAL_CONSOLE) || defined(CONFIG_SERIAL_8250_CONSOLE)
63 extern unsigned long com_port;
65 extern int serial_tstc(unsigned long com_port);
66 extern unsigned char serial_getc(unsigned long com_port);
67 extern void serial_putc(unsigned long com_port, unsigned char c);
83 #if defined(CONFIG_SERIAL_CONSOLE) || defined(CONFIG_SERIAL_8250_CONSOLE)
85 return (CRT_tstc() || serial_tstc(com_port));
87 return (serial_tstc(com_port));
96 #if defined(CONFIG_SERIAL_CONSOLE) || defined(CONFIG_SERIAL_8250_CONSOLE)
97 if (serial_tstc(com_port))
98 return (serial_getc(com_port));
99 #endif /* serial console */
111 #if defined(CONFIG_SERIAL_CONSOLE) || defined(CONFIG_SERIAL_8250_CONSOLE)
112 serial_putc(com_port, c);
114 serial_putc(com_port, '\r');
115 #endif /* serial console */
122 if ( ++y >= lines ) {
126 } else if (c == '\r') {
128 } else if (c == '\b') {
133 vidmem [ ( x + cols * y ) * 2 ] = c;
136 if ( ++y >= lines ) {
149 void puts(const char *s)
157 while ( ( c = *s++ ) != '\0' ) {
158 #if defined(CONFIG_SERIAL_CONSOLE) || defined(CONFIG_SERIAL_8250_CONSOLE)
159 serial_putc(com_port, c);
160 if ( c == '\n' ) serial_putc(com_port, '\r');
161 #endif /* serial console */
165 if ( ++y >= lines ) {
169 } else if (c == '\b') {
174 vidmem [ ( x + cols * y ) * 2 ] = c;
177 if ( ++y >= lines ) {
195 puts("\n\n -- System halted");
200 void *zalloc(void *x, unsigned items, unsigned size)
205 size = (size + 7) & -8;
207 if (avail_ram > end_avail) {
208 puts("oops... out of memory\n");
214 void zfree(void *x, void *addr, unsigned nb)
219 #define EXTRA_FIELD 4
222 #define RESERVED 0xe0
226 void gunzip(void *dst, int dstlen, unsigned char *src, int *lenp)
234 if (src[2] != DEFLATED || (flags & RESERVED) != 0) {
235 puts("bad gzipped data\n");
238 if ((flags & EXTRA_FIELD) != 0)
239 i = 12 + src[10] + (src[11] << 8);
240 if ((flags & ORIG_NAME) != 0)
241 while (src[i++] != 0)
243 if ((flags & COMMENT) != 0)
244 while (src[i++] != 0)
246 if ((flags & HEAD_CRC) != 0)
249 puts("gunzip: ran out of data in header\n");
255 r = inflateInit2(&s, -MAX_WBITS);
257 puts("inflateInit2 returned "); puthex(r); puts("\n");
261 s.avail_in = *lenp - i;
263 s.avail_out = dstlen;
264 r = inflate(&s, Z_FINISH);
265 if (r != Z_OK && r != Z_STREAM_END) {
266 puts("inflate returned "); puthex(r); puts("\n");
269 *lenp = s.next_out - (unsigned char *) dst;
274 puthex(unsigned long val)
277 unsigned char buf[10];
279 for (i = 7; i >= 0; i--)
281 buf[i] = "0123456789ABCDEF"[val & 0x0F];
292 _printk(char const *fmt, ...)
297 _vprintk(putc, fmt, ap);
302 #define is_digit(c) ((c >= '0') && (c <= '9'))
305 _vprintk(void(*putc)(const char), const char *fmt0, va_list ap)
307 char c, sign, *cp = 0;
308 int left_prec, right_prec, zero_fill, length = 0, pad, pad_on_right;
311 while ((c = *fmt0++))
316 left_prec = right_prec = pad_on_right = 0;
332 left_prec = (left_prec * 10) + (c - '0');
341 right_prec = (right_prec * 10) + (c - '0');
346 right_prec = left_prec;
354 val = va_arg(ap, long);
363 length = _cvt(val, buf, 10, "0123456789");
366 length = _cvt(val, buf, 16, "0123456789abcdef");
369 length = _cvt(val, buf, 16, "0123456789ABCDEF");
375 cp = va_arg(ap, char *);
379 c = va_arg(ap, long /*char*/);
385 pad = left_prec - length;
440 _cvt(unsigned long val, char *buf, long radix, char *digits)
451 *cp++ = digits[val % radix];
464 _dump_buf_with_offset(unsigned char *p, int s, unsigned char *base)
467 if ((unsigned int)s > (unsigned int)p)
469 s = (unsigned int)s - (unsigned int)p;
475 _printk("%06X: ", (int)p - (int)base);
478 _printk("%06X: ", p);
480 for (i = 0; i < 16; i++)
484 _printk("%02X", p[i] & 0xFF);
489 if ((i % 2) == 1) _printk(" ");
490 if ((i % 8) == 7) _printk(" ");
493 for (i = 0; i < 16; i++)
498 if ((c < 0x20) || (c >= 0x7F)) c = '.';
512 _dump_buf(unsigned char *p, int s)
515 _dump_buf_with_offset(p, s, 0);
518 /* Very simple inb/outb routines. We declare ISA_io to be 0 above, and
519 * then modify it on platforms which need to. We do it like this
520 * because on some platforms we give inb/outb an exact location, and
521 * on others it's an offset from a given location. -- Tom
525 outb(int port, unsigned char val)
527 /* Ensure I/O operations complete */
528 __asm__ volatile("eieio");
535 /* Ensure I/O operations complete */
536 __asm__ volatile("eieio");
537 return (ISA_io[port]);