Eric Lee / smarc-uboot

Blame view

cmd/led.c 2.64 KB
edit raw normal view history
d41ce506b   Eric Lee   Initial Release, ... 
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
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
 
  /*
   * Copyright (c) 2017 Google, Inc
   * Written by Simon Glass <sjg@chromium.org>
   *
   * SPDX-License-Identifier:     GPL-2.0+
   */
  
  #include <common.h>
  #include <command.h>
  #include <dm.h>
  #include <led.h>
  #include <dm/uclass-internal.h>
  
  #define LED_TOGGLE LEDST_COUNT
  
  static const char *const state_label[] = {
  	[LEDST_OFF]	= "off",
  	[LEDST_ON]	= "on",
  	[LEDST_TOGGLE]	= "toggle",
  #ifdef CONFIG_LED_BLINK
  	[LEDST_BLINK]	= "blink",
  #endif
  };
  
  enum led_state_t get_led_cmd(char *var)
  {
  	int i;
  
  	for (i = 0; i < LEDST_COUNT; i++) {
  		if (!strncmp(var, state_label[i], strlen(var)))
  			return i;
  	}
  
  	return -1;
  }
  
  static int show_led_state(struct udevice *dev)
  {
  	int ret;
  
  	ret = led_get_state(dev);
  	if (ret >= LEDST_COUNT)
  		ret = -EINVAL;
  	if (ret >= 0)
  		printf("%s
  ", state_label[ret]);
  
  	return ret;
  }
  
  static int list_leds(void)
  {
  	struct udevice *dev;
  	int ret;
  
  	for (uclass_find_first_device(UCLASS_LED, &dev);
  	     dev;
  	     uclass_find_next_device(&dev)) {
  		struct led_uc_plat *plat = dev_get_uclass_platdata(dev);
  
  		if (!plat->label)
  			continue;
  		printf("%-15s ", plat->label);
  		if (device_active(dev)) {
  			ret = show_led_state(dev);
  			if (ret < 0)
  				printf("Error %d
  ", ret);
  		} else {
  			printf("<inactive>
  ");
  		}
  	}
  
  	return 0;
  }
  
  int do_led(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  {
  	enum led_state_t cmd;
  	const char *led_label;
  	struct udevice *dev;
  #ifdef CONFIG_LED_BLINK
  	int freq_ms = 0;
  #endif
  	int ret;
  
  	/* Validate arguments */
  	if (argc < 2)
  		return CMD_RET_USAGE;
  	led_label = argv[1];
  	if (*led_label == 'l')
  		return list_leds();
  
  	cmd = argc > 2 ? get_led_cmd(argv[2]) : LEDST_COUNT;
  #ifdef CONFIG_LED_BLINK
  	if (cmd == LEDST_BLINK) {
  		if (argc < 4)
  			return CMD_RET_USAGE;
  		freq_ms = simple_strtoul(argv[3], NULL, 10);
  	}
  #endif
  	ret = led_get_by_label(led_label, &dev);
  	if (ret) {
  		printf("LED '%s' not found (err=%d)
  ", led_label, ret);
  		return CMD_RET_FAILURE;
  	}
  	switch (cmd) {
  	case LEDST_OFF:
  	case LEDST_ON:
  	case LEDST_TOGGLE:
  		ret = led_set_state(dev, cmd);
  		break;
  #ifdef CONFIG_LED_BLINK
  	case LEDST_BLINK:
  		ret = led_set_period(dev, freq_ms);
  		if (!ret)
  			ret = led_set_state(dev, LEDST_BLINK);
  		break;
  #endif
  	case LEDST_COUNT:
  		printf("LED '%s': ", led_label);
  		ret = show_led_state(dev);
  		break;
  	}
  	if (ret < 0) {
  		printf("LED '%s' operation failed (err=%d)
  ", led_label, ret);
  		return CMD_RET_FAILURE;
  	}
  
  	return 0;
  }
  
  #ifdef CONFIG_LED_BLINK
  #define BLINK "|blink [blink-freq in ms]"
  #else
  #define BLINK ""
  #endif
  
  U_BOOT_CMD(
  	led, 4, 1, do_led,
  	"manage LEDs",
  	"<led_label> on|off|toggle" BLINK "\tChange LED state
  "
  	"led [<led_label>\tGet LED state
  "
  	"led list\t\tshow a list of LEDs"
  );