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)
71 # define _flsbuf(chr, stream) 0
74 #define get_exp(f) floor(f == 0 ? 0 : (f >= 0 ? log10(f) : log10(-f)))
75 #define round(x) floor((x) + 0.5)
79 /* Due to restrictions in kernel mode regarding the use of floating point,
80 we prevent it from being inlined */
91 static const TCHAR digits_l
[] = _T("0123456789abcdef0x");
92 static const TCHAR digits_u
[] = _T("0123456789ABCDEF0X");
93 static const TCHAR _nan
[] = _T("#QNAN");
94 static const TCHAR _infinity
[] = _T("#INF");
95 const TCHAR
*digits
= digits_l
;
96 int exponent
= 0, sign
;
97 long double fpval
, fpval2
;
98 int padding
= 0, num_digits
, val32
, base
= 10;
100 /* Normalize the precision */
101 if (precision
< 0) precision
= 6;
102 else if (precision
> 17)
104 padding
= precision
- 17;
108 /* Get the float value and calculate the exponent */
109 fpval
= va_arg_ffp(*argptr
, flags
);
110 exponent
= get_exp(fpval
);
111 sign
= fpval
< 0 ? -1 : 1;
113 /* Shift the decimal point and round */
114 fpval2
= round(sign
* fpval
* pow(10., precision
- exponent
));
115 if (fpval2
>= (unsigned __int64
)pow(10., precision
+ 1))
118 fpval2
= round(sign
* fpval
* pow(10., precision
- exponent
));
126 if (precision
> 0) precision
--;
127 if (exponent
< -4 || exponent
>= precision
) goto case_e
;
129 /* Skip trailing zeroes */
130 while (precision
&& (unsigned __int64
)fpval2
% 10 == 0)
141 val32
= exponent
>= 0 ? exponent
: -exponent
;
143 // FIXME: handle length of exponent field:
144 // http://msdn.microsoft.com/de-de/library/0fatw238%28VS.80%29.aspx
148 *--(*string
) = digits
[val32
% 10];
152 /* Sign for the exponent */
153 *--(*string
) = exponent
>= 0 ? _T('+') : _T('-');
155 /* Add 'e' or 'E' separator */
156 *--(*string
) = digits
[0xe];
174 else if (flags
& FLAG_FORCE_SIGN
)
176 else if (flags
& FLAG_FORCE_SIGNSP
)
179 /* Handle special cases first */
182 (*string
) -= sizeof(_nan
) / sizeof(TCHAR
) - 1;
183 _tcscpy((*string
), _nan
);
186 else if (!_finite(fpval
))
188 (*string
) -= sizeof(_infinity
) / sizeof(TCHAR
) - 1;
189 _tcscpy((*string
), _infinity
);
195 while (padding
-- > 0) *--(*string
) = _T('0');
197 /* Digits after the decimal point */
198 num_digits
= precision
;
199 while (num_digits
-- > 0)
201 *--(*string
) = digits
[(unsigned __int64
)fpval2
% 10];
206 if (precision
> 0 || flags
& FLAG_SPECIAL
)
207 *--(*string
) = _T('.');
209 /* Digits before the decimal point */
212 *--(*string
) = digits
[(unsigned __int64
)fpval2
% base
];
215 while ((unsigned __int64
)fpval2
);
221 streamout_char(FILE *stream
, int chr
)
223 /* Check if the buffer is full */
224 if (stream
->_cnt
< sizeof(TCHAR
))
226 /* Strings are done now */
227 if (stream
->_flag
& _IOSTRG
) return _TEOF
;
229 /* Flush buffer for files */
230 return _flsbuf(chr
, stream
) != _TEOF
;
233 *(TCHAR
*)stream
->_ptr
= chr
;
234 stream
->_ptr
+= sizeof(TCHAR
);
235 stream
->_cnt
-= sizeof(TCHAR
);
242 streamout_astring(FILE *stream
, const char *string
, int count
)
251 if ((len
= mbtowc(&chr
, string
, MB_CUR_MAX
)) < 1) break;
256 if (streamout_char(stream
, chr
) == 0) return -1;
265 streamout_wstring(FILE *stream
, const wchar_t *string
, int count
)
273 char mbchar
[MB_CUR_MAX
], *ptr
= mbchar
;
276 mblen
= wctomb(mbchar
, *string
++);
277 if (mblen
<= 0) return written
;
279 while (chr
= *ptr
++, mblen
--)
284 if (streamout_char(stream
, chr
) == 0) return -1;
293 #define streamout_string streamout_wstring
295 #define streamout_string streamout_astring
301 streamout(FILE *stream
, const TCHAR
*format
, va_list argptr
)
303 static const TCHAR digits_l
[] = _T("0123456789abcdef0x");
304 static const TCHAR digits_u
[] = _T("0123456789ABCDEF0X");
305 static const char *_nullstring
= "(null)";
306 TCHAR buffer
[BUFFER_SIZE
+ 1];
309 const TCHAR
*digits
, *prefix
;
310 int base
, len
, prefixlen
, fieldwidth
, precision
, padding
;
311 int written
= 1, written_all
= 0;
313 unsigned __int64 val64
;
315 buffer
[BUFFER_SIZE
] = '\0';
321 /* Check for end of format string */
322 if (chr
== _T('\0')) break;
324 /* Check for 'normal' character or double % */
325 if ((chr
!= _T('%')) ||
326 (chr
= *format
++) == _T('%'))
328 /* Write the character to the stream */
329 if ((written
= streamout_char(stream
, chr
)) == 0) return -1;
330 written_all
+= written
;
338 if (chr
== _T('-')) flags
|= FLAG_ALIGN_LEFT
;
339 else if (chr
== _T('+')) flags
|= FLAG_FORCE_SIGN
;
340 else if (chr
== _T(' ')) flags
|= FLAG_FORCE_SIGNSP
;
341 else if (chr
== _T('0')) flags
|= FLAG_PAD_ZERO
;
342 else if (chr
== _T('#')) flags
|= FLAG_SPECIAL
;
347 /* Handle field width modifier */
350 fieldwidth
= va_arg(argptr
, int);
353 flags
|= FLAG_ALIGN_LEFT
;
354 fieldwidth
= -fieldwidth
;
361 while (chr
>= _T('0') && chr
<= _T('9'))
363 fieldwidth
= fieldwidth
* 10 + (chr
- _T('0'));
368 /* Handle precision modifier */
375 precision
= va_arg(argptr
, int);
381 while (chr
>= _T('0') && chr
<= _T('9'))
383 precision
= precision
* 10 + (chr
- _T('0'));
390 /* Handle argument size prefix */
393 if (chr
== _T('h')) flags
|= FLAG_SHORT
;
394 else if (chr
== _T('w')) flags
|= FLAG_WIDECHAR
;
395 else if (chr
== _T('L')) flags
|= 0; // FIXME: long double
396 else if (chr
== _T('F')) flags
|= 0; // FIXME: what is that?
397 else if (chr
== _T('l'))
401 if (format
[0] == _T('l'))
408 else if (chr
== _T('I'))
410 if (format
[0] == _T('3') && format
[1] == _T('2'))
414 else if (format
[0] == _T('6') && format
[1] == _T('4'))
419 else if (format
[0] == _T('x') || format
[0] == _T('X') ||
420 format
[0] == _T('d') || format
[0] == _T('i') ||
421 format
[0] == _T('u') || format
[0] == _T('o'))
423 flags
|= FLAG_INTPTR
;
431 /* Handle the format specifier */
433 string
= &buffer
[BUFFER_SIZE
];
439 if (flags
& FLAG_INT64
)
440 *va_arg(argptr
, __int64
*) = written_all
;
441 else if (flags
& FLAG_SHORT
)
442 *va_arg(argptr
, short*) = written_all
;
444 *va_arg(argptr
, int*) = written_all
;
449 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
455 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
460 if (flags
& FLAG_WIDECHAR
)
462 ((wchar_t*)string
)[0] = va_arg(argptr
, int);
463 ((wchar_t*)string
)[1] = _T('\0');
467 ((char*)string
)[0] = va_arg(argptr
, int);
468 ((char*)string
)[1] = _T('\0');
473 nt_string
= va_arg(argptr
, void*);
474 if (nt_string
&& (string
= nt_string
->Buffer
))
476 len
= nt_string
->Length
;
477 if (flags
& FLAG_WIDECHAR
) len
/= sizeof(wchar_t);
484 string
= va_arg(argptr
, void*);
486 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
491 string
= va_arg(argptr
, void*);
493 if (!(flags
& FLAG_SHORT
)) flags
|= FLAG_WIDECHAR
;
499 string
= (TCHAR
*)_nullstring
;
500 flags
&= ~FLAG_WIDECHAR
;
503 if (flags
& FLAG_WIDECHAR
)
504 len
= wcslen((wchar_t*)string
);
506 len
= strlen((char*)string
);
507 if (precision
>= 0 && len
> precision
) len
= precision
;
519 flags
|= FLAG_WIDECHAR
;
521 flags
&= ~FLAG_WIDECHAR
;
523 /* Use external function, one for kernel one for user mode */
524 format_float(chr
, flags
, precision
, &string
, &prefix
, &argptr
);
525 len
= _tcslen(string
);
531 val64
= (__int64
)va_arg_f(argptr
, flags
);
533 if ((__int64
)val64
< 0)
538 else if (flags
& FLAG_FORCE_SIGN
)
540 else if (flags
& FLAG_FORCE_SIGNSP
)
547 if (flags
& FLAG_SPECIAL
)
550 if (precision
> 0) precision
--;
555 precision
= 2 * sizeof(void*);
556 flags
&= ~FLAG_PAD_ZERO
;
557 flags
|= FLAG_INTPTR
;
566 if (flags
& FLAG_SPECIAL
)
568 prefix
= &digits
[16];
573 val64
= va_arg_fu(argptr
, flags
);
577 flags
|= FLAG_WIDECHAR
;
579 flags
&= ~FLAG_WIDECHAR
;
581 if (precision
< 0) precision
= 1;
583 /* Gather digits in reverse order */
586 *--string
= digits
[val64
% base
];
591 len
= _tcslen(string
);
595 /* Treat anything else as a new character */
600 /* Calculate padding */
601 prefixlen
= prefix
? _tcslen(prefix
) : 0;
602 if (precision
< 0) precision
= 0;
603 padding
= fieldwidth
- len
- prefixlen
- precision
;
604 if (padding
< 0) padding
= 0;
606 /* Optional left space padding */
607 if ((flags
& (FLAG_ALIGN_LEFT
| FLAG_PAD_ZERO
)) == 0)
609 for (; padding
> 0; padding
--)
611 if ((written
= streamout_char(stream
, _T(' '))) == 0) return -1;
612 written_all
+= written
;
616 /* Optional prefix */
619 written
= streamout_string(stream
, prefix
, prefixlen
);
620 if (written
== -1) return -1;
621 written_all
+= written
;
624 /* Optional left '0' padding */
625 if ((flags
& FLAG_ALIGN_LEFT
) == 0) precision
+= padding
;
626 while (precision
-- > 0)
628 if ((written
= streamout_char(stream
, _T('0'))) == 0) return -1;
629 written_all
+= written
;
632 /* Output the string */
633 if (flags
& FLAG_WIDECHAR
)
634 written
= streamout_wstring(stream
, (wchar_t*)string
, len
);
636 written
= streamout_astring(stream
, (char*)string
, len
);
637 if (written
== -1) return -1;
638 written_all
+= written
;
640 #if 0 && SUPPORT_FLOAT
641 /* Optional right '0' padding */
642 while (precision
-- > 0)
644 if ((written
= streamout_char(stream
, _T('0'))) == 0) return -1;
645 written_all
+= written
;
650 /* Optional right padding */
651 if (flags
& FLAG_ALIGN_LEFT
)
653 while (padding
-- > 0)
655 if ((written
= streamout_char(stream
, _T(' '))) == 0) return -1;
656 written_all
+= written
;
662 if (written
== -1) return -1;