source: mainline/kernel/generic/src/printf/printf_core.c@ 58d5a7e7

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 58d5a7e7 was 58d5a7e7, checked in by Jiri Svoboda <jirik.svoboda@…>, 16 years ago

Partial conversion of prinf_core.c
  • Property mode set to 100644
File size: 22.0 KB
Line 
1/*
2 * Copyright (c) 2001-2004 Jakub Jermar
3 * Copyright (c) 2006 Josef Cejka
4 * Copyright (c) 2009 Martin Decky
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 *
11 * - Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * - Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * - The name of the author may not be used to endorse or promote products
17 * derived from this software without specific prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
24 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
26 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
28 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 */
30
31/** @addtogroup generic
32 * @{
33 */
34/**
35 * @file
36 * @brief Printing functions.
37 */
38
39#include <printf/printf_core.h>
40#include <print.h>
41#include <arch/arg.h>
42#include <macros.h>
43#include <string.h>
44#include <arch.h>
45
46/** show prefixes 0x or 0 */
47#define __PRINTF_FLAG_PREFIX 0x00000001
48/** signed / unsigned number */
49#define __PRINTF_FLAG_SIGNED 0x00000002
50/** print leading zeroes */
51#define __PRINTF_FLAG_ZEROPADDED 0x00000004
52/** align to left */
53#define __PRINTF_FLAG_LEFTALIGNED 0x00000010
54/** always show + sign */
55#define __PRINTF_FLAG_SHOWPLUS 0x00000020
56/** print space instead of plus */
57#define __PRINTF_FLAG_SPACESIGN 0x00000040
58/** show big characters */
59#define __PRINTF_FLAG_BIGCHARS 0x00000080
60/** number has - sign */
61#define __PRINTF_FLAG_NEGATIVE 0x00000100
62
63/**
64 * Buffer big enough for 64-bit number printed in base 2, sign, prefix and 0
65 * to terminate string... (last one is only for better testing end of buffer by
66 * zero-filling subroutine)
67 */
68#define PRINT_NUMBER_BUFFER_SIZE (64 + 5)
69
70/** Enumeration of possible arguments types.
71 */
72typedef enum {
73 PrintfQualifierByte = 0,
74 PrintfQualifierShort,
75 PrintfQualifierInt,
76 PrintfQualifierLong,
77 PrintfQualifierLongLong,
78 PrintfQualifierPointer
79} qualifier_t;
80
81static char nullstr[] = "(NULL)";
82static char digits_small[] = "0123456789abcdef";
83static char digits_big[] = "0123456789ABCDEF";
84
85/** Print one or more UTF-8 characters without adding newline.
86 *
87 * @param buf Buffer holding UTF-8 characters with size of
88 * at least size bytes. NULL is not allowed!
89 * @param size Size of the buffer in bytes.
90 * @param ps Output method and its data.
91 *
92 * @return Number of UTF-8 characters printed.
93 *
94 */
95static int printf_putnchars_utf8(const char *buf, size_t size,
96 printf_spec_t *ps)
97{
98 return ps->write_utf8((void *) buf, size, ps->data);
99}
100
101/** Print one or more UTF-32 characters without adding newline.
102 *
103 * @param buf Buffer holding UTF-32 characters with size of
104 * at least size bytes. NULL is not allowed!
105 * @param size Size of the buffer in bytes.
106 * @param ps Output method and its data.
107 *
108 * @return Number of UTF-32 characters printed.
109 *
110 */
111static int printf_putnchars_utf32(const wchar_t *buf, size_t size,
112 printf_spec_t *ps)
113{
114 return ps->write_utf32((void *) buf, size, ps->data);
115}
116
117/** Print string without adding newline.
118 *
119 * @param str String to print.
120 * @param ps Write function specification and support data.
121 *
122 * @return Number of characters printed.
123 *
124 */
125static int printf_putstr(const char *str, printf_spec_t *ps)
126{
127 if (str == NULL)
128 return printf_putnchars_utf8(nullstr, str_size(nullstr), ps);
129
130 return ps->write_utf8((void *) str, str_size(str), ps->data);
131}
132
133/** Print one ASCII character.
134 *
135 * @param c ASCII character to be printed.
136 * @param ps Output method.
137 *
138 * @return Number of characters printed.
139 *
140 */
141static int printf_putchar(const char ch, printf_spec_t *ps)
142{
143 if (!ascii_check(ch))
144 return ps->write_utf8((void *) &invalch, 1, ps->data);
145
146 return ps->write_utf8(&ch, 1, ps->data);
147}
148
149/** Print one UTF-32 character.
150 *
151 * @param c UTF-32 character to be printed.
152 * @param ps Output method.
153 *
154 * @return Number of characters printed.
155 *
156 */
157static int printf_putwchar(const wchar_t ch, printf_spec_t *ps)
158{
159 if (!unicode_check(ch))
160 return ps->write_utf8((void *) &invalch, 1, ps->data);
161
162 return ps->write_utf32(&ch, sizeof(wchar_t), ps->data);
163}
164
165/** Print one formatted ASCII character.
166 *
167 * @param ch Character to print.
168 * @param width Width modifier.
169 * @param flags Flags that change the way the character is printed.
170 *
171 * @return Number of characters printed, negative value on failure.
172 *
173 */
174static int print_char(const char ch, int width, uint32_t flags, printf_spec_t *ps)
175{
176 count_t counter = 0;
177 if (!(flags & __PRINTF_FLAG_LEFTALIGNED)) {
178 while (--width > 0) {
179 /*
180 * One space is consumed by the character itself, hence
181 * the predecrement.
182 */
183 if (printf_putchar(' ', ps) > 0)
184 counter++;
185 }
186 }
187
188 if (printf_putchar(ch, ps) > 0)
189 counter++;
190
191 while (--width > 0) {
192 /*
193 * One space is consumed by the character itself, hence
194 * the predecrement.
195 */
196 if (printf_putchar(' ', ps) > 0)
197 counter++;
198 }
199
200 return (int) (counter + 1);
201}
202
203/** Print one formatted UTF-32 character.
204 *
205 * @param ch Character to print.
206 * @param width Width modifier.
207 * @param flags Flags that change the way the character is printed.
208 *
209 * @return Number of characters printed, negative value on failure.
210 *
211 */
212static int print_wchar(const wchar_t ch, int width, uint32_t flags, printf_spec_t *ps)
213{
214 count_t counter = 0;
215 if (!(flags & __PRINTF_FLAG_LEFTALIGNED)) {
216 while (--width > 0) {
217 /*
218 * One space is consumed by the character itself, hence
219 * the predecrement.
220 */
221 if (printf_putchar(' ', ps) > 0)
222 counter++;
223 }
224 }
225
226 if (printf_putwchar(ch, ps) > 0)
227 counter++;
228
229 while (--width > 0) {
230 /*
231 * One space is consumed by the character itself, hence
232 * the predecrement.
233 */
234 if (printf_putchar(' ', ps) > 0)
235 counter++;
236 }
237
238 return (int) (counter + 1);
239}
240
241/** Format and print a string.
242 *
243 * @param str String to be printed.
244 * @param width Width modifier.
245 * @param precision Precision modifier.
246 * @param flags Flags that modify the way the string is printed.
247 *
248 * @return Number of characters printed, negative value on failure.
249 */
250static int print_str(char *str, int width, unsigned int precision,
251 uint32_t flags, printf_spec_t *ps)
252{
253 if (str == NULL)
254 return printf_putstr(nullstr, ps);
255
256 /* Print leading spaces. */
257 count_t strw = str_length(str);
258 if (precision == 0)
259 precision = strw;
260
261 /* Left padding */
262 count_t counter = 0;
263 width -= precision;
264 if (!(flags & __PRINTF_FLAG_LEFTALIGNED)) {
265 while (width-- > 0) {
266 if (printf_putchar(' ', ps) == 1)
267 counter++;
268 }
269 }
270
271 /* Part of @a str fitting into the alloted space. */
272 int retval;
273 size_t size = str_wsize(str, precision);
274 if ((retval = printf_putnchars_utf8(str, size, ps)) < 0)
275 return -counter;
276
277 counter += retval;
278
279 /* Right padding */
280 while (width-- > 0) {
281 if (printf_putchar(' ', ps) == 1)
282 counter++;
283 }
284
285 return ((int) counter);
286
287}
288
289/** Format and print a wide string.
290 *
291 * @param wstr Wide string to be printed.
292 * @param width Width modifier.
293 * @param precision Precision modifier.
294 * @param flags Flags that modify the way the string is printed.
295 *
296 * @return Number of characters printed, negative value
297 * on failure.
298 */
299static int print_wstr(wchar_t *wstr, int width, unsigned int precision,
300 uint32_t flags, printf_spec_t *ps)
301{
302 if (wstr == NULL)
303 return printf_putstr(nullstr, ps);
304
305 /* Print leading spaces. */
306 size_t strw = wstr_length(wstr);
307 if (precision == 0)
308 precision = strw;
309
310 /* Left padding */
311 count_t counter = 0;
312 width -= precision;
313 if (!(flags & __PRINTF_FLAG_LEFTALIGNED)) {
314 while (width-- > 0) {
315 if (printf_putchar(' ', ps) == 1)
316 counter++;
317 }
318 }
319
320 /* Part of @a wstr fitting into the alloted space. */
321 int retval;
322 size_t size = wstr_wlength(wstr, precision) * sizeof(wchar_t);
323 if ((retval = printf_putnchars_utf32(wstr, size, ps)) < 0)
324 return -counter;
325
326 counter += retval;
327
328 /* Right padding */
329 while (width-- > 0) {
330 if (printf_putchar(' ', ps) == 1)
331 counter++;
332 }
333
334 return ((int) counter);
335}
336
337/** Print a number in a given base.
338 *
339 * Print significant digits of a number in given base.
340 *
341 * @param num Number to print.
342 * @param width Width modifier.
343 * @param precision Precision modifier.
344 * @param base Base to print the number in (must be between 2 and 16).
345 * @param flags Flags that modify the way the number is printed.
346 *
347 * @return Number of characters printed.
348 *
349 */
350static int print_number(uint64_t num, int width, int precision, int base,
351 uint32_t flags, printf_spec_t *ps)
352{
353 char *digits;
354 if (flags & __PRINTF_FLAG_BIGCHARS)
355 digits = digits_big;
356 else
357 digits = digits_small;
358
359 char data[PRINT_NUMBER_BUFFER_SIZE];
360 char *ptr = &data[PRINT_NUMBER_BUFFER_SIZE - 1];
361
362 /* Size of number with all prefixes and signs */
363 int size = 0;
364
365 /* Put zero at end of string */
366 *ptr-- = 0;
367
368 if (num == 0) {
369 *ptr-- = '0';
370 size++;
371 } else {
372 do {
373 *ptr-- = digits[num % base];
374 size++;
375 } while (num /= base);
376 }
377
378 /* Size of plain number */
379 int number_size = size;
380
381 /*
382 * Collect the sum of all prefixes/signs/etc. to calculate padding and
383 * leading zeroes.
384 */
385 if (flags & __PRINTF_FLAG_PREFIX) {
386 switch(base) {
387 case 2:
388 /* Binary formating is not standard, but usefull */
389 size += 2;
390 break;
391 case 8:
392 size++;
393 break;
394 case 16:
395 size += 2;
396 break;
397 }
398 }
399
400 char sgn = 0;
401 if (flags & __PRINTF_FLAG_SIGNED) {
402 if (flags & __PRINTF_FLAG_NEGATIVE) {
403 sgn = '-';
404 size++;
405 } else if (flags & __PRINTF_FLAG_SHOWPLUS) {
406 sgn = '+';
407 size++;
408 } else if (flags & __PRINTF_FLAG_SPACESIGN) {
409 sgn = ' ';
410 size++;
411 }
412 }
413
414 if (flags & __PRINTF_FLAG_LEFTALIGNED)
415 flags &= ~__PRINTF_FLAG_ZEROPADDED;
416
417 /*
418 * If the number is left-aligned or precision is specified then
419 * padding with zeros is ignored.
420 */
421 if (flags & __PRINTF_FLAG_ZEROPADDED) {
422 if ((precision == 0) && (width > size))
423 precision = width - size + number_size;
424 }
425
426 /* Print leading spaces. */
427 if (number_size > precision) {
428 /* Print the whole number, not only a part. */
429 precision = number_size;
430 }
431
432 width -= precision + size - number_size;
433 count_t counter = 0;
434
435 if (!(flags & __PRINTF_FLAG_LEFTALIGNED)) {
436 while (width-- > 0) {
437 if (printf_putchar(' ', ps) == 1)
438 counter++;
439 }
440 }
441
442 /* Print sign. */
443 if (sgn) {
444 if (printf_putchar(sgn, ps) == 1)
445 counter++;
446 }
447
448 /* Print prefix. */
449 if (flags & __PRINTF_FLAG_PREFIX) {
450 switch(base) {
451 case 2:
452 /* Binary formating is not standard, but usefull */
453 if (printf_putchar('0', ps) == 1)
454 counter++;
455 if (flags & __PRINTF_FLAG_BIGCHARS) {
456 if (printf_putchar('B', ps) == 1)
457 counter++;
458 } else {
459 if (printf_putchar('b', ps) == 1)
460 counter++;
461 }
462 break;
463 case 8:
464 if (printf_putchar('o', ps) == 1)
465 counter++;
466 break;
467 case 16:
468 if (printf_putchar('0', ps) == 1)
469 counter++;
470 if (flags & __PRINTF_FLAG_BIGCHARS) {
471 if (printf_putchar('X', ps) == 1)
472 counter++;
473 } else {
474 if (printf_putchar('x', ps) == 1)
475 counter++;
476 }
477 break;
478 }
479 }
480
481 /* Print leading zeroes. */
482 precision -= number_size;
483 while (precision-- > 0) {
484 if (printf_putchar('0', ps) == 1)
485 counter++;
486 }
487
488 /* Print the number itself. */
489 int retval;
490 if ((retval = printf_putstr(++ptr, ps)) > 0)
491 counter += retval;
492
493 /* Print tailing spaces. */
494
495 while (width-- > 0) {
496 if (printf_putchar(' ', ps) == 1)
497 counter++;
498 }
499
500 return ((int) counter);
501}
502
503/** Print formatted string.
504 *
505 * Print string formatted according to the fmt parameter and variadic arguments.
506 * Each formatting directive must have the following form:
507 *
508 * \% [ FLAGS ] [ WIDTH ] [ .PRECISION ] [ TYPE ] CONVERSION
509 *
510 * FLAGS:@n
511 * - "#" Force to print prefix. For \%o conversion, the prefix is 0, for
512 * \%x and \%X prefixes are 0x and 0X and for conversion \%b the
513 * prefix is 0b.
514 *
515 * - "-" Align to left.
516 *
517 * - "+" Print positive sign just as negative.
518 *
519 * - " " If the printed number is positive and "+" flag is not set,
520 * print space in place of sign.
521 *
522 * - "0" Print 0 as padding instead of spaces. Zeroes are placed between
523 * sign and the rest of the number. This flag is ignored if "-"
524 * flag is specified.
525 *
526 * WIDTH:@n
527 * - Specify the minimal width of a printed argument. If it is bigger,
528 * width is ignored. If width is specified with a "*" character instead of
529 * number, width is taken from parameter list. And integer parameter is
530 * expected before parameter for processed conversion specification. If
531 * this value is negative its absolute value is taken and the "-" flag is
532 * set.
533 *
534 * PRECISION:@n
535 * - Value precision. For numbers it specifies minimum valid numbers.
536 * Smaller numbers are printed with leading zeroes. Bigger numbers are not
537 * affected. Strings with more than precision characters are cut off. Just
538 * as with width, an "*" can be used used instead of a number. An integer
539 * value is then expected in parameters. When both width and precision are
540 * specified using "*", the first parameter is used for width and the
541 * second one for precision.
542 *
543 * TYPE:@n
544 * - "hh" Signed or unsigned char.@n
545 * - "h" Signed or unsigned short.@n
546 * - "" Signed or unsigned int (default value).@n
547 * - "l" Signed or unsigned long int.@n
548 * If conversion is "c", the character is wchar_t (UTF-32).@n
549 * If conversion is "s", the string is wchar_t * (UTF-32).@n
550 * - "ll" Signed or unsigned long long int.@n
551 *
552 * CONVERSION:@n
553 * - % Print percentile character itself.
554 *
555 * - c Print single character. The character is expected to be plain
556 * ASCII (e.g. only values 0 .. 127 are valid).@n
557 * If type is "l", then the character is expected to be UTF-32
558 * (e.g. values 0 .. 0x10ffff are valid).
559 *
560 * - s Print zero terminated string. If a NULL value is passed as
561 * value, "(NULL)" is printed instead.@n
562 * The string is expected to be correctly encoded UTF-8 (or plain
563 * ASCII, which is a subset of UTF-8).@n
564 * If type is "l", then the string is expected to be correctly
565 * encoded UTF-32.
566 *
567 * - P, p Print value of a pointer. Void * value is expected and it is
568 * printed in hexadecimal notation with prefix (as with \%#X / \%#x
569 * for 32-bit or \%#X / \%#x for 64-bit long pointers).
570 *
571 * - b Print value as unsigned binary number. Prefix is not printed by
572 * default. (Nonstandard extension.)
573 *
574 * - o Print value as unsigned octal number. Prefix is not printed by
575 * default.
576 *
577 * - d, i Print signed decimal number. There is no difference between d
578 * and i conversion.
579 *
580 * - u Print unsigned decimal number.
581 *
582 * - X, x Print hexadecimal number with upper- or lower-case. Prefix is
583 * not printed by default.
584 *
585 * All other characters from fmt except the formatting directives are printed
586 * verbatim.
587 *
588 * @param fmt Format string.
589 * @return Number of characters printed, negative value on failure.
590 *
591 */
592int printf_core(const char *fmt, printf_spec_t *ps, va_list ap)
593{
594 size_t i = 0; /* Index of the currently processed character from fmt */
595 size_t nxt = 0;
596 size_t j = 0; /* Index to the first not printed nonformating character */
597
598 wchar_t uc; /* Current character decoded from fmt */
599 count_t counter = 0; /* Number of characters printed */
600 int retval; /* Return values from nested functions */
601
602 while (true) {
603 i = nxt;
604 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
605
606 if (uc == '\0') break;
607
608 /* Control character */
609 if (uc == '%') {
610 /* Print common characters if any processed */
611 if (i > j) {
612 if ((retval = printf_putnchars_utf8(&fmt[j], i - j, ps)) < 0) {
613 /* Error */
614 counter = -counter;
615 goto out;
616 }
617 counter += retval;
618 }
619
620 j = i;
621
622 /* Parse modifiers */
623 uint32_t flags = 0;
624 bool end = false;
625
626 do {
627 i = nxt;
628 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
629 switch (uc) {
630 case '#':
631 flags |= __PRINTF_FLAG_PREFIX;
632 break;
633 case '-':
634 flags |= __PRINTF_FLAG_LEFTALIGNED;
635 break;
636 case '+':
637 flags |= __PRINTF_FLAG_SHOWPLUS;
638 break;
639 case ' ':
640 flags |= __PRINTF_FLAG_SPACESIGN;
641 break;
642 case '0':
643 flags |= __PRINTF_FLAG_ZEROPADDED;
644 break;
645 default:
646 end = true;
647 };
648 } while (!end);
649
650 /* Width & '*' operator */
651 int width = 0;
652 if (isdigit(uc)) {
653 while (true) {
654 width *= 10;
655 width += uc - '0';
656
657 i = nxt;
658 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
659 if (uc == '\0')
660 break;
661 if (!isdigit(uc))
662 break;
663 }
664 } else if (uc == '*') {
665 /* Get width value from argument list */
666 i = nxt;
667 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
668 width = (int) va_arg(ap, int);
669 if (width < 0) {
670 /* Negative width sets '-' flag */
671 width *= -1;
672 flags |= __PRINTF_FLAG_LEFTALIGNED;
673 }
674 }
675
676 /* Precision and '*' operator */
677 int precision = 0;
678 if (uc == '.') {
679 i = nxt;
680 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
681 if (isdigit(uc)) {
682 while (true) {
683 precision *= 10;
684 precision += uc - '0';
685
686 i = nxt;
687 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
688 if (uc == '\0')
689 break;
690 if (!isdigit(uc))
691 break;
692 }
693 } else if (uc == '*') {
694 /* Get precision value from the argument list */
695 i = nxt;
696 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
697 precision = (int) va_arg(ap, int);
698 if (precision < 0) {
699 /* Ignore negative precision */
700 precision = 0;
701 }
702 }
703 }
704
705 qualifier_t qualifier;
706
707 switch (uc) {
708 /** @todo Unimplemented qualifiers:
709 * t ptrdiff_t - ISO C 99
710 */
711 case 'h':
712 /* Char or short */
713 qualifier = PrintfQualifierShort;
714 i = nxt;
715 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
716 if (uc == 'h') {
717 i = nxt;
718 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
719 qualifier = PrintfQualifierByte;
720 }
721 break;
722 case 'l':
723 /* Long or long long */
724 qualifier = PrintfQualifierLong;
725 i = nxt;
726 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
727 if (uc == 'l') {
728 i = nxt;
729 uc = chr_decode(fmt, &nxt, UTF8_NO_LIMIT);
730 qualifier = PrintfQualifierLongLong;
731 }
732 break;
733 default:
734 /* Default type */
735 qualifier = PrintfQualifierInt;
736 }
737
738 unsigned int base = 10;
739
740 switch (uc) {
741 /*
742 * String and character conversions.
743 */
744 case 's':
745 if (qualifier == PrintfQualifierLong)
746 retval = print_wstr(va_arg(ap, wchar_t *), width, precision, flags, ps);
747 else
748 retval = print_str(va_arg(ap, char *), width, precision, flags, ps);
749
750 if (retval < 0) {
751 counter = -counter;
752 goto out;
753 }
754
755 counter += retval;
756 j = nxt;
757 goto next_char;
758 case 'c':
759 if (qualifier == PrintfQualifierLong)
760 retval = print_wchar(va_arg(ap, wchar_t), width, flags, ps);
761 else
762 retval = print_char(va_arg(ap, unsigned int), width, flags, ps);
763
764 if (retval < 0) {
765 counter = -counter;
766 goto out;
767 };
768
769 counter += retval;
770 j = nxt;
771 goto next_char;
772
773 /*
774 * Integer values
775 */
776 case 'P':
777 /* Pointer */
778 flags |= __PRINTF_FLAG_BIGCHARS;
779 case 'p':
780 flags |= __PRINTF_FLAG_PREFIX;
781 base = 16;
782 qualifier = PrintfQualifierPointer;
783 break;
784 case 'b':
785 base = 2;
786 break;
787 case 'o':
788 base = 8;
789 break;
790 case 'd':
791 case 'i':
792 flags |= __PRINTF_FLAG_SIGNED;
793 case 'u':
794 break;
795 case 'X':
796 flags |= __PRINTF_FLAG_BIGCHARS;
797 case 'x':
798 base = 16;
799 break;
800
801 /* Percentile itself */
802 case '%':
803 j = i;
804 goto next_char;
805
806 /*
807 * Bad formatting.
808 */
809 default:
810 /*
811 * Unknown format. Now, j is the index of '%'
812 * so we will print whole bad format sequence.
813 */
814 goto next_char;
815 }
816
817 /* Print integers */
818 size_t size;
819 uint64_t number;
820 switch (qualifier) {
821 case PrintfQualifierByte:
822 size = sizeof(unsigned char);
823 number = (uint64_t) va_arg(ap, unsigned int);
824 break;
825 case PrintfQualifierShort:
826 size = sizeof(unsigned short);
827 number = (uint64_t) va_arg(ap, unsigned int);
828 break;
829 case PrintfQualifierInt:
830 size = sizeof(unsigned int);
831 number = (uint64_t) va_arg(ap, unsigned int);
832 break;
833 case PrintfQualifierLong:
834 size = sizeof(unsigned long);
835 number = (uint64_t) va_arg(ap, unsigned long);
836 break;
837 case PrintfQualifierLongLong:
838 size = sizeof(unsigned long long);
839 number = (uint64_t) va_arg(ap, unsigned long long);
840 break;
841 case PrintfQualifierPointer:
842 size = sizeof(void *);
843 number = (uint64_t) (unsigned long) va_arg(ap, void *);
844 break;
845 default:
846 /* Unknown qualifier */
847 counter = -counter;
848 goto out;
849 }
850
851 if (flags & __PRINTF_FLAG_SIGNED) {
852 if (number & (0x1 << (size * 8 - 1))) {
853 flags |= __PRINTF_FLAG_NEGATIVE;
854
855 if (size == sizeof(uint64_t)) {
856 number = -((int64_t) number);
857 } else {
858 number = ~number;
859 number &=
860 ~(0xFFFFFFFFFFFFFFFFll <<
861 (size * 8));
862 number++;
863 }
864 }
865 }
866
867 if ((retval = print_number(number, width, precision,
868 base, flags, ps)) < 0) {
869 counter = -counter;
870 goto out;
871 }
872
873 counter += retval;
874 j = nxt;
875 }
876next_char:
877 ;
878 }
879
880 if (i > j) {
881 if ((retval = printf_putnchars_utf8(&fmt[j], i - j, ps)) < 0) {
882 /* Error */
883 counter = -counter;
884 goto out;
885 }
886 counter += retval;
887 }
888
889out:
890 return ((int) counter);
891}
892
893/** @}
894 */
Note: See TracBrowser for help on using the repository browser.