methods.c

OpenBIOS是一个开源的BIOS实现

/* 
 *   Creation Date: <2003/10/18 13:24:29 samuel>
 *   Time-stamp: <2004/03/27 02:00:30 samuel>
 *   
 *	<methods.c>
 *	
 *	Misc device node methods
 *   
 *   Copyright (C) 2003, 2004 Samuel Rydh ([e-mail])
 *   
 *   This program is free software; you can redistribute it and/or
 *   modify it under the terms of the GNU General Public License
 *   version 2
 *   
 */

#include "openbios/config.h"
#include "openbios/bindings.h"
#include "libc/string.h"
#include "mol/mol.h"
#include "ofmem.h"
#include "mol/prom.h"
#include "osi_calls.h"
#include "kbd_sh.h"

/************************************************************************/
/*	Power Management						*/
/************************************************************************/

DECLARE_NODE( powermgt, INSTALL_OPEN, 0, "/pci/pci-bridge/mac-io/power-mgt" );

/* ( -- ) */
static void 
set_hybernot_flag( void )
{
}

NODE_METHODS( powermgt ) = {
	{ "set-hybernot-flag",	set_hybernot_flag	},
};


/************************************************************************/
/*	RTAS (run-time abstraction services)				*/
/************************************************************************/

DECLARE_NODE( rtas, INSTALL_OPEN, 0, "+/rtas" );

/* ( physbase -- rtas_callback ) */
static void
rtas_instantiate( void )
{
	int physbase = POP();
	int s=0x1000, size = (int)of_rtas_end - (int)of_rtas_start;
	ulong virt;
	
	while( s < size )
		s += 0x1000;
	virt = ofmem_claim_virt( 0, s, 0x1000 );
	ofmem_map( physbase, virt, s, -1 );
	memcpy( (char*)virt, of_rtas_start, size );

	printk("RTAS instantiated at %08x\n", physbase );
	flush_icache_range( (char*)virt, (char*)virt + size );

	PUSH( physbase );
}

NODE_METHODS( rtas ) = {
	{ "instantiate",	rtas_instantiate },
	{ "instantiate-rtas",	rtas_instantiate },
};



/************************************************************************/
/*	stdout								*/
/************************************************************************/

DECLARE_NODE( video_stdout, INSTALL_OPEN, 0, "Tdisplay" );

/* ( addr len -- actual ) */
static void
stdout_write( void )
{
	int len = POP();
	char *addr = (char*)POP();
	char *s = malloc( len + 1 );

	strncpy_nopad( s, addr, len );
	s[len]=0;
	
	/* printk( "%s", s ); */
	console_draw_str( s );
	free( s );

	PUSH( len );
}

NODE_METHODS( video_stdout ) = {
	{ "write",	stdout_write	},
};


/************************************************************************/
/*	tty								*/
/************************************************************************/

DECLARE_NODE( tty, INSTALL_OPEN, 0, "+/mol/mol-tty" );

/* ( addr len -- actual ) */
static void
tty_read( void )
{
	int ch, len = POP();
	char *p = (char*)POP();
	int ret=0;

	if( len > 0 ) {
		ret = 1;
		ch = OSI_TTYGetc();
		if( ch >= 0 ) {
			*p = ch;
		} else {
			ret = 0;
			OSI_USleep(1);
		}
	}
	PUSH( ret );
}

/* ( addr len -- actual ) */
static void
tty_write( void )
{
	int i, len = POP();
	char *p = (char*)POP();
	for( i=0; i<len; i++ )
		OSI_TTYPutc( *p++ );
	RET( len );
}

NODE_METHODS( tty ) = {
	{ "read",	tty_read	},
	{ "write",	tty_write	},
};


/************************************************************************/
/*	keyboard							*/
/************************************************************************/

typedef struct {
	int	cntrl;
	int	shift;
	int	meta;
	int	alt;
	int	save_key;
	char 	keytable[32];
} kbd_state_t;

