legacy_led.c 4.1 KB

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