phy.c 6.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * (C) Copyright 2014
  4. * Dirk Eibach, Guntermann & Drunck GmbH, dirk.eibach@gdsys.cc
  5. */
  6. #include <common.h>
  7. #include <log.h>
  8. #include <miiphy.h>
  9. enum {
  10. MIICMD_SET,
  11. MIICMD_MODIFY,
  12. MIICMD_VERIFY_VALUE,
  13. MIICMD_WAIT_FOR_VALUE,
  14. };
  15. struct mii_setupcmd {
  16. u8 token;
  17. u8 reg;
  18. u16 data;
  19. u16 mask;
  20. u32 timeout;
  21. };
  22. /*
  23. * verify we are talking to a 88e1518
  24. */
  25. struct mii_setupcmd verify_88e1518[] = {
  26. { MIICMD_SET, 22, 0x0000 },
  27. { MIICMD_VERIFY_VALUE, 2, 0x0141, 0xffff },
  28. { MIICMD_VERIFY_VALUE, 3, 0x0dd0, 0xfff0 },
  29. };
  30. /*
  31. * workaround for erratum mentioned in 88E1518 release notes
  32. */
  33. struct mii_setupcmd fixup_88e1518[] = {
  34. { MIICMD_SET, 22, 0x00ff },
  35. { MIICMD_SET, 17, 0x214b },
  36. { MIICMD_SET, 16, 0x2144 },
  37. { MIICMD_SET, 17, 0x0c28 },
  38. { MIICMD_SET, 16, 0x2146 },
  39. { MIICMD_SET, 17, 0xb233 },
  40. { MIICMD_SET, 16, 0x214d },
  41. { MIICMD_SET, 17, 0xcc0c },
  42. { MIICMD_SET, 16, 0x2159 },
  43. { MIICMD_SET, 22, 0x0000 },
  44. };
  45. /*
  46. * default initialization:
  47. * - set RGMII receive timing to "receive clock transition when data stable"
  48. * - set RGMII transmit timing to "transmit clock internally delayed"
  49. * - set RGMII output impedance target to 78,8 Ohm
  50. * - run output impedance calibration
  51. * - set autonegotiation advertise to 1000FD only
  52. */
  53. struct mii_setupcmd default_88e1518[] = {
  54. { MIICMD_SET, 22, 0x0002 },
  55. { MIICMD_MODIFY, 21, 0x0030, 0x0030 },
  56. { MIICMD_MODIFY, 25, 0x0000, 0x0003 },
  57. { MIICMD_MODIFY, 24, 0x8000, 0x8000 },
  58. { MIICMD_WAIT_FOR_VALUE, 24, 0x4000, 0x4000, 2000 },
  59. { MIICMD_SET, 22, 0x0000 },
  60. { MIICMD_MODIFY, 4, 0x0000, 0x01e0 },
  61. { MIICMD_MODIFY, 9, 0x0200, 0x0300 },
  62. };
  63. /*
  64. * turn off CLK125 for PHY daughterboard
  65. */
  66. struct mii_setupcmd ch1fix_88e1518[] = {
  67. { MIICMD_SET, 22, 0x0002 },
  68. { MIICMD_MODIFY, 16, 0x0006, 0x0006 },
  69. { MIICMD_SET, 22, 0x0000 },
  70. };
  71. /*
  72. * perform copper software reset
  73. */
  74. struct mii_setupcmd swreset_88e1518[] = {
  75. { MIICMD_SET, 22, 0x0000 },
  76. { MIICMD_MODIFY, 0, 0x8000, 0x8000 },
  77. { MIICMD_WAIT_FOR_VALUE, 0, 0x0000, 0x8000, 2000 },
  78. };
  79. /*
  80. * special one for 88E1514:
  81. * Force SGMII to Copper mode
  82. */
  83. struct mii_setupcmd mii_to_copper_88e1514[] = {
  84. { MIICMD_SET, 22, 0x0012 },
  85. { MIICMD_MODIFY, 20, 0x0001, 0x0007 },
  86. { MIICMD_MODIFY, 20, 0x8000, 0x8000 },
  87. { MIICMD_SET, 22, 0x0000 },
  88. };
  89. /*
  90. * turn off SGMII auto-negotiation
  91. */
  92. struct mii_setupcmd sgmii_autoneg_off_88e1518[] = {
  93. { MIICMD_SET, 22, 0x0001 },
  94. { MIICMD_MODIFY, 0, 0x0000, 0x1000 },
  95. { MIICMD_MODIFY, 0, 0x8000, 0x8000 },
  96. { MIICMD_SET, 22, 0x0000 },
  97. };
  98. /*
  99. * invert LED2 polarity
  100. */
  101. struct mii_setupcmd invert_led2_88e1514[] = {
  102. { MIICMD_SET, 22, 0x0003 },
  103. { MIICMD_MODIFY, 17, 0x0030, 0x0010 },
  104. { MIICMD_SET, 22, 0x0000 },
  105. };
  106. static int process_setupcmd(const char *bus, unsigned char addr,
  107. struct mii_setupcmd *setupcmd)
  108. {
  109. int res;
  110. u8 reg = setupcmd->reg;
  111. u16 data = setupcmd->data;
  112. u16 mask = setupcmd->mask;
  113. u32 timeout = setupcmd->timeout;
  114. u16 orig_data;
  115. unsigned long start;
  116. debug("mii %s:%u reg %2u ", bus, addr, reg);
  117. switch (setupcmd->token) {
  118. case MIICMD_MODIFY:
  119. res = miiphy_read(bus, addr, reg, &orig_data);
  120. if (res)
  121. break;
  122. debug("is %04x. (value %04x mask %04x) ", orig_data, data,
  123. mask);
  124. data = (orig_data & ~mask) | (data & mask);
  125. /* fallthrough */
  126. case MIICMD_SET:
  127. debug("=> %04x\n", data);
  128. res = miiphy_write(bus, addr, reg, data);
  129. break;
  130. case MIICMD_VERIFY_VALUE:
  131. res = miiphy_read(bus, addr, reg, &orig_data);
  132. if (res)
  133. break;
  134. if ((orig_data & mask) != (data & mask))
  135. res = -1;
  136. debug("(value %04x mask %04x) == %04x? %s\n", data, mask,
  137. orig_data, res ? "FAIL" : "PASS");
  138. break;
  139. case MIICMD_WAIT_FOR_VALUE:
  140. res = -1;
  141. start = get_timer(0);
  142. while ((res != 0) && (get_timer(start) < timeout)) {
  143. res = miiphy_read(bus, addr, reg, &orig_data);
  144. if (res)
  145. continue;
  146. if ((orig_data & mask) != (data & mask))
  147. res = -1;
  148. }
  149. debug("(value %04x mask %04x) == %04x? %s after %lu ms\n", data,
  150. mask, orig_data, res ? "FAIL" : "PASS",
  151. get_timer(start));
  152. break;
  153. default:
  154. res = -1;
  155. break;
  156. }
  157. return res;
  158. }
  159. static int process_setup(const char *bus, unsigned char addr,
  160. struct mii_setupcmd *setupcmd, unsigned int count)
  161. {
  162. int res = 0;
  163. unsigned int k;
  164. for (k = 0; k < count; ++k) {
  165. res = process_setupcmd(bus, addr, &setupcmd[k]);
  166. if (res) {
  167. printf("mii cmd %u on bus %s addr %u failed, aborting setup\n",
  168. setupcmd[k].token, bus, addr);
  169. break;
  170. }
  171. }
  172. return res;
  173. }
  174. int setup_88e1518(const char *bus, unsigned char addr)
  175. {
  176. int res;
  177. res = process_setup(bus, addr,
  178. verify_88e1518, ARRAY_SIZE(verify_88e1518));
  179. if (res)
  180. return res;
  181. res = process_setup(bus, addr,
  182. fixup_88e1518, ARRAY_SIZE(fixup_88e1518));
  183. if (res)
  184. return res;
  185. res = process_setup(bus, addr,
  186. default_88e1518, ARRAY_SIZE(default_88e1518));
  187. if (res)
  188. return res;
  189. if (addr) {
  190. res = process_setup(bus, addr,
  191. ch1fix_88e1518, ARRAY_SIZE(ch1fix_88e1518));
  192. if (res)
  193. return res;
  194. }
  195. res = process_setup(bus, addr,
  196. swreset_88e1518, ARRAY_SIZE(swreset_88e1518));
  197. if (res)
  198. return res;
  199. return 0;
  200. }
  201. int setup_88e1514(const char *bus, unsigned char addr)
  202. {
  203. int res;
  204. res = process_setup(bus, addr,
  205. verify_88e1518, ARRAY_SIZE(verify_88e1518));
  206. if (res)
  207. return res;
  208. res = process_setup(bus, addr,
  209. fixup_88e1518, ARRAY_SIZE(fixup_88e1518));
  210. if (res)
  211. return res;
  212. res = process_setup(bus, addr,
  213. mii_to_copper_88e1514,
  214. ARRAY_SIZE(mii_to_copper_88e1514));
  215. if (res)
  216. return res;
  217. res = process_setup(bus, addr,
  218. sgmii_autoneg_off_88e1518,
  219. ARRAY_SIZE(sgmii_autoneg_off_88e1518));
  220. if (res)
  221. return res;
  222. res = process_setup(bus, addr,
  223. invert_led2_88e1514,
  224. ARRAY_SIZE(invert_led2_88e1514));
  225. if (res)
  226. return res;
  227. res = process_setup(bus, addr,
  228. default_88e1518, ARRAY_SIZE(default_88e1518));
  229. if (res)
  230. return res;
  231. if (addr) {
  232. res = process_setup(bus, addr,
  233. ch1fix_88e1518, ARRAY_SIZE(ch1fix_88e1518));
  234. if (res)
  235. return res;
  236. }
  237. res = process_setup(bus, addr,
  238. swreset_88e1518, ARRAY_SIZE(swreset_88e1518));
  239. if (res)
  240. return res;
  241. return 0;
  242. }