#include "fx2.h"
#include "fx2regs.h"
#include "io.h"

BYTE const LED_CODE[] = {0xC0,0xF9,0xA4,0xB0,0x99,0x92,0x82,0xF8,0x80,0x90,0x88,0x83,0xA7,0xA1,0x86,0x8E,0xFF}; //LED編碼
//						 0     1    2    3    4    5    6    7	  8    9    A    b    c    d    E    F	       			
BYTE DispBuf[4];
BYTE code Bit_No[4] = {0xfe,0xfd,0xfb,0xf7} ;

void Led_Display()
{
	BYTE i,j;
	
	for(i = 0; i < 4; i++)
	{
		*LED_CS = 0xFF;
		if(DispBuf[i] >= 0x80)
		{
			*LED_SEG = LED_CODE[DispBuf[i]-0x80]&0x7F ;
		}
		else
		{
			*LED_SEG = LED_CODE[DispBuf[i]];
		}
		*LED_CS = Bit_No[i];
		for(j=0;j<200;j++) ;
	}
	*LED_CS = 0xFF;
}

void Disp_Init()
{
	BYTE i;
	
	for(i = 0; i < 4; i++)
	{
		DispBuf[i] = 0;
	}
	*LED_SEG = 0xFF;
	*LED_CS = 0xFF;
}