micrel.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952
  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. return 0;
  246. }
  247. static int ksz9021_load_values_from_of(struct phy_device *phydev,
  248. const struct device_node *of_node,
  249. u16 reg,
  250. const char *field1, const char *field2,
  251. const char *field3, const char *field4)
  252. {
  253. int val1 = -1;
  254. int val2 = -2;
  255. int val3 = -3;
  256. int val4 = -4;
  257. int newval;
  258. int matches = 0;
  259. if (!of_property_read_u32(of_node, field1, &val1))
  260. matches++;
  261. if (!of_property_read_u32(of_node, field2, &val2))
  262. matches++;
  263. if (!of_property_read_u32(of_node, field3, &val3))
  264. matches++;
  265. if (!of_property_read_u32(of_node, field4, &val4))
  266. matches++;
  267. if (!matches)
  268. return 0;
  269. if (matches < 4)
  270. newval = kszphy_extended_read(phydev, reg);
  271. else
  272. newval = 0;
  273. if (val1 != -1)
  274. newval = ((newval & 0xfff0) | ((val1 / PS_TO_REG) & 0xf) << 0);
  275. if (val2 != -2)
  276. newval = ((newval & 0xff0f) | ((val2 / PS_TO_REG) & 0xf) << 4);
  277. if (val3 != -3)
  278. newval = ((newval & 0xf0ff) | ((val3 / PS_TO_REG) & 0xf) << 8);
  279. if (val4 != -4)
  280. newval = ((newval & 0x0fff) | ((val4 / PS_TO_REG) & 0xf) << 12);
  281. return kszphy_extended_write(phydev, reg, newval);
  282. }
  283. static int ksz9021_config_init(struct phy_device *phydev)
  284. {
  285. const struct device *dev = &phydev->mdio.dev;
  286. const struct device_node *of_node = dev->of_node;
  287. const struct device *dev_walker;
  288. /* The Micrel driver has a deprecated option to place phy OF
  289. * properties in the MAC node. Walk up the tree of devices to
  290. * find a device with an OF node.
  291. */
  292. dev_walker = &phydev->mdio.dev;
  293. do {
  294. of_node = dev_walker->of_node;
  295. dev_walker = dev_walker->parent;
  296. } while (!of_node && dev_walker);
  297. if (of_node) {
  298. ksz9021_load_values_from_of(phydev, of_node,
  299. MII_KSZPHY_CLK_CONTROL_PAD_SKEW,
  300. "txen-skew-ps", "txc-skew-ps",
  301. "rxdv-skew-ps", "rxc-skew-ps");
  302. ksz9021_load_values_from_of(phydev, of_node,
  303. MII_KSZPHY_RX_DATA_PAD_SKEW,
  304. "rxd0-skew-ps", "rxd1-skew-ps",
  305. "rxd2-skew-ps", "rxd3-skew-ps");
  306. ksz9021_load_values_from_of(phydev, of_node,
  307. MII_KSZPHY_TX_DATA_PAD_SKEW,
  308. "txd0-skew-ps", "txd1-skew-ps",
  309. "txd2-skew-ps", "txd3-skew-ps");
  310. }
  311. return 0;
  312. }
  313. #define MII_KSZ9031RN_MMD_CTRL_REG 0x0d
  314. #define MII_KSZ9031RN_MMD_REGDATA_REG 0x0e
  315. #define OP_DATA 1
  316. #define KSZ9031_PS_TO_REG 60
  317. /* Extended registers */
  318. /* MMD Address 0x0 */
  319. #define MII_KSZ9031RN_FLP_BURST_TX_LO 3
  320. #define MII_KSZ9031RN_FLP_BURST_TX_HI 4
  321. /* MMD Address 0x2 */
  322. #define MII_KSZ9031RN_CONTROL_PAD_SKEW 4
  323. #define MII_KSZ9031RN_RX_DATA_PAD_SKEW 5
  324. #define MII_KSZ9031RN_TX_DATA_PAD_SKEW 6
  325. #define MII_KSZ9031RN_CLK_PAD_SKEW 8
  326. static int ksz9031_extended_write(struct phy_device *phydev,
  327. u8 mode, u32 dev_addr, u32 regnum, u16 val)
  328. {
  329. phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
  330. phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
  331. phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
  332. return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
  333. }
  334. static int ksz9031_extended_read(struct phy_device *phydev,
  335. u8 mode, u32 dev_addr, u32 regnum)
  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_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
  341. }
  342. static int ksz9031_of_load_skew_values(struct phy_device *phydev,
  343. const struct device_node *of_node,
  344. u16 reg, size_t field_sz,
  345. const char *field[], u8 numfields)
  346. {
  347. int val[4] = {-1, -2, -3, -4};
  348. int matches = 0;
  349. u16 mask;
  350. u16 maxval;
  351. u16 newval;
  352. int i;
  353. for (i = 0; i < numfields; i++)
  354. if (!of_property_read_u32(of_node, field[i], val + i))
  355. matches++;
  356. if (!matches)
  357. return 0;
  358. if (matches < numfields)
  359. newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
  360. else
  361. newval = 0;
  362. maxval = (field_sz == 4) ? 0xf : 0x1f;
  363. for (i = 0; i < numfields; i++)
  364. if (val[i] != -(i + 1)) {
  365. mask = 0xffff;
  366. mask ^= maxval << (field_sz * i);
  367. newval = (newval & mask) |
  368. (((val[i] / KSZ9031_PS_TO_REG) & maxval)
  369. << (field_sz * i));
  370. }
  371. return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
  372. }
  373. static int ksz9031_center_flp_timing(struct phy_device *phydev)
  374. {
  375. int result;
  376. /* Center KSZ9031RNX FLP timing at 16ms. */
  377. result = ksz9031_extended_write(phydev, OP_DATA, 0,
  378. MII_KSZ9031RN_FLP_BURST_TX_HI, 0x0006);
  379. result = ksz9031_extended_write(phydev, OP_DATA, 0,
  380. MII_KSZ9031RN_FLP_BURST_TX_LO, 0x1A80);
  381. if (result)
  382. return result;
  383. return genphy_restart_aneg(phydev);
  384. }
  385. static int ksz9031_config_init(struct phy_device *phydev)
  386. {
  387. const struct device *dev = &phydev->mdio.dev;
  388. const struct device_node *of_node = dev->of_node;
  389. static const char *clk_skews[2] = {"rxc-skew-ps", "txc-skew-ps"};
  390. static const char *rx_data_skews[4] = {
  391. "rxd0-skew-ps", "rxd1-skew-ps",
  392. "rxd2-skew-ps", "rxd3-skew-ps"
  393. };
  394. static const char *tx_data_skews[4] = {
  395. "txd0-skew-ps", "txd1-skew-ps",
  396. "txd2-skew-ps", "txd3-skew-ps"
  397. };
  398. static const char *control_skews[2] = {"txen-skew-ps", "rxdv-skew-ps"};
  399. const struct device *dev_walker;
  400. /* The Micrel driver has a deprecated option to place phy OF
  401. * properties in the MAC node. Walk up the tree of devices to
  402. * find a device with an OF node.
  403. */
  404. dev_walker = &phydev->mdio.dev;
  405. do {
  406. of_node = dev_walker->of_node;
  407. dev_walker = dev_walker->parent;
  408. } while (!of_node && dev_walker);
  409. if (of_node) {
  410. ksz9031_of_load_skew_values(phydev, of_node,
  411. MII_KSZ9031RN_CLK_PAD_SKEW, 5,
  412. clk_skews, 2);
  413. ksz9031_of_load_skew_values(phydev, of_node,
  414. MII_KSZ9031RN_CONTROL_PAD_SKEW, 4,
  415. control_skews, 2);
  416. ksz9031_of_load_skew_values(phydev, of_node,
  417. MII_KSZ9031RN_RX_DATA_PAD_SKEW, 4,
  418. rx_data_skews, 4);
  419. ksz9031_of_load_skew_values(phydev, of_node,
  420. MII_KSZ9031RN_TX_DATA_PAD_SKEW, 4,
  421. tx_data_skews, 4);
  422. }
  423. return ksz9031_center_flp_timing(phydev);
  424. }
  425. #define KSZ8873MLL_GLOBAL_CONTROL_4 0x06
  426. #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX BIT(6)
  427. #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED BIT(4)
  428. static int ksz8873mll_read_status(struct phy_device *phydev)
  429. {
  430. int regval;
  431. /* dummy read */
  432. regval = phy_read(phydev, KSZ8873MLL_GLOBAL_CONTROL_4);
  433. regval = phy_read(phydev, KSZ8873MLL_GLOBAL_CONTROL_4);
  434. if (regval & KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX)
  435. phydev->duplex = DUPLEX_HALF;
  436. else
  437. phydev->duplex = DUPLEX_FULL;
  438. if (regval & KSZ8873MLL_GLOBAL_CONTROL_4_SPEED)
  439. phydev->speed = SPEED_10;
  440. else
  441. phydev->speed = SPEED_100;
  442. phydev->link = 1;
  443. phydev->pause = phydev->asym_pause = 0;
  444. return 0;
  445. }
  446. static int ksz9031_read_status(struct phy_device *phydev)
  447. {
  448. int err;
  449. int regval;
  450. err = genphy_read_status(phydev);
  451. if (err)
  452. return err;
  453. /* Make sure the PHY is not broken. Read idle error count,
  454. * and reset the PHY if it is maxed out.
  455. */
  456. regval = phy_read(phydev, MII_STAT1000);
  457. if ((regval & 0xFF) == 0xFF) {
  458. phy_init_hw(phydev);
  459. phydev->link = 0;
  460. }
  461. return 0;
  462. }
  463. static int ksz8873mll_config_aneg(struct phy_device *phydev)
  464. {
  465. return 0;
  466. }
  467. /* This routine returns -1 as an indication to the caller that the
  468. * Micrel ksz9021 10/100/1000 PHY does not support standard IEEE
  469. * MMD extended PHY registers.
  470. */
  471. static int
  472. ksz9021_rd_mmd_phyreg(struct phy_device *phydev, int ptrad, int devnum,
  473. int regnum)
  474. {
  475. return -1;
  476. }
  477. /* This routine does nothing since the Micrel ksz9021 does not support
  478. * standard IEEE MMD extended PHY registers.
  479. */
  480. static void
  481. ksz9021_wr_mmd_phyreg(struct phy_device *phydev, int ptrad, int devnum,
  482. int regnum, u32 val)
  483. {
  484. }
  485. static int kszphy_get_sset_count(struct phy_device *phydev)
  486. {
  487. return ARRAY_SIZE(kszphy_hw_stats);
  488. }
  489. static void kszphy_get_strings(struct phy_device *phydev, u8 *data)
  490. {
  491. int i;
  492. for (i = 0; i < ARRAY_SIZE(kszphy_hw_stats); i++) {
  493. memcpy(data + i * ETH_GSTRING_LEN,
  494. kszphy_hw_stats[i].string, ETH_GSTRING_LEN);
  495. }
  496. }
  497. #ifndef UINT64_MAX
  498. #define UINT64_MAX (u64)(~((u64)0))
  499. #endif
  500. static u64 kszphy_get_stat(struct phy_device *phydev, int i)
  501. {
  502. struct kszphy_hw_stat stat = kszphy_hw_stats[i];
  503. struct kszphy_priv *priv = phydev->priv;
  504. u64 val;
  505. val = phy_read(phydev, stat.reg);
  506. if (val < 0) {
  507. val = UINT64_MAX;
  508. } else {
  509. val = val & ((1 << stat.bits) - 1);
  510. priv->stats[i] += val;
  511. val = priv->stats[i];
  512. }
  513. return val;
  514. }
  515. static void kszphy_get_stats(struct phy_device *phydev,
  516. struct ethtool_stats *stats, u64 *data)
  517. {
  518. int i;
  519. for (i = 0; i < ARRAY_SIZE(kszphy_hw_stats); i++)
  520. data[i] = kszphy_get_stat(phydev, i);
  521. }
  522. static int kszphy_probe(struct phy_device *phydev)
  523. {
  524. const struct kszphy_type *type = phydev->drv->driver_data;
  525. const struct device_node *np = phydev->mdio.dev.of_node;
  526. struct kszphy_priv *priv;
  527. struct clk *clk;
  528. int ret;
  529. priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);
  530. if (!priv)
  531. return -ENOMEM;
  532. phydev->priv = priv;
  533. priv->type = type;
  534. if (type->led_mode_reg) {
  535. ret = of_property_read_u32(np, "micrel,led-mode",
  536. &priv->led_mode);
  537. if (ret)
  538. priv->led_mode = -1;
  539. if (priv->led_mode > 3) {
  540. phydev_err(phydev, "invalid led mode: 0x%02x\n",
  541. priv->led_mode);
  542. priv->led_mode = -1;
  543. }
  544. } else {
  545. priv->led_mode = -1;
  546. }
  547. clk = devm_clk_get(&phydev->mdio.dev, "rmii-ref");
  548. /* NOTE: clk may be NULL if building without CONFIG_HAVE_CLK */
  549. if (!IS_ERR_OR_NULL(clk)) {
  550. unsigned long rate = clk_get_rate(clk);
  551. bool rmii_ref_clk_sel_25_mhz;
  552. priv->rmii_ref_clk_sel = type->has_rmii_ref_clk_sel;
  553. rmii_ref_clk_sel_25_mhz = of_property_read_bool(np,
  554. "micrel,rmii-reference-clock-select-25-mhz");
  555. if (rate > 24500000 && rate < 25500000) {
  556. priv->rmii_ref_clk_sel_val = rmii_ref_clk_sel_25_mhz;
  557. } else if (rate > 49500000 && rate < 50500000) {
  558. priv->rmii_ref_clk_sel_val = !rmii_ref_clk_sel_25_mhz;
  559. } else {
  560. phydev_err(phydev, "Clock rate out of range: %ld\n",
  561. rate);
  562. return -EINVAL;
  563. }
  564. }
  565. /* Support legacy board-file configuration */
  566. if (phydev->dev_flags & MICREL_PHY_50MHZ_CLK) {
  567. priv->rmii_ref_clk_sel = true;
  568. priv->rmii_ref_clk_sel_val = true;
  569. }
  570. return 0;
  571. }
  572. static struct phy_driver ksphy_driver[] = {
  573. {
  574. .phy_id = PHY_ID_KS8737,
  575. .phy_id_mask = 0x00fffff0,
  576. .name = "Micrel KS8737",
  577. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  578. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  579. .driver_data = &ks8737_type,
  580. .config_init = kszphy_config_init,
  581. .config_aneg = genphy_config_aneg,
  582. .read_status = genphy_read_status,
  583. .ack_interrupt = kszphy_ack_interrupt,
  584. .config_intr = kszphy_config_intr,
  585. .get_sset_count = kszphy_get_sset_count,
  586. .get_strings = kszphy_get_strings,
  587. .get_stats = kszphy_get_stats,
  588. .suspend = genphy_suspend,
  589. .resume = genphy_resume,
  590. }, {
  591. .phy_id = PHY_ID_KSZ8021,
  592. .phy_id_mask = 0x00ffffff,
  593. .name = "Micrel KSZ8021 or KSZ8031",
  594. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause |
  595. SUPPORTED_Asym_Pause),
  596. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  597. .driver_data = &ksz8021_type,
  598. .probe = kszphy_probe,
  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_KSZ8031,
  611. .phy_id_mask = 0x00ffffff,
  612. .name = "Micrel 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_KSZ8041,
  630. .phy_id_mask = 0x00fffff0,
  631. .name = "Micrel KSZ8041",
  632. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause
  633. | SUPPORTED_Asym_Pause),
  634. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  635. .driver_data = &ksz8041_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_KSZ8041RNLI,
  649. .phy_id_mask = 0x00fffff0,
  650. .name = "Micrel KSZ8041RNLI",
  651. .features = PHY_BASIC_FEATURES |
  652. SUPPORTED_Pause | 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_KSZ8051,
  668. .phy_id_mask = 0x00fffff0,
  669. .name = "Micrel KSZ8051",
  670. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause
  671. | SUPPORTED_Asym_Pause),
  672. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  673. .driver_data = &ksz8051_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_KSZ8001,
  687. .name = "Micrel KSZ8001 or KS8721",
  688. .phy_id_mask = 0x00ffffff,
  689. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  690. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  691. .driver_data = &ksz8041_type,
  692. .probe = kszphy_probe,
  693. .config_init = kszphy_config_init,
  694. .config_aneg = genphy_config_aneg,
  695. .read_status = genphy_read_status,
  696. .ack_interrupt = kszphy_ack_interrupt,
  697. .config_intr = kszphy_config_intr,
  698. .get_sset_count = kszphy_get_sset_count,
  699. .get_strings = kszphy_get_strings,
  700. .get_stats = kszphy_get_stats,
  701. .suspend = genphy_suspend,
  702. .resume = genphy_resume,
  703. }, {
  704. .phy_id = PHY_ID_KSZ8081,
  705. .name = "Micrel KSZ8081 or KSZ8091",
  706. .phy_id_mask = 0x00fffff0,
  707. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  708. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  709. .driver_data = &ksz8081_type,
  710. .probe = kszphy_probe,
  711. .config_init = kszphy_config_init,
  712. .config_aneg = genphy_config_aneg,
  713. .read_status = genphy_read_status,
  714. .ack_interrupt = kszphy_ack_interrupt,
  715. .config_intr = kszphy_config_intr,
  716. .get_sset_count = kszphy_get_sset_count,
  717. .get_strings = kszphy_get_strings,
  718. .get_stats = kszphy_get_stats,
  719. .suspend = genphy_suspend,
  720. .resume = genphy_resume,
  721. }, {
  722. .phy_id = PHY_ID_KSZ8061,
  723. .name = "Micrel KSZ8061",
  724. .phy_id_mask = 0x00fffff0,
  725. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  726. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  727. .config_init = kszphy_config_init,
  728. .config_aneg = genphy_config_aneg,
  729. .read_status = genphy_read_status,
  730. .ack_interrupt = kszphy_ack_interrupt,
  731. .config_intr = kszphy_config_intr,
  732. .get_sset_count = kszphy_get_sset_count,
  733. .get_strings = kszphy_get_strings,
  734. .get_stats = kszphy_get_stats,
  735. .suspend = genphy_suspend,
  736. .resume = genphy_resume,
  737. }, {
  738. .phy_id = PHY_ID_KSZ9021,
  739. .phy_id_mask = 0x000ffffe,
  740. .name = "Micrel KSZ9021 Gigabit PHY",
  741. .features = (PHY_GBIT_FEATURES | SUPPORTED_Pause),
  742. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  743. .driver_data = &ksz9021_type,
  744. .config_init = ksz9021_config_init,
  745. .config_aneg = genphy_config_aneg,
  746. .read_status = genphy_read_status,
  747. .ack_interrupt = kszphy_ack_interrupt,
  748. .config_intr = kszphy_config_intr,
  749. .get_sset_count = kszphy_get_sset_count,
  750. .get_strings = kszphy_get_strings,
  751. .get_stats = kszphy_get_stats,
  752. .suspend = genphy_suspend,
  753. .resume = genphy_resume,
  754. .read_mmd_indirect = ksz9021_rd_mmd_phyreg,
  755. .write_mmd_indirect = ksz9021_wr_mmd_phyreg,
  756. }, {
  757. .phy_id = PHY_ID_KSZ9031,
  758. .phy_id_mask = 0x00fffff0,
  759. .name = "Micrel KSZ9031 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 = ksz9031_config_init,
  764. .config_aneg = genphy_config_aneg,
  765. .read_status = ksz9031_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. }, {
  774. .phy_id = PHY_ID_KSZ8873MLL,
  775. .phy_id_mask = 0x00fffff0,
  776. .name = "Micrel KSZ8873MLL Switch",
  777. .features = (SUPPORTED_Pause | SUPPORTED_Asym_Pause),
  778. .flags = PHY_HAS_MAGICANEG,
  779. .config_init = kszphy_config_init,
  780. .config_aneg = ksz8873mll_config_aneg,
  781. .read_status = ksz8873mll_read_status,
  782. .get_sset_count = kszphy_get_sset_count,
  783. .get_strings = kszphy_get_strings,
  784. .get_stats = kszphy_get_stats,
  785. .suspend = genphy_suspend,
  786. .resume = genphy_resume,
  787. }, {
  788. .phy_id = PHY_ID_KSZ886X,
  789. .phy_id_mask = 0x00fffff0,
  790. .name = "Micrel KSZ886X Switch",
  791. .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause),
  792. .flags = PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
  793. .config_init = kszphy_config_init,
  794. .config_aneg = genphy_config_aneg,
  795. .read_status = genphy_read_status,
  796. .get_sset_count = kszphy_get_sset_count,
  797. .get_strings = kszphy_get_strings,
  798. .get_stats = kszphy_get_stats,
  799. .suspend = genphy_suspend,
  800. .resume = genphy_resume,
  801. } };
  802. module_phy_driver(ksphy_driver);
  803. MODULE_DESCRIPTION("Micrel PHY driver");
  804. MODULE_AUTHOR("David J. Choi");
  805. MODULE_LICENSE("GPL");
  806. static struct mdio_device_id __maybe_unused micrel_tbl[] = {
  807. { PHY_ID_KSZ9021, 0x000ffffe },
  808. { PHY_ID_KSZ9031, 0x00fffff0 },
  809. { PHY_ID_KSZ8001, 0x00ffffff },
  810. { PHY_ID_KS8737, 0x00fffff0 },
  811. { PHY_ID_KSZ8021, 0x00ffffff },
  812. { PHY_ID_KSZ8031, 0x00ffffff },
  813. { PHY_ID_KSZ8041, 0x00fffff0 },
  814. { PHY_ID_KSZ8051, 0x00fffff0 },
  815. { PHY_ID_KSZ8061, 0x00fffff0 },
  816. { PHY_ID_KSZ8081, 0x00fffff0 },
  817. { PHY_ID_KSZ8873MLL, 0x00fffff0 },
  818. { PHY_ID_KSZ886X, 0x00fffff0 },
  819. { }
  820. };
  821. MODULE_DEVICE_TABLE(mdio, micrel_tbl);