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