4426a1296939ab811bcb129177d68b0fc7ad0375
[musl] / src / stdio / vfwscanf.c
1 #include <stdio.h>
2 #include <stdlib.h>
3 #include <stdarg.h>
4 #include <ctype.h>
5 #include <wchar.h>
6 #include <wctype.h>
7 #include <limits.h>
8 #include <string.h>
9 #include <errno.h>
10 #include <math.h>
11 #include <float.h>
12
13 #include "stdio_impl.h"
14 #include "shgetc.h"
15 #include "intscan.h"
16 #include "floatscan.h"
17
18 #define SIZE_hh -2
19 #define SIZE_h  -1
20 #define SIZE_def 0
21 #define SIZE_l   1
22 #define SIZE_L   2
23 #define SIZE_ll  3
24
25 static void store_int(void *dest, int size, unsigned long long i)
26 {
27         if (!dest) return;
28         switch (size) {
29         case SIZE_hh:
30                 *(char *)dest = i;
31                 break;
32         case SIZE_h:
33                 *(short *)dest = i;
34                 break;
35         case SIZE_def:
36                 *(int *)dest = i;
37                 break;
38         case SIZE_l:
39                 *(long *)dest = i;
40                 break;
41         case SIZE_ll:
42                 *(long long *)dest = i;
43                 break;
44         }
45 }
46
47 static void *arg_n(va_list ap, unsigned int n)
48 {
49         void *p;
50         unsigned int i;
51         va_list ap2;
52         va_copy(ap2, ap);
53         for (i=n; i>1; i--) va_arg(ap2, void *);
54         p = va_arg(ap2, void *);
55         va_end(ap2);
56         return p;
57 }
58
59 static int in_set(const wchar_t *set, int c)
60 {
61         int j;
62         const wchar_t *p = set;
63         if (*p == '-') {
64                 if (c=='-') return 1;
65                 p++;
66         } else if (*p == ']') {
67                 if (c==']') return 1;
68                 p++;
69         }
70         for (; *p && *p != ']'; p++) {
71                 if (*p=='-' && p[1] && p[1] != ']')
72                         for (j=p++[-1]; j<*p; j++)
73                                 if (c==j) return 1;
74                 if (c==*p) return 1;
75         }
76         return 0;
77 }
78
79 #if 1
80 #undef getwc
81 #define getwc(f) \
82         ((f)->rpos < (f)->rend && *(f)->rpos < 128 ? *(f)->rpos++ : (getwc)(f))
83
84 #undef ungetwc
85 #define ungetwc(c,f) \
86         ((f)->rend && (c)<128 ? *--(f)->rpos : ungetwc((c),(f)))
87 #endif
88
89 int vfwscanf(FILE *f, const wchar_t *fmt, va_list ap)
90 {
91         int width;
92         int size;
93         int alloc;
94         const wchar_t *p;
95         int c, t;
96         char *s;
97         wchar_t *wcs;
98         void *dest=NULL;
99         int invert;
100         int matches=0;
101         off_t pos = 0, cnt;
102         static const char size_pfx[][3] = { "hh", "h", "", "l", "L", "ll" };
103         char tmp[3*sizeof(int)+10];
104
105         FLOCK(f);
106
107         for (p=fmt; *p; p++) {
108
109                 if (iswspace(*p)) {
110                         while (iswspace(p[1])) p++;
111                         while (iswspace((c=getwc(f)))) pos++;
112                         ungetwc(c, f);
113                         continue;
114                 }
115                 if (*p != '%' || p[1] == '%') {
116                         p += *p=='%';
117                         c = getwc(f);
118                         if (c!=*p) {
119                                 ungetwc(c, f);
120                                 if (c<0) goto input_fail;
121                                 goto match_fail;
122                         }
123                         pos++;
124                         continue;
125                 }
126
127                 p++;
128                 if (*p=='*') {
129                         dest = 0; p++;
130                 } else if (iswdigit(*p) && p[1]=='$') {
131                         dest = arg_n(ap, *p-'0'); p+=2;
132                 } else {
133                         dest = va_arg(ap, void *);
134                 }
135
136                 for (width=0; iswdigit(*p); p++) {
137                         width = 10*width + *p - '0';
138                 }
139
140                 if (*p=='m') {
141                         alloc = 1;
142                         p++;
143                 } else {
144                         alloc = 0;
145                 }
146
147                 size = SIZE_def;
148                 switch (*p++) {
149                 case 'h':
150                         if (*p == 'h') p++, size = SIZE_hh;
151                         else size = SIZE_h;
152                         break;
153                 case 'l':
154                         if (*p == 'l') p++, size = SIZE_ll;
155                         else size = SIZE_l;
156                         break;
157                 case 'j':
158                         size = SIZE_ll;
159                         break;
160                 case 'z':
161                 case 't':
162                         size = SIZE_l;
163                         break;
164                 case 'L':
165                         size = SIZE_L;
166                         break;
167                 case 'd': case 'i': case 'o': case 'u': case 'x':
168                 case 'a': case 'e': case 'f': case 'g':
169                 case 'A': case 'E': case 'F': case 'G': case 'X':
170                 case 's': case 'c': case '[':
171                 case 'S': case 'C':
172                 case 'p': case 'n':
173                         p--;
174                         break;
175                 default:
176                         goto fmt_fail;
177                 }
178
179                 t = *p;
180
181                 /* Transform ls,lc -> S,C */
182                 if (size==SIZE_l && (t&15)==3) t&=~32;
183
184                 if (t != 'n' && t != '[' && (t|32) != 'c') {
185                         while (iswspace((c=getwc(f)))) pos++;
186                         if (c < 0) goto input_fail;
187                         ungetwc(c, f);
188                 }
189
190                 switch (t) {
191                 case 'n':
192                         store_int(dest, size, pos);
193                         /* do not increment match count, etc! */
194                         continue;
195
196                 case 'c':
197                         if (width < 1) width = 1;
198                         s = dest;
199                         for (; width && (c=getwc(f)) >= 0; width--) {
200                                 int l = wctomb(s?s:tmp, c);
201                                 if (l<0) goto input_fail;
202                                 if (s) s+=l;
203                                 pos++;
204                         }
205                         if (width) goto match_fail;
206                         break;
207
208                 case 'C':
209                         if (width < 1) width = 1;
210                         wcs = dest;
211                         for (; width && (c=getwc(f)) >= 0; width--)
212                                 pos++, wcs && (*wcs++ = c);
213                         if (width) goto match_fail;
214                         break;
215
216                 case 's':
217                         s = dest;
218                         while (!iswspace(c=getwc(f)) && c!=EOF) {
219                                 int l = wctomb(s?s:tmp, c);
220                                 if (l<0) goto input_fail;
221                                 if (s) s+=l;
222                                 pos++;
223                         }
224                         if (s) *s = 0;
225                         break;
226
227                 case 'S':
228                         wcs = dest;
229                         while (!iswspace(c=getwc(f)) && c!=EOF)
230                                 pos++, *wcs++ = c;
231                         if (wcs) *wcs = 0;
232                         break;
233
234                 case '[':
235                         s = (size == SIZE_def) ? dest : 0;
236                         wcs = (size == SIZE_l) ? dest : 0;
237
238                         if (*++p == '^') p++, invert = 1;
239                         else invert = 0;
240
241                         int gotmatch = 0;
242
243                         for (;;) {
244                                 if ((c=getwc(f))<0) break;
245                                 if (in_set(p, c) == invert)
246                                         break;
247                                 if (wcs) {
248                                         *wcs++ = c;
249                                 } else if (size != SIZE_l) {
250                                         int l = wctomb(s?s:tmp, c);
251                                         if (l<0) goto input_fail;
252                                         if (s) s+=l;
253                                 }
254                                 pos++;
255                                 gotmatch=1;
256                         }
257                         ungetwc(c, f);
258
259                         if (!gotmatch) goto match_fail;
260
261                         if (*p==']') p++;
262                         while (*p!=']') {
263                                 if (!*p) goto fmt_fail;
264                                 p++;
265                         }
266
267                         if (wcs) *wcs++ = 0;
268                         if (s) *s++ = 0;
269                         break;
270
271                 case 'd': case 'i': case 'o': case 'u': case 'x':
272                 case 'a': case 'e': case 'f': case 'g':
273                 case 'A': case 'E': case 'F': case 'G': case 'X':
274                 case 'p':
275                         if (width < 1) width = 0;
276                         snprintf(tmp, sizeof tmp, "%.*s%.0d%s%c%%lln",
277                                 1+!dest, "%*", width, size_pfx[size+2], t);
278                         cnt = 0;
279                         if (fscanf(f, tmp, dest?dest:&cnt, &cnt) == -1)
280                                 goto input_fail;
281                         else if (!cnt)
282                                 goto match_fail;
283                         pos += cnt;
284                         break;
285                 default:
286                         goto fmt_fail;
287                 }
288
289                 if (dest) matches++;
290         }
291         if (0) {
292 fmt_fail:
293 input_fail:
294                 if (!matches) matches--;
295         }
296 match_fail:
297         FUNLOCK(f);
298         return matches;
299 }