#include "mb91465k.h"

#pragma section CODE=IRAM,attr=CODE
const char ASCII[] = "0123456789ABCDEF";

void InitUart4(void)
{
	// Initialize UART asynchronous mode
	BGR04 = 416; // 38400 Baud @ 16MHz
	SCR04 = 0x17; // 8N1
	SMR04 = 0x0d; // enable SOT3, Reset, normal mode
	SSR04 = 0x00; // LSB first
	PFR19 = (PFR19 & 0xFC) | 0x03; // enable UART: SIN,SOT for async. transfer
	EPFR19 = 0x00; // enable UART
}

void Putch4(unsigned char ch) /* sends a char */
{
	while (SSR04_TDRE == 0); /* wait for transmit buffer empty */
	TDR04 = ch; /* put ch into buffer */
}

unsigned char Getch4(void) /* waits for and returns incomming char 	*/
{
	volatile unsigned ch;
	for(;;) {
		while(SSR04_RDRF == 0) /* wait for data received */
			HWWD = 0x00;
		ch = RDR04;

		if ((SSR04 & 0xE0) != 0) { /* Check for errors PE, ORE, FRE */
			SCR04_CRE = 1; /* Clear error flags */
		} else {
			return (ch); /* return char*/
		}
	}
}


void Puts4(const char *Name2)
{
	volatile int i,len;
	len = strlen(Name2);
	
	for(i=0; i<strlen(Name2); i++) {
	if(Name2[i] == 10)
		Putch4(13);
	Putch4(Name2[i]);
	}
}


void Puthex4(unsigned long n, unsigned char digits)
{
	unsigned char digit=0,div=0,i;

	div=(4*(digits-1));	/* init shift divisor */
	for (i=0;i<digits;i++) {
		digit = ((n >> div)&0xF); /* get hex-digit value */
		Putch4(digit + ((digit < 0xA) ? '0' : 'A' - 0xA));
		div-=4; /* next digit shift */
	}
}

void Putdec4(unsigned long x, int digits)
{
	int i;
	char buf[10],sign=1;
	
	if (digits < 0) {     /* should be print of zero? */
		digits *= (-1);
		sign =1;
	}  
	buf[digits]='\0';			/* end sign of string */
	
	for (i=digits; i>0; i--) {
		buf[i-1] = ASCII[x % 10]; // + '0' enough? :o
		x = x/10;
	}

	if (sign) {
		for (i=0; buf[i]=='0'; i++) { /* no print of zero */
			if ( i<digits-1)
				buf[i] = ' ';
		}
	}
	Puts4(buf); /* send string */
}