1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * (C) Copyright 2000-2003
3*4882a593Smuzhiyun * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <common.h>
9*4882a593Smuzhiyun #include <status_led.h>
10*4882a593Smuzhiyun
11*4882a593Smuzhiyun /*
12*4882a593Smuzhiyun * The purpose of this code is to signal the operational status of a
13*4882a593Smuzhiyun * target which usually boots over the network; while running in
14*4882a593Smuzhiyun * U-Boot, a status LED is blinking. As soon as a valid BOOTP reply
15*4882a593Smuzhiyun * message has been received, the LED is turned off. The Linux
16*4882a593Smuzhiyun * kernel, once it is running, will start blinking the LED again,
17*4882a593Smuzhiyun * with another frequency.
18*4882a593Smuzhiyun */
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun /* ------------------------------------------------------------------------- */
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun typedef struct {
23*4882a593Smuzhiyun led_id_t mask;
24*4882a593Smuzhiyun int state;
25*4882a593Smuzhiyun int period;
26*4882a593Smuzhiyun int cnt;
27*4882a593Smuzhiyun } led_dev_t;
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun led_dev_t led_dev[] = {
30*4882a593Smuzhiyun { CONFIG_LED_STATUS_BIT,
31*4882a593Smuzhiyun CONFIG_LED_STATUS_STATE,
32*4882a593Smuzhiyun LED_STATUS_PERIOD,
33*4882a593Smuzhiyun 0,
34*4882a593Smuzhiyun },
35*4882a593Smuzhiyun #if defined(CONFIG_LED_STATUS1)
36*4882a593Smuzhiyun { CONFIG_LED_STATUS_BIT1,
37*4882a593Smuzhiyun CONFIG_LED_STATUS_STATE1,
38*4882a593Smuzhiyun LED_STATUS_PERIOD1,
39*4882a593Smuzhiyun 0,
40*4882a593Smuzhiyun },
41*4882a593Smuzhiyun #endif
42*4882a593Smuzhiyun #if defined(CONFIG_LED_STATUS2)
43*4882a593Smuzhiyun { CONFIG_LED_STATUS_BIT2,
44*4882a593Smuzhiyun CONFIG_LED_STATUS_STATE2,
45*4882a593Smuzhiyun LED_STATUS_PERIOD2,
46*4882a593Smuzhiyun 0,
47*4882a593Smuzhiyun },
48*4882a593Smuzhiyun #endif
49*4882a593Smuzhiyun #if defined(CONFIG_LED_STATUS3)
50*4882a593Smuzhiyun { CONFIG_LED_STATUS_BIT3,
51*4882a593Smuzhiyun CONFIG_LED_STATUS_STATE3,
52*4882a593Smuzhiyun LED_STATUS_PERIOD3,
53*4882a593Smuzhiyun 0,
54*4882a593Smuzhiyun },
55*4882a593Smuzhiyun #endif
56*4882a593Smuzhiyun #if defined(CONFIG_LED_STATUS4)
57*4882a593Smuzhiyun { CONFIG_LED_STATUS_BIT4,
58*4882a593Smuzhiyun CONFIG_LED_STATUS_STATE4,
59*4882a593Smuzhiyun LED_STATUS_PERIOD4,
60*4882a593Smuzhiyun 0,
61*4882a593Smuzhiyun },
62*4882a593Smuzhiyun #endif
63*4882a593Smuzhiyun #if defined(CONFIG_LED_STATUS5)
64*4882a593Smuzhiyun { CONFIG_LED_STATUS_BIT5,
65*4882a593Smuzhiyun CONFIG_LED_STATUS_STATE5,
66*4882a593Smuzhiyun LED_STATUS_PERIOD5,
67*4882a593Smuzhiyun 0,
68*4882a593Smuzhiyun },
69*4882a593Smuzhiyun #endif
70*4882a593Smuzhiyun };
71*4882a593Smuzhiyun
72*4882a593Smuzhiyun #define MAX_LED_DEV (sizeof(led_dev)/sizeof(led_dev_t))
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun static int status_led_init_done = 0;
75*4882a593Smuzhiyun
status_led_init(void)76*4882a593Smuzhiyun void status_led_init(void)
77*4882a593Smuzhiyun {
78*4882a593Smuzhiyun led_dev_t *ld;
79*4882a593Smuzhiyun int i;
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun for (i = 0, ld = led_dev; i < MAX_LED_DEV; i++, ld++)
82*4882a593Smuzhiyun __led_init (ld->mask, ld->state);
83*4882a593Smuzhiyun status_led_init_done = 1;
84*4882a593Smuzhiyun }
85*4882a593Smuzhiyun
status_led_tick(ulong timestamp)86*4882a593Smuzhiyun void status_led_tick (ulong timestamp)
87*4882a593Smuzhiyun {
88*4882a593Smuzhiyun led_dev_t *ld;
89*4882a593Smuzhiyun int i;
90*4882a593Smuzhiyun
91*4882a593Smuzhiyun if (!status_led_init_done)
92*4882a593Smuzhiyun status_led_init ();
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun for (i = 0, ld = led_dev; i < MAX_LED_DEV; i++, ld++) {
95*4882a593Smuzhiyun
96*4882a593Smuzhiyun if (ld->state != CONFIG_LED_STATUS_BLINKING)
97*4882a593Smuzhiyun continue;
98*4882a593Smuzhiyun
99*4882a593Smuzhiyun if (++ld->cnt >= ld->period) {
100*4882a593Smuzhiyun __led_toggle (ld->mask);
101*4882a593Smuzhiyun ld->cnt -= ld->period;
102*4882a593Smuzhiyun }
103*4882a593Smuzhiyun
104*4882a593Smuzhiyun }
105*4882a593Smuzhiyun }
106*4882a593Smuzhiyun
status_led_set(int led,int state)107*4882a593Smuzhiyun void status_led_set (int led, int state)
108*4882a593Smuzhiyun {
109*4882a593Smuzhiyun led_dev_t *ld;
110*4882a593Smuzhiyun
111*4882a593Smuzhiyun if (led < 0 || led >= MAX_LED_DEV)
112*4882a593Smuzhiyun return;
113*4882a593Smuzhiyun
114*4882a593Smuzhiyun if (!status_led_init_done)
115*4882a593Smuzhiyun status_led_init ();
116*4882a593Smuzhiyun
117*4882a593Smuzhiyun ld = &led_dev[led];
118*4882a593Smuzhiyun
119*4882a593Smuzhiyun ld->state = state;
120*4882a593Smuzhiyun if (state == CONFIG_LED_STATUS_BLINKING) {
121*4882a593Smuzhiyun ld->cnt = 0; /* always start with full period */
122*4882a593Smuzhiyun state = CONFIG_LED_STATUS_ON; /* always start with LED _ON_ */
123*4882a593Smuzhiyun }
124*4882a593Smuzhiyun __led_set (ld->mask, state);
125*4882a593Smuzhiyun }
126