2 * COPYRIGHT: GNU GPL, see COPYING in the top level directory
3 * PROJECT: ReactOS crt library
4 * FILE: lib/sdk/crt/printf/streamout.c
5 * PURPOSE: Implementation of streamout
6 * PROGRAMMER: Timo Kreuzer
17 # define streamout wstreamout
18 # define format_float format_floatw
22 #define BUFFER_SIZE (32 + 17)
24 int mbtowc(wchar_t *wchar
, const char *mbchar
, size_t count
);
25 int wctomb(char *mbchar
, wchar_t wchar
);
27 typedef struct _STRING
29 unsigned short Length
;
30 unsigned short MaximumLength
;
36 /* Formatting flags */
37 FLAG_ALIGN_LEFT
= 0x01,
38 FLAG_FORCE_SIGN
= 0x02,
39 FLAG_FORCE_SIGNSP
= 0x04,
43 /* Data format flags */
46 FLAG_WIDECHAR
= FLAG_LONG
,
49 FLAG_INTPTR
= FLAG_INT64
,
53 FLAG_LONGDOUBLE
= 0x800,
56 #define va_arg_f(argptr, flags) \
57 (flags & FLAG_INT64) ? va_arg(argptr, __int64) : \
58 (flags & FLAG_SHORT) ? (short)va_arg(argptr, int) : \
61 #define va_arg_fu(argptr, flags) \
62 (flags & FLAG_INT64) ? va_arg(argptr, unsigned __int64) : \
63 (flags & FLAG_SHORT) ? (unsigned short)va_arg(argptr, int) : \
64 va_arg(argptr, unsigned int)
66 #define va_arg_ffp(argptr, flags) \
67 (flags & FLAG_LONGDOUBLE) ? va_arg(argptr, long double) : \
68 va_arg(argptr, double)
70 #define get_exp(f) (int)floor(f == 0 ? 0 : (f >= 0 ? log10(f) : log10(-f)))
71 #define round(x) floor((x) + 0.5)
73 #ifndef _USER32_WSPRINTF
77 /* Due to restrictions in kernel mode regarding the use of floating point,
78 we prevent it from being inlined */
89 static const TCHAR digits_l
[] = _T("0123456789abcdef0x");
90 static const TCHAR digits_u
[] = _T("0123456789ABCDEF0X");
91 static const TCHAR _nan
[] = _T("#QNAN");
92 static const TCHAR _infinity
[] = _T("#INF");
93 const TCHAR
*digits
= digits_l
;
94 int exponent
= 0, sign
;
95 long double fpval
, fpval2
;
96 int padding
= 0, num_digits
, val32
, base
= 10;
98 /* Normalize the precision */
99 if (precision
< 0) precision
= 6;
100 else if (precision
> 17)
102 padding
= precision
- 17;
106 /* Get the float value and calculate the exponent */
107 fpval
= va_arg_ffp(*argptr
, flags
);
108 exponent
= get_exp(fpval
);
109 sign
= fpval
< 0 ? -1 : 1;
116 if (precision
> 0) precision
--;
117 if (exponent
< -4 || exponent
>= precision
) goto case_e
;
119 /* Shift the decimal point and round */
120 fpval2
= round(sign
* fpval
* pow(10., precision
));
122 /* Skip trailing zeroes */
123 while (precision
&& (unsigned __int64
)fpval2
% 10 == 0)
134 /* Shift the decimal point and round */
135 fpval2
= round(sign
* fpval
* pow(10., precision
- exponent
));
137 /* Compensate for changed exponent through rounding */
138 if (fpval2
>= (unsigned __int64
)pow(10., precision
+ 1))
141 fpval2
= round(sign
* fpval
* pow(10., precision
- exponent
));
144 val32
= exponent
>= 0 ? exponent
: -exponent
;
146 // FIXME: handle length of exponent field:
147 // http://msdn.microsoft.com/de-de/library/0fatw238%28VS.80%29.aspx
151 *--(*string
) = digits
[val32
% 10];
155 /* Sign for the exponent */
156 *--(*string
) = exponent
>= 0 ? _T('+') : _T('-');
158 /* Add 'e' or 'E' separator */
159 *--(*string
) = digits
[0xe];
170 /* Shift the decimal point and round */
171 fpval2
= round(sign
* fpval
* pow(10., precision
));
180 else if (flags
& FLAG_FORCE_SIGN
)
182 else if (flags
& FLAG_FORCE_SIGNSP
)
185 /* Handle special cases first */
188 (*string
) -= sizeof(_nan
) / sizeof(TCHAR
) - 1;
189 _tcscpy((*string
), _nan
);
192 else if (!_finite(fpval
))
194 (*string
) -= sizeof(_infinity
) / sizeof(TCHAR
) - 1;
195 _tcscpy((*string
), _infinity
);
201 while (padding
-- > 0) *--(*string
) = _T('0');
203 /* Digits after the decimal point */
204 num_digits
= precision
;
205 while (num_digits
-- > 0)
207 *--(*string
) = digits
[(unsigned __int64
)fpval2
% 10];
212 if (precision
> 0 || flags
& FLAG_SPECIAL
)
213 *--(*string
) = _T('.');
215 /* Digits before the decimal point */
218 *--(*string
) = digits
[(unsigned __int64
)fpval2
% base
];
221 while ((unsigned __int64
)fpval2
);
228 streamout_char(FILE *stream
, int chr
)
230 if ((stream
->_flag
& _IOSTRG
) && (!stream
->_ptr
))
233 #if defined(_USER32_WSPRINTF) || defined(_LIBCNT_)
234 /* Check if the buffer is full */
235 if (stream
->_cnt
< sizeof(TCHAR
))
238 *(TCHAR
*)stream
->_ptr
= chr
;
239 stream
->_ptr
+= sizeof(TCHAR
);
240 stream
->_cnt
-= sizeof(TCHAR
);
244 return _fputtc((TCHAR
)chr
, stream
) != _TEOF
;
250 streamout_astring(FILE *stream
, const char *string
, size_t count
)
259 if ((len
= mbtowc(&chr
, string
, MB_CUR_MAX
)) < 1) break;
264 if (streamout_char(stream
, chr
) == 0) return -1;
273 streamout_wstring(FILE *stream
, const wchar_t *string
, size_t count
)
281 char mbchar
[MB_CUR_MAX
], *ptr
= mbchar
;
284 mblen
= wctomb(mbchar
, *string
++);
285 if (mblen
<= 0) return written
;
287 while (chr
= *ptr
++, mblen
--)
292 if (streamout_char(stream
, chr
) == 0) return -1;
301 #define streamout_string streamout_wstring
303 #define streamout_string streamout_astring
306 #ifdef _USER32_WSPRINTF
307 # define USE_MULTISIZE 0
309 # define USE_MULTISIZE 1
314 streamout(FILE *stream
, const TCHAR
*format
, va_list argptr
)
316 static const TCHAR digits_l
[] = _T("0123456789abcdef0x");
317 static const TCHAR digits_u
[] = _T("0123456789ABCDEF0X");
318 static const char *_nullstring
= "(null)";
319 TCHAR buffer
[BUFFER_SIZE
+ 1];
322 const TCHAR
*digits
, *prefix
;
323 int base
, fieldwidth
, precision
, padding
;
324 size_t prefixlen
, len
;
325 int written
= 1, written_all
= 0;
327 unsigned __int64 val64
;
329 buffer
[BUFFER_SIZE
] = '\0';
335 /* Check for end of format string */
336 if (chr
== _T('\0')) break;
338 /* Check for 'normal' character or double % */
339 if ((chr
!= _T('%')) ||
340 (chr
= *format
++) == _T('%'))
342 /* Write the character to the stream */
343 if ((written
= streamout_char(stream
, chr
)) == 0) return -1;
344 written_all
+= written
;
352 if (chr
== _T('-')) flags
|= FLAG_ALIGN_LEFT
;
353 else if (chr
== _T('+')) flags
|= FLAG_FORCE_SIGN
;
354 else if (chr
== _T(' ')) flags
|= FLAG_FORCE_SIGNSP
;
355 else if (chr
== _T('0')) flags
|= FLAG_PAD_ZERO
;
356 else if (chr
== _T('#')) flags
|= FLAG_SPECIAL
;
361 /* Handle field width modifier */
364 fieldwidth
= va_arg(argptr
, int);
367 flags
|= FLAG_ALIGN_LEFT
;
368 fieldwidth
= -fieldwidth
;
375 while (chr
>= _T('0') && chr
<= _T('9'))
377 fieldwidth
= fieldwidth
* 10 + (chr
- _T('0'));
382 /* Handle precision modifier */
389 precision
= va_arg(argptr
, int);
395 while (chr
>= _T('0') && chr
<= _T('9'))
397 precision
= precision
* 10 + (chr
- _T('0'));
404 /* Handle argument size prefix */
407 if (chr
== _T('h')) flags
|= FLAG_SHORT
;
408 else if (chr
== _T('w')) flags
|= FLAG_WIDECHAR
;
409 else if (chr
== _T('L')) flags
|= 0; // FIXME: long double
410 else if (chr
== _T('F')) flags
|= 0; // FIXME: what is that?
411 else if (chr
== _T('l'))
413 /* Check if this is the 2nd 'l' in a row */
414 if (format
[-2] == 'l') flags
|= FLAG_INT64
;
415 else flags
|= FLAG_LONG
;
417 else if (chr
== _T('I'))
419 if (format
[0] == _T('3') && format
[1] == _T('2'))
423 else if (format
[0] == _T('6') && format
[1] == _T('4'))
428 else if (format
[0] == _T('x') || format
[0] == _T('X') ||
429 format
[0] == _T('d') || format
[0] == _T('i') ||
430 format
[0] == _T('u') || format
[0] == _T('o'))
432 flags
|= FLAG_INTPTR
;
439 while (USE_MULTISIZE
);
441 /* Handle the format specifier */
443 string
= &buffer
[BUFFER_SIZE
];
449 if (flags
& FLAG_INT64
)
450 *va_arg(argptr
, __int64
*) = written_all
;
451 else if (flags
& FLAG_SHORT
)
452 *va_arg(argptr
, short*) = written_all
;
454 *va_arg(argptr
, int*) = written_all
;
459 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
465 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
470 if (flags
& FLAG_WIDECHAR
)
472 ((wchar_t*)string
)[0] = va_arg(argptr
, int);
473 ((wchar_t*)string
)[1] = _T('\0');
477 ((char*)string
)[0] = va_arg(argptr
, int);
478 ((char*)string
)[1] = _T('\0');
483 nt_string
= va_arg(argptr
, void*);
484 if (nt_string
&& (string
= nt_string
->Buffer
))
486 len
= nt_string
->Length
;
487 if (flags
& FLAG_WIDECHAR
) len
/= sizeof(wchar_t);
494 string
= va_arg(argptr
, void*);
496 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
501 string
= va_arg(argptr
, void*);
503 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
509 string
= (TCHAR
*)_nullstring
;
510 flags
&= ~FLAG_WIDECHAR
;
513 if (flags
& FLAG_WIDECHAR
)
514 len
= wcsnlen((wchar_t*)string
, (unsigned)precision
);
516 len
= strnlen((char*)string
, (unsigned)precision
);
520 #ifndef _USER32_WSPRINTF
529 flags
|= FLAG_WIDECHAR
;
531 flags
&= ~FLAG_WIDECHAR
;
533 /* Use external function, one for kernel one for user mode */
534 format_float(chr
, flags
, precision
, &string
, &prefix
, &argptr
);
535 len
= _tcslen(string
);
542 val64
= (__int64
)va_arg_f(argptr
, flags
);
544 if ((__int64
)val64
< 0)
546 val64
= -(__int64
)val64
;
549 else if (flags
& FLAG_FORCE_SIGN
)
551 else if (flags
& FLAG_FORCE_SIGNSP
)
558 if (flags
& FLAG_SPECIAL
)
561 if (precision
> 0) precision
--;
566 precision
= 2 * sizeof(void*);
567 flags
&= ~FLAG_PAD_ZERO
;
568 flags
|= FLAG_INTPTR
;
577 if (flags
& FLAG_SPECIAL
)
579 prefix
= &digits
[16];
580 #ifdef _USER32_WSPRINTF
587 val64
= va_arg_fu(argptr
, flags
);
591 flags
|= FLAG_WIDECHAR
;
593 flags
&= ~FLAG_WIDECHAR
;
595 if (precision
< 0) precision
= 1;
597 /* Gather digits in reverse order */
600 *--string
= digits
[val64
% base
];
605 len
= _tcslen(string
);
609 /* Treat anything else as a new character */
614 /* Calculate padding */
615 prefixlen
= prefix
? _tcslen(prefix
) : 0;
616 if (precision
< 0) precision
= 0;
617 padding
= (int)(fieldwidth
- len
- prefixlen
- precision
);
618 if (padding
< 0) padding
= 0;
620 /* Optional left space padding */
621 if ((flags
& (FLAG_ALIGN_LEFT
| FLAG_PAD_ZERO
)) == 0)
623 for (; padding
> 0; padding
--)
625 if ((written
= streamout_char(stream
, _T(' '))) == 0) return -1;
626 written_all
+= written
;
630 /* Optional prefix */
633 written
= streamout_string(stream
, prefix
, prefixlen
);
634 if (written
== -1) return -1;
635 written_all
+= written
;
638 /* Optional left '0' padding */
639 if ((flags
& FLAG_ALIGN_LEFT
) == 0) precision
+= padding
;
640 while (precision
-- > 0)
642 if ((written
= streamout_char(stream
, _T('0'))) == 0) return -1;
643 written_all
+= written
;
646 /* Output the string */
647 if (flags
& FLAG_WIDECHAR
)
648 written
= streamout_wstring(stream
, (wchar_t*)string
, len
);
650 written
= streamout_astring(stream
, (char*)string
, len
);
651 if (written
== -1) return -1;
652 written_all
+= written
;
654 #if 0 && SUPPORT_FLOAT
655 /* Optional right '0' padding */
656 while (precision
-- > 0)
658 if ((written
= streamout_char(stream
, _T('0'))) == 0) return -1;
659 written_all
+= written
;
664 /* Optional right padding */
665 if (flags
& FLAG_ALIGN_LEFT
)
667 while (padding
-- > 0)
669 if ((written
= streamout_char(stream
, _T(' '))) == 0) return -1;
670 written_all
+= written
;
676 if (written
== -1) return -1;