bcm7xxx.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694
  1. /*
  2. * Broadcom BCM7xxx internal transceivers support.
  3. *
  4. * Copyright (C) 2014-2017 Broadcom
  5. *
  6. * This program is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU General Public License
  8. * as published by the Free Software Foundation; either version
  9. * 2 of the License, or (at your option) any later version.
  10. */
  11. #include <linux/module.h>
  12. #include <linux/phy.h>
  13. #include <linux/delay.h>
  14. #include "bcm-phy-lib.h"
  15. #include <linux/bitops.h>
  16. #include <linux/brcmphy.h>
  17. #include <linux/mdio.h>
  18. /* Broadcom BCM7xxx internal PHY registers */
  19. /* EPHY only register definitions */
  20. #define MII_BCM7XXX_100TX_AUX_CTL 0x10
  21. #define MII_BCM7XXX_100TX_FALSE_CAR 0x13
  22. #define MII_BCM7XXX_100TX_DISC 0x14
  23. #define MII_BCM7XXX_AUX_MODE 0x1d
  24. #define MII_BCM7XXX_64CLK_MDIO BIT(12)
  25. #define MII_BCM7XXX_TEST 0x1f
  26. #define MII_BCM7XXX_SHD_MODE_2 BIT(2)
  27. #define MII_BCM7XXX_SHD_2_ADDR_CTRL 0xe
  28. #define MII_BCM7XXX_SHD_2_CTRL_STAT 0xf
  29. #define MII_BCM7XXX_SHD_2_BIAS_TRIM 0x1a
  30. #define MII_BCM7XXX_SHD_3_AN_EEE_ADV 0x3
  31. #define MII_BCM7XXX_SHD_3_PCS_CTRL_2 0x6
  32. #define MII_BCM7XXX_PCS_CTRL_2_DEF 0x4400
  33. #define MII_BCM7XXX_SHD_3_AN_STAT 0xb
  34. #define MII_BCM7XXX_AN_NULL_MSG_EN BIT(0)
  35. #define MII_BCM7XXX_AN_EEE_EN BIT(1)
  36. #define MII_BCM7XXX_SHD_3_EEE_THRESH 0xe
  37. #define MII_BCM7XXX_EEE_THRESH_DEF 0x50
  38. #define MII_BCM7XXX_SHD_3_TL4 0x23
  39. #define MII_BCM7XXX_TL4_RST_MSK (BIT(2) | BIT(1))
  40. /* 28nm only register definitions */
  41. #define MISC_ADDR(base, channel) base, channel
  42. #define DSP_TAP10 MISC_ADDR(0x0a, 0)
  43. #define PLL_PLLCTRL_1 MISC_ADDR(0x32, 1)
  44. #define PLL_PLLCTRL_2 MISC_ADDR(0x32, 2)
  45. #define PLL_PLLCTRL_4 MISC_ADDR(0x33, 0)
  46. #define AFE_RXCONFIG_0 MISC_ADDR(0x38, 0)
  47. #define AFE_RXCONFIG_1 MISC_ADDR(0x38, 1)
  48. #define AFE_RXCONFIG_2 MISC_ADDR(0x38, 2)
  49. #define AFE_RX_LP_COUNTER MISC_ADDR(0x38, 3)
  50. #define AFE_TX_CONFIG MISC_ADDR(0x39, 0)
  51. #define AFE_VDCA_ICTRL_0 MISC_ADDR(0x39, 1)
  52. #define AFE_VDAC_OTHERS_0 MISC_ADDR(0x39, 3)
  53. #define AFE_HPF_TRIM_OTHERS MISC_ADDR(0x3a, 0)
  54. struct bcm7xxx_phy_priv {
  55. u64 *stats;
  56. };
  57. static void r_rc_cal_reset(struct phy_device *phydev)
  58. {
  59. /* Reset R_CAL/RC_CAL Engine */
  60. bcm_phy_write_exp_sel(phydev, 0x00b0, 0x0010);
  61. /* Disable Reset R_AL/RC_CAL Engine */
  62. bcm_phy_write_exp_sel(phydev, 0x00b0, 0x0000);
  63. }
  64. static int bcm7xxx_28nm_b0_afe_config_init(struct phy_device *phydev)
  65. {
  66. /* Increase VCO range to prevent unlocking problem of PLL at low
  67. * temp
  68. */
  69. bcm_phy_write_misc(phydev, PLL_PLLCTRL_1, 0x0048);
  70. /* Change Ki to 011 */
  71. bcm_phy_write_misc(phydev, PLL_PLLCTRL_2, 0x021b);
  72. /* Disable loading of TVCO buffer to bandgap, set bandgap trim
  73. * to 111
  74. */
  75. bcm_phy_write_misc(phydev, PLL_PLLCTRL_4, 0x0e20);
  76. /* Adjust bias current trim by -3 */
  77. bcm_phy_write_misc(phydev, DSP_TAP10, 0x690b);
  78. /* Switch to CORE_BASE1E */
  79. phy_write(phydev, MII_BRCM_CORE_BASE1E, 0xd);
  80. r_rc_cal_reset(phydev);
  81. /* write AFE_RXCONFIG_0 */
  82. bcm_phy_write_misc(phydev, AFE_RXCONFIG_0, 0xeb19);
  83. /* write AFE_RXCONFIG_1 */
  84. bcm_phy_write_misc(phydev, AFE_RXCONFIG_1, 0x9a3f);
  85. /* write AFE_RX_LP_COUNTER */
  86. bcm_phy_write_misc(phydev, AFE_RX_LP_COUNTER, 0x7fc0);
  87. /* write AFE_HPF_TRIM_OTHERS */
  88. bcm_phy_write_misc(phydev, AFE_HPF_TRIM_OTHERS, 0x000b);
  89. /* write AFTE_TX_CONFIG */
  90. bcm_phy_write_misc(phydev, AFE_TX_CONFIG, 0x0800);
  91. return 0;
  92. }
  93. static int bcm7xxx_28nm_d0_afe_config_init(struct phy_device *phydev)
  94. {
  95. /* AFE_RXCONFIG_0 */
  96. bcm_phy_write_misc(phydev, AFE_RXCONFIG_0, 0xeb15);
  97. /* AFE_RXCONFIG_1 */
  98. bcm_phy_write_misc(phydev, AFE_RXCONFIG_1, 0x9b2f);
  99. /* AFE_RXCONFIG_2, set rCal offset for HT=0 code and LT=-2 code */
  100. bcm_phy_write_misc(phydev, AFE_RXCONFIG_2, 0x2003);
  101. /* AFE_RX_LP_COUNTER, set RX bandwidth to maximum */
  102. bcm_phy_write_misc(phydev, AFE_RX_LP_COUNTER, 0x7fc0);
  103. /* AFE_TX_CONFIG, set 100BT Cfeed=011 to improve rise/fall time */
  104. bcm_phy_write_misc(phydev, AFE_TX_CONFIG, 0x431);
  105. /* AFE_VDCA_ICTRL_0, set Iq=1101 instead of 0111 for AB symmetry */
  106. bcm_phy_write_misc(phydev, AFE_VDCA_ICTRL_0, 0xa7da);
  107. /* AFE_VDAC_OTHERS_0, set 1000BT Cidac=010 for all ports */
  108. bcm_phy_write_misc(phydev, AFE_VDAC_OTHERS_0, 0xa020);
  109. /* AFE_HPF_TRIM_OTHERS, set 100Tx/10BT to -4.5% swing and set rCal
  110. * offset for HT=0 code
  111. */
  112. bcm_phy_write_misc(phydev, AFE_HPF_TRIM_OTHERS, 0x00e3);
  113. /* CORE_BASE1E, force trim to overwrite and set I_ext trim to 0000 */
  114. phy_write(phydev, MII_BRCM_CORE_BASE1E, 0x0010);
  115. /* DSP_TAP10, adjust bias current trim (+0% swing, +0 tick) */
  116. bcm_phy_write_misc(phydev, DSP_TAP10, 0x011b);
  117. /* Reset R_CAL/RC_CAL engine */
  118. r_rc_cal_reset(phydev);
  119. return 0;
  120. }
  121. static int bcm7xxx_28nm_e0_plus_afe_config_init(struct phy_device *phydev)
  122. {
  123. /* AFE_RXCONFIG_1, provide more margin for INL/DNL measurement */
  124. bcm_phy_write_misc(phydev, AFE_RXCONFIG_1, 0x9b2f);
  125. /* AFE_TX_CONFIG, set 100BT Cfeed=011 to improve rise/fall time */
  126. bcm_phy_write_misc(phydev, AFE_TX_CONFIG, 0x431);
  127. /* AFE_VDCA_ICTRL_0, set Iq=1101 instead of 0111 for AB symmetry */
  128. bcm_phy_write_misc(phydev, AFE_VDCA_ICTRL_0, 0xa7da);
  129. /* AFE_HPF_TRIM_OTHERS, set 100Tx/10BT to -4.5% swing and set rCal
  130. * offset for HT=0 code
  131. */
  132. bcm_phy_write_misc(phydev, AFE_HPF_TRIM_OTHERS, 0x00e3);
  133. /* CORE_BASE1E, force trim to overwrite and set I_ext trim to 0000 */
  134. phy_write(phydev, MII_BRCM_CORE_BASE1E, 0x0010);
  135. /* DSP_TAP10, adjust bias current trim (+0% swing, +0 tick) */
  136. bcm_phy_write_misc(phydev, DSP_TAP10, 0x011b);
  137. /* Reset R_CAL/RC_CAL engine */
  138. r_rc_cal_reset(phydev);
  139. return 0;
  140. }
  141. static int bcm7xxx_28nm_a0_patch_afe_config_init(struct phy_device *phydev)
  142. {
  143. /* +1 RC_CAL codes for RL centering for both LT and HT conditions */
  144. bcm_phy_write_misc(phydev, AFE_RXCONFIG_2, 0xd003);
  145. /* Cut master bias current by 2% to compensate for RC_CAL offset */
  146. bcm_phy_write_misc(phydev, DSP_TAP10, 0x791b);
  147. /* Improve hybrid leakage */
  148. bcm_phy_write_misc(phydev, AFE_HPF_TRIM_OTHERS, 0x10e3);
  149. /* Change rx_on_tune 8 to 0xf */
  150. bcm_phy_write_misc(phydev, 0x21, 0x2, 0x87f6);
  151. /* Change 100Tx EEE bandwidth */
  152. bcm_phy_write_misc(phydev, 0x22, 0x2, 0x017d);
  153. /* Enable ffe zero detection for Vitesse interoperability */
  154. bcm_phy_write_misc(phydev, 0x26, 0x2, 0x0015);
  155. r_rc_cal_reset(phydev);
  156. return 0;
  157. }
  158. static int bcm7xxx_28nm_config_init(struct phy_device *phydev)
  159. {
  160. u8 rev = PHY_BRCM_7XXX_REV(phydev->dev_flags);
  161. u8 patch = PHY_BRCM_7XXX_PATCH(phydev->dev_flags);
  162. u8 count;
  163. int ret = 0;
  164. /* Newer devices have moved the revision information back into a
  165. * standard location in MII_PHYS_ID[23]
  166. */
  167. if (rev == 0)
  168. rev = phydev->phy_id & ~phydev->drv->phy_id_mask;
  169. pr_info_once("%s: %s PHY revision: 0x%02x, patch: %d\n",
  170. phydev_name(phydev), phydev->drv->name, rev, patch);
  171. /* Dummy read to a register to workaround an issue upon reset where the
  172. * internal inverter may not allow the first MDIO transaction to pass
  173. * the MDIO management controller and make us return 0xffff for such
  174. * reads.
  175. */
  176. phy_read(phydev, MII_BMSR);
  177. switch (rev) {
  178. case 0xb0:
  179. ret = bcm7xxx_28nm_b0_afe_config_init(phydev);
  180. break;
  181. case 0xd0:
  182. ret = bcm7xxx_28nm_d0_afe_config_init(phydev);
  183. break;
  184. case 0xe0:
  185. case 0xf0:
  186. /* Rev G0 introduces a roll over */
  187. case 0x10:
  188. ret = bcm7xxx_28nm_e0_plus_afe_config_init(phydev);
  189. break;
  190. case 0x01:
  191. ret = bcm7xxx_28nm_a0_patch_afe_config_init(phydev);
  192. break;
  193. default:
  194. break;
  195. }
  196. if (ret)
  197. return ret;
  198. ret = bcm_phy_downshift_get(phydev, &count);
  199. if (ret)
  200. return ret;
  201. /* Only enable EEE if Wirespeed/downshift is disabled */
  202. ret = bcm_phy_set_eee(phydev, count == DOWNSHIFT_DEV_DISABLE);
  203. if (ret)
  204. return ret;
  205. return bcm_phy_enable_apd(phydev, true);
  206. }
  207. static int bcm7xxx_28nm_resume(struct phy_device *phydev)
  208. {
  209. int ret;
  210. /* Re-apply workarounds coming out suspend/resume */
  211. ret = bcm7xxx_28nm_config_init(phydev);
  212. if (ret)
  213. return ret;
  214. /* 28nm Gigabit PHYs come out of reset without any half-duplex
  215. * or "hub" compliant advertised mode, fix that. This does not
  216. * cause any problems with the PHY library since genphy_config_aneg()
  217. * gracefully handles auto-negotiated and forced modes.
  218. */
  219. return genphy_config_aneg(phydev);
  220. }
  221. static int phy_set_clr_bits(struct phy_device *dev, int location,
  222. int set_mask, int clr_mask)
  223. {
  224. int v, ret;
  225. v = phy_read(dev, location);
  226. if (v < 0)
  227. return v;
  228. v &= ~clr_mask;
  229. v |= set_mask;
  230. ret = phy_write(dev, location, v);
  231. if (ret < 0)
  232. return ret;
  233. return v;
  234. }
  235. static int bcm7xxx_28nm_ephy_01_afe_config_init(struct phy_device *phydev)
  236. {
  237. int ret;
  238. /* set shadow mode 2 */
  239. ret = phy_set_clr_bits(phydev, MII_BCM7XXX_TEST,
  240. MII_BCM7XXX_SHD_MODE_2, 0);
  241. if (ret < 0)
  242. return ret;
  243. /* Set current trim values INT_trim = -1, Ext_trim =0 */
  244. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_BIAS_TRIM, 0x3BE0);
  245. if (ret < 0)
  246. goto reset_shadow_mode;
  247. /* Cal reset */
  248. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_ADDR_CTRL,
  249. MII_BCM7XXX_SHD_3_TL4);
  250. if (ret < 0)
  251. goto reset_shadow_mode;
  252. ret = phy_set_clr_bits(phydev, MII_BCM7XXX_SHD_2_CTRL_STAT,
  253. MII_BCM7XXX_TL4_RST_MSK, 0);
  254. if (ret < 0)
  255. goto reset_shadow_mode;
  256. /* Cal reset disable */
  257. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_ADDR_CTRL,
  258. MII_BCM7XXX_SHD_3_TL4);
  259. if (ret < 0)
  260. goto reset_shadow_mode;
  261. ret = phy_set_clr_bits(phydev, MII_BCM7XXX_SHD_2_CTRL_STAT,
  262. 0, MII_BCM7XXX_TL4_RST_MSK);
  263. if (ret < 0)
  264. goto reset_shadow_mode;
  265. reset_shadow_mode:
  266. /* reset shadow mode 2 */
  267. ret = phy_set_clr_bits(phydev, MII_BCM7XXX_TEST, 0,
  268. MII_BCM7XXX_SHD_MODE_2);
  269. if (ret < 0)
  270. return ret;
  271. return 0;
  272. }
  273. /* The 28nm EPHY does not support Clause 45 (MMD) used by bcm-phy-lib */
  274. static int bcm7xxx_28nm_ephy_apd_enable(struct phy_device *phydev)
  275. {
  276. int ret;
  277. /* set shadow mode 1 */
  278. ret = phy_set_clr_bits(phydev, MII_BRCM_FET_BRCMTEST,
  279. MII_BRCM_FET_BT_SRE, 0);
  280. if (ret < 0)
  281. return ret;
  282. /* Enable auto-power down */
  283. ret = phy_set_clr_bits(phydev, MII_BRCM_FET_SHDW_AUXSTAT2,
  284. MII_BRCM_FET_SHDW_AS2_APDE, 0);
  285. if (ret < 0)
  286. return ret;
  287. /* reset shadow mode 1 */
  288. ret = phy_set_clr_bits(phydev, MII_BRCM_FET_BRCMTEST, 0,
  289. MII_BRCM_FET_BT_SRE);
  290. if (ret < 0)
  291. return ret;
  292. return 0;
  293. }
  294. static int bcm7xxx_28nm_ephy_eee_enable(struct phy_device *phydev)
  295. {
  296. int ret;
  297. /* set shadow mode 2 */
  298. ret = phy_set_clr_bits(phydev, MII_BCM7XXX_TEST,
  299. MII_BCM7XXX_SHD_MODE_2, 0);
  300. if (ret < 0)
  301. return ret;
  302. /* Advertise supported modes */
  303. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_ADDR_CTRL,
  304. MII_BCM7XXX_SHD_3_AN_EEE_ADV);
  305. if (ret < 0)
  306. goto reset_shadow_mode;
  307. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_CTRL_STAT,
  308. MDIO_EEE_100TX);
  309. if (ret < 0)
  310. goto reset_shadow_mode;
  311. /* Restore Defaults */
  312. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_ADDR_CTRL,
  313. MII_BCM7XXX_SHD_3_PCS_CTRL_2);
  314. if (ret < 0)
  315. goto reset_shadow_mode;
  316. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_CTRL_STAT,
  317. MII_BCM7XXX_PCS_CTRL_2_DEF);
  318. if (ret < 0)
  319. goto reset_shadow_mode;
  320. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_ADDR_CTRL,
  321. MII_BCM7XXX_SHD_3_EEE_THRESH);
  322. if (ret < 0)
  323. goto reset_shadow_mode;
  324. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_CTRL_STAT,
  325. MII_BCM7XXX_EEE_THRESH_DEF);
  326. if (ret < 0)
  327. goto reset_shadow_mode;
  328. /* Enable EEE autonegotiation */
  329. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_ADDR_CTRL,
  330. MII_BCM7XXX_SHD_3_AN_STAT);
  331. if (ret < 0)
  332. goto reset_shadow_mode;
  333. ret = phy_write(phydev, MII_BCM7XXX_SHD_2_CTRL_STAT,
  334. (MII_BCM7XXX_AN_NULL_MSG_EN | MII_BCM7XXX_AN_EEE_EN));
  335. if (ret < 0)
  336. goto reset_shadow_mode;
  337. reset_shadow_mode:
  338. /* reset shadow mode 2 */
  339. ret = phy_set_clr_bits(phydev, MII_BCM7XXX_TEST, 0,
  340. MII_BCM7XXX_SHD_MODE_2);
  341. if (ret < 0)
  342. return ret;
  343. /* Restart autoneg */
  344. phy_write(phydev, MII_BMCR,
  345. (BMCR_SPEED100 | BMCR_ANENABLE | BMCR_ANRESTART));
  346. return 0;
  347. }
  348. static int bcm7xxx_28nm_ephy_config_init(struct phy_device *phydev)
  349. {
  350. u8 rev = phydev->phy_id & ~phydev->drv->phy_id_mask;
  351. int ret = 0;
  352. pr_info_once("%s: %s PHY revision: 0x%02x\n",
  353. phydev_name(phydev), phydev->drv->name, rev);
  354. /* Dummy read to a register to workaround a possible issue upon reset
  355. * where the internal inverter may not allow the first MDIO transaction
  356. * to pass the MDIO management controller and make us return 0xffff for
  357. * such reads.
  358. */
  359. phy_read(phydev, MII_BMSR);
  360. /* Apply AFE software work-around if necessary */
  361. if (rev == 0x01) {
  362. ret = bcm7xxx_28nm_ephy_01_afe_config_init(phydev);
  363. if (ret)
  364. return ret;
  365. }
  366. ret = bcm7xxx_28nm_ephy_eee_enable(phydev);
  367. if (ret)
  368. return ret;
  369. return bcm7xxx_28nm_ephy_apd_enable(phydev);
  370. }
  371. static int bcm7xxx_28nm_ephy_resume(struct phy_device *phydev)
  372. {
  373. int ret;
  374. /* Re-apply workarounds coming out suspend/resume */
  375. ret = bcm7xxx_28nm_ephy_config_init(phydev);
  376. if (ret)
  377. return ret;
  378. return genphy_config_aneg(phydev);
  379. }
  380. static int bcm7xxx_config_init(struct phy_device *phydev)
  381. {
  382. int ret;
  383. /* Enable 64 clock MDIO */
  384. phy_write(phydev, MII_BCM7XXX_AUX_MODE, MII_BCM7XXX_64CLK_MDIO);
  385. phy_read(phydev, MII_BCM7XXX_AUX_MODE);
  386. /* set shadow mode 2 */
  387. ret = phy_set_clr_bits(phydev, MII_BCM7XXX_TEST,
  388. MII_BCM7XXX_SHD_MODE_2, MII_BCM7XXX_SHD_MODE_2);
  389. if (ret < 0)
  390. return ret;
  391. /* set iddq_clkbias */
  392. phy_write(phydev, MII_BCM7XXX_100TX_DISC, 0x0F00);
  393. udelay(10);
  394. /* reset iddq_clkbias */
  395. phy_write(phydev, MII_BCM7XXX_100TX_DISC, 0x0C00);
  396. phy_write(phydev, MII_BCM7XXX_100TX_FALSE_CAR, 0x7555);
  397. /* reset shadow mode 2 */
  398. ret = phy_set_clr_bits(phydev, MII_BCM7XXX_TEST, 0, MII_BCM7XXX_SHD_MODE_2);
  399. if (ret < 0)
  400. return ret;
  401. return 0;
  402. }
  403. /* Workaround for putting the PHY in IDDQ mode, required
  404. * for all BCM7XXX 40nm and 65nm PHYs
  405. */
  406. static int bcm7xxx_suspend(struct phy_device *phydev)
  407. {
  408. int ret;
  409. static const struct bcm7xxx_regs {
  410. int reg;
  411. u16 value;
  412. } bcm7xxx_suspend_cfg[] = {
  413. { MII_BCM7XXX_TEST, 0x008b },
  414. { MII_BCM7XXX_100TX_AUX_CTL, 0x01c0 },
  415. { MII_BCM7XXX_100TX_DISC, 0x7000 },
  416. { MII_BCM7XXX_TEST, 0x000f },
  417. { MII_BCM7XXX_100TX_AUX_CTL, 0x20d0 },
  418. { MII_BCM7XXX_TEST, 0x000b },
  419. };
  420. unsigned int i;
  421. for (i = 0; i < ARRAY_SIZE(bcm7xxx_suspend_cfg); i++) {
  422. ret = phy_write(phydev,
  423. bcm7xxx_suspend_cfg[i].reg,
  424. bcm7xxx_suspend_cfg[i].value);
  425. if (ret)
  426. return ret;
  427. }
  428. return 0;
  429. }
  430. static int bcm7xxx_28nm_get_tunable(struct phy_device *phydev,
  431. struct ethtool_tunable *tuna,
  432. void *data)
  433. {
  434. switch (tuna->id) {
  435. case ETHTOOL_PHY_DOWNSHIFT:
  436. return bcm_phy_downshift_get(phydev, (u8 *)data);
  437. default:
  438. return -EOPNOTSUPP;
  439. }
  440. }
  441. static int bcm7xxx_28nm_set_tunable(struct phy_device *phydev,
  442. struct ethtool_tunable *tuna,
  443. const void *data)
  444. {
  445. u8 count = *(u8 *)data;
  446. int ret;
  447. switch (tuna->id) {
  448. case ETHTOOL_PHY_DOWNSHIFT:
  449. ret = bcm_phy_downshift_set(phydev, count);
  450. break;
  451. default:
  452. return -EOPNOTSUPP;
  453. }
  454. if (ret)
  455. return ret;
  456. /* Disable EEE advertisement since this prevents the PHY
  457. * from successfully linking up, trigger auto-negotiation restart
  458. * to let the MAC decide what to do.
  459. */
  460. ret = bcm_phy_set_eee(phydev, count == DOWNSHIFT_DEV_DISABLE);
  461. if (ret)
  462. return ret;
  463. return genphy_restart_aneg(phydev);
  464. }
  465. static void bcm7xxx_28nm_get_phy_stats(struct phy_device *phydev,
  466. struct ethtool_stats *stats, u64 *data)
  467. {
  468. struct bcm7xxx_phy_priv *priv = phydev->priv;
  469. bcm_phy_get_stats(phydev, priv->stats, stats, data);
  470. }
  471. static int bcm7xxx_28nm_probe(struct phy_device *phydev)
  472. {
  473. struct bcm7xxx_phy_priv *priv;
  474. priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);
  475. if (!priv)
  476. return -ENOMEM;
  477. phydev->priv = priv;
  478. priv->stats = devm_kcalloc(&phydev->mdio.dev,
  479. bcm_phy_get_sset_count(phydev), sizeof(u64),
  480. GFP_KERNEL);
  481. if (!priv->stats)
  482. return -ENOMEM;
  483. return 0;
  484. }
  485. #define BCM7XXX_28NM_GPHY(_oui, _name) \
  486. { \
  487. .phy_id = (_oui), \
  488. .phy_id_mask = 0xfffffff0, \
  489. .name = _name, \
  490. .features = PHY_GBIT_FEATURES, \
  491. .flags = PHY_IS_INTERNAL, \
  492. .config_init = bcm7xxx_28nm_config_init, \
  493. .resume = bcm7xxx_28nm_resume, \
  494. .get_tunable = bcm7xxx_28nm_get_tunable, \
  495. .set_tunable = bcm7xxx_28nm_set_tunable, \
  496. .get_sset_count = bcm_phy_get_sset_count, \
  497. .get_strings = bcm_phy_get_strings, \
  498. .get_stats = bcm7xxx_28nm_get_phy_stats, \
  499. .probe = bcm7xxx_28nm_probe, \
  500. }
  501. #define BCM7XXX_28NM_EPHY(_oui, _name) \
  502. { \
  503. .phy_id = (_oui), \
  504. .phy_id_mask = 0xfffffff0, \
  505. .name = _name, \
  506. .features = PHY_BASIC_FEATURES, \
  507. .flags = PHY_IS_INTERNAL, \
  508. .config_init = bcm7xxx_28nm_ephy_config_init, \
  509. .resume = bcm7xxx_28nm_ephy_resume, \
  510. .get_sset_count = bcm_phy_get_sset_count, \
  511. .get_strings = bcm_phy_get_strings, \
  512. .get_stats = bcm7xxx_28nm_get_phy_stats, \
  513. .probe = bcm7xxx_28nm_probe, \
  514. }
  515. #define BCM7XXX_40NM_EPHY(_oui, _name) \
  516. { \
  517. .phy_id = (_oui), \
  518. .phy_id_mask = 0xfffffff0, \
  519. .name = _name, \
  520. .features = PHY_BASIC_FEATURES, \
  521. .flags = PHY_IS_INTERNAL, \
  522. .config_init = bcm7xxx_config_init, \
  523. .suspend = bcm7xxx_suspend, \
  524. .resume = bcm7xxx_config_init, \
  525. }
  526. static struct phy_driver bcm7xxx_driver[] = {
  527. BCM7XXX_28NM_GPHY(PHY_ID_BCM7250, "Broadcom BCM7250"),
  528. BCM7XXX_28NM_EPHY(PHY_ID_BCM7260, "Broadcom BCM7260"),
  529. BCM7XXX_28NM_EPHY(PHY_ID_BCM7268, "Broadcom BCM7268"),
  530. BCM7XXX_28NM_EPHY(PHY_ID_BCM7271, "Broadcom BCM7271"),
  531. BCM7XXX_28NM_GPHY(PHY_ID_BCM7278, "Broadcom BCM7278"),
  532. BCM7XXX_28NM_GPHY(PHY_ID_BCM7364, "Broadcom BCM7364"),
  533. BCM7XXX_28NM_GPHY(PHY_ID_BCM7366, "Broadcom BCM7366"),
  534. BCM7XXX_28NM_GPHY(PHY_ID_BCM74371, "Broadcom BCM74371"),
  535. BCM7XXX_28NM_GPHY(PHY_ID_BCM7439, "Broadcom BCM7439"),
  536. BCM7XXX_28NM_GPHY(PHY_ID_BCM7439_2, "Broadcom BCM7439 (2)"),
  537. BCM7XXX_28NM_GPHY(PHY_ID_BCM7445, "Broadcom BCM7445"),
  538. BCM7XXX_40NM_EPHY(PHY_ID_BCM7346, "Broadcom BCM7346"),
  539. BCM7XXX_40NM_EPHY(PHY_ID_BCM7362, "Broadcom BCM7362"),
  540. BCM7XXX_40NM_EPHY(PHY_ID_BCM7425, "Broadcom BCM7425"),
  541. BCM7XXX_40NM_EPHY(PHY_ID_BCM7429, "Broadcom BCM7429"),
  542. BCM7XXX_40NM_EPHY(PHY_ID_BCM7435, "Broadcom BCM7435"),
  543. };
  544. static struct mdio_device_id __maybe_unused bcm7xxx_tbl[] = {
  545. { PHY_ID_BCM7250, 0xfffffff0, },
  546. { PHY_ID_BCM7260, 0xfffffff0, },
  547. { PHY_ID_BCM7268, 0xfffffff0, },
  548. { PHY_ID_BCM7271, 0xfffffff0, },
  549. { PHY_ID_BCM7278, 0xfffffff0, },
  550. { PHY_ID_BCM7364, 0xfffffff0, },
  551. { PHY_ID_BCM7366, 0xfffffff0, },
  552. { PHY_ID_BCM7346, 0xfffffff0, },
  553. { PHY_ID_BCM7362, 0xfffffff0, },
  554. { PHY_ID_BCM7425, 0xfffffff0, },
  555. { PHY_ID_BCM7429, 0xfffffff0, },
  556. { PHY_ID_BCM74371, 0xfffffff0, },
  557. { PHY_ID_BCM7439, 0xfffffff0, },
  558. { PHY_ID_BCM7435, 0xfffffff0, },
  559. { PHY_ID_BCM7445, 0xfffffff0, },
  560. { }
  561. };
  562. module_phy_driver(bcm7xxx_driver);
  563. MODULE_DEVICE_TABLE(mdio, bcm7xxx_tbl);
  564. MODULE_DESCRIPTION("Broadcom BCM7xxx internal PHY driver");
  565. MODULE_LICENSE("GPL");
  566. MODULE_AUTHOR("Broadcom Corporation");