broadcom.c 20 KB

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