1 | /*
|
---|
2 | =============================================================================
|
---|
3 | scan.c -- input scan conversion for the portable C I/O Library
|
---|
4 | Version 3 -- 1989-01-16 -- D.N. Lynx Crowe
|
---|
5 | =============================================================================
|
---|
6 | */
|
---|
7 |
|
---|
8 | #include "ram.h"
|
---|
9 |
|
---|
10 | static int16_t maxwide;
|
---|
11 | static int16_t (*gsub)(int16_t what);
|
---|
12 |
|
---|
13 | static int8_t *scnstr;
|
---|
14 | static int8_t quit;
|
---|
15 |
|
---|
16 | static int32_t getnum(int8_t *list, int8_t *values, int16_t base)
|
---|
17 | {
|
---|
18 | register int32_t val;
|
---|
19 | register int8_t *cp;
|
---|
20 | int16_t c;
|
---|
21 | int16_t sign;
|
---|
22 |
|
---|
23 | if (maxwide LE 0)
|
---|
24 | return(0L);
|
---|
25 |
|
---|
26 | val = sign = 0;
|
---|
27 |
|
---|
28 | if ((c = (*gsub)(0)) EQ '-') {
|
---|
29 |
|
---|
30 | sign = 1;
|
---|
31 | --maxwide;
|
---|
32 |
|
---|
33 | } else if (c EQ '+')
|
---|
34 | --maxwide;
|
---|
35 | else
|
---|
36 | (*gsub)(1);
|
---|
37 |
|
---|
38 | while (maxwide--) {
|
---|
39 |
|
---|
40 | if ((cp = index(list, (int8_t)(*gsub)(0))) EQ NULL) {
|
---|
41 |
|
---|
42 | (*gsub)(1);
|
---|
43 | break;
|
---|
44 | }
|
---|
45 |
|
---|
46 | val *= base;
|
---|
47 | val += values[(int32_t)cp - (int32_t)list];
|
---|
48 | }
|
---|
49 |
|
---|
50 | if (sign)
|
---|
51 | val = -val;
|
---|
52 |
|
---|
53 | return(val);
|
---|
54 | }
|
---|
55 |
|
---|
56 | static int16_t skipblk(void)
|
---|
57 | {
|
---|
58 | while (isspace((*gsub)(0)))
|
---|
59 | ;
|
---|
60 |
|
---|
61 | if ((*gsub)(1) EQ EOF)
|
---|
62 | return(EOF);
|
---|
63 |
|
---|
64 | return(0);
|
---|
65 | }
|
---|
66 |
|
---|
67 | static int16_t sgetc(int16_t what)
|
---|
68 | {
|
---|
69 | if (what EQ 0) {
|
---|
70 |
|
---|
71 | if (*scnstr)
|
---|
72 | return(*scnstr++ & 0x00FF);
|
---|
73 |
|
---|
74 | quit = TRUE;
|
---|
75 |
|
---|
76 | } else {
|
---|
77 |
|
---|
78 | if (!quit)
|
---|
79 | return(*--scnstr & 0x00FF);
|
---|
80 | }
|
---|
81 |
|
---|
82 | return(EOF);
|
---|
83 | }
|
---|
84 |
|
---|
85 | int16_t scanfmt(int16_t (*getsub)(int16_t what), int8_t *fmt, int16_t **args)
|
---|
86 | {
|
---|
87 |
|
---|
88 | #ifdef FLOAT
|
---|
89 | double getflt(), d;
|
---|
90 | #endif
|
---|
91 |
|
---|
92 | int32_t lv;
|
---|
93 | int16_t c, count, dontdo, lflag, base;
|
---|
94 | int8_t *cp;
|
---|
95 | int8_t tlist[130];
|
---|
96 |
|
---|
97 | static int8_t list[] = "ABCDEFabcdef9876543210";
|
---|
98 |
|
---|
99 | static int8_t vals[] = {
|
---|
100 |
|
---|
101 | 10,11,12,13,14,15,10,11,12,13,14,15,9,8,7,6,5,4,3,2,1,0
|
---|
102 | };
|
---|
103 |
|
---|
104 |
|
---|
105 | count = 0;
|
---|
106 | gsub = getsub;
|
---|
107 |
|
---|
108 | while ((c = *fmt++)) {
|
---|
109 |
|
---|
110 | if (c EQ '%') {
|
---|
111 |
|
---|
112 | lflag = dontdo = FALSE;
|
---|
113 | maxwide = 127;
|
---|
114 |
|
---|
115 | if (*fmt EQ '*') {
|
---|
116 | ++fmt;
|
---|
117 | dontdo = 1;
|
---|
118 | }
|
---|
119 |
|
---|
120 | if (isdigit(*fmt)) {
|
---|
121 |
|
---|
122 | maxwide = 0;
|
---|
123 |
|
---|
124 | do {
|
---|
125 |
|
---|
126 | maxwide = maxwide*10 + *fmt - '0';
|
---|
127 |
|
---|
128 | } while (isdigit(*++fmt));
|
---|
129 | }
|
---|
130 |
|
---|
131 | if (*fmt EQ 'l') {
|
---|
132 |
|
---|
133 | lflag = TRUE;
|
---|
134 | ++fmt;
|
---|
135 | }
|
---|
136 |
|
---|
137 |
|
---|
138 | switch (*fmt++) {
|
---|
139 |
|
---|
140 | case '%':
|
---|
141 | c = '%';
|
---|
142 | goto matchit;
|
---|
143 |
|
---|
144 | case 'h': /* specify short (for compatibility) */
|
---|
145 | lflag = FALSE;
|
---|
146 | goto decimal;
|
---|
147 |
|
---|
148 | case 'D':
|
---|
149 | lflag = TRUE;
|
---|
150 | /* fall through */
|
---|
151 |
|
---|
152 | case 'd':
|
---|
153 | decimal:
|
---|
154 | c = 12;
|
---|
155 | base = 10;
|
---|
156 | goto getval;
|
---|
157 |
|
---|
158 | case 'X':
|
---|
159 | lflag = TRUE;
|
---|
160 | /* fall through */
|
---|
161 |
|
---|
162 | case 'x':
|
---|
163 | c = 0;
|
---|
164 | base = 16;
|
---|
165 | goto getval;
|
---|
166 |
|
---|
167 | case 'O':
|
---|
168 | lflag = TRUE;
|
---|
169 | /* fall through */
|
---|
170 |
|
---|
171 | case 'o':
|
---|
172 | c = 14;
|
---|
173 | base = 8;
|
---|
174 | getval:
|
---|
175 | if (skipblk())
|
---|
176 | goto ateof;
|
---|
177 |
|
---|
178 | lv = getnum(&list[c], &vals[c], base);
|
---|
179 |
|
---|
180 | if (!dontdo) {
|
---|
181 |
|
---|
182 | if (lflag)
|
---|
183 | *(int32_t *)(*args++) = lv;
|
---|
184 | else
|
---|
185 | **args++ = (int16_t)lv;
|
---|
186 | ++count;
|
---|
187 | }
|
---|
188 |
|
---|
189 | break;
|
---|
190 |
|
---|
191 | #ifdef FLOAT
|
---|
192 | case 'E':
|
---|
193 | case 'F':
|
---|
194 | lflag = TRUE;
|
---|
195 |
|
---|
196 | case 'e':
|
---|
197 | case 'f':
|
---|
198 | if (skipblk())
|
---|
199 | goto ateof;
|
---|
200 |
|
---|
201 | d = getflt(tlist);
|
---|
202 |
|
---|
203 | if (!dontdo) {
|
---|
204 |
|
---|
205 | if (lflag)
|
---|
206 | *(double *)(*args++) = d;
|
---|
207 | else
|
---|
208 | *(float *)(*args++) = d;
|
---|
209 | ++count;
|
---|
210 | }
|
---|
211 |
|
---|
212 | break;
|
---|
213 | #endif
|
---|
214 |
|
---|
215 | case '[':
|
---|
216 | lflag = FALSE;
|
---|
217 |
|
---|
218 | if (*fmt EQ '^' || *fmt EQ '~') {
|
---|
219 |
|
---|
220 | ++fmt;
|
---|
221 | lflag = TRUE;
|
---|
222 | }
|
---|
223 |
|
---|
224 | for (cp = tlist ; (c = *fmt++) != ']' ; )
|
---|
225 | *cp++ = (int8_t)c;
|
---|
226 |
|
---|
227 | *cp = 0;
|
---|
228 | goto string;
|
---|
229 |
|
---|
230 | case 's':
|
---|
231 | lflag = TRUE;
|
---|
232 | tlist[0] = ' ';
|
---|
233 | tlist[1] = '\t';
|
---|
234 | tlist[2] = '\n';
|
---|
235 | tlist[3] = 0;
|
---|
236 | string:
|
---|
237 | if (skipblk())
|
---|
238 | goto ateof;
|
---|
239 |
|
---|
240 | if (!dontdo)
|
---|
241 | cp = (int8_t *)*args++;
|
---|
242 | else
|
---|
243 | cp = NULL; /* fix compiler warning */
|
---|
244 |
|
---|
245 | while (maxwide--) {
|
---|
246 |
|
---|
247 | if ((c = (*gsub)(0)) EQ EOF)
|
---|
248 | break;
|
---|
249 |
|
---|
250 | if (lflag ?
|
---|
251 | (index(tlist, (int8_t)c) NE 0) :
|
---|
252 | (index(tlist, (int8_t)c) EQ 0)) {
|
---|
253 |
|
---|
254 | (*gsub)(1); /* unget last character */
|
---|
255 | break;
|
---|
256 | }
|
---|
257 |
|
---|
258 | if (!dontdo)
|
---|
259 | *cp++ = (int8_t)c;
|
---|
260 | }
|
---|
261 |
|
---|
262 | if (!dontdo) {
|
---|
263 |
|
---|
264 | *cp = 0;
|
---|
265 | ++count;
|
---|
266 | }
|
---|
267 |
|
---|
268 | break;
|
---|
269 |
|
---|
270 | case 'c':
|
---|
271 | if ((c = (*gsub)(0)) EQ EOF)
|
---|
272 | goto ateof;
|
---|
273 |
|
---|
274 | if (!dontdo) {
|
---|
275 |
|
---|
276 | *(int8_t *)(*args++) = (int8_t)c;
|
---|
277 | ++count;
|
---|
278 | }
|
---|
279 |
|
---|
280 | break;
|
---|
281 | }
|
---|
282 |
|
---|
283 | } else if (isspace(c)) {
|
---|
284 |
|
---|
285 | if (skipblk()) {
|
---|
286 | ateof:
|
---|
287 | if (count EQ 0)
|
---|
288 | return(EOF);
|
---|
289 |
|
---|
290 | return(count);
|
---|
291 | }
|
---|
292 |
|
---|
293 | } else {
|
---|
294 |
|
---|
295 | matchit:
|
---|
296 | if (skipblk())
|
---|
297 | goto ateof;
|
---|
298 |
|
---|
299 | if ((*gsub)(0) != c)
|
---|
300 | return(count);
|
---|
301 | }
|
---|
302 | }
|
---|
303 |
|
---|
304 | return(count);
|
---|
305 | }
|
---|
306 |
|
---|
307 | #ifdef FLOAT
|
---|
308 |
|
---|
309 | double
|
---|
310 | getflt(buffer)
|
---|
311 | char *buffer;
|
---|
312 | {
|
---|
313 | register int c;
|
---|
314 | char decpt, sign, exp;
|
---|
315 | register char *cp;
|
---|
316 | double atof();
|
---|
317 |
|
---|
318 | cp = buffer;
|
---|
319 | sign = exp = decpt = 0;
|
---|
320 |
|
---|
321 | while (maxwide--) {
|
---|
322 |
|
---|
323 | c = (*gsub)(0);
|
---|
324 |
|
---|
325 | if (!sign AND (c EQ '-' OR c EQ '+'))
|
---|
326 | sign = 1;
|
---|
327 | else if (!decpt AND c EQ '.')
|
---|
328 | decpt = 1;
|
---|
329 | else if (!exp AND (c EQ 'e' OR c EQ 'E')) {
|
---|
330 |
|
---|
331 | sign = 0;
|
---|
332 | exp = decpt = 1;
|
---|
333 |
|
---|
334 | } else if (!isdigit(c)) {
|
---|
335 |
|
---|
336 | (*gsub)(1);
|
---|
337 | break;
|
---|
338 | }
|
---|
339 |
|
---|
340 | *cp++ = c;
|
---|
341 | }
|
---|
342 |
|
---|
343 | *cp = 0;
|
---|
344 | return(atof(buffer));
|
---|
345 | }
|
---|
346 |
|
---|
347 | #endif
|
---|
348 |
|
---|
349 | int16_t sscanf(int8_t *string, int8_t *fmt, int16_t *args)
|
---|
350 | {
|
---|
351 | scnstr = string;
|
---|
352 | quit = FALSE;
|
---|
353 | return(scanfmt(sgetc, fmt, &args));
|
---|
354 | }
|
---|
355 |
|
---|
356 |
|
---|