#include "oled.h"
#define  MAX_NUMBER_BYTES  64

//==================================================================================================
typedef char *  oled_va_list;
#define _INTSIZEOF(n)   ( (sizeof(n) + sizeof(int) - 1) & ~(sizeof(int) - 1) )

#define va_start(ap,v)  ( ap = (oled_va_list)&v + _INTSIZEOF(v) )
#define va_arg(ap,t)    ( *(t *)((ap += _INTSIZEOF(t)) - _INTSIZEOF(t)) )
//#define va_arg(ap,t)    ( *(t *)( ap=ap + _INTSIZEOF(t), ap- _INTSIZEOF(t)) )
#define va_end(ap)      ( ap = (oled_va_list)0 )

//==================================================================================================
unsigned char oled_hex_tab[]={'0','1','2','3','4','5','6','7',\
		                 '8','9','a','b','c','d','e','f'};


static void out_num(int page,int col,long n, int base,char lead,int maxwidth) 
{
	unsigned long m=0;
	char buf[MAX_NUMBER_BYTES];
	char *s = buf + sizeof(buf);
	int count=0,i=0;
			

	*--s = '\0';
	
	if (n < 0){
		m = -n;
	}
	else{
		m = n;
	}
	
	do{
		*--s = oled_hex_tab[m%base];
		count++;
	}while ((m /= base) != 0);
	
	if( maxwidth && count < maxwidth){
		for (i=maxwidth - count; i; i--)	
			*--s = lead;
}

	if (n < 0)
		*--s = '-';

	OLEDPrint(page, col, s);
}
   

/*reference :   int vprintf(const char *format, t_va_list ap); */
static int oled_my_vprintf(int page,int col,char *fmt, oled_va_list ap) 
{
	char lead=' ';
	int  maxwidth=0;
	
	 for(; *fmt != '\0'; fmt++)
	 {
		if (*fmt != '%') {
			OLEDPutChar(page, col, *fmt);
			col = col+8;
			if (col > 127) /* »»ÐÐ */
			{
				col = 0;
				page = page+16;
			}
			continue;
		}
		lead=' ';
		maxwidth=0;

		    fmt++;
		if(*fmt == '0'){
			lead = '0';
			fmt++;	
		}
		
		while(*fmt >= '0' && *fmt <= '9'){
			maxwidth *=10;
			maxwidth += (*fmt - '0');
			fmt++;
		}
		
		switch (*fmt) 
		{
		case 'd': out_num(page,col,va_arg(ap, int),          10,lead,maxwidth); break;
		case 'o': out_num(page,col,va_arg(ap, unsigned int),  8,lead,maxwidth); break;				
		case 'u': out_num(page,col,va_arg(ap, unsigned int), 10,lead,maxwidth); break;
		case 'x': out_num(page,col,va_arg(ap, unsigned int), 16,lead,maxwidth); break;
		case 'c': OLEDPutChar(page, col, *fmt);
					col = col+8;
					if (col > 127) /* »»ÐÐ */
					{
						col = 0;
						page = page+16;
					}
					break;
		case 's': OLEDPrint(page, col, va_arg(ap, char *));
					break;	
			
		default: OLEDPutChar(page, col, *fmt);
				col = col+8;
				if (col > 127) /* »»ÐÐ */
				{
					col = 0;
					page = page+16;
				}
				break;
		}
	}
	return 0;
}


//reference :  int printf(const char *format, ...); 
int oled_printf(int page,int col,char *fmt,...) 
{
	oled_va_list ap;

	va_start(ap, fmt);
	oled_my_vprintf(page,col,fmt, ap);	
	va_end(ap);
	return 0;
}

