ddb2433104071c01f47ec7f35f18fedb23c242cf
[musl] / src / stdio / fmemopen.c
1 #include "stdio_impl.h"
2
3 struct cookie {
4         size_t pos, len, size;
5         unsigned char *buf;
6         int mode;
7 };
8
9 static off_t mseek(FILE *f, off_t off, int whence)
10 {
11         ssize_t base;
12         struct cookie *c = f->cookie;
13         if (whence>2U) {
14 fail:
15                 errno = EINVAL;
16                 return -1;
17         }
18         base = (size_t [3]){0, c->pos, c->len}[whence];
19         if (off < -base || off > (ssize_t)c->size-base) goto fail;
20         return c->pos = base+off;
21 }
22
23 static size_t mread(FILE *f, unsigned char *buf, size_t len)
24 {
25         struct cookie *c = f->cookie;
26         size_t rem = c->size - c->pos;
27         if (!len) return 0;
28         if (len > rem) len = rem;
29         memcpy(buf, c->buf+c->pos, len);
30         c->pos += len;
31         rem -= len;
32         if (rem > f->buf_size) rem = f->buf_size;
33         f->rpos = f->buf;
34         f->rend = f->buf + rem;
35         memcpy(f->rpos, c->buf+c->pos, rem);
36         c->pos += rem;
37         if (!len) f->flags |= F_EOF;
38         return len;
39 }
40
41 static size_t mwrite(FILE *f, const unsigned char *buf, size_t len)
42 {
43         struct cookie *c = f->cookie;
44         size_t rem;
45         size_t len2 = f->wpos - f->wbase;
46         if (len2) {
47                 f->wpos = f->wbase;
48                 if (mwrite(f, f->wpos, len2) < len2) return 0;
49         }
50         if (c->mode == 'a') c->pos = c->size;
51         rem = c->size - c->pos;
52         if (len > rem) len = rem;
53         memcpy(c->buf+c->pos, buf, len);
54         c->pos += len;
55         if (c->pos >= c->len) c->len = c->pos;
56         c->buf[c->len==c->size ? c->len-1 : c->len] = 0;
57         return len;
58 }
59
60 static int mclose(FILE *m)
61 {
62         return 0;
63 }
64
65 FILE *fmemopen(void *buf, size_t size, const char *mode)
66 {
67         FILE *f;
68         struct cookie *c;
69         int plus = !!strchr(mode, '+');
70         
71         if (!size || !strchr("rwa", *mode)) {
72                 errno = EINVAL;
73                 return 0;
74         }
75
76         if (!buf && size > SIZE_MAX-sizeof(FILE)-BUFSIZ-UNGET) {
77                 errno = ENOMEM;
78                 return 0;
79         }
80
81         f = calloc(sizeof *f + sizeof *c + UNGET + BUFSIZ + (buf?0:size), 1);
82         if (!f) return 0;
83         f->cookie = c = (void *)(f+1);
84         f->fd = -1;
85         f->lbf = EOF;
86         f->buf = (unsigned char *)(c+1) + UNGET;
87         f->buf_size = BUFSIZ;
88         if (!buf) buf = f->buf + BUFSIZ;
89
90         c->buf = buf;
91         c->size = size;
92         c->mode = *mode;
93         
94         if (!plus) f->flags = (*mode == 'r') ? F_NOWR : F_NORD;
95         if (*mode == 'r') c->len = size;
96         else if (*mode == 'a') c->len = c->pos = strnlen(buf, size);
97
98         f->read = mread;
99         f->write = mwrite;
100         f->seek = mseek;
101         f->close = mclose;
102
103         if (!libc.threaded) {
104                 f->lock = -1;
105                 f->next = libc.ofl_head;
106                 if (libc.ofl_head) libc.ofl_head->prev = f;
107                 libc.ofl_head = f;
108         }
109
110         return f;
111 }