chip.c 121 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220422142224223422442254226422742284229423042314232423342344235423642374238423942404241424242434244424542464247424842494250425142524253425442554256425742584259426042614262426342644265426642674268426942704271427242734274427542764277427842794280428142824283428442854286428742884289429042914292429342944295429642974298429943004301430243034304430543064307430843094310431143124313431443154316431743184319432043214322432343244325432643274328432943304331433243334334433543364337433843394340
  1. /*
  2. * Marvell 88e6xxx Ethernet switch single-chip support
  3. *
  4. * Copyright (c) 2008 Marvell Semiconductor
  5. *
  6. * Copyright (c) 2016 Andrew Lunn <andrew@lunn.ch>
  7. *
  8. * Copyright (c) 2016-2017 Savoir-faire Linux Inc.
  9. * Vivien Didelot <vivien.didelot@savoirfairelinux.com>
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License as published by
  13. * the Free Software Foundation; either version 2 of the License, or
  14. * (at your option) any later version.
  15. */
  16. #include <linux/delay.h>
  17. #include <linux/etherdevice.h>
  18. #include <linux/ethtool.h>
  19. #include <linux/if_bridge.h>
  20. #include <linux/interrupt.h>
  21. #include <linux/irq.h>
  22. #include <linux/irqdomain.h>
  23. #include <linux/jiffies.h>
  24. #include <linux/list.h>
  25. #include <linux/mdio.h>
  26. #include <linux/module.h>
  27. #include <linux/of_device.h>
  28. #include <linux/of_irq.h>
  29. #include <linux/of_mdio.h>
  30. #include <linux/netdevice.h>
  31. #include <linux/gpio/consumer.h>
  32. #include <linux/phy.h>
  33. #include <net/dsa.h>
  34. #include "chip.h"
  35. #include "global1.h"
  36. #include "global2.h"
  37. #include "hwtstamp.h"
  38. #include "phy.h"
  39. #include "port.h"
  40. #include "ptp.h"
  41. #include "serdes.h"
  42. static void assert_reg_lock(struct mv88e6xxx_chip *chip)
  43. {
  44. if (unlikely(!mutex_is_locked(&chip->reg_lock))) {
  45. dev_err(chip->dev, "Switch registers lock not held!\n");
  46. dump_stack();
  47. }
  48. }
  49. /* The switch ADDR[4:1] configuration pins define the chip SMI device address
  50. * (ADDR[0] is always zero, thus only even SMI addresses can be strapped).
  51. *
  52. * When ADDR is all zero, the chip uses Single-chip Addressing Mode, assuming it
  53. * is the only device connected to the SMI master. In this mode it responds to
  54. * all 32 possible SMI addresses, and thus maps directly the internal devices.
  55. *
  56. * When ADDR is non-zero, the chip uses Multi-chip Addressing Mode, allowing
  57. * multiple devices to share the SMI interface. In this mode it responds to only
  58. * 2 registers, used to indirectly access the internal SMI devices.
  59. */
  60. static int mv88e6xxx_smi_read(struct mv88e6xxx_chip *chip,
  61. int addr, int reg, u16 *val)
  62. {
  63. if (!chip->smi_ops)
  64. return -EOPNOTSUPP;
  65. return chip->smi_ops->read(chip, addr, reg, val);
  66. }
  67. static int mv88e6xxx_smi_write(struct mv88e6xxx_chip *chip,
  68. int addr, int reg, u16 val)
  69. {
  70. if (!chip->smi_ops)
  71. return -EOPNOTSUPP;
  72. return chip->smi_ops->write(chip, addr, reg, val);
  73. }
  74. static int mv88e6xxx_smi_single_chip_read(struct mv88e6xxx_chip *chip,
  75. int addr, int reg, u16 *val)
  76. {
  77. int ret;
  78. ret = mdiobus_read_nested(chip->bus, addr, reg);
  79. if (ret < 0)
  80. return ret;
  81. *val = ret & 0xffff;
  82. return 0;
  83. }
  84. static int mv88e6xxx_smi_single_chip_write(struct mv88e6xxx_chip *chip,
  85. int addr, int reg, u16 val)
  86. {
  87. int ret;
  88. ret = mdiobus_write_nested(chip->bus, addr, reg, val);
  89. if (ret < 0)
  90. return ret;
  91. return 0;
  92. }
  93. static const struct mv88e6xxx_bus_ops mv88e6xxx_smi_single_chip_ops = {
  94. .read = mv88e6xxx_smi_single_chip_read,
  95. .write = mv88e6xxx_smi_single_chip_write,
  96. };
  97. static int mv88e6xxx_smi_multi_chip_wait(struct mv88e6xxx_chip *chip)
  98. {
  99. int ret;
  100. int i;
  101. for (i = 0; i < 16; i++) {
  102. ret = mdiobus_read_nested(chip->bus, chip->sw_addr, SMI_CMD);
  103. if (ret < 0)
  104. return ret;
  105. if ((ret & SMI_CMD_BUSY) == 0)
  106. return 0;
  107. }
  108. return -ETIMEDOUT;
  109. }
  110. static int mv88e6xxx_smi_multi_chip_read(struct mv88e6xxx_chip *chip,
  111. int addr, int reg, u16 *val)
  112. {
  113. int ret;
  114. /* Wait for the bus to become free. */
  115. ret = mv88e6xxx_smi_multi_chip_wait(chip);
  116. if (ret < 0)
  117. return ret;
  118. /* Transmit the read command. */
  119. ret = mdiobus_write_nested(chip->bus, chip->sw_addr, SMI_CMD,
  120. SMI_CMD_OP_22_READ | (addr << 5) | reg);
  121. if (ret < 0)
  122. return ret;
  123. /* Wait for the read command to complete. */
  124. ret = mv88e6xxx_smi_multi_chip_wait(chip);
  125. if (ret < 0)
  126. return ret;
  127. /* Read the data. */
  128. ret = mdiobus_read_nested(chip->bus, chip->sw_addr, SMI_DATA);
  129. if (ret < 0)
  130. return ret;
  131. *val = ret & 0xffff;
  132. return 0;
  133. }
  134. static int mv88e6xxx_smi_multi_chip_write(struct mv88e6xxx_chip *chip,
  135. int addr, int reg, u16 val)
  136. {
  137. int ret;
  138. /* Wait for the bus to become free. */
  139. ret = mv88e6xxx_smi_multi_chip_wait(chip);
  140. if (ret < 0)
  141. return ret;
  142. /* Transmit the data to write. */
  143. ret = mdiobus_write_nested(chip->bus, chip->sw_addr, SMI_DATA, val);
  144. if (ret < 0)
  145. return ret;
  146. /* Transmit the write command. */
  147. ret = mdiobus_write_nested(chip->bus, chip->sw_addr, SMI_CMD,
  148. SMI_CMD_OP_22_WRITE | (addr << 5) | reg);
  149. if (ret < 0)
  150. return ret;
  151. /* Wait for the write command to complete. */
  152. ret = mv88e6xxx_smi_multi_chip_wait(chip);
  153. if (ret < 0)
  154. return ret;
  155. return 0;
  156. }
  157. static const struct mv88e6xxx_bus_ops mv88e6xxx_smi_multi_chip_ops = {
  158. .read = mv88e6xxx_smi_multi_chip_read,
  159. .write = mv88e6xxx_smi_multi_chip_write,
  160. };
  161. int mv88e6xxx_read(struct mv88e6xxx_chip *chip, int addr, int reg, u16 *val)
  162. {
  163. int err;
  164. assert_reg_lock(chip);
  165. err = mv88e6xxx_smi_read(chip, addr, reg, val);
  166. if (err)
  167. return err;
  168. dev_dbg(chip->dev, "<- addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
  169. addr, reg, *val);
  170. return 0;
  171. }
  172. int mv88e6xxx_write(struct mv88e6xxx_chip *chip, int addr, int reg, u16 val)
  173. {
  174. int err;
  175. assert_reg_lock(chip);
  176. err = mv88e6xxx_smi_write(chip, addr, reg, val);
  177. if (err)
  178. return err;
  179. dev_dbg(chip->dev, "-> addr: 0x%.2x reg: 0x%.2x val: 0x%.4x\n",
  180. addr, reg, val);
  181. return 0;
  182. }
  183. struct mii_bus *mv88e6xxx_default_mdio_bus(struct mv88e6xxx_chip *chip)
  184. {
  185. struct mv88e6xxx_mdio_bus *mdio_bus;
  186. mdio_bus = list_first_entry(&chip->mdios, struct mv88e6xxx_mdio_bus,
  187. list);
  188. if (!mdio_bus)
  189. return NULL;
  190. return mdio_bus->bus;
  191. }
  192. static void mv88e6xxx_g1_irq_mask(struct irq_data *d)
  193. {
  194. struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
  195. unsigned int n = d->hwirq;
  196. chip->g1_irq.masked |= (1 << n);
  197. }
  198. static void mv88e6xxx_g1_irq_unmask(struct irq_data *d)
  199. {
  200. struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
  201. unsigned int n = d->hwirq;
  202. chip->g1_irq.masked &= ~(1 << n);
  203. }
  204. static irqreturn_t mv88e6xxx_g1_irq_thread_work(struct mv88e6xxx_chip *chip)
  205. {
  206. unsigned int nhandled = 0;
  207. unsigned int sub_irq;
  208. unsigned int n;
  209. u16 reg;
  210. int err;
  211. mutex_lock(&chip->reg_lock);
  212. err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_STS, &reg);
  213. mutex_unlock(&chip->reg_lock);
  214. if (err)
  215. goto out;
  216. for (n = 0; n < chip->g1_irq.nirqs; ++n) {
  217. if (reg & (1 << n)) {
  218. sub_irq = irq_find_mapping(chip->g1_irq.domain, n);
  219. handle_nested_irq(sub_irq);
  220. ++nhandled;
  221. }
  222. }
  223. out:
  224. return (nhandled > 0 ? IRQ_HANDLED : IRQ_NONE);
  225. }
  226. static irqreturn_t mv88e6xxx_g1_irq_thread_fn(int irq, void *dev_id)
  227. {
  228. struct mv88e6xxx_chip *chip = dev_id;
  229. return mv88e6xxx_g1_irq_thread_work(chip);
  230. }
  231. static void mv88e6xxx_g1_irq_bus_lock(struct irq_data *d)
  232. {
  233. struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
  234. mutex_lock(&chip->reg_lock);
  235. }
  236. static void mv88e6xxx_g1_irq_bus_sync_unlock(struct irq_data *d)
  237. {
  238. struct mv88e6xxx_chip *chip = irq_data_get_irq_chip_data(d);
  239. u16 mask = GENMASK(chip->g1_irq.nirqs, 0);
  240. u16 reg;
  241. int err;
  242. err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_CTL1, &reg);
  243. if (err)
  244. goto out;
  245. reg &= ~mask;
  246. reg |= (~chip->g1_irq.masked & mask);
  247. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_CTL1, reg);
  248. if (err)
  249. goto out;
  250. out:
  251. mutex_unlock(&chip->reg_lock);
  252. }
  253. static const struct irq_chip mv88e6xxx_g1_irq_chip = {
  254. .name = "mv88e6xxx-g1",
  255. .irq_mask = mv88e6xxx_g1_irq_mask,
  256. .irq_unmask = mv88e6xxx_g1_irq_unmask,
  257. .irq_bus_lock = mv88e6xxx_g1_irq_bus_lock,
  258. .irq_bus_sync_unlock = mv88e6xxx_g1_irq_bus_sync_unlock,
  259. };
  260. static int mv88e6xxx_g1_irq_domain_map(struct irq_domain *d,
  261. unsigned int irq,
  262. irq_hw_number_t hwirq)
  263. {
  264. struct mv88e6xxx_chip *chip = d->host_data;
  265. irq_set_chip_data(irq, d->host_data);
  266. irq_set_chip_and_handler(irq, &chip->g1_irq.chip, handle_level_irq);
  267. irq_set_noprobe(irq);
  268. return 0;
  269. }
  270. static const struct irq_domain_ops mv88e6xxx_g1_irq_domain_ops = {
  271. .map = mv88e6xxx_g1_irq_domain_map,
  272. .xlate = irq_domain_xlate_twocell,
  273. };
  274. static void mv88e6xxx_g1_irq_free_common(struct mv88e6xxx_chip *chip)
  275. {
  276. int irq, virq;
  277. u16 mask;
  278. mv88e6xxx_g1_read(chip, MV88E6XXX_G1_CTL1, &mask);
  279. mask &= ~GENMASK(chip->g1_irq.nirqs, 0);
  280. mv88e6xxx_g1_write(chip, MV88E6XXX_G1_CTL1, mask);
  281. for (irq = 0; irq < chip->g1_irq.nirqs; irq++) {
  282. virq = irq_find_mapping(chip->g1_irq.domain, irq);
  283. irq_dispose_mapping(virq);
  284. }
  285. irq_domain_remove(chip->g1_irq.domain);
  286. }
  287. static void mv88e6xxx_g1_irq_free(struct mv88e6xxx_chip *chip)
  288. {
  289. mv88e6xxx_g1_irq_free_common(chip);
  290. free_irq(chip->irq, chip);
  291. }
  292. static int mv88e6xxx_g1_irq_setup_common(struct mv88e6xxx_chip *chip)
  293. {
  294. int err, irq, virq;
  295. u16 reg, mask;
  296. chip->g1_irq.nirqs = chip->info->g1_irqs;
  297. chip->g1_irq.domain = irq_domain_add_simple(
  298. NULL, chip->g1_irq.nirqs, 0,
  299. &mv88e6xxx_g1_irq_domain_ops, chip);
  300. if (!chip->g1_irq.domain)
  301. return -ENOMEM;
  302. for (irq = 0; irq < chip->g1_irq.nirqs; irq++)
  303. irq_create_mapping(chip->g1_irq.domain, irq);
  304. chip->g1_irq.chip = mv88e6xxx_g1_irq_chip;
  305. chip->g1_irq.masked = ~0;
  306. err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_CTL1, &mask);
  307. if (err)
  308. goto out_mapping;
  309. mask &= ~GENMASK(chip->g1_irq.nirqs, 0);
  310. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_CTL1, mask);
  311. if (err)
  312. goto out_disable;
  313. /* Reading the interrupt status clears (most of) them */
  314. err = mv88e6xxx_g1_read(chip, MV88E6XXX_G1_STS, &reg);
  315. if (err)
  316. goto out_disable;
  317. return 0;
  318. out_disable:
  319. mask &= ~GENMASK(chip->g1_irq.nirqs, 0);
  320. mv88e6xxx_g1_write(chip, MV88E6XXX_G1_CTL1, mask);
  321. out_mapping:
  322. for (irq = 0; irq < 16; irq++) {
  323. virq = irq_find_mapping(chip->g1_irq.domain, irq);
  324. irq_dispose_mapping(virq);
  325. }
  326. irq_domain_remove(chip->g1_irq.domain);
  327. return err;
  328. }
  329. static int mv88e6xxx_g1_irq_setup(struct mv88e6xxx_chip *chip)
  330. {
  331. int err;
  332. err = mv88e6xxx_g1_irq_setup_common(chip);
  333. if (err)
  334. return err;
  335. err = request_threaded_irq(chip->irq, NULL,
  336. mv88e6xxx_g1_irq_thread_fn,
  337. IRQF_ONESHOT,
  338. dev_name(chip->dev), chip);
  339. if (err)
  340. mv88e6xxx_g1_irq_free_common(chip);
  341. return err;
  342. }
  343. static void mv88e6xxx_irq_poll(struct kthread_work *work)
  344. {
  345. struct mv88e6xxx_chip *chip = container_of(work,
  346. struct mv88e6xxx_chip,
  347. irq_poll_work.work);
  348. mv88e6xxx_g1_irq_thread_work(chip);
  349. kthread_queue_delayed_work(chip->kworker, &chip->irq_poll_work,
  350. msecs_to_jiffies(100));
  351. }
  352. static int mv88e6xxx_irq_poll_setup(struct mv88e6xxx_chip *chip)
  353. {
  354. int err;
  355. err = mv88e6xxx_g1_irq_setup_common(chip);
  356. if (err)
  357. return err;
  358. kthread_init_delayed_work(&chip->irq_poll_work,
  359. mv88e6xxx_irq_poll);
  360. chip->kworker = kthread_create_worker(0, dev_name(chip->dev));
  361. if (IS_ERR(chip->kworker))
  362. return PTR_ERR(chip->kworker);
  363. kthread_queue_delayed_work(chip->kworker, &chip->irq_poll_work,
  364. msecs_to_jiffies(100));
  365. return 0;
  366. }
  367. static void mv88e6xxx_irq_poll_free(struct mv88e6xxx_chip *chip)
  368. {
  369. mv88e6xxx_g1_irq_free_common(chip);
  370. kthread_cancel_delayed_work_sync(&chip->irq_poll_work);
  371. kthread_destroy_worker(chip->kworker);
  372. }
  373. int mv88e6xxx_wait(struct mv88e6xxx_chip *chip, int addr, int reg, u16 mask)
  374. {
  375. int i;
  376. for (i = 0; i < 16; i++) {
  377. u16 val;
  378. int err;
  379. err = mv88e6xxx_read(chip, addr, reg, &val);
  380. if (err)
  381. return err;
  382. if (!(val & mask))
  383. return 0;
  384. usleep_range(1000, 2000);
  385. }
  386. dev_err(chip->dev, "Timeout while waiting for switch\n");
  387. return -ETIMEDOUT;
  388. }
  389. /* Indirect write to single pointer-data register with an Update bit */
  390. int mv88e6xxx_update(struct mv88e6xxx_chip *chip, int addr, int reg, u16 update)
  391. {
  392. u16 val;
  393. int err;
  394. /* Wait until the previous operation is completed */
  395. err = mv88e6xxx_wait(chip, addr, reg, BIT(15));
  396. if (err)
  397. return err;
  398. /* Set the Update bit to trigger a write operation */
  399. val = BIT(15) | update;
  400. return mv88e6xxx_write(chip, addr, reg, val);
  401. }
  402. static int mv88e6xxx_port_setup_mac(struct mv88e6xxx_chip *chip, int port,
  403. int link, int speed, int duplex,
  404. phy_interface_t mode)
  405. {
  406. int err;
  407. if (!chip->info->ops->port_set_link)
  408. return 0;
  409. /* Port's MAC control must not be changed unless the link is down */
  410. err = chip->info->ops->port_set_link(chip, port, 0);
  411. if (err)
  412. return err;
  413. if (chip->info->ops->port_set_speed) {
  414. err = chip->info->ops->port_set_speed(chip, port, speed);
  415. if (err && err != -EOPNOTSUPP)
  416. goto restore_link;
  417. }
  418. if (chip->info->ops->port_set_duplex) {
  419. err = chip->info->ops->port_set_duplex(chip, port, duplex);
  420. if (err && err != -EOPNOTSUPP)
  421. goto restore_link;
  422. }
  423. if (chip->info->ops->port_set_rgmii_delay) {
  424. err = chip->info->ops->port_set_rgmii_delay(chip, port, mode);
  425. if (err && err != -EOPNOTSUPP)
  426. goto restore_link;
  427. }
  428. if (chip->info->ops->port_set_cmode) {
  429. err = chip->info->ops->port_set_cmode(chip, port, mode);
  430. if (err && err != -EOPNOTSUPP)
  431. goto restore_link;
  432. }
  433. err = 0;
  434. restore_link:
  435. if (chip->info->ops->port_set_link(chip, port, link))
  436. dev_err(chip->dev, "p%d: failed to restore MAC's link\n", port);
  437. return err;
  438. }
  439. /* We expect the switch to perform auto negotiation if there is a real
  440. * phy. However, in the case of a fixed link phy, we force the port
  441. * settings from the fixed link settings.
  442. */
  443. static void mv88e6xxx_adjust_link(struct dsa_switch *ds, int port,
  444. struct phy_device *phydev)
  445. {
  446. struct mv88e6xxx_chip *chip = ds->priv;
  447. int err;
  448. if (!phy_is_pseudo_fixed_link(phydev))
  449. return;
  450. mutex_lock(&chip->reg_lock);
  451. err = mv88e6xxx_port_setup_mac(chip, port, phydev->link, phydev->speed,
  452. phydev->duplex, phydev->interface);
  453. mutex_unlock(&chip->reg_lock);
  454. if (err && err != -EOPNOTSUPP)
  455. dev_err(ds->dev, "p%d: failed to configure MAC\n", port);
  456. }
  457. static int mv88e6xxx_stats_snapshot(struct mv88e6xxx_chip *chip, int port)
  458. {
  459. if (!chip->info->ops->stats_snapshot)
  460. return -EOPNOTSUPP;
  461. return chip->info->ops->stats_snapshot(chip, port);
  462. }
  463. static struct mv88e6xxx_hw_stat mv88e6xxx_hw_stats[] = {
  464. { "in_good_octets", 8, 0x00, STATS_TYPE_BANK0, },
  465. { "in_bad_octets", 4, 0x02, STATS_TYPE_BANK0, },
  466. { "in_unicast", 4, 0x04, STATS_TYPE_BANK0, },
  467. { "in_broadcasts", 4, 0x06, STATS_TYPE_BANK0, },
  468. { "in_multicasts", 4, 0x07, STATS_TYPE_BANK0, },
  469. { "in_pause", 4, 0x16, STATS_TYPE_BANK0, },
  470. { "in_undersize", 4, 0x18, STATS_TYPE_BANK0, },
  471. { "in_fragments", 4, 0x19, STATS_TYPE_BANK0, },
  472. { "in_oversize", 4, 0x1a, STATS_TYPE_BANK0, },
  473. { "in_jabber", 4, 0x1b, STATS_TYPE_BANK0, },
  474. { "in_rx_error", 4, 0x1c, STATS_TYPE_BANK0, },
  475. { "in_fcs_error", 4, 0x1d, STATS_TYPE_BANK0, },
  476. { "out_octets", 8, 0x0e, STATS_TYPE_BANK0, },
  477. { "out_unicast", 4, 0x10, STATS_TYPE_BANK0, },
  478. { "out_broadcasts", 4, 0x13, STATS_TYPE_BANK0, },
  479. { "out_multicasts", 4, 0x12, STATS_TYPE_BANK0, },
  480. { "out_pause", 4, 0x15, STATS_TYPE_BANK0, },
  481. { "excessive", 4, 0x11, STATS_TYPE_BANK0, },
  482. { "collisions", 4, 0x1e, STATS_TYPE_BANK0, },
  483. { "deferred", 4, 0x05, STATS_TYPE_BANK0, },
  484. { "single", 4, 0x14, STATS_TYPE_BANK0, },
  485. { "multiple", 4, 0x17, STATS_TYPE_BANK0, },
  486. { "out_fcs_error", 4, 0x03, STATS_TYPE_BANK0, },
  487. { "late", 4, 0x1f, STATS_TYPE_BANK0, },
  488. { "hist_64bytes", 4, 0x08, STATS_TYPE_BANK0, },
  489. { "hist_65_127bytes", 4, 0x09, STATS_TYPE_BANK0, },
  490. { "hist_128_255bytes", 4, 0x0a, STATS_TYPE_BANK0, },
  491. { "hist_256_511bytes", 4, 0x0b, STATS_TYPE_BANK0, },
  492. { "hist_512_1023bytes", 4, 0x0c, STATS_TYPE_BANK0, },
  493. { "hist_1024_max_bytes", 4, 0x0d, STATS_TYPE_BANK0, },
  494. { "sw_in_discards", 4, 0x10, STATS_TYPE_PORT, },
  495. { "sw_in_filtered", 2, 0x12, STATS_TYPE_PORT, },
  496. { "sw_out_filtered", 2, 0x13, STATS_TYPE_PORT, },
  497. { "in_discards", 4, 0x00, STATS_TYPE_BANK1, },
  498. { "in_filtered", 4, 0x01, STATS_TYPE_BANK1, },
  499. { "in_accepted", 4, 0x02, STATS_TYPE_BANK1, },
  500. { "in_bad_accepted", 4, 0x03, STATS_TYPE_BANK1, },
  501. { "in_good_avb_class_a", 4, 0x04, STATS_TYPE_BANK1, },
  502. { "in_good_avb_class_b", 4, 0x05, STATS_TYPE_BANK1, },
  503. { "in_bad_avb_class_a", 4, 0x06, STATS_TYPE_BANK1, },
  504. { "in_bad_avb_class_b", 4, 0x07, STATS_TYPE_BANK1, },
  505. { "tcam_counter_0", 4, 0x08, STATS_TYPE_BANK1, },
  506. { "tcam_counter_1", 4, 0x09, STATS_TYPE_BANK1, },
  507. { "tcam_counter_2", 4, 0x0a, STATS_TYPE_BANK1, },
  508. { "tcam_counter_3", 4, 0x0b, STATS_TYPE_BANK1, },
  509. { "in_da_unknown", 4, 0x0e, STATS_TYPE_BANK1, },
  510. { "in_management", 4, 0x0f, STATS_TYPE_BANK1, },
  511. { "out_queue_0", 4, 0x10, STATS_TYPE_BANK1, },
  512. { "out_queue_1", 4, 0x11, STATS_TYPE_BANK1, },
  513. { "out_queue_2", 4, 0x12, STATS_TYPE_BANK1, },
  514. { "out_queue_3", 4, 0x13, STATS_TYPE_BANK1, },
  515. { "out_queue_4", 4, 0x14, STATS_TYPE_BANK1, },
  516. { "out_queue_5", 4, 0x15, STATS_TYPE_BANK1, },
  517. { "out_queue_6", 4, 0x16, STATS_TYPE_BANK1, },
  518. { "out_queue_7", 4, 0x17, STATS_TYPE_BANK1, },
  519. { "out_cut_through", 4, 0x18, STATS_TYPE_BANK1, },
  520. { "out_octets_a", 4, 0x1a, STATS_TYPE_BANK1, },
  521. { "out_octets_b", 4, 0x1b, STATS_TYPE_BANK1, },
  522. { "out_management", 4, 0x1f, STATS_TYPE_BANK1, },
  523. };
  524. static uint64_t _mv88e6xxx_get_ethtool_stat(struct mv88e6xxx_chip *chip,
  525. struct mv88e6xxx_hw_stat *s,
  526. int port, u16 bank1_select,
  527. u16 histogram)
  528. {
  529. u32 low;
  530. u32 high = 0;
  531. u16 reg = 0;
  532. int err;
  533. u64 value;
  534. switch (s->type) {
  535. case STATS_TYPE_PORT:
  536. err = mv88e6xxx_port_read(chip, port, s->reg, &reg);
  537. if (err)
  538. return UINT64_MAX;
  539. low = reg;
  540. if (s->size == 4) {
  541. err = mv88e6xxx_port_read(chip, port, s->reg + 1, &reg);
  542. if (err)
  543. return UINT64_MAX;
  544. high = reg;
  545. }
  546. break;
  547. case STATS_TYPE_BANK1:
  548. reg = bank1_select;
  549. /* fall through */
  550. case STATS_TYPE_BANK0:
  551. reg |= s->reg | histogram;
  552. mv88e6xxx_g1_stats_read(chip, reg, &low);
  553. if (s->size == 8)
  554. mv88e6xxx_g1_stats_read(chip, reg + 1, &high);
  555. break;
  556. default:
  557. return UINT64_MAX;
  558. }
  559. value = (((u64)high) << 16) | low;
  560. return value;
  561. }
  562. static int mv88e6xxx_stats_get_strings(struct mv88e6xxx_chip *chip,
  563. uint8_t *data, int types)
  564. {
  565. struct mv88e6xxx_hw_stat *stat;
  566. int i, j;
  567. for (i = 0, j = 0; i < ARRAY_SIZE(mv88e6xxx_hw_stats); i++) {
  568. stat = &mv88e6xxx_hw_stats[i];
  569. if (stat->type & types) {
  570. memcpy(data + j * ETH_GSTRING_LEN, stat->string,
  571. ETH_GSTRING_LEN);
  572. j++;
  573. }
  574. }
  575. return j;
  576. }
  577. static int mv88e6095_stats_get_strings(struct mv88e6xxx_chip *chip,
  578. uint8_t *data)
  579. {
  580. return mv88e6xxx_stats_get_strings(chip, data,
  581. STATS_TYPE_BANK0 | STATS_TYPE_PORT);
  582. }
  583. static int mv88e6320_stats_get_strings(struct mv88e6xxx_chip *chip,
  584. uint8_t *data)
  585. {
  586. return mv88e6xxx_stats_get_strings(chip, data,
  587. STATS_TYPE_BANK0 | STATS_TYPE_BANK1);
  588. }
  589. static const uint8_t *mv88e6xxx_atu_vtu_stats_strings[] = {
  590. "atu_member_violation",
  591. "atu_miss_violation",
  592. "atu_full_violation",
  593. "vtu_member_violation",
  594. "vtu_miss_violation",
  595. };
  596. static void mv88e6xxx_atu_vtu_get_strings(uint8_t *data)
  597. {
  598. unsigned int i;
  599. for (i = 0; i < ARRAY_SIZE(mv88e6xxx_atu_vtu_stats_strings); i++)
  600. strlcpy(data + i * ETH_GSTRING_LEN,
  601. mv88e6xxx_atu_vtu_stats_strings[i],
  602. ETH_GSTRING_LEN);
  603. }
  604. static void mv88e6xxx_get_strings(struct dsa_switch *ds, int port,
  605. uint8_t *data)
  606. {
  607. struct mv88e6xxx_chip *chip = ds->priv;
  608. int count = 0;
  609. mutex_lock(&chip->reg_lock);
  610. if (chip->info->ops->stats_get_strings)
  611. count = chip->info->ops->stats_get_strings(chip, data);
  612. if (chip->info->ops->serdes_get_strings) {
  613. data += count * ETH_GSTRING_LEN;
  614. count = chip->info->ops->serdes_get_strings(chip, port, data);
  615. }
  616. data += count * ETH_GSTRING_LEN;
  617. mv88e6xxx_atu_vtu_get_strings(data);
  618. mutex_unlock(&chip->reg_lock);
  619. }
  620. static int mv88e6xxx_stats_get_sset_count(struct mv88e6xxx_chip *chip,
  621. int types)
  622. {
  623. struct mv88e6xxx_hw_stat *stat;
  624. int i, j;
  625. for (i = 0, j = 0; i < ARRAY_SIZE(mv88e6xxx_hw_stats); i++) {
  626. stat = &mv88e6xxx_hw_stats[i];
  627. if (stat->type & types)
  628. j++;
  629. }
  630. return j;
  631. }
  632. static int mv88e6095_stats_get_sset_count(struct mv88e6xxx_chip *chip)
  633. {
  634. return mv88e6xxx_stats_get_sset_count(chip, STATS_TYPE_BANK0 |
  635. STATS_TYPE_PORT);
  636. }
  637. static int mv88e6320_stats_get_sset_count(struct mv88e6xxx_chip *chip)
  638. {
  639. return mv88e6xxx_stats_get_sset_count(chip, STATS_TYPE_BANK0 |
  640. STATS_TYPE_BANK1);
  641. }
  642. static int mv88e6xxx_get_sset_count(struct dsa_switch *ds, int port)
  643. {
  644. struct mv88e6xxx_chip *chip = ds->priv;
  645. int serdes_count = 0;
  646. int count = 0;
  647. mutex_lock(&chip->reg_lock);
  648. if (chip->info->ops->stats_get_sset_count)
  649. count = chip->info->ops->stats_get_sset_count(chip);
  650. if (count < 0)
  651. goto out;
  652. if (chip->info->ops->serdes_get_sset_count)
  653. serdes_count = chip->info->ops->serdes_get_sset_count(chip,
  654. port);
  655. if (serdes_count < 0) {
  656. count = serdes_count;
  657. goto out;
  658. }
  659. count += serdes_count;
  660. count += ARRAY_SIZE(mv88e6xxx_atu_vtu_stats_strings);
  661. out:
  662. mutex_unlock(&chip->reg_lock);
  663. return count;
  664. }
  665. static int mv88e6xxx_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
  666. uint64_t *data, int types,
  667. u16 bank1_select, u16 histogram)
  668. {
  669. struct mv88e6xxx_hw_stat *stat;
  670. int i, j;
  671. for (i = 0, j = 0; i < ARRAY_SIZE(mv88e6xxx_hw_stats); i++) {
  672. stat = &mv88e6xxx_hw_stats[i];
  673. if (stat->type & types) {
  674. mutex_lock(&chip->reg_lock);
  675. data[j] = _mv88e6xxx_get_ethtool_stat(chip, stat, port,
  676. bank1_select,
  677. histogram);
  678. mutex_unlock(&chip->reg_lock);
  679. j++;
  680. }
  681. }
  682. return j;
  683. }
  684. static int mv88e6095_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
  685. uint64_t *data)
  686. {
  687. return mv88e6xxx_stats_get_stats(chip, port, data,
  688. STATS_TYPE_BANK0 | STATS_TYPE_PORT,
  689. 0, MV88E6XXX_G1_STATS_OP_HIST_RX_TX);
  690. }
  691. static int mv88e6320_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
  692. uint64_t *data)
  693. {
  694. return mv88e6xxx_stats_get_stats(chip, port, data,
  695. STATS_TYPE_BANK0 | STATS_TYPE_BANK1,
  696. MV88E6XXX_G1_STATS_OP_BANK_1_BIT_9,
  697. MV88E6XXX_G1_STATS_OP_HIST_RX_TX);
  698. }
  699. static int mv88e6390_stats_get_stats(struct mv88e6xxx_chip *chip, int port,
  700. uint64_t *data)
  701. {
  702. return mv88e6xxx_stats_get_stats(chip, port, data,
  703. STATS_TYPE_BANK0 | STATS_TYPE_BANK1,
  704. MV88E6XXX_G1_STATS_OP_BANK_1_BIT_10,
  705. 0);
  706. }
  707. static void mv88e6xxx_atu_vtu_get_stats(struct mv88e6xxx_chip *chip, int port,
  708. uint64_t *data)
  709. {
  710. *data++ = chip->ports[port].atu_member_violation;
  711. *data++ = chip->ports[port].atu_miss_violation;
  712. *data++ = chip->ports[port].atu_full_violation;
  713. *data++ = chip->ports[port].vtu_member_violation;
  714. *data++ = chip->ports[port].vtu_miss_violation;
  715. }
  716. static void mv88e6xxx_get_stats(struct mv88e6xxx_chip *chip, int port,
  717. uint64_t *data)
  718. {
  719. int count = 0;
  720. if (chip->info->ops->stats_get_stats)
  721. count = chip->info->ops->stats_get_stats(chip, port, data);
  722. mutex_lock(&chip->reg_lock);
  723. if (chip->info->ops->serdes_get_stats) {
  724. data += count;
  725. count = chip->info->ops->serdes_get_stats(chip, port, data);
  726. }
  727. data += count;
  728. mv88e6xxx_atu_vtu_get_stats(chip, port, data);
  729. mutex_unlock(&chip->reg_lock);
  730. }
  731. static void mv88e6xxx_get_ethtool_stats(struct dsa_switch *ds, int port,
  732. uint64_t *data)
  733. {
  734. struct mv88e6xxx_chip *chip = ds->priv;
  735. int ret;
  736. mutex_lock(&chip->reg_lock);
  737. ret = mv88e6xxx_stats_snapshot(chip, port);
  738. mutex_unlock(&chip->reg_lock);
  739. if (ret < 0)
  740. return;
  741. mv88e6xxx_get_stats(chip, port, data);
  742. }
  743. static int mv88e6xxx_stats_set_histogram(struct mv88e6xxx_chip *chip)
  744. {
  745. if (chip->info->ops->stats_set_histogram)
  746. return chip->info->ops->stats_set_histogram(chip);
  747. return 0;
  748. }
  749. static int mv88e6xxx_get_regs_len(struct dsa_switch *ds, int port)
  750. {
  751. return 32 * sizeof(u16);
  752. }
  753. static void mv88e6xxx_get_regs(struct dsa_switch *ds, int port,
  754. struct ethtool_regs *regs, void *_p)
  755. {
  756. struct mv88e6xxx_chip *chip = ds->priv;
  757. int err;
  758. u16 reg;
  759. u16 *p = _p;
  760. int i;
  761. regs->version = 0;
  762. memset(p, 0xff, 32 * sizeof(u16));
  763. mutex_lock(&chip->reg_lock);
  764. for (i = 0; i < 32; i++) {
  765. err = mv88e6xxx_port_read(chip, port, i, &reg);
  766. if (!err)
  767. p[i] = reg;
  768. }
  769. mutex_unlock(&chip->reg_lock);
  770. }
  771. static int mv88e6xxx_get_mac_eee(struct dsa_switch *ds, int port,
  772. struct ethtool_eee *e)
  773. {
  774. /* Nothing to do on the port's MAC */
  775. return 0;
  776. }
  777. static int mv88e6xxx_set_mac_eee(struct dsa_switch *ds, int port,
  778. struct ethtool_eee *e)
  779. {
  780. /* Nothing to do on the port's MAC */
  781. return 0;
  782. }
  783. static u16 mv88e6xxx_port_vlan(struct mv88e6xxx_chip *chip, int dev, int port)
  784. {
  785. struct dsa_switch *ds = NULL;
  786. struct net_device *br;
  787. u16 pvlan;
  788. int i;
  789. if (dev < DSA_MAX_SWITCHES)
  790. ds = chip->ds->dst->ds[dev];
  791. /* Prevent frames from unknown switch or port */
  792. if (!ds || port >= ds->num_ports)
  793. return 0;
  794. /* Frames from DSA links and CPU ports can egress any local port */
  795. if (dsa_is_cpu_port(ds, port) || dsa_is_dsa_port(ds, port))
  796. return mv88e6xxx_port_mask(chip);
  797. br = ds->ports[port].bridge_dev;
  798. pvlan = 0;
  799. /* Frames from user ports can egress any local DSA links and CPU ports,
  800. * as well as any local member of their bridge group.
  801. */
  802. for (i = 0; i < mv88e6xxx_num_ports(chip); ++i)
  803. if (dsa_is_cpu_port(chip->ds, i) ||
  804. dsa_is_dsa_port(chip->ds, i) ||
  805. (br && dsa_to_port(chip->ds, i)->bridge_dev == br))
  806. pvlan |= BIT(i);
  807. return pvlan;
  808. }
  809. static int mv88e6xxx_port_vlan_map(struct mv88e6xxx_chip *chip, int port)
  810. {
  811. u16 output_ports = mv88e6xxx_port_vlan(chip, chip->ds->index, port);
  812. /* prevent frames from going back out of the port they came in on */
  813. output_ports &= ~BIT(port);
  814. return mv88e6xxx_port_set_vlan_map(chip, port, output_ports);
  815. }
  816. static void mv88e6xxx_port_stp_state_set(struct dsa_switch *ds, int port,
  817. u8 state)
  818. {
  819. struct mv88e6xxx_chip *chip = ds->priv;
  820. int err;
  821. mutex_lock(&chip->reg_lock);
  822. err = mv88e6xxx_port_set_state(chip, port, state);
  823. mutex_unlock(&chip->reg_lock);
  824. if (err)
  825. dev_err(ds->dev, "p%d: failed to update state\n", port);
  826. }
  827. static int mv88e6xxx_pot_setup(struct mv88e6xxx_chip *chip)
  828. {
  829. if (chip->info->ops->pot_clear)
  830. return chip->info->ops->pot_clear(chip);
  831. return 0;
  832. }
  833. static int mv88e6xxx_rsvd2cpu_setup(struct mv88e6xxx_chip *chip)
  834. {
  835. if (chip->info->ops->mgmt_rsvd2cpu)
  836. return chip->info->ops->mgmt_rsvd2cpu(chip);
  837. return 0;
  838. }
  839. static int mv88e6xxx_atu_setup(struct mv88e6xxx_chip *chip)
  840. {
  841. int err;
  842. err = mv88e6xxx_g1_atu_flush(chip, 0, true);
  843. if (err)
  844. return err;
  845. err = mv88e6xxx_g1_atu_set_learn2all(chip, true);
  846. if (err)
  847. return err;
  848. return mv88e6xxx_g1_atu_set_age_time(chip, 300000);
  849. }
  850. static int mv88e6xxx_irl_setup(struct mv88e6xxx_chip *chip)
  851. {
  852. int port;
  853. int err;
  854. if (!chip->info->ops->irl_init_all)
  855. return 0;
  856. for (port = 0; port < mv88e6xxx_num_ports(chip); port++) {
  857. /* Disable ingress rate limiting by resetting all per port
  858. * ingress rate limit resources to their initial state.
  859. */
  860. err = chip->info->ops->irl_init_all(chip, port);
  861. if (err)
  862. return err;
  863. }
  864. return 0;
  865. }
  866. static int mv88e6xxx_mac_setup(struct mv88e6xxx_chip *chip)
  867. {
  868. if (chip->info->ops->set_switch_mac) {
  869. u8 addr[ETH_ALEN];
  870. eth_random_addr(addr);
  871. return chip->info->ops->set_switch_mac(chip, addr);
  872. }
  873. return 0;
  874. }
  875. static int mv88e6xxx_pvt_map(struct mv88e6xxx_chip *chip, int dev, int port)
  876. {
  877. u16 pvlan = 0;
  878. if (!mv88e6xxx_has_pvt(chip))
  879. return -EOPNOTSUPP;
  880. /* Skip the local source device, which uses in-chip port VLAN */
  881. if (dev != chip->ds->index)
  882. pvlan = mv88e6xxx_port_vlan(chip, dev, port);
  883. return mv88e6xxx_g2_pvt_write(chip, dev, port, pvlan);
  884. }
  885. static int mv88e6xxx_pvt_setup(struct mv88e6xxx_chip *chip)
  886. {
  887. int dev, port;
  888. int err;
  889. if (!mv88e6xxx_has_pvt(chip))
  890. return 0;
  891. /* Clear 5 Bit Port for usage with Marvell Link Street devices:
  892. * use 4 bits for the Src_Port/Src_Trunk and 5 bits for the Src_Dev.
  893. */
  894. err = mv88e6xxx_g2_misc_4_bit_port(chip);
  895. if (err)
  896. return err;
  897. for (dev = 0; dev < MV88E6XXX_MAX_PVT_SWITCHES; ++dev) {
  898. for (port = 0; port < MV88E6XXX_MAX_PVT_PORTS; ++port) {
  899. err = mv88e6xxx_pvt_map(chip, dev, port);
  900. if (err)
  901. return err;
  902. }
  903. }
  904. return 0;
  905. }
  906. static void mv88e6xxx_port_fast_age(struct dsa_switch *ds, int port)
  907. {
  908. struct mv88e6xxx_chip *chip = ds->priv;
  909. int err;
  910. mutex_lock(&chip->reg_lock);
  911. err = mv88e6xxx_g1_atu_remove(chip, 0, port, false);
  912. mutex_unlock(&chip->reg_lock);
  913. if (err)
  914. dev_err(ds->dev, "p%d: failed to flush ATU\n", port);
  915. }
  916. static int mv88e6xxx_vtu_setup(struct mv88e6xxx_chip *chip)
  917. {
  918. if (!chip->info->max_vid)
  919. return 0;
  920. return mv88e6xxx_g1_vtu_flush(chip);
  921. }
  922. static int mv88e6xxx_vtu_getnext(struct mv88e6xxx_chip *chip,
  923. struct mv88e6xxx_vtu_entry *entry)
  924. {
  925. if (!chip->info->ops->vtu_getnext)
  926. return -EOPNOTSUPP;
  927. return chip->info->ops->vtu_getnext(chip, entry);
  928. }
  929. static int mv88e6xxx_vtu_loadpurge(struct mv88e6xxx_chip *chip,
  930. struct mv88e6xxx_vtu_entry *entry)
  931. {
  932. if (!chip->info->ops->vtu_loadpurge)
  933. return -EOPNOTSUPP;
  934. return chip->info->ops->vtu_loadpurge(chip, entry);
  935. }
  936. static int mv88e6xxx_atu_new(struct mv88e6xxx_chip *chip, u16 *fid)
  937. {
  938. DECLARE_BITMAP(fid_bitmap, MV88E6XXX_N_FID);
  939. struct mv88e6xxx_vtu_entry vlan = {
  940. .vid = chip->info->max_vid,
  941. };
  942. int i, err;
  943. bitmap_zero(fid_bitmap, MV88E6XXX_N_FID);
  944. /* Set every FID bit used by the (un)bridged ports */
  945. for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
  946. err = mv88e6xxx_port_get_fid(chip, i, fid);
  947. if (err)
  948. return err;
  949. set_bit(*fid, fid_bitmap);
  950. }
  951. /* Set every FID bit used by the VLAN entries */
  952. do {
  953. err = mv88e6xxx_vtu_getnext(chip, &vlan);
  954. if (err)
  955. return err;
  956. if (!vlan.valid)
  957. break;
  958. set_bit(vlan.fid, fid_bitmap);
  959. } while (vlan.vid < chip->info->max_vid);
  960. /* The reset value 0x000 is used to indicate that multiple address
  961. * databases are not needed. Return the next positive available.
  962. */
  963. *fid = find_next_zero_bit(fid_bitmap, MV88E6XXX_N_FID, 1);
  964. if (unlikely(*fid >= mv88e6xxx_num_databases(chip)))
  965. return -ENOSPC;
  966. /* Clear the database */
  967. return mv88e6xxx_g1_atu_flush(chip, *fid, true);
  968. }
  969. static int mv88e6xxx_vtu_get(struct mv88e6xxx_chip *chip, u16 vid,
  970. struct mv88e6xxx_vtu_entry *entry, bool new)
  971. {
  972. int err;
  973. if (!vid)
  974. return -EINVAL;
  975. entry->vid = vid - 1;
  976. entry->valid = false;
  977. err = mv88e6xxx_vtu_getnext(chip, entry);
  978. if (err)
  979. return err;
  980. if (entry->vid == vid && entry->valid)
  981. return 0;
  982. if (new) {
  983. int i;
  984. /* Initialize a fresh VLAN entry */
  985. memset(entry, 0, sizeof(*entry));
  986. entry->valid = true;
  987. entry->vid = vid;
  988. /* Exclude all ports */
  989. for (i = 0; i < mv88e6xxx_num_ports(chip); ++i)
  990. entry->member[i] =
  991. MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_NON_MEMBER;
  992. return mv88e6xxx_atu_new(chip, &entry->fid);
  993. }
  994. /* switchdev expects -EOPNOTSUPP to honor software VLANs */
  995. return -EOPNOTSUPP;
  996. }
  997. static int mv88e6xxx_port_check_hw_vlan(struct dsa_switch *ds, int port,
  998. u16 vid_begin, u16 vid_end)
  999. {
  1000. struct mv88e6xxx_chip *chip = ds->priv;
  1001. struct mv88e6xxx_vtu_entry vlan = {
  1002. .vid = vid_begin - 1,
  1003. };
  1004. int i, err;
  1005. /* DSA and CPU ports have to be members of multiple vlans */
  1006. if (dsa_is_dsa_port(ds, port) || dsa_is_cpu_port(ds, port))
  1007. return 0;
  1008. if (!vid_begin)
  1009. return -EOPNOTSUPP;
  1010. mutex_lock(&chip->reg_lock);
  1011. do {
  1012. err = mv88e6xxx_vtu_getnext(chip, &vlan);
  1013. if (err)
  1014. goto unlock;
  1015. if (!vlan.valid)
  1016. break;
  1017. if (vlan.vid > vid_end)
  1018. break;
  1019. for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
  1020. if (dsa_is_dsa_port(ds, i) || dsa_is_cpu_port(ds, i))
  1021. continue;
  1022. if (!ds->ports[i].slave)
  1023. continue;
  1024. if (vlan.member[i] ==
  1025. MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_NON_MEMBER)
  1026. continue;
  1027. if (dsa_to_port(ds, i)->bridge_dev ==
  1028. ds->ports[port].bridge_dev)
  1029. break; /* same bridge, check next VLAN */
  1030. if (!dsa_to_port(ds, i)->bridge_dev)
  1031. continue;
  1032. dev_err(ds->dev, "p%d: hw VLAN %d already used by port %d in %s\n",
  1033. port, vlan.vid, i,
  1034. netdev_name(dsa_to_port(ds, i)->bridge_dev));
  1035. err = -EOPNOTSUPP;
  1036. goto unlock;
  1037. }
  1038. } while (vlan.vid < vid_end);
  1039. unlock:
  1040. mutex_unlock(&chip->reg_lock);
  1041. return err;
  1042. }
  1043. static int mv88e6xxx_port_vlan_filtering(struct dsa_switch *ds, int port,
  1044. bool vlan_filtering)
  1045. {
  1046. struct mv88e6xxx_chip *chip = ds->priv;
  1047. u16 mode = vlan_filtering ? MV88E6XXX_PORT_CTL2_8021Q_MODE_SECURE :
  1048. MV88E6XXX_PORT_CTL2_8021Q_MODE_DISABLED;
  1049. int err;
  1050. if (!chip->info->max_vid)
  1051. return -EOPNOTSUPP;
  1052. mutex_lock(&chip->reg_lock);
  1053. err = mv88e6xxx_port_set_8021q_mode(chip, port, mode);
  1054. mutex_unlock(&chip->reg_lock);
  1055. return err;
  1056. }
  1057. static int
  1058. mv88e6xxx_port_vlan_prepare(struct dsa_switch *ds, int port,
  1059. const struct switchdev_obj_port_vlan *vlan)
  1060. {
  1061. struct mv88e6xxx_chip *chip = ds->priv;
  1062. int err;
  1063. if (!chip->info->max_vid)
  1064. return -EOPNOTSUPP;
  1065. /* If the requested port doesn't belong to the same bridge as the VLAN
  1066. * members, do not support it (yet) and fallback to software VLAN.
  1067. */
  1068. err = mv88e6xxx_port_check_hw_vlan(ds, port, vlan->vid_begin,
  1069. vlan->vid_end);
  1070. if (err)
  1071. return err;
  1072. /* We don't need any dynamic resource from the kernel (yet),
  1073. * so skip the prepare phase.
  1074. */
  1075. return 0;
  1076. }
  1077. static int mv88e6xxx_port_db_load_purge(struct mv88e6xxx_chip *chip, int port,
  1078. const unsigned char *addr, u16 vid,
  1079. u8 state)
  1080. {
  1081. struct mv88e6xxx_vtu_entry vlan;
  1082. struct mv88e6xxx_atu_entry entry;
  1083. int err;
  1084. /* Null VLAN ID corresponds to the port private database */
  1085. if (vid == 0)
  1086. err = mv88e6xxx_port_get_fid(chip, port, &vlan.fid);
  1087. else
  1088. err = mv88e6xxx_vtu_get(chip, vid, &vlan, false);
  1089. if (err)
  1090. return err;
  1091. entry.state = MV88E6XXX_G1_ATU_DATA_STATE_UNUSED;
  1092. ether_addr_copy(entry.mac, addr);
  1093. eth_addr_dec(entry.mac);
  1094. err = mv88e6xxx_g1_atu_getnext(chip, vlan.fid, &entry);
  1095. if (err)
  1096. return err;
  1097. /* Initialize a fresh ATU entry if it isn't found */
  1098. if (entry.state == MV88E6XXX_G1_ATU_DATA_STATE_UNUSED ||
  1099. !ether_addr_equal(entry.mac, addr)) {
  1100. memset(&entry, 0, sizeof(entry));
  1101. ether_addr_copy(entry.mac, addr);
  1102. }
  1103. /* Purge the ATU entry only if no port is using it anymore */
  1104. if (state == MV88E6XXX_G1_ATU_DATA_STATE_UNUSED) {
  1105. entry.portvec &= ~BIT(port);
  1106. if (!entry.portvec)
  1107. entry.state = MV88E6XXX_G1_ATU_DATA_STATE_UNUSED;
  1108. } else {
  1109. entry.portvec |= BIT(port);
  1110. entry.state = state;
  1111. }
  1112. return mv88e6xxx_g1_atu_loadpurge(chip, vlan.fid, &entry);
  1113. }
  1114. static int mv88e6xxx_port_add_broadcast(struct mv88e6xxx_chip *chip, int port,
  1115. u16 vid)
  1116. {
  1117. const char broadcast[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
  1118. u8 state = MV88E6XXX_G1_ATU_DATA_STATE_MC_STATIC;
  1119. return mv88e6xxx_port_db_load_purge(chip, port, broadcast, vid, state);
  1120. }
  1121. static int mv88e6xxx_broadcast_setup(struct mv88e6xxx_chip *chip, u16 vid)
  1122. {
  1123. int port;
  1124. int err;
  1125. for (port = 0; port < mv88e6xxx_num_ports(chip); port++) {
  1126. err = mv88e6xxx_port_add_broadcast(chip, port, vid);
  1127. if (err)
  1128. return err;
  1129. }
  1130. return 0;
  1131. }
  1132. static int _mv88e6xxx_port_vlan_add(struct mv88e6xxx_chip *chip, int port,
  1133. u16 vid, u8 member)
  1134. {
  1135. struct mv88e6xxx_vtu_entry vlan;
  1136. int err;
  1137. err = mv88e6xxx_vtu_get(chip, vid, &vlan, true);
  1138. if (err)
  1139. return err;
  1140. vlan.member[port] = member;
  1141. err = mv88e6xxx_vtu_loadpurge(chip, &vlan);
  1142. if (err)
  1143. return err;
  1144. return mv88e6xxx_broadcast_setup(chip, vid);
  1145. }
  1146. static void mv88e6xxx_port_vlan_add(struct dsa_switch *ds, int port,
  1147. const struct switchdev_obj_port_vlan *vlan)
  1148. {
  1149. struct mv88e6xxx_chip *chip = ds->priv;
  1150. bool untagged = vlan->flags & BRIDGE_VLAN_INFO_UNTAGGED;
  1151. bool pvid = vlan->flags & BRIDGE_VLAN_INFO_PVID;
  1152. u8 member;
  1153. u16 vid;
  1154. if (!chip->info->max_vid)
  1155. return;
  1156. if (dsa_is_dsa_port(ds, port) || dsa_is_cpu_port(ds, port))
  1157. member = MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_UNMODIFIED;
  1158. else if (untagged)
  1159. member = MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_UNTAGGED;
  1160. else
  1161. member = MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_TAGGED;
  1162. mutex_lock(&chip->reg_lock);
  1163. for (vid = vlan->vid_begin; vid <= vlan->vid_end; ++vid)
  1164. if (_mv88e6xxx_port_vlan_add(chip, port, vid, member))
  1165. dev_err(ds->dev, "p%d: failed to add VLAN %d%c\n", port,
  1166. vid, untagged ? 'u' : 't');
  1167. if (pvid && mv88e6xxx_port_set_pvid(chip, port, vlan->vid_end))
  1168. dev_err(ds->dev, "p%d: failed to set PVID %d\n", port,
  1169. vlan->vid_end);
  1170. mutex_unlock(&chip->reg_lock);
  1171. }
  1172. static int _mv88e6xxx_port_vlan_del(struct mv88e6xxx_chip *chip,
  1173. int port, u16 vid)
  1174. {
  1175. struct mv88e6xxx_vtu_entry vlan;
  1176. int i, err;
  1177. err = mv88e6xxx_vtu_get(chip, vid, &vlan, false);
  1178. if (err)
  1179. return err;
  1180. /* Tell switchdev if this VLAN is handled in software */
  1181. if (vlan.member[port] == MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_NON_MEMBER)
  1182. return -EOPNOTSUPP;
  1183. vlan.member[port] = MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_NON_MEMBER;
  1184. /* keep the VLAN unless all ports are excluded */
  1185. vlan.valid = false;
  1186. for (i = 0; i < mv88e6xxx_num_ports(chip); ++i) {
  1187. if (vlan.member[i] !=
  1188. MV88E6XXX_G1_VTU_DATA_MEMBER_TAG_NON_MEMBER) {
  1189. vlan.valid = true;
  1190. break;
  1191. }
  1192. }
  1193. err = mv88e6xxx_vtu_loadpurge(chip, &vlan);
  1194. if (err)
  1195. return err;
  1196. return mv88e6xxx_g1_atu_remove(chip, vlan.fid, port, false);
  1197. }
  1198. static int mv88e6xxx_port_vlan_del(struct dsa_switch *ds, int port,
  1199. const struct switchdev_obj_port_vlan *vlan)
  1200. {
  1201. struct mv88e6xxx_chip *chip = ds->priv;
  1202. u16 pvid, vid;
  1203. int err = 0;
  1204. if (!chip->info->max_vid)
  1205. return -EOPNOTSUPP;
  1206. mutex_lock(&chip->reg_lock);
  1207. err = mv88e6xxx_port_get_pvid(chip, port, &pvid);
  1208. if (err)
  1209. goto unlock;
  1210. for (vid = vlan->vid_begin; vid <= vlan->vid_end; ++vid) {
  1211. err = _mv88e6xxx_port_vlan_del(chip, port, vid);
  1212. if (err)
  1213. goto unlock;
  1214. if (vid == pvid) {
  1215. err = mv88e6xxx_port_set_pvid(chip, port, 0);
  1216. if (err)
  1217. goto unlock;
  1218. }
  1219. }
  1220. unlock:
  1221. mutex_unlock(&chip->reg_lock);
  1222. return err;
  1223. }
  1224. static int mv88e6xxx_port_fdb_add(struct dsa_switch *ds, int port,
  1225. const unsigned char *addr, u16 vid)
  1226. {
  1227. struct mv88e6xxx_chip *chip = ds->priv;
  1228. int err;
  1229. mutex_lock(&chip->reg_lock);
  1230. err = mv88e6xxx_port_db_load_purge(chip, port, addr, vid,
  1231. MV88E6XXX_G1_ATU_DATA_STATE_UC_STATIC);
  1232. mutex_unlock(&chip->reg_lock);
  1233. return err;
  1234. }
  1235. static int mv88e6xxx_port_fdb_del(struct dsa_switch *ds, int port,
  1236. const unsigned char *addr, u16 vid)
  1237. {
  1238. struct mv88e6xxx_chip *chip = ds->priv;
  1239. int err;
  1240. mutex_lock(&chip->reg_lock);
  1241. err = mv88e6xxx_port_db_load_purge(chip, port, addr, vid,
  1242. MV88E6XXX_G1_ATU_DATA_STATE_UNUSED);
  1243. mutex_unlock(&chip->reg_lock);
  1244. return err;
  1245. }
  1246. static int mv88e6xxx_port_db_dump_fid(struct mv88e6xxx_chip *chip,
  1247. u16 fid, u16 vid, int port,
  1248. dsa_fdb_dump_cb_t *cb, void *data)
  1249. {
  1250. struct mv88e6xxx_atu_entry addr;
  1251. bool is_static;
  1252. int err;
  1253. addr.state = MV88E6XXX_G1_ATU_DATA_STATE_UNUSED;
  1254. eth_broadcast_addr(addr.mac);
  1255. do {
  1256. mutex_lock(&chip->reg_lock);
  1257. err = mv88e6xxx_g1_atu_getnext(chip, fid, &addr);
  1258. mutex_unlock(&chip->reg_lock);
  1259. if (err)
  1260. return err;
  1261. if (addr.state == MV88E6XXX_G1_ATU_DATA_STATE_UNUSED)
  1262. break;
  1263. if (addr.trunk || (addr.portvec & BIT(port)) == 0)
  1264. continue;
  1265. if (!is_unicast_ether_addr(addr.mac))
  1266. continue;
  1267. is_static = (addr.state ==
  1268. MV88E6XXX_G1_ATU_DATA_STATE_UC_STATIC);
  1269. err = cb(addr.mac, vid, is_static, data);
  1270. if (err)
  1271. return err;
  1272. } while (!is_broadcast_ether_addr(addr.mac));
  1273. return err;
  1274. }
  1275. static int mv88e6xxx_port_db_dump(struct mv88e6xxx_chip *chip, int port,
  1276. dsa_fdb_dump_cb_t *cb, void *data)
  1277. {
  1278. struct mv88e6xxx_vtu_entry vlan = {
  1279. .vid = chip->info->max_vid,
  1280. };
  1281. u16 fid;
  1282. int err;
  1283. /* Dump port's default Filtering Information Database (VLAN ID 0) */
  1284. mutex_lock(&chip->reg_lock);
  1285. err = mv88e6xxx_port_get_fid(chip, port, &fid);
  1286. mutex_unlock(&chip->reg_lock);
  1287. if (err)
  1288. return err;
  1289. err = mv88e6xxx_port_db_dump_fid(chip, fid, 0, port, cb, data);
  1290. if (err)
  1291. return err;
  1292. /* Dump VLANs' Filtering Information Databases */
  1293. do {
  1294. mutex_lock(&chip->reg_lock);
  1295. err = mv88e6xxx_vtu_getnext(chip, &vlan);
  1296. mutex_unlock(&chip->reg_lock);
  1297. if (err)
  1298. return err;
  1299. if (!vlan.valid)
  1300. break;
  1301. err = mv88e6xxx_port_db_dump_fid(chip, vlan.fid, vlan.vid, port,
  1302. cb, data);
  1303. if (err)
  1304. return err;
  1305. } while (vlan.vid < chip->info->max_vid);
  1306. return err;
  1307. }
  1308. static int mv88e6xxx_port_fdb_dump(struct dsa_switch *ds, int port,
  1309. dsa_fdb_dump_cb_t *cb, void *data)
  1310. {
  1311. struct mv88e6xxx_chip *chip = ds->priv;
  1312. return mv88e6xxx_port_db_dump(chip, port, cb, data);
  1313. }
  1314. static int mv88e6xxx_bridge_map(struct mv88e6xxx_chip *chip,
  1315. struct net_device *br)
  1316. {
  1317. struct dsa_switch *ds;
  1318. int port;
  1319. int dev;
  1320. int err;
  1321. /* Remap the Port VLAN of each local bridge group member */
  1322. for (port = 0; port < mv88e6xxx_num_ports(chip); ++port) {
  1323. if (chip->ds->ports[port].bridge_dev == br) {
  1324. err = mv88e6xxx_port_vlan_map(chip, port);
  1325. if (err)
  1326. return err;
  1327. }
  1328. }
  1329. if (!mv88e6xxx_has_pvt(chip))
  1330. return 0;
  1331. /* Remap the Port VLAN of each cross-chip bridge group member */
  1332. for (dev = 0; dev < DSA_MAX_SWITCHES; ++dev) {
  1333. ds = chip->ds->dst->ds[dev];
  1334. if (!ds)
  1335. break;
  1336. for (port = 0; port < ds->num_ports; ++port) {
  1337. if (ds->ports[port].bridge_dev == br) {
  1338. err = mv88e6xxx_pvt_map(chip, dev, port);
  1339. if (err)
  1340. return err;
  1341. }
  1342. }
  1343. }
  1344. return 0;
  1345. }
  1346. static int mv88e6xxx_port_bridge_join(struct dsa_switch *ds, int port,
  1347. struct net_device *br)
  1348. {
  1349. struct mv88e6xxx_chip *chip = ds->priv;
  1350. int err;
  1351. mutex_lock(&chip->reg_lock);
  1352. err = mv88e6xxx_bridge_map(chip, br);
  1353. mutex_unlock(&chip->reg_lock);
  1354. return err;
  1355. }
  1356. static void mv88e6xxx_port_bridge_leave(struct dsa_switch *ds, int port,
  1357. struct net_device *br)
  1358. {
  1359. struct mv88e6xxx_chip *chip = ds->priv;
  1360. mutex_lock(&chip->reg_lock);
  1361. if (mv88e6xxx_bridge_map(chip, br) ||
  1362. mv88e6xxx_port_vlan_map(chip, port))
  1363. dev_err(ds->dev, "failed to remap in-chip Port VLAN\n");
  1364. mutex_unlock(&chip->reg_lock);
  1365. }
  1366. static int mv88e6xxx_crosschip_bridge_join(struct dsa_switch *ds, int dev,
  1367. int port, struct net_device *br)
  1368. {
  1369. struct mv88e6xxx_chip *chip = ds->priv;
  1370. int err;
  1371. if (!mv88e6xxx_has_pvt(chip))
  1372. return 0;
  1373. mutex_lock(&chip->reg_lock);
  1374. err = mv88e6xxx_pvt_map(chip, dev, port);
  1375. mutex_unlock(&chip->reg_lock);
  1376. return err;
  1377. }
  1378. static void mv88e6xxx_crosschip_bridge_leave(struct dsa_switch *ds, int dev,
  1379. int port, struct net_device *br)
  1380. {
  1381. struct mv88e6xxx_chip *chip = ds->priv;
  1382. if (!mv88e6xxx_has_pvt(chip))
  1383. return;
  1384. mutex_lock(&chip->reg_lock);
  1385. if (mv88e6xxx_pvt_map(chip, dev, port))
  1386. dev_err(ds->dev, "failed to remap cross-chip Port VLAN\n");
  1387. mutex_unlock(&chip->reg_lock);
  1388. }
  1389. static int mv88e6xxx_software_reset(struct mv88e6xxx_chip *chip)
  1390. {
  1391. if (chip->info->ops->reset)
  1392. return chip->info->ops->reset(chip);
  1393. return 0;
  1394. }
  1395. static void mv88e6xxx_hardware_reset(struct mv88e6xxx_chip *chip)
  1396. {
  1397. struct gpio_desc *gpiod = chip->reset;
  1398. /* If there is a GPIO connected to the reset pin, toggle it */
  1399. if (gpiod) {
  1400. gpiod_set_value_cansleep(gpiod, 1);
  1401. usleep_range(10000, 20000);
  1402. gpiod_set_value_cansleep(gpiod, 0);
  1403. usleep_range(10000, 20000);
  1404. }
  1405. }
  1406. static int mv88e6xxx_disable_ports(struct mv88e6xxx_chip *chip)
  1407. {
  1408. int i, err;
  1409. /* Set all ports to the Disabled state */
  1410. for (i = 0; i < mv88e6xxx_num_ports(chip); i++) {
  1411. err = mv88e6xxx_port_set_state(chip, i, BR_STATE_DISABLED);
  1412. if (err)
  1413. return err;
  1414. }
  1415. /* Wait for transmit queues to drain,
  1416. * i.e. 2ms for a maximum frame to be transmitted at 10 Mbps.
  1417. */
  1418. usleep_range(2000, 4000);
  1419. return 0;
  1420. }
  1421. static int mv88e6xxx_switch_reset(struct mv88e6xxx_chip *chip)
  1422. {
  1423. int err;
  1424. err = mv88e6xxx_disable_ports(chip);
  1425. if (err)
  1426. return err;
  1427. mv88e6xxx_hardware_reset(chip);
  1428. return mv88e6xxx_software_reset(chip);
  1429. }
  1430. static int mv88e6xxx_set_port_mode(struct mv88e6xxx_chip *chip, int port,
  1431. enum mv88e6xxx_frame_mode frame,
  1432. enum mv88e6xxx_egress_mode egress, u16 etype)
  1433. {
  1434. int err;
  1435. if (!chip->info->ops->port_set_frame_mode)
  1436. return -EOPNOTSUPP;
  1437. err = mv88e6xxx_port_set_egress_mode(chip, port, egress);
  1438. if (err)
  1439. return err;
  1440. err = chip->info->ops->port_set_frame_mode(chip, port, frame);
  1441. if (err)
  1442. return err;
  1443. if (chip->info->ops->port_set_ether_type)
  1444. return chip->info->ops->port_set_ether_type(chip, port, etype);
  1445. return 0;
  1446. }
  1447. static int mv88e6xxx_set_port_mode_normal(struct mv88e6xxx_chip *chip, int port)
  1448. {
  1449. return mv88e6xxx_set_port_mode(chip, port, MV88E6XXX_FRAME_MODE_NORMAL,
  1450. MV88E6XXX_EGRESS_MODE_UNMODIFIED,
  1451. MV88E6XXX_PORT_ETH_TYPE_DEFAULT);
  1452. }
  1453. static int mv88e6xxx_set_port_mode_dsa(struct mv88e6xxx_chip *chip, int port)
  1454. {
  1455. return mv88e6xxx_set_port_mode(chip, port, MV88E6XXX_FRAME_MODE_DSA,
  1456. MV88E6XXX_EGRESS_MODE_UNMODIFIED,
  1457. MV88E6XXX_PORT_ETH_TYPE_DEFAULT);
  1458. }
  1459. static int mv88e6xxx_set_port_mode_edsa(struct mv88e6xxx_chip *chip, int port)
  1460. {
  1461. return mv88e6xxx_set_port_mode(chip, port,
  1462. MV88E6XXX_FRAME_MODE_ETHERTYPE,
  1463. MV88E6XXX_EGRESS_MODE_ETHERTYPE,
  1464. ETH_P_EDSA);
  1465. }
  1466. static int mv88e6xxx_setup_port_mode(struct mv88e6xxx_chip *chip, int port)
  1467. {
  1468. if (dsa_is_dsa_port(chip->ds, port))
  1469. return mv88e6xxx_set_port_mode_dsa(chip, port);
  1470. if (dsa_is_user_port(chip->ds, port))
  1471. return mv88e6xxx_set_port_mode_normal(chip, port);
  1472. /* Setup CPU port mode depending on its supported tag format */
  1473. if (chip->info->tag_protocol == DSA_TAG_PROTO_DSA)
  1474. return mv88e6xxx_set_port_mode_dsa(chip, port);
  1475. if (chip->info->tag_protocol == DSA_TAG_PROTO_EDSA)
  1476. return mv88e6xxx_set_port_mode_edsa(chip, port);
  1477. return -EINVAL;
  1478. }
  1479. static int mv88e6xxx_setup_message_port(struct mv88e6xxx_chip *chip, int port)
  1480. {
  1481. bool message = dsa_is_dsa_port(chip->ds, port);
  1482. return mv88e6xxx_port_set_message_port(chip, port, message);
  1483. }
  1484. static int mv88e6xxx_setup_egress_floods(struct mv88e6xxx_chip *chip, int port)
  1485. {
  1486. struct dsa_switch *ds = chip->ds;
  1487. bool flood;
  1488. /* Upstream ports flood frames with unknown unicast or multicast DA */
  1489. flood = dsa_is_cpu_port(ds, port) || dsa_is_dsa_port(ds, port);
  1490. if (chip->info->ops->port_set_egress_floods)
  1491. return chip->info->ops->port_set_egress_floods(chip, port,
  1492. flood, flood);
  1493. return 0;
  1494. }
  1495. static int mv88e6xxx_serdes_power(struct mv88e6xxx_chip *chip, int port,
  1496. bool on)
  1497. {
  1498. if (chip->info->ops->serdes_power)
  1499. return chip->info->ops->serdes_power(chip, port, on);
  1500. return 0;
  1501. }
  1502. static int mv88e6xxx_setup_upstream_port(struct mv88e6xxx_chip *chip, int port)
  1503. {
  1504. struct dsa_switch *ds = chip->ds;
  1505. int upstream_port;
  1506. int err;
  1507. upstream_port = dsa_upstream_port(ds, port);
  1508. if (chip->info->ops->port_set_upstream_port) {
  1509. err = chip->info->ops->port_set_upstream_port(chip, port,
  1510. upstream_port);
  1511. if (err)
  1512. return err;
  1513. }
  1514. if (port == upstream_port) {
  1515. if (chip->info->ops->set_cpu_port) {
  1516. err = chip->info->ops->set_cpu_port(chip,
  1517. upstream_port);
  1518. if (err)
  1519. return err;
  1520. }
  1521. if (chip->info->ops->set_egress_port) {
  1522. err = chip->info->ops->set_egress_port(chip,
  1523. upstream_port);
  1524. if (err)
  1525. return err;
  1526. }
  1527. }
  1528. return 0;
  1529. }
  1530. static int mv88e6xxx_setup_port(struct mv88e6xxx_chip *chip, int port)
  1531. {
  1532. struct dsa_switch *ds = chip->ds;
  1533. int err;
  1534. u16 reg;
  1535. /* MAC Forcing register: don't force link, speed, duplex or flow control
  1536. * state to any particular values on physical ports, but force the CPU
  1537. * port and all DSA ports to their maximum bandwidth and full duplex.
  1538. */
  1539. if (dsa_is_cpu_port(ds, port) || dsa_is_dsa_port(ds, port))
  1540. err = mv88e6xxx_port_setup_mac(chip, port, LINK_FORCED_UP,
  1541. SPEED_MAX, DUPLEX_FULL,
  1542. PHY_INTERFACE_MODE_NA);
  1543. else
  1544. err = mv88e6xxx_port_setup_mac(chip, port, LINK_UNFORCED,
  1545. SPEED_UNFORCED, DUPLEX_UNFORCED,
  1546. PHY_INTERFACE_MODE_NA);
  1547. if (err)
  1548. return err;
  1549. /* Port Control: disable Drop-on-Unlock, disable Drop-on-Lock,
  1550. * disable Header mode, enable IGMP/MLD snooping, disable VLAN
  1551. * tunneling, determine priority by looking at 802.1p and IP
  1552. * priority fields (IP prio has precedence), and set STP state
  1553. * to Forwarding.
  1554. *
  1555. * If this is the CPU link, use DSA or EDSA tagging depending
  1556. * on which tagging mode was configured.
  1557. *
  1558. * If this is a link to another switch, use DSA tagging mode.
  1559. *
  1560. * If this is the upstream port for this switch, enable
  1561. * forwarding of unknown unicasts and multicasts.
  1562. */
  1563. reg = MV88E6XXX_PORT_CTL0_IGMP_MLD_SNOOP |
  1564. MV88E6185_PORT_CTL0_USE_TAG | MV88E6185_PORT_CTL0_USE_IP |
  1565. MV88E6XXX_PORT_CTL0_STATE_FORWARDING;
  1566. err = mv88e6xxx_port_write(chip, port, MV88E6XXX_PORT_CTL0, reg);
  1567. if (err)
  1568. return err;
  1569. err = mv88e6xxx_setup_port_mode(chip, port);
  1570. if (err)
  1571. return err;
  1572. err = mv88e6xxx_setup_egress_floods(chip, port);
  1573. if (err)
  1574. return err;
  1575. /* Enable the SERDES interface for DSA and CPU ports. Normal
  1576. * ports SERDES are enabled when the port is enabled, thus
  1577. * saving a bit of power.
  1578. */
  1579. if ((dsa_is_cpu_port(ds, port) || dsa_is_dsa_port(ds, port))) {
  1580. err = mv88e6xxx_serdes_power(chip, port, true);
  1581. if (err)
  1582. return err;
  1583. }
  1584. /* Port Control 2: don't force a good FCS, set the maximum frame size to
  1585. * 10240 bytes, disable 802.1q tags checking, don't discard tagged or
  1586. * untagged frames on this port, do a destination address lookup on all
  1587. * received packets as usual, disable ARP mirroring and don't send a
  1588. * copy of all transmitted/received frames on this port to the CPU.
  1589. */
  1590. err = mv88e6xxx_port_set_map_da(chip, port);
  1591. if (err)
  1592. return err;
  1593. err = mv88e6xxx_setup_upstream_port(chip, port);
  1594. if (err)
  1595. return err;
  1596. err = mv88e6xxx_port_set_8021q_mode(chip, port,
  1597. MV88E6XXX_PORT_CTL2_8021Q_MODE_DISABLED);
  1598. if (err)
  1599. return err;
  1600. if (chip->info->ops->port_set_jumbo_size) {
  1601. err = chip->info->ops->port_set_jumbo_size(chip, port, 10240);
  1602. if (err)
  1603. return err;
  1604. }
  1605. /* Port Association Vector: when learning source addresses
  1606. * of packets, add the address to the address database using
  1607. * a port bitmap that has only the bit for this port set and
  1608. * the other bits clear.
  1609. */
  1610. reg = 1 << port;
  1611. /* Disable learning for CPU port */
  1612. if (dsa_is_cpu_port(ds, port))
  1613. reg = 0;
  1614. err = mv88e6xxx_port_write(chip, port, MV88E6XXX_PORT_ASSOC_VECTOR,
  1615. reg);
  1616. if (err)
  1617. return err;
  1618. /* Egress rate control 2: disable egress rate control. */
  1619. err = mv88e6xxx_port_write(chip, port, MV88E6XXX_PORT_EGRESS_RATE_CTL2,
  1620. 0x0000);
  1621. if (err)
  1622. return err;
  1623. if (chip->info->ops->port_pause_limit) {
  1624. err = chip->info->ops->port_pause_limit(chip, port, 0, 0);
  1625. if (err)
  1626. return err;
  1627. }
  1628. if (chip->info->ops->port_disable_learn_limit) {
  1629. err = chip->info->ops->port_disable_learn_limit(chip, port);
  1630. if (err)
  1631. return err;
  1632. }
  1633. if (chip->info->ops->port_disable_pri_override) {
  1634. err = chip->info->ops->port_disable_pri_override(chip, port);
  1635. if (err)
  1636. return err;
  1637. }
  1638. if (chip->info->ops->port_tag_remap) {
  1639. err = chip->info->ops->port_tag_remap(chip, port);
  1640. if (err)
  1641. return err;
  1642. }
  1643. if (chip->info->ops->port_egress_rate_limiting) {
  1644. err = chip->info->ops->port_egress_rate_limiting(chip, port);
  1645. if (err)
  1646. return err;
  1647. }
  1648. err = mv88e6xxx_setup_message_port(chip, port);
  1649. if (err)
  1650. return err;
  1651. /* Port based VLAN map: give each port the same default address
  1652. * database, and allow bidirectional communication between the
  1653. * CPU and DSA port(s), and the other ports.
  1654. */
  1655. err = mv88e6xxx_port_set_fid(chip, port, 0);
  1656. if (err)
  1657. return err;
  1658. err = mv88e6xxx_port_vlan_map(chip, port);
  1659. if (err)
  1660. return err;
  1661. /* Default VLAN ID and priority: don't set a default VLAN
  1662. * ID, and set the default packet priority to zero.
  1663. */
  1664. return mv88e6xxx_port_write(chip, port, MV88E6XXX_PORT_DEFAULT_VLAN, 0);
  1665. }
  1666. static int mv88e6xxx_port_enable(struct dsa_switch *ds, int port,
  1667. struct phy_device *phydev)
  1668. {
  1669. struct mv88e6xxx_chip *chip = ds->priv;
  1670. int err;
  1671. mutex_lock(&chip->reg_lock);
  1672. err = mv88e6xxx_serdes_power(chip, port, true);
  1673. mutex_unlock(&chip->reg_lock);
  1674. return err;
  1675. }
  1676. static void mv88e6xxx_port_disable(struct dsa_switch *ds, int port,
  1677. struct phy_device *phydev)
  1678. {
  1679. struct mv88e6xxx_chip *chip = ds->priv;
  1680. mutex_lock(&chip->reg_lock);
  1681. if (mv88e6xxx_serdes_power(chip, port, false))
  1682. dev_err(chip->dev, "failed to power off SERDES\n");
  1683. mutex_unlock(&chip->reg_lock);
  1684. }
  1685. static int mv88e6xxx_set_ageing_time(struct dsa_switch *ds,
  1686. unsigned int ageing_time)
  1687. {
  1688. struct mv88e6xxx_chip *chip = ds->priv;
  1689. int err;
  1690. mutex_lock(&chip->reg_lock);
  1691. err = mv88e6xxx_g1_atu_set_age_time(chip, ageing_time);
  1692. mutex_unlock(&chip->reg_lock);
  1693. return err;
  1694. }
  1695. static int mv88e6xxx_g1_setup(struct mv88e6xxx_chip *chip)
  1696. {
  1697. struct dsa_switch *ds = chip->ds;
  1698. int err;
  1699. /* Disable remote management, and set the switch's DSA device number. */
  1700. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_CTL2,
  1701. MV88E6XXX_G1_CTL2_MULTIPLE_CASCADE |
  1702. (ds->index & 0x1f));
  1703. if (err)
  1704. return err;
  1705. /* Configure the IP ToS mapping registers. */
  1706. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IP_PRI_0, 0x0000);
  1707. if (err)
  1708. return err;
  1709. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IP_PRI_1, 0x0000);
  1710. if (err)
  1711. return err;
  1712. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IP_PRI_2, 0x5555);
  1713. if (err)
  1714. return err;
  1715. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IP_PRI_3, 0x5555);
  1716. if (err)
  1717. return err;
  1718. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IP_PRI_4, 0xaaaa);
  1719. if (err)
  1720. return err;
  1721. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IP_PRI_5, 0xaaaa);
  1722. if (err)
  1723. return err;
  1724. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IP_PRI_6, 0xffff);
  1725. if (err)
  1726. return err;
  1727. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IP_PRI_7, 0xffff);
  1728. if (err)
  1729. return err;
  1730. /* Configure the IEEE 802.1p priority mapping register. */
  1731. err = mv88e6xxx_g1_write(chip, MV88E6XXX_G1_IEEE_PRI, 0xfa41);
  1732. if (err)
  1733. return err;
  1734. /* Initialize the statistics unit */
  1735. err = mv88e6xxx_stats_set_histogram(chip);
  1736. if (err)
  1737. return err;
  1738. return mv88e6xxx_g1_stats_clear(chip);
  1739. }
  1740. static int mv88e6xxx_setup(struct dsa_switch *ds)
  1741. {
  1742. struct mv88e6xxx_chip *chip = ds->priv;
  1743. int err;
  1744. int i;
  1745. chip->ds = ds;
  1746. ds->slave_mii_bus = mv88e6xxx_default_mdio_bus(chip);
  1747. mutex_lock(&chip->reg_lock);
  1748. /* Setup Switch Port Registers */
  1749. for (i = 0; i < mv88e6xxx_num_ports(chip); i++) {
  1750. if (dsa_is_unused_port(ds, i))
  1751. continue;
  1752. err = mv88e6xxx_setup_port(chip, i);
  1753. if (err)
  1754. goto unlock;
  1755. }
  1756. /* Setup Switch Global 1 Registers */
  1757. err = mv88e6xxx_g1_setup(chip);
  1758. if (err)
  1759. goto unlock;
  1760. /* Setup Switch Global 2 Registers */
  1761. if (chip->info->global2_addr) {
  1762. err = mv88e6xxx_g2_setup(chip);
  1763. if (err)
  1764. goto unlock;
  1765. }
  1766. err = mv88e6xxx_irl_setup(chip);
  1767. if (err)
  1768. goto unlock;
  1769. err = mv88e6xxx_mac_setup(chip);
  1770. if (err)
  1771. goto unlock;
  1772. err = mv88e6xxx_phy_setup(chip);
  1773. if (err)
  1774. goto unlock;
  1775. err = mv88e6xxx_vtu_setup(chip);
  1776. if (err)
  1777. goto unlock;
  1778. err = mv88e6xxx_pvt_setup(chip);
  1779. if (err)
  1780. goto unlock;
  1781. err = mv88e6xxx_atu_setup(chip);
  1782. if (err)
  1783. goto unlock;
  1784. err = mv88e6xxx_broadcast_setup(chip, 0);
  1785. if (err)
  1786. goto unlock;
  1787. err = mv88e6xxx_pot_setup(chip);
  1788. if (err)
  1789. goto unlock;
  1790. err = mv88e6xxx_rsvd2cpu_setup(chip);
  1791. if (err)
  1792. goto unlock;
  1793. /* Setup PTP Hardware Clock and timestamping */
  1794. if (chip->info->ptp_support) {
  1795. err = mv88e6xxx_ptp_setup(chip);
  1796. if (err)
  1797. goto unlock;
  1798. err = mv88e6xxx_hwtstamp_setup(chip);
  1799. if (err)
  1800. goto unlock;
  1801. }
  1802. unlock:
  1803. mutex_unlock(&chip->reg_lock);
  1804. return err;
  1805. }
  1806. static int mv88e6xxx_mdio_read(struct mii_bus *bus, int phy, int reg)
  1807. {
  1808. struct mv88e6xxx_mdio_bus *mdio_bus = bus->priv;
  1809. struct mv88e6xxx_chip *chip = mdio_bus->chip;
  1810. u16 val;
  1811. int err;
  1812. if (!chip->info->ops->phy_read)
  1813. return -EOPNOTSUPP;
  1814. mutex_lock(&chip->reg_lock);
  1815. err = chip->info->ops->phy_read(chip, bus, phy, reg, &val);
  1816. mutex_unlock(&chip->reg_lock);
  1817. if (reg == MII_PHYSID2) {
  1818. /* Some internal PHYS don't have a model number. Use
  1819. * the mv88e6390 family model number instead.
  1820. */
  1821. if (!(val & 0x3f0))
  1822. val |= MV88E6XXX_PORT_SWITCH_ID_PROD_6390 >> 4;
  1823. }
  1824. return err ? err : val;
  1825. }
  1826. static int mv88e6xxx_mdio_write(struct mii_bus *bus, int phy, int reg, u16 val)
  1827. {
  1828. struct mv88e6xxx_mdio_bus *mdio_bus = bus->priv;
  1829. struct mv88e6xxx_chip *chip = mdio_bus->chip;
  1830. int err;
  1831. if (!chip->info->ops->phy_write)
  1832. return -EOPNOTSUPP;
  1833. mutex_lock(&chip->reg_lock);
  1834. err = chip->info->ops->phy_write(chip, bus, phy, reg, val);
  1835. mutex_unlock(&chip->reg_lock);
  1836. return err;
  1837. }
  1838. static int mv88e6xxx_mdio_register(struct mv88e6xxx_chip *chip,
  1839. struct device_node *np,
  1840. bool external)
  1841. {
  1842. static int index;
  1843. struct mv88e6xxx_mdio_bus *mdio_bus;
  1844. struct mii_bus *bus;
  1845. int err;
  1846. if (external) {
  1847. mutex_lock(&chip->reg_lock);
  1848. err = mv88e6xxx_g2_scratch_gpio_set_smi(chip, true);
  1849. mutex_unlock(&chip->reg_lock);
  1850. if (err)
  1851. return err;
  1852. }
  1853. bus = devm_mdiobus_alloc_size(chip->dev, sizeof(*mdio_bus));
  1854. if (!bus)
  1855. return -ENOMEM;
  1856. mdio_bus = bus->priv;
  1857. mdio_bus->bus = bus;
  1858. mdio_bus->chip = chip;
  1859. INIT_LIST_HEAD(&mdio_bus->list);
  1860. mdio_bus->external = external;
  1861. if (np) {
  1862. bus->name = np->full_name;
  1863. snprintf(bus->id, MII_BUS_ID_SIZE, "%pOF", np);
  1864. } else {
  1865. bus->name = "mv88e6xxx SMI";
  1866. snprintf(bus->id, MII_BUS_ID_SIZE, "mv88e6xxx-%d", index++);
  1867. }
  1868. bus->read = mv88e6xxx_mdio_read;
  1869. bus->write = mv88e6xxx_mdio_write;
  1870. bus->parent = chip->dev;
  1871. if (!external) {
  1872. err = mv88e6xxx_g2_irq_mdio_setup(chip, bus);
  1873. if (err)
  1874. return err;
  1875. }
  1876. if (np)
  1877. err = of_mdiobus_register(bus, np);
  1878. else
  1879. err = mdiobus_register(bus);
  1880. if (err) {
  1881. dev_err(chip->dev, "Cannot register MDIO bus (%d)\n", err);
  1882. mv88e6xxx_g2_irq_mdio_free(chip, bus);
  1883. return err;
  1884. }
  1885. if (external)
  1886. list_add_tail(&mdio_bus->list, &chip->mdios);
  1887. else
  1888. list_add(&mdio_bus->list, &chip->mdios);
  1889. return 0;
  1890. }
  1891. static const struct of_device_id mv88e6xxx_mdio_external_match[] = {
  1892. { .compatible = "marvell,mv88e6xxx-mdio-external",
  1893. .data = (void *)true },
  1894. { },
  1895. };
  1896. static void mv88e6xxx_mdios_unregister(struct mv88e6xxx_chip *chip)
  1897. {
  1898. struct mv88e6xxx_mdio_bus *mdio_bus;
  1899. struct mii_bus *bus;
  1900. list_for_each_entry(mdio_bus, &chip->mdios, list) {
  1901. bus = mdio_bus->bus;
  1902. if (!mdio_bus->external)
  1903. mv88e6xxx_g2_irq_mdio_free(chip, bus);
  1904. mdiobus_unregister(bus);
  1905. }
  1906. }
  1907. static int mv88e6xxx_mdios_register(struct mv88e6xxx_chip *chip,
  1908. struct device_node *np)
  1909. {
  1910. const struct of_device_id *match;
  1911. struct device_node *child;
  1912. int err;
  1913. /* Always register one mdio bus for the internal/default mdio
  1914. * bus. This maybe represented in the device tree, but is
  1915. * optional.
  1916. */
  1917. child = of_get_child_by_name(np, "mdio");
  1918. err = mv88e6xxx_mdio_register(chip, child, false);
  1919. if (err)
  1920. return err;
  1921. /* Walk the device tree, and see if there are any other nodes
  1922. * which say they are compatible with the external mdio
  1923. * bus.
  1924. */
  1925. for_each_available_child_of_node(np, child) {
  1926. match = of_match_node(mv88e6xxx_mdio_external_match, child);
  1927. if (match) {
  1928. err = mv88e6xxx_mdio_register(chip, child, true);
  1929. if (err) {
  1930. mv88e6xxx_mdios_unregister(chip);
  1931. return err;
  1932. }
  1933. }
  1934. }
  1935. return 0;
  1936. }
  1937. static int mv88e6xxx_get_eeprom_len(struct dsa_switch *ds)
  1938. {
  1939. struct mv88e6xxx_chip *chip = ds->priv;
  1940. return chip->eeprom_len;
  1941. }
  1942. static int mv88e6xxx_get_eeprom(struct dsa_switch *ds,
  1943. struct ethtool_eeprom *eeprom, u8 *data)
  1944. {
  1945. struct mv88e6xxx_chip *chip = ds->priv;
  1946. int err;
  1947. if (!chip->info->ops->get_eeprom)
  1948. return -EOPNOTSUPP;
  1949. mutex_lock(&chip->reg_lock);
  1950. err = chip->info->ops->get_eeprom(chip, eeprom, data);
  1951. mutex_unlock(&chip->reg_lock);
  1952. if (err)
  1953. return err;
  1954. eeprom->magic = 0xc3ec4951;
  1955. return 0;
  1956. }
  1957. static int mv88e6xxx_set_eeprom(struct dsa_switch *ds,
  1958. struct ethtool_eeprom *eeprom, u8 *data)
  1959. {
  1960. struct mv88e6xxx_chip *chip = ds->priv;
  1961. int err;
  1962. if (!chip->info->ops->set_eeprom)
  1963. return -EOPNOTSUPP;
  1964. if (eeprom->magic != 0xc3ec4951)
  1965. return -EINVAL;
  1966. mutex_lock(&chip->reg_lock);
  1967. err = chip->info->ops->set_eeprom(chip, eeprom, data);
  1968. mutex_unlock(&chip->reg_lock);
  1969. return err;
  1970. }
  1971. static const struct mv88e6xxx_ops mv88e6085_ops = {
  1972. /* MV88E6XXX_FAMILY_6097 */
  1973. .irl_init_all = mv88e6352_g2_irl_init_all,
  1974. .set_switch_mac = mv88e6xxx_g1_set_switch_mac,
  1975. .phy_read = mv88e6185_phy_ppu_read,
  1976. .phy_write = mv88e6185_phy_ppu_write,
  1977. .port_set_link = mv88e6xxx_port_set_link,
  1978. .port_set_duplex = mv88e6xxx_port_set_duplex,
  1979. .port_set_speed = mv88e6185_port_set_speed,
  1980. .port_tag_remap = mv88e6095_port_tag_remap,
  1981. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  1982. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  1983. .port_set_ether_type = mv88e6351_port_set_ether_type,
  1984. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  1985. .port_pause_limit = mv88e6097_port_pause_limit,
  1986. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  1987. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  1988. .stats_snapshot = mv88e6xxx_g1_stats_snapshot,
  1989. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  1990. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  1991. .stats_get_strings = mv88e6095_stats_get_strings,
  1992. .stats_get_stats = mv88e6095_stats_get_stats,
  1993. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  1994. .set_egress_port = mv88e6095_g1_set_egress_port,
  1995. .watchdog_ops = &mv88e6097_watchdog_ops,
  1996. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  1997. .pot_clear = mv88e6xxx_g2_pot_clear,
  1998. .ppu_enable = mv88e6185_g1_ppu_enable,
  1999. .ppu_disable = mv88e6185_g1_ppu_disable,
  2000. .reset = mv88e6185_g1_reset,
  2001. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2002. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2003. };
  2004. static const struct mv88e6xxx_ops mv88e6095_ops = {
  2005. /* MV88E6XXX_FAMILY_6095 */
  2006. .set_switch_mac = mv88e6xxx_g1_set_switch_mac,
  2007. .phy_read = mv88e6185_phy_ppu_read,
  2008. .phy_write = mv88e6185_phy_ppu_write,
  2009. .port_set_link = mv88e6xxx_port_set_link,
  2010. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2011. .port_set_speed = mv88e6185_port_set_speed,
  2012. .port_set_frame_mode = mv88e6085_port_set_frame_mode,
  2013. .port_set_egress_floods = mv88e6185_port_set_egress_floods,
  2014. .port_set_upstream_port = mv88e6095_port_set_upstream_port,
  2015. .stats_snapshot = mv88e6xxx_g1_stats_snapshot,
  2016. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2017. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2018. .stats_get_strings = mv88e6095_stats_get_strings,
  2019. .stats_get_stats = mv88e6095_stats_get_stats,
  2020. .mgmt_rsvd2cpu = mv88e6185_g2_mgmt_rsvd2cpu,
  2021. .ppu_enable = mv88e6185_g1_ppu_enable,
  2022. .ppu_disable = mv88e6185_g1_ppu_disable,
  2023. .reset = mv88e6185_g1_reset,
  2024. .vtu_getnext = mv88e6185_g1_vtu_getnext,
  2025. .vtu_loadpurge = mv88e6185_g1_vtu_loadpurge,
  2026. };
  2027. static const struct mv88e6xxx_ops mv88e6097_ops = {
  2028. /* MV88E6XXX_FAMILY_6097 */
  2029. .irl_init_all = mv88e6352_g2_irl_init_all,
  2030. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2031. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2032. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2033. .port_set_link = mv88e6xxx_port_set_link,
  2034. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2035. .port_set_speed = mv88e6185_port_set_speed,
  2036. .port_tag_remap = mv88e6095_port_tag_remap,
  2037. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2038. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2039. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2040. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2041. .port_egress_rate_limiting = mv88e6095_port_egress_rate_limiting,
  2042. .port_pause_limit = mv88e6097_port_pause_limit,
  2043. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2044. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2045. .stats_snapshot = mv88e6xxx_g1_stats_snapshot,
  2046. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2047. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2048. .stats_get_strings = mv88e6095_stats_get_strings,
  2049. .stats_get_stats = mv88e6095_stats_get_stats,
  2050. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2051. .set_egress_port = mv88e6095_g1_set_egress_port,
  2052. .watchdog_ops = &mv88e6097_watchdog_ops,
  2053. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2054. .pot_clear = mv88e6xxx_g2_pot_clear,
  2055. .reset = mv88e6352_g1_reset,
  2056. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2057. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2058. };
  2059. static const struct mv88e6xxx_ops mv88e6123_ops = {
  2060. /* MV88E6XXX_FAMILY_6165 */
  2061. .irl_init_all = mv88e6352_g2_irl_init_all,
  2062. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2063. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2064. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2065. .port_set_link = mv88e6xxx_port_set_link,
  2066. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2067. .port_set_speed = mv88e6185_port_set_speed,
  2068. .port_set_frame_mode = mv88e6085_port_set_frame_mode,
  2069. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2070. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2071. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2072. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2073. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2074. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2075. .stats_get_strings = mv88e6095_stats_get_strings,
  2076. .stats_get_stats = mv88e6095_stats_get_stats,
  2077. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2078. .set_egress_port = mv88e6095_g1_set_egress_port,
  2079. .watchdog_ops = &mv88e6097_watchdog_ops,
  2080. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2081. .pot_clear = mv88e6xxx_g2_pot_clear,
  2082. .reset = mv88e6352_g1_reset,
  2083. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2084. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2085. };
  2086. static const struct mv88e6xxx_ops mv88e6131_ops = {
  2087. /* MV88E6XXX_FAMILY_6185 */
  2088. .set_switch_mac = mv88e6xxx_g1_set_switch_mac,
  2089. .phy_read = mv88e6185_phy_ppu_read,
  2090. .phy_write = mv88e6185_phy_ppu_write,
  2091. .port_set_link = mv88e6xxx_port_set_link,
  2092. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2093. .port_set_speed = mv88e6185_port_set_speed,
  2094. .port_tag_remap = mv88e6095_port_tag_remap,
  2095. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2096. .port_set_egress_floods = mv88e6185_port_set_egress_floods,
  2097. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2098. .port_set_upstream_port = mv88e6095_port_set_upstream_port,
  2099. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2100. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2101. .port_pause_limit = mv88e6097_port_pause_limit,
  2102. .stats_snapshot = mv88e6xxx_g1_stats_snapshot,
  2103. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2104. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2105. .stats_get_strings = mv88e6095_stats_get_strings,
  2106. .stats_get_stats = mv88e6095_stats_get_stats,
  2107. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2108. .set_egress_port = mv88e6095_g1_set_egress_port,
  2109. .watchdog_ops = &mv88e6097_watchdog_ops,
  2110. .mgmt_rsvd2cpu = mv88e6185_g2_mgmt_rsvd2cpu,
  2111. .ppu_enable = mv88e6185_g1_ppu_enable,
  2112. .ppu_disable = mv88e6185_g1_ppu_disable,
  2113. .reset = mv88e6185_g1_reset,
  2114. .vtu_getnext = mv88e6185_g1_vtu_getnext,
  2115. .vtu_loadpurge = mv88e6185_g1_vtu_loadpurge,
  2116. };
  2117. static const struct mv88e6xxx_ops mv88e6141_ops = {
  2118. /* MV88E6XXX_FAMILY_6341 */
  2119. .irl_init_all = mv88e6352_g2_irl_init_all,
  2120. .get_eeprom = mv88e6xxx_g2_get_eeprom8,
  2121. .set_eeprom = mv88e6xxx_g2_set_eeprom8,
  2122. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2123. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2124. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2125. .port_set_link = mv88e6xxx_port_set_link,
  2126. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2127. .port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
  2128. .port_set_speed = mv88e6390_port_set_speed,
  2129. .port_tag_remap = mv88e6095_port_tag_remap,
  2130. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2131. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2132. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2133. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2134. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2135. .port_pause_limit = mv88e6097_port_pause_limit,
  2136. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2137. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2138. .stats_snapshot = mv88e6390_g1_stats_snapshot,
  2139. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2140. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2141. .stats_get_strings = mv88e6320_stats_get_strings,
  2142. .stats_get_stats = mv88e6390_stats_get_stats,
  2143. .set_cpu_port = mv88e6390_g1_set_cpu_port,
  2144. .set_egress_port = mv88e6390_g1_set_egress_port,
  2145. .watchdog_ops = &mv88e6390_watchdog_ops,
  2146. .mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
  2147. .pot_clear = mv88e6xxx_g2_pot_clear,
  2148. .reset = mv88e6352_g1_reset,
  2149. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2150. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2151. .gpio_ops = &mv88e6352_gpio_ops,
  2152. };
  2153. static const struct mv88e6xxx_ops mv88e6161_ops = {
  2154. /* MV88E6XXX_FAMILY_6165 */
  2155. .irl_init_all = mv88e6352_g2_irl_init_all,
  2156. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2157. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2158. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2159. .port_set_link = mv88e6xxx_port_set_link,
  2160. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2161. .port_set_speed = mv88e6185_port_set_speed,
  2162. .port_tag_remap = mv88e6095_port_tag_remap,
  2163. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2164. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2165. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2166. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2167. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2168. .port_pause_limit = mv88e6097_port_pause_limit,
  2169. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2170. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2171. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2172. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2173. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2174. .stats_get_strings = mv88e6095_stats_get_strings,
  2175. .stats_get_stats = mv88e6095_stats_get_stats,
  2176. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2177. .set_egress_port = mv88e6095_g1_set_egress_port,
  2178. .watchdog_ops = &mv88e6097_watchdog_ops,
  2179. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2180. .pot_clear = mv88e6xxx_g2_pot_clear,
  2181. .reset = mv88e6352_g1_reset,
  2182. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2183. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2184. };
  2185. static const struct mv88e6xxx_ops mv88e6165_ops = {
  2186. /* MV88E6XXX_FAMILY_6165 */
  2187. .irl_init_all = mv88e6352_g2_irl_init_all,
  2188. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2189. .phy_read = mv88e6165_phy_read,
  2190. .phy_write = mv88e6165_phy_write,
  2191. .port_set_link = mv88e6xxx_port_set_link,
  2192. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2193. .port_set_speed = mv88e6185_port_set_speed,
  2194. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2195. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2196. .stats_snapshot = mv88e6xxx_g1_stats_snapshot,
  2197. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2198. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2199. .stats_get_strings = mv88e6095_stats_get_strings,
  2200. .stats_get_stats = mv88e6095_stats_get_stats,
  2201. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2202. .set_egress_port = mv88e6095_g1_set_egress_port,
  2203. .watchdog_ops = &mv88e6097_watchdog_ops,
  2204. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2205. .pot_clear = mv88e6xxx_g2_pot_clear,
  2206. .reset = mv88e6352_g1_reset,
  2207. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2208. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2209. };
  2210. static const struct mv88e6xxx_ops mv88e6171_ops = {
  2211. /* MV88E6XXX_FAMILY_6351 */
  2212. .irl_init_all = mv88e6352_g2_irl_init_all,
  2213. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2214. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2215. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2216. .port_set_link = mv88e6xxx_port_set_link,
  2217. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2218. .port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
  2219. .port_set_speed = mv88e6185_port_set_speed,
  2220. .port_tag_remap = mv88e6095_port_tag_remap,
  2221. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2222. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2223. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2224. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2225. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2226. .port_pause_limit = mv88e6097_port_pause_limit,
  2227. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2228. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2229. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2230. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2231. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2232. .stats_get_strings = mv88e6095_stats_get_strings,
  2233. .stats_get_stats = mv88e6095_stats_get_stats,
  2234. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2235. .set_egress_port = mv88e6095_g1_set_egress_port,
  2236. .watchdog_ops = &mv88e6097_watchdog_ops,
  2237. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2238. .pot_clear = mv88e6xxx_g2_pot_clear,
  2239. .reset = mv88e6352_g1_reset,
  2240. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2241. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2242. };
  2243. static const struct mv88e6xxx_ops mv88e6172_ops = {
  2244. /* MV88E6XXX_FAMILY_6352 */
  2245. .irl_init_all = mv88e6352_g2_irl_init_all,
  2246. .get_eeprom = mv88e6xxx_g2_get_eeprom16,
  2247. .set_eeprom = mv88e6xxx_g2_set_eeprom16,
  2248. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2249. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2250. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2251. .port_set_link = mv88e6xxx_port_set_link,
  2252. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2253. .port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
  2254. .port_set_speed = mv88e6352_port_set_speed,
  2255. .port_tag_remap = mv88e6095_port_tag_remap,
  2256. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2257. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2258. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2259. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2260. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2261. .port_pause_limit = mv88e6097_port_pause_limit,
  2262. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2263. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2264. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2265. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2266. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2267. .stats_get_strings = mv88e6095_stats_get_strings,
  2268. .stats_get_stats = mv88e6095_stats_get_stats,
  2269. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2270. .set_egress_port = mv88e6095_g1_set_egress_port,
  2271. .watchdog_ops = &mv88e6097_watchdog_ops,
  2272. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2273. .pot_clear = mv88e6xxx_g2_pot_clear,
  2274. .reset = mv88e6352_g1_reset,
  2275. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2276. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2277. .serdes_power = mv88e6352_serdes_power,
  2278. .gpio_ops = &mv88e6352_gpio_ops,
  2279. };
  2280. static const struct mv88e6xxx_ops mv88e6175_ops = {
  2281. /* MV88E6XXX_FAMILY_6351 */
  2282. .irl_init_all = mv88e6352_g2_irl_init_all,
  2283. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2284. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2285. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2286. .port_set_link = mv88e6xxx_port_set_link,
  2287. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2288. .port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
  2289. .port_set_speed = mv88e6185_port_set_speed,
  2290. .port_tag_remap = mv88e6095_port_tag_remap,
  2291. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2292. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2293. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2294. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2295. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2296. .port_pause_limit = mv88e6097_port_pause_limit,
  2297. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2298. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2299. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2300. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2301. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2302. .stats_get_strings = mv88e6095_stats_get_strings,
  2303. .stats_get_stats = mv88e6095_stats_get_stats,
  2304. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2305. .set_egress_port = mv88e6095_g1_set_egress_port,
  2306. .watchdog_ops = &mv88e6097_watchdog_ops,
  2307. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2308. .pot_clear = mv88e6xxx_g2_pot_clear,
  2309. .reset = mv88e6352_g1_reset,
  2310. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2311. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2312. };
  2313. static const struct mv88e6xxx_ops mv88e6176_ops = {
  2314. /* MV88E6XXX_FAMILY_6352 */
  2315. .irl_init_all = mv88e6352_g2_irl_init_all,
  2316. .get_eeprom = mv88e6xxx_g2_get_eeprom16,
  2317. .set_eeprom = mv88e6xxx_g2_set_eeprom16,
  2318. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2319. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2320. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2321. .port_set_link = mv88e6xxx_port_set_link,
  2322. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2323. .port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
  2324. .port_set_speed = mv88e6352_port_set_speed,
  2325. .port_tag_remap = mv88e6095_port_tag_remap,
  2326. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2327. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2328. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2329. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2330. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2331. .port_pause_limit = mv88e6097_port_pause_limit,
  2332. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2333. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2334. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2335. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2336. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2337. .stats_get_strings = mv88e6095_stats_get_strings,
  2338. .stats_get_stats = mv88e6095_stats_get_stats,
  2339. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2340. .set_egress_port = mv88e6095_g1_set_egress_port,
  2341. .watchdog_ops = &mv88e6097_watchdog_ops,
  2342. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2343. .pot_clear = mv88e6xxx_g2_pot_clear,
  2344. .reset = mv88e6352_g1_reset,
  2345. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2346. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2347. .serdes_power = mv88e6352_serdes_power,
  2348. .gpio_ops = &mv88e6352_gpio_ops,
  2349. };
  2350. static const struct mv88e6xxx_ops mv88e6185_ops = {
  2351. /* MV88E6XXX_FAMILY_6185 */
  2352. .set_switch_mac = mv88e6xxx_g1_set_switch_mac,
  2353. .phy_read = mv88e6185_phy_ppu_read,
  2354. .phy_write = mv88e6185_phy_ppu_write,
  2355. .port_set_link = mv88e6xxx_port_set_link,
  2356. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2357. .port_set_speed = mv88e6185_port_set_speed,
  2358. .port_set_frame_mode = mv88e6085_port_set_frame_mode,
  2359. .port_set_egress_floods = mv88e6185_port_set_egress_floods,
  2360. .port_egress_rate_limiting = mv88e6095_port_egress_rate_limiting,
  2361. .port_set_upstream_port = mv88e6095_port_set_upstream_port,
  2362. .stats_snapshot = mv88e6xxx_g1_stats_snapshot,
  2363. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2364. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2365. .stats_get_strings = mv88e6095_stats_get_strings,
  2366. .stats_get_stats = mv88e6095_stats_get_stats,
  2367. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2368. .set_egress_port = mv88e6095_g1_set_egress_port,
  2369. .watchdog_ops = &mv88e6097_watchdog_ops,
  2370. .mgmt_rsvd2cpu = mv88e6185_g2_mgmt_rsvd2cpu,
  2371. .ppu_enable = mv88e6185_g1_ppu_enable,
  2372. .ppu_disable = mv88e6185_g1_ppu_disable,
  2373. .reset = mv88e6185_g1_reset,
  2374. .vtu_getnext = mv88e6185_g1_vtu_getnext,
  2375. .vtu_loadpurge = mv88e6185_g1_vtu_loadpurge,
  2376. };
  2377. static const struct mv88e6xxx_ops mv88e6190_ops = {
  2378. /* MV88E6XXX_FAMILY_6390 */
  2379. .irl_init_all = mv88e6390_g2_irl_init_all,
  2380. .get_eeprom = mv88e6xxx_g2_get_eeprom8,
  2381. .set_eeprom = mv88e6xxx_g2_set_eeprom8,
  2382. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2383. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2384. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2385. .port_set_link = mv88e6xxx_port_set_link,
  2386. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2387. .port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
  2388. .port_set_speed = mv88e6390_port_set_speed,
  2389. .port_tag_remap = mv88e6390_port_tag_remap,
  2390. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2391. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2392. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2393. .port_pause_limit = mv88e6390_port_pause_limit,
  2394. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2395. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2396. .stats_snapshot = mv88e6390_g1_stats_snapshot,
  2397. .stats_set_histogram = mv88e6390_g1_stats_set_histogram,
  2398. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2399. .stats_get_strings = mv88e6320_stats_get_strings,
  2400. .stats_get_stats = mv88e6390_stats_get_stats,
  2401. .set_cpu_port = mv88e6390_g1_set_cpu_port,
  2402. .set_egress_port = mv88e6390_g1_set_egress_port,
  2403. .watchdog_ops = &mv88e6390_watchdog_ops,
  2404. .mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
  2405. .pot_clear = mv88e6xxx_g2_pot_clear,
  2406. .reset = mv88e6352_g1_reset,
  2407. .vtu_getnext = mv88e6390_g1_vtu_getnext,
  2408. .vtu_loadpurge = mv88e6390_g1_vtu_loadpurge,
  2409. .serdes_power = mv88e6390_serdes_power,
  2410. .gpio_ops = &mv88e6352_gpio_ops,
  2411. };
  2412. static const struct mv88e6xxx_ops mv88e6190x_ops = {
  2413. /* MV88E6XXX_FAMILY_6390 */
  2414. .irl_init_all = mv88e6390_g2_irl_init_all,
  2415. .get_eeprom = mv88e6xxx_g2_get_eeprom8,
  2416. .set_eeprom = mv88e6xxx_g2_set_eeprom8,
  2417. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2418. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2419. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2420. .port_set_link = mv88e6xxx_port_set_link,
  2421. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2422. .port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
  2423. .port_set_speed = mv88e6390x_port_set_speed,
  2424. .port_tag_remap = mv88e6390_port_tag_remap,
  2425. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2426. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2427. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2428. .port_pause_limit = mv88e6390_port_pause_limit,
  2429. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2430. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2431. .stats_snapshot = mv88e6390_g1_stats_snapshot,
  2432. .stats_set_histogram = mv88e6390_g1_stats_set_histogram,
  2433. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2434. .stats_get_strings = mv88e6320_stats_get_strings,
  2435. .stats_get_stats = mv88e6390_stats_get_stats,
  2436. .set_cpu_port = mv88e6390_g1_set_cpu_port,
  2437. .set_egress_port = mv88e6390_g1_set_egress_port,
  2438. .watchdog_ops = &mv88e6390_watchdog_ops,
  2439. .mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
  2440. .pot_clear = mv88e6xxx_g2_pot_clear,
  2441. .reset = mv88e6352_g1_reset,
  2442. .vtu_getnext = mv88e6390_g1_vtu_getnext,
  2443. .vtu_loadpurge = mv88e6390_g1_vtu_loadpurge,
  2444. .serdes_power = mv88e6390_serdes_power,
  2445. .gpio_ops = &mv88e6352_gpio_ops,
  2446. };
  2447. static const struct mv88e6xxx_ops mv88e6191_ops = {
  2448. /* MV88E6XXX_FAMILY_6390 */
  2449. .irl_init_all = mv88e6390_g2_irl_init_all,
  2450. .get_eeprom = mv88e6xxx_g2_get_eeprom8,
  2451. .set_eeprom = mv88e6xxx_g2_set_eeprom8,
  2452. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2453. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2454. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2455. .port_set_link = mv88e6xxx_port_set_link,
  2456. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2457. .port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
  2458. .port_set_speed = mv88e6390_port_set_speed,
  2459. .port_tag_remap = mv88e6390_port_tag_remap,
  2460. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2461. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2462. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2463. .port_pause_limit = mv88e6390_port_pause_limit,
  2464. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2465. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2466. .stats_snapshot = mv88e6390_g1_stats_snapshot,
  2467. .stats_set_histogram = mv88e6390_g1_stats_set_histogram,
  2468. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2469. .stats_get_strings = mv88e6320_stats_get_strings,
  2470. .stats_get_stats = mv88e6390_stats_get_stats,
  2471. .set_cpu_port = mv88e6390_g1_set_cpu_port,
  2472. .set_egress_port = mv88e6390_g1_set_egress_port,
  2473. .watchdog_ops = &mv88e6390_watchdog_ops,
  2474. .mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
  2475. .pot_clear = mv88e6xxx_g2_pot_clear,
  2476. .reset = mv88e6352_g1_reset,
  2477. .vtu_getnext = mv88e6390_g1_vtu_getnext,
  2478. .vtu_loadpurge = mv88e6390_g1_vtu_loadpurge,
  2479. .serdes_power = mv88e6390_serdes_power,
  2480. };
  2481. static const struct mv88e6xxx_ops mv88e6240_ops = {
  2482. /* MV88E6XXX_FAMILY_6352 */
  2483. .irl_init_all = mv88e6352_g2_irl_init_all,
  2484. .get_eeprom = mv88e6xxx_g2_get_eeprom16,
  2485. .set_eeprom = mv88e6xxx_g2_set_eeprom16,
  2486. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2487. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2488. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2489. .port_set_link = mv88e6xxx_port_set_link,
  2490. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2491. .port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
  2492. .port_set_speed = mv88e6352_port_set_speed,
  2493. .port_tag_remap = mv88e6095_port_tag_remap,
  2494. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2495. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2496. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2497. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2498. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2499. .port_pause_limit = mv88e6097_port_pause_limit,
  2500. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2501. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2502. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2503. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2504. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2505. .stats_get_strings = mv88e6095_stats_get_strings,
  2506. .stats_get_stats = mv88e6095_stats_get_stats,
  2507. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2508. .set_egress_port = mv88e6095_g1_set_egress_port,
  2509. .watchdog_ops = &mv88e6097_watchdog_ops,
  2510. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2511. .pot_clear = mv88e6xxx_g2_pot_clear,
  2512. .reset = mv88e6352_g1_reset,
  2513. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2514. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2515. .serdes_power = mv88e6352_serdes_power,
  2516. .gpio_ops = &mv88e6352_gpio_ops,
  2517. .avb_ops = &mv88e6352_avb_ops,
  2518. };
  2519. static const struct mv88e6xxx_ops mv88e6290_ops = {
  2520. /* MV88E6XXX_FAMILY_6390 */
  2521. .irl_init_all = mv88e6390_g2_irl_init_all,
  2522. .get_eeprom = mv88e6xxx_g2_get_eeprom8,
  2523. .set_eeprom = mv88e6xxx_g2_set_eeprom8,
  2524. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2525. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2526. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2527. .port_set_link = mv88e6xxx_port_set_link,
  2528. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2529. .port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
  2530. .port_set_speed = mv88e6390_port_set_speed,
  2531. .port_tag_remap = mv88e6390_port_tag_remap,
  2532. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2533. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2534. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2535. .port_pause_limit = mv88e6390_port_pause_limit,
  2536. .port_set_cmode = mv88e6390x_port_set_cmode,
  2537. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2538. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2539. .stats_snapshot = mv88e6390_g1_stats_snapshot,
  2540. .stats_set_histogram = mv88e6390_g1_stats_set_histogram,
  2541. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2542. .stats_get_strings = mv88e6320_stats_get_strings,
  2543. .stats_get_stats = mv88e6390_stats_get_stats,
  2544. .set_cpu_port = mv88e6390_g1_set_cpu_port,
  2545. .set_egress_port = mv88e6390_g1_set_egress_port,
  2546. .watchdog_ops = &mv88e6390_watchdog_ops,
  2547. .mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
  2548. .pot_clear = mv88e6xxx_g2_pot_clear,
  2549. .reset = mv88e6352_g1_reset,
  2550. .vtu_getnext = mv88e6390_g1_vtu_getnext,
  2551. .vtu_loadpurge = mv88e6390_g1_vtu_loadpurge,
  2552. .serdes_power = mv88e6390_serdes_power,
  2553. .gpio_ops = &mv88e6352_gpio_ops,
  2554. .avb_ops = &mv88e6390_avb_ops,
  2555. };
  2556. static const struct mv88e6xxx_ops mv88e6320_ops = {
  2557. /* MV88E6XXX_FAMILY_6320 */
  2558. .irl_init_all = mv88e6352_g2_irl_init_all,
  2559. .get_eeprom = mv88e6xxx_g2_get_eeprom16,
  2560. .set_eeprom = mv88e6xxx_g2_set_eeprom16,
  2561. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2562. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2563. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2564. .port_set_link = mv88e6xxx_port_set_link,
  2565. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2566. .port_set_speed = mv88e6185_port_set_speed,
  2567. .port_tag_remap = mv88e6095_port_tag_remap,
  2568. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2569. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2570. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2571. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2572. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2573. .port_pause_limit = mv88e6097_port_pause_limit,
  2574. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2575. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2576. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2577. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2578. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2579. .stats_get_strings = mv88e6320_stats_get_strings,
  2580. .stats_get_stats = mv88e6320_stats_get_stats,
  2581. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2582. .set_egress_port = mv88e6095_g1_set_egress_port,
  2583. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2584. .pot_clear = mv88e6xxx_g2_pot_clear,
  2585. .reset = mv88e6352_g1_reset,
  2586. .vtu_getnext = mv88e6185_g1_vtu_getnext,
  2587. .vtu_loadpurge = mv88e6185_g1_vtu_loadpurge,
  2588. .gpio_ops = &mv88e6352_gpio_ops,
  2589. .avb_ops = &mv88e6352_avb_ops,
  2590. };
  2591. static const struct mv88e6xxx_ops mv88e6321_ops = {
  2592. /* MV88E6XXX_FAMILY_6320 */
  2593. .irl_init_all = mv88e6352_g2_irl_init_all,
  2594. .get_eeprom = mv88e6xxx_g2_get_eeprom16,
  2595. .set_eeprom = mv88e6xxx_g2_set_eeprom16,
  2596. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2597. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2598. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2599. .port_set_link = mv88e6xxx_port_set_link,
  2600. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2601. .port_set_speed = mv88e6185_port_set_speed,
  2602. .port_tag_remap = mv88e6095_port_tag_remap,
  2603. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2604. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2605. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2606. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2607. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2608. .port_pause_limit = mv88e6097_port_pause_limit,
  2609. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2610. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2611. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2612. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2613. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2614. .stats_get_strings = mv88e6320_stats_get_strings,
  2615. .stats_get_stats = mv88e6320_stats_get_stats,
  2616. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2617. .set_egress_port = mv88e6095_g1_set_egress_port,
  2618. .reset = mv88e6352_g1_reset,
  2619. .vtu_getnext = mv88e6185_g1_vtu_getnext,
  2620. .vtu_loadpurge = mv88e6185_g1_vtu_loadpurge,
  2621. .gpio_ops = &mv88e6352_gpio_ops,
  2622. .avb_ops = &mv88e6352_avb_ops,
  2623. };
  2624. static const struct mv88e6xxx_ops mv88e6341_ops = {
  2625. /* MV88E6XXX_FAMILY_6341 */
  2626. .irl_init_all = mv88e6352_g2_irl_init_all,
  2627. .get_eeprom = mv88e6xxx_g2_get_eeprom8,
  2628. .set_eeprom = mv88e6xxx_g2_set_eeprom8,
  2629. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2630. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2631. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2632. .port_set_link = mv88e6xxx_port_set_link,
  2633. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2634. .port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
  2635. .port_set_speed = mv88e6390_port_set_speed,
  2636. .port_tag_remap = mv88e6095_port_tag_remap,
  2637. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2638. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2639. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2640. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2641. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2642. .port_pause_limit = mv88e6097_port_pause_limit,
  2643. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2644. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2645. .stats_snapshot = mv88e6390_g1_stats_snapshot,
  2646. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2647. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2648. .stats_get_strings = mv88e6320_stats_get_strings,
  2649. .stats_get_stats = mv88e6390_stats_get_stats,
  2650. .set_cpu_port = mv88e6390_g1_set_cpu_port,
  2651. .set_egress_port = mv88e6390_g1_set_egress_port,
  2652. .watchdog_ops = &mv88e6390_watchdog_ops,
  2653. .mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
  2654. .pot_clear = mv88e6xxx_g2_pot_clear,
  2655. .reset = mv88e6352_g1_reset,
  2656. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2657. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2658. .gpio_ops = &mv88e6352_gpio_ops,
  2659. .avb_ops = &mv88e6390_avb_ops,
  2660. };
  2661. static const struct mv88e6xxx_ops mv88e6350_ops = {
  2662. /* MV88E6XXX_FAMILY_6351 */
  2663. .irl_init_all = mv88e6352_g2_irl_init_all,
  2664. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2665. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2666. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2667. .port_set_link = mv88e6xxx_port_set_link,
  2668. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2669. .port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
  2670. .port_set_speed = mv88e6185_port_set_speed,
  2671. .port_tag_remap = mv88e6095_port_tag_remap,
  2672. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2673. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2674. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2675. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2676. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2677. .port_pause_limit = mv88e6097_port_pause_limit,
  2678. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2679. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2680. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2681. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2682. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2683. .stats_get_strings = mv88e6095_stats_get_strings,
  2684. .stats_get_stats = mv88e6095_stats_get_stats,
  2685. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2686. .set_egress_port = mv88e6095_g1_set_egress_port,
  2687. .watchdog_ops = &mv88e6097_watchdog_ops,
  2688. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2689. .pot_clear = mv88e6xxx_g2_pot_clear,
  2690. .reset = mv88e6352_g1_reset,
  2691. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2692. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2693. };
  2694. static const struct mv88e6xxx_ops mv88e6351_ops = {
  2695. /* MV88E6XXX_FAMILY_6351 */
  2696. .irl_init_all = mv88e6352_g2_irl_init_all,
  2697. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2698. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2699. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2700. .port_set_link = mv88e6xxx_port_set_link,
  2701. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2702. .port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
  2703. .port_set_speed = mv88e6185_port_set_speed,
  2704. .port_tag_remap = mv88e6095_port_tag_remap,
  2705. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2706. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2707. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2708. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2709. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2710. .port_pause_limit = mv88e6097_port_pause_limit,
  2711. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2712. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2713. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2714. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2715. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2716. .stats_get_strings = mv88e6095_stats_get_strings,
  2717. .stats_get_stats = mv88e6095_stats_get_stats,
  2718. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2719. .set_egress_port = mv88e6095_g1_set_egress_port,
  2720. .watchdog_ops = &mv88e6097_watchdog_ops,
  2721. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2722. .pot_clear = mv88e6xxx_g2_pot_clear,
  2723. .reset = mv88e6352_g1_reset,
  2724. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2725. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2726. .avb_ops = &mv88e6352_avb_ops,
  2727. };
  2728. static const struct mv88e6xxx_ops mv88e6352_ops = {
  2729. /* MV88E6XXX_FAMILY_6352 */
  2730. .irl_init_all = mv88e6352_g2_irl_init_all,
  2731. .get_eeprom = mv88e6xxx_g2_get_eeprom16,
  2732. .set_eeprom = mv88e6xxx_g2_set_eeprom16,
  2733. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2734. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2735. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2736. .port_set_link = mv88e6xxx_port_set_link,
  2737. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2738. .port_set_rgmii_delay = mv88e6352_port_set_rgmii_delay,
  2739. .port_set_speed = mv88e6352_port_set_speed,
  2740. .port_tag_remap = mv88e6095_port_tag_remap,
  2741. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2742. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2743. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2744. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2745. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2746. .port_pause_limit = mv88e6097_port_pause_limit,
  2747. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2748. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2749. .stats_snapshot = mv88e6320_g1_stats_snapshot,
  2750. .stats_set_histogram = mv88e6095_g1_stats_set_histogram,
  2751. .stats_get_sset_count = mv88e6095_stats_get_sset_count,
  2752. .stats_get_strings = mv88e6095_stats_get_strings,
  2753. .stats_get_stats = mv88e6095_stats_get_stats,
  2754. .set_cpu_port = mv88e6095_g1_set_cpu_port,
  2755. .set_egress_port = mv88e6095_g1_set_egress_port,
  2756. .watchdog_ops = &mv88e6097_watchdog_ops,
  2757. .mgmt_rsvd2cpu = mv88e6352_g2_mgmt_rsvd2cpu,
  2758. .pot_clear = mv88e6xxx_g2_pot_clear,
  2759. .reset = mv88e6352_g1_reset,
  2760. .vtu_getnext = mv88e6352_g1_vtu_getnext,
  2761. .vtu_loadpurge = mv88e6352_g1_vtu_loadpurge,
  2762. .serdes_power = mv88e6352_serdes_power,
  2763. .gpio_ops = &mv88e6352_gpio_ops,
  2764. .avb_ops = &mv88e6352_avb_ops,
  2765. .serdes_get_sset_count = mv88e6352_serdes_get_sset_count,
  2766. .serdes_get_strings = mv88e6352_serdes_get_strings,
  2767. .serdes_get_stats = mv88e6352_serdes_get_stats,
  2768. };
  2769. static const struct mv88e6xxx_ops mv88e6390_ops = {
  2770. /* MV88E6XXX_FAMILY_6390 */
  2771. .irl_init_all = mv88e6390_g2_irl_init_all,
  2772. .get_eeprom = mv88e6xxx_g2_get_eeprom8,
  2773. .set_eeprom = mv88e6xxx_g2_set_eeprom8,
  2774. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2775. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2776. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2777. .port_set_link = mv88e6xxx_port_set_link,
  2778. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2779. .port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
  2780. .port_set_speed = mv88e6390_port_set_speed,
  2781. .port_tag_remap = mv88e6390_port_tag_remap,
  2782. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2783. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2784. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2785. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2786. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2787. .port_pause_limit = mv88e6390_port_pause_limit,
  2788. .port_set_cmode = mv88e6390x_port_set_cmode,
  2789. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2790. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2791. .stats_snapshot = mv88e6390_g1_stats_snapshot,
  2792. .stats_set_histogram = mv88e6390_g1_stats_set_histogram,
  2793. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2794. .stats_get_strings = mv88e6320_stats_get_strings,
  2795. .stats_get_stats = mv88e6390_stats_get_stats,
  2796. .set_cpu_port = mv88e6390_g1_set_cpu_port,
  2797. .set_egress_port = mv88e6390_g1_set_egress_port,
  2798. .watchdog_ops = &mv88e6390_watchdog_ops,
  2799. .mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
  2800. .pot_clear = mv88e6xxx_g2_pot_clear,
  2801. .reset = mv88e6352_g1_reset,
  2802. .vtu_getnext = mv88e6390_g1_vtu_getnext,
  2803. .vtu_loadpurge = mv88e6390_g1_vtu_loadpurge,
  2804. .serdes_power = mv88e6390_serdes_power,
  2805. .gpio_ops = &mv88e6352_gpio_ops,
  2806. .avb_ops = &mv88e6390_avb_ops,
  2807. };
  2808. static const struct mv88e6xxx_ops mv88e6390x_ops = {
  2809. /* MV88E6XXX_FAMILY_6390 */
  2810. .irl_init_all = mv88e6390_g2_irl_init_all,
  2811. .get_eeprom = mv88e6xxx_g2_get_eeprom8,
  2812. .set_eeprom = mv88e6xxx_g2_set_eeprom8,
  2813. .set_switch_mac = mv88e6xxx_g2_set_switch_mac,
  2814. .phy_read = mv88e6xxx_g2_smi_phy_read,
  2815. .phy_write = mv88e6xxx_g2_smi_phy_write,
  2816. .port_set_link = mv88e6xxx_port_set_link,
  2817. .port_set_duplex = mv88e6xxx_port_set_duplex,
  2818. .port_set_rgmii_delay = mv88e6390_port_set_rgmii_delay,
  2819. .port_set_speed = mv88e6390x_port_set_speed,
  2820. .port_tag_remap = mv88e6390_port_tag_remap,
  2821. .port_set_frame_mode = mv88e6351_port_set_frame_mode,
  2822. .port_set_egress_floods = mv88e6352_port_set_egress_floods,
  2823. .port_set_ether_type = mv88e6351_port_set_ether_type,
  2824. .port_set_jumbo_size = mv88e6165_port_set_jumbo_size,
  2825. .port_egress_rate_limiting = mv88e6097_port_egress_rate_limiting,
  2826. .port_pause_limit = mv88e6390_port_pause_limit,
  2827. .port_set_cmode = mv88e6390x_port_set_cmode,
  2828. .port_disable_learn_limit = mv88e6xxx_port_disable_learn_limit,
  2829. .port_disable_pri_override = mv88e6xxx_port_disable_pri_override,
  2830. .stats_snapshot = mv88e6390_g1_stats_snapshot,
  2831. .stats_set_histogram = mv88e6390_g1_stats_set_histogram,
  2832. .stats_get_sset_count = mv88e6320_stats_get_sset_count,
  2833. .stats_get_strings = mv88e6320_stats_get_strings,
  2834. .stats_get_stats = mv88e6390_stats_get_stats,
  2835. .set_cpu_port = mv88e6390_g1_set_cpu_port,
  2836. .set_egress_port = mv88e6390_g1_set_egress_port,
  2837. .watchdog_ops = &mv88e6390_watchdog_ops,
  2838. .mgmt_rsvd2cpu = mv88e6390_g1_mgmt_rsvd2cpu,
  2839. .pot_clear = mv88e6xxx_g2_pot_clear,
  2840. .reset = mv88e6352_g1_reset,
  2841. .vtu_getnext = mv88e6390_g1_vtu_getnext,
  2842. .vtu_loadpurge = mv88e6390_g1_vtu_loadpurge,
  2843. .serdes_power = mv88e6390_serdes_power,
  2844. .gpio_ops = &mv88e6352_gpio_ops,
  2845. .avb_ops = &mv88e6390_avb_ops,
  2846. };
  2847. static const struct mv88e6xxx_info mv88e6xxx_table[] = {
  2848. [MV88E6085] = {
  2849. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6085,
  2850. .family = MV88E6XXX_FAMILY_6097,
  2851. .name = "Marvell 88E6085",
  2852. .num_databases = 4096,
  2853. .num_ports = 10,
  2854. .num_internal_phys = 5,
  2855. .max_vid = 4095,
  2856. .port_base_addr = 0x10,
  2857. .global1_addr = 0x1b,
  2858. .global2_addr = 0x1c,
  2859. .age_time_coeff = 15000,
  2860. .g1_irqs = 8,
  2861. .g2_irqs = 10,
  2862. .atu_move_port_mask = 0xf,
  2863. .pvt = true,
  2864. .multi_chip = true,
  2865. .tag_protocol = DSA_TAG_PROTO_DSA,
  2866. .ops = &mv88e6085_ops,
  2867. },
  2868. [MV88E6095] = {
  2869. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6095,
  2870. .family = MV88E6XXX_FAMILY_6095,
  2871. .name = "Marvell 88E6095/88E6095F",
  2872. .num_databases = 256,
  2873. .num_ports = 11,
  2874. .num_internal_phys = 0,
  2875. .max_vid = 4095,
  2876. .port_base_addr = 0x10,
  2877. .global1_addr = 0x1b,
  2878. .global2_addr = 0x1c,
  2879. .age_time_coeff = 15000,
  2880. .g1_irqs = 8,
  2881. .atu_move_port_mask = 0xf,
  2882. .multi_chip = true,
  2883. .tag_protocol = DSA_TAG_PROTO_DSA,
  2884. .ops = &mv88e6095_ops,
  2885. },
  2886. [MV88E6097] = {
  2887. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6097,
  2888. .family = MV88E6XXX_FAMILY_6097,
  2889. .name = "Marvell 88E6097/88E6097F",
  2890. .num_databases = 4096,
  2891. .num_ports = 11,
  2892. .num_internal_phys = 8,
  2893. .max_vid = 4095,
  2894. .port_base_addr = 0x10,
  2895. .global1_addr = 0x1b,
  2896. .global2_addr = 0x1c,
  2897. .age_time_coeff = 15000,
  2898. .g1_irqs = 8,
  2899. .g2_irqs = 10,
  2900. .atu_move_port_mask = 0xf,
  2901. .pvt = true,
  2902. .multi_chip = true,
  2903. .tag_protocol = DSA_TAG_PROTO_EDSA,
  2904. .ops = &mv88e6097_ops,
  2905. },
  2906. [MV88E6123] = {
  2907. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6123,
  2908. .family = MV88E6XXX_FAMILY_6165,
  2909. .name = "Marvell 88E6123",
  2910. .num_databases = 4096,
  2911. .num_ports = 3,
  2912. .num_internal_phys = 5,
  2913. .max_vid = 4095,
  2914. .port_base_addr = 0x10,
  2915. .global1_addr = 0x1b,
  2916. .global2_addr = 0x1c,
  2917. .age_time_coeff = 15000,
  2918. .g1_irqs = 9,
  2919. .g2_irqs = 10,
  2920. .atu_move_port_mask = 0xf,
  2921. .pvt = true,
  2922. .multi_chip = true,
  2923. .tag_protocol = DSA_TAG_PROTO_EDSA,
  2924. .ops = &mv88e6123_ops,
  2925. },
  2926. [MV88E6131] = {
  2927. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6131,
  2928. .family = MV88E6XXX_FAMILY_6185,
  2929. .name = "Marvell 88E6131",
  2930. .num_databases = 256,
  2931. .num_ports = 8,
  2932. .num_internal_phys = 0,
  2933. .max_vid = 4095,
  2934. .port_base_addr = 0x10,
  2935. .global1_addr = 0x1b,
  2936. .global2_addr = 0x1c,
  2937. .age_time_coeff = 15000,
  2938. .g1_irqs = 9,
  2939. .atu_move_port_mask = 0xf,
  2940. .multi_chip = true,
  2941. .tag_protocol = DSA_TAG_PROTO_DSA,
  2942. .ops = &mv88e6131_ops,
  2943. },
  2944. [MV88E6141] = {
  2945. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6141,
  2946. .family = MV88E6XXX_FAMILY_6341,
  2947. .name = "Marvell 88E6141",
  2948. .num_databases = 4096,
  2949. .num_ports = 6,
  2950. .num_internal_phys = 5,
  2951. .num_gpio = 11,
  2952. .max_vid = 4095,
  2953. .port_base_addr = 0x10,
  2954. .global1_addr = 0x1b,
  2955. .global2_addr = 0x1c,
  2956. .age_time_coeff = 3750,
  2957. .atu_move_port_mask = 0x1f,
  2958. .g1_irqs = 9,
  2959. .g2_irqs = 10,
  2960. .pvt = true,
  2961. .multi_chip = true,
  2962. .tag_protocol = DSA_TAG_PROTO_EDSA,
  2963. .ops = &mv88e6141_ops,
  2964. },
  2965. [MV88E6161] = {
  2966. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6161,
  2967. .family = MV88E6XXX_FAMILY_6165,
  2968. .name = "Marvell 88E6161",
  2969. .num_databases = 4096,
  2970. .num_ports = 6,
  2971. .num_internal_phys = 5,
  2972. .max_vid = 4095,
  2973. .port_base_addr = 0x10,
  2974. .global1_addr = 0x1b,
  2975. .global2_addr = 0x1c,
  2976. .age_time_coeff = 15000,
  2977. .g1_irqs = 9,
  2978. .g2_irqs = 10,
  2979. .atu_move_port_mask = 0xf,
  2980. .pvt = true,
  2981. .multi_chip = true,
  2982. .tag_protocol = DSA_TAG_PROTO_EDSA,
  2983. .ops = &mv88e6161_ops,
  2984. },
  2985. [MV88E6165] = {
  2986. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6165,
  2987. .family = MV88E6XXX_FAMILY_6165,
  2988. .name = "Marvell 88E6165",
  2989. .num_databases = 4096,
  2990. .num_ports = 6,
  2991. .num_internal_phys = 0,
  2992. .max_vid = 4095,
  2993. .port_base_addr = 0x10,
  2994. .global1_addr = 0x1b,
  2995. .global2_addr = 0x1c,
  2996. .age_time_coeff = 15000,
  2997. .g1_irqs = 9,
  2998. .g2_irqs = 10,
  2999. .atu_move_port_mask = 0xf,
  3000. .pvt = true,
  3001. .multi_chip = true,
  3002. .tag_protocol = DSA_TAG_PROTO_DSA,
  3003. .ops = &mv88e6165_ops,
  3004. },
  3005. [MV88E6171] = {
  3006. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6171,
  3007. .family = MV88E6XXX_FAMILY_6351,
  3008. .name = "Marvell 88E6171",
  3009. .num_databases = 4096,
  3010. .num_ports = 7,
  3011. .num_internal_phys = 5,
  3012. .max_vid = 4095,
  3013. .port_base_addr = 0x10,
  3014. .global1_addr = 0x1b,
  3015. .global2_addr = 0x1c,
  3016. .age_time_coeff = 15000,
  3017. .g1_irqs = 9,
  3018. .g2_irqs = 10,
  3019. .atu_move_port_mask = 0xf,
  3020. .pvt = true,
  3021. .multi_chip = true,
  3022. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3023. .ops = &mv88e6171_ops,
  3024. },
  3025. [MV88E6172] = {
  3026. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6172,
  3027. .family = MV88E6XXX_FAMILY_6352,
  3028. .name = "Marvell 88E6172",
  3029. .num_databases = 4096,
  3030. .num_ports = 7,
  3031. .num_internal_phys = 5,
  3032. .num_gpio = 15,
  3033. .max_vid = 4095,
  3034. .port_base_addr = 0x10,
  3035. .global1_addr = 0x1b,
  3036. .global2_addr = 0x1c,
  3037. .age_time_coeff = 15000,
  3038. .g1_irqs = 9,
  3039. .g2_irqs = 10,
  3040. .atu_move_port_mask = 0xf,
  3041. .pvt = true,
  3042. .multi_chip = true,
  3043. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3044. .ops = &mv88e6172_ops,
  3045. },
  3046. [MV88E6175] = {
  3047. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6175,
  3048. .family = MV88E6XXX_FAMILY_6351,
  3049. .name = "Marvell 88E6175",
  3050. .num_databases = 4096,
  3051. .num_ports = 7,
  3052. .num_internal_phys = 5,
  3053. .max_vid = 4095,
  3054. .port_base_addr = 0x10,
  3055. .global1_addr = 0x1b,
  3056. .global2_addr = 0x1c,
  3057. .age_time_coeff = 15000,
  3058. .g1_irqs = 9,
  3059. .g2_irqs = 10,
  3060. .atu_move_port_mask = 0xf,
  3061. .pvt = true,
  3062. .multi_chip = true,
  3063. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3064. .ops = &mv88e6175_ops,
  3065. },
  3066. [MV88E6176] = {
  3067. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6176,
  3068. .family = MV88E6XXX_FAMILY_6352,
  3069. .name = "Marvell 88E6176",
  3070. .num_databases = 4096,
  3071. .num_ports = 7,
  3072. .num_internal_phys = 5,
  3073. .num_gpio = 15,
  3074. .max_vid = 4095,
  3075. .port_base_addr = 0x10,
  3076. .global1_addr = 0x1b,
  3077. .global2_addr = 0x1c,
  3078. .age_time_coeff = 15000,
  3079. .g1_irqs = 9,
  3080. .g2_irqs = 10,
  3081. .atu_move_port_mask = 0xf,
  3082. .pvt = true,
  3083. .multi_chip = true,
  3084. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3085. .ops = &mv88e6176_ops,
  3086. },
  3087. [MV88E6185] = {
  3088. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6185,
  3089. .family = MV88E6XXX_FAMILY_6185,
  3090. .name = "Marvell 88E6185",
  3091. .num_databases = 256,
  3092. .num_ports = 10,
  3093. .num_internal_phys = 0,
  3094. .max_vid = 4095,
  3095. .port_base_addr = 0x10,
  3096. .global1_addr = 0x1b,
  3097. .global2_addr = 0x1c,
  3098. .age_time_coeff = 15000,
  3099. .g1_irqs = 8,
  3100. .atu_move_port_mask = 0xf,
  3101. .multi_chip = true,
  3102. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3103. .ops = &mv88e6185_ops,
  3104. },
  3105. [MV88E6190] = {
  3106. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6190,
  3107. .family = MV88E6XXX_FAMILY_6390,
  3108. .name = "Marvell 88E6190",
  3109. .num_databases = 4096,
  3110. .num_ports = 11, /* 10 + Z80 */
  3111. .num_internal_phys = 11,
  3112. .num_gpio = 16,
  3113. .max_vid = 8191,
  3114. .port_base_addr = 0x0,
  3115. .global1_addr = 0x1b,
  3116. .global2_addr = 0x1c,
  3117. .tag_protocol = DSA_TAG_PROTO_DSA,
  3118. .age_time_coeff = 3750,
  3119. .g1_irqs = 9,
  3120. .g2_irqs = 14,
  3121. .pvt = true,
  3122. .multi_chip = true,
  3123. .atu_move_port_mask = 0x1f,
  3124. .ops = &mv88e6190_ops,
  3125. },
  3126. [MV88E6190X] = {
  3127. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6190X,
  3128. .family = MV88E6XXX_FAMILY_6390,
  3129. .name = "Marvell 88E6190X",
  3130. .num_databases = 4096,
  3131. .num_ports = 11, /* 10 + Z80 */
  3132. .num_internal_phys = 11,
  3133. .num_gpio = 16,
  3134. .max_vid = 8191,
  3135. .port_base_addr = 0x0,
  3136. .global1_addr = 0x1b,
  3137. .global2_addr = 0x1c,
  3138. .age_time_coeff = 3750,
  3139. .g1_irqs = 9,
  3140. .g2_irqs = 14,
  3141. .atu_move_port_mask = 0x1f,
  3142. .pvt = true,
  3143. .multi_chip = true,
  3144. .tag_protocol = DSA_TAG_PROTO_DSA,
  3145. .ops = &mv88e6190x_ops,
  3146. },
  3147. [MV88E6191] = {
  3148. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6191,
  3149. .family = MV88E6XXX_FAMILY_6390,
  3150. .name = "Marvell 88E6191",
  3151. .num_databases = 4096,
  3152. .num_ports = 11, /* 10 + Z80 */
  3153. .num_internal_phys = 11,
  3154. .max_vid = 8191,
  3155. .port_base_addr = 0x0,
  3156. .global1_addr = 0x1b,
  3157. .global2_addr = 0x1c,
  3158. .age_time_coeff = 3750,
  3159. .g1_irqs = 9,
  3160. .g2_irqs = 14,
  3161. .atu_move_port_mask = 0x1f,
  3162. .pvt = true,
  3163. .multi_chip = true,
  3164. .tag_protocol = DSA_TAG_PROTO_DSA,
  3165. .ptp_support = true,
  3166. .ops = &mv88e6191_ops,
  3167. },
  3168. [MV88E6240] = {
  3169. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6240,
  3170. .family = MV88E6XXX_FAMILY_6352,
  3171. .name = "Marvell 88E6240",
  3172. .num_databases = 4096,
  3173. .num_ports = 7,
  3174. .num_internal_phys = 5,
  3175. .num_gpio = 15,
  3176. .max_vid = 4095,
  3177. .port_base_addr = 0x10,
  3178. .global1_addr = 0x1b,
  3179. .global2_addr = 0x1c,
  3180. .age_time_coeff = 15000,
  3181. .g1_irqs = 9,
  3182. .g2_irqs = 10,
  3183. .atu_move_port_mask = 0xf,
  3184. .pvt = true,
  3185. .multi_chip = true,
  3186. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3187. .ptp_support = true,
  3188. .ops = &mv88e6240_ops,
  3189. },
  3190. [MV88E6290] = {
  3191. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6290,
  3192. .family = MV88E6XXX_FAMILY_6390,
  3193. .name = "Marvell 88E6290",
  3194. .num_databases = 4096,
  3195. .num_ports = 11, /* 10 + Z80 */
  3196. .num_internal_phys = 11,
  3197. .num_gpio = 16,
  3198. .max_vid = 8191,
  3199. .port_base_addr = 0x0,
  3200. .global1_addr = 0x1b,
  3201. .global2_addr = 0x1c,
  3202. .age_time_coeff = 3750,
  3203. .g1_irqs = 9,
  3204. .g2_irqs = 14,
  3205. .atu_move_port_mask = 0x1f,
  3206. .pvt = true,
  3207. .multi_chip = true,
  3208. .tag_protocol = DSA_TAG_PROTO_DSA,
  3209. .ptp_support = true,
  3210. .ops = &mv88e6290_ops,
  3211. },
  3212. [MV88E6320] = {
  3213. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6320,
  3214. .family = MV88E6XXX_FAMILY_6320,
  3215. .name = "Marvell 88E6320",
  3216. .num_databases = 4096,
  3217. .num_ports = 7,
  3218. .num_internal_phys = 5,
  3219. .num_gpio = 15,
  3220. .max_vid = 4095,
  3221. .port_base_addr = 0x10,
  3222. .global1_addr = 0x1b,
  3223. .global2_addr = 0x1c,
  3224. .age_time_coeff = 15000,
  3225. .g1_irqs = 8,
  3226. .g2_irqs = 10,
  3227. .atu_move_port_mask = 0xf,
  3228. .pvt = true,
  3229. .multi_chip = true,
  3230. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3231. .ptp_support = true,
  3232. .ops = &mv88e6320_ops,
  3233. },
  3234. [MV88E6321] = {
  3235. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6321,
  3236. .family = MV88E6XXX_FAMILY_6320,
  3237. .name = "Marvell 88E6321",
  3238. .num_databases = 4096,
  3239. .num_ports = 7,
  3240. .num_internal_phys = 5,
  3241. .num_gpio = 15,
  3242. .max_vid = 4095,
  3243. .port_base_addr = 0x10,
  3244. .global1_addr = 0x1b,
  3245. .global2_addr = 0x1c,
  3246. .age_time_coeff = 15000,
  3247. .g1_irqs = 8,
  3248. .g2_irqs = 10,
  3249. .atu_move_port_mask = 0xf,
  3250. .multi_chip = true,
  3251. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3252. .ptp_support = true,
  3253. .ops = &mv88e6321_ops,
  3254. },
  3255. [MV88E6341] = {
  3256. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6341,
  3257. .family = MV88E6XXX_FAMILY_6341,
  3258. .name = "Marvell 88E6341",
  3259. .num_databases = 4096,
  3260. .num_internal_phys = 5,
  3261. .num_ports = 6,
  3262. .num_gpio = 11,
  3263. .max_vid = 4095,
  3264. .port_base_addr = 0x10,
  3265. .global1_addr = 0x1b,
  3266. .global2_addr = 0x1c,
  3267. .age_time_coeff = 3750,
  3268. .atu_move_port_mask = 0x1f,
  3269. .g1_irqs = 9,
  3270. .g2_irqs = 10,
  3271. .pvt = true,
  3272. .multi_chip = true,
  3273. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3274. .ptp_support = true,
  3275. .ops = &mv88e6341_ops,
  3276. },
  3277. [MV88E6350] = {
  3278. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6350,
  3279. .family = MV88E6XXX_FAMILY_6351,
  3280. .name = "Marvell 88E6350",
  3281. .num_databases = 4096,
  3282. .num_ports = 7,
  3283. .num_internal_phys = 5,
  3284. .max_vid = 4095,
  3285. .port_base_addr = 0x10,
  3286. .global1_addr = 0x1b,
  3287. .global2_addr = 0x1c,
  3288. .age_time_coeff = 15000,
  3289. .g1_irqs = 9,
  3290. .g2_irqs = 10,
  3291. .atu_move_port_mask = 0xf,
  3292. .pvt = true,
  3293. .multi_chip = true,
  3294. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3295. .ops = &mv88e6350_ops,
  3296. },
  3297. [MV88E6351] = {
  3298. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6351,
  3299. .family = MV88E6XXX_FAMILY_6351,
  3300. .name = "Marvell 88E6351",
  3301. .num_databases = 4096,
  3302. .num_ports = 7,
  3303. .num_internal_phys = 5,
  3304. .max_vid = 4095,
  3305. .port_base_addr = 0x10,
  3306. .global1_addr = 0x1b,
  3307. .global2_addr = 0x1c,
  3308. .age_time_coeff = 15000,
  3309. .g1_irqs = 9,
  3310. .g2_irqs = 10,
  3311. .atu_move_port_mask = 0xf,
  3312. .pvt = true,
  3313. .multi_chip = true,
  3314. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3315. .ops = &mv88e6351_ops,
  3316. },
  3317. [MV88E6352] = {
  3318. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6352,
  3319. .family = MV88E6XXX_FAMILY_6352,
  3320. .name = "Marvell 88E6352",
  3321. .num_databases = 4096,
  3322. .num_ports = 7,
  3323. .num_internal_phys = 5,
  3324. .num_gpio = 15,
  3325. .max_vid = 4095,
  3326. .port_base_addr = 0x10,
  3327. .global1_addr = 0x1b,
  3328. .global2_addr = 0x1c,
  3329. .age_time_coeff = 15000,
  3330. .g1_irqs = 9,
  3331. .g2_irqs = 10,
  3332. .atu_move_port_mask = 0xf,
  3333. .pvt = true,
  3334. .multi_chip = true,
  3335. .tag_protocol = DSA_TAG_PROTO_EDSA,
  3336. .ptp_support = true,
  3337. .ops = &mv88e6352_ops,
  3338. },
  3339. [MV88E6390] = {
  3340. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6390,
  3341. .family = MV88E6XXX_FAMILY_6390,
  3342. .name = "Marvell 88E6390",
  3343. .num_databases = 4096,
  3344. .num_ports = 11, /* 10 + Z80 */
  3345. .num_internal_phys = 11,
  3346. .num_gpio = 16,
  3347. .max_vid = 8191,
  3348. .port_base_addr = 0x0,
  3349. .global1_addr = 0x1b,
  3350. .global2_addr = 0x1c,
  3351. .age_time_coeff = 3750,
  3352. .g1_irqs = 9,
  3353. .g2_irqs = 14,
  3354. .atu_move_port_mask = 0x1f,
  3355. .pvt = true,
  3356. .multi_chip = true,
  3357. .tag_protocol = DSA_TAG_PROTO_DSA,
  3358. .ptp_support = true,
  3359. .ops = &mv88e6390_ops,
  3360. },
  3361. [MV88E6390X] = {
  3362. .prod_num = MV88E6XXX_PORT_SWITCH_ID_PROD_6390X,
  3363. .family = MV88E6XXX_FAMILY_6390,
  3364. .name = "Marvell 88E6390X",
  3365. .num_databases = 4096,
  3366. .num_ports = 11, /* 10 + Z80 */
  3367. .num_internal_phys = 11,
  3368. .num_gpio = 16,
  3369. .max_vid = 8191,
  3370. .port_base_addr = 0x0,
  3371. .global1_addr = 0x1b,
  3372. .global2_addr = 0x1c,
  3373. .age_time_coeff = 3750,
  3374. .g1_irqs = 9,
  3375. .g2_irqs = 14,
  3376. .atu_move_port_mask = 0x1f,
  3377. .pvt = true,
  3378. .multi_chip = true,
  3379. .tag_protocol = DSA_TAG_PROTO_DSA,
  3380. .ptp_support = true,
  3381. .ops = &mv88e6390x_ops,
  3382. },
  3383. };
  3384. static const struct mv88e6xxx_info *mv88e6xxx_lookup_info(unsigned int prod_num)
  3385. {
  3386. int i;
  3387. for (i = 0; i < ARRAY_SIZE(mv88e6xxx_table); ++i)
  3388. if (mv88e6xxx_table[i].prod_num == prod_num)
  3389. return &mv88e6xxx_table[i];
  3390. return NULL;
  3391. }
  3392. static int mv88e6xxx_detect(struct mv88e6xxx_chip *chip)
  3393. {
  3394. const struct mv88e6xxx_info *info;
  3395. unsigned int prod_num, rev;
  3396. u16 id;
  3397. int err;
  3398. mutex_lock(&chip->reg_lock);
  3399. err = mv88e6xxx_port_read(chip, 0, MV88E6XXX_PORT_SWITCH_ID, &id);
  3400. mutex_unlock(&chip->reg_lock);
  3401. if (err)
  3402. return err;
  3403. prod_num = id & MV88E6XXX_PORT_SWITCH_ID_PROD_MASK;
  3404. rev = id & MV88E6XXX_PORT_SWITCH_ID_REV_MASK;
  3405. info = mv88e6xxx_lookup_info(prod_num);
  3406. if (!info)
  3407. return -ENODEV;
  3408. /* Update the compatible info with the probed one */
  3409. chip->info = info;
  3410. err = mv88e6xxx_g2_require(chip);
  3411. if (err)
  3412. return err;
  3413. dev_info(chip->dev, "switch 0x%x detected: %s, revision %u\n",
  3414. chip->info->prod_num, chip->info->name, rev);
  3415. return 0;
  3416. }
  3417. static struct mv88e6xxx_chip *mv88e6xxx_alloc_chip(struct device *dev)
  3418. {
  3419. struct mv88e6xxx_chip *chip;
  3420. chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL);
  3421. if (!chip)
  3422. return NULL;
  3423. chip->dev = dev;
  3424. mutex_init(&chip->reg_lock);
  3425. INIT_LIST_HEAD(&chip->mdios);
  3426. return chip;
  3427. }
  3428. static int mv88e6xxx_smi_init(struct mv88e6xxx_chip *chip,
  3429. struct mii_bus *bus, int sw_addr)
  3430. {
  3431. if (sw_addr == 0)
  3432. chip->smi_ops = &mv88e6xxx_smi_single_chip_ops;
  3433. else if (chip->info->multi_chip)
  3434. chip->smi_ops = &mv88e6xxx_smi_multi_chip_ops;
  3435. else
  3436. return -EINVAL;
  3437. chip->bus = bus;
  3438. chip->sw_addr = sw_addr;
  3439. return 0;
  3440. }
  3441. static enum dsa_tag_protocol mv88e6xxx_get_tag_protocol(struct dsa_switch *ds,
  3442. int port)
  3443. {
  3444. struct mv88e6xxx_chip *chip = ds->priv;
  3445. return chip->info->tag_protocol;
  3446. }
  3447. #if IS_ENABLED(CONFIG_NET_DSA_LEGACY)
  3448. static const char *mv88e6xxx_drv_probe(struct device *dsa_dev,
  3449. struct device *host_dev, int sw_addr,
  3450. void **priv)
  3451. {
  3452. struct mv88e6xxx_chip *chip;
  3453. struct mii_bus *bus;
  3454. int err;
  3455. bus = dsa_host_dev_to_mii_bus(host_dev);
  3456. if (!bus)
  3457. return NULL;
  3458. chip = mv88e6xxx_alloc_chip(dsa_dev);
  3459. if (!chip)
  3460. return NULL;
  3461. /* Legacy SMI probing will only support chips similar to 88E6085 */
  3462. chip->info = &mv88e6xxx_table[MV88E6085];
  3463. err = mv88e6xxx_smi_init(chip, bus, sw_addr);
  3464. if (err)
  3465. goto free;
  3466. err = mv88e6xxx_detect(chip);
  3467. if (err)
  3468. goto free;
  3469. mutex_lock(&chip->reg_lock);
  3470. err = mv88e6xxx_switch_reset(chip);
  3471. mutex_unlock(&chip->reg_lock);
  3472. if (err)
  3473. goto free;
  3474. mv88e6xxx_phy_init(chip);
  3475. err = mv88e6xxx_mdios_register(chip, NULL);
  3476. if (err)
  3477. goto free;
  3478. *priv = chip;
  3479. return chip->info->name;
  3480. free:
  3481. devm_kfree(dsa_dev, chip);
  3482. return NULL;
  3483. }
  3484. #endif
  3485. static int mv88e6xxx_port_mdb_prepare(struct dsa_switch *ds, int port,
  3486. const struct switchdev_obj_port_mdb *mdb)
  3487. {
  3488. /* We don't need any dynamic resource from the kernel (yet),
  3489. * so skip the prepare phase.
  3490. */
  3491. return 0;
  3492. }
  3493. static void mv88e6xxx_port_mdb_add(struct dsa_switch *ds, int port,
  3494. const struct switchdev_obj_port_mdb *mdb)
  3495. {
  3496. struct mv88e6xxx_chip *chip = ds->priv;
  3497. mutex_lock(&chip->reg_lock);
  3498. if (mv88e6xxx_port_db_load_purge(chip, port, mdb->addr, mdb->vid,
  3499. MV88E6XXX_G1_ATU_DATA_STATE_MC_STATIC))
  3500. dev_err(ds->dev, "p%d: failed to load multicast MAC address\n",
  3501. port);
  3502. mutex_unlock(&chip->reg_lock);
  3503. }
  3504. static int mv88e6xxx_port_mdb_del(struct dsa_switch *ds, int port,
  3505. const struct switchdev_obj_port_mdb *mdb)
  3506. {
  3507. struct mv88e6xxx_chip *chip = ds->priv;
  3508. int err;
  3509. mutex_lock(&chip->reg_lock);
  3510. err = mv88e6xxx_port_db_load_purge(chip, port, mdb->addr, mdb->vid,
  3511. MV88E6XXX_G1_ATU_DATA_STATE_UNUSED);
  3512. mutex_unlock(&chip->reg_lock);
  3513. return err;
  3514. }
  3515. static const struct dsa_switch_ops mv88e6xxx_switch_ops = {
  3516. #if IS_ENABLED(CONFIG_NET_DSA_LEGACY)
  3517. .probe = mv88e6xxx_drv_probe,
  3518. #endif
  3519. .get_tag_protocol = mv88e6xxx_get_tag_protocol,
  3520. .setup = mv88e6xxx_setup,
  3521. .adjust_link = mv88e6xxx_adjust_link,
  3522. .get_strings = mv88e6xxx_get_strings,
  3523. .get_ethtool_stats = mv88e6xxx_get_ethtool_stats,
  3524. .get_sset_count = mv88e6xxx_get_sset_count,
  3525. .port_enable = mv88e6xxx_port_enable,
  3526. .port_disable = mv88e6xxx_port_disable,
  3527. .get_mac_eee = mv88e6xxx_get_mac_eee,
  3528. .set_mac_eee = mv88e6xxx_set_mac_eee,
  3529. .get_eeprom_len = mv88e6xxx_get_eeprom_len,
  3530. .get_eeprom = mv88e6xxx_get_eeprom,
  3531. .set_eeprom = mv88e6xxx_set_eeprom,
  3532. .get_regs_len = mv88e6xxx_get_regs_len,
  3533. .get_regs = mv88e6xxx_get_regs,
  3534. .set_ageing_time = mv88e6xxx_set_ageing_time,
  3535. .port_bridge_join = mv88e6xxx_port_bridge_join,
  3536. .port_bridge_leave = mv88e6xxx_port_bridge_leave,
  3537. .port_stp_state_set = mv88e6xxx_port_stp_state_set,
  3538. .port_fast_age = mv88e6xxx_port_fast_age,
  3539. .port_vlan_filtering = mv88e6xxx_port_vlan_filtering,
  3540. .port_vlan_prepare = mv88e6xxx_port_vlan_prepare,
  3541. .port_vlan_add = mv88e6xxx_port_vlan_add,
  3542. .port_vlan_del = mv88e6xxx_port_vlan_del,
  3543. .port_fdb_add = mv88e6xxx_port_fdb_add,
  3544. .port_fdb_del = mv88e6xxx_port_fdb_del,
  3545. .port_fdb_dump = mv88e6xxx_port_fdb_dump,
  3546. .port_mdb_prepare = mv88e6xxx_port_mdb_prepare,
  3547. .port_mdb_add = mv88e6xxx_port_mdb_add,
  3548. .port_mdb_del = mv88e6xxx_port_mdb_del,
  3549. .crosschip_bridge_join = mv88e6xxx_crosschip_bridge_join,
  3550. .crosschip_bridge_leave = mv88e6xxx_crosschip_bridge_leave,
  3551. .port_hwtstamp_set = mv88e6xxx_port_hwtstamp_set,
  3552. .port_hwtstamp_get = mv88e6xxx_port_hwtstamp_get,
  3553. .port_txtstamp = mv88e6xxx_port_txtstamp,
  3554. .port_rxtstamp = mv88e6xxx_port_rxtstamp,
  3555. .get_ts_info = mv88e6xxx_get_ts_info,
  3556. };
  3557. static struct dsa_switch_driver mv88e6xxx_switch_drv = {
  3558. .ops = &mv88e6xxx_switch_ops,
  3559. };
  3560. static int mv88e6xxx_register_switch(struct mv88e6xxx_chip *chip)
  3561. {
  3562. struct device *dev = chip->dev;
  3563. struct dsa_switch *ds;
  3564. ds = dsa_switch_alloc(dev, mv88e6xxx_num_ports(chip));
  3565. if (!ds)
  3566. return -ENOMEM;
  3567. ds->priv = chip;
  3568. ds->ops = &mv88e6xxx_switch_ops;
  3569. ds->ageing_time_min = chip->info->age_time_coeff;
  3570. ds->ageing_time_max = chip->info->age_time_coeff * U8_MAX;
  3571. dev_set_drvdata(dev, ds);
  3572. return dsa_register_switch(ds);
  3573. }
  3574. static void mv88e6xxx_unregister_switch(struct mv88e6xxx_chip *chip)
  3575. {
  3576. dsa_unregister_switch(chip->ds);
  3577. }
  3578. static int mv88e6xxx_probe(struct mdio_device *mdiodev)
  3579. {
  3580. struct device *dev = &mdiodev->dev;
  3581. struct device_node *np = dev->of_node;
  3582. const struct mv88e6xxx_info *compat_info;
  3583. struct mv88e6xxx_chip *chip;
  3584. u32 eeprom_len;
  3585. int err;
  3586. compat_info = of_device_get_match_data(dev);
  3587. if (!compat_info)
  3588. return -EINVAL;
  3589. chip = mv88e6xxx_alloc_chip(dev);
  3590. if (!chip)
  3591. return -ENOMEM;
  3592. chip->info = compat_info;
  3593. err = mv88e6xxx_smi_init(chip, mdiodev->bus, mdiodev->addr);
  3594. if (err)
  3595. return err;
  3596. chip->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW);
  3597. if (IS_ERR(chip->reset))
  3598. return PTR_ERR(chip->reset);
  3599. err = mv88e6xxx_detect(chip);
  3600. if (err)
  3601. return err;
  3602. mv88e6xxx_phy_init(chip);
  3603. if (chip->info->ops->get_eeprom &&
  3604. !of_property_read_u32(np, "eeprom-length", &eeprom_len))
  3605. chip->eeprom_len = eeprom_len;
  3606. mutex_lock(&chip->reg_lock);
  3607. err = mv88e6xxx_switch_reset(chip);
  3608. mutex_unlock(&chip->reg_lock);
  3609. if (err)
  3610. goto out;
  3611. chip->irq = of_irq_get(np, 0);
  3612. if (chip->irq == -EPROBE_DEFER) {
  3613. err = chip->irq;
  3614. goto out;
  3615. }
  3616. /* Has to be performed before the MDIO bus is created, because
  3617. * the PHYs will link their interrupts to these interrupt
  3618. * controllers
  3619. */
  3620. mutex_lock(&chip->reg_lock);
  3621. if (chip->irq > 0)
  3622. err = mv88e6xxx_g1_irq_setup(chip);
  3623. else
  3624. err = mv88e6xxx_irq_poll_setup(chip);
  3625. mutex_unlock(&chip->reg_lock);
  3626. if (err)
  3627. goto out;
  3628. if (chip->info->g2_irqs > 0) {
  3629. err = mv88e6xxx_g2_irq_setup(chip);
  3630. if (err)
  3631. goto out_g1_irq;
  3632. }
  3633. err = mv88e6xxx_g1_atu_prob_irq_setup(chip);
  3634. if (err)
  3635. goto out_g2_irq;
  3636. err = mv88e6xxx_g1_vtu_prob_irq_setup(chip);
  3637. if (err)
  3638. goto out_g1_atu_prob_irq;
  3639. err = mv88e6xxx_mdios_register(chip, np);
  3640. if (err)
  3641. goto out_g1_vtu_prob_irq;
  3642. err = mv88e6xxx_register_switch(chip);
  3643. if (err)
  3644. goto out_mdio;
  3645. return 0;
  3646. out_mdio:
  3647. mv88e6xxx_mdios_unregister(chip);
  3648. out_g1_vtu_prob_irq:
  3649. mv88e6xxx_g1_vtu_prob_irq_free(chip);
  3650. out_g1_atu_prob_irq:
  3651. mv88e6xxx_g1_atu_prob_irq_free(chip);
  3652. out_g2_irq:
  3653. if (chip->info->g2_irqs > 0)
  3654. mv88e6xxx_g2_irq_free(chip);
  3655. out_g1_irq:
  3656. mutex_lock(&chip->reg_lock);
  3657. if (chip->irq > 0)
  3658. mv88e6xxx_g1_irq_free(chip);
  3659. else
  3660. mv88e6xxx_irq_poll_free(chip);
  3661. mutex_unlock(&chip->reg_lock);
  3662. out:
  3663. return err;
  3664. }
  3665. static void mv88e6xxx_remove(struct mdio_device *mdiodev)
  3666. {
  3667. struct dsa_switch *ds = dev_get_drvdata(&mdiodev->dev);
  3668. struct mv88e6xxx_chip *chip = ds->priv;
  3669. if (chip->info->ptp_support) {
  3670. mv88e6xxx_hwtstamp_free(chip);
  3671. mv88e6xxx_ptp_free(chip);
  3672. }
  3673. mv88e6xxx_phy_destroy(chip);
  3674. mv88e6xxx_unregister_switch(chip);
  3675. mv88e6xxx_mdios_unregister(chip);
  3676. mv88e6xxx_g1_vtu_prob_irq_free(chip);
  3677. mv88e6xxx_g1_atu_prob_irq_free(chip);
  3678. if (chip->info->g2_irqs > 0)
  3679. mv88e6xxx_g2_irq_free(chip);
  3680. mutex_lock(&chip->reg_lock);
  3681. if (chip->irq > 0)
  3682. mv88e6xxx_g1_irq_free(chip);
  3683. else
  3684. mv88e6xxx_irq_poll_free(chip);
  3685. mutex_unlock(&chip->reg_lock);
  3686. }
  3687. static const struct of_device_id mv88e6xxx_of_match[] = {
  3688. {
  3689. .compatible = "marvell,mv88e6085",
  3690. .data = &mv88e6xxx_table[MV88E6085],
  3691. },
  3692. {
  3693. .compatible = "marvell,mv88e6190",
  3694. .data = &mv88e6xxx_table[MV88E6190],
  3695. },
  3696. { /* sentinel */ },
  3697. };
  3698. MODULE_DEVICE_TABLE(of, mv88e6xxx_of_match);
  3699. static struct mdio_driver mv88e6xxx_driver = {
  3700. .probe = mv88e6xxx_probe,
  3701. .remove = mv88e6xxx_remove,
  3702. .mdiodrv.driver = {
  3703. .name = "mv88e6085",
  3704. .of_match_table = mv88e6xxx_of_match,
  3705. },
  3706. };
  3707. static int __init mv88e6xxx_init(void)
  3708. {
  3709. register_switch_driver(&mv88e6xxx_switch_drv);
  3710. return mdio_driver_register(&mv88e6xxx_driver);
  3711. }
  3712. module_init(mv88e6xxx_init);
  3713. static void __exit mv88e6xxx_cleanup(void)
  3714. {
  3715. mdio_driver_unregister(&mv88e6xxx_driver);
  3716. unregister_switch_driver(&mv88e6xxx_switch_drv);
  3717. }
  3718. module_exit(mv88e6xxx_cleanup);
  3719. MODULE_AUTHOR("Lennert Buytenhek <buytenh@wantstofly.org>");
  3720. MODULE_DESCRIPTION("Driver for Marvell 88E6XXX ethernet switch chips");
  3721. MODULE_LICENSE("GPL");