dp83822.c 34 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253
  1. // SPDX-License-Identifier: GPL-2.0
  2. /* Driver for the Texas Instruments DP83822, DP83825 and DP83826 PHYs.
  3. *
  4. * Copyright (C) 2017 Texas Instruments Inc.
  5. */
  6. #include <linux/ethtool.h>
  7. #include <linux/etherdevice.h>
  8. #include <linux/kernel.h>
  9. #include <linux/mii.h>
  10. #include <linux/module.h>
  11. #include <linux/of.h>
  12. #include <linux/phy.h>
  13. #include <linux/phy_port.h>
  14. #include <linux/netdevice.h>
  15. #include <linux/bitfield.h>
  16. #define DP83822_PHY_ID 0x2000a240
  17. #define DP83825S_PHY_ID 0x2000a140
  18. #define DP83825I_PHY_ID 0x2000a150
  19. #define DP83825CM_PHY_ID 0x2000a160
  20. #define DP83825CS_PHY_ID 0x2000a170
  21. #define DP83826C_PHY_ID 0x2000a130
  22. #define DP83826NC_PHY_ID 0x2000a110
  23. #define MII_DP83822_CTRL_2 0x0a
  24. #define MII_DP83822_PHYSTS 0x10
  25. #define MII_DP83822_PHYSCR 0x11
  26. #define MII_DP83822_MISR1 0x12
  27. #define MII_DP83822_MISR2 0x13
  28. #define MII_DP83822_FCSCR 0x14
  29. #define MII_DP83822_RCSR 0x17
  30. #define MII_DP83822_RESET_CTRL 0x1f
  31. #define MII_DP83822_MLEDCR 0x25
  32. #define MII_DP83822_LDCTRL 0x403
  33. #define MII_DP83822_LEDCFG1 0x460
  34. #define MII_DP83822_IOCTRL 0x461
  35. #define MII_DP83822_IOCTRL1 0x462
  36. #define MII_DP83822_IOCTRL2 0x463
  37. #define MII_DP83822_GENCFG 0x465
  38. #define MII_DP83822_SOR1 0x467
  39. /* DP83826 specific registers */
  40. #define MII_DP83826_VOD_CFG1 0x30b
  41. #define MII_DP83826_VOD_CFG2 0x30c
  42. /* GENCFG */
  43. #define DP83822_SIG_DET_LOW BIT(0)
  44. /* Control Register 2 bits */
  45. #define DP83822_FX_ENABLE BIT(14)
  46. #define DP83822_SW_RESET BIT(15)
  47. #define DP83822_DIG_RESTART BIT(14)
  48. /* PHY STS bits */
  49. #define DP83822_PHYSTS_DUPLEX BIT(2)
  50. #define DP83822_PHYSTS_10 BIT(1)
  51. #define DP83822_PHYSTS_LINK BIT(0)
  52. /* PHYSCR Register Fields */
  53. #define DP83822_PHYSCR_INT_OE BIT(0) /* Interrupt Output Enable */
  54. #define DP83822_PHYSCR_INTEN BIT(1) /* Interrupt Enable */
  55. /* MISR1 bits */
  56. #define DP83822_RX_ERR_HF_INT_EN BIT(0)
  57. #define DP83822_FALSE_CARRIER_HF_INT_EN BIT(1)
  58. #define DP83822_ANEG_COMPLETE_INT_EN BIT(2)
  59. #define DP83822_DUP_MODE_CHANGE_INT_EN BIT(3)
  60. #define DP83822_SPEED_CHANGED_INT_EN BIT(4)
  61. #define DP83822_LINK_STAT_INT_EN BIT(5)
  62. #define DP83822_ENERGY_DET_INT_EN BIT(6)
  63. #define DP83822_LINK_QUAL_INT_EN BIT(7)
  64. /* MISR2 bits */
  65. #define DP83822_JABBER_DET_INT_EN BIT(0)
  66. #define DP83822_WOL_PKT_INT_EN BIT(1)
  67. #define DP83822_SLEEP_MODE_INT_EN BIT(2)
  68. #define DP83822_MDI_XOVER_INT_EN BIT(3)
  69. #define DP83822_LB_FIFO_INT_EN BIT(4)
  70. #define DP83822_PAGE_RX_INT_EN BIT(5)
  71. #define DP83822_ANEG_ERR_INT_EN BIT(6)
  72. #define DP83822_EEE_ERROR_CHANGE_INT_EN BIT(7)
  73. /* INT_STAT1 bits */
  74. #define DP83822_WOL_INT_EN BIT(4)
  75. #define DP83822_WOL_INT_STAT BIT(12)
  76. #define MII_DP83822_RXSOP1 0x04a5
  77. #define MII_DP83822_RXSOP2 0x04a6
  78. #define MII_DP83822_RXSOP3 0x04a7
  79. /* WoL Registers */
  80. #define MII_DP83822_WOL_CFG 0x04a0
  81. #define MII_DP83822_WOL_STAT 0x04a1
  82. #define MII_DP83822_WOL_DA1 0x04a2
  83. #define MII_DP83822_WOL_DA2 0x04a3
  84. #define MII_DP83822_WOL_DA3 0x04a4
  85. /* WoL bits */
  86. #define DP83822_WOL_MAGIC_EN BIT(0)
  87. #define DP83822_WOL_SECURE_ON BIT(5)
  88. #define DP83822_WOL_EN BIT(7)
  89. #define DP83822_WOL_INDICATION_SEL BIT(8)
  90. #define DP83822_WOL_CLR_INDICATION BIT(11)
  91. /* RCSR bits */
  92. #define DP83822_RMII_MODE_EN BIT(5)
  93. #define DP83822_RMII_MODE_SEL BIT(7)
  94. #define DP83822_RGMII_MODE_EN BIT(9)
  95. #define DP83822_RX_CLK_SHIFT BIT(12)
  96. #define DP83822_TX_CLK_SHIFT BIT(11)
  97. /* MLEDCR bits */
  98. #define DP83822_MLEDCR_CFG GENMASK(6, 3)
  99. #define DP83822_MLEDCR_ROUTE GENMASK(1, 0)
  100. #define DP83822_MLEDCR_ROUTE_LED_0 DP83822_MLEDCR_ROUTE
  101. /* LEDCFG1 bits */
  102. #define DP83822_LEDCFG1_LED1_CTRL GENMASK(11, 8)
  103. #define DP83822_LEDCFG1_LED3_CTRL GENMASK(7, 4)
  104. /* IOCTRL bits */
  105. #define DP83822_IOCTRL_MAC_IMPEDANCE_CTRL GENMASK(4, 1)
  106. /* IOCTRL1 bits */
  107. #define DP83822_IOCTRL1_GPIO3_CTRL GENMASK(10, 8)
  108. #define DP83822_IOCTRL1_GPIO3_CTRL_LED3 BIT(0)
  109. #define DP83822_IOCTRL1_GPIO1_CTRL GENMASK(2, 0)
  110. #define DP83822_IOCTRL1_GPIO1_CTRL_LED_1 BIT(0)
  111. /* LDCTRL bits */
  112. #define DP83822_100BASE_TX_LINE_DRIVER_SWING GENMASK(7, 4)
  113. /* IOCTRL2 bits */
  114. #define DP83822_IOCTRL2_GPIO2_CLK_SRC GENMASK(6, 4)
  115. #define DP83822_IOCTRL2_GPIO2_CTRL GENMASK(2, 0)
  116. #define DP83822_IOCTRL2_GPIO2_CTRL_CLK_REF GENMASK(1, 0)
  117. #define DP83822_IOCTRL2_GPIO2_CTRL_MLED BIT(0)
  118. #define DP83822_CLK_SRC_MAC_IF 0x0
  119. #define DP83822_CLK_SRC_XI 0x1
  120. #define DP83822_CLK_SRC_INT_REF 0x2
  121. #define DP83822_CLK_SRC_RMII_MASTER_MODE_REF 0x4
  122. #define DP83822_CLK_SRC_FREE_RUNNING 0x6
  123. #define DP83822_CLK_SRC_RECOVERED 0x7
  124. #define DP83822_LED_FN_LINK 0x0 /* Link established */
  125. #define DP83822_LED_FN_RX_TX 0x1 /* Receive or Transmit activity */
  126. #define DP83822_LED_FN_TX 0x2 /* Transmit activity */
  127. #define DP83822_LED_FN_RX 0x3 /* Receive activity */
  128. #define DP83822_LED_FN_COLLISION 0x4 /* Collision detected */
  129. #define DP83822_LED_FN_LINK_100_BTX 0x5 /* 100 BTX link established */
  130. #define DP83822_LED_FN_LINK_10_BT 0x6 /* 10BT link established */
  131. #define DP83822_LED_FN_FULL_DUPLEX 0x7 /* Full duplex */
  132. #define DP83822_LED_FN_LINK_RX_TX 0x8 /* Link established, blink for rx or tx activity */
  133. #define DP83822_LED_FN_ACTIVE_STRETCH 0x9 /* Active Stretch Signal */
  134. #define DP83822_LED_FN_MII_LINK 0xa /* MII LINK (100BT+FD) */
  135. #define DP83822_LED_FN_LPI_MODE 0xb /* LPI Mode (EEE) */
  136. #define DP83822_LED_FN_RX_TX_ERR 0xc /* TX/RX MII Error */
  137. #define DP83822_LED_FN_LINK_LOST 0xd /* Link Lost */
  138. #define DP83822_LED_FN_PRBS_ERR 0xe /* Blink for PRBS error */
  139. /* SOR1 mode */
  140. #define DP83822_STRAP_MODE1 0
  141. #define DP83822_STRAP_MODE2 BIT(0)
  142. #define DP83822_STRAP_MODE3 BIT(1)
  143. #define DP83822_STRAP_MODE4 GENMASK(1, 0)
  144. #define DP83822_COL_STRAP_MASK GENMASK(11, 10)
  145. #define DP83822_COL_SHIFT 10
  146. #define DP83822_RX_ER_STR_MASK GENMASK(9, 8)
  147. #define DP83822_RX_ER_SHIFT 8
  148. /* DP83826: VOD_CFG1 & VOD_CFG2 */
  149. #define DP83826_VOD_CFG1_MINUS_MDIX_MASK GENMASK(13, 12)
  150. #define DP83826_VOD_CFG1_MINUS_MDI_MASK GENMASK(11, 6)
  151. #define DP83826_VOD_CFG2_MINUS_MDIX_MASK GENMASK(15, 12)
  152. #define DP83826_VOD_CFG2_PLUS_MDIX_MASK GENMASK(11, 6)
  153. #define DP83826_VOD_CFG2_PLUS_MDI_MASK GENMASK(5, 0)
  154. #define DP83826_CFG_DAC_MINUS_MDIX_5_TO_4 GENMASK(5, 4)
  155. #define DP83826_CFG_DAC_MINUS_MDIX_3_TO_0 GENMASK(3, 0)
  156. #define DP83826_CFG_DAC_PERCENT_PER_STEP 625
  157. #define DP83826_CFG_DAC_PERCENT_DEFAULT 10000
  158. #define DP83826_CFG_DAC_MINUS_DEFAULT 0x30
  159. #define DP83826_CFG_DAC_PLUS_DEFAULT 0x10
  160. #define MII_DP83822_FIBER_ADVERTISE (ADVERTISED_TP | ADVERTISED_MII | \
  161. ADVERTISED_FIBRE | \
  162. ADVERTISED_Pause | ADVERTISED_Asym_Pause)
  163. #define DP83822_MAX_LED_PINS 4
  164. #define DP83822_LED_INDEX_LED_0 0
  165. #define DP83822_LED_INDEX_LED_1_GPIO1 1
  166. #define DP83822_LED_INDEX_COL_GPIO2 2
  167. #define DP83822_LED_INDEX_RX_D3_GPIO3 3
  168. struct dp83822_private {
  169. bool fx_signal_det_low;
  170. int fx_enabled;
  171. u16 fx_sd_enable;
  172. u8 cfg_dac_minus;
  173. u8 cfg_dac_plus;
  174. struct ethtool_wolinfo wol;
  175. bool set_gpio2_clk_out;
  176. u32 gpio2_clk_out;
  177. bool led_pin_enable[DP83822_MAX_LED_PINS];
  178. int tx_amplitude_100base_tx_index;
  179. int mac_termination_index;
  180. };
  181. static int dp83822_config_wol(struct phy_device *phydev,
  182. struct ethtool_wolinfo *wol)
  183. {
  184. struct net_device *ndev = phydev->attached_dev;
  185. u16 value;
  186. const u8 *mac;
  187. if (wol->wolopts & (WAKE_MAGIC | WAKE_MAGICSECURE)) {
  188. mac = (const u8 *)ndev->dev_addr;
  189. if (!is_valid_ether_addr(mac))
  190. return -EINVAL;
  191. /* MAC addresses start with byte 5, but stored in mac[0].
  192. * 822 PHYs store bytes 4|5, 2|3, 0|1
  193. */
  194. phy_write_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_WOL_DA1,
  195. (mac[1] << 8) | mac[0]);
  196. phy_write_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_WOL_DA2,
  197. (mac[3] << 8) | mac[2]);
  198. phy_write_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_WOL_DA3,
  199. (mac[5] << 8) | mac[4]);
  200. value = phy_read_mmd(phydev, MDIO_MMD_VEND2,
  201. MII_DP83822_WOL_CFG);
  202. if (wol->wolopts & WAKE_MAGIC)
  203. value |= DP83822_WOL_MAGIC_EN;
  204. else
  205. value &= ~DP83822_WOL_MAGIC_EN;
  206. if (wol->wolopts & WAKE_MAGICSECURE) {
  207. phy_write_mmd(phydev, MDIO_MMD_VEND2,
  208. MII_DP83822_RXSOP1,
  209. (wol->sopass[1] << 8) | wol->sopass[0]);
  210. phy_write_mmd(phydev, MDIO_MMD_VEND2,
  211. MII_DP83822_RXSOP2,
  212. (wol->sopass[3] << 8) | wol->sopass[2]);
  213. phy_write_mmd(phydev, MDIO_MMD_VEND2,
  214. MII_DP83822_RXSOP3,
  215. (wol->sopass[5] << 8) | wol->sopass[4]);
  216. value |= DP83822_WOL_SECURE_ON;
  217. } else {
  218. value &= ~DP83822_WOL_SECURE_ON;
  219. }
  220. /* Clear any pending WoL interrupt */
  221. phy_read(phydev, MII_DP83822_MISR2);
  222. value |= DP83822_WOL_EN | DP83822_WOL_INDICATION_SEL |
  223. DP83822_WOL_CLR_INDICATION;
  224. return phy_write_mmd(phydev, MDIO_MMD_VEND2,
  225. MII_DP83822_WOL_CFG, value);
  226. } else {
  227. return phy_clear_bits_mmd(phydev, MDIO_MMD_VEND2,
  228. MII_DP83822_WOL_CFG,
  229. DP83822_WOL_EN |
  230. DP83822_WOL_MAGIC_EN |
  231. DP83822_WOL_SECURE_ON);
  232. }
  233. }
  234. static int dp83822_set_wol(struct phy_device *phydev,
  235. struct ethtool_wolinfo *wol)
  236. {
  237. struct dp83822_private *dp83822 = phydev->priv;
  238. int ret;
  239. ret = dp83822_config_wol(phydev, wol);
  240. if (!ret)
  241. memcpy(&dp83822->wol, wol, sizeof(*wol));
  242. return ret;
  243. }
  244. static void dp83822_get_wol(struct phy_device *phydev,
  245. struct ethtool_wolinfo *wol)
  246. {
  247. int value;
  248. u16 sopass_val;
  249. wol->supported = (WAKE_MAGIC | WAKE_MAGICSECURE);
  250. wol->wolopts = 0;
  251. value = phy_read_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_WOL_CFG);
  252. if (value & DP83822_WOL_MAGIC_EN)
  253. wol->wolopts |= WAKE_MAGIC;
  254. if (value & DP83822_WOL_SECURE_ON) {
  255. sopass_val = phy_read_mmd(phydev, MDIO_MMD_VEND2,
  256. MII_DP83822_RXSOP1);
  257. wol->sopass[0] = (sopass_val & 0xff);
  258. wol->sopass[1] = (sopass_val >> 8);
  259. sopass_val = phy_read_mmd(phydev, MDIO_MMD_VEND2,
  260. MII_DP83822_RXSOP2);
  261. wol->sopass[2] = (sopass_val & 0xff);
  262. wol->sopass[3] = (sopass_val >> 8);
  263. sopass_val = phy_read_mmd(phydev, MDIO_MMD_VEND2,
  264. MII_DP83822_RXSOP3);
  265. wol->sopass[4] = (sopass_val & 0xff);
  266. wol->sopass[5] = (sopass_val >> 8);
  267. wol->wolopts |= WAKE_MAGICSECURE;
  268. }
  269. /* WoL is not enabled so set wolopts to 0 */
  270. if (!(value & DP83822_WOL_EN))
  271. wol->wolopts = 0;
  272. }
  273. static int dp83822_config_intr(struct phy_device *phydev)
  274. {
  275. struct dp83822_private *dp83822 = phydev->priv;
  276. int misr_status;
  277. int physcr_status;
  278. int err;
  279. if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  280. misr_status = phy_read(phydev, MII_DP83822_MISR1);
  281. if (misr_status < 0)
  282. return misr_status;
  283. misr_status |= (DP83822_LINK_STAT_INT_EN |
  284. DP83822_ENERGY_DET_INT_EN |
  285. DP83822_LINK_QUAL_INT_EN);
  286. if (!dp83822->fx_enabled)
  287. misr_status |= DP83822_ANEG_COMPLETE_INT_EN |
  288. DP83822_DUP_MODE_CHANGE_INT_EN |
  289. DP83822_SPEED_CHANGED_INT_EN;
  290. err = phy_write(phydev, MII_DP83822_MISR1, misr_status);
  291. if (err < 0)
  292. return err;
  293. misr_status = phy_read(phydev, MII_DP83822_MISR2);
  294. if (misr_status < 0)
  295. return misr_status;
  296. misr_status |= (DP83822_JABBER_DET_INT_EN |
  297. DP83822_SLEEP_MODE_INT_EN |
  298. DP83822_LB_FIFO_INT_EN |
  299. DP83822_PAGE_RX_INT_EN |
  300. DP83822_EEE_ERROR_CHANGE_INT_EN);
  301. if (!dp83822->fx_enabled)
  302. misr_status |= DP83822_ANEG_ERR_INT_EN |
  303. DP83822_WOL_PKT_INT_EN;
  304. err = phy_write(phydev, MII_DP83822_MISR2, misr_status);
  305. if (err < 0)
  306. return err;
  307. physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
  308. if (physcr_status < 0)
  309. return physcr_status;
  310. physcr_status |= DP83822_PHYSCR_INT_OE | DP83822_PHYSCR_INTEN;
  311. } else {
  312. err = phy_write(phydev, MII_DP83822_MISR1, 0);
  313. if (err < 0)
  314. return err;
  315. err = phy_write(phydev, MII_DP83822_MISR2, 0);
  316. if (err < 0)
  317. return err;
  318. physcr_status = phy_read(phydev, MII_DP83822_PHYSCR);
  319. if (physcr_status < 0)
  320. return physcr_status;
  321. physcr_status &= ~DP83822_PHYSCR_INTEN;
  322. }
  323. return phy_write(phydev, MII_DP83822_PHYSCR, physcr_status);
  324. }
  325. static irqreturn_t dp83822_handle_interrupt(struct phy_device *phydev)
  326. {
  327. bool trigger_machine = false;
  328. int irq_status;
  329. /* The MISR1 and MISR2 registers are holding the interrupt status in
  330. * the upper half (15:8), while the lower half (7:0) is used for
  331. * controlling the interrupt enable state of those individual interrupt
  332. * sources. To determine the possible interrupt sources, just read the
  333. * MISR* register and use it directly to know which interrupts have
  334. * been enabled previously or not.
  335. */
  336. irq_status = phy_read(phydev, MII_DP83822_MISR1);
  337. if (irq_status < 0) {
  338. phy_error(phydev);
  339. return IRQ_NONE;
  340. }
  341. if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
  342. trigger_machine = true;
  343. irq_status = phy_read(phydev, MII_DP83822_MISR2);
  344. if (irq_status < 0) {
  345. phy_error(phydev);
  346. return IRQ_NONE;
  347. }
  348. if (irq_status & ((irq_status & GENMASK(7, 0)) << 8))
  349. trigger_machine = true;
  350. if (!trigger_machine)
  351. return IRQ_NONE;
  352. phy_trigger_machine(phydev);
  353. return IRQ_HANDLED;
  354. }
  355. static int dp83822_read_status(struct phy_device *phydev)
  356. {
  357. struct dp83822_private *dp83822 = phydev->priv;
  358. int status = phy_read(phydev, MII_DP83822_PHYSTS);
  359. int ctrl2;
  360. int ret;
  361. if (dp83822->fx_enabled) {
  362. if (status & DP83822_PHYSTS_LINK) {
  363. phydev->speed = SPEED_UNKNOWN;
  364. phydev->duplex = DUPLEX_UNKNOWN;
  365. } else {
  366. ctrl2 = phy_read(phydev, MII_DP83822_CTRL_2);
  367. if (ctrl2 < 0)
  368. return ctrl2;
  369. if (!(ctrl2 & DP83822_FX_ENABLE)) {
  370. ret = phy_write(phydev, MII_DP83822_CTRL_2,
  371. DP83822_FX_ENABLE | ctrl2);
  372. if (ret < 0)
  373. return ret;
  374. }
  375. }
  376. }
  377. ret = genphy_read_status(phydev);
  378. if (ret)
  379. return ret;
  380. if (status < 0)
  381. return status;
  382. if (status & DP83822_PHYSTS_DUPLEX)
  383. phydev->duplex = DUPLEX_FULL;
  384. else
  385. phydev->duplex = DUPLEX_HALF;
  386. if (status & DP83822_PHYSTS_10)
  387. phydev->speed = SPEED_10;
  388. else
  389. phydev->speed = SPEED_100;
  390. return 0;
  391. }
  392. static int dp83822_config_init_leds(struct phy_device *phydev)
  393. {
  394. struct dp83822_private *dp83822 = phydev->priv;
  395. int ret;
  396. if (dp83822->led_pin_enable[DP83822_LED_INDEX_LED_0]) {
  397. ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_MLEDCR,
  398. DP83822_MLEDCR_ROUTE,
  399. FIELD_PREP(DP83822_MLEDCR_ROUTE,
  400. DP83822_MLEDCR_ROUTE_LED_0));
  401. if (ret)
  402. return ret;
  403. } else if (dp83822->led_pin_enable[DP83822_LED_INDEX_COL_GPIO2]) {
  404. ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_IOCTRL2,
  405. DP83822_IOCTRL2_GPIO2_CTRL,
  406. FIELD_PREP(DP83822_IOCTRL2_GPIO2_CTRL,
  407. DP83822_IOCTRL2_GPIO2_CTRL_MLED));
  408. if (ret)
  409. return ret;
  410. }
  411. if (dp83822->led_pin_enable[DP83822_LED_INDEX_LED_1_GPIO1]) {
  412. ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_IOCTRL1,
  413. DP83822_IOCTRL1_GPIO1_CTRL,
  414. FIELD_PREP(DP83822_IOCTRL1_GPIO1_CTRL,
  415. DP83822_IOCTRL1_GPIO1_CTRL_LED_1));
  416. if (ret)
  417. return ret;
  418. }
  419. if (dp83822->led_pin_enable[DP83822_LED_INDEX_RX_D3_GPIO3]) {
  420. ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_IOCTRL1,
  421. DP83822_IOCTRL1_GPIO3_CTRL,
  422. FIELD_PREP(DP83822_IOCTRL1_GPIO3_CTRL,
  423. DP83822_IOCTRL1_GPIO3_CTRL_LED3));
  424. if (ret)
  425. return ret;
  426. }
  427. return 0;
  428. }
  429. static int dp83822_config_init(struct phy_device *phydev)
  430. {
  431. struct dp83822_private *dp83822 = phydev->priv;
  432. int rgmii_delay = 0;
  433. s32 rx_int_delay;
  434. s32 tx_int_delay;
  435. int err = 0;
  436. int bmcr;
  437. if (dp83822->set_gpio2_clk_out)
  438. phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_IOCTRL2,
  439. DP83822_IOCTRL2_GPIO2_CTRL |
  440. DP83822_IOCTRL2_GPIO2_CLK_SRC,
  441. FIELD_PREP(DP83822_IOCTRL2_GPIO2_CTRL,
  442. DP83822_IOCTRL2_GPIO2_CTRL_CLK_REF) |
  443. FIELD_PREP(DP83822_IOCTRL2_GPIO2_CLK_SRC,
  444. dp83822->gpio2_clk_out));
  445. if (dp83822->tx_amplitude_100base_tx_index >= 0)
  446. phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_LDCTRL,
  447. DP83822_100BASE_TX_LINE_DRIVER_SWING,
  448. FIELD_PREP(DP83822_100BASE_TX_LINE_DRIVER_SWING,
  449. dp83822->tx_amplitude_100base_tx_index));
  450. if (dp83822->mac_termination_index >= 0)
  451. phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_IOCTRL,
  452. DP83822_IOCTRL_MAC_IMPEDANCE_CTRL,
  453. FIELD_PREP(DP83822_IOCTRL_MAC_IMPEDANCE_CTRL,
  454. dp83822->mac_termination_index));
  455. err = dp83822_config_init_leds(phydev);
  456. if (err)
  457. return err;
  458. if (phy_interface_is_rgmii(phydev)) {
  459. rx_int_delay = phy_get_internal_delay(phydev, NULL, 0, true);
  460. /* Set DP83822_RX_CLK_SHIFT to enable rx clk internal delay */
  461. if (rx_int_delay > 0)
  462. rgmii_delay |= DP83822_RX_CLK_SHIFT;
  463. tx_int_delay = phy_get_internal_delay(phydev, NULL, 0, false);
  464. /* Set DP83822_TX_CLK_SHIFT to disable tx clk internal delay */
  465. if (tx_int_delay <= 0)
  466. rgmii_delay |= DP83822_TX_CLK_SHIFT;
  467. err = phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_RCSR,
  468. DP83822_RX_CLK_SHIFT | DP83822_TX_CLK_SHIFT, rgmii_delay);
  469. if (err)
  470. return err;
  471. err = phy_set_bits_mmd(phydev, MDIO_MMD_VEND2,
  472. MII_DP83822_RCSR, DP83822_RGMII_MODE_EN);
  473. if (err)
  474. return err;
  475. } else {
  476. err = phy_clear_bits_mmd(phydev, MDIO_MMD_VEND2,
  477. MII_DP83822_RCSR, DP83822_RGMII_MODE_EN);
  478. if (err)
  479. return err;
  480. }
  481. if (dp83822->fx_enabled) {
  482. err = phy_modify(phydev, MII_DP83822_CTRL_2,
  483. DP83822_FX_ENABLE, 1);
  484. if (err < 0)
  485. return err;
  486. /* Only allow advertising what this PHY supports */
  487. linkmode_and(phydev->advertising, phydev->advertising,
  488. phydev->supported);
  489. linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT,
  490. phydev->supported);
  491. linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT,
  492. phydev->advertising);
  493. linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Full_BIT,
  494. phydev->supported);
  495. linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Half_BIT,
  496. phydev->supported);
  497. linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Full_BIT,
  498. phydev->advertising);
  499. linkmode_set_bit(ETHTOOL_LINK_MODE_100baseFX_Half_BIT,
  500. phydev->advertising);
  501. /* Auto neg is not supported in fiber mode */
  502. bmcr = phy_read(phydev, MII_BMCR);
  503. if (bmcr < 0)
  504. return bmcr;
  505. if (bmcr & BMCR_ANENABLE) {
  506. err = phy_modify(phydev, MII_BMCR, BMCR_ANENABLE, 0);
  507. if (err < 0)
  508. return err;
  509. }
  510. phydev->autoneg = AUTONEG_DISABLE;
  511. linkmode_clear_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
  512. phydev->supported);
  513. linkmode_clear_bit(ETHTOOL_LINK_MODE_Autoneg_BIT,
  514. phydev->advertising);
  515. /* Setup fiber advertisement */
  516. err = phy_modify_changed(phydev, MII_ADVERTISE,
  517. MII_DP83822_FIBER_ADVERTISE,
  518. MII_DP83822_FIBER_ADVERTISE);
  519. if (err < 0)
  520. return err;
  521. if (dp83822->fx_signal_det_low) {
  522. err = phy_set_bits_mmd(phydev, MDIO_MMD_VEND2,
  523. MII_DP83822_GENCFG,
  524. DP83822_SIG_DET_LOW);
  525. if (err)
  526. return err;
  527. }
  528. }
  529. return dp83822_config_wol(phydev, &dp83822->wol);
  530. }
  531. static int dp8382x_config_rmii_mode(struct phy_device *phydev)
  532. {
  533. struct device *dev = &phydev->mdio.dev;
  534. const char *of_val;
  535. int ret;
  536. if (!device_property_read_string(dev, "ti,rmii-mode", &of_val)) {
  537. if (strcmp(of_val, "master") == 0) {
  538. ret = phy_clear_bits_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_RCSR,
  539. DP83822_RMII_MODE_SEL);
  540. } else if (strcmp(of_val, "slave") == 0) {
  541. ret = phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_RCSR,
  542. DP83822_RMII_MODE_SEL);
  543. } else {
  544. phydev_err(phydev, "Invalid value for ti,rmii-mode property (%s)\n",
  545. of_val);
  546. ret = -EINVAL;
  547. }
  548. if (ret)
  549. return ret;
  550. }
  551. return 0;
  552. }
  553. static int dp83826_config_init(struct phy_device *phydev)
  554. {
  555. struct dp83822_private *dp83822 = phydev->priv;
  556. u16 val, mask;
  557. int ret;
  558. if (phydev->interface == PHY_INTERFACE_MODE_RMII) {
  559. ret = phy_set_bits_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_RCSR,
  560. DP83822_RMII_MODE_EN);
  561. if (ret)
  562. return ret;
  563. ret = dp8382x_config_rmii_mode(phydev);
  564. if (ret)
  565. return ret;
  566. } else {
  567. ret = phy_clear_bits_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_RCSR,
  568. DP83822_RMII_MODE_EN);
  569. if (ret)
  570. return ret;
  571. }
  572. if (dp83822->cfg_dac_minus != DP83826_CFG_DAC_MINUS_DEFAULT) {
  573. val = FIELD_PREP(DP83826_VOD_CFG1_MINUS_MDI_MASK, dp83822->cfg_dac_minus) |
  574. FIELD_PREP(DP83826_VOD_CFG1_MINUS_MDIX_MASK,
  575. FIELD_GET(DP83826_CFG_DAC_MINUS_MDIX_5_TO_4,
  576. dp83822->cfg_dac_minus));
  577. mask = DP83826_VOD_CFG1_MINUS_MDIX_MASK | DP83826_VOD_CFG1_MINUS_MDI_MASK;
  578. ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83826_VOD_CFG1, mask, val);
  579. if (ret)
  580. return ret;
  581. val = FIELD_PREP(DP83826_VOD_CFG2_MINUS_MDIX_MASK,
  582. FIELD_GET(DP83826_CFG_DAC_MINUS_MDIX_3_TO_0,
  583. dp83822->cfg_dac_minus));
  584. mask = DP83826_VOD_CFG2_MINUS_MDIX_MASK;
  585. ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83826_VOD_CFG2, mask, val);
  586. if (ret)
  587. return ret;
  588. }
  589. if (dp83822->cfg_dac_plus != DP83826_CFG_DAC_PLUS_DEFAULT) {
  590. val = FIELD_PREP(DP83826_VOD_CFG2_PLUS_MDIX_MASK, dp83822->cfg_dac_plus) |
  591. FIELD_PREP(DP83826_VOD_CFG2_PLUS_MDI_MASK, dp83822->cfg_dac_plus);
  592. mask = DP83826_VOD_CFG2_PLUS_MDIX_MASK | DP83826_VOD_CFG2_PLUS_MDI_MASK;
  593. ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2, MII_DP83826_VOD_CFG2, mask, val);
  594. if (ret)
  595. return ret;
  596. }
  597. return dp83822_config_wol(phydev, &dp83822->wol);
  598. }
  599. static int dp83825_config_init(struct phy_device *phydev)
  600. {
  601. struct dp83822_private *dp83822 = phydev->priv;
  602. int ret;
  603. ret = dp8382x_config_rmii_mode(phydev);
  604. if (ret)
  605. return ret;
  606. return dp83822_config_wol(phydev, &dp83822->wol);
  607. }
  608. static int dp83822_phy_reset(struct phy_device *phydev)
  609. {
  610. int err;
  611. err = phy_write(phydev, MII_DP83822_RESET_CTRL, DP83822_SW_RESET);
  612. if (err < 0)
  613. return err;
  614. return phydev->drv->config_init(phydev);
  615. }
  616. #if IS_ENABLED(CONFIG_OF_MDIO)
  617. static const u32 tx_amplitude_100base_tx_gain[] = {
  618. 80, 82, 83, 85, 87, 88, 90, 92,
  619. 93, 95, 97, 98, 100, 102, 103, 105,
  620. };
  621. static const u32 mac_termination[] = {
  622. 99, 91, 84, 78, 73, 69, 65, 61, 58, 55, 53, 50, 48, 46, 44, 43,
  623. };
  624. static int dp83822_of_init_leds(struct phy_device *phydev)
  625. {
  626. struct device_node *node = phydev->mdio.dev.of_node;
  627. struct dp83822_private *dp83822 = phydev->priv;
  628. struct device_node *leds;
  629. u32 index;
  630. int err;
  631. if (!node)
  632. return 0;
  633. leds = of_get_child_by_name(node, "leds");
  634. if (!leds)
  635. return 0;
  636. for_each_available_child_of_node_scoped(leds, led) {
  637. err = of_property_read_u32(led, "reg", &index);
  638. if (err) {
  639. of_node_put(leds);
  640. return err;
  641. }
  642. if (index <= DP83822_LED_INDEX_RX_D3_GPIO3) {
  643. dp83822->led_pin_enable[index] = true;
  644. } else {
  645. of_node_put(leds);
  646. return -EINVAL;
  647. }
  648. }
  649. of_node_put(leds);
  650. /* LED_0 and COL(GPIO2) use the MLED function. MLED can be routed to
  651. * only one of these two pins at a time.
  652. */
  653. if (dp83822->led_pin_enable[DP83822_LED_INDEX_LED_0] &&
  654. dp83822->led_pin_enable[DP83822_LED_INDEX_COL_GPIO2]) {
  655. phydev_err(phydev, "LED_0 and COL(GPIO2) cannot be used as LED output at the same time\n");
  656. return -EINVAL;
  657. }
  658. if (dp83822->led_pin_enable[DP83822_LED_INDEX_COL_GPIO2] &&
  659. dp83822->set_gpio2_clk_out) {
  660. phydev_err(phydev, "COL(GPIO2) cannot be used as LED output, already used as clock output\n");
  661. return -EINVAL;
  662. }
  663. if (dp83822->led_pin_enable[DP83822_LED_INDEX_RX_D3_GPIO3] &&
  664. phydev->interface != PHY_INTERFACE_MODE_RMII) {
  665. phydev_err(phydev, "RX_D3 can only be used as LED output when in RMII mode\n");
  666. return -EINVAL;
  667. }
  668. return 0;
  669. }
  670. static int dp83822_of_init(struct phy_device *phydev)
  671. {
  672. struct dp83822_private *dp83822 = phydev->priv;
  673. struct device *dev = &phydev->mdio.dev;
  674. const char *of_val;
  675. int i, ret;
  676. u32 val;
  677. if (!device_property_read_string(dev, "ti,gpio2-clk-out", &of_val)) {
  678. if (strcmp(of_val, "mac-if") == 0) {
  679. dp83822->gpio2_clk_out = DP83822_CLK_SRC_MAC_IF;
  680. } else if (strcmp(of_val, "xi") == 0) {
  681. dp83822->gpio2_clk_out = DP83822_CLK_SRC_XI;
  682. } else if (strcmp(of_val, "int-ref") == 0) {
  683. dp83822->gpio2_clk_out = DP83822_CLK_SRC_INT_REF;
  684. } else if (strcmp(of_val, "rmii-master-mode-ref") == 0) {
  685. dp83822->gpio2_clk_out = DP83822_CLK_SRC_RMII_MASTER_MODE_REF;
  686. } else if (strcmp(of_val, "free-running") == 0) {
  687. dp83822->gpio2_clk_out = DP83822_CLK_SRC_FREE_RUNNING;
  688. } else if (strcmp(of_val, "recovered") == 0) {
  689. dp83822->gpio2_clk_out = DP83822_CLK_SRC_RECOVERED;
  690. } else {
  691. phydev_err(phydev,
  692. "Invalid value for ti,gpio2-clk-out property (%s)\n",
  693. of_val);
  694. return -EINVAL;
  695. }
  696. dp83822->set_gpio2_clk_out = true;
  697. }
  698. ret = phy_get_tx_amplitude_gain(phydev, dev,
  699. ETHTOOL_LINK_MODE_100baseT_Full_BIT,
  700. &val);
  701. if (!ret) {
  702. for (i = 0; i < ARRAY_SIZE(tx_amplitude_100base_tx_gain); i++) {
  703. if (tx_amplitude_100base_tx_gain[i] == val) {
  704. dp83822->tx_amplitude_100base_tx_index = i;
  705. break;
  706. }
  707. }
  708. if (dp83822->tx_amplitude_100base_tx_index < 0) {
  709. phydev_err(phydev,
  710. "Invalid value for tx-amplitude-100base-tx-percent property (%u)\n",
  711. val);
  712. return -EINVAL;
  713. }
  714. }
  715. ret = phy_get_mac_termination(phydev, dev, &val);
  716. if (!ret) {
  717. for (i = 0; i < ARRAY_SIZE(mac_termination); i++) {
  718. if (mac_termination[i] == val) {
  719. dp83822->mac_termination_index = i;
  720. break;
  721. }
  722. }
  723. if (dp83822->mac_termination_index < 0) {
  724. phydev_err(phydev,
  725. "Invalid value for mac-termination-ohms property (%u)\n",
  726. val);
  727. return -EINVAL;
  728. }
  729. }
  730. return dp83822_of_init_leds(phydev);
  731. }
  732. static int dp83826_to_dac_minus_one_regval(int percent)
  733. {
  734. int tmp = DP83826_CFG_DAC_PERCENT_DEFAULT - percent;
  735. return tmp / DP83826_CFG_DAC_PERCENT_PER_STEP;
  736. }
  737. static int dp83826_to_dac_plus_one_regval(int percent)
  738. {
  739. int tmp = percent - DP83826_CFG_DAC_PERCENT_DEFAULT;
  740. return tmp / DP83826_CFG_DAC_PERCENT_PER_STEP;
  741. }
  742. static void dp83826_of_init(struct phy_device *phydev)
  743. {
  744. struct dp83822_private *dp83822 = phydev->priv;
  745. struct device *dev = &phydev->mdio.dev;
  746. u32 val;
  747. dp83822->cfg_dac_minus = DP83826_CFG_DAC_MINUS_DEFAULT;
  748. if (!device_property_read_u32(dev, "ti,cfg-dac-minus-one-bp", &val))
  749. dp83822->cfg_dac_minus += dp83826_to_dac_minus_one_regval(val);
  750. dp83822->cfg_dac_plus = DP83826_CFG_DAC_PLUS_DEFAULT;
  751. if (!device_property_read_u32(dev, "ti,cfg-dac-plus-one-bp", &val))
  752. dp83822->cfg_dac_plus += dp83826_to_dac_plus_one_regval(val);
  753. }
  754. #else
  755. static int dp83822_of_init(struct phy_device *phydev)
  756. {
  757. return 0;
  758. }
  759. static void dp83826_of_init(struct phy_device *phydev)
  760. {
  761. }
  762. #endif /* CONFIG_OF_MDIO */
  763. static int dp83822_read_straps(struct phy_device *phydev)
  764. {
  765. struct dp83822_private *dp83822 = phydev->priv;
  766. int fx_enabled, fx_sd_enable;
  767. int val;
  768. val = phy_read_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_SOR1);
  769. if (val < 0)
  770. return val;
  771. phydev_dbg(phydev, "SOR1 strap register: 0x%04x\n", val);
  772. fx_enabled = (val & DP83822_COL_STRAP_MASK) >> DP83822_COL_SHIFT;
  773. if (fx_enabled == DP83822_STRAP_MODE2 ||
  774. fx_enabled == DP83822_STRAP_MODE3)
  775. dp83822->fx_enabled = 1;
  776. if (dp83822->fx_enabled) {
  777. fx_sd_enable = (val & DP83822_RX_ER_STR_MASK) >> DP83822_RX_ER_SHIFT;
  778. if (fx_sd_enable == DP83822_STRAP_MODE3 ||
  779. fx_sd_enable == DP83822_STRAP_MODE4)
  780. dp83822->fx_sd_enable = 1;
  781. }
  782. return 0;
  783. }
  784. static int dp83822_attach_mdi_port(struct phy_device *phydev,
  785. struct phy_port *port)
  786. {
  787. struct dp83822_private *dp83822 = phydev->priv;
  788. int ret;
  789. if (port->mediums) {
  790. if (phy_port_is_fiber(port))
  791. dp83822->fx_enabled = true;
  792. } else {
  793. ret = dp83822_read_straps(phydev);
  794. if (ret)
  795. return ret;
  796. #if IS_ENABLED(CONFIG_OF_MDIO)
  797. if (dp83822->fx_enabled && dp83822->fx_sd_enable)
  798. dp83822->fx_signal_det_low =
  799. device_property_present(&phydev->mdio.dev,
  800. "ti,link-loss-low");
  801. /* ti,fiber-mode is still used for backwards compatibility, but
  802. * has been replaced with the mdi node definition, see
  803. * ethernet-port.yaml
  804. */
  805. if (!dp83822->fx_enabled)
  806. dp83822->fx_enabled =
  807. device_property_present(&phydev->mdio.dev,
  808. "ti,fiber-mode");
  809. #endif /* CONFIG_OF_MDIO */
  810. if (dp83822->fx_enabled) {
  811. port->mediums = BIT(ETHTOOL_LINK_MEDIUM_BASEF);
  812. } else {
  813. /* This PHY can only to 100BaseTX max, so on 2 pairs */
  814. port->pairs = 2;
  815. port->mediums = BIT(ETHTOOL_LINK_MEDIUM_BASET);
  816. }
  817. }
  818. return 0;
  819. }
  820. static int dp8382x_probe(struct phy_device *phydev)
  821. {
  822. struct dp83822_private *dp83822;
  823. dp83822 = devm_kzalloc(&phydev->mdio.dev, sizeof(*dp83822),
  824. GFP_KERNEL);
  825. if (!dp83822)
  826. return -ENOMEM;
  827. dp83822->tx_amplitude_100base_tx_index = -1;
  828. dp83822->mac_termination_index = -1;
  829. phydev->priv = dp83822;
  830. return 0;
  831. }
  832. static int dp83822_probe(struct phy_device *phydev)
  833. {
  834. int ret;
  835. ret = dp8382x_probe(phydev);
  836. if (ret)
  837. return ret;
  838. return dp83822_of_init(phydev);
  839. }
  840. static int dp83826_probe(struct phy_device *phydev)
  841. {
  842. int ret;
  843. ret = dp8382x_probe(phydev);
  844. if (ret)
  845. return ret;
  846. dp83826_of_init(phydev);
  847. return 0;
  848. }
  849. static int dp83822_suspend(struct phy_device *phydev)
  850. {
  851. int value;
  852. value = phy_read_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_WOL_CFG);
  853. if (!(value & DP83822_WOL_EN))
  854. genphy_suspend(phydev);
  855. return 0;
  856. }
  857. static int dp83822_resume(struct phy_device *phydev)
  858. {
  859. int value;
  860. genphy_resume(phydev);
  861. value = phy_read_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_WOL_CFG);
  862. phy_write_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_WOL_CFG, value |
  863. DP83822_WOL_CLR_INDICATION);
  864. return 0;
  865. }
  866. static int dp83822_led_mode(u8 index, unsigned long rules)
  867. {
  868. switch (rules) {
  869. case BIT(TRIGGER_NETDEV_LINK):
  870. return DP83822_LED_FN_LINK;
  871. case BIT(TRIGGER_NETDEV_LINK_10):
  872. return DP83822_LED_FN_LINK_10_BT;
  873. case BIT(TRIGGER_NETDEV_LINK_100):
  874. return DP83822_LED_FN_LINK_100_BTX;
  875. case BIT(TRIGGER_NETDEV_FULL_DUPLEX):
  876. return DP83822_LED_FN_FULL_DUPLEX;
  877. case BIT(TRIGGER_NETDEV_TX):
  878. return DP83822_LED_FN_TX;
  879. case BIT(TRIGGER_NETDEV_RX):
  880. return DP83822_LED_FN_RX;
  881. case BIT(TRIGGER_NETDEV_TX) | BIT(TRIGGER_NETDEV_RX):
  882. return DP83822_LED_FN_RX_TX;
  883. case BIT(TRIGGER_NETDEV_TX_ERR) | BIT(TRIGGER_NETDEV_RX_ERR):
  884. return DP83822_LED_FN_RX_TX_ERR;
  885. case BIT(TRIGGER_NETDEV_LINK) | BIT(TRIGGER_NETDEV_TX) | BIT(TRIGGER_NETDEV_RX):
  886. return DP83822_LED_FN_LINK_RX_TX;
  887. default:
  888. return -EOPNOTSUPP;
  889. }
  890. }
  891. static int dp83822_led_hw_is_supported(struct phy_device *phydev, u8 index,
  892. unsigned long rules)
  893. {
  894. int mode;
  895. mode = dp83822_led_mode(index, rules);
  896. if (mode < 0)
  897. return mode;
  898. return 0;
  899. }
  900. static int dp83822_led_hw_control_set(struct phy_device *phydev, u8 index,
  901. unsigned long rules)
  902. {
  903. int mode;
  904. mode = dp83822_led_mode(index, rules);
  905. if (mode < 0)
  906. return mode;
  907. if (index == DP83822_LED_INDEX_LED_0 || index == DP83822_LED_INDEX_COL_GPIO2)
  908. return phy_modify_mmd(phydev, MDIO_MMD_VEND2,
  909. MII_DP83822_MLEDCR, DP83822_MLEDCR_CFG,
  910. FIELD_PREP(DP83822_MLEDCR_CFG, mode));
  911. else if (index == DP83822_LED_INDEX_LED_1_GPIO1)
  912. return phy_modify_mmd(phydev, MDIO_MMD_VEND2,
  913. MII_DP83822_LEDCFG1,
  914. DP83822_LEDCFG1_LED1_CTRL,
  915. FIELD_PREP(DP83822_LEDCFG1_LED1_CTRL,
  916. mode));
  917. else
  918. return phy_modify_mmd(phydev, MDIO_MMD_VEND2,
  919. MII_DP83822_LEDCFG1,
  920. DP83822_LEDCFG1_LED3_CTRL,
  921. FIELD_PREP(DP83822_LEDCFG1_LED3_CTRL,
  922. mode));
  923. }
  924. static int dp83822_led_hw_control_get(struct phy_device *phydev, u8 index,
  925. unsigned long *rules)
  926. {
  927. int val;
  928. if (index == DP83822_LED_INDEX_LED_0 || index == DP83822_LED_INDEX_COL_GPIO2) {
  929. val = phy_read_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_MLEDCR);
  930. if (val < 0)
  931. return val;
  932. val = FIELD_GET(DP83822_MLEDCR_CFG, val);
  933. } else {
  934. val = phy_read_mmd(phydev, MDIO_MMD_VEND2, MII_DP83822_LEDCFG1);
  935. if (val < 0)
  936. return val;
  937. if (index == DP83822_LED_INDEX_LED_1_GPIO1)
  938. val = FIELD_GET(DP83822_LEDCFG1_LED1_CTRL, val);
  939. else
  940. val = FIELD_GET(DP83822_LEDCFG1_LED3_CTRL, val);
  941. }
  942. switch (val) {
  943. case DP83822_LED_FN_LINK:
  944. *rules = BIT(TRIGGER_NETDEV_LINK);
  945. break;
  946. case DP83822_LED_FN_LINK_10_BT:
  947. *rules = BIT(TRIGGER_NETDEV_LINK_10);
  948. break;
  949. case DP83822_LED_FN_LINK_100_BTX:
  950. *rules = BIT(TRIGGER_NETDEV_LINK_100);
  951. break;
  952. case DP83822_LED_FN_FULL_DUPLEX:
  953. *rules = BIT(TRIGGER_NETDEV_FULL_DUPLEX);
  954. break;
  955. case DP83822_LED_FN_TX:
  956. *rules = BIT(TRIGGER_NETDEV_TX);
  957. break;
  958. case DP83822_LED_FN_RX:
  959. *rules = BIT(TRIGGER_NETDEV_RX);
  960. break;
  961. case DP83822_LED_FN_RX_TX:
  962. *rules = BIT(TRIGGER_NETDEV_TX) | BIT(TRIGGER_NETDEV_RX);
  963. break;
  964. case DP83822_LED_FN_RX_TX_ERR:
  965. *rules = BIT(TRIGGER_NETDEV_TX_ERR) | BIT(TRIGGER_NETDEV_RX_ERR);
  966. break;
  967. case DP83822_LED_FN_LINK_RX_TX:
  968. *rules = BIT(TRIGGER_NETDEV_LINK) | BIT(TRIGGER_NETDEV_TX) |
  969. BIT(TRIGGER_NETDEV_RX);
  970. break;
  971. default:
  972. *rules = 0;
  973. break;
  974. }
  975. return 0;
  976. }
  977. #define DP83822_PHY_DRIVER(_id, _name) \
  978. { \
  979. PHY_ID_MATCH_MODEL(_id), \
  980. .name = (_name), \
  981. /* PHY_BASIC_FEATURES */ \
  982. .probe = dp83822_probe, \
  983. .soft_reset = dp83822_phy_reset, \
  984. .config_init = dp83822_config_init, \
  985. .read_status = dp83822_read_status, \
  986. .get_wol = dp83822_get_wol, \
  987. .set_wol = dp83822_set_wol, \
  988. .config_intr = dp83822_config_intr, \
  989. .handle_interrupt = dp83822_handle_interrupt, \
  990. .suspend = dp83822_suspend, \
  991. .resume = dp83822_resume, \
  992. .led_hw_is_supported = dp83822_led_hw_is_supported, \
  993. .led_hw_control_set = dp83822_led_hw_control_set, \
  994. .led_hw_control_get = dp83822_led_hw_control_get, \
  995. .attach_mdi_port = dp83822_attach_mdi_port \
  996. }
  997. #define DP83825_PHY_DRIVER(_id, _name) \
  998. { \
  999. PHY_ID_MATCH_MODEL(_id), \
  1000. .name = (_name), \
  1001. /* PHY_BASIC_FEATURES */ \
  1002. .probe = dp8382x_probe, \
  1003. .soft_reset = dp83822_phy_reset, \
  1004. .config_init = dp83825_config_init, \
  1005. .get_wol = dp83822_get_wol, \
  1006. .set_wol = dp83822_set_wol, \
  1007. .config_intr = dp83822_config_intr, \
  1008. .handle_interrupt = dp83822_handle_interrupt, \
  1009. .suspend = dp83822_suspend, \
  1010. .resume = dp83822_resume, \
  1011. }
  1012. #define DP83826_PHY_DRIVER(_id, _name) \
  1013. { \
  1014. PHY_ID_MATCH_MODEL(_id), \
  1015. .name = (_name), \
  1016. /* PHY_BASIC_FEATURES */ \
  1017. .probe = dp83826_probe, \
  1018. .soft_reset = dp83822_phy_reset, \
  1019. .config_init = dp83826_config_init, \
  1020. .get_wol = dp83822_get_wol, \
  1021. .set_wol = dp83822_set_wol, \
  1022. .config_intr = dp83822_config_intr, \
  1023. .handle_interrupt = dp83822_handle_interrupt, \
  1024. .suspend = dp83822_suspend, \
  1025. .resume = dp83822_resume, \
  1026. }
  1027. static struct phy_driver dp83822_driver[] = {
  1028. DP83822_PHY_DRIVER(DP83822_PHY_ID, "TI DP83822"),
  1029. DP83825_PHY_DRIVER(DP83825I_PHY_ID, "TI DP83825I"),
  1030. DP83825_PHY_DRIVER(DP83825S_PHY_ID, "TI DP83825S"),
  1031. DP83825_PHY_DRIVER(DP83825CM_PHY_ID, "TI DP83825M"),
  1032. DP83825_PHY_DRIVER(DP83825CS_PHY_ID, "TI DP83825CS"),
  1033. DP83826_PHY_DRIVER(DP83826C_PHY_ID, "TI DP83826C"),
  1034. DP83826_PHY_DRIVER(DP83826NC_PHY_ID, "TI DP83826NC"),
  1035. };
  1036. module_phy_driver(dp83822_driver);
  1037. static const struct mdio_device_id __maybe_unused dp83822_tbl[] = {
  1038. { DP83822_PHY_ID, 0xfffffff0 },
  1039. { DP83825I_PHY_ID, 0xfffffff0 },
  1040. { DP83826C_PHY_ID, 0xfffffff0 },
  1041. { DP83826NC_PHY_ID, 0xfffffff0 },
  1042. { DP83825S_PHY_ID, 0xfffffff0 },
  1043. { DP83825CM_PHY_ID, 0xfffffff0 },
  1044. { DP83825CS_PHY_ID, 0xfffffff0 },
  1045. { },
  1046. };
  1047. MODULE_DEVICE_TABLE(mdio, dp83822_tbl);
  1048. MODULE_DESCRIPTION("Texas Instruments DP83822 PHY driver");
  1049. MODULE_AUTHOR("Dan Murphy <dmurphy@ti.com");
  1050. MODULE_LICENSE("GPL v2");