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
failure(int ret)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
do_dev(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])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
do_list(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])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
do_dump(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])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
do_read(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])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
do_write(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])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
do_pmic(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])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