cmd/pinmux.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2018, STMicroelectronics - All Rights Reserved
   4  */
   5
   6 #include <command.h>
   7 #include <dm.h>
   8 #include <errno.h>
   9 #include <dm/pinctrl.h>
  10 #include <dm/uclass-internal.h>
  11
  12 #define LIMIT_DEVNAME   30
  13
  14 static struct udevice *currdev;
  15
  16 static int do_dev(struct cmd_tbl *cmdtp, int flag, int argc,
  17                   char *const argv[])
  18 {
  19         const char *name;
  20         int ret;
  21
  22         switch (argc) {
  23         case 2:
  24                 name = argv[1];
  25                 ret = uclass_get_device_by_name(UCLASS_PINCTRL, name, &currdev);
  26                 if (ret) {
  27                         printf("Can't get the pin-controller: %s!\n", name);
  28                         return CMD_RET_FAILURE;
  29                 }
  30                 /* fall through */
  31         case 1:
  32                 if (!currdev) {
  33                         printf("Pin-controller device is not set!\n");
  34                         return CMD_RET_USAGE;
  35                 }
  36
  37                 printf("dev: %s\n", currdev->name);
  38         }
  39
  40         return CMD_RET_SUCCESS;
  41 }
  42
  43 /**
  44  * Print the muxing information for one or all pins of one pinctrl device
  45  *
  46  * @param dev           pinctrl device
  47  * @param name          NULL to display all the pins
  48  *                      or name of the pin to display
  49  * Return: 0 on success, non-0 on error
  50  */
  51 static int show_pinmux(struct udevice *dev, char *name)
  52 {
  53         char pin_name[PINNAME_SIZE];
  54         char pin_mux[PINMUX_SIZE];
  55         int pins_count;
  56         int i;
  57         int ret;
  58         bool found = false;
  59
  60         pins_count = pinctrl_get_pins_count(dev);
  61
  62         if (pins_count == -ENOSYS) {
  63                 printf("Ops get_pins_count not supported by %s\n", dev->name);
  64                 return pins_count;
  65         }
  66
  67         for (i = 0; i < pins_count; i++) {
  68                 ret = pinctrl_get_pin_name(dev, i, pin_name, PINNAME_SIZE);
  69                 if (ret) {
  70                         printf("Ops get_pin_name error (%d) by %s\n", ret, dev->name);
  71                         return ret;
  72                 }
  73                 if (name && strcmp(name, pin_name))
  74                         continue;
  75                 found = true;
  76                 ret = pinctrl_get_pin_muxing(dev, i, pin_mux, PINMUX_SIZE);
  77                 if (ret) {
  78                         printf("Ops get_pin_muxing error (%d) by %s in %s\n",
  79                                ret, pin_name, dev->name);
  80                         return ret;
  81                 }
  82
  83                 printf("%-*s: %-*s\n", PINNAME_SIZE, pin_name,
  84                        PINMUX_SIZE, pin_mux);
  85         }
  86
  87         if (!found)
  88                 return -ENOENT;
  89
  90         return 0;
  91 }
  92
  93 static int do_status(struct cmd_tbl *cmdtp, int flag, int argc,
  94                      char *const argv[])
  95 {
  96         struct udevice *dev;
  97         char *name;
  98         int ret;
  99
 100         if (argc < 2) {
 101                 if (!currdev) {
 102                         printf("pin-controller device not selected\n");
 103                         return CMD_RET_FAILURE;
 104                 }
 105                 show_pinmux(currdev, NULL);
 106                 return CMD_RET_SUCCESS;
 107         }
 108
 109         if (strcmp(argv[1], "-a"))
 110                 name = argv[1];
 111         else
 112                 name = NULL;
 113
 114         uclass_foreach_dev_probe(UCLASS_PINCTRL, dev) {
 115                 if (!name) {
 116                         /* insert a separator between each pin-controller display */
 117                         printf("--------------------------\n");
 118                         printf("%s:\n", dev->name);
 119                 }
 120                 ret = show_pinmux(dev, name);
 121                 /* stop when the status of requested pin is displayed */
 122                 if (name && !ret)
 123                         return CMD_RET_SUCCESS;
 124         }
 125
 126         if (name) {
 127                 printf("%s not found\n", name);
 128                 return CMD_RET_FAILURE;
 129         }
 130
 131         return CMD_RET_SUCCESS;
 132 }
 133
 134 static int do_list(struct cmd_tbl *cmdtp, int flag, int argc,
 135                    char *const argv[])
 136 {
 137         struct udevice *dev;
 138
 139         printf("| %-*.*s| %-*.*s| %s\n",
 140                LIMIT_DEVNAME, LIMIT_DEVNAME, "Device",
 141                LIMIT_DEVNAME, LIMIT_DEVNAME, "Driver",
 142                "Parent");
 143
 144         uclass_foreach_dev_probe(UCLASS_PINCTRL, dev) {
 145                 printf("| %-*.*s| %-*.*s| %s\n",
 146                        LIMIT_DEVNAME, LIMIT_DEVNAME, dev->name,
 147                        LIMIT_DEVNAME, LIMIT_DEVNAME, dev->driver->name,
 148                        dev->parent->name);
 149         }
 150
 151         return CMD_RET_SUCCESS;
 152 }
 153
 154 static struct cmd_tbl pinmux_subcmd[] = {
 155         U_BOOT_CMD_MKENT(dev, 2, 1, do_dev, "", ""),
 156         U_BOOT_CMD_MKENT(list, 1, 1, do_list, "", ""),
 157         U_BOOT_CMD_MKENT(status, 2, 1, do_status, "", ""),
 158 };
 159
 160 static int do_pinmux(struct cmd_tbl *cmdtp, int flag, int argc,
 161                      char *const argv[])
 162 {
 163         struct cmd_tbl *cmd;
 164
 165         argc--;
 166         argv++;
 167
 168         cmd = find_cmd_tbl(argv[0], pinmux_subcmd, ARRAY_SIZE(pinmux_subcmd));
 169         if (!cmd || argc > cmd->maxargs)
 170                 return CMD_RET_USAGE;
 171
 172         return cmd->cmd(cmdtp, flag, argc, argv);
 173 }
 174
 175 U_BOOT_CMD(pinmux, CONFIG_SYS_MAXARGS, 1, do_pinmux,
 176            "show pin-controller muxing",
 177            "list                     - list UCLASS_PINCTRL devices\n"
 178            "pinmux dev [pincontroller-name] - select pin-controller device\n"
 179            "pinmux status [-a | pin-name]   - print pin-controller muxing [for all | for pin-name]\n"
 180 );