Sets ENOENT when appropriate
[akaros.git] / kern / drivers / dev / tab.c
1 /*
2  * Stub.
3  */
4 //#define DEBUG
5 #include <kmalloc.h>
6 #include <string.h>
7 #include <stdio.h>
8 #include <assert.h>
9 #include <error.h>
10 #include <pmap.h>
11 #include <sys/queue.h>
12 #include <smp.h>
13 #include <kref.h>
14 #include <atomic.h>
15 #include <alarm.h>
16 #include <event.h>
17 #include <umem.h>
18
19 void devtabreset()
20 {
21         int i;
22
23         for (i = 0; &devtab[i] < __devtabend; i++)
24                 devtab[i].reset();
25 }
26
27 void devtabinit()
28 {
29         int i;
30
31         for (i = 0; &devtab[i] < __devtabend; i++) {
32                 /* if we have errors, check the align of struct dev and objdump */
33                 printd("i %d, dev %p, init %p\n", i, &devtab[i], devtab[i].init);
34                 devtab[i].init();
35         }
36 }
37
38 void devtabshutdown()
39 {
40         int i;
41
42         /*
43          * Shutdown in reverse order.
44          */
45         for (i = 0; &devtab[i] < __devtabend; i++) ;
46         for (i--; i >= 0; i--)
47                 devtab[i].shutdown();
48 }
49
50 struct dev *devtabget(int dc, int user)
51 {
52         int i;
53
54         for (i = 0; &devtab[i] < __devtabend; i++) {
55                 if (devtab[i].dc == dc)
56                         return &devtab[i];
57         }
58
59         printk("devtabget FAILED %c\n", dc);
60         set_errno(ENOENT);
61         error(Enonexist);
62 }
63
64 long
65 devtabread(struct chan *c, void *buf, long n, int64_t off)
66 {
67         ERRSTACK(1);
68
69         int i;
70         struct dev *dev;
71         char *alloc, *e, *p;
72
73         alloc = kzmalloc(READSTR, KMALLOC_WAIT);
74         if (alloc == NULL)
75                 error(Enomem);
76
77         p = alloc;
78         e = p + READSTR;
79         for (i = 0; &devtab[i] < __devtabend; i++) {
80                 dev = &devtab[i];
81                 printd("p %p e %p e-p %d\n", p, e, e - p);
82                 printd("do %d %c %s\n", i, dev->dc, dev->name);
83                 p += snprintf(p, e - p, "#%c %s\n", dev->dc, dev->name);
84         }
85
86         if (waserror()) {
87                 kfree(alloc);
88                 nexterror();
89         }
90         n = readstr(off, buf, n, alloc);
91
92         kfree(alloc);
93         poperror();
94
95         return n;
96 }