sprintf.c 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146
  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 = 0;
  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. break;
  71. case 'u':
  72. i = va_arg(va, unsigned int);
  73. s = unsigned_int_to_base10(i);
  74. break;
  75. case '%':
  76. buf[c++] = *fp++;
  77. continue;
  78. case 'c':
  79. buf[c++] = (char) va_arg(va, int);
  80. fp++;
  81. continue;
  82. default:
  83. continue;
  84. }
  85. if (s)
  86. while (*s && c < size - 1)
  87. buf[c++] = *s++;
  88. fp++;
  89. } else
  90. buf[c++] = *fp++;
  91. }
  92. buf[c] = '\0';
  93. return c;
  94. }
  95. size_t simple_vsprintf(char *buf, const char *format, va_list va)
  96. {
  97. return simple_vsnprintf(buf, VSPRINTF_MAXSIZE, format, va);
  98. }
  99. size_t simple_sprintf2 (char *buf, const char *format, ...)
  100. {
  101. size_t ret = 0;
  102. va_list va;
  103. va_start(va, format);
  104. ret = simple_vsprintf(buf, format, va);
  105. va_end(va);
  106. return ret;
  107. }
  108. size_t simple_sprintf (char *buf, const char *format, ...)
  109. {
  110. size_t ret = 0;
  111. va_list va;
  112. va_start(va, format);
  113. ret = simple_vsprintf(buf, format, va);
  114. va_end(va);
  115. return ret;
  116. }
  117. size_t simple_snprintf (char *buf, size_t size, const char *format, ...)
  118. {
  119. size_t ret = 0;
  120. va_list va;
  121. va_start(va, format);
  122. ret = simple_vsnprintf(buf, size, format, va);
  123. va_end(va);
  124. return ret;
  125. }