/********************************************************************************************
|
* File: led_beep.c
|
* Version: 1.0.0
|
* Copyright: 2011 (c) Guo Wenxue <guowenxue@gmail.com>
|
* Description: LED & Beep operate funciton.
|
* ChangeLog: 1, Release initial version on "Tue Jul 12 16:43:18 CST 2011"
|
*
|
*******************************************************************************************/
|
|
#include <common.h>
|
#define DELAY_TIME 1000000
|
|
/*LED & Beep */
|
#define GPBCON (*(unsigned long volatile *)0x56000010)
|
#define GPBDAT (*(unsigned long volatile *)0x56000014)
|
#define GPBUP (*(unsigned long volatile *)0x56000018)
|
|
inline void delay(unsigned long loops)
|
{
|
__asm__ volatile ("1:\n" "subs %0, %1, #1\n" "bne 1b":"=r" (loops):"0"(loops));
|
}
|
|
void init_led_beep(void)
|
{
|
/* Set GPB5,GPB6,GPB8,GPB10 as GPIO mode(0x01) */
|
GPBCON = (GPBCON | 0x333C03) & 0x111401;
|
GPBUP = (GPBUP | 0x560);
|
/* Set GPB5,GPB6,GPB8,GPB10 as high level, to turn LED0,LED1,LED2,LED3 off */
|
GPBDAT = (GPBDAT | 0x560);
|
}
|
|
void turn_led_on(int led)
|
{
|
GPBDAT = (GPBDAT & (~(1 << led)));
|
delay(DELAY_TIME);
|
}
|
|
void turn_led_off(int led)
|
{
|
/* Turn LED0 on */
|
GPBDAT = (GPBDAT | (1 << led));
|
delay(DELAY_TIME);
|
}
|
|
void beep(int count)
|
{
|
int i;
|
for (i = 0; i < count; i++)
|
{
|
GPBDAT |= 1 << BEEP; /* Set Beep GPIO as high level */
|
delay(DELAY_TIME * 50);
|
|
GPBDAT &= ~(1 << BEEP); /* Set Beep GPIO as low level */
|
delay(DELAY_TIME * 50);
|
}
|
}
|
