You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
52 lines
1.0 KiB
52 lines
1.0 KiB
12 years ago
|
/* led.c */
|
||
|
|
||
|
#include "led.h"
|
||
|
#include "timer.h"
|
||
|
|
||
|
#define FP0XVAL (*((volatile unsigned int *) 0x3FFFC014))
|
||
|
|
||
|
led_pattern *led_current_pattern;
|
||
|
led_pattern *led_current_pointer;
|
||
|
unsigned int led_next_time;
|
||
|
bool led_next_state;
|
||
|
|
||
|
led_pattern led_pattern_active[] = {250, 250, 0};
|
||
|
|
||
|
void led_set(bool on)
|
||
|
{
|
||
|
if (on)
|
||
|
FP0XVAL |= 0x04000000;
|
||
|
else
|
||
|
FP0XVAL &= ~0x04000000;
|
||
|
}
|
||
|
|
||
|
void led_update(void)
|
||
|
{
|
||
|
unsigned int time = timer_read();
|
||
|
|
||
|
/* This should never be possible, but let's just be sure. */
|
||
|
if (!led_current_pattern)
|
||
|
return;
|
||
|
if (!led_current_pointer)
|
||
|
return;
|
||
|
|
||
|
if (((signed int) (((signed int)led_next_time)-time)) > 0)
|
||
|
return;
|
||
|
|
||
|
led_set(led_next_state);
|
||
|
led_next_state = !led_next_state;
|
||
|
led_next_time += *led_current_pointer * TIMER_MS;
|
||
|
led_current_pointer++;
|
||
|
if (*led_current_pointer == 0)
|
||
|
led_current_pointer = led_current_pattern;
|
||
|
}
|
||
|
|
||
|
void led_set_pattern(led_pattern *pattern)
|
||
|
{
|
||
|
led_current_pattern = pattern;
|
||
|
led_current_pointer = pattern;
|
||
|
led_next_state = TRUE;
|
||
|
led_next_time = timer_read();
|
||
|
led_update();
|
||
|
}
|