]> git.sur5r.net Git - u-boot/blob - lib/membuff.c
efi_selftest: avoid superfluous messages for task priority levels
[u-boot] / lib / membuff.c
1 /*
2  * Copyright (c) 2015 Google, Inc
3  * Written by Simon Glass <sjg@chromium.org>
4  *
5  * Copyright (c) 1992 Simon Glass
6  *
7  * SPDX-License-Identifier:     GPL-2.0+
8  */
9
10 #include <common.h>
11 #include <errno.h>
12 #include <malloc.h>
13 #include "membuff.h"
14
15 void membuff_purge(struct membuff *mb)
16 {
17         /* set mb->head and mb->tail so the buffers look empty */
18         mb->head = mb->start;
19         mb->tail = mb->start;
20 }
21
22 static int membuff_putrawflex(struct membuff *mb, int maxlen, bool update,
23                               char ***data, int *offsetp)
24 {
25         int len;
26
27         /* always write to 'mb->head' */
28         assert(data && offsetp);
29         *data = &mb->start;
30         *offsetp = mb->head - mb->start;
31
32         /* if there is no buffer, we can do nothing */
33         if (!mb->start)
34                 return 0;
35
36         /*
37          * if head is ahead of tail, we can write from head until the end of
38          * the buffer
39          */
40         if (mb->head >= mb->tail) {
41                 /* work out how many bytes can fit here */
42                 len = mb->end - mb->head - 1;
43                 if (maxlen >= 0 && len > maxlen)
44                         len = maxlen;
45
46                 /* update the head pointer to mark these bytes as written */
47                 if (update)
48                         mb->head += len;
49
50                 /*
51                  * if the tail isn't at start of the buffer, then we can
52                  * write one more byte right at the end
53                  */
54                 if ((maxlen < 0 || len < maxlen) && mb->tail != mb->start) {
55                         len++;
56                         if (update)
57                                 mb->head = mb->start;
58                 }
59
60         /* otherwise now we can write until head almost reaches tail */
61         } else {
62                 /* work out how many bytes can fit here */
63                 len = mb->tail - mb->head - 1;
64                 if (maxlen >= 0 && len > maxlen)
65                         len = maxlen;
66
67                 /* update the head pointer to mark these bytes as written */
68                 if (update)
69                         mb->head += len;
70         }
71
72         /* return the number of bytes which can be/must be written */
73         return len;
74 }
75
76 int membuff_putraw(struct membuff *mb, int maxlen, bool update, char **data)
77 {
78         char **datap;
79         int offset;
80         int size;
81
82         size = membuff_putrawflex(mb, maxlen, update, &datap, &offset);
83         *data = *datap + offset;
84
85         return size;
86 }
87
88 bool membuff_putbyte(struct membuff *mb, int ch)
89 {
90         char *data;
91
92         if (membuff_putraw(mb, 1, true, &data) != 1)
93                 return false;
94         *data = ch;
95
96         return true;
97 }
98
99 int membuff_getraw(struct membuff *mb, int maxlen, bool update, char **data)
100 {
101         int len;
102
103         /* assume for now there is no data to get */
104         len = 0;
105
106         /*
107          * in this case head is ahead of tail, so we must return data between
108          *'tail' and 'head'
109          */
110         if (mb->head > mb->tail) {
111                 /* work out the amount of data */
112                 *data = mb->tail;
113                 len = mb->head - mb->tail;
114
115                 /* check it isn't too much */
116                 if (maxlen >= 0 && len > maxlen)
117                         len = maxlen;
118
119                 /* & mark it as read from the buffer */
120                 if (update)
121                         mb->tail += len;
122         }
123
124         /*
125          * if head is before tail, then we have data between 'tail' and 'end'
126          * and some more data between 'start' and 'head'(which we can't
127          * return this time
128          */
129         else if (mb->head < mb->tail) {
130                 /* work out the amount of data */
131                 *data = mb->tail;
132                 len = mb->end - mb->tail;
133                 if (maxlen >= 0 && len > maxlen)
134                         len = maxlen;
135                 if (update) {
136                         mb->tail += len;
137                         if (mb->tail == mb->end)
138                                 mb->tail = mb->start;
139                 }
140         }
141
142         debug("getraw: maxlen=%d, update=%d, head=%d, tail=%d, data=%d, len=%d",
143               maxlen, update, (int)(mb->head - mb->start),
144               (int)(mb->tail - mb->start), (int)(*data - mb->start), len);
145
146         /* return the number of bytes we found */
147         return len;
148 }
149
150 int membuff_getbyte(struct membuff *mb)
151 {
152         char *data = 0;
153
154         return membuff_getraw(mb, 1, true, &data) != 1 ? -1 : *(uint8_t *)data;
155 }
156
157 int membuff_peekbyte(struct membuff *mb)
158 {
159         char *data = 0;
160
161         return membuff_getraw(mb, 1, false, &data) != 1 ? -1 : *(uint8_t *)data;
162 }
163
164 int membuff_get(struct membuff *mb, char *buff, int maxlen)
165 {
166         char *data = 0, *buffptr = buff;
167         int len = 1, i;
168
169         /*
170          * do this in up to two lots(see GetRaw for why) stopping when there
171          * is no more data
172          */
173         for (i = 0; len && i < 2; i++) {
174                 /* get a pointer to the data available */
175                 len = membuff_getraw(mb, maxlen, true, &data);
176
177                 /* copy it into the buffer */
178                 memcpy(buffptr, data, len);
179                 buffptr += len;
180                 maxlen -= len;
181         }
182
183         /* return the number of bytes read */
184         return buffptr - buff;
185 }
186
187 int membuff_put(struct membuff *mb, const char *buff, int length)
188 {
189         char *data;
190         int towrite, i, written;
191
192         for (i = written = 0; i < 2; i++) {
193                 /* ask where some data can be written */
194                 towrite = membuff_putraw(mb, length, true, &data);
195
196                 /* and write it, updating the bytes length */
197                 memcpy(data, buff, towrite);
198                 written += towrite;
199                 buff += towrite;
200                 length -= towrite;
201         }
202
203         /* return the number of bytes written */
204         return written;
205 }
206
207 bool membuff_isempty(struct membuff *mb)
208 {
209         return mb->head == mb->tail;
210 }
211
212 int membuff_avail(struct membuff *mb)
213 {
214         struct membuff copy;
215         int i, avail;
216         char *data = 0;
217
218         /* make a copy of this buffer's control data */
219         copy = *mb;
220
221         /* now read everything out of the copied buffer */
222         for (i = avail = 0; i < 2; i++)
223                 avail += membuff_getraw(&copy, -1, true, &data);
224
225         /* and return how much we read */
226         return avail;
227 }
228
229 int membuff_size(struct membuff *mb)
230 {
231         return mb->end - mb->start;
232 }
233
234 bool membuff_makecontig(struct membuff *mb)
235 {
236         int topsize, botsize;
237
238         debug("makecontig: head=%d, tail=%d, size=%d",
239               (int)(mb->head - mb->start), (int)(mb->tail - mb->start),
240               (int)(mb->end - mb->start));
241
242         /*
243          * first we move anything at the start of the buffer into the correct
244          * place some way along
245          */
246         if (mb->tail > mb->head) {
247                 /*
248                  * the data is split into two parts, from 0 to ->head and
249                  * from ->tail to ->end. We move the stuff from 0 to ->head
250                  * up to make space for the other data before it
251                  */
252                 topsize = mb->end - mb->tail;
253                 botsize = mb->head - mb->start;
254
255                 /*
256                  * must move data at bottom up by 'topsize' bytes - check if
257                  * there's room
258                  */
259                 if (mb->head + topsize >= mb->tail)
260                         return false;
261                 memmove(mb->start + topsize, mb->start, botsize);
262                 debug(" - memmove(%d, %d, %d)", topsize, 0, botsize);
263
264         /* nothing at the start, so skip that step */
265         } else {
266                 topsize = mb->head - mb->tail;
267                 botsize = 0;
268         }
269
270         /* now move data at top down to the bottom */
271         memcpy(mb->start, mb->tail, topsize);
272         debug(" - memcpy(%d, %d, %d)", 0, (int)(mb->tail - mb->start), topsize);
273
274         /* adjust pointers */
275         mb->tail = mb->start;
276         mb->head = mb->start + topsize + botsize;
277
278         debug(" - head=%d, tail=%d", (int)(mb->head - mb->start),
279               (int)(mb->tail - mb->start));
280
281         /* all ok */
282         return true;
283 }
284
285 int membuff_free(struct membuff *mb)
286 {
287         return mb->end == mb->start ? 0 :
288                         (mb->end - mb->start) - 1 - membuff_avail(mb);
289 }
290
291 int membuff_readline(struct membuff *mb, char *str, int maxlen, int minch)
292 {
293         int len;  /* number of bytes read (!= string length) */
294         char *s, *end;
295         bool ok = false;
296         char *orig = str;
297
298         end = mb->head >= mb->tail ? mb->head : mb->end;
299         for (len = 0, s = mb->tail; s < end && len < maxlen - 1; str++) {
300                 *str = *s++;
301                 len++;
302                 if (*str == '\n' || *str < minch) {
303                         ok = true;
304                         break;
305                 }
306                 if (s == end && mb->tail > mb->head) {
307                         s = mb->start;
308                         end = mb->head;
309                 }
310         }
311
312         /* couldn't get the whole string */
313         if (!ok) {
314                 if (maxlen)
315                         *orig = '\0';
316                 return 0;
317         }
318
319         /* terminate the string, update the membuff and return success */
320         *str = '\0';
321         mb->tail = s == mb->end ? mb->start : s;
322
323         return len;
324 }
325
326 int membuff_extend_by(struct membuff *mb, int by, int max)
327 {
328         int oldhead, oldtail;
329         int size, orig;
330         char *ptr;
331
332         /* double the buffer size until it is big enough */
333         assert(by >= 0);
334         for (orig = mb->end - mb->start, size = orig; size < orig + by;)
335                 size *= 2;
336         if (max != -1)
337                 size = min(size, max);
338         by = size - orig;
339
340         /* if we're already at maximum, give up */
341         if (by <= 0)
342                 return -E2BIG;
343
344         oldhead = mb->head - mb->start;
345         oldtail = mb->tail - mb->start;
346         ptr = realloc(mb->start, size);
347         if (!ptr)
348                 return -ENOMEM;
349         mb->start = ptr;
350         mb->head = mb->start + oldhead;
351         mb->tail = mb->start + oldtail;
352
353         if (mb->head < mb->tail) {
354                 memmove(mb->tail + by, mb->tail, orig - oldtail);
355                 mb->tail += by;
356         }
357         mb->end = mb->start + size;
358
359         return 0;
360 }
361
362 void membuff_init(struct membuff *mb, char *buff, int size)
363 {
364         mb->start = buff;
365         mb->end = mb->start + size;
366         membuff_purge(mb);
367 }
368
369 int membuff_new(struct membuff *mb, int size)
370 {
371         mb->start = malloc(size);
372         if (!mb->start)
373                 return -ENOMEM;
374
375         membuff_init(mb, mb->start, size);
376         return 0;
377 }
378
379 void membuff_uninit(struct membuff *mb)
380 {
381         mb->end = NULL;
382         mb->start = NULL;
383         membuff_purge(mb);
384 }
385
386 void membuff_dispose(struct membuff *mb)
387 {
388         free(&mb->start);
389         membuff_uninit(mb);
390 }