This links.
[akaros.git] / kern / src / ns / allocb.c
1 // INFERNO
2 #include <vfs.h>
3 #include <kfs.h>
4 #include <slab.h>
5 #include <kmalloc.h>
6 #include <kref.h>
7 #include <string.h>
8 #include <stdio.h>
9 #include <assert.h>
10 #include <error.h>
11 #include <cpio.h>
12 #include <pmap.h>
13 #include <smp.h>
14 #include <ip.h>
15 #include <process.h>
16
17 enum
18 {
19         Hdrspc          = 64,           /* leave room for high-level headers */
20         Bdead           = 0x51494F42,   /* "QIOB" */
21         BLOCKALIGN  = 32,               /* was the old BY2V in inferno, which was 8 */
22 };
23
24 static atomic_t ialloc_bytes = 0;
25
26 /*
27  *  allocate blocks (round data base address to 64 bit boundary).
28  *  if mallocz gives us more than we asked for, leave room at the front
29  *  for header.
30  */
31 struct block *_allocb(int size)
32 {
33         struct block *b;
34         uintptr_t addr;
35         int n;
36
37         /* TODO: verify we end up with properly aligned blocks */
38         b = kzmalloc(sizeof(struct block) + size + Hdrspc + (BLOCKALIGN - 1),
39                      KMALLOC_WAIT);
40         if (b == NULL)
41                 return NULL;
42
43         b->next = NULL;
44         b->list = NULL;
45         b->free = NULL;
46         b->flag = 0;
47
48         addr = (uintptr_t)b;
49         addr = ROUNDUP(addr + sizeof(struct block), BLOCKALIGN);
50         b->base = (uint8_t*)addr;
51         /* interesting. We can ask the allocator, after allocating,
52          * the *real* size of the block we got. Very nice.
53          * Not on akaros yet.
54         b->lim = ((uint8_t*)b) + msize(b);
55          */
56         b->lim = ((uint8_t*)b) + sizeof(struct block) + size + Hdrspc + (BLOCKALIGN - 1);
57         b->rp = b->base;
58         n = b->lim - b->base - size;
59         b->rp += n & ~(BLOCKALIGN - 1);
60         b->wp = b->rp;
61
62         return b;
63 }
64
65 struct block *allocb(int size)
66 {
67         struct block *b;
68
69         if (!current)
70                 panic("allocb outside process: %8.8lux", getcallerpc(&size));
71         b = _allocb(size);
72         if (b == 0)
73                 exhausted("Blocks");
74         return b;
75 }
76
77 /*
78  *  interrupt time allocation
79  */
80 struct block *iallocb(int size)
81 {
82         struct block *b;
83
84         #if 0 /* conf is some inferno global config */
85         if (atomic_read(&ialloc_bytes) > conf.ialloc) {
86                 //printk("iallocb: limited %lud/%lud\n", atomic_read(&ialloc_bytes),
87                 //       conf.ialloc);
88                 return NULL;
89         }
90         #endif
91
92         b = _allocb(size);
93         if (b == NULL) {
94                 //printk("iallocb: no memory %lud/%lud\n", atomic_read(&ialloc_bytes),
95                 //       conf.ialloc);
96                 return NULL;
97         }
98         b->flag = BINTR;
99
100         atomic_add(&ialloc_bytes, b->lim - b->base);
101
102         return b;
103 }
104
105 void freeb(struct block *b)
106 {
107         void *dead = (void *)Bdead;
108
109         if (b == NULL)
110                 return;
111
112         /*
113          * drivers which perform non cache coherent DMA manage their own buffer
114          * pool of uncached buffers and provide their own free routine.
115          */
116         if (b->free) {
117                 b->free(b);
118                 return;
119         }
120         if (b->flag & BINTR) {
121                 /* subtracting the size of b */
122                 atomic_add(&ialloc_bytes, -(b->lim - b->base));
123         }
124
125         /* poison the block in case someone is still holding onto it */
126         b->next = dead;
127         b->rp = dead;
128         b->wp = dead;
129         b->lim = dead;
130         b->base = dead;
131
132         kfree(b);
133 }
134
135 void checkb(struct block *b, char *msg)
136 {
137         void *dead = (void *)Bdead;
138
139         if (b == dead)
140                 panic("checkb b %s %lux", msg, b);
141         if (b->base == dead || b->lim == dead || b->next == dead
142                 || b->rp == dead || b->wp == dead) {
143                 printd("checkb: base 0x%8.8luX lim 0x%8.8luX next 0x%8.8luX\n",
144                            b->base, b->lim, b->next);
145                 printd("checkb: rp 0x%8.8luX wp 0x%8.8luX\n", b->rp, b->wp);
146                 panic("checkb dead: %s\n", msg);
147         }
148
149         if (b->base > b->lim)
150                 panic("checkb 0 %s %lux %lux", msg, b->base, b->lim);
151         if (b->rp < b->base)
152                 panic("checkb 1 %s %lux %lux", msg, b->base, b->rp);
153         if (b->wp < b->base)
154                 panic("checkb 2 %s %lux %lux", msg, b->base, b->wp);
155         if (b->rp > b->lim)
156                 panic("checkb 3 %s %lux %lux", msg, b->rp, b->lim);
157         if (b->wp > b->lim)
158                 panic("checkb 4 %s %lux %lux", msg, b->wp, b->lim);
159
160 }
161
162 void iallocsummary(void)
163 {
164         printd("ialloc %lud/%lud\n", atomic_read(&ialloc_bytes), 0 /*conf.ialloc*/);
165 }