sprintf.c 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145
  1. /* sprintf.c
  2. *
  3. */
  4. #include "common.h"
  5. #include "sprintf.h"
  6. #include "base64.h"
  7. #include <stdarg.h>
  8. static char *int_to_base10(int val)
  9. {
  10. static char buf_base10[17] = "";
  11. buf_base10[16] = 0;
  12. if (!val) {
  13. buf_base10[15] = '0';
  14. return buf_base10 + 15;
  15. }
  16. int p = 0;
  17. int i = 16;
  18. if (val < 0) {
  19. p = 1;
  20. val *= -1;
  21. }
  22. while (val) {
  23. i--;
  24. buf_base10[i] = '0' + (val % 10);
  25. val /= 10;
  26. }
  27. if (p) {
  28. i--;
  29. buf_base10[i] = '-';
  30. }
  31. return buf_base10 + i;
  32. }
  33. static char *unsigned_int_to_base10(unsigned int val)
  34. {
  35. static char buf_base10[16] = "";
  36. buf_base10[15] = 0;
  37. if (!val) {
  38. buf_base10[14] = '0';
  39. return buf_base10 + 14;
  40. }
  41. int i = 15;
  42. while (val) {
  43. i--;
  44. buf_base10[i] = '0' + (val % 10);
  45. val /= 10;
  46. }
  47. return buf_base10 + i;
  48. }
  49. size_t simple_vsnprintf(char *buf, size_t size, const char *format, va_list va)
  50. {
  51. char *s = NULL;
  52. char *fp = (char *) format;
  53. size_t c = 0;
  54. unsigned int i;
  55. while (*fp && c < size - 1) {
  56. if (*fp == '%') {
  57. fp++;
  58. switch (*fp) {
  59. case 's':
  60. s = va_arg(va, char *);
  61. break;
  62. case 'd':
  63. case 'i':
  64. i = va_arg(va, int);
  65. s = int_to_base10(i);
  66. break;
  67. case 'D':
  68. i = va_arg(va, int);
  69. s = int_to_base64((unsigned int) i);
  70. case 'u':
  71. i = va_arg(va, unsigned int);
  72. s = unsigned_int_to_base10(i);
  73. break;
  74. case '%':
  75. buf[c++] = *fp++;
  76. continue;
  77. case 'c':
  78. buf[c++] = (char) va_arg(va, int);
  79. fp++;
  80. continue;
  81. default:
  82. continue;
  83. }
  84. if (s)
  85. while (*s && c < size - 1)
  86. buf[c++] = *s++;
  87. fp++;
  88. } else
  89. buf[c++] = *fp++;
  90. }
  91. buf[c] = 0;
  92. return c;
  93. }
  94. size_t simple_vsprintf(char *buf, const char *format, va_list va)
  95. {
  96. return simple_vsnprintf(buf, VSPRINTF_MAXSIZE, format, va);
  97. }
  98. size_t simple_sprintf2 (char *buf, const char *format, ...)
  99. {
  100. size_t ret = 0;
  101. va_list va;
  102. va_start(va, format);
  103. ret = simple_vsprintf(buf, format, va);
  104. va_end(va);
  105. return ret;
  106. }
  107. size_t simple_sprintf (char *buf, const char *format, ...)
  108. {
  109. size_t ret = 0;
  110. va_list va;
  111. va_start(va, format);
  112. ret = simple_vsprintf(buf, format, va);
  113. va_end(va);
  114. return ret;
  115. }
  116. size_t simple_snprintf (char *buf, size_t size, const char *format, ...)
  117. {
  118. size_t ret = 0;
  119. va_list va;
  120. va_start(va, format);
  121. ret = simple_vsnprintf(buf, size, format, va);
  122. va_end(va);
  123. return ret;
  124. }