pinmux.c 3.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (C) 2018, STMicroelectronics - All Rights Reserved
  4. */
  5. #include <common.h>
  6. #include <command.h>
  7. #include <dm.h>
  8. #include <errno.h>
  9. #include <dm/pinctrl.h>
  10. #include <dm/uclass-internal.h>
  11. #define LIMIT_DEVNAME 30
  12. static struct udevice *currdev;
  13. static int do_dev(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  14. {
  15. const char *name;
  16. int ret;
  17. switch (argc) {
  18. case 2:
  19. name = argv[1];
  20. ret = uclass_get_device_by_name(UCLASS_PINCTRL, name, &currdev);
  21. if (ret) {
  22. printf("Can't get the pin-controller: %s!\n", name);
  23. return CMD_RET_FAILURE;
  24. }
  25. /* fall through */
  26. case 1:
  27. if (!currdev) {
  28. printf("Pin-controller device is not set!\n");
  29. return CMD_RET_USAGE;
  30. }
  31. printf("dev: %s\n", currdev->name);
  32. }
  33. return CMD_RET_SUCCESS;
  34. }
  35. static int show_pinmux(struct udevice *dev)
  36. {
  37. char pin_name[PINNAME_SIZE];
  38. char pin_mux[PINMUX_SIZE];
  39. int pins_count;
  40. int i;
  41. int ret;
  42. pins_count = pinctrl_get_pins_count(dev);
  43. if (pins_count == -ENOSYS) {
  44. printf("Ops get_pins_count not supported\n");
  45. return pins_count;
  46. }
  47. for (i = 0; i < pins_count; i++) {
  48. ret = pinctrl_get_pin_name(dev, i, pin_name, PINNAME_SIZE);
  49. if (ret == -ENOSYS) {
  50. printf("Ops get_pin_name not supported\n");
  51. return ret;
  52. }
  53. ret = pinctrl_get_pin_muxing(dev, i, pin_mux, PINMUX_SIZE);
  54. if (ret) {
  55. printf("Ops get_pin_muxing error (%d)\n", ret);
  56. return ret;
  57. }
  58. printf("%-*s: %-*s\n", PINNAME_SIZE, pin_name,
  59. PINMUX_SIZE, pin_mux);
  60. }
  61. return 0;
  62. }
  63. static int do_status(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  64. {
  65. struct udevice *dev;
  66. int ret = CMD_RET_USAGE;
  67. if (currdev && (argc < 2 || strcmp(argv[1], "-a")))
  68. return show_pinmux(currdev);
  69. if (argc < 2 || strcmp(argv[1], "-a"))
  70. return ret;
  71. uclass_foreach_dev_probe(UCLASS_PINCTRL, dev) {
  72. /* insert a separator between each pin-controller display */
  73. printf("--------------------------\n");
  74. printf("%s:\n", dev->name);
  75. ret = show_pinmux(dev);
  76. if (ret < 0)
  77. printf("Can't display pin muxing for %s\n",
  78. dev->name);
  79. }
  80. return ret;
  81. }
  82. static int do_list(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
  83. {
  84. struct udevice *dev;
  85. printf("| %-*.*s| %-*.*s| %s\n",
  86. LIMIT_DEVNAME, LIMIT_DEVNAME, "Device",
  87. LIMIT_DEVNAME, LIMIT_DEVNAME, "Driver",
  88. "Parent");
  89. uclass_foreach_dev_probe(UCLASS_PINCTRL, dev) {
  90. printf("| %-*.*s| %-*.*s| %s\n",
  91. LIMIT_DEVNAME, LIMIT_DEVNAME, dev->name,
  92. LIMIT_DEVNAME, LIMIT_DEVNAME, dev->driver->name,
  93. dev->parent->name);
  94. }
  95. return CMD_RET_SUCCESS;
  96. }
  97. static cmd_tbl_t pinmux_subcmd[] = {
  98. U_BOOT_CMD_MKENT(dev, 2, 1, do_dev, "", ""),
  99. U_BOOT_CMD_MKENT(list, 1, 1, do_list, "", ""),
  100. U_BOOT_CMD_MKENT(status, 2, 1, do_status, "", ""),
  101. };
  102. static int do_pinmux(cmd_tbl_t *cmdtp, int flag, int argc,
  103. char * const argv[])
  104. {
  105. cmd_tbl_t *cmd;
  106. argc--;
  107. argv++;
  108. cmd = find_cmd_tbl(argv[0], pinmux_subcmd, ARRAY_SIZE(pinmux_subcmd));
  109. if (!cmd || argc > cmd->maxargs)
  110. return CMD_RET_USAGE;
  111. return cmd->cmd(cmdtp, flag, argc, argv);
  112. }
  113. U_BOOT_CMD(pinmux, CONFIG_SYS_MAXARGS, 1, do_pinmux,
  114. "show pin-controller muxing",
  115. "list - list UCLASS_PINCTRL devices\n"
  116. "pinmux dev [pincontroller-name] - select pin-controller device\n"
  117. "pinmux status [-a] - print pin-controller muxing [for all]\n"
  118. )