![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to client.c CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Qemu by Fabrice Bellard] / qemu / roms / openbios / libopenbios|
Return to client.c CVS log | Up to [Qemu by Fabrice Bellard] / qemu / roms / openbios / libopenbios |
1.1 root 1: /*
2: * Creation Date: <2003/11/25 14:29:08 samuel>
3: * Time-stamp: <2004/03/27 01:13:53 samuel>
4: *
5: * <client.c>
6: *
7: * OpenFirmware client interface
8: *
9: * Copyright (C) 2003, 2004 Samuel Rydh ([email protected])
10: *
11: * This program is free software; you can redistribute it and/or
12: * modify it under the terms of the GNU General Public License
13: * version 2
14: *
15: */
16:
17: #include "config.h"
18: #include "libopenbios/bindings.h"
19: #include "libopenbios/of.h"
20:
21: /* Uncomment to enable debug printout of client interface calls */
22: //#define DEBUG_CIF
23: //#define DUMP_IO
24:
25: /* OF client interface. r3 points to the argument array. On return,
26: * r3 should contain 0==true or -1==false. r4-r12,cr0,cr1 may
27: * be modified freely.
28: *
29: * -1 should only be returned if the control transfer to OF fails
30: * (it doesn't) or if the function is unimplemented.
31: */
32:
33: #define PROM_MAX_ARGS 10
34: typedef struct prom_args {
35: prom_uarg_t service;
36: prom_arg_t nargs;
37: prom_arg_t nret;
38: prom_uarg_t args[PROM_MAX_ARGS];
39: } __attribute__((packed)) prom_args_t;
40:
41: static inline const char *
42: arg2pointer(prom_uarg_t value)
43: {
44: return (char*)(uintptr_t)value;
45: }
46:
47: static inline const char *
48: get_service(prom_args_t *pb)
49: {
50: return arg2pointer(pb->service);
51: }
52:
53: #ifdef DEBUG_CIF
54: static void memdump(const char *mem, unsigned long size)
55: {
56: int i;
57:
58: if (size == (unsigned long) -1)
59: return;
60:
61: for (i = 0; i < size; i += 16) {
62: int j;
63:
64: printk("0x%08lx ", (unsigned long)mem + i);
65:
66: for (j = 0; j < 16 && i + j < size; j++)
67: printk(" %02x", *(unsigned char*)(mem + i + j));
68:
69: for ( ; j < 16; j++)
70: printk(" __");
71:
72: printk(" ");
73:
74: for (j = 0; j < 16 && i + j < size; j++) {
75: unsigned char c = *(mem + i + j);
76: if (isprint(c))
77: printk("%c", c);
78: else
79: printk(".");
80: }
81: printk("\n");
82: }
83: }
84:
85: static void dump_service(prom_args_t *pb)
86: {
87: int i;
88: const char *service = get_service(pb);
89: if (strcmp(service, "test") == 0) {
90: printk("test(\"%s\") = ", arg2pointer(pb->args[0]));
91: } else if (strcmp(service, "peer") == 0) {
92: printk("peer(0x" FMT_prom_uargx ") = ", pb->args[0]);
93: } else if (strcmp(service, "child") == 0) {
94: printk("child(0x" FMT_prom_uargx ") = ", pb->args[0]);
95: } else if (strcmp(service, "parent") == 0) {
96: printk("parent(0x" FMT_prom_uargx ") = ", pb->args[0]);
97: } else if (strcmp(service, "instance-to-package") == 0) {
98: printk("instance-to-package(0x" FMT_prom_uargx ") = ", pb->args[0]);
99: } else if (strcmp(service, "getproplen") == 0) {
100: printk("getproplen(0x" FMT_prom_uargx ", \"%s\") = ",
101: pb->args[0], arg2pointer(pb->args[1]));
102: } else if (strcmp(service, "getprop") == 0) {
103: printk("getprop(0x" FMT_prom_uargx ", \"%s\", 0x" FMT_prom_uargx ", " FMT_prom_arg ") = ",
104: pb->args[0], arg2pointer(pb->args[1]),
105: pb->args[2], pb->args[3]);
106: } else if (strcmp(service, "nextprop") == 0) {
107: printk("nextprop(0x" FMT_prom_uargx ", \"%s\", 0x" FMT_prom_uargx ") = ",
108: pb->args[0], arg2pointer(pb->args[1]), pb->args[2]);
109: } else if (strcmp(service, "setprop") == 0) {
110: printk("setprop(0x" FMT_prom_uargx ", \"%s\", 0x" FMT_prom_uargx ", " FMT_prom_arg ")\n",
111: pb->args[0], arg2pointer(pb->args[1]),
112: pb->args[2], pb->args[3]);
113: memdump(arg2pointer(pb->args[2]), pb->args[3]);
114: printk(" = ");
115: } else if (strcmp(service, "canon") == 0) {
116: printk("canon(\"%s\", 0x" FMT_prom_uargx ", " FMT_prom_arg ")\n",
117: arg2pointer(pb->args[0]), pb->args[1], pb->args[2]);
118: } else if (strcmp(service, "finddevice") == 0) {
119: printk("finddevice(\"%s\") = ", arg2pointer(pb->args[0]));
120: } else if (strcmp(service, "instance-to-path") == 0) {
121: printk("instance-to-path(0x" FMT_prom_uargx ", 0x" FMT_prom_uargx ", " FMT_prom_arg ") = ",
122: pb->args[0], pb->args[1], pb->args[2]);
123: } else if (strcmp(service, "package-to-path") == 0) {
124: printk("package-to-path(0x" FMT_prom_uargx ", 0x" FMT_prom_uargx ", " FMT_prom_arg ") = ",
125: pb->args[0], pb->args[1], pb->args[2]);
126: } else if (strcmp(service, "open") == 0) {
127: printk("open(\"%s\") = ", arg2pointer(pb->args[0]));
128: } else if (strcmp(service, "close") == 0) {
129: printk("close(0x" FMT_prom_uargx ")\n", pb->args[0]);
130: } else if (strcmp(service, "read") == 0) {
131: #ifdef DUMP_IO
132: printk("read(0x" FMT_prom_uargx ", 0x" FMT_prom_uargx ", " FMT_prom_arg ") = ",
133: pb->args[0], pb->args[1], pb->args[2]);
134: #endif
135: } else if (strcmp(service, "write") == 0) {
136: #ifdef DUMP_IO
137: printk("write(0x" FMT_prom_uargx ", 0x" FMT_prom_uargx ", " FMT_prom_arg ")\n",
138: pb->args[0], pb->args[1], pb->args[2]);
139: memdump(arg2pointer(pb->args[1]), pb->args[2]);
140: printk(" = ");
141: #endif
142: } else if (strcmp(service, "seek") == 0) {
143: #ifdef DUMP_IO
144: printk("seek(0x" FMT_prom_uargx ", 0x" FMT_prom_uargx ", 0x" FMT_prom_uargx ") = ",
145: pb->args[0], pb->args[1], pb->args[2]);
146: #endif
147: } else if (strcmp(service, "claim") == 0) {
148: printk("claim(0x" FMT_prom_uargx ", " FMT_prom_arg ", " FMT_prom_arg ") = ",
149: pb->args[0], pb->args[1], pb->args[2]);
150: } else if (strcmp(service, "release") == 0) {
151: printk("release(0x" FMT_prom_uargx ", " FMT_prom_arg ")\n",
152: pb->args[0], pb->args[1]);
153: } else if (strcmp(service, "boot") == 0) {
154: printk("boot \"%s\"\n", arg2pointer(pb->args[0]));
155: } else if (strcmp(service, "enter") == 0) {
156: printk("enter()\n");
157: } else if (strcmp(service, "exit") == 0) {
158: printk("exit()\n");
159: } else if (strcmp(service, "test-method") == 0) {
160: printk("test-method(0x" FMT_prom_uargx ", \"%s\") = ",
161: pb->args[0], arg2pointer(pb->args[1]));
162: } else {
163: printk("of_client_interface: %s", service);
164: for( i = 0; i < pb->nargs; i++ )
165: printk(" " FMT_prom_uargx, pb->args[i]);
166: printk("\n");
167: }
168: }
169:
170: static void dump_return(prom_args_t *pb)
171: {
172: int i;
173: const char *service = get_service(pb);
174: if (strcmp(service, "test") == 0) {
175: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
176: } else if (strcmp(service, "peer") == 0) {
177: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
178: } else if (strcmp(service, "child") == 0) {
179: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
180: } else if (strcmp(service, "parent") == 0) {
181: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
182: } else if (strcmp(service, "instance-to-package") == 0) {
183: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
184: } else if (strcmp(service, "getproplen") == 0) {
185: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
186: } else if (strcmp(service, "getprop") == 0) {
187: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
188: if ((prom_arg_t)pb->args[pb->nargs] != -1)
189: memdump(arg2pointer(pb->args[2]), MIN(pb->args[3], pb->args[pb->nargs]));
190: } else if (strcmp(service, "nextprop") == 0) {
191: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
192: memdump(arg2pointer(pb->args[2]), pb->args[pb->nargs]);
193: } else if (strcmp(service, "setprop") == 0) {
194: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
195: } else if (strcmp(service, "canon") == 0) {
196: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
197: memdump(arg2pointer(pb->args[1]), pb->args[pb->nargs]);
198: } else if (strcmp(service, "finddevice") == 0) {
199: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
200: } else if (strcmp(service, "instance-to-path") == 0) {
201: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
202: memdump(arg2pointer(pb->args[1]), pb->args[pb->nargs]);
203: } else if (strcmp(service, "package-to-path") == 0) {
204: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
205: memdump(arg2pointer(pb->args[1]), pb->args[pb->nargs]);
206: } else if (strcmp(service, "open") == 0) {
207: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
208: } else if (strcmp(service, "close") == 0) {
209: /* do nothing */
210: } else if (strcmp(service, "read") == 0) {
211: #ifdef DUMP_IO
212: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
213: memdump(arg2pointer(pb->args[1]), pb->args[pb->nargs]);
214: #endif
215: } else if (strcmp(service, "write") == 0) {
216: #ifdef DUMP_IO
217: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
218: #endif
219: } else if (strcmp(service, "seek") == 0) {
220: #ifdef DUMP_IO
221: printk(FMT_prom_arg "\n", pb->args[pb->nargs]);
222: #endif
223: } else if (strcmp(service, "claim") == 0) {
224: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
225: } else if (strcmp(service, "release") == 0) {
226: /* do nothing */
227: } else if (strcmp(service, "boot") == 0) {
228: /* do nothing */
229: } else if (strcmp(service, "enter") == 0) {
230: /* do nothing */
231: } else if (strcmp(service, "exit") == 0) {
232: /* do nothing */
233: } else if (strcmp(service, "test-method") == 0) {
234: printk("0x" FMT_prom_uargx "\n", pb->args[pb->nargs]);
235: } else {
236: printk("of_client_interface return:");
237: for (i = 0; i < pb->nret; i++) {
238: printk(" " FMT_prom_uargx, pb->args[pb->nargs + i]);
239: }
240: printk("\n");
241: }
242: }
243: #endif
244:
245: /* call-method, interpret */
246: static int
247: handle_calls( prom_args_t *pb )
248: {
249: int i, dstacksave = dstackcnt;
250: prom_uarg_t val;
251:
252: #ifdef DEBUG_CIF
253: printk("%s %s ([" FMT_prom_arg "] -- [" FMT_prom_arg "])\n",
254: get_service(pb), arg2pointer(pb->args[0]), pb->nargs, pb->nret);
255: #endif
256:
257: for( i=pb->nargs-1; i>=0; i-- )
258: PUSH( pb->args[i] );
259:
260: push_str(get_service(pb));
261: fword("client-call-iface");
262:
263: /* Drop the return code from client-call-iface (status is handled by the
264: catch result which is the first parameter below) */
265: POP();
266:
267: for( i=0; i<pb->nret; i++ ) {
268: val = POP();
269: pb->args[pb->nargs + i] = val;
270:
271: /* don't pop args if an exception occured */
272: if( !i && val )
273: break;
274: }
275:
276: #ifdef DEBUG_CIF
277: /* useful for debug but not necessarily an error */
278: if (i != pb->nret || dstackcnt != dstacksave) {
279: printk("%s '%s': possible argument error (" FMT_prom_arg "--" FMT_prom_arg ") got %d\n",
280: get_service(pb), arg2pointer(pb->args[0]),
281: pb->nargs - 2, pb->nret, i);
282: }
283:
284: printk("handle_calls return:");
285: for (i = 0; i < pb->nret; i++) {
286: printk(" " FMT_prom_uargx, pb->args[pb->nargs + i]);
287: }
288: printk("\n");
289: #endif
290:
291: dstackcnt = dstacksave;
292: return 0;
293: }
294:
295: int
296: of_client_interface( int *params )
297: {
298: prom_args_t *pb = (prom_args_t*)params;
299: int val, i, dstacksave;
300:
301: if( pb->nargs < 0 || pb->nret < 0 ||
302: pb->nargs + pb->nret > PROM_MAX_ARGS)
303: return -1;
304:
305: #ifdef DEBUG_CIF
306: dump_service(pb);
307: #endif
308:
309: /* call-method exceptions are special */
310: if (!strcmp("call-method", get_service(pb)) || !strcmp("interpret", get_service(pb)))
311: return handle_calls( pb );
312:
313: dstacksave = dstackcnt;
314: for( i=pb->nargs-1; i>=0; i-- )
315: PUSH( pb->args[i] );
316:
317: push_str(get_service(pb));
318: fword("client-iface");
319:
320: if( (val=POP()) ) {
321: dstackcnt = dstacksave;
322: if( val == -1 )
323: printk("Unimplemented service %s ([" FMT_prom_arg "] -- [" FMT_prom_arg "])\n",
324: get_service(pb), pb->nargs, pb->nret );
325: #ifdef DEBUG_CIF
326: else
327: printk("ERROR!\n");
328: #endif
329: return -1;
330: }
331:
332: for( i=0; i<pb->nret ; i++ )
333: pb->args[pb->nargs + i] = POP();
334:
335: if( dstackcnt != dstacksave ) {
336: #ifdef DEBUG_CIF
337: printk("service %s: possible argument error (%d %d)\n",
338: get_service(pb), i, dstackcnt - dstacksave );
339: #endif
340: /* Some clients request less parameters than the CIF method
341: returns, e.g. getprop with OpenSolaris. Hence we drop any
342: stack parameters after issuing a warning above */
343: dstackcnt = dstacksave;
344: }
345:
346: #ifdef DEBUG_CIF
347: dump_return(pb);
348: #endif
349: return 0;
350: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.