broadcom.c 23 KB

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