1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87#include <common.h>
88#include <ctype.h>
89#include <errno.h>
90#include <stddef.h>
91#include <stdio.h>
92#include <stdlib.h>
93
94#define WANT_HEX_ESCAPES 0
95#define PRINT_CONVERSION_ERROR 1
96#define PRINT_TRUNCATED_ERROR 2
97#define PRINT_SIZE_ERROR 4
98
99struct print_inf {
100 char *str;
101 size_t size;
102 size_t offset;
103 unsigned int error;
104};
105
106typedef void (*converter)(const char *arg, void *result);
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123static void printf_str(struct print_inf *inf, char *format, ...)
124{
125 va_list args;
126 int i;
127
128 if (!inf)
129 return;
130
131
132 if (inf->error)
133 return;
134
135
136 if (inf->offset >= inf->size) {
137 inf->error |= PRINT_SIZE_ERROR;
138 return;
139 }
140
141 size_t remaining = inf->size - inf->offset;
142
143 va_start(args, format);
144 i = vsnprintf(inf->str + inf->offset, remaining, format, args);
145 va_end(args);
146
147 if (i >= remaining)
148 inf->error |= PRINT_TRUNCATED_ERROR;
149 else if (i < 0)
150 inf->error |= PRINT_CONVERSION_ERROR;
151 else
152 inf->offset += i;
153}
154
155
156
157
158
159
160
161
162
163
164static void putchar_str(struct print_inf *inf, char c)
165{
166 printf_str(inf, "%c", c);
167}
168
169static char process_escape_sequence(const char **ptr)
170{
171 const char *q;
172 unsigned int num_digits;
173 unsigned int n;
174 unsigned int base;
175
176 num_digits = 0;
177 n = 0;
178 base = 8;
179 q = *ptr;
180
181 if (WANT_HEX_ESCAPES && *q == 'x') {
182 ++q;
183 base = 16;
184 ++num_digits;
185 }
186
187
188
189
190
191 do {
192 unsigned int r;
193 unsigned int d = (unsigned char)(*q) - '0';
194#if WANT_HEX_ESCAPES
195 if (d >= 10) {
196 d = (unsigned char)tolower(*q) - 'a';
197
198
199
200
201
202 if ((int)d >= 0)
203 d += 10;
204 }
205#endif
206 if (d >= base) {
207 if (WANT_HEX_ESCAPES && base == 16) {
208 --num_digits;
209 if (num_digits == 0) {
210
211
212
213 return '\\';
214 }
215 }
216 break;
217 }
218
219 r = n * base + d;
220 if (r > 255)
221 break;
222
223 n = r;
224 ++q;
225 } while (++num_digits < 3);
226
227 if (num_digits == 0) {
228
229
230
231
232
233
234
235
236 static const char charmap[] = {
237 'a', 'b', 'e', 'f', 'n', 'r', 't', 'v', '\\', '\0',
238 '\a', '\b', 27, '\f', '\n', '\r', '\t', '\v', '\\', '\\',
239 };
240
241 const char *p = charmap;
242
243 do {
244 if (*p == *q) {
245 q++;
246 break;
247 }
248 } while (*++p != '\0');
249
250
251
252
253
254 n = p[sizeof(charmap) / 2];
255 }
256
257 *ptr = q;
258
259 return (char)n;
260}
261
262static char *skip_whitespace(const char *s)
263{
264
265
266
267
268
269
270 while (*s == ' ' || (unsigned char)(*s - 9) <= (13 - 9))
271 s++;
272
273 return (char *)s;
274}
275
276
277static void overlapping_strcpy(char *dst, const char *src)
278{
279
280
281
282 if (dst != src) {
283 while ((*dst = *src) != '\0') {
284 dst++;
285 src++;
286 }
287 }
288}
289
290static int multiconvert(const char *arg, void *result, converter convert)
291{
292 if (*arg == '"' || *arg == '\'')
293 sprintf((char *)arg + strlen(arg), "%u", (unsigned char)arg[1]);
294
295 convert(arg, result);
296
297
298
299
300
301
302
303
304 return 0;
305}
306
307static void conv_strtoull(const char *arg, void *result)
308{
309
310
311
312
313
314 if (arg[0] == '-') {
315 *(unsigned long long *)result = simple_strtoll(arg, NULL, 16);
316 return;
317 }
318
319
320
321
322 if (arg[0] == '+')
323 arg++;
324 *(unsigned long long *)result = simple_strtoull(arg, NULL, 16);
325}
326
327static void conv_strtoll(const char *arg, void *result)
328{
329 if (arg[0] == '+')
330 arg++;
331 *(long long *)result = simple_strtoll(arg, NULL, 16);
332}
333
334
335static unsigned long long my_xstrtoull(const char *arg)
336{
337 unsigned long long result;
338
339 if (multiconvert(arg, &result, conv_strtoull))
340 result = 0;
341 return result;
342}
343
344static long long my_xstrtoll(const char *arg)
345{
346 long long result;
347
348 if (multiconvert(arg, &result, conv_strtoll))
349 result = 0;
350 return result;
351}
352
353
354static int print_esc_string(struct print_inf *inf, const char *str)
355{
356 char c;
357
358 while ((c = *str) != '\0') {
359 str++;
360 if (c == '\\') {
361
362 if (*str == '0') {
363 if ((unsigned char)(str[1] - '0') < 8) {
364
365 str++;
366 }
367 } else if (*str == 'c') {
368 return 1;
369 }
370 {
371
372
373
374 const char *z = str;
375
376 c = process_escape_sequence(&z);
377 str = z;
378 }
379 }
380 putchar_str(inf, c);
381 }
382
383 return 0;
384}
385
386static void print_direc(struct print_inf *inf, char *format, unsigned int fmt_length,
387 int field_width, int precision,
388 const char *argument)
389{
390 long long llv;
391 char saved;
392 char *have_prec, *have_width;
393
394 saved = format[fmt_length];
395 format[fmt_length] = '\0';
396
397 have_prec = strstr(format, ".*");
398 have_width = strchr(format, '*');
399 if (have_width - 1 == have_prec)
400 have_width = NULL;
401
402
403 errno = 0;
404
405 switch (format[fmt_length - 1]) {
406 case 'c':
407 printf_str(inf, format, *argument);
408 break;
409 case 'd':
410 case 'i':
411 llv = my_xstrtoll(skip_whitespace(argument));
412 print_long:
413 if (!have_width) {
414 if (!have_prec)
415 printf_str(inf, format, llv);
416 else
417 printf_str(inf, format, precision, llv);
418 } else {
419 if (!have_prec)
420 printf_str(inf, format, field_width, llv);
421 else
422 printf_str(inf, format, field_width, precision, llv);
423 }
424 break;
425 case 'o':
426 case 'u':
427 case 'x':
428 case 'X':
429 llv = my_xstrtoull(skip_whitespace(argument));
430
431 goto print_long;
432 case 's':
433
434 if (sizeof(argument) == sizeof(llv)) {
435 llv = (long long)(ptrdiff_t)argument;
436 goto print_long;
437 } else {
438
439
440
441 if (!have_width) {
442 if (!have_prec)
443 printf_str(inf, format, argument,
444 argument, argument);
445 else
446 printf_str(inf, format, precision,
447 argument, argument);
448 } else {
449 if (!have_prec)
450 printf_str(inf, format, field_width,
451 argument, argument);
452 else
453 printf_str(inf, format, field_width,
454 precision, argument);
455 }
456 break;
457 }
458 break;
459 }
460
461 format[fmt_length] = saved;
462}
463
464
465static int get_width_prec(const char *str)
466{
467 long v = simple_strtol(str, NULL, 10);
468
469
470
471
472
473
474
475
476 return (int)v;
477}
478
479
480
481
482static char **print_formatted(struct print_inf *inf, char *f, char **argv, int *conv_err)
483{
484 char *direc_start;
485 unsigned int direc_length;
486 int field_width;
487 int precision;
488 char **saved_argv = argv;
489
490 for (; *f; ++f) {
491 switch (*f) {
492 case '%':
493 direc_start = f++;
494 direc_length = 1;
495 field_width = 0;
496 precision = 0;
497 if (*f == '%') {
498 putchar_str(inf, '%');
499 break;
500 }
501 if (*f == 'b') {
502 if (*argv) {
503 if (print_esc_string(inf, *argv))
504 return saved_argv;
505 ++argv;
506 }
507 break;
508 }
509 if (*f && strchr("-+ #", *f)) {
510 ++f;
511 ++direc_length;
512 }
513 if (*f == '*') {
514 ++f;
515 ++direc_length;
516 if (*argv)
517 field_width = get_width_prec(*argv++);
518 } else {
519 while (isdigit(*f)) {
520 ++f;
521 ++direc_length;
522 }
523 }
524 if (*f == '.') {
525 ++f;
526 ++direc_length;
527 if (*f == '*') {
528 ++f;
529 ++direc_length;
530 if (*argv)
531 precision = get_width_prec(*argv++);
532 } else {
533 while (isdigit(*f)) {
534 ++f;
535 ++direc_length;
536 }
537 }
538 }
539
540
541
542
543
544
545 while ((*f | 0x20) == 'l' || *f == 'h' || *f == 'z')
546 overlapping_strcpy(f, f + 1);
547
548 {
549 static const char format_chars[] = "diouxXcs";
550 char *p = strchr(format_chars, *f);
551
552 if (!p || *f == '\0') {
553 printf("`%s': invalid format\n", direc_start);
554
555 return saved_argv - 1;
556 }
557 ++direc_length;
558 if (p - format_chars <= 5) {
559
560 p = malloc(direc_length + 3);
561 if (!p) {
562
563 return saved_argv - 1;
564 }
565 memcpy(p, direc_start, direc_length);
566 p[direc_length + 1] = p[direc_length - 1];
567 p[direc_length - 1] = 'l';
568 p[direc_length] = 'l';
569
570 direc_length += 2;
571 direc_start = p;
572 } else {
573 p = NULL;
574 }
575 if (*argv) {
576 print_direc(inf, direc_start, direc_length,
577 field_width, precision, *argv++);
578 } else {
579 print_direc(inf, direc_start, direc_length,
580 field_width, precision, "");
581 }
582 *conv_err |= errno;
583 free(p);
584 }
585 break;
586 case '\\':
587 if (*++f == 'c')
588 return saved_argv;
589 putchar_str(inf, process_escape_sequence((const char **)&f));
590 f--;
591 break;
592 default:
593 putchar_str(inf, *f);
594 }
595 }
596
597 return argv;
598}
599
600
601
602
603
604
605
606
607
608
609
610
611
612int printf_setexpr(char *str, size_t size, int argc, char *const *argv)
613{
614 int conv_err;
615 char *format;
616 char **argv2;
617 struct print_inf inf = {
618 .str = str,
619 .size = size,
620 .offset = 0,
621 .error = 0,
622 };
623
624 if (!str || !size)
625 return 1;
626
627 inf.str[0] = '\0';
628
629 format = argv[0];
630 argv2 = (char **)argv + 1;
631
632 conv_err = 0;
633 argv = argv2;
634
635
636
637 argv2 = print_formatted(&inf, format, (char **)argv, &conv_err);
638
639
640
641
642
643
644 return (argv2 < argv) ||
645 conv_err ||
646 inf.error;
647}
648