tigon3.c 173 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598559956005601560256035604560556065607560856095610561156125613561456155616561756185619562056215622562356245625562656275628562956305631563256335634563556365637563856395640564156425643564456455646564756485649565056515652565356545655565656575658565956605661566256635664566556665667566856695670567156725673567456755676567756785679568056815682568356845685568656875688568956905691569256935694569556965697
  1. /******************************************************************************/
  2. /* */
  3. /* Broadcom BCM5700 Linux Network Driver, Copyright (c) 2000 Broadcom */
  4. /* Corporation. */
  5. /* All rights reserved. */
  6. /* */
  7. /* This program is free software; you can redistribute it and/or modify */
  8. /* it under the terms of the GNU General Public License as published by */
  9. /* the Free Software Foundation, located in the file LICENSE. */
  10. /* */
  11. /* History: */
  12. /******************************************************************************/
  13. #include <common.h>
  14. #include <asm/types.h>
  15. #ifdef CONFIG_BMW
  16. #include <mpc824x.h>
  17. #endif
  18. #include <malloc.h>
  19. #include <linux/byteorder/big_endian.h>
  20. #include "bcm570x_mm.h"
  21. #define EMBEDDED 1
  22. /******************************************************************************/
  23. /* Local functions. */
  24. /******************************************************************************/
  25. LM_STATUS LM_Abort (PLM_DEVICE_BLOCK pDevice);
  26. LM_STATUS LM_QueueRxPackets (PLM_DEVICE_BLOCK pDevice);
  27. static LM_STATUS LM_TranslateRequestedMediaType (LM_REQUESTED_MEDIA_TYPE
  28. RequestedMediaType,
  29. PLM_MEDIA_TYPE pMediaType,
  30. PLM_LINE_SPEED pLineSpeed,
  31. PLM_DUPLEX_MODE pDuplexMode);
  32. static LM_STATUS LM_InitBcm540xPhy (PLM_DEVICE_BLOCK pDevice);
  33. __inline static LM_VOID LM_ServiceRxInterrupt (PLM_DEVICE_BLOCK pDevice);
  34. __inline static LM_VOID LM_ServiceTxInterrupt (PLM_DEVICE_BLOCK pDevice);
  35. static LM_STATUS LM_ForceAutoNegBcm540xPhy (PLM_DEVICE_BLOCK pDevice,
  36. LM_REQUESTED_MEDIA_TYPE
  37. RequestedMediaType);
  38. static LM_STATUS LM_ForceAutoNeg (PLM_DEVICE_BLOCK pDevice,
  39. LM_REQUESTED_MEDIA_TYPE RequestedMediaType);
  40. static LM_UINT32 GetPhyAdFlowCntrlSettings (PLM_DEVICE_BLOCK pDevice);
  41. STATIC LM_STATUS LM_SetFlowControl (PLM_DEVICE_BLOCK pDevice,
  42. LM_UINT32 LocalPhyAd,
  43. LM_UINT32 RemotePhyAd);
  44. #if INCLUDE_TBI_SUPPORT
  45. STATIC LM_STATUS LM_SetupFiberPhy (PLM_DEVICE_BLOCK pDevice);
  46. STATIC LM_STATUS LM_InitBcm800xPhy (PLM_DEVICE_BLOCK pDevice);
  47. #endif
  48. STATIC LM_STATUS LM_SetupCopperPhy (PLM_DEVICE_BLOCK pDevice);
  49. STATIC PLM_ADAPTER_INFO LM_GetAdapterInfoBySsid (LM_UINT16 Svid,
  50. LM_UINT16 Ssid);
  51. STATIC LM_STATUS LM_DmaTest (PLM_DEVICE_BLOCK pDevice, PLM_UINT8 pBufferVirt,
  52. LM_PHYSICAL_ADDRESS BufferPhy,
  53. LM_UINT32 BufferSize);
  54. STATIC LM_STATUS LM_HaltCpu (PLM_DEVICE_BLOCK pDevice, LM_UINT32 cpu_number);
  55. STATIC LM_STATUS LM_ResetChip (PLM_DEVICE_BLOCK pDevice);
  56. STATIC LM_STATUS LM_Test4GBoundary (PLM_DEVICE_BLOCK pDevice,
  57. PLM_PACKET pPacket, PT3_SND_BD pSendBd);
  58. /******************************************************************************/
  59. /* External functions. */
  60. /******************************************************************************/
  61. LM_STATUS LM_LoadRlsFirmware (PLM_DEVICE_BLOCK pDevice);
  62. /******************************************************************************/
  63. /* Description: */
  64. /* */
  65. /* Return: */
  66. /******************************************************************************/
  67. LM_UINT32 LM_RegRdInd (PLM_DEVICE_BLOCK pDevice, LM_UINT32 Register)
  68. {
  69. LM_UINT32 Value32;
  70. #if PCIX_TARGET_WORKAROUND
  71. MM_ACQUIRE_UNDI_LOCK (pDevice);
  72. #endif
  73. MM_WriteConfig32 (pDevice, T3_PCI_REG_ADDR_REG, Register);
  74. MM_ReadConfig32 (pDevice, T3_PCI_REG_DATA_REG, &Value32);
  75. #if PCIX_TARGET_WORKAROUND
  76. MM_RELEASE_UNDI_LOCK (pDevice);
  77. #endif
  78. return Value32;
  79. } /* LM_RegRdInd */
  80. /******************************************************************************/
  81. /* Description: */
  82. /* */
  83. /* Return: */
  84. /******************************************************************************/
  85. LM_VOID
  86. LM_RegWrInd (PLM_DEVICE_BLOCK pDevice, LM_UINT32 Register, LM_UINT32 Value32)
  87. {
  88. #if PCIX_TARGET_WORKAROUND
  89. MM_ACQUIRE_UNDI_LOCK (pDevice);
  90. #endif
  91. MM_WriteConfig32 (pDevice, T3_PCI_REG_ADDR_REG, Register);
  92. MM_WriteConfig32 (pDevice, T3_PCI_REG_DATA_REG, Value32);
  93. #if PCIX_TARGET_WORKAROUND
  94. MM_RELEASE_UNDI_LOCK (pDevice);
  95. #endif
  96. } /* LM_RegWrInd */
  97. /******************************************************************************/
  98. /* Description: */
  99. /* */
  100. /* Return: */
  101. /******************************************************************************/
  102. LM_UINT32 LM_MemRdInd (PLM_DEVICE_BLOCK pDevice, LM_UINT32 MemAddr)
  103. {
  104. LM_UINT32 Value32;
  105. MM_ACQUIRE_UNDI_LOCK (pDevice);
  106. #ifdef BIG_ENDIAN_HOST
  107. MM_WriteConfig32 (pDevice, T3_PCI_MEM_WIN_ADDR_REG, MemAddr);
  108. Value32 = REG_RD (pDevice, PciCfg.MemWindowData);
  109. /* Value32 = REG_RD(pDevice,uIntMem.Mbuf[(MemAddr & 0x7fff)/4]); */
  110. #else
  111. MM_WriteConfig32 (pDevice, T3_PCI_MEM_WIN_ADDR_REG, MemAddr);
  112. MM_ReadConfig32 (pDevice, T3_PCI_MEM_WIN_DATA_REG, &Value32);
  113. #endif
  114. MM_RELEASE_UNDI_LOCK (pDevice);
  115. return Value32;
  116. } /* LM_MemRdInd */
  117. /******************************************************************************/
  118. /* Description: */
  119. /* */
  120. /* Return: */
  121. /******************************************************************************/
  122. LM_VOID
  123. LM_MemWrInd (PLM_DEVICE_BLOCK pDevice, LM_UINT32 MemAddr, LM_UINT32 Value32)
  124. {
  125. MM_ACQUIRE_UNDI_LOCK (pDevice);
  126. #ifdef BIG_ENDIAN_HOST
  127. REG_WR (pDevice, PciCfg.MemWindowBaseAddr, MemAddr);
  128. REG_WR (pDevice, uIntMem.Mbuf[(MemAddr & 0x7fff) / 4], Value32);
  129. #else
  130. MM_WriteConfig32 (pDevice, T3_PCI_MEM_WIN_ADDR_REG, MemAddr);
  131. MM_WriteConfig32 (pDevice, T3_PCI_MEM_WIN_DATA_REG, Value32);
  132. #endif
  133. MM_RELEASE_UNDI_LOCK (pDevice);
  134. } /* LM_MemWrInd */
  135. /******************************************************************************/
  136. /* Description: */
  137. /* */
  138. /* Return: */
  139. /******************************************************************************/
  140. LM_STATUS LM_QueueRxPackets (PLM_DEVICE_BLOCK pDevice)
  141. {
  142. LM_STATUS Lmstatus;
  143. PLM_PACKET pPacket;
  144. PT3_RCV_BD pRcvBd;
  145. LM_UINT32 StdBdAdded = 0;
  146. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  147. LM_UINT32 JumboBdAdded = 0;
  148. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  149. Lmstatus = LM_STATUS_SUCCESS;
  150. pPacket = (PLM_PACKET) QQ_PopHead (&pDevice->RxPacketFreeQ.Container);
  151. while (pPacket) {
  152. switch (pPacket->u.Rx.RcvProdRing) {
  153. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  154. case T3_JUMBO_RCV_PROD_RING: /* Jumbo Receive Ring. */
  155. /* Initialize the buffer descriptor. */
  156. pRcvBd =
  157. &pDevice->pRxJumboBdVirt[pDevice->RxJumboProdIdx];
  158. pRcvBd->Flags =
  159. RCV_BD_FLAG_END | RCV_BD_FLAG_JUMBO_RING;
  160. pRcvBd->Len = (LM_UINT16) pDevice->RxJumboBufferSize;
  161. /* Initialize the receive buffer pointer */
  162. #if 0 /* Jimmy, deleted in new */
  163. pRcvBd->HostAddr.Low = pPacket->u.Rx.RxBufferPhy.Low;
  164. pRcvBd->HostAddr.High = pPacket->u.Rx.RxBufferPhy.High;
  165. #endif
  166. MM_MapRxDma (pDevice, pPacket, &pRcvBd->HostAddr);
  167. /* The opaque field may point to an offset from a fix addr. */
  168. pRcvBd->Opaque = (LM_UINT32) (MM_UINT_PTR (pPacket) -
  169. MM_UINT_PTR (pDevice->
  170. pPacketDescBase));
  171. /* Update the producer index. */
  172. pDevice->RxJumboProdIdx =
  173. (pDevice->RxJumboProdIdx +
  174. 1) & T3_JUMBO_RCV_RCB_ENTRY_COUNT_MASK;
  175. JumboBdAdded++;
  176. break;
  177. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  178. case T3_STD_RCV_PROD_RING: /* Standard Receive Ring. */
  179. /* Initialize the buffer descriptor. */
  180. pRcvBd = &pDevice->pRxStdBdVirt[pDevice->RxStdProdIdx];
  181. pRcvBd->Flags = RCV_BD_FLAG_END;
  182. pRcvBd->Len = MAX_STD_RCV_BUFFER_SIZE;
  183. /* Initialize the receive buffer pointer */
  184. #if 0 /* Jimmy, deleted in new replaced with MM_MapRxDma */
  185. pRcvBd->HostAddr.Low = pPacket->u.Rx.RxBufferPhy.Low;
  186. pRcvBd->HostAddr.High = pPacket->u.Rx.RxBufferPhy.High;
  187. #endif
  188. MM_MapRxDma (pDevice, pPacket, &pRcvBd->HostAddr);
  189. /* The opaque field may point to an offset from a fix addr. */
  190. pRcvBd->Opaque = (LM_UINT32) (MM_UINT_PTR (pPacket) -
  191. MM_UINT_PTR (pDevice->
  192. pPacketDescBase));
  193. /* Update the producer index. */
  194. pDevice->RxStdProdIdx = (pDevice->RxStdProdIdx + 1) &
  195. T3_STD_RCV_RCB_ENTRY_COUNT_MASK;
  196. StdBdAdded++;
  197. break;
  198. case T3_UNKNOWN_RCV_PROD_RING:
  199. default:
  200. Lmstatus = LM_STATUS_FAILURE;
  201. break;
  202. } /* switch */
  203. /* Bail out if there is any error. */
  204. if (Lmstatus != LM_STATUS_SUCCESS) {
  205. break;
  206. }
  207. pPacket =
  208. (PLM_PACKET) QQ_PopHead (&pDevice->RxPacketFreeQ.Container);
  209. } /* while */
  210. wmb ();
  211. /* Update the procedure index. */
  212. if (StdBdAdded) {
  213. MB_REG_WR (pDevice, Mailbox.RcvStdProdIdx.Low,
  214. pDevice->RxStdProdIdx);
  215. }
  216. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  217. if (JumboBdAdded) {
  218. MB_REG_WR (pDevice, Mailbox.RcvJumboProdIdx.Low,
  219. pDevice->RxJumboProdIdx);
  220. }
  221. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  222. return Lmstatus;
  223. } /* LM_QueueRxPackets */
  224. /******************************************************************************/
  225. /* Description: */
  226. /* */
  227. /* Return: */
  228. /******************************************************************************/
  229. STATIC LM_VOID LM_NvramInit (PLM_DEVICE_BLOCK pDevice)
  230. {
  231. LM_UINT32 Value32;
  232. LM_UINT32 j;
  233. /* Intialize clock period and state machine. */
  234. Value32 = SEEPROM_ADDR_CLK_PERD (SEEPROM_CLOCK_PERIOD) |
  235. SEEPROM_ADDR_FSM_RESET;
  236. REG_WR (pDevice, Grc.EepromAddr, Value32);
  237. for (j = 0; j < 100; j++) {
  238. MM_Wait (10);
  239. }
  240. /* Serial eeprom access using the Grc.EepromAddr/EepromData registers. */
  241. Value32 = REG_RD (pDevice, Grc.LocalCtrl);
  242. REG_WR (pDevice, Grc.LocalCtrl,
  243. Value32 | GRC_MISC_LOCAL_CTRL_AUTO_SEEPROM);
  244. /* Set the 5701 compatibility mode if we are using EEPROM. */
  245. if (T3_ASIC_REV (pDevice->ChipRevId) != T3_ASIC_REV_5700 &&
  246. T3_ASIC_REV (pDevice->ChipRevId) != T3_ASIC_REV_5701) {
  247. Value32 = REG_RD (pDevice, Nvram.Config1);
  248. if ((Value32 & FLASH_INTERFACE_ENABLE) == 0) {
  249. /* Use the new interface to read EEPROM. */
  250. Value32 &= ~FLASH_COMPAT_BYPASS;
  251. REG_WR (pDevice, Nvram.Config1, Value32);
  252. }
  253. }
  254. } /* LM_NvRamInit */
  255. /******************************************************************************/
  256. /* Description: */
  257. /* */
  258. /* Return: */
  259. /******************************************************************************/
  260. STATIC LM_STATUS
  261. LM_EepromRead (PLM_DEVICE_BLOCK pDevice, LM_UINT32 Offset, LM_UINT32 * pData)
  262. {
  263. LM_UINT32 Value32;
  264. LM_UINT32 Addr;
  265. LM_UINT32 Dev;
  266. LM_UINT32 j;
  267. if (Offset > SEEPROM_CHIP_SIZE) {
  268. return LM_STATUS_FAILURE;
  269. }
  270. Dev = Offset / SEEPROM_CHIP_SIZE;
  271. Addr = Offset % SEEPROM_CHIP_SIZE;
  272. Value32 = REG_RD (pDevice, Grc.EepromAddr);
  273. Value32 &= ~(SEEPROM_ADDR_ADDRESS_MASK | SEEPROM_ADDR_DEV_ID_MASK |
  274. SEEPROM_ADDR_RW_MASK);
  275. REG_WR (pDevice, Grc.EepromAddr, Value32 | SEEPROM_ADDR_DEV_ID (Dev) |
  276. SEEPROM_ADDR_ADDRESS (Addr) | SEEPROM_ADDR_START |
  277. SEEPROM_ADDR_READ);
  278. for (j = 0; j < 1000; j++) {
  279. Value32 = REG_RD (pDevice, Grc.EepromAddr);
  280. if (Value32 & SEEPROM_ADDR_COMPLETE) {
  281. break;
  282. }
  283. MM_Wait (10);
  284. }
  285. if (Value32 & SEEPROM_ADDR_COMPLETE) {
  286. Value32 = REG_RD (pDevice, Grc.EepromData);
  287. *pData = Value32;
  288. return LM_STATUS_SUCCESS;
  289. }
  290. return LM_STATUS_FAILURE;
  291. } /* LM_EepromRead */
  292. /******************************************************************************/
  293. /* Description: */
  294. /* */
  295. /* Return: */
  296. /******************************************************************************/
  297. STATIC LM_STATUS
  298. LM_NvramRead (PLM_DEVICE_BLOCK pDevice, LM_UINT32 Offset, LM_UINT32 * pData)
  299. {
  300. LM_UINT32 Value32;
  301. LM_STATUS Status;
  302. LM_UINT32 j;
  303. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  304. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  305. Status = LM_EepromRead (pDevice, Offset, pData);
  306. } else {
  307. /* Determine if we have flash or EEPROM. */
  308. Value32 = REG_RD (pDevice, Nvram.Config1);
  309. if (Value32 & FLASH_INTERFACE_ENABLE) {
  310. if (Value32 & FLASH_SSRAM_BUFFERRED_MODE) {
  311. Offset = ((Offset / BUFFERED_FLASH_PAGE_SIZE) <<
  312. BUFFERED_FLASH_PAGE_POS) +
  313. (Offset % BUFFERED_FLASH_PAGE_SIZE);
  314. }
  315. }
  316. REG_WR (pDevice, Nvram.SwArb, SW_ARB_REQ_SET1);
  317. for (j = 0; j < 1000; j++) {
  318. if (REG_RD (pDevice, Nvram.SwArb) & SW_ARB_GNT1) {
  319. break;
  320. }
  321. MM_Wait (20);
  322. }
  323. if (j == 1000) {
  324. return LM_STATUS_FAILURE;
  325. }
  326. /* Read from flash or EEPROM with the new 5703/02 interface. */
  327. REG_WR (pDevice, Nvram.Addr, Offset & NVRAM_ADDRESS_MASK);
  328. REG_WR (pDevice, Nvram.Cmd, NVRAM_CMD_RD | NVRAM_CMD_DO_IT |
  329. NVRAM_CMD_FIRST | NVRAM_CMD_LAST | NVRAM_CMD_DONE);
  330. /* Wait for the done bit to clear. */
  331. for (j = 0; j < 500; j++) {
  332. MM_Wait (10);
  333. Value32 = REG_RD (pDevice, Nvram.Cmd);
  334. if (!(Value32 & NVRAM_CMD_DONE)) {
  335. break;
  336. }
  337. }
  338. /* Wait for the done bit. */
  339. if (!(Value32 & NVRAM_CMD_DONE)) {
  340. for (j = 0; j < 500; j++) {
  341. MM_Wait (10);
  342. Value32 = REG_RD (pDevice, Nvram.Cmd);
  343. if (Value32 & NVRAM_CMD_DONE) {
  344. MM_Wait (10);
  345. *pData =
  346. REG_RD (pDevice, Nvram.ReadData);
  347. /* Change the endianess. */
  348. *pData =
  349. ((*pData & 0xff) << 24) |
  350. ((*pData & 0xff00) << 8) |
  351. ((*pData & 0xff0000) >> 8) |
  352. ((*pData >> 24) & 0xff);
  353. break;
  354. }
  355. }
  356. }
  357. REG_WR (pDevice, Nvram.SwArb, SW_ARB_REQ_CLR1);
  358. if (Value32 & NVRAM_CMD_DONE) {
  359. Status = LM_STATUS_SUCCESS;
  360. } else {
  361. Status = LM_STATUS_FAILURE;
  362. }
  363. }
  364. return Status;
  365. } /* LM_NvramRead */
  366. STATIC void LM_ReadVPD (PLM_DEVICE_BLOCK pDevice)
  367. {
  368. LM_UINT32 Vpd_arr[256 / 4];
  369. LM_UINT8 *Vpd = (LM_UINT8 *) & Vpd_arr[0];
  370. LM_UINT32 *Vpd_dptr = &Vpd_arr[0];
  371. LM_UINT32 Value32;
  372. unsigned int j;
  373. /* Read PN from VPD */
  374. for (j = 0; j < 256; j += 4, Vpd_dptr++) {
  375. if (LM_NvramRead (pDevice, 0x100 + j, &Value32) !=
  376. LM_STATUS_SUCCESS) {
  377. printf ("BCM570x: LM_ReadVPD: VPD read failed"
  378. " (no EEPROM onboard)\n");
  379. return;
  380. }
  381. *Vpd_dptr = cpu_to_le32 (Value32);
  382. }
  383. for (j = 0; j < 256;) {
  384. unsigned int Vpd_r_len;
  385. unsigned int Vpd_r_end;
  386. if ((Vpd[j] == 0x82) || (Vpd[j] == 0x91)) {
  387. j = j + 3 + Vpd[j + 1] + (Vpd[j + 2] << 8);
  388. } else if (Vpd[j] == 0x90) {
  389. Vpd_r_len = Vpd[j + 1] + (Vpd[j + 2] << 8);
  390. j += 3;
  391. Vpd_r_end = Vpd_r_len + j;
  392. while (j < Vpd_r_end) {
  393. if ((Vpd[j] == 'P') && (Vpd[j + 1] == 'N')) {
  394. unsigned int len = Vpd[j + 2];
  395. if (len <= 24) {
  396. memcpy (pDevice->PartNo,
  397. &Vpd[j + 3], len);
  398. }
  399. break;
  400. } else {
  401. if (Vpd[j + 2] == 0) {
  402. break;
  403. }
  404. j = j + Vpd[j + 2];
  405. }
  406. }
  407. break;
  408. } else {
  409. break;
  410. }
  411. }
  412. }
  413. STATIC void LM_ReadBootCodeVersion (PLM_DEVICE_BLOCK pDevice)
  414. {
  415. LM_UINT32 Value32, offset, ver_offset;
  416. int i;
  417. if (LM_NvramRead (pDevice, 0x0, &Value32) != LM_STATUS_SUCCESS)
  418. return;
  419. if (Value32 != 0xaa559966)
  420. return;
  421. if (LM_NvramRead (pDevice, 0xc, &offset) != LM_STATUS_SUCCESS)
  422. return;
  423. offset = ((offset & 0xff) << 24) | ((offset & 0xff00) << 8) |
  424. ((offset & 0xff0000) >> 8) | ((offset >> 24) & 0xff);
  425. if (LM_NvramRead (pDevice, offset, &Value32) != LM_STATUS_SUCCESS)
  426. return;
  427. if ((Value32 == 0x0300000e) &&
  428. (LM_NvramRead (pDevice, offset + 4, &Value32) == LM_STATUS_SUCCESS)
  429. && (Value32 == 0)) {
  430. if (LM_NvramRead (pDevice, offset + 8, &ver_offset) !=
  431. LM_STATUS_SUCCESS)
  432. return;
  433. ver_offset = ((ver_offset & 0xff0000) >> 8) |
  434. ((ver_offset >> 24) & 0xff);
  435. for (i = 0; i < 16; i += 4) {
  436. if (LM_NvramRead
  437. (pDevice, offset + ver_offset + i,
  438. &Value32) != LM_STATUS_SUCCESS) {
  439. return;
  440. }
  441. *((LM_UINT32 *) & pDevice->BootCodeVer[i]) =
  442. cpu_to_le32 (Value32);
  443. }
  444. } else {
  445. char c;
  446. if (LM_NvramRead (pDevice, 0x94, &Value32) != LM_STATUS_SUCCESS)
  447. return;
  448. i = 0;
  449. c = ((Value32 & 0xff0000) >> 16);
  450. if (c < 10) {
  451. pDevice->BootCodeVer[i++] = c + '0';
  452. } else {
  453. pDevice->BootCodeVer[i++] = (c / 10) + '0';
  454. pDevice->BootCodeVer[i++] = (c % 10) + '0';
  455. }
  456. pDevice->BootCodeVer[i++] = '.';
  457. c = (Value32 & 0xff000000) >> 24;
  458. if (c < 10) {
  459. pDevice->BootCodeVer[i++] = c + '0';
  460. } else {
  461. pDevice->BootCodeVer[i++] = (c / 10) + '0';
  462. pDevice->BootCodeVer[i++] = (c % 10) + '0';
  463. }
  464. pDevice->BootCodeVer[i] = 0;
  465. }
  466. }
  467. STATIC void LM_GetBusSpeed (PLM_DEVICE_BLOCK pDevice)
  468. {
  469. LM_UINT32 PciState = pDevice->PciState;
  470. LM_UINT32 ClockCtrl;
  471. char *SpeedStr = "";
  472. if (PciState & T3_PCI_STATE_32BIT_PCI_BUS) {
  473. strcpy (pDevice->BusSpeedStr, "32-bit ");
  474. } else {
  475. strcpy (pDevice->BusSpeedStr, "64-bit ");
  476. }
  477. if (PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE) {
  478. strcat (pDevice->BusSpeedStr, "PCI ");
  479. if (PciState & T3_PCI_STATE_HIGH_BUS_SPEED) {
  480. SpeedStr = "66MHz";
  481. } else {
  482. SpeedStr = "33MHz";
  483. }
  484. } else {
  485. strcat (pDevice->BusSpeedStr, "PCIX ");
  486. if (pDevice->BondId == GRC_MISC_BD_ID_5704CIOBE) {
  487. SpeedStr = "133MHz";
  488. } else {
  489. ClockCtrl = REG_RD (pDevice, PciCfg.ClockCtrl) & 0x1f;
  490. switch (ClockCtrl) {
  491. case 0:
  492. SpeedStr = "33MHz";
  493. break;
  494. case 2:
  495. SpeedStr = "50MHz";
  496. break;
  497. case 4:
  498. SpeedStr = "66MHz";
  499. break;
  500. case 6:
  501. SpeedStr = "100MHz";
  502. break;
  503. case 7:
  504. SpeedStr = "133MHz";
  505. break;
  506. }
  507. }
  508. }
  509. strcat (pDevice->BusSpeedStr, SpeedStr);
  510. }
  511. /******************************************************************************/
  512. /* Description: */
  513. /* This routine initializes default parameters and reads the PCI */
  514. /* configurations. */
  515. /* */
  516. /* Return: */
  517. /* LM_STATUS_SUCCESS */
  518. /******************************************************************************/
  519. LM_STATUS LM_GetAdapterInfo (PLM_DEVICE_BLOCK pDevice)
  520. {
  521. PLM_ADAPTER_INFO pAdapterInfo;
  522. LM_UINT32 Value32;
  523. LM_STATUS Status;
  524. LM_UINT32 j;
  525. LM_UINT32 EeSigFound;
  526. LM_UINT32 EePhyTypeSerdes = 0;
  527. LM_UINT32 EePhyLedMode = 0;
  528. LM_UINT32 EePhyId = 0;
  529. /* Get Device Id and Vendor Id */
  530. Status = MM_ReadConfig32 (pDevice, PCI_VENDOR_ID_REG, &Value32);
  531. if (Status != LM_STATUS_SUCCESS) {
  532. return Status;
  533. }
  534. pDevice->PciVendorId = (LM_UINT16) Value32;
  535. pDevice->PciDeviceId = (LM_UINT16) (Value32 >> 16);
  536. /* If we are not getting the write adapter, exit. */
  537. if ((Value32 != T3_PCI_ID_BCM5700) &&
  538. (Value32 != T3_PCI_ID_BCM5701) &&
  539. (Value32 != T3_PCI_ID_BCM5702) &&
  540. (Value32 != T3_PCI_ID_BCM5702x) &&
  541. (Value32 != T3_PCI_ID_BCM5702FE) &&
  542. (Value32 != T3_PCI_ID_BCM5703) &&
  543. (Value32 != T3_PCI_ID_BCM5703x) && (Value32 != T3_PCI_ID_BCM5704)) {
  544. return LM_STATUS_FAILURE;
  545. }
  546. Status = MM_ReadConfig32 (pDevice, PCI_REV_ID_REG, &Value32);
  547. if (Status != LM_STATUS_SUCCESS) {
  548. return Status;
  549. }
  550. pDevice->PciRevId = (LM_UINT8) Value32;
  551. /* Get IRQ. */
  552. Status = MM_ReadConfig32 (pDevice, PCI_INT_LINE_REG, &Value32);
  553. if (Status != LM_STATUS_SUCCESS) {
  554. return Status;
  555. }
  556. pDevice->Irq = (LM_UINT8) Value32;
  557. /* Get interrupt pin. */
  558. pDevice->IntPin = (LM_UINT8) (Value32 >> 8);
  559. /* Get chip revision id. */
  560. Status = MM_ReadConfig32 (pDevice, T3_PCI_MISC_HOST_CTRL_REG, &Value32);
  561. pDevice->ChipRevId = Value32 >> 16;
  562. /* Get subsystem vendor. */
  563. Status =
  564. MM_ReadConfig32 (pDevice, PCI_SUBSYSTEM_VENDOR_ID_REG, &Value32);
  565. if (Status != LM_STATUS_SUCCESS) {
  566. return Status;
  567. }
  568. pDevice->SubsystemVendorId = (LM_UINT16) Value32;
  569. /* Get PCI subsystem id. */
  570. pDevice->SubsystemId = (LM_UINT16) (Value32 >> 16);
  571. /* Get the cache line size. */
  572. MM_ReadConfig32 (pDevice, PCI_CACHE_LINE_SIZE_REG, &Value32);
  573. pDevice->CacheLineSize = (LM_UINT8) Value32;
  574. pDevice->SavedCacheLineReg = Value32;
  575. if (pDevice->ChipRevId != T3_CHIP_ID_5703_A1 &&
  576. pDevice->ChipRevId != T3_CHIP_ID_5703_A2 &&
  577. pDevice->ChipRevId != T3_CHIP_ID_5704_A0) {
  578. pDevice->UndiFix = FALSE;
  579. }
  580. #if !PCIX_TARGET_WORKAROUND
  581. pDevice->UndiFix = FALSE;
  582. #endif
  583. /* Map the memory base to system address space. */
  584. if (!pDevice->UndiFix) {
  585. Status = MM_MapMemBase (pDevice);
  586. if (Status != LM_STATUS_SUCCESS) {
  587. return Status;
  588. }
  589. /* Initialize the memory view pointer. */
  590. pDevice->pMemView = (PT3_STD_MEM_MAP) pDevice->pMappedMemBase;
  591. }
  592. #if PCIX_TARGET_WORKAROUND
  593. /* store whether we are in PCI are PCI-X mode */
  594. pDevice->EnablePciXFix = FALSE;
  595. MM_ReadConfig32 (pDevice, T3_PCI_STATE_REG, &Value32);
  596. if ((Value32 & T3_PCI_STATE_CONVENTIONAL_PCI_MODE) == 0) {
  597. /* Enable PCI-X workaround only if we are running on 5700 BX. */
  598. if (T3_CHIP_REV (pDevice->ChipRevId) == T3_CHIP_REV_5700_BX) {
  599. pDevice->EnablePciXFix = TRUE;
  600. }
  601. }
  602. if (pDevice->UndiFix) {
  603. pDevice->EnablePciXFix = TRUE;
  604. }
  605. #endif
  606. /* Bx bug: due to the "byte_enable bug" in PCI-X mode, the power */
  607. /* management register may be clobbered which may cause the */
  608. /* BCM5700 to go into D3 state. While in this state, we will */
  609. /* not have memory mapped register access. As a workaround, we */
  610. /* need to restore the device to D0 state. */
  611. MM_ReadConfig32 (pDevice, T3_PCI_PM_STATUS_CTRL_REG, &Value32);
  612. Value32 |= T3_PM_PME_ASSERTED;
  613. Value32 &= ~T3_PM_POWER_STATE_MASK;
  614. Value32 |= T3_PM_POWER_STATE_D0;
  615. MM_WriteConfig32 (pDevice, T3_PCI_PM_STATUS_CTRL_REG, Value32);
  616. /* read the current PCI command word */
  617. MM_ReadConfig32 (pDevice, PCI_COMMAND_REG, &Value32);
  618. /* Make sure bus-mastering is enabled. */
  619. Value32 |= PCI_BUSMASTER_ENABLE;
  620. #if PCIX_TARGET_WORKAROUND
  621. /* if we are in PCI-X mode, also make sure mem-mapping and SERR#/PERR#
  622. are enabled */
  623. if (pDevice->EnablePciXFix == TRUE) {
  624. Value32 |= (PCI_MEM_SPACE_ENABLE | PCI_SYSTEM_ERROR_ENABLE |
  625. PCI_PARITY_ERROR_ENABLE);
  626. }
  627. if (pDevice->UndiFix) {
  628. Value32 &= ~PCI_MEM_SPACE_ENABLE;
  629. }
  630. #endif
  631. if (pDevice->EnableMWI) {
  632. Value32 |= PCI_MEMORY_WRITE_INVALIDATE;
  633. } else {
  634. Value32 &= (~PCI_MEMORY_WRITE_INVALIDATE);
  635. }
  636. /* Error out if mem-mapping is NOT enabled for PCI systems */
  637. if (!(Value32 | PCI_MEM_SPACE_ENABLE)) {
  638. return LM_STATUS_FAILURE;
  639. }
  640. /* save the value we are going to write into the PCI command word */
  641. pDevice->PciCommandStatusWords = Value32;
  642. Status = MM_WriteConfig32 (pDevice, PCI_COMMAND_REG, Value32);
  643. if (Status != LM_STATUS_SUCCESS) {
  644. return Status;
  645. }
  646. /* Set power state to D0. */
  647. LM_SetPowerState (pDevice, LM_POWER_STATE_D0);
  648. #ifdef BIG_ENDIAN_PCI
  649. pDevice->MiscHostCtrl =
  650. MISC_HOST_CTRL_MASK_PCI_INT |
  651. MISC_HOST_CTRL_ENABLE_INDIRECT_ACCESS |
  652. MISC_HOST_CTRL_ENABLE_ENDIAN_WORD_SWAP |
  653. MISC_HOST_CTRL_ENABLE_PCI_STATE_REG_RW;
  654. #else /* No CPU Swap modes for PCI IO */
  655. /* Setup the mode registers. */
  656. pDevice->MiscHostCtrl =
  657. MISC_HOST_CTRL_MASK_PCI_INT |
  658. MISC_HOST_CTRL_ENABLE_ENDIAN_WORD_SWAP |
  659. #ifdef BIG_ENDIAN_HOST
  660. MISC_HOST_CTRL_ENABLE_ENDIAN_BYTE_SWAP |
  661. #endif /* BIG_ENDIAN_HOST */
  662. MISC_HOST_CTRL_ENABLE_INDIRECT_ACCESS |
  663. MISC_HOST_CTRL_ENABLE_PCI_STATE_REG_RW;
  664. #endif /* !BIG_ENDIAN_PCI */
  665. /* write to PCI misc host ctr first in order to enable indirect accesses */
  666. MM_WriteConfig32 (pDevice, T3_PCI_MISC_HOST_CTRL_REG,
  667. pDevice->MiscHostCtrl);
  668. REG_WR (pDevice, PciCfg.MiscHostCtrl, pDevice->MiscHostCtrl);
  669. #ifdef BIG_ENDIAN_PCI
  670. Value32 = GRC_MODE_WORD_SWAP_DATA | GRC_MODE_WORD_SWAP_NON_FRAME_DATA;
  671. #else
  672. /* No CPU Swap modes for PCI IO */
  673. #ifdef BIG_ENDIAN_HOST
  674. Value32 = GRC_MODE_BYTE_SWAP_NON_FRAME_DATA |
  675. GRC_MODE_WORD_SWAP_NON_FRAME_DATA;
  676. #else
  677. Value32 = GRC_MODE_BYTE_SWAP_NON_FRAME_DATA | GRC_MODE_BYTE_SWAP_DATA;
  678. #endif
  679. #endif /* !BIG_ENDIAN_PCI */
  680. REG_WR (pDevice, Grc.Mode, Value32);
  681. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  682. REG_WR (pDevice, Grc.LocalCtrl,
  683. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1 |
  684. GRC_MISC_LOCAL_CTRL_GPIO_OE1);
  685. }
  686. MM_Wait (40);
  687. /* Enable indirect memory access */
  688. REG_WR (pDevice, MemArbiter.Mode, T3_MEM_ARBITER_MODE_ENABLE);
  689. if (REG_RD (pDevice, PciCfg.ClockCtrl) & T3_PCI_44MHZ_CORE_CLOCK) {
  690. REG_WR (pDevice, PciCfg.ClockCtrl, T3_PCI_44MHZ_CORE_CLOCK |
  691. T3_PCI_SELECT_ALTERNATE_CLOCK);
  692. REG_WR (pDevice, PciCfg.ClockCtrl,
  693. T3_PCI_SELECT_ALTERNATE_CLOCK);
  694. MM_Wait (40); /* required delay is 27usec */
  695. }
  696. REG_WR (pDevice, PciCfg.ClockCtrl, 0);
  697. REG_WR (pDevice, PciCfg.MemWindowBaseAddr, 0);
  698. #if PCIX_TARGET_WORKAROUND
  699. MM_ReadConfig32 (pDevice, T3_PCI_STATE_REG, &Value32);
  700. if ((pDevice->EnablePciXFix == FALSE) &&
  701. ((Value32 & T3_PCI_STATE_CONVENTIONAL_PCI_MODE) == 0)) {
  702. if (pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
  703. pDevice->ChipRevId == T3_CHIP_ID_5701_B0 ||
  704. pDevice->ChipRevId == T3_CHIP_ID_5701_B2 ||
  705. pDevice->ChipRevId == T3_CHIP_ID_5701_B5) {
  706. __raw_writel (0,
  707. &(pDevice->pMemView->uIntMem.
  708. MemBlock32K[0x300]));
  709. __raw_writel (0,
  710. &(pDevice->pMemView->uIntMem.
  711. MemBlock32K[0x301]));
  712. __raw_writel (0xffffffff,
  713. &(pDevice->pMemView->uIntMem.
  714. MemBlock32K[0x301]));
  715. if (__raw_readl
  716. (&(pDevice->pMemView->uIntMem.MemBlock32K[0x300])))
  717. {
  718. pDevice->EnablePciXFix = TRUE;
  719. }
  720. }
  721. }
  722. #endif
  723. #if 1
  724. /*
  725. * This code was at the beginning of else block below, but that's
  726. * a bug if node address in shared memory.
  727. */
  728. MM_Wait (50);
  729. LM_NvramInit (pDevice);
  730. #endif
  731. /* Get the node address. First try to get in from the shared memory. */
  732. /* If the signature is not present, then get it from the NVRAM. */
  733. Value32 = MEM_RD_OFFSET (pDevice, T3_MAC_ADDR_HIGH_MAILBOX);
  734. if ((Value32 >> 16) == 0x484b) {
  735. pDevice->NodeAddress[0] = (LM_UINT8) (Value32 >> 8);
  736. pDevice->NodeAddress[1] = (LM_UINT8) Value32;
  737. Value32 = MEM_RD_OFFSET (pDevice, T3_MAC_ADDR_LOW_MAILBOX);
  738. pDevice->NodeAddress[2] = (LM_UINT8) (Value32 >> 24);
  739. pDevice->NodeAddress[3] = (LM_UINT8) (Value32 >> 16);
  740. pDevice->NodeAddress[4] = (LM_UINT8) (Value32 >> 8);
  741. pDevice->NodeAddress[5] = (LM_UINT8) Value32;
  742. Status = LM_STATUS_SUCCESS;
  743. } else {
  744. Status = LM_NvramRead (pDevice, 0x7c, &Value32);
  745. if (Status == LM_STATUS_SUCCESS) {
  746. pDevice->NodeAddress[0] = (LM_UINT8) (Value32 >> 16);
  747. pDevice->NodeAddress[1] = (LM_UINT8) (Value32 >> 24);
  748. Status = LM_NvramRead (pDevice, 0x80, &Value32);
  749. pDevice->NodeAddress[2] = (LM_UINT8) Value32;
  750. pDevice->NodeAddress[3] = (LM_UINT8) (Value32 >> 8);
  751. pDevice->NodeAddress[4] = (LM_UINT8) (Value32 >> 16);
  752. pDevice->NodeAddress[5] = (LM_UINT8) (Value32 >> 24);
  753. }
  754. }
  755. /* Assign a default address. */
  756. if (Status != LM_STATUS_SUCCESS) {
  757. #ifndef EMBEDDED
  758. printk (KERN_ERR
  759. "Cannot get MAC addr from NVRAM. Using default.\n");
  760. #endif
  761. pDevice->NodeAddress[0] = 0x00;
  762. pDevice->NodeAddress[1] = 0x10;
  763. pDevice->NodeAddress[2] = 0x18;
  764. pDevice->NodeAddress[3] = 0x68;
  765. pDevice->NodeAddress[4] = 0x61;
  766. pDevice->NodeAddress[5] = 0x76;
  767. }
  768. pDevice->PermanentNodeAddress[0] = pDevice->NodeAddress[0];
  769. pDevice->PermanentNodeAddress[1] = pDevice->NodeAddress[1];
  770. pDevice->PermanentNodeAddress[2] = pDevice->NodeAddress[2];
  771. pDevice->PermanentNodeAddress[3] = pDevice->NodeAddress[3];
  772. pDevice->PermanentNodeAddress[4] = pDevice->NodeAddress[4];
  773. pDevice->PermanentNodeAddress[5] = pDevice->NodeAddress[5];
  774. /* Initialize the default values. */
  775. pDevice->NoTxPseudoHdrChksum = FALSE;
  776. pDevice->NoRxPseudoHdrChksum = FALSE;
  777. pDevice->NicSendBd = FALSE;
  778. pDevice->TxPacketDescCnt = DEFAULT_TX_PACKET_DESC_COUNT;
  779. pDevice->RxStdDescCnt = DEFAULT_STD_RCV_DESC_COUNT;
  780. pDevice->RxCoalescingTicks = DEFAULT_RX_COALESCING_TICKS;
  781. pDevice->TxCoalescingTicks = DEFAULT_TX_COALESCING_TICKS;
  782. pDevice->RxMaxCoalescedFrames = DEFAULT_RX_MAX_COALESCED_FRAMES;
  783. pDevice->TxMaxCoalescedFrames = DEFAULT_TX_MAX_COALESCED_FRAMES;
  784. pDevice->RxCoalescingTicksDuringInt = BAD_DEFAULT_VALUE;
  785. pDevice->TxCoalescingTicksDuringInt = BAD_DEFAULT_VALUE;
  786. pDevice->RxMaxCoalescedFramesDuringInt = BAD_DEFAULT_VALUE;
  787. pDevice->TxMaxCoalescedFramesDuringInt = BAD_DEFAULT_VALUE;
  788. pDevice->StatsCoalescingTicks = DEFAULT_STATS_COALESCING_TICKS;
  789. pDevice->EnableMWI = FALSE;
  790. pDevice->TxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
  791. pDevice->RxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
  792. pDevice->DisableAutoNeg = FALSE;
  793. pDevice->PhyIntMode = T3_PHY_INT_MODE_AUTO;
  794. pDevice->LinkChngMode = T3_LINK_CHNG_MODE_AUTO;
  795. pDevice->LedMode = LED_MODE_AUTO;
  796. pDevice->ResetPhyOnInit = TRUE;
  797. pDevice->DelayPciGrant = TRUE;
  798. pDevice->UseTaggedStatus = FALSE;
  799. pDevice->OneDmaAtOnce = BAD_DEFAULT_VALUE;
  800. pDevice->DmaMbufLowMark = T3_DEF_DMA_MBUF_LOW_WMARK_JUMBO;
  801. pDevice->RxMacMbufLowMark = T3_DEF_RX_MAC_MBUF_LOW_WMARK_JUMBO;
  802. pDevice->MbufHighMark = T3_DEF_MBUF_HIGH_WMARK_JUMBO;
  803. pDevice->RequestedMediaType = LM_REQUESTED_MEDIA_TYPE_AUTO;
  804. pDevice->TaskOffloadCap = LM_TASK_OFFLOAD_NONE;
  805. pDevice->FlowControlCap = LM_FLOW_CONTROL_AUTO_PAUSE;
  806. pDevice->EnableTbi = FALSE;
  807. #if INCLUDE_TBI_SUPPORT
  808. pDevice->PollTbiLink = BAD_DEFAULT_VALUE;
  809. #endif
  810. switch (T3_ASIC_REV (pDevice->ChipRevId)) {
  811. case T3_ASIC_REV_5704:
  812. pDevice->MbufBase = T3_NIC_MBUF_POOL_ADDR;
  813. pDevice->MbufSize = T3_NIC_MBUF_POOL_SIZE64;
  814. break;
  815. default:
  816. pDevice->MbufBase = T3_NIC_MBUF_POOL_ADDR;
  817. pDevice->MbufSize = T3_NIC_MBUF_POOL_SIZE96;
  818. break;
  819. }
  820. pDevice->LinkStatus = LM_STATUS_LINK_DOWN;
  821. pDevice->QueueRxPackets = TRUE;
  822. pDevice->EnableWireSpeed = TRUE;
  823. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  824. pDevice->RxJumboDescCnt = DEFAULT_JUMBO_RCV_DESC_COUNT;
  825. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  826. /* Make this is a known adapter. */
  827. pAdapterInfo = LM_GetAdapterInfoBySsid (pDevice->SubsystemVendorId,
  828. pDevice->SubsystemId);
  829. pDevice->BondId = REG_RD (pDevice, Grc.MiscCfg) & GRC_MISC_BD_ID_MASK;
  830. if (pDevice->BondId != GRC_MISC_BD_ID_5700 &&
  831. pDevice->BondId != GRC_MISC_BD_ID_5701 &&
  832. pDevice->BondId != GRC_MISC_BD_ID_5702FE &&
  833. pDevice->BondId != GRC_MISC_BD_ID_5703 &&
  834. pDevice->BondId != GRC_MISC_BD_ID_5703S &&
  835. pDevice->BondId != GRC_MISC_BD_ID_5704 &&
  836. pDevice->BondId != GRC_MISC_BD_ID_5704CIOBE) {
  837. return LM_STATUS_UNKNOWN_ADAPTER;
  838. }
  839. pDevice->SplitModeEnable = SPLIT_MODE_DISABLE;
  840. if ((pDevice->ChipRevId == T3_CHIP_ID_5704_A0) &&
  841. (pDevice->BondId == GRC_MISC_BD_ID_5704CIOBE)) {
  842. pDevice->SplitModeEnable = SPLIT_MODE_ENABLE;
  843. pDevice->SplitModeMaxReq = SPLIT_MODE_5704_MAX_REQ;
  844. }
  845. /* Get Eeprom info. */
  846. Value32 = MEM_RD_OFFSET (pDevice, T3_NIC_DATA_SIG_ADDR);
  847. if (Value32 == T3_NIC_DATA_SIG) {
  848. EeSigFound = TRUE;
  849. Value32 = MEM_RD_OFFSET (pDevice, T3_NIC_DATA_NIC_CFG_ADDR);
  850. /* Determine PHY type. */
  851. switch (Value32 & T3_NIC_CFG_PHY_TYPE_MASK) {
  852. case T3_NIC_CFG_PHY_TYPE_COPPER:
  853. EePhyTypeSerdes = FALSE;
  854. break;
  855. case T3_NIC_CFG_PHY_TYPE_FIBER:
  856. EePhyTypeSerdes = TRUE;
  857. break;
  858. default:
  859. EePhyTypeSerdes = FALSE;
  860. break;
  861. }
  862. /* Determine PHY led mode. */
  863. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  864. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  865. switch (Value32 & T3_NIC_CFG_LED_MODE_MASK) {
  866. case T3_NIC_CFG_LED_MODE_TRIPLE_SPEED:
  867. EePhyLedMode = LED_MODE_THREE_LINK;
  868. break;
  869. case T3_NIC_CFG_LED_MODE_LINK_SPEED:
  870. EePhyLedMode = LED_MODE_LINK10;
  871. break;
  872. default:
  873. EePhyLedMode = LED_MODE_AUTO;
  874. break;
  875. }
  876. } else {
  877. switch (Value32 & T3_NIC_CFG_LED_MODE_MASK) {
  878. case T3_NIC_CFG_LED_MODE_OPEN_DRAIN:
  879. EePhyLedMode = LED_MODE_OPEN_DRAIN;
  880. break;
  881. case T3_NIC_CFG_LED_MODE_OUTPUT:
  882. EePhyLedMode = LED_MODE_OUTPUT;
  883. break;
  884. default:
  885. EePhyLedMode = LED_MODE_AUTO;
  886. break;
  887. }
  888. }
  889. if (pDevice->ChipRevId == T3_CHIP_ID_5703_A1 ||
  890. pDevice->ChipRevId == T3_CHIP_ID_5703_A2) {
  891. /* Enable EEPROM write protection. */
  892. if (Value32 & T3_NIC_EEPROM_WP) {
  893. pDevice->EepromWp = TRUE;
  894. }
  895. }
  896. /* Get the PHY Id. */
  897. Value32 = MEM_RD_OFFSET (pDevice, T3_NIC_DATA_PHY_ID_ADDR);
  898. if (Value32) {
  899. EePhyId = (((Value32 & T3_NIC_PHY_ID1_MASK) >> 16) &
  900. PHY_ID1_OUI_MASK) << 10;
  901. Value32 = Value32 & T3_NIC_PHY_ID2_MASK;
  902. EePhyId |= ((Value32 & PHY_ID2_OUI_MASK) << 16) |
  903. (Value32 & PHY_ID2_MODEL_MASK) | (Value32 &
  904. PHY_ID2_REV_MASK);
  905. } else {
  906. EePhyId = 0;
  907. }
  908. } else {
  909. EeSigFound = FALSE;
  910. }
  911. /* Set the PHY address. */
  912. pDevice->PhyAddr = PHY_DEVICE_ID;
  913. /* Disable auto polling. */
  914. pDevice->MiMode = 0xc0000;
  915. REG_WR (pDevice, MacCtrl.MiMode, pDevice->MiMode);
  916. MM_Wait (40);
  917. /* Get the PHY id. */
  918. LM_ReadPhy (pDevice, PHY_ID1_REG, &Value32);
  919. pDevice->PhyId = (Value32 & PHY_ID1_OUI_MASK) << 10;
  920. LM_ReadPhy (pDevice, PHY_ID2_REG, &Value32);
  921. pDevice->PhyId |= ((Value32 & PHY_ID2_OUI_MASK) << 16) |
  922. (Value32 & PHY_ID2_MODEL_MASK) | (Value32 & PHY_ID2_REV_MASK);
  923. /* Set the EnableTbi flag to false if we have a copper PHY. */
  924. switch (pDevice->PhyId & PHY_ID_MASK) {
  925. case PHY_BCM5400_PHY_ID:
  926. pDevice->EnableTbi = FALSE;
  927. break;
  928. case PHY_BCM5401_PHY_ID:
  929. pDevice->EnableTbi = FALSE;
  930. break;
  931. case PHY_BCM5411_PHY_ID:
  932. pDevice->EnableTbi = FALSE;
  933. break;
  934. case PHY_BCM5701_PHY_ID:
  935. pDevice->EnableTbi = FALSE;
  936. break;
  937. case PHY_BCM5703_PHY_ID:
  938. pDevice->EnableTbi = FALSE;
  939. break;
  940. case PHY_BCM5704_PHY_ID:
  941. pDevice->EnableTbi = FALSE;
  942. break;
  943. case PHY_BCM8002_PHY_ID:
  944. pDevice->EnableTbi = TRUE;
  945. break;
  946. default:
  947. if (pAdapterInfo) {
  948. pDevice->PhyId = pAdapterInfo->PhyId;
  949. pDevice->EnableTbi = pAdapterInfo->Serdes;
  950. } else if (EeSigFound) {
  951. pDevice->PhyId = EePhyId;
  952. pDevice->EnableTbi = EePhyTypeSerdes;
  953. }
  954. break;
  955. }
  956. /* Bail out if we don't know the copper PHY id. */
  957. if (UNKNOWN_PHY_ID (pDevice->PhyId) && !pDevice->EnableTbi) {
  958. return LM_STATUS_FAILURE;
  959. }
  960. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5703) {
  961. if ((pDevice->SavedCacheLineReg & 0xff00) < 0x4000) {
  962. pDevice->SavedCacheLineReg &= 0xffff00ff;
  963. pDevice->SavedCacheLineReg |= 0x4000;
  964. }
  965. }
  966. /* Change driver parameters. */
  967. Status = MM_GetConfig (pDevice);
  968. if (Status != LM_STATUS_SUCCESS) {
  969. return Status;
  970. }
  971. #if INCLUDE_5701_AX_FIX
  972. if (pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
  973. pDevice->ChipRevId == T3_CHIP_ID_5701_B0) {
  974. pDevice->ResetPhyOnInit = TRUE;
  975. }
  976. #endif
  977. /* Save the current phy link status. */
  978. if (!pDevice->EnableTbi) {
  979. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  980. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  981. /* If we don't have link reset the PHY. */
  982. if (!(Value32 & PHY_STATUS_LINK_PASS)
  983. || pDevice->ResetPhyOnInit) {
  984. LM_WritePhy (pDevice, PHY_CTRL_REG, PHY_CTRL_PHY_RESET);
  985. for (j = 0; j < 100; j++) {
  986. MM_Wait (10);
  987. LM_ReadPhy (pDevice, PHY_CTRL_REG, &Value32);
  988. if (Value32 && !(Value32 & PHY_CTRL_PHY_RESET)) {
  989. MM_Wait (40);
  990. break;
  991. }
  992. }
  993. #if INCLUDE_5701_AX_FIX
  994. /* 5701_AX_BX bug: only advertises 10mb speed. */
  995. if (pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
  996. pDevice->ChipRevId == T3_CHIP_ID_5701_B0) {
  997. Value32 = PHY_AN_AD_PROTOCOL_802_3_CSMA_CD |
  998. PHY_AN_AD_10BASET_HALF |
  999. PHY_AN_AD_10BASET_FULL |
  1000. PHY_AN_AD_100BASETX_FULL |
  1001. PHY_AN_AD_100BASETX_HALF;
  1002. Value32 |= GetPhyAdFlowCntrlSettings (pDevice);
  1003. LM_WritePhy (pDevice, PHY_AN_AD_REG, Value32);
  1004. pDevice->advertising = Value32;
  1005. Value32 = BCM540X_AN_AD_1000BASET_HALF |
  1006. BCM540X_AN_AD_1000BASET_FULL |
  1007. BCM540X_CONFIG_AS_MASTER |
  1008. BCM540X_ENABLE_CONFIG_AS_MASTER;
  1009. LM_WritePhy (pDevice,
  1010. BCM540X_1000BASET_CTRL_REG,
  1011. Value32);
  1012. pDevice->advertising1000 = Value32;
  1013. LM_WritePhy (pDevice, PHY_CTRL_REG,
  1014. PHY_CTRL_AUTO_NEG_ENABLE |
  1015. PHY_CTRL_RESTART_AUTO_NEG);
  1016. }
  1017. #endif
  1018. if (T3_ASIC_REV (pDevice->ChipRevId) ==
  1019. T3_ASIC_REV_5703) {
  1020. LM_WritePhy (pDevice, 0x18, 0x0c00);
  1021. LM_WritePhy (pDevice, 0x17, 0x201f);
  1022. LM_WritePhy (pDevice, 0x15, 0x2aaa);
  1023. }
  1024. if (pDevice->ChipRevId == T3_CHIP_ID_5704_A0) {
  1025. LM_WritePhy (pDevice, 0x1c, 0x8d68);
  1026. LM_WritePhy (pDevice, 0x1c, 0x8d68);
  1027. }
  1028. /* Enable Ethernet@WireSpeed. */
  1029. if (pDevice->EnableWireSpeed) {
  1030. LM_WritePhy (pDevice, 0x18, 0x7007);
  1031. LM_ReadPhy (pDevice, 0x18, &Value32);
  1032. LM_WritePhy (pDevice, 0x18,
  1033. Value32 | BIT_15 | BIT_4);
  1034. }
  1035. }
  1036. }
  1037. /* Turn off tap power management. */
  1038. if ((pDevice->PhyId & PHY_ID_MASK) == PHY_BCM5401_PHY_ID) {
  1039. LM_WritePhy (pDevice, BCM5401_AUX_CTRL, 0x0c20);
  1040. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x0012);
  1041. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x1804);
  1042. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x0013);
  1043. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x1204);
  1044. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
  1045. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x0132);
  1046. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
  1047. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x0232);
  1048. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x201f);
  1049. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x0a20);
  1050. MM_Wait (40);
  1051. }
  1052. #if INCLUDE_TBI_SUPPORT
  1053. pDevice->IgnoreTbiLinkChange = FALSE;
  1054. if (pDevice->EnableTbi) {
  1055. pDevice->WakeUpModeCap = LM_WAKE_UP_MODE_NONE;
  1056. pDevice->PhyIntMode = T3_PHY_INT_MODE_LINK_READY;
  1057. if ((pDevice->PollTbiLink == BAD_DEFAULT_VALUE) ||
  1058. pDevice->DisableAutoNeg) {
  1059. pDevice->PollTbiLink = FALSE;
  1060. }
  1061. } else {
  1062. pDevice->PollTbiLink = FALSE;
  1063. }
  1064. #endif /* INCLUDE_TBI_SUPPORT */
  1065. /* UseTaggedStatus is only valid for 5701 and later. */
  1066. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  1067. pDevice->UseTaggedStatus = FALSE;
  1068. pDevice->CoalesceMode = 0;
  1069. } else {
  1070. pDevice->CoalesceMode =
  1071. HOST_COALESCE_CLEAR_TICKS_ON_RX_BD_EVENT |
  1072. HOST_COALESCE_CLEAR_TICKS_ON_TX_BD_EVENT;
  1073. }
  1074. /* Set the status block size. */
  1075. if (T3_CHIP_REV (pDevice->ChipRevId) != T3_CHIP_REV_5700_AX &&
  1076. T3_CHIP_REV (pDevice->ChipRevId) != T3_CHIP_REV_5700_BX) {
  1077. pDevice->CoalesceMode |= HOST_COALESCE_32_BYTE_STATUS_MODE;
  1078. }
  1079. /* Check the DURING_INT coalescing ticks parameters. */
  1080. if (pDevice->UseTaggedStatus) {
  1081. if (pDevice->RxCoalescingTicksDuringInt == BAD_DEFAULT_VALUE) {
  1082. pDevice->RxCoalescingTicksDuringInt =
  1083. DEFAULT_RX_COALESCING_TICKS_DURING_INT;
  1084. }
  1085. if (pDevice->TxCoalescingTicksDuringInt == BAD_DEFAULT_VALUE) {
  1086. pDevice->TxCoalescingTicksDuringInt =
  1087. DEFAULT_TX_COALESCING_TICKS_DURING_INT;
  1088. }
  1089. if (pDevice->RxMaxCoalescedFramesDuringInt == BAD_DEFAULT_VALUE) {
  1090. pDevice->RxMaxCoalescedFramesDuringInt =
  1091. DEFAULT_RX_MAX_COALESCED_FRAMES_DURING_INT;
  1092. }
  1093. if (pDevice->TxMaxCoalescedFramesDuringInt == BAD_DEFAULT_VALUE) {
  1094. pDevice->TxMaxCoalescedFramesDuringInt =
  1095. DEFAULT_TX_MAX_COALESCED_FRAMES_DURING_INT;
  1096. }
  1097. } else {
  1098. if (pDevice->RxCoalescingTicksDuringInt == BAD_DEFAULT_VALUE) {
  1099. pDevice->RxCoalescingTicksDuringInt = 0;
  1100. }
  1101. if (pDevice->TxCoalescingTicksDuringInt == BAD_DEFAULT_VALUE) {
  1102. pDevice->TxCoalescingTicksDuringInt = 0;
  1103. }
  1104. if (pDevice->RxMaxCoalescedFramesDuringInt == BAD_DEFAULT_VALUE) {
  1105. pDevice->RxMaxCoalescedFramesDuringInt = 0;
  1106. }
  1107. if (pDevice->TxMaxCoalescedFramesDuringInt == BAD_DEFAULT_VALUE) {
  1108. pDevice->TxMaxCoalescedFramesDuringInt = 0;
  1109. }
  1110. }
  1111. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  1112. if (pDevice->RxMtu <= (MAX_STD_RCV_BUFFER_SIZE - 8 /* CRC */ )) {
  1113. pDevice->RxJumboDescCnt = 0;
  1114. if (pDevice->RxMtu <= MAX_ETHERNET_PACKET_SIZE_NO_CRC) {
  1115. pDevice->RxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
  1116. }
  1117. } else {
  1118. pDevice->RxJumboBufferSize =
  1119. (pDevice->RxMtu + 8 /* CRC + VLAN */ +
  1120. COMMON_CACHE_LINE_SIZE - 1) & ~COMMON_CACHE_LINE_MASK;
  1121. if (pDevice->RxJumboBufferSize > MAX_JUMBO_RCV_BUFFER_SIZE) {
  1122. pDevice->RxJumboBufferSize =
  1123. DEFAULT_JUMBO_RCV_BUFFER_SIZE;
  1124. pDevice->RxMtu =
  1125. pDevice->RxJumboBufferSize - 8 /* CRC + VLAN */ ;
  1126. }
  1127. pDevice->TxMtu = pDevice->RxMtu;
  1128. }
  1129. #else
  1130. pDevice->RxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
  1131. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  1132. pDevice->RxPacketDescCnt =
  1133. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  1134. pDevice->RxJumboDescCnt +
  1135. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  1136. pDevice->RxStdDescCnt;
  1137. if (pDevice->TxMtu < MAX_ETHERNET_PACKET_SIZE_NO_CRC) {
  1138. pDevice->TxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
  1139. }
  1140. if (pDevice->TxMtu > MAX_JUMBO_TX_BUFFER_SIZE) {
  1141. pDevice->TxMtu = MAX_JUMBO_TX_BUFFER_SIZE;
  1142. }
  1143. /* Configure the proper ways to get link change interrupt. */
  1144. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO) {
  1145. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  1146. pDevice->PhyIntMode = T3_PHY_INT_MODE_MI_INTERRUPT;
  1147. } else {
  1148. pDevice->PhyIntMode = T3_PHY_INT_MODE_LINK_READY;
  1149. }
  1150. } else if (pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING) {
  1151. /* Auto-polling does not work on 5700_AX and 5700_BX. */
  1152. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  1153. pDevice->PhyIntMode = T3_PHY_INT_MODE_MI_INTERRUPT;
  1154. }
  1155. }
  1156. /* Determine the method to get link change status. */
  1157. if (pDevice->LinkChngMode == T3_LINK_CHNG_MODE_AUTO) {
  1158. /* The link status bit in the status block does not work on 5700_AX */
  1159. /* and 5700_BX chips. */
  1160. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  1161. pDevice->LinkChngMode =
  1162. T3_LINK_CHNG_MODE_USE_STATUS_REG;
  1163. } else {
  1164. pDevice->LinkChngMode =
  1165. T3_LINK_CHNG_MODE_USE_STATUS_BLOCK;
  1166. }
  1167. }
  1168. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_MI_INTERRUPT ||
  1169. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  1170. pDevice->LinkChngMode = T3_LINK_CHNG_MODE_USE_STATUS_REG;
  1171. }
  1172. /* Configure PHY led mode. */
  1173. if (pDevice->LedMode == LED_MODE_AUTO) {
  1174. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  1175. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  1176. if (pDevice->SubsystemVendorId == T3_SVID_DELL) {
  1177. pDevice->LedMode = LED_MODE_LINK10;
  1178. } else {
  1179. pDevice->LedMode = LED_MODE_THREE_LINK;
  1180. if (EeSigFound && EePhyLedMode != LED_MODE_AUTO) {
  1181. pDevice->LedMode = EePhyLedMode;
  1182. }
  1183. }
  1184. /* bug? 5701 in LINK10 mode does not seem to work when */
  1185. /* PhyIntMode is LINK_READY. */
  1186. if (T3_ASIC_REV (pDevice->ChipRevId) != T3_ASIC_REV_5700
  1187. &&
  1188. #if INCLUDE_TBI_SUPPORT
  1189. pDevice->EnableTbi == FALSE &&
  1190. #endif
  1191. pDevice->LedMode == LED_MODE_LINK10) {
  1192. pDevice->PhyIntMode =
  1193. T3_PHY_INT_MODE_MI_INTERRUPT;
  1194. pDevice->LinkChngMode =
  1195. T3_LINK_CHNG_MODE_USE_STATUS_REG;
  1196. }
  1197. if (pDevice->EnableTbi) {
  1198. pDevice->LedMode = LED_MODE_THREE_LINK;
  1199. }
  1200. } else {
  1201. if (EeSigFound && EePhyLedMode != LED_MODE_AUTO) {
  1202. pDevice->LedMode = EePhyLedMode;
  1203. } else {
  1204. pDevice->LedMode = LED_MODE_OPEN_DRAIN;
  1205. }
  1206. }
  1207. }
  1208. /* Enable OneDmaAtOnce. */
  1209. if (pDevice->OneDmaAtOnce == BAD_DEFAULT_VALUE) {
  1210. pDevice->OneDmaAtOnce = FALSE;
  1211. }
  1212. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  1213. pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
  1214. pDevice->ChipRevId == T3_CHIP_ID_5701_B0 ||
  1215. pDevice->ChipRevId == T3_CHIP_ID_5701_B2) {
  1216. pDevice->WolSpeed = WOL_SPEED_10MB;
  1217. } else {
  1218. pDevice->WolSpeed = WOL_SPEED_100MB;
  1219. }
  1220. /* Offloadings. */
  1221. pDevice->TaskToOffload = LM_TASK_OFFLOAD_NONE;
  1222. /* Turn off task offloading on Ax. */
  1223. if (pDevice->ChipRevId == T3_CHIP_ID_5700_B0) {
  1224. pDevice->TaskOffloadCap &= ~(LM_TASK_OFFLOAD_TX_TCP_CHECKSUM |
  1225. LM_TASK_OFFLOAD_TX_UDP_CHECKSUM);
  1226. }
  1227. pDevice->PciState = REG_RD (pDevice, PciCfg.PciState);
  1228. LM_ReadVPD (pDevice);
  1229. LM_ReadBootCodeVersion (pDevice);
  1230. LM_GetBusSpeed (pDevice);
  1231. return LM_STATUS_SUCCESS;
  1232. } /* LM_GetAdapterInfo */
  1233. STATIC PLM_ADAPTER_INFO LM_GetAdapterInfoBySsid (LM_UINT16 Svid, LM_UINT16 Ssid)
  1234. {
  1235. static LM_ADAPTER_INFO AdapterArr[] = {
  1236. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95700A6,
  1237. PHY_BCM5401_PHY_ID, 0},
  1238. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701A5,
  1239. PHY_BCM5701_PHY_ID, 0},
  1240. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95700T6,
  1241. PHY_BCM8002_PHY_ID, 1},
  1242. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95700A9, 0, 1},
  1243. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701T1,
  1244. PHY_BCM5701_PHY_ID, 0},
  1245. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701T8,
  1246. PHY_BCM5701_PHY_ID, 0},
  1247. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701A7, 0, 1},
  1248. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701A10,
  1249. PHY_BCM5701_PHY_ID, 0},
  1250. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701A12,
  1251. PHY_BCM5701_PHY_ID, 0},
  1252. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95703Ax1,
  1253. PHY_BCM5701_PHY_ID, 0},
  1254. {T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95703Ax2,
  1255. PHY_BCM5701_PHY_ID, 0},
  1256. {T3_SVID_3COM, T3_SSID_3COM_3C996T, PHY_BCM5401_PHY_ID, 0},
  1257. {T3_SVID_3COM, T3_SSID_3COM_3C996BT, PHY_BCM5701_PHY_ID, 0},
  1258. {T3_SVID_3COM, T3_SSID_3COM_3C996SX, 0, 1},
  1259. {T3_SVID_3COM, T3_SSID_3COM_3C1000T, PHY_BCM5701_PHY_ID, 0},
  1260. {T3_SVID_3COM, T3_SSID_3COM_3C940BR01, PHY_BCM5701_PHY_ID, 0},
  1261. {T3_SVID_DELL, T3_SSID_DELL_VIPER, PHY_BCM5401_PHY_ID, 0},
  1262. {T3_SVID_DELL, T3_SSID_DELL_JAGUAR, PHY_BCM5401_PHY_ID, 0},
  1263. {T3_SVID_DELL, T3_SSID_DELL_MERLOT, PHY_BCM5411_PHY_ID, 0},
  1264. {T3_SVID_DELL, T3_SSID_DELL_SLIM_MERLOT, PHY_BCM5411_PHY_ID, 0},
  1265. {T3_SVID_COMPAQ, T3_SSID_COMPAQ_BANSHEE, PHY_BCM5701_PHY_ID, 0},
  1266. {T3_SVID_COMPAQ, T3_SSID_COMPAQ_BANSHEE_2, PHY_BCM5701_PHY_ID,
  1267. 0},
  1268. {T3_SVID_COMPAQ, T3_SSID_COMPAQ_CHANGELING, 0, 1},
  1269. {T3_SVID_COMPAQ, T3_SSID_COMPAQ_NC7780, PHY_BCM5701_PHY_ID, 0},
  1270. {T3_SVID_COMPAQ, T3_SSID_COMPAQ_NC7780_2, PHY_BCM5701_PHY_ID,
  1271. 0},
  1272. };
  1273. LM_UINT32 j;
  1274. for (j = 0; j < sizeof (AdapterArr) / sizeof (LM_ADAPTER_INFO); j++) {
  1275. if (AdapterArr[j].Svid == Svid && AdapterArr[j].Ssid == Ssid) {
  1276. return &AdapterArr[j];
  1277. }
  1278. }
  1279. return NULL;
  1280. }
  1281. /******************************************************************************/
  1282. /* Description: */
  1283. /* This routine sets up receive/transmit buffer descriptions queues. */
  1284. /* */
  1285. /* Return: */
  1286. /* LM_STATUS_SUCCESS */
  1287. /******************************************************************************/
  1288. LM_STATUS LM_InitializeAdapter (PLM_DEVICE_BLOCK pDevice)
  1289. {
  1290. LM_PHYSICAL_ADDRESS MemPhy;
  1291. PLM_UINT8 pMemVirt;
  1292. PLM_PACKET pPacket;
  1293. LM_STATUS Status;
  1294. LM_UINT32 Size;
  1295. LM_UINT32 j;
  1296. /* Set power state to D0. */
  1297. LM_SetPowerState (pDevice, LM_POWER_STATE_D0);
  1298. /* Intialize the queues. */
  1299. QQ_InitQueue (&pDevice->RxPacketReceivedQ.Container,
  1300. MAX_RX_PACKET_DESC_COUNT);
  1301. QQ_InitQueue (&pDevice->RxPacketFreeQ.Container,
  1302. MAX_RX_PACKET_DESC_COUNT);
  1303. QQ_InitQueue (&pDevice->TxPacketFreeQ.Container,
  1304. MAX_TX_PACKET_DESC_COUNT);
  1305. QQ_InitQueue (&pDevice->TxPacketActiveQ.Container,
  1306. MAX_TX_PACKET_DESC_COUNT);
  1307. QQ_InitQueue (&pDevice->TxPacketXmittedQ.Container,
  1308. MAX_TX_PACKET_DESC_COUNT);
  1309. /* Allocate shared memory for: status block, the buffers for receive */
  1310. /* rings -- standard, mini, jumbo, and return rings. */
  1311. Size = T3_STATUS_BLOCK_SIZE + sizeof (T3_STATS_BLOCK) +
  1312. T3_STD_RCV_RCB_ENTRY_COUNT * sizeof (T3_RCV_BD) +
  1313. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  1314. T3_JUMBO_RCV_RCB_ENTRY_COUNT * sizeof (T3_RCV_BD) +
  1315. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  1316. T3_RCV_RETURN_RCB_ENTRY_COUNT * sizeof (T3_RCV_BD);
  1317. /* Memory for host based Send BD. */
  1318. if (pDevice->NicSendBd == FALSE) {
  1319. Size += sizeof (T3_SND_BD) * T3_SEND_RCB_ENTRY_COUNT;
  1320. }
  1321. /* Allocate the memory block. */
  1322. Status =
  1323. MM_AllocateSharedMemory (pDevice, Size, (PLM_VOID) & pMemVirt,
  1324. &MemPhy, FALSE);
  1325. if (Status != LM_STATUS_SUCCESS) {
  1326. return Status;
  1327. }
  1328. /* Program DMA Read/Write */
  1329. if (pDevice->PciState & T3_PCI_STATE_NOT_PCI_X_BUS) {
  1330. pDevice->DmaReadWriteCtrl = 0x763f000f;
  1331. } else {
  1332. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5704) {
  1333. pDevice->DmaReadWriteCtrl = 0x761f0000;
  1334. } else {
  1335. pDevice->DmaReadWriteCtrl = 0x761b000f;
  1336. }
  1337. if (pDevice->ChipRevId == T3_CHIP_ID_5703_A1 ||
  1338. pDevice->ChipRevId == T3_CHIP_ID_5703_A2) {
  1339. pDevice->OneDmaAtOnce = TRUE;
  1340. }
  1341. }
  1342. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5703) {
  1343. pDevice->DmaReadWriteCtrl &= 0xfffffff0;
  1344. }
  1345. if (pDevice->OneDmaAtOnce) {
  1346. pDevice->DmaReadWriteCtrl |= DMA_CTRL_WRITE_ONE_DMA_AT_ONCE;
  1347. }
  1348. REG_WR (pDevice, PciCfg.DmaReadWriteCtrl, pDevice->DmaReadWriteCtrl);
  1349. if (LM_DmaTest (pDevice, pMemVirt, MemPhy, 0x400) != LM_STATUS_SUCCESS) {
  1350. return LM_STATUS_FAILURE;
  1351. }
  1352. /* Status block. */
  1353. pDevice->pStatusBlkVirt = (PT3_STATUS_BLOCK) pMemVirt;
  1354. pDevice->StatusBlkPhy = MemPhy;
  1355. pMemVirt += T3_STATUS_BLOCK_SIZE;
  1356. LM_INC_PHYSICAL_ADDRESS (&MemPhy, T3_STATUS_BLOCK_SIZE);
  1357. /* Statistics block. */
  1358. pDevice->pStatsBlkVirt = (PT3_STATS_BLOCK) pMemVirt;
  1359. pDevice->StatsBlkPhy = MemPhy;
  1360. pMemVirt += sizeof (T3_STATS_BLOCK);
  1361. LM_INC_PHYSICAL_ADDRESS (&MemPhy, sizeof (T3_STATS_BLOCK));
  1362. /* Receive standard BD buffer. */
  1363. pDevice->pRxStdBdVirt = (PT3_RCV_BD) pMemVirt;
  1364. pDevice->RxStdBdPhy = MemPhy;
  1365. pMemVirt += T3_STD_RCV_RCB_ENTRY_COUNT * sizeof (T3_RCV_BD);
  1366. LM_INC_PHYSICAL_ADDRESS (&MemPhy,
  1367. T3_STD_RCV_RCB_ENTRY_COUNT *
  1368. sizeof (T3_RCV_BD));
  1369. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  1370. /* Receive jumbo BD buffer. */
  1371. pDevice->pRxJumboBdVirt = (PT3_RCV_BD) pMemVirt;
  1372. pDevice->RxJumboBdPhy = MemPhy;
  1373. pMemVirt += T3_JUMBO_RCV_RCB_ENTRY_COUNT * sizeof (T3_RCV_BD);
  1374. LM_INC_PHYSICAL_ADDRESS (&MemPhy,
  1375. T3_JUMBO_RCV_RCB_ENTRY_COUNT *
  1376. sizeof (T3_RCV_BD));
  1377. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  1378. /* Receive return BD buffer. */
  1379. pDevice->pRcvRetBdVirt = (PT3_RCV_BD) pMemVirt;
  1380. pDevice->RcvRetBdPhy = MemPhy;
  1381. pMemVirt += T3_RCV_RETURN_RCB_ENTRY_COUNT * sizeof (T3_RCV_BD);
  1382. LM_INC_PHYSICAL_ADDRESS (&MemPhy,
  1383. T3_RCV_RETURN_RCB_ENTRY_COUNT *
  1384. sizeof (T3_RCV_BD));
  1385. /* Set up Send BD. */
  1386. if (pDevice->NicSendBd == FALSE) {
  1387. pDevice->pSendBdVirt = (PT3_SND_BD) pMemVirt;
  1388. pDevice->SendBdPhy = MemPhy;
  1389. pMemVirt += sizeof (T3_SND_BD) * T3_SEND_RCB_ENTRY_COUNT;
  1390. LM_INC_PHYSICAL_ADDRESS (&MemPhy,
  1391. sizeof (T3_SND_BD) *
  1392. T3_SEND_RCB_ENTRY_COUNT);
  1393. } else {
  1394. pDevice->pSendBdVirt = (PT3_SND_BD)
  1395. pDevice->pMemView->uIntMem.First32k.BufferDesc;
  1396. pDevice->SendBdPhy.High = 0;
  1397. pDevice->SendBdPhy.Low = T3_NIC_SND_BUFFER_DESC_ADDR;
  1398. }
  1399. /* Allocate memory for packet descriptors. */
  1400. Size = (pDevice->RxPacketDescCnt +
  1401. pDevice->TxPacketDescCnt) * MM_PACKET_DESC_SIZE;
  1402. Status = MM_AllocateMemory (pDevice, Size, (PLM_VOID *) & pPacket);
  1403. if (Status != LM_STATUS_SUCCESS) {
  1404. return Status;
  1405. }
  1406. pDevice->pPacketDescBase = (PLM_VOID) pPacket;
  1407. /* Create transmit packet descriptors from the memory block and add them */
  1408. /* to the TxPacketFreeQ for each send ring. */
  1409. for (j = 0; j < pDevice->TxPacketDescCnt; j++) {
  1410. /* Ring index. */
  1411. pPacket->Flags = 0;
  1412. /* Queue the descriptor in the TxPacketFreeQ of the 'k' ring. */
  1413. QQ_PushTail (&pDevice->TxPacketFreeQ.Container, pPacket);
  1414. /* Get the pointer to the next descriptor. MM_PACKET_DESC_SIZE */
  1415. /* is the total size of the packet descriptor including the */
  1416. /* os-specific extensions in the UM_PACKET structure. */
  1417. pPacket =
  1418. (PLM_PACKET) ((PLM_UINT8) pPacket + MM_PACKET_DESC_SIZE);
  1419. } /* for(j.. */
  1420. /* Create receive packet descriptors from the memory block and add them */
  1421. /* to the RxPacketFreeQ. Create the Standard packet descriptors. */
  1422. for (j = 0; j < pDevice->RxStdDescCnt; j++) {
  1423. /* Receive producer ring. */
  1424. pPacket->u.Rx.RcvProdRing = T3_STD_RCV_PROD_RING;
  1425. /* Receive buffer size. */
  1426. pPacket->u.Rx.RxBufferSize = MAX_STD_RCV_BUFFER_SIZE;
  1427. /* Add the descriptor to RxPacketFreeQ. */
  1428. QQ_PushTail (&pDevice->RxPacketFreeQ.Container, pPacket);
  1429. /* Get the pointer to the next descriptor. MM_PACKET_DESC_SIZE */
  1430. /* is the total size of the packet descriptor including the */
  1431. /* os-specific extensions in the UM_PACKET structure. */
  1432. pPacket =
  1433. (PLM_PACKET) ((PLM_UINT8) pPacket + MM_PACKET_DESC_SIZE);
  1434. } /* for */
  1435. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  1436. /* Create the Jumbo packet descriptors. */
  1437. for (j = 0; j < pDevice->RxJumboDescCnt; j++) {
  1438. /* Receive producer ring. */
  1439. pPacket->u.Rx.RcvProdRing = T3_JUMBO_RCV_PROD_RING;
  1440. /* Receive buffer size. */
  1441. pPacket->u.Rx.RxBufferSize = pDevice->RxJumboBufferSize;
  1442. /* Add the descriptor to RxPacketFreeQ. */
  1443. QQ_PushTail (&pDevice->RxPacketFreeQ.Container, pPacket);
  1444. /* Get the pointer to the next descriptor. MM_PACKET_DESC_SIZE */
  1445. /* is the total size of the packet descriptor including the */
  1446. /* os-specific extensions in the UM_PACKET structure. */
  1447. pPacket =
  1448. (PLM_PACKET) ((PLM_UINT8) pPacket + MM_PACKET_DESC_SIZE);
  1449. } /* for */
  1450. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  1451. /* Initialize the rest of the packet descriptors. */
  1452. Status = MM_InitializeUmPackets (pDevice);
  1453. if (Status != LM_STATUS_SUCCESS) {
  1454. return Status;
  1455. }
  1456. /* if */
  1457. /* Default receive mask. */
  1458. pDevice->ReceiveMask = LM_ACCEPT_MULTICAST | LM_ACCEPT_BROADCAST |
  1459. LM_ACCEPT_UNICAST;
  1460. /* Make sure we are in the first 32k memory window or NicSendBd. */
  1461. REG_WR (pDevice, PciCfg.MemWindowBaseAddr, 0);
  1462. /* Initialize the hardware. */
  1463. Status = LM_ResetAdapter (pDevice);
  1464. if (Status != LM_STATUS_SUCCESS) {
  1465. return Status;
  1466. }
  1467. /* We are done with initialization. */
  1468. pDevice->InitDone = TRUE;
  1469. return LM_STATUS_SUCCESS;
  1470. } /* LM_InitializeAdapter */
  1471. /******************************************************************************/
  1472. /* Description: */
  1473. /* This function Enables/Disables a given block. */
  1474. /* */
  1475. /* Return: */
  1476. /* LM_STATUS_SUCCESS */
  1477. /******************************************************************************/
  1478. LM_STATUS
  1479. LM_CntrlBlock (PLM_DEVICE_BLOCK pDevice, LM_UINT32 mask, LM_UINT32 cntrl)
  1480. {
  1481. LM_UINT32 j, i, data;
  1482. LM_UINT32 MaxWaitCnt;
  1483. MaxWaitCnt = 2;
  1484. j = 0;
  1485. for (i = 0; i < 32; i++) {
  1486. if (!(mask & (1 << i)))
  1487. continue;
  1488. switch (1 << i) {
  1489. case T3_BLOCK_DMA_RD:
  1490. data = REG_RD (pDevice, DmaRead.Mode);
  1491. if (cntrl == LM_DISABLE) {
  1492. data &= ~DMA_READ_MODE_ENABLE;
  1493. REG_WR (pDevice, DmaRead.Mode, data);
  1494. for (j = 0; j < MaxWaitCnt; j++) {
  1495. if (!
  1496. (REG_RD (pDevice, DmaRead.Mode) &
  1497. DMA_READ_MODE_ENABLE))
  1498. break;
  1499. MM_Wait (10);
  1500. }
  1501. } else
  1502. REG_WR (pDevice, DmaRead.Mode,
  1503. data | DMA_READ_MODE_ENABLE);
  1504. break;
  1505. case T3_BLOCK_DMA_COMP:
  1506. data = REG_RD (pDevice, DmaComp.Mode);
  1507. if (cntrl == LM_DISABLE) {
  1508. data &= ~DMA_COMP_MODE_ENABLE;
  1509. REG_WR (pDevice, DmaComp.Mode, data);
  1510. for (j = 0; j < MaxWaitCnt; j++) {
  1511. if (!
  1512. (REG_RD (pDevice, DmaComp.Mode) &
  1513. DMA_COMP_MODE_ENABLE))
  1514. break;
  1515. MM_Wait (10);
  1516. }
  1517. } else
  1518. REG_WR (pDevice, DmaComp.Mode,
  1519. data | DMA_COMP_MODE_ENABLE);
  1520. break;
  1521. case T3_BLOCK_RX_BD_INITIATOR:
  1522. data = REG_RD (pDevice, RcvBdIn.Mode);
  1523. if (cntrl == LM_DISABLE) {
  1524. data &= ~RCV_BD_IN_MODE_ENABLE;
  1525. REG_WR (pDevice, RcvBdIn.Mode, data);
  1526. for (j = 0; j < MaxWaitCnt; j++) {
  1527. if (!
  1528. (REG_RD (pDevice, RcvBdIn.Mode) &
  1529. RCV_BD_IN_MODE_ENABLE))
  1530. break;
  1531. MM_Wait (10);
  1532. }
  1533. } else
  1534. REG_WR (pDevice, RcvBdIn.Mode,
  1535. data | RCV_BD_IN_MODE_ENABLE);
  1536. break;
  1537. case T3_BLOCK_RX_BD_COMP:
  1538. data = REG_RD (pDevice, RcvBdComp.Mode);
  1539. if (cntrl == LM_DISABLE) {
  1540. data &= ~RCV_BD_COMP_MODE_ENABLE;
  1541. REG_WR (pDevice, RcvBdComp.Mode, data);
  1542. for (j = 0; j < MaxWaitCnt; j++) {
  1543. if (!
  1544. (REG_RD (pDevice, RcvBdComp.Mode) &
  1545. RCV_BD_COMP_MODE_ENABLE))
  1546. break;
  1547. MM_Wait (10);
  1548. }
  1549. } else
  1550. REG_WR (pDevice, RcvBdComp.Mode,
  1551. data | RCV_BD_COMP_MODE_ENABLE);
  1552. break;
  1553. case T3_BLOCK_DMA_WR:
  1554. data = REG_RD (pDevice, DmaWrite.Mode);
  1555. if (cntrl == LM_DISABLE) {
  1556. data &= ~DMA_WRITE_MODE_ENABLE;
  1557. REG_WR (pDevice, DmaWrite.Mode, data);
  1558. for (j = 0; j < MaxWaitCnt; j++) {
  1559. if (!
  1560. (REG_RD (pDevice, DmaWrite.Mode) &
  1561. DMA_WRITE_MODE_ENABLE))
  1562. break;
  1563. MM_Wait (10);
  1564. }
  1565. } else
  1566. REG_WR (pDevice, DmaWrite.Mode,
  1567. data | DMA_WRITE_MODE_ENABLE);
  1568. break;
  1569. case T3_BLOCK_MSI_HANDLER:
  1570. data = REG_RD (pDevice, Msi.Mode);
  1571. if (cntrl == LM_DISABLE) {
  1572. data &= ~MSI_MODE_ENABLE;
  1573. REG_WR (pDevice, Msi.Mode, data);
  1574. for (j = 0; j < MaxWaitCnt; j++) {
  1575. if (!
  1576. (REG_RD (pDevice, Msi.Mode) &
  1577. MSI_MODE_ENABLE))
  1578. break;
  1579. MM_Wait (10);
  1580. }
  1581. } else
  1582. REG_WR (pDevice, Msi.Mode,
  1583. data | MSI_MODE_ENABLE);
  1584. break;
  1585. case T3_BLOCK_RX_LIST_PLMT:
  1586. data = REG_RD (pDevice, RcvListPlmt.Mode);
  1587. if (cntrl == LM_DISABLE) {
  1588. data &= ~RCV_LIST_PLMT_MODE_ENABLE;
  1589. REG_WR (pDevice, RcvListPlmt.Mode, data);
  1590. for (j = 0; j < MaxWaitCnt; j++) {
  1591. if (!
  1592. (REG_RD (pDevice, RcvListPlmt.Mode)
  1593. & RCV_LIST_PLMT_MODE_ENABLE))
  1594. break;
  1595. MM_Wait (10);
  1596. }
  1597. } else
  1598. REG_WR (pDevice, RcvListPlmt.Mode,
  1599. data | RCV_LIST_PLMT_MODE_ENABLE);
  1600. break;
  1601. case T3_BLOCK_RX_LIST_SELECTOR:
  1602. data = REG_RD (pDevice, RcvListSel.Mode);
  1603. if (cntrl == LM_DISABLE) {
  1604. data &= ~RCV_LIST_SEL_MODE_ENABLE;
  1605. REG_WR (pDevice, RcvListSel.Mode, data);
  1606. for (j = 0; j < MaxWaitCnt; j++) {
  1607. if (!
  1608. (REG_RD (pDevice, RcvListSel.Mode) &
  1609. RCV_LIST_SEL_MODE_ENABLE))
  1610. break;
  1611. MM_Wait (10);
  1612. }
  1613. } else
  1614. REG_WR (pDevice, RcvListSel.Mode,
  1615. data | RCV_LIST_SEL_MODE_ENABLE);
  1616. break;
  1617. case T3_BLOCK_RX_DATA_INITIATOR:
  1618. data = REG_RD (pDevice, RcvDataBdIn.Mode);
  1619. if (cntrl == LM_DISABLE) {
  1620. data &= ~RCV_DATA_BD_IN_MODE_ENABLE;
  1621. REG_WR (pDevice, RcvDataBdIn.Mode, data);
  1622. for (j = 0; j < MaxWaitCnt; j++) {
  1623. if (!
  1624. (REG_RD (pDevice, RcvDataBdIn.Mode)
  1625. & RCV_DATA_BD_IN_MODE_ENABLE))
  1626. break;
  1627. MM_Wait (10);
  1628. }
  1629. } else
  1630. REG_WR (pDevice, RcvDataBdIn.Mode,
  1631. data | RCV_DATA_BD_IN_MODE_ENABLE);
  1632. break;
  1633. case T3_BLOCK_RX_DATA_COMP:
  1634. data = REG_RD (pDevice, RcvDataComp.Mode);
  1635. if (cntrl == LM_DISABLE) {
  1636. data &= ~RCV_DATA_COMP_MODE_ENABLE;
  1637. REG_WR (pDevice, RcvDataComp.Mode, data);
  1638. for (j = 0; j < MaxWaitCnt; j++) {
  1639. if (!
  1640. (REG_RD (pDevice, RcvDataBdIn.Mode)
  1641. & RCV_DATA_COMP_MODE_ENABLE))
  1642. break;
  1643. MM_Wait (10);
  1644. }
  1645. } else
  1646. REG_WR (pDevice, RcvDataComp.Mode,
  1647. data | RCV_DATA_COMP_MODE_ENABLE);
  1648. break;
  1649. case T3_BLOCK_HOST_COALESING:
  1650. data = REG_RD (pDevice, HostCoalesce.Mode);
  1651. if (cntrl == LM_DISABLE) {
  1652. data &= ~HOST_COALESCE_ENABLE;
  1653. REG_WR (pDevice, HostCoalesce.Mode, data);
  1654. for (j = 0; j < MaxWaitCnt; j++) {
  1655. if (!
  1656. (REG_RD (pDevice, SndBdIn.Mode) &
  1657. HOST_COALESCE_ENABLE))
  1658. break;
  1659. MM_Wait (10);
  1660. }
  1661. } else
  1662. REG_WR (pDevice, HostCoalesce.Mode,
  1663. data | HOST_COALESCE_ENABLE);
  1664. break;
  1665. case T3_BLOCK_MAC_RX_ENGINE:
  1666. if (cntrl == LM_DISABLE) {
  1667. pDevice->RxMode &= ~RX_MODE_ENABLE;
  1668. REG_WR (pDevice, MacCtrl.RxMode,
  1669. pDevice->RxMode);
  1670. for (j = 0; j < MaxWaitCnt; j++) {
  1671. if (!
  1672. (REG_RD (pDevice, MacCtrl.RxMode) &
  1673. RX_MODE_ENABLE)) {
  1674. break;
  1675. }
  1676. MM_Wait (10);
  1677. }
  1678. } else {
  1679. pDevice->RxMode |= RX_MODE_ENABLE;
  1680. REG_WR (pDevice, MacCtrl.RxMode,
  1681. pDevice->RxMode);
  1682. }
  1683. break;
  1684. case T3_BLOCK_MBUF_CLUSTER_FREE:
  1685. data = REG_RD (pDevice, MbufClusterFree.Mode);
  1686. if (cntrl == LM_DISABLE) {
  1687. data &= ~MBUF_CLUSTER_FREE_MODE_ENABLE;
  1688. REG_WR (pDevice, MbufClusterFree.Mode, data);
  1689. for (j = 0; j < MaxWaitCnt; j++) {
  1690. if (!
  1691. (REG_RD
  1692. (pDevice,
  1693. MbufClusterFree.
  1694. Mode) &
  1695. MBUF_CLUSTER_FREE_MODE_ENABLE))
  1696. break;
  1697. MM_Wait (10);
  1698. }
  1699. } else
  1700. REG_WR (pDevice, MbufClusterFree.Mode,
  1701. data | MBUF_CLUSTER_FREE_MODE_ENABLE);
  1702. break;
  1703. case T3_BLOCK_SEND_BD_INITIATOR:
  1704. data = REG_RD (pDevice, SndBdIn.Mode);
  1705. if (cntrl == LM_DISABLE) {
  1706. data &= ~SND_BD_IN_MODE_ENABLE;
  1707. REG_WR (pDevice, SndBdIn.Mode, data);
  1708. for (j = 0; j < MaxWaitCnt; j++) {
  1709. if (!
  1710. (REG_RD (pDevice, SndBdIn.Mode) &
  1711. SND_BD_IN_MODE_ENABLE))
  1712. break;
  1713. MM_Wait (10);
  1714. }
  1715. } else
  1716. REG_WR (pDevice, SndBdIn.Mode,
  1717. data | SND_BD_IN_MODE_ENABLE);
  1718. break;
  1719. case T3_BLOCK_SEND_BD_COMP:
  1720. data = REG_RD (pDevice, SndBdComp.Mode);
  1721. if (cntrl == LM_DISABLE) {
  1722. data &= ~SND_BD_COMP_MODE_ENABLE;
  1723. REG_WR (pDevice, SndBdComp.Mode, data);
  1724. for (j = 0; j < MaxWaitCnt; j++) {
  1725. if (!
  1726. (REG_RD (pDevice, SndBdComp.Mode) &
  1727. SND_BD_COMP_MODE_ENABLE))
  1728. break;
  1729. MM_Wait (10);
  1730. }
  1731. } else
  1732. REG_WR (pDevice, SndBdComp.Mode,
  1733. data | SND_BD_COMP_MODE_ENABLE);
  1734. break;
  1735. case T3_BLOCK_SEND_BD_SELECTOR:
  1736. data = REG_RD (pDevice, SndBdSel.Mode);
  1737. if (cntrl == LM_DISABLE) {
  1738. data &= ~SND_BD_SEL_MODE_ENABLE;
  1739. REG_WR (pDevice, SndBdSel.Mode, data);
  1740. for (j = 0; j < MaxWaitCnt; j++) {
  1741. if (!
  1742. (REG_RD (pDevice, SndBdSel.Mode) &
  1743. SND_BD_SEL_MODE_ENABLE))
  1744. break;
  1745. MM_Wait (10);
  1746. }
  1747. } else
  1748. REG_WR (pDevice, SndBdSel.Mode,
  1749. data | SND_BD_SEL_MODE_ENABLE);
  1750. break;
  1751. case T3_BLOCK_SEND_DATA_INITIATOR:
  1752. data = REG_RD (pDevice, SndDataIn.Mode);
  1753. if (cntrl == LM_DISABLE) {
  1754. data &= ~T3_SND_DATA_IN_MODE_ENABLE;
  1755. REG_WR (pDevice, SndDataIn.Mode, data);
  1756. for (j = 0; j < MaxWaitCnt; j++) {
  1757. if (!
  1758. (REG_RD (pDevice, SndDataIn.Mode) &
  1759. T3_SND_DATA_IN_MODE_ENABLE))
  1760. break;
  1761. MM_Wait (10);
  1762. }
  1763. } else
  1764. REG_WR (pDevice, SndDataIn.Mode,
  1765. data | T3_SND_DATA_IN_MODE_ENABLE);
  1766. break;
  1767. case T3_BLOCK_SEND_DATA_COMP:
  1768. data = REG_RD (pDevice, SndDataComp.Mode);
  1769. if (cntrl == LM_DISABLE) {
  1770. data &= ~SND_DATA_COMP_MODE_ENABLE;
  1771. REG_WR (pDevice, SndDataComp.Mode, data);
  1772. for (j = 0; j < MaxWaitCnt; j++) {
  1773. if (!
  1774. (REG_RD (pDevice, SndDataComp.Mode)
  1775. & SND_DATA_COMP_MODE_ENABLE))
  1776. break;
  1777. MM_Wait (10);
  1778. }
  1779. } else
  1780. REG_WR (pDevice, SndDataComp.Mode,
  1781. data | SND_DATA_COMP_MODE_ENABLE);
  1782. break;
  1783. case T3_BLOCK_MAC_TX_ENGINE:
  1784. if (cntrl == LM_DISABLE) {
  1785. pDevice->TxMode &= ~TX_MODE_ENABLE;
  1786. REG_WR (pDevice, MacCtrl.TxMode,
  1787. pDevice->TxMode);
  1788. for (j = 0; j < MaxWaitCnt; j++) {
  1789. if (!
  1790. (REG_RD (pDevice, MacCtrl.TxMode) &
  1791. TX_MODE_ENABLE))
  1792. break;
  1793. MM_Wait (10);
  1794. }
  1795. } else {
  1796. pDevice->TxMode |= TX_MODE_ENABLE;
  1797. REG_WR (pDevice, MacCtrl.TxMode,
  1798. pDevice->TxMode);
  1799. }
  1800. break;
  1801. case T3_BLOCK_MEM_ARBITOR:
  1802. data = REG_RD (pDevice, MemArbiter.Mode);
  1803. if (cntrl == LM_DISABLE) {
  1804. data &= ~T3_MEM_ARBITER_MODE_ENABLE;
  1805. REG_WR (pDevice, MemArbiter.Mode, data);
  1806. for (j = 0; j < MaxWaitCnt; j++) {
  1807. if (!
  1808. (REG_RD (pDevice, MemArbiter.Mode) &
  1809. T3_MEM_ARBITER_MODE_ENABLE))
  1810. break;
  1811. MM_Wait (10);
  1812. }
  1813. } else
  1814. REG_WR (pDevice, MemArbiter.Mode,
  1815. data | T3_MEM_ARBITER_MODE_ENABLE);
  1816. break;
  1817. case T3_BLOCK_MBUF_MANAGER:
  1818. data = REG_RD (pDevice, BufMgr.Mode);
  1819. if (cntrl == LM_DISABLE) {
  1820. data &= ~BUFMGR_MODE_ENABLE;
  1821. REG_WR (pDevice, BufMgr.Mode, data);
  1822. for (j = 0; j < MaxWaitCnt; j++) {
  1823. if (!
  1824. (REG_RD (pDevice, BufMgr.Mode) &
  1825. BUFMGR_MODE_ENABLE))
  1826. break;
  1827. MM_Wait (10);
  1828. }
  1829. } else
  1830. REG_WR (pDevice, BufMgr.Mode,
  1831. data | BUFMGR_MODE_ENABLE);
  1832. break;
  1833. case T3_BLOCK_MAC_GLOBAL:
  1834. if (cntrl == LM_DISABLE) {
  1835. pDevice->MacMode &= ~(MAC_MODE_ENABLE_TDE |
  1836. MAC_MODE_ENABLE_RDE |
  1837. MAC_MODE_ENABLE_FHDE);
  1838. } else {
  1839. pDevice->MacMode |= (MAC_MODE_ENABLE_TDE |
  1840. MAC_MODE_ENABLE_RDE |
  1841. MAC_MODE_ENABLE_FHDE);
  1842. }
  1843. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode);
  1844. break;
  1845. default:
  1846. return LM_STATUS_FAILURE;
  1847. } /* switch */
  1848. if (j >= MaxWaitCnt) {
  1849. return LM_STATUS_FAILURE;
  1850. }
  1851. }
  1852. return LM_STATUS_SUCCESS;
  1853. }
  1854. /******************************************************************************/
  1855. /* Description: */
  1856. /* This function reinitializes the adapter. */
  1857. /* */
  1858. /* Return: */
  1859. /* LM_STATUS_SUCCESS */
  1860. /******************************************************************************/
  1861. LM_STATUS LM_ResetAdapter (PLM_DEVICE_BLOCK pDevice)
  1862. {
  1863. LM_UINT32 Value32;
  1864. LM_UINT16 Value16;
  1865. LM_UINT32 j, k;
  1866. /* Disable interrupt. */
  1867. LM_DisableInterrupt (pDevice);
  1868. /* May get a spurious interrupt */
  1869. pDevice->pStatusBlkVirt->Status = STATUS_BLOCK_UPDATED;
  1870. /* Disable transmit and receive DMA engines. Abort all pending requests. */
  1871. if (pDevice->InitDone) {
  1872. LM_Abort (pDevice);
  1873. }
  1874. pDevice->ShuttingDown = FALSE;
  1875. LM_ResetChip (pDevice);
  1876. /* Bug: Athlon fix for B3 silicon only. This bit does not do anything */
  1877. /* in other chip revisions. */
  1878. if (pDevice->DelayPciGrant) {
  1879. Value32 = REG_RD (pDevice, PciCfg.ClockCtrl);
  1880. REG_WR (pDevice, PciCfg.ClockCtrl, Value32 | BIT_31);
  1881. }
  1882. if (pDevice->ChipRevId == T3_CHIP_ID_5704_A0) {
  1883. if (!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE)) {
  1884. Value32 = REG_RD (pDevice, PciCfg.PciState);
  1885. Value32 |= T3_PCI_STATE_RETRY_SAME_DMA;
  1886. REG_WR (pDevice, PciCfg.PciState, Value32);
  1887. }
  1888. }
  1889. /* Enable TaggedStatus mode. */
  1890. if (pDevice->UseTaggedStatus) {
  1891. pDevice->MiscHostCtrl |=
  1892. MISC_HOST_CTRL_ENABLE_TAGGED_STATUS_MODE;
  1893. }
  1894. /* Restore PCI configuration registers. */
  1895. MM_WriteConfig32 (pDevice, PCI_CACHE_LINE_SIZE_REG,
  1896. pDevice->SavedCacheLineReg);
  1897. MM_WriteConfig32 (pDevice, PCI_SUBSYSTEM_VENDOR_ID_REG,
  1898. (pDevice->SubsystemId << 16) | pDevice->
  1899. SubsystemVendorId);
  1900. /* Clear the statistics block. */
  1901. for (j = 0x0300; j < 0x0b00; j++) {
  1902. MEM_WR_OFFSET (pDevice, j, 0);
  1903. }
  1904. /* Initialize the statistis Block */
  1905. pDevice->pStatusBlkVirt->Status = 0;
  1906. pDevice->pStatusBlkVirt->RcvStdConIdx = 0;
  1907. pDevice->pStatusBlkVirt->RcvJumboConIdx = 0;
  1908. pDevice->pStatusBlkVirt->RcvMiniConIdx = 0;
  1909. for (j = 0; j < 16; j++) {
  1910. pDevice->pStatusBlkVirt->Idx[j].RcvProdIdx = 0;
  1911. pDevice->pStatusBlkVirt->Idx[j].SendConIdx = 0;
  1912. }
  1913. for (k = 0; k < T3_STD_RCV_RCB_ENTRY_COUNT; k++) {
  1914. pDevice->pRxStdBdVirt[k].HostAddr.High = 0;
  1915. pDevice->pRxStdBdVirt[k].HostAddr.Low = 0;
  1916. }
  1917. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  1918. /* Receive jumbo BD buffer. */
  1919. for (k = 0; k < T3_JUMBO_RCV_RCB_ENTRY_COUNT; k++) {
  1920. pDevice->pRxJumboBdVirt[k].HostAddr.High = 0;
  1921. pDevice->pRxJumboBdVirt[k].HostAddr.Low = 0;
  1922. }
  1923. #endif
  1924. REG_WR (pDevice, PciCfg.DmaReadWriteCtrl, pDevice->DmaReadWriteCtrl);
  1925. /* GRC mode control register. */
  1926. #ifdef BIG_ENDIAN_PCI /* Jimmy, this ifdef block deleted in new code! */
  1927. Value32 =
  1928. GRC_MODE_WORD_SWAP_DATA |
  1929. GRC_MODE_WORD_SWAP_NON_FRAME_DATA |
  1930. GRC_MODE_INT_ON_MAC_ATTN | GRC_MODE_HOST_STACK_UP;
  1931. #else
  1932. /* No CPU Swap modes for PCI IO */
  1933. Value32 =
  1934. #ifdef BIG_ENDIAN_HOST
  1935. GRC_MODE_BYTE_SWAP_NON_FRAME_DATA |
  1936. GRC_MODE_WORD_SWAP_NON_FRAME_DATA |
  1937. GRC_MODE_BYTE_SWAP_DATA | GRC_MODE_WORD_SWAP_DATA |
  1938. #else
  1939. GRC_MODE_WORD_SWAP_NON_FRAME_DATA |
  1940. GRC_MODE_BYTE_SWAP_DATA | GRC_MODE_WORD_SWAP_DATA |
  1941. #endif
  1942. GRC_MODE_INT_ON_MAC_ATTN | GRC_MODE_HOST_STACK_UP;
  1943. #endif /* !BIG_ENDIAN_PCI */
  1944. /* Configure send BD mode. */
  1945. if (pDevice->NicSendBd == FALSE) {
  1946. Value32 |= GRC_MODE_HOST_SEND_BDS;
  1947. } else {
  1948. Value32 |= GRC_MODE_4X_NIC_BASED_SEND_RINGS;
  1949. }
  1950. /* Configure pseudo checksum mode. */
  1951. if (pDevice->NoTxPseudoHdrChksum) {
  1952. Value32 |= GRC_MODE_TX_NO_PSEUDO_HEADER_CHKSUM;
  1953. }
  1954. if (pDevice->NoRxPseudoHdrChksum) {
  1955. Value32 |= GRC_MODE_RX_NO_PSEUDO_HEADER_CHKSUM;
  1956. }
  1957. REG_WR (pDevice, Grc.Mode, Value32);
  1958. /* Setup the timer prescalar register. */
  1959. REG_WR (pDevice, Grc.MiscCfg, 65 << 1); /* Clock is alwasy 66MHz. */
  1960. /* Set up the MBUF pool base address and size. */
  1961. REG_WR (pDevice, BufMgr.MbufPoolAddr, pDevice->MbufBase);
  1962. REG_WR (pDevice, BufMgr.MbufPoolSize, pDevice->MbufSize);
  1963. /* Set up the DMA descriptor pool base address and size. */
  1964. REG_WR (pDevice, BufMgr.DmaDescPoolAddr, T3_NIC_DMA_DESC_POOL_ADDR);
  1965. REG_WR (pDevice, BufMgr.DmaDescPoolSize, T3_NIC_DMA_DESC_POOL_SIZE);
  1966. /* Configure MBUF and Threshold watermarks */
  1967. /* Configure the DMA read MBUF low water mark. */
  1968. if (pDevice->DmaMbufLowMark) {
  1969. REG_WR (pDevice, BufMgr.MbufReadDmaLowWaterMark,
  1970. pDevice->DmaMbufLowMark);
  1971. } else {
  1972. if (pDevice->TxMtu < MAX_ETHERNET_PACKET_BUFFER_SIZE) {
  1973. REG_WR (pDevice, BufMgr.MbufReadDmaLowWaterMark,
  1974. T3_DEF_DMA_MBUF_LOW_WMARK);
  1975. } else {
  1976. REG_WR (pDevice, BufMgr.MbufReadDmaLowWaterMark,
  1977. T3_DEF_DMA_MBUF_LOW_WMARK_JUMBO);
  1978. }
  1979. }
  1980. /* Configure the MAC Rx MBUF low water mark. */
  1981. if (pDevice->RxMacMbufLowMark) {
  1982. REG_WR (pDevice, BufMgr.MbufMacRxLowWaterMark,
  1983. pDevice->RxMacMbufLowMark);
  1984. } else {
  1985. if (pDevice->TxMtu < MAX_ETHERNET_PACKET_BUFFER_SIZE) {
  1986. REG_WR (pDevice, BufMgr.MbufMacRxLowWaterMark,
  1987. T3_DEF_RX_MAC_MBUF_LOW_WMARK);
  1988. } else {
  1989. REG_WR (pDevice, BufMgr.MbufMacRxLowWaterMark,
  1990. T3_DEF_RX_MAC_MBUF_LOW_WMARK_JUMBO);
  1991. }
  1992. }
  1993. /* Configure the MBUF high water mark. */
  1994. if (pDevice->MbufHighMark) {
  1995. REG_WR (pDevice, BufMgr.MbufHighWaterMark,
  1996. pDevice->MbufHighMark);
  1997. } else {
  1998. if (pDevice->TxMtu < MAX_ETHERNET_PACKET_BUFFER_SIZE) {
  1999. REG_WR (pDevice, BufMgr.MbufHighWaterMark,
  2000. T3_DEF_MBUF_HIGH_WMARK);
  2001. } else {
  2002. REG_WR (pDevice, BufMgr.MbufHighWaterMark,
  2003. T3_DEF_MBUF_HIGH_WMARK_JUMBO);
  2004. }
  2005. }
  2006. REG_WR (pDevice, BufMgr.DmaLowWaterMark, T3_DEF_DMA_DESC_LOW_WMARK);
  2007. REG_WR (pDevice, BufMgr.DmaHighWaterMark, T3_DEF_DMA_DESC_HIGH_WMARK);
  2008. /* Enable buffer manager. */
  2009. REG_WR (pDevice, BufMgr.Mode,
  2010. BUFMGR_MODE_ENABLE | BUFMGR_MODE_ATTN_ENABLE);
  2011. for (j = 0; j < 2000; j++) {
  2012. if (REG_RD (pDevice, BufMgr.Mode) & BUFMGR_MODE_ENABLE)
  2013. break;
  2014. MM_Wait (10);
  2015. }
  2016. if (j >= 2000) {
  2017. return LM_STATUS_FAILURE;
  2018. }
  2019. /* Enable the FTQs. */
  2020. REG_WR (pDevice, Ftq.Reset, 0xffffffff);
  2021. REG_WR (pDevice, Ftq.Reset, 0);
  2022. /* Wait until FTQ is ready */
  2023. for (j = 0; j < 2000; j++) {
  2024. if (REG_RD (pDevice, Ftq.Reset) == 0)
  2025. break;
  2026. MM_Wait (10);
  2027. }
  2028. if (j >= 2000) {
  2029. return LM_STATUS_FAILURE;
  2030. }
  2031. /* Initialize the Standard Receive RCB. */
  2032. REG_WR (pDevice, RcvDataBdIn.StdRcvRcb.HostRingAddr.High,
  2033. pDevice->RxStdBdPhy.High);
  2034. REG_WR (pDevice, RcvDataBdIn.StdRcvRcb.HostRingAddr.Low,
  2035. pDevice->RxStdBdPhy.Low);
  2036. REG_WR (pDevice, RcvDataBdIn.StdRcvRcb.u.MaxLen_Flags,
  2037. MAX_STD_RCV_BUFFER_SIZE << 16);
  2038. /* Initialize the Jumbo Receive RCB. */
  2039. REG_WR (pDevice, RcvDataBdIn.JumboRcvRcb.u.MaxLen_Flags,
  2040. T3_RCB_FLAG_RING_DISABLED);
  2041. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  2042. REG_WR (pDevice, RcvDataBdIn.JumboRcvRcb.HostRingAddr.High,
  2043. pDevice->RxJumboBdPhy.High);
  2044. REG_WR (pDevice, RcvDataBdIn.JumboRcvRcb.HostRingAddr.Low,
  2045. pDevice->RxJumboBdPhy.Low);
  2046. REG_WR (pDevice, RcvDataBdIn.JumboRcvRcb.u.MaxLen_Flags, 0);
  2047. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  2048. /* Initialize the Mini Receive RCB. */
  2049. REG_WR (pDevice, RcvDataBdIn.MiniRcvRcb.u.MaxLen_Flags,
  2050. T3_RCB_FLAG_RING_DISABLED);
  2051. {
  2052. REG_WR (pDevice, RcvDataBdIn.StdRcvRcb.NicRingAddr,
  2053. (LM_UINT32) T3_NIC_STD_RCV_BUFFER_DESC_ADDR);
  2054. REG_WR (pDevice, RcvDataBdIn.JumboRcvRcb.NicRingAddr,
  2055. (LM_UINT32) T3_NIC_JUMBO_RCV_BUFFER_DESC_ADDR);
  2056. }
  2057. /* Receive BD Ring replenish threshold. */
  2058. REG_WR (pDevice, RcvBdIn.StdRcvThreshold, pDevice->RxStdDescCnt / 8);
  2059. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  2060. REG_WR (pDevice, RcvBdIn.JumboRcvThreshold,
  2061. pDevice->RxJumboDescCnt / 8);
  2062. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  2063. /* Disable all the unused rings. */
  2064. for (j = 0; j < T3_MAX_SEND_RCB_COUNT; j++) {
  2065. MEM_WR (pDevice, SendRcb[j].u.MaxLen_Flags,
  2066. T3_RCB_FLAG_RING_DISABLED);
  2067. } /* for */
  2068. /* Initialize the indices. */
  2069. pDevice->SendProdIdx = 0;
  2070. pDevice->SendConIdx = 0;
  2071. MB_REG_WR (pDevice, Mailbox.SendHostProdIdx[0].Low, 0);
  2072. MB_REG_WR (pDevice, Mailbox.SendNicProdIdx[0].Low, 0);
  2073. /* Set up host or NIC based send RCB. */
  2074. if (pDevice->NicSendBd == FALSE) {
  2075. MEM_WR (pDevice, SendRcb[0].HostRingAddr.High,
  2076. pDevice->SendBdPhy.High);
  2077. MEM_WR (pDevice, SendRcb[0].HostRingAddr.Low,
  2078. pDevice->SendBdPhy.Low);
  2079. /* Set up the NIC ring address in the RCB. */
  2080. MEM_WR (pDevice, SendRcb[0].NicRingAddr,
  2081. T3_NIC_SND_BUFFER_DESC_ADDR);
  2082. /* Setup the RCB. */
  2083. MEM_WR (pDevice, SendRcb[0].u.MaxLen_Flags,
  2084. T3_SEND_RCB_ENTRY_COUNT << 16);
  2085. for (k = 0; k < T3_SEND_RCB_ENTRY_COUNT; k++) {
  2086. pDevice->pSendBdVirt[k].HostAddr.High = 0;
  2087. pDevice->pSendBdVirt[k].HostAddr.Low = 0;
  2088. }
  2089. } else {
  2090. MEM_WR (pDevice, SendRcb[0].HostRingAddr.High, 0);
  2091. MEM_WR (pDevice, SendRcb[0].HostRingAddr.Low, 0);
  2092. MEM_WR (pDevice, SendRcb[0].NicRingAddr,
  2093. pDevice->SendBdPhy.Low);
  2094. for (k = 0; k < T3_SEND_RCB_ENTRY_COUNT; k++) {
  2095. __raw_writel (0,
  2096. &(pDevice->pSendBdVirt[k].HostAddr.High));
  2097. __raw_writel (0,
  2098. &(pDevice->pSendBdVirt[k].HostAddr.Low));
  2099. __raw_writel (0,
  2100. &(pDevice->pSendBdVirt[k].u1.Len_Flags));
  2101. pDevice->ShadowSendBd[k].HostAddr.High = 0;
  2102. pDevice->ShadowSendBd[k].u1.Len_Flags = 0;
  2103. }
  2104. }
  2105. atomic_set (&pDevice->SendBdLeft, T3_SEND_RCB_ENTRY_COUNT - 1);
  2106. /* Configure the receive return rings. */
  2107. for (j = 0; j < T3_MAX_RCV_RETURN_RCB_COUNT; j++) {
  2108. MEM_WR (pDevice, RcvRetRcb[j].u.MaxLen_Flags,
  2109. T3_RCB_FLAG_RING_DISABLED);
  2110. }
  2111. pDevice->RcvRetConIdx = 0;
  2112. MEM_WR (pDevice, RcvRetRcb[0].HostRingAddr.High,
  2113. pDevice->RcvRetBdPhy.High);
  2114. MEM_WR (pDevice, RcvRetRcb[0].HostRingAddr.Low,
  2115. pDevice->RcvRetBdPhy.Low);
  2116. /* Set up the NIC ring address in the RCB. */
  2117. /* Not very clear from the spec. I am guessing that for Receive */
  2118. /* Return Ring, NicRingAddr is not used. */
  2119. MEM_WR (pDevice, RcvRetRcb[0].NicRingAddr, 0);
  2120. /* Setup the RCB. */
  2121. MEM_WR (pDevice, RcvRetRcb[0].u.MaxLen_Flags,
  2122. T3_RCV_RETURN_RCB_ENTRY_COUNT << 16);
  2123. /* Reinitialize RX ring producer index */
  2124. MB_REG_WR (pDevice, Mailbox.RcvStdProdIdx.Low, 0);
  2125. MB_REG_WR (pDevice, Mailbox.RcvJumboProdIdx.Low, 0);
  2126. MB_REG_WR (pDevice, Mailbox.RcvMiniProdIdx.Low, 0);
  2127. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  2128. pDevice->RxJumboProdIdx = 0;
  2129. pDevice->RxJumboQueuedCnt = 0;
  2130. #endif
  2131. /* Reinitialize our copy of the indices. */
  2132. pDevice->RxStdProdIdx = 0;
  2133. pDevice->RxStdQueuedCnt = 0;
  2134. #if T3_JUMBO_RCV_ENTRY_COUNT
  2135. pDevice->RxJumboProdIdx = 0;
  2136. #endif /* T3_JUMBO_RCV_ENTRY_COUNT */
  2137. /* Configure the MAC address. */
  2138. LM_SetMacAddress (pDevice);
  2139. /* Initialize the transmit random backoff seed. */
  2140. Value32 = (pDevice->NodeAddress[0] + pDevice->NodeAddress[1] +
  2141. pDevice->NodeAddress[2] + pDevice->NodeAddress[3] +
  2142. pDevice->NodeAddress[4] + pDevice->NodeAddress[5]) &
  2143. MAC_TX_BACKOFF_SEED_MASK;
  2144. REG_WR (pDevice, MacCtrl.TxBackoffSeed, Value32);
  2145. /* Receive MTU. Frames larger than the MTU is marked as oversized. */
  2146. REG_WR (pDevice, MacCtrl.MtuSize, pDevice->RxMtu + 8); /* CRC + VLAN. */
  2147. /* Configure Time slot/IPG per 802.3 */
  2148. REG_WR (pDevice, MacCtrl.TxLengths, 0x2620);
  2149. /*
  2150. * Configure Receive Rules so that packets don't match
  2151. * Programmble rule will be queued to Return Ring 1
  2152. */
  2153. REG_WR (pDevice, MacCtrl.RcvRuleCfg, RX_RULE_DEFAULT_CLASS);
  2154. /*
  2155. * Configure to have 16 Classes of Services (COS) and one
  2156. * queue per class. Bad frames are queued to RRR#1.
  2157. * And frames don't match rules are also queued to COS#1.
  2158. */
  2159. REG_WR (pDevice, RcvListPlmt.Config, 0x181);
  2160. /* Enable Receive Placement Statistics */
  2161. REG_WR (pDevice, RcvListPlmt.StatsEnableMask, 0xffffff);
  2162. REG_WR (pDevice, RcvListPlmt.StatsCtrl, RCV_LIST_STATS_ENABLE);
  2163. /* Enable Send Data Initator Statistics */
  2164. REG_WR (pDevice, SndDataIn.StatsEnableMask, 0xffffff);
  2165. REG_WR (pDevice, SndDataIn.StatsCtrl,
  2166. T3_SND_DATA_IN_STATS_CTRL_ENABLE |
  2167. T3_SND_DATA_IN_STATS_CTRL_FASTER_UPDATE);
  2168. /* Disable the host coalescing state machine before configuring it's */
  2169. /* parameters. */
  2170. REG_WR (pDevice, HostCoalesce.Mode, 0);
  2171. for (j = 0; j < 2000; j++) {
  2172. Value32 = REG_RD (pDevice, HostCoalesce.Mode);
  2173. if (!(Value32 & HOST_COALESCE_ENABLE)) {
  2174. break;
  2175. }
  2176. MM_Wait (10);
  2177. }
  2178. /* Host coalescing configurations. */
  2179. REG_WR (pDevice, HostCoalesce.RxCoalescingTicks,
  2180. pDevice->RxCoalescingTicks);
  2181. REG_WR (pDevice, HostCoalesce.TxCoalescingTicks,
  2182. pDevice->TxCoalescingTicks);
  2183. REG_WR (pDevice, HostCoalesce.RxMaxCoalescedFrames,
  2184. pDevice->RxMaxCoalescedFrames);
  2185. REG_WR (pDevice, HostCoalesce.TxMaxCoalescedFrames,
  2186. pDevice->TxMaxCoalescedFrames);
  2187. REG_WR (pDevice, HostCoalesce.RxCoalescedTickDuringInt,
  2188. pDevice->RxCoalescingTicksDuringInt);
  2189. REG_WR (pDevice, HostCoalesce.TxCoalescedTickDuringInt,
  2190. pDevice->TxCoalescingTicksDuringInt);
  2191. REG_WR (pDevice, HostCoalesce.RxMaxCoalescedFramesDuringInt,
  2192. pDevice->RxMaxCoalescedFramesDuringInt);
  2193. REG_WR (pDevice, HostCoalesce.TxMaxCoalescedFramesDuringInt,
  2194. pDevice->TxMaxCoalescedFramesDuringInt);
  2195. /* Initialize the address of the status block. The NIC will DMA */
  2196. /* the status block to this memory which resides on the host. */
  2197. REG_WR (pDevice, HostCoalesce.StatusBlkHostAddr.High,
  2198. pDevice->StatusBlkPhy.High);
  2199. REG_WR (pDevice, HostCoalesce.StatusBlkHostAddr.Low,
  2200. pDevice->StatusBlkPhy.Low);
  2201. /* Initialize the address of the statistics block. The NIC will DMA */
  2202. /* the statistics to this block of memory. */
  2203. REG_WR (pDevice, HostCoalesce.StatsBlkHostAddr.High,
  2204. pDevice->StatsBlkPhy.High);
  2205. REG_WR (pDevice, HostCoalesce.StatsBlkHostAddr.Low,
  2206. pDevice->StatsBlkPhy.Low);
  2207. REG_WR (pDevice, HostCoalesce.StatsCoalescingTicks,
  2208. pDevice->StatsCoalescingTicks);
  2209. REG_WR (pDevice, HostCoalesce.StatsBlkNicAddr, 0x300);
  2210. REG_WR (pDevice, HostCoalesce.StatusBlkNicAddr, 0xb00);
  2211. /* Enable Host Coalesing state machine */
  2212. REG_WR (pDevice, HostCoalesce.Mode, HOST_COALESCE_ENABLE |
  2213. pDevice->CoalesceMode);
  2214. /* Enable the Receive BD Completion state machine. */
  2215. REG_WR (pDevice, RcvBdComp.Mode, RCV_BD_COMP_MODE_ENABLE |
  2216. RCV_BD_COMP_MODE_ATTN_ENABLE);
  2217. /* Enable the Receive List Placement state machine. */
  2218. REG_WR (pDevice, RcvListPlmt.Mode, RCV_LIST_PLMT_MODE_ENABLE);
  2219. /* Enable the Receive List Selector state machine. */
  2220. REG_WR (pDevice, RcvListSel.Mode, RCV_LIST_SEL_MODE_ENABLE |
  2221. RCV_LIST_SEL_MODE_ATTN_ENABLE);
  2222. /* Enable transmit DMA, clear statistics. */
  2223. pDevice->MacMode = MAC_MODE_ENABLE_TX_STATISTICS |
  2224. MAC_MODE_ENABLE_RX_STATISTICS | MAC_MODE_ENABLE_TDE |
  2225. MAC_MODE_ENABLE_RDE | MAC_MODE_ENABLE_FHDE;
  2226. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode |
  2227. MAC_MODE_CLEAR_RX_STATISTICS | MAC_MODE_CLEAR_TX_STATISTICS);
  2228. /* GRC miscellaneous local control register. */
  2229. pDevice->GrcLocalCtrl = GRC_MISC_LOCAL_CTRL_INT_ON_ATTN |
  2230. GRC_MISC_LOCAL_CTRL_AUTO_SEEPROM;
  2231. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  2232. pDevice->GrcLocalCtrl |= GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
  2233. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1;
  2234. }
  2235. REG_WR (pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl);
  2236. MM_Wait (40);
  2237. /* Reset RX counters. */
  2238. for (j = 0; j < sizeof (LM_RX_COUNTERS); j++) {
  2239. ((PLM_UINT8) & pDevice->RxCounters)[j] = 0;
  2240. }
  2241. /* Reset TX counters. */
  2242. for (j = 0; j < sizeof (LM_TX_COUNTERS); j++) {
  2243. ((PLM_UINT8) & pDevice->TxCounters)[j] = 0;
  2244. }
  2245. MB_REG_WR (pDevice, Mailbox.Interrupt[0].Low, 0);
  2246. /* Enable the DMA Completion state machine. */
  2247. REG_WR (pDevice, DmaComp.Mode, DMA_COMP_MODE_ENABLE);
  2248. /* Enable the DMA Write state machine. */
  2249. Value32 = DMA_WRITE_MODE_ENABLE |
  2250. DMA_WRITE_MODE_TARGET_ABORT_ATTN_ENABLE |
  2251. DMA_WRITE_MODE_MASTER_ABORT_ATTN_ENABLE |
  2252. DMA_WRITE_MODE_PARITY_ERROR_ATTN_ENABLE |
  2253. DMA_WRITE_MODE_ADDR_OVERFLOW_ATTN_ENABLE |
  2254. DMA_WRITE_MODE_FIFO_OVERRUN_ATTN_ENABLE |
  2255. DMA_WRITE_MODE_FIFO_UNDERRUN_ATTN_ENABLE |
  2256. DMA_WRITE_MODE_FIFO_OVERREAD_ATTN_ENABLE |
  2257. DMA_WRITE_MODE_LONG_READ_ATTN_ENABLE;
  2258. REG_WR (pDevice, DmaWrite.Mode, Value32);
  2259. if (!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE)) {
  2260. if (pDevice->ChipRevId == T3_CHIP_ID_5704_A0) {
  2261. Value16 = REG_RD (pDevice, PciCfg.PciXCommand);
  2262. Value16 &=
  2263. ~(PCIX_CMD_MAX_SPLIT_MASK |
  2264. PCIX_CMD_MAX_BURST_MASK);
  2265. Value16 |=
  2266. ((PCIX_CMD_MAX_BURST_CPIOB <<
  2267. PCIX_CMD_MAX_BURST_SHL) &
  2268. PCIX_CMD_MAX_BURST_MASK);
  2269. if (pDevice->SplitModeEnable == SPLIT_MODE_ENABLE) {
  2270. Value16 |=
  2271. (pDevice->
  2272. SplitModeMaxReq << PCIX_CMD_MAX_SPLIT_SHL)
  2273. & PCIX_CMD_MAX_SPLIT_MASK;
  2274. }
  2275. REG_WR (pDevice, PciCfg.PciXCommand, Value16);
  2276. }
  2277. }
  2278. /* Enable the Read DMA state machine. */
  2279. Value32 = DMA_READ_MODE_ENABLE |
  2280. DMA_READ_MODE_TARGET_ABORT_ATTN_ENABLE |
  2281. DMA_READ_MODE_MASTER_ABORT_ATTN_ENABLE |
  2282. DMA_READ_MODE_PARITY_ERROR_ATTN_ENABLE |
  2283. DMA_READ_MODE_ADDR_OVERFLOW_ATTN_ENABLE |
  2284. DMA_READ_MODE_FIFO_OVERRUN_ATTN_ENABLE |
  2285. DMA_READ_MODE_FIFO_UNDERRUN_ATTN_ENABLE |
  2286. DMA_READ_MODE_FIFO_OVERREAD_ATTN_ENABLE |
  2287. DMA_READ_MODE_LONG_READ_ATTN_ENABLE;
  2288. if (pDevice->SplitModeEnable == SPLIT_MODE_ENABLE) {
  2289. Value32 |= DMA_READ_MODE_SPLIT_ENABLE;
  2290. }
  2291. REG_WR (pDevice, DmaRead.Mode, Value32);
  2292. /* Enable the Receive Data Completion state machine. */
  2293. REG_WR (pDevice, RcvDataComp.Mode, RCV_DATA_COMP_MODE_ENABLE |
  2294. RCV_DATA_COMP_MODE_ATTN_ENABLE);
  2295. /* Enable the Mbuf Cluster Free state machine. */
  2296. REG_WR (pDevice, MbufClusterFree.Mode, MBUF_CLUSTER_FREE_MODE_ENABLE);
  2297. /* Enable the Send Data Completion state machine. */
  2298. REG_WR (pDevice, SndDataComp.Mode, SND_DATA_COMP_MODE_ENABLE);
  2299. /* Enable the Send BD Completion state machine. */
  2300. REG_WR (pDevice, SndBdComp.Mode, SND_BD_COMP_MODE_ENABLE |
  2301. SND_BD_COMP_MODE_ATTN_ENABLE);
  2302. /* Enable the Receive BD Initiator state machine. */
  2303. REG_WR (pDevice, RcvBdIn.Mode, RCV_BD_IN_MODE_ENABLE |
  2304. RCV_BD_IN_MODE_BD_IN_DIABLED_RCB_ATTN_ENABLE);
  2305. /* Enable the Receive Data and Receive BD Initiator state machine. */
  2306. REG_WR (pDevice, RcvDataBdIn.Mode, RCV_DATA_BD_IN_MODE_ENABLE |
  2307. RCV_DATA_BD_IN_MODE_INVALID_RING_SIZE);
  2308. /* Enable the Send Data Initiator state machine. */
  2309. REG_WR (pDevice, SndDataIn.Mode, T3_SND_DATA_IN_MODE_ENABLE);
  2310. /* Enable the Send BD Initiator state machine. */
  2311. REG_WR (pDevice, SndBdIn.Mode, SND_BD_IN_MODE_ENABLE |
  2312. SND_BD_IN_MODE_ATTN_ENABLE);
  2313. /* Enable the Send BD Selector state machine. */
  2314. REG_WR (pDevice, SndBdSel.Mode, SND_BD_SEL_MODE_ENABLE |
  2315. SND_BD_SEL_MODE_ATTN_ENABLE);
  2316. #if INCLUDE_5701_AX_FIX
  2317. /* Load the firmware for the 5701_A0 workaround. */
  2318. if (pDevice->ChipRevId == T3_CHIP_ID_5701_A0) {
  2319. LM_LoadRlsFirmware (pDevice);
  2320. }
  2321. #endif
  2322. /* Enable the transmitter. */
  2323. pDevice->TxMode = TX_MODE_ENABLE;
  2324. REG_WR (pDevice, MacCtrl.TxMode, pDevice->TxMode);
  2325. /* Enable the receiver. */
  2326. pDevice->RxMode = RX_MODE_ENABLE;
  2327. REG_WR (pDevice, MacCtrl.RxMode, pDevice->RxMode);
  2328. if (pDevice->RestoreOnWakeUp) {
  2329. pDevice->RestoreOnWakeUp = FALSE;
  2330. pDevice->DisableAutoNeg = pDevice->WakeUpDisableAutoNeg;
  2331. pDevice->RequestedMediaType = pDevice->WakeUpRequestedMediaType;
  2332. }
  2333. /* Disable auto polling. */
  2334. pDevice->MiMode = 0xc0000;
  2335. REG_WR (pDevice, MacCtrl.MiMode, pDevice->MiMode);
  2336. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  2337. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  2338. Value32 = LED_CTRL_PHY_MODE_1;
  2339. } else {
  2340. if (pDevice->LedMode == LED_MODE_OUTPUT) {
  2341. Value32 = LED_CTRL_PHY_MODE_2;
  2342. } else {
  2343. Value32 = LED_CTRL_PHY_MODE_1;
  2344. }
  2345. }
  2346. REG_WR (pDevice, MacCtrl.LedCtrl, Value32);
  2347. /* Activate Link to enable MAC state machine */
  2348. REG_WR (pDevice, MacCtrl.MiStatus, MI_STATUS_ENABLE_LINK_STATUS_ATTN);
  2349. if (pDevice->EnableTbi) {
  2350. REG_WR (pDevice, MacCtrl.RxMode, RX_MODE_RESET);
  2351. MM_Wait (10);
  2352. REG_WR (pDevice, MacCtrl.RxMode, pDevice->RxMode);
  2353. if (pDevice->ChipRevId == T3_CHIP_ID_5703_A1) {
  2354. REG_WR (pDevice, MacCtrl.SerdesCfg, 0x616000);
  2355. }
  2356. }
  2357. /* Setup the phy chip. */
  2358. LM_SetupPhy (pDevice);
  2359. if (!pDevice->EnableTbi) {
  2360. /* Clear CRC stats */
  2361. LM_ReadPhy (pDevice, 0x1e, &Value32);
  2362. LM_WritePhy (pDevice, 0x1e, Value32 | 0x8000);
  2363. LM_ReadPhy (pDevice, 0x14, &Value32);
  2364. }
  2365. /* Set up the receive mask. */
  2366. LM_SetReceiveMask (pDevice, pDevice->ReceiveMask);
  2367. /* Queue Rx packet buffers. */
  2368. if (pDevice->QueueRxPackets) {
  2369. LM_QueueRxPackets (pDevice);
  2370. }
  2371. /* Enable interrupt to the host. */
  2372. if (pDevice->InitDone) {
  2373. LM_EnableInterrupt (pDevice);
  2374. }
  2375. return LM_STATUS_SUCCESS;
  2376. } /* LM_ResetAdapter */
  2377. /******************************************************************************/
  2378. /* Description: */
  2379. /* This routine disables the adapter from generating interrupts. */
  2380. /* */
  2381. /* Return: */
  2382. /* LM_STATUS_SUCCESS */
  2383. /******************************************************************************/
  2384. LM_STATUS LM_DisableInterrupt (PLM_DEVICE_BLOCK pDevice)
  2385. {
  2386. REG_WR (pDevice, PciCfg.MiscHostCtrl, pDevice->MiscHostCtrl |
  2387. MISC_HOST_CTRL_MASK_PCI_INT);
  2388. MB_REG_WR (pDevice, Mailbox.Interrupt[0].Low, 1);
  2389. return LM_STATUS_SUCCESS;
  2390. }
  2391. /******************************************************************************/
  2392. /* Description: */
  2393. /* This routine enables the adapter to generate interrupts. */
  2394. /* */
  2395. /* Return: */
  2396. /* LM_STATUS_SUCCESS */
  2397. /******************************************************************************/
  2398. LM_STATUS LM_EnableInterrupt (PLM_DEVICE_BLOCK pDevice)
  2399. {
  2400. REG_WR (pDevice, PciCfg.MiscHostCtrl, pDevice->MiscHostCtrl &
  2401. ~MISC_HOST_CTRL_MASK_PCI_INT);
  2402. MB_REG_WR (pDevice, Mailbox.Interrupt[0].Low, 0);
  2403. if (pDevice->pStatusBlkVirt->Status & STATUS_BLOCK_UPDATED) {
  2404. REG_WR (pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
  2405. GRC_MISC_LOCAL_CTRL_SET_INT);
  2406. }
  2407. return LM_STATUS_SUCCESS;
  2408. }
  2409. /******************************************************************************/
  2410. /* Description: */
  2411. /* This routine puts a packet on the wire if there is a transmit DMA */
  2412. /* descriptor available; otherwise the packet is queued for later */
  2413. /* transmission. If the second argue is NULL, this routine will put */
  2414. /* the queued packet on the wire if possible. */
  2415. /* */
  2416. /* Return: */
  2417. /* LM_STATUS_SUCCESS */
  2418. /******************************************************************************/
  2419. #if 0
  2420. LM_STATUS LM_SendPacket (PLM_DEVICE_BLOCK pDevice, PLM_PACKET pPacket)
  2421. {
  2422. LM_UINT32 FragCount;
  2423. PT3_SND_BD pSendBd;
  2424. PT3_SND_BD pShadowSendBd;
  2425. LM_UINT32 Value32, Len;
  2426. LM_UINT32 Idx;
  2427. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  2428. return LM_5700SendPacket (pDevice, pPacket);
  2429. }
  2430. /* Update the SendBdLeft count. */
  2431. atomic_sub (pPacket->u.Tx.FragCount, &pDevice->SendBdLeft);
  2432. /* Initalize the send buffer descriptors. */
  2433. Idx = pDevice->SendProdIdx;
  2434. pSendBd = &pDevice->pSendBdVirt[Idx];
  2435. /* Next producer index. */
  2436. if (pDevice->NicSendBd == TRUE) {
  2437. T3_64BIT_HOST_ADDR paddr;
  2438. pShadowSendBd = &pDevice->ShadowSendBd[Idx];
  2439. for (FragCount = 0;;) {
  2440. MM_MapTxDma (pDevice, pPacket, &paddr, &Len, FragCount);
  2441. /* Initialize the pointer to the send buffer fragment. */
  2442. if (paddr.High != pShadowSendBd->HostAddr.High) {
  2443. __raw_writel (paddr.High,
  2444. &(pSendBd->HostAddr.High));
  2445. pShadowSendBd->HostAddr.High = paddr.High;
  2446. }
  2447. __raw_writel (paddr.Low, &(pSendBd->HostAddr.Low));
  2448. /* Setup the control flags and send buffer size. */
  2449. Value32 = (Len << 16) | pPacket->Flags;
  2450. Idx = (Idx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
  2451. FragCount++;
  2452. if (FragCount >= pPacket->u.Tx.FragCount) {
  2453. Value32 |= SND_BD_FLAG_END;
  2454. if (Value32 != pShadowSendBd->u1.Len_Flags) {
  2455. __raw_writel (Value32,
  2456. &(pSendBd->u1.Len_Flags));
  2457. pShadowSendBd->u1.Len_Flags = Value32;
  2458. }
  2459. if (pPacket->Flags & SND_BD_FLAG_VLAN_TAG) {
  2460. __raw_writel (pPacket->VlanTag,
  2461. &(pSendBd->u2.VlanTag));
  2462. }
  2463. break;
  2464. } else {
  2465. if (Value32 != pShadowSendBd->u1.Len_Flags) {
  2466. __raw_writel (Value32,
  2467. &(pSendBd->u1.Len_Flags));
  2468. pShadowSendBd->u1.Len_Flags = Value32;
  2469. }
  2470. if (pPacket->Flags & SND_BD_FLAG_VLAN_TAG) {
  2471. __raw_writel (pPacket->VlanTag,
  2472. &(pSendBd->u2.VlanTag));
  2473. }
  2474. }
  2475. pSendBd++;
  2476. pShadowSendBd++;
  2477. if (Idx == 0) {
  2478. pSendBd = &pDevice->pSendBdVirt[0];
  2479. pShadowSendBd = &pDevice->ShadowSendBd[0];
  2480. }
  2481. } /* for */
  2482. /* Put the packet descriptor in the ActiveQ. */
  2483. QQ_PushTail (&pDevice->TxPacketActiveQ.Container, pPacket);
  2484. wmb ();
  2485. MB_REG_WR (pDevice, Mailbox.SendNicProdIdx[0].Low, Idx);
  2486. } else {
  2487. for (FragCount = 0;;) {
  2488. /* Initialize the pointer to the send buffer fragment. */
  2489. MM_MapTxDma (pDevice, pPacket, &pSendBd->HostAddr, &Len,
  2490. FragCount);
  2491. pSendBd->u2.VlanTag = pPacket->VlanTag;
  2492. /* Setup the control flags and send buffer size. */
  2493. Value32 = (Len << 16) | pPacket->Flags;
  2494. Idx = (Idx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
  2495. FragCount++;
  2496. if (FragCount >= pPacket->u.Tx.FragCount) {
  2497. pSendBd->u1.Len_Flags =
  2498. Value32 | SND_BD_FLAG_END;
  2499. break;
  2500. } else {
  2501. pSendBd->u1.Len_Flags = Value32;
  2502. }
  2503. pSendBd++;
  2504. if (Idx == 0) {
  2505. pSendBd = &pDevice->pSendBdVirt[0];
  2506. }
  2507. } /* for */
  2508. /* Put the packet descriptor in the ActiveQ. */
  2509. QQ_PushTail (&pDevice->TxPacketActiveQ.Container, pPacket);
  2510. wmb ();
  2511. MB_REG_WR (pDevice, Mailbox.SendHostProdIdx[0].Low, Idx);
  2512. }
  2513. /* Update the producer index. */
  2514. pDevice->SendProdIdx = Idx;
  2515. return LM_STATUS_SUCCESS;
  2516. }
  2517. #endif
  2518. LM_STATUS LM_SendPacket (PLM_DEVICE_BLOCK pDevice, PLM_PACKET pPacket)
  2519. {
  2520. LM_UINT32 FragCount;
  2521. PT3_SND_BD pSendBd, pTmpSendBd, pShadowSendBd;
  2522. T3_SND_BD NicSendBdArr[MAX_FRAGMENT_COUNT];
  2523. LM_UINT32 StartIdx, Idx;
  2524. while (1) {
  2525. /* Initalize the send buffer descriptors. */
  2526. StartIdx = Idx = pDevice->SendProdIdx;
  2527. if (pDevice->NicSendBd) {
  2528. pTmpSendBd = pSendBd = &NicSendBdArr[0];
  2529. } else {
  2530. pTmpSendBd = pSendBd = &pDevice->pSendBdVirt[Idx];
  2531. }
  2532. /* Next producer index. */
  2533. for (FragCount = 0;;) {
  2534. LM_UINT32 Value32, Len;
  2535. /* Initialize the pointer to the send buffer fragment. */
  2536. MM_MapTxDma (pDevice, pPacket, &pSendBd->HostAddr, &Len,
  2537. FragCount);
  2538. pSendBd->u2.VlanTag = pPacket->VlanTag;
  2539. /* Setup the control flags and send buffer size. */
  2540. Value32 = (Len << 16) | pPacket->Flags;
  2541. Idx = (Idx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
  2542. FragCount++;
  2543. if (FragCount >= pPacket->u.Tx.FragCount) {
  2544. pSendBd->u1.Len_Flags =
  2545. Value32 | SND_BD_FLAG_END;
  2546. break;
  2547. } else {
  2548. pSendBd->u1.Len_Flags = Value32;
  2549. }
  2550. pSendBd++;
  2551. if ((Idx == 0) && !pDevice->NicSendBd) {
  2552. pSendBd = &pDevice->pSendBdVirt[0];
  2553. }
  2554. } /* for */
  2555. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  2556. if (LM_Test4GBoundary (pDevice, pPacket, pTmpSendBd) ==
  2557. LM_STATUS_SUCCESS) {
  2558. if (MM_CoalesceTxBuffer (pDevice, pPacket) !=
  2559. LM_STATUS_SUCCESS) {
  2560. QQ_PushHead (&pDevice->TxPacketFreeQ.
  2561. Container, pPacket);
  2562. return LM_STATUS_FAILURE;
  2563. }
  2564. continue;
  2565. }
  2566. }
  2567. break;
  2568. }
  2569. /* Put the packet descriptor in the ActiveQ. */
  2570. QQ_PushTail (&pDevice->TxPacketActiveQ.Container, pPacket);
  2571. if (pDevice->NicSendBd) {
  2572. pSendBd = &pDevice->pSendBdVirt[StartIdx];
  2573. pShadowSendBd = &pDevice->ShadowSendBd[StartIdx];
  2574. while (StartIdx != Idx) {
  2575. LM_UINT32 Value32;
  2576. if ((Value32 = pTmpSendBd->HostAddr.High) !=
  2577. pShadowSendBd->HostAddr.High) {
  2578. __raw_writel (Value32,
  2579. &(pSendBd->HostAddr.High));
  2580. pShadowSendBd->HostAddr.High = Value32;
  2581. }
  2582. __raw_writel (pTmpSendBd->HostAddr.Low,
  2583. &(pSendBd->HostAddr.Low));
  2584. if ((Value32 = pTmpSendBd->u1.Len_Flags) !=
  2585. pShadowSendBd->u1.Len_Flags) {
  2586. __raw_writel (Value32,
  2587. &(pSendBd->u1.Len_Flags));
  2588. pShadowSendBd->u1.Len_Flags = Value32;
  2589. }
  2590. if (pPacket->Flags & SND_BD_FLAG_VLAN_TAG) {
  2591. __raw_writel (pTmpSendBd->u2.VlanTag,
  2592. &(pSendBd->u2.VlanTag));
  2593. }
  2594. StartIdx =
  2595. (StartIdx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
  2596. if (StartIdx == 0)
  2597. pSendBd = &pDevice->pSendBdVirt[0];
  2598. else
  2599. pSendBd++;
  2600. pTmpSendBd++;
  2601. }
  2602. wmb ();
  2603. MB_REG_WR (pDevice, Mailbox.SendNicProdIdx[0].Low, Idx);
  2604. if (T3_CHIP_REV (pDevice->ChipRevId) == T3_CHIP_REV_5700_BX) {
  2605. MB_REG_WR (pDevice, Mailbox.SendNicProdIdx[0].Low, Idx);
  2606. }
  2607. } else {
  2608. wmb ();
  2609. MB_REG_WR (pDevice, Mailbox.SendHostProdIdx[0].Low, Idx);
  2610. if (T3_CHIP_REV (pDevice->ChipRevId) == T3_CHIP_REV_5700_BX) {
  2611. MB_REG_WR (pDevice, Mailbox.SendHostProdIdx[0].Low,
  2612. Idx);
  2613. }
  2614. }
  2615. /* Update the SendBdLeft count. */
  2616. atomic_sub (pPacket->u.Tx.FragCount, &pDevice->SendBdLeft);
  2617. /* Update the producer index. */
  2618. pDevice->SendProdIdx = Idx;
  2619. return LM_STATUS_SUCCESS;
  2620. }
  2621. STATIC LM_STATUS
  2622. LM_Test4GBoundary (PLM_DEVICE_BLOCK pDevice, PLM_PACKET pPacket,
  2623. PT3_SND_BD pSendBd)
  2624. {
  2625. int FragCount;
  2626. LM_UINT32 Idx, Base, Len;
  2627. Idx = pDevice->SendProdIdx;
  2628. for (FragCount = 0;;) {
  2629. Len = pSendBd->u1.Len_Flags >> 16;
  2630. if (((Base = pSendBd->HostAddr.Low) > 0xffffdcc0) &&
  2631. (pSendBd->HostAddr.High == 0) &&
  2632. ((Base + 8 + Len) < Base)) {
  2633. return LM_STATUS_SUCCESS;
  2634. }
  2635. FragCount++;
  2636. if (FragCount >= pPacket->u.Tx.FragCount) {
  2637. break;
  2638. }
  2639. pSendBd++;
  2640. if (!pDevice->NicSendBd) {
  2641. Idx = (Idx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
  2642. if (Idx == 0) {
  2643. pSendBd = &pDevice->pSendBdVirt[0];
  2644. }
  2645. }
  2646. }
  2647. return LM_STATUS_FAILURE;
  2648. }
  2649. /******************************************************************************/
  2650. /* Description: */
  2651. /* */
  2652. /* Return: */
  2653. /******************************************************************************/
  2654. __inline static unsigned long
  2655. ComputeCrc32 (unsigned char *pBuffer, unsigned long BufferSize)
  2656. {
  2657. unsigned long Reg;
  2658. unsigned long Tmp;
  2659. unsigned long j, k;
  2660. Reg = 0xffffffff;
  2661. for (j = 0; j < BufferSize; j++) {
  2662. Reg ^= pBuffer[j];
  2663. for (k = 0; k < 8; k++) {
  2664. Tmp = Reg & 0x01;
  2665. Reg >>= 1;
  2666. if (Tmp) {
  2667. Reg ^= 0xedb88320;
  2668. }
  2669. }
  2670. }
  2671. return ~Reg;
  2672. } /* ComputeCrc32 */
  2673. /******************************************************************************/
  2674. /* Description: */
  2675. /* This routine sets the receive control register according to ReceiveMask */
  2676. /* */
  2677. /* Return: */
  2678. /* LM_STATUS_SUCCESS */
  2679. /******************************************************************************/
  2680. LM_STATUS LM_SetReceiveMask (PLM_DEVICE_BLOCK pDevice, LM_UINT32 Mask)
  2681. {
  2682. LM_UINT32 ReceiveMask;
  2683. LM_UINT32 RxMode;
  2684. LM_UINT32 j, k;
  2685. ReceiveMask = Mask;
  2686. RxMode = pDevice->RxMode;
  2687. if (Mask & LM_ACCEPT_UNICAST) {
  2688. Mask &= ~LM_ACCEPT_UNICAST;
  2689. }
  2690. if (Mask & LM_ACCEPT_MULTICAST) {
  2691. Mask &= ~LM_ACCEPT_MULTICAST;
  2692. }
  2693. if (Mask & LM_ACCEPT_ALL_MULTICAST) {
  2694. Mask &= ~LM_ACCEPT_ALL_MULTICAST;
  2695. }
  2696. if (Mask & LM_ACCEPT_BROADCAST) {
  2697. Mask &= ~LM_ACCEPT_BROADCAST;
  2698. }
  2699. RxMode &= ~RX_MODE_PROMISCUOUS_MODE;
  2700. if (Mask & LM_PROMISCUOUS_MODE) {
  2701. RxMode |= RX_MODE_PROMISCUOUS_MODE;
  2702. Mask &= ~LM_PROMISCUOUS_MODE;
  2703. }
  2704. RxMode &= ~(RX_MODE_ACCEPT_RUNTS | RX_MODE_ACCEPT_OVERSIZED);
  2705. if (Mask & LM_ACCEPT_ERROR_PACKET) {
  2706. RxMode |= RX_MODE_ACCEPT_RUNTS | RX_MODE_ACCEPT_OVERSIZED;
  2707. Mask &= ~LM_ACCEPT_ERROR_PACKET;
  2708. }
  2709. /* Make sure all the bits are valid before committing changes. */
  2710. if (Mask) {
  2711. return LM_STATUS_FAILURE;
  2712. }
  2713. /* Commit the new filter. */
  2714. pDevice->RxMode = RxMode;
  2715. REG_WR (pDevice, MacCtrl.RxMode, RxMode);
  2716. pDevice->ReceiveMask = ReceiveMask;
  2717. /* Set up the MC hash table. */
  2718. if (ReceiveMask & LM_ACCEPT_ALL_MULTICAST) {
  2719. for (k = 0; k < 4; k++) {
  2720. REG_WR (pDevice, MacCtrl.HashReg[k], 0xffffffff);
  2721. }
  2722. } else if (ReceiveMask & LM_ACCEPT_MULTICAST) {
  2723. LM_UINT32 HashReg[4];
  2724. HashReg[0] = 0;
  2725. HashReg[1] = 0;
  2726. HashReg[2] = 0;
  2727. HashReg[3] = 0;
  2728. for (j = 0; j < pDevice->McEntryCount; j++) {
  2729. LM_UINT32 RegIndex;
  2730. LM_UINT32 Bitpos;
  2731. LM_UINT32 Crc32;
  2732. Crc32 =
  2733. ComputeCrc32 (pDevice->McTable[j],
  2734. ETHERNET_ADDRESS_SIZE);
  2735. /* The most significant 7 bits of the CRC32 (no inversion), */
  2736. /* are used to index into one of the possible 128 bit positions. */
  2737. Bitpos = ~Crc32 & 0x7f;
  2738. /* Hash register index. */
  2739. RegIndex = (Bitpos & 0x60) >> 5;
  2740. /* Bit to turn on within a hash register. */
  2741. Bitpos &= 0x1f;
  2742. /* Enable the multicast bit. */
  2743. HashReg[RegIndex] |= (1 << Bitpos);
  2744. }
  2745. /* REV_AX has problem with multicast filtering where it uses both */
  2746. /* DA and SA to perform hashing. */
  2747. for (k = 0; k < 4; k++) {
  2748. REG_WR (pDevice, MacCtrl.HashReg[k], HashReg[k]);
  2749. }
  2750. } else {
  2751. /* Reject all multicast frames. */
  2752. for (j = 0; j < 4; j++) {
  2753. REG_WR (pDevice, MacCtrl.HashReg[j], 0);
  2754. }
  2755. }
  2756. /* By default, Tigon3 will accept broadcast frames. We need to setup */
  2757. if (ReceiveMask & LM_ACCEPT_BROADCAST) {
  2758. REG_WR (pDevice,
  2759. MacCtrl.RcvRules[RCV_RULE1_REJECT_BROADCAST_IDX].Rule,
  2760. REJECT_BROADCAST_RULE1_RULE & RCV_DISABLE_RULE_MASK);
  2761. REG_WR (pDevice,
  2762. MacCtrl.RcvRules[RCV_RULE1_REJECT_BROADCAST_IDX].Value,
  2763. REJECT_BROADCAST_RULE1_VALUE & RCV_DISABLE_RULE_MASK);
  2764. REG_WR (pDevice,
  2765. MacCtrl.RcvRules[RCV_RULE2_REJECT_BROADCAST_IDX].Rule,
  2766. REJECT_BROADCAST_RULE1_RULE & RCV_DISABLE_RULE_MASK);
  2767. REG_WR (pDevice,
  2768. MacCtrl.RcvRules[RCV_RULE2_REJECT_BROADCAST_IDX].Value,
  2769. REJECT_BROADCAST_RULE1_VALUE & RCV_DISABLE_RULE_MASK);
  2770. } else {
  2771. REG_WR (pDevice,
  2772. MacCtrl.RcvRules[RCV_RULE1_REJECT_BROADCAST_IDX].Rule,
  2773. REJECT_BROADCAST_RULE1_RULE);
  2774. REG_WR (pDevice,
  2775. MacCtrl.RcvRules[RCV_RULE1_REJECT_BROADCAST_IDX].Value,
  2776. REJECT_BROADCAST_RULE1_VALUE);
  2777. REG_WR (pDevice,
  2778. MacCtrl.RcvRules[RCV_RULE2_REJECT_BROADCAST_IDX].Rule,
  2779. REJECT_BROADCAST_RULE2_RULE);
  2780. REG_WR (pDevice,
  2781. MacCtrl.RcvRules[RCV_RULE2_REJECT_BROADCAST_IDX].Value,
  2782. REJECT_BROADCAST_RULE2_VALUE);
  2783. }
  2784. /* disable the rest of the rules. */
  2785. for (j = RCV_LAST_RULE_IDX; j < 16; j++) {
  2786. REG_WR (pDevice, MacCtrl.RcvRules[j].Rule, 0);
  2787. REG_WR (pDevice, MacCtrl.RcvRules[j].Value, 0);
  2788. }
  2789. return LM_STATUS_SUCCESS;
  2790. } /* LM_SetReceiveMask */
  2791. /******************************************************************************/
  2792. /* Description: */
  2793. /* Disable the interrupt and put the transmitter and receiver engines in */
  2794. /* an idle state. Also aborts all pending send requests and receive */
  2795. /* buffers. */
  2796. /* */
  2797. /* Return: */
  2798. /* LM_STATUS_SUCCESS */
  2799. /******************************************************************************/
  2800. LM_STATUS LM_Abort (PLM_DEVICE_BLOCK pDevice)
  2801. {
  2802. PLM_PACKET pPacket;
  2803. LM_UINT Idx;
  2804. LM_DisableInterrupt (pDevice);
  2805. /* Disable all the state machines. */
  2806. LM_CntrlBlock (pDevice, T3_BLOCK_MAC_RX_ENGINE, LM_DISABLE);
  2807. LM_CntrlBlock (pDevice, T3_BLOCK_RX_BD_INITIATOR, LM_DISABLE);
  2808. LM_CntrlBlock (pDevice, T3_BLOCK_RX_LIST_PLMT, LM_DISABLE);
  2809. LM_CntrlBlock (pDevice, T3_BLOCK_RX_LIST_SELECTOR, LM_DISABLE);
  2810. LM_CntrlBlock (pDevice, T3_BLOCK_RX_DATA_INITIATOR, LM_DISABLE);
  2811. LM_CntrlBlock (pDevice, T3_BLOCK_RX_DATA_COMP, LM_DISABLE);
  2812. LM_CntrlBlock (pDevice, T3_BLOCK_RX_BD_COMP, LM_DISABLE);
  2813. LM_CntrlBlock (pDevice, T3_BLOCK_SEND_BD_SELECTOR, LM_DISABLE);
  2814. LM_CntrlBlock (pDevice, T3_BLOCK_SEND_BD_INITIATOR, LM_DISABLE);
  2815. LM_CntrlBlock (pDevice, T3_BLOCK_SEND_DATA_INITIATOR, LM_DISABLE);
  2816. LM_CntrlBlock (pDevice, T3_BLOCK_DMA_RD, LM_DISABLE);
  2817. LM_CntrlBlock (pDevice, T3_BLOCK_SEND_DATA_COMP, LM_DISABLE);
  2818. LM_CntrlBlock (pDevice, T3_BLOCK_DMA_COMP, LM_DISABLE);
  2819. LM_CntrlBlock (pDevice, T3_BLOCK_SEND_BD_COMP, LM_DISABLE);
  2820. /* Clear TDE bit */
  2821. pDevice->MacMode &= ~MAC_MODE_ENABLE_TDE;
  2822. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode);
  2823. LM_CntrlBlock (pDevice, T3_BLOCK_MAC_TX_ENGINE, LM_DISABLE);
  2824. LM_CntrlBlock (pDevice, T3_BLOCK_HOST_COALESING, LM_DISABLE);
  2825. LM_CntrlBlock (pDevice, T3_BLOCK_DMA_WR, LM_DISABLE);
  2826. LM_CntrlBlock (pDevice, T3_BLOCK_MBUF_CLUSTER_FREE, LM_DISABLE);
  2827. /* Reset all FTQs */
  2828. REG_WR (pDevice, Ftq.Reset, 0xffffffff);
  2829. REG_WR (pDevice, Ftq.Reset, 0x0);
  2830. LM_CntrlBlock (pDevice, T3_BLOCK_MBUF_MANAGER, LM_DISABLE);
  2831. LM_CntrlBlock (pDevice, T3_BLOCK_MEM_ARBITOR, LM_DISABLE);
  2832. MM_ACQUIRE_INT_LOCK (pDevice);
  2833. /* Abort packets that have already queued to go out. */
  2834. pPacket = (PLM_PACKET) QQ_PopHead (&pDevice->TxPacketActiveQ.Container);
  2835. while (pPacket) {
  2836. pPacket->PacketStatus = LM_STATUS_TRANSMIT_ABORTED;
  2837. pDevice->TxCounters.TxPacketAbortedCnt++;
  2838. atomic_add (pPacket->u.Tx.FragCount, &pDevice->SendBdLeft);
  2839. QQ_PushTail (&pDevice->TxPacketXmittedQ.Container, pPacket);
  2840. pPacket = (PLM_PACKET)
  2841. QQ_PopHead (&pDevice->TxPacketActiveQ.Container);
  2842. }
  2843. /* Cleanup the receive return rings. */
  2844. LM_ServiceRxInterrupt (pDevice);
  2845. /* Don't want to indicate rx packets in Ndis miniport shutdown context. */
  2846. /* Doing so may cause system crash. */
  2847. if (!pDevice->ShuttingDown) {
  2848. /* Indicate packets to the protocol. */
  2849. MM_IndicateTxPackets (pDevice);
  2850. /* Indicate received packets to the protocols. */
  2851. MM_IndicateRxPackets (pDevice);
  2852. } else {
  2853. /* Move the receive packet descriptors in the ReceivedQ to the */
  2854. /* free queue. */
  2855. for (;;) {
  2856. pPacket =
  2857. (PLM_PACKET) QQ_PopHead (&pDevice->
  2858. RxPacketReceivedQ.
  2859. Container);
  2860. if (pPacket == NULL) {
  2861. break;
  2862. }
  2863. QQ_PushTail (&pDevice->RxPacketFreeQ.Container,
  2864. pPacket);
  2865. }
  2866. }
  2867. /* Clean up the Std Receive Producer ring. */
  2868. Idx = pDevice->pStatusBlkVirt->RcvStdConIdx;
  2869. while (Idx != pDevice->RxStdProdIdx) {
  2870. pPacket = (PLM_PACKET) (MM_UINT_PTR (pDevice->pPacketDescBase) +
  2871. MM_UINT_PTR (pDevice->pRxStdBdVirt[Idx].
  2872. Opaque));
  2873. QQ_PushTail (&pDevice->RxPacketFreeQ.Container, pPacket);
  2874. Idx = (Idx + 1) & T3_STD_RCV_RCB_ENTRY_COUNT_MASK;
  2875. } /* while */
  2876. /* Reinitialize our copy of the indices. */
  2877. pDevice->RxStdProdIdx = 0;
  2878. #if T3_JUMBO_RCV_RCB_ENTRY_COUNT
  2879. /* Clean up the Jumbo Receive Producer ring. */
  2880. Idx = pDevice->pStatusBlkVirt->RcvJumboConIdx;
  2881. while (Idx != pDevice->RxJumboProdIdx) {
  2882. pPacket = (PLM_PACKET) (MM_UINT_PTR (pDevice->pPacketDescBase) +
  2883. MM_UINT_PTR (pDevice->
  2884. pRxJumboBdVirt[Idx].
  2885. Opaque));
  2886. QQ_PushTail (&pDevice->RxPacketFreeQ.Container, pPacket);
  2887. Idx = (Idx + 1) & T3_JUMBO_RCV_RCB_ENTRY_COUNT_MASK;
  2888. } /* while */
  2889. /* Reinitialize our copy of the indices. */
  2890. pDevice->RxJumboProdIdx = 0;
  2891. #endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
  2892. MM_RELEASE_INT_LOCK (pDevice);
  2893. /* Initialize the statistis Block */
  2894. pDevice->pStatusBlkVirt->Status = 0;
  2895. pDevice->pStatusBlkVirt->RcvStdConIdx = 0;
  2896. pDevice->pStatusBlkVirt->RcvJumboConIdx = 0;
  2897. pDevice->pStatusBlkVirt->RcvMiniConIdx = 0;
  2898. return LM_STATUS_SUCCESS;
  2899. } /* LM_Abort */
  2900. /******************************************************************************/
  2901. /* Description: */
  2902. /* Disable the interrupt and put the transmitter and receiver engines in */
  2903. /* an idle state. Aborts all pending send requests and receive buffers. */
  2904. /* Also free all the receive buffers. */
  2905. /* */
  2906. /* Return: */
  2907. /* LM_STATUS_SUCCESS */
  2908. /******************************************************************************/
  2909. LM_STATUS LM_Halt (PLM_DEVICE_BLOCK pDevice)
  2910. {
  2911. PLM_PACKET pPacket;
  2912. LM_UINT32 EntryCnt;
  2913. LM_Abort (pDevice);
  2914. /* Get the number of entries in the queue. */
  2915. EntryCnt = QQ_GetEntryCnt (&pDevice->RxPacketFreeQ.Container);
  2916. /* Make sure all the packets have been accounted for. */
  2917. for (EntryCnt = 0; EntryCnt < pDevice->RxPacketDescCnt; EntryCnt++) {
  2918. pPacket =
  2919. (PLM_PACKET) QQ_PopHead (&pDevice->RxPacketFreeQ.Container);
  2920. if (pPacket == 0)
  2921. break;
  2922. MM_FreeRxBuffer (pDevice, pPacket);
  2923. QQ_PushTail (&pDevice->RxPacketFreeQ.Container, pPacket);
  2924. }
  2925. LM_ResetChip (pDevice);
  2926. /* Restore PCI configuration registers. */
  2927. MM_WriteConfig32 (pDevice, PCI_CACHE_LINE_SIZE_REG,
  2928. pDevice->SavedCacheLineReg);
  2929. LM_RegWrInd (pDevice, PCI_SUBSYSTEM_VENDOR_ID_REG,
  2930. (pDevice->SubsystemId << 16) | pDevice->SubsystemVendorId);
  2931. /* Reprogram the MAC address. */
  2932. LM_SetMacAddress (pDevice);
  2933. return LM_STATUS_SUCCESS;
  2934. } /* LM_Halt */
  2935. STATIC LM_STATUS LM_ResetChip (PLM_DEVICE_BLOCK pDevice)
  2936. {
  2937. LM_UINT32 Value32;
  2938. LM_UINT32 j;
  2939. /* Wait for access to the nvram interface before resetting. This is */
  2940. /* a workaround to prevent EEPROM corruption. */
  2941. if (T3_ASIC_REV (pDevice->ChipRevId) != T3_ASIC_REV_5700 &&
  2942. T3_ASIC_REV (pDevice->ChipRevId) != T3_ASIC_REV_5701) {
  2943. /* Request access to the flash interface. */
  2944. REG_WR (pDevice, Nvram.SwArb, SW_ARB_REQ_SET1);
  2945. for (j = 0; j < 100000; j++) {
  2946. Value32 = REG_RD (pDevice, Nvram.SwArb);
  2947. if (Value32 & SW_ARB_GNT1) {
  2948. break;
  2949. }
  2950. MM_Wait (10);
  2951. }
  2952. }
  2953. /* Global reset. */
  2954. REG_WR (pDevice, Grc.MiscCfg, GRC_MISC_CFG_CORE_CLOCK_RESET);
  2955. MM_Wait (40);
  2956. MM_Wait (40);
  2957. MM_Wait (40);
  2958. /* make sure we re-enable indirect accesses */
  2959. MM_WriteConfig32 (pDevice, T3_PCI_MISC_HOST_CTRL_REG,
  2960. pDevice->MiscHostCtrl);
  2961. /* Set MAX PCI retry to zero. */
  2962. Value32 =
  2963. T3_PCI_STATE_PCI_ROM_ENABLE | T3_PCI_STATE_PCI_ROM_RETRY_ENABLE;
  2964. if (pDevice->ChipRevId == T3_CHIP_ID_5704_A0) {
  2965. if (!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE)) {
  2966. Value32 |= T3_PCI_STATE_RETRY_SAME_DMA;
  2967. }
  2968. }
  2969. MM_WriteConfig32 (pDevice, T3_PCI_STATE_REG, Value32);
  2970. /* Restore PCI command register. */
  2971. MM_WriteConfig32 (pDevice, PCI_COMMAND_REG,
  2972. pDevice->PciCommandStatusWords);
  2973. /* Disable PCI-X relaxed ordering bit. */
  2974. MM_ReadConfig32 (pDevice, PCIX_CAP_REG, &Value32);
  2975. Value32 &= ~PCIX_ENABLE_RELAXED_ORDERING;
  2976. MM_WriteConfig32 (pDevice, PCIX_CAP_REG, Value32);
  2977. /* Enable memory arbiter. */
  2978. REG_WR (pDevice, MemArbiter.Mode, T3_MEM_ARBITER_MODE_ENABLE);
  2979. #ifdef BIG_ENDIAN_PCI /* This from jfd */
  2980. Value32 = GRC_MODE_WORD_SWAP_DATA | GRC_MODE_WORD_SWAP_NON_FRAME_DATA;
  2981. #else
  2982. #ifdef BIG_ENDIAN_HOST
  2983. /* Reconfigure the mode register. */
  2984. Value32 = GRC_MODE_BYTE_SWAP_NON_FRAME_DATA |
  2985. GRC_MODE_WORD_SWAP_NON_FRAME_DATA |
  2986. GRC_MODE_BYTE_SWAP_DATA | GRC_MODE_WORD_SWAP_DATA;
  2987. #else
  2988. /* Reconfigure the mode register. */
  2989. Value32 = GRC_MODE_BYTE_SWAP_NON_FRAME_DATA | GRC_MODE_BYTE_SWAP_DATA;
  2990. #endif
  2991. #endif
  2992. REG_WR (pDevice, Grc.Mode, Value32);
  2993. /* Prevent PXE from restarting. */
  2994. MEM_WR_OFFSET (pDevice, 0x0b50, T3_MAGIC_NUM);
  2995. if (pDevice->EnableTbi) {
  2996. pDevice->MacMode = MAC_MODE_PORT_MODE_TBI;
  2997. REG_WR (pDevice, MacCtrl.Mode, MAC_MODE_PORT_MODE_TBI);
  2998. } else {
  2999. REG_WR (pDevice, MacCtrl.Mode, 0);
  3000. }
  3001. /* Wait for the firmware to finish initialization. */
  3002. for (j = 0; j < 100000; j++) {
  3003. MM_Wait (10);
  3004. Value32 = MEM_RD_OFFSET (pDevice, 0x0b50);
  3005. if (Value32 == ~T3_MAGIC_NUM) {
  3006. break;
  3007. }
  3008. }
  3009. return LM_STATUS_SUCCESS;
  3010. }
  3011. /******************************************************************************/
  3012. /* Description: */
  3013. /* */
  3014. /* Return: */
  3015. /******************************************************************************/
  3016. __inline static void LM_ServiceTxInterrupt (PLM_DEVICE_BLOCK pDevice)
  3017. {
  3018. PLM_PACKET pPacket;
  3019. LM_UINT32 HwConIdx;
  3020. LM_UINT32 SwConIdx;
  3021. HwConIdx = pDevice->pStatusBlkVirt->Idx[0].SendConIdx;
  3022. /* Get our copy of the consumer index. The buffer descriptors */
  3023. /* that are in between the consumer indices are freed. */
  3024. SwConIdx = pDevice->SendConIdx;
  3025. /* Move the packets from the TxPacketActiveQ that are sent out to */
  3026. /* the TxPacketXmittedQ. Packets that are sent use the */
  3027. /* descriptors that are between SwConIdx and HwConIdx. */
  3028. while (SwConIdx != HwConIdx) {
  3029. /* Get the packet that was sent from the TxPacketActiveQ. */
  3030. pPacket =
  3031. (PLM_PACKET) QQ_PopHead (&pDevice->TxPacketActiveQ.
  3032. Container);
  3033. /* Set the return status. */
  3034. pPacket->PacketStatus = LM_STATUS_SUCCESS;
  3035. /* Put the packet in the TxPacketXmittedQ for indication later. */
  3036. QQ_PushTail (&pDevice->TxPacketXmittedQ.Container, pPacket);
  3037. /* Move to the next packet's BD. */
  3038. SwConIdx = (SwConIdx + pPacket->u.Tx.FragCount) &
  3039. T3_SEND_RCB_ENTRY_COUNT_MASK;
  3040. /* Update the number of unused BDs. */
  3041. atomic_add (pPacket->u.Tx.FragCount, &pDevice->SendBdLeft);
  3042. /* Get the new updated HwConIdx. */
  3043. HwConIdx = pDevice->pStatusBlkVirt->Idx[0].SendConIdx;
  3044. } /* while */
  3045. /* Save the new SwConIdx. */
  3046. pDevice->SendConIdx = SwConIdx;
  3047. } /* LM_ServiceTxInterrupt */
  3048. /******************************************************************************/
  3049. /* Description: */
  3050. /* */
  3051. /* Return: */
  3052. /******************************************************************************/
  3053. __inline static void LM_ServiceRxInterrupt (PLM_DEVICE_BLOCK pDevice)
  3054. {
  3055. PLM_PACKET pPacket;
  3056. PT3_RCV_BD pRcvBd;
  3057. LM_UINT32 HwRcvRetProdIdx;
  3058. LM_UINT32 SwRcvRetConIdx;
  3059. /* Loop thru the receive return rings for received packets. */
  3060. HwRcvRetProdIdx = pDevice->pStatusBlkVirt->Idx[0].RcvProdIdx;
  3061. SwRcvRetConIdx = pDevice->RcvRetConIdx;
  3062. while (SwRcvRetConIdx != HwRcvRetProdIdx) {
  3063. pRcvBd = &pDevice->pRcvRetBdVirt[SwRcvRetConIdx];
  3064. /* Get the received packet descriptor. */
  3065. pPacket = (PLM_PACKET) (MM_UINT_PTR (pDevice->pPacketDescBase) +
  3066. MM_UINT_PTR (pRcvBd->Opaque));
  3067. /* Check the error flag. */
  3068. if (pRcvBd->ErrorFlag &&
  3069. pRcvBd->ErrorFlag != RCV_BD_ERR_ODD_NIBBLED_RCVD_MII) {
  3070. pPacket->PacketStatus = LM_STATUS_FAILURE;
  3071. pDevice->RxCounters.RxPacketErrCnt++;
  3072. if (pRcvBd->ErrorFlag & RCV_BD_ERR_BAD_CRC) {
  3073. pDevice->RxCounters.RxErrCrcCnt++;
  3074. }
  3075. if (pRcvBd->ErrorFlag & RCV_BD_ERR_COLL_DETECT) {
  3076. pDevice->RxCounters.RxErrCollCnt++;
  3077. }
  3078. if (pRcvBd->ErrorFlag & RCV_BD_ERR_LINK_LOST_DURING_PKT) {
  3079. pDevice->RxCounters.RxErrLinkLostCnt++;
  3080. }
  3081. if (pRcvBd->ErrorFlag & RCV_BD_ERR_PHY_DECODE_ERR) {
  3082. pDevice->RxCounters.RxErrPhyDecodeCnt++;
  3083. }
  3084. if (pRcvBd->ErrorFlag & RCV_BD_ERR_ODD_NIBBLED_RCVD_MII) {
  3085. pDevice->RxCounters.RxErrOddNibbleCnt++;
  3086. }
  3087. if (pRcvBd->ErrorFlag & RCV_BD_ERR_MAC_ABORT) {
  3088. pDevice->RxCounters.RxErrMacAbortCnt++;
  3089. }
  3090. if (pRcvBd->ErrorFlag & RCV_BD_ERR_LEN_LT_64) {
  3091. pDevice->RxCounters.RxErrShortPacketCnt++;
  3092. }
  3093. if (pRcvBd->ErrorFlag & RCV_BD_ERR_TRUNC_NO_RESOURCES) {
  3094. pDevice->RxCounters.RxErrNoResourceCnt++;
  3095. }
  3096. if (pRcvBd->ErrorFlag & RCV_BD_ERR_GIANT_FRAME_RCVD) {
  3097. pDevice->RxCounters.RxErrLargePacketCnt++;
  3098. }
  3099. } else {
  3100. pPacket->PacketStatus = LM_STATUS_SUCCESS;
  3101. pPacket->PacketSize = pRcvBd->Len - 4;
  3102. pPacket->Flags = pRcvBd->Flags;
  3103. if (pRcvBd->Flags & RCV_BD_FLAG_VLAN_TAG) {
  3104. pPacket->VlanTag = pRcvBd->VlanTag;
  3105. }
  3106. pPacket->u.Rx.TcpUdpChecksum = pRcvBd->TcpUdpCksum;
  3107. }
  3108. /* Put the packet descriptor containing the received packet */
  3109. /* buffer in the RxPacketReceivedQ for indication later. */
  3110. QQ_PushTail (&pDevice->RxPacketReceivedQ.Container, pPacket);
  3111. /* Go to the next buffer descriptor. */
  3112. SwRcvRetConIdx = (SwRcvRetConIdx + 1) &
  3113. T3_RCV_RETURN_RCB_ENTRY_COUNT_MASK;
  3114. /* Get the updated HwRcvRetProdIdx. */
  3115. HwRcvRetProdIdx = pDevice->pStatusBlkVirt->Idx[0].RcvProdIdx;
  3116. } /* while */
  3117. pDevice->RcvRetConIdx = SwRcvRetConIdx;
  3118. /* Update the receive return ring consumer index. */
  3119. MB_REG_WR (pDevice, Mailbox.RcvRetConIdx[0].Low, SwRcvRetConIdx);
  3120. } /* LM_ServiceRxInterrupt */
  3121. /******************************************************************************/
  3122. /* Description: */
  3123. /* This is the interrupt event handler routine. It acknowledges all */
  3124. /* pending interrupts and process all pending events. */
  3125. /* */
  3126. /* Return: */
  3127. /* LM_STATUS_SUCCESS */
  3128. /******************************************************************************/
  3129. LM_STATUS LM_ServiceInterrupts (PLM_DEVICE_BLOCK pDevice)
  3130. {
  3131. LM_UINT32 Value32;
  3132. int ServicePhyInt = FALSE;
  3133. /* Setup the phy chip whenever the link status changes. */
  3134. if (pDevice->LinkChngMode == T3_LINK_CHNG_MODE_USE_STATUS_REG) {
  3135. Value32 = REG_RD (pDevice, MacCtrl.Status);
  3136. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_MI_INTERRUPT) {
  3137. if (Value32 & MAC_STATUS_MI_INTERRUPT) {
  3138. ServicePhyInt = TRUE;
  3139. }
  3140. } else if (Value32 & MAC_STATUS_LINK_STATE_CHANGED) {
  3141. ServicePhyInt = TRUE;
  3142. }
  3143. } else {
  3144. if (pDevice->pStatusBlkVirt->
  3145. Status & STATUS_BLOCK_LINK_CHANGED_STATUS) {
  3146. pDevice->pStatusBlkVirt->Status =
  3147. STATUS_BLOCK_UPDATED | (pDevice->pStatusBlkVirt->
  3148. Status &
  3149. ~STATUS_BLOCK_LINK_CHANGED_STATUS);
  3150. ServicePhyInt = TRUE;
  3151. }
  3152. }
  3153. #if INCLUDE_TBI_SUPPORT
  3154. if (pDevice->IgnoreTbiLinkChange == TRUE) {
  3155. ServicePhyInt = FALSE;
  3156. }
  3157. #endif
  3158. if (ServicePhyInt == TRUE) {
  3159. LM_SetupPhy (pDevice);
  3160. }
  3161. /* Service receive and transmit interrupts. */
  3162. LM_ServiceRxInterrupt (pDevice);
  3163. LM_ServiceTxInterrupt (pDevice);
  3164. /* No spinlock for this queue since this routine is serialized. */
  3165. if (!QQ_Empty (&pDevice->RxPacketReceivedQ.Container)) {
  3166. /* Indicate receive packets. */
  3167. MM_IndicateRxPackets (pDevice);
  3168. /* LM_QueueRxPackets(pDevice); */
  3169. }
  3170. /* No spinlock for this queue since this routine is serialized. */
  3171. if (!QQ_Empty (&pDevice->TxPacketXmittedQ.Container)) {
  3172. MM_IndicateTxPackets (pDevice);
  3173. }
  3174. return LM_STATUS_SUCCESS;
  3175. } /* LM_ServiceInterrupts */
  3176. /******************************************************************************/
  3177. /* Description: */
  3178. /* */
  3179. /* Return: */
  3180. /******************************************************************************/
  3181. LM_STATUS LM_MulticastAdd (PLM_DEVICE_BLOCK pDevice, PLM_UINT8 pMcAddress)
  3182. {
  3183. PLM_UINT8 pEntry;
  3184. LM_UINT32 j;
  3185. pEntry = pDevice->McTable[0];
  3186. for (j = 0; j < pDevice->McEntryCount; j++) {
  3187. if (IS_ETH_ADDRESS_EQUAL (pEntry, pMcAddress)) {
  3188. /* Found a match, increment the instance count. */
  3189. pEntry[LM_MC_INSTANCE_COUNT_INDEX] += 1;
  3190. return LM_STATUS_SUCCESS;
  3191. }
  3192. pEntry += LM_MC_ENTRY_SIZE;
  3193. }
  3194. if (pDevice->McEntryCount >= LM_MAX_MC_TABLE_SIZE) {
  3195. return LM_STATUS_FAILURE;
  3196. }
  3197. pEntry = pDevice->McTable[pDevice->McEntryCount];
  3198. COPY_ETH_ADDRESS (pMcAddress, pEntry);
  3199. pEntry[LM_MC_INSTANCE_COUNT_INDEX] = 1;
  3200. pDevice->McEntryCount++;
  3201. LM_SetReceiveMask (pDevice, pDevice->ReceiveMask | LM_ACCEPT_MULTICAST);
  3202. return LM_STATUS_SUCCESS;
  3203. } /* LM_MulticastAdd */
  3204. /******************************************************************************/
  3205. /* Description: */
  3206. /* */
  3207. /* Return: */
  3208. /******************************************************************************/
  3209. LM_STATUS LM_MulticastDel (PLM_DEVICE_BLOCK pDevice, PLM_UINT8 pMcAddress)
  3210. {
  3211. PLM_UINT8 pEntry;
  3212. LM_UINT32 j;
  3213. pEntry = pDevice->McTable[0];
  3214. for (j = 0; j < pDevice->McEntryCount; j++) {
  3215. if (IS_ETH_ADDRESS_EQUAL (pEntry, pMcAddress)) {
  3216. /* Found a match, decrement the instance count. */
  3217. pEntry[LM_MC_INSTANCE_COUNT_INDEX] -= 1;
  3218. /* No more instance left, remove the address from the table. */
  3219. /* Move the last entry in the table to the delete slot. */
  3220. if (pEntry[LM_MC_INSTANCE_COUNT_INDEX] == 0 &&
  3221. pDevice->McEntryCount > 1) {
  3222. COPY_ETH_ADDRESS (pDevice->
  3223. McTable[pDevice->
  3224. McEntryCount - 1],
  3225. pEntry);
  3226. pEntry[LM_MC_INSTANCE_COUNT_INDEX] =
  3227. pDevice->McTable[pDevice->McEntryCount - 1]
  3228. [LM_MC_INSTANCE_COUNT_INDEX];
  3229. }
  3230. pDevice->McEntryCount--;
  3231. /* Update the receive mask if the table is empty. */
  3232. if (pDevice->McEntryCount == 0) {
  3233. LM_SetReceiveMask (pDevice,
  3234. pDevice->
  3235. ReceiveMask &
  3236. ~LM_ACCEPT_MULTICAST);
  3237. }
  3238. return LM_STATUS_SUCCESS;
  3239. }
  3240. pEntry += LM_MC_ENTRY_SIZE;
  3241. }
  3242. return LM_STATUS_FAILURE;
  3243. } /* LM_MulticastDel */
  3244. /******************************************************************************/
  3245. /* Description: */
  3246. /* */
  3247. /* Return: */
  3248. /******************************************************************************/
  3249. LM_STATUS LM_MulticastClear (PLM_DEVICE_BLOCK pDevice)
  3250. {
  3251. pDevice->McEntryCount = 0;
  3252. LM_SetReceiveMask (pDevice,
  3253. pDevice->ReceiveMask & ~LM_ACCEPT_MULTICAST);
  3254. return LM_STATUS_SUCCESS;
  3255. } /* LM_MulticastClear */
  3256. /******************************************************************************/
  3257. /* Description: */
  3258. /* */
  3259. /* Return: */
  3260. /******************************************************************************/
  3261. LM_STATUS LM_SetMacAddress (PLM_DEVICE_BLOCK pDevice)
  3262. {
  3263. LM_UINT32 j;
  3264. PLM_UINT8 pMacAddress = pDevice->NodeAddress;
  3265. for (j = 0; j < 4; j++) {
  3266. REG_WR (pDevice, MacCtrl.MacAddr[j].High,
  3267. (pMacAddress[0] << 8) | pMacAddress[1]);
  3268. REG_WR (pDevice, MacCtrl.MacAddr[j].Low,
  3269. (pMacAddress[2] << 24) | (pMacAddress[3] << 16) |
  3270. (pMacAddress[4] << 8) | pMacAddress[5]);
  3271. }
  3272. return LM_STATUS_SUCCESS;
  3273. }
  3274. /******************************************************************************/
  3275. /* Description: */
  3276. /* Sets up the default line speed, and duplex modes based on the requested */
  3277. /* media type. */
  3278. /* */
  3279. /* Return: */
  3280. /* None. */
  3281. /******************************************************************************/
  3282. static LM_STATUS
  3283. LM_TranslateRequestedMediaType (LM_REQUESTED_MEDIA_TYPE RequestedMediaType,
  3284. PLM_MEDIA_TYPE pMediaType,
  3285. PLM_LINE_SPEED pLineSpeed,
  3286. PLM_DUPLEX_MODE pDuplexMode)
  3287. {
  3288. *pMediaType = LM_MEDIA_TYPE_AUTO;
  3289. *pLineSpeed = LM_LINE_SPEED_UNKNOWN;
  3290. *pDuplexMode = LM_DUPLEX_MODE_UNKNOWN;
  3291. /* determine media type */
  3292. switch (RequestedMediaType) {
  3293. case LM_REQUESTED_MEDIA_TYPE_BNC:
  3294. *pMediaType = LM_MEDIA_TYPE_BNC;
  3295. *pLineSpeed = LM_LINE_SPEED_10MBPS;
  3296. *pDuplexMode = LM_DUPLEX_MODE_HALF;
  3297. break;
  3298. case LM_REQUESTED_MEDIA_TYPE_UTP_AUTO:
  3299. *pMediaType = LM_MEDIA_TYPE_UTP;
  3300. break;
  3301. case LM_REQUESTED_MEDIA_TYPE_UTP_10MBPS:
  3302. *pMediaType = LM_MEDIA_TYPE_UTP;
  3303. *pLineSpeed = LM_LINE_SPEED_10MBPS;
  3304. *pDuplexMode = LM_DUPLEX_MODE_HALF;
  3305. break;
  3306. case LM_REQUESTED_MEDIA_TYPE_UTP_10MBPS_FULL_DUPLEX:
  3307. *pMediaType = LM_MEDIA_TYPE_UTP;
  3308. *pLineSpeed = LM_LINE_SPEED_10MBPS;
  3309. *pDuplexMode = LM_DUPLEX_MODE_FULL;
  3310. break;
  3311. case LM_REQUESTED_MEDIA_TYPE_UTP_100MBPS:
  3312. *pMediaType = LM_MEDIA_TYPE_UTP;
  3313. *pLineSpeed = LM_LINE_SPEED_100MBPS;
  3314. *pDuplexMode = LM_DUPLEX_MODE_HALF;
  3315. break;
  3316. case LM_REQUESTED_MEDIA_TYPE_UTP_100MBPS_FULL_DUPLEX:
  3317. *pMediaType = LM_MEDIA_TYPE_UTP;
  3318. *pLineSpeed = LM_LINE_SPEED_100MBPS;
  3319. *pDuplexMode = LM_DUPLEX_MODE_FULL;
  3320. break;
  3321. case LM_REQUESTED_MEDIA_TYPE_UTP_1000MBPS:
  3322. *pMediaType = LM_MEDIA_TYPE_UTP;
  3323. *pLineSpeed = LM_LINE_SPEED_1000MBPS;
  3324. *pDuplexMode = LM_DUPLEX_MODE_HALF;
  3325. break;
  3326. case LM_REQUESTED_MEDIA_TYPE_UTP_1000MBPS_FULL_DUPLEX:
  3327. *pMediaType = LM_MEDIA_TYPE_UTP;
  3328. *pLineSpeed = LM_LINE_SPEED_1000MBPS;
  3329. *pDuplexMode = LM_DUPLEX_MODE_FULL;
  3330. break;
  3331. case LM_REQUESTED_MEDIA_TYPE_FIBER_100MBPS:
  3332. *pMediaType = LM_MEDIA_TYPE_FIBER;
  3333. *pLineSpeed = LM_LINE_SPEED_100MBPS;
  3334. *pDuplexMode = LM_DUPLEX_MODE_HALF;
  3335. break;
  3336. case LM_REQUESTED_MEDIA_TYPE_FIBER_100MBPS_FULL_DUPLEX:
  3337. *pMediaType = LM_MEDIA_TYPE_FIBER;
  3338. *pLineSpeed = LM_LINE_SPEED_100MBPS;
  3339. *pDuplexMode = LM_DUPLEX_MODE_FULL;
  3340. break;
  3341. case LM_REQUESTED_MEDIA_TYPE_FIBER_1000MBPS:
  3342. *pMediaType = LM_MEDIA_TYPE_FIBER;
  3343. *pLineSpeed = LM_LINE_SPEED_1000MBPS;
  3344. *pDuplexMode = LM_DUPLEX_MODE_HALF;
  3345. break;
  3346. case LM_REQUESTED_MEDIA_TYPE_FIBER_1000MBPS_FULL_DUPLEX:
  3347. *pMediaType = LM_MEDIA_TYPE_FIBER;
  3348. *pLineSpeed = LM_LINE_SPEED_1000MBPS;
  3349. *pDuplexMode = LM_DUPLEX_MODE_FULL;
  3350. break;
  3351. default:
  3352. break;
  3353. } /* switch */
  3354. return LM_STATUS_SUCCESS;
  3355. } /* LM_TranslateRequestedMediaType */
  3356. /******************************************************************************/
  3357. /* Description: */
  3358. /* */
  3359. /* Return: */
  3360. /* LM_STATUS_LINK_ACTIVE */
  3361. /* LM_STATUS_LINK_DOWN */
  3362. /******************************************************************************/
  3363. static LM_STATUS LM_InitBcm540xPhy (PLM_DEVICE_BLOCK pDevice)
  3364. {
  3365. LM_LINE_SPEED CurrentLineSpeed;
  3366. LM_DUPLEX_MODE CurrentDuplexMode;
  3367. LM_STATUS CurrentLinkStatus;
  3368. LM_UINT32 Value32;
  3369. LM_UINT32 j;
  3370. #if 1 /* jmb: bugfix -- moved here, out of code that sets initial pwr state */
  3371. LM_WritePhy (pDevice, BCM5401_AUX_CTRL, 0x2);
  3372. #endif
  3373. if ((pDevice->PhyId & PHY_ID_MASK) == PHY_BCM5401_PHY_ID) {
  3374. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  3375. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  3376. if (!pDevice->InitDone) {
  3377. Value32 = 0;
  3378. }
  3379. if (!(Value32 & PHY_STATUS_LINK_PASS)) {
  3380. LM_WritePhy (pDevice, BCM5401_AUX_CTRL, 0x0c20);
  3381. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x0012);
  3382. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x1804);
  3383. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x0013);
  3384. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x1204);
  3385. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
  3386. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x0132);
  3387. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
  3388. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x0232);
  3389. LM_WritePhy (pDevice, BCM540X_DSP_ADDRESS_REG, 0x201f);
  3390. LM_WritePhy (pDevice, BCM540X_DSP_RW_PORT, 0x0a20);
  3391. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  3392. for (j = 0; j < 1000; j++) {
  3393. MM_Wait (10);
  3394. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  3395. if (Value32 & PHY_STATUS_LINK_PASS) {
  3396. MM_Wait (40);
  3397. break;
  3398. }
  3399. }
  3400. if ((pDevice->PhyId & PHY_ID_REV_MASK) ==
  3401. PHY_BCM5401_B0_REV) {
  3402. if (!(Value32 & PHY_STATUS_LINK_PASS)
  3403. && (pDevice->OldLineSpeed ==
  3404. LM_LINE_SPEED_1000MBPS)) {
  3405. LM_WritePhy (pDevice, PHY_CTRL_REG,
  3406. PHY_CTRL_PHY_RESET);
  3407. for (j = 0; j < 100; j++) {
  3408. MM_Wait (10);
  3409. LM_ReadPhy (pDevice,
  3410. PHY_CTRL_REG,
  3411. &Value32);
  3412. if (!
  3413. (Value32 &
  3414. PHY_CTRL_PHY_RESET)) {
  3415. MM_Wait (40);
  3416. break;
  3417. }
  3418. }
  3419. LM_WritePhy (pDevice, BCM5401_AUX_CTRL,
  3420. 0x0c20);
  3421. LM_WritePhy (pDevice,
  3422. BCM540X_DSP_ADDRESS_REG,
  3423. 0x0012);
  3424. LM_WritePhy (pDevice,
  3425. BCM540X_DSP_RW_PORT,
  3426. 0x1804);
  3427. LM_WritePhy (pDevice,
  3428. BCM540X_DSP_ADDRESS_REG,
  3429. 0x0013);
  3430. LM_WritePhy (pDevice,
  3431. BCM540X_DSP_RW_PORT,
  3432. 0x1204);
  3433. LM_WritePhy (pDevice,
  3434. BCM540X_DSP_ADDRESS_REG,
  3435. 0x8006);
  3436. LM_WritePhy (pDevice,
  3437. BCM540X_DSP_RW_PORT,
  3438. 0x0132);
  3439. LM_WritePhy (pDevice,
  3440. BCM540X_DSP_ADDRESS_REG,
  3441. 0x8006);
  3442. LM_WritePhy (pDevice,
  3443. BCM540X_DSP_RW_PORT,
  3444. 0x0232);
  3445. LM_WritePhy (pDevice,
  3446. BCM540X_DSP_ADDRESS_REG,
  3447. 0x201f);
  3448. LM_WritePhy (pDevice,
  3449. BCM540X_DSP_RW_PORT,
  3450. 0x0a20);
  3451. }
  3452. }
  3453. }
  3454. } else if (pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
  3455. pDevice->ChipRevId == T3_CHIP_ID_5701_B0) {
  3456. /* Bug: 5701 A0, B0 TX CRC workaround. */
  3457. LM_WritePhy (pDevice, 0x15, 0x0a75);
  3458. LM_WritePhy (pDevice, 0x1c, 0x8c68);
  3459. LM_WritePhy (pDevice, 0x1c, 0x8d68);
  3460. LM_WritePhy (pDevice, 0x1c, 0x8c68);
  3461. }
  3462. /* Acknowledge interrupts. */
  3463. LM_ReadPhy (pDevice, BCM540X_INT_STATUS_REG, &Value32);
  3464. LM_ReadPhy (pDevice, BCM540X_INT_STATUS_REG, &Value32);
  3465. /* Configure the interrupt mask. */
  3466. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_MI_INTERRUPT) {
  3467. LM_WritePhy (pDevice, BCM540X_INT_MASK_REG,
  3468. ~BCM540X_INT_LINK_CHANGE);
  3469. }
  3470. /* Configure PHY led mode. */
  3471. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701 ||
  3472. (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700)) {
  3473. if (pDevice->LedMode == LED_MODE_THREE_LINK) {
  3474. LM_WritePhy (pDevice, BCM540X_EXT_CTRL_REG,
  3475. BCM540X_EXT_CTRL_LINK3_LED_MODE);
  3476. } else {
  3477. LM_WritePhy (pDevice, BCM540X_EXT_CTRL_REG, 0);
  3478. }
  3479. }
  3480. CurrentLinkStatus = LM_STATUS_LINK_DOWN;
  3481. /* Get current link and duplex mode. */
  3482. for (j = 0; j < 100; j++) {
  3483. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  3484. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  3485. if (Value32 & PHY_STATUS_LINK_PASS) {
  3486. break;
  3487. }
  3488. MM_Wait (40);
  3489. }
  3490. if (Value32 & PHY_STATUS_LINK_PASS) {
  3491. /* Determine the current line and duplex settings. */
  3492. LM_ReadPhy (pDevice, BCM540X_AUX_STATUS_REG, &Value32);
  3493. for (j = 0; j < 2000; j++) {
  3494. MM_Wait (10);
  3495. LM_ReadPhy (pDevice, BCM540X_AUX_STATUS_REG, &Value32);
  3496. if (Value32) {
  3497. break;
  3498. }
  3499. }
  3500. switch (Value32 & BCM540X_AUX_SPEED_MASK) {
  3501. case BCM540X_AUX_10BASET_HD:
  3502. CurrentLineSpeed = LM_LINE_SPEED_10MBPS;
  3503. CurrentDuplexMode = LM_DUPLEX_MODE_HALF;
  3504. break;
  3505. case BCM540X_AUX_10BASET_FD:
  3506. CurrentLineSpeed = LM_LINE_SPEED_10MBPS;
  3507. CurrentDuplexMode = LM_DUPLEX_MODE_FULL;
  3508. break;
  3509. case BCM540X_AUX_100BASETX_HD:
  3510. CurrentLineSpeed = LM_LINE_SPEED_100MBPS;
  3511. CurrentDuplexMode = LM_DUPLEX_MODE_HALF;
  3512. break;
  3513. case BCM540X_AUX_100BASETX_FD:
  3514. CurrentLineSpeed = LM_LINE_SPEED_100MBPS;
  3515. CurrentDuplexMode = LM_DUPLEX_MODE_FULL;
  3516. break;
  3517. case BCM540X_AUX_100BASET_HD:
  3518. CurrentLineSpeed = LM_LINE_SPEED_1000MBPS;
  3519. CurrentDuplexMode = LM_DUPLEX_MODE_HALF;
  3520. break;
  3521. case BCM540X_AUX_100BASET_FD:
  3522. CurrentLineSpeed = LM_LINE_SPEED_1000MBPS;
  3523. CurrentDuplexMode = LM_DUPLEX_MODE_FULL;
  3524. break;
  3525. default:
  3526. CurrentLineSpeed = LM_LINE_SPEED_UNKNOWN;
  3527. CurrentDuplexMode = LM_DUPLEX_MODE_UNKNOWN;
  3528. break;
  3529. }
  3530. /* Make sure we are in auto-neg mode. */
  3531. for (j = 0; j < 200; j++) {
  3532. LM_ReadPhy (pDevice, PHY_CTRL_REG, &Value32);
  3533. if (Value32 && Value32 != 0x7fff) {
  3534. break;
  3535. }
  3536. if (Value32 == 0 && pDevice->RequestedMediaType ==
  3537. LM_REQUESTED_MEDIA_TYPE_UTP_10MBPS) {
  3538. break;
  3539. }
  3540. MM_Wait (10);
  3541. }
  3542. /* Use the current line settings for "auto" mode. */
  3543. if (pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_AUTO
  3544. || pDevice->RequestedMediaType ==
  3545. LM_REQUESTED_MEDIA_TYPE_UTP_AUTO) {
  3546. if (Value32 & PHY_CTRL_AUTO_NEG_ENABLE) {
  3547. CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
  3548. /* We may be exiting low power mode and the link is in */
  3549. /* 10mb. In this case, we need to restart autoneg. */
  3550. LM_ReadPhy (pDevice, BCM540X_1000BASET_CTRL_REG,
  3551. &Value32);
  3552. pDevice->advertising1000 = Value32;
  3553. /* 5702FE supports 10/100Mb only. */
  3554. if (T3_ASIC_REV (pDevice->ChipRevId) !=
  3555. T3_ASIC_REV_5703
  3556. || pDevice->BondId !=
  3557. GRC_MISC_BD_ID_5702FE) {
  3558. if (!
  3559. (Value32 &
  3560. (BCM540X_AN_AD_1000BASET_HALF |
  3561. BCM540X_AN_AD_1000BASET_FULL))) {
  3562. CurrentLinkStatus =
  3563. LM_STATUS_LINK_SETTING_MISMATCH;
  3564. }
  3565. }
  3566. } else {
  3567. CurrentLinkStatus =
  3568. LM_STATUS_LINK_SETTING_MISMATCH;
  3569. }
  3570. } else {
  3571. /* Force line settings. */
  3572. /* Use the current setting if it matches the user's requested */
  3573. /* setting. */
  3574. LM_ReadPhy (pDevice, PHY_CTRL_REG, &Value32);
  3575. if ((pDevice->LineSpeed == CurrentLineSpeed) &&
  3576. (pDevice->DuplexMode == CurrentDuplexMode)) {
  3577. if ((pDevice->DisableAutoNeg &&
  3578. !(Value32 & PHY_CTRL_AUTO_NEG_ENABLE)) ||
  3579. (!pDevice->DisableAutoNeg &&
  3580. (Value32 & PHY_CTRL_AUTO_NEG_ENABLE))) {
  3581. CurrentLinkStatus =
  3582. LM_STATUS_LINK_ACTIVE;
  3583. } else {
  3584. CurrentLinkStatus =
  3585. LM_STATUS_LINK_SETTING_MISMATCH;
  3586. }
  3587. } else {
  3588. CurrentLinkStatus =
  3589. LM_STATUS_LINK_SETTING_MISMATCH;
  3590. }
  3591. }
  3592. /* Save line settings. */
  3593. pDevice->LineSpeed = CurrentLineSpeed;
  3594. pDevice->DuplexMode = CurrentDuplexMode;
  3595. pDevice->MediaType = LM_MEDIA_TYPE_UTP;
  3596. }
  3597. return CurrentLinkStatus;
  3598. } /* LM_InitBcm540xPhy */
  3599. /******************************************************************************/
  3600. /* Description: */
  3601. /* */
  3602. /* Return: */
  3603. /******************************************************************************/
  3604. LM_STATUS
  3605. LM_SetFlowControl (PLM_DEVICE_BLOCK pDevice,
  3606. LM_UINT32 LocalPhyAd, LM_UINT32 RemotePhyAd)
  3607. {
  3608. LM_FLOW_CONTROL FlowCap;
  3609. /* Resolve flow control. */
  3610. FlowCap = LM_FLOW_CONTROL_NONE;
  3611. /* See Table 28B-3 of 802.3ab-1999 spec. */
  3612. if (pDevice->FlowControlCap & LM_FLOW_CONTROL_AUTO_PAUSE) {
  3613. if (LocalPhyAd & PHY_AN_AD_PAUSE_CAPABLE) {
  3614. if (LocalPhyAd & PHY_AN_AD_ASYM_PAUSE) {
  3615. if (RemotePhyAd &
  3616. PHY_LINK_PARTNER_PAUSE_CAPABLE) {
  3617. FlowCap =
  3618. LM_FLOW_CONTROL_TRANSMIT_PAUSE |
  3619. LM_FLOW_CONTROL_RECEIVE_PAUSE;
  3620. } else if (RemotePhyAd &
  3621. PHY_LINK_PARTNER_ASYM_PAUSE) {
  3622. FlowCap = LM_FLOW_CONTROL_RECEIVE_PAUSE;
  3623. }
  3624. } else {
  3625. if (RemotePhyAd &
  3626. PHY_LINK_PARTNER_PAUSE_CAPABLE) {
  3627. FlowCap =
  3628. LM_FLOW_CONTROL_TRANSMIT_PAUSE |
  3629. LM_FLOW_CONTROL_RECEIVE_PAUSE;
  3630. }
  3631. }
  3632. } else if (LocalPhyAd & PHY_AN_AD_ASYM_PAUSE) {
  3633. if ((RemotePhyAd & PHY_LINK_PARTNER_PAUSE_CAPABLE) &&
  3634. (RemotePhyAd & PHY_LINK_PARTNER_ASYM_PAUSE)) {
  3635. FlowCap = LM_FLOW_CONTROL_TRANSMIT_PAUSE;
  3636. }
  3637. }
  3638. } else {
  3639. FlowCap = pDevice->FlowControlCap;
  3640. }
  3641. /* Enable/disable rx PAUSE. */
  3642. pDevice->RxMode &= ~RX_MODE_ENABLE_FLOW_CONTROL;
  3643. if (FlowCap & LM_FLOW_CONTROL_RECEIVE_PAUSE &&
  3644. (pDevice->FlowControlCap == LM_FLOW_CONTROL_AUTO_PAUSE ||
  3645. pDevice->FlowControlCap & LM_FLOW_CONTROL_RECEIVE_PAUSE)) {
  3646. pDevice->FlowControl |= LM_FLOW_CONTROL_RECEIVE_PAUSE;
  3647. pDevice->RxMode |= RX_MODE_ENABLE_FLOW_CONTROL;
  3648. }
  3649. REG_WR (pDevice, MacCtrl.RxMode, pDevice->RxMode);
  3650. /* Enable/disable tx PAUSE. */
  3651. pDevice->TxMode &= ~TX_MODE_ENABLE_FLOW_CONTROL;
  3652. if (FlowCap & LM_FLOW_CONTROL_TRANSMIT_PAUSE &&
  3653. (pDevice->FlowControlCap == LM_FLOW_CONTROL_AUTO_PAUSE ||
  3654. pDevice->FlowControlCap & LM_FLOW_CONTROL_TRANSMIT_PAUSE)) {
  3655. pDevice->FlowControl |= LM_FLOW_CONTROL_TRANSMIT_PAUSE;
  3656. pDevice->TxMode |= TX_MODE_ENABLE_FLOW_CONTROL;
  3657. }
  3658. REG_WR (pDevice, MacCtrl.TxMode, pDevice->TxMode);
  3659. return LM_STATUS_SUCCESS;
  3660. }
  3661. #if INCLUDE_TBI_SUPPORT
  3662. /******************************************************************************/
  3663. /* Description: */
  3664. /* */
  3665. /* Return: */
  3666. /******************************************************************************/
  3667. STATIC LM_STATUS LM_InitBcm800xPhy (PLM_DEVICE_BLOCK pDevice)
  3668. {
  3669. LM_UINT32 Value32;
  3670. LM_UINT32 j;
  3671. Value32 = REG_RD (pDevice, MacCtrl.Status);
  3672. /* Reset the SERDES during init and when we have link. */
  3673. if (!pDevice->InitDone || Value32 & MAC_STATUS_PCS_SYNCED) {
  3674. /* Set PLL lock range. */
  3675. LM_WritePhy (pDevice, 0x16, 0x8007);
  3676. /* Software reset. */
  3677. LM_WritePhy (pDevice, 0x00, 0x8000);
  3678. /* Wait for reset to complete. */
  3679. for (j = 0; j < 500; j++) {
  3680. MM_Wait (10);
  3681. }
  3682. /* Config mode; seletct PMA/Ch 1 regs. */
  3683. LM_WritePhy (pDevice, 0x10, 0x8411);
  3684. /* Enable auto-lock and comdet, select txclk for tx. */
  3685. LM_WritePhy (pDevice, 0x11, 0x0a10);
  3686. LM_WritePhy (pDevice, 0x18, 0x00a0);
  3687. LM_WritePhy (pDevice, 0x16, 0x41ff);
  3688. /* Assert and deassert POR. */
  3689. LM_WritePhy (pDevice, 0x13, 0x0400);
  3690. MM_Wait (40);
  3691. LM_WritePhy (pDevice, 0x13, 0x0000);
  3692. LM_WritePhy (pDevice, 0x11, 0x0a50);
  3693. MM_Wait (40);
  3694. LM_WritePhy (pDevice, 0x11, 0x0a10);
  3695. /* Delay for signal to stabilize. */
  3696. for (j = 0; j < 15000; j++) {
  3697. MM_Wait (10);
  3698. }
  3699. /* Deselect the channel register so we can read the PHY id later. */
  3700. LM_WritePhy (pDevice, 0x10, 0x8011);
  3701. }
  3702. return LM_STATUS_SUCCESS;
  3703. }
  3704. /******************************************************************************/
  3705. /* Description: */
  3706. /* */
  3707. /* Return: */
  3708. /******************************************************************************/
  3709. STATIC LM_STATUS LM_SetupFiberPhy (PLM_DEVICE_BLOCK pDevice)
  3710. {
  3711. LM_STATUS CurrentLinkStatus;
  3712. AUTONEG_STATUS AnStatus = 0;
  3713. LM_UINT32 Value32;
  3714. LM_UINT32 Cnt;
  3715. LM_UINT32 j, k;
  3716. pDevice->MacMode &= ~(MAC_MODE_HALF_DUPLEX | MAC_MODE_PORT_MODE_MASK);
  3717. /* Initialize the send_config register. */
  3718. REG_WR (pDevice, MacCtrl.TxAutoNeg, 0);
  3719. /* Enable TBI and full duplex mode. */
  3720. pDevice->MacMode |= MAC_MODE_PORT_MODE_TBI;
  3721. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode);
  3722. /* Initialize the BCM8002 SERDES PHY. */
  3723. switch (pDevice->PhyId & PHY_ID_MASK) {
  3724. case PHY_BCM8002_PHY_ID:
  3725. LM_InitBcm800xPhy (pDevice);
  3726. break;
  3727. default:
  3728. break;
  3729. }
  3730. /* Enable link change interrupt. */
  3731. REG_WR (pDevice, MacCtrl.MacEvent,
  3732. MAC_EVENT_ENABLE_LINK_STATE_CHANGED_ATTN);
  3733. /* Default to link down. */
  3734. CurrentLinkStatus = LM_STATUS_LINK_DOWN;
  3735. /* Get the link status. */
  3736. Value32 = REG_RD (pDevice, MacCtrl.Status);
  3737. if (Value32 & MAC_STATUS_PCS_SYNCED) {
  3738. if ((pDevice->RequestedMediaType ==
  3739. LM_REQUESTED_MEDIA_TYPE_AUTO)
  3740. || (pDevice->DisableAutoNeg == FALSE)) {
  3741. /* auto-negotiation mode. */
  3742. /* Initialize the autoneg default capaiblities. */
  3743. AutonegInit (&pDevice->AnInfo);
  3744. /* Set the context pointer to point to the main device structure. */
  3745. pDevice->AnInfo.pContext = pDevice;
  3746. /* Setup flow control advertisement register. */
  3747. Value32 = GetPhyAdFlowCntrlSettings (pDevice);
  3748. if (Value32 & PHY_AN_AD_PAUSE_CAPABLE) {
  3749. pDevice->AnInfo.mr_adv_sym_pause = 1;
  3750. } else {
  3751. pDevice->AnInfo.mr_adv_sym_pause = 0;
  3752. }
  3753. if (Value32 & PHY_AN_AD_ASYM_PAUSE) {
  3754. pDevice->AnInfo.mr_adv_asym_pause = 1;
  3755. } else {
  3756. pDevice->AnInfo.mr_adv_asym_pause = 0;
  3757. }
  3758. /* Try to autoneg up to six times. */
  3759. if (pDevice->IgnoreTbiLinkChange) {
  3760. Cnt = 1;
  3761. } else {
  3762. Cnt = 6;
  3763. }
  3764. for (j = 0; j < Cnt; j++) {
  3765. REG_WR (pDevice, MacCtrl.TxAutoNeg, 0);
  3766. Value32 =
  3767. pDevice->MacMode & ~MAC_MODE_PORT_MODE_MASK;
  3768. REG_WR (pDevice, MacCtrl.Mode, Value32);
  3769. MM_Wait (20);
  3770. REG_WR (pDevice, MacCtrl.Mode,
  3771. pDevice->
  3772. MacMode | MAC_MODE_SEND_CONFIGS);
  3773. MM_Wait (20);
  3774. pDevice->AnInfo.State = AN_STATE_UNKNOWN;
  3775. pDevice->AnInfo.CurrentTime_us = 0;
  3776. REG_WR (pDevice, Grc.Timer, 0);
  3777. for (k = 0;
  3778. (pDevice->AnInfo.CurrentTime_us < 75000)
  3779. && (k < 75000); k++) {
  3780. AnStatus =
  3781. Autoneg8023z (&pDevice->AnInfo);
  3782. if ((AnStatus == AUTONEG_STATUS_DONE) ||
  3783. (AnStatus == AUTONEG_STATUS_FAILED))
  3784. {
  3785. break;
  3786. }
  3787. pDevice->AnInfo.CurrentTime_us =
  3788. REG_RD (pDevice, Grc.Timer);
  3789. }
  3790. if ((AnStatus == AUTONEG_STATUS_DONE) ||
  3791. (AnStatus == AUTONEG_STATUS_FAILED)) {
  3792. break;
  3793. }
  3794. if (j >= 1) {
  3795. if (!(REG_RD (pDevice, MacCtrl.Status) &
  3796. MAC_STATUS_PCS_SYNCED)) {
  3797. break;
  3798. }
  3799. }
  3800. }
  3801. /* Stop sending configs. */
  3802. MM_AnTxIdle (&pDevice->AnInfo);
  3803. /* Resolve flow control settings. */
  3804. if ((AnStatus == AUTONEG_STATUS_DONE) &&
  3805. pDevice->AnInfo.mr_an_complete
  3806. && pDevice->AnInfo.mr_link_ok
  3807. && pDevice->AnInfo.mr_lp_adv_full_duplex) {
  3808. LM_UINT32 RemotePhyAd;
  3809. LM_UINT32 LocalPhyAd;
  3810. LocalPhyAd = 0;
  3811. if (pDevice->AnInfo.mr_adv_sym_pause) {
  3812. LocalPhyAd |= PHY_AN_AD_PAUSE_CAPABLE;
  3813. }
  3814. if (pDevice->AnInfo.mr_adv_asym_pause) {
  3815. LocalPhyAd |= PHY_AN_AD_ASYM_PAUSE;
  3816. }
  3817. RemotePhyAd = 0;
  3818. if (pDevice->AnInfo.mr_lp_adv_sym_pause) {
  3819. RemotePhyAd |=
  3820. PHY_LINK_PARTNER_PAUSE_CAPABLE;
  3821. }
  3822. if (pDevice->AnInfo.mr_lp_adv_asym_pause) {
  3823. RemotePhyAd |=
  3824. PHY_LINK_PARTNER_ASYM_PAUSE;
  3825. }
  3826. LM_SetFlowControl (pDevice, LocalPhyAd,
  3827. RemotePhyAd);
  3828. CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
  3829. }
  3830. for (j = 0; j < 30; j++) {
  3831. MM_Wait (20);
  3832. REG_WR (pDevice, MacCtrl.Status,
  3833. MAC_STATUS_SYNC_CHANGED |
  3834. MAC_STATUS_CFG_CHANGED);
  3835. MM_Wait (20);
  3836. if ((REG_RD (pDevice, MacCtrl.Status) &
  3837. (MAC_STATUS_SYNC_CHANGED |
  3838. MAC_STATUS_CFG_CHANGED)) == 0)
  3839. break;
  3840. }
  3841. if (pDevice->PollTbiLink) {
  3842. Value32 = REG_RD (pDevice, MacCtrl.Status);
  3843. if (Value32 & MAC_STATUS_RECEIVING_CFG) {
  3844. pDevice->IgnoreTbiLinkChange = TRUE;
  3845. } else {
  3846. pDevice->IgnoreTbiLinkChange = FALSE;
  3847. }
  3848. }
  3849. Value32 = REG_RD (pDevice, MacCtrl.Status);
  3850. if (CurrentLinkStatus == LM_STATUS_LINK_DOWN &&
  3851. (Value32 & MAC_STATUS_PCS_SYNCED) &&
  3852. ((Value32 & MAC_STATUS_RECEIVING_CFG) == 0)) {
  3853. CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
  3854. }
  3855. } else {
  3856. /* We are forcing line speed. */
  3857. pDevice->FlowControlCap &= ~LM_FLOW_CONTROL_AUTO_PAUSE;
  3858. LM_SetFlowControl (pDevice, 0, 0);
  3859. CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
  3860. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode |
  3861. MAC_MODE_SEND_CONFIGS);
  3862. }
  3863. }
  3864. /* Set the link polarity bit. */
  3865. pDevice->MacMode &= ~MAC_MODE_LINK_POLARITY;
  3866. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode);
  3867. pDevice->pStatusBlkVirt->Status = STATUS_BLOCK_UPDATED |
  3868. (pDevice->pStatusBlkVirt->
  3869. Status & ~STATUS_BLOCK_LINK_CHANGED_STATUS);
  3870. for (j = 0; j < 100; j++) {
  3871. REG_WR (pDevice, MacCtrl.Status, MAC_STATUS_SYNC_CHANGED |
  3872. MAC_STATUS_CFG_CHANGED);
  3873. MM_Wait (5);
  3874. if ((REG_RD (pDevice, MacCtrl.Status) &
  3875. (MAC_STATUS_SYNC_CHANGED | MAC_STATUS_CFG_CHANGED)) == 0)
  3876. break;
  3877. }
  3878. Value32 = REG_RD (pDevice, MacCtrl.Status);
  3879. if ((Value32 & MAC_STATUS_PCS_SYNCED) == 0) {
  3880. CurrentLinkStatus = LM_STATUS_LINK_DOWN;
  3881. if (pDevice->DisableAutoNeg == FALSE) {
  3882. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode |
  3883. MAC_MODE_SEND_CONFIGS);
  3884. MM_Wait (1);
  3885. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode);
  3886. }
  3887. }
  3888. /* Initialize the current link status. */
  3889. if (CurrentLinkStatus == LM_STATUS_LINK_ACTIVE) {
  3890. pDevice->LineSpeed = LM_LINE_SPEED_1000MBPS;
  3891. pDevice->DuplexMode = LM_DUPLEX_MODE_FULL;
  3892. REG_WR (pDevice, MacCtrl.LedCtrl, LED_CTRL_OVERRIDE_LINK_LED |
  3893. LED_CTRL_1000MBPS_LED_ON);
  3894. } else {
  3895. pDevice->LineSpeed = LM_LINE_SPEED_UNKNOWN;
  3896. pDevice->DuplexMode = LM_DUPLEX_MODE_UNKNOWN;
  3897. REG_WR (pDevice, MacCtrl.LedCtrl, LED_CTRL_OVERRIDE_LINK_LED |
  3898. LED_CTRL_OVERRIDE_TRAFFIC_LED);
  3899. }
  3900. /* Indicate link status. */
  3901. if (pDevice->LinkStatus != CurrentLinkStatus) {
  3902. pDevice->LinkStatus = CurrentLinkStatus;
  3903. MM_IndicateStatus (pDevice, CurrentLinkStatus);
  3904. }
  3905. return LM_STATUS_SUCCESS;
  3906. }
  3907. #endif /* INCLUDE_TBI_SUPPORT */
  3908. /******************************************************************************/
  3909. /* Description: */
  3910. /* */
  3911. /* Return: */
  3912. /******************************************************************************/
  3913. LM_STATUS LM_SetupCopperPhy (PLM_DEVICE_BLOCK pDevice)
  3914. {
  3915. LM_STATUS CurrentLinkStatus;
  3916. LM_UINT32 Value32;
  3917. /* Assume there is not link first. */
  3918. CurrentLinkStatus = LM_STATUS_LINK_DOWN;
  3919. /* Disable phy link change attention. */
  3920. REG_WR (pDevice, MacCtrl.MacEvent, 0);
  3921. /* Clear link change attention. */
  3922. REG_WR (pDevice, MacCtrl.Status, MAC_STATUS_SYNC_CHANGED |
  3923. MAC_STATUS_CFG_CHANGED);
  3924. /* Disable auto-polling for the moment. */
  3925. pDevice->MiMode = 0xc0000;
  3926. REG_WR (pDevice, MacCtrl.MiMode, pDevice->MiMode);
  3927. MM_Wait (40);
  3928. /* Determine the requested line speed and duplex. */
  3929. pDevice->OldLineSpeed = pDevice->LineSpeed;
  3930. LM_TranslateRequestedMediaType (pDevice->RequestedMediaType,
  3931. &pDevice->MediaType,
  3932. &pDevice->LineSpeed,
  3933. &pDevice->DuplexMode);
  3934. /* Initialize the phy chip. */
  3935. switch (pDevice->PhyId & PHY_ID_MASK) {
  3936. case PHY_BCM5400_PHY_ID:
  3937. case PHY_BCM5401_PHY_ID:
  3938. case PHY_BCM5411_PHY_ID:
  3939. case PHY_BCM5701_PHY_ID:
  3940. case PHY_BCM5703_PHY_ID:
  3941. case PHY_BCM5704_PHY_ID:
  3942. CurrentLinkStatus = LM_InitBcm540xPhy (pDevice);
  3943. break;
  3944. default:
  3945. break;
  3946. }
  3947. if (CurrentLinkStatus == LM_STATUS_LINK_SETTING_MISMATCH) {
  3948. CurrentLinkStatus = LM_STATUS_LINK_DOWN;
  3949. }
  3950. /* Setup flow control. */
  3951. pDevice->FlowControl = LM_FLOW_CONTROL_NONE;
  3952. if (CurrentLinkStatus == LM_STATUS_LINK_ACTIVE) {
  3953. LM_FLOW_CONTROL FlowCap; /* Flow control capability. */
  3954. FlowCap = LM_FLOW_CONTROL_NONE;
  3955. if (pDevice->DuplexMode == LM_DUPLEX_MODE_FULL) {
  3956. if (pDevice->DisableAutoNeg == FALSE ||
  3957. pDevice->RequestedMediaType ==
  3958. LM_REQUESTED_MEDIA_TYPE_AUTO
  3959. || pDevice->RequestedMediaType ==
  3960. LM_REQUESTED_MEDIA_TYPE_UTP_AUTO) {
  3961. LM_UINT32 ExpectedPhyAd;
  3962. LM_UINT32 LocalPhyAd;
  3963. LM_UINT32 RemotePhyAd;
  3964. LM_ReadPhy (pDevice, PHY_AN_AD_REG,
  3965. &LocalPhyAd);
  3966. pDevice->advertising = LocalPhyAd;
  3967. LocalPhyAd &=
  3968. (PHY_AN_AD_ASYM_PAUSE |
  3969. PHY_AN_AD_PAUSE_CAPABLE);
  3970. ExpectedPhyAd =
  3971. GetPhyAdFlowCntrlSettings (pDevice);
  3972. if (LocalPhyAd != ExpectedPhyAd) {
  3973. CurrentLinkStatus = LM_STATUS_LINK_DOWN;
  3974. } else {
  3975. LM_ReadPhy (pDevice,
  3976. PHY_LINK_PARTNER_ABILITY_REG,
  3977. &RemotePhyAd);
  3978. LM_SetFlowControl (pDevice, LocalPhyAd,
  3979. RemotePhyAd);
  3980. }
  3981. } else {
  3982. pDevice->FlowControlCap &=
  3983. ~LM_FLOW_CONTROL_AUTO_PAUSE;
  3984. LM_SetFlowControl (pDevice, 0, 0);
  3985. }
  3986. }
  3987. }
  3988. if (CurrentLinkStatus == LM_STATUS_LINK_DOWN) {
  3989. LM_ForceAutoNeg (pDevice, pDevice->RequestedMediaType);
  3990. /* If we force line speed, we make get link right away. */
  3991. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  3992. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  3993. if (Value32 & PHY_STATUS_LINK_PASS) {
  3994. CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
  3995. }
  3996. }
  3997. /* GMII interface. */
  3998. pDevice->MacMode &= ~MAC_MODE_PORT_MODE_MASK;
  3999. if (CurrentLinkStatus == LM_STATUS_LINK_ACTIVE) {
  4000. if (pDevice->LineSpeed == LM_LINE_SPEED_100MBPS ||
  4001. pDevice->LineSpeed == LM_LINE_SPEED_10MBPS) {
  4002. pDevice->MacMode |= MAC_MODE_PORT_MODE_MII;
  4003. } else {
  4004. pDevice->MacMode |= MAC_MODE_PORT_MODE_GMII;
  4005. }
  4006. } else {
  4007. pDevice->MacMode |= MAC_MODE_PORT_MODE_GMII;
  4008. }
  4009. /* Set the MAC to operate in the appropriate duplex mode. */
  4010. pDevice->MacMode &= ~MAC_MODE_HALF_DUPLEX;
  4011. if (pDevice->DuplexMode == LM_DUPLEX_MODE_HALF) {
  4012. pDevice->MacMode |= MAC_MODE_HALF_DUPLEX;
  4013. }
  4014. /* Set the link polarity bit. */
  4015. pDevice->MacMode &= ~MAC_MODE_LINK_POLARITY;
  4016. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  4017. if ((pDevice->LedMode == LED_MODE_LINK10) ||
  4018. (CurrentLinkStatus == LM_STATUS_LINK_ACTIVE &&
  4019. pDevice->LineSpeed == LM_LINE_SPEED_10MBPS)) {
  4020. pDevice->MacMode |= MAC_MODE_LINK_POLARITY;
  4021. }
  4022. } else {
  4023. if (CurrentLinkStatus == LM_STATUS_LINK_ACTIVE) {
  4024. pDevice->MacMode |= MAC_MODE_LINK_POLARITY;
  4025. }
  4026. /* Set LED mode. */
  4027. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  4028. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  4029. Value32 = LED_CTRL_PHY_MODE_1;
  4030. } else {
  4031. if (pDevice->LedMode == LED_MODE_OUTPUT) {
  4032. Value32 = LED_CTRL_PHY_MODE_2;
  4033. } else {
  4034. Value32 = LED_CTRL_PHY_MODE_1;
  4035. }
  4036. }
  4037. REG_WR (pDevice, MacCtrl.LedCtrl, Value32);
  4038. }
  4039. REG_WR (pDevice, MacCtrl.Mode, pDevice->MacMode);
  4040. /* Enable auto polling. */
  4041. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING) {
  4042. pDevice->MiMode |= MI_MODE_AUTO_POLLING_ENABLE;
  4043. REG_WR (pDevice, MacCtrl.MiMode, pDevice->MiMode);
  4044. }
  4045. /* Enable phy link change attention. */
  4046. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_MI_INTERRUPT) {
  4047. REG_WR (pDevice, MacCtrl.MacEvent,
  4048. MAC_EVENT_ENABLE_MI_INTERRUPT);
  4049. } else {
  4050. REG_WR (pDevice, MacCtrl.MacEvent,
  4051. MAC_EVENT_ENABLE_LINK_STATE_CHANGED_ATTN);
  4052. }
  4053. if ((T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) &&
  4054. (CurrentLinkStatus == LM_STATUS_LINK_ACTIVE) &&
  4055. (pDevice->LineSpeed == LM_LINE_SPEED_1000MBPS) &&
  4056. (((pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE) &&
  4057. (pDevice->PciState & T3_PCI_STATE_BUS_SPEED_HIGH)) ||
  4058. !(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE))) {
  4059. MM_Wait (120);
  4060. REG_WR (pDevice, MacCtrl.Status, MAC_STATUS_SYNC_CHANGED |
  4061. MAC_STATUS_CFG_CHANGED);
  4062. MEM_WR_OFFSET (pDevice, T3_FIRMWARE_MAILBOX,
  4063. T3_MAGIC_NUM_DISABLE_DMAW_ON_LINK_CHANGE);
  4064. }
  4065. /* Indicate link status. */
  4066. if (pDevice->LinkStatus != CurrentLinkStatus) {
  4067. pDevice->LinkStatus = CurrentLinkStatus;
  4068. MM_IndicateStatus (pDevice, CurrentLinkStatus);
  4069. }
  4070. return LM_STATUS_SUCCESS;
  4071. } /* LM_SetupCopperPhy */
  4072. /******************************************************************************/
  4073. /* Description: */
  4074. /* */
  4075. /* Return: */
  4076. /******************************************************************************/
  4077. LM_STATUS LM_SetupPhy (PLM_DEVICE_BLOCK pDevice)
  4078. {
  4079. LM_STATUS LmStatus;
  4080. LM_UINT32 Value32;
  4081. #if INCLUDE_TBI_SUPPORT
  4082. if (pDevice->EnableTbi) {
  4083. LmStatus = LM_SetupFiberPhy (pDevice);
  4084. } else
  4085. #endif /* INCLUDE_TBI_SUPPORT */
  4086. {
  4087. LmStatus = LM_SetupCopperPhy (pDevice);
  4088. }
  4089. if (pDevice->ChipRevId == T3_CHIP_ID_5704_A0) {
  4090. if (!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE)) {
  4091. Value32 = REG_RD (pDevice, PciCfg.PciState);
  4092. REG_WR (pDevice, PciCfg.PciState,
  4093. Value32 | T3_PCI_STATE_RETRY_SAME_DMA);
  4094. }
  4095. }
  4096. if ((pDevice->LineSpeed == LM_LINE_SPEED_1000MBPS) &&
  4097. (pDevice->DuplexMode == LM_DUPLEX_MODE_HALF)) {
  4098. REG_WR (pDevice, MacCtrl.TxLengths, 0x26ff);
  4099. } else {
  4100. REG_WR (pDevice, MacCtrl.TxLengths, 0x2620);
  4101. }
  4102. return LmStatus;
  4103. }
  4104. /******************************************************************************/
  4105. /* Description: */
  4106. /* */
  4107. /* Return: */
  4108. /******************************************************************************/
  4109. LM_VOID
  4110. LM_ReadPhy (PLM_DEVICE_BLOCK pDevice, LM_UINT32 PhyReg, PLM_UINT32 pData32)
  4111. {
  4112. LM_UINT32 Value32;
  4113. LM_UINT32 j;
  4114. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING) {
  4115. REG_WR (pDevice, MacCtrl.MiMode, pDevice->MiMode &
  4116. ~MI_MODE_AUTO_POLLING_ENABLE);
  4117. MM_Wait (40);
  4118. }
  4119. Value32 = (pDevice->PhyAddr << MI_COM_FIRST_PHY_ADDR_BIT) |
  4120. ((PhyReg & MI_COM_PHY_REG_ADDR_MASK) <<
  4121. MI_COM_FIRST_PHY_REG_ADDR_BIT) | MI_COM_CMD_READ | MI_COM_START;
  4122. REG_WR (pDevice, MacCtrl.MiCom, Value32);
  4123. for (j = 0; j < 20; j++) {
  4124. MM_Wait (25);
  4125. Value32 = REG_RD (pDevice, MacCtrl.MiCom);
  4126. if (!(Value32 & MI_COM_BUSY)) {
  4127. MM_Wait (5);
  4128. Value32 = REG_RD (pDevice, MacCtrl.MiCom);
  4129. Value32 &= MI_COM_PHY_DATA_MASK;
  4130. break;
  4131. }
  4132. }
  4133. if (Value32 & MI_COM_BUSY) {
  4134. Value32 = 0;
  4135. }
  4136. *pData32 = Value32;
  4137. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING) {
  4138. REG_WR (pDevice, MacCtrl.MiMode, pDevice->MiMode);
  4139. MM_Wait (40);
  4140. }
  4141. } /* LM_ReadPhy */
  4142. /******************************************************************************/
  4143. /* Description: */
  4144. /* */
  4145. /* Return: */
  4146. /******************************************************************************/
  4147. LM_VOID
  4148. LM_WritePhy (PLM_DEVICE_BLOCK pDevice, LM_UINT32 PhyReg, LM_UINT32 Data32)
  4149. {
  4150. LM_UINT32 Value32;
  4151. LM_UINT32 j;
  4152. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING) {
  4153. REG_WR (pDevice, MacCtrl.MiMode, pDevice->MiMode &
  4154. ~MI_MODE_AUTO_POLLING_ENABLE);
  4155. MM_Wait (40);
  4156. }
  4157. Value32 = (pDevice->PhyAddr << MI_COM_FIRST_PHY_ADDR_BIT) |
  4158. ((PhyReg & MI_COM_PHY_REG_ADDR_MASK) <<
  4159. MI_COM_FIRST_PHY_REG_ADDR_BIT) | (Data32 & MI_COM_PHY_DATA_MASK) |
  4160. MI_COM_CMD_WRITE | MI_COM_START;
  4161. REG_WR (pDevice, MacCtrl.MiCom, Value32);
  4162. for (j = 0; j < 20; j++) {
  4163. MM_Wait (25);
  4164. Value32 = REG_RD (pDevice, MacCtrl.MiCom);
  4165. if (!(Value32 & MI_COM_BUSY)) {
  4166. MM_Wait (5);
  4167. break;
  4168. }
  4169. }
  4170. if (pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING) {
  4171. REG_WR (pDevice, MacCtrl.MiMode, pDevice->MiMode);
  4172. MM_Wait (40);
  4173. }
  4174. } /* LM_WritePhy */
  4175. /******************************************************************************/
  4176. /* Description: */
  4177. /* */
  4178. /* Return: */
  4179. /******************************************************************************/
  4180. LM_STATUS LM_SetPowerState (PLM_DEVICE_BLOCK pDevice, LM_POWER_STATE PowerLevel)
  4181. {
  4182. LM_UINT32 PmeSupport;
  4183. LM_UINT32 Value32;
  4184. LM_UINT32 PmCtrl;
  4185. /* make sureindirect accesses are enabled */
  4186. MM_WriteConfig32 (pDevice, T3_PCI_MISC_HOST_CTRL_REG,
  4187. pDevice->MiscHostCtrl);
  4188. /* Clear the PME_ASSERT bit and the power state bits. Also enable */
  4189. /* the PME bit. */
  4190. MM_ReadConfig32 (pDevice, T3_PCI_PM_STATUS_CTRL_REG, &PmCtrl);
  4191. PmCtrl |= T3_PM_PME_ASSERTED;
  4192. PmCtrl &= ~T3_PM_POWER_STATE_MASK;
  4193. /* Set the appropriate power state. */
  4194. if (PowerLevel == LM_POWER_STATE_D0) {
  4195. /* Bring the card out of low power mode. */
  4196. PmCtrl |= T3_PM_POWER_STATE_D0;
  4197. MM_WriteConfig32 (pDevice, T3_PCI_PM_STATUS_CTRL_REG, PmCtrl);
  4198. REG_WR (pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl);
  4199. MM_Wait (40);
  4200. #if 0 /* Bugfix by jmb...can't call WritePhy here because pDevice not fully initialized */
  4201. LM_WritePhy (pDevice, BCM5401_AUX_CTRL, 0x02);
  4202. #endif
  4203. return LM_STATUS_SUCCESS;
  4204. } else if (PowerLevel == LM_POWER_STATE_D1) {
  4205. PmCtrl |= T3_PM_POWER_STATE_D1;
  4206. } else if (PowerLevel == LM_POWER_STATE_D2) {
  4207. PmCtrl |= T3_PM_POWER_STATE_D2;
  4208. } else if (PowerLevel == LM_POWER_STATE_D3) {
  4209. PmCtrl |= T3_PM_POWER_STATE_D3;
  4210. } else {
  4211. return LM_STATUS_FAILURE;
  4212. }
  4213. PmCtrl |= T3_PM_PME_ENABLE;
  4214. /* Mask out all interrupts so LM_SetupPhy won't be called while we are */
  4215. /* setting new line speed. */
  4216. Value32 = REG_RD (pDevice, PciCfg.MiscHostCtrl);
  4217. REG_WR (pDevice, PciCfg.MiscHostCtrl,
  4218. Value32 | MISC_HOST_CTRL_MASK_PCI_INT);
  4219. if (!pDevice->RestoreOnWakeUp) {
  4220. pDevice->RestoreOnWakeUp = TRUE;
  4221. pDevice->WakeUpDisableAutoNeg = pDevice->DisableAutoNeg;
  4222. pDevice->WakeUpRequestedMediaType = pDevice->RequestedMediaType;
  4223. }
  4224. /* Force auto-negotiation to 10 line speed. */
  4225. pDevice->DisableAutoNeg = FALSE;
  4226. pDevice->RequestedMediaType = LM_REQUESTED_MEDIA_TYPE_UTP_10MBPS;
  4227. LM_SetupPhy (pDevice);
  4228. /* Put the driver in the initial state, and go through the power down */
  4229. /* sequence. */
  4230. LM_Halt (pDevice);
  4231. MM_ReadConfig32 (pDevice, T3_PCI_PM_CAP_REG, &PmeSupport);
  4232. if (pDevice->WakeUpModeCap != LM_WAKE_UP_MODE_NONE) {
  4233. /* Enable WOL. */
  4234. LM_WritePhy (pDevice, BCM5401_AUX_CTRL, 0x5a);
  4235. MM_Wait (40);
  4236. /* Set LED mode. */
  4237. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  4238. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  4239. Value32 = LED_CTRL_PHY_MODE_1;
  4240. } else {
  4241. if (pDevice->LedMode == LED_MODE_OUTPUT) {
  4242. Value32 = LED_CTRL_PHY_MODE_2;
  4243. } else {
  4244. Value32 = LED_CTRL_PHY_MODE_1;
  4245. }
  4246. }
  4247. Value32 = MAC_MODE_PORT_MODE_MII;
  4248. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700) {
  4249. if (pDevice->LedMode == LED_MODE_LINK10 ||
  4250. pDevice->WolSpeed == WOL_SPEED_10MB) {
  4251. Value32 |= MAC_MODE_LINK_POLARITY;
  4252. }
  4253. } else {
  4254. Value32 |= MAC_MODE_LINK_POLARITY;
  4255. }
  4256. REG_WR (pDevice, MacCtrl.Mode, Value32);
  4257. MM_Wait (40);
  4258. MM_Wait (40);
  4259. MM_Wait (40);
  4260. /* Always enable magic packet wake-up if we have vaux. */
  4261. if ((PmeSupport & T3_PCI_PM_CAP_PME_D3COLD) &&
  4262. (pDevice->WakeUpModeCap & LM_WAKE_UP_MODE_MAGIC_PACKET)) {
  4263. Value32 |= MAC_MODE_DETECT_MAGIC_PACKET_ENABLE;
  4264. }
  4265. REG_WR (pDevice, MacCtrl.Mode, Value32);
  4266. /* Enable the receiver. */
  4267. REG_WR (pDevice, MacCtrl.RxMode, RX_MODE_ENABLE);
  4268. }
  4269. /* Disable tx/rx clocks, and seletect an alternate clock. */
  4270. if (pDevice->WolSpeed == WOL_SPEED_100MB) {
  4271. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  4272. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  4273. Value32 =
  4274. T3_PCI_DISABLE_RX_CLOCK | T3_PCI_DISABLE_TX_CLOCK |
  4275. T3_PCI_SELECT_ALTERNATE_CLOCK;
  4276. } else {
  4277. Value32 = T3_PCI_SELECT_ALTERNATE_CLOCK;
  4278. }
  4279. REG_WR (pDevice, PciCfg.ClockCtrl, Value32);
  4280. MM_Wait (40);
  4281. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  4282. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  4283. Value32 =
  4284. T3_PCI_DISABLE_RX_CLOCK | T3_PCI_DISABLE_TX_CLOCK |
  4285. T3_PCI_SELECT_ALTERNATE_CLOCK |
  4286. T3_PCI_44MHZ_CORE_CLOCK;
  4287. } else {
  4288. Value32 = T3_PCI_SELECT_ALTERNATE_CLOCK |
  4289. T3_PCI_44MHZ_CORE_CLOCK;
  4290. }
  4291. REG_WR (pDevice, PciCfg.ClockCtrl, Value32);
  4292. MM_Wait (40);
  4293. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  4294. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  4295. Value32 =
  4296. T3_PCI_DISABLE_RX_CLOCK | T3_PCI_DISABLE_TX_CLOCK |
  4297. T3_PCI_44MHZ_CORE_CLOCK;
  4298. } else {
  4299. Value32 = T3_PCI_44MHZ_CORE_CLOCK;
  4300. }
  4301. REG_WR (pDevice, PciCfg.ClockCtrl, Value32);
  4302. } else {
  4303. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  4304. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  4305. Value32 =
  4306. T3_PCI_DISABLE_RX_CLOCK | T3_PCI_DISABLE_TX_CLOCK |
  4307. T3_PCI_SELECT_ALTERNATE_CLOCK |
  4308. T3_PCI_POWER_DOWN_PCI_PLL133;
  4309. } else {
  4310. Value32 = T3_PCI_SELECT_ALTERNATE_CLOCK |
  4311. T3_PCI_POWER_DOWN_PCI_PLL133;
  4312. }
  4313. REG_WR (pDevice, PciCfg.ClockCtrl, Value32);
  4314. }
  4315. MM_Wait (40);
  4316. if (!pDevice->EepromWp
  4317. && (pDevice->WakeUpModeCap != LM_WAKE_UP_MODE_NONE)) {
  4318. /* Switch adapter to auxilliary power. */
  4319. if (T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
  4320. T3_ASIC_REV (pDevice->ChipRevId) == T3_ASIC_REV_5701) {
  4321. /* GPIO0 = 1, GPIO1 = 1, GPIO2 = 0. */
  4322. REG_WR (pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
  4323. GRC_MISC_LOCAL_CTRL_GPIO_OE0 |
  4324. GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
  4325. GRC_MISC_LOCAL_CTRL_GPIO_OE2 |
  4326. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT0 |
  4327. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1);
  4328. MM_Wait (40);
  4329. } else {
  4330. /* GPIO0 = 0, GPIO1 = 1, GPIO2 = 1. */
  4331. REG_WR (pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
  4332. GRC_MISC_LOCAL_CTRL_GPIO_OE0 |
  4333. GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
  4334. GRC_MISC_LOCAL_CTRL_GPIO_OE2 |
  4335. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1 |
  4336. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT2);
  4337. MM_Wait (40);
  4338. /* GPIO0 = 1, GPIO1 = 1, GPIO2 = 1. */
  4339. REG_WR (pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
  4340. GRC_MISC_LOCAL_CTRL_GPIO_OE0 |
  4341. GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
  4342. GRC_MISC_LOCAL_CTRL_GPIO_OE2 |
  4343. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT0 |
  4344. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1 |
  4345. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT2);
  4346. MM_Wait (40);
  4347. /* GPIO0 = 1, GPIO1 = 1, GPIO2 = 0. */
  4348. REG_WR (pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
  4349. GRC_MISC_LOCAL_CTRL_GPIO_OE0 |
  4350. GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
  4351. GRC_MISC_LOCAL_CTRL_GPIO_OE2 |
  4352. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT0 |
  4353. GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1);
  4354. MM_Wait (40);
  4355. }
  4356. }
  4357. /* Set the phy to low power mode. */
  4358. /* Put the the hardware in low power mode. */
  4359. MM_WriteConfig32 (pDevice, T3_PCI_PM_STATUS_CTRL_REG, PmCtrl);
  4360. return LM_STATUS_SUCCESS;
  4361. } /* LM_SetPowerState */
  4362. /******************************************************************************/
  4363. /* Description: */
  4364. /* */
  4365. /* Return: */
  4366. /******************************************************************************/
  4367. static LM_UINT32 GetPhyAdFlowCntrlSettings (PLM_DEVICE_BLOCK pDevice)
  4368. {
  4369. LM_UINT32 Value32;
  4370. Value32 = 0;
  4371. /* Auto negotiation flow control only when autonegotiation is enabled. */
  4372. if (pDevice->DisableAutoNeg == FALSE ||
  4373. pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_AUTO ||
  4374. pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_UTP_AUTO) {
  4375. /* Please refer to Table 28B-3 of the 802.3ab-1999 spec. */
  4376. if ((pDevice->FlowControlCap == LM_FLOW_CONTROL_AUTO_PAUSE) ||
  4377. ((pDevice->FlowControlCap & LM_FLOW_CONTROL_RECEIVE_PAUSE)
  4378. && (pDevice->
  4379. FlowControlCap & LM_FLOW_CONTROL_TRANSMIT_PAUSE))) {
  4380. Value32 |= PHY_AN_AD_PAUSE_CAPABLE;
  4381. } else if (pDevice->
  4382. FlowControlCap & LM_FLOW_CONTROL_TRANSMIT_PAUSE) {
  4383. Value32 |= PHY_AN_AD_ASYM_PAUSE;
  4384. } else if (pDevice->
  4385. FlowControlCap & LM_FLOW_CONTROL_RECEIVE_PAUSE) {
  4386. Value32 |=
  4387. PHY_AN_AD_PAUSE_CAPABLE | PHY_AN_AD_ASYM_PAUSE;
  4388. }
  4389. }
  4390. return Value32;
  4391. }
  4392. /******************************************************************************/
  4393. /* Description: */
  4394. /* */
  4395. /* Return: */
  4396. /* LM_STATUS_FAILURE */
  4397. /* LM_STATUS_SUCCESS */
  4398. /* */
  4399. /******************************************************************************/
  4400. static LM_STATUS
  4401. LM_ForceAutoNegBcm540xPhy (PLM_DEVICE_BLOCK pDevice,
  4402. LM_REQUESTED_MEDIA_TYPE RequestedMediaType)
  4403. {
  4404. LM_MEDIA_TYPE MediaType;
  4405. LM_LINE_SPEED LineSpeed;
  4406. LM_DUPLEX_MODE DuplexMode;
  4407. LM_UINT32 NewPhyCtrl;
  4408. LM_UINT32 Value32;
  4409. LM_UINT32 Cnt;
  4410. /* Get the interface type, line speed, and duplex mode. */
  4411. LM_TranslateRequestedMediaType (RequestedMediaType, &MediaType,
  4412. &LineSpeed, &DuplexMode);
  4413. if (pDevice->RestoreOnWakeUp) {
  4414. LM_WritePhy (pDevice, BCM540X_1000BASET_CTRL_REG, 0);
  4415. pDevice->advertising1000 = 0;
  4416. Value32 = PHY_AN_AD_10BASET_FULL | PHY_AN_AD_10BASET_HALF;
  4417. if (pDevice->WolSpeed == WOL_SPEED_100MB) {
  4418. Value32 |=
  4419. PHY_AN_AD_100BASETX_FULL | PHY_AN_AD_100BASETX_HALF;
  4420. }
  4421. Value32 |= PHY_AN_AD_PROTOCOL_802_3_CSMA_CD;
  4422. Value32 |= GetPhyAdFlowCntrlSettings (pDevice);
  4423. LM_WritePhy (pDevice, PHY_AN_AD_REG, Value32);
  4424. pDevice->advertising = Value32;
  4425. }
  4426. /* Setup the auto-negotiation advertisement register. */
  4427. else if (LineSpeed == LM_LINE_SPEED_UNKNOWN) {
  4428. /* Setup the 10/100 Mbps auto-negotiation advertisement register. */
  4429. Value32 = PHY_AN_AD_PROTOCOL_802_3_CSMA_CD |
  4430. PHY_AN_AD_10BASET_HALF | PHY_AN_AD_10BASET_FULL |
  4431. PHY_AN_AD_100BASETX_FULL | PHY_AN_AD_100BASETX_HALF;
  4432. Value32 |= GetPhyAdFlowCntrlSettings (pDevice);
  4433. LM_WritePhy (pDevice, PHY_AN_AD_REG, Value32);
  4434. pDevice->advertising = Value32;
  4435. /* Advertise 1000Mbps */
  4436. Value32 =
  4437. BCM540X_AN_AD_1000BASET_HALF | BCM540X_AN_AD_1000BASET_FULL;
  4438. #if INCLUDE_5701_AX_FIX
  4439. /* Bug: workaround for CRC error in gigabit mode when we are in */
  4440. /* slave mode. This will force the PHY to operate in */
  4441. /* master mode. */
  4442. if (pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
  4443. pDevice->ChipRevId == T3_CHIP_ID_5701_B0) {
  4444. Value32 |= BCM540X_CONFIG_AS_MASTER |
  4445. BCM540X_ENABLE_CONFIG_AS_MASTER;
  4446. }
  4447. #endif
  4448. LM_WritePhy (pDevice, BCM540X_1000BASET_CTRL_REG, Value32);
  4449. pDevice->advertising1000 = Value32;
  4450. } else {
  4451. if (LineSpeed == LM_LINE_SPEED_1000MBPS) {
  4452. Value32 = PHY_AN_AD_PROTOCOL_802_3_CSMA_CD;
  4453. Value32 |= GetPhyAdFlowCntrlSettings (pDevice);
  4454. LM_WritePhy (pDevice, PHY_AN_AD_REG, Value32);
  4455. pDevice->advertising = Value32;
  4456. if (DuplexMode != LM_DUPLEX_MODE_FULL) {
  4457. Value32 = BCM540X_AN_AD_1000BASET_HALF;
  4458. } else {
  4459. Value32 = BCM540X_AN_AD_1000BASET_FULL;
  4460. }
  4461. LM_WritePhy (pDevice, BCM540X_1000BASET_CTRL_REG,
  4462. Value32);
  4463. pDevice->advertising1000 = Value32;
  4464. } else if (LineSpeed == LM_LINE_SPEED_100MBPS) {
  4465. LM_WritePhy (pDevice, BCM540X_1000BASET_CTRL_REG, 0);
  4466. pDevice->advertising1000 = 0;
  4467. if (DuplexMode != LM_DUPLEX_MODE_FULL) {
  4468. Value32 = PHY_AN_AD_100BASETX_HALF;
  4469. } else {
  4470. Value32 = PHY_AN_AD_100BASETX_FULL;
  4471. }
  4472. Value32 |= PHY_AN_AD_PROTOCOL_802_3_CSMA_CD;
  4473. Value32 |= GetPhyAdFlowCntrlSettings (pDevice);
  4474. LM_WritePhy (pDevice, PHY_AN_AD_REG, Value32);
  4475. pDevice->advertising = Value32;
  4476. } else if (LineSpeed == LM_LINE_SPEED_10MBPS) {
  4477. LM_WritePhy (pDevice, BCM540X_1000BASET_CTRL_REG, 0);
  4478. pDevice->advertising1000 = 0;
  4479. if (DuplexMode != LM_DUPLEX_MODE_FULL) {
  4480. Value32 = PHY_AN_AD_10BASET_HALF;
  4481. } else {
  4482. Value32 = PHY_AN_AD_10BASET_FULL;
  4483. }
  4484. Value32 |= PHY_AN_AD_PROTOCOL_802_3_CSMA_CD;
  4485. Value32 |= GetPhyAdFlowCntrlSettings (pDevice);
  4486. LM_WritePhy (pDevice, PHY_AN_AD_REG, Value32);
  4487. pDevice->advertising = Value32;
  4488. }
  4489. }
  4490. /* Force line speed if auto-negotiation is disabled. */
  4491. if (pDevice->DisableAutoNeg && LineSpeed != LM_LINE_SPEED_UNKNOWN) {
  4492. /* This code path is executed only when there is link. */
  4493. pDevice->MediaType = MediaType;
  4494. pDevice->LineSpeed = LineSpeed;
  4495. pDevice->DuplexMode = DuplexMode;
  4496. /* Force line seepd. */
  4497. NewPhyCtrl = 0;
  4498. switch (LineSpeed) {
  4499. case LM_LINE_SPEED_10MBPS:
  4500. NewPhyCtrl |= PHY_CTRL_SPEED_SELECT_10MBPS;
  4501. break;
  4502. case LM_LINE_SPEED_100MBPS:
  4503. NewPhyCtrl |= PHY_CTRL_SPEED_SELECT_100MBPS;
  4504. break;
  4505. case LM_LINE_SPEED_1000MBPS:
  4506. NewPhyCtrl |= PHY_CTRL_SPEED_SELECT_1000MBPS;
  4507. break;
  4508. default:
  4509. NewPhyCtrl |= PHY_CTRL_SPEED_SELECT_1000MBPS;
  4510. break;
  4511. }
  4512. if (DuplexMode == LM_DUPLEX_MODE_FULL) {
  4513. NewPhyCtrl |= PHY_CTRL_FULL_DUPLEX_MODE;
  4514. }
  4515. /* Don't do anything if the PHY_CTRL is already what we wanted. */
  4516. LM_ReadPhy (pDevice, PHY_CTRL_REG, &Value32);
  4517. if (Value32 != NewPhyCtrl) {
  4518. /* Temporary bring the link down before forcing line speed. */
  4519. LM_WritePhy (pDevice, PHY_CTRL_REG,
  4520. PHY_CTRL_LOOPBACK_MODE);
  4521. /* Wait for link to go down. */
  4522. for (Cnt = 0; Cnt < 15000; Cnt++) {
  4523. MM_Wait (10);
  4524. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  4525. LM_ReadPhy (pDevice, PHY_STATUS_REG, &Value32);
  4526. if (!(Value32 & PHY_STATUS_LINK_PASS)) {
  4527. MM_Wait (40);
  4528. break;
  4529. }
  4530. }
  4531. LM_WritePhy (pDevice, PHY_CTRL_REG, NewPhyCtrl);
  4532. MM_Wait (40);
  4533. }
  4534. } else {
  4535. LM_WritePhy (pDevice, PHY_CTRL_REG, PHY_CTRL_AUTO_NEG_ENABLE |
  4536. PHY_CTRL_RESTART_AUTO_NEG);
  4537. }
  4538. return LM_STATUS_SUCCESS;
  4539. } /* LM_ForceAutoNegBcm540xPhy */
  4540. /******************************************************************************/
  4541. /* Description: */
  4542. /* */
  4543. /* Return: */
  4544. /******************************************************************************/
  4545. static LM_STATUS
  4546. LM_ForceAutoNeg (PLM_DEVICE_BLOCK pDevice,
  4547. LM_REQUESTED_MEDIA_TYPE RequestedMediaType)
  4548. {
  4549. LM_STATUS LmStatus;
  4550. /* Initialize the phy chip. */
  4551. switch (pDevice->PhyId & PHY_ID_MASK) {
  4552. case PHY_BCM5400_PHY_ID:
  4553. case PHY_BCM5401_PHY_ID:
  4554. case PHY_BCM5411_PHY_ID:
  4555. case PHY_BCM5701_PHY_ID:
  4556. case PHY_BCM5703_PHY_ID:
  4557. case PHY_BCM5704_PHY_ID:
  4558. LmStatus =
  4559. LM_ForceAutoNegBcm540xPhy (pDevice, RequestedMediaType);
  4560. break;
  4561. default:
  4562. LmStatus = LM_STATUS_FAILURE;
  4563. break;
  4564. }
  4565. return LmStatus;
  4566. } /* LM_ForceAutoNeg */
  4567. /******************************************************************************/
  4568. /* Description: */
  4569. /* */
  4570. /* Return: */
  4571. /******************************************************************************/
  4572. LM_STATUS LM_LoadFirmware (PLM_DEVICE_BLOCK pDevice,
  4573. PT3_FWIMG_INFO pFwImg,
  4574. LM_UINT32 LoadCpu, LM_UINT32 StartCpu)
  4575. {
  4576. LM_UINT32 i;
  4577. LM_UINT32 address;
  4578. if (LoadCpu & T3_RX_CPU_ID) {
  4579. if (LM_HaltCpu (pDevice, T3_RX_CPU_ID) != LM_STATUS_SUCCESS) {
  4580. return LM_STATUS_FAILURE;
  4581. }
  4582. /* First of all clear scrach pad memory */
  4583. for (i = 0; i < T3_RX_CPU_SPAD_SIZE; i += 4) {
  4584. LM_RegWrInd (pDevice, T3_RX_CPU_SPAD_ADDR + i, 0);
  4585. }
  4586. /* Copy code first */
  4587. address = T3_RX_CPU_SPAD_ADDR + (pFwImg->Text.Offset & 0xffff);
  4588. for (i = 0; i <= pFwImg->Text.Length; i += 4) {
  4589. LM_RegWrInd (pDevice, address + i,
  4590. ((LM_UINT32 *) pFwImg->Text.Buffer)[i /
  4591. 4]);
  4592. }
  4593. address =
  4594. T3_RX_CPU_SPAD_ADDR + (pFwImg->ROnlyData.Offset & 0xffff);
  4595. for (i = 0; i <= pFwImg->ROnlyData.Length; i += 4) {
  4596. LM_RegWrInd (pDevice, address + i,
  4597. ((LM_UINT32 *) pFwImg->ROnlyData.
  4598. Buffer)[i / 4]);
  4599. }
  4600. address = T3_RX_CPU_SPAD_ADDR + (pFwImg->Data.Offset & 0xffff);
  4601. for (i = 0; i <= pFwImg->Data.Length; i += 4) {
  4602. LM_RegWrInd (pDevice, address + i,
  4603. ((LM_UINT32 *) pFwImg->Data.Buffer)[i /
  4604. 4]);
  4605. }
  4606. }
  4607. if (LoadCpu & T3_TX_CPU_ID) {
  4608. if (LM_HaltCpu (pDevice, T3_TX_CPU_ID) != LM_STATUS_SUCCESS) {
  4609. return LM_STATUS_FAILURE;
  4610. }
  4611. /* First of all clear scrach pad memory */
  4612. for (i = 0; i < T3_TX_CPU_SPAD_SIZE; i += 4) {
  4613. LM_RegWrInd (pDevice, T3_TX_CPU_SPAD_ADDR + i, 0);
  4614. }
  4615. /* Copy code first */
  4616. address = T3_TX_CPU_SPAD_ADDR + (pFwImg->Text.Offset & 0xffff);
  4617. for (i = 0; i <= pFwImg->Text.Length; i += 4) {
  4618. LM_RegWrInd (pDevice, address + i,
  4619. ((LM_UINT32 *) pFwImg->Text.Buffer)[i /
  4620. 4]);
  4621. }
  4622. address =
  4623. T3_TX_CPU_SPAD_ADDR + (pFwImg->ROnlyData.Offset & 0xffff);
  4624. for (i = 0; i <= pFwImg->ROnlyData.Length; i += 4) {
  4625. LM_RegWrInd (pDevice, address + i,
  4626. ((LM_UINT32 *) pFwImg->ROnlyData.
  4627. Buffer)[i / 4]);
  4628. }
  4629. address = T3_TX_CPU_SPAD_ADDR + (pFwImg->Data.Offset & 0xffff);
  4630. for (i = 0; i <= pFwImg->Data.Length; i += 4) {
  4631. LM_RegWrInd (pDevice, address + i,
  4632. ((LM_UINT32 *) pFwImg->Data.Buffer)[i /
  4633. 4]);
  4634. }
  4635. }
  4636. if (StartCpu & T3_RX_CPU_ID) {
  4637. /* Start Rx CPU */
  4638. REG_WR (pDevice, rxCpu.reg.state, 0xffffffff);
  4639. REG_WR (pDevice, rxCpu.reg.PC, pFwImg->StartAddress);
  4640. for (i = 0; i < 5; i++) {
  4641. if (pFwImg->StartAddress ==
  4642. REG_RD (pDevice, rxCpu.reg.PC))
  4643. break;
  4644. REG_WR (pDevice, rxCpu.reg.state, 0xffffffff);
  4645. REG_WR (pDevice, rxCpu.reg.mode, CPU_MODE_HALT);
  4646. REG_WR (pDevice, rxCpu.reg.PC, pFwImg->StartAddress);
  4647. MM_Wait (1000);
  4648. }
  4649. REG_WR (pDevice, rxCpu.reg.state, 0xffffffff);
  4650. REG_WR (pDevice, rxCpu.reg.mode, 0);
  4651. }
  4652. if (StartCpu & T3_TX_CPU_ID) {
  4653. /* Start Tx CPU */
  4654. REG_WR (pDevice, txCpu.reg.state, 0xffffffff);
  4655. REG_WR (pDevice, txCpu.reg.PC, pFwImg->StartAddress);
  4656. for (i = 0; i < 5; i++) {
  4657. if (pFwImg->StartAddress ==
  4658. REG_RD (pDevice, txCpu.reg.PC))
  4659. break;
  4660. REG_WR (pDevice, txCpu.reg.state, 0xffffffff);
  4661. REG_WR (pDevice, txCpu.reg.mode, CPU_MODE_HALT);
  4662. REG_WR (pDevice, txCpu.reg.PC, pFwImg->StartAddress);
  4663. MM_Wait (1000);
  4664. }
  4665. REG_WR (pDevice, txCpu.reg.state, 0xffffffff);
  4666. REG_WR (pDevice, txCpu.reg.mode, 0);
  4667. }
  4668. return LM_STATUS_SUCCESS;
  4669. }
  4670. STATIC LM_STATUS LM_HaltCpu (PLM_DEVICE_BLOCK pDevice, LM_UINT32 cpu_number)
  4671. {
  4672. LM_UINT32 i;
  4673. if (cpu_number == T3_RX_CPU_ID) {
  4674. for (i = 0; i < 10000; i++) {
  4675. REG_WR (pDevice, rxCpu.reg.state, 0xffffffff);
  4676. REG_WR (pDevice, rxCpu.reg.mode, CPU_MODE_HALT);
  4677. if (REG_RD (pDevice, rxCpu.reg.mode) & CPU_MODE_HALT)
  4678. break;
  4679. }
  4680. REG_WR (pDevice, rxCpu.reg.state, 0xffffffff);
  4681. REG_WR (pDevice, rxCpu.reg.mode, CPU_MODE_HALT);
  4682. MM_Wait (10);
  4683. } else {
  4684. for (i = 0; i < 10000; i++) {
  4685. REG_WR (pDevice, txCpu.reg.state, 0xffffffff);
  4686. REG_WR (pDevice, txCpu.reg.mode, CPU_MODE_HALT);
  4687. if (REG_RD (pDevice, txCpu.reg.mode) & CPU_MODE_HALT)
  4688. break;
  4689. }
  4690. }
  4691. return ((i == 10000) ? LM_STATUS_FAILURE : LM_STATUS_SUCCESS);
  4692. }
  4693. int LM_BlinkLED (PLM_DEVICE_BLOCK pDevice, LM_UINT32 BlinkDurationSec)
  4694. {
  4695. LM_UINT32 Oldcfg;
  4696. int j;
  4697. int ret = 0;
  4698. if (BlinkDurationSec == 0) {
  4699. return 0;
  4700. }
  4701. if (BlinkDurationSec > 120) {
  4702. BlinkDurationSec = 120;
  4703. }
  4704. Oldcfg = REG_RD (pDevice, MacCtrl.LedCtrl);
  4705. for (j = 0; j < BlinkDurationSec * 2; j++) {
  4706. if (j % 2) {
  4707. /* Turn on the LEDs. */
  4708. REG_WR (pDevice, MacCtrl.LedCtrl,
  4709. LED_CTRL_OVERRIDE_LINK_LED |
  4710. LED_CTRL_1000MBPS_LED_ON |
  4711. LED_CTRL_100MBPS_LED_ON |
  4712. LED_CTRL_10MBPS_LED_ON |
  4713. LED_CTRL_OVERRIDE_TRAFFIC_LED |
  4714. LED_CTRL_BLINK_TRAFFIC_LED |
  4715. LED_CTRL_TRAFFIC_LED);
  4716. } else {
  4717. /* Turn off the LEDs. */
  4718. REG_WR (pDevice, MacCtrl.LedCtrl,
  4719. LED_CTRL_OVERRIDE_LINK_LED |
  4720. LED_CTRL_OVERRIDE_TRAFFIC_LED);
  4721. }
  4722. #ifndef EMBEDDED
  4723. current->state = TASK_INTERRUPTIBLE;
  4724. if (schedule_timeout (HZ / 2) != 0) {
  4725. ret = -EINTR;
  4726. break;
  4727. }
  4728. #else
  4729. udelay (100000); /* 1s sleep */
  4730. #endif
  4731. }
  4732. REG_WR (pDevice, MacCtrl.LedCtrl, Oldcfg);
  4733. return ret;
  4734. }
  4735. int t3_do_dma (PLM_DEVICE_BLOCK pDevice,
  4736. LM_PHYSICAL_ADDRESS host_addr_phy, int length, int dma_read)
  4737. {
  4738. T3_DMA_DESC dma_desc;
  4739. int i;
  4740. LM_UINT32 dma_desc_addr;
  4741. LM_UINT32 value32;
  4742. REG_WR (pDevice, BufMgr.Mode, 0);
  4743. REG_WR (pDevice, Ftq.Reset, 0);
  4744. dma_desc.host_addr.High = host_addr_phy.High;
  4745. dma_desc.host_addr.Low = host_addr_phy.Low;
  4746. dma_desc.nic_mbuf = 0x2100;
  4747. dma_desc.len = length;
  4748. dma_desc.flags = 0x00000004; /* Generate Rx-CPU event */
  4749. if (dma_read) {
  4750. dma_desc.cqid_sqid = (T3_QID_RX_BD_COMP << 8) |
  4751. T3_QID_DMA_HIGH_PRI_READ;
  4752. REG_WR (pDevice, DmaRead.Mode, DMA_READ_MODE_ENABLE);
  4753. } else {
  4754. dma_desc.cqid_sqid = (T3_QID_RX_DATA_COMP << 8) |
  4755. T3_QID_DMA_HIGH_PRI_WRITE;
  4756. REG_WR (pDevice, DmaWrite.Mode, DMA_WRITE_MODE_ENABLE);
  4757. }
  4758. dma_desc_addr = T3_NIC_DMA_DESC_POOL_ADDR;
  4759. /* Writing this DMA descriptor to DMA memory */
  4760. for (i = 0; i < sizeof (T3_DMA_DESC); i += 4) {
  4761. value32 = *((PLM_UINT32) (((PLM_UINT8) & dma_desc) + i));
  4762. MM_WriteConfig32 (pDevice, T3_PCI_MEM_WIN_ADDR_REG,
  4763. dma_desc_addr + i);
  4764. MM_WriteConfig32 (pDevice, T3_PCI_MEM_WIN_DATA_REG,
  4765. cpu_to_le32 (value32));
  4766. }
  4767. MM_WriteConfig32 (pDevice, T3_PCI_MEM_WIN_ADDR_REG, 0);
  4768. if (dma_read)
  4769. REG_WR (pDevice, Ftq.DmaHighReadFtqFifoEnqueueDequeue,
  4770. dma_desc_addr);
  4771. else
  4772. REG_WR (pDevice, Ftq.DmaHighWriteFtqFifoEnqueueDequeue,
  4773. dma_desc_addr);
  4774. for (i = 0; i < 40; i++) {
  4775. if (dma_read)
  4776. value32 =
  4777. REG_RD (pDevice,
  4778. Ftq.RcvBdCompFtqFifoEnqueueDequeue);
  4779. else
  4780. value32 =
  4781. REG_RD (pDevice,
  4782. Ftq.RcvDataCompFtqFifoEnqueueDequeue);
  4783. if ((value32 & 0xffff) == dma_desc_addr)
  4784. break;
  4785. MM_Wait (10);
  4786. }
  4787. return LM_STATUS_SUCCESS;
  4788. }
  4789. STATIC LM_STATUS
  4790. LM_DmaTest (PLM_DEVICE_BLOCK pDevice, PLM_UINT8 pBufferVirt,
  4791. LM_PHYSICAL_ADDRESS BufferPhy, LM_UINT32 BufferSize)
  4792. {
  4793. int j;
  4794. LM_UINT32 *ptr;
  4795. int dma_success = 0;
  4796. if (T3_ASIC_REV (pDevice->ChipRevId) != T3_ASIC_REV_5700 &&
  4797. T3_ASIC_REV (pDevice->ChipRevId) != T3_ASIC_REV_5701) {
  4798. return LM_STATUS_SUCCESS;
  4799. }
  4800. while (!dma_success) {
  4801. /* Fill data with incremental patterns */
  4802. ptr = (LM_UINT32 *) pBufferVirt;
  4803. for (j = 0; j < BufferSize / 4; j++)
  4804. *ptr++ = j;
  4805. if (t3_do_dma (pDevice, BufferPhy, BufferSize, 1) ==
  4806. LM_STATUS_FAILURE) {
  4807. return LM_STATUS_FAILURE;
  4808. }
  4809. MM_Wait (40);
  4810. ptr = (LM_UINT32 *) pBufferVirt;
  4811. /* Fill data with zero */
  4812. for (j = 0; j < BufferSize / 4; j++)
  4813. *ptr++ = 0;
  4814. if (t3_do_dma (pDevice, BufferPhy, BufferSize, 0) ==
  4815. LM_STATUS_FAILURE) {
  4816. return LM_STATUS_FAILURE;
  4817. }
  4818. MM_Wait (40);
  4819. /* Check for data */
  4820. ptr = (LM_UINT32 *) pBufferVirt;
  4821. for (j = 0; j < BufferSize / 4; j++) {
  4822. if (*ptr++ != j) {
  4823. if ((pDevice->
  4824. DmaReadWriteCtrl &
  4825. DMA_CTRL_WRITE_BOUNDARY_MASK)
  4826. == DMA_CTRL_WRITE_BOUNDARY_DISABLE) {
  4827. pDevice->DmaReadWriteCtrl =
  4828. (pDevice->
  4829. DmaReadWriteCtrl &
  4830. ~DMA_CTRL_WRITE_BOUNDARY_MASK) |
  4831. DMA_CTRL_WRITE_BOUNDARY_16;
  4832. REG_WR (pDevice,
  4833. PciCfg.DmaReadWriteCtrl,
  4834. pDevice->DmaReadWriteCtrl);
  4835. break;
  4836. } else {
  4837. return LM_STATUS_FAILURE;
  4838. }
  4839. }
  4840. }
  4841. if (j == (BufferSize / 4))
  4842. dma_success = 1;
  4843. }
  4844. return LM_STATUS_SUCCESS;
  4845. }