static const uchar adb_ascii_table[128] = 
	/* 0x00 */	"asdfhgzxcv`bqwer"
	/* 0x10 */	"yt123465=97-80]o"
	/* 0x20 */	"u[ip\nlj'k;\\,/nm."
	/* 0x30 */	"\t <\b \e          "
	/* 0x40 */	" . * +     /  - "
	/* 0x50 */	" =01234567 89   "
	/* 0x60 */	"                "
	/* 0x70 */	"                ";

static const uchar adb_shift_table[128] = 
	/* 0x00 */	"ASDFHGZXCV~BQWER"
	/* 0x10 */	"YT!@#$^%+(&_*)}O"
	/* 0x20 */	"U{IP\nLJ\"K:|<?NM>"
	/* 0x30 */	"\t <\b \e          "
	/* 0x40 */	" . * +     /  - "
	/* 0x50 */	" =01234567 89   "
	/* 0x60 */	"                "
	/* 0x70 */	"                ";

DECLARE_NODE( kbd, INSTALL_OPEN, sizeof(kbd_state_t), 
      "/psuedo-hid/keyboard",
      "/mol/mol-keyboard",
      "/mol/keyboard"
);

/* ( -- keymap ) (?) */
/* should return a pointer to an array with 32 bytes (256 bits) */
static void
kbd_get_key_map( kbd_state_t *ks )
{
	/* printk("met_kbd_get_key_map\n"); */

	/* keytable[5] = 0x40; */
	PUSH( (int)ks->keytable );
}

/* ( buf len --- actlen ) */
static void
kbd_read( kbd_state_t *ks )
{
	int ret=0, len = POP();
	char *p = (char*)POP();
	int key;
	
	if( !p || !len ) {
		PUSH( -1 );
		return;
	}

	if( ks->save_key ) {
		*p = ks->save_key;
		ks->save_key = 0;
		RET( 1 );
	}
	OSI_USleep(1);	/* be nice */ 

	for( ; (key=OSI_GetAdbKey()) >= 0 ; ) {
		int code = (key & 0x7f);
		int down = !(key & 0x80);
		
		if( code == 0x36 /* ctrl */ ) {
			ks->cntrl = down;
			continue;
		}
		if( code == 0x38 /* shift */ || code == 0x7b) {
			ks->shift = down;
			continue;
		}
		if( code == 0x37 /* command */ ) {
			ks->meta = down;
			continue;
		}
		if( code == 0x3a /* alt */ ) {
			ks->alt = down;
			continue;
		}
		if( !down )
			continue;

		ret = 1;
		if( ks->shift )
			key = adb_shift_table[ key & 0x7f ];
		else
			key = adb_ascii_table[ key & 0x7f ];

		if( ks->meta ) {
			ks->save_key = key;
			key = 27;
		} else if( ks->cntrl ) {
			key = key - 'a' + 1;
		}
		*p = key;
		if( !*p )
			*p = 'x';
		break;
	}
	PUSH( ret );
}

NODE_METHODS( kbd ) = {
	{ "read",		kbd_read		},
	{ "get-key-map",	kbd_get_key_map		},
};


/************************************************************************/
/*	client interface 'quiesce'					*/
/************************************************************************/

DECLARE_NODE( ciface, 0, 0, "/packages/client-iface" );

/* ( -- ) */
static void
ciface_quiesce( ulong args[], ulong ret[] ) 
{
#if 0
	ulong msr;
	/* This seems to be the correct thing to do - but I'm not sure */
	asm volatile("mfmsr %0" : "=r" (msr) : );
	msr &= ~(MSR_IR | MSR_DR);
	asm volatile("mtmsr %0" :: "r" (msr) );
#endif
	printk("=============================================================\n\n");
	prom_close();

	OSI_KbdCntrl( kKbdCntrlSuspend );
}

/* ( -- ms ) */
static void
ciface_milliseconds( ulong args[], ulong ret[] ) 
{
	static ulong mticks=0, usecs=0;
	ulong t;
        
	asm volatile("mftb %0" : "=r" (t) : );
	if( mticks )
		usecs += OSI_MticksToUsecs( t-mticks );
	mticks = t;

	PUSH( usecs/1000 );
}


