blob: bdfd08406d645e0a0ecf3878d5d219765af64dcc (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
|
#include "project.h"
#define LED_BOARD GPIO13
#define LED_BOARD_PORT GPIOC
#define LED_YELLOW GPIO11
#define LED_YELLOW_PORT GPIOA
#define LED_GREEN1 GPIO12
#define LED_GREEN1_PORT GPIOA
#define LED_GREEN2 GPIO15
#define LED_GREEN2_PORT GPIOA
#define LED_RED GPIO3
#define LED_RED_PORT GPIOB
static unsigned led, yellow;
void led_red_set (int i)
{
if (i)
CLEAR (LED_RED);
else
SET (LED_RED);
}
void led_green1_set (int i)
{
if (i)
CLEAR (LED_GREEN1);
else
SET (LED_GREEN1);
}
void led_green2_set (int i)
{
if (i)
CLEAR (LED_GREEN2);
else
SET (LED_GREEN2);
}
static void _led_yellow_set (int i)
{
if (i)
CLEAR (LED_YELLOW);
else
SET (LED_YELLOW);
}
static void led_board_set (int i)
{
if (i)
CLEAR (LED_BOARD);
else
SET (LED_BOARD);
}
void led_blink (void)
{
led = MS_TO_TICKS (25);
}
void led_yellow_set (int i)
{
yellow = !!i;
}
void
led_tick (void)
{
if (led) {
led--;
led_board_set (1);
_led_yellow_set (!yellow);
} else {
led_board_set (0);
_led_yellow_set (yellow);
}
}
void
led_init (void)
{
MAP_OUTPUT_PP (LED_BOARD);
MAP_OUTPUT_PP (LED_RED);
MAP_OUTPUT_PP (LED_GREEN1);
MAP_OUTPUT_PP (LED_GREEN2);
MAP_OUTPUT_PP (LED_YELLOW);
CLEAR (LED_BOARD);
}
|