micrel.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979
  1. /*
  2. * drivers/net/phy/micrel.c
  3. *
  4. * Driver for Micrel PHYs
  5. *
  6. * Author: David J. Choi
  7. *
  8. * Copyright (c) 2010-2013 Micrel, Inc.
  9. * Copyright (c) 2014 Johan Hovold <johan@kernel.org>
  10. *
  11. * This program is free software; you can redistribute it and/or modify it
  12. * under the terms of the GNU General Public License as published by the
  13. * Free Software Foundation; either version 2 of the License, or (at your
  14. * option) any later version.
  15. *
  16. * Support : Micrel Phys:
  17. * Giga phys: ksz9021, ksz9031
  18. * 100/10 Phys : ksz8001, ksz8721, ksz8737, ksz8041
  19. * ksz8021, ksz8031, ksz8051,
  20. * ksz8081, ksz8091,
  21. * ksz8061,
  22. * Switch : ksz8873, ksz886x
  23. */
  24. #include <linux/kernel.h>
  25. #include <linux/module.h>
  26. #include <linux/phy.h>
  27. #include <linux/micrel_phy.h>
  28. #include <linux/of.h>
  29. #include <linux/clk.h>
  30. /* Operation Mode Strap Override */
  31. #define MII_KSZPHY_OMSO 0x16
  32. #define KSZPHY_OMSO_B_CAST_OFF BIT(9)
  33. #define KSZPHY_OMSO_NAND_TREE_ON BIT(5)
  34. #define KSZPHY_OMSO_RMII_OVERRIDE BIT(1)
  35. #define KSZPHY_OMSO_MII_OVERRIDE BIT(0)
  36. /* general Interrupt control/status reg in vendor specific block. */
  37. #define MII_KSZPHY_INTCS 0x1B
  38. #define KSZPHY_INTCS_JABBER BIT(15)
  39. #define KSZPHY_INTCS_RECEIVE_ERR BIT(14)
  40. #define KSZPHY_INTCS_PAGE_RECEIVE BIT(13)
  41. #define KSZPHY_INTCS_PARELLEL BIT(12)
  42. #define KSZPHY_INTCS_LINK_PARTNER_ACK BIT(11)
  43. #define KSZPHY_INTCS_LINK_DOWN BIT(10)
  44. #define KSZPHY_INTCS_REMOTE_FAULT BIT(9)
  45. #define KSZPHY_INTCS_LINK_UP BIT(8)
  46. #define KSZPHY_INTCS_ALL (KSZPHY_INTCS_LINK_UP |\
  47. KSZPHY_INTCS_LINK_DOWN)
  48. /* PHY Control 1 */
  49. #define MII_KSZPHY_CTRL_1 0x1e
  50. /* PHY Control 2 / PHY Control (if no PHY Control 1) */
  51. #define MII_KSZPHY_CTRL_2 0x1f
  52. #define MII_KSZPHY_CTRL MII_KSZPHY_CTRL_2
  53. /* bitmap of PHY register to set interrupt mode */
  54. #define KSZPHY_CTRL_INT_ACTIVE_HIGH BIT(9)
  55. #define KSZPHY_RMII_REF_CLK_SEL BIT(7)
  56. /* Write/read to/from extended registers */
  57. #define MII_KSZPHY_EXTREG 0x0b
  58. #define KSZPHY_EXTREG_WRITE 0x8000
  59. #define MII_KSZPHY_EXTREG_WRITE 0x0c
  60. #define MII_KSZPHY_EXTREG_READ 0x0d
  61. /* Extended registers */
  62. #define MII_KSZPHY_CLK_CONTROL_PAD_SKEW 0x104
  63. #define MII_KSZPHY_RX_DATA_PAD_SKEW 0x105
  64. #define MII_KSZPHY_TX_DATA_PAD_SKEW 0x106
  65. #define PS_TO_REG 200
  66. struct kszphy_hw_stat {
  67. const char *string;
  68. u8 reg;
  69. u8 bits;
  70. };
  71. static struct kszphy_hw_stat kszphy_hw_stats[] = {
  72. { "phy_receive_errors", 21, 16},
  73. { "phy_idle_errors", 10, 8 },
  74. };
  75. struct kszphy_type {
  76. u32 led_mode_reg;
  77. u16 interrupt_level_mask;
  78. bool has_broadcast_disable;
  79. bool has_nand_tree_disable;
  80. bool has_rmii_ref_clk_sel;
  81. };
  82. struct kszphy_priv {
  83. const struct kszphy_type *type;
  84. int led_mode;
  85. bool rmii_ref_clk_sel;
  86. bool rmii_ref_clk_sel_val;
  87. u64 stats[ARRAY_SIZE(kszphy_hw_stats)];
  88. };
  89. static const struct kszphy_type ksz8021_type = {
  90. .led_mode_reg = MII_KSZPHY_CTRL_2,
  91. .has_broadcast_disable = true,
  92. .has_nand_tree_disable = true,
  93. .has_rmii_ref_clk_sel = true,
  94. };
  95. static const struct kszphy_type ksz8041_type = {
  96. .led_mode_reg = MII_KSZPHY_CTRL_1,
  97. };
  98. static const struct kszphy_type ksz8051_type = {
  99. .led_mode_reg = MII_KSZPHY_CTRL_2,
  100. .has_nand_tree_disable = true,
  101. };
  102. static const struct kszphy_type ksz8081_type = {
  103. .led_mode_reg = MII_KSZPHY_CTRL_2,
  104. .has_broadcast_disable = true,
  105. .has_nand_tree_disable = true,
  106. .has_rmii_ref_clk_sel = true,
  107. };
  108. static const struct kszphy_type ks8737_type = {
  109. .interrupt_level_mask = BIT(14),
  110. };
  111. static const struct kszphy_type ksz9021_type = {
  112. .interrupt_level_mask = BIT(14),
  113. };
  114. static int kszphy_extended_write(struct phy_device *phydev,
  115. u32 regnum, u16 val)
  116. {
  117. phy_write(phydev, MII_KSZPHY_EXTREG, KSZPHY_EXTREG_WRITE | regnum);
  118. return phy_write(phydev, MII_KSZPHY_EXTREG_WRITE, val);
  119. }
  120. static int kszphy_extended_read(struct phy_device *phydev,
  121. u32 regnum)
  122. {
  123. phy_write(phydev, MII_KSZPHY_EXTREG, regnum);
  124. return phy_read(phydev, MII_KSZPHY_EXTREG_READ);
  125. }
  126. static int kszphy_ack_interrupt(struct phy_device *phydev)
  127. {
  128. /* bit[7..0] int status, which is a read and clear register. */
  129. int rc;
  130. rc = phy_read(phydev, MII_KSZPHY_INTCS);
  131. return (rc < 0) ? rc : 0;
  132. }
  133. static int kszphy_config_intr(struct phy_device *phydev)
  134. {
  135. const struct kszphy_type *type = phydev->drv->driver_data;
  136. int temp;
  137. u16 mask;
  138. if (type && type->interrupt_level_mask)
  139. mask = type->interrupt_level_mask;
  140. else
  141. mask = KSZPHY_CTRL_INT_ACTIVE_HIGH;
  142. /* set the interrupt pin active low */
  143. temp = phy_read(phydev, MII_KSZPHY_CTRL);
  144. if (temp < 0)
  145. return temp;
  146. temp &= ~mask;
  147. phy_write(phydev, MII_KSZPHY_CTRL, temp);
  148. /* enable / disable interrupts */
  149. if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
  150. temp = KSZPHY_INTCS_ALL;
  151. else
  152. temp = 0;
  153. return phy_write(phydev, MII_KSZPHY_INTCS, temp);
  154. }
  155. static int kszphy_rmii_clk_sel(struct phy_device *phydev, bool val)
  156. {
  157. int ctrl;
  158. ctrl = phy_read(phydev, MII_KSZPHY_CTRL);
  159. if (ctrl < 0)
  160. return ctrl;
  161. if (val)
  162. ctrl |= KSZPHY_RMII_REF_CLK_SEL;
  163. else
  164. ctrl &= ~KSZPHY_RMII_REF_CLK_SEL;
  165. return phy_write(phydev, MII_KSZPHY_CTRL, ctrl);
  166. }
  167. static int kszphy_setup_led(struct phy_device *phydev, u32 reg, int val)
  168. {
  169. int rc, temp, shift;
  170. switch (reg) {
  171. case MII_KSZPHY_CTRL_1:
  172. shift = 14;
  173. break;
  174. case MII_KSZPHY_CTRL_2:
  175. shift = 4;
  176. break;
  177. default:
  178. return -EINVAL;
  179. }
  180. temp = phy_read(phydev, reg);
  181. if (temp < 0) {
  182. rc = temp;
  183. goto out;
  184. }
  185. temp &= ~(3 << shift);
  186. temp |= val << shift;
  187. rc = phy_write(phydev, reg, temp);
  188. out:
  189. if (rc < 0)
  190. phydev_err(phydev, "failed to set led mode\n");
  191. return rc;
  192. }
  193. /* Disable PHY address 0 as the broadcast address, so that it can be used as a
  194. * unique (non-broadcast) address on a shared bus.
  195. */
  196. static int kszphy_broadcast_disable(struct phy_device *phydev)
  197. {
  198. int ret;
  199. ret = phy_read(phydev, MII_KSZPHY_OMSO);
  200. if (ret < 0)
  201. goto out;
  202. ret = phy_write(phydev, MII_KSZPHY_OMSO, ret | KSZPHY_OMSO_B_CAST_OFF);
  203. out:
  204. if (ret)
  205. phydev_err(phydev, "failed to disable broadcast address\n");
  206. return ret;
  207. }
  208. static int kszphy_nand_tree_disable(struct phy_device *phydev)
  209. {
  210. int ret;
  211. ret = phy_read(phydev, MII_KSZPHY_OMSO);
  212. if (ret < 0)
  213. goto out;
  214. if (!(ret & KSZPHY_OMSO_NAND_TREE_ON))
  215. return 0;
  216. ret = phy_write(phydev, MII_KSZPHY_OMSO,
  217. ret & ~KSZPHY_OMSO_NAND_TREE_ON);
  218. out:
  219. if (ret)
  220. phydev_err(phydev, "failed to disable NAND tree mode\n");
  221. return ret;
  222. }
  223. static int kszphy_config_init(struct phy_device *phydev)
  224. {
  225. struct kszphy_priv *priv = phydev->priv;
  226. const struct kszphy_type *type;
  227. int ret;
  228. if (!priv)
  229. return 0;
  230. type = priv->type;
  231. if (type->has_broadcast_disable)
  232. kszphy_broadcast_disable(phydev);
  233. if (type->has_nand_tree_disable)
  234. kszphy_nand_tree_disable(phydev);
  235. if (priv->rmii_ref_clk_sel) {
  236. ret = kszphy_rmii_clk_sel(phydev, priv->rmii_ref_clk_sel_val);
  237. if (ret) {
  238. phydev_err(phydev,
  239. "failed to set rmii reference clock\n");
  240. return ret;
  241. }
  242. }
  243. if (priv->led_mode >= 0)
  244. kszphy_setup_led(phydev, type->led_mode_reg, priv->led_mode);
  245. if (phy_interrupt_is_valid(phydev)) {
  246. int ctl = phy_read(phydev, MII_BMCR);
  247. if (ctl < 0)
  248. return ctl;
  249. ret = phy_write(phydev, MII_BMCR, ctl & ~BMCR_ANENABLE);
  250. if (ret < 0)
  251. return ret;
  252. }
  253. return 0;
  254. }
  255. static int ksz9021_load_values_from_of(struct phy_device *phydev,
  256. const struct device_node *of_node,
  257. u16 reg,
  258. const char *field1, const char *field2,
  259. const char *field3, const char *field4)
  260. {
  261. int val1 = -1;
  262. int val2 = -2;
  263. int val3 = -3;
  264. int val4 = -4;
  265. int newval;
  266. int matches = 0;
  267. if (!of_property_read_u32(of_node, field1, &val1))
  268. matches++;
  269. if (!of_property_read_u32(of_node, field2, &val2))
  270. matches++;
  271. if (!of_property_read_u32(of_node, field3, &val3))
  272. matches++;
  273. if (!of_property_read_u32(of_node, field4, &val4))
  274. matches++;
  275. if (!matches)
  276. return 0;
  277. if (matches < 4)
  278. newval = kszphy_extended_read(phydev, reg);
  279. else
  280. newval = 0;
  281. if (val1 != -1)
  282. newval = ((newval & 0xfff0) | ((val1 / PS_TO_REG) & 0xf) << 0);
  283. if (val2 != -2)
  284. newval = ((newval & 0xff0f) | ((val2 / PS_TO_REG) & 0xf) << 4);
  285. if (val3 != -3)
  286. newval = ((newval & 0xf0ff) | ((val3 / PS_TO_REG) & 0xf) << 8);
  287. if (val4 != -4)
  288. newval = ((newval & 0x0fff) | ((val4 / PS_TO_REG) & 0xf) << 12);
  289. return kszphy_extended_write(phydev, reg, newval);
  290. }
  291. static int ksz9021_config_init(struct phy_device *phydev)
  292. {
  293. const struct device *dev = &phydev->mdio.dev;
  294. const struct device_node *of_node = dev->of_node;
  295. const struct device *dev_walker;
  296. /* The Micrel driver has a deprecated option to place phy OF
  297. * properties in the MAC node. Walk up the tree of devices to
  298. * find a device with an OF node.
  299. */
  300. dev_walker = &phydev->mdio.dev;
  301. do {
  302. of_node = dev_walker->of_node;
  303. dev_walker = dev_walker->parent;
  304. } while (!of_node && dev_walker);
  305. if (of_node) {
  306. ksz9021_load_values_from_of(phydev, of_node,
  307. MII_KSZPHY_CLK_CONTROL_PAD_SKEW,
  308. "txen-skew-ps", "txc-skew-ps",
  309. "rxdv-skew-ps", "rxc-skew-ps");
  310. ksz9021_load_values_from_of(phydev, of_node,
  311. MII_KSZPHY_RX_DATA_PAD_SKEW,
  312. "rxd0-skew-ps", "rxd1-skew-ps",
  313. "rxd2-skew-ps", "rxd3-skew-ps");
  314. ksz9021_load_values_from_of(phydev, of_node,
  315. MII_KSZPHY_TX_DATA_PAD_SKEW,
  316. "txd0-skew-ps", "txd1-skew-ps",
  317. "txd2-skew-ps", "txd3-skew-ps");
  318. }
  319. return 0;
  320. }
  321. #define MII_KSZ9031RN_MMD_CTRL_REG 0x0d
  322. #define MII_KSZ9031RN_MMD_REGDATA_REG 0x0e
  323. #define OP_DATA 1
  324. #define KSZ9031_PS_TO_REG 60
  325. /* Extended registers */
  326. /* MMD Address 0x0 */
  327. #define MII_KSZ9031RN_FLP_BURST_TX_LO 3
  328. #define MII_KSZ9031RN_FLP_BURST_TX_HI 4
  329. /* MMD Address 0x2 */
  330. #define MII_KSZ9031RN_CONTROL_PAD_SKEW 4
  331. #define MII_KSZ9031RN_RX_DATA_PAD_SKEW 5
  332. #define MII_KSZ9031RN_TX_DATA_PAD_SKEW 6
  333. #define MII_KSZ9031RN_CLK_PAD_SKEW 8
  334. static int ksz9031_extended_write(struct phy_device *phydev,
  335. u8 mode, u32 dev_addr, u32 regnum, u16 val)
  336. {
  337. phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
  338. phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
  339. phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
  340. return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
  341. }
  342. static int ksz9031_extended_read(struct phy_device *phydev,
  343. u8 mode, u32 dev_addr, u32 regnum)
  344. {
  345. phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
  346. phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
  347. phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
  348. return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
  349. }
  350. static int ksz9031_of_load_skew_values(struct phy_device *phydev,
  351. const struct device_node *of_node,
  352. u16 reg, size_t field_sz,
  353. const char *field[], u8 numfields)
  354. {
  355. int val[4] = {-1, -2, -3, -4};
  356. int matches = 0;
  357. u16 mask;
  358. u16 maxval;
  359. u16 newval;
  360. int i;
  361. for (i = 0; i < numfields; i++)
  362. if (!of_property_read_u32(of_node, field[i], val + i))
  363. matches++;
  364. if (!matches)
  365. return 0;
  366. if (matches < numfields)
  367. newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
  368. else
  369. newval = 0;
  370. maxval = (field_sz == 4) ? 0xf : 0x1f;
  371. for (i = 0; i < numfields; i++)
  372. if (val[i] != -(i + 1)) {
  373. mask = 0xffff;
  374. mask ^= maxval << (field_sz * i);
  375. newval = (newval & mask) |
  376. (((val[i] / KSZ9031_PS_TO_REG) & maxval)
  377. << (field_sz * i));
  378. }
  379. return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
  380. }
  381. static int ksz9031_center_flp_timing(struct phy_device *phydev)
  382. {
  383. int result;
  384. /* Center KSZ9031RNX FLP timing at 16ms. */
  385. result = ksz9031_extended_write(phydev, OP_DATA, 0,
  386. MII_KSZ9031RN_FLP_BURST_TX_HI, 0x0006);
  387. result = ksz9031_extended_write(phydev, OP_DATA, 0,
  388. MII_KSZ9031RN_FLP_BURST_TX_LO, 0x1A80);
  389. if (result)
  390. return result;
  391. return genphy_restart_aneg(phydev);
  392. }
  393. static int ksz9031_config_init(struct phy_device *phydev)
  394. {
  395. const struct device *dev = &phydev->mdio.dev;
  396. const struct device_node *of_node = dev->of_node;
  397. static const char *clk_skews[2] = {"rxc-skew-ps", "txc-skew-ps"};
  398. static const char *rx_data_skews[4] = {
  399. "rxd0-skew-ps", "rxd1-skew-ps",
  400. "rxd2-skew-ps", "rxd3-skew-ps"
  401. };
  402. static const char *tx_data_skews[4] = {
  403. "txd0-skew-ps", "txd1-skew-ps",
  404. "txd2-skew-ps", "txd3-skew-ps"
  405. };
  406. static const char *control_skews[2] = {"txen-skew-ps", "rxdv-skew-ps"};
  407. const struct device *dev_walker;
  408. /* The Micrel driver has a deprecated option to place phy OF
  409. * properties in the MAC node. Walk up the tree of devices to
  410. * find a device with an OF node.
  411. */
  412. dev_walker = &phydev->mdio.dev;
  413. do {
  414. of_node = dev_walker->of_node;
  415. dev_walker = dev_walker->parent;
  416. } while (!of_node && dev_walker);
  417. if (of_node) {
  418. ksz9031_of_load_skew_values(phydev, of_node,
  419. MII_KSZ9031RN_CLK_PAD_SKEW, 5,
  420. clk_skews, 2);
  421. ksz9031_of_load_skew_values(phydev, of_node,
  422. MII_KSZ9031RN_CONTROL_PAD_SKEW, 4,
  423. control_skews, 2);
  424. ksz9031_of_load_skew_values(phydev, of_node,
  425. MII_KSZ9031RN_RX_DATA_PAD_SKEW, 4,
  426. rx_data_skews, 4);
  427. ksz9031_of_load_skew_values(phydev, of_node,
  428. MII_KSZ9031RN_TX_DATA_PAD_SKEW, 4,
  429. tx_data_skews, 4);
  430. }
  431. return ksz9031_center_flp_timing(phydev);
  432. }
  433. #define KSZ8873MLL_GLOBAL_CONTROL_4 0x06
  434. #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX BIT(6)
  435. #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED BIT(4)
  436. static int ksz8873mll_read_status(struct phy_device *phydev)
  437. {
  438. int regval;
  439. /* dummy read */
  440. regval = phy_read(phydev, KSZ8873MLL_GLOBAL_CONTROL_4);
  441. regval = phy_read(phydev, KSZ8873MLL_GLOBAL_CONTROL_4);
  442. if (regval & KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX)
  443. phydev->duplex = DUPLEX_HALF;
  444. else
  445. phydev->duplex = DUPLEX_FULL;
  446. if (regval & KSZ8873MLL_GLOBAL_CONTROL_4_SPEED)
  447. phydev->speed = SPEED_10;
  448. else
  449. phydev->speed = SPEED_100;
  450. phydev->link = 1;
  451. phydev->pause = phydev->asym_pause = 0;
  452. return 0;
  453. }
  454. static int ksz9031_read_status(struct phy_device *phydev)
  455. {
  456. int err;
  457. int regval;
  458. err = genphy_read_status(phydev);
  459. if (err)
  460. return err;
  461. /* Make sure the PHY is not broken. Read idle error count,
  462. * and reset the PHY if it is maxed out.
  463. */
  464. regval = phy_read(phydev, MII_STAT1000);
  465. if ((regval & 0xFF) == 0xFF) {
  466. phy_init_hw(phydev);
  467. phydev->link = 0;
  468. }
  469. return 0;
  470. }
  471. static int ksz8873mll_config_aneg(struct phy_device *phydev)
  472. {
  473. return 0;
  474. }
  475. /* This routine returns -1 as an indication to the caller that the
  476. * Micrel ksz9021 10/100/1000 PHY does not support standard IEEE
  477. * MMD extended PHY registers.
  478. */
  479. static int
  480. ksz9021_rd_mmd_phyreg(struct phy_device *phydev, int ptrad, int devnum,
  481. int regnum)
  482. {
  483. return -1;
  484. }
  485. /* This routine does nothing since the Micrel ksz9021 does not support
  486. * standard IEEE MMD extended PHY registers.
  487. */
  488. static void
  489. ksz9021_wr_mmd_phyreg(struct phy_device *phydev, int ptrad, int devnum,
  490. int regnum, u32 val)
  491. {
  492. }
  493. static int kszphy_get_sset_count(struct phy_device *phydev)
  494. {
  495. return ARRAY_SIZE(kszphy_hw_stats);
  496. }
  497. static void kszphy_get_strings(struct phy_device *phydev, u8 *data)
  498. {
  499. int i;
  500. for (i = 0; i < ARRAY_SIZE(kszphy_hw_stats); i++) {
  501. memcpy(data + i * ETH_GSTRING_LEN,
  502. kszphy_hw_stats[i].string, ETH_GSTRING_LEN);
  503. }
  504. }
  505. #ifndef UINT64_MAX
  506. #define UINT64_MAX (u64)(~((u64)0))
  507. #endif
  508. static u64 kszphy_get_stat(struct phy_device *phydev, int i)
  509. {
  510. struct kszphy_hw_stat stat = kszphy_hw_stats[i];
  511. struct kszphy_priv *priv = phydev->priv;
  512. int val;
  513. u64 ret;
  514. val = phy_read(phydev, stat.reg);
  515. if (val < 0) {
  516. ret = UINT64_MAX;
  517. } else {
  518. val = val & ((1 << stat.bits) - 1);
  519. priv->stats[i] += val;
  520. ret = priv->stats[i];
  521. }
  522. return ret;
  523. }
  524. static void kszphy_get_stats(struct phy_device *phydev,
  525. struct ethtool_stats *stats, u64 *data)
  526. {
  527. int i;
  528. for (i = 0; i < ARRAY_SIZE(kszphy_hw_stats); i++)
  529. data[i] = kszphy_get_stat(phydev, i);
  530. }
  531. static int kszphy_resume(struct phy_device *phydev)
  532. {
  533. int value;
  534. mutex_lock(&phydev->lock);
  535. value = phy_read(phydev, MII_BMCR);
  536. phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN);
  537. kszphy_config_intr(phydev);
  538. mutex_unlock(&phydev->lock);
  539. return 0;
  540. }
  541. static int kszphy_probe(struct phy_device *phydev)
  542. {
  543. const struct kszphy_type *type = phydev->drv->driver_data;
  544. const struct device_node *np = phydev->mdio.dev.of_node;
  545. struct kszphy_priv *priv;
  546. struct clk *clk;
  547. int ret;
  548. priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);
  549. if (!priv)
  550. return -ENOMEM;
  551. phydev->priv = priv;
  552. priv->type = type;
  553. if (type->led_mode_reg) {
  554. ret = of_property_read_u32(np, "micrel,led-mode",
  555. &priv->led_mode);
  556. if (ret)
  557. priv->led_mode = -1;
  558. if (priv->led_mode > 3) {
  559. phydev_err(phydev, "invalid led mode: 0x%02x\n",
  560. priv->led_mode);
  561. priv->led_mode = -1;
  562. }
  563. } else {
  564. priv->led_mode = -1;
  565. }
  566. clk = devm_clk_get(&phydev->mdio.dev, "rmii-ref");
  567. /* NOTE: clk may be NULL if building without CONFIG_HAVE_CLK */
  568. if (!IS_ERR_OR_NULL(clk)) {
  569. unsigned long rate = clk_get_rate(clk);
  570. bool rmii_ref_clk_sel_25_mhz;
  571. priv->rmii_ref_clk_sel = type->has_rmii_ref_clk_sel;
  572. rmii_ref_clk_sel_25_mhz = of_property_read_bool(np,
  573. "micrel,rmii-reference-clock-select-25-mhz");
  574. if (rate > 24500000 && rate < 25500000) {
  575. priv->rmii_ref_clk_sel_val = rmii_ref_clk_sel_25_mhz;
  576. } else if (rate > 49500000 && rate < 50500000) {
  577. priv->rmii_ref_clk_sel_val = !rmii_ref_clk_sel_25_mhz;
  578. } else {
  579. phydev_err(phydev, "Clock rate out of range: %ld\n",
  580. rate);
  581. return -EINVAL;
  582. }
  583. }
  584. /* Support legacy board-file configuration */
  585. if (phydev->dev_flags & MICREL_PHY_50MHZ_CLK) {
  586. priv->rmii_ref_clk_sel = true;
  587. priv->rmii_ref_clk_sel_val = true;
  588. }
  589. return 0;
  590. }
  591. static struct phy_driver ksphy_driver[] = {
  592. {
  593. .phy_id = PHY_ID_KS8737,
  594. .phy_id_mask = 0x00fffff0,
  595. .name = "Micrel KS8737",
  596. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  597. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  598. .driver_data = &ks8737_type,
  599. .config_init = kszphy_config_init,
  600. .config_aneg = genphy_config_aneg,
  601. .read_status = genphy_read_status,
  602. .ack_interrupt = kszphy_ack_interrupt,
  603. .config_intr = kszphy_config_intr,
  604. .get_sset_count = kszphy_get_sset_count,
  605. .get_strings = kszphy_get_strings,
  606. .get_stats = kszphy_get_stats,
  607. .suspend = genphy_suspend,
  608. .resume = genphy_resume,
  609. }, {
  610. .phy_id = PHY_ID_KSZ8021,
  611. .phy_id_mask = 0x00ffffff,
  612. .name = "Micrel KSZ8021 or KSZ8031",
  613. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause |
  614. SUPPORTED_Asym_Pause),
  615. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  616. .driver_data = &ksz8021_type,
  617. .probe = kszphy_probe,
  618. .config_init = kszphy_config_init,
  619. .config_aneg = genphy_config_aneg,
  620. .read_status = genphy_read_status,
  621. .ack_interrupt = kszphy_ack_interrupt,
  622. .config_intr = kszphy_config_intr,
  623. .get_sset_count = kszphy_get_sset_count,
  624. .get_strings = kszphy_get_strings,
  625. .get_stats = kszphy_get_stats,
  626. .suspend = genphy_suspend,
  627. .resume = genphy_resume,
  628. }, {
  629. .phy_id = PHY_ID_KSZ8031,
  630. .phy_id_mask = 0x00ffffff,
  631. .name = "Micrel KSZ8031",
  632. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause |
  633. SUPPORTED_Asym_Pause),
  634. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  635. .driver_data = &ksz8021_type,
  636. .probe = kszphy_probe,
  637. .config_init = kszphy_config_init,
  638. .config_aneg = genphy_config_aneg,
  639. .read_status = genphy_read_status,
  640. .ack_interrupt = kszphy_ack_interrupt,
  641. .config_intr = kszphy_config_intr,
  642. .get_sset_count = kszphy_get_sset_count,
  643. .get_strings = kszphy_get_strings,
  644. .get_stats = kszphy_get_stats,
  645. .suspend = genphy_suspend,
  646. .resume = genphy_resume,
  647. }, {
  648. .phy_id = PHY_ID_KSZ8041,
  649. .phy_id_mask = 0x00fffff0,
  650. .name = "Micrel KSZ8041",
  651. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause
  652. | SUPPORTED_Asym_Pause),
  653. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  654. .driver_data = &ksz8041_type,
  655. .probe = kszphy_probe,
  656. .config_init = kszphy_config_init,
  657. .config_aneg = genphy_config_aneg,
  658. .read_status = genphy_read_status,
  659. .ack_interrupt = kszphy_ack_interrupt,
  660. .config_intr = kszphy_config_intr,
  661. .get_sset_count = kszphy_get_sset_count,
  662. .get_strings = kszphy_get_strings,
  663. .get_stats = kszphy_get_stats,
  664. .suspend = genphy_suspend,
  665. .resume = genphy_resume,
  666. }, {
  667. .phy_id = PHY_ID_KSZ8041RNLI,
  668. .phy_id_mask = 0x00fffff0,
  669. .name = "Micrel KSZ8041RNLI",
  670. .features = PHY_BASIC_FEATURES |
  671. SUPPORTED_Pause | SUPPORTED_Asym_Pause,
  672. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  673. .driver_data = &ksz8041_type,
  674. .probe = kszphy_probe,
  675. .config_init = kszphy_config_init,
  676. .config_aneg = genphy_config_aneg,
  677. .read_status = genphy_read_status,
  678. .ack_interrupt = kszphy_ack_interrupt,
  679. .config_intr = kszphy_config_intr,
  680. .get_sset_count = kszphy_get_sset_count,
  681. .get_strings = kszphy_get_strings,
  682. .get_stats = kszphy_get_stats,
  683. .suspend = genphy_suspend,
  684. .resume = genphy_resume,
  685. }, {
  686. .phy_id = PHY_ID_KSZ8051,
  687. .phy_id_mask = 0x00fffff0,
  688. .name = "Micrel KSZ8051",
  689. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause
  690. | SUPPORTED_Asym_Pause),
  691. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  692. .driver_data = &ksz8051_type,
  693. .probe = kszphy_probe,
  694. .config_init = kszphy_config_init,
  695. .config_aneg = genphy_config_aneg,
  696. .read_status = genphy_read_status,
  697. .ack_interrupt = kszphy_ack_interrupt,
  698. .config_intr = kszphy_config_intr,
  699. .get_sset_count = kszphy_get_sset_count,
  700. .get_strings = kszphy_get_strings,
  701. .get_stats = kszphy_get_stats,
  702. .suspend = genphy_suspend,
  703. .resume = genphy_resume,
  704. }, {
  705. .phy_id = PHY_ID_KSZ8001,
  706. .name = "Micrel KSZ8001 or KS8721",
  707. .phy_id_mask = 0x00ffffff,
  708. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  709. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  710. .driver_data = &ksz8041_type,
  711. .probe = kszphy_probe,
  712. .config_init = kszphy_config_init,
  713. .config_aneg = genphy_config_aneg,
  714. .read_status = genphy_read_status,
  715. .ack_interrupt = kszphy_ack_interrupt,
  716. .config_intr = kszphy_config_intr,
  717. .get_sset_count = kszphy_get_sset_count,
  718. .get_strings = kszphy_get_strings,
  719. .get_stats = kszphy_get_stats,
  720. .suspend = genphy_suspend,
  721. .resume = genphy_resume,
  722. }, {
  723. .phy_id = PHY_ID_KSZ8081,
  724. .name = "Micrel KSZ8081 or KSZ8091",
  725. .phy_id_mask = 0x00fffff0,
  726. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  727. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  728. .driver_data = &ksz8081_type,
  729. .probe = kszphy_probe,
  730. .config_init = kszphy_config_init,
  731. .config_aneg = genphy_config_aneg,
  732. .read_status = genphy_read_status,
  733. .ack_interrupt = kszphy_ack_interrupt,
  734. .config_intr = kszphy_config_intr,
  735. .get_sset_count = kszphy_get_sset_count,
  736. .get_strings = kszphy_get_strings,
  737. .get_stats = kszphy_get_stats,
  738. .suspend = genphy_suspend,
  739. .resume = kszphy_resume,
  740. }, {
  741. .phy_id = PHY_ID_KSZ8061,
  742. .name = "Micrel KSZ8061",
  743. .phy_id_mask = 0x00fffff0,
  744. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  745. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  746. .config_init = kszphy_config_init,
  747. .config_aneg = genphy_config_aneg,
  748. .read_status = genphy_read_status,
  749. .ack_interrupt = kszphy_ack_interrupt,
  750. .config_intr = kszphy_config_intr,
  751. .get_sset_count = kszphy_get_sset_count,
  752. .get_strings = kszphy_get_strings,
  753. .get_stats = kszphy_get_stats,
  754. .suspend = genphy_suspend,
  755. .resume = genphy_resume,
  756. }, {
  757. .phy_id = PHY_ID_KSZ9021,
  758. .phy_id_mask = 0x000ffffe,
  759. .name = "Micrel KSZ9021 Gigabit PHY",
  760. .features = (PHY_GBIT_FEATURES | SUPPORTED_Pause),
  761. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  762. .driver_data = &ksz9021_type,
  763. .config_init = ksz9021_config_init,
  764. .config_aneg = genphy_config_aneg,
  765. .read_status = genphy_read_status,
  766. .ack_interrupt = kszphy_ack_interrupt,
  767. .config_intr = kszphy_config_intr,
  768. .get_sset_count = kszphy_get_sset_count,
  769. .get_strings = kszphy_get_strings,
  770. .get_stats = kszphy_get_stats,
  771. .suspend = genphy_suspend,
  772. .resume = genphy_resume,
  773. .read_mmd_indirect = ksz9021_rd_mmd_phyreg,
  774. .write_mmd_indirect = ksz9021_wr_mmd_phyreg,
  775. }, {
  776. .phy_id = PHY_ID_KSZ9031,
  777. .phy_id_mask = 0x00fffff0,
  778. .name = "Micrel KSZ9031 Gigabit PHY",
  779. .features = (PHY_GBIT_FEATURES | SUPPORTED_Pause),
  780. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  781. .driver_data = &ksz9021_type,
  782. .config_init = ksz9031_config_init,
  783. .config_aneg = genphy_config_aneg,
  784. .read_status = ksz9031_read_status,
  785. .ack_interrupt = kszphy_ack_interrupt,
  786. .config_intr = kszphy_config_intr,
  787. .get_sset_count = kszphy_get_sset_count,
  788. .get_strings = kszphy_get_strings,
  789. .get_stats = kszphy_get_stats,
  790. .suspend = genphy_suspend,
  791. .resume = genphy_resume,
  792. }, {
  793. .phy_id = PHY_ID_KSZ8873MLL,
  794. .phy_id_mask = 0x00fffff0,
  795. .name = "Micrel KSZ8873MLL Switch",
  796. .features = (SUPPORTED_Pause | SUPPORTED_Asym_Pause),
  797. .flags = PHY_HAS_MAGICANEG,
  798. .config_init = kszphy_config_init,
  799. .config_aneg = ksz8873mll_config_aneg,
  800. .read_status = ksz8873mll_read_status,
  801. .get_sset_count = kszphy_get_sset_count,
  802. .get_strings = kszphy_get_strings,
  803. .get_stats = kszphy_get_stats,
  804. .suspend = genphy_suspend,
  805. .resume = genphy_resume,
  806. }, {
  807. .phy_id = PHY_ID_KSZ886X,
  808. .phy_id_mask = 0x00fffff0,
  809. .name = "Micrel KSZ886X Switch",
  810. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  811. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  812. .config_init = kszphy_config_init,
  813. .config_aneg = genphy_config_aneg,
  814. .read_status = genphy_read_status,
  815. .get_sset_count = kszphy_get_sset_count,
  816. .get_strings = kszphy_get_strings,
  817. .get_stats = kszphy_get_stats,
  818. .suspend = genphy_suspend,
  819. .resume = genphy_resume,
  820. } };
  821. module_phy_driver(ksphy_driver);
  822. MODULE_DESCRIPTION("Micrel PHY driver");
  823. MODULE_AUTHOR("David J. Choi");
  824. MODULE_LICENSE("GPL");
  825. static struct mdio_device_id __maybe_unused micrel_tbl[] = {
  826. { PHY_ID_KSZ9021, 0x000ffffe },
  827. { PHY_ID_KSZ9031, 0x00fffff0 },
  828. { PHY_ID_KSZ8001, 0x00ffffff },
  829. { PHY_ID_KS8737, 0x00fffff0 },
  830. { PHY_ID_KSZ8021, 0x00ffffff },
  831. { PHY_ID_KSZ8031, 0x00ffffff },
  832. { PHY_ID_KSZ8041, 0x00fffff0 },
  833. { PHY_ID_KSZ8051, 0x00fffff0 },
  834. { PHY_ID_KSZ8061, 0x00fffff0 },
  835. { PHY_ID_KSZ8081, 0x00fffff0 },
  836. { PHY_ID_KSZ8873MLL, 0x00fffff0 },
  837. { PHY_ID_KSZ886X, 0x00fffff0 },
  838. { }
  839. };
  840. MODULE_DEVICE_TABLE(mdio, micrel_tbl);