mdio.c 7.1 KB

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