Subversion Repositories thor

//#include "c:\AtlysCores\RTF65000\trunk\software\stdio.h"
extern pascal int prtdbl(double,int,int,char E);
 
typedef union tagval {
    __int64 i;
    double d;
} uval;
 
pascal void putch(char ch)
{
	asm {
		addui	sp,sp,#-8
		sw		r6,[sp]
		lw		r1,32[bp]
		ldi     r6,#14    ; Teletype output function
        sys     #10       ; Video BIOS call
        lw		r6,[sp]
		addui	sp,sp,#8
	}
}
 
pascal void putnum(int num, int wid, char sep, char padchar)
{
	int n, m10;
	char sign;
	static char numwka[200];
 
        asm {
            ldi   r1,#80
            sc    r1,hs:LEDS
        }
	if (wid < 0 or wid > 200)	// take care of nutty parameter
		wid = 0;
	sign = num < 0 ? '-' : '+';
	if (num < 0) num = -num;
	n = 0;
	do {
		if ((n % 4)==3 && sep) {
			numwka[n]=sep;
			n++;
		}
		m10 = num % 10;
		numwka[n] = m10 + '0';
		num = num / 10;
		n++;
	} until (num == 0 or n > 18);
	if (sign=='-') {
		numwka[n] = sign;
		n++;
	}
        asm {
            ldi   r1,#88
            sc    r1,hs:LEDS
        }
	for (; n < wid; wid--)
		putch(padchar);
        asm {
            ldi   r1,#89
            sc    r1,hs:LEDS
        }
	while (n > 0) {
		--n;
		putch(numwka[n]);
	}
        asm {
            ldi   r1,#90
            sc    r1,hs:LEDS
        }
}
 
pascal void puthexnum(int num, int wid, int ul, char padchar)
{
	int n, m;
	char sign;
	char numwka[200];
 
	if (wid < 0 or wid > 200)	// take care of nutty parameter
		wid = 0;
	n = 0;
	sign = num < 0 ? '-' : '+';
	if (num < 0) num = -num;
	do {
		m = num & 15;
		if (m < 10)
			numwka[n] = m + '0';
		else if (ul)
			numwka[n] = m + 'A'-10;
		else
			numwka[n] = m + 'a'-10;
		num = num >> 4;
		n++;
	}
	while (num != 0 && n < 18);
	if (sign=='-') {
		numwka[n] = sign;
		n++;
	}
	while (n < wid) {
		putch(sign=='-' ? ' ' : padchar);
		wid--;
	}
	while (n > 0) {
		--n;
		putch(numwka[n]);
	}
}
 
pascal int putstr(char *p, int maxchars)
{
	char *q;
 
	for (q = p; *p && maxchars > 0; p++, maxchars--)
		putch(*p);
	return p-q;
}
 
pascal void putstr2(char *p)
{
    asm {
		addui	sp,sp,#-8
		sw		r6,[sp]
        lw      r1,24[bp]
        ldi     r6,#$1B   ; Video BIOS DisplayString16 function
        sys     #10
		lw		r6,[sp]
		addui	sp,sp,#8
    }
}
 
int getcharNoWait()
{
    return KeybdGetBufferedCharNoWait();
}
 
/*
naked int getcharNoWait()
{
	asm {
        push    lr
        bsr     KeybdGetBufferedCharNoWait_
        pop     lr
        rtl
        push    r6
        ld      r6,#3    ; KeybdGetCharNoWait
        sys     #10
        pop     r6
        rtl
	}
}
*/
 
int (getchar)()
{
	int ch;
 
	do {
		ch = getcharNoWait();
	}
	while (ch==-1);
	return ch & 255;
}
 
 
int printf(char *p, ...)
{
	int *q;
	int fmtwidth;
	int maxwidth;
	int wd;
	uval v;
	char padchar;
	q = &p;
 
	for (; *p; p++) {
        padchar = ' ';
		if (*p=='%') {
			fmtwidth = 0;
			maxwidth = 65535;
			p++;
j1:
			switch(*p) {
			case '%':
				putch('%');
				break;
			case 'c':
				q++;
				putch(*q);
				break;
			case 'd':
				q++;
				putnum(*q,fmtwidth,0,padchar);
				break;
			case 'e':
            case 'E':
				q++;
				v.i = *q;
				prtdbl(v.d,fmtwidth,maxwidth,*p);
				break;
			case 'x':
				q++;
				puthexnum(*q,fmtwidth,0,padchar);
				break;
			case 'X':
				q++;
				puthexnum(*q,fmtwidth,1,padchar);
				break;
			case 's':
				q++;
				wd = putstr(*q,maxwidth);
				//while (wd < fmtwidth) {
				//	putch(' ');
				//	wd++;
				//}
				break;
			// width specification
			case '0':
                padchar = '0';
            case '1','2','3','4','5','6','7','8','9':
				fmtwidth = *p - '0';
				p++;
				while (isdigit(*p)) { 
					fmtwidth *= 10;
					fmtwidth += *p - '0';
					p++;
				}
				if (*p != '.')
					goto j1;
			case '.':
				p++;
				if (!isdigit(*p))
					goto j1;
				maxwidth = *p - '0';
				p++;
				while (isdigit(*p)) {
					maxwidth *= 10;
					maxwidth += *p - '0';
					p++;
				}
				goto j1;
			}
		}
		else
			putch(*p);
	}
}