vitesse.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Driver for Vitesse PHYs
  4. *
  5. * Author: Kriston Carson
  6. */
  7. #include <linux/kernel.h>
  8. #include <linux/module.h>
  9. #include <linux/mii.h>
  10. #include <linux/ethtool.h>
  11. #include <linux/phy.h>
  12. #include <linux/bitfield.h>
  13. /* Vitesse Extended Page Magic Register(s) */
  14. #define MII_VSC73XX_EXT_PAGE_1E 0x01
  15. #define MII_VSC82X4_EXT_PAGE_16E 0x10
  16. #define MII_VSC82X4_EXT_PAGE_17E 0x11
  17. #define MII_VSC82X4_EXT_PAGE_18E 0x12
  18. /* Vitesse Extended Control Register 1 */
  19. #define MII_VSC8244_EXT_CON1 0x17
  20. #define MII_VSC8244_EXTCON1_INIT 0x0000
  21. #define MII_VSC8244_EXTCON1_TX_SKEW_MASK 0x0c00
  22. #define MII_VSC8244_EXTCON1_RX_SKEW_MASK 0x0300
  23. #define MII_VSC8244_EXTCON1_TX_SKEW 0x0800
  24. #define MII_VSC8244_EXTCON1_RX_SKEW 0x0200
  25. /* Vitesse Interrupt Mask Register */
  26. #define MII_VSC8244_IMASK 0x19
  27. #define MII_VSC8244_IMASK_IEN 0x8000
  28. #define MII_VSC8244_IMASK_SPEED 0x4000
  29. #define MII_VSC8244_IMASK_LINK 0x2000
  30. #define MII_VSC8244_IMASK_DUPLEX 0x1000
  31. #define MII_VSC8244_IMASK_MASK 0xf000
  32. #define MII_VSC8221_IMASK_MASK 0xa000
  33. /* Vitesse Interrupt Status Register */
  34. #define MII_VSC8244_ISTAT 0x1a
  35. #define MII_VSC8244_ISTAT_STATUS 0x8000
  36. #define MII_VSC8244_ISTAT_SPEED 0x4000
  37. #define MII_VSC8244_ISTAT_LINK 0x2000
  38. #define MII_VSC8244_ISTAT_DUPLEX 0x1000
  39. #define MII_VSC8244_ISTAT_MASK (MII_VSC8244_ISTAT_SPEED | \
  40. MII_VSC8244_ISTAT_LINK | \
  41. MII_VSC8244_ISTAT_DUPLEX)
  42. #define MII_VSC8221_ISTAT_MASK MII_VSC8244_ISTAT_LINK
  43. /* Vitesse Auxiliary Control/Status Register */
  44. #define MII_VSC8244_AUX_CONSTAT 0x1c
  45. #define MII_VSC8244_AUXCONSTAT_INIT 0x0000
  46. #define MII_VSC8244_AUXCONSTAT_DUPLEX 0x0020
  47. #define MII_VSC8244_AUXCONSTAT_SPEED 0x0018
  48. #define MII_VSC8244_AUXCONSTAT_GBIT 0x0010
  49. #define MII_VSC8244_AUXCONSTAT_100 0x0008
  50. #define MII_VSC8221_AUXCONSTAT_INIT 0x0004 /* need to set this bit? */
  51. #define MII_VSC8221_AUXCONSTAT_RESERVED 0x0004
  52. /* Vitesse Extended Page Access Register */
  53. #define MII_VSC82X4_EXT_PAGE_ACCESS 0x1f
  54. /* Vitesse VSC73XX Extended Control Register */
  55. #define MII_VSC73XX_PHY_CTRL_EXT3 0x14
  56. #define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN BIT(4)
  57. #define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT GENMASK(3, 2)
  58. #define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_STA BIT(1)
  59. #define MII_VSC73XX_DOWNSHIFT_MAX 5
  60. #define MII_VSC73XX_DOWNSHIFT_INVAL 1
  61. /* VSC73XX PHY_BYPASS_CTRL register*/
  62. #define MII_VSC73XX_PHY_BYPASS_CTRL MII_DCOUNTER
  63. #define MII_VSC73XX_PBC_TX_DIS BIT(15)
  64. #define MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS BIT(7)
  65. #define MII_VSC73XX_PBC_PAIR_SWAP_DIS BIT(5)
  66. #define MII_VSC73XX_PBC_POL_INV_DIS BIT(4)
  67. #define MII_VSC73XX_PBC_PARALLEL_DET_DIS BIT(3)
  68. #define MII_VSC73XX_PBC_AUTO_NP_EXCHANGE_DIS BIT(1)
  69. /* VSC73XX PHY_AUX_CTRL_STAT register */
  70. #define MII_VSC73XX_PHY_AUX_CTRL_STAT MII_NCONFIG
  71. #define MII_VSC73XX_PACS_NO_MDI_X_IND BIT(13)
  72. /* Vitesse VSC8601 Extended PHY Control Register 1 */
  73. #define MII_VSC8601_EPHY_CTL 0x17
  74. #define MII_VSC8601_EPHY_CTL_RGMII_SKEW (1 << 8)
  75. #define PHY_ID_VSC8234 0x000fc620
  76. #define PHY_ID_VSC8244 0x000fc6c0
  77. #define PHY_ID_VSC8572 0x000704d0
  78. #define PHY_ID_VSC8601 0x00070420
  79. #define PHY_ID_VSC7385 0x00070450
  80. #define PHY_ID_VSC7388 0x00070480
  81. #define PHY_ID_VSC7395 0x00070550
  82. #define PHY_ID_VSC7398 0x00070580
  83. #define PHY_ID_VSC8662 0x00070660
  84. #define PHY_ID_VSC8221 0x000fc550
  85. #define PHY_ID_VSC8211 0x000fc4b0
  86. MODULE_DESCRIPTION("Vitesse PHY driver");
  87. MODULE_AUTHOR("Kriston Carson");
  88. MODULE_LICENSE("GPL");
  89. static int vsc824x_add_skew(struct phy_device *phydev)
  90. {
  91. int err;
  92. int extcon;
  93. extcon = phy_read(phydev, MII_VSC8244_EXT_CON1);
  94. if (extcon < 0)
  95. return extcon;
  96. extcon &= ~(MII_VSC8244_EXTCON1_TX_SKEW_MASK |
  97. MII_VSC8244_EXTCON1_RX_SKEW_MASK);
  98. extcon |= (MII_VSC8244_EXTCON1_TX_SKEW |
  99. MII_VSC8244_EXTCON1_RX_SKEW);
  100. err = phy_write(phydev, MII_VSC8244_EXT_CON1, extcon);
  101. return err;
  102. }
  103. static int vsc824x_config_init(struct phy_device *phydev)
  104. {
  105. int err;
  106. err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
  107. MII_VSC8244_AUXCONSTAT_INIT);
  108. if (err < 0)
  109. return err;
  110. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
  111. err = vsc824x_add_skew(phydev);
  112. return err;
  113. }
  114. #define VSC73XX_EXT_PAGE_ACCESS 0x1f
  115. static int vsc73xx_read_page(struct phy_device *phydev)
  116. {
  117. return __phy_read(phydev, VSC73XX_EXT_PAGE_ACCESS);
  118. }
  119. static int vsc73xx_write_page(struct phy_device *phydev, int page)
  120. {
  121. return __phy_write(phydev, VSC73XX_EXT_PAGE_ACCESS, page);
  122. }
  123. static int vsc73xx_get_downshift(struct phy_device *phydev, u8 *data)
  124. {
  125. int val, enable, cnt;
  126. val = phy_read_paged(phydev, MII_VSC73XX_EXT_PAGE_1E,
  127. MII_VSC73XX_PHY_CTRL_EXT3);
  128. if (val < 0)
  129. return val;
  130. enable = FIELD_GET(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN, val);
  131. cnt = FIELD_GET(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT, val) + 2;
  132. *data = enable ? cnt : DOWNSHIFT_DEV_DISABLE;
  133. return 0;
  134. }
  135. static int vsc73xx_set_downshift(struct phy_device *phydev, u8 cnt)
  136. {
  137. u16 mask, val;
  138. int ret;
  139. if (cnt > MII_VSC73XX_DOWNSHIFT_MAX)
  140. return -E2BIG;
  141. else if (cnt == MII_VSC73XX_DOWNSHIFT_INVAL)
  142. return -EINVAL;
  143. mask = MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN;
  144. if (!cnt) {
  145. val = 0;
  146. } else {
  147. mask |= MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT;
  148. val = MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN |
  149. FIELD_PREP(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT,
  150. cnt - 2);
  151. }
  152. ret = phy_modify_paged(phydev, MII_VSC73XX_EXT_PAGE_1E,
  153. MII_VSC73XX_PHY_CTRL_EXT3, mask, val);
  154. if (ret < 0)
  155. return ret;
  156. return genphy_soft_reset(phydev);
  157. }
  158. static int vsc73xx_get_tunable(struct phy_device *phydev,
  159. struct ethtool_tunable *tuna, void *data)
  160. {
  161. switch (tuna->id) {
  162. case ETHTOOL_PHY_DOWNSHIFT:
  163. return vsc73xx_get_downshift(phydev, data);
  164. default:
  165. return -EOPNOTSUPP;
  166. }
  167. }
  168. static int vsc73xx_set_tunable(struct phy_device *phydev,
  169. struct ethtool_tunable *tuna, const void *data)
  170. {
  171. switch (tuna->id) {
  172. case ETHTOOL_PHY_DOWNSHIFT:
  173. return vsc73xx_set_downshift(phydev, *(const u8 *)data);
  174. default:
  175. return -EOPNOTSUPP;
  176. }
  177. }
  178. static void vsc73xx_config_init(struct phy_device *phydev)
  179. {
  180. /* Receiver init */
  181. phy_write(phydev, 0x1f, 0x2a30);
  182. phy_modify(phydev, 0x0c, 0x0300, 0x0200);
  183. phy_write(phydev, 0x1f, 0x0000);
  184. /* Config LEDs 0x61 */
  185. phy_modify(phydev, MII_TPISTATUS, 0xff00, 0x0061);
  186. /* Enable downshift by default */
  187. vsc73xx_set_downshift(phydev, MII_VSC73XX_DOWNSHIFT_MAX);
  188. /* Set Auto MDI-X by default */
  189. phydev->mdix_ctrl = ETH_TP_MDI_AUTO;
  190. }
  191. static int vsc738x_config_init(struct phy_device *phydev)
  192. {
  193. u16 rev;
  194. /* This magic sequence appear in the application note
  195. * "VSC7385/7388 PHY Configuration".
  196. *
  197. * Maybe one day we will get to know what it all means.
  198. */
  199. phy_write(phydev, 0x1f, 0x2a30);
  200. phy_modify(phydev, 0x08, 0x0200, 0x0200);
  201. phy_write(phydev, 0x1f, 0x52b5);
  202. phy_write(phydev, 0x10, 0xb68a);
  203. phy_modify(phydev, 0x12, 0xff07, 0x0003);
  204. phy_modify(phydev, 0x11, 0x00ff, 0x00a2);
  205. phy_write(phydev, 0x10, 0x968a);
  206. phy_write(phydev, 0x1f, 0x2a30);
  207. phy_modify(phydev, 0x08, 0x0200, 0x0000);
  208. phy_write(phydev, 0x1f, 0x0000);
  209. /* Read revision */
  210. rev = phy_read(phydev, MII_PHYSID2);
  211. rev &= 0x0f;
  212. /* Special quirk for revision 0 */
  213. if (rev == 0) {
  214. phy_write(phydev, 0x1f, 0x2a30);
  215. phy_modify(phydev, 0x08, 0x0200, 0x0200);
  216. phy_write(phydev, 0x1f, 0x52b5);
  217. phy_write(phydev, 0x12, 0x0000);
  218. phy_write(phydev, 0x11, 0x0689);
  219. phy_write(phydev, 0x10, 0x8f92);
  220. phy_write(phydev, 0x1f, 0x52b5);
  221. phy_write(phydev, 0x12, 0x0000);
  222. phy_write(phydev, 0x11, 0x0e35);
  223. phy_write(phydev, 0x10, 0x9786);
  224. phy_write(phydev, 0x1f, 0x2a30);
  225. phy_modify(phydev, 0x08, 0x0200, 0x0000);
  226. phy_write(phydev, 0x17, 0xff80);
  227. phy_write(phydev, 0x17, 0x0000);
  228. }
  229. phy_write(phydev, 0x1f, 0x0000);
  230. phy_write(phydev, 0x12, 0x0048);
  231. if (rev == 0) {
  232. phy_write(phydev, 0x1f, 0x2a30);
  233. phy_write(phydev, 0x14, 0x6600);
  234. phy_write(phydev, 0x1f, 0x0000);
  235. phy_write(phydev, 0x18, 0xa24e);
  236. } else {
  237. phy_write(phydev, 0x1f, 0x2a30);
  238. phy_modify(phydev, 0x16, 0x0fc0, 0x0240);
  239. phy_modify(phydev, 0x14, 0x6000, 0x4000);
  240. /* bits 14-15 in extended register 0x14 controls DACG amplitude
  241. * 6 = -8%, 2 is hardware default
  242. */
  243. phy_write(phydev, 0x1f, 0x0001);
  244. phy_modify(phydev, 0x14, 0xe000, 0x6000);
  245. phy_write(phydev, 0x1f, 0x0000);
  246. }
  247. vsc73xx_config_init(phydev);
  248. return 0;
  249. }
  250. static int vsc739x_config_init(struct phy_device *phydev)
  251. {
  252. /* This magic sequence appears in the VSC7395 SparX-G5e application
  253. * note "VSC7395/VSC7398 PHY Configuration"
  254. *
  255. * Maybe one day we will get to know what it all means.
  256. */
  257. phy_write(phydev, 0x1f, 0x2a30);
  258. phy_modify(phydev, 0x08, 0x0200, 0x0200);
  259. phy_write(phydev, 0x1f, 0x52b5);
  260. phy_write(phydev, 0x10, 0xb68a);
  261. phy_modify(phydev, 0x12, 0xff07, 0x0003);
  262. phy_modify(phydev, 0x11, 0x00ff, 0x00a2);
  263. phy_write(phydev, 0x10, 0x968a);
  264. phy_write(phydev, 0x1f, 0x2a30);
  265. phy_modify(phydev, 0x08, 0x0200, 0x0000);
  266. phy_write(phydev, 0x1f, 0x0000);
  267. phy_write(phydev, 0x1f, 0x0000);
  268. phy_write(phydev, 0x12, 0x0048);
  269. phy_write(phydev, 0x1f, 0x2a30);
  270. phy_modify(phydev, 0x16, 0x0fc0, 0x0240);
  271. phy_modify(phydev, 0x14, 0x6000, 0x4000);
  272. phy_write(phydev, 0x1f, 0x0001);
  273. phy_modify(phydev, 0x14, 0xe000, 0x6000);
  274. phy_write(phydev, 0x1f, 0x0000);
  275. vsc73xx_config_init(phydev);
  276. return 0;
  277. }
  278. static int vsc73xx_mdix_set(struct phy_device *phydev, u8 mdix)
  279. {
  280. int ret;
  281. u16 val;
  282. val = phy_read(phydev, MII_VSC73XX_PHY_BYPASS_CTRL);
  283. switch (mdix) {
  284. case ETH_TP_MDI:
  285. val |= MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS |
  286. MII_VSC73XX_PBC_PAIR_SWAP_DIS |
  287. MII_VSC73XX_PBC_POL_INV_DIS;
  288. break;
  289. case ETH_TP_MDI_X:
  290. /* When MDI-X auto configuration is disabled, is possible
  291. * to force only MDI mode. Let's use autoconfig for forced
  292. * MDIX mode.
  293. */
  294. case ETH_TP_MDI_AUTO:
  295. val &= ~(MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS |
  296. MII_VSC73XX_PBC_PAIR_SWAP_DIS |
  297. MII_VSC73XX_PBC_POL_INV_DIS);
  298. break;
  299. default:
  300. return -EINVAL;
  301. }
  302. ret = phy_write(phydev, MII_VSC73XX_PHY_BYPASS_CTRL, val);
  303. if (ret)
  304. return ret;
  305. return genphy_restart_aneg(phydev);
  306. }
  307. static int vsc73xx_config_aneg(struct phy_device *phydev)
  308. {
  309. int ret;
  310. ret = vsc73xx_mdix_set(phydev, phydev->mdix_ctrl);
  311. if (ret)
  312. return ret;
  313. return genphy_config_aneg(phydev);
  314. }
  315. static int vsc73xx_mdix_get(struct phy_device *phydev, u8 *mdix)
  316. {
  317. u16 reg_val;
  318. reg_val = phy_read(phydev, MII_VSC73XX_PHY_AUX_CTRL_STAT);
  319. if (reg_val & MII_VSC73XX_PACS_NO_MDI_X_IND)
  320. *mdix = ETH_TP_MDI;
  321. else
  322. *mdix = ETH_TP_MDI_X;
  323. return 0;
  324. }
  325. static int vsc73xx_read_status(struct phy_device *phydev)
  326. {
  327. int ret;
  328. ret = vsc73xx_mdix_get(phydev, &phydev->mdix);
  329. if (ret < 0)
  330. return ret;
  331. return genphy_read_status(phydev);
  332. }
  333. /* This adds a skew for both TX and RX clocks, so the skew should only be
  334. * applied to "rgmii-id" interfaces. It may not work as expected
  335. * on "rgmii-txid", "rgmii-rxid" or "rgmii" interfaces.
  336. */
  337. static int vsc8601_add_skew(struct phy_device *phydev)
  338. {
  339. int ret;
  340. ret = phy_read(phydev, MII_VSC8601_EPHY_CTL);
  341. if (ret < 0)
  342. return ret;
  343. ret |= MII_VSC8601_EPHY_CTL_RGMII_SKEW;
  344. return phy_write(phydev, MII_VSC8601_EPHY_CTL, ret);
  345. }
  346. static int vsc8601_config_init(struct phy_device *phydev)
  347. {
  348. int ret = 0;
  349. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
  350. ret = vsc8601_add_skew(phydev);
  351. if (ret < 0)
  352. return ret;
  353. return 0;
  354. }
  355. static int vsc82xx_config_intr(struct phy_device *phydev)
  356. {
  357. int err;
  358. if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
  359. /* Don't bother to ACK the interrupts since the 824x cannot
  360. * clear the interrupts if they are disabled.
  361. */
  362. err = phy_write(phydev, MII_VSC8244_IMASK,
  363. (phydev->drv->phy_id == PHY_ID_VSC8234 ||
  364. phydev->drv->phy_id == PHY_ID_VSC8244 ||
  365. phydev->drv->phy_id == PHY_ID_VSC8572 ||
  366. phydev->drv->phy_id == PHY_ID_VSC8601) ?
  367. MII_VSC8244_IMASK_MASK :
  368. MII_VSC8221_IMASK_MASK);
  369. else {
  370. /* The Vitesse PHY cannot clear the interrupt
  371. * once it has disabled them, so we clear them first
  372. */
  373. err = phy_read(phydev, MII_VSC8244_ISTAT);
  374. if (err < 0)
  375. return err;
  376. err = phy_write(phydev, MII_VSC8244_IMASK, 0);
  377. }
  378. return err;
  379. }
  380. static irqreturn_t vsc82xx_handle_interrupt(struct phy_device *phydev)
  381. {
  382. int irq_status, irq_mask;
  383. if (phydev->drv->phy_id == PHY_ID_VSC8244 ||
  384. phydev->drv->phy_id == PHY_ID_VSC8572 ||
  385. phydev->drv->phy_id == PHY_ID_VSC8601)
  386. irq_mask = MII_VSC8244_ISTAT_MASK;
  387. else
  388. irq_mask = MII_VSC8221_ISTAT_MASK;
  389. irq_status = phy_read(phydev, MII_VSC8244_ISTAT);
  390. if (irq_status < 0) {
  391. phy_error(phydev);
  392. return IRQ_NONE;
  393. }
  394. if (!(irq_status & irq_mask))
  395. return IRQ_NONE;
  396. phy_trigger_machine(phydev);
  397. return IRQ_HANDLED;
  398. }
  399. static int vsc8221_config_init(struct phy_device *phydev)
  400. {
  401. int err;
  402. err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
  403. MII_VSC8221_AUXCONSTAT_INIT);
  404. return err;
  405. /* Perhaps we should set EXT_CON1 based on the interface?
  406. * Options are 802.3Z SerDes or SGMII
  407. */
  408. }
  409. /* vsc82x4_config_autocross_enable - Enable auto MDI/MDI-X for forced links
  410. * @phydev: target phy_device struct
  411. *
  412. * Enable auto MDI/MDI-X when in 10/100 forced link speeds by writing
  413. * special values in the VSC8234/VSC8244 extended reserved registers
  414. */
  415. static int vsc82x4_config_autocross_enable(struct phy_device *phydev)
  416. {
  417. int ret;
  418. if (phydev->autoneg == AUTONEG_ENABLE || phydev->speed > SPEED_100)
  419. return 0;
  420. /* map extended registers set 0x10 - 0x1e */
  421. ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x52b5);
  422. if (ret >= 0)
  423. ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_18E, 0x0012);
  424. if (ret >= 0)
  425. ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_17E, 0x2803);
  426. if (ret >= 0)
  427. ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_16E, 0x87fa);
  428. /* map standard registers set 0x10 - 0x1e */
  429. if (ret >= 0)
  430. ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
  431. else
  432. phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
  433. return ret;
  434. }
  435. /* vsc82x4_config_aneg - restart auto-negotiation or write BMCR
  436. * @phydev: target phy_device struct
  437. *
  438. * Description: If auto-negotiation is enabled, we configure the
  439. * advertising, and then restart auto-negotiation. If it is not
  440. * enabled, then we write the BMCR and also start the auto
  441. * MDI/MDI-X feature
  442. */
  443. static int vsc82x4_config_aneg(struct phy_device *phydev)
  444. {
  445. int ret;
  446. /* Enable auto MDI/MDI-X when in 10/100 forced link speeds by
  447. * writing special values in the VSC8234 extended reserved registers
  448. */
  449. if (phydev->autoneg != AUTONEG_ENABLE && phydev->speed <= SPEED_100) {
  450. ret = genphy_setup_forced(phydev);
  451. if (ret < 0) /* error */
  452. return ret;
  453. return vsc82x4_config_autocross_enable(phydev);
  454. }
  455. return genphy_config_aneg(phydev);
  456. }
  457. /* Vitesse 82xx */
  458. static struct phy_driver vsc82xx_driver[] = {
  459. {
  460. .phy_id = PHY_ID_VSC8234,
  461. .name = "Vitesse VSC8234",
  462. .phy_id_mask = 0x000ffff0,
  463. /* PHY_GBIT_FEATURES */
  464. .config_init = &vsc824x_config_init,
  465. .config_aneg = &vsc82x4_config_aneg,
  466. .config_intr = &vsc82xx_config_intr,
  467. .handle_interrupt = &vsc82xx_handle_interrupt,
  468. }, {
  469. .phy_id = PHY_ID_VSC8244,
  470. .name = "Vitesse VSC8244",
  471. .phy_id_mask = 0x000fffc0,
  472. /* PHY_GBIT_FEATURES */
  473. .config_init = &vsc824x_config_init,
  474. .config_aneg = &vsc82x4_config_aneg,
  475. .config_intr = &vsc82xx_config_intr,
  476. .handle_interrupt = &vsc82xx_handle_interrupt,
  477. }, {
  478. .phy_id = PHY_ID_VSC8572,
  479. .name = "Vitesse VSC8572",
  480. .phy_id_mask = 0x000ffff0,
  481. /* PHY_GBIT_FEATURES */
  482. .config_init = &vsc824x_config_init,
  483. .config_aneg = &vsc82x4_config_aneg,
  484. .config_intr = &vsc82xx_config_intr,
  485. .handle_interrupt = &vsc82xx_handle_interrupt,
  486. }, {
  487. .phy_id = PHY_ID_VSC8601,
  488. .name = "Vitesse VSC8601",
  489. .phy_id_mask = 0x000ffff0,
  490. /* PHY_GBIT_FEATURES */
  491. .config_init = &vsc8601_config_init,
  492. .config_intr = &vsc82xx_config_intr,
  493. .handle_interrupt = &vsc82xx_handle_interrupt,
  494. }, {
  495. .phy_id = PHY_ID_VSC7385,
  496. .name = "Vitesse VSC7385",
  497. .phy_id_mask = 0x000ffff0,
  498. /* PHY_GBIT_FEATURES */
  499. .config_init = vsc738x_config_init,
  500. .config_aneg = vsc73xx_config_aneg,
  501. .read_status = vsc73xx_read_status,
  502. .read_page = vsc73xx_read_page,
  503. .write_page = vsc73xx_write_page,
  504. .get_tunable = vsc73xx_get_tunable,
  505. .set_tunable = vsc73xx_set_tunable,
  506. }, {
  507. .phy_id = PHY_ID_VSC7388,
  508. .name = "Vitesse VSC7388",
  509. .phy_id_mask = 0x000ffff0,
  510. /* PHY_GBIT_FEATURES */
  511. .config_init = vsc738x_config_init,
  512. .config_aneg = vsc73xx_config_aneg,
  513. .read_status = vsc73xx_read_status,
  514. .read_page = vsc73xx_read_page,
  515. .write_page = vsc73xx_write_page,
  516. .get_tunable = vsc73xx_get_tunable,
  517. .set_tunable = vsc73xx_set_tunable,
  518. }, {
  519. .phy_id = PHY_ID_VSC7395,
  520. .name = "Vitesse VSC7395",
  521. .phy_id_mask = 0x000ffff0,
  522. /* PHY_GBIT_FEATURES */
  523. .config_init = vsc739x_config_init,
  524. .config_aneg = vsc73xx_config_aneg,
  525. .read_status = vsc73xx_read_status,
  526. .read_page = vsc73xx_read_page,
  527. .write_page = vsc73xx_write_page,
  528. .get_tunable = vsc73xx_get_tunable,
  529. .set_tunable = vsc73xx_set_tunable,
  530. }, {
  531. .phy_id = PHY_ID_VSC7398,
  532. .name = "Vitesse VSC7398",
  533. .phy_id_mask = 0x000ffff0,
  534. /* PHY_GBIT_FEATURES */
  535. .config_init = vsc739x_config_init,
  536. .config_aneg = vsc73xx_config_aneg,
  537. .read_status = vsc73xx_read_status,
  538. .read_page = vsc73xx_read_page,
  539. .write_page = vsc73xx_write_page,
  540. .get_tunable = vsc73xx_get_tunable,
  541. .set_tunable = vsc73xx_set_tunable,
  542. }, {
  543. .phy_id = PHY_ID_VSC8662,
  544. .name = "Vitesse VSC8662",
  545. .phy_id_mask = 0x000ffff0,
  546. /* PHY_GBIT_FEATURES */
  547. .config_init = &vsc824x_config_init,
  548. .config_aneg = &vsc82x4_config_aneg,
  549. .config_intr = &vsc82xx_config_intr,
  550. .handle_interrupt = &vsc82xx_handle_interrupt,
  551. }, {
  552. /* Vitesse 8221 */
  553. .phy_id = PHY_ID_VSC8221,
  554. .phy_id_mask = 0x000ffff0,
  555. .name = "Vitesse VSC8221",
  556. /* PHY_GBIT_FEATURES */
  557. .config_init = &vsc8221_config_init,
  558. .config_intr = &vsc82xx_config_intr,
  559. .handle_interrupt = &vsc82xx_handle_interrupt,
  560. }, {
  561. /* Vitesse 8211 */
  562. .phy_id = PHY_ID_VSC8211,
  563. .phy_id_mask = 0x000ffff0,
  564. .name = "Vitesse VSC8211",
  565. /* PHY_GBIT_FEATURES */
  566. .config_init = &vsc8221_config_init,
  567. .config_intr = &vsc82xx_config_intr,
  568. .handle_interrupt = &vsc82xx_handle_interrupt,
  569. } };
  570. module_phy_driver(vsc82xx_driver);
  571. static const struct mdio_device_id __maybe_unused vitesse_tbl[] = {
  572. { PHY_ID_VSC8234, 0x000ffff0 },
  573. { PHY_ID_VSC8244, 0x000fffc0 },
  574. { PHY_ID_VSC8572, 0x000ffff0 },
  575. { PHY_ID_VSC7385, 0x000ffff0 },
  576. { PHY_ID_VSC7388, 0x000ffff0 },
  577. { PHY_ID_VSC7395, 0x000ffff0 },
  578. { PHY_ID_VSC7398, 0x000ffff0 },
  579. { PHY_ID_VSC8662, 0x000ffff0 },
  580. { PHY_ID_VSC8221, 0x000ffff0 },
  581. { PHY_ID_VSC8211, 0x000ffff0 },
  582. { }
  583. };
  584. MODULE_DEVICE_TABLE(mdio, vitesse_tbl);