realtek_main.c 62 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /* drivers/net/phy/realtek.c
  3. *
  4. * Driver for Realtek PHYs
  5. *
  6. * Author: Johnson Leung <r58129@freescale.com>
  7. *
  8. * Copyright (c) 2004 Freescale Semiconductor, Inc.
  9. */
  10. #include <linux/bitops.h>
  11. #include <linux/ethtool_netlink.h>
  12. #include <linux/of.h>
  13. #include <linux/phy.h>
  14. #include <linux/pm_wakeirq.h>
  15. #include <linux/netdevice.h>
  16. #include <linux/module.h>
  17. #include <linux/delay.h>
  18. #include <linux/clk.h>
  19. #include <linux/string_choices.h>
  20. #include <net/phy/realtek_phy.h>
  21. #include "../phylib.h"
  22. #include "realtek.h"
  23. #define RTL8201F_IER 0x13
  24. #define RTL8201F_ISR 0x1e
  25. #define RTL8201F_ISR_ANERR BIT(15)
  26. #define RTL8201F_ISR_DUPLEX BIT(13)
  27. #define RTL8201F_ISR_LINK BIT(11)
  28. #define RTL8201F_ISR_MASK (RTL8201F_ISR_ANERR | \
  29. RTL8201F_ISR_DUPLEX | \
  30. RTL8201F_ISR_LINK)
  31. #define RTL821x_INER 0x12
  32. #define RTL8211B_INER_INIT 0x6400
  33. #define RTL8211E_INER_LINK_STATUS BIT(10)
  34. #define RTL8211F_INER_PME BIT(7)
  35. #define RTL8211F_INER_LINK_STATUS BIT(4)
  36. #define RTL821x_INSR 0x13
  37. #define RTL821x_EXT_PAGE_SELECT 0x1e
  38. #define RTL821x_PAGE_SELECT 0x1f
  39. #define RTL821x_SET_EXT_PAGE 0x07
  40. /* RTL8211E extension page 44/0x2c */
  41. #define RTL8211E_LEDCR_EXT_PAGE 0x2c
  42. #define RTL8211E_LEDCR1 0x1a
  43. #define RTL8211E_LEDCR1_ACT_TXRX BIT(4)
  44. #define RTL8211E_LEDCR1_MASK BIT(4)
  45. #define RTL8211E_LEDCR1_SHIFT 1
  46. #define RTL8211E_LEDCR2 0x1c
  47. #define RTL8211E_LEDCR2_LINK_1000 BIT(2)
  48. #define RTL8211E_LEDCR2_LINK_100 BIT(1)
  49. #define RTL8211E_LEDCR2_LINK_10 BIT(0)
  50. #define RTL8211E_LEDCR2_MASK GENMASK(2, 0)
  51. #define RTL8211E_LEDCR2_SHIFT 4
  52. /* RTL8211E extension page 164/0xa4 */
  53. #define RTL8211E_RGMII_EXT_PAGE 0xa4
  54. #define RTL8211E_RGMII_DELAY 0x1c
  55. #define RTL8211E_CTRL_DELAY BIT(13)
  56. #define RTL8211E_TX_DELAY BIT(12)
  57. #define RTL8211E_RX_DELAY BIT(11)
  58. #define RTL8211E_DELAY_MASK GENMASK(13, 11)
  59. /* RTL8211F PHY configuration */
  60. #define RTL8211F_PHYCR1 0x18
  61. #define RTL8211F_ALDPS_PLL_OFF BIT(1)
  62. #define RTL8211F_ALDPS_ENABLE BIT(2)
  63. #define RTL8211F_ALDPS_XTAL_OFF BIT(12)
  64. #define RTL8211F_PHYCR2 0x19
  65. #define RTL8211F_CLKOUT_EN BIT(0)
  66. #define RTL8211F_PHYCR2_PHY_EEE_ENABLE BIT(5)
  67. #define RTL8211F_INSR 0x1d
  68. /* RTL8211F LED configuration */
  69. #define RTL8211F_LEDCR_PAGE 0xd04
  70. #define RTL8211F_LEDCR 0x10
  71. #define RTL8211F_LEDCR_MODE BIT(15)
  72. #define RTL8211F_LEDCR_ACT_TXRX BIT(4)
  73. #define RTL8211F_LEDCR_LINK_1000 BIT(3)
  74. #define RTL8211F_LEDCR_LINK_100 BIT(1)
  75. #define RTL8211F_LEDCR_LINK_10 BIT(0)
  76. #define RTL8211F_LEDCR_MASK GENMASK(4, 0)
  77. #define RTL8211F_LEDCR_SHIFT 5
  78. /* RTL8211F(D)(I)-VD-CG CLKOUT configuration is specified via magic values
  79. * to undocumented register pages. The names here do not reflect the datasheet.
  80. * Unlike other PHY models, CLKOUT configuration does not go through PHYCR2.
  81. */
  82. #define RTL8211FVD_CLKOUT_PAGE 0xd05
  83. #define RTL8211FVD_CLKOUT_REG 0x11
  84. #define RTL8211FVD_CLKOUT_EN BIT(8)
  85. /* RTL8211F RGMII configuration */
  86. #define RTL8211F_RGMII_PAGE 0xd08
  87. #define RTL8211F_TXCR 0x11
  88. #define RTL8211F_TX_DELAY BIT(8)
  89. #define RTL8211F_RXCR 0x15
  90. #define RTL8211F_RX_DELAY BIT(3)
  91. /* RTL8211F WOL settings */
  92. #define RTL8211F_WOL_PAGE 0xd8a
  93. #define RTL8211F_WOL_SETTINGS_EVENTS 16
  94. #define RTL8211F_WOL_EVENT_MAGIC BIT(12)
  95. #define RTL8211F_WOL_RST_RMSQ 17
  96. #define RTL8211F_WOL_RG_RSTB BIT(15)
  97. #define RTL8211F_WOL_RMSQ 0x1fff
  98. /* RTL8211F Unique phyiscal and multicast address (WOL) */
  99. #define RTL8211F_PHYSICAL_ADDR_PAGE 0xd8c
  100. #define RTL8211F_PHYSICAL_ADDR_WORD0 16
  101. #define RTL8211F_PHYSICAL_ADDR_WORD1 17
  102. #define RTL8211F_PHYSICAL_ADDR_WORD2 18
  103. #define RTL822X_VND1_SERDES_OPTION 0x697a
  104. #define RTL822X_VND1_SERDES_OPTION_MODE_MASK GENMASK(5, 0)
  105. #define RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII 0
  106. #define RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX 2
  107. #define RTL822X_VND1_SERDES_CTRL3 0x7580
  108. #define RTL822X_VND1_SERDES_CTRL3_MODE_MASK GENMASK(5, 0)
  109. #define RTL822X_VND1_SERDES_CTRL3_MODE_SGMII 0x02
  110. #define RTL822X_VND1_SERDES_CTRL3_MODE_2500BASEX 0x16
  111. #define RTL822X_VND1_SERDES_CMD 0x7587
  112. #define RTL822X_VND1_SERDES_CMD_WRITE BIT(1)
  113. #define RTL822X_VND1_SERDES_CMD_BUSY BIT(0)
  114. #define RTL822X_VND1_SERDES_ADDR 0x7588
  115. #define RTL822X_VND1_SERDES_ADDR_AUTONEG 0x2
  116. #define RTL822X_VND1_SERDES_INBAND_DISABLE 0x71d0
  117. #define RTL822X_VND1_SERDES_INBAND_ENABLE 0x70d0
  118. #define RTL822X_VND1_SERDES_DATA 0x7589
  119. #define RTL822X_VND2_TO_PAGE(reg) ((reg) >> 4)
  120. #define RTL822X_VND2_TO_PAGE_REG(reg) (16 + (((reg) & GENMASK(3, 0)) >> 1))
  121. #define RTL822X_VND2_TO_C22_REG(reg) (((reg) - 0xa400) / 2)
  122. #define RTL822X_VND2_C22_REG(reg) (0xa400 + 2 * (reg))
  123. #define RTL8221B_VND2_INER 0xa4d2
  124. #define RTL8221B_VND2_INER_LINK_STATUS BIT(4)
  125. #define RTL8221B_VND2_INSR 0xa4d4
  126. #define RTL8224_MII_RTCT 0x11
  127. #define RTL8224_MII_RTCT_ENABLE BIT(0)
  128. #define RTL8224_MII_RTCT_PAIR_A BIT(4)
  129. #define RTL8224_MII_RTCT_PAIR_B BIT(5)
  130. #define RTL8224_MII_RTCT_PAIR_C BIT(6)
  131. #define RTL8224_MII_RTCT_PAIR_D BIT(7)
  132. #define RTL8224_MII_RTCT_DONE BIT(15)
  133. #define RTL8224_MII_SRAM_ADDR 0x1b
  134. #define RTL8224_MII_SRAM_DATA 0x1c
  135. #define RTL8224_SRAM_RTCT_FAULT(pair) (0x8026 + (pair) * 4)
  136. #define RTL8224_SRAM_RTCT_FAULT_BUSY BIT(0)
  137. #define RTL8224_SRAM_RTCT_FAULT_OPEN BIT(3)
  138. #define RTL8224_SRAM_RTCT_FAULT_SAME_SHORT BIT(4)
  139. #define RTL8224_SRAM_RTCT_FAULT_OK BIT(5)
  140. #define RTL8224_SRAM_RTCT_FAULT_DONE BIT(6)
  141. #define RTL8224_SRAM_RTCT_FAULT_CROSS_SHORT BIT(7)
  142. #define RTL8224_SRAM_RTCT_LEN(pair) (0x8028 + (pair) * 4)
  143. #define RTL8366RB_POWER_SAVE 0x15
  144. #define RTL8366RB_POWER_SAVE_ON BIT(12)
  145. #define RTL9000A_GINMR 0x14
  146. #define RTL9000A_GINMR_LINK_STATUS BIT(4)
  147. #define RTL_PHYSR MII_RESV2
  148. #define RTL_PHYSR_DUPLEX BIT(3)
  149. #define RTL_PHYSR_SPEEDL GENMASK(5, 4)
  150. #define RTL_PHYSR_SPEEDH GENMASK(10, 9)
  151. #define RTL_PHYSR_MASTER BIT(11)
  152. #define RTL_PHYSR_SPEED_MASK (RTL_PHYSR_SPEEDL | RTL_PHYSR_SPEEDH)
  153. #define RTL_MDIO_PCS_EEE_ABLE 0xa5c4
  154. #define RTL_MDIO_AN_EEE_ADV 0xa5d0
  155. #define RTL_MDIO_AN_EEE_LPABLE 0xa5d2
  156. #define RTL_MDIO_AN_10GBT_CTRL 0xa5d4
  157. #define RTL_MDIO_AN_10GBT_STAT 0xa5d6
  158. #define RTL_MDIO_PMA_SPEED 0xa616
  159. #define RTL_MDIO_AN_EEE_LPABLE2 0xa6d0
  160. #define RTL_MDIO_AN_EEE_ADV2 0xa6d4
  161. #define RTL_MDIO_PCS_EEE_ABLE2 0xa6ec
  162. #define RTL_GENERIC_PHYID 0x001cc800
  163. #define RTL_8211FVD_PHYID 0x001cc878
  164. #define RTL_8221B 0x001cc840
  165. #define RTL_8221B_VB_CG 0x001cc849
  166. #define RTL_8221B_VM_CG 0x001cc84a
  167. #define RTL_8251B 0x001cc862
  168. #define RTL_8261C 0x001cc890
  169. /* RTL8211E and RTL8211F support up to three LEDs */
  170. #define RTL8211x_LED_COUNT 3
  171. MODULE_DESCRIPTION("Realtek PHY driver");
  172. MODULE_AUTHOR("Johnson Leung");
  173. MODULE_LICENSE("GPL");
  174. struct rtl821x_priv {
  175. bool enable_aldps;
  176. bool disable_clk_out;
  177. struct clk *clk;
  178. /* rtl8211f */
  179. u16 iner;
  180. };
  181. static int rtl821x_read_page(struct phy_device *phydev)
  182. {
  183. return __phy_read(phydev, RTL821x_PAGE_SELECT);
  184. }
  185. static int rtl821x_write_page(struct phy_device *phydev, int page)
  186. {
  187. return __phy_write(phydev, RTL821x_PAGE_SELECT, page);
  188. }
  189. static int rtl821x_read_ext_page(struct phy_device *phydev, u16 ext_page,
  190. u32 regnum)
  191. {
  192. int oldpage, ret = 0;
  193. oldpage = phy_select_page(phydev, RTL821x_SET_EXT_PAGE);
  194. if (oldpage >= 0) {
  195. ret = __phy_write(phydev, RTL821x_EXT_PAGE_SELECT, ext_page);
  196. if (ret == 0)
  197. ret = __phy_read(phydev, regnum);
  198. }
  199. return phy_restore_page(phydev, oldpage, ret);
  200. }
  201. static int rtl821x_modify_ext_page(struct phy_device *phydev, u16 ext_page,
  202. u32 regnum, u16 mask, u16 set)
  203. {
  204. int oldpage, ret = 0;
  205. oldpage = phy_select_page(phydev, RTL821x_SET_EXT_PAGE);
  206. if (oldpage >= 0) {
  207. ret = __phy_write(phydev, RTL821x_EXT_PAGE_SELECT, ext_page);
  208. if (ret == 0)
  209. ret = __phy_modify(phydev, regnum, mask, set);
  210. }
  211. return phy_restore_page(phydev, oldpage, ret);
  212. }
  213. static int rtl821x_probe(struct phy_device *phydev)
  214. {
  215. struct device *dev = &phydev->mdio.dev;
  216. struct rtl821x_priv *priv;
  217. priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
  218. if (!priv)
  219. return -ENOMEM;
  220. priv->clk = devm_clk_get_optional_enabled(dev, NULL);
  221. if (IS_ERR(priv->clk))
  222. return dev_err_probe(dev, PTR_ERR(priv->clk),
  223. "failed to get phy clock\n");
  224. priv->enable_aldps = of_property_read_bool(dev->of_node,
  225. "realtek,aldps-enable");
  226. priv->disable_clk_out = of_property_read_bool(dev->of_node,
  227. "realtek,clkout-disable");
  228. phydev->priv = priv;
  229. return 0;
  230. }
  231. static int rtl8211f_probe(struct phy_device *phydev)
  232. {
  233. struct device *dev = &phydev->mdio.dev;
  234. int ret;
  235. ret = rtl821x_probe(phydev);
  236. if (ret < 0)
  237. return ret;
  238. /* Disable all PME events */
  239. ret = phy_write_paged(phydev, RTL8211F_WOL_PAGE,
  240. RTL8211F_WOL_SETTINGS_EVENTS, 0);
  241. if (ret < 0)
  242. return ret;
  243. /* Mark this PHY as wakeup capable and register the interrupt as a
  244. * wakeup IRQ if the PHY is marked as a wakeup source in firmware,
  245. * and the interrupt is valid.
  246. */
  247. if (device_property_read_bool(dev, "wakeup-source") &&
  248. phy_interrupt_is_valid(phydev)) {
  249. device_set_wakeup_capable(dev, true);
  250. devm_pm_set_wake_irq(dev, phydev->irq);
  251. }
  252. return ret;
  253. }
  254. static int rtl8201_ack_interrupt(struct phy_device *phydev)
  255. {
  256. int err;
  257. err = phy_read(phydev, RTL8201F_ISR);
  258. return (err < 0) ? err : 0;
  259. }
  260. static int rtl821x_ack_interrupt(struct phy_device *phydev)
  261. {
  262. int err;
  263. err = phy_read(phydev, RTL821x_INSR);
  264. return (err < 0) ? err : 0;
  265. }
  266. static int rtl8211f_ack_interrupt(struct phy_device *phydev)
  267. {
  268. int err;
  269. err = phy_read(phydev, RTL8211F_INSR);
  270. return (err < 0) ? err : 0;
  271. }
  272. static int rtl8201_config_intr(struct phy_device *phydev)
  273. {
  274. u16 val;
  275. int err;
  276. if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  277. err = rtl8201_ack_interrupt(phydev);
  278. if (err)
  279. return err;
  280. val = BIT(13) | BIT(12) | BIT(11);
  281. err = phy_write_paged(phydev, 0x7, RTL8201F_IER, val);
  282. } else {
  283. val = 0;
  284. err = phy_write_paged(phydev, 0x7, RTL8201F_IER, val);
  285. if (err)
  286. return err;
  287. err = rtl8201_ack_interrupt(phydev);
  288. }
  289. return err;
  290. }
  291. static int rtl8211b_config_intr(struct phy_device *phydev)
  292. {
  293. int err;
  294. if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  295. err = rtl821x_ack_interrupt(phydev);
  296. if (err)
  297. return err;
  298. err = phy_write(phydev, RTL821x_INER,
  299. RTL8211B_INER_INIT);
  300. } else {
  301. err = phy_write(phydev, RTL821x_INER, 0);
  302. if (err)
  303. return err;
  304. err = rtl821x_ack_interrupt(phydev);
  305. }
  306. return err;
  307. }
  308. static int rtl8211e_config_intr(struct phy_device *phydev)
  309. {
  310. int err;
  311. if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  312. err = rtl821x_ack_interrupt(phydev);
  313. if (err)
  314. return err;
  315. err = phy_write(phydev, RTL821x_INER,
  316. RTL8211E_INER_LINK_STATUS);
  317. } else {
  318. err = phy_write(phydev, RTL821x_INER, 0);
  319. if (err)
  320. return err;
  321. err = rtl821x_ack_interrupt(phydev);
  322. }
  323. return err;
  324. }
  325. static int rtl8211f_config_intr(struct phy_device *phydev)
  326. {
  327. struct rtl821x_priv *priv = phydev->priv;
  328. u16 val;
  329. int err;
  330. if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  331. err = rtl8211f_ack_interrupt(phydev);
  332. if (err)
  333. return err;
  334. val = RTL8211F_INER_LINK_STATUS;
  335. err = phy_write_paged(phydev, 0xa42, RTL821x_INER, val);
  336. if (err == 0)
  337. priv->iner = val;
  338. } else {
  339. priv->iner = val = 0;
  340. err = phy_write_paged(phydev, 0xa42, RTL821x_INER, val);
  341. if (err)
  342. return err;
  343. err = rtl8211f_ack_interrupt(phydev);
  344. }
  345. return err;
  346. }
  347. static irqreturn_t rtl8201_handle_interrupt(struct phy_device *phydev)
  348. {
  349. int irq_status;
  350. irq_status = phy_read(phydev, RTL8201F_ISR);
  351. if (irq_status < 0) {
  352. phy_error(phydev);
  353. return IRQ_NONE;
  354. }
  355. if (!(irq_status & RTL8201F_ISR_MASK))
  356. return IRQ_NONE;
  357. phy_trigger_machine(phydev);
  358. return IRQ_HANDLED;
  359. }
  360. static irqreturn_t rtl821x_handle_interrupt(struct phy_device *phydev)
  361. {
  362. int irq_status, irq_enabled;
  363. irq_status = phy_read(phydev, RTL821x_INSR);
  364. if (irq_status < 0) {
  365. phy_error(phydev);
  366. return IRQ_NONE;
  367. }
  368. irq_enabled = phy_read(phydev, RTL821x_INER);
  369. if (irq_enabled < 0) {
  370. phy_error(phydev);
  371. return IRQ_NONE;
  372. }
  373. if (!(irq_status & irq_enabled))
  374. return IRQ_NONE;
  375. phy_trigger_machine(phydev);
  376. return IRQ_HANDLED;
  377. }
  378. static irqreturn_t rtl8211f_handle_interrupt(struct phy_device *phydev)
  379. {
  380. int irq_status;
  381. irq_status = phy_read(phydev, RTL8211F_INSR);
  382. if (irq_status < 0) {
  383. phy_error(phydev);
  384. return IRQ_NONE;
  385. }
  386. if (irq_status & RTL8211F_INER_LINK_STATUS) {
  387. phy_trigger_machine(phydev);
  388. return IRQ_HANDLED;
  389. }
  390. if (irq_status & RTL8211F_INER_PME) {
  391. pm_wakeup_event(&phydev->mdio.dev, 0);
  392. return IRQ_HANDLED;
  393. }
  394. return IRQ_NONE;
  395. }
  396. static void rtl8211f_get_wol(struct phy_device *dev, struct ethtool_wolinfo *wol)
  397. {
  398. int wol_events;
  399. /* If the PHY is not capable of waking the system, then WoL can not
  400. * be supported.
  401. */
  402. if (!device_can_wakeup(&dev->mdio.dev)) {
  403. wol->supported = 0;
  404. return;
  405. }
  406. wol->supported = WAKE_MAGIC;
  407. wol_events = phy_read_paged(dev, RTL8211F_WOL_PAGE, RTL8211F_WOL_SETTINGS_EVENTS);
  408. if (wol_events < 0)
  409. return;
  410. if (wol_events & RTL8211F_WOL_EVENT_MAGIC)
  411. wol->wolopts = WAKE_MAGIC;
  412. }
  413. static int rtl8211f_set_wol(struct phy_device *dev, struct ethtool_wolinfo *wol)
  414. {
  415. const u8 *mac_addr = dev->attached_dev->dev_addr;
  416. int oldpage;
  417. if (!device_can_wakeup(&dev->mdio.dev))
  418. return -EOPNOTSUPP;
  419. oldpage = phy_save_page(dev);
  420. if (oldpage < 0)
  421. goto err;
  422. if (wol->wolopts & WAKE_MAGIC) {
  423. /* Store the device address for the magic packet */
  424. rtl821x_write_page(dev, RTL8211F_PHYSICAL_ADDR_PAGE);
  425. __phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD0, mac_addr[1] << 8 | (mac_addr[0]));
  426. __phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD1, mac_addr[3] << 8 | (mac_addr[2]));
  427. __phy_write(dev, RTL8211F_PHYSICAL_ADDR_WORD2, mac_addr[5] << 8 | (mac_addr[4]));
  428. /* Enable magic packet matching */
  429. rtl821x_write_page(dev, RTL8211F_WOL_PAGE);
  430. __phy_write(dev, RTL8211F_WOL_SETTINGS_EVENTS, RTL8211F_WOL_EVENT_MAGIC);
  431. /* Set the maximum packet size, and assert WoL reset */
  432. __phy_write(dev, RTL8211F_WOL_RST_RMSQ, RTL8211F_WOL_RMSQ);
  433. } else {
  434. /* Disable magic packet matching */
  435. rtl821x_write_page(dev, RTL8211F_WOL_PAGE);
  436. __phy_write(dev, RTL8211F_WOL_SETTINGS_EVENTS, 0);
  437. /* Place WoL in reset */
  438. __phy_clear_bits(dev, RTL8211F_WOL_RST_RMSQ,
  439. RTL8211F_WOL_RG_RSTB);
  440. }
  441. device_set_wakeup_enable(&dev->mdio.dev, !!(wol->wolopts & WAKE_MAGIC));
  442. err:
  443. return phy_restore_page(dev, oldpage, 0);
  444. }
  445. static int rtl8211_config_aneg(struct phy_device *phydev)
  446. {
  447. int ret;
  448. ret = genphy_config_aneg(phydev);
  449. if (ret < 0)
  450. return ret;
  451. /* Quirk was copied from vendor driver. Unfortunately it includes no
  452. * description of the magic numbers.
  453. */
  454. if (phydev->speed == SPEED_100 && phydev->autoneg == AUTONEG_DISABLE) {
  455. phy_write(phydev, 0x17, 0x2138);
  456. phy_write(phydev, 0x0e, 0x0260);
  457. } else {
  458. phy_write(phydev, 0x17, 0x2108);
  459. phy_write(phydev, 0x0e, 0x0000);
  460. }
  461. return 0;
  462. }
  463. static int rtl8211c_config_init(struct phy_device *phydev)
  464. {
  465. /* RTL8211C has an issue when operating in Gigabit slave mode */
  466. return phy_set_bits(phydev, MII_CTRL1000,
  467. CTL1000_ENABLE_MASTER | CTL1000_AS_MASTER);
  468. }
  469. static int rtl8211f_config_rgmii_delay(struct phy_device *phydev)
  470. {
  471. u16 val_txdly, val_rxdly;
  472. int ret;
  473. switch (phydev->interface) {
  474. case PHY_INTERFACE_MODE_RGMII:
  475. val_txdly = 0;
  476. val_rxdly = 0;
  477. break;
  478. case PHY_INTERFACE_MODE_RGMII_RXID:
  479. val_txdly = 0;
  480. val_rxdly = RTL8211F_RX_DELAY;
  481. break;
  482. case PHY_INTERFACE_MODE_RGMII_TXID:
  483. val_txdly = RTL8211F_TX_DELAY;
  484. val_rxdly = 0;
  485. break;
  486. case PHY_INTERFACE_MODE_RGMII_ID:
  487. val_txdly = RTL8211F_TX_DELAY;
  488. val_rxdly = RTL8211F_RX_DELAY;
  489. break;
  490. default: /* the rest of the modes imply leaving delay as is. */
  491. return 0;
  492. }
  493. ret = phy_modify_paged_changed(phydev, RTL8211F_RGMII_PAGE,
  494. RTL8211F_TXCR, RTL8211F_TX_DELAY,
  495. val_txdly);
  496. if (ret < 0) {
  497. phydev_err(phydev, "Failed to update the TX delay register: %pe\n",
  498. ERR_PTR(ret));
  499. return ret;
  500. } else if (ret) {
  501. phydev_dbg(phydev,
  502. "%s 2ns TX delay (and changing the value from pin-strapping RXD1 or the bootloader)\n",
  503. str_enable_disable(val_txdly));
  504. } else {
  505. phydev_dbg(phydev,
  506. "2ns TX delay was already %s (by pin-strapping RXD1 or bootloader configuration)\n",
  507. str_enabled_disabled(val_txdly));
  508. }
  509. ret = phy_modify_paged_changed(phydev, RTL8211F_RGMII_PAGE,
  510. RTL8211F_RXCR, RTL8211F_RX_DELAY,
  511. val_rxdly);
  512. if (ret < 0) {
  513. phydev_err(phydev, "Failed to update the RX delay register: %pe\n",
  514. ERR_PTR(ret));
  515. return ret;
  516. } else if (ret) {
  517. phydev_dbg(phydev,
  518. "%s 2ns RX delay (and changing the value from pin-strapping RXD0 or the bootloader)\n",
  519. str_enable_disable(val_rxdly));
  520. } else {
  521. phydev_dbg(phydev,
  522. "2ns RX delay was already %s (by pin-strapping RXD0 or bootloader configuration)\n",
  523. str_enabled_disabled(val_rxdly));
  524. }
  525. return 0;
  526. }
  527. static int rtl8211f_config_clk_out(struct phy_device *phydev)
  528. {
  529. struct rtl821x_priv *priv = phydev->priv;
  530. int ret;
  531. /* The value is preserved if the device tree property is absent */
  532. if (!priv->disable_clk_out)
  533. return 0;
  534. if (phydev->drv->phy_id == RTL_8211FVD_PHYID)
  535. ret = phy_modify_paged(phydev, RTL8211FVD_CLKOUT_PAGE,
  536. RTL8211FVD_CLKOUT_REG,
  537. RTL8211FVD_CLKOUT_EN, 0);
  538. else
  539. ret = phy_modify(phydev, RTL8211F_PHYCR2, RTL8211F_CLKOUT_EN,
  540. 0);
  541. if (ret)
  542. return ret;
  543. return genphy_soft_reset(phydev);
  544. }
  545. /* Advance Link Down Power Saving (ALDPS) mode changes crystal/clock behaviour,
  546. * which causes the RXC clock signal to stop for tens to hundreds of
  547. * milliseconds.
  548. *
  549. * Some MACs need the RXC clock to support their internal RX logic, so ALDPS is
  550. * only enabled based on an opt-in device tree property.
  551. */
  552. static int rtl8211f_config_aldps(struct phy_device *phydev)
  553. {
  554. struct rtl821x_priv *priv = phydev->priv;
  555. u16 mask = RTL8211F_ALDPS_PLL_OFF |
  556. RTL8211F_ALDPS_ENABLE |
  557. RTL8211F_ALDPS_XTAL_OFF;
  558. /* The value is preserved if the device tree property is absent */
  559. if (!priv->enable_aldps)
  560. return 0;
  561. return phy_modify(phydev, RTL8211F_PHYCR1, mask, mask);
  562. }
  563. static int rtl8211f_config_phy_eee(struct phy_device *phydev)
  564. {
  565. /* Disable PHY-mode EEE so LPI is passed to the MAC */
  566. return phy_modify(phydev, RTL8211F_PHYCR2,
  567. RTL8211F_PHYCR2_PHY_EEE_ENABLE, 0);
  568. }
  569. static int rtl8211f_config_init(struct phy_device *phydev)
  570. {
  571. struct device *dev = &phydev->mdio.dev;
  572. int ret;
  573. ret = rtl8211f_config_aldps(phydev);
  574. if (ret) {
  575. dev_err(dev, "aldps mode configuration failed: %pe\n",
  576. ERR_PTR(ret));
  577. return ret;
  578. }
  579. ret = rtl8211f_config_rgmii_delay(phydev);
  580. if (ret)
  581. return ret;
  582. ret = rtl8211f_config_clk_out(phydev);
  583. if (ret) {
  584. dev_err(dev, "clkout configuration failed: %pe\n",
  585. ERR_PTR(ret));
  586. return ret;
  587. }
  588. return rtl8211f_config_phy_eee(phydev);
  589. }
  590. static int rtl821x_suspend(struct phy_device *phydev)
  591. {
  592. struct rtl821x_priv *priv = phydev->priv;
  593. int ret = 0;
  594. if (!phydev->wol_enabled) {
  595. ret = genphy_suspend(phydev);
  596. if (ret)
  597. return ret;
  598. clk_disable_unprepare(priv->clk);
  599. }
  600. return ret;
  601. }
  602. static int rtl8211f_suspend(struct phy_device *phydev)
  603. {
  604. u16 wol_rst;
  605. int ret;
  606. ret = rtl821x_suspend(phydev);
  607. if (ret < 0)
  608. return ret;
  609. /* If a PME event is enabled, then configure the interrupt for
  610. * PME events only, disabling link interrupt. We avoid switching
  611. * to PMEB mode as we don't have a status bit for that.
  612. */
  613. if (device_may_wakeup(&phydev->mdio.dev)) {
  614. ret = phy_write_paged(phydev, 0xa42, RTL821x_INER,
  615. RTL8211F_INER_PME);
  616. if (ret < 0)
  617. goto err;
  618. /* Read the INSR to clear any pending interrupt */
  619. phy_read(phydev, RTL8211F_INSR);
  620. /* Reset the WoL to ensure that an event is picked up.
  621. * Unless we do this, even if we receive another packet,
  622. * we may not have a PME interrupt raised.
  623. */
  624. ret = phy_read_paged(phydev, RTL8211F_WOL_PAGE,
  625. RTL8211F_WOL_RST_RMSQ);
  626. if (ret < 0)
  627. goto err;
  628. wol_rst = ret & ~RTL8211F_WOL_RG_RSTB;
  629. ret = phy_write_paged(phydev, RTL8211F_WOL_PAGE,
  630. RTL8211F_WOL_RST_RMSQ, wol_rst);
  631. if (ret < 0)
  632. goto err;
  633. wol_rst |= RTL8211F_WOL_RG_RSTB;
  634. ret = phy_write_paged(phydev, RTL8211F_WOL_PAGE,
  635. RTL8211F_WOL_RST_RMSQ, wol_rst);
  636. }
  637. err:
  638. return ret;
  639. }
  640. static int rtl821x_resume(struct phy_device *phydev)
  641. {
  642. struct rtl821x_priv *priv = phydev->priv;
  643. int ret;
  644. if (!phydev->wol_enabled)
  645. clk_prepare_enable(priv->clk);
  646. ret = genphy_resume(phydev);
  647. if (ret < 0)
  648. return ret;
  649. msleep(20);
  650. return 0;
  651. }
  652. static int rtl8211f_resume(struct phy_device *phydev)
  653. {
  654. struct rtl821x_priv *priv = phydev->priv;
  655. int ret;
  656. ret = rtl821x_resume(phydev);
  657. if (ret < 0)
  658. return ret;
  659. /* If the device was programmed for a PME event, restore the interrupt
  660. * enable so phylib can receive link state interrupts.
  661. */
  662. if (device_may_wakeup(&phydev->mdio.dev))
  663. ret = phy_write_paged(phydev, 0xa42, RTL821x_INER, priv->iner);
  664. return ret;
  665. }
  666. static int rtl8211x_led_hw_is_supported(struct phy_device *phydev, u8 index,
  667. unsigned long rules)
  668. {
  669. const unsigned long mask = BIT(TRIGGER_NETDEV_LINK) |
  670. BIT(TRIGGER_NETDEV_LINK_10) |
  671. BIT(TRIGGER_NETDEV_LINK_100) |
  672. BIT(TRIGGER_NETDEV_LINK_1000) |
  673. BIT(TRIGGER_NETDEV_RX) |
  674. BIT(TRIGGER_NETDEV_TX);
  675. /* The RTL8211F PHY supports these LED settings on up to three LEDs:
  676. * - Link: Configurable subset of 10/100/1000 link rates
  677. * - Active: Blink on activity, RX or TX is not differentiated
  678. * The Active option has two modes, A and B:
  679. * - A: Link and Active indication at configurable, but matching,
  680. * subset of 10/100/1000 link rates
  681. * - B: Link indication at configurable subset of 10/100/1000 link
  682. * rates and Active indication always at all three 10+100+1000
  683. * link rates.
  684. * This code currently uses mode B only.
  685. *
  686. * RTL8211E PHY LED has one mode, which works like RTL8211F mode B.
  687. */
  688. if (index >= RTL8211x_LED_COUNT)
  689. return -EINVAL;
  690. /* Filter out any other unsupported triggers. */
  691. if (rules & ~mask)
  692. return -EOPNOTSUPP;
  693. /* RX and TX are not differentiated, either both are set or not set. */
  694. if (!(rules & BIT(TRIGGER_NETDEV_RX)) ^ !(rules & BIT(TRIGGER_NETDEV_TX)))
  695. return -EOPNOTSUPP;
  696. return 0;
  697. }
  698. static int rtl8211f_led_hw_control_get(struct phy_device *phydev, u8 index,
  699. unsigned long *rules)
  700. {
  701. int val;
  702. if (index >= RTL8211x_LED_COUNT)
  703. return -EINVAL;
  704. val = phy_read_paged(phydev, 0xd04, RTL8211F_LEDCR);
  705. if (val < 0)
  706. return val;
  707. val >>= RTL8211F_LEDCR_SHIFT * index;
  708. val &= RTL8211F_LEDCR_MASK;
  709. if (val & RTL8211F_LEDCR_LINK_10)
  710. __set_bit(TRIGGER_NETDEV_LINK_10, rules);
  711. if (val & RTL8211F_LEDCR_LINK_100)
  712. __set_bit(TRIGGER_NETDEV_LINK_100, rules);
  713. if (val & RTL8211F_LEDCR_LINK_1000)
  714. __set_bit(TRIGGER_NETDEV_LINK_1000, rules);
  715. if ((val & RTL8211F_LEDCR_LINK_10) &&
  716. (val & RTL8211F_LEDCR_LINK_100) &&
  717. (val & RTL8211F_LEDCR_LINK_1000)) {
  718. __set_bit(TRIGGER_NETDEV_LINK, rules);
  719. }
  720. if (val & RTL8211F_LEDCR_ACT_TXRX) {
  721. __set_bit(TRIGGER_NETDEV_RX, rules);
  722. __set_bit(TRIGGER_NETDEV_TX, rules);
  723. }
  724. return 0;
  725. }
  726. static int rtl8211f_led_hw_control_set(struct phy_device *phydev, u8 index,
  727. unsigned long rules)
  728. {
  729. const u16 mask = RTL8211F_LEDCR_MASK << (RTL8211F_LEDCR_SHIFT * index);
  730. u16 reg = 0;
  731. if (index >= RTL8211x_LED_COUNT)
  732. return -EINVAL;
  733. if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
  734. test_bit(TRIGGER_NETDEV_LINK_10, &rules)) {
  735. reg |= RTL8211F_LEDCR_LINK_10;
  736. }
  737. if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
  738. test_bit(TRIGGER_NETDEV_LINK_100, &rules)) {
  739. reg |= RTL8211F_LEDCR_LINK_100;
  740. }
  741. if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
  742. test_bit(TRIGGER_NETDEV_LINK_1000, &rules)) {
  743. reg |= RTL8211F_LEDCR_LINK_1000;
  744. }
  745. if (test_bit(TRIGGER_NETDEV_RX, &rules) ||
  746. test_bit(TRIGGER_NETDEV_TX, &rules)) {
  747. reg |= RTL8211F_LEDCR_ACT_TXRX;
  748. }
  749. reg <<= RTL8211F_LEDCR_SHIFT * index;
  750. reg |= RTL8211F_LEDCR_MODE; /* Mode B */
  751. return phy_modify_paged(phydev, 0xd04, RTL8211F_LEDCR, mask, reg);
  752. }
  753. static int rtl8211e_led_hw_control_get(struct phy_device *phydev, u8 index,
  754. unsigned long *rules)
  755. {
  756. int ret;
  757. u16 cr1, cr2;
  758. if (index >= RTL8211x_LED_COUNT)
  759. return -EINVAL;
  760. ret = rtl821x_read_ext_page(phydev, RTL8211E_LEDCR_EXT_PAGE,
  761. RTL8211E_LEDCR1);
  762. if (ret < 0)
  763. return ret;
  764. cr1 = ret >> RTL8211E_LEDCR1_SHIFT * index;
  765. if (cr1 & RTL8211E_LEDCR1_ACT_TXRX) {
  766. __set_bit(TRIGGER_NETDEV_RX, rules);
  767. __set_bit(TRIGGER_NETDEV_TX, rules);
  768. }
  769. ret = rtl821x_read_ext_page(phydev, RTL8211E_LEDCR_EXT_PAGE,
  770. RTL8211E_LEDCR2);
  771. if (ret < 0)
  772. return ret;
  773. cr2 = ret >> RTL8211E_LEDCR2_SHIFT * index;
  774. if (cr2 & RTL8211E_LEDCR2_LINK_10)
  775. __set_bit(TRIGGER_NETDEV_LINK_10, rules);
  776. if (cr2 & RTL8211E_LEDCR2_LINK_100)
  777. __set_bit(TRIGGER_NETDEV_LINK_100, rules);
  778. if (cr2 & RTL8211E_LEDCR2_LINK_1000)
  779. __set_bit(TRIGGER_NETDEV_LINK_1000, rules);
  780. if ((cr2 & RTL8211E_LEDCR2_LINK_10) &&
  781. (cr2 & RTL8211E_LEDCR2_LINK_100) &&
  782. (cr2 & RTL8211E_LEDCR2_LINK_1000)) {
  783. __set_bit(TRIGGER_NETDEV_LINK, rules);
  784. }
  785. return ret;
  786. }
  787. static int rtl8211e_led_hw_control_set(struct phy_device *phydev, u8 index,
  788. unsigned long rules)
  789. {
  790. const u16 cr1mask =
  791. RTL8211E_LEDCR1_MASK << (RTL8211E_LEDCR1_SHIFT * index);
  792. const u16 cr2mask =
  793. RTL8211E_LEDCR2_MASK << (RTL8211E_LEDCR2_SHIFT * index);
  794. u16 cr1 = 0, cr2 = 0;
  795. int ret;
  796. if (index >= RTL8211x_LED_COUNT)
  797. return -EINVAL;
  798. if (test_bit(TRIGGER_NETDEV_RX, &rules) ||
  799. test_bit(TRIGGER_NETDEV_TX, &rules)) {
  800. cr1 |= RTL8211E_LEDCR1_ACT_TXRX;
  801. }
  802. cr1 <<= RTL8211E_LEDCR1_SHIFT * index;
  803. ret = rtl821x_modify_ext_page(phydev, RTL8211E_LEDCR_EXT_PAGE,
  804. RTL8211E_LEDCR1, cr1mask, cr1);
  805. if (ret < 0)
  806. return ret;
  807. if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
  808. test_bit(TRIGGER_NETDEV_LINK_10, &rules)) {
  809. cr2 |= RTL8211E_LEDCR2_LINK_10;
  810. }
  811. if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
  812. test_bit(TRIGGER_NETDEV_LINK_100, &rules)) {
  813. cr2 |= RTL8211E_LEDCR2_LINK_100;
  814. }
  815. if (test_bit(TRIGGER_NETDEV_LINK, &rules) ||
  816. test_bit(TRIGGER_NETDEV_LINK_1000, &rules)) {
  817. cr2 |= RTL8211E_LEDCR2_LINK_1000;
  818. }
  819. cr2 <<= RTL8211E_LEDCR2_SHIFT * index;
  820. ret = rtl821x_modify_ext_page(phydev, RTL8211E_LEDCR_EXT_PAGE,
  821. RTL8211E_LEDCR2, cr2mask, cr2);
  822. return ret;
  823. }
  824. static int rtl8211e_config_init(struct phy_device *phydev)
  825. {
  826. u16 val;
  827. /* enable TX/RX delay for rgmii-* modes, and disable them for rgmii. */
  828. switch (phydev->interface) {
  829. case PHY_INTERFACE_MODE_RGMII:
  830. val = RTL8211E_CTRL_DELAY | 0;
  831. break;
  832. case PHY_INTERFACE_MODE_RGMII_ID:
  833. val = RTL8211E_CTRL_DELAY | RTL8211E_TX_DELAY | RTL8211E_RX_DELAY;
  834. break;
  835. case PHY_INTERFACE_MODE_RGMII_RXID:
  836. val = RTL8211E_CTRL_DELAY | RTL8211E_RX_DELAY;
  837. break;
  838. case PHY_INTERFACE_MODE_RGMII_TXID:
  839. val = RTL8211E_CTRL_DELAY | RTL8211E_TX_DELAY;
  840. break;
  841. default: /* the rest of the modes imply leaving delays as is. */
  842. return 0;
  843. }
  844. /* According to a sample driver there is a 0x1c config register on the
  845. * 0xa4 extension page (0x7) layout. It can be used to disable/enable
  846. * the RX/TX delays otherwise controlled by RXDLY/TXDLY pins.
  847. * The configuration register definition:
  848. * 14 = reserved
  849. * 13 = Force Tx RX Delay controlled by bit12 bit11,
  850. * 12 = RX Delay, 11 = TX Delay
  851. * 10:0 = Test && debug settings reserved by realtek
  852. */
  853. return rtl821x_modify_ext_page(phydev, RTL8211E_RGMII_EXT_PAGE,
  854. RTL8211E_RGMII_DELAY,
  855. RTL8211E_DELAY_MASK, val);
  856. }
  857. static int rtl8211b_suspend(struct phy_device *phydev)
  858. {
  859. phy_write(phydev, MII_MMD_DATA, BIT(9));
  860. return genphy_suspend(phydev);
  861. }
  862. static int rtl8211b_resume(struct phy_device *phydev)
  863. {
  864. phy_write(phydev, MII_MMD_DATA, 0);
  865. return genphy_resume(phydev);
  866. }
  867. static int rtl8366rb_config_init(struct phy_device *phydev)
  868. {
  869. int ret;
  870. ret = phy_set_bits(phydev, RTL8366RB_POWER_SAVE,
  871. RTL8366RB_POWER_SAVE_ON);
  872. if (ret) {
  873. dev_err(&phydev->mdio.dev,
  874. "error enabling power management\n");
  875. }
  876. return ret;
  877. }
  878. /* get actual speed to cover the downshift case */
  879. static void rtlgen_decode_physr(struct phy_device *phydev, int val)
  880. {
  881. /* bit 3
  882. * 0: Half Duplex
  883. * 1: Full Duplex
  884. */
  885. if (val & RTL_PHYSR_DUPLEX)
  886. phydev->duplex = DUPLEX_FULL;
  887. else
  888. phydev->duplex = DUPLEX_HALF;
  889. switch (val & RTL_PHYSR_SPEED_MASK) {
  890. case 0x0000:
  891. phydev->speed = SPEED_10;
  892. break;
  893. case 0x0010:
  894. phydev->speed = SPEED_100;
  895. break;
  896. case 0x0020:
  897. phydev->speed = SPEED_1000;
  898. break;
  899. case 0x0200:
  900. phydev->speed = SPEED_10000;
  901. break;
  902. case 0x0210:
  903. phydev->speed = SPEED_2500;
  904. break;
  905. case 0x0220:
  906. phydev->speed = SPEED_5000;
  907. break;
  908. default:
  909. break;
  910. }
  911. /* bit 11
  912. * 0: Slave Mode
  913. * 1: Master Mode
  914. */
  915. if (phydev->speed >= 1000) {
  916. if (val & RTL_PHYSR_MASTER)
  917. phydev->master_slave_state = MASTER_SLAVE_STATE_MASTER;
  918. else
  919. phydev->master_slave_state = MASTER_SLAVE_STATE_SLAVE;
  920. } else {
  921. phydev->master_slave_state = MASTER_SLAVE_STATE_UNSUPPORTED;
  922. }
  923. }
  924. static int rtlgen_read_status(struct phy_device *phydev)
  925. {
  926. int ret, val;
  927. ret = genphy_read_status(phydev);
  928. if (ret < 0)
  929. return ret;
  930. if (!phydev->link)
  931. return 0;
  932. val = phy_read(phydev, RTL_PHYSR);
  933. if (val < 0)
  934. return val;
  935. rtlgen_decode_physr(phydev, val);
  936. return 0;
  937. }
  938. static int rtlgen_read_vend2(struct phy_device *phydev, int regnum)
  939. {
  940. return __mdiobus_c45_read(phydev->mdio.bus, 0, MDIO_MMD_VEND2, regnum);
  941. }
  942. static int rtlgen_write_vend2(struct phy_device *phydev, int regnum, u16 val)
  943. {
  944. return __mdiobus_c45_write(phydev->mdio.bus, 0, MDIO_MMD_VEND2, regnum,
  945. val);
  946. }
  947. static int rtlgen_read_mmd(struct phy_device *phydev, int devnum, u16 regnum)
  948. {
  949. int ret;
  950. if (devnum == MDIO_MMD_VEND2)
  951. ret = rtlgen_read_vend2(phydev, regnum);
  952. else if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE)
  953. ret = rtlgen_read_vend2(phydev, RTL_MDIO_PCS_EEE_ABLE);
  954. else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV)
  955. ret = rtlgen_read_vend2(phydev, RTL_MDIO_AN_EEE_ADV);
  956. else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE)
  957. ret = rtlgen_read_vend2(phydev, RTL_MDIO_AN_EEE_LPABLE);
  958. else
  959. ret = -EOPNOTSUPP;
  960. return ret;
  961. }
  962. static int rtlgen_write_mmd(struct phy_device *phydev, int devnum, u16 regnum,
  963. u16 val)
  964. {
  965. int ret;
  966. if (devnum == MDIO_MMD_VEND2)
  967. ret = rtlgen_write_vend2(phydev, regnum, val);
  968. else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV)
  969. ret = rtlgen_write_vend2(phydev, regnum, RTL_MDIO_AN_EEE_ADV);
  970. else
  971. ret = -EOPNOTSUPP;
  972. return ret;
  973. }
  974. static int rtl822x_read_mmd(struct phy_device *phydev, int devnum, u16 regnum)
  975. {
  976. int ret = rtlgen_read_mmd(phydev, devnum, regnum);
  977. if (ret != -EOPNOTSUPP)
  978. return ret;
  979. if (devnum == MDIO_MMD_PCS && regnum == MDIO_PCS_EEE_ABLE2)
  980. ret = rtlgen_read_vend2(phydev, RTL_MDIO_PCS_EEE_ABLE2);
  981. else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2)
  982. ret = rtlgen_read_vend2(phydev, RTL_MDIO_AN_EEE_ADV2);
  983. else if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_LPABLE2)
  984. ret = rtlgen_read_vend2(phydev, RTL_MDIO_AN_EEE_LPABLE2);
  985. return ret;
  986. }
  987. static int rtl822x_write_mmd(struct phy_device *phydev, int devnum, u16 regnum,
  988. u16 val)
  989. {
  990. int ret = rtlgen_write_mmd(phydev, devnum, regnum, val);
  991. if (ret != -EOPNOTSUPP)
  992. return ret;
  993. if (devnum == MDIO_MMD_AN && regnum == MDIO_AN_EEE_ADV2)
  994. ret = rtlgen_write_vend2(phydev, RTL_MDIO_AN_EEE_ADV2, val);
  995. return ret;
  996. }
  997. static int rtl822x_probe(struct phy_device *phydev)
  998. {
  999. if (IS_ENABLED(CONFIG_REALTEK_PHY_HWMON) &&
  1000. phydev->phy_id != RTL_GENERIC_PHYID)
  1001. return rtl822x_hwmon_init(phydev);
  1002. return 0;
  1003. }
  1004. /* RTL822x cannot access MDIO_MMD_VEND2 via MII_MMD_CTRL/MII_MMD_DATA.
  1005. * A mapping to use paged access needs to be used instead.
  1006. * All other MMD devices can be accessed as usual.
  1007. */
  1008. static int rtl822xb_read_mmd(struct phy_device *phydev, int devnum, u16 reg)
  1009. {
  1010. int oldpage, ret, read_ret;
  1011. u16 page;
  1012. /* Use default method for all MMDs except MDIO_MMD_VEND2 or in case
  1013. * Clause-45 access is available
  1014. */
  1015. if (devnum != MDIO_MMD_VEND2 || phydev->is_c45)
  1016. return mmd_phy_read(phydev->mdio.bus, phydev->mdio.addr,
  1017. phydev->is_c45, devnum, reg);
  1018. /* Simplify access to C22-registers addressed inside MDIO_MMD_VEND2 */
  1019. if (reg >= RTL822X_VND2_C22_REG(0) &&
  1020. reg <= RTL822X_VND2_C22_REG(30))
  1021. return __phy_read(phydev, RTL822X_VND2_TO_C22_REG(reg));
  1022. /* Use paged access for MDIO_MMD_VEND2 over Clause-22 */
  1023. page = RTL822X_VND2_TO_PAGE(reg);
  1024. oldpage = __phy_read(phydev, RTL821x_PAGE_SELECT);
  1025. if (oldpage < 0)
  1026. return oldpage;
  1027. if (oldpage != page) {
  1028. ret = __phy_write(phydev, RTL821x_PAGE_SELECT, page);
  1029. if (ret < 0)
  1030. return ret;
  1031. }
  1032. read_ret = __phy_read(phydev, RTL822X_VND2_TO_PAGE_REG(reg));
  1033. if (oldpage != page) {
  1034. ret = __phy_write(phydev, RTL821x_PAGE_SELECT, oldpage);
  1035. if (ret < 0)
  1036. return ret;
  1037. }
  1038. return read_ret;
  1039. }
  1040. static int rtl822xb_write_mmd(struct phy_device *phydev, int devnum, u16 reg,
  1041. u16 val)
  1042. {
  1043. int oldpage, ret, write_ret;
  1044. u16 page;
  1045. /* Use default method for all MMDs except MDIO_MMD_VEND2 or in case
  1046. * Clause-45 access is available
  1047. */
  1048. if (devnum != MDIO_MMD_VEND2 || phydev->is_c45)
  1049. return mmd_phy_write(phydev->mdio.bus, phydev->mdio.addr,
  1050. phydev->is_c45, devnum, reg, val);
  1051. /* Simplify access to C22-registers addressed inside MDIO_MMD_VEND2 */
  1052. if (reg >= RTL822X_VND2_C22_REG(0) &&
  1053. reg <= RTL822X_VND2_C22_REG(30))
  1054. return __phy_write(phydev, RTL822X_VND2_TO_C22_REG(reg), val);
  1055. /* Use paged access for MDIO_MMD_VEND2 over Clause-22 */
  1056. page = RTL822X_VND2_TO_PAGE(reg);
  1057. oldpage = __phy_read(phydev, RTL821x_PAGE_SELECT);
  1058. if (oldpage < 0)
  1059. return oldpage;
  1060. if (oldpage != page) {
  1061. ret = __phy_write(phydev, RTL821x_PAGE_SELECT, page);
  1062. if (ret < 0)
  1063. return ret;
  1064. }
  1065. write_ret = __phy_write(phydev, RTL822X_VND2_TO_PAGE_REG(reg), val);
  1066. if (oldpage != page) {
  1067. ret = __phy_write(phydev, RTL821x_PAGE_SELECT, oldpage);
  1068. if (ret < 0)
  1069. return ret;
  1070. }
  1071. return write_ret;
  1072. }
  1073. static int rtl822x_set_serdes_option_mode(struct phy_device *phydev, bool gen1)
  1074. {
  1075. bool has_2500, has_sgmii;
  1076. u16 mode;
  1077. int ret;
  1078. has_2500 = test_bit(PHY_INTERFACE_MODE_2500BASEX,
  1079. phydev->host_interfaces) ||
  1080. phydev->interface == PHY_INTERFACE_MODE_2500BASEX;
  1081. has_sgmii = test_bit(PHY_INTERFACE_MODE_SGMII,
  1082. phydev->host_interfaces) ||
  1083. phydev->interface == PHY_INTERFACE_MODE_SGMII;
  1084. /* fill in possible interfaces */
  1085. __assign_bit(PHY_INTERFACE_MODE_2500BASEX, phydev->possible_interfaces,
  1086. has_2500);
  1087. __assign_bit(PHY_INTERFACE_MODE_SGMII, phydev->possible_interfaces,
  1088. has_sgmii);
  1089. if (!has_2500 && !has_sgmii)
  1090. return 0;
  1091. /* determine SerDes option mode */
  1092. if (has_2500 && !has_sgmii) {
  1093. mode = RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX;
  1094. phydev->rate_matching = RATE_MATCH_PAUSE;
  1095. } else {
  1096. mode = RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII;
  1097. phydev->rate_matching = RATE_MATCH_NONE;
  1098. }
  1099. /* the following sequence with magic numbers sets up the SerDes
  1100. * option mode
  1101. */
  1102. if (!gen1) {
  1103. ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x75f3, 0);
  1104. if (ret < 0)
  1105. return ret;
  1106. }
  1107. ret = phy_modify_mmd_changed(phydev, MDIO_MMD_VEND1,
  1108. RTL822X_VND1_SERDES_OPTION,
  1109. RTL822X_VND1_SERDES_OPTION_MODE_MASK,
  1110. mode);
  1111. if (gen1 || ret < 0)
  1112. return ret;
  1113. ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6a04, 0x0503);
  1114. if (ret < 0)
  1115. return ret;
  1116. ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6f10, 0xd455);
  1117. if (ret < 0)
  1118. return ret;
  1119. return phy_write_mmd(phydev, MDIO_MMD_VEND1, 0x6f11, 0x8020);
  1120. }
  1121. static int rtl822x_config_init(struct phy_device *phydev)
  1122. {
  1123. return rtl822x_set_serdes_option_mode(phydev, true);
  1124. }
  1125. static int rtl822xb_config_init(struct phy_device *phydev)
  1126. {
  1127. return rtl822x_set_serdes_option_mode(phydev, false);
  1128. }
  1129. static int rtl822x_serdes_write(struct phy_device *phydev, u16 reg, u16 val)
  1130. {
  1131. int ret, poll;
  1132. ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_ADDR, reg);
  1133. if (ret < 0)
  1134. return ret;
  1135. ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_DATA, val);
  1136. if (ret < 0)
  1137. return ret;
  1138. ret = phy_write_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_CMD,
  1139. RTL822X_VND1_SERDES_CMD_WRITE |
  1140. RTL822X_VND1_SERDES_CMD_BUSY);
  1141. if (ret < 0)
  1142. return ret;
  1143. return phy_read_mmd_poll_timeout(phydev, MDIO_MMD_VEND1,
  1144. RTL822X_VND1_SERDES_CMD, poll,
  1145. !(poll & RTL822X_VND1_SERDES_CMD_BUSY),
  1146. 500, 100000, false);
  1147. }
  1148. static int rtl822x_config_inband(struct phy_device *phydev, unsigned int modes)
  1149. {
  1150. return rtl822x_serdes_write(phydev, RTL822X_VND1_SERDES_ADDR_AUTONEG,
  1151. (modes != LINK_INBAND_DISABLE) ?
  1152. RTL822X_VND1_SERDES_INBAND_ENABLE :
  1153. RTL822X_VND1_SERDES_INBAND_DISABLE);
  1154. }
  1155. static unsigned int rtl822x_inband_caps(struct phy_device *phydev,
  1156. phy_interface_t interface)
  1157. {
  1158. switch (interface) {
  1159. case PHY_INTERFACE_MODE_2500BASEX:
  1160. return LINK_INBAND_DISABLE;
  1161. case PHY_INTERFACE_MODE_SGMII:
  1162. return LINK_INBAND_DISABLE | LINK_INBAND_ENABLE;
  1163. default:
  1164. return 0;
  1165. }
  1166. }
  1167. static int rtl822xb_get_rate_matching(struct phy_device *phydev,
  1168. phy_interface_t iface)
  1169. {
  1170. int val;
  1171. /* Only rate matching at 2500base-x */
  1172. if (iface != PHY_INTERFACE_MODE_2500BASEX)
  1173. return RATE_MATCH_NONE;
  1174. val = phy_read_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_OPTION);
  1175. if (val < 0)
  1176. return val;
  1177. if ((val & RTL822X_VND1_SERDES_OPTION_MODE_MASK) ==
  1178. RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX)
  1179. return RATE_MATCH_PAUSE;
  1180. /* RTL822X_VND1_SERDES_OPTION_MODE_2500BASEX_SGMII */
  1181. return RATE_MATCH_NONE;
  1182. }
  1183. static int rtl822x_get_features(struct phy_device *phydev)
  1184. {
  1185. int val;
  1186. val = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL_MDIO_PMA_SPEED);
  1187. if (val < 0)
  1188. return val;
  1189. linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT,
  1190. phydev->supported, val & MDIO_PMA_SPEED_2_5G);
  1191. linkmode_mod_bit(ETHTOOL_LINK_MODE_5000baseT_Full_BIT,
  1192. phydev->supported, val & MDIO_PMA_SPEED_5G);
  1193. linkmode_mod_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
  1194. phydev->supported, val & MDIO_SPEED_10G);
  1195. return genphy_read_abilities(phydev);
  1196. }
  1197. static int rtl822x_config_aneg(struct phy_device *phydev)
  1198. {
  1199. int ret = 0;
  1200. if (phydev->autoneg == AUTONEG_ENABLE) {
  1201. u16 adv = linkmode_adv_to_mii_10gbt_adv_t(phydev->advertising);
  1202. ret = phy_modify_mmd_changed(phydev, MDIO_MMD_VEND2,
  1203. RTL_MDIO_AN_10GBT_CTRL,
  1204. MDIO_AN_10GBT_CTRL_ADV2_5G |
  1205. MDIO_AN_10GBT_CTRL_ADV5G, adv);
  1206. if (ret < 0)
  1207. return ret;
  1208. }
  1209. return __genphy_config_aneg(phydev, ret);
  1210. }
  1211. static void rtl822xb_update_interface(struct phy_device *phydev)
  1212. {
  1213. int val;
  1214. if (!phydev->link)
  1215. return;
  1216. /* Change interface according to serdes mode */
  1217. val = phy_read_mmd(phydev, MDIO_MMD_VEND1, RTL822X_VND1_SERDES_CTRL3);
  1218. if (val < 0)
  1219. return;
  1220. switch (val & RTL822X_VND1_SERDES_CTRL3_MODE_MASK) {
  1221. case RTL822X_VND1_SERDES_CTRL3_MODE_2500BASEX:
  1222. phydev->interface = PHY_INTERFACE_MODE_2500BASEX;
  1223. break;
  1224. case RTL822X_VND1_SERDES_CTRL3_MODE_SGMII:
  1225. phydev->interface = PHY_INTERFACE_MODE_SGMII;
  1226. break;
  1227. }
  1228. }
  1229. static int rtl822x_read_status(struct phy_device *phydev)
  1230. {
  1231. int lpadv, ret;
  1232. mii_10gbt_stat_mod_linkmode_lpa_t(phydev->lp_advertising, 0);
  1233. ret = rtlgen_read_status(phydev);
  1234. if (ret < 0)
  1235. return ret;
  1236. if (phydev->autoneg == AUTONEG_DISABLE ||
  1237. !phydev->autoneg_complete)
  1238. return 0;
  1239. lpadv = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL_MDIO_AN_10GBT_STAT);
  1240. if (lpadv < 0)
  1241. return lpadv;
  1242. mii_10gbt_stat_mod_linkmode_lpa_t(phydev->lp_advertising, lpadv);
  1243. return 0;
  1244. }
  1245. static int rtl822xb_read_status(struct phy_device *phydev)
  1246. {
  1247. int ret;
  1248. ret = rtl822x_read_status(phydev);
  1249. if (ret < 0)
  1250. return ret;
  1251. rtl822xb_update_interface(phydev);
  1252. return 0;
  1253. }
  1254. static int rtl822x_c45_get_features(struct phy_device *phydev)
  1255. {
  1256. linkmode_set_bit(ETHTOOL_LINK_MODE_TP_BIT,
  1257. phydev->supported);
  1258. return genphy_c45_pma_read_abilities(phydev);
  1259. }
  1260. static int rtl822x_c45_config_aneg(struct phy_device *phydev)
  1261. {
  1262. bool changed = false;
  1263. int ret, val;
  1264. if (phydev->autoneg == AUTONEG_DISABLE)
  1265. return genphy_c45_pma_setup_forced(phydev);
  1266. ret = genphy_c45_an_config_aneg(phydev);
  1267. if (ret < 0)
  1268. return ret;
  1269. if (ret > 0)
  1270. changed = true;
  1271. val = linkmode_adv_to_mii_ctrl1000_t(phydev->advertising);
  1272. /* Vendor register as C45 has no standardized support for 1000BaseT */
  1273. ret = phy_modify_mmd_changed(phydev, MDIO_MMD_VEND2,
  1274. RTL822X_VND2_C22_REG(MII_CTRL1000),
  1275. ADVERTISE_1000FULL, val);
  1276. if (ret < 0)
  1277. return ret;
  1278. if (ret > 0)
  1279. changed = true;
  1280. return genphy_c45_check_and_restart_aneg(phydev, changed);
  1281. }
  1282. static int rtl822x_c45_read_status(struct phy_device *phydev)
  1283. {
  1284. int ret, val;
  1285. /* Vendor register as C45 has no standardized support for 1000BaseT */
  1286. if (phydev->autoneg == AUTONEG_ENABLE && genphy_c45_aneg_done(phydev)) {
  1287. val = phy_read_mmd(phydev, MDIO_MMD_VEND2,
  1288. RTL822X_VND2_C22_REG(MII_STAT1000));
  1289. if (val < 0)
  1290. return val;
  1291. } else {
  1292. val = 0;
  1293. }
  1294. mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, val);
  1295. ret = genphy_c45_read_status(phydev);
  1296. if (ret < 0)
  1297. return ret;
  1298. if (!phydev->link) {
  1299. phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN;
  1300. return 0;
  1301. }
  1302. /* Read actual speed from vendor register. */
  1303. val = phy_read_mmd(phydev, MDIO_MMD_VEND2,
  1304. RTL822X_VND2_C22_REG(RTL_PHYSR));
  1305. if (val < 0)
  1306. return val;
  1307. rtlgen_decode_physr(phydev, val);
  1308. return 0;
  1309. }
  1310. static int rtl822x_c45_soft_reset(struct phy_device *phydev)
  1311. {
  1312. int ret, val;
  1313. ret = phy_modify_mmd(phydev, MDIO_MMD_PMAPMD, MDIO_CTRL1,
  1314. MDIO_CTRL1_RESET, MDIO_CTRL1_RESET);
  1315. if (ret < 0)
  1316. return ret;
  1317. return phy_read_mmd_poll_timeout(phydev, MDIO_MMD_PMAPMD,
  1318. MDIO_CTRL1, val,
  1319. !(val & MDIO_CTRL1_RESET),
  1320. 5000, 100000, true);
  1321. }
  1322. static int rtl822xb_c45_read_status(struct phy_device *phydev)
  1323. {
  1324. int ret;
  1325. ret = rtl822x_c45_read_status(phydev);
  1326. if (ret < 0)
  1327. return ret;
  1328. rtl822xb_update_interface(phydev);
  1329. return 0;
  1330. }
  1331. static int rtl8224_cable_test_start(struct phy_device *phydev)
  1332. {
  1333. u32 val;
  1334. int ret;
  1335. /* disable auto-negotiation and force 1000/Full */
  1336. ret = phy_modify_mmd(phydev, MDIO_MMD_VEND2,
  1337. RTL822X_VND2_C22_REG(MII_BMCR),
  1338. BMCR_ANENABLE | BMCR_SPEED100 | BMCR_SPEED10,
  1339. BMCR_SPEED1000 | BMCR_FULLDPLX);
  1340. if (ret)
  1341. return ret;
  1342. mdelay(500);
  1343. /* trigger cable test */
  1344. val = RTL8224_MII_RTCT_ENABLE;
  1345. val |= RTL8224_MII_RTCT_PAIR_A;
  1346. val |= RTL8224_MII_RTCT_PAIR_B;
  1347. val |= RTL8224_MII_RTCT_PAIR_C;
  1348. val |= RTL8224_MII_RTCT_PAIR_D;
  1349. return phy_modify_mmd(phydev, MDIO_MMD_VEND2,
  1350. RTL822X_VND2_C22_REG(RTL8224_MII_RTCT),
  1351. RTL8224_MII_RTCT_DONE, val);
  1352. }
  1353. static int rtl8224_sram_read(struct phy_device *phydev, u32 reg)
  1354. {
  1355. int ret;
  1356. ret = phy_write_mmd(phydev, MDIO_MMD_VEND2,
  1357. RTL822X_VND2_C22_REG(RTL8224_MII_SRAM_ADDR),
  1358. reg);
  1359. if (ret)
  1360. return ret;
  1361. return phy_read_mmd(phydev, MDIO_MMD_VEND2,
  1362. RTL822X_VND2_C22_REG(RTL8224_MII_SRAM_DATA));
  1363. }
  1364. static int rtl8224_pair_len_get(struct phy_device *phydev, u32 pair)
  1365. {
  1366. int cable_len;
  1367. u32 reg_len;
  1368. int ret;
  1369. u32 cm;
  1370. reg_len = RTL8224_SRAM_RTCT_LEN(pair);
  1371. ret = rtl8224_sram_read(phydev, reg_len);
  1372. if (ret < 0)
  1373. return ret;
  1374. cable_len = ret & 0xff00;
  1375. ret = rtl8224_sram_read(phydev, reg_len + 1);
  1376. if (ret < 0)
  1377. return ret;
  1378. cable_len |= (ret & 0xff00) >> 8;
  1379. cable_len -= 620;
  1380. cable_len = max(cable_len, 0);
  1381. cm = cable_len * 100 / 78;
  1382. return cm;
  1383. }
  1384. static int rtl8224_cable_test_result_trans(u32 result)
  1385. {
  1386. if (!(result & RTL8224_SRAM_RTCT_FAULT_DONE))
  1387. return -EBUSY;
  1388. if (result & RTL8224_SRAM_RTCT_FAULT_OK)
  1389. return ETHTOOL_A_CABLE_RESULT_CODE_OK;
  1390. if (result & RTL8224_SRAM_RTCT_FAULT_OPEN)
  1391. return ETHTOOL_A_CABLE_RESULT_CODE_OPEN;
  1392. if (result & RTL8224_SRAM_RTCT_FAULT_SAME_SHORT)
  1393. return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT;
  1394. if (result & RTL8224_SRAM_RTCT_FAULT_BUSY)
  1395. return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
  1396. if (result & RTL8224_SRAM_RTCT_FAULT_CROSS_SHORT)
  1397. return ETHTOOL_A_CABLE_RESULT_CODE_CROSS_SHORT;
  1398. return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
  1399. }
  1400. static int rtl8224_cable_test_report_pair(struct phy_device *phydev, unsigned int pair)
  1401. {
  1402. int fault_rslt;
  1403. int ret;
  1404. ret = rtl8224_sram_read(phydev, RTL8224_SRAM_RTCT_FAULT(pair));
  1405. if (ret < 0)
  1406. return ret;
  1407. fault_rslt = rtl8224_cable_test_result_trans(ret);
  1408. if (fault_rslt < 0)
  1409. return 0;
  1410. ret = ethnl_cable_test_result(phydev, pair, fault_rslt);
  1411. if (ret < 0)
  1412. return ret;
  1413. switch (fault_rslt) {
  1414. case ETHTOOL_A_CABLE_RESULT_CODE_OPEN:
  1415. case ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT:
  1416. case ETHTOOL_A_CABLE_RESULT_CODE_CROSS_SHORT:
  1417. ret = rtl8224_pair_len_get(phydev, pair);
  1418. if (ret < 0)
  1419. return ret;
  1420. return ethnl_cable_test_fault_length(phydev, pair, ret);
  1421. default:
  1422. return 0;
  1423. }
  1424. }
  1425. static int rtl8224_cable_test_report(struct phy_device *phydev, bool *finished)
  1426. {
  1427. unsigned int pair;
  1428. int ret;
  1429. for (pair = ETHTOOL_A_CABLE_PAIR_A; pair <= ETHTOOL_A_CABLE_PAIR_D; pair++) {
  1430. ret = rtl8224_cable_test_report_pair(phydev, pair);
  1431. if (ret == -EBUSY) {
  1432. *finished = false;
  1433. return 0;
  1434. }
  1435. if (ret < 0)
  1436. return ret;
  1437. }
  1438. return 0;
  1439. }
  1440. static int rtl8224_cable_test_get_status(struct phy_device *phydev, bool *finished)
  1441. {
  1442. int ret;
  1443. *finished = false;
  1444. ret = phy_read_mmd(phydev, MDIO_MMD_VEND2,
  1445. RTL822X_VND2_C22_REG(RTL8224_MII_RTCT));
  1446. if (ret < 0)
  1447. return ret;
  1448. if (!(ret & RTL8224_MII_RTCT_DONE))
  1449. return 0;
  1450. *finished = true;
  1451. return rtl8224_cable_test_report(phydev, finished);
  1452. }
  1453. static bool rtlgen_supports_2_5gbps(struct phy_device *phydev)
  1454. {
  1455. int val;
  1456. phy_write(phydev, RTL821x_PAGE_SELECT, 0xa61);
  1457. val = phy_read(phydev, 0x13);
  1458. phy_write(phydev, RTL821x_PAGE_SELECT, 0);
  1459. return val >= 0 && val & MDIO_PMA_SPEED_2_5G;
  1460. }
  1461. /* On internal PHY's MMD reads over C22 always return 0.
  1462. * Check a MMD register which is known to be non-zero.
  1463. */
  1464. static bool rtlgen_supports_mmd(struct phy_device *phydev)
  1465. {
  1466. int val;
  1467. phy_lock_mdio_bus(phydev);
  1468. __phy_write(phydev, MII_MMD_CTRL, MDIO_MMD_PCS);
  1469. __phy_write(phydev, MII_MMD_DATA, MDIO_PCS_EEE_ABLE);
  1470. __phy_write(phydev, MII_MMD_CTRL, MDIO_MMD_PCS | MII_MMD_CTRL_NOINCR);
  1471. val = __phy_read(phydev, MII_MMD_DATA);
  1472. phy_unlock_mdio_bus(phydev);
  1473. return val > 0;
  1474. }
  1475. static int rtlgen_match_phy_device(struct phy_device *phydev,
  1476. const struct phy_driver *phydrv)
  1477. {
  1478. return phydev->phy_id == RTL_GENERIC_PHYID &&
  1479. !rtlgen_supports_2_5gbps(phydev);
  1480. }
  1481. static int rtl8226_match_phy_device(struct phy_device *phydev,
  1482. const struct phy_driver *phydrv)
  1483. {
  1484. return phydev->phy_id == RTL_GENERIC_PHYID &&
  1485. rtlgen_supports_2_5gbps(phydev) &&
  1486. rtlgen_supports_mmd(phydev);
  1487. }
  1488. static int rtlgen_is_c45_match(struct phy_device *phydev, unsigned int id,
  1489. bool is_c45)
  1490. {
  1491. if (phydev->is_c45)
  1492. return is_c45 && (id == phydev->c45_ids.device_ids[1]);
  1493. else
  1494. return !is_c45 && (id == phydev->phy_id);
  1495. }
  1496. static int rtl8221b_match_phy_device(struct phy_device *phydev,
  1497. const struct phy_driver *phydrv)
  1498. {
  1499. return phydev->phy_id == RTL_8221B && rtlgen_supports_mmd(phydev);
  1500. }
  1501. static int rtl8221b_vb_cg_match_phy_device(struct phy_device *phydev,
  1502. const struct phy_driver *phydrv)
  1503. {
  1504. return rtlgen_is_c45_match(phydev, RTL_8221B_VB_CG, true) ||
  1505. rtlgen_is_c45_match(phydev, RTL_8221B_VB_CG, false);
  1506. }
  1507. static int rtl8221b_vm_cg_match_phy_device(struct phy_device *phydev,
  1508. const struct phy_driver *phydrv)
  1509. {
  1510. return rtlgen_is_c45_match(phydev, RTL_8221B_VM_CG, true) ||
  1511. rtlgen_is_c45_match(phydev, RTL_8221B_VM_CG, false);
  1512. }
  1513. static int rtl_internal_nbaset_match_phy_device(struct phy_device *phydev,
  1514. const struct phy_driver *phydrv)
  1515. {
  1516. if (phydev->is_c45)
  1517. return false;
  1518. switch (phydev->phy_id) {
  1519. case RTL_GENERIC_PHYID:
  1520. case RTL_8221B:
  1521. case RTL_8251B:
  1522. case RTL_8261C:
  1523. case 0x001cc841:
  1524. break;
  1525. default:
  1526. return false;
  1527. }
  1528. return rtlgen_supports_2_5gbps(phydev) && !rtlgen_supports_mmd(phydev);
  1529. }
  1530. static int rtl8251b_c45_match_phy_device(struct phy_device *phydev,
  1531. const struct phy_driver *phydrv)
  1532. {
  1533. return rtlgen_is_c45_match(phydev, RTL_8251B, true);
  1534. }
  1535. static int rtlgen_resume(struct phy_device *phydev)
  1536. {
  1537. int ret = genphy_resume(phydev);
  1538. /* Internal PHY's from RTL8168h up may not be instantly ready */
  1539. msleep(20);
  1540. return ret;
  1541. }
  1542. static int rtlgen_c45_resume(struct phy_device *phydev)
  1543. {
  1544. int ret = genphy_c45_pma_resume(phydev);
  1545. msleep(20);
  1546. return ret;
  1547. }
  1548. static int rtl9000a_config_init(struct phy_device *phydev)
  1549. {
  1550. phydev->autoneg = AUTONEG_DISABLE;
  1551. phydev->speed = SPEED_100;
  1552. phydev->duplex = DUPLEX_FULL;
  1553. return 0;
  1554. }
  1555. static int rtl9000a_config_aneg(struct phy_device *phydev)
  1556. {
  1557. int ret;
  1558. u16 ctl = 0;
  1559. switch (phydev->master_slave_set) {
  1560. case MASTER_SLAVE_CFG_MASTER_FORCE:
  1561. ctl |= CTL1000_AS_MASTER;
  1562. break;
  1563. case MASTER_SLAVE_CFG_SLAVE_FORCE:
  1564. break;
  1565. case MASTER_SLAVE_CFG_UNKNOWN:
  1566. case MASTER_SLAVE_CFG_UNSUPPORTED:
  1567. return 0;
  1568. default:
  1569. phydev_warn(phydev, "Unsupported Master/Slave mode\n");
  1570. return -EOPNOTSUPP;
  1571. }
  1572. ret = phy_modify_changed(phydev, MII_CTRL1000, CTL1000_AS_MASTER, ctl);
  1573. if (ret == 1)
  1574. ret = genphy_soft_reset(phydev);
  1575. return ret;
  1576. }
  1577. static int rtl9000a_read_status(struct phy_device *phydev)
  1578. {
  1579. int ret;
  1580. phydev->master_slave_get = MASTER_SLAVE_CFG_UNKNOWN;
  1581. phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN;
  1582. ret = genphy_update_link(phydev);
  1583. if (ret)
  1584. return ret;
  1585. ret = phy_read(phydev, MII_CTRL1000);
  1586. if (ret < 0)
  1587. return ret;
  1588. if (ret & CTL1000_AS_MASTER)
  1589. phydev->master_slave_get = MASTER_SLAVE_CFG_MASTER_FORCE;
  1590. else
  1591. phydev->master_slave_get = MASTER_SLAVE_CFG_SLAVE_FORCE;
  1592. ret = phy_read(phydev, MII_STAT1000);
  1593. if (ret < 0)
  1594. return ret;
  1595. if (ret & LPA_1000MSRES)
  1596. phydev->master_slave_state = MASTER_SLAVE_STATE_MASTER;
  1597. else
  1598. phydev->master_slave_state = MASTER_SLAVE_STATE_SLAVE;
  1599. return 0;
  1600. }
  1601. static int rtl9000a_ack_interrupt(struct phy_device *phydev)
  1602. {
  1603. int err;
  1604. err = phy_read(phydev, RTL8211F_INSR);
  1605. return (err < 0) ? err : 0;
  1606. }
  1607. static int rtl9000a_config_intr(struct phy_device *phydev)
  1608. {
  1609. u16 val;
  1610. int err;
  1611. if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  1612. err = rtl9000a_ack_interrupt(phydev);
  1613. if (err)
  1614. return err;
  1615. val = (u16)~RTL9000A_GINMR_LINK_STATUS;
  1616. err = phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
  1617. } else {
  1618. val = ~0;
  1619. err = phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
  1620. if (err)
  1621. return err;
  1622. err = rtl9000a_ack_interrupt(phydev);
  1623. }
  1624. return phy_write_paged(phydev, 0xa42, RTL9000A_GINMR, val);
  1625. }
  1626. static irqreturn_t rtl9000a_handle_interrupt(struct phy_device *phydev)
  1627. {
  1628. int irq_status;
  1629. irq_status = phy_read(phydev, RTL8211F_INSR);
  1630. if (irq_status < 0) {
  1631. phy_error(phydev);
  1632. return IRQ_NONE;
  1633. }
  1634. if (!(irq_status & RTL8211F_INER_LINK_STATUS))
  1635. return IRQ_NONE;
  1636. phy_trigger_machine(phydev);
  1637. return IRQ_HANDLED;
  1638. }
  1639. static int rtl8221b_ack_interrupt(struct phy_device *phydev)
  1640. {
  1641. int err;
  1642. err = phy_read_mmd(phydev, MDIO_MMD_VEND2, RTL8221B_VND2_INSR);
  1643. return (err < 0) ? err : 0;
  1644. }
  1645. static int rtl8221b_config_intr(struct phy_device *phydev)
  1646. {
  1647. int err;
  1648. if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  1649. err = rtl8221b_ack_interrupt(phydev);
  1650. if (err)
  1651. return err;
  1652. err = phy_write_mmd(phydev, MDIO_MMD_VEND2, RTL8221B_VND2_INER,
  1653. RTL8221B_VND2_INER_LINK_STATUS);
  1654. } else {
  1655. err = phy_write_mmd(phydev, MDIO_MMD_VEND2,
  1656. RTL8221B_VND2_INER, 0);
  1657. if (err)
  1658. return err;
  1659. err = rtl8221b_ack_interrupt(phydev);
  1660. }
  1661. return err;
  1662. }
  1663. static irqreturn_t rtl8221b_handle_interrupt(struct phy_device *phydev)
  1664. {
  1665. int err;
  1666. err = rtl8221b_ack_interrupt(phydev);
  1667. if (err) {
  1668. phy_error(phydev);
  1669. return IRQ_NONE;
  1670. }
  1671. phy_trigger_machine(phydev);
  1672. return IRQ_HANDLED;
  1673. }
  1674. static int rtlgen_sfp_get_features(struct phy_device *phydev)
  1675. {
  1676. linkmode_set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT,
  1677. phydev->supported);
  1678. /* set default mode */
  1679. phydev->speed = SPEED_10000;
  1680. phydev->duplex = DUPLEX_FULL;
  1681. phydev->port = PORT_FIBRE;
  1682. return 0;
  1683. }
  1684. static int rtlgen_sfp_read_status(struct phy_device *phydev)
  1685. {
  1686. int val, err;
  1687. err = genphy_update_link(phydev);
  1688. if (err)
  1689. return err;
  1690. if (!phydev->link)
  1691. return 0;
  1692. val = phy_read(phydev, RTL_PHYSR);
  1693. if (val < 0)
  1694. return val;
  1695. rtlgen_decode_physr(phydev, val);
  1696. return 0;
  1697. }
  1698. static int rtlgen_sfp_config_aneg(struct phy_device *phydev)
  1699. {
  1700. return 0;
  1701. }
  1702. static struct phy_driver realtek_drvs[] = {
  1703. {
  1704. PHY_ID_MATCH_EXACT(0x00008201),
  1705. .name = "RTL8201CP Ethernet",
  1706. .read_page = rtl821x_read_page,
  1707. .write_page = rtl821x_write_page,
  1708. }, {
  1709. PHY_ID_MATCH_EXACT(0x001cc816),
  1710. .name = "RTL8201F Fast Ethernet",
  1711. .config_intr = &rtl8201_config_intr,
  1712. .handle_interrupt = rtl8201_handle_interrupt,
  1713. .suspend = genphy_suspend,
  1714. .resume = genphy_resume,
  1715. .read_page = rtl821x_read_page,
  1716. .write_page = rtl821x_write_page,
  1717. }, {
  1718. PHY_ID_MATCH_MODEL(0x001cc880),
  1719. .name = "RTL8208 Fast Ethernet",
  1720. .read_mmd = genphy_read_mmd_unsupported,
  1721. .write_mmd = genphy_write_mmd_unsupported,
  1722. .suspend = genphy_suspend,
  1723. .resume = genphy_resume,
  1724. .read_page = rtl821x_read_page,
  1725. .write_page = rtl821x_write_page,
  1726. }, {
  1727. PHY_ID_MATCH_EXACT(0x001cc910),
  1728. .name = "RTL8211 Gigabit Ethernet",
  1729. .config_aneg = rtl8211_config_aneg,
  1730. .read_mmd = &genphy_read_mmd_unsupported,
  1731. .write_mmd = &genphy_write_mmd_unsupported,
  1732. .read_page = rtl821x_read_page,
  1733. .write_page = rtl821x_write_page,
  1734. }, {
  1735. PHY_ID_MATCH_EXACT(0x001cc912),
  1736. .name = "RTL8211B Gigabit Ethernet",
  1737. .config_intr = &rtl8211b_config_intr,
  1738. .handle_interrupt = rtl821x_handle_interrupt,
  1739. .read_mmd = &genphy_read_mmd_unsupported,
  1740. .write_mmd = &genphy_write_mmd_unsupported,
  1741. .suspend = rtl8211b_suspend,
  1742. .resume = rtl8211b_resume,
  1743. .read_page = rtl821x_read_page,
  1744. .write_page = rtl821x_write_page,
  1745. }, {
  1746. PHY_ID_MATCH_EXACT(0x001cc913),
  1747. .name = "RTL8211C Gigabit Ethernet",
  1748. .config_init = rtl8211c_config_init,
  1749. .read_mmd = &genphy_read_mmd_unsupported,
  1750. .write_mmd = &genphy_write_mmd_unsupported,
  1751. .read_page = rtl821x_read_page,
  1752. .write_page = rtl821x_write_page,
  1753. }, {
  1754. PHY_ID_MATCH_EXACT(0x001cc914),
  1755. .name = "RTL8211DN Gigabit Ethernet",
  1756. .config_intr = rtl8211e_config_intr,
  1757. .handle_interrupt = rtl821x_handle_interrupt,
  1758. .suspend = genphy_suspend,
  1759. .resume = genphy_resume,
  1760. .read_page = rtl821x_read_page,
  1761. .write_page = rtl821x_write_page,
  1762. }, {
  1763. PHY_ID_MATCH_EXACT(0x001cc915),
  1764. .name = "RTL8211E Gigabit Ethernet",
  1765. .config_init = &rtl8211e_config_init,
  1766. .config_intr = &rtl8211e_config_intr,
  1767. .handle_interrupt = rtl821x_handle_interrupt,
  1768. .suspend = genphy_suspend,
  1769. .resume = genphy_resume,
  1770. .read_page = rtl821x_read_page,
  1771. .write_page = rtl821x_write_page,
  1772. .led_hw_is_supported = rtl8211x_led_hw_is_supported,
  1773. .led_hw_control_get = rtl8211e_led_hw_control_get,
  1774. .led_hw_control_set = rtl8211e_led_hw_control_set,
  1775. }, {
  1776. PHY_ID_MATCH_EXACT(0x001cc916),
  1777. .name = "RTL8211F Gigabit Ethernet",
  1778. .probe = rtl8211f_probe,
  1779. .config_init = &rtl8211f_config_init,
  1780. .read_status = rtlgen_read_status,
  1781. .config_intr = &rtl8211f_config_intr,
  1782. .handle_interrupt = rtl8211f_handle_interrupt,
  1783. .set_wol = rtl8211f_set_wol,
  1784. .get_wol = rtl8211f_get_wol,
  1785. .suspend = rtl8211f_suspend,
  1786. .resume = rtl8211f_resume,
  1787. .read_page = rtl821x_read_page,
  1788. .write_page = rtl821x_write_page,
  1789. .flags = PHY_ALWAYS_CALL_SUSPEND,
  1790. .led_hw_is_supported = rtl8211x_led_hw_is_supported,
  1791. .led_hw_control_get = rtl8211f_led_hw_control_get,
  1792. .led_hw_control_set = rtl8211f_led_hw_control_set,
  1793. }, {
  1794. PHY_ID_MATCH_EXACT(RTL_8211FVD_PHYID),
  1795. .name = "RTL8211F-VD Gigabit Ethernet",
  1796. .probe = rtl821x_probe,
  1797. .config_init = &rtl8211f_config_init,
  1798. .read_status = rtlgen_read_status,
  1799. .config_intr = &rtl8211f_config_intr,
  1800. .handle_interrupt = rtl8211f_handle_interrupt,
  1801. .suspend = rtl821x_suspend,
  1802. .resume = rtl821x_resume,
  1803. .read_page = rtl821x_read_page,
  1804. .write_page = rtl821x_write_page,
  1805. .flags = PHY_ALWAYS_CALL_SUSPEND,
  1806. }, {
  1807. .name = "Generic FE-GE Realtek PHY",
  1808. .match_phy_device = rtlgen_match_phy_device,
  1809. .read_status = rtlgen_read_status,
  1810. .suspend = genphy_suspend,
  1811. .resume = rtlgen_resume,
  1812. .read_page = rtl821x_read_page,
  1813. .write_page = rtl821x_write_page,
  1814. .read_mmd = rtlgen_read_mmd,
  1815. .write_mmd = rtlgen_write_mmd,
  1816. }, {
  1817. .name = "RTL8226 2.5Gbps PHY",
  1818. .match_phy_device = rtl8226_match_phy_device,
  1819. .get_features = rtl822x_get_features,
  1820. .config_aneg = rtl822x_config_aneg,
  1821. .read_status = rtl822x_read_status,
  1822. .suspend = genphy_suspend,
  1823. .resume = rtlgen_resume,
  1824. .read_page = rtl821x_read_page,
  1825. .write_page = rtl821x_write_page,
  1826. .read_mmd = rtl822xb_read_mmd,
  1827. .write_mmd = rtl822xb_write_mmd,
  1828. }, {
  1829. .match_phy_device = rtl8221b_match_phy_device,
  1830. .name = "RTL8226B_RTL8221B 2.5Gbps PHY",
  1831. .get_features = rtl822x_get_features,
  1832. .config_aneg = rtl822x_config_aneg,
  1833. .config_init = rtl822xb_config_init,
  1834. .inband_caps = rtl822x_inband_caps,
  1835. .config_inband = rtl822x_config_inband,
  1836. .get_rate_matching = rtl822xb_get_rate_matching,
  1837. .read_status = rtl822xb_read_status,
  1838. .suspend = genphy_suspend,
  1839. .resume = rtlgen_resume,
  1840. .read_page = rtl821x_read_page,
  1841. .write_page = rtl821x_write_page,
  1842. .read_mmd = rtl822xb_read_mmd,
  1843. .write_mmd = rtl822xb_write_mmd,
  1844. }, {
  1845. PHY_ID_MATCH_EXACT(0x001cc838),
  1846. .name = "RTL8226-CG 2.5Gbps PHY",
  1847. .soft_reset = rtl822x_c45_soft_reset,
  1848. .get_features = rtl822x_c45_get_features,
  1849. .config_aneg = rtl822x_c45_config_aneg,
  1850. .config_init = rtl822x_config_init,
  1851. .inband_caps = rtl822x_inband_caps,
  1852. .config_inband = rtl822x_config_inband,
  1853. .read_status = rtl822xb_c45_read_status,
  1854. .suspend = genphy_c45_pma_suspend,
  1855. .resume = rtlgen_c45_resume,
  1856. .read_mmd = rtl822xb_read_mmd,
  1857. .write_mmd = rtl822xb_write_mmd,
  1858. }, {
  1859. PHY_ID_MATCH_EXACT(0x001cc848),
  1860. .name = "RTL8226B-CG_RTL8221B-CG 2.5Gbps PHY",
  1861. .get_features = rtl822x_get_features,
  1862. .config_aneg = rtl822x_config_aneg,
  1863. .config_init = rtl822xb_config_init,
  1864. .inband_caps = rtl822x_inband_caps,
  1865. .config_inband = rtl822x_config_inband,
  1866. .get_rate_matching = rtl822xb_get_rate_matching,
  1867. .read_status = rtl822xb_read_status,
  1868. .suspend = genphy_suspend,
  1869. .resume = rtlgen_resume,
  1870. .read_page = rtl821x_read_page,
  1871. .write_page = rtl821x_write_page,
  1872. .read_mmd = rtl822xb_read_mmd,
  1873. .write_mmd = rtl822xb_write_mmd,
  1874. }, {
  1875. .match_phy_device = rtl8221b_vb_cg_match_phy_device,
  1876. .name = "RTL8221B-VB-CG 2.5Gbps PHY",
  1877. .config_intr = rtl8221b_config_intr,
  1878. .handle_interrupt = rtl8221b_handle_interrupt,
  1879. .probe = rtl822x_probe,
  1880. .config_init = rtl822xb_config_init,
  1881. .inband_caps = rtl822x_inband_caps,
  1882. .config_inband = rtl822x_config_inband,
  1883. .get_rate_matching = rtl822xb_get_rate_matching,
  1884. .get_features = rtl822x_c45_get_features,
  1885. .config_aneg = rtl822x_c45_config_aneg,
  1886. .read_status = rtl822xb_c45_read_status,
  1887. .suspend = genphy_c45_pma_suspend,
  1888. .resume = rtlgen_c45_resume,
  1889. .read_page = rtl821x_read_page,
  1890. .write_page = rtl821x_write_page,
  1891. .read_mmd = rtl822xb_read_mmd,
  1892. .write_mmd = rtl822xb_write_mmd,
  1893. }, {
  1894. .match_phy_device = rtl8221b_vm_cg_match_phy_device,
  1895. .name = "RTL8221B-VM-CG 2.5Gbps PHY",
  1896. .config_intr = rtl8221b_config_intr,
  1897. .handle_interrupt = rtl8221b_handle_interrupt,
  1898. .probe = rtl822x_probe,
  1899. .config_init = rtl822xb_config_init,
  1900. .inband_caps = rtl822x_inband_caps,
  1901. .config_inband = rtl822x_config_inband,
  1902. .get_rate_matching = rtl822xb_get_rate_matching,
  1903. .get_features = rtl822x_c45_get_features,
  1904. .config_aneg = rtl822x_c45_config_aneg,
  1905. .read_status = rtl822xb_c45_read_status,
  1906. .suspend = genphy_c45_pma_suspend,
  1907. .resume = rtlgen_c45_resume,
  1908. .read_page = rtl821x_read_page,
  1909. .write_page = rtl821x_write_page,
  1910. .read_mmd = rtl822xb_read_mmd,
  1911. .write_mmd = rtl822xb_write_mmd,
  1912. }, {
  1913. .match_phy_device = rtl8251b_c45_match_phy_device,
  1914. .name = "RTL8251B 5Gbps PHY",
  1915. .probe = rtl822x_probe,
  1916. .get_features = rtl822x_get_features,
  1917. .config_aneg = rtl822x_config_aneg,
  1918. .read_status = rtl822x_read_status,
  1919. .suspend = genphy_suspend,
  1920. .resume = rtlgen_resume,
  1921. .read_page = rtl821x_read_page,
  1922. .write_page = rtl821x_write_page,
  1923. }, {
  1924. .match_phy_device = rtl_internal_nbaset_match_phy_device,
  1925. .name = "Realtek Internal NBASE-T PHY",
  1926. .flags = PHY_IS_INTERNAL,
  1927. .probe = rtl822x_probe,
  1928. .get_features = rtl822x_get_features,
  1929. .config_aneg = rtl822x_config_aneg,
  1930. .read_status = rtl822x_read_status,
  1931. .suspend = genphy_suspend,
  1932. .resume = rtlgen_resume,
  1933. .read_page = rtl821x_read_page,
  1934. .write_page = rtl821x_write_page,
  1935. .read_mmd = rtl822x_read_mmd,
  1936. .write_mmd = rtl822x_write_mmd,
  1937. }, {
  1938. PHY_ID_MATCH_EXACT(PHY_ID_RTL_DUMMY_SFP),
  1939. .name = "Realtek SFP PHY Mode",
  1940. .flags = PHY_IS_INTERNAL,
  1941. .probe = rtl822x_probe,
  1942. .get_features = rtlgen_sfp_get_features,
  1943. .config_aneg = rtlgen_sfp_config_aneg,
  1944. .read_status = rtlgen_sfp_read_status,
  1945. .suspend = genphy_suspend,
  1946. .resume = rtlgen_resume,
  1947. .read_page = rtl821x_read_page,
  1948. .write_page = rtl821x_write_page,
  1949. .read_mmd = rtl822x_read_mmd,
  1950. .write_mmd = rtl822x_write_mmd,
  1951. }, {
  1952. PHY_ID_MATCH_EXACT(0x001ccad0),
  1953. .name = "RTL8224 2.5Gbps PHY",
  1954. .flags = PHY_POLL_CABLE_TEST,
  1955. .get_features = rtl822x_c45_get_features,
  1956. .config_aneg = rtl822x_c45_config_aneg,
  1957. .read_status = rtl822x_c45_read_status,
  1958. .suspend = genphy_c45_pma_suspend,
  1959. .resume = rtlgen_c45_resume,
  1960. .cable_test_start = rtl8224_cable_test_start,
  1961. .cable_test_get_status = rtl8224_cable_test_get_status,
  1962. }, {
  1963. PHY_ID_MATCH_EXACT(0x001cc961),
  1964. .name = "RTL8366RB Gigabit Ethernet",
  1965. .config_init = &rtl8366rb_config_init,
  1966. /* These interrupts are handled by the irq controller
  1967. * embedded inside the RTL8366RB, they get unmasked when the
  1968. * irq is requested and ACKed by reading the status register,
  1969. * which is done by the irqchip code.
  1970. */
  1971. .config_intr = genphy_no_config_intr,
  1972. .handle_interrupt = genphy_handle_interrupt_no_ack,
  1973. .suspend = genphy_suspend,
  1974. .resume = genphy_resume,
  1975. }, {
  1976. PHY_ID_MATCH_EXACT(0x001ccb00),
  1977. .name = "RTL9000AA_RTL9000AN Ethernet",
  1978. .features = PHY_BASIC_T1_FEATURES,
  1979. .config_init = rtl9000a_config_init,
  1980. .config_aneg = rtl9000a_config_aneg,
  1981. .read_status = rtl9000a_read_status,
  1982. .config_intr = rtl9000a_config_intr,
  1983. .handle_interrupt = rtl9000a_handle_interrupt,
  1984. .suspend = genphy_suspend,
  1985. .resume = genphy_resume,
  1986. .read_page = rtl821x_read_page,
  1987. .write_page = rtl821x_write_page,
  1988. }, {
  1989. PHY_ID_MATCH_EXACT(0x001cc942),
  1990. .name = "RTL8365MB-VC Gigabit Ethernet",
  1991. /* Interrupt handling analogous to RTL8366RB */
  1992. .config_intr = genphy_no_config_intr,
  1993. .handle_interrupt = genphy_handle_interrupt_no_ack,
  1994. .suspend = genphy_suspend,
  1995. .resume = genphy_resume,
  1996. }, {
  1997. PHY_ID_MATCH_EXACT(0x001cc960),
  1998. .name = "RTL8366S Gigabit Ethernet",
  1999. .suspend = genphy_suspend,
  2000. .resume = genphy_resume,
  2001. .read_mmd = genphy_read_mmd_unsupported,
  2002. .write_mmd = genphy_write_mmd_unsupported,
  2003. },
  2004. };
  2005. module_phy_driver(realtek_drvs);
  2006. static const struct mdio_device_id __maybe_unused realtek_tbl[] = {
  2007. { PHY_ID_MATCH_VENDOR(0x001cc800) },
  2008. { }
  2009. };
  2010. MODULE_DEVICE_TABLE(mdio, realtek_tbl);