marvell.c 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476
  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/slab.h>
  21. #include <linux/interrupt.h>
  22. #include <linux/init.h>
  23. #include <linux/delay.h>
  24. #include <linux/netdevice.h>
  25. #include <linux/etherdevice.h>
  26. #include <linux/skbuff.h>
  27. #include <linux/spinlock.h>
  28. #include <linux/mm.h>
  29. #include <linux/module.h>
  30. #include <linux/mii.h>
  31. #include <linux/ethtool.h>
  32. #include <linux/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 M1145_DEV_FLAGS_RESISTANCE 0x00000001
  47. #define MII_M1111_PHY_LED_CONTROL 0x18
  48. #define MII_M1111_PHY_LED_DIRECT 0x4100
  49. #define MII_M1111_PHY_LED_COMBINE 0x411c
  50. #define MII_M1111_PHY_EXT_CR 0x14
  51. #define MII_M1111_RX_DELAY 0x80
  52. #define MII_M1111_TX_DELAY 0x2
  53. #define MII_M1111_PHY_EXT_SR 0x1b
  54. #define MII_M1111_HWCFG_MODE_MASK 0xf
  55. #define MII_M1111_HWCFG_MODE_COPPER_RGMII 0xb
  56. #define MII_M1111_HWCFG_MODE_FIBER_RGMII 0x3
  57. #define MII_M1111_HWCFG_MODE_SGMII_NO_CLK 0x4
  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_M1011_PHY_STATUS 0x11
  63. #define MII_M1011_PHY_STATUS_1000 0x8000
  64. #define MII_M1011_PHY_STATUS_100 0x4000
  65. #define MII_M1011_PHY_STATUS_SPD_MASK 0xc000
  66. #define MII_M1011_PHY_STATUS_FULLDUPLEX 0x2000
  67. #define MII_M1011_PHY_STATUS_RESOLVED 0x0800
  68. #define MII_M1011_PHY_STATUS_LINK 0x0400
  69. MODULE_DESCRIPTION("Marvell PHY driver");
  70. MODULE_AUTHOR("Andy Fleming");
  71. MODULE_LICENSE("GPL");
  72. static int marvell_ack_interrupt(struct phy_device *phydev)
  73. {
  74. int err;
  75. /* Clear the interrupts by reading the reg */
  76. err = phy_read(phydev, MII_M1011_IEVENT);
  77. if (err < 0)
  78. return err;
  79. return 0;
  80. }
  81. static int marvell_config_intr(struct phy_device *phydev)
  82. {
  83. int err;
  84. if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
  85. err = phy_write(phydev, MII_M1011_IMASK, MII_M1011_IMASK_INIT);
  86. else
  87. err = phy_write(phydev, MII_M1011_IMASK, MII_M1011_IMASK_CLEAR);
  88. return err;
  89. }
  90. static int marvell_config_aneg(struct phy_device *phydev)
  91. {
  92. int err;
  93. /* The Marvell PHY has an errata which requires
  94. * that certain registers get written in order
  95. * to restart autonegotiation */
  96. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  97. if (err < 0)
  98. return err;
  99. err = phy_write(phydev, 0x1d, 0x1f);
  100. if (err < 0)
  101. return err;
  102. err = phy_write(phydev, 0x1e, 0x200c);
  103. if (err < 0)
  104. return err;
  105. err = phy_write(phydev, 0x1d, 0x5);
  106. if (err < 0)
  107. return err;
  108. err = phy_write(phydev, 0x1e, 0);
  109. if (err < 0)
  110. return err;
  111. err = phy_write(phydev, 0x1e, 0x100);
  112. if (err < 0)
  113. return err;
  114. err = phy_write(phydev, MII_M1011_PHY_SCR,
  115. MII_M1011_PHY_SCR_AUTO_CROSS);
  116. if (err < 0)
  117. return err;
  118. err = phy_write(phydev, MII_M1111_PHY_LED_CONTROL,
  119. MII_M1111_PHY_LED_DIRECT);
  120. if (err < 0)
  121. return err;
  122. err = genphy_config_aneg(phydev);
  123. return err;
  124. }
  125. static int m88e1111_config_init(struct phy_device *phydev)
  126. {
  127. int err;
  128. int temp;
  129. int mode;
  130. /* Enable Fiber/Copper auto selection */
  131. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  132. temp |= MII_M1111_HWCFG_FIBER_COPPER_AUTO;
  133. phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  134. temp = phy_read(phydev, MII_BMCR);
  135. temp |= BMCR_RESET;
  136. phy_write(phydev, MII_BMCR, temp);
  137. if ((phydev->interface == PHY_INTERFACE_MODE_RGMII) ||
  138. (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) ||
  139. (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) ||
  140. (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)) {
  141. temp = phy_read(phydev, MII_M1111_PHY_EXT_CR);
  142. if (temp < 0)
  143. return temp;
  144. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) {
  145. temp |= (MII_M1111_RX_DELAY | MII_M1111_TX_DELAY);
  146. } else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) {
  147. temp &= ~MII_M1111_TX_DELAY;
  148. temp |= MII_M1111_RX_DELAY;
  149. } else if (phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
  150. temp &= ~MII_M1111_RX_DELAY;
  151. temp |= MII_M1111_TX_DELAY;
  152. }
  153. err = phy_write(phydev, MII_M1111_PHY_EXT_CR, temp);
  154. if (err < 0)
  155. return err;
  156. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  157. if (temp < 0)
  158. return temp;
  159. temp &= ~(MII_M1111_HWCFG_MODE_MASK);
  160. mode = phy_read(phydev, MII_M1111_PHY_EXT_CR);
  161. if (mode & MII_M1111_HWCFG_FIBER_COPPER_RES)
  162. temp |= MII_M1111_HWCFG_MODE_FIBER_RGMII;
  163. else
  164. temp |= MII_M1111_HWCFG_MODE_COPPER_RGMII;
  165. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  166. if (err < 0)
  167. return err;
  168. }
  169. if (phydev->interface == PHY_INTERFACE_MODE_SGMII) {
  170. temp = phy_read(phydev, MII_M1111_PHY_EXT_SR);
  171. if (temp < 0)
  172. return temp;
  173. temp &= ~(MII_M1111_HWCFG_MODE_MASK);
  174. temp |= MII_M1111_HWCFG_MODE_SGMII_NO_CLK;
  175. err = phy_write(phydev, MII_M1111_PHY_EXT_SR, temp);
  176. if (err < 0)
  177. return err;
  178. }
  179. err = phy_write(phydev, MII_BMCR, BMCR_RESET);
  180. if (err < 0)
  181. return err;
  182. return 0;
  183. }
  184. static int m88e1145_config_init(struct phy_device *phydev)
  185. {
  186. int err;
  187. /* Take care of errata E0 & E1 */
  188. err = phy_write(phydev, 0x1d, 0x001b);
  189. if (err < 0)
  190. return err;
  191. err = phy_write(phydev, 0x1e, 0x418f);
  192. if (err < 0)
  193. return err;
  194. err = phy_write(phydev, 0x1d, 0x0016);
  195. if (err < 0)
  196. return err;
  197. err = phy_write(phydev, 0x1e, 0xa2da);
  198. if (err < 0)
  199. return err;
  200. if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) {
  201. int temp = phy_read(phydev, MII_M1145_PHY_EXT_CR);
  202. if (temp < 0)
  203. return temp;
  204. temp |= (MII_M1145_RGMII_RX_DELAY | MII_M1145_RGMII_TX_DELAY);
  205. err = phy_write(phydev, MII_M1145_PHY_EXT_CR, temp);
  206. if (err < 0)
  207. return err;
  208. if (phydev->dev_flags & M1145_DEV_FLAGS_RESISTANCE) {
  209. err = phy_write(phydev, 0x1d, 0x0012);
  210. if (err < 0)
  211. return err;
  212. temp = phy_read(phydev, 0x1e);
  213. if (temp < 0)
  214. return temp;
  215. temp &= 0xf03f;
  216. temp |= 2 << 9; /* 36 ohm */
  217. temp |= 2 << 6; /* 39 ohm */
  218. err = phy_write(phydev, 0x1e, temp);
  219. if (err < 0)
  220. return err;
  221. err = phy_write(phydev, 0x1d, 0x3);
  222. if (err < 0)
  223. return err;
  224. err = phy_write(phydev, 0x1e, 0x8000);
  225. if (err < 0)
  226. return err;
  227. }
  228. }
  229. return 0;
  230. }
  231. /* marvell_read_status
  232. *
  233. * Generic status code does not detect Fiber correctly!
  234. * Description:
  235. * Check the link, then figure out the current state
  236. * by comparing what we advertise with what the link partner
  237. * advertises. Start by checking the gigabit possibilities,
  238. * then move on to 10/100.
  239. */
  240. static int marvell_read_status(struct phy_device *phydev)
  241. {
  242. int adv;
  243. int err;
  244. int lpa;
  245. int status = 0;
  246. /* Update the link, but return if there
  247. * was an error */
  248. err = genphy_update_link(phydev);
  249. if (err)
  250. return err;
  251. if (AUTONEG_ENABLE == phydev->autoneg) {
  252. status = phy_read(phydev, MII_M1011_PHY_STATUS);
  253. if (status < 0)
  254. return status;
  255. lpa = phy_read(phydev, MII_LPA);
  256. if (lpa < 0)
  257. return lpa;
  258. adv = phy_read(phydev, MII_ADVERTISE);
  259. if (adv < 0)
  260. return adv;
  261. lpa &= adv;
  262. if (status & MII_M1011_PHY_STATUS_FULLDUPLEX)
  263. phydev->duplex = DUPLEX_FULL;
  264. else
  265. phydev->duplex = DUPLEX_HALF;
  266. status = status & MII_M1011_PHY_STATUS_SPD_MASK;
  267. phydev->pause = phydev->asym_pause = 0;
  268. switch (status) {
  269. case MII_M1011_PHY_STATUS_1000:
  270. phydev->speed = SPEED_1000;
  271. break;
  272. case MII_M1011_PHY_STATUS_100:
  273. phydev->speed = SPEED_100;
  274. break;
  275. default:
  276. phydev->speed = SPEED_10;
  277. break;
  278. }
  279. if (phydev->duplex == DUPLEX_FULL) {
  280. phydev->pause = lpa & LPA_PAUSE_CAP ? 1 : 0;
  281. phydev->asym_pause = lpa & LPA_PAUSE_ASYM ? 1 : 0;
  282. }
  283. } else {
  284. int bmcr = phy_read(phydev, MII_BMCR);
  285. if (bmcr < 0)
  286. return bmcr;
  287. if (bmcr & BMCR_FULLDPLX)
  288. phydev->duplex = DUPLEX_FULL;
  289. else
  290. phydev->duplex = DUPLEX_HALF;
  291. if (bmcr & BMCR_SPEED1000)
  292. phydev->speed = SPEED_1000;
  293. else if (bmcr & BMCR_SPEED100)
  294. phydev->speed = SPEED_100;
  295. else
  296. phydev->speed = SPEED_10;
  297. phydev->pause = phydev->asym_pause = 0;
  298. }
  299. return 0;
  300. }
  301. static struct phy_driver marvell_drivers[] = {
  302. {
  303. .phy_id = 0x01410c60,
  304. .phy_id_mask = 0xfffffff0,
  305. .name = "Marvell 88E1101",
  306. .features = PHY_GBIT_FEATURES,
  307. .flags = PHY_HAS_INTERRUPT,
  308. .config_aneg = &marvell_config_aneg,
  309. .read_status = &genphy_read_status,
  310. .ack_interrupt = &marvell_ack_interrupt,
  311. .config_intr = &marvell_config_intr,
  312. .driver = { .owner = THIS_MODULE },
  313. },
  314. {
  315. .phy_id = 0x01410c90,
  316. .phy_id_mask = 0xfffffff0,
  317. .name = "Marvell 88E1112",
  318. .features = PHY_GBIT_FEATURES,
  319. .flags = PHY_HAS_INTERRUPT,
  320. .config_init = &m88e1111_config_init,
  321. .config_aneg = &marvell_config_aneg,
  322. .read_status = &genphy_read_status,
  323. .ack_interrupt = &marvell_ack_interrupt,
  324. .config_intr = &marvell_config_intr,
  325. .driver = { .owner = THIS_MODULE },
  326. },
  327. {
  328. .phy_id = 0x01410cc0,
  329. .phy_id_mask = 0xfffffff0,
  330. .name = "Marvell 88E1111",
  331. .features = PHY_GBIT_FEATURES,
  332. .flags = PHY_HAS_INTERRUPT,
  333. .config_init = &m88e1111_config_init,
  334. .config_aneg = &marvell_config_aneg,
  335. .read_status = &marvell_read_status,
  336. .ack_interrupt = &marvell_ack_interrupt,
  337. .config_intr = &marvell_config_intr,
  338. .driver = { .owner = THIS_MODULE },
  339. },
  340. {
  341. .phy_id = 0x01410cd0,
  342. .phy_id_mask = 0xfffffff0,
  343. .name = "Marvell 88E1145",
  344. .features = PHY_GBIT_FEATURES,
  345. .flags = PHY_HAS_INTERRUPT,
  346. .config_init = &m88e1145_config_init,
  347. .config_aneg = &marvell_config_aneg,
  348. .read_status = &genphy_read_status,
  349. .ack_interrupt = &marvell_ack_interrupt,
  350. .config_intr = &marvell_config_intr,
  351. .driver = { .owner = THIS_MODULE },
  352. },
  353. {
  354. .phy_id = 0x01410e30,
  355. .phy_id_mask = 0xfffffff0,
  356. .name = "Marvell 88E1240",
  357. .features = PHY_GBIT_FEATURES,
  358. .flags = PHY_HAS_INTERRUPT,
  359. .config_init = &m88e1111_config_init,
  360. .config_aneg = &marvell_config_aneg,
  361. .read_status = &genphy_read_status,
  362. .ack_interrupt = &marvell_ack_interrupt,
  363. .config_intr = &marvell_config_intr,
  364. .driver = { .owner = THIS_MODULE },
  365. },
  366. };
  367. static int __init marvell_init(void)
  368. {
  369. int ret;
  370. int i;
  371. for (i = 0; i < ARRAY_SIZE(marvell_drivers); i++) {
  372. ret = phy_driver_register(&marvell_drivers[i]);
  373. if (ret) {
  374. while (i-- > 0)
  375. phy_driver_unregister(&marvell_drivers[i]);
  376. return ret;
  377. }
  378. }
  379. return 0;
  380. }
  381. static void __exit marvell_exit(void)
  382. {
  383. int i;
  384. for (i = 0; i < ARRAY_SIZE(marvell_drivers); i++)
  385. phy_driver_unregister(&marvell_drivers[i]);
  386. }
  387. module_init(marvell_init);
  388. module_exit(marvell_exit);