led.c

来自「Tornado的源代码资源包」· C语言 代码 · 共 31 行

/* --- LED IO addresses (only rGPBDAT is used) --- */
#define rGPBCON (*(volatile unsigned *) 0x56000010)
#define rGPBDAT (*(volatile unsigned *) 0x56000014)
#define rGPBUP  (*(volatile unsigned *) 0x56000018)


void Led_Display(int data)
{
	semTake(semLED,WAIT_FOREVER);
	rGPBDAT = (rGPBDAT & ~(0xf<<5)) | ((~data & 0xf)<<5);
	semGive(semLED);
}

/* Rotate LEDs */
int rotate_data[]={2,4,1,8};
void doRotate()
{
	int i,j;
	
	Led_Display(0);

	for(i=0;i<7;i++) {
		for(j=0;j<sizeof(rotate_data)/sizeof(int);j++) {
			Led_Display(rotate_data[j]);
			taskDelay(8);
		}
	}

	
}