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