source: branches/fault_tolerance/softs/tsar_boot/src/reset_tty.c @ 724

/********************************************************************
 * \file    reset_tty.c
 * \date    5 mars 2014
 * \author  Cesar Fuguet 
 *
 * Minimal driver for TTY controler 
 *******************************************************************/

#include <reset_tty.h>
#include <io.h>
#include <defs.h>

///////////////////////
int reset_getc(char *c)
{
    unsigned int* tty_address = (unsigned int*) TTY_PADDR_BASE;

    if (ioread32( &tty_address[TTY_STATUS] ) == 0) return 0;
    *c = ioread32( &tty_address[TTY_READ] );
    return 1;
}

/////////////////////////////
void reset_putc(const char c)
{
    unsigned int* tty_address = (unsigned int*) TTY_PADDR_BASE;

    iowrite32( &tty_address[TTY_WRITE], (unsigned int)c );
    if (c == '\n') reset_putc( '\r' );
}

///////////////////////////////////
void reset_puts(const char *buffer) 
{
    unsigned int n;

    for ( n=0; n<100; n++)
    {
        if (buffer[n] == 0) break;
        reset_putc(buffer[n]);
    }
} 

/////////////////////////////////
void reset_putx(unsigned int val)
{
    static const char HexaTab[] = "0123456789ABCDEF";
    char              buf[11];
    unsigned int      c;

    buf[0]  = '0';
    buf[1]  = 'x';
    buf[10] = 0;

    for ( c = 0 ; c < 8 ; c++ )
    { 
        buf[9-c] = HexaTab[val&0xF];
        val = val >> 4;
    }
    reset_puts(buf);
}

/////////////////////////////////
void reset_putd(unsigned int val)
{
    static const char DecTab[] = "0123456789";
    char              buf[11];
    unsigned int      i;
    unsigned int      first = 0;

    buf[10] = 0;

    for ( i = 0 ; i < 10 ; i++ )
    {
        if ((val != 0) || (i == 0))
        {
            buf[9-i] = DecTab[val % 10];
            first    = 9-i;
        }
        else
        {
            break;
        }
        val /= 10;
    }
    reset_puts( &buf[first] );
}

/////////////////
void reset_exit()
{
    register int pid;
    asm volatile( "mfc0 %0, $15, 1": "=r"(pid) );

    reset_puts("\n!!! Exit Processor ");
    reset_putx(pid);
    reset_puts(" !!!\n");

    while(1) asm volatile("nop");   // infinite loop...
}