panthema / 2006 / SDIOS06 / sdios06 / lib / io / powerpc-ofppc-io.cc (Download File)
/****************************************************************************
 *
 * Copyright (C) 2002, Karlsruhe University
 *
 * File path:	lib/io/powerpc-ofppc-io.cc
 * Description:	Comport getc() for PowerPC-L4.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 * $Id: powerpc-ofppc-io.cc,v 1.1.2.1 2004/01/16 17:52:21 joshua Exp $
 *
 ***************************************************************************/

#include <config.h>

extern "C" int __l4_getc( void );
extern "C" int getc( void ) __attribute__ ((weak, alias("__l4_getc")));

extern "C" void __l4_putc( int c );
extern "C" void putc( int c ) __attribute__ ((weak, alias("__l4_putc")));


/****************************************************************************
 *
 *  Console I/O using kernel debugger traps.
 *
 ***************************************************************************/
#if !defined(CONFIG_COMPORT)

#include <l4/types.h>
#include <l4/powerpc/kdebug.h>

extern "C" int __l4_getc()
{
    return L4_KDB_ReadChar_Blocked();
}

extern "C" void __l4_putc( int c )
{
    L4_KDB_PrintChar( c );
    if( c == '\n' )
	L4_KDB_PrintChar( '\r' );
}

#endif	/* !CONFIG_COMPORT */

/****************************************************************************
 *
 *  Console I/O using psim's comport interface.
 *
 ***************************************************************************/
#if defined(CONFIG_COMPORT)

#include <l4/types.h>
#include <l4/sigma0.h>
#include <l4/kip.h>

#include "1275tree.h"


static bool __l4_io_enabled = false;
static char *__l4_com_registers = 0;

extern "C" int __l4_io_init( void )
{
    of1275_device_t *dev;
    char *alias;
    L4_Word_t *reg, len;

    __l4_io_enabled = true;

    of1275_tree_t *of1275_tree = get_of1275_tree_from_sigma0();
    if( of1275_tree == 0 )
	return 0;

    dev = of1275_tree->find( "/aliases" );
    if( dev == 0 )
	return 0;
    if( !dev->get_prop("com", &alias, &len) )
	return 0;

    dev = of1275_tree->find( alias );
    if( dev == 0 )
	return 0;
    if( !dev->get_prop("reg", (char **)&reg, &len) )
	return 0;

    if( (len != 3*sizeof(L4_Word_t)) || !reg[1] )
	return 0;

    /* Request the device page from sigma0.
     */

    L4_ThreadId_t sigma0 = L4_GlobalId( L4_ThreadIdUserBase(L4_GetKernelInterface()), 1);
    if( sigma0 == L4_Myself() )
	return 0;

    // Install it as the 2nd page in our address space.  
    // Hopefully it is free!
    L4_Fpage_t target = L4_Fpage( 4096, 4096 );	

    L4_Fpage_t fpage = L4_Fpage( reg[1], 4096 );
    fpage.X.rwx = L4_ReadWriteOnly;
    fpage = L4_Sigma0_GetPage( sigma0, fpage, target );
    if( L4_IsNilFpage(fpage) )
	return 0;

    __l4_com_registers = (char *)L4_Address(target);
    __l4_com_registers[3] = 0;	// Some initialization ...

    return 1;
}

extern "C" int __l4_getc( void )
{
    if( __l4_com_registers == 0 )
    {
	if( __l4_io_enabled )
	    return 0;
	if( !__l4_io_init() )
	    return 0;
    }

    return __l4_com_registers[0];
}

extern "C" void __l4_putc( int c )
{
    if( __l4_com_registers == 0 )
    {
	if( __l4_io_enabled )
	    return;
	if( !__l4_io_init() )
	    return;
    }

    __l4_com_registers[0] = c;
}

#endif	/* CONFIG_COMPORT */
RSS 2.0 Weblog Feed Atom 1.0 Weblog Feed Valid XHTML 1.1 Valid CSS (2.1)
Copyright 2005-2014 Timo Bingmann - Impressum