2 * Creation Date: <2004/08/28 18:38:22 greg>
3 * Time-stamp: <2004/08/28 18:38:22 greg>
7 * Misc device node methods
9 * Copyright (C) 2004 Greg Watson
11 * Based on MOL specific code which is
13 * Copyright (C) 2003, 2004 Samuel Rydh (samuel@ibrium.se)
15 * This program is free software; you can redistribute it and/or
16 * modify it under the terms of the GNU General Public License
22 #include "libopenbios/bindings.h"
23 #include "drivers/drivers.h"
24 #include "libc/string.h"
25 #include "qemu/qemu.h"
26 #include "libopenbios/ofmem.h"
27 #include "arch/ppc/processor.h"
28 #include "drivers/usb.h"
30 /************************************************************************/
31 /* RTAS (run-time abstraction services) */
32 /************************************************************************/
35 DECLARE_NODE( rtas, INSTALL_OPEN, 0, "+/rtas" );
37 /* ( physbase -- rtas_callback ) */
39 rtas_instantiate( void )
41 ucell physbase = POP();
42 ucell s=0x1000, size = (ucell)of_rtas_end - (ucell)of_rtas_start;
47 virt = ofmem_claim_virt( 0, s, 0x1000 );
48 ofmem_map( physbase, virt, s, -1 );
49 memcpy( (char*)virt, of_rtas_start, size );
51 printk("RTAS instantiated at %08x\n", physbase );
52 flush_icache_range( (char*)virt, (char*)virt + size );
57 NODE_METHODS( rtas ) = {
58 { "instantiate", rtas_instantiate },
59 { "instantiate-rtas", rtas_instantiate },
64 /************************************************************************/
66 /************************************************************************/
68 DECLARE_NODE( tty, INSTALL_OPEN, 0, "/packages/terminal-emulator" );
70 /* ( addr len -- actual ) */
75 char *p = (char*)cell2pointer(POP());
90 /* ( addr len -- actual ) */
95 char *p = (char*)cell2pointer(POP());
96 for( i=0; i<len; i++ )
101 NODE_METHODS( tty ) = {
102 { "read", tty_read },
103 { "write", tty_write },
106 /************************************************************************/
107 /* client interface 'quiesce' */
108 /************************************************************************/
110 DECLARE_NODE( ciface, 0, 0, "+/openprom/client-services" );
114 ciface_quiesce( unsigned long args[], unsigned long ret[] )
119 /* This seems to be the correct thing to do - but I'm not sure */
120 asm volatile("mfmsr %0" : "=r" (msr) : );
121 msr &= ~(MSR_IR | MSR_DR);
122 asm volatile("mtmsr %0" :: "r" (msr) );
127 #define TIMER_FREQUENCY 16600000ULL
130 ciface_milliseconds( unsigned long args[], unsigned long ret[] )
132 unsigned long tbu, tbl, temp;
133 unsigned long long ticks, msecs;
142 : "=r"(tbl), "=r"(tbu), "=r"(temp)
146 ticks = (((unsigned long long)tbu) << 32) | (unsigned long long)tbl;
147 msecs = (1000 * ticks) / TIMER_FREQUENCY;
152 NODE_METHODS( ciface ) = {
153 { "quiesce", ciface_quiesce },
154 { "milliseconds", ciface_milliseconds },
158 /************************************************************************/
159 /* MMU/memory methods */
160 /************************************************************************/
162 DECLARE_NODE( memory, INSTALL_OPEN, 0, "/memory" );
163 DECLARE_UNNAMED_NODE( mmu, INSTALL_OPEN, 0 );
164 DECLARE_NODE( mmu_ciface, 0, 0, "+/openprom/client-services" );
167 /* ( phys size align --- base ) */
174 ucell ret = ofmem_claim_phys( phys, size, align );
177 printk("MEM: claim failure\n");
184 /* ( phys size --- ) */
191 /* ( phys size align --- base ) */
198 ucell ret = ofmem_claim_virt( phys, size, align );
201 printk("MMU: CLAIM failure\n");
208 /* ( phys size --- ) */
215 /* ( phys virt size mode -- [ret???] ) */
225 /* printk("mmu_map: %x %x %x %x\n", phys, virt, size, mode ); */
226 ret = ofmem_map( phys, virt, size, mode );
229 printk("MMU: map failure\n");
235 /* ( virt size -- ) */
242 /* ( virt -- false | phys mode true ) */
244 mmu_translate( void )
248 ucell phys = ofmem_translate( virt, &mode );
259 /* ( virt size align -- baseaddr|-1 ) */
266 ucell ret = ofmem_claim( virt, size, align );
268 /* printk("ciface_claim: %08x %08x %x\n", virt, size, align ); */
272 /* ( virt size -- ) */
274 ciface_release( void )
278 ofmem_release(virt, size);
282 NODE_METHODS( memory ) = {
283 { "claim", mem_claim },
284 { "release", mem_release },
287 NODE_METHODS( mmu ) = {
288 { "claim", mmu_claim },
289 { "release", mmu_release },
291 { "unmap", mmu_unmap },
292 { "translate", mmu_translate },
295 NODE_METHODS( mmu_ciface ) = {
296 { "cif-claim", ciface_claim },
297 { "cif-release", ciface_release },
301 /************************************************************************/
303 /************************************************************************/
306 node_methods_init( const char *cpuname )
308 phandle_t chosen, ph;
311 REGISTER_NODE( rtas );
314 REGISTER_NODE( ciface );
315 REGISTER_NODE( memory );
316 REGISTER_NODE_METHODS( mmu, cpuname );
317 REGISTER_NODE( mmu_ciface );
318 REGISTER_NODE( tty );
320 chosen = find_dev("/chosen");
325 set_int_property(chosen, "mmu", ph);