Loading...
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 | // SPDX-License-Identifier: GPL-2.0+ /* * Copyright (c) 2017 Google, Inc * Written by Simon Glass <sjg@chromium.org> */ #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", [LEDST_BLINK] = "blink", }; 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\n", 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_plat(dev); if (!plat->label) continue; printf("%-15s ", plat->label); if (device_active(dev)) { ret = show_led_state(dev); if (ret < 0) printf("Error %d\n", ret); } else { printf("<inactive>\n"); } } return 0; } int do_led(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) { enum led_state_t cmd; const char *led_label; struct udevice *dev; int freq_ms = 0; int ret; /* Validate arguments */ if (argc < 2) return CMD_RET_USAGE; led_label = argv[1]; if (strncmp(led_label, "list", 4) == 0) return list_leds(); cmd = argc > 2 ? get_led_cmd(argv[2]) : LEDST_COUNT; if (cmd == LEDST_BLINK) { if (argc < 4) return CMD_RET_USAGE; freq_ms = dectoul(argv[3], NULL); } ret = led_get_by_label(led_label, &dev); if (ret) { printf("LED '%s' not found (err=%d)\n", 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; case LEDST_BLINK: ret = led_set_period(dev, freq_ms); if (!ret) ret = led_set_state(dev, LEDST_BLINK); break; case LEDST_COUNT: printf("LED '%s': ", led_label); ret = show_led_state(dev); break; } if (ret < 0) { printf("LED '%s' operation failed (err=%d)\n", led_label, ret); return CMD_RET_FAILURE; } return 0; } U_BOOT_CMD( led, 4, 1, do_led, "manage LEDs", "<led_label> on|off|toggle\tChange LED state\n" #if defined(CONFIG_LED_BLINK) || defined(CONFIG_LED_SW_BLINK) "led <led_label> blink <blink-freq in ms>\tBlink LED (duty cycle 50%)\n" #endif "led <led_label>\tGet LED state\n" "led list\t\tshow a list of LEDs" ); |