a7c3a64502bcfcdfa452bf3a04b579c1a78da876
[musl] / src / stdio / open_wmemstream.c
1 #include "stdio_impl.h"
2 #include <wchar.h>
3 #include <errno.h>
4 #include <limits.h>
5 #include <string.h>
6
7 struct cookie {
8         wchar_t **bufp;
9         size_t *sizep;
10         size_t pos;
11         wchar_t *buf;
12         size_t len;
13         size_t space;
14         mbstate_t mbs;
15 };
16
17 struct wms_FILE {
18         FILE f;
19         struct cookie c;
20         unsigned char buf[1];
21 };
22
23 static off_t wms_seek(FILE *f, off_t off, int whence)
24 {
25         ssize_t base;
26         struct cookie *c = f->cookie;
27         if (whence>2U) {
28 fail:
29                 errno = EINVAL;
30                 return -1;
31         }
32         base = (size_t [3]){0, c->pos, c->len}[whence];
33         if (off < -base || off > SSIZE_MAX/4-base) goto fail;
34         memset(&c->mbs, 0, sizeof c->mbs);
35         return c->pos = base+off;
36 }
37
38 static size_t wms_write(FILE *f, const unsigned char *buf, size_t len)
39 {
40         struct cookie *c = f->cookie;
41         size_t len2;
42         wchar_t *newbuf;
43         if (len + c->pos >= c->space) {
44                 len2 = 2*c->space+1 | c->pos+len+1;
45                 if (len2 > SSIZE_MAX/4) return 0;
46                 newbuf = realloc(c->buf, len2*4);
47                 if (!newbuf) return 0;
48                 *c->bufp = c->buf = newbuf;
49                 memset(c->buf + c->space, 0, 4*(len2 - c->space));
50                 c->space = len2;
51         }
52         
53         len2 = mbsnrtowcs(c->buf+c->pos, (void *)&buf, len, c->space-c->pos, &c->mbs);
54         if (len2 == -1) return 0;
55         c->pos += len2;
56         if (c->pos >= c->len) c->len = c->pos;
57         *c->sizep = c->pos;
58         return len;
59 }
60
61 static int wms_close(FILE *f)
62 {
63         return 0;
64 }
65
66 FILE *open_wmemstream(wchar_t **bufp, size_t *sizep)
67 {
68         struct wms_FILE *f;
69         wchar_t *buf;
70
71         if (!(f=malloc(sizeof *f))) return 0;
72         if (!(buf=malloc(sizeof *buf))) {
73                 free(f);
74                 return 0;
75         }
76         memset(&f->f, 0, sizeof f->f);
77         memset(&f->c, 0, sizeof f->c);
78         f->f.cookie = &f->c;
79
80         f->c.bufp = bufp;
81         f->c.sizep = sizep;
82         f->c.pos = f->c.len = f->c.space = *sizep = 0;
83         f->c.buf = *bufp = buf;
84         *buf = 0;
85
86         f->f.flags = F_NORD;
87         f->f.fd = -1;
88         f->f.buf = f->buf;
89         f->f.buf_size = 0;
90         f->f.lbf = EOF;
91         f->f.write = wms_write;
92         f->f.seek = wms_seek;
93         f->f.close = wms_close;
94
95         if (!libc.threaded) f->f.lock = -1;
96
97         fwide(&f->f, 1);
98
99         return __ofl_add(&f->f);
100 }