Fix naming conventions.
[bertos.git] / mware / formatwr.c
1 /*!
2  * \file
3  * <!--
4  * Copyright 2003, 2004, 2005 Develer S.r.l. (http://www.develer.com/)
5  * This file is part of DevLib - See README.devlib for information.
6  * -->
7  *
8  * \version $Id$
9  *
10  * \brief Basic "printf", "sprintf" and "fprintf" formatter.
11  *
12  * This module is 100% reentrant and can be adapted to user-defined routines
13  * that needs formatters with special properties like different output
14  * channels or new format specifiers.
15  *
16  * To reduce size in applications not using real numbers or long integers
17  * the formatter may be compiled to exclude certain parts.  This is
18  * controlled by giving a -D option a compilation time:
19  *
20  * \code
21  *  -D CONFIG_PRINTF=PRINTF_FULL         Full ANSI printf formatter
22  *  -D CONFIG_PRINTF=PRINTF_NOFLOAT      Exclude support for floats
23  *  -D CONFIG_PRINTF=PRINTF_REDUCED      Simplified formatter (see below)
24  *  -D CONFIG_PRINTF=PRINTF_NOMODIFIERS  Exclude 'l' and 'h' modifiers in reduced version
25  *  -D CONFIG_PRINTF=PRINTF_DISABLED     No formatter at all
26  * \endcode
27  *
28  * Code size on AVR4 with GCC 3.4.1 (-O2):
29  *   PRINTF_FULL        2912byte (0xB60)
30  *   PRINTF_NOFLOAT     1684byte (0x694)
31  *   PRINTF_REDUCED      924byte (0x39C)
32  *   PRINTF_NOMODIFIERS  416byte (0x1A0)
33  *
34  * Code/data size in words on DSP56K with CodeWarrior 6.0:
35  *   PRINTF_FULL         1493/45
36  *   PRINTF_NOFLOAT      795/45
37  *   PRINTF_REDUCED      482/0
38  *   PRINTF_NOMODIFIERS  301/0
39  *
40  * The reduced version of formatter is suitable when program size is critical
41  * rather than formatting power.  This routine uses less than 20 bytes of
42  * stack space which makes it practical even in systems with less than 256
43  * bytes of user RAM.
44  *
45  * The only formatting specifiers supported by the reduced formatter are:
46  * \code
47  *    %% %c %s %d %o %x %X and %hd %ho %hx %hX %ld %lo %lx %lX
48  * \endcode
49  *
50  * It means that real variables are not supported as well as field
51  * width and precision arguments.
52  */
53
54 /*#*
55  *#* $Log$
56  *#* Revision 1.17  2005/11/04 17:43:27  bernie
57  *#* Fix for LP64 architectures; Add some more tests.
58  *#*
59  *#* Revision 1.16  2005/07/19 07:25:46  bernie
60  *#* Use appconfig.h instead of cfg/config.h.
61  *#*
62  *#* Revision 1.15  2005/04/11 19:10:28  bernie
63  *#* Include top-level headers from cfg/ subdir.
64  *#*
65  *#* Revision 1.14  2005/03/01 23:26:22  bernie
66  *#* Use shared hextab.
67  *#*
68  *#* Revision 1.13  2005/02/18 12:33:25  bernie
69  *#* Avoid strlen().
70  *#*
71  *#* Revision 1.12  2005/02/16 20:28:03  bernie
72  *#* Add %S formatter.
73  *#*
74  *#* Revision 1.11  2005/02/16 16:51:29  bernie
75  *#* Simplify float code.
76  *#*
77  *#* Revision 1.10  2004/10/26 09:01:35  bernie
78  *#* Fix spacing.
79  *#*
80  *#* Revision 1.9  2004/09/14 21:06:23  bernie
81  *#* Spelling fix.
82  *#*
83  *#* Revision 1.8  2004/08/25 14:12:09  rasky
84  *#* Aggiornato il comment block dei log RCS
85  *#*/
86
87 #include "formatwr.h"
88 #include <mware/pgm.h>
89 #include <mware/hex.h>
90 #include <cfg/debug.h> /* ASSERT */
91 #include <appconfig.h> /* CONFIG_ macros */
92
93 #ifndef CONFIG_PRINTF_N_FORMATTER
94         /*! Disable the arcane %n formatter. */
95         #define CONFIG_PRINTF_N_FORMATTER 0
96 #endif
97
98 #ifndef CONFIG_PRINTF_OCTAL_FORMATTER
99         /*! Disable the %o formatter. */
100         #define CONFIG_PRINTF_OCTAL_FORMATTER 0
101 #endif
102
103 /* True if we must keep a count of the number of characters we print. */
104 #define CONFIG_PRINTF_COUNT_CHARS (CONFIG_PRINTF_RETURN_COUNT || CONFIG_PRINTF_N_FORMATTER)
105
106 #if CONFIG_PRINTF
107
108 #if CONFIG_PRINTF > PRINTF_NOFLOAT
109         #include <float.h>
110
111         /* Maximum precision for floating point values */
112         typedef long double max_float_t;
113
114         /*bernie: save some memory, who cares about floats with lots of decimals? */
115         #define FRMWRI_BUFSIZE 134
116         #warning 134 is too much, the code must be fixed to have a lower precision limit
117 #else
118         /*
119          * Conservative estimate. Should be (probably) 12 (which is the size necessary
120          * to represent (2^32-1) in octal plus the sign bit.
121          */
122         #define FRMWRI_BUFSIZE 16
123 #endif
124
125 /* Probably useful for fancy microcontrollers such as the PIC, nobody knows. */
126 #ifndef MEM_ATTRIBUTE
127 #define MEM_ATTRIBUTE
128 #endif
129
130 #if CONFIG_PRINTF > PRINTF_NOMODIFIERS
131         #define IS_SHORT (h_modifier || (sizeof(int) == 2 && !l_modifier))
132 #else
133         #define IS_SHORT (sizeof(int) == 2)
134 #endif /* CONFIG_PRINTF > PRINTF_NOMODIFIERS */
135
136
137 #if CONFIG_PRINTF > PRINTF_NOFLOAT
138
139 static char *float_conversion(MEM_ATTRIBUTE max_float_t value,
140                 MEM_ATTRIBUTE short nr_of_digits,
141                 MEM_ATTRIBUTE char *buf,
142                 MEM_ATTRIBUTE char format_flag,
143                 MEM_ATTRIBUTE char g_flag,
144                 MEM_ATTRIBUTE bool alternate_flag)
145 {
146         MEM_ATTRIBUTE char *cp;
147         MEM_ATTRIBUTE char *buf_pointer;
148         MEM_ATTRIBUTE short n, i, dec_point_pos, integral_10_log;
149
150         buf_pointer = buf;
151         integral_10_log = 0;
152
153         if (value >= 1)
154         {
155                 while (value >= 1e11) /* To speed up things a bit */
156                 {
157                         value /= 1e10;
158                         integral_10_log += 10;
159                 }
160                 while (value >= 10)
161                 {
162                         value /= 10;
163                         integral_10_log++;
164                 }
165         }
166         else if (value) /* Not just 0.0 */
167         {
168                 while (value <= 1e-10) /* To speed up things a bit */
169                 {
170                         value *= 1e10;
171                         integral_10_log -= 10;
172                 }
173                 while (value < 1)
174                 {
175                         value *= 10;
176                         integral_10_log--;
177                 }
178         }
179         if (g_flag)
180         {
181                 if (integral_10_log < nr_of_digits && integral_10_log >= -4)
182                 {
183                         format_flag = 0;
184                         nr_of_digits -= integral_10_log;
185                 }
186                 nr_of_digits--;
187                 if (alternate_flag)
188                         /* %#G - No removal of trailing zeros */
189                         g_flag = 0;
190                 else
191                         /* %G - Removal of trailing zeros */
192                         alternate_flag = true;
193         }
194
195         /* %e or %E */
196         if (format_flag)
197         {
198                 dec_point_pos = 0;
199         }
200         else
201         {
202                 /* Less than one... */
203                 if (integral_10_log < 0)
204                 {
205                         *buf_pointer++ = '0';
206                         if ((n = nr_of_digits) || alternate_flag)
207                                 *buf_pointer++ = '.';
208                         i = 0;
209                         while (--i > integral_10_log && nr_of_digits)
210                         {
211                                 *buf_pointer++ = '0';
212                                 nr_of_digits--;
213                         }
214                         if (integral_10_log < (-n - 1))
215                                 /* Nothing more to do */
216                                 goto CLEAN_UP;
217                         dec_point_pos = 1;
218                 }
219                 else
220                 {
221                         dec_point_pos = - integral_10_log;
222                 }
223         }
224
225         i = dec_point_pos;
226         while (i <= nr_of_digits )
227         {
228                 value -= (max_float_t)(n = (short)value); /* n=Digit value=Remainder */
229                 value *= 10; /* Prepare for next shot */
230                 *buf_pointer++ = n + '0';
231                 if ( ! i++ && (nr_of_digits || alternate_flag))
232                         *buf_pointer++ = '.';
233         }
234
235         /* Rounding possible */
236         if (value >= 5)
237         {
238                 n = 1; /* Carry */
239                 cp = buf_pointer - 1;
240                 do
241                 {
242                         if (*cp != '.')
243                         {
244                                 if ( (*cp += n) == ('9' + 1) )
245                                 {
246                                         *cp = '0';
247                                         n = 1;
248                                 }
249                                 else
250                                         n = 0;
251                         }
252                 } while (cp-- > buf);
253                 if (n)
254                 {
255                         /* %e or %E */
256                         if (format_flag)
257                         {
258                                 cp = buf_pointer;
259                                 while (cp > buf)
260                                 {
261                                         if (*(cp - 1) == '.')
262                                         {
263                                                 *cp = *(cp - 2);
264                                                 cp--;
265                                         }
266                                         else
267                                                 *cp = *(cp - 1);
268                                         cp--;
269                                 }
270                                 integral_10_log++;
271                         }
272                         else
273                         {
274                                 cp = ++buf_pointer;
275                                 while (cp > buf)
276                                 {
277                                         *cp = *(cp - 1);
278                                         cp--;
279                                 }
280                         }
281                         *buf = '1';
282                 }
283         }
284
285 CLEAN_UP:
286         /* %G - Remove trailing zeros */
287         if (g_flag)
288         {
289                 while (*(buf_pointer - 1) == '0')
290                         buf_pointer--;
291                 if (*(buf_pointer - 1) == '.')
292                         buf_pointer--;
293         }
294
295         /* %e or %E */
296         if (format_flag)
297         {
298                 *buf_pointer++ = format_flag;
299                 if (integral_10_log < 0)
300                 {
301                         *buf_pointer++ = '-';
302                         integral_10_log = -integral_10_log;
303                 }
304                 else
305                         *buf_pointer++ = '+';
306                 n = 0;
307                 buf_pointer +=10;
308                 do
309                 {
310                         n++;
311                         *buf_pointer++ = (integral_10_log % 10) + '0';
312                         integral_10_log /= 10;
313                 } while ( integral_10_log || n < 2 );
314                 for ( i = n ; n > 0 ; n-- )
315                         *(buf_pointer - 11 - i + n) = *(buf_pointer - n);
316                 buf_pointer -= 10;
317         }
318         return (buf_pointer);
319 }
320
321 #endif /* CONFIG_PRINTF > PRINTF_NOFLOAT */
322
323 /*!
324  * This routine forms the core and entry of the formatter.
325  *
326  * The conversion performed conforms to the ANSI specification for "printf".
327  */
328 int
329 PGM_FUNC(_formatted_write)(const char * PGM_ATTR format,
330                 void put_one_char(char, void *),
331                 void *secret_pointer,
332                 va_list ap)
333 {
334 #if CONFIG_PRINTF > PRINTF_REDUCED
335         MEM_ATTRIBUTE static char bad_conversion[] = "???";
336         MEM_ATTRIBUTE static char null_pointer[] = "<NULL>";
337
338         MEM_ATTRIBUTE int precision;
339         MEM_ATTRIBUTE int n;
340 #if CONFIG_PRINTF_COUNT_CHARS
341         MEM_ATTRIBUTE int nr_of_chars;
342 #endif
343         MEM_ATTRIBUTE int field_width;
344         MEM_ATTRIBUTE char format_flag;
345         enum PLUS_SPACE_FLAGS {
346                 PSF_NONE, PSF_PLUS, PSF_MINUS
347         };
348         enum DIV_FACTOR {
349                 DIV_DEC, DIV_HEX,
350 #if CONFIG_PRINTF_OCTAL_FORMATTER
351                 DIV_OCT,
352 #endif
353         };
354         MEM_ATTRIBUTE struct {
355                 enum PLUS_SPACE_FLAGS plus_space_flag : 2;
356 #if CONFIG_PRINTF_OCTAL_FORMATTER
357                 enum DIV_FACTOR div_factor : 2;
358 #else
359                 enum DIV_FACTOR div_factor : 1;
360 #endif
361                 bool left_adjust : 1;
362                 bool l_L_modifier : 1;
363                 bool h_modifier : 1;
364                 bool alternate_flag : 1;
365                 bool nonzero_value : 1;
366                 bool zeropad : 1;
367 #if CPU_HARVARD
368                 bool progmem : 1;
369 #endif
370         } flags;
371         MEM_ATTRIBUTE unsigned long ulong;
372
373 #if CONFIG_PRINTF >  PRINTF_NOFLOAT
374         MEM_ATTRIBUTE max_float_t fvalue;
375 #endif
376
377         MEM_ATTRIBUTE char *buf_pointer;
378         MEM_ATTRIBUTE char *ptr;
379         MEM_ATTRIBUTE const char *hex;
380         MEM_ATTRIBUTE char buf[FRMWRI_BUFSIZE];
381
382 #if CONFIG_PRINTF_COUNT_CHARS
383         nr_of_chars = 0;
384 #endif
385         for (;;)    /* Until full format string read */
386         {
387                 while ((format_flag = PGM_READ_CHAR(format++)) != '%')    /* Until '%' or '\0' */
388                 {
389                         if (!format_flag)
390 #if CONFIG_PRINTF_RETURN_COUNT
391                                 return (nr_of_chars);
392 #else
393                                 return 0;
394 #endif
395                         put_one_char(format_flag, secret_pointer);
396 #if CONFIG_PRINTF_COUNT_CHARS
397                         nr_of_chars++;
398 #endif
399                 }
400                 if (PGM_READ_CHAR(format) == '%')    /* %% prints as % */
401                 {
402                         format++;
403                         put_one_char('%', secret_pointer);
404 #if CONFIG_PRINTF_COUNT_CHARS
405                         nr_of_chars++;
406 #endif
407                         continue;
408                 }
409
410                 flags.left_adjust = false;
411                 flags.alternate_flag = false;
412                 flags.plus_space_flag = PSF_NONE;
413                 flags.zeropad = false;
414 #if CPU_HARVARD
415                 flags.progmem = false;
416 #endif
417                 ptr = buf_pointer = &buf[0];
418                 hex = HEX_tab;
419
420                 /* check for leading '-', '+', ' ','#' or '0' flags  */
421                 for (;;)
422                 {
423                         switch (PGM_READ_CHAR(format))
424                         {
425                                 case ' ':
426                                         if (flags.plus_space_flag)
427                                                 goto NEXT_FLAG;
428                                 case '+':
429                                         flags.plus_space_flag = PSF_PLUS;
430                                         goto NEXT_FLAG;
431                                 case '-':
432                                         flags.left_adjust = true;
433                                         goto NEXT_FLAG;
434                                 case '#':
435                                         flags.alternate_flag = true;
436                                         goto NEXT_FLAG;
437                                 case '0':
438                                         flags.zeropad = true;
439                                         goto NEXT_FLAG;
440                         }
441                         break;
442 NEXT_FLAG:
443                         format++;
444                 }
445
446                 /* Optional field width (may be '*') */
447                 if (PGM_READ_CHAR(format) == '*')
448                 {
449                         field_width = va_arg(ap, int);
450                         if (field_width < 0)
451                         {
452                                 field_width = -field_width;
453                                 flags.left_adjust = true;
454                         }
455                         format++;
456                 }
457                 else
458                 {
459                         field_width = 0;
460                         while (PGM_READ_CHAR(format) >= '0' && PGM_READ_CHAR(format) <= '9')
461                                 field_width = field_width * 10 + (PGM_READ_CHAR(format++) - '0');
462                 }
463
464                 if (flags.left_adjust)
465                         flags.zeropad = false;
466
467                 /* Optional precision (or '*') */
468                 if (PGM_READ_CHAR(format) == '.')
469                 {
470                         if (PGM_READ_CHAR(++format) == '*')
471                         {
472                                 precision = va_arg(ap, int);
473                                 format++;
474                         }
475                         else
476                         {
477                                 precision = 0;
478                                 while (PGM_READ_CHAR(format) >= '0' && PGM_READ_CHAR(format) <= '9')
479                                         precision = precision * 10 + (PGM_READ_CHAR(format++) - '0');
480                         }
481                 }
482                 else
483                         precision = -1;
484
485                 /* At this point, "left_adjust" is nonzero if there was
486                  * a sign, "zeropad" is 1 if there was a leading zero
487                  * and 0 otherwise, "field_width" and "precision"
488                  * contain numbers corresponding to the digit strings
489                  * before and after the decimal point, respectively,
490                  * and "plus_space_flag" is either 0 (no flag) or
491                  * contains a plus or space character. If there was no
492                  * decimal point, "precision" will be -1.
493                  */
494
495                 flags.l_L_modifier = false;
496                 flags.h_modifier = false;
497
498                 /* Optional 'l','L' r 'h' modifier? */
499                 switch (PGM_READ_CHAR(format))
500                 {
501                         case 'l':
502                         case 'L':
503                                 flags.l_L_modifier = true;
504                                 format++;
505                                 break;
506                         case 'h':
507                                 flags.h_modifier = true;
508                                 format++;
509                                 break;
510                 }
511
512                 /*
513                  * At exit from the following switch, we will emit
514                  * the characters starting at "buf_pointer" and
515                  * ending at "ptr"-1
516                  */
517                 switch (format_flag = PGM_READ_CHAR(format++))
518                 {
519 #if CONFIG_PRINTF_N_FORMATTER
520                         case 'n':
521                                 if (sizeof(short) != sizeof(int))
522                                 {
523                                         if (sizeof(int) != sizeof(long))
524                                         {
525                                                 if (h_modifier)
526                                                         *va_arg(ap, short *) = nr_of_chars;
527                                                 else if (flags.l_L_modifier)
528                                                         *va_arg(ap, long *) = nr_of_chars;
529                                                 else
530                                                         *va_arg(ap, int *) = nr_of_chars;
531                                         }
532                                         else
533                                         {
534                                                 if (h_modifier)
535                                                         *va_arg(ap, short *) = nr_of_chars;
536                                                 else
537                                                         *va_arg(ap, int *) = nr_of_chars;
538                                         }
539                                 }
540                                 else
541                                 {
542                                         if (flags.l_L_modifier)
543                                                 *va_arg(ap, long *) = nr_of_chars;
544                                         else
545                                                 *va_arg(ap, int *) = nr_of_chars;
546                                 }
547                                 continue;
548 #endif
549                         case 'c':
550                                 buf[0] = va_arg(ap, int);
551                                 ptr++;
552                                 break;
553
554                         /* Custom formatter for strings in program memory. */
555                         case 'S':
556 #if CPU_HARVARD
557                                 flags.progmem = true;
558 #endif
559                                 /* Fall trough */
560
561                         case 's':
562                                 if ( !(buf_pointer = va_arg(ap, char *)) )
563                                         buf_pointer = null_pointer;
564                                 if (precision < 0)
565                                         precision = 10000;
566
567                                 /*
568                                  * Move `ptr' to the last character of the
569                                  * string that will be actually printed.
570                                  */
571                                 ptr = buf_pointer;
572 #if CPU_HARVARD
573                                 if (flags.progmem)
574                                 {
575                                         for (n=0; pgm_read_char(ptr) && n < precision; n++)
576                                                 ++ptr;
577                                 }
578                                 else
579 #endif
580                                 for (n=0; *ptr && n < precision; n++)
581                                         ++ptr;
582                                 break;
583
584 #if CONFIG_PRINTF_OCTAL_FORMATTER
585                         case 'o':
586                                 if (flags.alternate_flag && !precision)
587                                         precision++;
588 #endif
589                         case 'x':
590                                 hex = hex_tab;
591                         case 'u':
592                         case 'p':
593                         case 'X':
594                                 if (format_flag == 'p')
595 #if defined(__AVR__) || defined(__I196__) /* 16bit pointers */
596                                         ulong = (unsigned long)(unsigned short)va_arg(ap, char *);
597 #else /* 32bit pointers */
598                                         ulong = (unsigned long)va_arg(ap, char *);
599 #endif /* 32bit pointers */
600                                 else if (flags.l_L_modifier)
601                                         ulong = va_arg(ap, unsigned long);
602                                 else if (flags.h_modifier)
603                                         ulong = (unsigned long)(unsigned short)va_arg(ap, unsigned int);
604                                 else
605                                         ulong = va_arg(ap, unsigned int);
606
607                                 flags.div_factor =
608 #if CONFIG_PRINTF_OCTAL_FORMATTER
609                                         (format_flag == 'o') ? DIV_OCT :
610 #endif
611                                         (format_flag == 'u') ? DIV_DEC : DIV_HEX;
612                                 flags.plus_space_flag = PSF_NONE;
613                                 goto INTEGRAL_CONVERSION;
614
615                         case 'd':
616                         case 'i':
617                                 if (flags.l_L_modifier)
618                                         ulong = (unsigned long)(long)va_arg(ap, long);
619                                 else
620                                         ulong = (unsigned long)(long)va_arg(ap, int);
621
622                                 /* Extract sign */
623                                 if ((signed long)ulong < 0)
624                                 {
625                                         flags.plus_space_flag = PSF_MINUS;
626                                         ulong = (unsigned long)(-((signed long)ulong));
627                                 }
628
629                                 flags.div_factor = DIV_DEC;
630
631                                 /* Now convert to digits */
632 INTEGRAL_CONVERSION:
633                                 ptr = buf_pointer = &buf[FRMWRI_BUFSIZE - 1];
634                                 flags.nonzero_value = (ulong != 0);
635
636                                 /* No char if zero and zero precision */
637                                 if (precision != 0 || flags.nonzero_value)
638                                 {
639                                         switch (flags.div_factor)
640                                         {
641                                         case DIV_DEC:
642                                                 do
643                                                         *--buf_pointer = hex[ulong % 10];
644                                                 while (ulong /= 10);
645                                                 break;
646
647                                         case DIV_HEX:
648                                                 do
649                                                         *--buf_pointer = hex[ulong % 16];
650                                                 while (ulong /= 16);
651                                                 break;
652 #if CONFIG_PRINTF_OCTAL_FORMATTER
653                                         case DIV_OCT:
654                                                 do
655                                                         *--buf_pointer = hex[ulong % 8];
656                                                 while (ulong /= 8);
657                                                 break;
658 #endif
659                                         }
660                                 }
661
662                                 /* "precision" takes precedence */
663                                 if (precision < 0)
664                                         if (flags.zeropad)
665                                                 precision = field_width - (flags.plus_space_flag != PSF_NONE);
666                                 while (precision > (int)(ptr - buf_pointer))
667                                         *--buf_pointer = '0';
668
669                                 if (flags.alternate_flag && flags.nonzero_value)
670                                 {
671                                         if (format_flag == 'x' || format_flag == 'X')
672                                         {
673                                                 *--buf_pointer = format_flag;
674                                                 *--buf_pointer = '0';
675                                         }
676 #if CONFIG_PRINTF_OCTAL_FORMATTER
677                                         else if ((format_flag == 'o') && (*buf_pointer != '0'))
678                                         {
679                                                 *--buf_pointer = '0';
680                                         }
681 #endif
682                                 }
683                                 ASSERT(buf_pointer >= buf);
684                                 break;
685
686 #if CONFIG_PRINTF > PRINTF_NOFLOAT
687                         case 'g':
688                         case 'G':
689                                 n = 1;
690                                 format_flag -= 2;
691                                 if (! precision)
692                                 {
693                                         precision = 1;
694                                 }
695                                 goto FLOATING_CONVERSION;
696                         case 'f':
697                                 format_flag = 0;
698                         case 'e':
699                         case 'E':
700                                 n = 0;
701 FLOATING_CONVERSION:
702                                 if (precision < 0)
703                                 {
704                                         precision = 6;
705                                 }
706
707                                 if (sizeof(double) != sizeof(max_float_t))
708                                 {
709                                         fvalue = flags.l_L_modifier ?
710                                                 va_arg(ap,max_float_t) : va_arg(ap,double);
711                                 }
712                                 else
713                                         fvalue = va_arg(ap,max_float_t);
714
715                                 if (fvalue < 0)
716                                 {
717                                         flags.plus_space_flag = PSF_MINUS;
718                                         fvalue = -fvalue;
719                                 }
720                                 ptr = float_conversion (fvalue,
721                                                 (short)precision,
722                                                 buf_pointer += field_width,
723                                                 format_flag,
724                                                 (char)n,
725                                                 flags.alternate_flag);
726                                 if (flags.zeropad)
727                                 {
728                                         precision = field_width - (flags.plus_space_flag != PSF_NONE);
729                                         while (precision > ptr - buf_pointer)
730                                                 *--buf_pointer = '0';
731                                 }
732                                 break;
733
734 #endif /* CONFIG_PRINTF <= PRINTF_NOFLOAT */
735
736                         case '\0': /* Really bad place to find NUL in */
737                                 format--;
738
739                         default:
740                                 /* Undefined conversion! */
741                                 ptr = buf_pointer = bad_conversion;
742                                 ptr += sizeof(bad_conversion) - 1;
743                                 break;
744
745                 }
746
747                 /*
748                  * This part emittes the formatted string to "put_one_char".
749                  */
750
751                 /* If field_width == 0 then nothing should be written. */
752                 precision = ptr - buf_pointer;
753
754                 if ( precision > field_width)
755                 {
756                         n = 0;
757                 }
758                 else
759                 {
760                         n = field_width - precision - (flags.plus_space_flag != PSF_NONE);
761                 }
762
763                 /* emit any leading pad characters */
764                 if (!flags.left_adjust)
765                         while (--n >= 0)
766                         {
767                                 put_one_char(' ', secret_pointer);
768 #if CONFIG_PRINTF_COUNT_CHARS
769                                 nr_of_chars++;
770 #endif
771                         }
772
773                 /* emit flag characters (if any) */
774                 if (flags.plus_space_flag)
775                 {
776                         put_one_char(flags.plus_space_flag == PSF_PLUS ? '+' : '-', secret_pointer);
777 #if CONFIG_PRINTF_COUNT_CHARS
778                         nr_of_chars++;
779 #endif
780                 }
781
782 #if CPU_HARVARD
783                 if (flags.progmem)
784                 {
785                         while (--precision >= 0)
786                         {
787                                 put_one_char(pgm_read_char(buf_pointer++), secret_pointer);
788 #if CONFIG_PRINTF_COUNT_CHARS
789                                 nr_of_chars++;
790 #endif
791                         }
792                 }
793                 else
794 #endif /* CPU_HARVARD */
795                 {
796                         /* emit the string itself */
797                         while (--precision >= 0)
798                         {
799                                 put_one_char(*buf_pointer++, secret_pointer);
800 #if CONFIG_PRINTF_COUNT_CHARS
801                                 nr_of_chars++;
802 #endif
803                         }
804                 }
805
806                 /* emit trailing space characters */
807                 if (flags.left_adjust)
808                         while (--n >= 0)
809                         {
810                                 put_one_char(' ', secret_pointer);
811 #if CONFIG_PRINTF_COUNT_CHARS
812                                 nr_of_chars++;
813 #endif
814                         }
815         }
816
817 #else /* PRINTF_REDUCED starts here */
818
819 #if CONFIG_PRINTF > PRINTF_NOMODIFIERS
820         char l_modifier, h_modifier;
821         unsigned long u_val, div_val;
822 #else
823         unsigned int u_val, div_val;
824 #endif /* CONFIG_PRINTF > PRINTF_NOMODIFIERS */
825
826         char format_flag;
827         unsigned int nr_of_chars, base;
828         char outChar;
829         char *ptr;
830
831         nr_of_chars = 0;
832         for (;;)    /* Until full format string read */
833         {
834                 while ((format_flag = PGM_READ_CHAR(format++)) != '%')    /* Until '%' or '\0' */
835                 {
836                         if (!format_flag)
837                                 return (nr_of_chars);
838                         put_one_char(format_flag, secret_pointer);
839                         nr_of_chars++;
840                 }
841
842 #if CONFIG_PRINTF > PRINTF_NOMODIFIERS
843                 /*=================================*/
844                 /* Optional 'l' or 'h' modifiers ? */
845                 /*=================================*/
846                 l_modifier = h_modifier = 0;
847                 switch (PGM_READ_CHAR(format))
848                 {
849                         case 'l':
850                                 l_modifier = 1;
851                                 format++;
852                                 break;
853
854                         case 'h':
855                                 h_modifier = 1;
856                                 format++;
857                                 break;
858                 }
859 #endif /* CONFIG_PRINTF > PRINTF_NOMODIFIERS */
860
861                 switch (format_flag = PGM_READ_CHAR(format++))
862                 {
863                         case 'c':
864                                 format_flag = va_arg(ap, int);
865                         default:
866                                 put_one_char(format_flag, secret_pointer);
867                                 nr_of_chars++;
868                                 continue;
869
870                         case 's':
871                                 ptr = va_arg(ap, char *);
872                                 while ((format_flag = *ptr++))
873                                 {
874                                         put_one_char(format_flag, secret_pointer);
875                                         nr_of_chars++;
876                                 }
877                                 continue;
878
879                         case 'o':
880                                 base = 8;
881                                 if (IS_SHORT)
882                                         div_val = 0x8000;
883                                 else
884                                         div_val = 0x40000000;
885                                 goto CONVERSION_LOOP;
886
887                         case 'd':
888                                 base = 10;
889                                 if (IS_SHORT)
890                                         div_val = 10000;
891                                 else
892                                         div_val = 1000000000;
893                                 goto CONVERSION_LOOP;
894
895                         case 'X':
896                         case 'x':
897                                 base = 16;
898                                 if (IS_SHORT)
899                                         div_val = 0x1000;
900                                 else
901                                         div_val = 0x10000000;
902
903 CONVERSION_LOOP:
904 #if CONFIG_PRINTF > PRINTF_NOMODIFIERS
905                                 if (h_modifier)
906                                         u_val = (format_flag == 'd') ?
907                                                 (short)va_arg(ap, int) : (unsigned short)va_arg(ap, int);
908                                 else if (l_modifier)
909                                         u_val = va_arg(ap, long);
910                                 else
911                                         u_val = (format_flag == 'd') ?
912                                                 va_arg(ap,int) : va_arg(ap,unsigned int);
913 #else /* CONFIG_PRINTF > PRINTF_NOMODIFIERS */
914                                 u_val = va_arg(ap,int);
915 #endif /* CONFIG_PRINTF > PRINTF_NOMODIFIERS */
916                                 if (format_flag == 'd')
917                                 {
918                                         if (((int)u_val) < 0)
919                                         {
920                                                 u_val = - u_val;
921                                                 put_one_char('-', secret_pointer);
922                                                 nr_of_chars++;
923                                         }
924                                 }
925                                 while (div_val > 1 && div_val > u_val)
926                                 {
927                                         div_val /= base;
928                                 }
929                                 do
930                                 {
931                                         outChar = (u_val / div_val) + '0';
932                                         if (outChar > '9')
933                                         {
934                                                 if (format_flag == 'x')
935                                                         outChar += 'a'-'9'-1;
936                                                 else
937                                                         outChar += 'A'-'9'-1;
938                                         }
939                                         put_one_char(outChar, secret_pointer);
940                                         nr_of_chars++;
941                                         u_val %= div_val;
942                                         div_val /= base;
943                                 }
944                                 while (div_val);
945
946                 } /* end switch(format_flag...) */
947         }
948 #endif /* CONFIG_PRINTF > PRINTF_REDUCED */
949 }
950
951 #endif /* CONFIG_PRINTF */