broadcom.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831
  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 <linux/module.h>
  17. #include <linux/phy.h>
  18. #include <linux/brcmphy.h>
  19. #define PHY_ID_BCM50610 0x0143bd60
  20. #define PHY_ID_BCM50610M 0x0143bd70
  21. #define PHY_ID_BCM57780 0x03625d90
  22. #define BRCM_PHY_MODEL(phydev) \
  23. ((phydev)->drv->phy_id & (phydev)->drv->phy_id_mask)
  24. #define MII_BCM54XX_ECR 0x10 /* BCM54xx extended control register */
  25. #define MII_BCM54XX_ECR_IM 0x1000 /* Interrupt mask */
  26. #define MII_BCM54XX_ECR_IF 0x0800 /* Interrupt force */
  27. #define MII_BCM54XX_ESR 0x11 /* BCM54xx extended status register */
  28. #define MII_BCM54XX_ESR_IS 0x1000 /* Interrupt status */
  29. #define MII_BCM54XX_EXP_DATA 0x15 /* Expansion register data */
  30. #define MII_BCM54XX_EXP_SEL 0x17 /* Expansion register select */
  31. #define MII_BCM54XX_EXP_SEL_SSD 0x0e00 /* Secondary SerDes select */
  32. #define MII_BCM54XX_EXP_SEL_ER 0x0f00 /* Expansion register select */
  33. #define MII_BCM54XX_AUX_CTL 0x18 /* Auxiliary control register */
  34. #define MII_BCM54XX_ISR 0x1a /* BCM54xx interrupt status register */
  35. #define MII_BCM54XX_IMR 0x1b /* BCM54xx interrupt mask register */
  36. #define MII_BCM54XX_INT_CRCERR 0x0001 /* CRC error */
  37. #define MII_BCM54XX_INT_LINK 0x0002 /* Link status changed */
  38. #define MII_BCM54XX_INT_SPEED 0x0004 /* Link speed change */
  39. #define MII_BCM54XX_INT_DUPLEX 0x0008 /* Duplex mode changed */
  40. #define MII_BCM54XX_INT_LRS 0x0010 /* Local receiver status changed */
  41. #define MII_BCM54XX_INT_RRS 0x0020 /* Remote receiver status changed */
  42. #define MII_BCM54XX_INT_SSERR 0x0040 /* Scrambler synchronization error */
  43. #define MII_BCM54XX_INT_UHCD 0x0080 /* Unsupported HCD negotiated */
  44. #define MII_BCM54XX_INT_NHCD 0x0100 /* No HCD */
  45. #define MII_BCM54XX_INT_NHCDL 0x0200 /* No HCD link */
  46. #define MII_BCM54XX_INT_ANPR 0x0400 /* Auto-negotiation page received */
  47. #define MII_BCM54XX_INT_LC 0x0800 /* All counters below 128 */
  48. #define MII_BCM54XX_INT_HC 0x1000 /* Counter above 32768 */
  49. #define MII_BCM54XX_INT_MDIX 0x2000 /* MDIX status change */
  50. #define MII_BCM54XX_INT_PSERR 0x4000 /* Pair swap error */
  51. #define MII_BCM54XX_SHD 0x1c /* 0x1c shadow registers */
  52. #define MII_BCM54XX_SHD_WRITE 0x8000
  53. #define MII_BCM54XX_SHD_VAL(x) ((x & 0x1f) << 10)
  54. #define MII_BCM54XX_SHD_DATA(x) ((x & 0x3ff) << 0)
  55. /*
  56. * AUXILIARY CONTROL SHADOW ACCESS REGISTERS. (PHY REG 0x18)
  57. */
  58. #define MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL 0x0000
  59. #define MII_BCM54XX_AUXCTL_ACTL_TX_6DB 0x0400
  60. #define MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA 0x0800
  61. #define MII_BCM54XX_AUXCTL_MISC_WREN 0x8000
  62. #define MII_BCM54XX_AUXCTL_MISC_FORCE_AMDIX 0x0200
  63. #define MII_BCM54XX_AUXCTL_MISC_RDSEL_MISC 0x7000
  64. #define MII_BCM54XX_AUXCTL_SHDWSEL_MISC 0x0007
  65. #define MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL 0x0000
  66. /*
  67. * Broadcom LED source encodings. These are used in BCM5461, BCM5481,
  68. * BCM5482, and possibly some others.
  69. */
  70. #define BCM_LED_SRC_LINKSPD1 0x0
  71. #define BCM_LED_SRC_LINKSPD2 0x1
  72. #define BCM_LED_SRC_XMITLED 0x2
  73. #define BCM_LED_SRC_ACTIVITYLED 0x3
  74. #define BCM_LED_SRC_FDXLED 0x4
  75. #define BCM_LED_SRC_SLAVE 0x5
  76. #define BCM_LED_SRC_INTR 0x6
  77. #define BCM_LED_SRC_QUALITY 0x7
  78. #define BCM_LED_SRC_RCVLED 0x8
  79. #define BCM_LED_SRC_MULTICOLOR1 0xa
  80. #define BCM_LED_SRC_OPENSHORT 0xb
  81. #define BCM_LED_SRC_OFF 0xe /* Tied high */
  82. #define BCM_LED_SRC_ON 0xf /* Tied low */
  83. /*
  84. * BCM5482: Shadow registers
  85. * Shadow values go into bits [14:10] of register 0x1c to select a shadow
  86. * register to access.
  87. */
  88. #define BCM5482_SHD_LEDS1 0x0d /* 01101: LED Selector 1 */
  89. /* LED3 / ~LINKSPD[2] selector */
  90. #define BCM5482_SHD_LEDS1_LED3(src) ((src & 0xf) << 4)
  91. /* LED1 / ~LINKSPD[1] selector */
  92. #define BCM5482_SHD_LEDS1_LED1(src) ((src & 0xf) << 0)
  93. #define BCM54XX_SHD_RGMII_MODE 0x0b /* 01011: RGMII Mode Selector */
  94. #define BCM5482_SHD_SSD 0x14 /* 10100: Secondary SerDes control */
  95. #define BCM5482_SHD_SSD_LEDM 0x0008 /* SSD LED Mode enable */
  96. #define BCM5482_SHD_SSD_EN 0x0001 /* SSD enable */
  97. #define BCM5482_SHD_MODE 0x1f /* 11111: Mode Control Register */
  98. #define BCM5482_SHD_MODE_1000BX 0x0001 /* Enable 1000BASE-X registers */
  99. /*
  100. * EXPANSION SHADOW ACCESS REGISTERS. (PHY REG 0x15, 0x16, and 0x17)
  101. */
  102. #define MII_BCM54XX_EXP_AADJ1CH0 0x001f
  103. #define MII_BCM54XX_EXP_AADJ1CH0_SWP_ABCD_OEN 0x0200
  104. #define MII_BCM54XX_EXP_AADJ1CH0_SWSEL_THPF 0x0100
  105. #define MII_BCM54XX_EXP_AADJ1CH3 0x601f
  106. #define MII_BCM54XX_EXP_AADJ1CH3_ADCCKADJ 0x0002
  107. #define MII_BCM54XX_EXP_EXP08 0x0F08
  108. #define MII_BCM54XX_EXP_EXP08_RJCT_2MHZ 0x0001
  109. #define MII_BCM54XX_EXP_EXP08_EARLY_DAC_WAKE 0x0200
  110. #define MII_BCM54XX_EXP_EXP75 0x0f75
  111. #define MII_BCM54XX_EXP_EXP75_VDACCTRL 0x003c
  112. #define MII_BCM54XX_EXP_EXP75_CM_OSC 0x0001
  113. #define MII_BCM54XX_EXP_EXP96 0x0f96
  114. #define MII_BCM54XX_EXP_EXP96_MYST 0x0010
  115. #define MII_BCM54XX_EXP_EXP97 0x0f97
  116. #define MII_BCM54XX_EXP_EXP97_MYST 0x0c0c
  117. /*
  118. * BCM5482: Secondary SerDes registers
  119. */
  120. #define BCM5482_SSD_1000BX_CTL 0x00 /* 1000BASE-X Control */
  121. #define BCM5482_SSD_1000BX_CTL_PWRDOWN 0x0800 /* Power-down SSD */
  122. #define BCM5482_SSD_SGMII_SLAVE 0x15 /* SGMII Slave Register */
  123. #define BCM5482_SSD_SGMII_SLAVE_EN 0x0002 /* Slave mode enable */
  124. #define BCM5482_SSD_SGMII_SLAVE_AD 0x0001 /* Slave auto-detection */
  125. /*****************************************************************************/
  126. /* Fast Ethernet Transceiver definitions. */
  127. /*****************************************************************************/
  128. #define MII_BRCM_FET_INTREG 0x1a /* Interrupt register */
  129. #define MII_BRCM_FET_IR_MASK 0x0100 /* Mask all interrupts */
  130. #define MII_BRCM_FET_IR_LINK_EN 0x0200 /* Link status change enable */
  131. #define MII_BRCM_FET_IR_SPEED_EN 0x0400 /* Link speed change enable */
  132. #define MII_BRCM_FET_IR_DUPLEX_EN 0x0800 /* Duplex mode change enable */
  133. #define MII_BRCM_FET_IR_ENABLE 0x4000 /* Interrupt enable */
  134. #define MII_BRCM_FET_BRCMTEST 0x1f /* Brcm test register */
  135. #define MII_BRCM_FET_BT_SRE 0x0080 /* Shadow register enable */
  136. /*** Shadow register definitions ***/
  137. #define MII_BRCM_FET_SHDW_MISCCTRL 0x10 /* Shadow misc ctrl */
  138. #define MII_BRCM_FET_SHDW_MC_FAME 0x4000 /* Force Auto MDIX enable */
  139. #define MII_BRCM_FET_SHDW_AUXMODE4 0x1a /* Auxiliary mode 4 */
  140. #define MII_BRCM_FET_SHDW_AM4_LED_MASK 0x0003
  141. #define MII_BRCM_FET_SHDW_AM4_LED_MODE1 0x0001
  142. #define MII_BRCM_FET_SHDW_AUXSTAT2 0x1b /* Auxiliary status 2 */
  143. #define MII_BRCM_FET_SHDW_AS2_APDE 0x0020 /* Auto power down enable */
  144. MODULE_DESCRIPTION("Broadcom PHY driver");
  145. MODULE_AUTHOR("Maciej W. Rozycki");
  146. MODULE_LICENSE("GPL");
  147. /*
  148. * Indirect register access functions for the 1000BASE-T/100BASE-TX/10BASE-T
  149. * 0x1c shadow registers.
  150. */
  151. static int bcm54xx_shadow_read(struct phy_device *phydev, u16 shadow)
  152. {
  153. phy_write(phydev, MII_BCM54XX_SHD, MII_BCM54XX_SHD_VAL(shadow));
  154. return MII_BCM54XX_SHD_DATA(phy_read(phydev, MII_BCM54XX_SHD));
  155. }
  156. static int bcm54xx_shadow_write(struct phy_device *phydev, u16 shadow, u16 val)
  157. {
  158. return phy_write(phydev, MII_BCM54XX_SHD,
  159. MII_BCM54XX_SHD_WRITE |
  160. MII_BCM54XX_SHD_VAL(shadow) |
  161. MII_BCM54XX_SHD_DATA(val));
  162. }
  163. /* Indirect register access functions for the Expansion Registers */
  164. static int bcm54xx_exp_read(struct phy_device *phydev, u16 regnum)
  165. {
  166. int val;
  167. val = phy_write(phydev, MII_BCM54XX_EXP_SEL, regnum);
  168. if (val < 0)
  169. return val;
  170. val = phy_read(phydev, MII_BCM54XX_EXP_DATA);
  171. /* Restore default value. It's O.K. if this write fails. */
  172. phy_write(phydev, MII_BCM54XX_EXP_SEL, 0);
  173. return val;
  174. }
  175. static int bcm54xx_exp_write(struct phy_device *phydev, u16 regnum, u16 val)
  176. {
  177. int ret;
  178. ret = phy_write(phydev, MII_BCM54XX_EXP_SEL, regnum);
  179. if (ret < 0)
  180. return ret;
  181. ret = phy_write(phydev, MII_BCM54XX_EXP_DATA, val);
  182. /* Restore default value. It's O.K. if this write fails. */
  183. phy_write(phydev, MII_BCM54XX_EXP_SEL, 0);
  184. return ret;
  185. }
  186. static int bcm54xx_auxctl_write(struct phy_device *phydev, u16 regnum, u16 val)
  187. {
  188. return phy_write(phydev, MII_BCM54XX_AUX_CTL, regnum | val);
  189. }
  190. /* Needs SMDSP clock enabled via bcm54xx_phydsp_config() */
  191. static int bcm50610_a0_workaround(struct phy_device *phydev)
  192. {
  193. int err;
  194. err = bcm54xx_exp_write(phydev, MII_BCM54XX_EXP_AADJ1CH0,
  195. MII_BCM54XX_EXP_AADJ1CH0_SWP_ABCD_OEN |
  196. MII_BCM54XX_EXP_AADJ1CH0_SWSEL_THPF);
  197. if (err < 0)
  198. return err;
  199. err = bcm54xx_exp_write(phydev, MII_BCM54XX_EXP_AADJ1CH3,
  200. MII_BCM54XX_EXP_AADJ1CH3_ADCCKADJ);
  201. if (err < 0)
  202. return err;
  203. err = bcm54xx_exp_write(phydev, MII_BCM54XX_EXP_EXP75,
  204. MII_BCM54XX_EXP_EXP75_VDACCTRL);
  205. if (err < 0)
  206. return err;
  207. err = bcm54xx_exp_write(phydev, MII_BCM54XX_EXP_EXP96,
  208. MII_BCM54XX_EXP_EXP96_MYST);
  209. if (err < 0)
  210. return err;
  211. err = bcm54xx_exp_write(phydev, MII_BCM54XX_EXP_EXP97,
  212. MII_BCM54XX_EXP_EXP97_MYST);
  213. return err;
  214. }
  215. static int bcm54xx_phydsp_config(struct phy_device *phydev)
  216. {
  217. int err, err2;
  218. /* Enable the SMDSP clock */
  219. err = bcm54xx_auxctl_write(phydev,
  220. MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL,
  221. MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA |
  222. MII_BCM54XX_AUXCTL_ACTL_TX_6DB);
  223. if (err < 0)
  224. return err;
  225. if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
  226. BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) {
  227. /* Clear bit 9 to fix a phy interop issue. */
  228. err = bcm54xx_exp_write(phydev, MII_BCM54XX_EXP_EXP08,
  229. MII_BCM54XX_EXP_EXP08_RJCT_2MHZ);
  230. if (err < 0)
  231. goto error;
  232. if (phydev->drv->phy_id == PHY_ID_BCM50610) {
  233. err = bcm50610_a0_workaround(phydev);
  234. if (err < 0)
  235. goto error;
  236. }
  237. }
  238. if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM57780) {
  239. int val;
  240. val = bcm54xx_exp_read(phydev, MII_BCM54XX_EXP_EXP75);
  241. if (val < 0)
  242. goto error;
  243. val |= MII_BCM54XX_EXP_EXP75_CM_OSC;
  244. err = bcm54xx_exp_write(phydev, MII_BCM54XX_EXP_EXP75, val);
  245. }
  246. error:
  247. /* Disable the SMDSP clock */
  248. err2 = bcm54xx_auxctl_write(phydev,
  249. MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL,
  250. MII_BCM54XX_AUXCTL_ACTL_TX_6DB);
  251. /* Return the first error reported. */
  252. return err ? err : err2;
  253. }
  254. static int bcm54xx_config_init(struct phy_device *phydev)
  255. {
  256. int reg, err;
  257. reg = phy_read(phydev, MII_BCM54XX_ECR);
  258. if (reg < 0)
  259. return reg;
  260. /* Mask interrupts globally. */
  261. reg |= MII_BCM54XX_ECR_IM;
  262. err = phy_write(phydev, MII_BCM54XX_ECR, reg);
  263. if (err < 0)
  264. return err;
  265. /* Unmask events we are interested in. */
  266. reg = ~(MII_BCM54XX_INT_DUPLEX |
  267. MII_BCM54XX_INT_SPEED |
  268. MII_BCM54XX_INT_LINK);
  269. err = phy_write(phydev, MII_BCM54XX_IMR, reg);
  270. if (err < 0)
  271. return err;
  272. if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 ||
  273. BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) &&
  274. (phydev->dev_flags & PHY_BRCM_CLEAR_RGMII_MODE))
  275. bcm54xx_shadow_write(phydev, BCM54XX_SHD_RGMII_MODE, 0);
  276. bcm54xx_phydsp_config(phydev);
  277. return 0;
  278. }
  279. static int bcm5482_config_init(struct phy_device *phydev)
  280. {
  281. int err, reg;
  282. err = bcm54xx_config_init(phydev);
  283. if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) {
  284. /*
  285. * Enable secondary SerDes and its use as an LED source
  286. */
  287. reg = bcm54xx_shadow_read(phydev, BCM5482_SHD_SSD);
  288. bcm54xx_shadow_write(phydev, BCM5482_SHD_SSD,
  289. reg |
  290. BCM5482_SHD_SSD_LEDM |
  291. BCM5482_SHD_SSD_EN);
  292. /*
  293. * Enable SGMII slave mode and auto-detection
  294. */
  295. reg = BCM5482_SSD_SGMII_SLAVE | MII_BCM54XX_EXP_SEL_SSD;
  296. err = bcm54xx_exp_read(phydev, reg);
  297. if (err < 0)
  298. return err;
  299. err = bcm54xx_exp_write(phydev, reg, err |
  300. BCM5482_SSD_SGMII_SLAVE_EN |
  301. BCM5482_SSD_SGMII_SLAVE_AD);
  302. if (err < 0)
  303. return err;
  304. /*
  305. * Disable secondary SerDes powerdown
  306. */
  307. reg = BCM5482_SSD_1000BX_CTL | MII_BCM54XX_EXP_SEL_SSD;
  308. err = bcm54xx_exp_read(phydev, reg);
  309. if (err < 0)
  310. return err;
  311. err = bcm54xx_exp_write(phydev, reg,
  312. err & ~BCM5482_SSD_1000BX_CTL_PWRDOWN);
  313. if (err < 0)
  314. return err;
  315. /*
  316. * Select 1000BASE-X register set (primary SerDes)
  317. */
  318. reg = bcm54xx_shadow_read(phydev, BCM5482_SHD_MODE);
  319. bcm54xx_shadow_write(phydev, BCM5482_SHD_MODE,
  320. reg | BCM5482_SHD_MODE_1000BX);
  321. /*
  322. * LED1=ACTIVITYLED, LED3=LINKSPD[2]
  323. * (Use LED1 as secondary SerDes ACTIVITY LED)
  324. */
  325. bcm54xx_shadow_write(phydev, BCM5482_SHD_LEDS1,
  326. BCM5482_SHD_LEDS1_LED1(BCM_LED_SRC_ACTIVITYLED) |
  327. BCM5482_SHD_LEDS1_LED3(BCM_LED_SRC_LINKSPD2));
  328. /*
  329. * Auto-negotiation doesn't seem to work quite right
  330. * in this mode, so we disable it and force it to the
  331. * right speed/duplex setting. Only 'link status'
  332. * is important.
  333. */
  334. phydev->autoneg = AUTONEG_DISABLE;
  335. phydev->speed = SPEED_1000;
  336. phydev->duplex = DUPLEX_FULL;
  337. }
  338. return err;
  339. }
  340. static int bcm5482_read_status(struct phy_device *phydev)
  341. {
  342. int err;
  343. err = genphy_read_status(phydev);
  344. if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) {
  345. /*
  346. * Only link status matters for 1000Base-X mode, so force
  347. * 1000 Mbit/s full-duplex status
  348. */
  349. if (phydev->link) {
  350. phydev->speed = SPEED_1000;
  351. phydev->duplex = DUPLEX_FULL;
  352. }
  353. }
  354. return err;
  355. }
  356. static int bcm54xx_ack_interrupt(struct phy_device *phydev)
  357. {
  358. int reg;
  359. /* Clear pending interrupts. */
  360. reg = phy_read(phydev, MII_BCM54XX_ISR);
  361. if (reg < 0)
  362. return reg;
  363. return 0;
  364. }
  365. static int bcm54xx_config_intr(struct phy_device *phydev)
  366. {
  367. int reg, err;
  368. reg = phy_read(phydev, MII_BCM54XX_ECR);
  369. if (reg < 0)
  370. return reg;
  371. if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
  372. reg &= ~MII_BCM54XX_ECR_IM;
  373. else
  374. reg |= MII_BCM54XX_ECR_IM;
  375. err = phy_write(phydev, MII_BCM54XX_ECR, reg);
  376. return err;
  377. }
  378. static int bcm5481_config_aneg(struct phy_device *phydev)
  379. {
  380. int ret;
  381. /* Aneg firsly. */
  382. ret = genphy_config_aneg(phydev);
  383. /* Then we can set up the delay. */
  384. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
  385. u16 reg;
  386. /*
  387. * There is no BCM5481 specification available, so down
  388. * here is everything we know about "register 0x18". This
  389. * at least helps BCM5481 to successfuly receive packets
  390. * on MPC8360E-RDK board. Peter Barada <peterb@logicpd.com>
  391. * says: "This sets delay between the RXD and RXC signals
  392. * instead of using trace lengths to achieve timing".
  393. */
  394. /* Set RDX clk delay. */
  395. reg = 0x7 | (0x7 << 12);
  396. phy_write(phydev, 0x18, reg);
  397. reg = phy_read(phydev, 0x18);
  398. /* Set RDX-RXC skew. */
  399. reg |= (1 << 8);
  400. /* Write bits 14:0. */
  401. reg |= (1 << 15);
  402. phy_write(phydev, 0x18, reg);
  403. }
  404. return ret;
  405. }
  406. static int brcm_phy_setbits(struct phy_device *phydev, int reg, int set)
  407. {
  408. int val;
  409. val = phy_read(phydev, reg);
  410. if (val < 0)
  411. return val;
  412. return phy_write(phydev, reg, val | set);
  413. }
  414. static int brcm_fet_config_init(struct phy_device *phydev)
  415. {
  416. int reg, err, err2, brcmtest;
  417. /* Reset the PHY to bring it to a known state. */
  418. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  419. if (err < 0)
  420. return err;
  421. reg = phy_read(phydev, MII_BRCM_FET_INTREG);
  422. if (reg < 0)
  423. return reg;
  424. /* Unmask events we are interested in and mask interrupts globally. */
  425. reg = MII_BRCM_FET_IR_DUPLEX_EN |
  426. MII_BRCM_FET_IR_SPEED_EN |
  427. MII_BRCM_FET_IR_LINK_EN |
  428. MII_BRCM_FET_IR_ENABLE |
  429. MII_BRCM_FET_IR_MASK;
  430. err = phy_write(phydev, MII_BRCM_FET_INTREG, reg);
  431. if (err < 0)
  432. return err;
  433. /* Enable shadow register access */
  434. brcmtest = phy_read(phydev, MII_BRCM_FET_BRCMTEST);
  435. if (brcmtest < 0)
  436. return brcmtest;
  437. reg = brcmtest | MII_BRCM_FET_BT_SRE;
  438. err = phy_write(phydev, MII_BRCM_FET_BRCMTEST, reg);
  439. if (err < 0)
  440. return err;
  441. /* Set the LED mode */
  442. reg = phy_read(phydev, MII_BRCM_FET_SHDW_AUXMODE4);
  443. if (reg < 0) {
  444. err = reg;
  445. goto done;
  446. }
  447. reg &= ~MII_BRCM_FET_SHDW_AM4_LED_MASK;
  448. reg |= MII_BRCM_FET_SHDW_AM4_LED_MODE1;
  449. err = phy_write(phydev, MII_BRCM_FET_SHDW_AUXMODE4, reg);
  450. if (err < 0)
  451. goto done;
  452. /* Enable auto MDIX */
  453. err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_MISCCTRL,
  454. MII_BRCM_FET_SHDW_MC_FAME);
  455. if (err < 0)
  456. goto done;
  457. if (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE) {
  458. /* Enable auto power down */
  459. err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_AUXSTAT2,
  460. MII_BRCM_FET_SHDW_AS2_APDE);
  461. }
  462. done:
  463. /* Disable shadow register access */
  464. err2 = phy_write(phydev, MII_BRCM_FET_BRCMTEST, brcmtest);
  465. if (!err)
  466. err = err2;
  467. return err;
  468. }
  469. static int brcm_fet_ack_interrupt(struct phy_device *phydev)
  470. {
  471. int reg;
  472. /* Clear pending interrupts. */
  473. reg = phy_read(phydev, MII_BRCM_FET_INTREG);
  474. if (reg < 0)
  475. return reg;
  476. return 0;
  477. }
  478. static int brcm_fet_config_intr(struct phy_device *phydev)
  479. {
  480. int reg, err;
  481. reg = phy_read(phydev, MII_BRCM_FET_INTREG);
  482. if (reg < 0)
  483. return reg;
  484. if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
  485. reg &= ~MII_BRCM_FET_IR_MASK;
  486. else
  487. reg |= MII_BRCM_FET_IR_MASK;
  488. err = phy_write(phydev, MII_BRCM_FET_INTREG, reg);
  489. return err;
  490. }
  491. static struct phy_driver bcm5411_driver = {
  492. .phy_id = 0x00206070,
  493. .phy_id_mask = 0xfffffff0,
  494. .name = "Broadcom BCM5411",
  495. .features = PHY_GBIT_FEATURES |
  496. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  497. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  498. .config_init = bcm54xx_config_init,
  499. .config_aneg = genphy_config_aneg,
  500. .read_status = genphy_read_status,
  501. .ack_interrupt = bcm54xx_ack_interrupt,
  502. .config_intr = bcm54xx_config_intr,
  503. .driver = { .owner = THIS_MODULE },
  504. };
  505. static struct phy_driver bcm5421_driver = {
  506. .phy_id = 0x002060e0,
  507. .phy_id_mask = 0xfffffff0,
  508. .name = "Broadcom BCM5421",
  509. .features = PHY_GBIT_FEATURES |
  510. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  511. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  512. .config_init = bcm54xx_config_init,
  513. .config_aneg = genphy_config_aneg,
  514. .read_status = genphy_read_status,
  515. .ack_interrupt = bcm54xx_ack_interrupt,
  516. .config_intr = bcm54xx_config_intr,
  517. .driver = { .owner = THIS_MODULE },
  518. };
  519. static struct phy_driver bcm5461_driver = {
  520. .phy_id = 0x002060c0,
  521. .phy_id_mask = 0xfffffff0,
  522. .name = "Broadcom BCM5461",
  523. .features = PHY_GBIT_FEATURES |
  524. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  525. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  526. .config_init = bcm54xx_config_init,
  527. .config_aneg = genphy_config_aneg,
  528. .read_status = genphy_read_status,
  529. .ack_interrupt = bcm54xx_ack_interrupt,
  530. .config_intr = bcm54xx_config_intr,
  531. .driver = { .owner = THIS_MODULE },
  532. };
  533. static struct phy_driver bcm5464_driver = {
  534. .phy_id = 0x002060b0,
  535. .phy_id_mask = 0xfffffff0,
  536. .name = "Broadcom BCM5464",
  537. .features = PHY_GBIT_FEATURES |
  538. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  539. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  540. .config_init = bcm54xx_config_init,
  541. .config_aneg = genphy_config_aneg,
  542. .read_status = genphy_read_status,
  543. .ack_interrupt = bcm54xx_ack_interrupt,
  544. .config_intr = bcm54xx_config_intr,
  545. .driver = { .owner = THIS_MODULE },
  546. };
  547. static struct phy_driver bcm5481_driver = {
  548. .phy_id = 0x0143bca0,
  549. .phy_id_mask = 0xfffffff0,
  550. .name = "Broadcom BCM5481",
  551. .features = PHY_GBIT_FEATURES |
  552. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  553. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  554. .config_init = bcm54xx_config_init,
  555. .config_aneg = bcm5481_config_aneg,
  556. .read_status = genphy_read_status,
  557. .ack_interrupt = bcm54xx_ack_interrupt,
  558. .config_intr = bcm54xx_config_intr,
  559. .driver = { .owner = THIS_MODULE },
  560. };
  561. static struct phy_driver bcm5482_driver = {
  562. .phy_id = 0x0143bcb0,
  563. .phy_id_mask = 0xfffffff0,
  564. .name = "Broadcom BCM5482",
  565. .features = PHY_GBIT_FEATURES |
  566. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  567. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  568. .config_init = bcm5482_config_init,
  569. .config_aneg = genphy_config_aneg,
  570. .read_status = bcm5482_read_status,
  571. .ack_interrupt = bcm54xx_ack_interrupt,
  572. .config_intr = bcm54xx_config_intr,
  573. .driver = { .owner = THIS_MODULE },
  574. };
  575. static struct phy_driver bcm50610_driver = {
  576. .phy_id = PHY_ID_BCM50610,
  577. .phy_id_mask = 0xfffffff0,
  578. .name = "Broadcom BCM50610",
  579. .features = PHY_GBIT_FEATURES |
  580. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  581. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  582. .config_init = bcm54xx_config_init,
  583. .config_aneg = genphy_config_aneg,
  584. .read_status = genphy_read_status,
  585. .ack_interrupt = bcm54xx_ack_interrupt,
  586. .config_intr = bcm54xx_config_intr,
  587. .driver = { .owner = THIS_MODULE },
  588. };
  589. static struct phy_driver bcm50610m_driver = {
  590. .phy_id = PHY_ID_BCM50610M,
  591. .phy_id_mask = 0xfffffff0,
  592. .name = "Broadcom BCM50610M",
  593. .features = PHY_GBIT_FEATURES |
  594. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  595. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  596. .config_init = bcm54xx_config_init,
  597. .config_aneg = genphy_config_aneg,
  598. .read_status = genphy_read_status,
  599. .ack_interrupt = bcm54xx_ack_interrupt,
  600. .config_intr = bcm54xx_config_intr,
  601. .driver = { .owner = THIS_MODULE },
  602. };
  603. static struct phy_driver bcm57780_driver = {
  604. .phy_id = PHY_ID_BCM57780,
  605. .phy_id_mask = 0xfffffff0,
  606. .name = "Broadcom BCM57780",
  607. .features = PHY_GBIT_FEATURES |
  608. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  609. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  610. .config_init = bcm54xx_config_init,
  611. .config_aneg = genphy_config_aneg,
  612. .read_status = genphy_read_status,
  613. .ack_interrupt = bcm54xx_ack_interrupt,
  614. .config_intr = bcm54xx_config_intr,
  615. .driver = { .owner = THIS_MODULE },
  616. };
  617. static struct phy_driver bcmac131_driver = {
  618. .phy_id = 0x0143bc70,
  619. .phy_id_mask = 0xfffffff0,
  620. .name = "Broadcom BCMAC131",
  621. .features = PHY_BASIC_FEATURES |
  622. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  623. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  624. .config_init = brcm_fet_config_init,
  625. .config_aneg = genphy_config_aneg,
  626. .read_status = genphy_read_status,
  627. .ack_interrupt = brcm_fet_ack_interrupt,
  628. .config_intr = brcm_fet_config_intr,
  629. .driver = { .owner = THIS_MODULE },
  630. };
  631. static int __init broadcom_init(void)
  632. {
  633. int ret;
  634. ret = phy_driver_register(&bcm5411_driver);
  635. if (ret)
  636. goto out_5411;
  637. ret = phy_driver_register(&bcm5421_driver);
  638. if (ret)
  639. goto out_5421;
  640. ret = phy_driver_register(&bcm5461_driver);
  641. if (ret)
  642. goto out_5461;
  643. ret = phy_driver_register(&bcm5464_driver);
  644. if (ret)
  645. goto out_5464;
  646. ret = phy_driver_register(&bcm5481_driver);
  647. if (ret)
  648. goto out_5481;
  649. ret = phy_driver_register(&bcm5482_driver);
  650. if (ret)
  651. goto out_5482;
  652. ret = phy_driver_register(&bcm50610_driver);
  653. if (ret)
  654. goto out_50610;
  655. ret = phy_driver_register(&bcm50610m_driver);
  656. if (ret)
  657. goto out_50610m;
  658. ret = phy_driver_register(&bcm57780_driver);
  659. if (ret)
  660. goto out_57780;
  661. ret = phy_driver_register(&bcmac131_driver);
  662. if (ret)
  663. goto out_ac131;
  664. return ret;
  665. out_ac131:
  666. phy_driver_unregister(&bcm57780_driver);
  667. out_57780:
  668. phy_driver_unregister(&bcm50610m_driver);
  669. out_50610m:
  670. phy_driver_unregister(&bcm50610_driver);
  671. out_50610:
  672. phy_driver_unregister(&bcm5482_driver);
  673. out_5482:
  674. phy_driver_unregister(&bcm5481_driver);
  675. out_5481:
  676. phy_driver_unregister(&bcm5464_driver);
  677. out_5464:
  678. phy_driver_unregister(&bcm5461_driver);
  679. out_5461:
  680. phy_driver_unregister(&bcm5421_driver);
  681. out_5421:
  682. phy_driver_unregister(&bcm5411_driver);
  683. out_5411:
  684. return ret;
  685. }
  686. static void __exit broadcom_exit(void)
  687. {
  688. phy_driver_unregister(&bcmac131_driver);
  689. phy_driver_unregister(&bcm57780_driver);
  690. phy_driver_unregister(&bcm50610m_driver);
  691. phy_driver_unregister(&bcm50610_driver);
  692. phy_driver_unregister(&bcm5482_driver);
  693. phy_driver_unregister(&bcm5481_driver);
  694. phy_driver_unregister(&bcm5464_driver);
  695. phy_driver_unregister(&bcm5461_driver);
  696. phy_driver_unregister(&bcm5421_driver);
  697. phy_driver_unregister(&bcm5411_driver);
  698. }
  699. module_init(broadcom_init);
  700. module_exit(broadcom_exit);