debug.c

来自「p89lpc915程序」· C语言 代码 · 共 63 行

#include <reg915.h>
#include "debug.h"
#include "comm.h"

#ifdef DEBUG_PRINTF
void PutChar(unsigned char ch)
{
/*jian add */
#if 1
	if(ch == '\n')
		{
		SBUF = '\r';
		while(TI == 0);
		TI = 0;
		}
/*end jian*/
#endif
		SBUF = ch;
		while(TI == 0);/*软件置0*/
		TI = 0;
}


void digit2char(uchar *dest, uchar data_dig)
{
    data_dig &= 0xf;
    if( data_dig<=9 && data_dig>= 0)
	*dest = data_dig +'0';
    else if(data_dig<=0xf && data_dig>= 0xa)
	*dest = data_dig - 0xa +'A';
    else
	*dest = ' ';
}


void tvbox_printf(unsigned char *buffer,unsigned char ch,unsigned char mode)
{
	uchar i;
	uchar buffer_vaule[2];
	for(i=0;i<20;i++)
		{
		if(buffer[i] == '\0')
			break;
		PutChar(buffer[i]);
		}
      
	digit2char(&buffer_vaule[0], (ch) >> 4);
	digit2char(&buffer_vaule[1], (ch) & 0xf);	
	PutChar(buffer_vaule[0]);
	PutChar(buffer_vaule[1]);
	if(mode == 1)
		{
		PutChar('\n');
		}
	else
		{
		PutChar(' ');
		}
}


#endif