broadcom.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769
  1. /*
  2. * drivers/net/phy/broadcom.c
  3. *
  4. * Broadcom BCM5411, BCM5421 and BCM5461 Gigabit Ethernet
  5. * transceivers.
  6. *
  7. * Copyright (c) 2006 Maciej W. Rozycki
  8. *
  9. * Inspired by code written by Amy Fong.
  10. *
  11. * This program is free software; you can redistribute it and/or
  12. * modify it under the terms of the GNU General Public License
  13. * as published by the Free Software Foundation; either version
  14. * 2 of the License, or (at your option) any later version.
  15. */
  16. #include "bcm-phy-lib.h"
  17. #include <linux/module.h>
  18. #include <linux/phy.h>
  19. #include <linux/brcmphy.h>
  20. #include <linux/of.h>
  21. #define BRCM_PHY_MODEL(phydev) \
  22. ((phydev)->drv->phy_id & (phydev)->drv->phy_id_mask)
  23. #define BRCM_PHY_REV(phydev) \
  24. ((phydev)->drv->phy_id & ~((phydev)->drv->phy_id_mask))
  25. MODULE_DESCRIPTION("Broadcom PHY driver");
  26. MODULE_AUTHOR("Maciej W. Rozycki");
  27. MODULE_LICENSE("GPL");
  28. static int bcm54210e_config_init(struct phy_device *phydev)
  29. {
  30. int val;
  31. val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC);
  32. val &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN;
  33. val |= MII_BCM54XX_AUXCTL_MISC_WREN;
  34. bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, val);
  35. val = bcm_phy_read_shadow(phydev, BCM54810_SHD_CLK_CTL);
  36. val &= ~BCM54810_SHD_CLK_CTL_GTXCLK_EN;
  37. bcm_phy_write_shadow(phydev, BCM54810_SHD_CLK_CTL, val);
  38. if (phydev->dev_flags & PHY_BRCM_EN_MASTER_MODE) {
  39. val = phy_read(phydev, MII_CTRL1000);
  40. val |= CTL1000_AS_MASTER | CTL1000_ENABLE_MASTER;
  41. phy_write(phydev, MII_CTRL1000, val);
  42. }
  43. return 0;
  44. }
  45. static int bcm54612e_config_init(struct phy_device *phydev)
  46. {
  47. int reg;
  48. /* Clear TX internal delay unless requested. */
  49. if ((phydev->interface != PHY_INTERFACE_MODE_RGMII_ID) &&
  50. (phydev->interface != PHY_INTERFACE_MODE_RGMII_TXID)) {
  51. /* Disable TXD to GTXCLK clock delay (default set) */
  52. /* Bit 9 is the only field in shadow register 00011 */
  53. bcm_phy_write_shadow(phydev, 0x03, 0);
  54. }
  55. /* Clear RX internal delay unless requested. */
  56. if ((phydev->interface != PHY_INTERFACE_MODE_RGMII_ID) &&
  57. (phydev->interface != PHY_INTERFACE_MODE_RGMII_RXID)) {
  58. reg = bcm54xx_auxctl_read(phydev,
  59. MII_BCM54XX_AUXCTL_SHDWSEL_MISC);
  60. /* Disable RXD to RXC delay (default set) */
  61. reg &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN;
  62. /* Clear shadow selector field */
  63. reg &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MASK;
  64. bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC,
  65. MII_BCM54XX_AUXCTL_MISC_WREN | reg);
  66. }
  67. /* Enable CLK125 MUX on LED4 if ref clock is enabled. */
  68. if (!(phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED)) {
  69. int err;
  70. reg = bcm_phy_read_exp(phydev, BCM54612E_EXP_SPARE0);
  71. err = bcm_phy_write_exp(phydev, BCM54612E_EXP_SPARE0,
  72. BCM54612E_LED4_CLK125OUT_EN | reg);
  73. if (err < 0)
  74. return err;
  75. }
  76. return 0;
  77. }
  78. static int bcm5481x_config(struct phy_device *phydev)
  79. {
  80. int rc, val;
  81. /* handling PHY's internal RX clock delay */
  82. val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC);
  83. val |= MII_BCM54XX_AUXCTL_MISC_WREN;
  84. if (phydev->interface == PHY_INTERFACE_MODE_RGMII ||
  85. phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
  86. /* Disable RGMII RXC-RXD skew */
  87. val &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN;
  88. }
  89. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
  90. phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
  91. /* Enable RGMII RXC-RXD skew */
  92. val |= MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN;
  93. }
  94. rc = bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC,
  95. val);
  96. if (rc < 0)
  97. return rc;
  98. /* handling PHY's internal TX clock delay */
  99. val = bcm_phy_read_shadow(phydev, BCM54810_SHD_CLK_CTL);
  100. if (phydev->interface == PHY_INTERFACE_MODE_RGMII ||
  101. phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
  102. /* Disable internal TX clock delay */
  103. val &= ~BCM54810_SHD_CLK_CTL_GTXCLK_EN;
  104. }
  105. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
  106. phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
  107. /* Enable internal TX clock delay */
  108. val |= BCM54810_SHD_CLK_CTL_GTXCLK_EN;
  109. }
  110. rc = bcm_phy_write_shadow(phydev, BCM54810_SHD_CLK_CTL, val);
  111. if (rc < 0)
  112. return rc;
  113. return 0;
  114. }
  115. /* Needs SMDSP clock enabled via bcm54xx_phydsp_config() */
  116. static int bcm50610_a0_workaround(struct phy_device *phydev)
  117. {
  118. int err;
  119. err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH0,
  120. MII_BCM54XX_EXP_AADJ1CH0_SWP_ABCD_OEN |
  121. MII_BCM54XX_EXP_AADJ1CH0_SWSEL_THPF);
  122. if (err < 0)
  123. return err;
  124. err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH3,
  125. MII_BCM54XX_EXP_AADJ1CH3_ADCCKADJ);
  126. if (err < 0)
  127. return err;
  128. err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75,
  129. MII_BCM54XX_EXP_EXP75_VDACCTRL);
  130. if (err < 0)
  131. return err;
  132. err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP96,
  133. MII_BCM54XX_EXP_EXP96_MYST);
  134. if (err < 0)
  135. return err;
  136. err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP97,
  137. MII_BCM54XX_EXP_EXP97_MYST);
  138. return err;
  139. }
  140. static int bcm54xx_phydsp_config(struct phy_device *phydev)
  141. {
  142. int err, err2;
  143. /* Enable the SMDSP clock */
  144. err = bcm54xx_auxctl_write(phydev,
  145. MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL,
  146. MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA |
  147. MII_BCM54XX_AUXCTL_ACTL_TX_6DB);
  148. if (err < 0)
  149. return err;
  150. if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
  151. BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) {
  152. /* Clear bit 9 to fix a phy interop issue. */
  153. err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP08,
  154. MII_BCM54XX_EXP_EXP08_RJCT_2MHZ);
  155. if (err < 0)
  156. goto error;
  157. if (phydev->drv->phy_id == PHY_ID_BCM50610) {
  158. err = bcm50610_a0_workaround(phydev);
  159. if (err < 0)
  160. goto error;
  161. }
  162. }
  163. if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM57780) {
  164. int val;
  165. val = bcm_phy_read_exp(phydev, MII_BCM54XX_EXP_EXP75);
  166. if (val < 0)
  167. goto error;
  168. val |= MII_BCM54XX_EXP_EXP75_CM_OSC;
  169. err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75, val);
  170. }
  171. error:
  172. /* Disable the SMDSP clock */
  173. err2 = bcm54xx_auxctl_write(phydev,
  174. MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL,
  175. MII_BCM54XX_AUXCTL_ACTL_TX_6DB);
  176. /* Return the first error reported. */
  177. return err ? err : err2;
  178. }
  179. static void bcm54xx_adjust_rxrefclk(struct phy_device *phydev)
  180. {
  181. u32 orig;
  182. int val;
  183. bool clk125en = true;
  184. /* Abort if we are using an untested phy. */
  185. if (BRCM_PHY_MODEL(phydev) != PHY_ID_BCM57780 &&
  186. BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610 &&
  187. BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610M)
  188. return;
  189. val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR3);
  190. if (val < 0)
  191. return;
  192. orig = val;
  193. if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
  194. BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) &&
  195. BRCM_PHY_REV(phydev) >= 0x3) {
  196. /*
  197. * Here, bit 0 _disables_ CLK125 when set.
  198. * This bit is set by default.
  199. */
  200. clk125en = false;
  201. } else {
  202. if (phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED) {
  203. /* Here, bit 0 _enables_ CLK125 when set */
  204. val &= ~BCM54XX_SHD_SCR3_DEF_CLK125;
  205. clk125en = false;
  206. }
  207. }
  208. if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE))
  209. val &= ~BCM54XX_SHD_SCR3_DLLAPD_DIS;
  210. else
  211. val |= BCM54XX_SHD_SCR3_DLLAPD_DIS;
  212. if (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY)
  213. val |= BCM54XX_SHD_SCR3_TRDDAPD;
  214. if (orig != val)
  215. bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR3, val);
  216. val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_APD);
  217. if (val < 0)
  218. return;
  219. orig = val;
  220. if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE))
  221. val |= BCM54XX_SHD_APD_EN;
  222. else
  223. val &= ~BCM54XX_SHD_APD_EN;
  224. if (orig != val)
  225. bcm_phy_write_shadow(phydev, BCM54XX_SHD_APD, val);
  226. }
  227. static int bcm54xx_config_init(struct phy_device *phydev)
  228. {
  229. int reg, err, val;
  230. reg = phy_read(phydev, MII_BCM54XX_ECR);
  231. if (reg < 0)
  232. return reg;
  233. /* Mask interrupts globally. */
  234. reg |= MII_BCM54XX_ECR_IM;
  235. err = phy_write(phydev, MII_BCM54XX_ECR, reg);
  236. if (err < 0)
  237. return err;
  238. /* Unmask events we are interested in. */
  239. reg = ~(MII_BCM54XX_INT_DUPLEX |
  240. MII_BCM54XX_INT_SPEED |
  241. MII_BCM54XX_INT_LINK);
  242. err = phy_write(phydev, MII_BCM54XX_IMR, reg);
  243. if (err < 0)
  244. return err;
  245. if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
  246. BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) &&
  247. (phydev->dev_flags & PHY_BRCM_CLEAR_RGMII_MODE))
  248. bcm_phy_write_shadow(phydev, BCM54XX_SHD_RGMII_MODE, 0);
  249. if ((phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED) ||
  250. (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY) ||
  251. (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE))
  252. bcm54xx_adjust_rxrefclk(phydev);
  253. if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54210E) {
  254. err = bcm54210e_config_init(phydev);
  255. if (err)
  256. return err;
  257. } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54612E) {
  258. err = bcm54612e_config_init(phydev);
  259. if (err)
  260. return err;
  261. } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810) {
  262. /* For BCM54810, we need to disable BroadR-Reach function */
  263. val = bcm_phy_read_exp(phydev,
  264. BCM54810_EXP_BROADREACH_LRE_MISC_CTL);
  265. val &= ~BCM54810_EXP_BROADREACH_LRE_MISC_CTL_EN;
  266. err = bcm_phy_write_exp(phydev,
  267. BCM54810_EXP_BROADREACH_LRE_MISC_CTL,
  268. val);
  269. if (err < 0)
  270. return err;
  271. }
  272. bcm54xx_phydsp_config(phydev);
  273. return 0;
  274. }
  275. static int bcm5482_config_init(struct phy_device *phydev)
  276. {
  277. int err, reg;
  278. err = bcm54xx_config_init(phydev);
  279. if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) {
  280. /*
  281. * Enable secondary SerDes and its use as an LED source
  282. */
  283. reg = bcm_phy_read_shadow(phydev, BCM5482_SHD_SSD);
  284. bcm_phy_write_shadow(phydev, BCM5482_SHD_SSD,
  285. reg |
  286. BCM5482_SHD_SSD_LEDM |
  287. BCM5482_SHD_SSD_EN);
  288. /*
  289. * Enable SGMII slave mode and auto-detection
  290. */
  291. reg = BCM5482_SSD_SGMII_SLAVE | MII_BCM54XX_EXP_SEL_SSD;
  292. err = bcm_phy_read_exp(phydev, reg);
  293. if (err < 0)
  294. return err;
  295. err = bcm_phy_write_exp(phydev, reg, err |
  296. BCM5482_SSD_SGMII_SLAVE_EN |
  297. BCM5482_SSD_SGMII_SLAVE_AD);
  298. if (err < 0)
  299. return err;
  300. /*
  301. * Disable secondary SerDes powerdown
  302. */
  303. reg = BCM5482_SSD_1000BX_CTL | MII_BCM54XX_EXP_SEL_SSD;
  304. err = bcm_phy_read_exp(phydev, reg);
  305. if (err < 0)
  306. return err;
  307. err = bcm_phy_write_exp(phydev, reg,
  308. err & ~BCM5482_SSD_1000BX_CTL_PWRDOWN);
  309. if (err < 0)
  310. return err;
  311. /*
  312. * Select 1000BASE-X register set (primary SerDes)
  313. */
  314. reg = bcm_phy_read_shadow(phydev, BCM5482_SHD_MODE);
  315. bcm_phy_write_shadow(phydev, BCM5482_SHD_MODE,
  316. reg | BCM5482_SHD_MODE_1000BX);
  317. /*
  318. * LED1=ACTIVITYLED, LED3=LINKSPD[2]
  319. * (Use LED1 as secondary SerDes ACTIVITY LED)
  320. */
  321. bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1,
  322. BCM5482_SHD_LEDS1_LED1(BCM_LED_SRC_ACTIVITYLED) |
  323. BCM5482_SHD_LEDS1_LED3(BCM_LED_SRC_LINKSPD2));
  324. /*
  325. * Auto-negotiation doesn't seem to work quite right
  326. * in this mode, so we disable it and force it to the
  327. * right speed/duplex setting. Only 'link status'
  328. * is important.
  329. */
  330. phydev->autoneg = AUTONEG_DISABLE;
  331. phydev->speed = SPEED_1000;
  332. phydev->duplex = DUPLEX_FULL;
  333. }
  334. return err;
  335. }
  336. static int bcm5482_read_status(struct phy_device *phydev)
  337. {
  338. int err;
  339. err = genphy_read_status(phydev);
  340. if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) {
  341. /*
  342. * Only link status matters for 1000Base-X mode, so force
  343. * 1000 Mbit/s full-duplex status
  344. */
  345. if (phydev->link) {
  346. phydev->speed = SPEED_1000;
  347. phydev->duplex = DUPLEX_FULL;
  348. }
  349. }
  350. return err;
  351. }
  352. static int bcm5481_config_aneg(struct phy_device *phydev)
  353. {
  354. struct device_node *np = phydev->mdio.dev.of_node;
  355. int ret;
  356. /* Aneg firsly. */
  357. ret = genphy_config_aneg(phydev);
  358. /* Then we can set up the delay. */
  359. bcm5481x_config(phydev);
  360. if (of_property_read_bool(np, "enet-phy-lane-swap")) {
  361. /* Lane Swap - Undocumented register...magic! */
  362. ret = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_SEL_ER + 0x9,
  363. 0x11B);
  364. if (ret < 0)
  365. return ret;
  366. }
  367. return ret;
  368. }
  369. static int brcm_phy_setbits(struct phy_device *phydev, int reg, int set)
  370. {
  371. int val;
  372. val = phy_read(phydev, reg);
  373. if (val < 0)
  374. return val;
  375. return phy_write(phydev, reg, val | set);
  376. }
  377. static int brcm_fet_config_init(struct phy_device *phydev)
  378. {
  379. int reg, err, err2, brcmtest;
  380. /* Reset the PHY to bring it to a known state. */
  381. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  382. if (err < 0)
  383. return err;
  384. reg = phy_read(phydev, MII_BRCM_FET_INTREG);
  385. if (reg < 0)
  386. return reg;
  387. /* Unmask events we are interested in and mask interrupts globally. */
  388. reg = MII_BRCM_FET_IR_DUPLEX_EN |
  389. MII_BRCM_FET_IR_SPEED_EN |
  390. MII_BRCM_FET_IR_LINK_EN |
  391. MII_BRCM_FET_IR_ENABLE |
  392. MII_BRCM_FET_IR_MASK;
  393. err = phy_write(phydev, MII_BRCM_FET_INTREG, reg);
  394. if (err < 0)
  395. return err;
  396. /* Enable shadow register access */
  397. brcmtest = phy_read(phydev, MII_BRCM_FET_BRCMTEST);
  398. if (brcmtest < 0)
  399. return brcmtest;
  400. reg = brcmtest | MII_BRCM_FET_BT_SRE;
  401. err = phy_write(phydev, MII_BRCM_FET_BRCMTEST, reg);
  402. if (err < 0)
  403. return err;
  404. /* Set the LED mode */
  405. reg = phy_read(phydev, MII_BRCM_FET_SHDW_AUXMODE4);
  406. if (reg < 0) {
  407. err = reg;
  408. goto done;
  409. }
  410. reg &= ~MII_BRCM_FET_SHDW_AM4_LED_MASK;
  411. reg |= MII_BRCM_FET_SHDW_AM4_LED_MODE1;
  412. err = phy_write(phydev, MII_BRCM_FET_SHDW_AUXMODE4, reg);
  413. if (err < 0)
  414. goto done;
  415. /* Enable auto MDIX */
  416. err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_MISCCTRL,
  417. MII_BRCM_FET_SHDW_MC_FAME);
  418. if (err < 0)
  419. goto done;
  420. if (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE) {
  421. /* Enable auto power down */
  422. err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_AUXSTAT2,
  423. MII_BRCM_FET_SHDW_AS2_APDE);
  424. }
  425. done:
  426. /* Disable shadow register access */
  427. err2 = phy_write(phydev, MII_BRCM_FET_BRCMTEST, brcmtest);
  428. if (!err)
  429. err = err2;
  430. return err;
  431. }
  432. static int brcm_fet_ack_interrupt(struct phy_device *phydev)
  433. {
  434. int reg;
  435. /* Clear pending interrupts. */
  436. reg = phy_read(phydev, MII_BRCM_FET_INTREG);
  437. if (reg < 0)
  438. return reg;
  439. return 0;
  440. }
  441. static int brcm_fet_config_intr(struct phy_device *phydev)
  442. {
  443. int reg, err;
  444. reg = phy_read(phydev, MII_BRCM_FET_INTREG);
  445. if (reg < 0)
  446. return reg;
  447. if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
  448. reg &= ~MII_BRCM_FET_IR_MASK;
  449. else
  450. reg |= MII_BRCM_FET_IR_MASK;
  451. err = phy_write(phydev, MII_BRCM_FET_INTREG, reg);
  452. return err;
  453. }
  454. struct bcm53xx_phy_priv {
  455. u64 *stats;
  456. };
  457. static int bcm53xx_phy_probe(struct phy_device *phydev)
  458. {
  459. struct bcm53xx_phy_priv *priv;
  460. priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);
  461. if (!priv)
  462. return -ENOMEM;
  463. phydev->priv = priv;
  464. priv->stats = devm_kcalloc(&phydev->mdio.dev,
  465. bcm_phy_get_sset_count(phydev), sizeof(u64),
  466. GFP_KERNEL);
  467. if (!priv->stats)
  468. return -ENOMEM;
  469. return 0;
  470. }
  471. static void bcm53xx_phy_get_stats(struct phy_device *phydev,
  472. struct ethtool_stats *stats, u64 *data)
  473. {
  474. struct bcm53xx_phy_priv *priv = phydev->priv;
  475. bcm_phy_get_stats(phydev, priv->stats, stats, data);
  476. }
  477. static struct phy_driver broadcom_drivers[] = {
  478. {
  479. .phy_id = PHY_ID_BCM5411,
  480. .phy_id_mask = 0xfffffff0,
  481. .name = "Broadcom BCM5411",
  482. .features = PHY_GBIT_FEATURES,
  483. .flags = PHY_HAS_INTERRUPT,
  484. .config_init = bcm54xx_config_init,
  485. .ack_interrupt = bcm_phy_ack_intr,
  486. .config_intr = bcm_phy_config_intr,
  487. }, {
  488. .phy_id = PHY_ID_BCM5421,
  489. .phy_id_mask = 0xfffffff0,
  490. .name = "Broadcom BCM5421",
  491. .features = PHY_GBIT_FEATURES,
  492. .flags = PHY_HAS_INTERRUPT,
  493. .config_init = bcm54xx_config_init,
  494. .ack_interrupt = bcm_phy_ack_intr,
  495. .config_intr = bcm_phy_config_intr,
  496. }, {
  497. .phy_id = PHY_ID_BCM54210E,
  498. .phy_id_mask = 0xfffffff0,
  499. .name = "Broadcom BCM54210E",
  500. .features = PHY_GBIT_FEATURES,
  501. .flags = PHY_HAS_INTERRUPT,
  502. .config_init = bcm54xx_config_init,
  503. .ack_interrupt = bcm_phy_ack_intr,
  504. .config_intr = bcm_phy_config_intr,
  505. }, {
  506. .phy_id = PHY_ID_BCM5461,
  507. .phy_id_mask = 0xfffffff0,
  508. .name = "Broadcom BCM5461",
  509. .features = PHY_GBIT_FEATURES,
  510. .flags = PHY_HAS_INTERRUPT,
  511. .config_init = bcm54xx_config_init,
  512. .ack_interrupt = bcm_phy_ack_intr,
  513. .config_intr = bcm_phy_config_intr,
  514. }, {
  515. .phy_id = PHY_ID_BCM54612E,
  516. .phy_id_mask = 0xfffffff0,
  517. .name = "Broadcom BCM54612E",
  518. .features = PHY_GBIT_FEATURES,
  519. .flags = PHY_HAS_INTERRUPT,
  520. .config_init = bcm54xx_config_init,
  521. .ack_interrupt = bcm_phy_ack_intr,
  522. .config_intr = bcm_phy_config_intr,
  523. }, {
  524. .phy_id = PHY_ID_BCM54616S,
  525. .phy_id_mask = 0xfffffff0,
  526. .name = "Broadcom BCM54616S",
  527. .features = PHY_GBIT_FEATURES,
  528. .flags = PHY_HAS_INTERRUPT,
  529. .config_init = bcm54xx_config_init,
  530. .ack_interrupt = bcm_phy_ack_intr,
  531. .config_intr = bcm_phy_config_intr,
  532. }, {
  533. .phy_id = PHY_ID_BCM5464,
  534. .phy_id_mask = 0xfffffff0,
  535. .name = "Broadcom BCM5464",
  536. .features = PHY_GBIT_FEATURES,
  537. .flags = PHY_HAS_INTERRUPT,
  538. .config_init = bcm54xx_config_init,
  539. .ack_interrupt = bcm_phy_ack_intr,
  540. .config_intr = bcm_phy_config_intr,
  541. }, {
  542. .phy_id = PHY_ID_BCM5481,
  543. .phy_id_mask = 0xfffffff0,
  544. .name = "Broadcom BCM5481",
  545. .features = PHY_GBIT_FEATURES,
  546. .flags = PHY_HAS_INTERRUPT,
  547. .config_init = bcm54xx_config_init,
  548. .config_aneg = bcm5481_config_aneg,
  549. .ack_interrupt = bcm_phy_ack_intr,
  550. .config_intr = bcm_phy_config_intr,
  551. }, {
  552. .phy_id = PHY_ID_BCM54810,
  553. .phy_id_mask = 0xfffffff0,
  554. .name = "Broadcom BCM54810",
  555. .features = PHY_GBIT_FEATURES,
  556. .flags = PHY_HAS_INTERRUPT,
  557. .config_init = bcm54xx_config_init,
  558. .config_aneg = bcm5481_config_aneg,
  559. .ack_interrupt = bcm_phy_ack_intr,
  560. .config_intr = bcm_phy_config_intr,
  561. }, {
  562. .phy_id = PHY_ID_BCM5482,
  563. .phy_id_mask = 0xfffffff0,
  564. .name = "Broadcom BCM5482",
  565. .features = PHY_GBIT_FEATURES,
  566. .flags = PHY_HAS_INTERRUPT,
  567. .config_init = bcm5482_config_init,
  568. .read_status = bcm5482_read_status,
  569. .ack_interrupt = bcm_phy_ack_intr,
  570. .config_intr = bcm_phy_config_intr,
  571. }, {
  572. .phy_id = PHY_ID_BCM50610,
  573. .phy_id_mask = 0xfffffff0,
  574. .name = "Broadcom BCM50610",
  575. .features = PHY_GBIT_FEATURES,
  576. .flags = PHY_HAS_INTERRUPT,
  577. .config_init = bcm54xx_config_init,
  578. .ack_interrupt = bcm_phy_ack_intr,
  579. .config_intr = bcm_phy_config_intr,
  580. }, {
  581. .phy_id = PHY_ID_BCM50610M,
  582. .phy_id_mask = 0xfffffff0,
  583. .name = "Broadcom BCM50610M",
  584. .features = PHY_GBIT_FEATURES,
  585. .flags = PHY_HAS_INTERRUPT,
  586. .config_init = bcm54xx_config_init,
  587. .ack_interrupt = bcm_phy_ack_intr,
  588. .config_intr = bcm_phy_config_intr,
  589. }, {
  590. .phy_id = PHY_ID_BCM57780,
  591. .phy_id_mask = 0xfffffff0,
  592. .name = "Broadcom BCM57780",
  593. .features = PHY_GBIT_FEATURES,
  594. .flags = PHY_HAS_INTERRUPT,
  595. .config_init = bcm54xx_config_init,
  596. .ack_interrupt = bcm_phy_ack_intr,
  597. .config_intr = bcm_phy_config_intr,
  598. }, {
  599. .phy_id = PHY_ID_BCMAC131,
  600. .phy_id_mask = 0xfffffff0,
  601. .name = "Broadcom BCMAC131",
  602. .features = PHY_BASIC_FEATURES,
  603. .flags = PHY_HAS_INTERRUPT,
  604. .config_init = brcm_fet_config_init,
  605. .ack_interrupt = brcm_fet_ack_interrupt,
  606. .config_intr = brcm_fet_config_intr,
  607. }, {
  608. .phy_id = PHY_ID_BCM5241,
  609. .phy_id_mask = 0xfffffff0,
  610. .name = "Broadcom BCM5241",
  611. .features = PHY_BASIC_FEATURES,
  612. .flags = PHY_HAS_INTERRUPT,
  613. .config_init = brcm_fet_config_init,
  614. .ack_interrupt = brcm_fet_ack_interrupt,
  615. .config_intr = brcm_fet_config_intr,
  616. }, {
  617. .phy_id = PHY_ID_BCM5395,
  618. .phy_id_mask = 0xfffffff0,
  619. .name = "Broadcom BCM5395",
  620. .flags = PHY_IS_INTERNAL,
  621. .features = PHY_GBIT_FEATURES,
  622. .get_sset_count = bcm_phy_get_sset_count,
  623. .get_strings = bcm_phy_get_strings,
  624. .get_stats = bcm53xx_phy_get_stats,
  625. .probe = bcm53xx_phy_probe,
  626. }, {
  627. .phy_id = PHY_ID_BCM89610,
  628. .phy_id_mask = 0xfffffff0,
  629. .name = "Broadcom BCM89610",
  630. .features = PHY_GBIT_FEATURES,
  631. .flags = PHY_HAS_INTERRUPT,
  632. .config_init = bcm54xx_config_init,
  633. .ack_interrupt = bcm_phy_ack_intr,
  634. .config_intr = bcm_phy_config_intr,
  635. } };
  636. module_phy_driver(broadcom_drivers);
  637. static struct mdio_device_id __maybe_unused broadcom_tbl[] = {
  638. { PHY_ID_BCM5411, 0xfffffff0 },
  639. { PHY_ID_BCM5421, 0xfffffff0 },
  640. { PHY_ID_BCM54210E, 0xfffffff0 },
  641. { PHY_ID_BCM5461, 0xfffffff0 },
  642. { PHY_ID_BCM54612E, 0xfffffff0 },
  643. { PHY_ID_BCM54616S, 0xfffffff0 },
  644. { PHY_ID_BCM5464, 0xfffffff0 },
  645. { PHY_ID_BCM5481, 0xfffffff0 },
  646. { PHY_ID_BCM54810, 0xfffffff0 },
  647. { PHY_ID_BCM5482, 0xfffffff0 },
  648. { PHY_ID_BCM50610, 0xfffffff0 },
  649. { PHY_ID_BCM50610M, 0xfffffff0 },
  650. { PHY_ID_BCM57780, 0xfffffff0 },
  651. { PHY_ID_BCMAC131, 0xfffffff0 },
  652. { PHY_ID_BCM5241, 0xfffffff0 },
  653. { PHY_ID_BCM5395, 0xfffffff0 },
  654. { PHY_ID_BCM89610, 0xfffffff0 },
  655. { }
  656. };
  657. MODULE_DEVICE_TABLE(mdio, broadcom_tbl);