713-v6.9-01-net-phy-move-at803x-PHY-driver-to-dedicated-director.patch 162 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598
  1. From 9e56ff53b4115875667760445b028357848b4748 Mon Sep 17 00:00:00 2001
  2. From: Christian Marangi <[email protected]>
  3. Date: Mon, 29 Jan 2024 15:15:19 +0100
  4. Subject: [PATCH 1/5] net: phy: move at803x PHY driver to dedicated directory
  5. In preparation for addition of other Qcom PHY and to tidy things up,
  6. move the at803x PHY driver to dedicated directory.
  7. The same order in the Kconfig selection is saved.
  8. Signed-off-by: Christian Marangi <[email protected]>
  9. Reviewed-by: Andrew Lunn <[email protected]>
  10. Link: https://lore.kernel.org/r/[email protected]
  11. Signed-off-by: Jakub Kicinski <[email protected]>
  12. ---
  13. drivers/net/phy/Kconfig | 7 +------
  14. drivers/net/phy/Makefile | 2 +-
  15. drivers/net/phy/qcom/Kconfig | 7 +++++++
  16. drivers/net/phy/qcom/Makefile | 2 ++
  17. drivers/net/phy/{ => qcom}/at803x.c | 0
  18. 5 files changed, 11 insertions(+), 7 deletions(-)
  19. create mode 100644 drivers/net/phy/qcom/Kconfig
  20. create mode 100644 drivers/net/phy/qcom/Makefile
  21. rename drivers/net/phy/{ => qcom}/at803x.c (100%)
  22. --- a/drivers/net/phy/Kconfig
  23. +++ b/drivers/net/phy/Kconfig
  24. @@ -318,12 +318,7 @@ config NCN26000_PHY
  25. Currently supports the NCN26000 10BASE-T1S Industrial PHY
  26. with MII interface.
  27. -config AT803X_PHY
  28. - tristate "Qualcomm Atheros AR803X PHYs and QCA833x PHYs"
  29. - depends on REGULATOR
  30. - help
  31. - Currently supports the AR8030, AR8031, AR8033, AR8035 and internal
  32. - QCA8337(Internal qca8k PHY) model
  33. +source "drivers/net/phy/qcom/Kconfig"
  34. config QSEMI_PHY
  35. tristate "Quality Semiconductor PHYs"
  36. --- a/drivers/net/phy/Makefile
  37. +++ b/drivers/net/phy/Makefile
  38. @@ -36,7 +36,6 @@ obj-$(CONFIG_ADIN_PHY) += adin.o
  39. obj-$(CONFIG_ADIN1100_PHY) += adin1100.o
  40. obj-$(CONFIG_AMD_PHY) += amd.o
  41. obj-$(CONFIG_AQUANTIA_PHY) += aquantia/
  42. -obj-$(CONFIG_AT803X_PHY) += at803x.o
  43. obj-$(CONFIG_AX88796B_PHY) += ax88796b.o
  44. obj-$(CONFIG_BCM54140_PHY) += bcm54140.o
  45. obj-$(CONFIG_BCM63XX_PHY) += bcm63xx.o
  46. @@ -82,6 +81,7 @@ obj-$(CONFIG_NCN26000_PHY) += ncn26000.o
  47. obj-$(CONFIG_NXP_C45_TJA11XX_PHY) += nxp-c45-tja11xx.o
  48. obj-$(CONFIG_NXP_CBTX_PHY) += nxp-cbtx.o
  49. obj-$(CONFIG_NXP_TJA11XX_PHY) += nxp-tja11xx.o
  50. +obj-y += qcom/
  51. obj-$(CONFIG_QSEMI_PHY) += qsemi.o
  52. obj-$(CONFIG_REALTEK_PHY) += realtek.o
  53. obj-$(CONFIG_RENESAS_PHY) += uPD60620.o
  54. --- /dev/null
  55. +++ b/drivers/net/phy/qcom/Kconfig
  56. @@ -0,0 +1,7 @@
  57. +# SPDX-License-Identifier: GPL-2.0-only
  58. +config AT803X_PHY
  59. + tristate "Qualcomm Atheros AR803X PHYs and QCA833x PHYs"
  60. + depends on REGULATOR
  61. + help
  62. + Currently supports the AR8030, AR8031, AR8033, AR8035 and internal
  63. + QCA8337(Internal qca8k PHY) model
  64. --- /dev/null
  65. +++ b/drivers/net/phy/qcom/Makefile
  66. @@ -0,0 +1,2 @@
  67. +# SPDX-License-Identifier: GPL-2.0
  68. +obj-$(CONFIG_AT803X_PHY) += at803x.o
  69. --- a/drivers/net/phy/at803x.c
  70. +++ /dev/null
  71. @@ -1,2759 +0,0 @@
  72. -// SPDX-License-Identifier: GPL-2.0+
  73. -/*
  74. - * drivers/net/phy/at803x.c
  75. - *
  76. - * Driver for Qualcomm Atheros AR803x PHY
  77. - *
  78. - * Author: Matus Ujhelyi <[email protected]>
  79. - */
  80. -
  81. -#include <linux/phy.h>
  82. -#include <linux/module.h>
  83. -#include <linux/string.h>
  84. -#include <linux/netdevice.h>
  85. -#include <linux/etherdevice.h>
  86. -#include <linux/ethtool_netlink.h>
  87. -#include <linux/bitfield.h>
  88. -#include <linux/regulator/of_regulator.h>
  89. -#include <linux/regulator/driver.h>
  90. -#include <linux/regulator/consumer.h>
  91. -#include <linux/of.h>
  92. -#include <linux/phylink.h>
  93. -#include <linux/sfp.h>
  94. -#include <dt-bindings/net/qca-ar803x.h>
  95. -
  96. -#define AT803X_SPECIFIC_FUNCTION_CONTROL 0x10
  97. -#define AT803X_SFC_ASSERT_CRS BIT(11)
  98. -#define AT803X_SFC_FORCE_LINK BIT(10)
  99. -#define AT803X_SFC_MDI_CROSSOVER_MODE_M GENMASK(6, 5)
  100. -#define AT803X_SFC_AUTOMATIC_CROSSOVER 0x3
  101. -#define AT803X_SFC_MANUAL_MDIX 0x1
  102. -#define AT803X_SFC_MANUAL_MDI 0x0
  103. -#define AT803X_SFC_SQE_TEST BIT(2)
  104. -#define AT803X_SFC_POLARITY_REVERSAL BIT(1)
  105. -#define AT803X_SFC_DISABLE_JABBER BIT(0)
  106. -
  107. -#define AT803X_SPECIFIC_STATUS 0x11
  108. -#define AT803X_SS_SPEED_MASK GENMASK(15, 14)
  109. -#define AT803X_SS_SPEED_1000 2
  110. -#define AT803X_SS_SPEED_100 1
  111. -#define AT803X_SS_SPEED_10 0
  112. -#define AT803X_SS_DUPLEX BIT(13)
  113. -#define AT803X_SS_SPEED_DUPLEX_RESOLVED BIT(11)
  114. -#define AT803X_SS_MDIX BIT(6)
  115. -
  116. -#define QCA808X_SS_SPEED_MASK GENMASK(9, 7)
  117. -#define QCA808X_SS_SPEED_2500 4
  118. -
  119. -#define AT803X_INTR_ENABLE 0x12
  120. -#define AT803X_INTR_ENABLE_AUTONEG_ERR BIT(15)
  121. -#define AT803X_INTR_ENABLE_SPEED_CHANGED BIT(14)
  122. -#define AT803X_INTR_ENABLE_DUPLEX_CHANGED BIT(13)
  123. -#define AT803X_INTR_ENABLE_PAGE_RECEIVED BIT(12)
  124. -#define AT803X_INTR_ENABLE_LINK_FAIL BIT(11)
  125. -#define AT803X_INTR_ENABLE_LINK_SUCCESS BIT(10)
  126. -#define AT803X_INTR_ENABLE_LINK_FAIL_BX BIT(8)
  127. -#define AT803X_INTR_ENABLE_LINK_SUCCESS_BX BIT(7)
  128. -#define AT803X_INTR_ENABLE_WIRESPEED_DOWNGRADE BIT(5)
  129. -#define AT803X_INTR_ENABLE_POLARITY_CHANGED BIT(1)
  130. -#define AT803X_INTR_ENABLE_WOL BIT(0)
  131. -
  132. -#define AT803X_INTR_STATUS 0x13
  133. -
  134. -#define AT803X_SMART_SPEED 0x14
  135. -#define AT803X_SMART_SPEED_ENABLE BIT(5)
  136. -#define AT803X_SMART_SPEED_RETRY_LIMIT_MASK GENMASK(4, 2)
  137. -#define AT803X_SMART_SPEED_BYPASS_TIMER BIT(1)
  138. -#define AT803X_CDT 0x16
  139. -#define AT803X_CDT_MDI_PAIR_MASK GENMASK(9, 8)
  140. -#define AT803X_CDT_ENABLE_TEST BIT(0)
  141. -#define AT803X_CDT_STATUS 0x1c
  142. -#define AT803X_CDT_STATUS_STAT_NORMAL 0
  143. -#define AT803X_CDT_STATUS_STAT_SHORT 1
  144. -#define AT803X_CDT_STATUS_STAT_OPEN 2
  145. -#define AT803X_CDT_STATUS_STAT_FAIL 3
  146. -#define AT803X_CDT_STATUS_STAT_MASK GENMASK(9, 8)
  147. -#define AT803X_CDT_STATUS_DELTA_TIME_MASK GENMASK(7, 0)
  148. -#define AT803X_LED_CONTROL 0x18
  149. -
  150. -#define AT803X_PHY_MMD3_WOL_CTRL 0x8012
  151. -#define AT803X_WOL_EN BIT(5)
  152. -#define AT803X_LOC_MAC_ADDR_0_15_OFFSET 0x804C
  153. -#define AT803X_LOC_MAC_ADDR_16_31_OFFSET 0x804B
  154. -#define AT803X_LOC_MAC_ADDR_32_47_OFFSET 0x804A
  155. -#define AT803X_REG_CHIP_CONFIG 0x1f
  156. -#define AT803X_BT_BX_REG_SEL 0x8000
  157. -
  158. -#define AT803X_DEBUG_ADDR 0x1D
  159. -#define AT803X_DEBUG_DATA 0x1E
  160. -
  161. -#define AT803X_MODE_CFG_MASK 0x0F
  162. -#define AT803X_MODE_CFG_BASET_RGMII 0x00
  163. -#define AT803X_MODE_CFG_BASET_SGMII 0x01
  164. -#define AT803X_MODE_CFG_BX1000_RGMII_50OHM 0x02
  165. -#define AT803X_MODE_CFG_BX1000_RGMII_75OHM 0x03
  166. -#define AT803X_MODE_CFG_BX1000_CONV_50OHM 0x04
  167. -#define AT803X_MODE_CFG_BX1000_CONV_75OHM 0x05
  168. -#define AT803X_MODE_CFG_FX100_RGMII_50OHM 0x06
  169. -#define AT803X_MODE_CFG_FX100_CONV_50OHM 0x07
  170. -#define AT803X_MODE_CFG_RGMII_AUTO_MDET 0x0B
  171. -#define AT803X_MODE_CFG_FX100_RGMII_75OHM 0x0E
  172. -#define AT803X_MODE_CFG_FX100_CONV_75OHM 0x0F
  173. -
  174. -#define AT803X_PSSR 0x11 /*PHY-Specific Status Register*/
  175. -#define AT803X_PSSR_MR_AN_COMPLETE 0x0200
  176. -
  177. -#define AT803X_DEBUG_ANALOG_TEST_CTRL 0x00
  178. -#define QCA8327_DEBUG_MANU_CTRL_EN BIT(2)
  179. -#define QCA8337_DEBUG_MANU_CTRL_EN GENMASK(3, 2)
  180. -#define AT803X_DEBUG_RX_CLK_DLY_EN BIT(15)
  181. -
  182. -#define AT803X_DEBUG_SYSTEM_CTRL_MODE 0x05
  183. -#define AT803X_DEBUG_TX_CLK_DLY_EN BIT(8)
  184. -
  185. -#define AT803X_DEBUG_REG_HIB_CTRL 0x0b
  186. -#define AT803X_DEBUG_HIB_CTRL_SEL_RST_80U BIT(10)
  187. -#define AT803X_DEBUG_HIB_CTRL_EN_ANY_CHANGE BIT(13)
  188. -#define AT803X_DEBUG_HIB_CTRL_PS_HIB_EN BIT(15)
  189. -
  190. -#define AT803X_DEBUG_REG_3C 0x3C
  191. -
  192. -#define AT803X_DEBUG_REG_GREEN 0x3D
  193. -#define AT803X_DEBUG_GATE_CLK_IN1000 BIT(6)
  194. -
  195. -#define AT803X_DEBUG_REG_1F 0x1F
  196. -#define AT803X_DEBUG_PLL_ON BIT(2)
  197. -#define AT803X_DEBUG_RGMII_1V8 BIT(3)
  198. -
  199. -#define MDIO_AZ_DEBUG 0x800D
  200. -
  201. -/* AT803x supports either the XTAL input pad, an internal PLL or the
  202. - * DSP as clock reference for the clock output pad. The XTAL reference
  203. - * is only used for 25 MHz output, all other frequencies need the PLL.
  204. - * The DSP as a clock reference is used in synchronous ethernet
  205. - * applications.
  206. - *
  207. - * By default the PLL is only enabled if there is a link. Otherwise
  208. - * the PHY will go into low power state and disabled the PLL. You can
  209. - * set the PLL_ON bit (see debug register 0x1f) to keep the PLL always
  210. - * enabled.
  211. - */
  212. -#define AT803X_MMD7_CLK25M 0x8016
  213. -#define AT803X_CLK_OUT_MASK GENMASK(4, 2)
  214. -#define AT803X_CLK_OUT_25MHZ_XTAL 0
  215. -#define AT803X_CLK_OUT_25MHZ_DSP 1
  216. -#define AT803X_CLK_OUT_50MHZ_PLL 2
  217. -#define AT803X_CLK_OUT_50MHZ_DSP 3
  218. -#define AT803X_CLK_OUT_62_5MHZ_PLL 4
  219. -#define AT803X_CLK_OUT_62_5MHZ_DSP 5
  220. -#define AT803X_CLK_OUT_125MHZ_PLL 6
  221. -#define AT803X_CLK_OUT_125MHZ_DSP 7
  222. -
  223. -/* The AR8035 has another mask which is compatible with the AR8031/AR8033 mask
  224. - * but doesn't support choosing between XTAL/PLL and DSP.
  225. - */
  226. -#define AT8035_CLK_OUT_MASK GENMASK(4, 3)
  227. -
  228. -#define AT803X_CLK_OUT_STRENGTH_MASK GENMASK(8, 7)
  229. -#define AT803X_CLK_OUT_STRENGTH_FULL 0
  230. -#define AT803X_CLK_OUT_STRENGTH_HALF 1
  231. -#define AT803X_CLK_OUT_STRENGTH_QUARTER 2
  232. -
  233. -#define AT803X_DEFAULT_DOWNSHIFT 5
  234. -#define AT803X_MIN_DOWNSHIFT 2
  235. -#define AT803X_MAX_DOWNSHIFT 9
  236. -
  237. -#define AT803X_MMD3_SMARTEEE_CTL1 0x805b
  238. -#define AT803X_MMD3_SMARTEEE_CTL2 0x805c
  239. -#define AT803X_MMD3_SMARTEEE_CTL3 0x805d
  240. -#define AT803X_MMD3_SMARTEEE_CTL3_LPI_EN BIT(8)
  241. -
  242. -#define ATH9331_PHY_ID 0x004dd041
  243. -#define ATH8030_PHY_ID 0x004dd076
  244. -#define ATH8031_PHY_ID 0x004dd074
  245. -#define ATH8032_PHY_ID 0x004dd023
  246. -#define ATH8035_PHY_ID 0x004dd072
  247. -#define AT8030_PHY_ID_MASK 0xffffffef
  248. -
  249. -#define QCA8081_PHY_ID 0x004dd101
  250. -
  251. -#define QCA8327_A_PHY_ID 0x004dd033
  252. -#define QCA8327_B_PHY_ID 0x004dd034
  253. -#define QCA8337_PHY_ID 0x004dd036
  254. -#define QCA9561_PHY_ID 0x004dd042
  255. -#define QCA8K_PHY_ID_MASK 0xffffffff
  256. -
  257. -#define QCA8K_DEVFLAGS_REVISION_MASK GENMASK(2, 0)
  258. -
  259. -#define AT803X_PAGE_FIBER 0
  260. -#define AT803X_PAGE_COPPER 1
  261. -
  262. -/* don't turn off internal PLL */
  263. -#define AT803X_KEEP_PLL_ENABLED BIT(0)
  264. -#define AT803X_DISABLE_SMARTEEE BIT(1)
  265. -
  266. -/* disable hibernation mode */
  267. -#define AT803X_DISABLE_HIBERNATION_MODE BIT(2)
  268. -
  269. -/* ADC threshold */
  270. -#define QCA808X_PHY_DEBUG_ADC_THRESHOLD 0x2c80
  271. -#define QCA808X_ADC_THRESHOLD_MASK GENMASK(7, 0)
  272. -#define QCA808X_ADC_THRESHOLD_80MV 0
  273. -#define QCA808X_ADC_THRESHOLD_100MV 0xf0
  274. -#define QCA808X_ADC_THRESHOLD_200MV 0x0f
  275. -#define QCA808X_ADC_THRESHOLD_300MV 0xff
  276. -
  277. -/* CLD control */
  278. -#define QCA808X_PHY_MMD3_ADDR_CLD_CTRL7 0x8007
  279. -#define QCA808X_8023AZ_AFE_CTRL_MASK GENMASK(8, 4)
  280. -#define QCA808X_8023AZ_AFE_EN 0x90
  281. -
  282. -/* AZ control */
  283. -#define QCA808X_PHY_MMD3_AZ_TRAINING_CTRL 0x8008
  284. -#define QCA808X_MMD3_AZ_TRAINING_VAL 0x1c32
  285. -
  286. -#define QCA808X_PHY_MMD1_MSE_THRESHOLD_20DB 0x8014
  287. -#define QCA808X_MSE_THRESHOLD_20DB_VALUE 0x529
  288. -
  289. -#define QCA808X_PHY_MMD1_MSE_THRESHOLD_17DB 0x800E
  290. -#define QCA808X_MSE_THRESHOLD_17DB_VALUE 0x341
  291. -
  292. -#define QCA808X_PHY_MMD1_MSE_THRESHOLD_27DB 0x801E
  293. -#define QCA808X_MSE_THRESHOLD_27DB_VALUE 0x419
  294. -
  295. -#define QCA808X_PHY_MMD1_MSE_THRESHOLD_28DB 0x8020
  296. -#define QCA808X_MSE_THRESHOLD_28DB_VALUE 0x341
  297. -
  298. -#define QCA808X_PHY_MMD7_TOP_OPTION1 0x901c
  299. -#define QCA808X_TOP_OPTION1_DATA 0x0
  300. -
  301. -#define QCA808X_PHY_MMD3_DEBUG_1 0xa100
  302. -#define QCA808X_MMD3_DEBUG_1_VALUE 0x9203
  303. -#define QCA808X_PHY_MMD3_DEBUG_2 0xa101
  304. -#define QCA808X_MMD3_DEBUG_2_VALUE 0x48ad
  305. -#define QCA808X_PHY_MMD3_DEBUG_3 0xa103
  306. -#define QCA808X_MMD3_DEBUG_3_VALUE 0x1698
  307. -#define QCA808X_PHY_MMD3_DEBUG_4 0xa105
  308. -#define QCA808X_MMD3_DEBUG_4_VALUE 0x8001
  309. -#define QCA808X_PHY_MMD3_DEBUG_5 0xa106
  310. -#define QCA808X_MMD3_DEBUG_5_VALUE 0x1111
  311. -#define QCA808X_PHY_MMD3_DEBUG_6 0xa011
  312. -#define QCA808X_MMD3_DEBUG_6_VALUE 0x5f85
  313. -
  314. -/* master/slave seed config */
  315. -#define QCA808X_PHY_DEBUG_LOCAL_SEED 9
  316. -#define QCA808X_MASTER_SLAVE_SEED_ENABLE BIT(1)
  317. -#define QCA808X_MASTER_SLAVE_SEED_CFG GENMASK(12, 2)
  318. -#define QCA808X_MASTER_SLAVE_SEED_RANGE 0x32
  319. -
  320. -/* Hibernation yields lower power consumpiton in contrast with normal operation mode.
  321. - * when the copper cable is unplugged, the PHY enters into hibernation mode in about 10s.
  322. - */
  323. -#define QCA808X_DBG_AN_TEST 0xb
  324. -#define QCA808X_HIBERNATION_EN BIT(15)
  325. -
  326. -#define QCA808X_CDT_ENABLE_TEST BIT(15)
  327. -#define QCA808X_CDT_INTER_CHECK_DIS BIT(13)
  328. -#define QCA808X_CDT_STATUS BIT(11)
  329. -#define QCA808X_CDT_LENGTH_UNIT BIT(10)
  330. -
  331. -#define QCA808X_MMD3_CDT_STATUS 0x8064
  332. -#define QCA808X_MMD3_CDT_DIAG_PAIR_A 0x8065
  333. -#define QCA808X_MMD3_CDT_DIAG_PAIR_B 0x8066
  334. -#define QCA808X_MMD3_CDT_DIAG_PAIR_C 0x8067
  335. -#define QCA808X_MMD3_CDT_DIAG_PAIR_D 0x8068
  336. -#define QCA808X_CDT_DIAG_LENGTH_SAME_SHORT GENMASK(15, 8)
  337. -#define QCA808X_CDT_DIAG_LENGTH_CROSS_SHORT GENMASK(7, 0)
  338. -
  339. -#define QCA808X_CDT_CODE_PAIR_A GENMASK(15, 12)
  340. -#define QCA808X_CDT_CODE_PAIR_B GENMASK(11, 8)
  341. -#define QCA808X_CDT_CODE_PAIR_C GENMASK(7, 4)
  342. -#define QCA808X_CDT_CODE_PAIR_D GENMASK(3, 0)
  343. -
  344. -#define QCA808X_CDT_STATUS_STAT_TYPE GENMASK(1, 0)
  345. -#define QCA808X_CDT_STATUS_STAT_FAIL FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 0)
  346. -#define QCA808X_CDT_STATUS_STAT_NORMAL FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 1)
  347. -#define QCA808X_CDT_STATUS_STAT_SAME_OPEN FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 2)
  348. -#define QCA808X_CDT_STATUS_STAT_SAME_SHORT FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 3)
  349. -
  350. -#define QCA808X_CDT_STATUS_STAT_MDI GENMASK(3, 2)
  351. -#define QCA808X_CDT_STATUS_STAT_MDI1 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 1)
  352. -#define QCA808X_CDT_STATUS_STAT_MDI2 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 2)
  353. -#define QCA808X_CDT_STATUS_STAT_MDI3 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 3)
  354. -
  355. -/* NORMAL are MDI with type set to 0 */
  356. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI1
  357. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  358. - QCA808X_CDT_STATUS_STAT_MDI1)
  359. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  360. - QCA808X_CDT_STATUS_STAT_MDI1)
  361. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI2
  362. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  363. - QCA808X_CDT_STATUS_STAT_MDI2)
  364. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  365. - QCA808X_CDT_STATUS_STAT_MDI2)
  366. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI3
  367. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  368. - QCA808X_CDT_STATUS_STAT_MDI3)
  369. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  370. - QCA808X_CDT_STATUS_STAT_MDI3)
  371. -
  372. -/* Added for reference of existence but should be handled by wait_for_completion already */
  373. -#define QCA808X_CDT_STATUS_STAT_BUSY (BIT(1) | BIT(3))
  374. -
  375. -#define QCA808X_MMD7_LED_GLOBAL 0x8073
  376. -#define QCA808X_LED_BLINK_1 GENMASK(11, 6)
  377. -#define QCA808X_LED_BLINK_2 GENMASK(5, 0)
  378. -/* Values are the same for both BLINK_1 and BLINK_2 */
  379. -#define QCA808X_LED_BLINK_FREQ_MASK GENMASK(5, 3)
  380. -#define QCA808X_LED_BLINK_FREQ_2HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x0)
  381. -#define QCA808X_LED_BLINK_FREQ_4HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x1)
  382. -#define QCA808X_LED_BLINK_FREQ_8HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x2)
  383. -#define QCA808X_LED_BLINK_FREQ_16HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x3)
  384. -#define QCA808X_LED_BLINK_FREQ_32HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x4)
  385. -#define QCA808X_LED_BLINK_FREQ_64HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x5)
  386. -#define QCA808X_LED_BLINK_FREQ_128HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x6)
  387. -#define QCA808X_LED_BLINK_FREQ_256HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x7)
  388. -#define QCA808X_LED_BLINK_DUTY_MASK GENMASK(2, 0)
  389. -#define QCA808X_LED_BLINK_DUTY_50_50 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x0)
  390. -#define QCA808X_LED_BLINK_DUTY_75_25 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x1)
  391. -#define QCA808X_LED_BLINK_DUTY_25_75 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x2)
  392. -#define QCA808X_LED_BLINK_DUTY_33_67 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x3)
  393. -#define QCA808X_LED_BLINK_DUTY_67_33 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x4)
  394. -#define QCA808X_LED_BLINK_DUTY_17_83 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x5)
  395. -#define QCA808X_LED_BLINK_DUTY_83_17 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x6)
  396. -#define QCA808X_LED_BLINK_DUTY_8_92 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x7)
  397. -
  398. -#define QCA808X_MMD7_LED2_CTRL 0x8074
  399. -#define QCA808X_MMD7_LED2_FORCE_CTRL 0x8075
  400. -#define QCA808X_MMD7_LED1_CTRL 0x8076
  401. -#define QCA808X_MMD7_LED1_FORCE_CTRL 0x8077
  402. -#define QCA808X_MMD7_LED0_CTRL 0x8078
  403. -#define QCA808X_MMD7_LED_CTRL(x) (0x8078 - ((x) * 2))
  404. -
  405. -/* LED hw control pattern is the same for every LED */
  406. -#define QCA808X_LED_PATTERN_MASK GENMASK(15, 0)
  407. -#define QCA808X_LED_SPEED2500_ON BIT(15)
  408. -#define QCA808X_LED_SPEED2500_BLINK BIT(14)
  409. -/* Follow blink trigger even if duplex or speed condition doesn't match */
  410. -#define QCA808X_LED_BLINK_CHECK_BYPASS BIT(13)
  411. -#define QCA808X_LED_FULL_DUPLEX_ON BIT(12)
  412. -#define QCA808X_LED_HALF_DUPLEX_ON BIT(11)
  413. -#define QCA808X_LED_TX_BLINK BIT(10)
  414. -#define QCA808X_LED_RX_BLINK BIT(9)
  415. -#define QCA808X_LED_TX_ON_10MS BIT(8)
  416. -#define QCA808X_LED_RX_ON_10MS BIT(7)
  417. -#define QCA808X_LED_SPEED1000_ON BIT(6)
  418. -#define QCA808X_LED_SPEED100_ON BIT(5)
  419. -#define QCA808X_LED_SPEED10_ON BIT(4)
  420. -#define QCA808X_LED_COLLISION_BLINK BIT(3)
  421. -#define QCA808X_LED_SPEED1000_BLINK BIT(2)
  422. -#define QCA808X_LED_SPEED100_BLINK BIT(1)
  423. -#define QCA808X_LED_SPEED10_BLINK BIT(0)
  424. -
  425. -#define QCA808X_MMD7_LED0_FORCE_CTRL 0x8079
  426. -#define QCA808X_MMD7_LED_FORCE_CTRL(x) (0x8079 - ((x) * 2))
  427. -
  428. -/* LED force ctrl is the same for every LED
  429. - * No documentation exist for this, not even internal one
  430. - * with NDA as QCOM gives only info about configuring
  431. - * hw control pattern rules and doesn't indicate any way
  432. - * to force the LED to specific mode.
  433. - * These define comes from reverse and testing and maybe
  434. - * lack of some info or some info are not entirely correct.
  435. - * For the basic LED control and hw control these finding
  436. - * are enough to support LED control in all the required APIs.
  437. - *
  438. - * On doing some comparison with implementation with qca807x,
  439. - * it was found that it's 1:1 equal to it and confirms all the
  440. - * reverse done. It was also found further specification with the
  441. - * force mode and the blink modes.
  442. - */
  443. -#define QCA808X_LED_FORCE_EN BIT(15)
  444. -#define QCA808X_LED_FORCE_MODE_MASK GENMASK(14, 13)
  445. -#define QCA808X_LED_FORCE_BLINK_1 FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x3)
  446. -#define QCA808X_LED_FORCE_BLINK_2 FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x2)
  447. -#define QCA808X_LED_FORCE_ON FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x1)
  448. -#define QCA808X_LED_FORCE_OFF FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x0)
  449. -
  450. -#define QCA808X_MMD7_LED_POLARITY_CTRL 0x901a
  451. -/* QSDK sets by default 0x46 to this reg that sets BIT 6 for
  452. - * LED to active high. It's not clear what BIT 3 and BIT 4 does.
  453. - */
  454. -#define QCA808X_LED_ACTIVE_HIGH BIT(6)
  455. -
  456. -/* QCA808X 1G chip type */
  457. -#define QCA808X_PHY_MMD7_CHIP_TYPE 0x901d
  458. -#define QCA808X_PHY_CHIP_TYPE_1G BIT(0)
  459. -
  460. -#define QCA8081_PHY_SERDES_MMD1_FIFO_CTRL 0x9072
  461. -#define QCA8081_PHY_FIFO_RSTN BIT(11)
  462. -
  463. -MODULE_DESCRIPTION("Qualcomm Atheros AR803x and QCA808X PHY driver");
  464. -MODULE_AUTHOR("Matus Ujhelyi");
  465. -MODULE_LICENSE("GPL");
  466. -
  467. -enum stat_access_type {
  468. - PHY,
  469. - MMD
  470. -};
  471. -
  472. -struct at803x_hw_stat {
  473. - const char *string;
  474. - u8 reg;
  475. - u32 mask;
  476. - enum stat_access_type access_type;
  477. -};
  478. -
  479. -static struct at803x_hw_stat qca83xx_hw_stats[] = {
  480. - { "phy_idle_errors", 0xa, GENMASK(7, 0), PHY},
  481. - { "phy_receive_errors", 0x15, GENMASK(15, 0), PHY},
  482. - { "eee_wake_errors", 0x16, GENMASK(15, 0), MMD},
  483. -};
  484. -
  485. -struct at803x_ss_mask {
  486. - u16 speed_mask;
  487. - u8 speed_shift;
  488. -};
  489. -
  490. -struct at803x_priv {
  491. - int flags;
  492. - u16 clk_25m_reg;
  493. - u16 clk_25m_mask;
  494. - u8 smarteee_lpi_tw_1g;
  495. - u8 smarteee_lpi_tw_100m;
  496. - bool is_fiber;
  497. - bool is_1000basex;
  498. - struct regulator_dev *vddio_rdev;
  499. - struct regulator_dev *vddh_rdev;
  500. - u64 stats[ARRAY_SIZE(qca83xx_hw_stats)];
  501. - int led_polarity_mode;
  502. -};
  503. -
  504. -struct at803x_context {
  505. - u16 bmcr;
  506. - u16 advertise;
  507. - u16 control1000;
  508. - u16 int_enable;
  509. - u16 smart_speed;
  510. - u16 led_control;
  511. -};
  512. -
  513. -static int at803x_debug_reg_write(struct phy_device *phydev, u16 reg, u16 data)
  514. -{
  515. - int ret;
  516. -
  517. - ret = phy_write(phydev, AT803X_DEBUG_ADDR, reg);
  518. - if (ret < 0)
  519. - return ret;
  520. -
  521. - return phy_write(phydev, AT803X_DEBUG_DATA, data);
  522. -}
  523. -
  524. -static int at803x_debug_reg_read(struct phy_device *phydev, u16 reg)
  525. -{
  526. - int ret;
  527. -
  528. - ret = phy_write(phydev, AT803X_DEBUG_ADDR, reg);
  529. - if (ret < 0)
  530. - return ret;
  531. -
  532. - return phy_read(phydev, AT803X_DEBUG_DATA);
  533. -}
  534. -
  535. -static int at803x_debug_reg_mask(struct phy_device *phydev, u16 reg,
  536. - u16 clear, u16 set)
  537. -{
  538. - u16 val;
  539. - int ret;
  540. -
  541. - ret = at803x_debug_reg_read(phydev, reg);
  542. - if (ret < 0)
  543. - return ret;
  544. -
  545. - val = ret & 0xffff;
  546. - val &= ~clear;
  547. - val |= set;
  548. -
  549. - return phy_write(phydev, AT803X_DEBUG_DATA, val);
  550. -}
  551. -
  552. -static int at803x_write_page(struct phy_device *phydev, int page)
  553. -{
  554. - int mask;
  555. - int set;
  556. -
  557. - if (page == AT803X_PAGE_COPPER) {
  558. - set = AT803X_BT_BX_REG_SEL;
  559. - mask = 0;
  560. - } else {
  561. - set = 0;
  562. - mask = AT803X_BT_BX_REG_SEL;
  563. - }
  564. -
  565. - return __phy_modify(phydev, AT803X_REG_CHIP_CONFIG, mask, set);
  566. -}
  567. -
  568. -static int at803x_read_page(struct phy_device *phydev)
  569. -{
  570. - int ccr = __phy_read(phydev, AT803X_REG_CHIP_CONFIG);
  571. -
  572. - if (ccr < 0)
  573. - return ccr;
  574. -
  575. - if (ccr & AT803X_BT_BX_REG_SEL)
  576. - return AT803X_PAGE_COPPER;
  577. -
  578. - return AT803X_PAGE_FIBER;
  579. -}
  580. -
  581. -static int at803x_enable_rx_delay(struct phy_device *phydev)
  582. -{
  583. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL, 0,
  584. - AT803X_DEBUG_RX_CLK_DLY_EN);
  585. -}
  586. -
  587. -static int at803x_enable_tx_delay(struct phy_device *phydev)
  588. -{
  589. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_SYSTEM_CTRL_MODE, 0,
  590. - AT803X_DEBUG_TX_CLK_DLY_EN);
  591. -}
  592. -
  593. -static int at803x_disable_rx_delay(struct phy_device *phydev)
  594. -{
  595. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL,
  596. - AT803X_DEBUG_RX_CLK_DLY_EN, 0);
  597. -}
  598. -
  599. -static int at803x_disable_tx_delay(struct phy_device *phydev)
  600. -{
  601. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_SYSTEM_CTRL_MODE,
  602. - AT803X_DEBUG_TX_CLK_DLY_EN, 0);
  603. -}
  604. -
  605. -/* save relevant PHY registers to private copy */
  606. -static void at803x_context_save(struct phy_device *phydev,
  607. - struct at803x_context *context)
  608. -{
  609. - context->bmcr = phy_read(phydev, MII_BMCR);
  610. - context->advertise = phy_read(phydev, MII_ADVERTISE);
  611. - context->control1000 = phy_read(phydev, MII_CTRL1000);
  612. - context->int_enable = phy_read(phydev, AT803X_INTR_ENABLE);
  613. - context->smart_speed = phy_read(phydev, AT803X_SMART_SPEED);
  614. - context->led_control = phy_read(phydev, AT803X_LED_CONTROL);
  615. -}
  616. -
  617. -/* restore relevant PHY registers from private copy */
  618. -static void at803x_context_restore(struct phy_device *phydev,
  619. - const struct at803x_context *context)
  620. -{
  621. - phy_write(phydev, MII_BMCR, context->bmcr);
  622. - phy_write(phydev, MII_ADVERTISE, context->advertise);
  623. - phy_write(phydev, MII_CTRL1000, context->control1000);
  624. - phy_write(phydev, AT803X_INTR_ENABLE, context->int_enable);
  625. - phy_write(phydev, AT803X_SMART_SPEED, context->smart_speed);
  626. - phy_write(phydev, AT803X_LED_CONTROL, context->led_control);
  627. -}
  628. -
  629. -static int at803x_set_wol(struct phy_device *phydev,
  630. - struct ethtool_wolinfo *wol)
  631. -{
  632. - int ret, irq_enabled;
  633. -
  634. - if (wol->wolopts & WAKE_MAGIC) {
  635. - struct net_device *ndev = phydev->attached_dev;
  636. - const u8 *mac;
  637. - unsigned int i;
  638. - static const unsigned int offsets[] = {
  639. - AT803X_LOC_MAC_ADDR_32_47_OFFSET,
  640. - AT803X_LOC_MAC_ADDR_16_31_OFFSET,
  641. - AT803X_LOC_MAC_ADDR_0_15_OFFSET,
  642. - };
  643. -
  644. - if (!ndev)
  645. - return -ENODEV;
  646. -
  647. - mac = (const u8 *)ndev->dev_addr;
  648. -
  649. - if (!is_valid_ether_addr(mac))
  650. - return -EINVAL;
  651. -
  652. - for (i = 0; i < 3; i++)
  653. - phy_write_mmd(phydev, MDIO_MMD_PCS, offsets[i],
  654. - mac[(i * 2) + 1] | (mac[(i * 2)] << 8));
  655. -
  656. - /* Enable WOL interrupt */
  657. - ret = phy_modify(phydev, AT803X_INTR_ENABLE, 0, AT803X_INTR_ENABLE_WOL);
  658. - if (ret)
  659. - return ret;
  660. - } else {
  661. - /* Disable WOL interrupt */
  662. - ret = phy_modify(phydev, AT803X_INTR_ENABLE, AT803X_INTR_ENABLE_WOL, 0);
  663. - if (ret)
  664. - return ret;
  665. - }
  666. -
  667. - /* Clear WOL status */
  668. - ret = phy_read(phydev, AT803X_INTR_STATUS);
  669. - if (ret < 0)
  670. - return ret;
  671. -
  672. - /* Check if there are other interrupts except for WOL triggered when PHY is
  673. - * in interrupt mode, only the interrupts enabled by AT803X_INTR_ENABLE can
  674. - * be passed up to the interrupt PIN.
  675. - */
  676. - irq_enabled = phy_read(phydev, AT803X_INTR_ENABLE);
  677. - if (irq_enabled < 0)
  678. - return irq_enabled;
  679. -
  680. - irq_enabled &= ~AT803X_INTR_ENABLE_WOL;
  681. - if (ret & irq_enabled && !phy_polling_mode(phydev))
  682. - phy_trigger_machine(phydev);
  683. -
  684. - return 0;
  685. -}
  686. -
  687. -static void at803x_get_wol(struct phy_device *phydev,
  688. - struct ethtool_wolinfo *wol)
  689. -{
  690. - int value;
  691. -
  692. - wol->supported = WAKE_MAGIC;
  693. - wol->wolopts = 0;
  694. -
  695. - value = phy_read(phydev, AT803X_INTR_ENABLE);
  696. - if (value < 0)
  697. - return;
  698. -
  699. - if (value & AT803X_INTR_ENABLE_WOL)
  700. - wol->wolopts |= WAKE_MAGIC;
  701. -}
  702. -
  703. -static int qca83xx_get_sset_count(struct phy_device *phydev)
  704. -{
  705. - return ARRAY_SIZE(qca83xx_hw_stats);
  706. -}
  707. -
  708. -static void qca83xx_get_strings(struct phy_device *phydev, u8 *data)
  709. -{
  710. - int i;
  711. -
  712. - for (i = 0; i < ARRAY_SIZE(qca83xx_hw_stats); i++) {
  713. - strscpy(data + i * ETH_GSTRING_LEN,
  714. - qca83xx_hw_stats[i].string, ETH_GSTRING_LEN);
  715. - }
  716. -}
  717. -
  718. -static u64 qca83xx_get_stat(struct phy_device *phydev, int i)
  719. -{
  720. - struct at803x_hw_stat stat = qca83xx_hw_stats[i];
  721. - struct at803x_priv *priv = phydev->priv;
  722. - int val;
  723. - u64 ret;
  724. -
  725. - if (stat.access_type == MMD)
  726. - val = phy_read_mmd(phydev, MDIO_MMD_PCS, stat.reg);
  727. - else
  728. - val = phy_read(phydev, stat.reg);
  729. -
  730. - if (val < 0) {
  731. - ret = U64_MAX;
  732. - } else {
  733. - val = val & stat.mask;
  734. - priv->stats[i] += val;
  735. - ret = priv->stats[i];
  736. - }
  737. -
  738. - return ret;
  739. -}
  740. -
  741. -static void qca83xx_get_stats(struct phy_device *phydev,
  742. - struct ethtool_stats *stats, u64 *data)
  743. -{
  744. - int i;
  745. -
  746. - for (i = 0; i < ARRAY_SIZE(qca83xx_hw_stats); i++)
  747. - data[i] = qca83xx_get_stat(phydev, i);
  748. -}
  749. -
  750. -static int at803x_suspend(struct phy_device *phydev)
  751. -{
  752. - int value;
  753. - int wol_enabled;
  754. -
  755. - value = phy_read(phydev, AT803X_INTR_ENABLE);
  756. - wol_enabled = value & AT803X_INTR_ENABLE_WOL;
  757. -
  758. - if (wol_enabled)
  759. - value = BMCR_ISOLATE;
  760. - else
  761. - value = BMCR_PDOWN;
  762. -
  763. - phy_modify(phydev, MII_BMCR, 0, value);
  764. -
  765. - return 0;
  766. -}
  767. -
  768. -static int at803x_resume(struct phy_device *phydev)
  769. -{
  770. - return phy_modify(phydev, MII_BMCR, BMCR_PDOWN | BMCR_ISOLATE, 0);
  771. -}
  772. -
  773. -static int at803x_parse_dt(struct phy_device *phydev)
  774. -{
  775. - struct device_node *node = phydev->mdio.dev.of_node;
  776. - struct at803x_priv *priv = phydev->priv;
  777. - u32 freq, strength, tw;
  778. - unsigned int sel;
  779. - int ret;
  780. -
  781. - if (!IS_ENABLED(CONFIG_OF_MDIO))
  782. - return 0;
  783. -
  784. - if (of_property_read_bool(node, "qca,disable-smarteee"))
  785. - priv->flags |= AT803X_DISABLE_SMARTEEE;
  786. -
  787. - if (of_property_read_bool(node, "qca,disable-hibernation-mode"))
  788. - priv->flags |= AT803X_DISABLE_HIBERNATION_MODE;
  789. -
  790. - if (!of_property_read_u32(node, "qca,smarteee-tw-us-1g", &tw)) {
  791. - if (!tw || tw > 255) {
  792. - phydev_err(phydev, "invalid qca,smarteee-tw-us-1g\n");
  793. - return -EINVAL;
  794. - }
  795. - priv->smarteee_lpi_tw_1g = tw;
  796. - }
  797. -
  798. - if (!of_property_read_u32(node, "qca,smarteee-tw-us-100m", &tw)) {
  799. - if (!tw || tw > 255) {
  800. - phydev_err(phydev, "invalid qca,smarteee-tw-us-100m\n");
  801. - return -EINVAL;
  802. - }
  803. - priv->smarteee_lpi_tw_100m = tw;
  804. - }
  805. -
  806. - ret = of_property_read_u32(node, "qca,clk-out-frequency", &freq);
  807. - if (!ret) {
  808. - switch (freq) {
  809. - case 25000000:
  810. - sel = AT803X_CLK_OUT_25MHZ_XTAL;
  811. - break;
  812. - case 50000000:
  813. - sel = AT803X_CLK_OUT_50MHZ_PLL;
  814. - break;
  815. - case 62500000:
  816. - sel = AT803X_CLK_OUT_62_5MHZ_PLL;
  817. - break;
  818. - case 125000000:
  819. - sel = AT803X_CLK_OUT_125MHZ_PLL;
  820. - break;
  821. - default:
  822. - phydev_err(phydev, "invalid qca,clk-out-frequency\n");
  823. - return -EINVAL;
  824. - }
  825. -
  826. - priv->clk_25m_reg |= FIELD_PREP(AT803X_CLK_OUT_MASK, sel);
  827. - priv->clk_25m_mask |= AT803X_CLK_OUT_MASK;
  828. - }
  829. -
  830. - ret = of_property_read_u32(node, "qca,clk-out-strength", &strength);
  831. - if (!ret) {
  832. - priv->clk_25m_mask |= AT803X_CLK_OUT_STRENGTH_MASK;
  833. - switch (strength) {
  834. - case AR803X_STRENGTH_FULL:
  835. - priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_FULL;
  836. - break;
  837. - case AR803X_STRENGTH_HALF:
  838. - priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_HALF;
  839. - break;
  840. - case AR803X_STRENGTH_QUARTER:
  841. - priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_QUARTER;
  842. - break;
  843. - default:
  844. - phydev_err(phydev, "invalid qca,clk-out-strength\n");
  845. - return -EINVAL;
  846. - }
  847. - }
  848. -
  849. - return 0;
  850. -}
  851. -
  852. -static int at803x_probe(struct phy_device *phydev)
  853. -{
  854. - struct device *dev = &phydev->mdio.dev;
  855. - struct at803x_priv *priv;
  856. - int ret;
  857. -
  858. - priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
  859. - if (!priv)
  860. - return -ENOMEM;
  861. -
  862. - /* Init LED polarity mode to -1 */
  863. - priv->led_polarity_mode = -1;
  864. -
  865. - phydev->priv = priv;
  866. -
  867. - ret = at803x_parse_dt(phydev);
  868. - if (ret)
  869. - return ret;
  870. -
  871. - return 0;
  872. -}
  873. -
  874. -static int at803x_get_features(struct phy_device *phydev)
  875. -{
  876. - struct at803x_priv *priv = phydev->priv;
  877. - int err;
  878. -
  879. - err = genphy_read_abilities(phydev);
  880. - if (err)
  881. - return err;
  882. -
  883. - if (phydev->drv->phy_id != ATH8031_PHY_ID)
  884. - return 0;
  885. -
  886. - /* AR8031/AR8033 have different status registers
  887. - * for copper and fiber operation. However, the
  888. - * extended status register is the same for both
  889. - * operation modes.
  890. - *
  891. - * As a result of that, ESTATUS_1000_XFULL is set
  892. - * to 1 even when operating in copper TP mode.
  893. - *
  894. - * Remove this mode from the supported link modes
  895. - * when not operating in 1000BaseX mode.
  896. - */
  897. - if (!priv->is_1000basex)
  898. - linkmode_clear_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT,
  899. - phydev->supported);
  900. -
  901. - return 0;
  902. -}
  903. -
  904. -static int at803x_smarteee_config(struct phy_device *phydev)
  905. -{
  906. - struct at803x_priv *priv = phydev->priv;
  907. - u16 mask = 0, val = 0;
  908. - int ret;
  909. -
  910. - if (priv->flags & AT803X_DISABLE_SMARTEEE)
  911. - return phy_modify_mmd(phydev, MDIO_MMD_PCS,
  912. - AT803X_MMD3_SMARTEEE_CTL3,
  913. - AT803X_MMD3_SMARTEEE_CTL3_LPI_EN, 0);
  914. -
  915. - if (priv->smarteee_lpi_tw_1g) {
  916. - mask |= 0xff00;
  917. - val |= priv->smarteee_lpi_tw_1g << 8;
  918. - }
  919. - if (priv->smarteee_lpi_tw_100m) {
  920. - mask |= 0x00ff;
  921. - val |= priv->smarteee_lpi_tw_100m;
  922. - }
  923. - if (!mask)
  924. - return 0;
  925. -
  926. - ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, AT803X_MMD3_SMARTEEE_CTL1,
  927. - mask, val);
  928. - if (ret)
  929. - return ret;
  930. -
  931. - return phy_modify_mmd(phydev, MDIO_MMD_PCS, AT803X_MMD3_SMARTEEE_CTL3,
  932. - AT803X_MMD3_SMARTEEE_CTL3_LPI_EN,
  933. - AT803X_MMD3_SMARTEEE_CTL3_LPI_EN);
  934. -}
  935. -
  936. -static int at803x_clk_out_config(struct phy_device *phydev)
  937. -{
  938. - struct at803x_priv *priv = phydev->priv;
  939. -
  940. - if (!priv->clk_25m_mask)
  941. - return 0;
  942. -
  943. - return phy_modify_mmd(phydev, MDIO_MMD_AN, AT803X_MMD7_CLK25M,
  944. - priv->clk_25m_mask, priv->clk_25m_reg);
  945. -}
  946. -
  947. -static int at8031_pll_config(struct phy_device *phydev)
  948. -{
  949. - struct at803x_priv *priv = phydev->priv;
  950. -
  951. - /* The default after hardware reset is PLL OFF. After a soft reset, the
  952. - * values are retained.
  953. - */
  954. - if (priv->flags & AT803X_KEEP_PLL_ENABLED)
  955. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F,
  956. - 0, AT803X_DEBUG_PLL_ON);
  957. - else
  958. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F,
  959. - AT803X_DEBUG_PLL_ON, 0);
  960. -}
  961. -
  962. -static int at803x_hibernation_mode_config(struct phy_device *phydev)
  963. -{
  964. - struct at803x_priv *priv = phydev->priv;
  965. -
  966. - /* The default after hardware reset is hibernation mode enabled. After
  967. - * software reset, the value is retained.
  968. - */
  969. - if (!(priv->flags & AT803X_DISABLE_HIBERNATION_MODE))
  970. - return 0;
  971. -
  972. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_HIB_CTRL,
  973. - AT803X_DEBUG_HIB_CTRL_PS_HIB_EN, 0);
  974. -}
  975. -
  976. -static int at803x_config_init(struct phy_device *phydev)
  977. -{
  978. - int ret;
  979. -
  980. - /* The RX and TX delay default is:
  981. - * after HW reset: RX delay enabled and TX delay disabled
  982. - * after SW reset: RX delay enabled, while TX delay retains the
  983. - * value before reset.
  984. - */
  985. - if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
  986. - phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID)
  987. - ret = at803x_enable_rx_delay(phydev);
  988. - else
  989. - ret = at803x_disable_rx_delay(phydev);
  990. - if (ret < 0)
  991. - return ret;
  992. -
  993. - if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
  994. - phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)
  995. - ret = at803x_enable_tx_delay(phydev);
  996. - else
  997. - ret = at803x_disable_tx_delay(phydev);
  998. - if (ret < 0)
  999. - return ret;
  1000. -
  1001. - ret = at803x_smarteee_config(phydev);
  1002. - if (ret < 0)
  1003. - return ret;
  1004. -
  1005. - ret = at803x_clk_out_config(phydev);
  1006. - if (ret < 0)
  1007. - return ret;
  1008. -
  1009. - ret = at803x_hibernation_mode_config(phydev);
  1010. - if (ret < 0)
  1011. - return ret;
  1012. -
  1013. - /* Ar803x extended next page bit is enabled by default. Cisco
  1014. - * multigig switches read this bit and attempt to negotiate 10Gbps
  1015. - * rates even if the next page bit is disabled. This is incorrect
  1016. - * behaviour but we still need to accommodate it. XNP is only needed
  1017. - * for 10Gbps support, so disable XNP.
  1018. - */
  1019. - return phy_modify(phydev, MII_ADVERTISE, MDIO_AN_CTRL1_XNP, 0);
  1020. -}
  1021. -
  1022. -static int at803x_ack_interrupt(struct phy_device *phydev)
  1023. -{
  1024. - int err;
  1025. -
  1026. - err = phy_read(phydev, AT803X_INTR_STATUS);
  1027. -
  1028. - return (err < 0) ? err : 0;
  1029. -}
  1030. -
  1031. -static int at803x_config_intr(struct phy_device *phydev)
  1032. -{
  1033. - int err;
  1034. - int value;
  1035. -
  1036. - value = phy_read(phydev, AT803X_INTR_ENABLE);
  1037. -
  1038. - if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  1039. - /* Clear any pending interrupts */
  1040. - err = at803x_ack_interrupt(phydev);
  1041. - if (err)
  1042. - return err;
  1043. -
  1044. - value |= AT803X_INTR_ENABLE_AUTONEG_ERR;
  1045. - value |= AT803X_INTR_ENABLE_SPEED_CHANGED;
  1046. - value |= AT803X_INTR_ENABLE_DUPLEX_CHANGED;
  1047. - value |= AT803X_INTR_ENABLE_LINK_FAIL;
  1048. - value |= AT803X_INTR_ENABLE_LINK_SUCCESS;
  1049. -
  1050. - err = phy_write(phydev, AT803X_INTR_ENABLE, value);
  1051. - } else {
  1052. - err = phy_write(phydev, AT803X_INTR_ENABLE, 0);
  1053. - if (err)
  1054. - return err;
  1055. -
  1056. - /* Clear any pending interrupts */
  1057. - err = at803x_ack_interrupt(phydev);
  1058. - }
  1059. -
  1060. - return err;
  1061. -}
  1062. -
  1063. -static irqreturn_t at803x_handle_interrupt(struct phy_device *phydev)
  1064. -{
  1065. - int irq_status, int_enabled;
  1066. -
  1067. - irq_status = phy_read(phydev, AT803X_INTR_STATUS);
  1068. - if (irq_status < 0) {
  1069. - phy_error(phydev);
  1070. - return IRQ_NONE;
  1071. - }
  1072. -
  1073. - /* Read the current enabled interrupts */
  1074. - int_enabled = phy_read(phydev, AT803X_INTR_ENABLE);
  1075. - if (int_enabled < 0) {
  1076. - phy_error(phydev);
  1077. - return IRQ_NONE;
  1078. - }
  1079. -
  1080. - /* See if this was one of our enabled interrupts */
  1081. - if (!(irq_status & int_enabled))
  1082. - return IRQ_NONE;
  1083. -
  1084. - phy_trigger_machine(phydev);
  1085. -
  1086. - return IRQ_HANDLED;
  1087. -}
  1088. -
  1089. -static void at803x_link_change_notify(struct phy_device *phydev)
  1090. -{
  1091. - /*
  1092. - * Conduct a hardware reset for AT8030 every time a link loss is
  1093. - * signalled. This is necessary to circumvent a hardware bug that
  1094. - * occurs when the cable is unplugged while TX packets are pending
  1095. - * in the FIFO. In such cases, the FIFO enters an error mode it
  1096. - * cannot recover from by software.
  1097. - */
  1098. - if (phydev->state == PHY_NOLINK && phydev->mdio.reset_gpio) {
  1099. - struct at803x_context context;
  1100. -
  1101. - at803x_context_save(phydev, &context);
  1102. -
  1103. - phy_device_reset(phydev, 1);
  1104. - usleep_range(1000, 2000);
  1105. - phy_device_reset(phydev, 0);
  1106. - usleep_range(1000, 2000);
  1107. -
  1108. - at803x_context_restore(phydev, &context);
  1109. -
  1110. - phydev_dbg(phydev, "%s(): phy was reset\n", __func__);
  1111. - }
  1112. -}
  1113. -
  1114. -static int at803x_read_specific_status(struct phy_device *phydev,
  1115. - struct at803x_ss_mask ss_mask)
  1116. -{
  1117. - int ss;
  1118. -
  1119. - /* Read the AT8035 PHY-Specific Status register, which indicates the
  1120. - * speed and duplex that the PHY is actually using, irrespective of
  1121. - * whether we are in autoneg mode or not.
  1122. - */
  1123. - ss = phy_read(phydev, AT803X_SPECIFIC_STATUS);
  1124. - if (ss < 0)
  1125. - return ss;
  1126. -
  1127. - if (ss & AT803X_SS_SPEED_DUPLEX_RESOLVED) {
  1128. - int sfc, speed;
  1129. -
  1130. - sfc = phy_read(phydev, AT803X_SPECIFIC_FUNCTION_CONTROL);
  1131. - if (sfc < 0)
  1132. - return sfc;
  1133. -
  1134. - speed = ss & ss_mask.speed_mask;
  1135. - speed >>= ss_mask.speed_shift;
  1136. -
  1137. - switch (speed) {
  1138. - case AT803X_SS_SPEED_10:
  1139. - phydev->speed = SPEED_10;
  1140. - break;
  1141. - case AT803X_SS_SPEED_100:
  1142. - phydev->speed = SPEED_100;
  1143. - break;
  1144. - case AT803X_SS_SPEED_1000:
  1145. - phydev->speed = SPEED_1000;
  1146. - break;
  1147. - case QCA808X_SS_SPEED_2500:
  1148. - phydev->speed = SPEED_2500;
  1149. - break;
  1150. - }
  1151. - if (ss & AT803X_SS_DUPLEX)
  1152. - phydev->duplex = DUPLEX_FULL;
  1153. - else
  1154. - phydev->duplex = DUPLEX_HALF;
  1155. -
  1156. - if (ss & AT803X_SS_MDIX)
  1157. - phydev->mdix = ETH_TP_MDI_X;
  1158. - else
  1159. - phydev->mdix = ETH_TP_MDI;
  1160. -
  1161. - switch (FIELD_GET(AT803X_SFC_MDI_CROSSOVER_MODE_M, sfc)) {
  1162. - case AT803X_SFC_MANUAL_MDI:
  1163. - phydev->mdix_ctrl = ETH_TP_MDI;
  1164. - break;
  1165. - case AT803X_SFC_MANUAL_MDIX:
  1166. - phydev->mdix_ctrl = ETH_TP_MDI_X;
  1167. - break;
  1168. - case AT803X_SFC_AUTOMATIC_CROSSOVER:
  1169. - phydev->mdix_ctrl = ETH_TP_MDI_AUTO;
  1170. - break;
  1171. - }
  1172. - }
  1173. -
  1174. - return 0;
  1175. -}
  1176. -
  1177. -static int at803x_read_status(struct phy_device *phydev)
  1178. -{
  1179. - struct at803x_ss_mask ss_mask = { 0 };
  1180. - int err, old_link = phydev->link;
  1181. -
  1182. - /* Update the link, but return if there was an error */
  1183. - err = genphy_update_link(phydev);
  1184. - if (err)
  1185. - return err;
  1186. -
  1187. - /* why bother the PHY if nothing can have changed */
  1188. - if (phydev->autoneg == AUTONEG_ENABLE && old_link && phydev->link)
  1189. - return 0;
  1190. -
  1191. - phydev->speed = SPEED_UNKNOWN;
  1192. - phydev->duplex = DUPLEX_UNKNOWN;
  1193. - phydev->pause = 0;
  1194. - phydev->asym_pause = 0;
  1195. -
  1196. - err = genphy_read_lpa(phydev);
  1197. - if (err < 0)
  1198. - return err;
  1199. -
  1200. - ss_mask.speed_mask = AT803X_SS_SPEED_MASK;
  1201. - ss_mask.speed_shift = __bf_shf(AT803X_SS_SPEED_MASK);
  1202. - err = at803x_read_specific_status(phydev, ss_mask);
  1203. - if (err < 0)
  1204. - return err;
  1205. -
  1206. - if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete)
  1207. - phy_resolve_aneg_pause(phydev);
  1208. -
  1209. - return 0;
  1210. -}
  1211. -
  1212. -static int at803x_config_mdix(struct phy_device *phydev, u8 ctrl)
  1213. -{
  1214. - u16 val;
  1215. -
  1216. - switch (ctrl) {
  1217. - case ETH_TP_MDI:
  1218. - val = AT803X_SFC_MANUAL_MDI;
  1219. - break;
  1220. - case ETH_TP_MDI_X:
  1221. - val = AT803X_SFC_MANUAL_MDIX;
  1222. - break;
  1223. - case ETH_TP_MDI_AUTO:
  1224. - val = AT803X_SFC_AUTOMATIC_CROSSOVER;
  1225. - break;
  1226. - default:
  1227. - return 0;
  1228. - }
  1229. -
  1230. - return phy_modify_changed(phydev, AT803X_SPECIFIC_FUNCTION_CONTROL,
  1231. - AT803X_SFC_MDI_CROSSOVER_MODE_M,
  1232. - FIELD_PREP(AT803X_SFC_MDI_CROSSOVER_MODE_M, val));
  1233. -}
  1234. -
  1235. -static int at803x_prepare_config_aneg(struct phy_device *phydev)
  1236. -{
  1237. - int ret;
  1238. -
  1239. - ret = at803x_config_mdix(phydev, phydev->mdix_ctrl);
  1240. - if (ret < 0)
  1241. - return ret;
  1242. -
  1243. - /* Changes of the midx bits are disruptive to the normal operation;
  1244. - * therefore any changes to these registers must be followed by a
  1245. - * software reset to take effect.
  1246. - */
  1247. - if (ret == 1) {
  1248. - ret = genphy_soft_reset(phydev);
  1249. - if (ret < 0)
  1250. - return ret;
  1251. - }
  1252. -
  1253. - return 0;
  1254. -}
  1255. -
  1256. -static int at803x_config_aneg(struct phy_device *phydev)
  1257. -{
  1258. - struct at803x_priv *priv = phydev->priv;
  1259. - int ret;
  1260. -
  1261. - ret = at803x_prepare_config_aneg(phydev);
  1262. - if (ret)
  1263. - return ret;
  1264. -
  1265. - if (priv->is_1000basex)
  1266. - return genphy_c37_config_aneg(phydev);
  1267. -
  1268. - return genphy_config_aneg(phydev);
  1269. -}
  1270. -
  1271. -static int at803x_get_downshift(struct phy_device *phydev, u8 *d)
  1272. -{
  1273. - int val;
  1274. -
  1275. - val = phy_read(phydev, AT803X_SMART_SPEED);
  1276. - if (val < 0)
  1277. - return val;
  1278. -
  1279. - if (val & AT803X_SMART_SPEED_ENABLE)
  1280. - *d = FIELD_GET(AT803X_SMART_SPEED_RETRY_LIMIT_MASK, val) + 2;
  1281. - else
  1282. - *d = DOWNSHIFT_DEV_DISABLE;
  1283. -
  1284. - return 0;
  1285. -}
  1286. -
  1287. -static int at803x_set_downshift(struct phy_device *phydev, u8 cnt)
  1288. -{
  1289. - u16 mask, set;
  1290. - int ret;
  1291. -
  1292. - switch (cnt) {
  1293. - case DOWNSHIFT_DEV_DEFAULT_COUNT:
  1294. - cnt = AT803X_DEFAULT_DOWNSHIFT;
  1295. - fallthrough;
  1296. - case AT803X_MIN_DOWNSHIFT ... AT803X_MAX_DOWNSHIFT:
  1297. - set = AT803X_SMART_SPEED_ENABLE |
  1298. - AT803X_SMART_SPEED_BYPASS_TIMER |
  1299. - FIELD_PREP(AT803X_SMART_SPEED_RETRY_LIMIT_MASK, cnt - 2);
  1300. - mask = AT803X_SMART_SPEED_RETRY_LIMIT_MASK;
  1301. - break;
  1302. - case DOWNSHIFT_DEV_DISABLE:
  1303. - set = 0;
  1304. - mask = AT803X_SMART_SPEED_ENABLE |
  1305. - AT803X_SMART_SPEED_BYPASS_TIMER;
  1306. - break;
  1307. - default:
  1308. - return -EINVAL;
  1309. - }
  1310. -
  1311. - ret = phy_modify_changed(phydev, AT803X_SMART_SPEED, mask, set);
  1312. -
  1313. - /* After changing the smart speed settings, we need to perform a
  1314. - * software reset, use phy_init_hw() to make sure we set the
  1315. - * reapply any values which might got lost during software reset.
  1316. - */
  1317. - if (ret == 1)
  1318. - ret = phy_init_hw(phydev);
  1319. -
  1320. - return ret;
  1321. -}
  1322. -
  1323. -static int at803x_get_tunable(struct phy_device *phydev,
  1324. - struct ethtool_tunable *tuna, void *data)
  1325. -{
  1326. - switch (tuna->id) {
  1327. - case ETHTOOL_PHY_DOWNSHIFT:
  1328. - return at803x_get_downshift(phydev, data);
  1329. - default:
  1330. - return -EOPNOTSUPP;
  1331. - }
  1332. -}
  1333. -
  1334. -static int at803x_set_tunable(struct phy_device *phydev,
  1335. - struct ethtool_tunable *tuna, const void *data)
  1336. -{
  1337. - switch (tuna->id) {
  1338. - case ETHTOOL_PHY_DOWNSHIFT:
  1339. - return at803x_set_downshift(phydev, *(const u8 *)data);
  1340. - default:
  1341. - return -EOPNOTSUPP;
  1342. - }
  1343. -}
  1344. -
  1345. -static int at803x_cable_test_result_trans(u16 status)
  1346. -{
  1347. - switch (FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status)) {
  1348. - case AT803X_CDT_STATUS_STAT_NORMAL:
  1349. - return ETHTOOL_A_CABLE_RESULT_CODE_OK;
  1350. - case AT803X_CDT_STATUS_STAT_SHORT:
  1351. - return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT;
  1352. - case AT803X_CDT_STATUS_STAT_OPEN:
  1353. - return ETHTOOL_A_CABLE_RESULT_CODE_OPEN;
  1354. - case AT803X_CDT_STATUS_STAT_FAIL:
  1355. - default:
  1356. - return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
  1357. - }
  1358. -}
  1359. -
  1360. -static bool at803x_cdt_test_failed(u16 status)
  1361. -{
  1362. - return FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status) ==
  1363. - AT803X_CDT_STATUS_STAT_FAIL;
  1364. -}
  1365. -
  1366. -static bool at803x_cdt_fault_length_valid(u16 status)
  1367. -{
  1368. - switch (FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status)) {
  1369. - case AT803X_CDT_STATUS_STAT_OPEN:
  1370. - case AT803X_CDT_STATUS_STAT_SHORT:
  1371. - return true;
  1372. - }
  1373. - return false;
  1374. -}
  1375. -
  1376. -static int at803x_cdt_fault_length(int dt)
  1377. -{
  1378. - /* According to the datasheet the distance to the fault is
  1379. - * DELTA_TIME * 0.824 meters.
  1380. - *
  1381. - * The author suspect the correct formula is:
  1382. - *
  1383. - * fault_distance = DELTA_TIME * (c * VF) / 125MHz / 2
  1384. - *
  1385. - * where c is the speed of light, VF is the velocity factor of
  1386. - * the twisted pair cable, 125MHz the counter frequency and
  1387. - * we need to divide by 2 because the hardware will measure the
  1388. - * round trip time to the fault and back to the PHY.
  1389. - *
  1390. - * With a VF of 0.69 we get the factor 0.824 mentioned in the
  1391. - * datasheet.
  1392. - */
  1393. - return (dt * 824) / 10;
  1394. -}
  1395. -
  1396. -static int at803x_cdt_start(struct phy_device *phydev,
  1397. - u32 cdt_start)
  1398. -{
  1399. - return phy_write(phydev, AT803X_CDT, cdt_start);
  1400. -}
  1401. -
  1402. -static int at803x_cdt_wait_for_completion(struct phy_device *phydev,
  1403. - u32 cdt_en)
  1404. -{
  1405. - int val, ret;
  1406. -
  1407. - /* One test run takes about 25ms */
  1408. - ret = phy_read_poll_timeout(phydev, AT803X_CDT, val,
  1409. - !(val & cdt_en),
  1410. - 30000, 100000, true);
  1411. -
  1412. - return ret < 0 ? ret : 0;
  1413. -}
  1414. -
  1415. -static int at803x_cable_test_one_pair(struct phy_device *phydev, int pair)
  1416. -{
  1417. - static const int ethtool_pair[] = {
  1418. - ETHTOOL_A_CABLE_PAIR_A,
  1419. - ETHTOOL_A_CABLE_PAIR_B,
  1420. - ETHTOOL_A_CABLE_PAIR_C,
  1421. - ETHTOOL_A_CABLE_PAIR_D,
  1422. - };
  1423. - int ret, val;
  1424. -
  1425. - val = FIELD_PREP(AT803X_CDT_MDI_PAIR_MASK, pair) |
  1426. - AT803X_CDT_ENABLE_TEST;
  1427. - ret = at803x_cdt_start(phydev, val);
  1428. - if (ret)
  1429. - return ret;
  1430. -
  1431. - ret = at803x_cdt_wait_for_completion(phydev, AT803X_CDT_ENABLE_TEST);
  1432. - if (ret)
  1433. - return ret;
  1434. -
  1435. - val = phy_read(phydev, AT803X_CDT_STATUS);
  1436. - if (val < 0)
  1437. - return val;
  1438. -
  1439. - if (at803x_cdt_test_failed(val))
  1440. - return 0;
  1441. -
  1442. - ethnl_cable_test_result(phydev, ethtool_pair[pair],
  1443. - at803x_cable_test_result_trans(val));
  1444. -
  1445. - if (at803x_cdt_fault_length_valid(val)) {
  1446. - val = FIELD_GET(AT803X_CDT_STATUS_DELTA_TIME_MASK, val);
  1447. - ethnl_cable_test_fault_length(phydev, ethtool_pair[pair],
  1448. - at803x_cdt_fault_length(val));
  1449. - }
  1450. -
  1451. - return 1;
  1452. -}
  1453. -
  1454. -static int at803x_cable_test_get_status(struct phy_device *phydev,
  1455. - bool *finished, unsigned long pair_mask)
  1456. -{
  1457. - int retries = 20;
  1458. - int pair, ret;
  1459. -
  1460. - *finished = false;
  1461. -
  1462. - /* According to the datasheet the CDT can be performed when
  1463. - * there is no link partner or when the link partner is
  1464. - * auto-negotiating. Starting the test will restart the AN
  1465. - * automatically. It seems that doing this repeatedly we will
  1466. - * get a slot where our link partner won't disturb our
  1467. - * measurement.
  1468. - */
  1469. - while (pair_mask && retries--) {
  1470. - for_each_set_bit(pair, &pair_mask, 4) {
  1471. - ret = at803x_cable_test_one_pair(phydev, pair);
  1472. - if (ret < 0)
  1473. - return ret;
  1474. - if (ret)
  1475. - clear_bit(pair, &pair_mask);
  1476. - }
  1477. - if (pair_mask)
  1478. - msleep(250);
  1479. - }
  1480. -
  1481. - *finished = true;
  1482. -
  1483. - return 0;
  1484. -}
  1485. -
  1486. -static void at803x_cable_test_autoneg(struct phy_device *phydev)
  1487. -{
  1488. - /* Enable auto-negotiation, but advertise no capabilities, no link
  1489. - * will be established. A restart of the auto-negotiation is not
  1490. - * required, because the cable test will automatically break the link.
  1491. - */
  1492. - phy_write(phydev, MII_BMCR, BMCR_ANENABLE);
  1493. - phy_write(phydev, MII_ADVERTISE, ADVERTISE_CSMA);
  1494. -}
  1495. -
  1496. -static int at803x_cable_test_start(struct phy_device *phydev)
  1497. -{
  1498. - at803x_cable_test_autoneg(phydev);
  1499. - /* we do all the (time consuming) work later */
  1500. - return 0;
  1501. -}
  1502. -
  1503. -static int at8031_rgmii_reg_set_voltage_sel(struct regulator_dev *rdev,
  1504. - unsigned int selector)
  1505. -{
  1506. - struct phy_device *phydev = rdev_get_drvdata(rdev);
  1507. -
  1508. - if (selector)
  1509. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F,
  1510. - 0, AT803X_DEBUG_RGMII_1V8);
  1511. - else
  1512. - return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F,
  1513. - AT803X_DEBUG_RGMII_1V8, 0);
  1514. -}
  1515. -
  1516. -static int at8031_rgmii_reg_get_voltage_sel(struct regulator_dev *rdev)
  1517. -{
  1518. - struct phy_device *phydev = rdev_get_drvdata(rdev);
  1519. - int val;
  1520. -
  1521. - val = at803x_debug_reg_read(phydev, AT803X_DEBUG_REG_1F);
  1522. - if (val < 0)
  1523. - return val;
  1524. -
  1525. - return (val & AT803X_DEBUG_RGMII_1V8) ? 1 : 0;
  1526. -}
  1527. -
  1528. -static const struct regulator_ops vddio_regulator_ops = {
  1529. - .list_voltage = regulator_list_voltage_table,
  1530. - .set_voltage_sel = at8031_rgmii_reg_set_voltage_sel,
  1531. - .get_voltage_sel = at8031_rgmii_reg_get_voltage_sel,
  1532. -};
  1533. -
  1534. -static const unsigned int vddio_voltage_table[] = {
  1535. - 1500000,
  1536. - 1800000,
  1537. -};
  1538. -
  1539. -static const struct regulator_desc vddio_desc = {
  1540. - .name = "vddio",
  1541. - .of_match = of_match_ptr("vddio-regulator"),
  1542. - .n_voltages = ARRAY_SIZE(vddio_voltage_table),
  1543. - .volt_table = vddio_voltage_table,
  1544. - .ops = &vddio_regulator_ops,
  1545. - .type = REGULATOR_VOLTAGE,
  1546. - .owner = THIS_MODULE,
  1547. -};
  1548. -
  1549. -static const struct regulator_ops vddh_regulator_ops = {
  1550. -};
  1551. -
  1552. -static const struct regulator_desc vddh_desc = {
  1553. - .name = "vddh",
  1554. - .of_match = of_match_ptr("vddh-regulator"),
  1555. - .n_voltages = 1,
  1556. - .fixed_uV = 2500000,
  1557. - .ops = &vddh_regulator_ops,
  1558. - .type = REGULATOR_VOLTAGE,
  1559. - .owner = THIS_MODULE,
  1560. -};
  1561. -
  1562. -static int at8031_register_regulators(struct phy_device *phydev)
  1563. -{
  1564. - struct at803x_priv *priv = phydev->priv;
  1565. - struct device *dev = &phydev->mdio.dev;
  1566. - struct regulator_config config = { };
  1567. -
  1568. - config.dev = dev;
  1569. - config.driver_data = phydev;
  1570. -
  1571. - priv->vddio_rdev = devm_regulator_register(dev, &vddio_desc, &config);
  1572. - if (IS_ERR(priv->vddio_rdev)) {
  1573. - phydev_err(phydev, "failed to register VDDIO regulator\n");
  1574. - return PTR_ERR(priv->vddio_rdev);
  1575. - }
  1576. -
  1577. - priv->vddh_rdev = devm_regulator_register(dev, &vddh_desc, &config);
  1578. - if (IS_ERR(priv->vddh_rdev)) {
  1579. - phydev_err(phydev, "failed to register VDDH regulator\n");
  1580. - return PTR_ERR(priv->vddh_rdev);
  1581. - }
  1582. -
  1583. - return 0;
  1584. -}
  1585. -
  1586. -static int at8031_sfp_insert(void *upstream, const struct sfp_eeprom_id *id)
  1587. -{
  1588. - struct phy_device *phydev = upstream;
  1589. - __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_support);
  1590. - __ETHTOOL_DECLARE_LINK_MODE_MASK(sfp_support);
  1591. - DECLARE_PHY_INTERFACE_MASK(interfaces);
  1592. - phy_interface_t iface;
  1593. -
  1594. - linkmode_zero(phy_support);
  1595. - phylink_set(phy_support, 1000baseX_Full);
  1596. - phylink_set(phy_support, 1000baseT_Full);
  1597. - phylink_set(phy_support, Autoneg);
  1598. - phylink_set(phy_support, Pause);
  1599. - phylink_set(phy_support, Asym_Pause);
  1600. -
  1601. - linkmode_zero(sfp_support);
  1602. - sfp_parse_support(phydev->sfp_bus, id, sfp_support, interfaces);
  1603. - /* Some modules support 10G modes as well as others we support.
  1604. - * Mask out non-supported modes so the correct interface is picked.
  1605. - */
  1606. - linkmode_and(sfp_support, phy_support, sfp_support);
  1607. -
  1608. - if (linkmode_empty(sfp_support)) {
  1609. - dev_err(&phydev->mdio.dev, "incompatible SFP module inserted\n");
  1610. - return -EINVAL;
  1611. - }
  1612. -
  1613. - iface = sfp_select_interface(phydev->sfp_bus, sfp_support);
  1614. -
  1615. - /* Only 1000Base-X is supported by AR8031/8033 as the downstream SerDes
  1616. - * interface for use with SFP modules.
  1617. - * However, some copper modules detected as having a preferred SGMII
  1618. - * interface do default to and function in 1000Base-X mode, so just
  1619. - * print a warning and allow such modules, as they may have some chance
  1620. - * of working.
  1621. - */
  1622. - if (iface == PHY_INTERFACE_MODE_SGMII)
  1623. - dev_warn(&phydev->mdio.dev, "module may not function if 1000Base-X not supported\n");
  1624. - else if (iface != PHY_INTERFACE_MODE_1000BASEX)
  1625. - return -EINVAL;
  1626. -
  1627. - return 0;
  1628. -}
  1629. -
  1630. -static const struct sfp_upstream_ops at8031_sfp_ops = {
  1631. - .attach = phy_sfp_attach,
  1632. - .detach = phy_sfp_detach,
  1633. - .module_insert = at8031_sfp_insert,
  1634. -};
  1635. -
  1636. -static int at8031_parse_dt(struct phy_device *phydev)
  1637. -{
  1638. - struct device_node *node = phydev->mdio.dev.of_node;
  1639. - struct at803x_priv *priv = phydev->priv;
  1640. - int ret;
  1641. -
  1642. - if (of_property_read_bool(node, "qca,keep-pll-enabled"))
  1643. - priv->flags |= AT803X_KEEP_PLL_ENABLED;
  1644. -
  1645. - ret = at8031_register_regulators(phydev);
  1646. - if (ret < 0)
  1647. - return ret;
  1648. -
  1649. - ret = devm_regulator_get_enable_optional(&phydev->mdio.dev,
  1650. - "vddio");
  1651. - if (ret) {
  1652. - phydev_err(phydev, "failed to get VDDIO regulator\n");
  1653. - return ret;
  1654. - }
  1655. -
  1656. - /* Only AR8031/8033 support 1000Base-X for SFP modules */
  1657. - return phy_sfp_probe(phydev, &at8031_sfp_ops);
  1658. -}
  1659. -
  1660. -static int at8031_probe(struct phy_device *phydev)
  1661. -{
  1662. - struct at803x_priv *priv = phydev->priv;
  1663. - int mode_cfg;
  1664. - int ccr;
  1665. - int ret;
  1666. -
  1667. - ret = at803x_probe(phydev);
  1668. - if (ret)
  1669. - return ret;
  1670. -
  1671. - /* Only supported on AR8031/AR8033, the AR8030/AR8035 use strapping
  1672. - * options.
  1673. - */
  1674. - ret = at8031_parse_dt(phydev);
  1675. - if (ret)
  1676. - return ret;
  1677. -
  1678. - ccr = phy_read(phydev, AT803X_REG_CHIP_CONFIG);
  1679. - if (ccr < 0)
  1680. - return ccr;
  1681. - mode_cfg = ccr & AT803X_MODE_CFG_MASK;
  1682. -
  1683. - switch (mode_cfg) {
  1684. - case AT803X_MODE_CFG_BX1000_RGMII_50OHM:
  1685. - case AT803X_MODE_CFG_BX1000_RGMII_75OHM:
  1686. - priv->is_1000basex = true;
  1687. - fallthrough;
  1688. - case AT803X_MODE_CFG_FX100_RGMII_50OHM:
  1689. - case AT803X_MODE_CFG_FX100_RGMII_75OHM:
  1690. - priv->is_fiber = true;
  1691. - break;
  1692. - }
  1693. -
  1694. - /* Disable WoL in 1588 register which is enabled
  1695. - * by default
  1696. - */
  1697. - return phy_modify_mmd(phydev, MDIO_MMD_PCS,
  1698. - AT803X_PHY_MMD3_WOL_CTRL,
  1699. - AT803X_WOL_EN, 0);
  1700. -}
  1701. -
  1702. -static int at8031_config_init(struct phy_device *phydev)
  1703. -{
  1704. - struct at803x_priv *priv = phydev->priv;
  1705. - int ret;
  1706. -
  1707. - /* Some bootloaders leave the fiber page selected.
  1708. - * Switch to the appropriate page (fiber or copper), as otherwise we
  1709. - * read the PHY capabilities from the wrong page.
  1710. - */
  1711. - phy_lock_mdio_bus(phydev);
  1712. - ret = at803x_write_page(phydev,
  1713. - priv->is_fiber ? AT803X_PAGE_FIBER :
  1714. - AT803X_PAGE_COPPER);
  1715. - phy_unlock_mdio_bus(phydev);
  1716. - if (ret)
  1717. - return ret;
  1718. -
  1719. - ret = at8031_pll_config(phydev);
  1720. - if (ret < 0)
  1721. - return ret;
  1722. -
  1723. - return at803x_config_init(phydev);
  1724. -}
  1725. -
  1726. -static int at8031_set_wol(struct phy_device *phydev,
  1727. - struct ethtool_wolinfo *wol)
  1728. -{
  1729. - int ret;
  1730. -
  1731. - /* First setup MAC address and enable WOL interrupt */
  1732. - ret = at803x_set_wol(phydev, wol);
  1733. - if (ret)
  1734. - return ret;
  1735. -
  1736. - if (wol->wolopts & WAKE_MAGIC)
  1737. - /* Enable WOL function for 1588 */
  1738. - ret = phy_modify_mmd(phydev, MDIO_MMD_PCS,
  1739. - AT803X_PHY_MMD3_WOL_CTRL,
  1740. - 0, AT803X_WOL_EN);
  1741. - else
  1742. - /* Disable WoL function for 1588 */
  1743. - ret = phy_modify_mmd(phydev, MDIO_MMD_PCS,
  1744. - AT803X_PHY_MMD3_WOL_CTRL,
  1745. - AT803X_WOL_EN, 0);
  1746. -
  1747. - return ret;
  1748. -}
  1749. -
  1750. -static int at8031_config_intr(struct phy_device *phydev)
  1751. -{
  1752. - struct at803x_priv *priv = phydev->priv;
  1753. - int err, value = 0;
  1754. -
  1755. - if (phydev->interrupts == PHY_INTERRUPT_ENABLED &&
  1756. - priv->is_fiber) {
  1757. - /* Clear any pending interrupts */
  1758. - err = at803x_ack_interrupt(phydev);
  1759. - if (err)
  1760. - return err;
  1761. -
  1762. - value |= AT803X_INTR_ENABLE_LINK_FAIL_BX;
  1763. - value |= AT803X_INTR_ENABLE_LINK_SUCCESS_BX;
  1764. -
  1765. - err = phy_set_bits(phydev, AT803X_INTR_ENABLE, value);
  1766. - if (err)
  1767. - return err;
  1768. - }
  1769. -
  1770. - return at803x_config_intr(phydev);
  1771. -}
  1772. -
  1773. -/* AR8031 and AR8033 share the same read status logic */
  1774. -static int at8031_read_status(struct phy_device *phydev)
  1775. -{
  1776. - struct at803x_priv *priv = phydev->priv;
  1777. -
  1778. - if (priv->is_1000basex)
  1779. - return genphy_c37_read_status(phydev);
  1780. -
  1781. - return at803x_read_status(phydev);
  1782. -}
  1783. -
  1784. -/* AR8031 and AR8035 share the same cable test get status reg */
  1785. -static int at8031_cable_test_get_status(struct phy_device *phydev,
  1786. - bool *finished)
  1787. -{
  1788. - return at803x_cable_test_get_status(phydev, finished, 0xf);
  1789. -}
  1790. -
  1791. -/* AR8031 and AR8035 share the same cable test start logic */
  1792. -static int at8031_cable_test_start(struct phy_device *phydev)
  1793. -{
  1794. - at803x_cable_test_autoneg(phydev);
  1795. - phy_write(phydev, MII_CTRL1000, 0);
  1796. - /* we do all the (time consuming) work later */
  1797. - return 0;
  1798. -}
  1799. -
  1800. -/* AR8032, AR9331 and QCA9561 share the same cable test get status reg */
  1801. -static int at8032_cable_test_get_status(struct phy_device *phydev,
  1802. - bool *finished)
  1803. -{
  1804. - return at803x_cable_test_get_status(phydev, finished, 0x3);
  1805. -}
  1806. -
  1807. -static int at8035_parse_dt(struct phy_device *phydev)
  1808. -{
  1809. - struct at803x_priv *priv = phydev->priv;
  1810. -
  1811. - /* Mask is set by the generic at803x_parse_dt
  1812. - * if property is set. Assume property is set
  1813. - * with the mask not zero.
  1814. - */
  1815. - if (priv->clk_25m_mask) {
  1816. - /* Fixup for the AR8030/AR8035. This chip has another mask and
  1817. - * doesn't support the DSP reference. Eg. the lowest bit of the
  1818. - * mask. The upper two bits select the same frequencies. Mask
  1819. - * the lowest bit here.
  1820. - *
  1821. - * Warning:
  1822. - * There was no datasheet for the AR8030 available so this is
  1823. - * just a guess. But the AR8035 is listed as pin compatible
  1824. - * to the AR8030 so there might be a good chance it works on
  1825. - * the AR8030 too.
  1826. - */
  1827. - priv->clk_25m_reg &= AT8035_CLK_OUT_MASK;
  1828. - priv->clk_25m_mask &= AT8035_CLK_OUT_MASK;
  1829. - }
  1830. -
  1831. - return 0;
  1832. -}
  1833. -
  1834. -/* AR8030 and AR8035 shared the same special mask for clk_25m */
  1835. -static int at8035_probe(struct phy_device *phydev)
  1836. -{
  1837. - int ret;
  1838. -
  1839. - ret = at803x_probe(phydev);
  1840. - if (ret)
  1841. - return ret;
  1842. -
  1843. - return at8035_parse_dt(phydev);
  1844. -}
  1845. -
  1846. -static int qca83xx_config_init(struct phy_device *phydev)
  1847. -{
  1848. - u8 switch_revision;
  1849. -
  1850. - switch_revision = phydev->dev_flags & QCA8K_DEVFLAGS_REVISION_MASK;
  1851. -
  1852. - switch (switch_revision) {
  1853. - case 1:
  1854. - /* For 100M waveform */
  1855. - at803x_debug_reg_write(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL, 0x02ea);
  1856. - /* Turn on Gigabit clock */
  1857. - at803x_debug_reg_write(phydev, AT803X_DEBUG_REG_GREEN, 0x68a0);
  1858. - break;
  1859. -
  1860. - case 2:
  1861. - phy_write_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, 0x0);
  1862. - fallthrough;
  1863. - case 4:
  1864. - phy_write_mmd(phydev, MDIO_MMD_PCS, MDIO_AZ_DEBUG, 0x803f);
  1865. - at803x_debug_reg_write(phydev, AT803X_DEBUG_REG_GREEN, 0x6860);
  1866. - at803x_debug_reg_write(phydev, AT803X_DEBUG_SYSTEM_CTRL_MODE, 0x2c46);
  1867. - at803x_debug_reg_write(phydev, AT803X_DEBUG_REG_3C, 0x6000);
  1868. - break;
  1869. - }
  1870. -
  1871. - /* Following original QCA sourcecode set port to prefer master */
  1872. - phy_set_bits(phydev, MII_CTRL1000, CTL1000_PREFER_MASTER);
  1873. -
  1874. - return 0;
  1875. -}
  1876. -
  1877. -static int qca8327_config_init(struct phy_device *phydev)
  1878. -{
  1879. - /* QCA8327 require DAC amplitude adjustment for 100m set to +6%.
  1880. - * Disable on init and enable only with 100m speed following
  1881. - * qca original source code.
  1882. - */
  1883. - at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL,
  1884. - QCA8327_DEBUG_MANU_CTRL_EN, 0);
  1885. -
  1886. - return qca83xx_config_init(phydev);
  1887. -}
  1888. -
  1889. -static void qca83xx_link_change_notify(struct phy_device *phydev)
  1890. -{
  1891. - /* Set DAC Amplitude adjustment to +6% for 100m on link running */
  1892. - if (phydev->state == PHY_RUNNING) {
  1893. - if (phydev->speed == SPEED_100)
  1894. - at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL,
  1895. - QCA8327_DEBUG_MANU_CTRL_EN,
  1896. - QCA8327_DEBUG_MANU_CTRL_EN);
  1897. - } else {
  1898. - /* Reset DAC Amplitude adjustment */
  1899. - at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL,
  1900. - QCA8327_DEBUG_MANU_CTRL_EN, 0);
  1901. - }
  1902. -}
  1903. -
  1904. -static int qca83xx_resume(struct phy_device *phydev)
  1905. -{
  1906. - int ret, val;
  1907. -
  1908. - /* Skip reset if not suspended */
  1909. - if (!phydev->suspended)
  1910. - return 0;
  1911. -
  1912. - /* Reinit the port, reset values set by suspend */
  1913. - qca83xx_config_init(phydev);
  1914. -
  1915. - /* Reset the port on port resume */
  1916. - phy_set_bits(phydev, MII_BMCR, BMCR_RESET | BMCR_ANENABLE);
  1917. -
  1918. - /* On resume from suspend the switch execute a reset and
  1919. - * restart auto-negotiation. Wait for reset to complete.
  1920. - */
  1921. - ret = phy_read_poll_timeout(phydev, MII_BMCR, val, !(val & BMCR_RESET),
  1922. - 50000, 600000, true);
  1923. - if (ret)
  1924. - return ret;
  1925. -
  1926. - usleep_range(1000, 2000);
  1927. -
  1928. - return 0;
  1929. -}
  1930. -
  1931. -static int qca83xx_suspend(struct phy_device *phydev)
  1932. -{
  1933. - at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_GREEN,
  1934. - AT803X_DEBUG_GATE_CLK_IN1000, 0);
  1935. -
  1936. - at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_HIB_CTRL,
  1937. - AT803X_DEBUG_HIB_CTRL_EN_ANY_CHANGE |
  1938. - AT803X_DEBUG_HIB_CTRL_SEL_RST_80U, 0);
  1939. -
  1940. - return 0;
  1941. -}
  1942. -
  1943. -static int qca8337_suspend(struct phy_device *phydev)
  1944. -{
  1945. - /* Only QCA8337 support actual suspend. */
  1946. - genphy_suspend(phydev);
  1947. -
  1948. - return qca83xx_suspend(phydev);
  1949. -}
  1950. -
  1951. -static int qca8327_suspend(struct phy_device *phydev)
  1952. -{
  1953. - u16 mask = 0;
  1954. -
  1955. - /* QCA8327 cause port unreliability when phy suspend
  1956. - * is set.
  1957. - */
  1958. - mask |= ~(BMCR_SPEED1000 | BMCR_FULLDPLX);
  1959. - phy_modify(phydev, MII_BMCR, mask, 0);
  1960. -
  1961. - return qca83xx_suspend(phydev);
  1962. -}
  1963. -
  1964. -static int qca808x_phy_fast_retrain_config(struct phy_device *phydev)
  1965. -{
  1966. - int ret;
  1967. -
  1968. - /* Enable fast retrain */
  1969. - ret = genphy_c45_fast_retrain(phydev, true);
  1970. - if (ret)
  1971. - return ret;
  1972. -
  1973. - phy_write_mmd(phydev, MDIO_MMD_AN, QCA808X_PHY_MMD7_TOP_OPTION1,
  1974. - QCA808X_TOP_OPTION1_DATA);
  1975. - phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_20DB,
  1976. - QCA808X_MSE_THRESHOLD_20DB_VALUE);
  1977. - phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_17DB,
  1978. - QCA808X_MSE_THRESHOLD_17DB_VALUE);
  1979. - phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_27DB,
  1980. - QCA808X_MSE_THRESHOLD_27DB_VALUE);
  1981. - phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_28DB,
  1982. - QCA808X_MSE_THRESHOLD_28DB_VALUE);
  1983. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_1,
  1984. - QCA808X_MMD3_DEBUG_1_VALUE);
  1985. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_4,
  1986. - QCA808X_MMD3_DEBUG_4_VALUE);
  1987. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_5,
  1988. - QCA808X_MMD3_DEBUG_5_VALUE);
  1989. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_3,
  1990. - QCA808X_MMD3_DEBUG_3_VALUE);
  1991. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_6,
  1992. - QCA808X_MMD3_DEBUG_6_VALUE);
  1993. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_2,
  1994. - QCA808X_MMD3_DEBUG_2_VALUE);
  1995. -
  1996. - return 0;
  1997. -}
  1998. -
  1999. -static int qca808x_phy_ms_seed_enable(struct phy_device *phydev, bool enable)
  2000. -{
  2001. - u16 seed_value;
  2002. -
  2003. - if (!enable)
  2004. - return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_LOCAL_SEED,
  2005. - QCA808X_MASTER_SLAVE_SEED_ENABLE, 0);
  2006. -
  2007. - seed_value = get_random_u32_below(QCA808X_MASTER_SLAVE_SEED_RANGE);
  2008. - return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_LOCAL_SEED,
  2009. - QCA808X_MASTER_SLAVE_SEED_CFG | QCA808X_MASTER_SLAVE_SEED_ENABLE,
  2010. - FIELD_PREP(QCA808X_MASTER_SLAVE_SEED_CFG, seed_value) |
  2011. - QCA808X_MASTER_SLAVE_SEED_ENABLE);
  2012. -}
  2013. -
  2014. -static bool qca808x_is_prefer_master(struct phy_device *phydev)
  2015. -{
  2016. - return (phydev->master_slave_get == MASTER_SLAVE_CFG_MASTER_FORCE) ||
  2017. - (phydev->master_slave_get == MASTER_SLAVE_CFG_MASTER_PREFERRED);
  2018. -}
  2019. -
  2020. -static bool qca808x_has_fast_retrain_or_slave_seed(struct phy_device *phydev)
  2021. -{
  2022. - return linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported);
  2023. -}
  2024. -
  2025. -static int qca808x_config_init(struct phy_device *phydev)
  2026. -{
  2027. - int ret;
  2028. -
  2029. - /* Active adc&vga on 802.3az for the link 1000M and 100M */
  2030. - ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_ADDR_CLD_CTRL7,
  2031. - QCA808X_8023AZ_AFE_CTRL_MASK, QCA808X_8023AZ_AFE_EN);
  2032. - if (ret)
  2033. - return ret;
  2034. -
  2035. - /* Adjust the threshold on 802.3az for the link 1000M */
  2036. - ret = phy_write_mmd(phydev, MDIO_MMD_PCS,
  2037. - QCA808X_PHY_MMD3_AZ_TRAINING_CTRL,
  2038. - QCA808X_MMD3_AZ_TRAINING_VAL);
  2039. - if (ret)
  2040. - return ret;
  2041. -
  2042. - if (qca808x_has_fast_retrain_or_slave_seed(phydev)) {
  2043. - /* Config the fast retrain for the link 2500M */
  2044. - ret = qca808x_phy_fast_retrain_config(phydev);
  2045. - if (ret)
  2046. - return ret;
  2047. -
  2048. - ret = genphy_read_master_slave(phydev);
  2049. - if (ret < 0)
  2050. - return ret;
  2051. -
  2052. - if (!qca808x_is_prefer_master(phydev)) {
  2053. - /* Enable seed and configure lower ramdom seed to make phy
  2054. - * linked as slave mode.
  2055. - */
  2056. - ret = qca808x_phy_ms_seed_enable(phydev, true);
  2057. - if (ret)
  2058. - return ret;
  2059. - }
  2060. - }
  2061. -
  2062. - /* Configure adc threshold as 100mv for the link 10M */
  2063. - return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_ADC_THRESHOLD,
  2064. - QCA808X_ADC_THRESHOLD_MASK,
  2065. - QCA808X_ADC_THRESHOLD_100MV);
  2066. -}
  2067. -
  2068. -static int qca808x_read_status(struct phy_device *phydev)
  2069. -{
  2070. - struct at803x_ss_mask ss_mask = { 0 };
  2071. - int ret;
  2072. -
  2073. - ret = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_STAT);
  2074. - if (ret < 0)
  2075. - return ret;
  2076. -
  2077. - linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->lp_advertising,
  2078. - ret & MDIO_AN_10GBT_STAT_LP2_5G);
  2079. -
  2080. - ret = genphy_read_status(phydev);
  2081. - if (ret)
  2082. - return ret;
  2083. -
  2084. - /* qca8081 takes the different bits for speed value from at803x */
  2085. - ss_mask.speed_mask = QCA808X_SS_SPEED_MASK;
  2086. - ss_mask.speed_shift = __bf_shf(QCA808X_SS_SPEED_MASK);
  2087. - ret = at803x_read_specific_status(phydev, ss_mask);
  2088. - if (ret < 0)
  2089. - return ret;
  2090. -
  2091. - if (phydev->link) {
  2092. - if (phydev->speed == SPEED_2500)
  2093. - phydev->interface = PHY_INTERFACE_MODE_2500BASEX;
  2094. - else
  2095. - phydev->interface = PHY_INTERFACE_MODE_SGMII;
  2096. - } else {
  2097. - /* generate seed as a lower random value to make PHY linked as SLAVE easily,
  2098. - * except for master/slave configuration fault detected or the master mode
  2099. - * preferred.
  2100. - *
  2101. - * the reason for not putting this code into the function link_change_notify is
  2102. - * the corner case where the link partner is also the qca8081 PHY and the seed
  2103. - * value is configured as the same value, the link can't be up and no link change
  2104. - * occurs.
  2105. - */
  2106. - if (qca808x_has_fast_retrain_or_slave_seed(phydev)) {
  2107. - if (phydev->master_slave_state == MASTER_SLAVE_STATE_ERR ||
  2108. - qca808x_is_prefer_master(phydev)) {
  2109. - qca808x_phy_ms_seed_enable(phydev, false);
  2110. - } else {
  2111. - qca808x_phy_ms_seed_enable(phydev, true);
  2112. - }
  2113. - }
  2114. - }
  2115. -
  2116. - return 0;
  2117. -}
  2118. -
  2119. -static int qca808x_soft_reset(struct phy_device *phydev)
  2120. -{
  2121. - int ret;
  2122. -
  2123. - ret = genphy_soft_reset(phydev);
  2124. - if (ret < 0)
  2125. - return ret;
  2126. -
  2127. - if (qca808x_has_fast_retrain_or_slave_seed(phydev))
  2128. - ret = qca808x_phy_ms_seed_enable(phydev, true);
  2129. -
  2130. - return ret;
  2131. -}
  2132. -
  2133. -static bool qca808x_cdt_fault_length_valid(int cdt_code)
  2134. -{
  2135. - switch (cdt_code) {
  2136. - case QCA808X_CDT_STATUS_STAT_SAME_SHORT:
  2137. - case QCA808X_CDT_STATUS_STAT_SAME_OPEN:
  2138. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL:
  2139. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN:
  2140. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT:
  2141. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL:
  2142. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN:
  2143. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT:
  2144. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL:
  2145. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN:
  2146. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT:
  2147. - return true;
  2148. - default:
  2149. - return false;
  2150. - }
  2151. -}
  2152. -
  2153. -static int qca808x_cable_test_result_trans(int cdt_code)
  2154. -{
  2155. - switch (cdt_code) {
  2156. - case QCA808X_CDT_STATUS_STAT_NORMAL:
  2157. - return ETHTOOL_A_CABLE_RESULT_CODE_OK;
  2158. - case QCA808X_CDT_STATUS_STAT_SAME_SHORT:
  2159. - return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT;
  2160. - case QCA808X_CDT_STATUS_STAT_SAME_OPEN:
  2161. - return ETHTOOL_A_CABLE_RESULT_CODE_OPEN;
  2162. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL:
  2163. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN:
  2164. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT:
  2165. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL:
  2166. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN:
  2167. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT:
  2168. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL:
  2169. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN:
  2170. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT:
  2171. - return ETHTOOL_A_CABLE_RESULT_CODE_CROSS_SHORT;
  2172. - case QCA808X_CDT_STATUS_STAT_FAIL:
  2173. - default:
  2174. - return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
  2175. - }
  2176. -}
  2177. -
  2178. -static int qca808x_cdt_fault_length(struct phy_device *phydev, int pair,
  2179. - int result)
  2180. -{
  2181. - int val;
  2182. - u32 cdt_length_reg = 0;
  2183. -
  2184. - switch (pair) {
  2185. - case ETHTOOL_A_CABLE_PAIR_A:
  2186. - cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_A;
  2187. - break;
  2188. - case ETHTOOL_A_CABLE_PAIR_B:
  2189. - cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_B;
  2190. - break;
  2191. - case ETHTOOL_A_CABLE_PAIR_C:
  2192. - cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_C;
  2193. - break;
  2194. - case ETHTOOL_A_CABLE_PAIR_D:
  2195. - cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_D;
  2196. - break;
  2197. - default:
  2198. - return -EINVAL;
  2199. - }
  2200. -
  2201. - val = phy_read_mmd(phydev, MDIO_MMD_PCS, cdt_length_reg);
  2202. - if (val < 0)
  2203. - return val;
  2204. -
  2205. - if (result == ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT)
  2206. - val = FIELD_GET(QCA808X_CDT_DIAG_LENGTH_SAME_SHORT, val);
  2207. - else
  2208. - val = FIELD_GET(QCA808X_CDT_DIAG_LENGTH_CROSS_SHORT, val);
  2209. -
  2210. - return at803x_cdt_fault_length(val);
  2211. -}
  2212. -
  2213. -static int qca808x_cable_test_start(struct phy_device *phydev)
  2214. -{
  2215. - int ret;
  2216. -
  2217. - /* perform CDT with the following configs:
  2218. - * 1. disable hibernation.
  2219. - * 2. force PHY working in MDI mode.
  2220. - * 3. for PHY working in 1000BaseT.
  2221. - * 4. configure the threshold.
  2222. - */
  2223. -
  2224. - ret = at803x_debug_reg_mask(phydev, QCA808X_DBG_AN_TEST, QCA808X_HIBERNATION_EN, 0);
  2225. - if (ret < 0)
  2226. - return ret;
  2227. -
  2228. - ret = at803x_config_mdix(phydev, ETH_TP_MDI);
  2229. - if (ret < 0)
  2230. - return ret;
  2231. -
  2232. - /* Force 1000base-T needs to configure PMA/PMD and MII_BMCR */
  2233. - phydev->duplex = DUPLEX_FULL;
  2234. - phydev->speed = SPEED_1000;
  2235. - ret = genphy_c45_pma_setup_forced(phydev);
  2236. - if (ret < 0)
  2237. - return ret;
  2238. -
  2239. - ret = genphy_setup_forced(phydev);
  2240. - if (ret < 0)
  2241. - return ret;
  2242. -
  2243. - /* configure the thresholds for open, short, pair ok test */
  2244. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8074, 0xc040);
  2245. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8076, 0xc040);
  2246. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8077, 0xa060);
  2247. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8078, 0xc050);
  2248. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x807a, 0xc060);
  2249. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x807e, 0xb060);
  2250. -
  2251. - return 0;
  2252. -}
  2253. -
  2254. -static int qca808x_cable_test_get_pair_status(struct phy_device *phydev, u8 pair,
  2255. - u16 status)
  2256. -{
  2257. - int length, result;
  2258. - u16 pair_code;
  2259. -
  2260. - switch (pair) {
  2261. - case ETHTOOL_A_CABLE_PAIR_A:
  2262. - pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_A, status);
  2263. - break;
  2264. - case ETHTOOL_A_CABLE_PAIR_B:
  2265. - pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_B, status);
  2266. - break;
  2267. - case ETHTOOL_A_CABLE_PAIR_C:
  2268. - pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_C, status);
  2269. - break;
  2270. - case ETHTOOL_A_CABLE_PAIR_D:
  2271. - pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_D, status);
  2272. - break;
  2273. - default:
  2274. - return -EINVAL;
  2275. - }
  2276. -
  2277. - result = qca808x_cable_test_result_trans(pair_code);
  2278. - ethnl_cable_test_result(phydev, pair, result);
  2279. -
  2280. - if (qca808x_cdt_fault_length_valid(pair_code)) {
  2281. - length = qca808x_cdt_fault_length(phydev, pair, result);
  2282. - ethnl_cable_test_fault_length(phydev, pair, length);
  2283. - }
  2284. -
  2285. - return 0;
  2286. -}
  2287. -
  2288. -static int qca808x_cable_test_get_status(struct phy_device *phydev, bool *finished)
  2289. -{
  2290. - int ret, val;
  2291. -
  2292. - *finished = false;
  2293. -
  2294. - val = QCA808X_CDT_ENABLE_TEST |
  2295. - QCA808X_CDT_LENGTH_UNIT;
  2296. - ret = at803x_cdt_start(phydev, val);
  2297. - if (ret)
  2298. - return ret;
  2299. -
  2300. - ret = at803x_cdt_wait_for_completion(phydev, QCA808X_CDT_ENABLE_TEST);
  2301. - if (ret)
  2302. - return ret;
  2303. -
  2304. - val = phy_read_mmd(phydev, MDIO_MMD_PCS, QCA808X_MMD3_CDT_STATUS);
  2305. - if (val < 0)
  2306. - return val;
  2307. -
  2308. - ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_A, val);
  2309. - if (ret)
  2310. - return ret;
  2311. -
  2312. - ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_B, val);
  2313. - if (ret)
  2314. - return ret;
  2315. -
  2316. - ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_C, val);
  2317. - if (ret)
  2318. - return ret;
  2319. -
  2320. - ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_D, val);
  2321. - if (ret)
  2322. - return ret;
  2323. -
  2324. - *finished = true;
  2325. -
  2326. - return 0;
  2327. -}
  2328. -
  2329. -static int qca808x_get_features(struct phy_device *phydev)
  2330. -{
  2331. - int ret;
  2332. -
  2333. - ret = genphy_c45_pma_read_abilities(phydev);
  2334. - if (ret)
  2335. - return ret;
  2336. -
  2337. - /* The autoneg ability is not existed in bit3 of MMD7.1,
  2338. - * but it is supported by qca808x PHY, so we add it here
  2339. - * manually.
  2340. - */
  2341. - linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->supported);
  2342. -
  2343. - /* As for the qca8081 1G version chip, the 2500baseT ability is also
  2344. - * existed in the bit0 of MMD1.21, we need to remove it manually if
  2345. - * it is the qca8081 1G chip according to the bit0 of MMD7.0x901d.
  2346. - */
  2347. - ret = phy_read_mmd(phydev, MDIO_MMD_AN, QCA808X_PHY_MMD7_CHIP_TYPE);
  2348. - if (ret < 0)
  2349. - return ret;
  2350. -
  2351. - if (QCA808X_PHY_CHIP_TYPE_1G & ret)
  2352. - linkmode_clear_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported);
  2353. -
  2354. - return 0;
  2355. -}
  2356. -
  2357. -static int qca808x_config_aneg(struct phy_device *phydev)
  2358. -{
  2359. - int phy_ctrl = 0;
  2360. - int ret;
  2361. -
  2362. - ret = at803x_prepare_config_aneg(phydev);
  2363. - if (ret)
  2364. - return ret;
  2365. -
  2366. - /* The reg MII_BMCR also needs to be configured for force mode, the
  2367. - * genphy_config_aneg is also needed.
  2368. - */
  2369. - if (phydev->autoneg == AUTONEG_DISABLE)
  2370. - genphy_c45_pma_setup_forced(phydev);
  2371. -
  2372. - if (linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->advertising))
  2373. - phy_ctrl = MDIO_AN_10GBT_CTRL_ADV2_5G;
  2374. -
  2375. - ret = phy_modify_mmd_changed(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_CTRL,
  2376. - MDIO_AN_10GBT_CTRL_ADV2_5G, phy_ctrl);
  2377. - if (ret < 0)
  2378. - return ret;
  2379. -
  2380. - return __genphy_config_aneg(phydev, ret);
  2381. -}
  2382. -
  2383. -static void qca808x_link_change_notify(struct phy_device *phydev)
  2384. -{
  2385. - /* Assert interface sgmii fifo on link down, deassert it on link up,
  2386. - * the interface device address is always phy address added by 1.
  2387. - */
  2388. - mdiobus_c45_modify_changed(phydev->mdio.bus, phydev->mdio.addr + 1,
  2389. - MDIO_MMD_PMAPMD, QCA8081_PHY_SERDES_MMD1_FIFO_CTRL,
  2390. - QCA8081_PHY_FIFO_RSTN,
  2391. - phydev->link ? QCA8081_PHY_FIFO_RSTN : 0);
  2392. -}
  2393. -
  2394. -static int qca808x_led_parse_netdev(struct phy_device *phydev, unsigned long rules,
  2395. - u16 *offload_trigger)
  2396. -{
  2397. - /* Parsing specific to netdev trigger */
  2398. - if (test_bit(TRIGGER_NETDEV_TX, &rules))
  2399. - *offload_trigger |= QCA808X_LED_TX_BLINK;
  2400. - if (test_bit(TRIGGER_NETDEV_RX, &rules))
  2401. - *offload_trigger |= QCA808X_LED_RX_BLINK;
  2402. - if (test_bit(TRIGGER_NETDEV_LINK_10, &rules))
  2403. - *offload_trigger |= QCA808X_LED_SPEED10_ON;
  2404. - if (test_bit(TRIGGER_NETDEV_LINK_100, &rules))
  2405. - *offload_trigger |= QCA808X_LED_SPEED100_ON;
  2406. - if (test_bit(TRIGGER_NETDEV_LINK_1000, &rules))
  2407. - *offload_trigger |= QCA808X_LED_SPEED1000_ON;
  2408. - if (test_bit(TRIGGER_NETDEV_LINK_2500, &rules))
  2409. - *offload_trigger |= QCA808X_LED_SPEED2500_ON;
  2410. - if (test_bit(TRIGGER_NETDEV_HALF_DUPLEX, &rules))
  2411. - *offload_trigger |= QCA808X_LED_HALF_DUPLEX_ON;
  2412. - if (test_bit(TRIGGER_NETDEV_FULL_DUPLEX, &rules))
  2413. - *offload_trigger |= QCA808X_LED_FULL_DUPLEX_ON;
  2414. -
  2415. - if (rules && !*offload_trigger)
  2416. - return -EOPNOTSUPP;
  2417. -
  2418. - /* Enable BLINK_CHECK_BYPASS by default to make the LED
  2419. - * blink even with duplex or speed mode not enabled.
  2420. - */
  2421. - *offload_trigger |= QCA808X_LED_BLINK_CHECK_BYPASS;
  2422. -
  2423. - return 0;
  2424. -}
  2425. -
  2426. -static int qca808x_led_hw_control_enable(struct phy_device *phydev, u8 index)
  2427. -{
  2428. - u16 reg;
  2429. -
  2430. - if (index > 2)
  2431. - return -EINVAL;
  2432. -
  2433. - reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  2434. -
  2435. - return phy_clear_bits_mmd(phydev, MDIO_MMD_AN, reg,
  2436. - QCA808X_LED_FORCE_EN);
  2437. -}
  2438. -
  2439. -static int qca808x_led_hw_is_supported(struct phy_device *phydev, u8 index,
  2440. - unsigned long rules)
  2441. -{
  2442. - u16 offload_trigger = 0;
  2443. -
  2444. - if (index > 2)
  2445. - return -EINVAL;
  2446. -
  2447. - return qca808x_led_parse_netdev(phydev, rules, &offload_trigger);
  2448. -}
  2449. -
  2450. -static int qca808x_led_hw_control_set(struct phy_device *phydev, u8 index,
  2451. - unsigned long rules)
  2452. -{
  2453. - u16 reg, offload_trigger = 0;
  2454. - int ret;
  2455. -
  2456. - if (index > 2)
  2457. - return -EINVAL;
  2458. -
  2459. - reg = QCA808X_MMD7_LED_CTRL(index);
  2460. -
  2461. - ret = qca808x_led_parse_netdev(phydev, rules, &offload_trigger);
  2462. - if (ret)
  2463. - return ret;
  2464. -
  2465. - ret = qca808x_led_hw_control_enable(phydev, index);
  2466. - if (ret)
  2467. - return ret;
  2468. -
  2469. - return phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  2470. - QCA808X_LED_PATTERN_MASK,
  2471. - offload_trigger);
  2472. -}
  2473. -
  2474. -static bool qca808x_led_hw_control_status(struct phy_device *phydev, u8 index)
  2475. -{
  2476. - u16 reg;
  2477. - int val;
  2478. -
  2479. - if (index > 2)
  2480. - return false;
  2481. -
  2482. - reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  2483. -
  2484. - val = phy_read_mmd(phydev, MDIO_MMD_AN, reg);
  2485. -
  2486. - return !(val & QCA808X_LED_FORCE_EN);
  2487. -}
  2488. -
  2489. -static int qca808x_led_hw_control_get(struct phy_device *phydev, u8 index,
  2490. - unsigned long *rules)
  2491. -{
  2492. - u16 reg;
  2493. - int val;
  2494. -
  2495. - if (index > 2)
  2496. - return -EINVAL;
  2497. -
  2498. - /* Check if we have hw control enabled */
  2499. - if (qca808x_led_hw_control_status(phydev, index))
  2500. - return -EINVAL;
  2501. -
  2502. - reg = QCA808X_MMD7_LED_CTRL(index);
  2503. -
  2504. - val = phy_read_mmd(phydev, MDIO_MMD_AN, reg);
  2505. - if (val & QCA808X_LED_TX_BLINK)
  2506. - set_bit(TRIGGER_NETDEV_TX, rules);
  2507. - if (val & QCA808X_LED_RX_BLINK)
  2508. - set_bit(TRIGGER_NETDEV_RX, rules);
  2509. - if (val & QCA808X_LED_SPEED10_ON)
  2510. - set_bit(TRIGGER_NETDEV_LINK_10, rules);
  2511. - if (val & QCA808X_LED_SPEED100_ON)
  2512. - set_bit(TRIGGER_NETDEV_LINK_100, rules);
  2513. - if (val & QCA808X_LED_SPEED1000_ON)
  2514. - set_bit(TRIGGER_NETDEV_LINK_1000, rules);
  2515. - if (val & QCA808X_LED_SPEED2500_ON)
  2516. - set_bit(TRIGGER_NETDEV_LINK_2500, rules);
  2517. - if (val & QCA808X_LED_HALF_DUPLEX_ON)
  2518. - set_bit(TRIGGER_NETDEV_HALF_DUPLEX, rules);
  2519. - if (val & QCA808X_LED_FULL_DUPLEX_ON)
  2520. - set_bit(TRIGGER_NETDEV_FULL_DUPLEX, rules);
  2521. -
  2522. - return 0;
  2523. -}
  2524. -
  2525. -static int qca808x_led_hw_control_reset(struct phy_device *phydev, u8 index)
  2526. -{
  2527. - u16 reg;
  2528. -
  2529. - if (index > 2)
  2530. - return -EINVAL;
  2531. -
  2532. - reg = QCA808X_MMD7_LED_CTRL(index);
  2533. -
  2534. - return phy_clear_bits_mmd(phydev, MDIO_MMD_AN, reg,
  2535. - QCA808X_LED_PATTERN_MASK);
  2536. -}
  2537. -
  2538. -static int qca808x_led_brightness_set(struct phy_device *phydev,
  2539. - u8 index, enum led_brightness value)
  2540. -{
  2541. - u16 reg;
  2542. - int ret;
  2543. -
  2544. - if (index > 2)
  2545. - return -EINVAL;
  2546. -
  2547. - if (!value) {
  2548. - ret = qca808x_led_hw_control_reset(phydev, index);
  2549. - if (ret)
  2550. - return ret;
  2551. - }
  2552. -
  2553. - reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  2554. -
  2555. - return phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  2556. - QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_MODE_MASK,
  2557. - QCA808X_LED_FORCE_EN | value ? QCA808X_LED_FORCE_ON :
  2558. - QCA808X_LED_FORCE_OFF);
  2559. -}
  2560. -
  2561. -static int qca808x_led_blink_set(struct phy_device *phydev, u8 index,
  2562. - unsigned long *delay_on,
  2563. - unsigned long *delay_off)
  2564. -{
  2565. - int ret;
  2566. - u16 reg;
  2567. -
  2568. - if (index > 2)
  2569. - return -EINVAL;
  2570. -
  2571. - reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  2572. -
  2573. - /* Set blink to 50% off, 50% on at 4Hz by default */
  2574. - ret = phy_modify_mmd(phydev, MDIO_MMD_AN, QCA808X_MMD7_LED_GLOBAL,
  2575. - QCA808X_LED_BLINK_FREQ_MASK | QCA808X_LED_BLINK_DUTY_MASK,
  2576. - QCA808X_LED_BLINK_FREQ_4HZ | QCA808X_LED_BLINK_DUTY_50_50);
  2577. - if (ret)
  2578. - return ret;
  2579. -
  2580. - /* We use BLINK_1 for normal blinking */
  2581. - ret = phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  2582. - QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_MODE_MASK,
  2583. - QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_BLINK_1);
  2584. - if (ret)
  2585. - return ret;
  2586. -
  2587. - /* We set blink to 4Hz, aka 250ms */
  2588. - *delay_on = 250 / 2;
  2589. - *delay_off = 250 / 2;
  2590. -
  2591. - return 0;
  2592. -}
  2593. -
  2594. -static int qca808x_led_polarity_set(struct phy_device *phydev, int index,
  2595. - unsigned long modes)
  2596. -{
  2597. - struct at803x_priv *priv = phydev->priv;
  2598. - bool active_low = false;
  2599. - u32 mode;
  2600. -
  2601. - for_each_set_bit(mode, &modes, __PHY_LED_MODES_NUM) {
  2602. - switch (mode) {
  2603. - case PHY_LED_ACTIVE_LOW:
  2604. - active_low = true;
  2605. - break;
  2606. - default:
  2607. - return -EINVAL;
  2608. - }
  2609. - }
  2610. -
  2611. - /* PHY polarity is global and can't be set per LED.
  2612. - * To detect this, check if last requested polarity mode
  2613. - * match the new one.
  2614. - */
  2615. - if (priv->led_polarity_mode >= 0 &&
  2616. - priv->led_polarity_mode != active_low) {
  2617. - phydev_err(phydev, "PHY polarity is global. Mismatched polarity on different LED\n");
  2618. - return -EINVAL;
  2619. - }
  2620. -
  2621. - /* Save the last PHY polarity mode */
  2622. - priv->led_polarity_mode = active_low;
  2623. -
  2624. - return phy_modify_mmd(phydev, MDIO_MMD_AN,
  2625. - QCA808X_MMD7_LED_POLARITY_CTRL,
  2626. - QCA808X_LED_ACTIVE_HIGH,
  2627. - active_low ? 0 : QCA808X_LED_ACTIVE_HIGH);
  2628. -}
  2629. -
  2630. -static struct phy_driver at803x_driver[] = {
  2631. -{
  2632. - /* Qualcomm Atheros AR8035 */
  2633. - PHY_ID_MATCH_EXACT(ATH8035_PHY_ID),
  2634. - .name = "Qualcomm Atheros AR8035",
  2635. - .flags = PHY_POLL_CABLE_TEST,
  2636. - .probe = at8035_probe,
  2637. - .config_aneg = at803x_config_aneg,
  2638. - .config_init = at803x_config_init,
  2639. - .soft_reset = genphy_soft_reset,
  2640. - .set_wol = at803x_set_wol,
  2641. - .get_wol = at803x_get_wol,
  2642. - .suspend = at803x_suspend,
  2643. - .resume = at803x_resume,
  2644. - /* PHY_GBIT_FEATURES */
  2645. - .read_status = at803x_read_status,
  2646. - .config_intr = at803x_config_intr,
  2647. - .handle_interrupt = at803x_handle_interrupt,
  2648. - .get_tunable = at803x_get_tunable,
  2649. - .set_tunable = at803x_set_tunable,
  2650. - .cable_test_start = at8031_cable_test_start,
  2651. - .cable_test_get_status = at8031_cable_test_get_status,
  2652. -}, {
  2653. - /* Qualcomm Atheros AR8030 */
  2654. - .phy_id = ATH8030_PHY_ID,
  2655. - .name = "Qualcomm Atheros AR8030",
  2656. - .phy_id_mask = AT8030_PHY_ID_MASK,
  2657. - .probe = at8035_probe,
  2658. - .config_init = at803x_config_init,
  2659. - .link_change_notify = at803x_link_change_notify,
  2660. - .set_wol = at803x_set_wol,
  2661. - .get_wol = at803x_get_wol,
  2662. - .suspend = at803x_suspend,
  2663. - .resume = at803x_resume,
  2664. - /* PHY_BASIC_FEATURES */
  2665. - .config_intr = at803x_config_intr,
  2666. - .handle_interrupt = at803x_handle_interrupt,
  2667. -}, {
  2668. - /* Qualcomm Atheros AR8031/AR8033 */
  2669. - PHY_ID_MATCH_EXACT(ATH8031_PHY_ID),
  2670. - .name = "Qualcomm Atheros AR8031/AR8033",
  2671. - .flags = PHY_POLL_CABLE_TEST,
  2672. - .probe = at8031_probe,
  2673. - .config_init = at8031_config_init,
  2674. - .config_aneg = at803x_config_aneg,
  2675. - .soft_reset = genphy_soft_reset,
  2676. - .set_wol = at8031_set_wol,
  2677. - .get_wol = at803x_get_wol,
  2678. - .suspend = at803x_suspend,
  2679. - .resume = at803x_resume,
  2680. - .read_page = at803x_read_page,
  2681. - .write_page = at803x_write_page,
  2682. - .get_features = at803x_get_features,
  2683. - .read_status = at8031_read_status,
  2684. - .config_intr = at8031_config_intr,
  2685. - .handle_interrupt = at803x_handle_interrupt,
  2686. - .get_tunable = at803x_get_tunable,
  2687. - .set_tunable = at803x_set_tunable,
  2688. - .cable_test_start = at8031_cable_test_start,
  2689. - .cable_test_get_status = at8031_cable_test_get_status,
  2690. -}, {
  2691. - /* Qualcomm Atheros AR8032 */
  2692. - PHY_ID_MATCH_EXACT(ATH8032_PHY_ID),
  2693. - .name = "Qualcomm Atheros AR8032",
  2694. - .probe = at803x_probe,
  2695. - .flags = PHY_POLL_CABLE_TEST,
  2696. - .config_init = at803x_config_init,
  2697. - .link_change_notify = at803x_link_change_notify,
  2698. - .suspend = at803x_suspend,
  2699. - .resume = at803x_resume,
  2700. - /* PHY_BASIC_FEATURES */
  2701. - .config_intr = at803x_config_intr,
  2702. - .handle_interrupt = at803x_handle_interrupt,
  2703. - .cable_test_start = at803x_cable_test_start,
  2704. - .cable_test_get_status = at8032_cable_test_get_status,
  2705. -}, {
  2706. - /* ATHEROS AR9331 */
  2707. - PHY_ID_MATCH_EXACT(ATH9331_PHY_ID),
  2708. - .name = "Qualcomm Atheros AR9331 built-in PHY",
  2709. - .probe = at803x_probe,
  2710. - .suspend = at803x_suspend,
  2711. - .resume = at803x_resume,
  2712. - .flags = PHY_POLL_CABLE_TEST,
  2713. - /* PHY_BASIC_FEATURES */
  2714. - .config_intr = at803x_config_intr,
  2715. - .handle_interrupt = at803x_handle_interrupt,
  2716. - .cable_test_start = at803x_cable_test_start,
  2717. - .cable_test_get_status = at8032_cable_test_get_status,
  2718. - .read_status = at803x_read_status,
  2719. - .soft_reset = genphy_soft_reset,
  2720. - .config_aneg = at803x_config_aneg,
  2721. -}, {
  2722. - /* Qualcomm Atheros QCA9561 */
  2723. - PHY_ID_MATCH_EXACT(QCA9561_PHY_ID),
  2724. - .name = "Qualcomm Atheros QCA9561 built-in PHY",
  2725. - .probe = at803x_probe,
  2726. - .suspend = at803x_suspend,
  2727. - .resume = at803x_resume,
  2728. - .flags = PHY_POLL_CABLE_TEST,
  2729. - /* PHY_BASIC_FEATURES */
  2730. - .config_intr = at803x_config_intr,
  2731. - .handle_interrupt = at803x_handle_interrupt,
  2732. - .cable_test_start = at803x_cable_test_start,
  2733. - .cable_test_get_status = at8032_cable_test_get_status,
  2734. - .read_status = at803x_read_status,
  2735. - .soft_reset = genphy_soft_reset,
  2736. - .config_aneg = at803x_config_aneg,
  2737. -}, {
  2738. - /* QCA8337 */
  2739. - .phy_id = QCA8337_PHY_ID,
  2740. - .phy_id_mask = QCA8K_PHY_ID_MASK,
  2741. - .name = "Qualcomm Atheros 8337 internal PHY",
  2742. - /* PHY_GBIT_FEATURES */
  2743. - .probe = at803x_probe,
  2744. - .flags = PHY_IS_INTERNAL,
  2745. - .config_init = qca83xx_config_init,
  2746. - .soft_reset = genphy_soft_reset,
  2747. - .get_sset_count = qca83xx_get_sset_count,
  2748. - .get_strings = qca83xx_get_strings,
  2749. - .get_stats = qca83xx_get_stats,
  2750. - .suspend = qca8337_suspend,
  2751. - .resume = qca83xx_resume,
  2752. -}, {
  2753. - /* QCA8327-A from switch QCA8327-AL1A */
  2754. - .phy_id = QCA8327_A_PHY_ID,
  2755. - .phy_id_mask = QCA8K_PHY_ID_MASK,
  2756. - .name = "Qualcomm Atheros 8327-A internal PHY",
  2757. - /* PHY_GBIT_FEATURES */
  2758. - .link_change_notify = qca83xx_link_change_notify,
  2759. - .probe = at803x_probe,
  2760. - .flags = PHY_IS_INTERNAL,
  2761. - .config_init = qca8327_config_init,
  2762. - .soft_reset = genphy_soft_reset,
  2763. - .get_sset_count = qca83xx_get_sset_count,
  2764. - .get_strings = qca83xx_get_strings,
  2765. - .get_stats = qca83xx_get_stats,
  2766. - .suspend = qca8327_suspend,
  2767. - .resume = qca83xx_resume,
  2768. -}, {
  2769. - /* QCA8327-B from switch QCA8327-BL1A */
  2770. - .phy_id = QCA8327_B_PHY_ID,
  2771. - .phy_id_mask = QCA8K_PHY_ID_MASK,
  2772. - .name = "Qualcomm Atheros 8327-B internal PHY",
  2773. - /* PHY_GBIT_FEATURES */
  2774. - .link_change_notify = qca83xx_link_change_notify,
  2775. - .probe = at803x_probe,
  2776. - .flags = PHY_IS_INTERNAL,
  2777. - .config_init = qca8327_config_init,
  2778. - .soft_reset = genphy_soft_reset,
  2779. - .get_sset_count = qca83xx_get_sset_count,
  2780. - .get_strings = qca83xx_get_strings,
  2781. - .get_stats = qca83xx_get_stats,
  2782. - .suspend = qca8327_suspend,
  2783. - .resume = qca83xx_resume,
  2784. -}, {
  2785. - /* Qualcomm QCA8081 */
  2786. - PHY_ID_MATCH_EXACT(QCA8081_PHY_ID),
  2787. - .name = "Qualcomm QCA8081",
  2788. - .flags = PHY_POLL_CABLE_TEST,
  2789. - .probe = at803x_probe,
  2790. - .config_intr = at803x_config_intr,
  2791. - .handle_interrupt = at803x_handle_interrupt,
  2792. - .get_tunable = at803x_get_tunable,
  2793. - .set_tunable = at803x_set_tunable,
  2794. - .set_wol = at803x_set_wol,
  2795. - .get_wol = at803x_get_wol,
  2796. - .get_features = qca808x_get_features,
  2797. - .config_aneg = qca808x_config_aneg,
  2798. - .suspend = genphy_suspend,
  2799. - .resume = genphy_resume,
  2800. - .read_status = qca808x_read_status,
  2801. - .config_init = qca808x_config_init,
  2802. - .soft_reset = qca808x_soft_reset,
  2803. - .cable_test_start = qca808x_cable_test_start,
  2804. - .cable_test_get_status = qca808x_cable_test_get_status,
  2805. - .link_change_notify = qca808x_link_change_notify,
  2806. - .led_brightness_set = qca808x_led_brightness_set,
  2807. - .led_blink_set = qca808x_led_blink_set,
  2808. - .led_hw_is_supported = qca808x_led_hw_is_supported,
  2809. - .led_hw_control_set = qca808x_led_hw_control_set,
  2810. - .led_hw_control_get = qca808x_led_hw_control_get,
  2811. - .led_polarity_set = qca808x_led_polarity_set,
  2812. -}, };
  2813. -
  2814. -module_phy_driver(at803x_driver);
  2815. -
  2816. -static struct mdio_device_id __maybe_unused atheros_tbl[] = {
  2817. - { ATH8030_PHY_ID, AT8030_PHY_ID_MASK },
  2818. - { PHY_ID_MATCH_EXACT(ATH8031_PHY_ID) },
  2819. - { PHY_ID_MATCH_EXACT(ATH8032_PHY_ID) },
  2820. - { PHY_ID_MATCH_EXACT(ATH8035_PHY_ID) },
  2821. - { PHY_ID_MATCH_EXACT(ATH9331_PHY_ID) },
  2822. - { PHY_ID_MATCH_EXACT(QCA8337_PHY_ID) },
  2823. - { PHY_ID_MATCH_EXACT(QCA8327_A_PHY_ID) },
  2824. - { PHY_ID_MATCH_EXACT(QCA8327_B_PHY_ID) },
  2825. - { PHY_ID_MATCH_EXACT(QCA9561_PHY_ID) },
  2826. - { PHY_ID_MATCH_EXACT(QCA8081_PHY_ID) },
  2827. - { }
  2828. -};
  2829. -
  2830. -MODULE_DEVICE_TABLE(mdio, atheros_tbl);
  2831. --- /dev/null
  2832. +++ b/drivers/net/phy/qcom/at803x.c
  2833. @@ -0,0 +1,2759 @@
  2834. +// SPDX-License-Identifier: GPL-2.0+
  2835. +/*
  2836. + * drivers/net/phy/at803x.c
  2837. + *
  2838. + * Driver for Qualcomm Atheros AR803x PHY
  2839. + *
  2840. + * Author: Matus Ujhelyi <[email protected]>
  2841. + */
  2842. +
  2843. +#include <linux/phy.h>
  2844. +#include <linux/module.h>
  2845. +#include <linux/string.h>
  2846. +#include <linux/netdevice.h>
  2847. +#include <linux/etherdevice.h>
  2848. +#include <linux/ethtool_netlink.h>
  2849. +#include <linux/bitfield.h>
  2850. +#include <linux/regulator/of_regulator.h>
  2851. +#include <linux/regulator/driver.h>
  2852. +#include <linux/regulator/consumer.h>
  2853. +#include <linux/of.h>
  2854. +#include <linux/phylink.h>
  2855. +#include <linux/sfp.h>
  2856. +#include <dt-bindings/net/qca-ar803x.h>
  2857. +
  2858. +#define AT803X_SPECIFIC_FUNCTION_CONTROL 0x10
  2859. +#define AT803X_SFC_ASSERT_CRS BIT(11)
  2860. +#define AT803X_SFC_FORCE_LINK BIT(10)
  2861. +#define AT803X_SFC_MDI_CROSSOVER_MODE_M GENMASK(6, 5)
  2862. +#define AT803X_SFC_AUTOMATIC_CROSSOVER 0x3
  2863. +#define AT803X_SFC_MANUAL_MDIX 0x1
  2864. +#define AT803X_SFC_MANUAL_MDI 0x0
  2865. +#define AT803X_SFC_SQE_TEST BIT(2)
  2866. +#define AT803X_SFC_POLARITY_REVERSAL BIT(1)
  2867. +#define AT803X_SFC_DISABLE_JABBER BIT(0)
  2868. +
  2869. +#define AT803X_SPECIFIC_STATUS 0x11
  2870. +#define AT803X_SS_SPEED_MASK GENMASK(15, 14)
  2871. +#define AT803X_SS_SPEED_1000 2
  2872. +#define AT803X_SS_SPEED_100 1
  2873. +#define AT803X_SS_SPEED_10 0
  2874. +#define AT803X_SS_DUPLEX BIT(13)
  2875. +#define AT803X_SS_SPEED_DUPLEX_RESOLVED BIT(11)
  2876. +#define AT803X_SS_MDIX BIT(6)
  2877. +
  2878. +#define QCA808X_SS_SPEED_MASK GENMASK(9, 7)
  2879. +#define QCA808X_SS_SPEED_2500 4
  2880. +
  2881. +#define AT803X_INTR_ENABLE 0x12
  2882. +#define AT803X_INTR_ENABLE_AUTONEG_ERR BIT(15)
  2883. +#define AT803X_INTR_ENABLE_SPEED_CHANGED BIT(14)
  2884. +#define AT803X_INTR_ENABLE_DUPLEX_CHANGED BIT(13)
  2885. +#define AT803X_INTR_ENABLE_PAGE_RECEIVED BIT(12)
  2886. +#define AT803X_INTR_ENABLE_LINK_FAIL BIT(11)
  2887. +#define AT803X_INTR_ENABLE_LINK_SUCCESS BIT(10)
  2888. +#define AT803X_INTR_ENABLE_LINK_FAIL_BX BIT(8)
  2889. +#define AT803X_INTR_ENABLE_LINK_SUCCESS_BX BIT(7)
  2890. +#define AT803X_INTR_ENABLE_WIRESPEED_DOWNGRADE BIT(5)
  2891. +#define AT803X_INTR_ENABLE_POLARITY_CHANGED BIT(1)
  2892. +#define AT803X_INTR_ENABLE_WOL BIT(0)
  2893. +
  2894. +#define AT803X_INTR_STATUS 0x13
  2895. +
  2896. +#define AT803X_SMART_SPEED 0x14
  2897. +#define AT803X_SMART_SPEED_ENABLE BIT(5)
  2898. +#define AT803X_SMART_SPEED_RETRY_LIMIT_MASK GENMASK(4, 2)
  2899. +#define AT803X_SMART_SPEED_BYPASS_TIMER BIT(1)
  2900. +#define AT803X_CDT 0x16
  2901. +#define AT803X_CDT_MDI_PAIR_MASK GENMASK(9, 8)
  2902. +#define AT803X_CDT_ENABLE_TEST BIT(0)
  2903. +#define AT803X_CDT_STATUS 0x1c
  2904. +#define AT803X_CDT_STATUS_STAT_NORMAL 0
  2905. +#define AT803X_CDT_STATUS_STAT_SHORT 1
  2906. +#define AT803X_CDT_STATUS_STAT_OPEN 2
  2907. +#define AT803X_CDT_STATUS_STAT_FAIL 3
  2908. +#define AT803X_CDT_STATUS_STAT_MASK GENMASK(9, 8)
  2909. +#define AT803X_CDT_STATUS_DELTA_TIME_MASK GENMASK(7, 0)
  2910. +#define AT803X_LED_CONTROL 0x18
  2911. +
  2912. +#define AT803X_PHY_MMD3_WOL_CTRL 0x8012
  2913. +#define AT803X_WOL_EN BIT(5)
  2914. +#define AT803X_LOC_MAC_ADDR_0_15_OFFSET 0x804C
  2915. +#define AT803X_LOC_MAC_ADDR_16_31_OFFSET 0x804B
  2916. +#define AT803X_LOC_MAC_ADDR_32_47_OFFSET 0x804A
  2917. +#define AT803X_REG_CHIP_CONFIG 0x1f
  2918. +#define AT803X_BT_BX_REG_SEL 0x8000
  2919. +
  2920. +#define AT803X_DEBUG_ADDR 0x1D
  2921. +#define AT803X_DEBUG_DATA 0x1E
  2922. +
  2923. +#define AT803X_MODE_CFG_MASK 0x0F
  2924. +#define AT803X_MODE_CFG_BASET_RGMII 0x00
  2925. +#define AT803X_MODE_CFG_BASET_SGMII 0x01
  2926. +#define AT803X_MODE_CFG_BX1000_RGMII_50OHM 0x02
  2927. +#define AT803X_MODE_CFG_BX1000_RGMII_75OHM 0x03
  2928. +#define AT803X_MODE_CFG_BX1000_CONV_50OHM 0x04
  2929. +#define AT803X_MODE_CFG_BX1000_CONV_75OHM 0x05
  2930. +#define AT803X_MODE_CFG_FX100_RGMII_50OHM 0x06
  2931. +#define AT803X_MODE_CFG_FX100_CONV_50OHM 0x07
  2932. +#define AT803X_MODE_CFG_RGMII_AUTO_MDET 0x0B
  2933. +#define AT803X_MODE_CFG_FX100_RGMII_75OHM 0x0E
  2934. +#define AT803X_MODE_CFG_FX100_CONV_75OHM 0x0F
  2935. +
  2936. +#define AT803X_PSSR 0x11 /*PHY-Specific Status Register*/
  2937. +#define AT803X_PSSR_MR_AN_COMPLETE 0x0200
  2938. +
  2939. +#define AT803X_DEBUG_ANALOG_TEST_CTRL 0x00
  2940. +#define QCA8327_DEBUG_MANU_CTRL_EN BIT(2)
  2941. +#define QCA8337_DEBUG_MANU_CTRL_EN GENMASK(3, 2)
  2942. +#define AT803X_DEBUG_RX_CLK_DLY_EN BIT(15)
  2943. +
  2944. +#define AT803X_DEBUG_SYSTEM_CTRL_MODE 0x05
  2945. +#define AT803X_DEBUG_TX_CLK_DLY_EN BIT(8)
  2946. +
  2947. +#define AT803X_DEBUG_REG_HIB_CTRL 0x0b
  2948. +#define AT803X_DEBUG_HIB_CTRL_SEL_RST_80U BIT(10)
  2949. +#define AT803X_DEBUG_HIB_CTRL_EN_ANY_CHANGE BIT(13)
  2950. +#define AT803X_DEBUG_HIB_CTRL_PS_HIB_EN BIT(15)
  2951. +
  2952. +#define AT803X_DEBUG_REG_3C 0x3C
  2953. +
  2954. +#define AT803X_DEBUG_REG_GREEN 0x3D
  2955. +#define AT803X_DEBUG_GATE_CLK_IN1000 BIT(6)
  2956. +
  2957. +#define AT803X_DEBUG_REG_1F 0x1F
  2958. +#define AT803X_DEBUG_PLL_ON BIT(2)
  2959. +#define AT803X_DEBUG_RGMII_1V8 BIT(3)
  2960. +
  2961. +#define MDIO_AZ_DEBUG 0x800D
  2962. +
  2963. +/* AT803x supports either the XTAL input pad, an internal PLL or the
  2964. + * DSP as clock reference for the clock output pad. The XTAL reference
  2965. + * is only used for 25 MHz output, all other frequencies need the PLL.
  2966. + * The DSP as a clock reference is used in synchronous ethernet
  2967. + * applications.
  2968. + *
  2969. + * By default the PLL is only enabled if there is a link. Otherwise
  2970. + * the PHY will go into low power state and disabled the PLL. You can
  2971. + * set the PLL_ON bit (see debug register 0x1f) to keep the PLL always
  2972. + * enabled.
  2973. + */
  2974. +#define AT803X_MMD7_CLK25M 0x8016
  2975. +#define AT803X_CLK_OUT_MASK GENMASK(4, 2)
  2976. +#define AT803X_CLK_OUT_25MHZ_XTAL 0
  2977. +#define AT803X_CLK_OUT_25MHZ_DSP 1
  2978. +#define AT803X_CLK_OUT_50MHZ_PLL 2
  2979. +#define AT803X_CLK_OUT_50MHZ_DSP 3
  2980. +#define AT803X_CLK_OUT_62_5MHZ_PLL 4
  2981. +#define AT803X_CLK_OUT_62_5MHZ_DSP 5
  2982. +#define AT803X_CLK_OUT_125MHZ_PLL 6
  2983. +#define AT803X_CLK_OUT_125MHZ_DSP 7
  2984. +
  2985. +/* The AR8035 has another mask which is compatible with the AR8031/AR8033 mask
  2986. + * but doesn't support choosing between XTAL/PLL and DSP.
  2987. + */
  2988. +#define AT8035_CLK_OUT_MASK GENMASK(4, 3)
  2989. +
  2990. +#define AT803X_CLK_OUT_STRENGTH_MASK GENMASK(8, 7)
  2991. +#define AT803X_CLK_OUT_STRENGTH_FULL 0
  2992. +#define AT803X_CLK_OUT_STRENGTH_HALF 1
  2993. +#define AT803X_CLK_OUT_STRENGTH_QUARTER 2
  2994. +
  2995. +#define AT803X_DEFAULT_DOWNSHIFT 5
  2996. +#define AT803X_MIN_DOWNSHIFT 2
  2997. +#define AT803X_MAX_DOWNSHIFT 9
  2998. +
  2999. +#define AT803X_MMD3_SMARTEEE_CTL1 0x805b
  3000. +#define AT803X_MMD3_SMARTEEE_CTL2 0x805c
  3001. +#define AT803X_MMD3_SMARTEEE_CTL3 0x805d
  3002. +#define AT803X_MMD3_SMARTEEE_CTL3_LPI_EN BIT(8)
  3003. +
  3004. +#define ATH9331_PHY_ID 0x004dd041
  3005. +#define ATH8030_PHY_ID 0x004dd076
  3006. +#define ATH8031_PHY_ID 0x004dd074
  3007. +#define ATH8032_PHY_ID 0x004dd023
  3008. +#define ATH8035_PHY_ID 0x004dd072
  3009. +#define AT8030_PHY_ID_MASK 0xffffffef
  3010. +
  3011. +#define QCA8081_PHY_ID 0x004dd101
  3012. +
  3013. +#define QCA8327_A_PHY_ID 0x004dd033
  3014. +#define QCA8327_B_PHY_ID 0x004dd034
  3015. +#define QCA8337_PHY_ID 0x004dd036
  3016. +#define QCA9561_PHY_ID 0x004dd042
  3017. +#define QCA8K_PHY_ID_MASK 0xffffffff
  3018. +
  3019. +#define QCA8K_DEVFLAGS_REVISION_MASK GENMASK(2, 0)
  3020. +
  3021. +#define AT803X_PAGE_FIBER 0
  3022. +#define AT803X_PAGE_COPPER 1
  3023. +
  3024. +/* don't turn off internal PLL */
  3025. +#define AT803X_KEEP_PLL_ENABLED BIT(0)
  3026. +#define AT803X_DISABLE_SMARTEEE BIT(1)
  3027. +
  3028. +/* disable hibernation mode */
  3029. +#define AT803X_DISABLE_HIBERNATION_MODE BIT(2)
  3030. +
  3031. +/* ADC threshold */
  3032. +#define QCA808X_PHY_DEBUG_ADC_THRESHOLD 0x2c80
  3033. +#define QCA808X_ADC_THRESHOLD_MASK GENMASK(7, 0)
  3034. +#define QCA808X_ADC_THRESHOLD_80MV 0
  3035. +#define QCA808X_ADC_THRESHOLD_100MV 0xf0
  3036. +#define QCA808X_ADC_THRESHOLD_200MV 0x0f
  3037. +#define QCA808X_ADC_THRESHOLD_300MV 0xff
  3038. +
  3039. +/* CLD control */
  3040. +#define QCA808X_PHY_MMD3_ADDR_CLD_CTRL7 0x8007
  3041. +#define QCA808X_8023AZ_AFE_CTRL_MASK GENMASK(8, 4)
  3042. +#define QCA808X_8023AZ_AFE_EN 0x90
  3043. +
  3044. +/* AZ control */
  3045. +#define QCA808X_PHY_MMD3_AZ_TRAINING_CTRL 0x8008
  3046. +#define QCA808X_MMD3_AZ_TRAINING_VAL 0x1c32
  3047. +
  3048. +#define QCA808X_PHY_MMD1_MSE_THRESHOLD_20DB 0x8014
  3049. +#define QCA808X_MSE_THRESHOLD_20DB_VALUE 0x529
  3050. +
  3051. +#define QCA808X_PHY_MMD1_MSE_THRESHOLD_17DB 0x800E
  3052. +#define QCA808X_MSE_THRESHOLD_17DB_VALUE 0x341
  3053. +
  3054. +#define QCA808X_PHY_MMD1_MSE_THRESHOLD_27DB 0x801E
  3055. +#define QCA808X_MSE_THRESHOLD_27DB_VALUE 0x419
  3056. +
  3057. +#define QCA808X_PHY_MMD1_MSE_THRESHOLD_28DB 0x8020
  3058. +#define QCA808X_MSE_THRESHOLD_28DB_VALUE 0x341
  3059. +
  3060. +#define QCA808X_PHY_MMD7_TOP_OPTION1 0x901c
  3061. +#define QCA808X_TOP_OPTION1_DATA 0x0
  3062. +
  3063. +#define QCA808X_PHY_MMD3_DEBUG_1 0xa100
  3064. +#define QCA808X_MMD3_DEBUG_1_VALUE 0x9203
  3065. +#define QCA808X_PHY_MMD3_DEBUG_2 0xa101
  3066. +#define QCA808X_MMD3_DEBUG_2_VALUE 0x48ad
  3067. +#define QCA808X_PHY_MMD3_DEBUG_3 0xa103
  3068. +#define QCA808X_MMD3_DEBUG_3_VALUE 0x1698
  3069. +#define QCA808X_PHY_MMD3_DEBUG_4 0xa105
  3070. +#define QCA808X_MMD3_DEBUG_4_VALUE 0x8001
  3071. +#define QCA808X_PHY_MMD3_DEBUG_5 0xa106
  3072. +#define QCA808X_MMD3_DEBUG_5_VALUE 0x1111
  3073. +#define QCA808X_PHY_MMD3_DEBUG_6 0xa011
  3074. +#define QCA808X_MMD3_DEBUG_6_VALUE 0x5f85
  3075. +
  3076. +/* master/slave seed config */
  3077. +#define QCA808X_PHY_DEBUG_LOCAL_SEED 9
  3078. +#define QCA808X_MASTER_SLAVE_SEED_ENABLE BIT(1)
  3079. +#define QCA808X_MASTER_SLAVE_SEED_CFG GENMASK(12, 2)
  3080. +#define QCA808X_MASTER_SLAVE_SEED_RANGE 0x32
  3081. +
  3082. +/* Hibernation yields lower power consumpiton in contrast with normal operation mode.
  3083. + * when the copper cable is unplugged, the PHY enters into hibernation mode in about 10s.
  3084. + */
  3085. +#define QCA808X_DBG_AN_TEST 0xb
  3086. +#define QCA808X_HIBERNATION_EN BIT(15)
  3087. +
  3088. +#define QCA808X_CDT_ENABLE_TEST BIT(15)
  3089. +#define QCA808X_CDT_INTER_CHECK_DIS BIT(13)
  3090. +#define QCA808X_CDT_STATUS BIT(11)
  3091. +#define QCA808X_CDT_LENGTH_UNIT BIT(10)
  3092. +
  3093. +#define QCA808X_MMD3_CDT_STATUS 0x8064
  3094. +#define QCA808X_MMD3_CDT_DIAG_PAIR_A 0x8065
  3095. +#define QCA808X_MMD3_CDT_DIAG_PAIR_B 0x8066
  3096. +#define QCA808X_MMD3_CDT_DIAG_PAIR_C 0x8067
  3097. +#define QCA808X_MMD3_CDT_DIAG_PAIR_D 0x8068
  3098. +#define QCA808X_CDT_DIAG_LENGTH_SAME_SHORT GENMASK(15, 8)
  3099. +#define QCA808X_CDT_DIAG_LENGTH_CROSS_SHORT GENMASK(7, 0)
  3100. +
  3101. +#define QCA808X_CDT_CODE_PAIR_A GENMASK(15, 12)
  3102. +#define QCA808X_CDT_CODE_PAIR_B GENMASK(11, 8)
  3103. +#define QCA808X_CDT_CODE_PAIR_C GENMASK(7, 4)
  3104. +#define QCA808X_CDT_CODE_PAIR_D GENMASK(3, 0)
  3105. +
  3106. +#define QCA808X_CDT_STATUS_STAT_TYPE GENMASK(1, 0)
  3107. +#define QCA808X_CDT_STATUS_STAT_FAIL FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 0)
  3108. +#define QCA808X_CDT_STATUS_STAT_NORMAL FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 1)
  3109. +#define QCA808X_CDT_STATUS_STAT_SAME_OPEN FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 2)
  3110. +#define QCA808X_CDT_STATUS_STAT_SAME_SHORT FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 3)
  3111. +
  3112. +#define QCA808X_CDT_STATUS_STAT_MDI GENMASK(3, 2)
  3113. +#define QCA808X_CDT_STATUS_STAT_MDI1 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 1)
  3114. +#define QCA808X_CDT_STATUS_STAT_MDI2 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 2)
  3115. +#define QCA808X_CDT_STATUS_STAT_MDI3 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 3)
  3116. +
  3117. +/* NORMAL are MDI with type set to 0 */
  3118. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI1
  3119. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  3120. + QCA808X_CDT_STATUS_STAT_MDI1)
  3121. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  3122. + QCA808X_CDT_STATUS_STAT_MDI1)
  3123. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI2
  3124. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  3125. + QCA808X_CDT_STATUS_STAT_MDI2)
  3126. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  3127. + QCA808X_CDT_STATUS_STAT_MDI2)
  3128. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI3
  3129. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  3130. + QCA808X_CDT_STATUS_STAT_MDI3)
  3131. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  3132. + QCA808X_CDT_STATUS_STAT_MDI3)
  3133. +
  3134. +/* Added for reference of existence but should be handled by wait_for_completion already */
  3135. +#define QCA808X_CDT_STATUS_STAT_BUSY (BIT(1) | BIT(3))
  3136. +
  3137. +#define QCA808X_MMD7_LED_GLOBAL 0x8073
  3138. +#define QCA808X_LED_BLINK_1 GENMASK(11, 6)
  3139. +#define QCA808X_LED_BLINK_2 GENMASK(5, 0)
  3140. +/* Values are the same for both BLINK_1 and BLINK_2 */
  3141. +#define QCA808X_LED_BLINK_FREQ_MASK GENMASK(5, 3)
  3142. +#define QCA808X_LED_BLINK_FREQ_2HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x0)
  3143. +#define QCA808X_LED_BLINK_FREQ_4HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x1)
  3144. +#define QCA808X_LED_BLINK_FREQ_8HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x2)
  3145. +#define QCA808X_LED_BLINK_FREQ_16HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x3)
  3146. +#define QCA808X_LED_BLINK_FREQ_32HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x4)
  3147. +#define QCA808X_LED_BLINK_FREQ_64HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x5)
  3148. +#define QCA808X_LED_BLINK_FREQ_128HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x6)
  3149. +#define QCA808X_LED_BLINK_FREQ_256HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x7)
  3150. +#define QCA808X_LED_BLINK_DUTY_MASK GENMASK(2, 0)
  3151. +#define QCA808X_LED_BLINK_DUTY_50_50 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x0)
  3152. +#define QCA808X_LED_BLINK_DUTY_75_25 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x1)
  3153. +#define QCA808X_LED_BLINK_DUTY_25_75 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x2)
  3154. +#define QCA808X_LED_BLINK_DUTY_33_67 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x3)
  3155. +#define QCA808X_LED_BLINK_DUTY_67_33 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x4)
  3156. +#define QCA808X_LED_BLINK_DUTY_17_83 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x5)
  3157. +#define QCA808X_LED_BLINK_DUTY_83_17 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x6)
  3158. +#define QCA808X_LED_BLINK_DUTY_8_92 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x7)
  3159. +
  3160. +#define QCA808X_MMD7_LED2_CTRL 0x8074
  3161. +#define QCA808X_MMD7_LED2_FORCE_CTRL 0x8075
  3162. +#define QCA808X_MMD7_LED1_CTRL 0x8076
  3163. +#define QCA808X_MMD7_LED1_FORCE_CTRL 0x8077
  3164. +#define QCA808X_MMD7_LED0_CTRL 0x8078
  3165. +#define QCA808X_MMD7_LED_CTRL(x) (0x8078 - ((x) * 2))
  3166. +
  3167. +/* LED hw control pattern is the same for every LED */
  3168. +#define QCA808X_LED_PATTERN_MASK GENMASK(15, 0)
  3169. +#define QCA808X_LED_SPEED2500_ON BIT(15)
  3170. +#define QCA808X_LED_SPEED2500_BLINK BIT(14)
  3171. +/* Follow blink trigger even if duplex or speed condition doesn't match */
  3172. +#define QCA808X_LED_BLINK_CHECK_BYPASS BIT(13)
  3173. +#define QCA808X_LED_FULL_DUPLEX_ON BIT(12)
  3174. +#define QCA808X_LED_HALF_DUPLEX_ON BIT(11)
  3175. +#define QCA808X_LED_TX_BLINK BIT(10)
  3176. +#define QCA808X_LED_RX_BLINK BIT(9)
  3177. +#define QCA808X_LED_TX_ON_10MS BIT(8)
  3178. +#define QCA808X_LED_RX_ON_10MS BIT(7)
  3179. +#define QCA808X_LED_SPEED1000_ON BIT(6)
  3180. +#define QCA808X_LED_SPEED100_ON BIT(5)
  3181. +#define QCA808X_LED_SPEED10_ON BIT(4)
  3182. +#define QCA808X_LED_COLLISION_BLINK BIT(3)
  3183. +#define QCA808X_LED_SPEED1000_BLINK BIT(2)
  3184. +#define QCA808X_LED_SPEED100_BLINK BIT(1)
  3185. +#define QCA808X_LED_SPEED10_BLINK BIT(0)
  3186. +
  3187. +#define QCA808X_MMD7_LED0_FORCE_CTRL 0x8079
  3188. +#define QCA808X_MMD7_LED_FORCE_CTRL(x) (0x8079 - ((x) * 2))
  3189. +
  3190. +/* LED force ctrl is the same for every LED
  3191. + * No documentation exist for this, not even internal one
  3192. + * with NDA as QCOM gives only info about configuring
  3193. + * hw control pattern rules and doesn't indicate any way
  3194. + * to force the LED to specific mode.
  3195. + * These define comes from reverse and testing and maybe
  3196. + * lack of some info or some info are not entirely correct.
  3197. + * For the basic LED control and hw control these finding
  3198. + * are enough to support LED control in all the required APIs.
  3199. + *
  3200. + * On doing some comparison with implementation with qca807x,
  3201. + * it was found that it's 1:1 equal to it and confirms all the
  3202. + * reverse done. It was also found further specification with the
  3203. + * force mode and the blink modes.
  3204. + */
  3205. +#define QCA808X_LED_FORCE_EN BIT(15)
  3206. +#define QCA808X_LED_FORCE_MODE_MASK GENMASK(14, 13)
  3207. +#define QCA808X_LED_FORCE_BLINK_1 FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x3)
  3208. +#define QCA808X_LED_FORCE_BLINK_2 FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x2)
  3209. +#define QCA808X_LED_FORCE_ON FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x1)
  3210. +#define QCA808X_LED_FORCE_OFF FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x0)
  3211. +
  3212. +#define QCA808X_MMD7_LED_POLARITY_CTRL 0x901a
  3213. +/* QSDK sets by default 0x46 to this reg that sets BIT 6 for
  3214. + * LED to active high. It's not clear what BIT 3 and BIT 4 does.
  3215. + */
  3216. +#define QCA808X_LED_ACTIVE_HIGH BIT(6)
  3217. +
  3218. +/* QCA808X 1G chip type */
  3219. +#define QCA808X_PHY_MMD7_CHIP_TYPE 0x901d
  3220. +#define QCA808X_PHY_CHIP_TYPE_1G BIT(0)
  3221. +
  3222. +#define QCA8081_PHY_SERDES_MMD1_FIFO_CTRL 0x9072
  3223. +#define QCA8081_PHY_FIFO_RSTN BIT(11)
  3224. +
  3225. +MODULE_DESCRIPTION("Qualcomm Atheros AR803x and QCA808X PHY driver");
  3226. +MODULE_AUTHOR("Matus Ujhelyi");
  3227. +MODULE_LICENSE("GPL");
  3228. +
  3229. +enum stat_access_type {
  3230. + PHY,
  3231. + MMD
  3232. +};
  3233. +
  3234. +struct at803x_hw_stat {
  3235. + const char *string;
  3236. + u8 reg;
  3237. + u32 mask;
  3238. + enum stat_access_type access_type;
  3239. +};
  3240. +
  3241. +static struct at803x_hw_stat qca83xx_hw_stats[] = {
  3242. + { "phy_idle_errors", 0xa, GENMASK(7, 0), PHY},
  3243. + { "phy_receive_errors", 0x15, GENMASK(15, 0), PHY},
  3244. + { "eee_wake_errors", 0x16, GENMASK(15, 0), MMD},
  3245. +};
  3246. +
  3247. +struct at803x_ss_mask {
  3248. + u16 speed_mask;
  3249. + u8 speed_shift;
  3250. +};
  3251. +
  3252. +struct at803x_priv {
  3253. + int flags;
  3254. + u16 clk_25m_reg;
  3255. + u16 clk_25m_mask;
  3256. + u8 smarteee_lpi_tw_1g;
  3257. + u8 smarteee_lpi_tw_100m;
  3258. + bool is_fiber;
  3259. + bool is_1000basex;
  3260. + struct regulator_dev *vddio_rdev;
  3261. + struct regulator_dev *vddh_rdev;
  3262. + u64 stats[ARRAY_SIZE(qca83xx_hw_stats)];
  3263. + int led_polarity_mode;
  3264. +};
  3265. +
  3266. +struct at803x_context {
  3267. + u16 bmcr;
  3268. + u16 advertise;
  3269. + u16 control1000;
  3270. + u16 int_enable;
  3271. + u16 smart_speed;
  3272. + u16 led_control;
  3273. +};
  3274. +
  3275. +static int at803x_debug_reg_write(struct phy_device *phydev, u16 reg, u16 data)
  3276. +{
  3277. + int ret;
  3278. +
  3279. + ret = phy_write(phydev, AT803X_DEBUG_ADDR, reg);
  3280. + if (ret < 0)
  3281. + return ret;
  3282. +
  3283. + return phy_write(phydev, AT803X_DEBUG_DATA, data);
  3284. +}
  3285. +
  3286. +static int at803x_debug_reg_read(struct phy_device *phydev, u16 reg)
  3287. +{
  3288. + int ret;
  3289. +
  3290. + ret = phy_write(phydev, AT803X_DEBUG_ADDR, reg);
  3291. + if (ret < 0)
  3292. + return ret;
  3293. +
  3294. + return phy_read(phydev, AT803X_DEBUG_DATA);
  3295. +}
  3296. +
  3297. +static int at803x_debug_reg_mask(struct phy_device *phydev, u16 reg,
  3298. + u16 clear, u16 set)
  3299. +{
  3300. + u16 val;
  3301. + int ret;
  3302. +
  3303. + ret = at803x_debug_reg_read(phydev, reg);
  3304. + if (ret < 0)
  3305. + return ret;
  3306. +
  3307. + val = ret & 0xffff;
  3308. + val &= ~clear;
  3309. + val |= set;
  3310. +
  3311. + return phy_write(phydev, AT803X_DEBUG_DATA, val);
  3312. +}
  3313. +
  3314. +static int at803x_write_page(struct phy_device *phydev, int page)
  3315. +{
  3316. + int mask;
  3317. + int set;
  3318. +
  3319. + if (page == AT803X_PAGE_COPPER) {
  3320. + set = AT803X_BT_BX_REG_SEL;
  3321. + mask = 0;
  3322. + } else {
  3323. + set = 0;
  3324. + mask = AT803X_BT_BX_REG_SEL;
  3325. + }
  3326. +
  3327. + return __phy_modify(phydev, AT803X_REG_CHIP_CONFIG, mask, set);
  3328. +}
  3329. +
  3330. +static int at803x_read_page(struct phy_device *phydev)
  3331. +{
  3332. + int ccr = __phy_read(phydev, AT803X_REG_CHIP_CONFIG);
  3333. +
  3334. + if (ccr < 0)
  3335. + return ccr;
  3336. +
  3337. + if (ccr & AT803X_BT_BX_REG_SEL)
  3338. + return AT803X_PAGE_COPPER;
  3339. +
  3340. + return AT803X_PAGE_FIBER;
  3341. +}
  3342. +
  3343. +static int at803x_enable_rx_delay(struct phy_device *phydev)
  3344. +{
  3345. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL, 0,
  3346. + AT803X_DEBUG_RX_CLK_DLY_EN);
  3347. +}
  3348. +
  3349. +static int at803x_enable_tx_delay(struct phy_device *phydev)
  3350. +{
  3351. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_SYSTEM_CTRL_MODE, 0,
  3352. + AT803X_DEBUG_TX_CLK_DLY_EN);
  3353. +}
  3354. +
  3355. +static int at803x_disable_rx_delay(struct phy_device *phydev)
  3356. +{
  3357. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL,
  3358. + AT803X_DEBUG_RX_CLK_DLY_EN, 0);
  3359. +}
  3360. +
  3361. +static int at803x_disable_tx_delay(struct phy_device *phydev)
  3362. +{
  3363. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_SYSTEM_CTRL_MODE,
  3364. + AT803X_DEBUG_TX_CLK_DLY_EN, 0);
  3365. +}
  3366. +
  3367. +/* save relevant PHY registers to private copy */
  3368. +static void at803x_context_save(struct phy_device *phydev,
  3369. + struct at803x_context *context)
  3370. +{
  3371. + context->bmcr = phy_read(phydev, MII_BMCR);
  3372. + context->advertise = phy_read(phydev, MII_ADVERTISE);
  3373. + context->control1000 = phy_read(phydev, MII_CTRL1000);
  3374. + context->int_enable = phy_read(phydev, AT803X_INTR_ENABLE);
  3375. + context->smart_speed = phy_read(phydev, AT803X_SMART_SPEED);
  3376. + context->led_control = phy_read(phydev, AT803X_LED_CONTROL);
  3377. +}
  3378. +
  3379. +/* restore relevant PHY registers from private copy */
  3380. +static void at803x_context_restore(struct phy_device *phydev,
  3381. + const struct at803x_context *context)
  3382. +{
  3383. + phy_write(phydev, MII_BMCR, context->bmcr);
  3384. + phy_write(phydev, MII_ADVERTISE, context->advertise);
  3385. + phy_write(phydev, MII_CTRL1000, context->control1000);
  3386. + phy_write(phydev, AT803X_INTR_ENABLE, context->int_enable);
  3387. + phy_write(phydev, AT803X_SMART_SPEED, context->smart_speed);
  3388. + phy_write(phydev, AT803X_LED_CONTROL, context->led_control);
  3389. +}
  3390. +
  3391. +static int at803x_set_wol(struct phy_device *phydev,
  3392. + struct ethtool_wolinfo *wol)
  3393. +{
  3394. + int ret, irq_enabled;
  3395. +
  3396. + if (wol->wolopts & WAKE_MAGIC) {
  3397. + struct net_device *ndev = phydev->attached_dev;
  3398. + const u8 *mac;
  3399. + unsigned int i;
  3400. + static const unsigned int offsets[] = {
  3401. + AT803X_LOC_MAC_ADDR_32_47_OFFSET,
  3402. + AT803X_LOC_MAC_ADDR_16_31_OFFSET,
  3403. + AT803X_LOC_MAC_ADDR_0_15_OFFSET,
  3404. + };
  3405. +
  3406. + if (!ndev)
  3407. + return -ENODEV;
  3408. +
  3409. + mac = (const u8 *)ndev->dev_addr;
  3410. +
  3411. + if (!is_valid_ether_addr(mac))
  3412. + return -EINVAL;
  3413. +
  3414. + for (i = 0; i < 3; i++)
  3415. + phy_write_mmd(phydev, MDIO_MMD_PCS, offsets[i],
  3416. + mac[(i * 2) + 1] | (mac[(i * 2)] << 8));
  3417. +
  3418. + /* Enable WOL interrupt */
  3419. + ret = phy_modify(phydev, AT803X_INTR_ENABLE, 0, AT803X_INTR_ENABLE_WOL);
  3420. + if (ret)
  3421. + return ret;
  3422. + } else {
  3423. + /* Disable WOL interrupt */
  3424. + ret = phy_modify(phydev, AT803X_INTR_ENABLE, AT803X_INTR_ENABLE_WOL, 0);
  3425. + if (ret)
  3426. + return ret;
  3427. + }
  3428. +
  3429. + /* Clear WOL status */
  3430. + ret = phy_read(phydev, AT803X_INTR_STATUS);
  3431. + if (ret < 0)
  3432. + return ret;
  3433. +
  3434. + /* Check if there are other interrupts except for WOL triggered when PHY is
  3435. + * in interrupt mode, only the interrupts enabled by AT803X_INTR_ENABLE can
  3436. + * be passed up to the interrupt PIN.
  3437. + */
  3438. + irq_enabled = phy_read(phydev, AT803X_INTR_ENABLE);
  3439. + if (irq_enabled < 0)
  3440. + return irq_enabled;
  3441. +
  3442. + irq_enabled &= ~AT803X_INTR_ENABLE_WOL;
  3443. + if (ret & irq_enabled && !phy_polling_mode(phydev))
  3444. + phy_trigger_machine(phydev);
  3445. +
  3446. + return 0;
  3447. +}
  3448. +
  3449. +static void at803x_get_wol(struct phy_device *phydev,
  3450. + struct ethtool_wolinfo *wol)
  3451. +{
  3452. + int value;
  3453. +
  3454. + wol->supported = WAKE_MAGIC;
  3455. + wol->wolopts = 0;
  3456. +
  3457. + value = phy_read(phydev, AT803X_INTR_ENABLE);
  3458. + if (value < 0)
  3459. + return;
  3460. +
  3461. + if (value & AT803X_INTR_ENABLE_WOL)
  3462. + wol->wolopts |= WAKE_MAGIC;
  3463. +}
  3464. +
  3465. +static int qca83xx_get_sset_count(struct phy_device *phydev)
  3466. +{
  3467. + return ARRAY_SIZE(qca83xx_hw_stats);
  3468. +}
  3469. +
  3470. +static void qca83xx_get_strings(struct phy_device *phydev, u8 *data)
  3471. +{
  3472. + int i;
  3473. +
  3474. + for (i = 0; i < ARRAY_SIZE(qca83xx_hw_stats); i++) {
  3475. + strscpy(data + i * ETH_GSTRING_LEN,
  3476. + qca83xx_hw_stats[i].string, ETH_GSTRING_LEN);
  3477. + }
  3478. +}
  3479. +
  3480. +static u64 qca83xx_get_stat(struct phy_device *phydev, int i)
  3481. +{
  3482. + struct at803x_hw_stat stat = qca83xx_hw_stats[i];
  3483. + struct at803x_priv *priv = phydev->priv;
  3484. + int val;
  3485. + u64 ret;
  3486. +
  3487. + if (stat.access_type == MMD)
  3488. + val = phy_read_mmd(phydev, MDIO_MMD_PCS, stat.reg);
  3489. + else
  3490. + val = phy_read(phydev, stat.reg);
  3491. +
  3492. + if (val < 0) {
  3493. + ret = U64_MAX;
  3494. + } else {
  3495. + val = val & stat.mask;
  3496. + priv->stats[i] += val;
  3497. + ret = priv->stats[i];
  3498. + }
  3499. +
  3500. + return ret;
  3501. +}
  3502. +
  3503. +static void qca83xx_get_stats(struct phy_device *phydev,
  3504. + struct ethtool_stats *stats, u64 *data)
  3505. +{
  3506. + int i;
  3507. +
  3508. + for (i = 0; i < ARRAY_SIZE(qca83xx_hw_stats); i++)
  3509. + data[i] = qca83xx_get_stat(phydev, i);
  3510. +}
  3511. +
  3512. +static int at803x_suspend(struct phy_device *phydev)
  3513. +{
  3514. + int value;
  3515. + int wol_enabled;
  3516. +
  3517. + value = phy_read(phydev, AT803X_INTR_ENABLE);
  3518. + wol_enabled = value & AT803X_INTR_ENABLE_WOL;
  3519. +
  3520. + if (wol_enabled)
  3521. + value = BMCR_ISOLATE;
  3522. + else
  3523. + value = BMCR_PDOWN;
  3524. +
  3525. + phy_modify(phydev, MII_BMCR, 0, value);
  3526. +
  3527. + return 0;
  3528. +}
  3529. +
  3530. +static int at803x_resume(struct phy_device *phydev)
  3531. +{
  3532. + return phy_modify(phydev, MII_BMCR, BMCR_PDOWN | BMCR_ISOLATE, 0);
  3533. +}
  3534. +
  3535. +static int at803x_parse_dt(struct phy_device *phydev)
  3536. +{
  3537. + struct device_node *node = phydev->mdio.dev.of_node;
  3538. + struct at803x_priv *priv = phydev->priv;
  3539. + u32 freq, strength, tw;
  3540. + unsigned int sel;
  3541. + int ret;
  3542. +
  3543. + if (!IS_ENABLED(CONFIG_OF_MDIO))
  3544. + return 0;
  3545. +
  3546. + if (of_property_read_bool(node, "qca,disable-smarteee"))
  3547. + priv->flags |= AT803X_DISABLE_SMARTEEE;
  3548. +
  3549. + if (of_property_read_bool(node, "qca,disable-hibernation-mode"))
  3550. + priv->flags |= AT803X_DISABLE_HIBERNATION_MODE;
  3551. +
  3552. + if (!of_property_read_u32(node, "qca,smarteee-tw-us-1g", &tw)) {
  3553. + if (!tw || tw > 255) {
  3554. + phydev_err(phydev, "invalid qca,smarteee-tw-us-1g\n");
  3555. + return -EINVAL;
  3556. + }
  3557. + priv->smarteee_lpi_tw_1g = tw;
  3558. + }
  3559. +
  3560. + if (!of_property_read_u32(node, "qca,smarteee-tw-us-100m", &tw)) {
  3561. + if (!tw || tw > 255) {
  3562. + phydev_err(phydev, "invalid qca,smarteee-tw-us-100m\n");
  3563. + return -EINVAL;
  3564. + }
  3565. + priv->smarteee_lpi_tw_100m = tw;
  3566. + }
  3567. +
  3568. + ret = of_property_read_u32(node, "qca,clk-out-frequency", &freq);
  3569. + if (!ret) {
  3570. + switch (freq) {
  3571. + case 25000000:
  3572. + sel = AT803X_CLK_OUT_25MHZ_XTAL;
  3573. + break;
  3574. + case 50000000:
  3575. + sel = AT803X_CLK_OUT_50MHZ_PLL;
  3576. + break;
  3577. + case 62500000:
  3578. + sel = AT803X_CLK_OUT_62_5MHZ_PLL;
  3579. + break;
  3580. + case 125000000:
  3581. + sel = AT803X_CLK_OUT_125MHZ_PLL;
  3582. + break;
  3583. + default:
  3584. + phydev_err(phydev, "invalid qca,clk-out-frequency\n");
  3585. + return -EINVAL;
  3586. + }
  3587. +
  3588. + priv->clk_25m_reg |= FIELD_PREP(AT803X_CLK_OUT_MASK, sel);
  3589. + priv->clk_25m_mask |= AT803X_CLK_OUT_MASK;
  3590. + }
  3591. +
  3592. + ret = of_property_read_u32(node, "qca,clk-out-strength", &strength);
  3593. + if (!ret) {
  3594. + priv->clk_25m_mask |= AT803X_CLK_OUT_STRENGTH_MASK;
  3595. + switch (strength) {
  3596. + case AR803X_STRENGTH_FULL:
  3597. + priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_FULL;
  3598. + break;
  3599. + case AR803X_STRENGTH_HALF:
  3600. + priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_HALF;
  3601. + break;
  3602. + case AR803X_STRENGTH_QUARTER:
  3603. + priv->clk_25m_reg |= AT803X_CLK_OUT_STRENGTH_QUARTER;
  3604. + break;
  3605. + default:
  3606. + phydev_err(phydev, "invalid qca,clk-out-strength\n");
  3607. + return -EINVAL;
  3608. + }
  3609. + }
  3610. +
  3611. + return 0;
  3612. +}
  3613. +
  3614. +static int at803x_probe(struct phy_device *phydev)
  3615. +{
  3616. + struct device *dev = &phydev->mdio.dev;
  3617. + struct at803x_priv *priv;
  3618. + int ret;
  3619. +
  3620. + priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
  3621. + if (!priv)
  3622. + return -ENOMEM;
  3623. +
  3624. + /* Init LED polarity mode to -1 */
  3625. + priv->led_polarity_mode = -1;
  3626. +
  3627. + phydev->priv = priv;
  3628. +
  3629. + ret = at803x_parse_dt(phydev);
  3630. + if (ret)
  3631. + return ret;
  3632. +
  3633. + return 0;
  3634. +}
  3635. +
  3636. +static int at803x_get_features(struct phy_device *phydev)
  3637. +{
  3638. + struct at803x_priv *priv = phydev->priv;
  3639. + int err;
  3640. +
  3641. + err = genphy_read_abilities(phydev);
  3642. + if (err)
  3643. + return err;
  3644. +
  3645. + if (phydev->drv->phy_id != ATH8031_PHY_ID)
  3646. + return 0;
  3647. +
  3648. + /* AR8031/AR8033 have different status registers
  3649. + * for copper and fiber operation. However, the
  3650. + * extended status register is the same for both
  3651. + * operation modes.
  3652. + *
  3653. + * As a result of that, ESTATUS_1000_XFULL is set
  3654. + * to 1 even when operating in copper TP mode.
  3655. + *
  3656. + * Remove this mode from the supported link modes
  3657. + * when not operating in 1000BaseX mode.
  3658. + */
  3659. + if (!priv->is_1000basex)
  3660. + linkmode_clear_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT,
  3661. + phydev->supported);
  3662. +
  3663. + return 0;
  3664. +}
  3665. +
  3666. +static int at803x_smarteee_config(struct phy_device *phydev)
  3667. +{
  3668. + struct at803x_priv *priv = phydev->priv;
  3669. + u16 mask = 0, val = 0;
  3670. + int ret;
  3671. +
  3672. + if (priv->flags & AT803X_DISABLE_SMARTEEE)
  3673. + return phy_modify_mmd(phydev, MDIO_MMD_PCS,
  3674. + AT803X_MMD3_SMARTEEE_CTL3,
  3675. + AT803X_MMD3_SMARTEEE_CTL3_LPI_EN, 0);
  3676. +
  3677. + if (priv->smarteee_lpi_tw_1g) {
  3678. + mask |= 0xff00;
  3679. + val |= priv->smarteee_lpi_tw_1g << 8;
  3680. + }
  3681. + if (priv->smarteee_lpi_tw_100m) {
  3682. + mask |= 0x00ff;
  3683. + val |= priv->smarteee_lpi_tw_100m;
  3684. + }
  3685. + if (!mask)
  3686. + return 0;
  3687. +
  3688. + ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, AT803X_MMD3_SMARTEEE_CTL1,
  3689. + mask, val);
  3690. + if (ret)
  3691. + return ret;
  3692. +
  3693. + return phy_modify_mmd(phydev, MDIO_MMD_PCS, AT803X_MMD3_SMARTEEE_CTL3,
  3694. + AT803X_MMD3_SMARTEEE_CTL3_LPI_EN,
  3695. + AT803X_MMD3_SMARTEEE_CTL3_LPI_EN);
  3696. +}
  3697. +
  3698. +static int at803x_clk_out_config(struct phy_device *phydev)
  3699. +{
  3700. + struct at803x_priv *priv = phydev->priv;
  3701. +
  3702. + if (!priv->clk_25m_mask)
  3703. + return 0;
  3704. +
  3705. + return phy_modify_mmd(phydev, MDIO_MMD_AN, AT803X_MMD7_CLK25M,
  3706. + priv->clk_25m_mask, priv->clk_25m_reg);
  3707. +}
  3708. +
  3709. +static int at8031_pll_config(struct phy_device *phydev)
  3710. +{
  3711. + struct at803x_priv *priv = phydev->priv;
  3712. +
  3713. + /* The default after hardware reset is PLL OFF. After a soft reset, the
  3714. + * values are retained.
  3715. + */
  3716. + if (priv->flags & AT803X_KEEP_PLL_ENABLED)
  3717. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F,
  3718. + 0, AT803X_DEBUG_PLL_ON);
  3719. + else
  3720. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F,
  3721. + AT803X_DEBUG_PLL_ON, 0);
  3722. +}
  3723. +
  3724. +static int at803x_hibernation_mode_config(struct phy_device *phydev)
  3725. +{
  3726. + struct at803x_priv *priv = phydev->priv;
  3727. +
  3728. + /* The default after hardware reset is hibernation mode enabled. After
  3729. + * software reset, the value is retained.
  3730. + */
  3731. + if (!(priv->flags & AT803X_DISABLE_HIBERNATION_MODE))
  3732. + return 0;
  3733. +
  3734. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_HIB_CTRL,
  3735. + AT803X_DEBUG_HIB_CTRL_PS_HIB_EN, 0);
  3736. +}
  3737. +
  3738. +static int at803x_config_init(struct phy_device *phydev)
  3739. +{
  3740. + int ret;
  3741. +
  3742. + /* The RX and TX delay default is:
  3743. + * after HW reset: RX delay enabled and TX delay disabled
  3744. + * after SW reset: RX delay enabled, while TX delay retains the
  3745. + * value before reset.
  3746. + */
  3747. + if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
  3748. + phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID)
  3749. + ret = at803x_enable_rx_delay(phydev);
  3750. + else
  3751. + ret = at803x_disable_rx_delay(phydev);
  3752. + if (ret < 0)
  3753. + return ret;
  3754. +
  3755. + if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID ||
  3756. + phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID)
  3757. + ret = at803x_enable_tx_delay(phydev);
  3758. + else
  3759. + ret = at803x_disable_tx_delay(phydev);
  3760. + if (ret < 0)
  3761. + return ret;
  3762. +
  3763. + ret = at803x_smarteee_config(phydev);
  3764. + if (ret < 0)
  3765. + return ret;
  3766. +
  3767. + ret = at803x_clk_out_config(phydev);
  3768. + if (ret < 0)
  3769. + return ret;
  3770. +
  3771. + ret = at803x_hibernation_mode_config(phydev);
  3772. + if (ret < 0)
  3773. + return ret;
  3774. +
  3775. + /* Ar803x extended next page bit is enabled by default. Cisco
  3776. + * multigig switches read this bit and attempt to negotiate 10Gbps
  3777. + * rates even if the next page bit is disabled. This is incorrect
  3778. + * behaviour but we still need to accommodate it. XNP is only needed
  3779. + * for 10Gbps support, so disable XNP.
  3780. + */
  3781. + return phy_modify(phydev, MII_ADVERTISE, MDIO_AN_CTRL1_XNP, 0);
  3782. +}
  3783. +
  3784. +static int at803x_ack_interrupt(struct phy_device *phydev)
  3785. +{
  3786. + int err;
  3787. +
  3788. + err = phy_read(phydev, AT803X_INTR_STATUS);
  3789. +
  3790. + return (err < 0) ? err : 0;
  3791. +}
  3792. +
  3793. +static int at803x_config_intr(struct phy_device *phydev)
  3794. +{
  3795. + int err;
  3796. + int value;
  3797. +
  3798. + value = phy_read(phydev, AT803X_INTR_ENABLE);
  3799. +
  3800. + if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
  3801. + /* Clear any pending interrupts */
  3802. + err = at803x_ack_interrupt(phydev);
  3803. + if (err)
  3804. + return err;
  3805. +
  3806. + value |= AT803X_INTR_ENABLE_AUTONEG_ERR;
  3807. + value |= AT803X_INTR_ENABLE_SPEED_CHANGED;
  3808. + value |= AT803X_INTR_ENABLE_DUPLEX_CHANGED;
  3809. + value |= AT803X_INTR_ENABLE_LINK_FAIL;
  3810. + value |= AT803X_INTR_ENABLE_LINK_SUCCESS;
  3811. +
  3812. + err = phy_write(phydev, AT803X_INTR_ENABLE, value);
  3813. + } else {
  3814. + err = phy_write(phydev, AT803X_INTR_ENABLE, 0);
  3815. + if (err)
  3816. + return err;
  3817. +
  3818. + /* Clear any pending interrupts */
  3819. + err = at803x_ack_interrupt(phydev);
  3820. + }
  3821. +
  3822. + return err;
  3823. +}
  3824. +
  3825. +static irqreturn_t at803x_handle_interrupt(struct phy_device *phydev)
  3826. +{
  3827. + int irq_status, int_enabled;
  3828. +
  3829. + irq_status = phy_read(phydev, AT803X_INTR_STATUS);
  3830. + if (irq_status < 0) {
  3831. + phy_error(phydev);
  3832. + return IRQ_NONE;
  3833. + }
  3834. +
  3835. + /* Read the current enabled interrupts */
  3836. + int_enabled = phy_read(phydev, AT803X_INTR_ENABLE);
  3837. + if (int_enabled < 0) {
  3838. + phy_error(phydev);
  3839. + return IRQ_NONE;
  3840. + }
  3841. +
  3842. + /* See if this was one of our enabled interrupts */
  3843. + if (!(irq_status & int_enabled))
  3844. + return IRQ_NONE;
  3845. +
  3846. + phy_trigger_machine(phydev);
  3847. +
  3848. + return IRQ_HANDLED;
  3849. +}
  3850. +
  3851. +static void at803x_link_change_notify(struct phy_device *phydev)
  3852. +{
  3853. + /*
  3854. + * Conduct a hardware reset for AT8030 every time a link loss is
  3855. + * signalled. This is necessary to circumvent a hardware bug that
  3856. + * occurs when the cable is unplugged while TX packets are pending
  3857. + * in the FIFO. In such cases, the FIFO enters an error mode it
  3858. + * cannot recover from by software.
  3859. + */
  3860. + if (phydev->state == PHY_NOLINK && phydev->mdio.reset_gpio) {
  3861. + struct at803x_context context;
  3862. +
  3863. + at803x_context_save(phydev, &context);
  3864. +
  3865. + phy_device_reset(phydev, 1);
  3866. + usleep_range(1000, 2000);
  3867. + phy_device_reset(phydev, 0);
  3868. + usleep_range(1000, 2000);
  3869. +
  3870. + at803x_context_restore(phydev, &context);
  3871. +
  3872. + phydev_dbg(phydev, "%s(): phy was reset\n", __func__);
  3873. + }
  3874. +}
  3875. +
  3876. +static int at803x_read_specific_status(struct phy_device *phydev,
  3877. + struct at803x_ss_mask ss_mask)
  3878. +{
  3879. + int ss;
  3880. +
  3881. + /* Read the AT8035 PHY-Specific Status register, which indicates the
  3882. + * speed and duplex that the PHY is actually using, irrespective of
  3883. + * whether we are in autoneg mode or not.
  3884. + */
  3885. + ss = phy_read(phydev, AT803X_SPECIFIC_STATUS);
  3886. + if (ss < 0)
  3887. + return ss;
  3888. +
  3889. + if (ss & AT803X_SS_SPEED_DUPLEX_RESOLVED) {
  3890. + int sfc, speed;
  3891. +
  3892. + sfc = phy_read(phydev, AT803X_SPECIFIC_FUNCTION_CONTROL);
  3893. + if (sfc < 0)
  3894. + return sfc;
  3895. +
  3896. + speed = ss & ss_mask.speed_mask;
  3897. + speed >>= ss_mask.speed_shift;
  3898. +
  3899. + switch (speed) {
  3900. + case AT803X_SS_SPEED_10:
  3901. + phydev->speed = SPEED_10;
  3902. + break;
  3903. + case AT803X_SS_SPEED_100:
  3904. + phydev->speed = SPEED_100;
  3905. + break;
  3906. + case AT803X_SS_SPEED_1000:
  3907. + phydev->speed = SPEED_1000;
  3908. + break;
  3909. + case QCA808X_SS_SPEED_2500:
  3910. + phydev->speed = SPEED_2500;
  3911. + break;
  3912. + }
  3913. + if (ss & AT803X_SS_DUPLEX)
  3914. + phydev->duplex = DUPLEX_FULL;
  3915. + else
  3916. + phydev->duplex = DUPLEX_HALF;
  3917. +
  3918. + if (ss & AT803X_SS_MDIX)
  3919. + phydev->mdix = ETH_TP_MDI_X;
  3920. + else
  3921. + phydev->mdix = ETH_TP_MDI;
  3922. +
  3923. + switch (FIELD_GET(AT803X_SFC_MDI_CROSSOVER_MODE_M, sfc)) {
  3924. + case AT803X_SFC_MANUAL_MDI:
  3925. + phydev->mdix_ctrl = ETH_TP_MDI;
  3926. + break;
  3927. + case AT803X_SFC_MANUAL_MDIX:
  3928. + phydev->mdix_ctrl = ETH_TP_MDI_X;
  3929. + break;
  3930. + case AT803X_SFC_AUTOMATIC_CROSSOVER:
  3931. + phydev->mdix_ctrl = ETH_TP_MDI_AUTO;
  3932. + break;
  3933. + }
  3934. + }
  3935. +
  3936. + return 0;
  3937. +}
  3938. +
  3939. +static int at803x_read_status(struct phy_device *phydev)
  3940. +{
  3941. + struct at803x_ss_mask ss_mask = { 0 };
  3942. + int err, old_link = phydev->link;
  3943. +
  3944. + /* Update the link, but return if there was an error */
  3945. + err = genphy_update_link(phydev);
  3946. + if (err)
  3947. + return err;
  3948. +
  3949. + /* why bother the PHY if nothing can have changed */
  3950. + if (phydev->autoneg == AUTONEG_ENABLE && old_link && phydev->link)
  3951. + return 0;
  3952. +
  3953. + phydev->speed = SPEED_UNKNOWN;
  3954. + phydev->duplex = DUPLEX_UNKNOWN;
  3955. + phydev->pause = 0;
  3956. + phydev->asym_pause = 0;
  3957. +
  3958. + err = genphy_read_lpa(phydev);
  3959. + if (err < 0)
  3960. + return err;
  3961. +
  3962. + ss_mask.speed_mask = AT803X_SS_SPEED_MASK;
  3963. + ss_mask.speed_shift = __bf_shf(AT803X_SS_SPEED_MASK);
  3964. + err = at803x_read_specific_status(phydev, ss_mask);
  3965. + if (err < 0)
  3966. + return err;
  3967. +
  3968. + if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete)
  3969. + phy_resolve_aneg_pause(phydev);
  3970. +
  3971. + return 0;
  3972. +}
  3973. +
  3974. +static int at803x_config_mdix(struct phy_device *phydev, u8 ctrl)
  3975. +{
  3976. + u16 val;
  3977. +
  3978. + switch (ctrl) {
  3979. + case ETH_TP_MDI:
  3980. + val = AT803X_SFC_MANUAL_MDI;
  3981. + break;
  3982. + case ETH_TP_MDI_X:
  3983. + val = AT803X_SFC_MANUAL_MDIX;
  3984. + break;
  3985. + case ETH_TP_MDI_AUTO:
  3986. + val = AT803X_SFC_AUTOMATIC_CROSSOVER;
  3987. + break;
  3988. + default:
  3989. + return 0;
  3990. + }
  3991. +
  3992. + return phy_modify_changed(phydev, AT803X_SPECIFIC_FUNCTION_CONTROL,
  3993. + AT803X_SFC_MDI_CROSSOVER_MODE_M,
  3994. + FIELD_PREP(AT803X_SFC_MDI_CROSSOVER_MODE_M, val));
  3995. +}
  3996. +
  3997. +static int at803x_prepare_config_aneg(struct phy_device *phydev)
  3998. +{
  3999. + int ret;
  4000. +
  4001. + ret = at803x_config_mdix(phydev, phydev->mdix_ctrl);
  4002. + if (ret < 0)
  4003. + return ret;
  4004. +
  4005. + /* Changes of the midx bits are disruptive to the normal operation;
  4006. + * therefore any changes to these registers must be followed by a
  4007. + * software reset to take effect.
  4008. + */
  4009. + if (ret == 1) {
  4010. + ret = genphy_soft_reset(phydev);
  4011. + if (ret < 0)
  4012. + return ret;
  4013. + }
  4014. +
  4015. + return 0;
  4016. +}
  4017. +
  4018. +static int at803x_config_aneg(struct phy_device *phydev)
  4019. +{
  4020. + struct at803x_priv *priv = phydev->priv;
  4021. + int ret;
  4022. +
  4023. + ret = at803x_prepare_config_aneg(phydev);
  4024. + if (ret)
  4025. + return ret;
  4026. +
  4027. + if (priv->is_1000basex)
  4028. + return genphy_c37_config_aneg(phydev);
  4029. +
  4030. + return genphy_config_aneg(phydev);
  4031. +}
  4032. +
  4033. +static int at803x_get_downshift(struct phy_device *phydev, u8 *d)
  4034. +{
  4035. + int val;
  4036. +
  4037. + val = phy_read(phydev, AT803X_SMART_SPEED);
  4038. + if (val < 0)
  4039. + return val;
  4040. +
  4041. + if (val & AT803X_SMART_SPEED_ENABLE)
  4042. + *d = FIELD_GET(AT803X_SMART_SPEED_RETRY_LIMIT_MASK, val) + 2;
  4043. + else
  4044. + *d = DOWNSHIFT_DEV_DISABLE;
  4045. +
  4046. + return 0;
  4047. +}
  4048. +
  4049. +static int at803x_set_downshift(struct phy_device *phydev, u8 cnt)
  4050. +{
  4051. + u16 mask, set;
  4052. + int ret;
  4053. +
  4054. + switch (cnt) {
  4055. + case DOWNSHIFT_DEV_DEFAULT_COUNT:
  4056. + cnt = AT803X_DEFAULT_DOWNSHIFT;
  4057. + fallthrough;
  4058. + case AT803X_MIN_DOWNSHIFT ... AT803X_MAX_DOWNSHIFT:
  4059. + set = AT803X_SMART_SPEED_ENABLE |
  4060. + AT803X_SMART_SPEED_BYPASS_TIMER |
  4061. + FIELD_PREP(AT803X_SMART_SPEED_RETRY_LIMIT_MASK, cnt - 2);
  4062. + mask = AT803X_SMART_SPEED_RETRY_LIMIT_MASK;
  4063. + break;
  4064. + case DOWNSHIFT_DEV_DISABLE:
  4065. + set = 0;
  4066. + mask = AT803X_SMART_SPEED_ENABLE |
  4067. + AT803X_SMART_SPEED_BYPASS_TIMER;
  4068. + break;
  4069. + default:
  4070. + return -EINVAL;
  4071. + }
  4072. +
  4073. + ret = phy_modify_changed(phydev, AT803X_SMART_SPEED, mask, set);
  4074. +
  4075. + /* After changing the smart speed settings, we need to perform a
  4076. + * software reset, use phy_init_hw() to make sure we set the
  4077. + * reapply any values which might got lost during software reset.
  4078. + */
  4079. + if (ret == 1)
  4080. + ret = phy_init_hw(phydev);
  4081. +
  4082. + return ret;
  4083. +}
  4084. +
  4085. +static int at803x_get_tunable(struct phy_device *phydev,
  4086. + struct ethtool_tunable *tuna, void *data)
  4087. +{
  4088. + switch (tuna->id) {
  4089. + case ETHTOOL_PHY_DOWNSHIFT:
  4090. + return at803x_get_downshift(phydev, data);
  4091. + default:
  4092. + return -EOPNOTSUPP;
  4093. + }
  4094. +}
  4095. +
  4096. +static int at803x_set_tunable(struct phy_device *phydev,
  4097. + struct ethtool_tunable *tuna, const void *data)
  4098. +{
  4099. + switch (tuna->id) {
  4100. + case ETHTOOL_PHY_DOWNSHIFT:
  4101. + return at803x_set_downshift(phydev, *(const u8 *)data);
  4102. + default:
  4103. + return -EOPNOTSUPP;
  4104. + }
  4105. +}
  4106. +
  4107. +static int at803x_cable_test_result_trans(u16 status)
  4108. +{
  4109. + switch (FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status)) {
  4110. + case AT803X_CDT_STATUS_STAT_NORMAL:
  4111. + return ETHTOOL_A_CABLE_RESULT_CODE_OK;
  4112. + case AT803X_CDT_STATUS_STAT_SHORT:
  4113. + return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT;
  4114. + case AT803X_CDT_STATUS_STAT_OPEN:
  4115. + return ETHTOOL_A_CABLE_RESULT_CODE_OPEN;
  4116. + case AT803X_CDT_STATUS_STAT_FAIL:
  4117. + default:
  4118. + return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
  4119. + }
  4120. +}
  4121. +
  4122. +static bool at803x_cdt_test_failed(u16 status)
  4123. +{
  4124. + return FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status) ==
  4125. + AT803X_CDT_STATUS_STAT_FAIL;
  4126. +}
  4127. +
  4128. +static bool at803x_cdt_fault_length_valid(u16 status)
  4129. +{
  4130. + switch (FIELD_GET(AT803X_CDT_STATUS_STAT_MASK, status)) {
  4131. + case AT803X_CDT_STATUS_STAT_OPEN:
  4132. + case AT803X_CDT_STATUS_STAT_SHORT:
  4133. + return true;
  4134. + }
  4135. + return false;
  4136. +}
  4137. +
  4138. +static int at803x_cdt_fault_length(int dt)
  4139. +{
  4140. + /* According to the datasheet the distance to the fault is
  4141. + * DELTA_TIME * 0.824 meters.
  4142. + *
  4143. + * The author suspect the correct formula is:
  4144. + *
  4145. + * fault_distance = DELTA_TIME * (c * VF) / 125MHz / 2
  4146. + *
  4147. + * where c is the speed of light, VF is the velocity factor of
  4148. + * the twisted pair cable, 125MHz the counter frequency and
  4149. + * we need to divide by 2 because the hardware will measure the
  4150. + * round trip time to the fault and back to the PHY.
  4151. + *
  4152. + * With a VF of 0.69 we get the factor 0.824 mentioned in the
  4153. + * datasheet.
  4154. + */
  4155. + return (dt * 824) / 10;
  4156. +}
  4157. +
  4158. +static int at803x_cdt_start(struct phy_device *phydev,
  4159. + u32 cdt_start)
  4160. +{
  4161. + return phy_write(phydev, AT803X_CDT, cdt_start);
  4162. +}
  4163. +
  4164. +static int at803x_cdt_wait_for_completion(struct phy_device *phydev,
  4165. + u32 cdt_en)
  4166. +{
  4167. + int val, ret;
  4168. +
  4169. + /* One test run takes about 25ms */
  4170. + ret = phy_read_poll_timeout(phydev, AT803X_CDT, val,
  4171. + !(val & cdt_en),
  4172. + 30000, 100000, true);
  4173. +
  4174. + return ret < 0 ? ret : 0;
  4175. +}
  4176. +
  4177. +static int at803x_cable_test_one_pair(struct phy_device *phydev, int pair)
  4178. +{
  4179. + static const int ethtool_pair[] = {
  4180. + ETHTOOL_A_CABLE_PAIR_A,
  4181. + ETHTOOL_A_CABLE_PAIR_B,
  4182. + ETHTOOL_A_CABLE_PAIR_C,
  4183. + ETHTOOL_A_CABLE_PAIR_D,
  4184. + };
  4185. + int ret, val;
  4186. +
  4187. + val = FIELD_PREP(AT803X_CDT_MDI_PAIR_MASK, pair) |
  4188. + AT803X_CDT_ENABLE_TEST;
  4189. + ret = at803x_cdt_start(phydev, val);
  4190. + if (ret)
  4191. + return ret;
  4192. +
  4193. + ret = at803x_cdt_wait_for_completion(phydev, AT803X_CDT_ENABLE_TEST);
  4194. + if (ret)
  4195. + return ret;
  4196. +
  4197. + val = phy_read(phydev, AT803X_CDT_STATUS);
  4198. + if (val < 0)
  4199. + return val;
  4200. +
  4201. + if (at803x_cdt_test_failed(val))
  4202. + return 0;
  4203. +
  4204. + ethnl_cable_test_result(phydev, ethtool_pair[pair],
  4205. + at803x_cable_test_result_trans(val));
  4206. +
  4207. + if (at803x_cdt_fault_length_valid(val)) {
  4208. + val = FIELD_GET(AT803X_CDT_STATUS_DELTA_TIME_MASK, val);
  4209. + ethnl_cable_test_fault_length(phydev, ethtool_pair[pair],
  4210. + at803x_cdt_fault_length(val));
  4211. + }
  4212. +
  4213. + return 1;
  4214. +}
  4215. +
  4216. +static int at803x_cable_test_get_status(struct phy_device *phydev,
  4217. + bool *finished, unsigned long pair_mask)
  4218. +{
  4219. + int retries = 20;
  4220. + int pair, ret;
  4221. +
  4222. + *finished = false;
  4223. +
  4224. + /* According to the datasheet the CDT can be performed when
  4225. + * there is no link partner or when the link partner is
  4226. + * auto-negotiating. Starting the test will restart the AN
  4227. + * automatically. It seems that doing this repeatedly we will
  4228. + * get a slot where our link partner won't disturb our
  4229. + * measurement.
  4230. + */
  4231. + while (pair_mask && retries--) {
  4232. + for_each_set_bit(pair, &pair_mask, 4) {
  4233. + ret = at803x_cable_test_one_pair(phydev, pair);
  4234. + if (ret < 0)
  4235. + return ret;
  4236. + if (ret)
  4237. + clear_bit(pair, &pair_mask);
  4238. + }
  4239. + if (pair_mask)
  4240. + msleep(250);
  4241. + }
  4242. +
  4243. + *finished = true;
  4244. +
  4245. + return 0;
  4246. +}
  4247. +
  4248. +static void at803x_cable_test_autoneg(struct phy_device *phydev)
  4249. +{
  4250. + /* Enable auto-negotiation, but advertise no capabilities, no link
  4251. + * will be established. A restart of the auto-negotiation is not
  4252. + * required, because the cable test will automatically break the link.
  4253. + */
  4254. + phy_write(phydev, MII_BMCR, BMCR_ANENABLE);
  4255. + phy_write(phydev, MII_ADVERTISE, ADVERTISE_CSMA);
  4256. +}
  4257. +
  4258. +static int at803x_cable_test_start(struct phy_device *phydev)
  4259. +{
  4260. + at803x_cable_test_autoneg(phydev);
  4261. + /* we do all the (time consuming) work later */
  4262. + return 0;
  4263. +}
  4264. +
  4265. +static int at8031_rgmii_reg_set_voltage_sel(struct regulator_dev *rdev,
  4266. + unsigned int selector)
  4267. +{
  4268. + struct phy_device *phydev = rdev_get_drvdata(rdev);
  4269. +
  4270. + if (selector)
  4271. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F,
  4272. + 0, AT803X_DEBUG_RGMII_1V8);
  4273. + else
  4274. + return at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_1F,
  4275. + AT803X_DEBUG_RGMII_1V8, 0);
  4276. +}
  4277. +
  4278. +static int at8031_rgmii_reg_get_voltage_sel(struct regulator_dev *rdev)
  4279. +{
  4280. + struct phy_device *phydev = rdev_get_drvdata(rdev);
  4281. + int val;
  4282. +
  4283. + val = at803x_debug_reg_read(phydev, AT803X_DEBUG_REG_1F);
  4284. + if (val < 0)
  4285. + return val;
  4286. +
  4287. + return (val & AT803X_DEBUG_RGMII_1V8) ? 1 : 0;
  4288. +}
  4289. +
  4290. +static const struct regulator_ops vddio_regulator_ops = {
  4291. + .list_voltage = regulator_list_voltage_table,
  4292. + .set_voltage_sel = at8031_rgmii_reg_set_voltage_sel,
  4293. + .get_voltage_sel = at8031_rgmii_reg_get_voltage_sel,
  4294. +};
  4295. +
  4296. +static const unsigned int vddio_voltage_table[] = {
  4297. + 1500000,
  4298. + 1800000,
  4299. +};
  4300. +
  4301. +static const struct regulator_desc vddio_desc = {
  4302. + .name = "vddio",
  4303. + .of_match = of_match_ptr("vddio-regulator"),
  4304. + .n_voltages = ARRAY_SIZE(vddio_voltage_table),
  4305. + .volt_table = vddio_voltage_table,
  4306. + .ops = &vddio_regulator_ops,
  4307. + .type = REGULATOR_VOLTAGE,
  4308. + .owner = THIS_MODULE,
  4309. +};
  4310. +
  4311. +static const struct regulator_ops vddh_regulator_ops = {
  4312. +};
  4313. +
  4314. +static const struct regulator_desc vddh_desc = {
  4315. + .name = "vddh",
  4316. + .of_match = of_match_ptr("vddh-regulator"),
  4317. + .n_voltages = 1,
  4318. + .fixed_uV = 2500000,
  4319. + .ops = &vddh_regulator_ops,
  4320. + .type = REGULATOR_VOLTAGE,
  4321. + .owner = THIS_MODULE,
  4322. +};
  4323. +
  4324. +static int at8031_register_regulators(struct phy_device *phydev)
  4325. +{
  4326. + struct at803x_priv *priv = phydev->priv;
  4327. + struct device *dev = &phydev->mdio.dev;
  4328. + struct regulator_config config = { };
  4329. +
  4330. + config.dev = dev;
  4331. + config.driver_data = phydev;
  4332. +
  4333. + priv->vddio_rdev = devm_regulator_register(dev, &vddio_desc, &config);
  4334. + if (IS_ERR(priv->vddio_rdev)) {
  4335. + phydev_err(phydev, "failed to register VDDIO regulator\n");
  4336. + return PTR_ERR(priv->vddio_rdev);
  4337. + }
  4338. +
  4339. + priv->vddh_rdev = devm_regulator_register(dev, &vddh_desc, &config);
  4340. + if (IS_ERR(priv->vddh_rdev)) {
  4341. + phydev_err(phydev, "failed to register VDDH regulator\n");
  4342. + return PTR_ERR(priv->vddh_rdev);
  4343. + }
  4344. +
  4345. + return 0;
  4346. +}
  4347. +
  4348. +static int at8031_sfp_insert(void *upstream, const struct sfp_eeprom_id *id)
  4349. +{
  4350. + struct phy_device *phydev = upstream;
  4351. + __ETHTOOL_DECLARE_LINK_MODE_MASK(phy_support);
  4352. + __ETHTOOL_DECLARE_LINK_MODE_MASK(sfp_support);
  4353. + DECLARE_PHY_INTERFACE_MASK(interfaces);
  4354. + phy_interface_t iface;
  4355. +
  4356. + linkmode_zero(phy_support);
  4357. + phylink_set(phy_support, 1000baseX_Full);
  4358. + phylink_set(phy_support, 1000baseT_Full);
  4359. + phylink_set(phy_support, Autoneg);
  4360. + phylink_set(phy_support, Pause);
  4361. + phylink_set(phy_support, Asym_Pause);
  4362. +
  4363. + linkmode_zero(sfp_support);
  4364. + sfp_parse_support(phydev->sfp_bus, id, sfp_support, interfaces);
  4365. + /* Some modules support 10G modes as well as others we support.
  4366. + * Mask out non-supported modes so the correct interface is picked.
  4367. + */
  4368. + linkmode_and(sfp_support, phy_support, sfp_support);
  4369. +
  4370. + if (linkmode_empty(sfp_support)) {
  4371. + dev_err(&phydev->mdio.dev, "incompatible SFP module inserted\n");
  4372. + return -EINVAL;
  4373. + }
  4374. +
  4375. + iface = sfp_select_interface(phydev->sfp_bus, sfp_support);
  4376. +
  4377. + /* Only 1000Base-X is supported by AR8031/8033 as the downstream SerDes
  4378. + * interface for use with SFP modules.
  4379. + * However, some copper modules detected as having a preferred SGMII
  4380. + * interface do default to and function in 1000Base-X mode, so just
  4381. + * print a warning and allow such modules, as they may have some chance
  4382. + * of working.
  4383. + */
  4384. + if (iface == PHY_INTERFACE_MODE_SGMII)
  4385. + dev_warn(&phydev->mdio.dev, "module may not function if 1000Base-X not supported\n");
  4386. + else if (iface != PHY_INTERFACE_MODE_1000BASEX)
  4387. + return -EINVAL;
  4388. +
  4389. + return 0;
  4390. +}
  4391. +
  4392. +static const struct sfp_upstream_ops at8031_sfp_ops = {
  4393. + .attach = phy_sfp_attach,
  4394. + .detach = phy_sfp_detach,
  4395. + .module_insert = at8031_sfp_insert,
  4396. +};
  4397. +
  4398. +static int at8031_parse_dt(struct phy_device *phydev)
  4399. +{
  4400. + struct device_node *node = phydev->mdio.dev.of_node;
  4401. + struct at803x_priv *priv = phydev->priv;
  4402. + int ret;
  4403. +
  4404. + if (of_property_read_bool(node, "qca,keep-pll-enabled"))
  4405. + priv->flags |= AT803X_KEEP_PLL_ENABLED;
  4406. +
  4407. + ret = at8031_register_regulators(phydev);
  4408. + if (ret < 0)
  4409. + return ret;
  4410. +
  4411. + ret = devm_regulator_get_enable_optional(&phydev->mdio.dev,
  4412. + "vddio");
  4413. + if (ret) {
  4414. + phydev_err(phydev, "failed to get VDDIO regulator\n");
  4415. + return ret;
  4416. + }
  4417. +
  4418. + /* Only AR8031/8033 support 1000Base-X for SFP modules */
  4419. + return phy_sfp_probe(phydev, &at8031_sfp_ops);
  4420. +}
  4421. +
  4422. +static int at8031_probe(struct phy_device *phydev)
  4423. +{
  4424. + struct at803x_priv *priv = phydev->priv;
  4425. + int mode_cfg;
  4426. + int ccr;
  4427. + int ret;
  4428. +
  4429. + ret = at803x_probe(phydev);
  4430. + if (ret)
  4431. + return ret;
  4432. +
  4433. + /* Only supported on AR8031/AR8033, the AR8030/AR8035 use strapping
  4434. + * options.
  4435. + */
  4436. + ret = at8031_parse_dt(phydev);
  4437. + if (ret)
  4438. + return ret;
  4439. +
  4440. + ccr = phy_read(phydev, AT803X_REG_CHIP_CONFIG);
  4441. + if (ccr < 0)
  4442. + return ccr;
  4443. + mode_cfg = ccr & AT803X_MODE_CFG_MASK;
  4444. +
  4445. + switch (mode_cfg) {
  4446. + case AT803X_MODE_CFG_BX1000_RGMII_50OHM:
  4447. + case AT803X_MODE_CFG_BX1000_RGMII_75OHM:
  4448. + priv->is_1000basex = true;
  4449. + fallthrough;
  4450. + case AT803X_MODE_CFG_FX100_RGMII_50OHM:
  4451. + case AT803X_MODE_CFG_FX100_RGMII_75OHM:
  4452. + priv->is_fiber = true;
  4453. + break;
  4454. + }
  4455. +
  4456. + /* Disable WoL in 1588 register which is enabled
  4457. + * by default
  4458. + */
  4459. + return phy_modify_mmd(phydev, MDIO_MMD_PCS,
  4460. + AT803X_PHY_MMD3_WOL_CTRL,
  4461. + AT803X_WOL_EN, 0);
  4462. +}
  4463. +
  4464. +static int at8031_config_init(struct phy_device *phydev)
  4465. +{
  4466. + struct at803x_priv *priv = phydev->priv;
  4467. + int ret;
  4468. +
  4469. + /* Some bootloaders leave the fiber page selected.
  4470. + * Switch to the appropriate page (fiber or copper), as otherwise we
  4471. + * read the PHY capabilities from the wrong page.
  4472. + */
  4473. + phy_lock_mdio_bus(phydev);
  4474. + ret = at803x_write_page(phydev,
  4475. + priv->is_fiber ? AT803X_PAGE_FIBER :
  4476. + AT803X_PAGE_COPPER);
  4477. + phy_unlock_mdio_bus(phydev);
  4478. + if (ret)
  4479. + return ret;
  4480. +
  4481. + ret = at8031_pll_config(phydev);
  4482. + if (ret < 0)
  4483. + return ret;
  4484. +
  4485. + return at803x_config_init(phydev);
  4486. +}
  4487. +
  4488. +static int at8031_set_wol(struct phy_device *phydev,
  4489. + struct ethtool_wolinfo *wol)
  4490. +{
  4491. + int ret;
  4492. +
  4493. + /* First setup MAC address and enable WOL interrupt */
  4494. + ret = at803x_set_wol(phydev, wol);
  4495. + if (ret)
  4496. + return ret;
  4497. +
  4498. + if (wol->wolopts & WAKE_MAGIC)
  4499. + /* Enable WOL function for 1588 */
  4500. + ret = phy_modify_mmd(phydev, MDIO_MMD_PCS,
  4501. + AT803X_PHY_MMD3_WOL_CTRL,
  4502. + 0, AT803X_WOL_EN);
  4503. + else
  4504. + /* Disable WoL function for 1588 */
  4505. + ret = phy_modify_mmd(phydev, MDIO_MMD_PCS,
  4506. + AT803X_PHY_MMD3_WOL_CTRL,
  4507. + AT803X_WOL_EN, 0);
  4508. +
  4509. + return ret;
  4510. +}
  4511. +
  4512. +static int at8031_config_intr(struct phy_device *phydev)
  4513. +{
  4514. + struct at803x_priv *priv = phydev->priv;
  4515. + int err, value = 0;
  4516. +
  4517. + if (phydev->interrupts == PHY_INTERRUPT_ENABLED &&
  4518. + priv->is_fiber) {
  4519. + /* Clear any pending interrupts */
  4520. + err = at803x_ack_interrupt(phydev);
  4521. + if (err)
  4522. + return err;
  4523. +
  4524. + value |= AT803X_INTR_ENABLE_LINK_FAIL_BX;
  4525. + value |= AT803X_INTR_ENABLE_LINK_SUCCESS_BX;
  4526. +
  4527. + err = phy_set_bits(phydev, AT803X_INTR_ENABLE, value);
  4528. + if (err)
  4529. + return err;
  4530. + }
  4531. +
  4532. + return at803x_config_intr(phydev);
  4533. +}
  4534. +
  4535. +/* AR8031 and AR8033 share the same read status logic */
  4536. +static int at8031_read_status(struct phy_device *phydev)
  4537. +{
  4538. + struct at803x_priv *priv = phydev->priv;
  4539. +
  4540. + if (priv->is_1000basex)
  4541. + return genphy_c37_read_status(phydev);
  4542. +
  4543. + return at803x_read_status(phydev);
  4544. +}
  4545. +
  4546. +/* AR8031 and AR8035 share the same cable test get status reg */
  4547. +static int at8031_cable_test_get_status(struct phy_device *phydev,
  4548. + bool *finished)
  4549. +{
  4550. + return at803x_cable_test_get_status(phydev, finished, 0xf);
  4551. +}
  4552. +
  4553. +/* AR8031 and AR8035 share the same cable test start logic */
  4554. +static int at8031_cable_test_start(struct phy_device *phydev)
  4555. +{
  4556. + at803x_cable_test_autoneg(phydev);
  4557. + phy_write(phydev, MII_CTRL1000, 0);
  4558. + /* we do all the (time consuming) work later */
  4559. + return 0;
  4560. +}
  4561. +
  4562. +/* AR8032, AR9331 and QCA9561 share the same cable test get status reg */
  4563. +static int at8032_cable_test_get_status(struct phy_device *phydev,
  4564. + bool *finished)
  4565. +{
  4566. + return at803x_cable_test_get_status(phydev, finished, 0x3);
  4567. +}
  4568. +
  4569. +static int at8035_parse_dt(struct phy_device *phydev)
  4570. +{
  4571. + struct at803x_priv *priv = phydev->priv;
  4572. +
  4573. + /* Mask is set by the generic at803x_parse_dt
  4574. + * if property is set. Assume property is set
  4575. + * with the mask not zero.
  4576. + */
  4577. + if (priv->clk_25m_mask) {
  4578. + /* Fixup for the AR8030/AR8035. This chip has another mask and
  4579. + * doesn't support the DSP reference. Eg. the lowest bit of the
  4580. + * mask. The upper two bits select the same frequencies. Mask
  4581. + * the lowest bit here.
  4582. + *
  4583. + * Warning:
  4584. + * There was no datasheet for the AR8030 available so this is
  4585. + * just a guess. But the AR8035 is listed as pin compatible
  4586. + * to the AR8030 so there might be a good chance it works on
  4587. + * the AR8030 too.
  4588. + */
  4589. + priv->clk_25m_reg &= AT8035_CLK_OUT_MASK;
  4590. + priv->clk_25m_mask &= AT8035_CLK_OUT_MASK;
  4591. + }
  4592. +
  4593. + return 0;
  4594. +}
  4595. +
  4596. +/* AR8030 and AR8035 shared the same special mask for clk_25m */
  4597. +static int at8035_probe(struct phy_device *phydev)
  4598. +{
  4599. + int ret;
  4600. +
  4601. + ret = at803x_probe(phydev);
  4602. + if (ret)
  4603. + return ret;
  4604. +
  4605. + return at8035_parse_dt(phydev);
  4606. +}
  4607. +
  4608. +static int qca83xx_config_init(struct phy_device *phydev)
  4609. +{
  4610. + u8 switch_revision;
  4611. +
  4612. + switch_revision = phydev->dev_flags & QCA8K_DEVFLAGS_REVISION_MASK;
  4613. +
  4614. + switch (switch_revision) {
  4615. + case 1:
  4616. + /* For 100M waveform */
  4617. + at803x_debug_reg_write(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL, 0x02ea);
  4618. + /* Turn on Gigabit clock */
  4619. + at803x_debug_reg_write(phydev, AT803X_DEBUG_REG_GREEN, 0x68a0);
  4620. + break;
  4621. +
  4622. + case 2:
  4623. + phy_write_mmd(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, 0x0);
  4624. + fallthrough;
  4625. + case 4:
  4626. + phy_write_mmd(phydev, MDIO_MMD_PCS, MDIO_AZ_DEBUG, 0x803f);
  4627. + at803x_debug_reg_write(phydev, AT803X_DEBUG_REG_GREEN, 0x6860);
  4628. + at803x_debug_reg_write(phydev, AT803X_DEBUG_SYSTEM_CTRL_MODE, 0x2c46);
  4629. + at803x_debug_reg_write(phydev, AT803X_DEBUG_REG_3C, 0x6000);
  4630. + break;
  4631. + }
  4632. +
  4633. + /* Following original QCA sourcecode set port to prefer master */
  4634. + phy_set_bits(phydev, MII_CTRL1000, CTL1000_PREFER_MASTER);
  4635. +
  4636. + return 0;
  4637. +}
  4638. +
  4639. +static int qca8327_config_init(struct phy_device *phydev)
  4640. +{
  4641. + /* QCA8327 require DAC amplitude adjustment for 100m set to +6%.
  4642. + * Disable on init and enable only with 100m speed following
  4643. + * qca original source code.
  4644. + */
  4645. + at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL,
  4646. + QCA8327_DEBUG_MANU_CTRL_EN, 0);
  4647. +
  4648. + return qca83xx_config_init(phydev);
  4649. +}
  4650. +
  4651. +static void qca83xx_link_change_notify(struct phy_device *phydev)
  4652. +{
  4653. + /* Set DAC Amplitude adjustment to +6% for 100m on link running */
  4654. + if (phydev->state == PHY_RUNNING) {
  4655. + if (phydev->speed == SPEED_100)
  4656. + at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL,
  4657. + QCA8327_DEBUG_MANU_CTRL_EN,
  4658. + QCA8327_DEBUG_MANU_CTRL_EN);
  4659. + } else {
  4660. + /* Reset DAC Amplitude adjustment */
  4661. + at803x_debug_reg_mask(phydev, AT803X_DEBUG_ANALOG_TEST_CTRL,
  4662. + QCA8327_DEBUG_MANU_CTRL_EN, 0);
  4663. + }
  4664. +}
  4665. +
  4666. +static int qca83xx_resume(struct phy_device *phydev)
  4667. +{
  4668. + int ret, val;
  4669. +
  4670. + /* Skip reset if not suspended */
  4671. + if (!phydev->suspended)
  4672. + return 0;
  4673. +
  4674. + /* Reinit the port, reset values set by suspend */
  4675. + qca83xx_config_init(phydev);
  4676. +
  4677. + /* Reset the port on port resume */
  4678. + phy_set_bits(phydev, MII_BMCR, BMCR_RESET | BMCR_ANENABLE);
  4679. +
  4680. + /* On resume from suspend the switch execute a reset and
  4681. + * restart auto-negotiation. Wait for reset to complete.
  4682. + */
  4683. + ret = phy_read_poll_timeout(phydev, MII_BMCR, val, !(val & BMCR_RESET),
  4684. + 50000, 600000, true);
  4685. + if (ret)
  4686. + return ret;
  4687. +
  4688. + usleep_range(1000, 2000);
  4689. +
  4690. + return 0;
  4691. +}
  4692. +
  4693. +static int qca83xx_suspend(struct phy_device *phydev)
  4694. +{
  4695. + at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_GREEN,
  4696. + AT803X_DEBUG_GATE_CLK_IN1000, 0);
  4697. +
  4698. + at803x_debug_reg_mask(phydev, AT803X_DEBUG_REG_HIB_CTRL,
  4699. + AT803X_DEBUG_HIB_CTRL_EN_ANY_CHANGE |
  4700. + AT803X_DEBUG_HIB_CTRL_SEL_RST_80U, 0);
  4701. +
  4702. + return 0;
  4703. +}
  4704. +
  4705. +static int qca8337_suspend(struct phy_device *phydev)
  4706. +{
  4707. + /* Only QCA8337 support actual suspend. */
  4708. + genphy_suspend(phydev);
  4709. +
  4710. + return qca83xx_suspend(phydev);
  4711. +}
  4712. +
  4713. +static int qca8327_suspend(struct phy_device *phydev)
  4714. +{
  4715. + u16 mask = 0;
  4716. +
  4717. + /* QCA8327 cause port unreliability when phy suspend
  4718. + * is set.
  4719. + */
  4720. + mask |= ~(BMCR_SPEED1000 | BMCR_FULLDPLX);
  4721. + phy_modify(phydev, MII_BMCR, mask, 0);
  4722. +
  4723. + return qca83xx_suspend(phydev);
  4724. +}
  4725. +
  4726. +static int qca808x_phy_fast_retrain_config(struct phy_device *phydev)
  4727. +{
  4728. + int ret;
  4729. +
  4730. + /* Enable fast retrain */
  4731. + ret = genphy_c45_fast_retrain(phydev, true);
  4732. + if (ret)
  4733. + return ret;
  4734. +
  4735. + phy_write_mmd(phydev, MDIO_MMD_AN, QCA808X_PHY_MMD7_TOP_OPTION1,
  4736. + QCA808X_TOP_OPTION1_DATA);
  4737. + phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_20DB,
  4738. + QCA808X_MSE_THRESHOLD_20DB_VALUE);
  4739. + phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_17DB,
  4740. + QCA808X_MSE_THRESHOLD_17DB_VALUE);
  4741. + phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_27DB,
  4742. + QCA808X_MSE_THRESHOLD_27DB_VALUE);
  4743. + phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_28DB,
  4744. + QCA808X_MSE_THRESHOLD_28DB_VALUE);
  4745. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_1,
  4746. + QCA808X_MMD3_DEBUG_1_VALUE);
  4747. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_4,
  4748. + QCA808X_MMD3_DEBUG_4_VALUE);
  4749. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_5,
  4750. + QCA808X_MMD3_DEBUG_5_VALUE);
  4751. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_3,
  4752. + QCA808X_MMD3_DEBUG_3_VALUE);
  4753. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_6,
  4754. + QCA808X_MMD3_DEBUG_6_VALUE);
  4755. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_2,
  4756. + QCA808X_MMD3_DEBUG_2_VALUE);
  4757. +
  4758. + return 0;
  4759. +}
  4760. +
  4761. +static int qca808x_phy_ms_seed_enable(struct phy_device *phydev, bool enable)
  4762. +{
  4763. + u16 seed_value;
  4764. +
  4765. + if (!enable)
  4766. + return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_LOCAL_SEED,
  4767. + QCA808X_MASTER_SLAVE_SEED_ENABLE, 0);
  4768. +
  4769. + seed_value = get_random_u32_below(QCA808X_MASTER_SLAVE_SEED_RANGE);
  4770. + return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_LOCAL_SEED,
  4771. + QCA808X_MASTER_SLAVE_SEED_CFG | QCA808X_MASTER_SLAVE_SEED_ENABLE,
  4772. + FIELD_PREP(QCA808X_MASTER_SLAVE_SEED_CFG, seed_value) |
  4773. + QCA808X_MASTER_SLAVE_SEED_ENABLE);
  4774. +}
  4775. +
  4776. +static bool qca808x_is_prefer_master(struct phy_device *phydev)
  4777. +{
  4778. + return (phydev->master_slave_get == MASTER_SLAVE_CFG_MASTER_FORCE) ||
  4779. + (phydev->master_slave_get == MASTER_SLAVE_CFG_MASTER_PREFERRED);
  4780. +}
  4781. +
  4782. +static bool qca808x_has_fast_retrain_or_slave_seed(struct phy_device *phydev)
  4783. +{
  4784. + return linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported);
  4785. +}
  4786. +
  4787. +static int qca808x_config_init(struct phy_device *phydev)
  4788. +{
  4789. + int ret;
  4790. +
  4791. + /* Active adc&vga on 802.3az for the link 1000M and 100M */
  4792. + ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_ADDR_CLD_CTRL7,
  4793. + QCA808X_8023AZ_AFE_CTRL_MASK, QCA808X_8023AZ_AFE_EN);
  4794. + if (ret)
  4795. + return ret;
  4796. +
  4797. + /* Adjust the threshold on 802.3az for the link 1000M */
  4798. + ret = phy_write_mmd(phydev, MDIO_MMD_PCS,
  4799. + QCA808X_PHY_MMD3_AZ_TRAINING_CTRL,
  4800. + QCA808X_MMD3_AZ_TRAINING_VAL);
  4801. + if (ret)
  4802. + return ret;
  4803. +
  4804. + if (qca808x_has_fast_retrain_or_slave_seed(phydev)) {
  4805. + /* Config the fast retrain for the link 2500M */
  4806. + ret = qca808x_phy_fast_retrain_config(phydev);
  4807. + if (ret)
  4808. + return ret;
  4809. +
  4810. + ret = genphy_read_master_slave(phydev);
  4811. + if (ret < 0)
  4812. + return ret;
  4813. +
  4814. + if (!qca808x_is_prefer_master(phydev)) {
  4815. + /* Enable seed and configure lower ramdom seed to make phy
  4816. + * linked as slave mode.
  4817. + */
  4818. + ret = qca808x_phy_ms_seed_enable(phydev, true);
  4819. + if (ret)
  4820. + return ret;
  4821. + }
  4822. + }
  4823. +
  4824. + /* Configure adc threshold as 100mv for the link 10M */
  4825. + return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_ADC_THRESHOLD,
  4826. + QCA808X_ADC_THRESHOLD_MASK,
  4827. + QCA808X_ADC_THRESHOLD_100MV);
  4828. +}
  4829. +
  4830. +static int qca808x_read_status(struct phy_device *phydev)
  4831. +{
  4832. + struct at803x_ss_mask ss_mask = { 0 };
  4833. + int ret;
  4834. +
  4835. + ret = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_STAT);
  4836. + if (ret < 0)
  4837. + return ret;
  4838. +
  4839. + linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->lp_advertising,
  4840. + ret & MDIO_AN_10GBT_STAT_LP2_5G);
  4841. +
  4842. + ret = genphy_read_status(phydev);
  4843. + if (ret)
  4844. + return ret;
  4845. +
  4846. + /* qca8081 takes the different bits for speed value from at803x */
  4847. + ss_mask.speed_mask = QCA808X_SS_SPEED_MASK;
  4848. + ss_mask.speed_shift = __bf_shf(QCA808X_SS_SPEED_MASK);
  4849. + ret = at803x_read_specific_status(phydev, ss_mask);
  4850. + if (ret < 0)
  4851. + return ret;
  4852. +
  4853. + if (phydev->link) {
  4854. + if (phydev->speed == SPEED_2500)
  4855. + phydev->interface = PHY_INTERFACE_MODE_2500BASEX;
  4856. + else
  4857. + phydev->interface = PHY_INTERFACE_MODE_SGMII;
  4858. + } else {
  4859. + /* generate seed as a lower random value to make PHY linked as SLAVE easily,
  4860. + * except for master/slave configuration fault detected or the master mode
  4861. + * preferred.
  4862. + *
  4863. + * the reason for not putting this code into the function link_change_notify is
  4864. + * the corner case where the link partner is also the qca8081 PHY and the seed
  4865. + * value is configured as the same value, the link can't be up and no link change
  4866. + * occurs.
  4867. + */
  4868. + if (qca808x_has_fast_retrain_or_slave_seed(phydev)) {
  4869. + if (phydev->master_slave_state == MASTER_SLAVE_STATE_ERR ||
  4870. + qca808x_is_prefer_master(phydev)) {
  4871. + qca808x_phy_ms_seed_enable(phydev, false);
  4872. + } else {
  4873. + qca808x_phy_ms_seed_enable(phydev, true);
  4874. + }
  4875. + }
  4876. + }
  4877. +
  4878. + return 0;
  4879. +}
  4880. +
  4881. +static int qca808x_soft_reset(struct phy_device *phydev)
  4882. +{
  4883. + int ret;
  4884. +
  4885. + ret = genphy_soft_reset(phydev);
  4886. + if (ret < 0)
  4887. + return ret;
  4888. +
  4889. + if (qca808x_has_fast_retrain_or_slave_seed(phydev))
  4890. + ret = qca808x_phy_ms_seed_enable(phydev, true);
  4891. +
  4892. + return ret;
  4893. +}
  4894. +
  4895. +static bool qca808x_cdt_fault_length_valid(int cdt_code)
  4896. +{
  4897. + switch (cdt_code) {
  4898. + case QCA808X_CDT_STATUS_STAT_SAME_SHORT:
  4899. + case QCA808X_CDT_STATUS_STAT_SAME_OPEN:
  4900. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL:
  4901. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN:
  4902. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT:
  4903. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL:
  4904. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN:
  4905. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT:
  4906. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL:
  4907. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN:
  4908. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT:
  4909. + return true;
  4910. + default:
  4911. + return false;
  4912. + }
  4913. +}
  4914. +
  4915. +static int qca808x_cable_test_result_trans(int cdt_code)
  4916. +{
  4917. + switch (cdt_code) {
  4918. + case QCA808X_CDT_STATUS_STAT_NORMAL:
  4919. + return ETHTOOL_A_CABLE_RESULT_CODE_OK;
  4920. + case QCA808X_CDT_STATUS_STAT_SAME_SHORT:
  4921. + return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT;
  4922. + case QCA808X_CDT_STATUS_STAT_SAME_OPEN:
  4923. + return ETHTOOL_A_CABLE_RESULT_CODE_OPEN;
  4924. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL:
  4925. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN:
  4926. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT:
  4927. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL:
  4928. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN:
  4929. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT:
  4930. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL:
  4931. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN:
  4932. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT:
  4933. + return ETHTOOL_A_CABLE_RESULT_CODE_CROSS_SHORT;
  4934. + case QCA808X_CDT_STATUS_STAT_FAIL:
  4935. + default:
  4936. + return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
  4937. + }
  4938. +}
  4939. +
  4940. +static int qca808x_cdt_fault_length(struct phy_device *phydev, int pair,
  4941. + int result)
  4942. +{
  4943. + int val;
  4944. + u32 cdt_length_reg = 0;
  4945. +
  4946. + switch (pair) {
  4947. + case ETHTOOL_A_CABLE_PAIR_A:
  4948. + cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_A;
  4949. + break;
  4950. + case ETHTOOL_A_CABLE_PAIR_B:
  4951. + cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_B;
  4952. + break;
  4953. + case ETHTOOL_A_CABLE_PAIR_C:
  4954. + cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_C;
  4955. + break;
  4956. + case ETHTOOL_A_CABLE_PAIR_D:
  4957. + cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_D;
  4958. + break;
  4959. + default:
  4960. + return -EINVAL;
  4961. + }
  4962. +
  4963. + val = phy_read_mmd(phydev, MDIO_MMD_PCS, cdt_length_reg);
  4964. + if (val < 0)
  4965. + return val;
  4966. +
  4967. + if (result == ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT)
  4968. + val = FIELD_GET(QCA808X_CDT_DIAG_LENGTH_SAME_SHORT, val);
  4969. + else
  4970. + val = FIELD_GET(QCA808X_CDT_DIAG_LENGTH_CROSS_SHORT, val);
  4971. +
  4972. + return at803x_cdt_fault_length(val);
  4973. +}
  4974. +
  4975. +static int qca808x_cable_test_start(struct phy_device *phydev)
  4976. +{
  4977. + int ret;
  4978. +
  4979. + /* perform CDT with the following configs:
  4980. + * 1. disable hibernation.
  4981. + * 2. force PHY working in MDI mode.
  4982. + * 3. for PHY working in 1000BaseT.
  4983. + * 4. configure the threshold.
  4984. + */
  4985. +
  4986. + ret = at803x_debug_reg_mask(phydev, QCA808X_DBG_AN_TEST, QCA808X_HIBERNATION_EN, 0);
  4987. + if (ret < 0)
  4988. + return ret;
  4989. +
  4990. + ret = at803x_config_mdix(phydev, ETH_TP_MDI);
  4991. + if (ret < 0)
  4992. + return ret;
  4993. +
  4994. + /* Force 1000base-T needs to configure PMA/PMD and MII_BMCR */
  4995. + phydev->duplex = DUPLEX_FULL;
  4996. + phydev->speed = SPEED_1000;
  4997. + ret = genphy_c45_pma_setup_forced(phydev);
  4998. + if (ret < 0)
  4999. + return ret;
  5000. +
  5001. + ret = genphy_setup_forced(phydev);
  5002. + if (ret < 0)
  5003. + return ret;
  5004. +
  5005. + /* configure the thresholds for open, short, pair ok test */
  5006. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8074, 0xc040);
  5007. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8076, 0xc040);
  5008. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8077, 0xa060);
  5009. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8078, 0xc050);
  5010. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x807a, 0xc060);
  5011. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x807e, 0xb060);
  5012. +
  5013. + return 0;
  5014. +}
  5015. +
  5016. +static int qca808x_cable_test_get_pair_status(struct phy_device *phydev, u8 pair,
  5017. + u16 status)
  5018. +{
  5019. + int length, result;
  5020. + u16 pair_code;
  5021. +
  5022. + switch (pair) {
  5023. + case ETHTOOL_A_CABLE_PAIR_A:
  5024. + pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_A, status);
  5025. + break;
  5026. + case ETHTOOL_A_CABLE_PAIR_B:
  5027. + pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_B, status);
  5028. + break;
  5029. + case ETHTOOL_A_CABLE_PAIR_C:
  5030. + pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_C, status);
  5031. + break;
  5032. + case ETHTOOL_A_CABLE_PAIR_D:
  5033. + pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_D, status);
  5034. + break;
  5035. + default:
  5036. + return -EINVAL;
  5037. + }
  5038. +
  5039. + result = qca808x_cable_test_result_trans(pair_code);
  5040. + ethnl_cable_test_result(phydev, pair, result);
  5041. +
  5042. + if (qca808x_cdt_fault_length_valid(pair_code)) {
  5043. + length = qca808x_cdt_fault_length(phydev, pair, result);
  5044. + ethnl_cable_test_fault_length(phydev, pair, length);
  5045. + }
  5046. +
  5047. + return 0;
  5048. +}
  5049. +
  5050. +static int qca808x_cable_test_get_status(struct phy_device *phydev, bool *finished)
  5051. +{
  5052. + int ret, val;
  5053. +
  5054. + *finished = false;
  5055. +
  5056. + val = QCA808X_CDT_ENABLE_TEST |
  5057. + QCA808X_CDT_LENGTH_UNIT;
  5058. + ret = at803x_cdt_start(phydev, val);
  5059. + if (ret)
  5060. + return ret;
  5061. +
  5062. + ret = at803x_cdt_wait_for_completion(phydev, QCA808X_CDT_ENABLE_TEST);
  5063. + if (ret)
  5064. + return ret;
  5065. +
  5066. + val = phy_read_mmd(phydev, MDIO_MMD_PCS, QCA808X_MMD3_CDT_STATUS);
  5067. + if (val < 0)
  5068. + return val;
  5069. +
  5070. + ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_A, val);
  5071. + if (ret)
  5072. + return ret;
  5073. +
  5074. + ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_B, val);
  5075. + if (ret)
  5076. + return ret;
  5077. +
  5078. + ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_C, val);
  5079. + if (ret)
  5080. + return ret;
  5081. +
  5082. + ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_D, val);
  5083. + if (ret)
  5084. + return ret;
  5085. +
  5086. + *finished = true;
  5087. +
  5088. + return 0;
  5089. +}
  5090. +
  5091. +static int qca808x_get_features(struct phy_device *phydev)
  5092. +{
  5093. + int ret;
  5094. +
  5095. + ret = genphy_c45_pma_read_abilities(phydev);
  5096. + if (ret)
  5097. + return ret;
  5098. +
  5099. + /* The autoneg ability is not existed in bit3 of MMD7.1,
  5100. + * but it is supported by qca808x PHY, so we add it here
  5101. + * manually.
  5102. + */
  5103. + linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->supported);
  5104. +
  5105. + /* As for the qca8081 1G version chip, the 2500baseT ability is also
  5106. + * existed in the bit0 of MMD1.21, we need to remove it manually if
  5107. + * it is the qca8081 1G chip according to the bit0 of MMD7.0x901d.
  5108. + */
  5109. + ret = phy_read_mmd(phydev, MDIO_MMD_AN, QCA808X_PHY_MMD7_CHIP_TYPE);
  5110. + if (ret < 0)
  5111. + return ret;
  5112. +
  5113. + if (QCA808X_PHY_CHIP_TYPE_1G & ret)
  5114. + linkmode_clear_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported);
  5115. +
  5116. + return 0;
  5117. +}
  5118. +
  5119. +static int qca808x_config_aneg(struct phy_device *phydev)
  5120. +{
  5121. + int phy_ctrl = 0;
  5122. + int ret;
  5123. +
  5124. + ret = at803x_prepare_config_aneg(phydev);
  5125. + if (ret)
  5126. + return ret;
  5127. +
  5128. + /* The reg MII_BMCR also needs to be configured for force mode, the
  5129. + * genphy_config_aneg is also needed.
  5130. + */
  5131. + if (phydev->autoneg == AUTONEG_DISABLE)
  5132. + genphy_c45_pma_setup_forced(phydev);
  5133. +
  5134. + if (linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->advertising))
  5135. + phy_ctrl = MDIO_AN_10GBT_CTRL_ADV2_5G;
  5136. +
  5137. + ret = phy_modify_mmd_changed(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_CTRL,
  5138. + MDIO_AN_10GBT_CTRL_ADV2_5G, phy_ctrl);
  5139. + if (ret < 0)
  5140. + return ret;
  5141. +
  5142. + return __genphy_config_aneg(phydev, ret);
  5143. +}
  5144. +
  5145. +static void qca808x_link_change_notify(struct phy_device *phydev)
  5146. +{
  5147. + /* Assert interface sgmii fifo on link down, deassert it on link up,
  5148. + * the interface device address is always phy address added by 1.
  5149. + */
  5150. + mdiobus_c45_modify_changed(phydev->mdio.bus, phydev->mdio.addr + 1,
  5151. + MDIO_MMD_PMAPMD, QCA8081_PHY_SERDES_MMD1_FIFO_CTRL,
  5152. + QCA8081_PHY_FIFO_RSTN,
  5153. + phydev->link ? QCA8081_PHY_FIFO_RSTN : 0);
  5154. +}
  5155. +
  5156. +static int qca808x_led_parse_netdev(struct phy_device *phydev, unsigned long rules,
  5157. + u16 *offload_trigger)
  5158. +{
  5159. + /* Parsing specific to netdev trigger */
  5160. + if (test_bit(TRIGGER_NETDEV_TX, &rules))
  5161. + *offload_trigger |= QCA808X_LED_TX_BLINK;
  5162. + if (test_bit(TRIGGER_NETDEV_RX, &rules))
  5163. + *offload_trigger |= QCA808X_LED_RX_BLINK;
  5164. + if (test_bit(TRIGGER_NETDEV_LINK_10, &rules))
  5165. + *offload_trigger |= QCA808X_LED_SPEED10_ON;
  5166. + if (test_bit(TRIGGER_NETDEV_LINK_100, &rules))
  5167. + *offload_trigger |= QCA808X_LED_SPEED100_ON;
  5168. + if (test_bit(TRIGGER_NETDEV_LINK_1000, &rules))
  5169. + *offload_trigger |= QCA808X_LED_SPEED1000_ON;
  5170. + if (test_bit(TRIGGER_NETDEV_LINK_2500, &rules))
  5171. + *offload_trigger |= QCA808X_LED_SPEED2500_ON;
  5172. + if (test_bit(TRIGGER_NETDEV_HALF_DUPLEX, &rules))
  5173. + *offload_trigger |= QCA808X_LED_HALF_DUPLEX_ON;
  5174. + if (test_bit(TRIGGER_NETDEV_FULL_DUPLEX, &rules))
  5175. + *offload_trigger |= QCA808X_LED_FULL_DUPLEX_ON;
  5176. +
  5177. + if (rules && !*offload_trigger)
  5178. + return -EOPNOTSUPP;
  5179. +
  5180. + /* Enable BLINK_CHECK_BYPASS by default to make the LED
  5181. + * blink even with duplex or speed mode not enabled.
  5182. + */
  5183. + *offload_trigger |= QCA808X_LED_BLINK_CHECK_BYPASS;
  5184. +
  5185. + return 0;
  5186. +}
  5187. +
  5188. +static int qca808x_led_hw_control_enable(struct phy_device *phydev, u8 index)
  5189. +{
  5190. + u16 reg;
  5191. +
  5192. + if (index > 2)
  5193. + return -EINVAL;
  5194. +
  5195. + reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  5196. +
  5197. + return phy_clear_bits_mmd(phydev, MDIO_MMD_AN, reg,
  5198. + QCA808X_LED_FORCE_EN);
  5199. +}
  5200. +
  5201. +static int qca808x_led_hw_is_supported(struct phy_device *phydev, u8 index,
  5202. + unsigned long rules)
  5203. +{
  5204. + u16 offload_trigger = 0;
  5205. +
  5206. + if (index > 2)
  5207. + return -EINVAL;
  5208. +
  5209. + return qca808x_led_parse_netdev(phydev, rules, &offload_trigger);
  5210. +}
  5211. +
  5212. +static int qca808x_led_hw_control_set(struct phy_device *phydev, u8 index,
  5213. + unsigned long rules)
  5214. +{
  5215. + u16 reg, offload_trigger = 0;
  5216. + int ret;
  5217. +
  5218. + if (index > 2)
  5219. + return -EINVAL;
  5220. +
  5221. + reg = QCA808X_MMD7_LED_CTRL(index);
  5222. +
  5223. + ret = qca808x_led_parse_netdev(phydev, rules, &offload_trigger);
  5224. + if (ret)
  5225. + return ret;
  5226. +
  5227. + ret = qca808x_led_hw_control_enable(phydev, index);
  5228. + if (ret)
  5229. + return ret;
  5230. +
  5231. + return phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  5232. + QCA808X_LED_PATTERN_MASK,
  5233. + offload_trigger);
  5234. +}
  5235. +
  5236. +static bool qca808x_led_hw_control_status(struct phy_device *phydev, u8 index)
  5237. +{
  5238. + u16 reg;
  5239. + int val;
  5240. +
  5241. + if (index > 2)
  5242. + return false;
  5243. +
  5244. + reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  5245. +
  5246. + val = phy_read_mmd(phydev, MDIO_MMD_AN, reg);
  5247. +
  5248. + return !(val & QCA808X_LED_FORCE_EN);
  5249. +}
  5250. +
  5251. +static int qca808x_led_hw_control_get(struct phy_device *phydev, u8 index,
  5252. + unsigned long *rules)
  5253. +{
  5254. + u16 reg;
  5255. + int val;
  5256. +
  5257. + if (index > 2)
  5258. + return -EINVAL;
  5259. +
  5260. + /* Check if we have hw control enabled */
  5261. + if (qca808x_led_hw_control_status(phydev, index))
  5262. + return -EINVAL;
  5263. +
  5264. + reg = QCA808X_MMD7_LED_CTRL(index);
  5265. +
  5266. + val = phy_read_mmd(phydev, MDIO_MMD_AN, reg);
  5267. + if (val & QCA808X_LED_TX_BLINK)
  5268. + set_bit(TRIGGER_NETDEV_TX, rules);
  5269. + if (val & QCA808X_LED_RX_BLINK)
  5270. + set_bit(TRIGGER_NETDEV_RX, rules);
  5271. + if (val & QCA808X_LED_SPEED10_ON)
  5272. + set_bit(TRIGGER_NETDEV_LINK_10, rules);
  5273. + if (val & QCA808X_LED_SPEED100_ON)
  5274. + set_bit(TRIGGER_NETDEV_LINK_100, rules);
  5275. + if (val & QCA808X_LED_SPEED1000_ON)
  5276. + set_bit(TRIGGER_NETDEV_LINK_1000, rules);
  5277. + if (val & QCA808X_LED_SPEED2500_ON)
  5278. + set_bit(TRIGGER_NETDEV_LINK_2500, rules);
  5279. + if (val & QCA808X_LED_HALF_DUPLEX_ON)
  5280. + set_bit(TRIGGER_NETDEV_HALF_DUPLEX, rules);
  5281. + if (val & QCA808X_LED_FULL_DUPLEX_ON)
  5282. + set_bit(TRIGGER_NETDEV_FULL_DUPLEX, rules);
  5283. +
  5284. + return 0;
  5285. +}
  5286. +
  5287. +static int qca808x_led_hw_control_reset(struct phy_device *phydev, u8 index)
  5288. +{
  5289. + u16 reg;
  5290. +
  5291. + if (index > 2)
  5292. + return -EINVAL;
  5293. +
  5294. + reg = QCA808X_MMD7_LED_CTRL(index);
  5295. +
  5296. + return phy_clear_bits_mmd(phydev, MDIO_MMD_AN, reg,
  5297. + QCA808X_LED_PATTERN_MASK);
  5298. +}
  5299. +
  5300. +static int qca808x_led_brightness_set(struct phy_device *phydev,
  5301. + u8 index, enum led_brightness value)
  5302. +{
  5303. + u16 reg;
  5304. + int ret;
  5305. +
  5306. + if (index > 2)
  5307. + return -EINVAL;
  5308. +
  5309. + if (!value) {
  5310. + ret = qca808x_led_hw_control_reset(phydev, index);
  5311. + if (ret)
  5312. + return ret;
  5313. + }
  5314. +
  5315. + reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  5316. +
  5317. + return phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  5318. + QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_MODE_MASK,
  5319. + QCA808X_LED_FORCE_EN | value ? QCA808X_LED_FORCE_ON :
  5320. + QCA808X_LED_FORCE_OFF);
  5321. +}
  5322. +
  5323. +static int qca808x_led_blink_set(struct phy_device *phydev, u8 index,
  5324. + unsigned long *delay_on,
  5325. + unsigned long *delay_off)
  5326. +{
  5327. + int ret;
  5328. + u16 reg;
  5329. +
  5330. + if (index > 2)
  5331. + return -EINVAL;
  5332. +
  5333. + reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  5334. +
  5335. + /* Set blink to 50% off, 50% on at 4Hz by default */
  5336. + ret = phy_modify_mmd(phydev, MDIO_MMD_AN, QCA808X_MMD7_LED_GLOBAL,
  5337. + QCA808X_LED_BLINK_FREQ_MASK | QCA808X_LED_BLINK_DUTY_MASK,
  5338. + QCA808X_LED_BLINK_FREQ_4HZ | QCA808X_LED_BLINK_DUTY_50_50);
  5339. + if (ret)
  5340. + return ret;
  5341. +
  5342. + /* We use BLINK_1 for normal blinking */
  5343. + ret = phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  5344. + QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_MODE_MASK,
  5345. + QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_BLINK_1);
  5346. + if (ret)
  5347. + return ret;
  5348. +
  5349. + /* We set blink to 4Hz, aka 250ms */
  5350. + *delay_on = 250 / 2;
  5351. + *delay_off = 250 / 2;
  5352. +
  5353. + return 0;
  5354. +}
  5355. +
  5356. +static int qca808x_led_polarity_set(struct phy_device *phydev, int index,
  5357. + unsigned long modes)
  5358. +{
  5359. + struct at803x_priv *priv = phydev->priv;
  5360. + bool active_low = false;
  5361. + u32 mode;
  5362. +
  5363. + for_each_set_bit(mode, &modes, __PHY_LED_MODES_NUM) {
  5364. + switch (mode) {
  5365. + case PHY_LED_ACTIVE_LOW:
  5366. + active_low = true;
  5367. + break;
  5368. + default:
  5369. + return -EINVAL;
  5370. + }
  5371. + }
  5372. +
  5373. + /* PHY polarity is global and can't be set per LED.
  5374. + * To detect this, check if last requested polarity mode
  5375. + * match the new one.
  5376. + */
  5377. + if (priv->led_polarity_mode >= 0 &&
  5378. + priv->led_polarity_mode != active_low) {
  5379. + phydev_err(phydev, "PHY polarity is global. Mismatched polarity on different LED\n");
  5380. + return -EINVAL;
  5381. + }
  5382. +
  5383. + /* Save the last PHY polarity mode */
  5384. + priv->led_polarity_mode = active_low;
  5385. +
  5386. + return phy_modify_mmd(phydev, MDIO_MMD_AN,
  5387. + QCA808X_MMD7_LED_POLARITY_CTRL,
  5388. + QCA808X_LED_ACTIVE_HIGH,
  5389. + active_low ? 0 : QCA808X_LED_ACTIVE_HIGH);
  5390. +}
  5391. +
  5392. +static struct phy_driver at803x_driver[] = {
  5393. +{
  5394. + /* Qualcomm Atheros AR8035 */
  5395. + PHY_ID_MATCH_EXACT(ATH8035_PHY_ID),
  5396. + .name = "Qualcomm Atheros AR8035",
  5397. + .flags = PHY_POLL_CABLE_TEST,
  5398. + .probe = at8035_probe,
  5399. + .config_aneg = at803x_config_aneg,
  5400. + .config_init = at803x_config_init,
  5401. + .soft_reset = genphy_soft_reset,
  5402. + .set_wol = at803x_set_wol,
  5403. + .get_wol = at803x_get_wol,
  5404. + .suspend = at803x_suspend,
  5405. + .resume = at803x_resume,
  5406. + /* PHY_GBIT_FEATURES */
  5407. + .read_status = at803x_read_status,
  5408. + .config_intr = at803x_config_intr,
  5409. + .handle_interrupt = at803x_handle_interrupt,
  5410. + .get_tunable = at803x_get_tunable,
  5411. + .set_tunable = at803x_set_tunable,
  5412. + .cable_test_start = at8031_cable_test_start,
  5413. + .cable_test_get_status = at8031_cable_test_get_status,
  5414. +}, {
  5415. + /* Qualcomm Atheros AR8030 */
  5416. + .phy_id = ATH8030_PHY_ID,
  5417. + .name = "Qualcomm Atheros AR8030",
  5418. + .phy_id_mask = AT8030_PHY_ID_MASK,
  5419. + .probe = at8035_probe,
  5420. + .config_init = at803x_config_init,
  5421. + .link_change_notify = at803x_link_change_notify,
  5422. + .set_wol = at803x_set_wol,
  5423. + .get_wol = at803x_get_wol,
  5424. + .suspend = at803x_suspend,
  5425. + .resume = at803x_resume,
  5426. + /* PHY_BASIC_FEATURES */
  5427. + .config_intr = at803x_config_intr,
  5428. + .handle_interrupt = at803x_handle_interrupt,
  5429. +}, {
  5430. + /* Qualcomm Atheros AR8031/AR8033 */
  5431. + PHY_ID_MATCH_EXACT(ATH8031_PHY_ID),
  5432. + .name = "Qualcomm Atheros AR8031/AR8033",
  5433. + .flags = PHY_POLL_CABLE_TEST,
  5434. + .probe = at8031_probe,
  5435. + .config_init = at8031_config_init,
  5436. + .config_aneg = at803x_config_aneg,
  5437. + .soft_reset = genphy_soft_reset,
  5438. + .set_wol = at8031_set_wol,
  5439. + .get_wol = at803x_get_wol,
  5440. + .suspend = at803x_suspend,
  5441. + .resume = at803x_resume,
  5442. + .read_page = at803x_read_page,
  5443. + .write_page = at803x_write_page,
  5444. + .get_features = at803x_get_features,
  5445. + .read_status = at8031_read_status,
  5446. + .config_intr = at8031_config_intr,
  5447. + .handle_interrupt = at803x_handle_interrupt,
  5448. + .get_tunable = at803x_get_tunable,
  5449. + .set_tunable = at803x_set_tunable,
  5450. + .cable_test_start = at8031_cable_test_start,
  5451. + .cable_test_get_status = at8031_cable_test_get_status,
  5452. +}, {
  5453. + /* Qualcomm Atheros AR8032 */
  5454. + PHY_ID_MATCH_EXACT(ATH8032_PHY_ID),
  5455. + .name = "Qualcomm Atheros AR8032",
  5456. + .probe = at803x_probe,
  5457. + .flags = PHY_POLL_CABLE_TEST,
  5458. + .config_init = at803x_config_init,
  5459. + .link_change_notify = at803x_link_change_notify,
  5460. + .suspend = at803x_suspend,
  5461. + .resume = at803x_resume,
  5462. + /* PHY_BASIC_FEATURES */
  5463. + .config_intr = at803x_config_intr,
  5464. + .handle_interrupt = at803x_handle_interrupt,
  5465. + .cable_test_start = at803x_cable_test_start,
  5466. + .cable_test_get_status = at8032_cable_test_get_status,
  5467. +}, {
  5468. + /* ATHEROS AR9331 */
  5469. + PHY_ID_MATCH_EXACT(ATH9331_PHY_ID),
  5470. + .name = "Qualcomm Atheros AR9331 built-in PHY",
  5471. + .probe = at803x_probe,
  5472. + .suspend = at803x_suspend,
  5473. + .resume = at803x_resume,
  5474. + .flags = PHY_POLL_CABLE_TEST,
  5475. + /* PHY_BASIC_FEATURES */
  5476. + .config_intr = at803x_config_intr,
  5477. + .handle_interrupt = at803x_handle_interrupt,
  5478. + .cable_test_start = at803x_cable_test_start,
  5479. + .cable_test_get_status = at8032_cable_test_get_status,
  5480. + .read_status = at803x_read_status,
  5481. + .soft_reset = genphy_soft_reset,
  5482. + .config_aneg = at803x_config_aneg,
  5483. +}, {
  5484. + /* Qualcomm Atheros QCA9561 */
  5485. + PHY_ID_MATCH_EXACT(QCA9561_PHY_ID),
  5486. + .name = "Qualcomm Atheros QCA9561 built-in PHY",
  5487. + .probe = at803x_probe,
  5488. + .suspend = at803x_suspend,
  5489. + .resume = at803x_resume,
  5490. + .flags = PHY_POLL_CABLE_TEST,
  5491. + /* PHY_BASIC_FEATURES */
  5492. + .config_intr = at803x_config_intr,
  5493. + .handle_interrupt = at803x_handle_interrupt,
  5494. + .cable_test_start = at803x_cable_test_start,
  5495. + .cable_test_get_status = at8032_cable_test_get_status,
  5496. + .read_status = at803x_read_status,
  5497. + .soft_reset = genphy_soft_reset,
  5498. + .config_aneg = at803x_config_aneg,
  5499. +}, {
  5500. + /* QCA8337 */
  5501. + .phy_id = QCA8337_PHY_ID,
  5502. + .phy_id_mask = QCA8K_PHY_ID_MASK,
  5503. + .name = "Qualcomm Atheros 8337 internal PHY",
  5504. + /* PHY_GBIT_FEATURES */
  5505. + .probe = at803x_probe,
  5506. + .flags = PHY_IS_INTERNAL,
  5507. + .config_init = qca83xx_config_init,
  5508. + .soft_reset = genphy_soft_reset,
  5509. + .get_sset_count = qca83xx_get_sset_count,
  5510. + .get_strings = qca83xx_get_strings,
  5511. + .get_stats = qca83xx_get_stats,
  5512. + .suspend = qca8337_suspend,
  5513. + .resume = qca83xx_resume,
  5514. +}, {
  5515. + /* QCA8327-A from switch QCA8327-AL1A */
  5516. + .phy_id = QCA8327_A_PHY_ID,
  5517. + .phy_id_mask = QCA8K_PHY_ID_MASK,
  5518. + .name = "Qualcomm Atheros 8327-A internal PHY",
  5519. + /* PHY_GBIT_FEATURES */
  5520. + .link_change_notify = qca83xx_link_change_notify,
  5521. + .probe = at803x_probe,
  5522. + .flags = PHY_IS_INTERNAL,
  5523. + .config_init = qca8327_config_init,
  5524. + .soft_reset = genphy_soft_reset,
  5525. + .get_sset_count = qca83xx_get_sset_count,
  5526. + .get_strings = qca83xx_get_strings,
  5527. + .get_stats = qca83xx_get_stats,
  5528. + .suspend = qca8327_suspend,
  5529. + .resume = qca83xx_resume,
  5530. +}, {
  5531. + /* QCA8327-B from switch QCA8327-BL1A */
  5532. + .phy_id = QCA8327_B_PHY_ID,
  5533. + .phy_id_mask = QCA8K_PHY_ID_MASK,
  5534. + .name = "Qualcomm Atheros 8327-B internal PHY",
  5535. + /* PHY_GBIT_FEATURES */
  5536. + .link_change_notify = qca83xx_link_change_notify,
  5537. + .probe = at803x_probe,
  5538. + .flags = PHY_IS_INTERNAL,
  5539. + .config_init = qca8327_config_init,
  5540. + .soft_reset = genphy_soft_reset,
  5541. + .get_sset_count = qca83xx_get_sset_count,
  5542. + .get_strings = qca83xx_get_strings,
  5543. + .get_stats = qca83xx_get_stats,
  5544. + .suspend = qca8327_suspend,
  5545. + .resume = qca83xx_resume,
  5546. +}, {
  5547. + /* Qualcomm QCA8081 */
  5548. + PHY_ID_MATCH_EXACT(QCA8081_PHY_ID),
  5549. + .name = "Qualcomm QCA8081",
  5550. + .flags = PHY_POLL_CABLE_TEST,
  5551. + .probe = at803x_probe,
  5552. + .config_intr = at803x_config_intr,
  5553. + .handle_interrupt = at803x_handle_interrupt,
  5554. + .get_tunable = at803x_get_tunable,
  5555. + .set_tunable = at803x_set_tunable,
  5556. + .set_wol = at803x_set_wol,
  5557. + .get_wol = at803x_get_wol,
  5558. + .get_features = qca808x_get_features,
  5559. + .config_aneg = qca808x_config_aneg,
  5560. + .suspend = genphy_suspend,
  5561. + .resume = genphy_resume,
  5562. + .read_status = qca808x_read_status,
  5563. + .config_init = qca808x_config_init,
  5564. + .soft_reset = qca808x_soft_reset,
  5565. + .cable_test_start = qca808x_cable_test_start,
  5566. + .cable_test_get_status = qca808x_cable_test_get_status,
  5567. + .link_change_notify = qca808x_link_change_notify,
  5568. + .led_brightness_set = qca808x_led_brightness_set,
  5569. + .led_blink_set = qca808x_led_blink_set,
  5570. + .led_hw_is_supported = qca808x_led_hw_is_supported,
  5571. + .led_hw_control_set = qca808x_led_hw_control_set,
  5572. + .led_hw_control_get = qca808x_led_hw_control_get,
  5573. + .led_polarity_set = qca808x_led_polarity_set,
  5574. +}, };
  5575. +
  5576. +module_phy_driver(at803x_driver);
  5577. +
  5578. +static struct mdio_device_id __maybe_unused atheros_tbl[] = {
  5579. + { ATH8030_PHY_ID, AT8030_PHY_ID_MASK },
  5580. + { PHY_ID_MATCH_EXACT(ATH8031_PHY_ID) },
  5581. + { PHY_ID_MATCH_EXACT(ATH8032_PHY_ID) },
  5582. + { PHY_ID_MATCH_EXACT(ATH8035_PHY_ID) },
  5583. + { PHY_ID_MATCH_EXACT(ATH9331_PHY_ID) },
  5584. + { PHY_ID_MATCH_EXACT(QCA8337_PHY_ID) },
  5585. + { PHY_ID_MATCH_EXACT(QCA8327_A_PHY_ID) },
  5586. + { PHY_ID_MATCH_EXACT(QCA8327_B_PHY_ID) },
  5587. + { PHY_ID_MATCH_EXACT(QCA9561_PHY_ID) },
  5588. + { PHY_ID_MATCH_EXACT(QCA8081_PHY_ID) },
  5589. + { }
  5590. +};
  5591. +
  5592. +MODULE_DEVICE_TABLE(mdio, atheros_tbl);