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
)
231 if ((stream
->_flag
& _IOSTRG
) && (!stream
->_ptr
))
235 #if defined(_USER32_WSPRINTF) || defined(_LIBCNT_)
236 /* Check if the buffer is full */
237 if (stream
->_cnt
< sizeof(TCHAR
))
240 *(TCHAR
*)stream
->_ptr
= chr
;
241 stream
->_ptr
+= sizeof(TCHAR
);
242 stream
->_cnt
-= sizeof(TCHAR
);
246 return _fputtc((TCHAR
)chr
, stream
) != _TEOF
;
252 streamout_astring(FILE *stream
, const char *string
, size_t count
)
261 if ((len
= mbtowc(&chr
, string
, MB_CUR_MAX
)) < 1) break;
266 if (streamout_char(stream
, chr
) == 0) return -1;
275 streamout_wstring(FILE *stream
, const wchar_t *string
, size_t count
)
283 char mbchar
[MB_CUR_MAX
], *ptr
= mbchar
;
286 mblen
= wctomb(mbchar
, *string
++);
287 if (mblen
<= 0) return written
;
289 while (chr
= *ptr
++, mblen
--)
294 if (streamout_char(stream
, chr
) == 0) return -1;
303 #define streamout_string streamout_wstring
305 #define streamout_string streamout_astring
308 #ifdef _USER32_WSPRINTF
309 # define USE_MULTISIZE 0
311 # define USE_MULTISIZE 1
316 streamout(FILE *stream
, const TCHAR
*format
, va_list argptr
)
318 static const TCHAR digits_l
[] = _T("0123456789abcdef0x");
319 static const TCHAR digits_u
[] = _T("0123456789ABCDEF0X");
320 static const char *_nullstring
= "(null)";
321 TCHAR buffer
[BUFFER_SIZE
+ 1];
324 const TCHAR
*digits
, *prefix
;
325 int base
, fieldwidth
, precision
, padding
;
326 size_t prefixlen
, len
;
327 int written
= 1, written_all
= 0;
329 unsigned __int64 val64
;
331 buffer
[BUFFER_SIZE
] = '\0';
337 /* Check for end of format string */
338 if (chr
== _T('\0')) break;
340 /* Check for 'normal' character or double % */
341 if ((chr
!= _T('%')) ||
342 (chr
= *format
++) == _T('%'))
344 /* Write the character to the stream */
345 if ((written
= streamout_char(stream
, chr
)) == 0) return -1;
346 written_all
+= written
;
354 if (chr
== _T('-')) flags
|= FLAG_ALIGN_LEFT
;
355 else if (chr
== _T('+')) flags
|= FLAG_FORCE_SIGN
;
356 else if (chr
== _T(' ')) flags
|= FLAG_FORCE_SIGNSP
;
357 else if (chr
== _T('0')) flags
|= FLAG_PAD_ZERO
;
358 else if (chr
== _T('#')) flags
|= FLAG_SPECIAL
;
363 /* Handle field width modifier */
366 fieldwidth
= va_arg(argptr
, int);
369 flags
|= FLAG_ALIGN_LEFT
;
370 fieldwidth
= -fieldwidth
;
377 while (chr
>= _T('0') && chr
<= _T('9'))
379 fieldwidth
= fieldwidth
* 10 + (chr
- _T('0'));
384 /* Handle precision modifier */
391 precision
= va_arg(argptr
, int);
397 while (chr
>= _T('0') && chr
<= _T('9'))
399 precision
= precision
* 10 + (chr
- _T('0'));
406 /* Handle argument size prefix */
409 if (chr
== _T('h')) flags
|= FLAG_SHORT
;
410 else if (chr
== _T('w')) flags
|= FLAG_WIDECHAR
;
411 else if (chr
== _T('L')) flags
|= 0; // FIXME: long double
412 else if (chr
== _T('F')) flags
|= 0; // FIXME: what is that?
413 else if (chr
== _T('l'))
415 /* Check if this is the 2nd 'l' in a row */
416 if (format
[-2] == 'l') flags
|= FLAG_INT64
;
417 else flags
|= FLAG_LONG
;
419 else if (chr
== _T('I'))
421 if (format
[0] == _T('3') && format
[1] == _T('2'))
425 else if (format
[0] == _T('6') && format
[1] == _T('4'))
430 else if (format
[0] == _T('x') || format
[0] == _T('X') ||
431 format
[0] == _T('d') || format
[0] == _T('i') ||
432 format
[0] == _T('u') || format
[0] == _T('o'))
434 flags
|= FLAG_INTPTR
;
441 while (USE_MULTISIZE
);
443 /* Handle the format specifier */
445 string
= &buffer
[BUFFER_SIZE
];
451 if (flags
& FLAG_INT64
)
452 *va_arg(argptr
, __int64
*) = written_all
;
453 else if (flags
& FLAG_SHORT
)
454 *va_arg(argptr
, short*) = written_all
;
456 *va_arg(argptr
, int*) = written_all
;
461 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
467 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
472 if (flags
& FLAG_WIDECHAR
)
474 ((wchar_t*)string
)[0] = va_arg(argptr
, int);
475 ((wchar_t*)string
)[1] = _T('\0');
479 ((char*)string
)[0] = va_arg(argptr
, int);
480 ((char*)string
)[1] = _T('\0');
485 nt_string
= va_arg(argptr
, void*);
486 if (nt_string
&& (string
= nt_string
->Buffer
))
488 len
= nt_string
->Length
;
489 if (flags
& FLAG_WIDECHAR
) len
/= sizeof(wchar_t);
496 string
= va_arg(argptr
, void*);
498 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
503 string
= va_arg(argptr
, void*);
505 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
511 string
= (TCHAR
*)_nullstring
;
512 flags
&= ~FLAG_WIDECHAR
;
515 if (flags
& FLAG_WIDECHAR
)
516 len
= wcsnlen((wchar_t*)string
, (unsigned)precision
);
518 len
= strnlen((char*)string
, (unsigned)precision
);
522 #ifndef _USER32_WSPRINTF
531 flags
|= FLAG_WIDECHAR
;
533 flags
&= ~FLAG_WIDECHAR
;
535 /* Use external function, one for kernel one for user mode */
536 format_float(chr
, flags
, precision
, &string
, &prefix
, &argptr
);
537 len
= _tcslen(string
);
544 val64
= (__int64
)va_arg_f(argptr
, flags
);
546 if ((__int64
)val64
< 0)
548 val64
= -(__int64
)val64
;
551 else if (flags
& FLAG_FORCE_SIGN
)
553 else if (flags
& FLAG_FORCE_SIGNSP
)
560 if (flags
& FLAG_SPECIAL
)
563 if (precision
> 0) precision
--;
568 precision
= 2 * sizeof(void*);
569 flags
&= ~FLAG_PAD_ZERO
;
570 flags
|= FLAG_INTPTR
;
579 if (flags
& FLAG_SPECIAL
)
581 prefix
= &digits
[16];
582 #ifdef _USER32_WSPRINTF
589 val64
= va_arg_fu(argptr
, flags
);
593 flags
|= FLAG_WIDECHAR
;
595 flags
&= ~FLAG_WIDECHAR
;
597 if (precision
< 0) precision
= 1;
599 /* Gather digits in reverse order */
602 *--string
= digits
[val64
% base
];
607 len
= _tcslen(string
);
611 /* Treat anything else as a new character */
616 /* Calculate padding */
617 prefixlen
= prefix
? _tcslen(prefix
) : 0;
618 if (precision
< 0) precision
= 0;
619 padding
= (int)(fieldwidth
- len
- prefixlen
- precision
);
620 if (padding
< 0) padding
= 0;
622 /* Optional left space padding */
623 if ((flags
& (FLAG_ALIGN_LEFT
| FLAG_PAD_ZERO
)) == 0)
625 for (; padding
> 0; padding
--)
627 if ((written
= streamout_char(stream
, _T(' '))) == 0) return -1;
628 written_all
+= written
;
632 /* Optional prefix */
635 written
= streamout_string(stream
, prefix
, prefixlen
);
636 if (written
== -1) return -1;
637 written_all
+= written
;
640 /* Optional left '0' padding */
641 if ((flags
& FLAG_ALIGN_LEFT
) == 0) precision
+= padding
;
642 while (precision
-- > 0)
644 if ((written
= streamout_char(stream
, _T('0'))) == 0) return -1;
645 written_all
+= written
;
648 /* Output the string */
649 if (flags
& FLAG_WIDECHAR
)
650 written
= streamout_wstring(stream
, (wchar_t*)string
, len
);
652 written
= streamout_astring(stream
, (char*)string
, len
);
653 if (written
== -1) return -1;
654 written_all
+= written
;
656 #if 0 && SUPPORT_FLOAT
657 /* Optional right '0' padding */
658 while (precision
-- > 0)
660 if ((written
= streamout_char(stream
, _T('0'))) == 0) return -1;
661 written_all
+= written
;
666 /* Optional right padding */
667 if (flags
& FLAG_ALIGN_LEFT
)
669 while (padding
-- > 0)
671 if ((written
= streamout_char(stream
, _T(' '))) == 0) return -1;
672 written_all
+= written
;
678 if (written
== -1) return -1;