Merge branch 'master' of git://git.denx.de/u-boot-socfpga
[platform/kernel/u-boot.git] / cmd / mdio.c
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * (C) Copyright 2011 Freescale Semiconductor, Inc
4  * Andy Fleming
5  */
6
7 /*
8  * MDIO Commands
9  */
10
11 #include <common.h>
12 #include <command.h>
13 #include <miiphy.h>
14 #include <phy.h>
15
16 static char last_op[2];
17 static uint last_data;
18 static uint last_addr_lo;
19 static uint last_addr_hi;
20 static uint last_devad_lo;
21 static uint last_devad_hi;
22 static uint last_reg_lo;
23 static uint last_reg_hi;
24
25 static int extract_range(char *input, int *plo, int *phi)
26 {
27         char *end;
28         *plo = simple_strtol(input, &end, 16);
29         if (end == input)
30                 return -1;
31
32         if ((*end == '-') && *(++end))
33                 *phi = simple_strtol(end, NULL, 16);
34         else if (*end == '\0')
35                 *phi = *plo;
36         else
37                 return -1;
38
39         return 0;
40 }
41
42 static int mdio_write_ranges(struct phy_device *phydev, struct mii_dev *bus,
43                              int addrlo,
44                              int addrhi, int devadlo, int devadhi,
45                              int reglo, int reghi, unsigned short data,
46                              int extended)
47 {
48         int addr, devad, reg;
49         int err = 0;
50
51         for (addr = addrlo; addr <= addrhi; addr++) {
52                 for (devad = devadlo; devad <= devadhi; devad++) {
53                         for (reg = reglo; reg <= reghi; reg++) {
54                                 if (!extended)
55                                         err = bus->write(bus, addr, devad,
56                                                          reg, data);
57                                 else
58                                         err = phydev->drv->writeext(phydev,
59                                                         addr, devad, reg, data);
60
61                                 if (err)
62                                         goto err_out;
63                         }
64                 }
65         }
66
67 err_out:
68         return err;
69 }
70
71 static int mdio_read_ranges(struct phy_device *phydev, struct mii_dev *bus,
72                             int addrlo,
73                             int addrhi, int devadlo, int devadhi,
74                             int reglo, int reghi, int extended)
75 {
76         int addr, devad, reg;
77
78         printf("Reading from bus %s\n", bus->name);
79         for (addr = addrlo; addr <= addrhi; addr++) {
80                 printf("PHY at address %x:\n", addr);
81
82                 for (devad = devadlo; devad <= devadhi; devad++) {
83                         for (reg = reglo; reg <= reghi; reg++) {
84                                 int val;
85
86                                 if (!extended)
87                                         val = bus->read(bus, addr, devad, reg);
88                                 else
89                                         val = phydev->drv->readext(phydev, addr,
90                                                 devad, reg);
91
92                                 if (val < 0) {
93                                         printf("Error\n");
94
95                                         return val;
96                                 }
97
98                                 if (devad >= 0)
99                                         printf("%d.", devad);
100
101                                 printf("%d - 0x%x\n", reg, val & 0xffff);
102                         }
103                 }
104         }
105
106         return 0;
107 }
108
109 /* The register will be in the form [a[-b].]x[-y] */
110 static int extract_reg_range(char *input, int *devadlo, int *devadhi,
111                              int *reglo, int *reghi)
112 {
113         char *regstr;
114
115         /* use strrchr to find the last string after a '.' */
116         regstr = strrchr(input, '.');
117
118         /* If it exists, extract the devad(s) */
119         if (regstr) {
120                 char devadstr[32];
121
122                 strncpy(devadstr, input, regstr - input);
123                 devadstr[regstr - input] = '\0';
124
125                 if (extract_range(devadstr, devadlo, devadhi))
126                         return -1;
127
128                 regstr++;
129         } else {
130                 /* Otherwise, we have no devad, and we just got regs */
131                 *devadlo = *devadhi = MDIO_DEVAD_NONE;
132
133                 regstr = input;
134         }
135
136         return extract_range(regstr, reglo, reghi);
137 }
138
139 static int extract_phy_range(char *const argv[], int argc, struct mii_dev **bus,
140                              struct phy_device **phydev,
141                              int *addrlo, int *addrhi)
142 {
143         struct phy_device *dev = *phydev;
144
145         if ((argc < 1) || (argc > 2))
146                 return -1;
147
148         /* If there are two arguments, it's busname addr */
149         if (argc == 2) {
150                 *bus = miiphy_get_dev_by_name(argv[0]);
151
152                 if (!*bus)
153                         return -1;
154
155                 return extract_range(argv[1], addrlo, addrhi);
156         }
157
158         /* It must be one argument, here */
159
160         /*
161          * This argument can be one of two things:
162          * 1) Ethernet device name
163          * 2) Just an address (use the previously-used bus)
164          *
165          * We check all buses for a PHY which is connected to an ethernet
166          * device by the given name.  If none are found, we call
167          * extract_range() on the string, and see if it's an address range.
168          */
169         dev = mdio_phydev_for_ethname(argv[0]);
170
171         if (dev) {
172                 *addrlo = *addrhi = dev->addr;
173                 *bus = dev->bus;
174
175                 return 0;
176         }
177
178         /* It's an address or nothing useful */
179         return extract_range(argv[0], addrlo, addrhi);
180 }
181
182 /* ---------------------------------------------------------------- */
183 static int do_mdio(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
184 {
185         char op[2];
186         int addrlo, addrhi, reglo, reghi, devadlo, devadhi;
187         unsigned short  data;
188         int pos = argc - 1;
189         struct mii_dev *bus;
190         struct phy_device *phydev = NULL;
191         int extended = 0;
192
193         if (argc < 2)
194                 return CMD_RET_USAGE;
195
196         /*
197          * We use the last specified parameters, unless new ones are
198          * entered.
199          */
200         op[0] = argv[1][0];
201         addrlo = last_addr_lo;
202         addrhi = last_addr_hi;
203         devadlo = last_devad_lo;
204         devadhi = last_devad_hi;
205         reglo  = last_reg_lo;
206         reghi  = last_reg_hi;
207         data   = last_data;
208
209         bus = mdio_get_current_dev();
210
211         if (flag & CMD_FLAG_REPEAT)
212                 op[0] = last_op[0];
213
214         if (strlen(argv[1]) > 1) {
215                 op[1] = argv[1][1];
216                 if (op[1] == 'x') {
217                         phydev = mdio_phydev_for_ethname(argv[2]);
218
219                         if (phydev) {
220                                 addrlo = phydev->addr;
221                                 addrhi = addrlo;
222                                 bus = phydev->bus;
223                                 extended = 1;
224                         } else {
225                                 return -1;
226                         }
227
228                         if (!phydev->drv ||
229                             (!phydev->drv->writeext && (op[0] == 'w')) ||
230                             (!phydev->drv->readext && (op[0] == 'r'))) {
231                                 puts("PHY does not have extended functions\n");
232                                 return -1;
233                         }
234                 }
235         }
236
237         switch (op[0]) {
238         case 'w':
239                 if (pos > 1)
240                         data = simple_strtoul(argv[pos--], NULL, 16);
241         case 'r':
242                 if (pos > 1)
243                         if (extract_reg_range(argv[pos--], &devadlo, &devadhi,
244                                               &reglo, &reghi))
245                                 return -1;
246
247         default:
248                 if (pos > 1)
249                         if (extract_phy_range(&argv[2], pos - 1, &bus,
250                                               &phydev, &addrlo, &addrhi))
251                                 return -1;
252
253                 break;
254         }
255
256         if (op[0] == 'l') {
257                 mdio_list_devices();
258
259                 return 0;
260         }
261
262         /* Save the chosen bus */
263         miiphy_set_current_dev(bus->name);
264
265         switch (op[0]) {
266         case 'w':
267                 mdio_write_ranges(phydev, bus, addrlo, addrhi, devadlo, devadhi,
268                                   reglo, reghi, data, extended);
269                 break;
270
271         case 'r':
272                 mdio_read_ranges(phydev, bus, addrlo, addrhi, devadlo, devadhi,
273                                  reglo, reghi, extended);
274                 break;
275         }
276
277         /*
278          * Save the parameters for repeats.
279          */
280         last_op[0] = op[0];
281         last_addr_lo = addrlo;
282         last_addr_hi = addrhi;
283         last_devad_lo = devadlo;
284         last_devad_hi = devadhi;
285         last_reg_lo  = reglo;
286         last_reg_hi  = reghi;
287         last_data    = data;
288
289         return 0;
290 }
291
292 /***************************************************/
293
294 U_BOOT_CMD(
295         mdio,   6,      1,      do_mdio,
296         "MDIO utility commands",
297         "list                   - List MDIO buses\n"
298         "mdio read <phydev> [<devad>.]<reg> - "
299                 "read PHY's register at <devad>.<reg>\n"
300         "mdio write <phydev> [<devad>.]<reg> <data> - "
301                 "write PHY's register at <devad>.<reg>\n"
302         "mdio rx <phydev> [<devad>.]<reg> - "
303                 "read PHY's extended register at <devad>.<reg>\n"
304         "mdio wx <phydev> [<devad>.]<reg> <data> - "
305                 "write PHY's extended register at <devad>.<reg>\n"
306         "<phydev> may be:\n"
307         "   <busname>  <addr>\n"
308         "   <addr>\n"
309         "   <eth name>\n"
310         "<addr> <devad>, and <reg> may be ranges, e.g. 1-5.4-0x1f.\n"
311 );