tparm.c revision 1.2 1 1.2 roy /* $NetBSD: tparm.c,v 1.2 2010/09/22 06:10:51 roy Exp $ */
2 1.1 roy
3 1.1 roy /*
4 1.1 roy * Copyright (c) 2009 The NetBSD Foundation, Inc.
5 1.1 roy *
6 1.1 roy * This code is derived from software contributed to The NetBSD Foundation
7 1.1 roy * by Roy Marples.
8 1.1 roy *
9 1.1 roy * Redistribution and use in source and binary forms, with or without
10 1.1 roy * modification, are permitted provided that the following conditions
11 1.1 roy * are met:
12 1.1 roy * 1. Redistributions of source code must retain the above copyright
13 1.1 roy * notice, this list of conditions and the following disclaimer.
14 1.1 roy * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 roy * notice, this list of conditions and the following disclaimer in the
16 1.1 roy * documentation and/or other materials provided with the distribution.
17 1.1 roy *
18 1.1 roy * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 1.1 roy * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 1.1 roy * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 1.1 roy * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 1.1 roy * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23 1.1 roy * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24 1.1 roy * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25 1.1 roy * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26 1.1 roy * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27 1.1 roy * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 1.1 roy */
29 1.1 roy
30 1.1 roy #include <sys/cdefs.h>
31 1.2 roy __RCSID("$NetBSD: tparm.c,v 1.2 2010/09/22 06:10:51 roy Exp $");
32 1.1 roy
33 1.1 roy #include <assert.h>
34 1.1 roy #include <ctype.h>
35 1.1 roy #include <errno.h>
36 1.1 roy #include <stdarg.h>
37 1.1 roy #include <stdio.h>
38 1.1 roy #include <stdlib.h>
39 1.1 roy #include <string.h>
40 1.1 roy #include <term_private.h>
41 1.1 roy #include <term.h>
42 1.1 roy
43 1.1 roy static TERMINAL *dumbterm; /* For non thread safe functions */
44 1.1 roy
45 1.2 roy typedef struct {
46 1.1 roy long nums[20];
47 1.1 roy char *strings[20];
48 1.1 roy size_t offset;
49 1.1 roy } TPSTACK;
50 1.1 roy
51 1.2 roy typedef struct {
52 1.1 roy long num;
53 1.1 roy char *string;
54 1.1 roy } TPVAR;
55 1.1 roy
56 1.1 roy static int
57 1.1 roy push(long num, char *string, TPSTACK *stack)
58 1.1 roy {
59 1.1 roy if (stack->offset > sizeof(stack->nums)) {
60 1.1 roy errno = E2BIG;
61 1.1 roy return -1;
62 1.1 roy }
63 1.1 roy stack->nums[stack->offset] = num;
64 1.1 roy stack->strings[stack->offset] = string;
65 1.1 roy stack->offset++;
66 1.1 roy return 0;
67 1.1 roy }
68 1.1 roy
69 1.1 roy static int
70 1.1 roy pop(long *num, char **string, TPSTACK *stack)
71 1.1 roy {
72 1.1 roy if (stack->offset == 0) {
73 1.1 roy errno = E2BIG;
74 1.1 roy return -1;
75 1.1 roy }
76 1.1 roy stack->offset--;
77 1.1 roy if (num)
78 1.1 roy *num = stack->nums[stack->offset];
79 1.1 roy if (string)
80 1.1 roy *string = stack->strings[stack->offset];
81 1.1 roy return 0;
82 1.1 roy }
83 1.1 roy
84 1.1 roy static char *
85 1.1 roy checkbuf(TERMINAL *term, size_t len)
86 1.1 roy {
87 1.1 roy char *buf;
88 1.1 roy
89 1.1 roy if (term->_bufpos + len >= term->_buflen) {
90 1.1 roy len = term->_buflen + BUFSIZ;
91 1.1 roy buf = realloc(term->_buf, len);
92 1.1 roy if (buf == NULL)
93 1.1 roy return 0;
94 1.1 roy term->_buf = buf;
95 1.1 roy term->_buflen = len;
96 1.1 roy }
97 1.1 roy return term->_buf;
98 1.1 roy }
99 1.1 roy
100 1.1 roy static size_t
101 1.1 roy ochar(TERMINAL *term, int c)
102 1.1 roy {
103 1.1 roy if (c == 0)
104 1.1 roy c = 0200;
105 1.1 roy /* Check we have space and a terminator */
106 1.1 roy if (checkbuf(term, 2) == NULL)
107 1.1 roy return 0;
108 1.1 roy term->_buf[term->_bufpos++] = (char)c;
109 1.1 roy return 1;
110 1.1 roy }
111 1.1 roy
112 1.1 roy static size_t
113 1.1 roy onum(TERMINAL *term, const char *fmt, long num, int len)
114 1.1 roy {
115 1.1 roy size_t l;
116 1.1 roy
117 1.1 roy /* Assume we never have natural number longer than 64 chars */
118 1.1 roy if (len < 64)
119 1.1 roy len = 64;
120 1.1 roy if (checkbuf(term, (size_t)len + 1) == NULL)
121 1.1 roy return 0;
122 1.1 roy l = sprintf(term->_buf + term->_bufpos, fmt, num);
123 1.1 roy term->_bufpos += l;
124 1.1 roy return l;
125 1.1 roy }
126 1.1 roy
127 1.1 roy static char *
128 1.1 roy _ti_vtparm(TERMINAL *term, const char *str, va_list parms)
129 1.1 roy {
130 1.1 roy const char *sp;
131 1.1 roy char c, fmt[64], *fp, *ostr;
132 1.1 roy long val, val2;
133 1.1 roy long dnums[26]; /* dynamic variables a-z, not preserved */
134 1.1 roy size_t l, max;
135 1.1 roy TPSTACK stack;
136 1.1 roy TPVAR params[9];
137 1.1 roy int done, dot, minus, width, precision, olen;
138 1.1 roy int piss[9]; /* Parameter IS String - piss ;) */
139 1.1 roy
140 1.1 roy if (str == NULL)
141 1.1 roy return NULL;
142 1.1 roy
143 1.1 roy /*
144 1.1 roy If not passed a terminal, malloc a dummy one.
145 1.1 roy This means we can preserve buffers and variables per terminal and
146 1.1 roy still work with non thread safe functions (which sadly are still the
147 1.1 roy norm and standard).
148 1.1 roy */
149 1.1 roy if (term == NULL) {
150 1.1 roy if (dumbterm == NULL) {
151 1.1 roy dumbterm = malloc(sizeof(*dumbterm));
152 1.1 roy if (dumbterm == NULL)
153 1.1 roy return NULL;
154 1.1 roy dumbterm->_buflen = 0;
155 1.1 roy }
156 1.1 roy term = dumbterm;
157 1.1 roy }
158 1.1 roy
159 1.1 roy term->_bufpos = 0;
160 1.1 roy /* Ensure we have an initial buffer */
161 1.1 roy if (term->_buflen == 0) {
162 1.1 roy term->_buf = malloc(BUFSIZ);
163 1.1 roy if (term->_buf == NULL)
164 1.1 roy return NULL;
165 1.1 roy term->_buflen = BUFSIZ;
166 1.1 roy }
167 1.1 roy
168 1.1 roy /*
169 1.1 roy Make a first pass through the string so we can work out
170 1.1 roy which parameters are longs and which are char *.
171 1.1 roy Basically we only use char * if %p[1-9] is followed by %l or %s.
172 1.1 roy */
173 1.1 roy memset(&piss, 0, sizeof(piss));
174 1.1 roy max = 0;
175 1.1 roy sp = str;
176 1.1 roy while ((c = *sp++) != '\0') {
177 1.1 roy if (c != '%')
178 1.1 roy continue;
179 1.1 roy c = *sp++;
180 1.1 roy if (c == '\0')
181 1.1 roy break;
182 1.1 roy if (c != 'p')
183 1.1 roy continue;
184 1.1 roy c = *sp++;
185 1.1 roy if (c < '1' || c > '9') {
186 1.1 roy errno = EINVAL;
187 1.1 roy return NULL;
188 1.1 roy }
189 1.1 roy l = c - '0';
190 1.1 roy if (l > max)
191 1.1 roy max = l;
192 1.1 roy if (*sp != '%')
193 1.1 roy continue;
194 1.1 roy /* Skip formatting */
195 1.1 roy sp++;
196 1.1 roy while (*sp == '.' || *sp == '#' || *sp == ' ' || *sp == ':' ||
197 1.1 roy *sp == '-' || isdigit((unsigned char)*sp))
198 1.1 roy sp++;
199 1.1 roy if (*sp == 'l' || *sp == 's')
200 1.1 roy piss[l - 1] = 1;
201 1.1 roy }
202 1.1 roy
203 1.1 roy /* Put our parameters into variables */
204 1.1 roy memset(¶ms, 0, sizeof(params));
205 1.1 roy for (l = 0; l < max; l++) {
206 1.1 roy if (piss[l] == 0)
207 1.1 roy params[l].num = va_arg(parms, long);
208 1.1 roy else
209 1.1 roy params[l].string = va_arg(parms, char *);
210 1.1 roy }
211 1.1 roy
212 1.1 roy term->_bufpos = 0;
213 1.1 roy memset(&stack, 0, sizeof(stack));
214 1.1 roy while ((c = *str++) != '\0') {
215 1.1 roy if (c != '%' || (c = *str++) == '%') {
216 1.1 roy if (c == '\0')
217 1.1 roy break;
218 1.1 roy if (ochar(term, c) == 0)
219 1.1 roy return NULL;
220 1.1 roy continue;
221 1.1 roy }
222 1.1 roy
223 1.1 roy /* Handle formatting. */
224 1.1 roy fp = fmt;
225 1.1 roy *fp++ = '%';
226 1.1 roy done = dot = minus = width = precision = 0;
227 1.1 roy val = 0;
228 1.1 roy while (done == 0 && (size_t)(fp - fmt) < sizeof(fmt)) {
229 1.1 roy switch (c) {
230 1.1 roy case 'c': /* FALLTHROUGH */
231 1.1 roy case 'd': /* FALLTHROUGH */
232 1.1 roy case 'o': /* FALLTHROUGH */
233 1.1 roy case 'x': /* FALLTHROUGH */
234 1.1 roy case 'X': /* FALLTHROUGH */
235 1.1 roy case 's':
236 1.1 roy *fp++ = c;
237 1.1 roy done = 1;
238 1.1 roy break;
239 1.1 roy case '#': /* FALLTHROUGH */
240 1.1 roy case ' ':
241 1.1 roy *fp++ = c;
242 1.1 roy break;
243 1.1 roy case '.':
244 1.1 roy *fp++ = c;
245 1.1 roy if (dot == 0) {
246 1.1 roy dot = 1;
247 1.1 roy width = val;
248 1.1 roy } else
249 1.1 roy done = 2;
250 1.1 roy val = 0;
251 1.1 roy break;
252 1.1 roy case ':':
253 1.1 roy minus = 1;
254 1.1 roy break;
255 1.1 roy case '-':
256 1.1 roy if (minus)
257 1.1 roy *fp++ = c;
258 1.1 roy else
259 1.1 roy done = 1;
260 1.1 roy break;
261 1.1 roy default:
262 1.1 roy if (isdigit((unsigned char)c)) {
263 1.1 roy val = (val * 10) + (c - '0');
264 1.1 roy if (val > 10000)
265 1.1 roy done = 2;
266 1.1 roy else
267 1.1 roy *fp++ = c;
268 1.1 roy } else
269 1.1 roy done = 1;
270 1.1 roy }
271 1.1 roy if (done == 0)
272 1.1 roy c = *str++;
273 1.1 roy }
274 1.1 roy if (done == 2) {
275 1.1 roy /* Found an error in the format */
276 1.1 roy fp = fmt + 1;
277 1.1 roy *fp = *str;
278 1.1 roy olen = 0;
279 1.1 roy } else {
280 1.1 roy if (dot == 0)
281 1.1 roy width = val;
282 1.1 roy else
283 1.1 roy precision = val;
284 1.1 roy olen = (width > precision) ? width : precision;
285 1.1 roy }
286 1.1 roy *fp++ = '\0';
287 1.1 roy
288 1.1 roy /* Handle commands */
289 1.1 roy switch (c) {
290 1.1 roy case 'c':
291 1.1 roy if (pop(&val, NULL, &stack))
292 1.1 roy return NULL;
293 1.1 roy if (ochar(term, (unsigned char)val) == 0)
294 1.1 roy return NULL;
295 1.1 roy break;
296 1.1 roy case 's':
297 1.1 roy if (pop(NULL, &ostr, &stack))
298 1.1 roy return NULL;
299 1.1 roy if (ostr != NULL) {
300 1.1 roy l = strlen(ostr);
301 1.1 roy if (l < (size_t)olen)
302 1.1 roy l = olen;
303 1.1 roy if (checkbuf(term, (size_t)(l + 1)) == NULL)
304 1.1 roy return NULL;
305 1.1 roy l = sprintf(term->_buf + term->_bufpos,
306 1.1 roy fmt, ostr);
307 1.1 roy term->_bufpos += l;
308 1.1 roy }
309 1.1 roy break;
310 1.1 roy case 'l':
311 1.1 roy if (pop(NULL, &ostr, &stack))
312 1.1 roy return NULL;
313 1.1 roy if (ostr == NULL)
314 1.1 roy l = 0;
315 1.1 roy else
316 1.1 roy l = strlen(ostr);
317 1.1 roy if (onum(term, "%d", (long)l, 0) == 0)
318 1.1 roy return NULL;
319 1.1 roy break;
320 1.1 roy case 'd': /* FALLTHROUGH */
321 1.1 roy case 'o': /* FALLTHROUGH */
322 1.1 roy case 'x': /* FALLTHROUGH */
323 1.1 roy case 'X':
324 1.1 roy if (pop(&val, NULL, &stack))
325 1.1 roy return NULL;
326 1.1 roy if (onum(term, fmt, val, olen) == 0)
327 1.1 roy return NULL;
328 1.1 roy break;
329 1.1 roy case 'p':
330 1.1 roy if (*str < '1' || *str > '9') {
331 1.1 roy errno = EINVAL;
332 1.1 roy return NULL;
333 1.1 roy }
334 1.1 roy l = *str++ - '1';
335 1.1 roy if (push(params[l].num, params[l].string, &stack))
336 1.1 roy return NULL;
337 1.1 roy break;
338 1.1 roy case 'P':
339 1.1 roy if (pop(&val, NULL, &stack))
340 1.1 roy return NULL;
341 1.1 roy str++;
342 1.1 roy if (*str >= 'a' && *str <= 'z')
343 1.1 roy dnums[*str - 'a'] = val;
344 1.1 roy else if (*str >= 'A' && *str <= 'Z')
345 1.1 roy term->_snums[*str - 'A'] = val;
346 1.1 roy break;
347 1.1 roy case 'g':
348 1.1 roy str++;
349 1.1 roy if (*str >= 'a' && *str <= 'z') {
350 1.1 roy if (push(dnums[*str - 'a'], NULL, &stack))
351 1.1 roy return NULL;
352 1.1 roy } else if (*str >= 'A' && *str <= 'Z') {
353 1.1 roy if (push(term->_snums[*str - 'A'],
354 1.1 roy NULL, &stack))
355 1.1 roy return NULL;
356 1.1 roy }
357 1.1 roy break;
358 1.1 roy case 'i':
359 1.1 roy if (piss[0] == 0)
360 1.1 roy params[0].num++;
361 1.1 roy if (piss[1] == 0)
362 1.1 roy params[1].num++;
363 1.1 roy break;
364 1.1 roy case '\'':
365 1.1 roy if (push((long)(unsigned char)*str++, NULL, &stack))
366 1.1 roy return NULL;
367 1.1 roy while (*str != '\0' && *str != '\'')
368 1.1 roy str++;
369 1.1 roy if (*str == '\'')
370 1.1 roy str++;
371 1.1 roy break;
372 1.1 roy case '{':
373 1.1 roy val = 0;
374 1.1 roy for (str++; isdigit((unsigned char)*str); str++)
375 1.1 roy val = (val * 10) + (*str - '0');
376 1.1 roy if (push(val, NULL, &stack))
377 1.1 roy return NULL;
378 1.1 roy while (*str != '\0' && *str != '}')
379 1.1 roy str++;
380 1.1 roy if (*str == '}')
381 1.1 roy str++;
382 1.1 roy break;
383 1.1 roy case '+': /* FALLTHROUGH */
384 1.1 roy case '-': /* FALLTHROUGH */
385 1.1 roy case '*': /* FALLTHROUGH */
386 1.1 roy case '/': /* FALLTHROUGH */
387 1.1 roy case 'm': /* FALLTHROUGH */
388 1.1 roy case 'A': /* FALLTHROUGH */
389 1.1 roy case 'O': /* FALLTHROUGH */
390 1.1 roy case '&': /* FALLTHROUGH */
391 1.1 roy case '|': /* FALLTHROUGH */
392 1.1 roy case '^': /* FALLTHROUGH */
393 1.1 roy case '=': /* FALLTHROUGH */
394 1.1 roy case '<': /* FALLTHROUGH */
395 1.1 roy case '>':
396 1.1 roy if (pop(&val, NULL, &stack) ||
397 1.1 roy pop(&val2, NULL, &stack))
398 1.1 roy return NULL;
399 1.1 roy switch (c) {
400 1.1 roy case '+':
401 1.1 roy val = val + val2;
402 1.1 roy break;
403 1.1 roy case '-':
404 1.1 roy val = val2 - val;
405 1.1 roy break;
406 1.1 roy case '*':
407 1.1 roy val = val * val2;
408 1.1 roy break;
409 1.1 roy case '/':
410 1.1 roy val = val ? val2 / val : 0;
411 1.1 roy break;
412 1.1 roy case 'm':
413 1.1 roy val = val ? val2 % val : 0;
414 1.1 roy break;
415 1.1 roy case 'A':
416 1.1 roy val = val && val2;
417 1.1 roy break;
418 1.1 roy case 'O':
419 1.1 roy val = val || val2;
420 1.1 roy break;
421 1.1 roy case '&':
422 1.1 roy val = val & val2;
423 1.1 roy break;
424 1.1 roy case '|':
425 1.1 roy val = val | val2;
426 1.1 roy break;
427 1.1 roy case '^':
428 1.1 roy val = val ^ val2;
429 1.1 roy break;
430 1.1 roy case '=':
431 1.1 roy val = val == val2;
432 1.1 roy break;
433 1.1 roy case '<':
434 1.1 roy val = val2 < val;
435 1.1 roy break;
436 1.1 roy case '>':
437 1.1 roy val = val2 > val;
438 1.1 roy break;
439 1.1 roy }
440 1.1 roy if (push(val, NULL, &stack))
441 1.1 roy return NULL;
442 1.1 roy break;
443 1.1 roy case '!':
444 1.1 roy case '~':
445 1.1 roy if (pop(&val, NULL, &stack))
446 1.1 roy return NULL;
447 1.1 roy switch (*str) {
448 1.1 roy case '!':
449 1.1 roy val = !val;
450 1.1 roy break;
451 1.1 roy case '~':
452 1.1 roy val = ~val;
453 1.1 roy break;
454 1.1 roy }
455 1.1 roy if (push(val, NULL, &stack))
456 1.1 roy return NULL;
457 1.1 roy break;
458 1.1 roy case '?': /* if */
459 1.1 roy break;
460 1.1 roy case 't': /* then */
461 1.1 roy if (pop(&val, NULL, &stack))
462 1.1 roy return NULL;
463 1.1 roy if (val != 0) {
464 1.1 roy l = 0;
465 1.1 roy for (; *str != '\0'; str++) {
466 1.1 roy if (*str != '%')
467 1.1 roy continue;
468 1.1 roy str++;
469 1.1 roy if (*str == '?')
470 1.1 roy l++;
471 1.1 roy else if (*str == ';') {
472 1.1 roy if (l > 0)
473 1.1 roy l--;
474 1.1 roy else
475 1.1 roy break;
476 1.1 roy } else if (*str == 'e' && l == 0)
477 1.1 roy break;
478 1.1 roy }
479 1.1 roy }
480 1.1 roy break;
481 1.1 roy case 'e': /* else */
482 1.1 roy l = 0;
483 1.1 roy for (; *str != '\0'; str++) {
484 1.1 roy if (*str != '%')
485 1.1 roy continue;
486 1.1 roy str++;
487 1.1 roy if (*str == '?')
488 1.1 roy l++;
489 1.1 roy else if (*str == ';') {
490 1.1 roy if (l > 0)
491 1.1 roy l--;
492 1.1 roy else
493 1.1 roy break;
494 1.1 roy }
495 1.1 roy }
496 1.1 roy break;
497 1.1 roy case ';': /* fi */
498 1.1 roy break;
499 1.1 roy }
500 1.1 roy }
501 1.1 roy term->_buf[term->_bufpos] = '\0';
502 1.1 roy return term->_buf;
503 1.1 roy }
504 1.1 roy
505 1.1 roy char *
506 1.1 roy t_vparm(TERMINAL *term, const char *str, ...)
507 1.1 roy {
508 1.1 roy va_list va;
509 1.1 roy char *ret;
510 1.1 roy
511 1.1 roy _DIAGASSERT(term != NULL);
512 1.1 roy _DIAGASSERT(str != NULL);
513 1.1 roy
514 1.1 roy va_start(va, str);
515 1.1 roy ret = _ti_vtparm(term, str, va);
516 1.1 roy va_end(va);
517 1.1 roy return ret;
518 1.1 roy }
519 1.1 roy
520 1.1 roy char *
521 1.1 roy vtparm(const char *str, ...)
522 1.1 roy {
523 1.1 roy va_list va;
524 1.1 roy char *ret;
525 1.1 roy
526 1.1 roy _DIAGASSERT(str != NULL);
527 1.1 roy
528 1.1 roy va_start(va, str);
529 1.1 roy ret = _ti_vtparm(NULL, str, va);
530 1.1 roy va_end(va);
531 1.1 roy return ret;
532 1.1 roy }
533 1.1 roy
534 1.1 roy char *
535 1.1 roy t_parm(TERMINAL *term, const char *str,
536 1.1 roy long p1, long p2, long p3, long p4, long p5,
537 1.1 roy long p6, long p7, long p8, long p9)
538 1.1 roy {
539 1.1 roy
540 1.1 roy _DIAGASSERT(term != NULL);
541 1.1 roy _DIAGASSERT(str != NULL);
542 1.1 roy return t_vparm(term, str, p1, p2, p3, p4, p5, p6, p7, p8, p9);
543 1.1 roy }
544 1.1 roy
545 1.1 roy char *
546 1.1 roy tparm(const char *str,
547 1.1 roy long p1, long p2, long p3, long p4, long p5,
548 1.1 roy long p6, long p7, long p8, long p9)
549 1.1 roy {
550 1.1 roy
551 1.1 roy _DIAGASSERT(str != NULL);
552 1.1 roy return t_vparm(NULL, str, p1, p2, p3, p4, p5, p6, p7, p8, p9);
553 1.1 roy }
554