old_vfprintf.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494
  1. /*
  2. * This file based on printf.c from 'Dlibs' on the atari ST (RdeBath)
  3. *
  4. *
  5. * Dale Schumacher 399 Beacon Ave.
  6. * (alias: Dalnefre') St. Paul, MN 55104
  7. * dal@syntel.UUCP United States of America
  8. * "It's not reality that's important, but how you perceive things."
  9. */
  10. /* Altered to use stdarg, made the core function vfnprintf.
  11. * Hooked into the stdio package using 'inside information'
  12. * Altered sizeof() assumptions, now assumes all integers except chars
  13. * will be either
  14. * sizeof(xxx) == sizeof(long) or sizeof(xxx) == sizeof(short)
  15. *
  16. * -RDB
  17. */
  18. /*
  19. * Manuel Novoa III Dec 2000
  20. *
  21. * The previous vfnprintf routine was almost completely rewritten with the
  22. * goal of fixing some shortcomings and reducing object size.
  23. *
  24. * The summary of changes:
  25. *
  26. * Converted print conversion specification parsing from one big switch
  27. * to a method using string tables. This new method verifies that the
  28. * conversion flags, field width, precision, qualifier, and specifier
  29. * appear in the correct order. Many questionable specifications were
  30. * accepted by the previous code. This new method also resulted in a
  31. * substantial reduction in object size of about 330 bytes (20%) from
  32. * the old version (1627 bytes) on i386, even with the following
  33. * improvements.
  34. *
  35. * Implemented %n specifier as required by the standards.
  36. * Implemented proper handling of precision for int types.
  37. * Implemented # for hex and pointer, fixed error for octal rep of 0.
  38. * Implemented return of -1 on stream error.
  39. *
  40. * Added optional support for the GNU extension %m which prints the string
  41. * corresponding the errno.
  42. *
  43. * Added optional support for long long ints and unsigned long long ints
  44. * using the conversion qualifiers "ll", "L", or "q" (like glibc).
  45. *
  46. * Added optional support for doubles in a very limited form. None of
  47. * the formating options are obeyed. The string returned by __dtostr
  48. * is printed directly.
  49. *
  50. * Converted to use my (un)signed long (long) to string routines, which are
  51. * smaller than the previous functions and don't require static buffers.
  52. *
  53. * Other Modifications:
  54. * Modified sprintf, snprintf, vsprintf, vsnprintf to share on fake-file.
  55. */
  56. /*
  57. * Manuel Novoa III Jan 2001
  58. *
  59. * Removed fake file from *s*printf functions because of possible problems
  60. * if called recursively. Instead, have sprintf, snprintf, and vsprintf
  61. * call vsnprintf which allocates a fake file on the stack.
  62. * Removed WANT_FPUTC option. Always use standard putc macro to avoid
  63. * problems with the fake file used by the *s*printf functions.
  64. * Fixed bug parsing flags -- did not restart scan.
  65. * Added function asprintf.
  66. * Fixed 0-pad prefixing bug.
  67. * Converted sizeof(int) == sizeof(long) tests to compile time vs run time.
  68. * This saves 112 bytes of code on i386.
  69. * Fixed precision bug -- when negative set to default.
  70. * Added function fnprintf to support __dtostr.
  71. * Added floating point support for doubles. Yeah!
  72. *
  73. *
  74. * May 2001 Fixes from Johan Adolfsson (johan.adolfsson@axis.com)
  75. * 1) printf("%c",0) returned 0 instead of 1.
  76. * 2) unrolled loop in asprintf to reduce size and remove compile warning.
  77. *
  78. *
  79. * June 2001
  80. * 1) fix %p so that "0x" is prepended to outputed hex val
  81. * 2) fix %p so that "(nil)" is output for (void *)0 to match glibc
  82. *
  83. */
  84. /*****************************************************************************/
  85. /* OPTIONS */
  86. /*****************************************************************************/
  87. /* The optional support for long longs and doubles comes in two forms.
  88. *
  89. * 1) Normal (or partial for doubles) output support. Set to 1 to turn on.
  90. * Adds about 130 bytes for doubles, about 220 bytes for long longs,
  91. * and about 275 for both to the base code size of 1163 on i386.
  92. */
  93. /* These are now set in uClibc_config.h based on Config. */
  94. /*
  95. #define __UCLIBC_HAS_FLOATS__ 1
  96. */
  97. /* 2) An error message is inserted into the stream, an arg of the
  98. * appropriate size is removed from the arglist, and processing
  99. * continues. This is adds less code and may be useful in some
  100. * cases. Set to 1 to turn on. Adds about 50 bytes for doubles,
  101. * about 140 bytes for long longs, and about 175 bytes for both
  102. * to the base code size of 1163 on i386.
  103. */
  104. #define WANT_FLOAT_ERROR 0
  105. /*
  106. * Set to support GNU extension of %m to print string corresponding to errno.
  107. *
  108. * Warning: This adds about 50 bytes (i386) to the code but it also pulls in
  109. * strerror and the corresponding string table which together are about 3.8k.
  110. */
  111. #define WANT_GNU_ERRNO 0
  112. /**************************************************************************/
  113. #define _GNU_SOURCE /* for strnlen */
  114. #define _STDIO_UTILITY
  115. #include <stdio.h>
  116. #include <stdarg.h>
  117. #include <limits.h>
  118. #include <string.h>
  119. #include <errno.h>
  120. #include <ctype.h>
  121. #define __PRINTF_INFO_NO_BITFIELD
  122. #include <printf.h>
  123. #ifdef __STDIO_THREADSAFE
  124. #include <pthread.h>
  125. #endif /* __STDIO_THREADSAFE */
  126. /* #undef __UCLIBC_HAS_FLOATS__ */
  127. /* #undef WANT_FLOAT_ERROR */
  128. /* #define WANT_FLOAT_ERROR 1 */
  129. /* #define __isdigit(c) (((unsigned int)(c - '0')) < 10) */
  130. extern size_t _dtostr(FILE * fp, long double x, struct printf_info *info);
  131. enum {
  132. FLAG_PLUS = 0,
  133. FLAG_MINUS_LJUSTIFY,
  134. FLAG_HASH,
  135. FLAG_0_PAD,
  136. FLAG_SPACE,
  137. };
  138. /* layout 01234 */
  139. static const char spec[] = "+-#0 ";
  140. static const char qual[] = "hlLq";
  141. #if !defined(__UCLIBC_HAS_FLOATS__) && WANT_FLOAT_ERROR
  142. static const char dbl_err[] = "<DOUBLE>";
  143. #endif
  144. #if defined(__UCLIBC_HAS_FLOATS__) || WANT_FLOAT_ERROR
  145. /* layout 012345678901234567 */
  146. static const char u_spec[] = "%nbopxXudicsfgGeEaA";
  147. #else
  148. /* layout 0123456789012 */
  149. static const char u_spec[] = "%nbopxXudics";
  150. #endif
  151. /* WARNING: u_spec and u_radix need to stay in agreement!!! */
  152. /* u_radix[i] <-> u_spec[i+2] for unsigned entries only */
  153. static const char u_radix[] = "\x02\x08\x10\x10\x10\x0a";
  154. int vfprintf(FILE * __restrict op, register const char * __restrict fmt,
  155. va_list ap)
  156. {
  157. int i, cnt, lval, len;
  158. char *p;
  159. const char *fmt0;
  160. int preci, width;
  161. #define upcase i
  162. int radix, dpoint /*, upcase*/;
  163. char tmp[65]; /* TODO - determing needed size from headers */
  164. char flag[sizeof(spec)];
  165. __STDIO_THREADLOCK(op);
  166. cnt = 0;
  167. while (*fmt) {
  168. if (*fmt == '%') {
  169. fmt0 = fmt; /* save our position in case of bad format */
  170. ++fmt;
  171. width = -1; /* min field width */
  172. preci = -5; /* max string width or mininum digits */
  173. radix = 10; /* number base */
  174. dpoint = 0; /* found decimal point */
  175. #if INT_MAX != LONG_MAX
  176. lval = 0; /* sizeof(int) != sizeof(long) */
  177. #else
  178. lval = 1; /* sizeof(int) == sizeof(long) */
  179. #endif
  180. /* init flags */
  181. for (p =(char *) spec ; *p ; p++) {
  182. flag[p-spec] = '\0';
  183. }
  184. flag[FLAG_0_PAD] = ' ';
  185. /* process optional flags */
  186. for (p = (char *)spec ; *p ; ) {
  187. if (*fmt == *p) {
  188. flag[p-spec] = *fmt++;
  189. p = (char *)spec; /* restart scan */
  190. } else {
  191. p++;
  192. }
  193. }
  194. if (!flag[FLAG_PLUS]) {
  195. flag[FLAG_PLUS] = flag[FLAG_SPACE];
  196. }
  197. /* process optional width and precision */
  198. do {
  199. if (*fmt == '.') {
  200. ++fmt;
  201. dpoint = 1;
  202. }
  203. if (*fmt == '*') { /* parameter width value */
  204. ++fmt;
  205. i = va_arg(ap, int);
  206. } else {
  207. for ( i = 0 ; (*fmt >= '0') && (*fmt <= '9') ; ++fmt ) {
  208. i = (i * 10) + (*fmt - '0');
  209. }
  210. }
  211. if (dpoint) {
  212. preci = i;
  213. if (i<0) {
  214. preci = -5;
  215. }
  216. } else {
  217. width = i;
  218. if (i<0) {
  219. width = -i;
  220. flag[FLAG_MINUS_LJUSTIFY] = 1;
  221. }
  222. }
  223. } while ((*fmt == '.') && !dpoint );
  224. /* process optional qualifier */
  225. for (p = (char *) qual ; *p ; p++) {
  226. if (*p == *fmt) {
  227. lval = p - qual;
  228. ++fmt; /* TODO - hh */
  229. if ((*p == 'l') && (*fmt == *p)) {
  230. ++lval;
  231. ++fmt;
  232. }
  233. }
  234. }
  235. #if WANT_GNU_ERRNO
  236. if (*fmt == 'm') {
  237. flag[FLAG_PLUS] = '\0';
  238. flag[FLAG_0_PAD] = ' ';
  239. p = strerror(errno);
  240. goto print;
  241. }
  242. #endif
  243. /* process format specifier */
  244. for (p = (char *) u_spec ; *p ; p++) {
  245. if (*fmt != *p) continue;
  246. if (p-u_spec < 1) { /* print a % */
  247. goto charout;
  248. }
  249. if (p-u_spec < 2) { /* store output count in int ptr */
  250. *(va_arg(ap, int *)) = cnt;
  251. goto nextfmt;
  252. }
  253. if (p-u_spec < 8) { /* unsigned conversion */
  254. radix = u_radix[p-u_spec-2];
  255. upcase = ((*p == 'x') ? __UIM_LOWER : __UIM_UPPER);
  256. if (*p == 'p') {
  257. lval = (sizeof(char *) == sizeof(long));
  258. upcase = __UIM_LOWER;
  259. flag[FLAG_HASH] = 'p';
  260. }
  261. p = _uintmaxtostr((tmp + sizeof(tmp) - 1),
  262. ((lval>1) /* TODO -- longlong/long/int/short/char */
  263. ? va_arg(ap, uintmax_t)
  264. : (uintmax_t)
  265. va_arg(ap, unsigned long)),
  266. radix, upcase);
  267. flag[FLAG_PLUS] = '\0'; /* meaningless for unsigned */
  268. if (*p != '0') { /* non-zero */
  269. if (flag[FLAG_HASH]) {
  270. if (radix == 8) {
  271. *--p = '0'; /* add leadding zero */
  272. } else if (radix != 10) { /* either 2 or 16 */
  273. flag[FLAG_PLUS] = '0';
  274. *--p = 'b';
  275. if (radix == 16) {
  276. *p = 'x';
  277. if (*fmt == 'X') {
  278. *p = 'X';
  279. }
  280. }
  281. }
  282. }
  283. } else if (flag[FLAG_HASH] == 'p') { /* null pointer */
  284. p = "(nil)";
  285. }
  286. } else if (p-u_spec < 10) { /* signed conversion */
  287. p = _uintmaxtostr((tmp + sizeof(tmp) - 1),
  288. ((lval>1) /* TODO -- longlong/long/int/short/char */
  289. ? va_arg(ap, uintmax_t)
  290. : (uintmax_t) ((long long) /* sign-extend! */
  291. va_arg(ap, long))),
  292. -radix, upcase);
  293. } else if (p-u_spec < 12) { /* character or string */
  294. flag[FLAG_PLUS] = '\0';
  295. flag[FLAG_0_PAD] = ' ';
  296. if (*p == 'c') { /* character */
  297. p = tmp;
  298. *p = va_arg(ap, int);
  299. /* This takes care of the "%c",0 case */
  300. len = 1;
  301. goto print_len_set;
  302. } else { /* string */
  303. p = va_arg(ap, char *);
  304. if (!p) {
  305. p = "(null)";
  306. preci = 6;
  307. } else {
  308. if (preci < 0) {
  309. preci = INT_MAX;
  310. }
  311. }
  312. len = strnlen(p, preci);
  313. goto print_len_set;
  314. }
  315. #if defined(__UCLIBC_HAS_FLOATS__) || WANT_FLOAT_ERROR
  316. } else if (p-u_spec < 27) { /* floating point */
  317. #endif /* defined(__UCLIBC_HAS_FLOATS__) || WANT_FLOAT_ERROR */
  318. #if defined(__UCLIBC_HAS_FLOATS__)
  319. struct printf_info info;
  320. if (preci < 0) {
  321. preci = 6;
  322. }
  323. info.width = width;
  324. info.prec = preci;
  325. info.spec = *fmt;
  326. info.pad = flag[FLAG_0_PAD];
  327. info._flags = 0;
  328. if (flag[FLAG_PLUS] == '+') {
  329. PRINT_INFO_SET_FLAG(&info,showsign);
  330. } else if (flag[FLAG_PLUS] == ' ') {
  331. PRINT_INFO_SET_FLAG(&info,space);
  332. }
  333. if (flag[FLAG_HASH]) {
  334. PRINT_INFO_SET_FLAG(&info,alt);
  335. }
  336. if (flag[FLAG_MINUS_LJUSTIFY]) {
  337. PRINT_INFO_SET_FLAG(&info,left);
  338. }
  339. cnt += _dtostr(op,
  340. ((lval > 1)
  341. ? va_arg(ap, long double)
  342. : (long double) va_arg(ap, double)),
  343. &info);
  344. goto nextfmt;
  345. #elif WANT_FLOAT_ERROR
  346. (void) ((lval > 1) ? va_arg(ap, long double)
  347. : va_arg(ap, double)); /* carry on */
  348. p = (char *) dbl_err;
  349. #endif /* defined(__UCLIBC_HAS_FLOATS__) */
  350. }
  351. #if WANT_GNU_ERRNO
  352. print:
  353. #endif
  354. { /* this used to be printfield */
  355. /* cheaper than strlen call */
  356. /* for ( len = 0 ; p[len] ; len++ ) { } */
  357. len = strnlen(p, SIZE_MAX);
  358. print_len_set:
  359. if ((*p == '-')
  360. #if WANT_GNU_ERRNO
  361. && (*fmt != 'm')
  362. #endif
  363. && (*fmt != 's')) {
  364. flag[FLAG_PLUS] = *p++;
  365. --len;
  366. }
  367. if (flag[FLAG_PLUS]) {
  368. ++len;
  369. ++preci;
  370. if (flag[FLAG_PLUS] == '0') { /* base 16 */
  371. ++preci; /* account for x or X */
  372. }
  373. }
  374. if (preci >= 0) {
  375. if ((*fmt == 's')
  376. #if WANT_GNU_ERRNO
  377. || (*fmt == 'm')
  378. #endif
  379. ) {
  380. if (len > preci) {
  381. len = preci;
  382. } else {
  383. preci = len;
  384. }
  385. }
  386. preci -= len;
  387. if (preci < 0) {
  388. preci = 0;
  389. }
  390. width -= preci;
  391. }
  392. width -= len;
  393. if (width < 0) {
  394. width = 0;
  395. }
  396. if (preci < 0) {
  397. preci = 0;
  398. if (!flag[FLAG_MINUS_LJUSTIFY]
  399. /* && flag[FLAG_PLUS] */
  400. && (flag[FLAG_0_PAD] == '0')) {
  401. preci = width;
  402. width = 0;
  403. }
  404. }
  405. while (width + len + preci) {
  406. unsigned char ch;
  407. /* right padding || left padding */
  408. if ((!len && !preci)
  409. || (width && !flag[FLAG_MINUS_LJUSTIFY])) {
  410. ch = ' ';
  411. --width;
  412. } else if (flag[FLAG_PLUS]) {
  413. ch = flag[FLAG_PLUS]; /* sign */
  414. if (flag[FLAG_PLUS]=='0') { /* base 16 case */
  415. flag[FLAG_PLUS] = *p++; /* get the x|X */
  416. } else {
  417. flag[FLAG_PLUS] = '\0';
  418. }
  419. --len;
  420. } else if (preci) {
  421. ch = '0';
  422. --preci;
  423. } else {
  424. ch = *p++; /* main field */
  425. --len;
  426. }
  427. ++cnt;
  428. putc(ch, op);
  429. }
  430. }
  431. goto nextfmt;
  432. }
  433. fmt = fmt0; /* this was an illegal format */
  434. }
  435. charout:
  436. ++cnt;
  437. putc(*fmt, op); /* normal char out */
  438. nextfmt:
  439. ++fmt;
  440. }
  441. i = (__FERROR(op)) ? -1 : cnt;
  442. __STDIO_THREADLOCK(op);
  443. return i;
  444. }