static void divOut(unsigned int div) {
unsigned char dgt=0;
num &= 0xffff; // just for testing the code with 32 bit ints
while (num>=div) {
num -= div;
dgt++;
}
if (zs || dgt>0)
outDgt(dgt);
}
static void divOut(const unsigned int d)
{
unsigned char dgt = 0;
while (num >= d) {
num -= d;
dgt++;
}
if (zs || dgt > 0)
outDgt(dgt);
}
void tfp_printf(char *fmt, ...)
{
va_list va;
char ch;
char* p;
va_start(va,fmt);
while ((ch=*(fmt++))) {
if (ch!='%') {
putchar_lcd(ch);
}
else {
char lz=0;
char w=0;
ch=*(fmt++);
if (ch=='0') {
ch=*(fmt++);
lz=1;
}
if (ch>='0' && ch<='9') {
w=0;
while (ch>='0' && ch<='9') {
w=(((w<<2)+w)<<1)+ch-'0';
ch=*fmt++;
}
}
bf=buf;
p=bf;
zs=0;
switch (ch) {
case 0:
goto abort;
case 'u':
case 'd' :
num=va_arg(va, unsigned int);
if (ch=='d' && (int)num<0) {
num = -(int)num;
out('-');
}
divOut(10000);
divOut(1000);
divOut(100);
divOut(10);
outDgt(num);
break;
case 'x':
case 'X' :
uc= ch=='X';
num=va_arg(va, unsigned int);
divOut(0x1000);
divOut(0x100);
divOut(0x10);
outDgt(num);
break;
case 'c' :
out((char)(va_arg(va, int)));
break;
case 's' :
p=va_arg(va, char*);
break;
case '%' :
out('%');
default:
break;
}
*bf=0;
bf=p;
while (*bf++ && w > 0)
w--;
while (w-- > 0)
putchar_lcd(lz ? '0' : ' ');
while ((ch= *p++))
putchar_lcd(ch);
}
}
abort:;
va_end(va);
}
