2 * (C) Copyright 2011 Freescale Semiconductor, Inc
5 * SPDX-License-Identifier: GPL-2.0+
17 static char last_op[2];
18 static uint last_data;
19 static uint last_addr_lo;
20 static uint last_addr_hi;
21 static uint last_devad_lo;
22 static uint last_devad_hi;
23 static uint last_reg_lo;
24 static uint last_reg_hi;
26 static int extract_range(char *input, int *plo, int *phi)
29 *plo = simple_strtol(input, &end, 16);
33 if ((*end == '-') && *(++end))
34 *phi = simple_strtol(end, NULL, 16);
35 else if (*end == '\0')
43 static int mdio_write_ranges(struct phy_device *phydev, struct mii_dev *bus,
45 int addrhi, int devadlo, int devadhi,
46 int reglo, int reghi, unsigned short data,
52 for (addr = addrlo; addr <= addrhi; addr++) {
53 for (devad = devadlo; devad <= devadhi; devad++) {
54 for (reg = reglo; reg <= reghi; reg++) {
56 err = bus->write(bus, addr, devad,
59 err = phydev->drv->writeext(phydev,
60 addr, devad, reg, data);
72 static int mdio_read_ranges(struct phy_device *phydev, struct mii_dev *bus,
74 int addrhi, int devadlo, int devadhi,
75 int reglo, int reghi, int extended)
79 printf("Reading from bus %s\n", bus->name);
80 for (addr = addrlo; addr <= addrhi; addr++) {
81 printf("PHY at address %x:\n", addr);
83 for (devad = devadlo; devad <= devadhi; devad++) {
84 for (reg = reglo; reg <= reghi; reg++) {
88 val = bus->read(bus, addr, devad, reg);
90 val = phydev->drv->readext(phydev, addr,
100 printf("%d.", devad);
102 printf("%d - 0x%x\n", reg, val & 0xffff);
110 /* The register will be in the form [a[-b].]x[-y] */
111 static int extract_reg_range(char *input, int *devadlo, int *devadhi,
112 int *reglo, int *reghi)
116 /* use strrchr to find the last string after a '.' */
117 regstr = strrchr(input, '.');
119 /* If it exists, extract the devad(s) */
123 strncpy(devadstr, input, regstr - input);
124 devadstr[regstr - input] = '\0';
126 if (extract_range(devadstr, devadlo, devadhi))
131 /* Otherwise, we have no devad, and we just got regs */
132 *devadlo = *devadhi = MDIO_DEVAD_NONE;
137 return extract_range(regstr, reglo, reghi);
140 static int extract_phy_range(char *const argv[], int argc, struct mii_dev **bus,
141 struct phy_device **phydev,
142 int *addrlo, int *addrhi)
144 struct phy_device *dev = *phydev;
146 if ((argc < 1) || (argc > 2))
149 /* If there are two arguments, it's busname addr */
151 *bus = miiphy_get_dev_by_name(argv[0]);
156 return extract_range(argv[1], addrlo, addrhi);
159 /* It must be one argument, here */
162 * This argument can be one of two things:
163 * 1) Ethernet device name
164 * 2) Just an address (use the previously-used bus)
166 * We check all buses for a PHY which is connected to an ethernet
167 * device by the given name. If none are found, we call
168 * extract_range() on the string, and see if it's an address range.
170 dev = mdio_phydev_for_ethname(argv[0]);
173 *addrlo = *addrhi = dev->addr;
179 /* It's an address or nothing useful */
180 return extract_range(argv[0], addrlo, addrhi);
183 /* ---------------------------------------------------------------- */
184 static int do_mdio(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
187 int addrlo, addrhi, reglo, reghi, devadlo, devadhi;
191 struct phy_device *phydev = NULL;
195 return CMD_RET_USAGE;
198 * We use the last specified parameters, unless new ones are
202 addrlo = last_addr_lo;
203 addrhi = last_addr_hi;
204 devadlo = last_devad_lo;
205 devadhi = last_devad_hi;
210 bus = mdio_get_current_dev();
212 if (flag & CMD_FLAG_REPEAT)
215 if (strlen(argv[1]) > 1) {
218 phydev = mdio_phydev_for_ethname(argv[2]);
221 addrlo = phydev->addr;
230 (!phydev->drv->writeext && (op[0] == 'w')) ||
231 (!phydev->drv->readext && (op[0] == 'r'))) {
232 puts("PHY does not have extended functions\n");
241 data = simple_strtoul(argv[pos--], NULL, 16);
244 if (extract_reg_range(argv[pos--], &devadlo, &devadhi,
250 if (extract_phy_range(&argv[2], pos - 1, &bus,
251 &phydev, &addrlo, &addrhi))
263 /* Save the chosen bus */
264 miiphy_set_current_dev(bus->name);
268 mdio_write_ranges(phydev, bus, addrlo, addrhi, devadlo, devadhi,
269 reglo, reghi, data, extended);
273 mdio_read_ranges(phydev, bus, addrlo, addrhi, devadlo, devadhi,
274 reglo, reghi, extended);
279 * Save the parameters for repeats.
282 last_addr_lo = addrlo;
283 last_addr_hi = addrhi;
284 last_devad_lo = devadlo;
285 last_devad_hi = devadhi;
293 /***************************************************/
297 "MDIO utility commands",
298 "list - List MDIO buses\n"
299 "mdio read <phydev> [<devad>.]<reg> - "
300 "read PHY's register at <devad>.<reg>\n"
301 "mdio write <phydev> [<devad>.]<reg> <data> - "
302 "write PHY's register at <devad>.<reg>\n"
303 "mdio rx <phydev> [<devad>.]<reg> - "
304 "read PHY's extended register at <devad>.<reg>\n"
305 "mdio wx <phydev> [<devad>.]<reg> <data> - "
306 "write PHY's extended register at <devad>.<reg>\n"
308 " <busname> <addr>\n"
311 "<addr> <devad>, and <reg> may be ranges, e.g. 1-5.4-0x1f.\n"