testled.c

AT91fr40162的FLASH读写程序

#include "dtm.h"


U8 LED_stat;

void Sys_init(void)
{
	LED_stat=0;
	pCPLD[6]=LED_stat;
}


void LED_Green(U32 Status)
{
	if(Status==0){
		LED_stat|=4;	pCPLD[6]=LED_stat;
	}else{
		LED_stat&=~4;	pCPLD[6]=LED_stat;
	}
}

void LED_Red(U32 Status)
{
	if(Status==0){
		LED_stat|=8;	pCPLD[6]=LED_stat;
	}else{
		LED_stat&=~8;	pCPLD[6]=LED_stat;
	}
}

void DelayMs(void)
{
	U32 i;
	for(i=0; i<0x100000; i++){}
}

void TestLED(void)
{
   	U8 i;
	
	i=20;
	while(i-->0){
		LED_Green(0);	DelayMs();
		LED_Red(0);		DelayMs();
		LED_Green(1);	DelayMs();
		LED_Red(1);		DelayMs();
	}
}