123 lines
1.9 KiB
C
123 lines
1.9 KiB
C
|
#include <system.h>
|
||
|
#include "data.h"
|
||
|
|
||
|
int mysprint( fmt, args)
|
||
|
char *fmt;
|
||
|
int args;
|
||
|
{
|
||
|
return( _myformat( fmt, &args));
|
||
|
}
|
||
|
|
||
|
char *long2str();
|
||
|
|
||
|
static int integral(c)
|
||
|
{
|
||
|
switch (c) {
|
||
|
case 'b':
|
||
|
return -2;
|
||
|
case 'd':
|
||
|
return 10;
|
||
|
case 'o':
|
||
|
return -8;
|
||
|
case 'u':
|
||
|
return -10;
|
||
|
case 'x':
|
||
|
return -16;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int _myformat( fmt, argp)
|
||
|
char *fmt;
|
||
|
char *argp;
|
||
|
{
|
||
|
register char *pf = fmt, *pa = argp;
|
||
|
register char *pb = string;
|
||
|
int n = 0;
|
||
|
|
||
|
while (*pf) {
|
||
|
if (*pf == '%') {
|
||
|
register width, base, pad, npad, s_l;
|
||
|
char *arg;
|
||
|
char cbuf[2];
|
||
|
char *badformat = "<bad format>";
|
||
|
|
||
|
/* get padder */
|
||
|
if (*++pf == '0') {
|
||
|
pad = '0';
|
||
|
++pf;
|
||
|
}
|
||
|
else
|
||
|
pad = ' ';
|
||
|
|
||
|
/* get width */
|
||
|
width = 0;
|
||
|
while (*pf >= '0' && *pf <= '9')
|
||
|
width = 10 * width + *pf++ - '0';
|
||
|
|
||
|
/* get text and move pa */
|
||
|
if (*pf == 's') {
|
||
|
arg = *(char **)pa;
|
||
|
pa += sizeof(char *);
|
||
|
}
|
||
|
else
|
||
|
if (*pf == 'c') {
|
||
|
cbuf[0] = * (int *) pa;
|
||
|
cbuf[1] = '\0';
|
||
|
pa += sizeof(int);
|
||
|
arg = &cbuf[0];
|
||
|
}
|
||
|
else
|
||
|
if (*pf == 'l') {
|
||
|
/* alignment ??? */
|
||
|
if (base = integral(*++pf)) {
|
||
|
arg = long2str(*(long *)pa, base);
|
||
|
pa += sizeof(long);
|
||
|
}
|
||
|
else {
|
||
|
pf--;
|
||
|
arg = badformat;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
if (base = integral(*pf)) {
|
||
|
arg = long2str((long)*(int *)pa, base);
|
||
|
pa += sizeof(int);
|
||
|
}
|
||
|
else
|
||
|
if (*pf == '%')
|
||
|
arg = "%";
|
||
|
else
|
||
|
arg = badformat;
|
||
|
|
||
|
s_l = strlen( arg);
|
||
|
npad = width - s_l;
|
||
|
if ( npad > 0)
|
||
|
s_l += npad;
|
||
|
|
||
|
if ( n + s_l + string - string_area >= size_string) {
|
||
|
mem_string();
|
||
|
pb = string + n;
|
||
|
}
|
||
|
|
||
|
while (npad-- > 0)
|
||
|
*pb++ = pad;
|
||
|
|
||
|
while (*pb++ = *arg++);
|
||
|
n += s_l;
|
||
|
|
||
|
pb--;
|
||
|
pf++;
|
||
|
}
|
||
|
else {
|
||
|
if ( n + ( string - string_area) >= size_string) {
|
||
|
mem_string();
|
||
|
pb = string + n;
|
||
|
}
|
||
|
n++;
|
||
|
*pb++ = *pf++;
|
||
|
}
|
||
|
}
|
||
|
return n ;
|
||
|
}
|