//-----------------------------------------------
//-	フォーマット出力処理			-
//-	printfのサブセットである、書式		-
//-	付きの出力を行なう			-
//-----------------------------------------------
// printf
//-  Copyright(c) by M.Kuwano(PastelMagic)	-
//-	All Rights Reserved			-
//-----------------------------------------------
// xprint for ImageCraftC modify by K.I 090516
// - Add outfunc parameter.
// - Correct DWORD output probrem.
// - Add 'S'option for output RAM string
//-----------------------------------------------

#include "ctype.h"
#include "cstdef.h"
#include <stdlib.h>

static void (*print_chr)(unsigned char c);	//// for xprintf by K.I
////extern void print_chr(unsigned char c);

union	DATAS {
	float		fdat;
	unsigned long	dword;
	unsigned int	word[2];
	unsigned char	byte[4];
};

static unsigned int param[4];
static union DATAS udat;
static unsigned char tbuf[24];	////

static unsigned int slen(const unsigned char	*s)
{
	unsigned int	len;
	for (len=0; *s; len++,s++)
		;
	return(len);
}


static void print_str(const unsigned char *c)
{
	while(*c)
		print_chr(*c++);
}

static void print_strx(unsigned char *c)	//// add for RAM string by K.I
{
	while(*c)
		print_chr(*c++);
}

static void print_pads(
	int		width,
	unsigned int	padchar)
{
	while(width-- > 0)
		print_chr(padchar);
}

static void print_val(unsigned int	width,
	  unsigned int  padchar,
	  unsigned int  base,
	  unsigned int  lflag,		//// add lflag by K.I
	  union	DATAS	data)
{
	unsigned int	datwidth;
	unsigned char	*p;

	p = tbuf;
////	if (data.word[1]) {										/* ３２ビットデータ			*/
	if (lflag) {				//// judge by lflag by K.I
		for (datwidth=0; data.dword>0; datwidth++) {
			if ((*p = (unsigned char )((data.dword % base) + '0')) > '9')
				*p += (unsigned char)('A'-'0'-10);
			p++;
			data.dword /= base;
		}
	}
	else {													/* １６ビットデータ			*/
		for (datwidth=0; data.word[0]>0; datwidth++) {
			if ((*p = (unsigned char )((data.word[0] % base) + '0')) > '9')
				*p += (unsigned char)('A'-'0'-10);
			p++;
			data.word[0] /= base;
		}
	}
	if (datwidth == 0) {
		*p++ = '0';
		datwidth = 1;
	}
	print_pads(width-datwidth,padchar);
	while(datwidth--)
		print_chr(*--p);
}

static void prtout(
	const unsigned char	*string,
	unsigned int	*param)
{
	unsigned char padchar;
	unsigned char *cp;
	float *fp;
	unsigned int	width,longflag;
	int	status;

	while(*string) {
		if (*string == LF) {
			print_chr(CR);
			print_chr(LF);
			string++;
			continue;
		}
		if (*string != '%') {
			print_chr(*string++);
			continue;
		}
		string++;
		padchar = *string;
		if (padchar == '0')
			string++;
		else	padchar = ' ';
		for (width = 0; isdigit(*string); width = width*10+(*string++ - '0'))
			;
		if (!width)
			width++;
		if (longflag = (*string == 'L') || (*string == 'l')) {
				string++;
				udat.word[1] = *param--;
		} else	udat.word[1] = 0;
		switch(*string) {
			case	'b':
			case	'B':	udat.word[0] = *param--;
					print_val(width,padchar,2,longflag,udat);	//// add lflag by K.I
					break;
			case	'o':
			case	'O':	udat.word[0] = *param--;
					print_val(width,padchar,8,longflag,udat);	//// add lflag by K.I
					break;
			case	'u':
			case	'U':	udat.word[0] = *param--;
					print_val(width,padchar,10,longflag,udat);	//// add lflag by K.I
					break;
			case	'd':
			case	'D':	udat.word[0] = *param--;
					print_val(width,padchar,10,longflag,udat);	//// add lflag by K.I
					break;
			case	'x':
			case	'X':	udat.word[0] = *param--;
					print_val(width,padchar,16,longflag,udat);	//// add lflag by K.I
					break;

			case	'f':	udat.word[1] = *param--;
					udat.word[0] = *param--;
					cp = ftoa(udat.fdat, &status);
					if (status != 0) break;
					while(*cp != EOS)
						print_chr(*cp++);
					break;

			case	'c':	print_pads(width-1,' ');
					print_chr(*param--);
					break;
			case	's':	width -= slen((const unsigned char *)(*param));
					print_pads(width,' ');
					print_str((const unsigned char *)(*param));
					param--;
					break;
			case	'S':	width -= slen((unsigned char *)(*param));	//// add 'S'option for RAM string by K.I
					print_pads(width,' ');
					print_strx((unsigned char *)(*param));
					param--;
					break;
			default:	print_chr('%');
					print_chr(*string);
					break;
		}
		string++;
	}
}

//// xprintf by K.I
void xprintf( void(*outfunc)(unsigned char c), const unsigned char *string, unsigned int arg)
////void printf(const unsigned char *string, unsigned int arg)
{
	print_chr = outfunc;	//// add outfunc for xprintf by K.I
	prtout(string, &arg);
}