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