]> git.kernelconcepts.de Git - karo-tx-uboot.git/blobdiff - common/cmd_led.c
JFFS2: Speed up and fix comparison functions
[karo-tx-uboot.git] / common / cmd_led.c
index f1e8a62cb631bc747250d0f3f9cc0f7ba40241bd..b0f1a61b1bb02cb813452b8ba696619645691f61 100644 (file)
@@ -7,23 +7,7 @@
  * (C) Copyright 2008
  * Ulf Samuelsson <ulf.samuelsson@atmel.com>
  *
- * See file CREDITS for list of people who contributed to this
- * project.
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; either version 2 of
- * the License, or (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.         See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
- * MA 02111-1307 USA
+ * SPDX-License-Identifier:    GPL-2.0+
  */
 
 #include <common.h>
@@ -34,8 +18,9 @@
 struct led_tbl_s {
        char            *string;        /* String for use in the command */
        led_id_t        mask;           /* Mask used for calling __led_set() */
-       void            (*on)(void);    /* Optional fucntion for turning LED on */
-       void            (*off)(void);   /* Optional fucntion for turning LED on */
+       void            (*off)(void);   /* Optional function for turning LED off */
+       void            (*on)(void);    /* Optional function for turning LED on */
+       void            (*toggle)(void);/* Optional function for toggling LED */
 };
 
 typedef struct led_tbl_s led_tbl_t;
@@ -43,85 +28,127 @@ typedef struct led_tbl_s led_tbl_t;
 static const led_tbl_t led_commands[] = {
 #ifdef CONFIG_BOARD_SPECIFIC_LED
 #ifdef STATUS_LED_BIT
-       { "0", STATUS_LED_BIT, NULL, NULL },
+       { "0", STATUS_LED_BIT, NULL, NULL, NULL },
 #endif
 #ifdef STATUS_LED_BIT1
-       { "1", STATUS_LED_BIT1, NULL, NULL },
+       { "1", STATUS_LED_BIT1, NULL, NULL, NULL },
 #endif
 #ifdef STATUS_LED_BIT2
-       { "2", STATUS_LED_BIT2, NULL, NULL },
+       { "2", STATUS_LED_BIT2, NULL, NULL, NULL },
 #endif
 #ifdef STATUS_LED_BIT3
-       { "3", STATUS_LED_BIT3, NULL, NULL },
+       { "3", STATUS_LED_BIT3, NULL, NULL, NULL },
+#endif
+#ifdef STATUS_LED_BIT4
+       { "4", STATUS_LED_BIT4, NULL, NULL, NULL },
+#endif
+#ifdef STATUS_LED_BIT5
+       { "5", STATUS_LED_BIT5, NULL, NULL, NULL },
 #endif
 #endif
 #ifdef STATUS_LED_GREEN
-       { "green", STATUS_LED_GREEN, green_LED_off, green_LED_on },
+       { "green", STATUS_LED_GREEN, green_led_off, green_led_on, NULL },
 #endif
 #ifdef STATUS_LED_YELLOW
-       { "yellow", STATUS_LED_YELLOW, yellow_LED_off, yellow_LED_on },
+       { "yellow", STATUS_LED_YELLOW, yellow_led_off, yellow_led_on, NULL },
 #endif
 #ifdef STATUS_LED_RED
-       { "red", STATUS_LED_RED, red_LED_off, red_LED_on },
+       { "red", STATUS_LED_RED, red_led_off, red_led_on, NULL },
 #endif
 #ifdef STATUS_LED_BLUE
-       { "blue", STATUS_LED_BLUE, blue_LED_off, blue_LED_on },
+       { "blue", STATUS_LED_BLUE, blue_led_off, blue_led_on, NULL },
 #endif
-       { NULL, 0, NULL, NULL }
+       { NULL, 0, NULL, NULL, NULL }
 };
 
-int str_onoff (char *var)
+enum led_cmd { LED_ON, LED_OFF, LED_TOGGLE, LED_BLINK };
+
+enum led_cmd get_led_cmd(char *var)
 {
-       if (strcmp(var, "off") == 0) {
-               return 0;
-       }
-       if (strcmp(var, "on") == 0) {
-               return 1;
-       }
+       if (strcmp(var, "off") == 0)
+               return LED_OFF;
+       if (strcmp(var, "on") == 0)
+               return LED_ON;
+       if (strcmp(var, "toggle") == 0)
+               return LED_TOGGLE;
+       if (strcmp(var, "blink") == 0)
+               return LED_BLINK;
+
        return -1;
 }
 
+/*
+ * LED drivers providing a blinking LED functionality, like the
+ * PCA9551, can override this empty weak function
+ */
+void __weak __led_blink(led_id_t mask, int freq)
+{
+}
+
 int do_led (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
-       int state, i;
+       int i, match = 0;
+       enum led_cmd cmd;
+       int freq;
 
        /* Validate arguments */
-       if ((argc != 3)) {
-               return cmd_usage(cmdtp);
-       }
+       if ((argc < 3) || (argc > 4))
+               return CMD_RET_USAGE;
 
-       state = str_onoff(argv[2]);
-       if (state < 0) {
-               return cmd_usage(cmdtp);
+       cmd = get_led_cmd(argv[2]);
+       if (cmd < 0) {
+               return CMD_RET_USAGE;
        }
 
        for (i = 0; led_commands[i].string; i++) {
-               if ((strcmp("all", argv[1]) == 0) || 
+               if ((strcmp("all", argv[1]) == 0) ||
                    (strcmp(led_commands[i].string, argv[1]) == 0)) {
-                       if (led_commands[i].on) {
-                               if (state) {
+                       match = 1;
+                       switch (cmd) {
+                       case LED_ON:
+                               if (led_commands[i].on)
                                        led_commands[i].on();
-                               } else {
+                               else
+                                       __led_set(led_commands[i].mask,
+                                                         STATUS_LED_ON);
+                               break;
+                       case LED_OFF:
+                               if (led_commands[i].off)
                                        led_commands[i].off();
-                               }
-                       } else {
-                               __led_set(led_commands[i].mask, state);
+                               else
+                                       __led_set(led_commands[i].mask,
+                                                         STATUS_LED_OFF);
+                               break;
+                       case LED_TOGGLE:
+                               if (led_commands[i].toggle)
+                                       led_commands[i].toggle();
+                               else
+                                       __led_toggle(led_commands[i].mask);
+                               break;
+                       case LED_BLINK:
+                               if (argc != 4)
+                                       return CMD_RET_USAGE;
+
+                               freq = simple_strtoul(argv[3], NULL, 10);
+                               __led_blink(led_commands[i].mask, freq);
                        }
-                       break;
+                       /* Need to set only 1 led if led_name wasn't 'all' */
+                       if (strcmp("all", argv[1]) != 0)
+                               break;
                }
        }
 
        /* If we ran out of matches, print Usage */
-       if (!led_commands[i].string && !(strcmp("all", argv[1]) == 0)) {
-               return cmd_usage(cmdtp);
+       if (!match) {
+               return CMD_RET_USAGE;
        }
 
        return 0;
 }
 
 U_BOOT_CMD(
-       led, 3, 1, do_led,
-       "led\t- ["
+       led, 4, 1, do_led,
+       "["
 #ifdef CONFIG_BOARD_SPECIFIC_LED
 #ifdef STATUS_LED_BIT
        "0|"
@@ -135,6 +162,12 @@ U_BOOT_CMD(
 #ifdef STATUS_LED_BIT3
        "3|"
 #endif
+#ifdef STATUS_LED_BIT4
+       "4|"
+#endif
+#ifdef STATUS_LED_BIT5
+       "5|"
+#endif
 #endif
 #ifdef STATUS_LED_GREEN
        "green|"
@@ -148,6 +181,6 @@ U_BOOT_CMD(
 #ifdef STATUS_LED_BLUE
        "blue|"
 #endif
-       "all] [on|off]\n",
-       "led [led_name] [on|off] sets or clears led(s)\n"
+       "all] [on|off|toggle|blink] [blink-freq in ms]",
+       "[led_name] [on|off|toggle|blink] sets or clears led(s)"
 );