1 /*
2 * print.c: Simple print fascility
3 *
4 * Copyright (C) 1998 Gleb Raiko & Vladimir Roganov
5 */
6 #include <stdarg.h>
7 #include <linux/kernel.h>
8 #include <linux/init.h>
9
10 #include <asm/baget/baget.h>
11
12 /*
13 * Define this to see 'baget_printk' (debug) messages
14 */
15 // #define BAGET_PRINTK
16
17 /*
18 * This function is same for BALO and Linux baget_printk,
19 * and normally prints characted to second (UART A) console.
20 */
21
delay(void)22 static void delay(void) {}
23
outc_low(char c)24 static void outc_low(char c)
25 {
26 int i;
27 vac_outb(c, VAC_UART_B_TX);
28 for (i=0; i<10000; i++)
29 delay();
30 }
31
outc(char c)32 void outc(char c)
33 {
34 if (c == '\n')
35 outc_low('\r');
36 outc_low(c);
37 }
38
outs(char * s)39 void outs(char *s)
40 {
41 while(*s) outc(*s++);
42 }
43
baget_write(char * s,int l)44 void baget_write(char *s, int l)
45 {
46 while(l--)
47 outc(*s++);
48 }
49
baget_printk(const char * fmt,...)50 int baget_printk(const char *fmt, ...)
51 {
52 #ifdef BAGET_PRINTK
53 va_list args;
54 int i;
55 static char buf[1024];
56
57 va_start(args, fmt);
58 i = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf)-4 */
59 va_end(args);
60 baget_write(buf, i);
61 return i;
62 #else
63 return 0;
64 #endif
65 }
66
puthex(int a)67 static __inline__ void puthex( int a )
68 {
69 static char s[9];
70 static char e[] = "0123456789ABCDEF";
71 int i;
72 for( i = 7; i >= 0; i--, a >>= 4 ) s[i] = e[a & 0x0F];
73 s[8] = '\0';
74 outs( s );
75 }
76
balo_printf(char * f,...)77 void __init balo_printf( char *f, ... )
78 {
79 int *arg = (int*)&f + 1;
80 char c;
81 int format = 0;
82
83 while((c = *f++) != 0) {
84 switch(c) {
85 default:
86 if(format) {
87 outc('%');
88 format = 0;
89 }
90 outc( c );
91 break;
92 case '%':
93 if( format ){
94 format = 0;
95 outc(c);
96 } else format = 1;
97 break;
98 case 'x':
99 if(format) puthex( *arg++ );
100 else outc(c);
101 format = 0;
102 break;
103 case 's':
104 if( format ) outs((char *)*arg++);
105 else outc(c);
106 format = 0;
107 break;
108 }
109 }
110 }
111
balo_hungup(void)112 void __init balo_hungup(void)
113 {
114 outs("Hunging up.\n");
115 while(1);
116 }
117