1 /* 2 * Copyright (C) 2014-2015 Samsung Electronics 3 * Przemyslaw Marczak <p.marczak@samsung.com> 4 * 5 * SPDX-License-Identifier: GPL-2.0+ 6 */ 7 #include <common.h> 8 #include <errno.h> 9 #include <dm.h> 10 #include <dm/uclass-internal.h> 11 #include <power/pmic.h> 12 13 #define LIMIT_DEV 32 14 #define LIMIT_PARENT 20 15 16 static struct udevice *currdev; 17 18 static int failure(int ret) 19 { 20 printf("Error: %d (%s)\n", ret, errno_str(ret)); 21 22 return CMD_RET_FAILURE; 23 } 24 25 static int do_dev(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 26 { 27 char *name; 28 int ret = -ENODEV; 29 30 switch (argc) { 31 case 2: 32 name = argv[1]; 33 ret = pmic_get(name, &currdev); 34 if (ret) { 35 printf("Can't get PMIC: %s!\n", name); 36 return failure(ret); 37 } 38 case 1: 39 if (!currdev) { 40 printf("PMIC device is not set!\n\n"); 41 return CMD_RET_USAGE; 42 } 43 44 printf("dev: %d @ %s\n", currdev->seq, currdev->name); 45 } 46 47 return CMD_RET_SUCCESS; 48 } 49 50 static int do_list(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 51 { 52 struct udevice *dev; 53 54 printf("| %-*.*s| %-*.*s| %s @ %s\n", 55 LIMIT_DEV, LIMIT_DEV, "Name", 56 LIMIT_PARENT, LIMIT_PARENT, "Parent name", 57 "Parent uclass", "seq"); 58 59 for (uclass_first_device(UCLASS_PMIC, &dev); dev; 60 uclass_next_device(&dev)) { 61 printf("| %-*.*s| %-*.*s| %s @ %d\n", 62 LIMIT_DEV, LIMIT_DEV, dev->name, 63 LIMIT_PARENT, LIMIT_PARENT, dev->parent->name, 64 dev_get_uclass_name(dev->parent), dev->parent->seq); 65 } 66 67 return CMD_RET_SUCCESS; 68 } 69 70 static int do_dump(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 71 { 72 struct udevice *dev; 73 uint8_t value; 74 uint reg; 75 int ret; 76 77 if (!currdev) { 78 printf("First, set the PMIC device!\n"); 79 return CMD_RET_USAGE; 80 } 81 82 dev = currdev; 83 84 printf("Dump pmic: %s registers\n", dev->name); 85 86 for (reg = 0; reg < pmic_reg_count(dev); reg++) { 87 ret = pmic_read(dev, reg, &value, 1); 88 if (ret) { 89 printf("Can't read register: %d\n", reg); 90 return failure(ret); 91 } 92 93 if (!(reg % 16)) 94 printf("\n0x%02x: ", reg); 95 96 printf("%2.2x ", value); 97 } 98 printf("\n"); 99 100 return CMD_RET_SUCCESS; 101 } 102 103 static int do_read(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 104 { 105 struct udevice *dev; 106 int regs, ret; 107 uint8_t value; 108 uint reg; 109 110 if (!currdev) { 111 printf("First, set the PMIC device!\n"); 112 return CMD_RET_USAGE; 113 } 114 115 dev = currdev; 116 117 if (argc != 2) 118 return CMD_RET_USAGE; 119 120 reg = simple_strtoul(argv[1], NULL, 0); 121 regs = pmic_reg_count(dev); 122 if (reg > regs) { 123 printf("PMIC max reg: %d\n", regs); 124 return failure(-EFAULT); 125 } 126 127 ret = pmic_read(dev, reg, &value, 1); 128 if (ret) { 129 printf("Can't read PMIC register: %d!\n", reg); 130 return failure(ret); 131 } 132 133 printf("0x%02x: 0x%2.2x\n", reg, value); 134 135 return CMD_RET_SUCCESS; 136 } 137 138 static int do_write(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 139 { 140 struct udevice *dev; 141 int regs, ret; 142 uint8_t value; 143 uint reg; 144 145 if (!currdev) { 146 printf("First, set the PMIC device!\n"); 147 return CMD_RET_USAGE; 148 } 149 150 dev = currdev; 151 152 if (argc != 3) 153 return CMD_RET_USAGE; 154 155 reg = simple_strtoul(argv[1], NULL, 0); 156 regs = pmic_reg_count(dev); 157 if (reg > regs) { 158 printf("PMIC max reg: %d\n", regs); 159 return failure(-EFAULT); 160 } 161 162 value = simple_strtoul(argv[2], NULL, 0); 163 164 ret = pmic_write(dev, reg, &value, 1); 165 if (ret) { 166 printf("Can't write PMIC register: %d!\n", reg); 167 return failure(ret); 168 } 169 170 return CMD_RET_SUCCESS; 171 } 172 173 static cmd_tbl_t subcmd[] = { 174 U_BOOT_CMD_MKENT(dev, 2, 1, do_dev, "", ""), 175 U_BOOT_CMD_MKENT(list, 1, 1, do_list, "", ""), 176 U_BOOT_CMD_MKENT(dump, 1, 1, do_dump, "", ""), 177 U_BOOT_CMD_MKENT(read, 2, 1, do_read, "", ""), 178 U_BOOT_CMD_MKENT(write, 3, 1, do_write, "", ""), 179 }; 180 181 static int do_pmic(cmd_tbl_t *cmdtp, int flag, int argc, 182 char * const argv[]) 183 { 184 cmd_tbl_t *cmd; 185 186 argc--; 187 argv++; 188 189 cmd = find_cmd_tbl(argv[0], subcmd, ARRAY_SIZE(subcmd)); 190 if (cmd == NULL || argc > cmd->maxargs) 191 return CMD_RET_USAGE; 192 193 return cmd->cmd(cmdtp, flag, argc, argv); 194 } 195 196 U_BOOT_CMD(pmic, CONFIG_SYS_MAXARGS, 1, do_pmic, 197 " operations", 198 "list - list pmic devices\n" 199 "pmic dev [name] - show or [set] operating PMIC device\n" 200 "pmic dump - dump registers\n" 201 "pmic read address - read byte of register at address\n" 202 "pmic write address - write byte to register at address\n" 203 ); 204