1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2a89c3a04SSimon Glass /*
3a89c3a04SSimon Glass * (C) Copyright 2010
4a89c3a04SSimon Glass * Jason Kridner <jkridner@beagleboard.org>
5a89c3a04SSimon Glass *
6a89c3a04SSimon Glass * Based on cmd_led.c patch from:
7a89c3a04SSimon Glass * http://www.mail-archive.com/u-boot@lists.denx.de/msg06873.html
8a89c3a04SSimon Glass * (C) Copyright 2008
9a89c3a04SSimon Glass * Ulf Samuelsson <ulf.samuelsson@atmel.com>
10a89c3a04SSimon Glass */
11a89c3a04SSimon Glass
12a89c3a04SSimon Glass #include <common.h>
13a89c3a04SSimon Glass #include <config.h>
14a89c3a04SSimon Glass #include <command.h>
15a89c3a04SSimon Glass #include <status_led.h>
16a89c3a04SSimon Glass
17a89c3a04SSimon Glass struct led_tbl_s {
18a89c3a04SSimon Glass char *string; /* String for use in the command */
19a89c3a04SSimon Glass led_id_t mask; /* Mask used for calling __led_set() */
20a89c3a04SSimon Glass void (*off)(void); /* Optional function for turning LED off */
21a89c3a04SSimon Glass void (*on)(void); /* Optional function for turning LED on */
22a89c3a04SSimon Glass void (*toggle)(void);/* Optional function for toggling LED */
23a89c3a04SSimon Glass };
24a89c3a04SSimon Glass
25a89c3a04SSimon Glass typedef struct led_tbl_s led_tbl_t;
26a89c3a04SSimon Glass
27a89c3a04SSimon Glass static const led_tbl_t led_commands[] = {
28a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_BOARD_SPECIFIC
29a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS0
30a89c3a04SSimon Glass { "0", CONFIG_LED_STATUS_BIT, NULL, NULL, NULL },
31a89c3a04SSimon Glass #endif
32a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS1
33a89c3a04SSimon Glass { "1", CONFIG_LED_STATUS_BIT1, NULL, NULL, NULL },
34a89c3a04SSimon Glass #endif
35a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS2
36a89c3a04SSimon Glass { "2", CONFIG_LED_STATUS_BIT2, NULL, NULL, NULL },
37a89c3a04SSimon Glass #endif
38a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS3
39a89c3a04SSimon Glass { "3", CONFIG_LED_STATUS_BIT3, NULL, NULL, NULL },
40a89c3a04SSimon Glass #endif
41a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS4
42a89c3a04SSimon Glass { "4", CONFIG_LED_STATUS_BIT4, NULL, NULL, NULL },
43a89c3a04SSimon Glass #endif
44a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS5
45a89c3a04SSimon Glass { "5", CONFIG_LED_STATUS_BIT5, NULL, NULL, NULL },
46a89c3a04SSimon Glass #endif
47a89c3a04SSimon Glass #endif
48a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_GREEN
49a89c3a04SSimon Glass { "green", CONFIG_LED_STATUS_GREEN, green_led_off, green_led_on, NULL },
50a89c3a04SSimon Glass #endif
51a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_YELLOW
52a89c3a04SSimon Glass { "yellow", CONFIG_LED_STATUS_YELLOW, yellow_led_off, yellow_led_on,
53a89c3a04SSimon Glass NULL },
54a89c3a04SSimon Glass #endif
55a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_RED
56a89c3a04SSimon Glass { "red", CONFIG_LED_STATUS_RED, red_led_off, red_led_on, NULL },
57a89c3a04SSimon Glass #endif
58a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_BLUE
59a89c3a04SSimon Glass { "blue", CONFIG_LED_STATUS_BLUE, blue_led_off, blue_led_on, NULL },
60a89c3a04SSimon Glass #endif
61a89c3a04SSimon Glass { NULL, 0, NULL, NULL, NULL }
62a89c3a04SSimon Glass };
63a89c3a04SSimon Glass
64a89c3a04SSimon Glass enum led_cmd { LED_ON, LED_OFF, LED_TOGGLE, LED_BLINK };
65a89c3a04SSimon Glass
get_led_cmd(char * var)66a89c3a04SSimon Glass enum led_cmd get_led_cmd(char *var)
67a89c3a04SSimon Glass {
68a89c3a04SSimon Glass if (strcmp(var, "off") == 0)
69a89c3a04SSimon Glass return LED_OFF;
70a89c3a04SSimon Glass if (strcmp(var, "on") == 0)
71a89c3a04SSimon Glass return LED_ON;
72a89c3a04SSimon Glass if (strcmp(var, "toggle") == 0)
73a89c3a04SSimon Glass return LED_TOGGLE;
74a89c3a04SSimon Glass if (strcmp(var, "blink") == 0)
75a89c3a04SSimon Glass return LED_BLINK;
76a89c3a04SSimon Glass
77a89c3a04SSimon Glass return -1;
78a89c3a04SSimon Glass }
79a89c3a04SSimon Glass
80a89c3a04SSimon Glass /*
81a89c3a04SSimon Glass * LED drivers providing a blinking LED functionality, like the
82a89c3a04SSimon Glass * PCA9551, can override this empty weak function
83a89c3a04SSimon Glass */
__led_blink(led_id_t mask,int freq)84a89c3a04SSimon Glass void __weak __led_blink(led_id_t mask, int freq)
85a89c3a04SSimon Glass {
86a89c3a04SSimon Glass }
87a89c3a04SSimon Glass
do_legacy_led(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])8821c34084SSimon Glass int do_legacy_led(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
89a89c3a04SSimon Glass {
90a89c3a04SSimon Glass int i, match = 0;
91a89c3a04SSimon Glass enum led_cmd cmd;
92a89c3a04SSimon Glass int freq;
93a89c3a04SSimon Glass
94a89c3a04SSimon Glass /* Validate arguments */
95a89c3a04SSimon Glass if ((argc < 3) || (argc > 4))
96a89c3a04SSimon Glass return CMD_RET_USAGE;
97a89c3a04SSimon Glass
98a89c3a04SSimon Glass cmd = get_led_cmd(argv[2]);
99a89c3a04SSimon Glass if (cmd < 0) {
100a89c3a04SSimon Glass return CMD_RET_USAGE;
101a89c3a04SSimon Glass }
102a89c3a04SSimon Glass
103a89c3a04SSimon Glass for (i = 0; led_commands[i].string; i++) {
104a89c3a04SSimon Glass if ((strcmp("all", argv[1]) == 0) ||
105a89c3a04SSimon Glass (strcmp(led_commands[i].string, argv[1]) == 0)) {
106a89c3a04SSimon Glass match = 1;
107a89c3a04SSimon Glass switch (cmd) {
108a89c3a04SSimon Glass case LED_ON:
109a89c3a04SSimon Glass if (led_commands[i].on)
110a89c3a04SSimon Glass led_commands[i].on();
111a89c3a04SSimon Glass else
112a89c3a04SSimon Glass __led_set(led_commands[i].mask,
113a89c3a04SSimon Glass CONFIG_LED_STATUS_ON);
114a89c3a04SSimon Glass break;
115a89c3a04SSimon Glass case LED_OFF:
116a89c3a04SSimon Glass if (led_commands[i].off)
117a89c3a04SSimon Glass led_commands[i].off();
118a89c3a04SSimon Glass else
119a89c3a04SSimon Glass __led_set(led_commands[i].mask,
120a89c3a04SSimon Glass CONFIG_LED_STATUS_OFF);
121a89c3a04SSimon Glass break;
122a89c3a04SSimon Glass case LED_TOGGLE:
123a89c3a04SSimon Glass if (led_commands[i].toggle)
124a89c3a04SSimon Glass led_commands[i].toggle();
125a89c3a04SSimon Glass else
126a89c3a04SSimon Glass __led_toggle(led_commands[i].mask);
127a89c3a04SSimon Glass break;
128a89c3a04SSimon Glass case LED_BLINK:
129a89c3a04SSimon Glass if (argc != 4)
130a89c3a04SSimon Glass return CMD_RET_USAGE;
131a89c3a04SSimon Glass
132a89c3a04SSimon Glass freq = simple_strtoul(argv[3], NULL, 10);
133a89c3a04SSimon Glass __led_blink(led_commands[i].mask, freq);
134a89c3a04SSimon Glass }
135a89c3a04SSimon Glass /* Need to set only 1 led if led_name wasn't 'all' */
136a89c3a04SSimon Glass if (strcmp("all", argv[1]) != 0)
137a89c3a04SSimon Glass break;
138a89c3a04SSimon Glass }
139a89c3a04SSimon Glass }
140a89c3a04SSimon Glass
141a89c3a04SSimon Glass /* If we ran out of matches, print Usage */
142a89c3a04SSimon Glass if (!match) {
143a89c3a04SSimon Glass return CMD_RET_USAGE;
144a89c3a04SSimon Glass }
145a89c3a04SSimon Glass
146a89c3a04SSimon Glass return 0;
147a89c3a04SSimon Glass }
148a89c3a04SSimon Glass
149a89c3a04SSimon Glass U_BOOT_CMD(
15021c34084SSimon Glass led, 4, 1, do_legacy_led,
151a89c3a04SSimon Glass "["
152a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_BOARD_SPECIFIC
153a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS0
154a89c3a04SSimon Glass "0|"
155a89c3a04SSimon Glass #endif
156a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS1
157a89c3a04SSimon Glass "1|"
158a89c3a04SSimon Glass #endif
159a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS2
160a89c3a04SSimon Glass "2|"
161a89c3a04SSimon Glass #endif
162a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS3
163a89c3a04SSimon Glass "3|"
164a89c3a04SSimon Glass #endif
165a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS4
166a89c3a04SSimon Glass "4|"
167a89c3a04SSimon Glass #endif
168a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS5
169a89c3a04SSimon Glass "5|"
170a89c3a04SSimon Glass #endif
171a89c3a04SSimon Glass #endif
172a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_GREEN
173a89c3a04SSimon Glass "green|"
174a89c3a04SSimon Glass #endif
175a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_YELLOW
176a89c3a04SSimon Glass "yellow|"
177a89c3a04SSimon Glass #endif
178a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_RED
179a89c3a04SSimon Glass "red|"
180a89c3a04SSimon Glass #endif
181a89c3a04SSimon Glass #ifdef CONFIG_LED_STATUS_BLUE
182a89c3a04SSimon Glass "blue|"
183a89c3a04SSimon Glass #endif
184a89c3a04SSimon Glass "all] [on|off|toggle|blink] [blink-freq in ms]",
185a89c3a04SSimon Glass "[led_name] [on|off|toggle|blink] sets or clears led(s)"
186a89c3a04SSimon Glass );
187