"Das U-Boot" Source Tree
at master 136 lines 3.4 kB view raw
1// SPDX-License-Identifier: GPL-2.0+ 2/* 3 * (C) Copyright 2024 Collabora 4 */ 5 6#include <command.h> 7#include <errno.h> 8#include <dm.h> 9#include <dm/uclass-internal.h> 10#include <usb/tcpm.h> 11 12#define LIMIT_DEV 32 13#define LIMIT_PARENT 20 14 15static struct udevice *currdev; 16 17static int do_dev(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) 18{ 19 int devnum, ret; 20 21 switch (argc) { 22 case 2: 23 devnum = (int)dectoul(argv[1], NULL); 24 ret = tcpm_get(devnum, &currdev); 25 if (ret) { 26 log_err("Can't get TCPM %d: %d (%s)!\n", devnum, ret, errno_str(ret)); 27 return CMD_RET_FAILURE; 28 } 29 case 1: 30 if (!currdev) { 31 log_err("TCPM device is not set!\n\n"); 32 return CMD_RET_USAGE; 33 } 34 35 printf("dev: %d @ %s\n", dev_seq(currdev), currdev->name); 36 } 37 38 return CMD_RET_SUCCESS; 39} 40 41static int do_list(struct cmd_tbl *cmdtp, int flag, int argc, 42 char *const argv[]) 43{ 44 struct udevice *dev; 45 int ret, err = 0; 46 47 printf("| ID | %-*.*s| %-*.*s| %s @ %s\n", 48 LIMIT_DEV, LIMIT_DEV, "Name", 49 LIMIT_PARENT, LIMIT_PARENT, "Parent name", 50 "Parent uclass", "seq"); 51 52 for (ret = uclass_first_device_check(UCLASS_TCPM, &dev); dev; 53 ret = uclass_next_device_check(&dev)) { 54 if (ret) 55 err = ret; 56 57 printf("| %2d | %-*.*s| %-*.*s| %s @ %d | status: %i\n", 58 dev_seq(dev), 59 LIMIT_DEV, LIMIT_DEV, dev->name, 60 LIMIT_PARENT, LIMIT_PARENT, dev->parent->name, 61 dev_get_uclass_name(dev->parent), dev_seq(dev->parent), 62 ret); 63 } 64 65 if (err) 66 return CMD_RET_FAILURE; 67 68 return CMD_RET_SUCCESS; 69} 70 71int do_print_info(struct udevice *dev) 72{ 73 enum typec_orientation orientation = tcpm_get_orientation(dev); 74 const char *state = tcpm_get_state(dev); 75 int pd_rev = tcpm_get_pd_rev(dev); 76 int mv = tcpm_get_voltage(dev); 77 int ma = tcpm_get_current(dev); 78 enum typec_role pwr_role = tcpm_get_pwr_role(dev); 79 enum typec_data_role data_role = tcpm_get_data_role(dev); 80 bool connected = tcpm_is_connected(dev); 81 82 if (!connected) { 83 printf("TCPM State: %s\n", state); 84 return 0; 85 } 86 87 printf("Orientation: %s\n", typec_orientation_name[orientation]); 88 printf("PD Revision: %s\n", typec_pd_rev_name[pd_rev]); 89 printf("Power Role: %s\n", typec_role_name[pwr_role]); 90 printf("Data Role: %s\n", typec_data_role_name[data_role]); 91 printf("Voltage: %2d.%03d V\n", mv / 1000, mv % 1000); 92 printf("Current: %2d.%03d A\n", ma / 1000, ma % 1000); 93 94 return 0; 95} 96 97static int do_info(struct cmd_tbl *cmdtp, int flag, int argc, 98 char *const argv[]) 99{ 100 if (!currdev) { 101 printf("First, set the TCPM device!\n"); 102 return CMD_RET_USAGE; 103 } 104 105 return do_print_info(currdev); 106} 107 108static struct cmd_tbl subcmd[] = { 109 U_BOOT_CMD_MKENT(dev, 2, 1, do_dev, "", ""), 110 U_BOOT_CMD_MKENT(list, 1, 1, do_list, "", ""), 111 U_BOOT_CMD_MKENT(info, 1, 1, do_info, "", ""), 112}; 113 114static int do_tcpm(struct cmd_tbl *cmdtp, int flag, int argc, 115 char *const argv[]) 116{ 117 struct cmd_tbl *cmd; 118 119 argc--; 120 argv++; 121 122 cmd = find_cmd_tbl(argv[0], subcmd, ARRAY_SIZE(subcmd)); 123 if (!cmd || argc > cmd->maxargs) 124 return CMD_RET_USAGE; 125 126 return cmd->cmd(cmdtp, flag, argc, argv); 127} 128 129 /**************************************************/ 130 131U_BOOT_CMD(tcpm, CONFIG_SYS_MAXARGS, 1, do_tcpm, 132 "TCPM sub-system", 133 "list - list TCPM devices\n" 134 "tcpm dev [ID] - show or [set] operating TCPM device\n" 135 "tcpm info - dump information\n" 136);