Subversion Repositories or1k

/*
 * print.c: Simple print fascility
 *
 * Copyright (C) 1998 Gleb Raiko & Vladimir Roganov
 */
#include <stdarg.h>
#include <linux/kernel.h>
#include <linux/init.h>
 
#include <asm/baget/baget.h>
 
/*
 *  Define this to see 'baget_printk' (debug) messages
 */
// #define BAGET_PRINTK
 
/*
 *  This function is same for BALO and Linux baget_printk,
 *  and normally prints characted to second (UART A) console.
 */
 
static void delay(void) {}
 
static void outc_low(char c)
{
        int i;
        vac_outb(c, VAC_UART_B_TX);
        for (i=0; i<10000; i++)
                delay();
}
 
void outc(char c)
{
        if (c == '\n')
                outc_low('\r');
        outc_low(c);
}
 
void outs(char *s)
{
        while(*s) outc(*s++);
}
 
void baget_write(char *s, int l)
{
        while(l--)
                outc(*s++);
}
 
int baget_printk(const char *fmt, ...)
{
#ifdef BAGET_PRINTK
        va_list args;
        int i;
        static char buf[1024];
 
        va_start(args, fmt);
        i = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf)-4 */
        va_end(args);
        baget_write(buf, i);
        return i;
#else
	return 0;
#endif
}
 
static __inline__ void puthex( int a )
{
        static char s[9];
        static char e[] = "0123456789ABCDEF";
        int i;
        for( i = 7; i >= 0; i--, a >>= 4 ) s[i] = e[a & 0x0F];
        s[8] = '\0';
        outs( s );
}
 
void __init balo_printf( char *f, ... )
{
        int *arg = (int*)&f + 1;
        char c;
        int format = 0;
 
        while((c = *f++) != 0) {
                switch(c) {
                default:
                        if(format) {
                                outc('%');
                                format = 0;
                        }
                        outc( c );
                        break;
                case '%':
                        if( format ){
                                format = 0;
                                outc(c);
                        } else format = 1;
                        break;
                case 'x':
                        if(format) puthex( *arg++ );
                        else outc(c);
                        format = 0;
                        break;
                case 's':
                        if( format ) outs((char *)*arg++);
                        else outc(c);
                        format = 0;
                        break;
                }
        }
}
 
void __init balo_hungup(void)
{
        outs("Hunging up.\n");
        while(1);
}