/*  *   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 (samuel@ibrium.se) *    *   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 voidrtas_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 voidstdout_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 voidtty_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 voidtty_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 voidkbd_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 voidkbd_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 voidciface_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 voidciface_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 voidmem_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 voidmem_release( void ){	POP(); POP();}/* ( phys size align --- base ) */static voidmmu_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 voidmmu_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 voidmmu_unmap( void ){	POP(); POP();}/* ( virt -- false | phys mode true ) */static voidmmu_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 voidciface_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 voidciface_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								*//************************************************************************/voidnode_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 );}