mii.c 12 KB

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