1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
|
#include <stdarg.h>
#include <kogata/printf.h>
int snprintf(char * buff, size_t len, const char *format, ...) {
va_list ap;
va_start(ap, format);
len = vsnprintf(buff, len, format, ap);
va_end(ap);
return len;
}
int vsnprintf(char *buff, size_t len, const char* format, va_list ap){
size_t i, result;
if (!buff || !format)
return -1;
#define PUTCHAR(thechar) \
do { \
if (result < len-1) \
*buff++ = (thechar); \
result++; \
} while (0)
result = 0;
for(i = 0; format[i] != '\0' ; i++) {
if (format[i] == '%') {
i++;
switch(format[i]) {
case '%':
PUTCHAR('%');
break;
case 'i':;
case 'd': {
int integer = va_arg(ap,int);
int cpt2 = 0;
char buff_int[16];
if (integer<0)
PUTCHAR('-');
do {
int m10 = integer%10;
m10 = (m10 < 0)? -m10:m10;
buff_int[cpt2++] = (char)('0'+ m10);
integer = integer/10;
} while(integer != 0);
for(cpt2 = cpt2 - 1; cpt2 >= 0; cpt2--)
PUTCHAR(buff_int[cpt2]);
break;
}
case 'c': {
int value = va_arg(ap,int);
PUTCHAR((char)value);
break;
}
case 's': {
char *string = va_arg(ap,char *);
if (!string)
string = "(null)";
for(; *string != '\0' ; string++)
PUTCHAR(*string);
break;
}
case 'x': {
unsigned int hexa = va_arg(ap,int);
int had_nonzero = 0;
for(int j = 0; j < 8; j++) {
unsigned int nb = (unsigned int)(hexa << (j*4));
nb = (nb >> 28) & 0xf;
// Skip the leading zeros
if (nb == 0) {
if (had_nonzero)
PUTCHAR('0');
} else {
had_nonzero = 1;
if (nb < 10)
PUTCHAR('0'+nb);
else
PUTCHAR('a'+(nb-10));
}
}
if (!had_nonzero)
PUTCHAR('0');
break;
}
case 'p': {
unsigned int hexa = va_arg(ap,int);
for (int j = 0; j < 8; j++) {
unsigned int nb = (unsigned int)(hexa << (j*4));
nb = (nb >> 28) & 0xf;
if (nb < 10)
PUTCHAR('0'+nb);
else
PUTCHAR('a'+(nb-10));
}
break;
}
default:
PUTCHAR('%');
PUTCHAR(format[i]);
}
} else {
PUTCHAR(format[i]);
}
}
*buff = '\0';
return result;
}
/* vim: set ts=4 sw=4 tw=0 noet :*/
|
