mdio.c 6.5 KB

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