cmd: sbi: formatting PolarFire Hart Software Services version

[thirdparty/u-boot.git] / cmd / gpio.c

diff --git a/cmd/gpio.c b/cmd/gpio.c
index 4150024e628ea78790b95666c0984c33c183750a..dab6f7097aec1a0c9ea40a64d128dfa665010377 100644 (file)
--- a/cmd/gpio.c
+++ b/cmd/gpio.c
@@ -12,8 +12,12 @@
 #include <dm.h>
 #include <log.h>
 #include <malloc.h>
+#ifdef CONFIG_CMD_GPIO_READ
+#include <env.h>
+#endif
 #include <asm/gpio.h>
 #include <linux/err.h>
+#include <dm/device_compat.h>
 
 __weak int name_to_gpio(const char *name)
 {
@@ -25,6 +29,9 @@ enum gpio_cmd {
        GPIOC_SET,
        GPIOC_CLEAR,
        GPIOC_TOGGLE,
+#ifdef CONFIG_CMD_GPIO_READ
+       GPIOC_READ,
+#endif
 };
 
 #if defined(CONFIG_DM_GPIO) && !defined(gpio_status)
@@ -63,7 +70,8 @@ static void gpio_get_description(struct udevice *dev, const char *bank_name,
        printf("%s\n", buf);
        return;
 err:
-       printf("Error %d\n", ret);
+       if (ret != -ENOENT)
+               printf("Error %d\n", ret);
 }
 
 static int do_gpio_status(bool all, const char *gpio_name)
@@ -71,17 +79,24 @@ static int do_gpio_status(bool all, const char *gpio_name)
        struct udevice *dev;
        int banklen;
        int flags;
-       int ret;
+       int ret, err = 0;
 
        flags = 0;
        if (gpio_name && !*gpio_name)
                gpio_name = NULL;
-       for (ret = uclass_first_device(UCLASS_GPIO, &dev);
+       for (ret = uclass_first_device_check(UCLASS_GPIO, &dev);
             dev;
-            ret = uclass_next_device(&dev)) {
+            ret = uclass_next_device_check(&dev)) {
                const char *bank_name;
                int num_bits;
 
+               if (ret) {
+                       printf("GPIO device %s probe error %i\n",
+                              dev->name, ret);
+                       err = ret;
+                       continue;
+               }
+
                flags |= FLAG_SHOW_BANK;
                if (all)
                        flags |= FLAG_SHOW_ALL;
@@ -114,7 +129,7 @@ static int do_gpio_status(bool all, const char *gpio_name)
                        flags |= FLAG_SHOW_NEWLINE;
        }
 
-       return ret;
+       return err;
 }
 #endif
 
@@ -125,6 +140,9 @@ static int do_gpio(struct cmd_tbl *cmdtp, int flag, int argc,
        enum gpio_cmd sub_cmd;
        int value;
        const char *str_cmd, *str_gpio = NULL;
+#ifdef CONFIG_CMD_GPIO_READ
+       const char *str_var = NULL;
+#endif
        int ret;
 #ifdef CONFIG_DM_GPIO
        bool all = false;
@@ -137,11 +155,20 @@ static int do_gpio(struct cmd_tbl *cmdtp, int flag, int argc,
        argc -= 2;
        argv += 2;
 #ifdef CONFIG_DM_GPIO
-       if (argc > 0 && !strcmp(*argv, "-a")) {
+       if (argc > 0 && !strncmp(str_cmd, "status", 2) && !strcmp(*argv, "-a")) {
                all = true;
                argc--;
                argv++;
        }
+#endif
+#ifdef CONFIG_CMD_GPIO_READ
+       if (argc > 0 && !strncmp(str_cmd, "read", 2)) {
+               if (argc < 2)
+                       goto show_usage;
+               str_var = *argv;
+               argc--;
+               argv++;
+       }
 #endif
        if (argc > 0)
                str_gpio = *argv;
@@ -174,6 +201,11 @@ static int do_gpio(struct cmd_tbl *cmdtp, int flag, int argc,
        case 't':
                sub_cmd = GPIOC_TOGGLE;
                break;
+#ifdef CONFIG_CMD_GPIO_READ
+       case 'r':
+               sub_cmd = GPIOC_READ;
+               break;
+#endif
        default:
                goto show_usage;
        }
@@ -205,7 +237,11 @@ static int do_gpio(struct cmd_tbl *cmdtp, int flag, int argc,
        }
 
        /* finally, let's do it: set direction and exec command */
-       if (sub_cmd == GPIOC_INPUT) {
+       if (sub_cmd == GPIOC_INPUT
+#ifdef CONFIG_CMD_GPIO_READ
+                       || sub_cmd == GPIOC_READ
+#endif
+                       ) {
                gpio_direction_input(gpio);
                value = gpio_get_value(gpio);
        } else {
@@ -233,9 +269,17 @@ static int do_gpio(struct cmd_tbl *cmdtp, int flag, int argc,
                goto err;
        } else {
                printf("%d\n", value);
+#ifdef CONFIG_CMD_GPIO_READ
+               if (sub_cmd == GPIOC_READ)
+                       env_set_ulong(str_var, (ulong)value);
+#endif
        }
 
-       if (sub_cmd != GPIOC_INPUT && !IS_ERR_VALUE(value)) {
+       if (sub_cmd != GPIOC_INPUT && !IS_ERR_VALUE(value)
+#ifdef CONFIG_CMD_GPIO_READ
+                       && sub_cmd != GPIOC_READ
+#endif
+                       ) {
                int nval = gpio_get_value(gpio);
 
                if (IS_ERR_VALUE(nval)) {
@@ -267,4 +311,8 @@ U_BOOT_CMD(gpio, 4, 0, do_gpio,
           "query and control gpio pins",
           "<input|set|clear|toggle> <pin>\n"
           "    - input/set/clear/toggle the specified pin\n"
+#ifdef CONFIG_CMD_GPIO_READ
+          "gpio read <name> <pin>\n"
+          "    - set environment variable 'name' to the specified pin\n"
+#endif
           "gpio status [-a] [<bank> | <pin>]  - show [all/claimed] GPIOs");