marvell.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881
  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 <linux/of.h>
  34. #include <asm/io.h>
  35. #include <asm/irq.h>
  36. #include <asm/uaccess.h>
  37. #define MII_MARVELL_PHY_PAGE 22
  38. #define MII_M1011_IEVENT 0x13
  39. #define MII_M1011_IEVENT_CLEAR 0x0000
  40. #define MII_M1011_IMASK 0x12
  41. #define MII_M1011_IMASK_INIT 0x6400
  42. #define MII_M1011_IMASK_CLEAR 0x0000
  43. #define MII_M1011_PHY_SCR 0x10
  44. #define MII_M1011_PHY_SCR_AUTO_CROSS 0x0060
  45. #define MII_M1145_PHY_EXT_CR 0x14
  46. #define MII_M1145_RGMII_RX_DELAY 0x0080
  47. #define MII_M1145_RGMII_TX_DELAY 0x0002
  48. #define MII_M1111_PHY_LED_CONTROL 0x18
  49. #define MII_M1111_PHY_LED_DIRECT 0x4100
  50. #define MII_M1111_PHY_LED_COMBINE 0x411c
  51. #define MII_M1111_PHY_EXT_CR 0x14
  52. #define MII_M1111_RX_DELAY 0x80
  53. #define MII_M1111_TX_DELAY 0x2
  54. #define MII_M1111_PHY_EXT_SR 0x1b
  55. #define MII_M1111_HWCFG_MODE_MASK 0xf
  56. #define MII_M1111_HWCFG_MODE_COPPER_RGMII 0xb
  57. #define MII_M1111_HWCFG_MODE_FIBER_RGMII 0x3
  58. #define MII_M1111_HWCFG_MODE_SGMII_NO_CLK 0x4
  59. #define MII_M1111_HWCFG_MODE_COPPER_RTBI 0x9
  60. #define MII_M1111_HWCFG_FIBER_COPPER_AUTO 0x8000
  61. #define MII_M1111_HWCFG_FIBER_COPPER_RES 0x2000
  62. #define MII_M1111_COPPER 0
  63. #define MII_M1111_FIBER 1
  64. #define MII_88E1121_PHY_MSCR_PAGE 2
  65. #define MII_88E1121_PHY_MSCR_REG 21
  66. #define MII_88E1121_PHY_MSCR_RX_DELAY BIT(5)
  67. #define MII_88E1121_PHY_MSCR_TX_DELAY BIT(4)
  68. #define MII_88E1121_PHY_MSCR_DELAY_MASK (~(0x3 << 4))
  69. #define MII_88E1318S_PHY_MSCR1_REG 16
  70. #define MII_88E1318S_PHY_MSCR1_PAD_ODD BIT(6)
  71. #define MII_88E1121_PHY_LED_CTRL 16
  72. #define MII_88E1121_PHY_LED_PAGE 3
  73. #define MII_88E1121_PHY_LED_DEF 0x0030
  74. #define MII_M1011_PHY_STATUS 0x11
  75. #define MII_M1011_PHY_STATUS_1000 0x8000
  76. #define MII_M1011_PHY_STATUS_100 0x4000
  77. #define MII_M1011_PHY_STATUS_SPD_MASK 0xc000
  78. #define MII_M1011_PHY_STATUS_FULLDUPLEX 0x2000
  79. #define MII_M1011_PHY_STATUS_RESOLVED 0x0800
  80. #define MII_M1011_PHY_STATUS_LINK 0x0400
  81. MODULE_DESCRIPTION("Marvell PHY driver");
  82. MODULE_AUTHOR("Andy Fleming");
  83. MODULE_LICENSE("GPL");
  84. static int marvell_ack_interrupt(struct phy_device *phydev)
  85. {
  86. int err;
  87. /* Clear the interrupts by reading the reg */
  88. err = phy_read(phydev, MII_M1011_IEVENT);
  89. if (err < 0)
  90. return err;
  91. return 0;
  92. }
  93. static int marvell_config_intr(struct phy_device *phydev)
  94. {
  95. int err;
  96. if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
  97. err = phy_write(phydev, MII_M1011_IMASK, MII_M1011_IMASK_INIT);
  98. else
  99. err = phy_write(phydev, MII_M1011_IMASK, MII_M1011_IMASK_CLEAR);
  100. return err;
  101. }
  102. static int marvell_config_aneg(struct phy_device *phydev)
  103. {
  104. int err;
  105. /* The Marvell PHY has an errata which requires
  106. * that certain registers get written in order
  107. * to restart autonegotiation */
  108. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  109. if (err < 0)
  110. return err;
  111. err = phy_write(phydev, 0x1d, 0x1f);
  112. if (err < 0)
  113. return err;
  114. err = phy_write(phydev, 0x1e, 0x200c);
  115. if (err < 0)
  116. return err;
  117. err = phy_write(phydev, 0x1d, 0x5);
  118. if (err < 0)
  119. return err;
  120. err = phy_write(phydev, 0x1e, 0);
  121. if (err < 0)
  122. return err;
  123. err = phy_write(phydev, 0x1e, 0x100);
  124. if (err < 0)
  125. return err;
  126. err = phy_write(phydev, MII_M1011_PHY_SCR,
  127. MII_M1011_PHY_SCR_AUTO_CROSS);
  128. if (err < 0)
  129. return err;
  130. err = phy_write(phydev, MII_M1111_PHY_LED_CONTROL,
  131. MII_M1111_PHY_LED_DIRECT);
  132. if (err < 0)
  133. return err;
  134. err = genphy_config_aneg(phydev);
  135. if (err < 0)
  136. return err;
  137. if (phydev->autoneg != AUTONEG_ENABLE) {
  138. int bmcr;
  139. /*
  140. * A write to speed/duplex bits (that is performed by
  141. * genphy_config_aneg() call above) must be followed by
  142. * a software reset. Otherwise, the write has no effect.
  143. */
  144. bmcr = phy_read(phydev, MII_BMCR);
  145. if (bmcr < 0)
  146. return bmcr;
  147. err = phy_write(phydev, MII_BMCR, bmcr | BMCR_RESET);
  148. if (err < 0)
  149. return err;
  150. }
  151. return 0;
  152. }
  153. #ifdef CONFIG_OF_MDIO
  154. /*
  155. * Set and/or override some configuration registers based on the
  156. * marvell,reg-init property stored in the of_node for the phydev.
  157. *
  158. * marvell,reg-init = <reg-page reg mask value>,...;
  159. *
  160. * There may be one or more sets of <reg-page reg mask value>:
  161. *
  162. * reg-page: which register bank to use.
  163. * reg: the register.
  164. * mask: if non-zero, ANDed with existing register value.
  165. * value: ORed with the masked value and written to the regiser.
  166. *
  167. */
  168. static int marvell_of_reg_init(struct phy_device *phydev)
  169. {
  170. const __be32 *paddr;
  171. int len, i, saved_page, current_page, page_changed, ret;
  172. if (!phydev->dev.of_node)
  173. return 0;
  174. paddr = of_get_property(phydev->dev.of_node, "marvell,reg-init", &len);
  175. if (!paddr || len < (4 * sizeof(*paddr)))
  176. return 0;
  177. saved_page = phy_read(phydev, MII_MARVELL_PHY_PAGE);
  178. if (saved_page < 0)
  179. return saved_page;
  180. page_changed = 0;
  181. current_page = saved_page;
  182. ret = 0;
  183. len /= sizeof(*paddr);
  184. for (i = 0; i < len - 3; i += 4) {
  185. u16 reg_page = be32_to_cpup(paddr + i);
  186. u16 reg = be32_to_cpup(paddr + i + 1);
  187. u16 mask = be32_to_cpup(paddr + i + 2);
  188. u16 val_bits = be32_to_cpup(paddr + i + 3);
  189. int val;
  190. if (reg_page != current_page) {
  191. current_page = reg_page;
  192. page_changed = 1;
  193. ret = phy_write(phydev, MII_MARVELL_PHY_PAGE, reg_page);
  194. if (ret < 0)
  195. goto err;
  196. }
  197. val = 0;
  198. if (mask) {
  199. val = phy_read(phydev, reg);
  200. if (val < 0) {
  201. ret = val;
  202. goto err;
  203. }
  204. val &= mask;
  205. }
  206. val |= val_bits;
  207. ret = phy_write(phydev, reg, val);
  208. if (ret < 0)
  209. goto err;
  210. }
  211. err:
  212. if (page_changed) {
  213. i = phy_write(phydev, MII_MARVELL_PHY_PAGE, saved_page);
  214. if (ret == 0)
  215. ret = i;
  216. }
  217. return ret;
  218. }
  219. #else
  220. static int marvell_of_reg_init(struct phy_device *phydev)
  221. {
  222. return 0;
  223. }
  224. #endif /* CONFIG_OF_MDIO */
  225. static int m88e1121_config_aneg(struct phy_device *phydev)
  226. {
  227. int err, oldpage, mscr;
  228. oldpage = phy_read(phydev, MII_MARVELL_PHY_PAGE);
  229. err = phy_write(phydev, MII_MARVELL_PHY_PAGE,
  230. MII_88E1121_PHY_MSCR_PAGE);
  231. if (err < 0)
  232. return err;
  233. if ((phydev->interface == PHY_INTERFACE_MODE_RGMII) ||
  234. (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) ||
  235. (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) ||
  236. (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)) {
  237. mscr = phy_read(phydev, MII_88E1121_PHY_MSCR_REG) &
  238. MII_88E1121_PHY_MSCR_DELAY_MASK;
  239. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
  240. mscr |= (MII_88E1121_PHY_MSCR_RX_DELAY |
  241. MII_88E1121_PHY_MSCR_TX_DELAY);
  242. else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID)
  243. mscr |= MII_88E1121_PHY_MSCR_RX_DELAY;
  244. else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)
  245. mscr |= MII_88E1121_PHY_MSCR_TX_DELAY;
  246. err = phy_write(phydev, MII_88E1121_PHY_MSCR_REG, mscr);
  247. if (err < 0)
  248. return err;
  249. }
  250. phy_write(phydev, MII_MARVELL_PHY_PAGE, oldpage);
  251. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  252. if (err < 0)
  253. return err;
  254. err = phy_write(phydev, MII_M1011_PHY_SCR,
  255. MII_M1011_PHY_SCR_AUTO_CROSS);
  256. if (err < 0)
  257. return err;
  258. oldpage = phy_read(phydev, MII_MARVELL_PHY_PAGE);
  259. phy_write(phydev, MII_MARVELL_PHY_PAGE, MII_88E1121_PHY_LED_PAGE);
  260. phy_write(phydev, MII_88E1121_PHY_LED_CTRL, MII_88E1121_PHY_LED_DEF);
  261. phy_write(phydev, MII_MARVELL_PHY_PAGE, oldpage);
  262. err = genphy_config_aneg(phydev);
  263. return err;
  264. }
  265. static int m88e1318_config_aneg(struct phy_device *phydev)
  266. {
  267. int err, oldpage, mscr;
  268. oldpage = phy_read(phydev, MII_MARVELL_PHY_PAGE);
  269. err = phy_write(phydev, MII_MARVELL_PHY_PAGE,
  270. MII_88E1121_PHY_MSCR_PAGE);
  271. if (err < 0)
  272. return err;
  273. mscr = phy_read(phydev, MII_88E1318S_PHY_MSCR1_REG);
  274. mscr |= MII_88E1318S_PHY_MSCR1_PAD_ODD;
  275. err = phy_write(phydev, MII_88E1318S_PHY_MSCR1_REG, mscr);
  276. if (err < 0)
  277. return err;
  278. err = phy_write(phydev, MII_MARVELL_PHY_PAGE, oldpage);
  279. if (err < 0)
  280. return err;
  281. return m88e1121_config_aneg(phydev);
  282. }
  283. static int m88e1111_config_init(struct phy_device *phydev)
  284. {
  285. int err;
  286. int temp;
  287. /* Enable Fiber/Copper auto selection */
  288. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  289. temp &= ~MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  290. phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  291. temp = phy_read(phydev, MII_BMCR);
  292. temp |= BMCR_RESET;
  293. phy_write(phydev, MII_BMCR, temp);
  294. if ((phydev->interface == PHY_INTERFACE_MODE_RGMII) ||
  295. (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) ||
  296. (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) ||
  297. (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)) {
  298. temp = phy_read(phydev, MII_M1111_PHY_EXT_CR);
  299. if (temp < 0)
  300. return temp;
  301. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) {
  302. temp |= (MII_M1111_RX_DELAY | MII_M1111_TX_DELAY);
  303. } else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
  304. temp &= ~MII_M1111_TX_DELAY;
  305. temp |= MII_M1111_RX_DELAY;
  306. } else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
  307. temp &= ~MII_M1111_RX_DELAY;
  308. temp |= MII_M1111_TX_DELAY;
  309. }
  310. err = phy_write(phydev, MII_M1111_PHY_EXT_CR, temp);
  311. if (err < 0)
  312. return err;
  313. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  314. if (temp < 0)
  315. return temp;
  316. temp &= ~(MII_M1111_HWCFG_MODE_MASK);
  317. if (temp & MII_M1111_HWCFG_FIBER_COPPER_RES)
  318. temp |= MII_M1111_HWCFG_MODE_FIBER_RGMII;
  319. else
  320. temp |= MII_M1111_HWCFG_MODE_COPPER_RGMII;
  321. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  322. if (err < 0)
  323. return err;
  324. }
  325. if (phydev->interface == PHY_INTERFACE_MODE_SGMII) {
  326. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  327. if (temp < 0)
  328. return temp;
  329. temp &= ~(MII_M1111_HWCFG_MODE_MASK);
  330. temp |= MII_M1111_HWCFG_MODE_SGMII_NO_CLK;
  331. temp |= MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  332. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  333. if (err < 0)
  334. return err;
  335. }
  336. if (phydev->interface == PHY_INTERFACE_MODE_RTBI) {
  337. temp = phy_read(phydev, MII_M1111_PHY_EXT_CR);
  338. if (temp < 0)
  339. return temp;
  340. temp |= (MII_M1111_RX_DELAY | MII_M1111_TX_DELAY);
  341. err = phy_write(phydev, MII_M1111_PHY_EXT_CR, temp);
  342. if (err < 0)
  343. return err;
  344. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  345. if (temp < 0)
  346. return temp;
  347. temp &= ~(MII_M1111_HWCFG_MODE_MASK | MII_M1111_HWCFG_FIBER_COPPER_RES);
  348. temp |= 0x7 | MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  349. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  350. if (err < 0)
  351. return err;
  352. /* soft reset */
  353. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  354. if (err < 0)
  355. return err;
  356. do
  357. temp = phy_read(phydev, MII_BMCR);
  358. while (temp & BMCR_RESET);
  359. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  360. if (temp < 0)
  361. return temp;
  362. temp &= ~(MII_M1111_HWCFG_MODE_MASK | MII_M1111_HWCFG_FIBER_COPPER_RES);
  363. temp |= MII_M1111_HWCFG_MODE_COPPER_RTBI | MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  364. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  365. if (err < 0)
  366. return err;
  367. }
  368. err = marvell_of_reg_init(phydev);
  369. if (err < 0)
  370. return err;
  371. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  372. if (err < 0)
  373. return err;
  374. return 0;
  375. }
  376. static int m88e1118_config_aneg(struct phy_device *phydev)
  377. {
  378. int err;
  379. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  380. if (err < 0)
  381. return err;
  382. err = phy_write(phydev, MII_M1011_PHY_SCR,
  383. MII_M1011_PHY_SCR_AUTO_CROSS);
  384. if (err < 0)
  385. return err;
  386. err = genphy_config_aneg(phydev);
  387. return 0;
  388. }
  389. static int m88e1118_config_init(struct phy_device *phydev)
  390. {
  391. int err;
  392. /* Change address */
  393. err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0002);
  394. if (err < 0)
  395. return err;
  396. /* Enable 1000 Mbit */
  397. err = phy_write(phydev, 0x15, 0x1070);
  398. if (err < 0)
  399. return err;
  400. /* Change address */
  401. err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0003);
  402. if (err < 0)
  403. return err;
  404. /* Adjust LED Control */
  405. if (phydev->dev_flags & MARVELL_PHY_M1118_DNS323_LEDS)
  406. err = phy_write(phydev, 0x10, 0x1100);
  407. else
  408. err = phy_write(phydev, 0x10, 0x021e);
  409. if (err < 0)
  410. return err;
  411. err = marvell_of_reg_init(phydev);
  412. if (err < 0)
  413. return err;
  414. /* Reset address */
  415. err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0);
  416. if (err < 0)
  417. return err;
  418. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  419. if (err < 0)
  420. return err;
  421. return 0;
  422. }
  423. static int m88e1149_config_init(struct phy_device *phydev)
  424. {
  425. int err;
  426. /* Change address */
  427. err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0002);
  428. if (err < 0)
  429. return err;
  430. /* Enable 1000 Mbit */
  431. err = phy_write(phydev, 0x15, 0x1048);
  432. if (err < 0)
  433. return err;
  434. err = marvell_of_reg_init(phydev);
  435. if (err < 0)
  436. return err;
  437. /* Reset address */
  438. err = phy_write(phydev, MII_MARVELL_PHY_PAGE, 0x0);
  439. if (err < 0)
  440. return err;
  441. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  442. if (err < 0)
  443. return err;
  444. return 0;
  445. }
  446. static int m88e1145_config_init(struct phy_device *phydev)
  447. {
  448. int err;
  449. /* Take care of errata E0 & E1 */
  450. err = phy_write(phydev, 0x1d, 0x001b);
  451. if (err < 0)
  452. return err;
  453. err = phy_write(phydev, 0x1e, 0x418f);
  454. if (err < 0)
  455. return err;
  456. err = phy_write(phydev, 0x1d, 0x0016);
  457. if (err < 0)
  458. return err;
  459. err = phy_write(phydev, 0x1e, 0xa2da);
  460. if (err < 0)
  461. return err;
  462. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) {
  463. int temp = phy_read(phydev, MII_M1145_PHY_EXT_CR);
  464. if (temp < 0)
  465. return temp;
  466. temp |= (MII_M1145_RGMII_RX_DELAY | MII_M1145_RGMII_TX_DELAY);
  467. err = phy_write(phydev, MII_M1145_PHY_EXT_CR, temp);
  468. if (err < 0)
  469. return err;
  470. if (phydev->dev_flags & MARVELL_PHY_M1145_FLAGS_RESISTANCE) {
  471. err = phy_write(phydev, 0x1d, 0x0012);
  472. if (err < 0)
  473. return err;
  474. temp = phy_read(phydev, 0x1e);
  475. if (temp < 0)
  476. return temp;
  477. temp &= 0xf03f;
  478. temp |= 2 << 9; /* 36 ohm */
  479. temp |= 2 << 6; /* 39 ohm */
  480. err = phy_write(phydev, 0x1e, temp);
  481. if (err < 0)
  482. return err;
  483. err = phy_write(phydev, 0x1d, 0x3);
  484. if (err < 0)
  485. return err;
  486. err = phy_write(phydev, 0x1e, 0x8000);
  487. if (err < 0)
  488. return err;
  489. }
  490. }
  491. err = marvell_of_reg_init(phydev);
  492. if (err < 0)
  493. return err;
  494. return 0;
  495. }
  496. /* marvell_read_status
  497. *
  498. * Generic status code does not detect Fiber correctly!
  499. * Description:
  500. * Check the link, then figure out the current state
  501. * by comparing what we advertise with what the link partner
  502. * advertises. Start by checking the gigabit possibilities,
  503. * then move on to 10/100.
  504. */
  505. static int marvell_read_status(struct phy_device *phydev)
  506. {
  507. int adv;
  508. int err;
  509. int lpa;
  510. int status = 0;
  511. /* Update the link, but return if there
  512. * was an error */
  513. err = genphy_update_link(phydev);
  514. if (err)
  515. return err;
  516. if (AUTONEG_ENABLE == phydev->autoneg) {
  517. status = phy_read(phydev, MII_M1011_PHY_STATUS);
  518. if (status < 0)
  519. return status;
  520. lpa = phy_read(phydev, MII_LPA);
  521. if (lpa < 0)
  522. return lpa;
  523. adv = phy_read(phydev, MII_ADVERTISE);
  524. if (adv < 0)
  525. return adv;
  526. lpa &= adv;
  527. if (status & MII_M1011_PHY_STATUS_FULLDUPLEX)
  528. phydev->duplex = DUPLEX_FULL;
  529. else
  530. phydev->duplex = DUPLEX_HALF;
  531. status = status & MII_M1011_PHY_STATUS_SPD_MASK;
  532. phydev->pause = phydev->asym_pause = 0;
  533. switch (status) {
  534. case MII_M1011_PHY_STATUS_1000:
  535. phydev->speed = SPEED_1000;
  536. break;
  537. case MII_M1011_PHY_STATUS_100:
  538. phydev->speed = SPEED_100;
  539. break;
  540. default:
  541. phydev->speed = SPEED_10;
  542. break;
  543. }
  544. if (phydev->duplex == DUPLEX_FULL) {
  545. phydev->pause = lpa & LPA_PAUSE_CAP ? 1 : 0;
  546. phydev->asym_pause = lpa & LPA_PAUSE_ASYM ? 1 : 0;
  547. }
  548. } else {
  549. int bmcr = phy_read(phydev, MII_BMCR);
  550. if (bmcr < 0)
  551. return bmcr;
  552. if (bmcr & BMCR_FULLDPLX)
  553. phydev->duplex = DUPLEX_FULL;
  554. else
  555. phydev->duplex = DUPLEX_HALF;
  556. if (bmcr & BMCR_SPEED1000)
  557. phydev->speed = SPEED_1000;
  558. else if (bmcr & BMCR_SPEED100)
  559. phydev->speed = SPEED_100;
  560. else
  561. phydev->speed = SPEED_10;
  562. phydev->pause = phydev->asym_pause = 0;
  563. }
  564. return 0;
  565. }
  566. static int m88e1121_did_interrupt(struct phy_device *phydev)
  567. {
  568. int imask;
  569. imask = phy_read(phydev, MII_M1011_IEVENT);
  570. if (imask & MII_M1011_IMASK_INIT)
  571. return 1;
  572. return 0;
  573. }
  574. static struct phy_driver marvell_drivers[] = {
  575. {
  576. .phy_id = MARVELL_PHY_ID_88E1101,
  577. .phy_id_mask = MARVELL_PHY_ID_MASK,
  578. .name = "Marvell 88E1101",
  579. .features = PHY_GBIT_FEATURES,
  580. .flags = PHY_HAS_INTERRUPT,
  581. .config_aneg = &marvell_config_aneg,
  582. .read_status = &genphy_read_status,
  583. .ack_interrupt = &marvell_ack_interrupt,
  584. .config_intr = &marvell_config_intr,
  585. .driver = { .owner = THIS_MODULE },
  586. },
  587. {
  588. .phy_id = MARVELL_PHY_ID_88E1112,
  589. .phy_id_mask = MARVELL_PHY_ID_MASK,
  590. .name = "Marvell 88E1112",
  591. .features = PHY_GBIT_FEATURES,
  592. .flags = PHY_HAS_INTERRUPT,
  593. .config_init = &m88e1111_config_init,
  594. .config_aneg = &marvell_config_aneg,
  595. .read_status = &genphy_read_status,
  596. .ack_interrupt = &marvell_ack_interrupt,
  597. .config_intr = &marvell_config_intr,
  598. .driver = { .owner = THIS_MODULE },
  599. },
  600. {
  601. .phy_id = MARVELL_PHY_ID_88E1111,
  602. .phy_id_mask = MARVELL_PHY_ID_MASK,
  603. .name = "Marvell 88E1111",
  604. .features = PHY_GBIT_FEATURES,
  605. .flags = PHY_HAS_INTERRUPT,
  606. .config_init = &m88e1111_config_init,
  607. .config_aneg = &marvell_config_aneg,
  608. .read_status = &marvell_read_status,
  609. .ack_interrupt = &marvell_ack_interrupt,
  610. .config_intr = &marvell_config_intr,
  611. .driver = { .owner = THIS_MODULE },
  612. },
  613. {
  614. .phy_id = MARVELL_PHY_ID_88E1118,
  615. .phy_id_mask = MARVELL_PHY_ID_MASK,
  616. .name = "Marvell 88E1118",
  617. .features = PHY_GBIT_FEATURES,
  618. .flags = PHY_HAS_INTERRUPT,
  619. .config_init = &m88e1118_config_init,
  620. .config_aneg = &m88e1118_config_aneg,
  621. .read_status = &genphy_read_status,
  622. .ack_interrupt = &marvell_ack_interrupt,
  623. .config_intr = &marvell_config_intr,
  624. .driver = {.owner = THIS_MODULE,},
  625. },
  626. {
  627. .phy_id = MARVELL_PHY_ID_88E1121R,
  628. .phy_id_mask = MARVELL_PHY_ID_MASK,
  629. .name = "Marvell 88E1121R",
  630. .features = PHY_GBIT_FEATURES,
  631. .flags = PHY_HAS_INTERRUPT,
  632. .config_aneg = &m88e1121_config_aneg,
  633. .read_status = &marvell_read_status,
  634. .ack_interrupt = &marvell_ack_interrupt,
  635. .config_intr = &marvell_config_intr,
  636. .did_interrupt = &m88e1121_did_interrupt,
  637. .driver = { .owner = THIS_MODULE },
  638. },
  639. {
  640. .phy_id = MARVELL_PHY_ID_88E1318S,
  641. .phy_id_mask = MARVELL_PHY_ID_MASK,
  642. .name = "Marvell 88E1318S",
  643. .features = PHY_GBIT_FEATURES,
  644. .flags = PHY_HAS_INTERRUPT,
  645. .config_aneg = &m88e1318_config_aneg,
  646. .read_status = &marvell_read_status,
  647. .ack_interrupt = &marvell_ack_interrupt,
  648. .config_intr = &marvell_config_intr,
  649. .did_interrupt = &m88e1121_did_interrupt,
  650. .driver = { .owner = THIS_MODULE },
  651. },
  652. {
  653. .phy_id = MARVELL_PHY_ID_88E1145,
  654. .phy_id_mask = MARVELL_PHY_ID_MASK,
  655. .name = "Marvell 88E1145",
  656. .features = PHY_GBIT_FEATURES,
  657. .flags = PHY_HAS_INTERRUPT,
  658. .config_init = &m88e1145_config_init,
  659. .config_aneg = &marvell_config_aneg,
  660. .read_status = &genphy_read_status,
  661. .ack_interrupt = &marvell_ack_interrupt,
  662. .config_intr = &marvell_config_intr,
  663. .driver = { .owner = THIS_MODULE },
  664. },
  665. {
  666. .phy_id = MARVELL_PHY_ID_88E1149R,
  667. .phy_id_mask = MARVELL_PHY_ID_MASK,
  668. .name = "Marvell 88E1149R",
  669. .features = PHY_GBIT_FEATURES,
  670. .flags = PHY_HAS_INTERRUPT,
  671. .config_init = &m88e1149_config_init,
  672. .config_aneg = &m88e1118_config_aneg,
  673. .read_status = &genphy_read_status,
  674. .ack_interrupt = &marvell_ack_interrupt,
  675. .config_intr = &marvell_config_intr,
  676. .driver = { .owner = THIS_MODULE },
  677. },
  678. {
  679. .phy_id = MARVELL_PHY_ID_88E1240,
  680. .phy_id_mask = MARVELL_PHY_ID_MASK,
  681. .name = "Marvell 88E1240",
  682. .features = PHY_GBIT_FEATURES,
  683. .flags = PHY_HAS_INTERRUPT,
  684. .config_init = &m88e1111_config_init,
  685. .config_aneg = &marvell_config_aneg,
  686. .read_status = &genphy_read_status,
  687. .ack_interrupt = &marvell_ack_interrupt,
  688. .config_intr = &marvell_config_intr,
  689. .driver = { .owner = THIS_MODULE },
  690. },
  691. };
  692. static int __init marvell_init(void)
  693. {
  694. int ret;
  695. int i;
  696. for (i = 0; i < ARRAY_SIZE(marvell_drivers); i++) {
  697. ret = phy_driver_register(&marvell_drivers[i]);
  698. if (ret) {
  699. while (i-- > 0)
  700. phy_driver_unregister(&marvell_drivers[i]);
  701. return ret;
  702. }
  703. }
  704. return 0;
  705. }
  706. static void __exit marvell_exit(void)
  707. {
  708. int i;
  709. for (i = 0; i < ARRAY_SIZE(marvell_drivers); i++)
  710. phy_driver_unregister(&marvell_drivers[i]);
  711. }
  712. module_init(marvell_init);
  713. module_exit(marvell_exit);
  714. static struct mdio_device_id __maybe_unused marvell_tbl[] = {
  715. { 0x01410c60, 0xfffffff0 },
  716. { 0x01410c90, 0xfffffff0 },
  717. { 0x01410cc0, 0xfffffff0 },
  718. { 0x01410e10, 0xfffffff0 },
  719. { 0x01410cb0, 0xfffffff0 },
  720. { 0x01410cd0, 0xfffffff0 },
  721. { 0x01410e50, 0xfffffff0 },
  722. { 0x01410e30, 0xfffffff0 },
  723. { 0x01410e90, 0xfffffff0 },
  724. { }
  725. };
  726. MODULE_DEVICE_TABLE(mdio, marvell_tbl);