2 * Creation Date: <2003/10/18 13:24:29 samuel>
3 * Time-stamp: <2004/03/27 02:00:30 samuel>
7 * Misc device node methods
9 * Copyright (C) 2003, 2004 Samuel Rydh (samuel@ibrium.se)
11 * This program is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License
18 #include "libopenbios/bindings.h"
19 #include "libc/string.h"
21 #include "libopenbios/ofmem.h"
23 #include "osi_calls.h"
26 /************************************************************************/
27 /* Power Management */
28 /************************************************************************/
30 DECLARE_NODE( powermgt, INSTALL_OPEN, 0, "/pci/pci-bridge/mac-io/power-mgt" );
34 set_hybernot_flag( void )
38 NODE_METHODS( powermgt ) = {
39 { "set-hybernot-flag", set_hybernot_flag },
43 /************************************************************************/
44 /* RTAS (run-time abstraction services) */
45 /************************************************************************/
47 DECLARE_NODE( rtas, INSTALL_OPEN, 0, "+/rtas" );
49 /* ( physbase -- rtas_callback ) */
51 rtas_instantiate( void )
54 int s=0x1000, size = (int)of_rtas_end - (int)of_rtas_start;
59 virt = ofmem_claim_virt( 0, s, 0x1000 );
60 ofmem_map( physbase, virt, s, -1 );
61 memcpy( (char*)virt, of_rtas_start, size );
63 printk("RTAS instantiated at %08x\n", physbase );
64 flush_icache_range( (char*)virt, (char*)virt + size );
69 NODE_METHODS( rtas ) = {
70 { "instantiate", rtas_instantiate },
71 { "instantiate-rtas", rtas_instantiate },
76 /************************************************************************/
78 /************************************************************************/
80 DECLARE_NODE( video_stdout, INSTALL_OPEN, 0, "Tdisplay" );
82 /* ( addr len -- actual ) */
87 char *addr = (char*)POP();
89 /* printk( "%s", s ); */
90 console_draw_fstr(addr, len);
95 NODE_METHODS( video_stdout ) = {
96 { "write", stdout_write },
100 /************************************************************************/
102 /************************************************************************/
104 DECLARE_NODE( tty, INSTALL_OPEN, 0, "+/mol/mol-tty" );
106 /* ( addr len -- actual ) */
111 char *p = (char*)POP();
127 /* ( addr len -- actual ) */
132 char *p = (char*)POP();
133 for( i=0; i<len; i++ )
138 NODE_METHODS( tty ) = {
139 { "read", tty_read },
140 { "write", tty_write },
144 /************************************************************************/
146 /************************************************************************/
157 static const unsigned char adb_ascii_table[128] =
158 /* 0x00 */ "asdfhgzxcv`bqwer"
159 /* 0x10 */ "yt123465=97-80]o"
160 /* 0x20 */ "u[ip\nlj'k;\\,/nm."
161 /* 0x30 */ "\t <\b \e "
162 /* 0x40 */ " . * + / - "
163 /* 0x50 */ " =01234567 89 "
167 static const unsigned char adb_shift_table[128] =
168 /* 0x00 */ "ASDFHGZXCV~BQWER"
169 /* 0x10 */ "YT!@#$^%+(&_*)}O"
170 /* 0x20 */ "U{IP\nLJ\"K:|<?NM>"
171 /* 0x30 */ "\t <\b \e "
172 /* 0x40 */ " . * + / - "
173 /* 0x50 */ " =01234567 89 "
177 DECLARE_NODE( kbd, INSTALL_OPEN, sizeof(kbd_state_t),
178 "/psuedo-hid/keyboard",
183 /* ( -- keymap ) (?) */
184 /* should return a pointer to an array with 32 bytes (256 bits) */
186 kbd_get_key_map( kbd_state_t *ks )
188 /* printk("met_kbd_get_key_map\n"); */
190 /* keytable[5] = 0x40; */
191 PUSH( (int)ks->keytable );
194 /* ( buf len --- actlen ) */
196 kbd_read( kbd_state_t *ks )
198 int ret=0, len = POP();
199 char *p = (char*)POP();
212 OSI_USleep(1); /* be nice */
214 for( ; (key=OSI_GetAdbKey()) >= 0 ; ) {
215 int code = (key & 0x7f);
216 int down = !(key & 0x80);
218 if( code == 0x36 /* ctrl */ ) {
222 if( code == 0x38 /* shift */ || code == 0x7b) {
226 if( code == 0x37 /* command */ ) {
230 if( code == 0x3a /* alt */ ) {
239 key = adb_shift_table[ key & 0x7f ];
241 key = adb_ascii_table[ key & 0x7f ];
246 } else if( ks->cntrl ) {
257 NODE_METHODS( kbd ) = {
258 { "read", kbd_read },
259 { "get-key-map", kbd_get_key_map },
263 /************************************************************************/
264 /* client interface 'quiesce' */
265 /************************************************************************/
267 DECLARE_NODE( ciface, 0, 0, "/packages/client-iface" );
271 ciface_quiesce( unsigned long args[], unsigned long ret[] )
275 /* This seems to be the correct thing to do - but I'm not sure */
276 asm volatile("mfmsr %0" : "=r" (msr) : );
277 msr &= ~(MSR_IR | MSR_DR);
278 asm volatile("mtmsr %0" :: "r" (msr) );
280 printk("=============================================================\n\n");
283 OSI_KbdCntrl( kKbdCntrlSuspend );
288 ciface_milliseconds( unsigned long args[], unsigned long ret[] )
290 static unsigned long mticks=0, usecs=0;
293 asm volatile("mftb %0" : "=r" (t) : );
295 usecs += OSI_MticksToUsecs( t-mticks );
302 NODE_METHODS( ciface ) = {
303 { "quiesce", ciface_quiesce },
304 { "milliseconds", ciface_milliseconds },
308 /************************************************************************/
309 /* MMU/memory methods */
310 /************************************************************************/
312 DECLARE_NODE( memory, INSTALL_OPEN, 0, "/memory" );
313 DECLARE_NODE( mmu, INSTALL_OPEN, 0, "/cpus/@0" );
314 DECLARE_NODE( mmu_ciface, 0, 0, "/packages/client-iface" );
317 /* ( phys size align --- base ) */
324 ucell ret = ofmem_claim_phys( phys, size, align );
327 printk("MEM: claim failure\n");
334 /* ( phys size --- ) */
341 /* ( phys size align --- base ) */
348 ucell ret = ofmem_claim_virt( phys, size, align );
351 printk("MMU: CLAIM failure\n");
358 /* ( phys size --- ) */
365 /* ( phys virt size mode -- [ret???] ) */
375 /* printk("mmu_map: %x %x %x %x\n", phys, virt, size, mode ); */
376 ret = ofmem_map( phys, virt, size, mode );
379 printk("MMU: map failure\n");
385 /* ( virt size -- ) */
392 /* ( virt -- false | phys mode true ) */
394 mmu_translate( void )
398 ucell phys = ofmem_translate( virt, &mode );
409 /* ( virt size align -- baseaddr|-1 ) */
416 ucell ret = ofmem_claim( virt, size, align );
418 /* printk("ciface_claim: %08x %08x %x\n", virt, size, align ); */
422 /* ( virt size -- ) */
424 ciface_release( void )
431 NODE_METHODS( memory ) = {
432 { "claim", mem_claim },
433 { "release", mem_release },
436 NODE_METHODS( mmu ) = {
437 { "claim", mmu_claim },
438 { "release", mmu_release },
440 { "unmap", mmu_unmap },
441 { "translate", mmu_translate },
444 NODE_METHODS( mmu_ciface ) = {
445 { "cif-claim", ciface_claim },
446 { "cif-release", ciface_release },
450 /************************************************************************/
452 /************************************************************************/
455 node_methods_init( void )
457 REGISTER_NODE( rtas );
458 REGISTER_NODE( powermgt );
459 REGISTER_NODE( kbd );
460 REGISTER_NODE( video_stdout );
461 REGISTER_NODE( ciface );
462 REGISTER_NODE( memory );
463 REGISTER_NODE( mmu );
464 REGISTER_NODE( mmu_ciface );
466 if( OSI_CallAvailable(OSI_TTY_GETC) )
467 REGISTER_NODE( tty );
469 OSI_KbdCntrl( kKbdCntrlActivate );