1
2
3
4
5
6
7
8
9#include <config.h>
10#include <command.h>
11#include <common.h>
12#include <malloc.h>
13#include <environment.h>
14#include <linux/types.h>
15#include <api_public.h>
16
17#include "api_private.h"
18
19#define DEBUG
20#undef DEBUG
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36#ifdef DEBUG
37#define debugf(fmt, args...) do { printf("%s(): ", __func__); printf(fmt, ##args); } while (0)
38#else
39#define debugf(fmt, args...)
40#endif
41
42typedef int (*cfp_t)(va_list argp);
43
44static int calls_no;
45
46
47
48
49
50
51static int API_getc(va_list ap)
52{
53 int *c;
54
55 if ((c = (int *)va_arg(ap, uintptr_t)) == NULL)
56 return API_EINVAL;
57
58 *c = getc();
59 return 0;
60}
61
62
63
64
65
66
67static int API_tstc(va_list ap)
68{
69 int *t;
70
71 if ((t = (int *)va_arg(ap, uintptr_t)) == NULL)
72 return API_EINVAL;
73
74 *t = tstc();
75 return 0;
76}
77
78
79
80
81
82
83static int API_putc(va_list ap)
84{
85 char *c;
86
87 if ((c = (char *)va_arg(ap, uintptr_t)) == NULL)
88 return API_EINVAL;
89
90 putc(*c);
91 return 0;
92}
93
94
95
96
97
98
99static int API_puts(va_list ap)
100{
101 char *s;
102
103 if ((s = (char *)va_arg(ap, uintptr_t)) == NULL)
104 return API_EINVAL;
105
106 puts(s);
107 return 0;
108}
109
110
111
112
113
114
115static int API_reset(va_list ap)
116{
117 do_reset(NULL, 0, 0, NULL);
118
119
120 return 0;
121}
122
123
124
125
126
127
128
129
130
131static int API_get_sys_info(va_list ap)
132{
133 struct sys_info *si;
134
135 si = (struct sys_info *)va_arg(ap, uintptr_t);
136 if (si == NULL)
137 return API_ENOMEM;
138
139 return (platform_sys_info(si)) ? 0 : API_ENODEV;
140}
141
142
143
144
145
146
147static int API_udelay(va_list ap)
148{
149 unsigned long *d;
150
151 if ((d = (unsigned long *)va_arg(ap, unsigned long)) == NULL)
152 return API_EINVAL;
153
154 udelay(*d);
155 return 0;
156}
157
158
159
160
161
162
163static int API_get_timer(va_list ap)
164{
165 unsigned long *base, *cur;
166
167 cur = (unsigned long *)va_arg(ap, unsigned long);
168 if (cur == NULL)
169 return API_EINVAL;
170
171 base = (unsigned long *)va_arg(ap, unsigned long);
172 if (base == NULL)
173 return API_EINVAL;
174
175 *cur = get_timer(*base);
176 return 0;
177}
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197static int API_dev_enum(va_list ap)
198{
199 struct device_info *di;
200
201
202 di = (struct device_info *)va_arg(ap, uintptr_t);
203 if (di == NULL)
204 return API_EINVAL;
205
206 if (di->cookie == NULL) {
207
208 dev_enum_reset();
209 debugf("RESTART ENUM\n");
210
211
212 if (dev_enum_net(di))
213 return 0;
214 }
215
216
217
218
219
220
221
222 if (!dev_enum_storage(di))
223
224 di->cookie = NULL;
225
226 return 0;
227}
228
229
230static int API_dev_open(va_list ap)
231{
232 struct device_info *di;
233 int err = 0;
234
235
236 di = (struct device_info *)va_arg(ap, uintptr_t);
237 if (di == NULL)
238 return API_EINVAL;
239
240
241 if (di->state == DEV_STA_OPEN)
242 return API_EBUSY;
243
244 if (di->cookie == NULL)
245 return API_ENODEV;
246
247 if (di->type & DEV_TYP_STOR)
248 err = dev_open_stor(di->cookie);
249
250 else if (di->type & DEV_TYP_NET)
251 err = dev_open_net(di->cookie);
252 else
253 err = API_ENODEV;
254
255 if (!err)
256 di->state = DEV_STA_OPEN;
257
258 return err;
259}
260
261
262static int API_dev_close(va_list ap)
263{
264 struct device_info *di;
265 int err = 0;
266
267
268 di = (struct device_info *)va_arg(ap, uintptr_t);
269 if (di == NULL)
270 return API_EINVAL;
271
272 if (di->state == DEV_STA_CLOSED)
273 return 0;
274
275 if (di->cookie == NULL)
276 return API_ENODEV;
277
278 if (di->type & DEV_TYP_STOR)
279 err = dev_close_stor(di->cookie);
280
281 else if (di->type & DEV_TYP_NET)
282 err = dev_close_net(di->cookie);
283 else
284
285
286
287
288 err = API_ENODEV;
289
290 if (!err)
291 di->state = DEV_STA_CLOSED;
292
293 return err;
294}
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314static int API_dev_write(va_list ap)
315{
316 struct device_info *di;
317 void *buf;
318 int *len;
319 int err = 0;
320
321
322 di = (struct device_info *)va_arg(ap, uintptr_t);
323 if (di == NULL)
324 return API_EINVAL;
325
326
327
328 if (di->cookie == NULL)
329 return API_ENODEV;
330
331
332 buf = (void *)va_arg(ap, uintptr_t);
333 if (buf == NULL)
334 return API_EINVAL;
335
336
337 len = (int *)va_arg(ap, uintptr_t);
338 if (len == NULL)
339 return API_EINVAL;
340 if (*len <= 0)
341 return API_EINVAL;
342
343 if (di->type & DEV_TYP_STOR)
344
345
346
347
348 return API_ENODEV;
349
350 else if (di->type & DEV_TYP_NET)
351 err = dev_write_net(di->cookie, buf, *len);
352 else
353 err = API_ENODEV;
354
355 return err;
356}
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381static int API_dev_read(va_list ap)
382{
383 struct device_info *di;
384 void *buf;
385 lbasize_t *len_stor, *act_len_stor;
386 lbastart_t *start;
387 int *len_net, *act_len_net;
388
389
390 di = (struct device_info *)va_arg(ap, uintptr_t);
391 if (di == NULL)
392 return API_EINVAL;
393
394
395
396 if (di->cookie == NULL)
397 return API_ENODEV;
398
399
400 buf = (void *)va_arg(ap, uintptr_t);
401 if (buf == NULL)
402 return API_EINVAL;
403
404 if (di->type & DEV_TYP_STOR) {
405
406 len_stor = (lbasize_t *)va_arg(ap, uintptr_t);
407 if (!len_stor)
408 return API_EINVAL;
409 if (*len_stor <= 0)
410 return API_EINVAL;
411
412
413 start = (lbastart_t *)va_arg(ap, uintptr_t);
414
415
416 act_len_stor = (lbasize_t *)va_arg(ap, uintptr_t);
417 if (!act_len_stor)
418 return API_EINVAL;
419
420 *act_len_stor = dev_read_stor(di->cookie, buf, *len_stor, *start);
421
422 } else if (di->type & DEV_TYP_NET) {
423
424
425 len_net = (int *)va_arg(ap, uintptr_t);
426 if (!len_net)
427 return API_EINVAL;
428 if (*len_net <= 0)
429 return API_EINVAL;
430
431
432 act_len_net = (int *)va_arg(ap, uintptr_t);
433 if (!act_len_net)
434 return API_EINVAL;
435
436 *act_len_net = dev_read_net(di->cookie, buf, *len_net);
437
438 } else
439 return API_ENODEV;
440
441 return 0;
442}
443
444
445
446
447
448
449
450
451
452static int API_env_get(va_list ap)
453{
454 char *name, **value;
455
456 if ((name = (char *)va_arg(ap, uintptr_t)) == NULL)
457 return API_EINVAL;
458 if ((value = (char **)va_arg(ap, uintptr_t)) == NULL)
459 return API_EINVAL;
460
461 *value = env_get(name);
462
463 return 0;
464}
465
466
467
468
469
470
471
472
473
474
475static int API_env_set(va_list ap)
476{
477 char *name, *value;
478
479 if ((name = (char *)va_arg(ap, uintptr_t)) == NULL)
480 return API_EINVAL;
481 if ((value = (char *)va_arg(ap, uintptr_t)) == NULL)
482 return API_EINVAL;
483
484 env_set(name, value);
485
486 return 0;
487}
488
489
490
491
492
493
494
495
496static int API_env_enum(va_list ap)
497{
498 int i, buflen;
499 char *last, **next, *s;
500 ENTRY *match, search;
501 static char *var;
502
503 last = (char *)va_arg(ap, unsigned long);
504
505 if ((next = (char **)va_arg(ap, uintptr_t)) == NULL)
506 return API_EINVAL;
507
508 if (last == NULL) {
509 var = NULL;
510 i = 0;
511 } else {
512 var = strdup(last);
513 s = strchr(var, '=');
514 if (s != NULL)
515 *s = 0;
516 search.key = var;
517 i = hsearch_r(search, FIND, &match, &env_htab, 0);
518 if (i == 0) {
519 i = API_EINVAL;
520 goto done;
521 }
522 }
523
524
525 i = hmatch_r("", i, &match, &env_htab);
526 if (i == 0)
527 goto done;
528 buflen = strlen(match->key) + strlen(match->data) + 2;
529 var = realloc(var, buflen);
530 snprintf(var, buflen, "%s=%s", match->key, match->data);
531 *next = var;
532 return 0;
533
534done:
535 free(var);
536 var = NULL;
537 *next = NULL;
538 return i;
539}
540
541
542
543
544
545
546static int API_display_get_info(va_list ap)
547{
548 int type;
549 struct display_info *di;
550
551 type = va_arg(ap, int);
552 di = va_arg(ap, struct display_info *);
553
554 return display_get_info(type, di);
555}
556
557
558
559
560
561
562static int API_display_draw_bitmap(va_list ap)
563{
564 ulong bitmap;
565 int x, y;
566
567 bitmap = va_arg(ap, ulong);
568 x = va_arg(ap, int);
569 y = va_arg(ap, int);
570
571 return display_draw_bitmap(bitmap, x, y);
572}
573
574
575
576
577
578
579static int API_display_clear(va_list ap)
580{
581 display_clear();
582 return 0;
583}
584
585static cfp_t calls_table[API_MAXCALL] = { NULL, };
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603int syscall(int call, int *retval, ...)
604{
605 va_list ap;
606 int rv;
607
608 if (call < 0 || call >= calls_no) {
609 debugf("invalid call #%d\n", call);
610 return 0;
611 }
612
613 if (calls_table[call] == NULL) {
614 debugf("syscall #%d does not have a handler\n", call);
615 return 0;
616 }
617
618 va_start(ap, retval);
619 rv = calls_table[call](ap);
620 if (retval != NULL)
621 *retval = rv;
622
623 return 1;
624}
625
626void api_init(void)
627{
628 struct api_signature *sig;
629
630
631 calls_table[API_RSVD] = NULL;
632 calls_table[API_GETC] = &API_getc;
633 calls_table[API_PUTC] = &API_putc;
634 calls_table[API_TSTC] = &API_tstc;
635 calls_table[API_PUTS] = &API_puts;
636 calls_table[API_RESET] = &API_reset;
637 calls_table[API_GET_SYS_INFO] = &API_get_sys_info;
638 calls_table[API_UDELAY] = &API_udelay;
639 calls_table[API_GET_TIMER] = &API_get_timer;
640 calls_table[API_DEV_ENUM] = &API_dev_enum;
641 calls_table[API_DEV_OPEN] = &API_dev_open;
642 calls_table[API_DEV_CLOSE] = &API_dev_close;
643 calls_table[API_DEV_READ] = &API_dev_read;
644 calls_table[API_DEV_WRITE] = &API_dev_write;
645 calls_table[API_ENV_GET] = &API_env_get;
646 calls_table[API_ENV_SET] = &API_env_set;
647 calls_table[API_ENV_ENUM] = &API_env_enum;
648 calls_table[API_DISPLAY_GET_INFO] = &API_display_get_info;
649 calls_table[API_DISPLAY_DRAW_BITMAP] = &API_display_draw_bitmap;
650 calls_table[API_DISPLAY_CLEAR] = &API_display_clear;
651 calls_no = API_MAXCALL;
652
653 debugf("API initialized with %d calls\n", calls_no);
654
655 dev_stor_init();
656
657
658
659
660 sig = malloc(sizeof(struct api_signature));
661 if (sig == NULL) {
662 printf("API: could not allocate memory for the signature!\n");
663 return;
664 }
665
666 env_set_hex("api_address", (unsigned long)sig);
667 debugf("API sig @ 0x%lX\n", (unsigned long)sig);
668 memcpy(sig->magic, API_SIG_MAGIC, 8);
669 sig->version = API_SIG_VERSION;
670 sig->syscall = &syscall;
671 sig->checksum = 0;
672 sig->checksum = crc32(0, (unsigned char *)sig,
673 sizeof(struct api_signature));
674 debugf("syscall entry: 0x%lX\n", (unsigned long)sig->syscall);
675}
676
677void platform_set_mr(struct sys_info *si, unsigned long start, unsigned long size,
678 int flags)
679{
680 int i;
681
682 if (!si->mr || !size || (flags == 0))
683 return;
684
685
686 for (i = 0; i < si->mr_no; i++)
687 if (si->mr[i].flags == 0) {
688
689 si->mr[i].start = start;
690 si->mr[i].size = size;
691 si->mr[i].flags = flags;
692 return;
693 }
694}
695