NODE_METHODS( ciface ) = {
	{ "quiesce",		ciface_quiesce		},
	{ "milliseconds",	ciface_milliseconds	},
};


/************************************************************************/
/*	MMU/memory methods						*/
/************************************************************************/

DECLARE_NODE( memory, INSTALL_OPEN, 0, "/memory" );
DECLARE_NODE( mmu, INSTALL_OPEN, 0, "/cpus/@0" );
DECLARE_NODE( mmu_ciface, 0, 0, "/packages/client-iface" );


/* ( phys size align --- base ) */
static void
mem_claim( void )
{
	int align = POP();
	int size = POP();
	int phys = POP();
	int ret = ofmem_claim_phys( phys, size, align );
	
	if( ret == -1 ) {
		printk("MEM: claim failure\n");
		throw( -13 );
		return;
	}
	PUSH( ret );
}

/* ( phys size --- ) */
static void
mem_release( void )
{
	POP(); POP();
}

/* ( phys size align --- base ) */
static void
mmu_claim( void )
{
	int align = POP();
	int size = POP();
	int phys = POP();
	int ret = ofmem_claim_virt( phys, size, align );

	if( ret == -1 ) {
		printk("MMU: CLAIM failure\n");
		throw( -13 );
		return;
	}
	PUSH( ret );
}

/* ( phys size --- ) */
static void
mmu_release( void )
{
	POP(); POP();
}

/* ( phys virt size mode -- [ret???] ) */
static void 
mmu_map( void )
{
	int mode = POP();
	int size = POP();
	int virt = POP();
	int phys = POP();
	int ret;
	
	/* printk("mmu_map: %x %x %x %x\n", phys, virt, size, mode ); */
	ret = ofmem_map( phys, virt, size, mode );

	if( ret ) {
		printk("MMU: map failure\n");
		throw( -13 );
		return;
	}
}

/* ( virt size -- ) */
static void
mmu_unmap( void )
{
	POP(); POP();
}

/* ( virt -- false | phys mode true ) */
static void
mmu_translate( void )
{
	ulong mode;
	int virt = POP();
	int phys = ofmem_translate( virt, &mode );

	if( phys == -1 ) {
		PUSH( 0 );
	} else {
		PUSH( phys );
		PUSH( (int)mode );
		PUSH( -1 );
	}
}

/* ( virt size align -- baseaddr|-1 ) */
static void
ciface_claim( void )
{
	int align = POP();
	int size = POP();
	int virt = POP();
	int ret = ofmem_claim( virt, size, align );

	/* printk("ciface_claim: %08x %08x %x\n", virt, size, align ); */
	PUSH( ret );
}

/* ( virt size -- ) */
static void
ciface_release( void )
{
	POP();
	POP();
}


NODE_METHODS( memory ) = {
	{ "claim",		mem_claim		},
	{ "release",		mem_release		},
};

NODE_METHODS( mmu ) = {
	{ "claim",		mmu_claim		},
	{ "release",		mmu_release		},
	{ "map",		mmu_map			},
	{ "unmap",		mmu_unmap		},
	{ "translate",		mmu_translate		},
};

NODE_METHODS( mmu_ciface ) = {
	{ "claim",		ciface_claim		},
	{ "release",		ciface_release		},
};


/************************************************************************/
/*	init								*/
/************************************************************************/

void
node_methods_init( void )
{
	REGISTER_NODE( rtas );
	REGISTER_NODE( powermgt );
	REGISTER_NODE( kbd );
	REGISTER_NODE( video_stdout );
	REGISTER_NODE( ciface );
	REGISTER_NODE( memory );
	REGISTER_NODE( mmu );
	REGISTER_NODE( mmu_ciface );

	if( OSI_CallAvailable(OSI_TTY_GETC) )
		REGISTER_NODE( tty );

	OSI_KbdCntrl( kKbdCntrlActivate );
}