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 !defined(_USER32_WSPRINTF)
231 if ((stream
->_flag
& _IOSTRG
) && (stream
->_base
== NULL
))
234 #if defined(_USER32_WSPRINTF) || defined(_LIBCNT_)
235 /* Check if the buffer is full */
236 if (stream
->_cnt
< sizeof(TCHAR
))
239 *(TCHAR
*)stream
->_ptr
= chr
;
240 stream
->_ptr
+= sizeof(TCHAR
);
241 stream
->_cnt
-= sizeof(TCHAR
);
245 return _fputtc((TCHAR
)chr
, stream
) != _TEOF
;
251 streamout_astring(FILE *stream
, const char *string
, size_t count
)
256 #if !defined(_USER32_WSPRINTF)
257 if ((stream
->_flag
& _IOSTRG
) && (stream
->_base
== NULL
))
265 if ((len
= mbtowc(&chr
, string
, MB_CUR_MAX
)) < 1) break;
270 if (streamout_char(stream
, chr
) == 0) return -1;
279 streamout_wstring(FILE *stream
, const wchar_t *string
, size_t count
)
284 #if defined(_UNICODE) && !defined(_USER32_WSPRINTF)
285 if ((stream
->_flag
& _IOSTRG
) && (stream
->_base
== NULL
))
292 char mbchar
[MB_CUR_MAX
], *ptr
= mbchar
;
295 mblen
= wctomb(mbchar
, *string
++);
296 if (mblen
<= 0) return written
;
298 while (chr
= *ptr
++, mblen
--)
303 if (streamout_char(stream
, chr
) == 0) return -1;
312 #define streamout_string streamout_wstring
314 #define streamout_string streamout_astring
317 #ifdef _USER32_WSPRINTF
318 # define USE_MULTISIZE 0
320 # define USE_MULTISIZE 1
325 streamout(FILE *stream
, const TCHAR
*format
, va_list argptr
)
327 static const TCHAR digits_l
[] = _T("0123456789abcdef0x");
328 static const TCHAR digits_u
[] = _T("0123456789ABCDEF0X");
329 static const char *_nullstring
= "(null)";
330 TCHAR buffer
[BUFFER_SIZE
+ 1];
333 const TCHAR
*digits
, *prefix
;
334 int base
, fieldwidth
, precision
, padding
;
335 size_t prefixlen
, len
;
336 int written
= 1, written_all
= 0;
338 unsigned __int64 val64
;
340 buffer
[BUFFER_SIZE
] = '\0';
346 /* Check for end of format string */
347 if (chr
== _T('\0')) break;
349 /* Check for 'normal' character or double % */
350 if ((chr
!= _T('%')) ||
351 (chr
= *format
++) == _T('%'))
353 /* Write the character to the stream */
354 if ((written
= streamout_char(stream
, chr
)) == 0) return -1;
355 written_all
+= written
;
363 if (chr
== _T('-')) flags
|= FLAG_ALIGN_LEFT
;
364 else if (chr
== _T('+')) flags
|= FLAG_FORCE_SIGN
;
365 else if (chr
== _T(' ')) flags
|= FLAG_FORCE_SIGNSP
;
366 else if (chr
== _T('0')) flags
|= FLAG_PAD_ZERO
;
367 else if (chr
== _T('#')) flags
|= FLAG_SPECIAL
;
372 /* Handle field width modifier */
375 fieldwidth
= va_arg(argptr
, int);
378 flags
|= FLAG_ALIGN_LEFT
;
379 fieldwidth
= -fieldwidth
;
386 while (chr
>= _T('0') && chr
<= _T('9'))
388 fieldwidth
= fieldwidth
* 10 + (chr
- _T('0'));
393 /* Handle precision modifier */
400 precision
= va_arg(argptr
, int);
406 while (chr
>= _T('0') && chr
<= _T('9'))
408 precision
= precision
* 10 + (chr
- _T('0'));
415 /* Handle argument size prefix */
418 if (chr
== _T('h')) flags
|= FLAG_SHORT
;
419 else if (chr
== _T('w')) flags
|= FLAG_WIDECHAR
;
420 else if (chr
== _T('L')) flags
|= 0; // FIXME: long double
421 else if (chr
== _T('F')) flags
|= 0; // FIXME: what is that?
422 else if (chr
== _T('l'))
424 /* Check if this is the 2nd 'l' in a row */
425 if (format
[-2] == 'l') flags
|= FLAG_INT64
;
426 else flags
|= FLAG_LONG
;
428 else if (chr
== _T('I'))
430 if (format
[0] == _T('3') && format
[1] == _T('2'))
434 else if (format
[0] == _T('6') && format
[1] == _T('4'))
439 else if (format
[0] == _T('x') || format
[0] == _T('X') ||
440 format
[0] == _T('d') || format
[0] == _T('i') ||
441 format
[0] == _T('u') || format
[0] == _T('o'))
443 flags
|= FLAG_INTPTR
;
450 while (USE_MULTISIZE
);
452 /* Handle the format specifier */
454 string
= &buffer
[BUFFER_SIZE
];
460 if (flags
& FLAG_INT64
)
461 *va_arg(argptr
, __int64
*) = written_all
;
462 else if (flags
& FLAG_SHORT
)
463 *va_arg(argptr
, short*) = written_all
;
465 *va_arg(argptr
, int*) = written_all
;
470 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
476 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
481 if (flags
& FLAG_WIDECHAR
)
483 ((wchar_t*)string
)[0] = va_arg(argptr
, int);
484 ((wchar_t*)string
)[1] = _T('\0');
488 ((char*)string
)[0] = va_arg(argptr
, int);
489 ((char*)string
)[1] = _T('\0');
494 nt_string
= va_arg(argptr
, void*);
495 if (nt_string
&& (string
= nt_string
->Buffer
))
497 len
= nt_string
->Length
;
498 if (flags
& FLAG_WIDECHAR
) len
/= sizeof(wchar_t);
505 string
= va_arg(argptr
, void*);
507 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
512 string
= va_arg(argptr
, void*);
514 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
520 string
= (TCHAR
*)_nullstring
;
521 flags
&= ~FLAG_WIDECHAR
;
524 if (flags
& FLAG_WIDECHAR
)
525 len
= wcsnlen((wchar_t*)string
, (unsigned)precision
);
527 len
= strnlen((char*)string
, (unsigned)precision
);
531 #ifndef _USER32_WSPRINTF
540 flags
|= FLAG_WIDECHAR
;
542 flags
&= ~FLAG_WIDECHAR
;
544 /* Use external function, one for kernel one for user mode */
545 format_float(chr
, flags
, precision
, &string
, &prefix
, &argptr
);
546 len
= _tcslen(string
);
553 val64
= (__int64
)va_arg_f(argptr
, flags
);
555 if ((__int64
)val64
< 0)
557 val64
= -(__int64
)val64
;
560 else if (flags
& FLAG_FORCE_SIGN
)
562 else if (flags
& FLAG_FORCE_SIGNSP
)
569 if (flags
& FLAG_SPECIAL
)
572 if (precision
> 0) precision
--;
577 precision
= 2 * sizeof(void*);
578 flags
&= ~FLAG_PAD_ZERO
;
579 flags
|= FLAG_INTPTR
;
588 if (flags
& FLAG_SPECIAL
)
590 prefix
= &digits
[16];
591 #ifdef _USER32_WSPRINTF
598 val64
= va_arg_fu(argptr
, flags
);
602 flags
|= FLAG_WIDECHAR
;
604 flags
&= ~FLAG_WIDECHAR
;
606 if (precision
< 0) precision
= 1;
608 /* Gather digits in reverse order */
611 *--string
= digits
[val64
% base
];
616 len
= _tcslen(string
);
620 /* Treat anything else as a new character */
625 /* Calculate padding */
626 prefixlen
= prefix
? _tcslen(prefix
) : 0;
627 if (precision
< 0) precision
= 0;
628 padding
= (int)(fieldwidth
- len
- prefixlen
- precision
);
629 if (padding
< 0) padding
= 0;
631 /* Optional left space padding */
632 if ((flags
& (FLAG_ALIGN_LEFT
| FLAG_PAD_ZERO
)) == 0)
634 for (; padding
> 0; padding
--)
636 if ((written
= streamout_char(stream
, _T(' '))) == 0) return -1;
637 written_all
+= written
;
641 /* Optional prefix */
644 written
= streamout_string(stream
, prefix
, prefixlen
);
645 if (written
== -1) return -1;
646 written_all
+= written
;
649 /* Optional left '0' padding */
650 if ((flags
& FLAG_ALIGN_LEFT
) == 0) precision
+= padding
;
651 while (precision
-- > 0)
653 if ((written
= streamout_char(stream
, _T('0'))) == 0) return -1;
654 written_all
+= written
;
657 /* Output the string */
658 if (flags
& FLAG_WIDECHAR
)
659 written
= streamout_wstring(stream
, (wchar_t*)string
, len
);
661 written
= streamout_astring(stream
, (char*)string
, len
);
662 if (written
== -1) return -1;
663 written_all
+= written
;
665 #if 0 && SUPPORT_FLOAT
666 /* Optional right '0' padding */
667 while (precision
-- > 0)
669 if ((written
= streamout_char(stream
, _T('0'))) == 0) return -1;
670 written_all
+= written
;
675 /* Optional right padding */
676 if (flags
& FLAG_ALIGN_LEFT
)
678 while (padding
-- > 0)
680 if ((written
= streamout_char(stream
, _T(' '))) == 0) return -1;
681 written_all
+= written
;
687 if (written
== -1) return -1;