marvell.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743
  1. /*
  2. * drivers/net/phy/marvell.c
  3. *
  4. * Driver for Marvell PHYs
  5. *
  6. * Author: Andy Fleming
  7. *
  8. * Copyright (c) 2004 Freescale Semiconductor, Inc.
  9. *
  10. * This program is free software; you can redistribute it and/or modify it
  11. * under the terms of the GNU General Public License as published by the
  12. * Free Software Foundation; either version 2 of the License, or (at your
  13. * option) any later version.
  14. *
  15. */
  16. #include <linux/kernel.h>
  17. #include <linux/string.h>
  18. #include <linux/errno.h>
  19. #include <linux/unistd.h>
  20. #include <linux/interrupt.h>
  21. #include <linux/init.h>
  22. #include <linux/delay.h>
  23. #include <linux/netdevice.h>
  24. #include <linux/etherdevice.h>
  25. #include <linux/skbuff.h>
  26. #include <linux/spinlock.h>
  27. #include <linux/mm.h>
  28. #include <linux/module.h>
  29. #include <linux/mii.h>
  30. #include <linux/ethtool.h>
  31. #include <linux/phy.h>
  32. #include <linux/marvell_phy.h>
  33. #include <asm/io.h>
  34. #include <asm/irq.h>
  35. #include <asm/uaccess.h>
  36. #define MII_M1011_IEVENT 0x13
  37. #define MII_M1011_IEVENT_CLEAR 0x0000
  38. #define MII_M1011_IMASK 0x12
  39. #define MII_M1011_IMASK_INIT 0x6400
  40. #define MII_M1011_IMASK_CLEAR 0x0000
  41. #define MII_M1011_PHY_SCR 0x10
  42. #define MII_M1011_PHY_SCR_AUTO_CROSS 0x0060
  43. #define MII_M1145_PHY_EXT_CR 0x14
  44. #define MII_M1145_RGMII_RX_DELAY 0x0080
  45. #define MII_M1145_RGMII_TX_DELAY 0x0002
  46. #define MII_M1111_PHY_LED_CONTROL 0x18
  47. #define MII_M1111_PHY_LED_DIRECT 0x4100
  48. #define MII_M1111_PHY_LED_COMBINE 0x411c
  49. #define MII_M1111_PHY_EXT_CR 0x14
  50. #define MII_M1111_RX_DELAY 0x80
  51. #define MII_M1111_TX_DELAY 0x2
  52. #define MII_M1111_PHY_EXT_SR 0x1b
  53. #define MII_M1111_HWCFG_MODE_MASK 0xf
  54. #define MII_M1111_HWCFG_MODE_COPPER_RGMII 0xb
  55. #define MII_M1111_HWCFG_MODE_FIBER_RGMII 0x3
  56. #define MII_M1111_HWCFG_MODE_SGMII_NO_CLK 0x4
  57. #define MII_M1111_HWCFG_MODE_COPPER_RTBI 0x9
  58. #define MII_M1111_HWCFG_FIBER_COPPER_AUTO 0x8000
  59. #define MII_M1111_HWCFG_FIBER_COPPER_RES 0x2000
  60. #define MII_M1111_COPPER 0
  61. #define MII_M1111_FIBER 1
  62. #define MII_88E1121_PHY_MSCR_PAGE 2
  63. #define MII_88E1121_PHY_MSCR_REG 21
  64. #define MII_88E1121_PHY_MSCR_RX_DELAY BIT(5)
  65. #define MII_88E1121_PHY_MSCR_TX_DELAY BIT(4)
  66. #define MII_88E1121_PHY_MSCR_DELAY_MASK (~(0x3 << 4))
  67. #define MII_88E1318S_PHY_MSCR1_REG 16
  68. #define MII_88E1318S_PHY_MSCR1_PAD_ODD BIT(6)
  69. #define MII_88E1121_PHY_LED_CTRL 16
  70. #define MII_88E1121_PHY_LED_PAGE 3
  71. #define MII_88E1121_PHY_LED_DEF 0x0030
  72. #define MII_88E1121_PHY_PAGE 22
  73. #define MII_M1011_PHY_STATUS 0x11
  74. #define MII_M1011_PHY_STATUS_1000 0x8000
  75. #define MII_M1011_PHY_STATUS_100 0x4000
  76. #define MII_M1011_PHY_STATUS_SPD_MASK 0xc000
  77. #define MII_M1011_PHY_STATUS_FULLDUPLEX 0x2000
  78. #define MII_M1011_PHY_STATUS_RESOLVED 0x0800
  79. #define MII_M1011_PHY_STATUS_LINK 0x0400
  80. MODULE_DESCRIPTION("Marvell PHY driver");
  81. MODULE_AUTHOR("Andy Fleming");
  82. MODULE_LICENSE("GPL");
  83. static int marvell_ack_interrupt(struct phy_device *phydev)
  84. {
  85. int err;
  86. /* Clear the interrupts by reading the reg */
  87. err = phy_read(phydev, MII_M1011_IEVENT);
  88. if (err < 0)
  89. return err;
  90. return 0;
  91. }
  92. static int marvell_config_intr(struct phy_device *phydev)
  93. {
  94. int err;
  95. if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
  96. err = phy_write(phydev, MII_M1011_IMASK, MII_M1011_IMASK_INIT);
  97. else
  98. err = phy_write(phydev, MII_M1011_IMASK, MII_M1011_IMASK_CLEAR);
  99. return err;
  100. }
  101. static int marvell_config_aneg(struct phy_device *phydev)
  102. {
  103. int err;
  104. /* The Marvell PHY has an errata which requires
  105. * that certain registers get written in order
  106. * to restart autonegotiation */
  107. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  108. if (err < 0)
  109. return err;
  110. err = phy_write(phydev, 0x1d, 0x1f);
  111. if (err < 0)
  112. return err;
  113. err = phy_write(phydev, 0x1e, 0x200c);
  114. if (err < 0)
  115. return err;
  116. err = phy_write(phydev, 0x1d, 0x5);
  117. if (err < 0)
  118. return err;
  119. err = phy_write(phydev, 0x1e, 0);
  120. if (err < 0)
  121. return err;
  122. err = phy_write(phydev, 0x1e, 0x100);
  123. if (err < 0)
  124. return err;
  125. err = phy_write(phydev, MII_M1011_PHY_SCR,
  126. MII_M1011_PHY_SCR_AUTO_CROSS);
  127. if (err < 0)
  128. return err;
  129. err = phy_write(phydev, MII_M1111_PHY_LED_CONTROL,
  130. MII_M1111_PHY_LED_DIRECT);
  131. if (err < 0)
  132. return err;
  133. err = genphy_config_aneg(phydev);
  134. if (err < 0)
  135. return err;
  136. if (phydev->autoneg != AUTONEG_ENABLE) {
  137. int bmcr;
  138. /*
  139. * A write to speed/duplex bits (that is performed by
  140. * genphy_config_aneg() call above) must be followed by
  141. * a software reset. Otherwise, the write has no effect.
  142. */
  143. bmcr = phy_read(phydev, MII_BMCR);
  144. if (bmcr < 0)
  145. return bmcr;
  146. err = phy_write(phydev, MII_BMCR, bmcr | BMCR_RESET);
  147. if (err < 0)
  148. return err;
  149. }
  150. return 0;
  151. }
  152. static int m88e1121_config_aneg(struct phy_device *phydev)
  153. {
  154. int err, oldpage, mscr;
  155. oldpage = phy_read(phydev, MII_88E1121_PHY_PAGE);
  156. err = phy_write(phydev, MII_88E1121_PHY_PAGE,
  157. MII_88E1121_PHY_MSCR_PAGE);
  158. if (err < 0)
  159. return err;
  160. if ((phydev->interface == PHY_INTERFACE_MODE_RGMII) ||
  161. (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) ||
  162. (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) ||
  163. (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)) {
  164. mscr = phy_read(phydev, MII_88E1121_PHY_MSCR_REG) &
  165. MII_88E1121_PHY_MSCR_DELAY_MASK;
  166. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
  167. mscr |= (MII_88E1121_PHY_MSCR_RX_DELAY |
  168. MII_88E1121_PHY_MSCR_TX_DELAY);
  169. else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID)
  170. mscr |= MII_88E1121_PHY_MSCR_RX_DELAY;
  171. else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)
  172. mscr |= MII_88E1121_PHY_MSCR_TX_DELAY;
  173. err = phy_write(phydev, MII_88E1121_PHY_MSCR_REG, mscr);
  174. if (err < 0)
  175. return err;
  176. }
  177. phy_write(phydev, MII_88E1121_PHY_PAGE, oldpage);
  178. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  179. if (err < 0)
  180. return err;
  181. err = phy_write(phydev, MII_M1011_PHY_SCR,
  182. MII_M1011_PHY_SCR_AUTO_CROSS);
  183. if (err < 0)
  184. return err;
  185. oldpage = phy_read(phydev, MII_88E1121_PHY_PAGE);
  186. phy_write(phydev, MII_88E1121_PHY_PAGE, MII_88E1121_PHY_LED_PAGE);
  187. phy_write(phydev, MII_88E1121_PHY_LED_CTRL, MII_88E1121_PHY_LED_DEF);
  188. phy_write(phydev, MII_88E1121_PHY_PAGE, oldpage);
  189. err = genphy_config_aneg(phydev);
  190. return err;
  191. }
  192. static int m88e1318_config_aneg(struct phy_device *phydev)
  193. {
  194. int err, oldpage, mscr;
  195. oldpage = phy_read(phydev, MII_88E1121_PHY_PAGE);
  196. err = phy_write(phydev, MII_88E1121_PHY_PAGE,
  197. MII_88E1121_PHY_MSCR_PAGE);
  198. if (err < 0)
  199. return err;
  200. mscr = phy_read(phydev, MII_88E1318S_PHY_MSCR1_REG);
  201. mscr |= MII_88E1318S_PHY_MSCR1_PAD_ODD;
  202. err = phy_write(phydev, MII_88E1318S_PHY_MSCR1_REG, mscr);
  203. if (err < 0)
  204. return err;
  205. err = phy_write(phydev, MII_88E1121_PHY_PAGE, oldpage);
  206. if (err < 0)
  207. return err;
  208. return m88e1121_config_aneg(phydev);
  209. }
  210. static int m88e1111_config_init(struct phy_device *phydev)
  211. {
  212. int err;
  213. int temp;
  214. /* Enable Fiber/Copper auto selection */
  215. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  216. temp &= ~MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  217. phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  218. temp = phy_read(phydev, MII_BMCR);
  219. temp |= BMCR_RESET;
  220. phy_write(phydev, MII_BMCR, temp);
  221. if ((phydev->interface == PHY_INTERFACE_MODE_RGMII) ||
  222. (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) ||
  223. (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) ||
  224. (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)) {
  225. temp = phy_read(phydev, MII_M1111_PHY_EXT_CR);
  226. if (temp < 0)
  227. return temp;
  228. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) {
  229. temp |= (MII_M1111_RX_DELAY | MII_M1111_TX_DELAY);
  230. } else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
  231. temp &= ~MII_M1111_TX_DELAY;
  232. temp |= MII_M1111_RX_DELAY;
  233. } else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
  234. temp &= ~MII_M1111_RX_DELAY;
  235. temp |= MII_M1111_TX_DELAY;
  236. }
  237. err = phy_write(phydev, MII_M1111_PHY_EXT_CR, temp);
  238. if (err < 0)
  239. return err;
  240. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  241. if (temp < 0)
  242. return temp;
  243. temp &= ~(MII_M1111_HWCFG_MODE_MASK);
  244. if (temp & MII_M1111_HWCFG_FIBER_COPPER_RES)
  245. temp |= MII_M1111_HWCFG_MODE_FIBER_RGMII;
  246. else
  247. temp |= MII_M1111_HWCFG_MODE_COPPER_RGMII;
  248. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  249. if (err < 0)
  250. return err;
  251. }
  252. if (phydev->interface == PHY_INTERFACE_MODE_SGMII) {
  253. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  254. if (temp < 0)
  255. return temp;
  256. temp &= ~(MII_M1111_HWCFG_MODE_MASK);
  257. temp |= MII_M1111_HWCFG_MODE_SGMII_NO_CLK;
  258. temp |= MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  259. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  260. if (err < 0)
  261. return err;
  262. }
  263. if (phydev->interface == PHY_INTERFACE_MODE_RTBI) {
  264. temp = phy_read(phydev, MII_M1111_PHY_EXT_CR);
  265. if (temp < 0)
  266. return temp;
  267. temp |= (MII_M1111_RX_DELAY | MII_M1111_TX_DELAY);
  268. err = phy_write(phydev, MII_M1111_PHY_EXT_CR, temp);
  269. if (err < 0)
  270. return err;
  271. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  272. if (temp < 0)
  273. return temp;
  274. temp &= ~(MII_M1111_HWCFG_MODE_MASK | MII_M1111_HWCFG_FIBER_COPPER_RES);
  275. temp |= 0x7 | MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  276. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  277. if (err < 0)
  278. return err;
  279. /* soft reset */
  280. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  281. if (err < 0)
  282. return err;
  283. do
  284. temp = phy_read(phydev, MII_BMCR);
  285. while (temp & BMCR_RESET);
  286. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  287. if (temp < 0)
  288. return temp;
  289. temp &= ~(MII_M1111_HWCFG_MODE_MASK | MII_M1111_HWCFG_FIBER_COPPER_RES);
  290. temp |= MII_M1111_HWCFG_MODE_COPPER_RTBI | MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  291. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  292. if (err < 0)
  293. return err;
  294. }
  295. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  296. if (err < 0)
  297. return err;
  298. return 0;
  299. }
  300. static int m88e1118_config_aneg(struct phy_device *phydev)
  301. {
  302. int err;
  303. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  304. if (err < 0)
  305. return err;
  306. err = phy_write(phydev, MII_M1011_PHY_SCR,
  307. MII_M1011_PHY_SCR_AUTO_CROSS);
  308. if (err < 0)
  309. return err;
  310. err = genphy_config_aneg(phydev);
  311. return 0;
  312. }
  313. static int m88e1118_config_init(struct phy_device *phydev)
  314. {
  315. int err;
  316. /* Change address */
  317. err = phy_write(phydev, 0x16, 0x0002);
  318. if (err < 0)
  319. return err;
  320. /* Enable 1000 Mbit */
  321. err = phy_write(phydev, 0x15, 0x1070);
  322. if (err < 0)
  323. return err;
  324. /* Change address */
  325. err = phy_write(phydev, 0x16, 0x0003);
  326. if (err < 0)
  327. return err;
  328. /* Adjust LED Control */
  329. if (phydev->dev_flags & MARVELL_PHY_M1118_DNS323_LEDS)
  330. err = phy_write(phydev, 0x10, 0x1100);
  331. else
  332. err = phy_write(phydev, 0x10, 0x021e);
  333. if (err < 0)
  334. return err;
  335. /* Reset address */
  336. err = phy_write(phydev, 0x16, 0x0);
  337. if (err < 0)
  338. return err;
  339. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  340. if (err < 0)
  341. return err;
  342. return 0;
  343. }
  344. static int m88e1145_config_init(struct phy_device *phydev)
  345. {
  346. int err;
  347. /* Take care of errata E0 & E1 */
  348. err = phy_write(phydev, 0x1d, 0x001b);
  349. if (err < 0)
  350. return err;
  351. err = phy_write(phydev, 0x1e, 0x418f);
  352. if (err < 0)
  353. return err;
  354. err = phy_write(phydev, 0x1d, 0x0016);
  355. if (err < 0)
  356. return err;
  357. err = phy_write(phydev, 0x1e, 0xa2da);
  358. if (err < 0)
  359. return err;
  360. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) {
  361. int temp = phy_read(phydev, MII_M1145_PHY_EXT_CR);
  362. if (temp < 0)
  363. return temp;
  364. temp |= (MII_M1145_RGMII_RX_DELAY | MII_M1145_RGMII_TX_DELAY);
  365. err = phy_write(phydev, MII_M1145_PHY_EXT_CR, temp);
  366. if (err < 0)
  367. return err;
  368. if (phydev->dev_flags & MARVELL_PHY_M1145_FLAGS_RESISTANCE) {
  369. err = phy_write(phydev, 0x1d, 0x0012);
  370. if (err < 0)
  371. return err;
  372. temp = phy_read(phydev, 0x1e);
  373. if (temp < 0)
  374. return temp;
  375. temp &= 0xf03f;
  376. temp |= 2 << 9; /* 36 ohm */
  377. temp |= 2 << 6; /* 39 ohm */
  378. err = phy_write(phydev, 0x1e, temp);
  379. if (err < 0)
  380. return err;
  381. err = phy_write(phydev, 0x1d, 0x3);
  382. if (err < 0)
  383. return err;
  384. err = phy_write(phydev, 0x1e, 0x8000);
  385. if (err < 0)
  386. return err;
  387. }
  388. }
  389. return 0;
  390. }
  391. /* marvell_read_status
  392. *
  393. * Generic status code does not detect Fiber correctly!
  394. * Description:
  395. * Check the link, then figure out the current state
  396. * by comparing what we advertise with what the link partner
  397. * advertises. Start by checking the gigabit possibilities,
  398. * then move on to 10/100.
  399. */
  400. static int marvell_read_status(struct phy_device *phydev)
  401. {
  402. int adv;
  403. int err;
  404. int lpa;
  405. int status = 0;
  406. /* Update the link, but return if there
  407. * was an error */
  408. err = genphy_update_link(phydev);
  409. if (err)
  410. return err;
  411. if (AUTONEG_ENABLE == phydev->autoneg) {
  412. status = phy_read(phydev, MII_M1011_PHY_STATUS);
  413. if (status < 0)
  414. return status;
  415. lpa = phy_read(phydev, MII_LPA);
  416. if (lpa < 0)
  417. return lpa;
  418. adv = phy_read(phydev, MII_ADVERTISE);
  419. if (adv < 0)
  420. return adv;
  421. lpa &= adv;
  422. if (status & MII_M1011_PHY_STATUS_FULLDUPLEX)
  423. phydev->duplex = DUPLEX_FULL;
  424. else
  425. phydev->duplex = DUPLEX_HALF;
  426. status = status & MII_M1011_PHY_STATUS_SPD_MASK;
  427. phydev->pause = phydev->asym_pause = 0;
  428. switch (status) {
  429. case MII_M1011_PHY_STATUS_1000:
  430. phydev->speed = SPEED_1000;
  431. break;
  432. case MII_M1011_PHY_STATUS_100:
  433. phydev->speed = SPEED_100;
  434. break;
  435. default:
  436. phydev->speed = SPEED_10;
  437. break;
  438. }
  439. if (phydev->duplex == DUPLEX_FULL) {
  440. phydev->pause = lpa & LPA_PAUSE_CAP ? 1 : 0;
  441. phydev->asym_pause = lpa & LPA_PAUSE_ASYM ? 1 : 0;
  442. }
  443. } else {
  444. int bmcr = phy_read(phydev, MII_BMCR);
  445. if (bmcr < 0)
  446. return bmcr;
  447. if (bmcr & BMCR_FULLDPLX)
  448. phydev->duplex = DUPLEX_FULL;
  449. else
  450. phydev->duplex = DUPLEX_HALF;
  451. if (bmcr & BMCR_SPEED1000)
  452. phydev->speed = SPEED_1000;
  453. else if (bmcr & BMCR_SPEED100)
  454. phydev->speed = SPEED_100;
  455. else
  456. phydev->speed = SPEED_10;
  457. phydev->pause = phydev->asym_pause = 0;
  458. }
  459. return 0;
  460. }
  461. static int m88e1121_did_interrupt(struct phy_device *phydev)
  462. {
  463. int imask;
  464. imask = phy_read(phydev, MII_M1011_IEVENT);
  465. if (imask & MII_M1011_IMASK_INIT)
  466. return 1;
  467. return 0;
  468. }
  469. static struct phy_driver marvell_drivers[] = {
  470. {
  471. .phy_id = MARVELL_PHY_ID_88E1101,
  472. .phy_id_mask = MARVELL_PHY_ID_MASK,
  473. .name = "Marvell 88E1101",
  474. .features = PHY_GBIT_FEATURES,
  475. .flags = PHY_HAS_INTERRUPT,
  476. .config_aneg = &marvell_config_aneg,
  477. .read_status = &genphy_read_status,
  478. .ack_interrupt = &marvell_ack_interrupt,
  479. .config_intr = &marvell_config_intr,
  480. .driver = { .owner = THIS_MODULE },
  481. },
  482. {
  483. .phy_id = MARVELL_PHY_ID_88E1112,
  484. .phy_id_mask = MARVELL_PHY_ID_MASK,
  485. .name = "Marvell 88E1112",
  486. .features = PHY_GBIT_FEATURES,
  487. .flags = PHY_HAS_INTERRUPT,
  488. .config_init = &m88e1111_config_init,
  489. .config_aneg = &marvell_config_aneg,
  490. .read_status = &genphy_read_status,
  491. .ack_interrupt = &marvell_ack_interrupt,
  492. .config_intr = &marvell_config_intr,
  493. .driver = { .owner = THIS_MODULE },
  494. },
  495. {
  496. .phy_id = MARVELL_PHY_ID_88E1111,
  497. .phy_id_mask = MARVELL_PHY_ID_MASK,
  498. .name = "Marvell 88E1111",
  499. .features = PHY_GBIT_FEATURES,
  500. .flags = PHY_HAS_INTERRUPT,
  501. .config_init = &m88e1111_config_init,
  502. .config_aneg = &marvell_config_aneg,
  503. .read_status = &marvell_read_status,
  504. .ack_interrupt = &marvell_ack_interrupt,
  505. .config_intr = &marvell_config_intr,
  506. .driver = { .owner = THIS_MODULE },
  507. },
  508. {
  509. .phy_id = MARVELL_PHY_ID_88E1118,
  510. .phy_id_mask = MARVELL_PHY_ID_MASK,
  511. .name = "Marvell 88E1118",
  512. .features = PHY_GBIT_FEATURES,
  513. .flags = PHY_HAS_INTERRUPT,
  514. .config_init = &m88e1118_config_init,
  515. .config_aneg = &m88e1118_config_aneg,
  516. .read_status = &genphy_read_status,
  517. .ack_interrupt = &marvell_ack_interrupt,
  518. .config_intr = &marvell_config_intr,
  519. .driver = {.owner = THIS_MODULE,},
  520. },
  521. {
  522. .phy_id = MARVELL_PHY_ID_88E1121R,
  523. .phy_id_mask = MARVELL_PHY_ID_MASK,
  524. .name = "Marvell 88E1121R",
  525. .features = PHY_GBIT_FEATURES,
  526. .flags = PHY_HAS_INTERRUPT,
  527. .config_aneg = &m88e1121_config_aneg,
  528. .read_status = &marvell_read_status,
  529. .ack_interrupt = &marvell_ack_interrupt,
  530. .config_intr = &marvell_config_intr,
  531. .did_interrupt = &m88e1121_did_interrupt,
  532. .driver = { .owner = THIS_MODULE },
  533. },
  534. {
  535. .phy_id = MARVELL_PHY_ID_88E1318S,
  536. .phy_id_mask = MARVELL_PHY_ID_MASK,
  537. .name = "Marvell 88E1318S",
  538. .features = PHY_GBIT_FEATURES,
  539. .flags = PHY_HAS_INTERRUPT,
  540. .config_aneg = &m88e1318_config_aneg,
  541. .read_status = &marvell_read_status,
  542. .ack_interrupt = &marvell_ack_interrupt,
  543. .config_intr = &marvell_config_intr,
  544. .did_interrupt = &m88e1121_did_interrupt,
  545. .driver = { .owner = THIS_MODULE },
  546. },
  547. {
  548. .phy_id = MARVELL_PHY_ID_88E1145,
  549. .phy_id_mask = MARVELL_PHY_ID_MASK,
  550. .name = "Marvell 88E1145",
  551. .features = PHY_GBIT_FEATURES,
  552. .flags = PHY_HAS_INTERRUPT,
  553. .config_init = &m88e1145_config_init,
  554. .config_aneg = &marvell_config_aneg,
  555. .read_status = &genphy_read_status,
  556. .ack_interrupt = &marvell_ack_interrupt,
  557. .config_intr = &marvell_config_intr,
  558. .driver = { .owner = THIS_MODULE },
  559. },
  560. {
  561. .phy_id = MARVELL_PHY_ID_88E1240,
  562. .phy_id_mask = MARVELL_PHY_ID_MASK,
  563. .name = "Marvell 88E1240",
  564. .features = PHY_GBIT_FEATURES,
  565. .flags = PHY_HAS_INTERRUPT,
  566. .config_init = &m88e1111_config_init,
  567. .config_aneg = &marvell_config_aneg,
  568. .read_status = &genphy_read_status,
  569. .ack_interrupt = &marvell_ack_interrupt,
  570. .config_intr = &marvell_config_intr,
  571. .driver = { .owner = THIS_MODULE },
  572. },
  573. };
  574. static int __init marvell_init(void)
  575. {
  576. int ret;
  577. int i;
  578. for (i = 0; i < ARRAY_SIZE(marvell_drivers); i++) {
  579. ret = phy_driver_register(&marvell_drivers[i]);
  580. if (ret) {
  581. while (i-- > 0)
  582. phy_driver_unregister(&marvell_drivers[i]);
  583. return ret;
  584. }
  585. }
  586. return 0;
  587. }
  588. static void __exit marvell_exit(void)
  589. {
  590. int i;
  591. for (i = 0; i < ARRAY_SIZE(marvell_drivers); i++)
  592. phy_driver_unregister(&marvell_drivers[i]);
  593. }
  594. module_init(marvell_init);
  595. module_exit(marvell_exit);
  596. static struct mdio_device_id __maybe_unused marvell_tbl[] = {
  597. { 0x01410c60, 0xfffffff0 },
  598. { 0x01410c90, 0xfffffff0 },
  599. { 0x01410cc0, 0xfffffff0 },
  600. { 0x01410e10, 0xfffffff0 },
  601. { 0x01410cb0, 0xfffffff0 },
  602. { 0x01410cd0, 0xfffffff0 },
  603. { 0x01410e30, 0xfffffff0 },
  604. { 0x01410e90, 0xfffffff0 },
  605. { }
  606. };
  607. MODULE_DEVICE_TABLE(mdio, marvell_tbl);