mii.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2001
  4. * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com
  5. */
  6. /*
  7. * MII Utilities
  8. */
  9. #include <common.h>
  10. #include <command.h>
  11. #include <dm.h>
  12. #include <miiphy.h>
  13. typedef struct _MII_field_desc_t {
  14. ushort hi;
  15. ushort lo;
  16. ushort mask;
  17. const char *name;
  18. } MII_field_desc_t;
  19. static const MII_field_desc_t reg_0_desc_tbl[] = {
  20. { 15, 15, 0x01, "reset" },
  21. { 14, 14, 0x01, "loopback" },
  22. { 13, 6, 0x81, "speed selection" }, /* special */
  23. { 12, 12, 0x01, "A/N enable" },
  24. { 11, 11, 0x01, "power-down" },
  25. { 10, 10, 0x01, "isolate" },
  26. { 9, 9, 0x01, "restart A/N" },
  27. { 8, 8, 0x01, "duplex" }, /* special */
  28. { 7, 7, 0x01, "collision test enable" },
  29. { 5, 0, 0x3f, "(reserved)" }
  30. };
  31. static const MII_field_desc_t reg_1_desc_tbl[] = {
  32. { 15, 15, 0x01, "100BASE-T4 able" },
  33. { 14, 14, 0x01, "100BASE-X full duplex able" },
  34. { 13, 13, 0x01, "100BASE-X half duplex able" },
  35. { 12, 12, 0x01, "10 Mbps full duplex able" },
  36. { 11, 11, 0x01, "10 Mbps half duplex able" },
  37. { 10, 10, 0x01, "100BASE-T2 full duplex able" },
  38. { 9, 9, 0x01, "100BASE-T2 half duplex able" },
  39. { 8, 8, 0x01, "extended status" },
  40. { 7, 7, 0x01, "(reserved)" },
  41. { 6, 6, 0x01, "MF preamble suppression" },
  42. { 5, 5, 0x01, "A/N complete" },
  43. { 4, 4, 0x01, "remote fault" },
  44. { 3, 3, 0x01, "A/N able" },
  45. { 2, 2, 0x01, "link status" },
  46. { 1, 1, 0x01, "jabber detect" },
  47. { 0, 0, 0x01, "extended capabilities" },
  48. };
  49. static const MII_field_desc_t reg_2_desc_tbl[] = {
  50. { 15, 0, 0xffff, "OUI portion" },
  51. };
  52. static const MII_field_desc_t reg_3_desc_tbl[] = {
  53. { 15, 10, 0x3f, "OUI portion" },
  54. { 9, 4, 0x3f, "manufacturer part number" },
  55. { 3, 0, 0x0f, "manufacturer rev. number" },
  56. };
  57. static const MII_field_desc_t reg_4_desc_tbl[] = {
  58. { 15, 15, 0x01, "next page able" },
  59. { 14, 14, 0x01, "(reserved)" },
  60. { 13, 13, 0x01, "remote fault" },
  61. { 12, 12, 0x01, "(reserved)" },
  62. { 11, 11, 0x01, "asymmetric pause" },
  63. { 10, 10, 0x01, "pause enable" },
  64. { 9, 9, 0x01, "100BASE-T4 able" },
  65. { 8, 8, 0x01, "100BASE-TX full duplex able" },
  66. { 7, 7, 0x01, "100BASE-TX able" },
  67. { 6, 6, 0x01, "10BASE-T full duplex able" },
  68. { 5, 5, 0x01, "10BASE-T able" },
  69. { 4, 0, 0x1f, "selector" },
  70. };
  71. static const MII_field_desc_t reg_5_desc_tbl[] = {
  72. { 15, 15, 0x01, "next page able" },
  73. { 14, 14, 0x01, "acknowledge" },
  74. { 13, 13, 0x01, "remote fault" },
  75. { 12, 12, 0x01, "(reserved)" },
  76. { 11, 11, 0x01, "asymmetric pause able" },
  77. { 10, 10, 0x01, "pause able" },
  78. { 9, 9, 0x01, "100BASE-T4 able" },
  79. { 8, 8, 0x01, "100BASE-X full duplex able" },
  80. { 7, 7, 0x01, "100BASE-TX able" },
  81. { 6, 6, 0x01, "10BASE-T full duplex able" },
  82. { 5, 5, 0x01, "10BASE-T able" },
  83. { 4, 0, 0x1f, "partner selector" },
  84. };
  85. static const MII_field_desc_t reg_9_desc_tbl[] = {
  86. { 15, 13, 0x07, "test mode" },
  87. { 12, 12, 0x01, "manual master/slave enable" },
  88. { 11, 11, 0x01, "manual master/slave value" },
  89. { 10, 10, 0x01, "multi/single port" },
  90. { 9, 9, 0x01, "1000BASE-T full duplex able" },
  91. { 8, 8, 0x01, "1000BASE-T half duplex able" },
  92. { 7, 7, 0x01, "automatic TDR on link down" },
  93. { 6, 6, 0x7f, "(reserved)" },
  94. };
  95. static const MII_field_desc_t reg_10_desc_tbl[] = {
  96. { 15, 15, 0x01, "master/slave config fault" },
  97. { 14, 14, 0x01, "master/slave config result" },
  98. { 13, 13, 0x01, "local receiver status OK" },
  99. { 12, 12, 0x01, "remote receiver status OK" },
  100. { 11, 11, 0x01, "1000BASE-T full duplex able" },
  101. { 10, 10, 0x01, "1000BASE-T half duplex able" },
  102. { 9, 8, 0x03, "(reserved)" },
  103. { 7, 0, 0xff, "1000BASE-T idle error counter"},
  104. };
  105. typedef struct _MII_reg_desc_t {
  106. ushort regno;
  107. const MII_field_desc_t *pdesc;
  108. ushort len;
  109. const char *name;
  110. } MII_reg_desc_t;
  111. static const MII_reg_desc_t mii_reg_desc_tbl[] = {
  112. { MII_BMCR, reg_0_desc_tbl, ARRAY_SIZE(reg_0_desc_tbl),
  113. "PHY control register" },
  114. { MII_BMSR, reg_1_desc_tbl, ARRAY_SIZE(reg_1_desc_tbl),
  115. "PHY status register" },
  116. { MII_PHYSID1, reg_2_desc_tbl, ARRAY_SIZE(reg_2_desc_tbl),
  117. "PHY ID 1 register" },
  118. { MII_PHYSID2, reg_3_desc_tbl, ARRAY_SIZE(reg_3_desc_tbl),
  119. "PHY ID 2 register" },
  120. { MII_ADVERTISE, reg_4_desc_tbl, ARRAY_SIZE(reg_4_desc_tbl),
  121. "Autonegotiation advertisement register" },
  122. { MII_LPA, reg_5_desc_tbl, ARRAY_SIZE(reg_5_desc_tbl),
  123. "Autonegotiation partner abilities register" },
  124. { MII_CTRL1000, reg_9_desc_tbl, ARRAY_SIZE(reg_9_desc_tbl),
  125. "1000BASE-T control register" },
  126. { MII_STAT1000, reg_10_desc_tbl, ARRAY_SIZE(reg_10_desc_tbl),
  127. "1000BASE-T status register" },
  128. };
  129. static void dump_reg(
  130. ushort regval,
  131. const MII_reg_desc_t *prd);
  132. static bool special_field(ushort regno, const MII_field_desc_t *pdesc,
  133. ushort regval);
  134. static void MII_dump(const ushort *regvals, uchar reglo, uchar reghi)
  135. {
  136. ulong i;
  137. for (i = 0; i < ARRAY_SIZE(mii_reg_desc_tbl); i++) {
  138. const uchar reg = mii_reg_desc_tbl[i].regno;
  139. if (reg >= reglo && reg <= reghi)
  140. dump_reg(regvals[reg - reglo], &mii_reg_desc_tbl[i]);
  141. }
  142. }
  143. /* Print out field position, value, name */
  144. static void dump_field(const MII_field_desc_t *pdesc, ushort regval)
  145. {
  146. if (pdesc->hi == pdesc->lo)
  147. printf("%2u ", pdesc->lo);
  148. else
  149. printf("%2u-%2u", pdesc->hi, pdesc->lo);
  150. printf(" = %5u %s", (regval >> pdesc->lo) & pdesc->mask,
  151. pdesc->name);
  152. }
  153. static void dump_reg(
  154. ushort regval,
  155. const MII_reg_desc_t *prd)
  156. {
  157. ulong i;
  158. ushort mask_in_place;
  159. const MII_field_desc_t *pdesc;
  160. printf("%u. (%04hx) -- %s --\n",
  161. prd->regno, regval, prd->name);
  162. for (i = 0; i < prd->len; i++) {
  163. pdesc = &prd->pdesc[i];
  164. mask_in_place = pdesc->mask << pdesc->lo;
  165. printf(" (%04hx:%04x) %u.",
  166. mask_in_place,
  167. regval & mask_in_place,
  168. prd->regno);
  169. if (!special_field(prd->regno, pdesc, regval))
  170. dump_field(pdesc, regval);
  171. printf("\n");
  172. }
  173. printf("\n");
  174. }
  175. /* Special fields:
  176. ** 0.6,13
  177. ** 0.8
  178. ** 2.15-0
  179. ** 3.15-0
  180. ** 4.4-0
  181. ** 5.4-0
  182. */
  183. static bool special_field(ushort regno, const MII_field_desc_t *pdesc,
  184. ushort regval)
  185. {
  186. const ushort sel_bits = (regval >> pdesc->lo) & pdesc->mask;
  187. if ((regno == MII_BMCR) && (pdesc->lo == 6)) {
  188. ushort speed_bits = regval & (BMCR_SPEED1000 | BMCR_SPEED100);
  189. printf("%2u,%2u = b%u%u speed selection = %s Mbps",
  190. 6, 13,
  191. (regval >> 6) & 1,
  192. (regval >> 13) & 1,
  193. speed_bits == BMCR_SPEED1000 ? "1000" :
  194. speed_bits == BMCR_SPEED100 ? "100" :
  195. "10");
  196. return 1;
  197. }
  198. else if ((regno == MII_BMCR) && (pdesc->lo == 8)) {
  199. dump_field(pdesc, regval);
  200. printf(" = %s", ((regval >> pdesc->lo) & 1) ? "full" : "half");
  201. return 1;
  202. }
  203. else if ((regno == MII_ADVERTISE) && (pdesc->lo == 0)) {
  204. dump_field(pdesc, regval);
  205. printf(" = %s",
  206. sel_bits == PHY_ANLPAR_PSB_802_3 ? "IEEE 802.3 CSMA/CD" :
  207. sel_bits == PHY_ANLPAR_PSB_802_9 ?
  208. "IEEE 802.9 ISLAN-16T" : "???");
  209. return 1;
  210. }
  211. else if ((regno == MII_LPA) && (pdesc->lo == 0)) {
  212. dump_field(pdesc, regval);
  213. printf(" = %s",
  214. sel_bits == PHY_ANLPAR_PSB_802_3 ? "IEEE 802.3 CSMA/CD" :
  215. sel_bits == PHY_ANLPAR_PSB_802_9 ?
  216. "IEEE 802.9 ISLAN-16T" : "???");
  217. return 1;
  218. }
  219. return 0;
  220. }
  221. static char last_op[2];
  222. static uint last_data;
  223. static uint last_addr_lo;
  224. static uint last_addr_hi;
  225. static uint last_reg_lo;
  226. static uint last_reg_hi;
  227. static uint last_mask;
  228. static void extract_range(
  229. char * input,
  230. unsigned char * plo,
  231. unsigned char * phi)
  232. {
  233. char * end;
  234. *plo = hextoul(input, &end);
  235. if (*end == '-') {
  236. end++;
  237. *phi = hextoul(end, NULL);
  238. }
  239. else {
  240. *phi = *plo;
  241. }
  242. }
  243. /* ---------------------------------------------------------------- */
  244. static int do_mii(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
  245. {
  246. char op[2];
  247. unsigned char addrlo, addrhi, reglo, reghi;
  248. unsigned char addr, reg;
  249. unsigned short data, mask;
  250. int rcode = 0;
  251. const char *devname;
  252. if (argc < 2)
  253. return CMD_RET_USAGE;
  254. #if defined(CONFIG_MII_INIT)
  255. mii_init ();
  256. #endif
  257. /*
  258. * We use the last specified parameters, unless new ones are
  259. * entered.
  260. */
  261. op[0] = last_op[0];
  262. op[1] = last_op[1];
  263. addrlo = last_addr_lo;
  264. addrhi = last_addr_hi;
  265. reglo = last_reg_lo;
  266. reghi = last_reg_hi;
  267. data = last_data;
  268. mask = last_mask;
  269. if ((flag & CMD_FLAG_REPEAT) == 0) {
  270. op[0] = argv[1][0];
  271. if (strlen(argv[1]) > 1)
  272. op[1] = argv[1][1];
  273. else
  274. op[1] = '\0';
  275. if (argc >= 3)
  276. extract_range(argv[2], &addrlo, &addrhi);
  277. if (argc >= 4)
  278. extract_range(argv[3], &reglo, &reghi);
  279. if (argc >= 5)
  280. data = hextoul(argv[4], NULL);
  281. if (argc >= 6)
  282. mask = hextoul(argv[5], NULL);
  283. }
  284. if (addrhi > 31 && strncmp(op, "de", 2)) {
  285. printf("Incorrect PHY address. Range should be 0-31\n");
  286. return CMD_RET_USAGE;
  287. }
  288. /* use current device */
  289. devname = miiphy_get_current_dev();
  290. /*
  291. * check info/read/write.
  292. */
  293. if (op[0] == 'i') {
  294. unsigned char j, start, end;
  295. unsigned int oui;
  296. unsigned char model;
  297. unsigned char rev;
  298. /*
  299. * Look for any and all PHYs. Valid addresses are 0..31.
  300. */
  301. if (argc >= 3) {
  302. start = addrlo; end = addrhi;
  303. } else {
  304. start = 0; end = 31;
  305. }
  306. for (j = start; j <= end; j++) {
  307. if (miiphy_info (devname, j, &oui, &model, &rev) == 0) {
  308. printf("PHY 0x%02X: "
  309. "OUI = 0x%04X, "
  310. "Model = 0x%02X, "
  311. "Rev = 0x%02X, "
  312. "%3dbase%s, %s\n",
  313. j, oui, model, rev,
  314. miiphy_speed (devname, j),
  315. miiphy_is_1000base_x (devname, j)
  316. ? "X" : "T",
  317. (miiphy_duplex (devname, j) == FULL)
  318. ? "FDX" : "HDX");
  319. }
  320. }
  321. } else if (op[0] == 'r') {
  322. for (addr = addrlo; addr <= addrhi; addr++) {
  323. for (reg = reglo; reg <= reghi; reg++) {
  324. data = 0xffff;
  325. if (miiphy_read (devname, addr, reg, &data) != 0) {
  326. printf(
  327. "Error reading from the PHY addr=%02x reg=%02x\n",
  328. addr, reg);
  329. rcode = 1;
  330. } else {
  331. if ((addrlo != addrhi) || (reglo != reghi))
  332. printf("addr=%02x reg=%02x data=",
  333. (uint)addr, (uint)reg);
  334. printf("%04X\n", data & 0x0000FFFF);
  335. }
  336. }
  337. if ((addrlo != addrhi) && (reglo != reghi))
  338. printf("\n");
  339. }
  340. } else if (op[0] == 'w') {
  341. for (addr = addrlo; addr <= addrhi; addr++) {
  342. for (reg = reglo; reg <= reghi; reg++) {
  343. if (miiphy_write (devname, addr, reg, data) != 0) {
  344. printf("Error writing to the PHY addr=%02x reg=%02x\n",
  345. addr, reg);
  346. rcode = 1;
  347. }
  348. }
  349. }
  350. } else if (op[0] == 'm') {
  351. for (addr = addrlo; addr <= addrhi; addr++) {
  352. for (reg = reglo; reg <= reghi; reg++) {
  353. unsigned short val = 0;
  354. if (miiphy_read(devname, addr,
  355. reg, &val)) {
  356. printf("Error reading from the PHY");
  357. printf(" addr=%02x", addr);
  358. printf(" reg=%02x\n", reg);
  359. rcode = 1;
  360. } else {
  361. val = (val & ~mask) | (data & mask);
  362. if (miiphy_write(devname, addr,
  363. reg, val)) {
  364. printf("Error writing to the PHY");
  365. printf(" addr=%02x", addr);
  366. printf(" reg=%02x\n", reg);
  367. rcode = 1;
  368. }
  369. }
  370. }
  371. }
  372. } else if (strncmp(op, "du", 2) == 0) {
  373. ushort regs[MII_STAT1000 + 1]; /* Last reg is 0x0a */
  374. int ok = 1;
  375. if (reglo > MII_STAT1000 || reghi > MII_STAT1000) {
  376. printf("The MII dump command only formats the standard MII registers, 0-5, 9-a.\n");
  377. return 1;
  378. }
  379. for (addr = addrlo; addr <= addrhi; addr++) {
  380. for (reg = reglo; reg <= reghi; reg++) {
  381. if (miiphy_read(devname, addr, reg,
  382. &regs[reg - reglo]) != 0) {
  383. ok = 0;
  384. printf(
  385. "Error reading from the PHY addr=%02x reg=%02x\n",
  386. addr, reg);
  387. rcode = 1;
  388. }
  389. }
  390. if (ok)
  391. MII_dump(regs, reglo, reghi);
  392. printf("\n");
  393. }
  394. } else if (strncmp(op, "de", 2) == 0) {
  395. if (argc == 2)
  396. miiphy_listdev ();
  397. else
  398. miiphy_set_current_dev (argv[2]);
  399. } else {
  400. return CMD_RET_USAGE;
  401. }
  402. /*
  403. * Save the parameters for repeats.
  404. */
  405. last_op[0] = op[0];
  406. last_op[1] = op[1];
  407. last_addr_lo = addrlo;
  408. last_addr_hi = addrhi;
  409. last_reg_lo = reglo;
  410. last_reg_hi = reghi;
  411. last_data = data;
  412. last_mask = mask;
  413. return rcode;
  414. }
  415. /***************************************************/
  416. U_BOOT_CMD(
  417. mii, 6, 1, do_mii,
  418. "MII utility commands",
  419. "device - list available devices\n"
  420. "mii device <devname> - set current device\n"
  421. "mii info <addr> - display MII PHY info\n"
  422. "mii read <addr> <reg> - read MII PHY <addr> register <reg>\n"
  423. "mii write <addr> <reg> <data> - write MII PHY <addr> register <reg>\n"
  424. "mii modify <addr> <reg> <data> <mask> - modify MII PHY <addr> register <reg>\n"
  425. " updating bits identified in <mask>\n"
  426. "mii dump <addr> <reg> - pretty-print <addr> <reg> (0-5 only)\n"
  427. "Addr and/or reg may be ranges, e.g. 2-7."
  428. );