smctr.c 185 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598559956005601560256035604560556065607560856095610561156125613561456155616561756185619562056215622562356245625562656275628562956305631563256335634563556365637563856395640564156425643564456455646564756485649565056515652565356545655565656575658565956605661566256635664566556665667566856695670567156725673567456755676567756785679568056815682568356845685568656875688568956905691569256935694569556965697569856995700570157025703570457055706570757085709571057115712571357145715571657175718
  1. /*
  2. * smctr.c: A network driver for the SMC Token Ring Adapters.
  3. *
  4. * Written by Jay Schulist <jschlst@samba.org>
  5. *
  6. * This software may be used and distributed according to the terms
  7. * of the GNU General Public License, incorporated herein by reference.
  8. *
  9. * This device driver works with the following SMC adapters:
  10. * - SMC TokenCard Elite (8115T, chips 825/584)
  11. * - SMC TokenCard Elite/A MCA (8115T/A, chips 825/594)
  12. *
  13. * Source(s):
  14. * - SMC TokenCard SDK.
  15. *
  16. * Maintainer(s):
  17. * JS Jay Schulist <jschlst@samba.org>
  18. *
  19. * Changes:
  20. * 07102000 JS Fixed a timing problem in smctr_wait_cmd();
  21. * Also added a bit more discriptive error msgs.
  22. * 07122000 JS Fixed problem with detecting a card with
  23. * module io/irq/mem specified.
  24. *
  25. * To do:
  26. * 1. Multicast support.
  27. *
  28. * Initial 2.5 cleanup Alan Cox <alan@lxorguk.ukuu.org.uk> 2002/10/28
  29. */
  30. #include <linux/module.h>
  31. #include <linux/kernel.h>
  32. #include <linux/types.h>
  33. #include <linux/fcntl.h>
  34. #include <linux/interrupt.h>
  35. #include <linux/ptrace.h>
  36. #include <linux/ioport.h>
  37. #include <linux/in.h>
  38. #include <linux/string.h>
  39. #include <linux/time.h>
  40. #include <linux/errno.h>
  41. #include <linux/init.h>
  42. #include <linux/mca-legacy.h>
  43. #include <linux/delay.h>
  44. #include <linux/netdevice.h>
  45. #include <linux/etherdevice.h>
  46. #include <linux/skbuff.h>
  47. #include <linux/trdevice.h>
  48. #include <linux/bitops.h>
  49. #include <linux/firmware.h>
  50. #include <asm/io.h>
  51. #include <asm/dma.h>
  52. #include <asm/irq.h>
  53. #if BITS_PER_LONG == 64
  54. #error FIXME: driver does not support 64-bit platforms
  55. #endif
  56. #include "smctr.h" /* Our Stuff */
  57. static const char version[] __initdata =
  58. KERN_INFO "smctr.c: v1.4 7/12/00 by jschlst@samba.org\n";
  59. static const char cardname[] = "smctr";
  60. #define SMCTR_IO_EXTENT 20
  61. #ifdef CONFIG_MCA_LEGACY
  62. static unsigned int smctr_posid = 0x6ec6;
  63. #endif
  64. static int ringspeed;
  65. /* SMC Name of the Adapter. */
  66. static char smctr_name[] = "SMC TokenCard";
  67. static char *smctr_model = "Unknown";
  68. /* Use 0 for production, 1 for verification, 2 for debug, and
  69. * 3 for very verbose debug.
  70. */
  71. #ifndef SMCTR_DEBUG
  72. #define SMCTR_DEBUG 1
  73. #endif
  74. static unsigned int smctr_debug = SMCTR_DEBUG;
  75. /* smctr.c prototypes and functions are arranged alphabeticly
  76. * for clearity, maintainability and pure old fashion fun.
  77. */
  78. /* A */
  79. static int smctr_alloc_shared_memory(struct net_device *dev);
  80. /* B */
  81. static int smctr_bypass_state(struct net_device *dev);
  82. /* C */
  83. static int smctr_checksum_firmware(struct net_device *dev);
  84. static int __init smctr_chk_isa(struct net_device *dev);
  85. static int smctr_chg_rx_mask(struct net_device *dev);
  86. static int smctr_clear_int(struct net_device *dev);
  87. static int smctr_clear_trc_reset(int ioaddr);
  88. static int smctr_close(struct net_device *dev);
  89. /* D */
  90. static int smctr_decode_firmware(struct net_device *dev,
  91. const struct firmware *fw);
  92. static int smctr_disable_16bit(struct net_device *dev);
  93. static int smctr_disable_adapter_ctrl_store(struct net_device *dev);
  94. static int smctr_disable_bic_int(struct net_device *dev);
  95. /* E */
  96. static int smctr_enable_16bit(struct net_device *dev);
  97. static int smctr_enable_adapter_ctrl_store(struct net_device *dev);
  98. static int smctr_enable_adapter_ram(struct net_device *dev);
  99. static int smctr_enable_bic_int(struct net_device *dev);
  100. /* G */
  101. static int __init smctr_get_boardid(struct net_device *dev, int mca);
  102. static int smctr_get_group_address(struct net_device *dev);
  103. static int smctr_get_functional_address(struct net_device *dev);
  104. static unsigned int smctr_get_num_rx_bdbs(struct net_device *dev);
  105. static int smctr_get_physical_drop_number(struct net_device *dev);
  106. static __u8 *smctr_get_rx_pointer(struct net_device *dev, short queue);
  107. static int smctr_get_station_id(struct net_device *dev);
  108. static FCBlock *smctr_get_tx_fcb(struct net_device *dev, __u16 queue,
  109. __u16 bytes_count);
  110. static int smctr_get_upstream_neighbor_addr(struct net_device *dev);
  111. /* H */
  112. static int smctr_hardware_send_packet(struct net_device *dev,
  113. struct net_local *tp);
  114. /* I */
  115. static int smctr_init_acbs(struct net_device *dev);
  116. static int smctr_init_adapter(struct net_device *dev);
  117. static int smctr_init_card_real(struct net_device *dev);
  118. static int smctr_init_rx_bdbs(struct net_device *dev);
  119. static int smctr_init_rx_fcbs(struct net_device *dev);
  120. static int smctr_init_shared_memory(struct net_device *dev);
  121. static int smctr_init_tx_bdbs(struct net_device *dev);
  122. static int smctr_init_tx_fcbs(struct net_device *dev);
  123. static int smctr_internal_self_test(struct net_device *dev);
  124. static irqreturn_t smctr_interrupt(int irq, void *dev_id);
  125. static int smctr_issue_enable_int_cmd(struct net_device *dev,
  126. __u16 interrupt_enable_mask);
  127. static int smctr_issue_int_ack(struct net_device *dev, __u16 iack_code,
  128. __u16 ibits);
  129. static int smctr_issue_init_timers_cmd(struct net_device *dev);
  130. static int smctr_issue_init_txrx_cmd(struct net_device *dev);
  131. static int smctr_issue_insert_cmd(struct net_device *dev);
  132. static int smctr_issue_read_ring_status_cmd(struct net_device *dev);
  133. static int smctr_issue_read_word_cmd(struct net_device *dev, __u16 aword_cnt);
  134. static int smctr_issue_remove_cmd(struct net_device *dev);
  135. static int smctr_issue_resume_acb_cmd(struct net_device *dev);
  136. static int smctr_issue_resume_rx_bdb_cmd(struct net_device *dev, __u16 queue);
  137. static int smctr_issue_resume_rx_fcb_cmd(struct net_device *dev, __u16 queue);
  138. static int smctr_issue_resume_tx_fcb_cmd(struct net_device *dev, __u16 queue);
  139. static int smctr_issue_test_internal_rom_cmd(struct net_device *dev);
  140. static int smctr_issue_test_hic_cmd(struct net_device *dev);
  141. static int smctr_issue_test_mac_reg_cmd(struct net_device *dev);
  142. static int smctr_issue_trc_loopback_cmd(struct net_device *dev);
  143. static int smctr_issue_tri_loopback_cmd(struct net_device *dev);
  144. static int smctr_issue_write_byte_cmd(struct net_device *dev,
  145. short aword_cnt, void *byte);
  146. static int smctr_issue_write_word_cmd(struct net_device *dev,
  147. short aword_cnt, void *word);
  148. /* J */
  149. static int smctr_join_complete_state(struct net_device *dev);
  150. /* L */
  151. static int smctr_link_tx_fcbs_to_bdbs(struct net_device *dev);
  152. static int smctr_load_firmware(struct net_device *dev);
  153. static int smctr_load_node_addr(struct net_device *dev);
  154. static int smctr_lobe_media_test(struct net_device *dev);
  155. static int smctr_lobe_media_test_cmd(struct net_device *dev);
  156. static int smctr_lobe_media_test_state(struct net_device *dev);
  157. /* M */
  158. static int smctr_make_8025_hdr(struct net_device *dev,
  159. MAC_HEADER *rmf, MAC_HEADER *tmf, __u16 ac_fc);
  160. static int smctr_make_access_pri(struct net_device *dev,
  161. MAC_SUB_VECTOR *tsv);
  162. static int smctr_make_addr_mod(struct net_device *dev, MAC_SUB_VECTOR *tsv);
  163. static int smctr_make_auth_funct_class(struct net_device *dev,
  164. MAC_SUB_VECTOR *tsv);
  165. static int smctr_make_corr(struct net_device *dev,
  166. MAC_SUB_VECTOR *tsv, __u16 correlator);
  167. static int smctr_make_funct_addr(struct net_device *dev,
  168. MAC_SUB_VECTOR *tsv);
  169. static int smctr_make_group_addr(struct net_device *dev,
  170. MAC_SUB_VECTOR *tsv);
  171. static int smctr_make_phy_drop_num(struct net_device *dev,
  172. MAC_SUB_VECTOR *tsv);
  173. static int smctr_make_product_id(struct net_device *dev, MAC_SUB_VECTOR *tsv);
  174. static int smctr_make_station_id(struct net_device *dev, MAC_SUB_VECTOR *tsv);
  175. static int smctr_make_ring_station_status(struct net_device *dev,
  176. MAC_SUB_VECTOR *tsv);
  177. static int smctr_make_ring_station_version(struct net_device *dev,
  178. MAC_SUB_VECTOR *tsv);
  179. static int smctr_make_tx_status_code(struct net_device *dev,
  180. MAC_SUB_VECTOR *tsv, __u16 tx_fstatus);
  181. static int smctr_make_upstream_neighbor_addr(struct net_device *dev,
  182. MAC_SUB_VECTOR *tsv);
  183. static int smctr_make_wrap_data(struct net_device *dev,
  184. MAC_SUB_VECTOR *tsv);
  185. /* O */
  186. static int smctr_open(struct net_device *dev);
  187. static int smctr_open_tr(struct net_device *dev);
  188. /* P */
  189. struct net_device *smctr_probe(int unit);
  190. static int __init smctr_probe1(struct net_device *dev, int ioaddr);
  191. static int smctr_process_rx_packet(MAC_HEADER *rmf, __u16 size,
  192. struct net_device *dev, __u16 rx_status);
  193. /* R */
  194. static int smctr_ram_memory_test(struct net_device *dev);
  195. static int smctr_rcv_chg_param(struct net_device *dev, MAC_HEADER *rmf,
  196. __u16 *correlator);
  197. static int smctr_rcv_init(struct net_device *dev, MAC_HEADER *rmf,
  198. __u16 *correlator);
  199. static int smctr_rcv_tx_forward(struct net_device *dev, MAC_HEADER *rmf);
  200. static int smctr_rcv_rq_addr_state_attch(struct net_device *dev,
  201. MAC_HEADER *rmf, __u16 *correlator);
  202. static int smctr_rcv_unknown(struct net_device *dev, MAC_HEADER *rmf,
  203. __u16 *correlator);
  204. static int smctr_reset_adapter(struct net_device *dev);
  205. static int smctr_restart_tx_chain(struct net_device *dev, short queue);
  206. static int smctr_ring_status_chg(struct net_device *dev);
  207. static int smctr_rx_frame(struct net_device *dev);
  208. /* S */
  209. static int smctr_send_dat(struct net_device *dev);
  210. static netdev_tx_t smctr_send_packet(struct sk_buff *skb,
  211. struct net_device *dev);
  212. static int smctr_send_lobe_media_test(struct net_device *dev);
  213. static int smctr_send_rpt_addr(struct net_device *dev, MAC_HEADER *rmf,
  214. __u16 correlator);
  215. static int smctr_send_rpt_attch(struct net_device *dev, MAC_HEADER *rmf,
  216. __u16 correlator);
  217. static int smctr_send_rpt_state(struct net_device *dev, MAC_HEADER *rmf,
  218. __u16 correlator);
  219. static int smctr_send_rpt_tx_forward(struct net_device *dev,
  220. MAC_HEADER *rmf, __u16 tx_fstatus);
  221. static int smctr_send_rsp(struct net_device *dev, MAC_HEADER *rmf,
  222. __u16 rcode, __u16 correlator);
  223. static int smctr_send_rq_init(struct net_device *dev);
  224. static int smctr_send_tx_forward(struct net_device *dev, MAC_HEADER *rmf,
  225. __u16 *tx_fstatus);
  226. static int smctr_set_auth_access_pri(struct net_device *dev,
  227. MAC_SUB_VECTOR *rsv);
  228. static int smctr_set_auth_funct_class(struct net_device *dev,
  229. MAC_SUB_VECTOR *rsv);
  230. static int smctr_set_corr(struct net_device *dev, MAC_SUB_VECTOR *rsv,
  231. __u16 *correlator);
  232. static int smctr_set_error_timer_value(struct net_device *dev,
  233. MAC_SUB_VECTOR *rsv);
  234. static int smctr_set_frame_forward(struct net_device *dev,
  235. MAC_SUB_VECTOR *rsv, __u8 dc_sc);
  236. static int smctr_set_local_ring_num(struct net_device *dev,
  237. MAC_SUB_VECTOR *rsv);
  238. static unsigned short smctr_set_ctrl_attention(struct net_device *dev);
  239. static void smctr_set_multicast_list(struct net_device *dev);
  240. static int smctr_set_page(struct net_device *dev, __u8 *buf);
  241. static int smctr_set_phy_drop(struct net_device *dev,
  242. MAC_SUB_VECTOR *rsv);
  243. static int smctr_set_ring_speed(struct net_device *dev);
  244. static int smctr_set_rx_look_ahead(struct net_device *dev);
  245. static int smctr_set_trc_reset(int ioaddr);
  246. static int smctr_setup_single_cmd(struct net_device *dev,
  247. __u16 command, __u16 subcommand);
  248. static int smctr_setup_single_cmd_w_data(struct net_device *dev,
  249. __u16 command, __u16 subcommand);
  250. static char *smctr_malloc(struct net_device *dev, __u16 size);
  251. static int smctr_status_chg(struct net_device *dev);
  252. /* T */
  253. static void smctr_timeout(struct net_device *dev);
  254. static int smctr_trc_send_packet(struct net_device *dev, FCBlock *fcb,
  255. __u16 queue);
  256. static __u16 smctr_tx_complete(struct net_device *dev, __u16 queue);
  257. static unsigned short smctr_tx_move_frame(struct net_device *dev,
  258. struct sk_buff *skb, __u8 *pbuff, unsigned int bytes);
  259. /* U */
  260. static int smctr_update_err_stats(struct net_device *dev);
  261. static int smctr_update_rx_chain(struct net_device *dev, __u16 queue);
  262. static int smctr_update_tx_chain(struct net_device *dev, FCBlock *fcb,
  263. __u16 queue);
  264. /* W */
  265. static int smctr_wait_cmd(struct net_device *dev);
  266. static int smctr_wait_while_cbusy(struct net_device *dev);
  267. #define TO_256_BYTE_BOUNDRY(X) (((X + 0xff) & 0xff00) - X)
  268. #define TO_PARAGRAPH_BOUNDRY(X) (((X + 0x0f) & 0xfff0) - X)
  269. #define PARAGRAPH_BOUNDRY(X) smctr_malloc(dev, TO_PARAGRAPH_BOUNDRY(X))
  270. /* Allocate Adapter Shared Memory.
  271. * IMPORTANT NOTE: Any changes to this function MUST be mirrored in the
  272. * function "get_num_rx_bdbs" below!!!
  273. *
  274. * Order of memory allocation:
  275. *
  276. * 0. Initial System Configuration Block Pointer
  277. * 1. System Configuration Block
  278. * 2. System Control Block
  279. * 3. Action Command Block
  280. * 4. Interrupt Status Block
  281. *
  282. * 5. MAC TX FCB'S
  283. * 6. NON-MAC TX FCB'S
  284. * 7. MAC TX BDB'S
  285. * 8. NON-MAC TX BDB'S
  286. * 9. MAC RX FCB'S
  287. * 10. NON-MAC RX FCB'S
  288. * 11. MAC RX BDB'S
  289. * 12. NON-MAC RX BDB'S
  290. * 13. MAC TX Data Buffer( 1, 256 byte buffer)
  291. * 14. MAC RX Data Buffer( 1, 256 byte buffer)
  292. *
  293. * 15. NON-MAC TX Data Buffer
  294. * 16. NON-MAC RX Data Buffer
  295. */
  296. static int smctr_alloc_shared_memory(struct net_device *dev)
  297. {
  298. struct net_local *tp = netdev_priv(dev);
  299. if(smctr_debug > 10)
  300. printk(KERN_DEBUG "%s: smctr_alloc_shared_memory\n", dev->name);
  301. /* Allocate initial System Control Block pointer.
  302. * This pointer is located in the last page, last offset - 4.
  303. */
  304. tp->iscpb_ptr = (ISCPBlock *)(tp->ram_access + ((__u32)64 * 0x400)
  305. - (long)ISCP_BLOCK_SIZE);
  306. /* Allocate System Control Blocks. */
  307. tp->scgb_ptr = (SCGBlock *)smctr_malloc(dev, sizeof(SCGBlock));
  308. PARAGRAPH_BOUNDRY(tp->sh_mem_used);
  309. tp->sclb_ptr = (SCLBlock *)smctr_malloc(dev, sizeof(SCLBlock));
  310. PARAGRAPH_BOUNDRY(tp->sh_mem_used);
  311. tp->acb_head = (ACBlock *)smctr_malloc(dev,
  312. sizeof(ACBlock)*tp->num_acbs);
  313. PARAGRAPH_BOUNDRY(tp->sh_mem_used);
  314. tp->isb_ptr = (ISBlock *)smctr_malloc(dev, sizeof(ISBlock));
  315. PARAGRAPH_BOUNDRY(tp->sh_mem_used);
  316. tp->misc_command_data = (__u16 *)smctr_malloc(dev, MISC_DATA_SIZE);
  317. PARAGRAPH_BOUNDRY(tp->sh_mem_used);
  318. /* Allocate transmit FCBs. */
  319. tp->tx_fcb_head[MAC_QUEUE] = (FCBlock *)smctr_malloc(dev,
  320. sizeof(FCBlock) * tp->num_tx_fcbs[MAC_QUEUE]);
  321. tp->tx_fcb_head[NON_MAC_QUEUE] = (FCBlock *)smctr_malloc(dev,
  322. sizeof(FCBlock) * tp->num_tx_fcbs[NON_MAC_QUEUE]);
  323. tp->tx_fcb_head[BUG_QUEUE] = (FCBlock *)smctr_malloc(dev,
  324. sizeof(FCBlock) * tp->num_tx_fcbs[BUG_QUEUE]);
  325. /* Allocate transmit BDBs. */
  326. tp->tx_bdb_head[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev,
  327. sizeof(BDBlock) * tp->num_tx_bdbs[MAC_QUEUE]);
  328. tp->tx_bdb_head[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev,
  329. sizeof(BDBlock) * tp->num_tx_bdbs[NON_MAC_QUEUE]);
  330. tp->tx_bdb_head[BUG_QUEUE] = (BDBlock *)smctr_malloc(dev,
  331. sizeof(BDBlock) * tp->num_tx_bdbs[BUG_QUEUE]);
  332. /* Allocate receive FCBs. */
  333. tp->rx_fcb_head[MAC_QUEUE] = (FCBlock *)smctr_malloc(dev,
  334. sizeof(FCBlock) * tp->num_rx_fcbs[MAC_QUEUE]);
  335. tp->rx_fcb_head[NON_MAC_QUEUE] = (FCBlock *)smctr_malloc(dev,
  336. sizeof(FCBlock) * tp->num_rx_fcbs[NON_MAC_QUEUE]);
  337. /* Allocate receive BDBs. */
  338. tp->rx_bdb_head[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev,
  339. sizeof(BDBlock) * tp->num_rx_bdbs[MAC_QUEUE]);
  340. tp->rx_bdb_end[MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, 0);
  341. tp->rx_bdb_head[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev,
  342. sizeof(BDBlock) * tp->num_rx_bdbs[NON_MAC_QUEUE]);
  343. tp->rx_bdb_end[NON_MAC_QUEUE] = (BDBlock *)smctr_malloc(dev, 0);
  344. /* Allocate MAC transmit buffers.
  345. * MAC Tx Buffers doen't have to be on an ODD Boundary.
  346. */
  347. tp->tx_buff_head[MAC_QUEUE]
  348. = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[MAC_QUEUE]);
  349. tp->tx_buff_curr[MAC_QUEUE] = tp->tx_buff_head[MAC_QUEUE];
  350. tp->tx_buff_end [MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
  351. /* Allocate BUG transmit buffers. */
  352. tp->tx_buff_head[BUG_QUEUE]
  353. = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[BUG_QUEUE]);
  354. tp->tx_buff_curr[BUG_QUEUE] = tp->tx_buff_head[BUG_QUEUE];
  355. tp->tx_buff_end[BUG_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
  356. /* Allocate MAC receive data buffers.
  357. * MAC Rx buffer doesn't have to be on a 256 byte boundary.
  358. */
  359. tp->rx_buff_head[MAC_QUEUE] = (__u16 *)smctr_malloc(dev,
  360. RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[MAC_QUEUE]);
  361. tp->rx_buff_end[MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
  362. /* Allocate Non-MAC transmit buffers.
  363. * ?? For maximum Netware performance, put Tx Buffers on
  364. * ODD Boundary and then restore malloc to Even Boundrys.
  365. */
  366. smctr_malloc(dev, 1L);
  367. tp->tx_buff_head[NON_MAC_QUEUE]
  368. = (__u16 *)smctr_malloc(dev, tp->tx_buff_size[NON_MAC_QUEUE]);
  369. tp->tx_buff_curr[NON_MAC_QUEUE] = tp->tx_buff_head[NON_MAC_QUEUE];
  370. tp->tx_buff_end [NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
  371. smctr_malloc(dev, 1L);
  372. /* Allocate Non-MAC receive data buffers.
  373. * To guarantee a minimum of 256 contiguous memory to
  374. * UM_Receive_Packet's lookahead pointer, before a page
  375. * change or ring end is encountered, place each rx buffer on
  376. * a 256 byte boundary.
  377. */
  378. smctr_malloc(dev, TO_256_BYTE_BOUNDRY(tp->sh_mem_used));
  379. tp->rx_buff_head[NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev,
  380. RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[NON_MAC_QUEUE]);
  381. tp->rx_buff_end[NON_MAC_QUEUE] = (__u16 *)smctr_malloc(dev, 0);
  382. return 0;
  383. }
  384. /* Enter Bypass state. */
  385. static int smctr_bypass_state(struct net_device *dev)
  386. {
  387. int err;
  388. if(smctr_debug > 10)
  389. printk(KERN_DEBUG "%s: smctr_bypass_state\n", dev->name);
  390. err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE, JS_BYPASS_STATE);
  391. return err;
  392. }
  393. static int smctr_checksum_firmware(struct net_device *dev)
  394. {
  395. struct net_local *tp = netdev_priv(dev);
  396. __u16 i, checksum = 0;
  397. if(smctr_debug > 10)
  398. printk(KERN_DEBUG "%s: smctr_checksum_firmware\n", dev->name);
  399. smctr_enable_adapter_ctrl_store(dev);
  400. for(i = 0; i < CS_RAM_SIZE; i += 2)
  401. checksum += *((__u16 *)(tp->ram_access + i));
  402. tp->microcode_version = *(__u16 *)(tp->ram_access
  403. + CS_RAM_VERSION_OFFSET);
  404. tp->microcode_version >>= 8;
  405. smctr_disable_adapter_ctrl_store(dev);
  406. if(checksum)
  407. return checksum;
  408. return 0;
  409. }
  410. static int __init smctr_chk_mca(struct net_device *dev)
  411. {
  412. #ifdef CONFIG_MCA_LEGACY
  413. struct net_local *tp = netdev_priv(dev);
  414. int current_slot;
  415. __u8 r1, r2, r3, r4, r5;
  416. current_slot = mca_find_unused_adapter(smctr_posid, 0);
  417. if(current_slot == MCA_NOTFOUND)
  418. return -ENODEV;
  419. mca_set_adapter_name(current_slot, smctr_name);
  420. mca_mark_as_used(current_slot);
  421. tp->slot_num = current_slot;
  422. r1 = mca_read_stored_pos(tp->slot_num, 2);
  423. r2 = mca_read_stored_pos(tp->slot_num, 3);
  424. if(tp->slot_num)
  425. outb(CNFG_POS_CONTROL_REG, (__u8)((tp->slot_num - 1) | CNFG_SLOT_ENABLE_BIT));
  426. else
  427. outb(CNFG_POS_CONTROL_REG, (__u8)((tp->slot_num) | CNFG_SLOT_ENABLE_BIT));
  428. r1 = inb(CNFG_POS_REG1);
  429. r2 = inb(CNFG_POS_REG0);
  430. tp->bic_type = BIC_594_CHIP;
  431. /* IO */
  432. r2 = mca_read_stored_pos(tp->slot_num, 2);
  433. r2 &= 0xF0;
  434. dev->base_addr = ((__u16)r2 << 8) + (__u16)0x800;
  435. request_region(dev->base_addr, SMCTR_IO_EXTENT, smctr_name);
  436. /* IRQ */
  437. r5 = mca_read_stored_pos(tp->slot_num, 5);
  438. r5 &= 0xC;
  439. switch(r5)
  440. {
  441. case 0:
  442. dev->irq = 3;
  443. break;
  444. case 0x4:
  445. dev->irq = 4;
  446. break;
  447. case 0x8:
  448. dev->irq = 10;
  449. break;
  450. default:
  451. dev->irq = 15;
  452. break;
  453. }
  454. if (request_irq(dev->irq, smctr_interrupt, IRQF_SHARED, smctr_name, dev)) {
  455. release_region(dev->base_addr, SMCTR_IO_EXTENT);
  456. return -ENODEV;
  457. }
  458. /* Get RAM base */
  459. r3 = mca_read_stored_pos(tp->slot_num, 3);
  460. tp->ram_base = ((__u32)(r3 & 0x7) << 13) + 0x0C0000;
  461. if (r3 & 0x8)
  462. tp->ram_base += 0x010000;
  463. if (r3 & 0x80)
  464. tp->ram_base += 0xF00000;
  465. /* Get Ram Size */
  466. r3 &= 0x30;
  467. r3 >>= 4;
  468. tp->ram_usable = (__u16)CNFG_SIZE_8KB << r3;
  469. tp->ram_size = (__u16)CNFG_SIZE_64KB;
  470. tp->board_id |= TOKEN_MEDIA;
  471. r4 = mca_read_stored_pos(tp->slot_num, 4);
  472. tp->rom_base = ((__u32)(r4 & 0x7) << 13) + 0x0C0000;
  473. if (r4 & 0x8)
  474. tp->rom_base += 0x010000;
  475. /* Get ROM size. */
  476. r4 >>= 4;
  477. switch (r4) {
  478. case 0:
  479. tp->rom_size = CNFG_SIZE_8KB;
  480. break;
  481. case 1:
  482. tp->rom_size = CNFG_SIZE_16KB;
  483. break;
  484. case 2:
  485. tp->rom_size = CNFG_SIZE_32KB;
  486. break;
  487. default:
  488. tp->rom_size = ROM_DISABLE;
  489. }
  490. /* Get Media Type. */
  491. r5 = mca_read_stored_pos(tp->slot_num, 5);
  492. r5 &= CNFG_MEDIA_TYPE_MASK;
  493. switch(r5)
  494. {
  495. case (0):
  496. tp->media_type = MEDIA_STP_4;
  497. break;
  498. case (1):
  499. tp->media_type = MEDIA_STP_16;
  500. break;
  501. case (3):
  502. tp->media_type = MEDIA_UTP_16;
  503. break;
  504. default:
  505. tp->media_type = MEDIA_UTP_4;
  506. break;
  507. }
  508. tp->media_menu = 14;
  509. r2 = mca_read_stored_pos(tp->slot_num, 2);
  510. if(!(r2 & 0x02))
  511. tp->mode_bits |= EARLY_TOKEN_REL;
  512. /* Disable slot */
  513. outb(CNFG_POS_CONTROL_REG, 0);
  514. tp->board_id = smctr_get_boardid(dev, 1);
  515. switch(tp->board_id & 0xffff)
  516. {
  517. case WD8115TA:
  518. smctr_model = "8115T/A";
  519. break;
  520. case WD8115T:
  521. if(tp->extra_info & CHIP_REV_MASK)
  522. smctr_model = "8115T rev XE";
  523. else
  524. smctr_model = "8115T rev XD";
  525. break;
  526. default:
  527. smctr_model = "Unknown";
  528. break;
  529. }
  530. return 0;
  531. #else
  532. return -1;
  533. #endif /* CONFIG_MCA_LEGACY */
  534. }
  535. static int smctr_chg_rx_mask(struct net_device *dev)
  536. {
  537. struct net_local *tp = netdev_priv(dev);
  538. int err = 0;
  539. if(smctr_debug > 10)
  540. printk(KERN_DEBUG "%s: smctr_chg_rx_mask\n", dev->name);
  541. smctr_enable_16bit(dev);
  542. smctr_set_page(dev, (__u8 *)tp->ram_access);
  543. if(tp->mode_bits & LOOPING_MODE_MASK)
  544. tp->config_word0 |= RX_OWN_BIT;
  545. else
  546. tp->config_word0 &= ~RX_OWN_BIT;
  547. if(tp->receive_mask & PROMISCUOUS_MODE)
  548. tp->config_word0 |= PROMISCUOUS_BIT;
  549. else
  550. tp->config_word0 &= ~PROMISCUOUS_BIT;
  551. if(tp->receive_mask & ACCEPT_ERR_PACKETS)
  552. tp->config_word0 |= SAVBAD_BIT;
  553. else
  554. tp->config_word0 &= ~SAVBAD_BIT;
  555. if(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES)
  556. tp->config_word0 |= RXATMAC;
  557. else
  558. tp->config_word0 &= ~RXATMAC;
  559. if(tp->receive_mask & ACCEPT_MULTI_PROM)
  560. tp->config_word1 |= MULTICAST_ADDRESS_BIT;
  561. else
  562. tp->config_word1 &= ~MULTICAST_ADDRESS_BIT;
  563. if(tp->receive_mask & ACCEPT_SOURCE_ROUTING_SPANNING)
  564. tp->config_word1 |= SOURCE_ROUTING_SPANNING_BITS;
  565. else
  566. {
  567. if(tp->receive_mask & ACCEPT_SOURCE_ROUTING)
  568. tp->config_word1 |= SOURCE_ROUTING_EXPLORER_BIT;
  569. else
  570. tp->config_word1 &= ~SOURCE_ROUTING_SPANNING_BITS;
  571. }
  572. if((err = smctr_issue_write_word_cmd(dev, RW_CONFIG_REGISTER_0,
  573. &tp->config_word0)))
  574. {
  575. return err;
  576. }
  577. if((err = smctr_issue_write_word_cmd(dev, RW_CONFIG_REGISTER_1,
  578. &tp->config_word1)))
  579. {
  580. return err;
  581. }
  582. smctr_disable_16bit(dev);
  583. return 0;
  584. }
  585. static int smctr_clear_int(struct net_device *dev)
  586. {
  587. struct net_local *tp = netdev_priv(dev);
  588. outb((tp->trc_mask | CSR_CLRTINT), dev->base_addr + CSR);
  589. return 0;
  590. }
  591. static int smctr_clear_trc_reset(int ioaddr)
  592. {
  593. __u8 r;
  594. r = inb(ioaddr + MSR);
  595. outb(~MSR_RST & r, ioaddr + MSR);
  596. return 0;
  597. }
  598. /*
  599. * The inverse routine to smctr_open().
  600. */
  601. static int smctr_close(struct net_device *dev)
  602. {
  603. struct net_local *tp = netdev_priv(dev);
  604. struct sk_buff *skb;
  605. int err;
  606. netif_stop_queue(dev);
  607. tp->cleanup = 1;
  608. /* Check to see if adapter is already in a closed state. */
  609. if(tp->status != OPEN)
  610. return 0;
  611. smctr_enable_16bit(dev);
  612. smctr_set_page(dev, (__u8 *)tp->ram_access);
  613. if((err = smctr_issue_remove_cmd(dev)))
  614. {
  615. smctr_disable_16bit(dev);
  616. return err;
  617. }
  618. for(;;)
  619. {
  620. skb = skb_dequeue(&tp->SendSkbQueue);
  621. if(skb == NULL)
  622. break;
  623. tp->QueueSkb++;
  624. dev_kfree_skb(skb);
  625. }
  626. return 0;
  627. }
  628. static int smctr_decode_firmware(struct net_device *dev,
  629. const struct firmware *fw)
  630. {
  631. struct net_local *tp = netdev_priv(dev);
  632. short bit = 0x80, shift = 12;
  633. DECODE_TREE_NODE *tree;
  634. short branch, tsize;
  635. __u16 buff = 0;
  636. long weight;
  637. __u8 *ucode;
  638. __u16 *mem;
  639. if(smctr_debug > 10)
  640. printk(KERN_DEBUG "%s: smctr_decode_firmware\n", dev->name);
  641. weight = *(long *)(fw->data + WEIGHT_OFFSET);
  642. tsize = *(__u8 *)(fw->data + TREE_SIZE_OFFSET);
  643. tree = (DECODE_TREE_NODE *)(fw->data + TREE_OFFSET);
  644. ucode = (__u8 *)(fw->data + TREE_OFFSET
  645. + (tsize * sizeof(DECODE_TREE_NODE)));
  646. mem = (__u16 *)(tp->ram_access);
  647. while(weight)
  648. {
  649. branch = ROOT;
  650. while((tree + branch)->tag != LEAF && weight)
  651. {
  652. branch = *ucode & bit ? (tree + branch)->llink
  653. : (tree + branch)->rlink;
  654. bit >>= 1;
  655. weight--;
  656. if(bit == 0)
  657. {
  658. bit = 0x80;
  659. ucode++;
  660. }
  661. }
  662. buff |= (tree + branch)->info << shift;
  663. shift -= 4;
  664. if(shift < 0)
  665. {
  666. *(mem++) = SWAP_BYTES(buff);
  667. buff = 0;
  668. shift = 12;
  669. }
  670. }
  671. /* The following assumes the Control Store Memory has
  672. * been initialized to zero. If the last partial word
  673. * is zero, it will not be written.
  674. */
  675. if(buff)
  676. *(mem++) = SWAP_BYTES(buff);
  677. return 0;
  678. }
  679. static int smctr_disable_16bit(struct net_device *dev)
  680. {
  681. return 0;
  682. }
  683. /*
  684. * On Exit, Adapter is:
  685. * 1. TRC is in a reset state and un-initialized.
  686. * 2. Adapter memory is enabled.
  687. * 3. Control Store memory is out of context (-WCSS is 1).
  688. */
  689. static int smctr_disable_adapter_ctrl_store(struct net_device *dev)
  690. {
  691. struct net_local *tp = netdev_priv(dev);
  692. int ioaddr = dev->base_addr;
  693. if(smctr_debug > 10)
  694. printk(KERN_DEBUG "%s: smctr_disable_adapter_ctrl_store\n", dev->name);
  695. tp->trc_mask |= CSR_WCSS;
  696. outb(tp->trc_mask, ioaddr + CSR);
  697. return 0;
  698. }
  699. static int smctr_disable_bic_int(struct net_device *dev)
  700. {
  701. struct net_local *tp = netdev_priv(dev);
  702. int ioaddr = dev->base_addr;
  703. tp->trc_mask = CSR_MSK_ALL | CSR_MSKCBUSY
  704. | CSR_MSKTINT | CSR_WCSS;
  705. outb(tp->trc_mask, ioaddr + CSR);
  706. return 0;
  707. }
  708. static int smctr_enable_16bit(struct net_device *dev)
  709. {
  710. struct net_local *tp = netdev_priv(dev);
  711. __u8 r;
  712. if(tp->adapter_bus == BUS_ISA16_TYPE)
  713. {
  714. r = inb(dev->base_addr + LAAR);
  715. outb((r | LAAR_MEM16ENB), dev->base_addr + LAAR);
  716. }
  717. return 0;
  718. }
  719. /*
  720. * To enable the adapter control store memory:
  721. * 1. Adapter must be in a RESET state.
  722. * 2. Adapter memory must be enabled.
  723. * 3. Control Store Memory is in context (-WCSS is 0).
  724. */
  725. static int smctr_enable_adapter_ctrl_store(struct net_device *dev)
  726. {
  727. struct net_local *tp = netdev_priv(dev);
  728. int ioaddr = dev->base_addr;
  729. if(smctr_debug > 10)
  730. printk(KERN_DEBUG "%s: smctr_enable_adapter_ctrl_store\n", dev->name);
  731. smctr_set_trc_reset(ioaddr);
  732. smctr_enable_adapter_ram(dev);
  733. tp->trc_mask &= ~CSR_WCSS;
  734. outb(tp->trc_mask, ioaddr + CSR);
  735. return 0;
  736. }
  737. static int smctr_enable_adapter_ram(struct net_device *dev)
  738. {
  739. int ioaddr = dev->base_addr;
  740. __u8 r;
  741. if(smctr_debug > 10)
  742. printk(KERN_DEBUG "%s: smctr_enable_adapter_ram\n", dev->name);
  743. r = inb(ioaddr + MSR);
  744. outb(MSR_MEMB | r, ioaddr + MSR);
  745. return 0;
  746. }
  747. static int smctr_enable_bic_int(struct net_device *dev)
  748. {
  749. struct net_local *tp = netdev_priv(dev);
  750. int ioaddr = dev->base_addr;
  751. __u8 r;
  752. switch(tp->bic_type)
  753. {
  754. case (BIC_584_CHIP):
  755. tp->trc_mask = CSR_MSKCBUSY | CSR_WCSS;
  756. outb(tp->trc_mask, ioaddr + CSR);
  757. r = inb(ioaddr + IRR);
  758. outb(r | IRR_IEN, ioaddr + IRR);
  759. break;
  760. case (BIC_594_CHIP):
  761. tp->trc_mask = CSR_MSKCBUSY | CSR_WCSS;
  762. outb(tp->trc_mask, ioaddr + CSR);
  763. r = inb(ioaddr + IMCCR);
  764. outb(r | IMCCR_EIL, ioaddr + IMCCR);
  765. break;
  766. }
  767. return 0;
  768. }
  769. static int __init smctr_chk_isa(struct net_device *dev)
  770. {
  771. struct net_local *tp = netdev_priv(dev);
  772. int ioaddr = dev->base_addr;
  773. __u8 r1, r2, b, chksum = 0;
  774. __u16 r;
  775. int i;
  776. int err = -ENODEV;
  777. if(smctr_debug > 10)
  778. printk(KERN_DEBUG "%s: smctr_chk_isa %#4x\n", dev->name, ioaddr);
  779. if((ioaddr & 0x1F) != 0)
  780. goto out;
  781. /* Grab the region so that no one else tries to probe our ioports. */
  782. if (!request_region(ioaddr, SMCTR_IO_EXTENT, smctr_name)) {
  783. err = -EBUSY;
  784. goto out;
  785. }
  786. /* Checksum SMC node address */
  787. for(i = 0; i < 8; i++)
  788. {
  789. b = inb(ioaddr + LAR0 + i);
  790. chksum += b;
  791. }
  792. if (chksum != NODE_ADDR_CKSUM)
  793. goto out2;
  794. b = inb(ioaddr + BDID);
  795. if(b != BRD_ID_8115T)
  796. {
  797. printk(KERN_ERR "%s: The adapter found is not supported\n", dev->name);
  798. goto out2;
  799. }
  800. /* Check for 8115T Board ID */
  801. r2 = 0;
  802. for(r = 0; r < 8; r++)
  803. {
  804. r1 = inb(ioaddr + 0x8 + r);
  805. r2 += r1;
  806. }
  807. /* value of RegF adds up the sum to 0xFF */
  808. if((r2 != 0xFF) && (r2 != 0xEE))
  809. goto out2;
  810. /* Get adapter ID */
  811. tp->board_id = smctr_get_boardid(dev, 0);
  812. switch(tp->board_id & 0xffff)
  813. {
  814. case WD8115TA:
  815. smctr_model = "8115T/A";
  816. break;
  817. case WD8115T:
  818. if(tp->extra_info & CHIP_REV_MASK)
  819. smctr_model = "8115T rev XE";
  820. else
  821. smctr_model = "8115T rev XD";
  822. break;
  823. default:
  824. smctr_model = "Unknown";
  825. break;
  826. }
  827. /* Store BIC type. */
  828. tp->bic_type = BIC_584_CHIP;
  829. tp->nic_type = NIC_825_CHIP;
  830. /* Copy Ram Size */
  831. tp->ram_usable = CNFG_SIZE_16KB;
  832. tp->ram_size = CNFG_SIZE_64KB;
  833. /* Get 58x Ram Base */
  834. r1 = inb(ioaddr);
  835. r1 &= 0x3F;
  836. r2 = inb(ioaddr + CNFG_LAAR_584);
  837. r2 &= CNFG_LAAR_MASK;
  838. r2 <<= 3;
  839. r2 |= ((r1 & 0x38) >> 3);
  840. tp->ram_base = ((__u32)r2 << 16) + (((__u32)(r1 & 0x7)) << 13);
  841. /* Get 584 Irq */
  842. r1 = 0;
  843. r1 = inb(ioaddr + CNFG_ICR_583);
  844. r1 &= CNFG_ICR_IR2_584;
  845. r2 = inb(ioaddr + CNFG_IRR_583);
  846. r2 &= CNFG_IRR_IRQS; /* 0x60 */
  847. r2 >>= 5;
  848. switch(r2)
  849. {
  850. case 0:
  851. if(r1 == 0)
  852. dev->irq = 2;
  853. else
  854. dev->irq = 10;
  855. break;
  856. case 1:
  857. if(r1 == 0)
  858. dev->irq = 3;
  859. else
  860. dev->irq = 11;
  861. break;
  862. case 2:
  863. if(r1 == 0)
  864. {
  865. if(tp->extra_info & ALTERNATE_IRQ_BIT)
  866. dev->irq = 5;
  867. else
  868. dev->irq = 4;
  869. }
  870. else
  871. dev->irq = 15;
  872. break;
  873. case 3:
  874. if(r1 == 0)
  875. dev->irq = 7;
  876. else
  877. dev->irq = 4;
  878. break;
  879. default:
  880. printk(KERN_ERR "%s: No IRQ found aborting\n", dev->name);
  881. goto out2;
  882. }
  883. if (request_irq(dev->irq, smctr_interrupt, IRQF_SHARED, smctr_name, dev))
  884. goto out2;
  885. /* Get 58x Rom Base */
  886. r1 = inb(ioaddr + CNFG_BIO_583);
  887. r1 &= 0x3E;
  888. r1 |= 0x40;
  889. tp->rom_base = (__u32)r1 << 13;
  890. /* Get 58x Rom Size */
  891. r1 = inb(ioaddr + CNFG_BIO_583);
  892. r1 &= 0xC0;
  893. if(r1 == 0)
  894. tp->rom_size = ROM_DISABLE;
  895. else
  896. {
  897. r1 >>= 6;
  898. tp->rom_size = (__u16)CNFG_SIZE_8KB << r1;
  899. }
  900. /* Get 58x Boot Status */
  901. r1 = inb(ioaddr + CNFG_GP2);
  902. tp->mode_bits &= (~BOOT_STATUS_MASK);
  903. if(r1 & CNFG_GP2_BOOT_NIBBLE)
  904. tp->mode_bits |= BOOT_TYPE_1;
  905. /* Get 58x Zero Wait State */
  906. tp->mode_bits &= (~ZERO_WAIT_STATE_MASK);
  907. r1 = inb(ioaddr + CNFG_IRR_583);
  908. if(r1 & CNFG_IRR_ZWS)
  909. tp->mode_bits |= ZERO_WAIT_STATE_8_BIT;
  910. if(tp->board_id & BOARD_16BIT)
  911. {
  912. r1 = inb(ioaddr + CNFG_LAAR_584);
  913. if(r1 & CNFG_LAAR_ZWS)
  914. tp->mode_bits |= ZERO_WAIT_STATE_16_BIT;
  915. }
  916. /* Get 584 Media Menu */
  917. tp->media_menu = 14;
  918. r1 = inb(ioaddr + CNFG_IRR_583);
  919. tp->mode_bits &= 0xf8ff; /* (~CNFG_INTERFACE_TYPE_MASK) */
  920. if((tp->board_id & TOKEN_MEDIA) == TOKEN_MEDIA)
  921. {
  922. /* Get Advanced Features */
  923. if(((r1 & 0x6) >> 1) == 0x3)
  924. tp->media_type |= MEDIA_UTP_16;
  925. else
  926. {
  927. if(((r1 & 0x6) >> 1) == 0x2)
  928. tp->media_type |= MEDIA_STP_16;
  929. else
  930. {
  931. if(((r1 & 0x6) >> 1) == 0x1)
  932. tp->media_type |= MEDIA_UTP_4;
  933. else
  934. tp->media_type |= MEDIA_STP_4;
  935. }
  936. }
  937. r1 = inb(ioaddr + CNFG_GP2);
  938. if(!(r1 & 0x2) ) /* GP2_ETRD */
  939. tp->mode_bits |= EARLY_TOKEN_REL;
  940. /* see if the chip is corrupted
  941. if(smctr_read_584_chksum(ioaddr))
  942. {
  943. printk(KERN_ERR "%s: EEPROM Checksum Failure\n", dev->name);
  944. free_irq(dev->irq, dev);
  945. goto out2;
  946. }
  947. */
  948. }
  949. return 0;
  950. out2:
  951. release_region(ioaddr, SMCTR_IO_EXTENT);
  952. out:
  953. return err;
  954. }
  955. static int __init smctr_get_boardid(struct net_device *dev, int mca)
  956. {
  957. struct net_local *tp = netdev_priv(dev);
  958. int ioaddr = dev->base_addr;
  959. __u8 r, r1, IdByte;
  960. __u16 BoardIdMask;
  961. tp->board_id = BoardIdMask = 0;
  962. if(mca)
  963. {
  964. BoardIdMask |= (MICROCHANNEL+INTERFACE_CHIP+TOKEN_MEDIA+PAGED_RAM+BOARD_16BIT);
  965. tp->extra_info |= (INTERFACE_594_CHIP+RAM_SIZE_64K+NIC_825_BIT+ALTERNATE_IRQ_BIT+SLOT_16BIT);
  966. }
  967. else
  968. {
  969. BoardIdMask|=(INTERFACE_CHIP+TOKEN_MEDIA+PAGED_RAM+BOARD_16BIT);
  970. tp->extra_info |= (INTERFACE_584_CHIP + RAM_SIZE_64K
  971. + NIC_825_BIT + ALTERNATE_IRQ_BIT);
  972. }
  973. if(!mca)
  974. {
  975. r = inb(ioaddr + BID_REG_1);
  976. r &= 0x0c;
  977. outb(r, ioaddr + BID_REG_1);
  978. r = inb(ioaddr + BID_REG_1);
  979. if(r & BID_SIXTEEN_BIT_BIT)
  980. {
  981. tp->extra_info |= SLOT_16BIT;
  982. tp->adapter_bus = BUS_ISA16_TYPE;
  983. }
  984. else
  985. tp->adapter_bus = BUS_ISA8_TYPE;
  986. }
  987. else
  988. tp->adapter_bus = BUS_MCA_TYPE;
  989. /* Get Board Id Byte */
  990. IdByte = inb(ioaddr + BID_BOARD_ID_BYTE);
  991. /* if Major version > 1.0 then
  992. * return;
  993. */
  994. if(IdByte & 0xF8)
  995. return -1;
  996. r1 = inb(ioaddr + BID_REG_1);
  997. r1 &= BID_ICR_MASK;
  998. r1 |= BID_OTHER_BIT;
  999. outb(r1, ioaddr + BID_REG_1);
  1000. r1 = inb(ioaddr + BID_REG_3);
  1001. r1 &= BID_EAR_MASK;
  1002. r1 |= BID_ENGR_PAGE;
  1003. outb(r1, ioaddr + BID_REG_3);
  1004. r1 = inb(ioaddr + BID_REG_1);
  1005. r1 &= BID_ICR_MASK;
  1006. r1 |= (BID_RLA | BID_OTHER_BIT);
  1007. outb(r1, ioaddr + BID_REG_1);
  1008. r1 = inb(ioaddr + BID_REG_1);
  1009. while(r1 & BID_RECALL_DONE_MASK)
  1010. r1 = inb(ioaddr + BID_REG_1);
  1011. r = inb(ioaddr + BID_LAR_0 + BID_REG_6);
  1012. /* clear chip rev bits */
  1013. tp->extra_info &= ~CHIP_REV_MASK;
  1014. tp->extra_info |= ((r & BID_EEPROM_CHIP_REV_MASK) << 6);
  1015. r1 = inb(ioaddr + BID_REG_1);
  1016. r1 &= BID_ICR_MASK;
  1017. r1 |= BID_OTHER_BIT;
  1018. outb(r1, ioaddr + BID_REG_1);
  1019. r1 = inb(ioaddr + BID_REG_3);
  1020. r1 &= BID_EAR_MASK;
  1021. r1 |= BID_EA6;
  1022. outb(r1, ioaddr + BID_REG_3);
  1023. r1 = inb(ioaddr + BID_REG_1);
  1024. r1 &= BID_ICR_MASK;
  1025. r1 |= BID_RLA;
  1026. outb(r1, ioaddr + BID_REG_1);
  1027. r1 = inb(ioaddr + BID_REG_1);
  1028. while(r1 & BID_RECALL_DONE_MASK)
  1029. r1 = inb(ioaddr + BID_REG_1);
  1030. return BoardIdMask;
  1031. }
  1032. static int smctr_get_group_address(struct net_device *dev)
  1033. {
  1034. smctr_issue_read_word_cmd(dev, RW_INDIVIDUAL_GROUP_ADDR);
  1035. return smctr_wait_cmd(dev);
  1036. }
  1037. static int smctr_get_functional_address(struct net_device *dev)
  1038. {
  1039. smctr_issue_read_word_cmd(dev, RW_FUNCTIONAL_ADDR);
  1040. return smctr_wait_cmd(dev);
  1041. }
  1042. /* Calculate number of Non-MAC receive BDB's and data buffers.
  1043. * This function must simulate allocateing shared memory exactly
  1044. * as the allocate_shared_memory function above.
  1045. */
  1046. static unsigned int smctr_get_num_rx_bdbs(struct net_device *dev)
  1047. {
  1048. struct net_local *tp = netdev_priv(dev);
  1049. unsigned int mem_used = 0;
  1050. /* Allocate System Control Blocks. */
  1051. mem_used += sizeof(SCGBlock);
  1052. mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
  1053. mem_used += sizeof(SCLBlock);
  1054. mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
  1055. mem_used += sizeof(ACBlock) * tp->num_acbs;
  1056. mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
  1057. mem_used += sizeof(ISBlock);
  1058. mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
  1059. mem_used += MISC_DATA_SIZE;
  1060. /* Allocate transmit FCB's. */
  1061. mem_used += TO_PARAGRAPH_BOUNDRY(mem_used);
  1062. mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[MAC_QUEUE];
  1063. mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[NON_MAC_QUEUE];
  1064. mem_used += sizeof(FCBlock) * tp->num_tx_fcbs[BUG_QUEUE];
  1065. /* Allocate transmit BDBs. */
  1066. mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[MAC_QUEUE];
  1067. mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[NON_MAC_QUEUE];
  1068. mem_used += sizeof(BDBlock) * tp->num_tx_bdbs[BUG_QUEUE];
  1069. /* Allocate receive FCBs. */
  1070. mem_used += sizeof(FCBlock) * tp->num_rx_fcbs[MAC_QUEUE];
  1071. mem_used += sizeof(FCBlock) * tp->num_rx_fcbs[NON_MAC_QUEUE];
  1072. /* Allocate receive BDBs. */
  1073. mem_used += sizeof(BDBlock) * tp->num_rx_bdbs[MAC_QUEUE];
  1074. /* Allocate MAC transmit buffers.
  1075. * MAC transmit buffers don't have to be on an ODD Boundary.
  1076. */
  1077. mem_used += tp->tx_buff_size[MAC_QUEUE];
  1078. /* Allocate BUG transmit buffers. */
  1079. mem_used += tp->tx_buff_size[BUG_QUEUE];
  1080. /* Allocate MAC receive data buffers.
  1081. * MAC receive buffers don't have to be on a 256 byte boundary.
  1082. */
  1083. mem_used += RX_DATA_BUFFER_SIZE * tp->num_rx_bdbs[MAC_QUEUE];
  1084. /* Allocate Non-MAC transmit buffers.
  1085. * For maximum Netware performance, put Tx Buffers on
  1086. * ODD Boundary,and then restore malloc to Even Boundrys.
  1087. */
  1088. mem_used += 1L;
  1089. mem_used += tp->tx_buff_size[NON_MAC_QUEUE];
  1090. mem_used += 1L;
  1091. /* CALCULATE NUMBER OF NON-MAC RX BDB'S
  1092. * AND NON-MAC RX DATA BUFFERS
  1093. *
  1094. * Make sure the mem_used offset at this point is the
  1095. * same as in allocate_shared memory or the following
  1096. * boundary adjustment will be incorrect (i.e. not allocating
  1097. * the non-mac receive buffers above cannot change the 256
  1098. * byte offset).
  1099. *
  1100. * Since this cannot be guaranteed, adding the full 256 bytes
  1101. * to the amount of shared memory used at this point will guaranteed
  1102. * that the rx data buffers do not overflow shared memory.
  1103. */
  1104. mem_used += 0x100;
  1105. return (0xffff - mem_used) / (RX_DATA_BUFFER_SIZE + sizeof(BDBlock));
  1106. }
  1107. static int smctr_get_physical_drop_number(struct net_device *dev)
  1108. {
  1109. smctr_issue_read_word_cmd(dev, RW_PHYSICAL_DROP_NUMBER);
  1110. return smctr_wait_cmd(dev);
  1111. }
  1112. static __u8 * smctr_get_rx_pointer(struct net_device *dev, short queue)
  1113. {
  1114. struct net_local *tp = netdev_priv(dev);
  1115. BDBlock *bdb;
  1116. bdb = (BDBlock *)((__u32)tp->ram_access
  1117. + (__u32)(tp->rx_fcb_curr[queue]->trc_bdb_ptr));
  1118. tp->rx_fcb_curr[queue]->bdb_ptr = bdb;
  1119. return (__u8 *)bdb->data_block_ptr;
  1120. }
  1121. static int smctr_get_station_id(struct net_device *dev)
  1122. {
  1123. smctr_issue_read_word_cmd(dev, RW_INDIVIDUAL_MAC_ADDRESS);
  1124. return smctr_wait_cmd(dev);
  1125. }
  1126. /*
  1127. * Get the current statistics. This may be called with the card open
  1128. * or closed.
  1129. */
  1130. static struct net_device_stats *smctr_get_stats(struct net_device *dev)
  1131. {
  1132. struct net_local *tp = netdev_priv(dev);
  1133. return (struct net_device_stats *)&tp->MacStat;
  1134. }
  1135. static FCBlock *smctr_get_tx_fcb(struct net_device *dev, __u16 queue,
  1136. __u16 bytes_count)
  1137. {
  1138. struct net_local *tp = netdev_priv(dev);
  1139. FCBlock *pFCB;
  1140. BDBlock *pbdb;
  1141. unsigned short alloc_size;
  1142. unsigned short *temp;
  1143. if(smctr_debug > 20)
  1144. printk(KERN_DEBUG "smctr_get_tx_fcb\n");
  1145. /* check if there is enough FCB blocks */
  1146. if(tp->num_tx_fcbs_used[queue] >= tp->num_tx_fcbs[queue])
  1147. return (FCBlock *)(-1L);
  1148. /* round off the input pkt size to the nearest even number */
  1149. alloc_size = (bytes_count + 1) & 0xfffe;
  1150. /* check if enough mem */
  1151. if((tp->tx_buff_used[queue] + alloc_size) > tp->tx_buff_size[queue])
  1152. return (FCBlock *)(-1L);
  1153. /* check if past the end ;
  1154. * if exactly enough mem to end of ring, alloc from front.
  1155. * this avoids update of curr when curr = end
  1156. */
  1157. if(((unsigned long)(tp->tx_buff_curr[queue]) + alloc_size)
  1158. >= (unsigned long)(tp->tx_buff_end[queue]))
  1159. {
  1160. /* check if enough memory from ring head */
  1161. alloc_size = alloc_size +
  1162. (__u16)((__u32)tp->tx_buff_end[queue]
  1163. - (__u32)tp->tx_buff_curr[queue]);
  1164. if((tp->tx_buff_used[queue] + alloc_size)
  1165. > tp->tx_buff_size[queue])
  1166. {
  1167. return (FCBlock *)(-1L);
  1168. }
  1169. /* ring wrap */
  1170. tp->tx_buff_curr[queue] = tp->tx_buff_head[queue];
  1171. }
  1172. tp->tx_buff_used[queue] += alloc_size;
  1173. tp->num_tx_fcbs_used[queue]++;
  1174. tp->tx_fcb_curr[queue]->frame_length = bytes_count;
  1175. tp->tx_fcb_curr[queue]->memory_alloc = alloc_size;
  1176. temp = tp->tx_buff_curr[queue];
  1177. tp->tx_buff_curr[queue]
  1178. = (__u16 *)((__u32)temp + (__u32)((bytes_count + 1) & 0xfffe));
  1179. pbdb = tp->tx_fcb_curr[queue]->bdb_ptr;
  1180. pbdb->buffer_length = bytes_count;
  1181. pbdb->data_block_ptr = temp;
  1182. pbdb->trc_data_block_ptr = TRC_POINTER(temp);
  1183. pFCB = tp->tx_fcb_curr[queue];
  1184. tp->tx_fcb_curr[queue] = tp->tx_fcb_curr[queue]->next_ptr;
  1185. return pFCB;
  1186. }
  1187. static int smctr_get_upstream_neighbor_addr(struct net_device *dev)
  1188. {
  1189. smctr_issue_read_word_cmd(dev, RW_UPSTREAM_NEIGHBOR_ADDRESS);
  1190. return smctr_wait_cmd(dev);
  1191. }
  1192. static int smctr_hardware_send_packet(struct net_device *dev,
  1193. struct net_local *tp)
  1194. {
  1195. struct tr_statistics *tstat = &tp->MacStat;
  1196. struct sk_buff *skb;
  1197. FCBlock *fcb;
  1198. if(smctr_debug > 10)
  1199. printk(KERN_DEBUG"%s: smctr_hardware_send_packet\n", dev->name);
  1200. if(tp->status != OPEN)
  1201. return -1;
  1202. if(tp->monitor_state_ready != 1)
  1203. return -1;
  1204. for(;;)
  1205. {
  1206. /* Send first buffer from queue */
  1207. skb = skb_dequeue(&tp->SendSkbQueue);
  1208. if(skb == NULL)
  1209. return -1;
  1210. tp->QueueSkb++;
  1211. if(skb->len < SMC_HEADER_SIZE || skb->len > tp->max_packet_size)
  1212. return -1;
  1213. smctr_enable_16bit(dev);
  1214. smctr_set_page(dev, (__u8 *)tp->ram_access);
  1215. if((fcb = smctr_get_tx_fcb(dev, NON_MAC_QUEUE, skb->len))
  1216. == (FCBlock *)(-1L))
  1217. {
  1218. smctr_disable_16bit(dev);
  1219. return -1;
  1220. }
  1221. smctr_tx_move_frame(dev, skb,
  1222. (__u8 *)fcb->bdb_ptr->data_block_ptr, skb->len);
  1223. smctr_set_page(dev, (__u8 *)fcb);
  1224. smctr_trc_send_packet(dev, fcb, NON_MAC_QUEUE);
  1225. dev_kfree_skb(skb);
  1226. tstat->tx_packets++;
  1227. smctr_disable_16bit(dev);
  1228. }
  1229. return 0;
  1230. }
  1231. static int smctr_init_acbs(struct net_device *dev)
  1232. {
  1233. struct net_local *tp = netdev_priv(dev);
  1234. unsigned int i;
  1235. ACBlock *acb;
  1236. if(smctr_debug > 10)
  1237. printk(KERN_DEBUG "%s: smctr_init_acbs\n", dev->name);
  1238. acb = tp->acb_head;
  1239. acb->cmd_done_status = (ACB_COMMAND_DONE | ACB_COMMAND_SUCCESSFUL);
  1240. acb->cmd_info = ACB_CHAIN_END;
  1241. acb->cmd = 0;
  1242. acb->subcmd = 0;
  1243. acb->data_offset_lo = 0;
  1244. acb->data_offset_hi = 0;
  1245. acb->next_ptr
  1246. = (ACBlock *)(((char *)acb) + sizeof(ACBlock));
  1247. acb->trc_next_ptr = TRC_POINTER(acb->next_ptr);
  1248. for(i = 1; i < tp->num_acbs; i++)
  1249. {
  1250. acb = acb->next_ptr;
  1251. acb->cmd_done_status
  1252. = (ACB_COMMAND_DONE | ACB_COMMAND_SUCCESSFUL);
  1253. acb->cmd_info = ACB_CHAIN_END;
  1254. acb->cmd = 0;
  1255. acb->subcmd = 0;
  1256. acb->data_offset_lo = 0;
  1257. acb->data_offset_hi = 0;
  1258. acb->next_ptr
  1259. = (ACBlock *)(((char *)acb) + sizeof(ACBlock));
  1260. acb->trc_next_ptr = TRC_POINTER(acb->next_ptr);
  1261. }
  1262. acb->next_ptr = tp->acb_head;
  1263. acb->trc_next_ptr = TRC_POINTER(tp->acb_head);
  1264. tp->acb_next = tp->acb_head->next_ptr;
  1265. tp->acb_curr = tp->acb_head->next_ptr;
  1266. tp->num_acbs_used = 0;
  1267. return 0;
  1268. }
  1269. static int smctr_init_adapter(struct net_device *dev)
  1270. {
  1271. struct net_local *tp = netdev_priv(dev);
  1272. int err;
  1273. if(smctr_debug > 10)
  1274. printk(KERN_DEBUG "%s: smctr_init_adapter\n", dev->name);
  1275. tp->status = CLOSED;
  1276. tp->page_offset_mask = (tp->ram_usable * 1024) - 1;
  1277. skb_queue_head_init(&tp->SendSkbQueue);
  1278. tp->QueueSkb = MAX_TX_QUEUE;
  1279. if(!(tp->group_address_0 & 0x0080))
  1280. tp->group_address_0 |= 0x00C0;
  1281. if(!(tp->functional_address_0 & 0x00C0))
  1282. tp->functional_address_0 |= 0x00C0;
  1283. tp->functional_address[0] &= 0xFF7F;
  1284. if(tp->authorized_function_classes == 0)
  1285. tp->authorized_function_classes = 0x7FFF;
  1286. if(tp->authorized_access_priority == 0)
  1287. tp->authorized_access_priority = 0x06;
  1288. smctr_disable_bic_int(dev);
  1289. smctr_set_trc_reset(dev->base_addr);
  1290. smctr_enable_16bit(dev);
  1291. smctr_set_page(dev, (__u8 *)tp->ram_access);
  1292. if(smctr_checksum_firmware(dev))
  1293. {
  1294. printk(KERN_ERR "%s: Previously loaded firmware is missing\n",dev->name);
  1295. return -ENOENT;
  1296. }
  1297. if((err = smctr_ram_memory_test(dev)))
  1298. {
  1299. printk(KERN_ERR "%s: RAM memory test failed.\n", dev->name);
  1300. return -EIO;
  1301. }
  1302. smctr_set_rx_look_ahead(dev);
  1303. smctr_load_node_addr(dev);
  1304. /* Initialize adapter for Internal Self Test. */
  1305. smctr_reset_adapter(dev);
  1306. if((err = smctr_init_card_real(dev)))
  1307. {
  1308. printk(KERN_ERR "%s: Initialization of card failed (%d)\n",
  1309. dev->name, err);
  1310. return -EINVAL;
  1311. }
  1312. /* This routine clobbers the TRC's internal registers. */
  1313. if((err = smctr_internal_self_test(dev)))
  1314. {
  1315. printk(KERN_ERR "%s: Card failed internal self test (%d)\n",
  1316. dev->name, err);
  1317. return -EINVAL;
  1318. }
  1319. /* Re-Initialize adapter's internal registers */
  1320. smctr_reset_adapter(dev);
  1321. if((err = smctr_init_card_real(dev)))
  1322. {
  1323. printk(KERN_ERR "%s: Initialization of card failed (%d)\n",
  1324. dev->name, err);
  1325. return -EINVAL;
  1326. }
  1327. smctr_enable_bic_int(dev);
  1328. if((err = smctr_issue_enable_int_cmd(dev, TRC_INTERRUPT_ENABLE_MASK)))
  1329. return err;
  1330. smctr_disable_16bit(dev);
  1331. return 0;
  1332. }
  1333. static int smctr_init_card_real(struct net_device *dev)
  1334. {
  1335. struct net_local *tp = netdev_priv(dev);
  1336. int err = 0;
  1337. if(smctr_debug > 10)
  1338. printk(KERN_DEBUG "%s: smctr_init_card_real\n", dev->name);
  1339. tp->sh_mem_used = 0;
  1340. tp->num_acbs = NUM_OF_ACBS;
  1341. /* Range Check Max Packet Size */
  1342. if(tp->max_packet_size < 256)
  1343. tp->max_packet_size = 256;
  1344. else
  1345. {
  1346. if(tp->max_packet_size > NON_MAC_TX_BUFFER_MEMORY)
  1347. tp->max_packet_size = NON_MAC_TX_BUFFER_MEMORY;
  1348. }
  1349. tp->num_of_tx_buffs = (NON_MAC_TX_BUFFER_MEMORY
  1350. / tp->max_packet_size) - 1;
  1351. if(tp->num_of_tx_buffs > NUM_NON_MAC_TX_FCBS)
  1352. tp->num_of_tx_buffs = NUM_NON_MAC_TX_FCBS;
  1353. else
  1354. {
  1355. if(tp->num_of_tx_buffs == 0)
  1356. tp->num_of_tx_buffs = 1;
  1357. }
  1358. /* Tx queue constants */
  1359. tp->num_tx_fcbs [BUG_QUEUE] = NUM_BUG_TX_FCBS;
  1360. tp->num_tx_bdbs [BUG_QUEUE] = NUM_BUG_TX_BDBS;
  1361. tp->tx_buff_size [BUG_QUEUE] = BUG_TX_BUFFER_MEMORY;
  1362. tp->tx_buff_used [BUG_QUEUE] = 0;
  1363. tp->tx_queue_status [BUG_QUEUE] = NOT_TRANSMITING;
  1364. tp->num_tx_fcbs [MAC_QUEUE] = NUM_MAC_TX_FCBS;
  1365. tp->num_tx_bdbs [MAC_QUEUE] = NUM_MAC_TX_BDBS;
  1366. tp->tx_buff_size [MAC_QUEUE] = MAC_TX_BUFFER_MEMORY;
  1367. tp->tx_buff_used [MAC_QUEUE] = 0;
  1368. tp->tx_queue_status [MAC_QUEUE] = NOT_TRANSMITING;
  1369. tp->num_tx_fcbs [NON_MAC_QUEUE] = NUM_NON_MAC_TX_FCBS;
  1370. tp->num_tx_bdbs [NON_MAC_QUEUE] = NUM_NON_MAC_TX_BDBS;
  1371. tp->tx_buff_size [NON_MAC_QUEUE] = NON_MAC_TX_BUFFER_MEMORY;
  1372. tp->tx_buff_used [NON_MAC_QUEUE] = 0;
  1373. tp->tx_queue_status [NON_MAC_QUEUE] = NOT_TRANSMITING;
  1374. /* Receive Queue Constants */
  1375. tp->num_rx_fcbs[MAC_QUEUE] = NUM_MAC_RX_FCBS;
  1376. tp->num_rx_bdbs[MAC_QUEUE] = NUM_MAC_RX_BDBS;
  1377. if(tp->extra_info & CHIP_REV_MASK)
  1378. tp->num_rx_fcbs[NON_MAC_QUEUE] = 78; /* 825 Rev. XE */
  1379. else
  1380. tp->num_rx_fcbs[NON_MAC_QUEUE] = 7; /* 825 Rev. XD */
  1381. tp->num_rx_bdbs[NON_MAC_QUEUE] = smctr_get_num_rx_bdbs(dev);
  1382. smctr_alloc_shared_memory(dev);
  1383. smctr_init_shared_memory(dev);
  1384. if((err = smctr_issue_init_timers_cmd(dev)))
  1385. return err;
  1386. if((err = smctr_issue_init_txrx_cmd(dev)))
  1387. {
  1388. printk(KERN_ERR "%s: Hardware failure\n", dev->name);
  1389. return err;
  1390. }
  1391. return 0;
  1392. }
  1393. static int smctr_init_rx_bdbs(struct net_device *dev)
  1394. {
  1395. struct net_local *tp = netdev_priv(dev);
  1396. unsigned int i, j;
  1397. BDBlock *bdb;
  1398. __u16 *buf;
  1399. if(smctr_debug > 10)
  1400. printk(KERN_DEBUG "%s: smctr_init_rx_bdbs\n", dev->name);
  1401. for(i = 0; i < NUM_RX_QS_USED; i++)
  1402. {
  1403. bdb = tp->rx_bdb_head[i];
  1404. buf = tp->rx_buff_head[i];
  1405. bdb->info = (BDB_CHAIN_END | BDB_NO_WARNING);
  1406. bdb->buffer_length = RX_DATA_BUFFER_SIZE;
  1407. bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock));
  1408. bdb->data_block_ptr = buf;
  1409. bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr);
  1410. if(i == NON_MAC_QUEUE)
  1411. bdb->trc_data_block_ptr = RX_BUFF_TRC_POINTER(buf);
  1412. else
  1413. bdb->trc_data_block_ptr = TRC_POINTER(buf);
  1414. for(j = 1; j < tp->num_rx_bdbs[i]; j++)
  1415. {
  1416. bdb->next_ptr->back_ptr = bdb;
  1417. bdb = bdb->next_ptr;
  1418. buf = (__u16 *)((char *)buf + RX_DATA_BUFFER_SIZE);
  1419. bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING);
  1420. bdb->buffer_length = RX_DATA_BUFFER_SIZE;
  1421. bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock));
  1422. bdb->data_block_ptr = buf;
  1423. bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr);
  1424. if(i == NON_MAC_QUEUE)
  1425. bdb->trc_data_block_ptr = RX_BUFF_TRC_POINTER(buf);
  1426. else
  1427. bdb->trc_data_block_ptr = TRC_POINTER(buf);
  1428. }
  1429. bdb->next_ptr = tp->rx_bdb_head[i];
  1430. bdb->trc_next_ptr = TRC_POINTER(tp->rx_bdb_head[i]);
  1431. tp->rx_bdb_head[i]->back_ptr = bdb;
  1432. tp->rx_bdb_curr[i] = tp->rx_bdb_head[i]->next_ptr;
  1433. }
  1434. return 0;
  1435. }
  1436. static int smctr_init_rx_fcbs(struct net_device *dev)
  1437. {
  1438. struct net_local *tp = netdev_priv(dev);
  1439. unsigned int i, j;
  1440. FCBlock *fcb;
  1441. for(i = 0; i < NUM_RX_QS_USED; i++)
  1442. {
  1443. fcb = tp->rx_fcb_head[i];
  1444. fcb->frame_status = 0;
  1445. fcb->frame_length = 0;
  1446. fcb->info = FCB_CHAIN_END;
  1447. fcb->next_ptr = (FCBlock *)(((char*)fcb) + sizeof(FCBlock));
  1448. if(i == NON_MAC_QUEUE)
  1449. fcb->trc_next_ptr = RX_FCB_TRC_POINTER(fcb->next_ptr);
  1450. else
  1451. fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr);
  1452. for(j = 1; j < tp->num_rx_fcbs[i]; j++)
  1453. {
  1454. fcb->next_ptr->back_ptr = fcb;
  1455. fcb = fcb->next_ptr;
  1456. fcb->frame_status = 0;
  1457. fcb->frame_length = 0;
  1458. fcb->info = FCB_WARNING;
  1459. fcb->next_ptr
  1460. = (FCBlock *)(((char *)fcb) + sizeof(FCBlock));
  1461. if(i == NON_MAC_QUEUE)
  1462. fcb->trc_next_ptr
  1463. = RX_FCB_TRC_POINTER(fcb->next_ptr);
  1464. else
  1465. fcb->trc_next_ptr
  1466. = TRC_POINTER(fcb->next_ptr);
  1467. }
  1468. fcb->next_ptr = tp->rx_fcb_head[i];
  1469. if(i == NON_MAC_QUEUE)
  1470. fcb->trc_next_ptr = RX_FCB_TRC_POINTER(fcb->next_ptr);
  1471. else
  1472. fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr);
  1473. tp->rx_fcb_head[i]->back_ptr = fcb;
  1474. tp->rx_fcb_curr[i] = tp->rx_fcb_head[i]->next_ptr;
  1475. }
  1476. return 0;
  1477. }
  1478. static int smctr_init_shared_memory(struct net_device *dev)
  1479. {
  1480. struct net_local *tp = netdev_priv(dev);
  1481. unsigned int i;
  1482. __u32 *iscpb;
  1483. if(smctr_debug > 10)
  1484. printk(KERN_DEBUG "%s: smctr_init_shared_memory\n", dev->name);
  1485. smctr_set_page(dev, (__u8 *)(unsigned int)tp->iscpb_ptr);
  1486. /* Initialize Initial System Configuration Point. (ISCP) */
  1487. iscpb = (__u32 *)PAGE_POINTER(&tp->iscpb_ptr->trc_scgb_ptr);
  1488. *iscpb = (__u32)(SWAP_WORDS(TRC_POINTER(tp->scgb_ptr)));
  1489. smctr_set_page(dev, (__u8 *)tp->ram_access);
  1490. /* Initialize System Configuration Pointers. (SCP) */
  1491. tp->scgb_ptr->config = (SCGB_ADDRESS_POINTER_FORMAT
  1492. | SCGB_MULTI_WORD_CONTROL | SCGB_DATA_FORMAT
  1493. | SCGB_BURST_LENGTH);
  1494. tp->scgb_ptr->trc_sclb_ptr = TRC_POINTER(tp->sclb_ptr);
  1495. tp->scgb_ptr->trc_acb_ptr = TRC_POINTER(tp->acb_head);
  1496. tp->scgb_ptr->trc_isb_ptr = TRC_POINTER(tp->isb_ptr);
  1497. tp->scgb_ptr->isbsiz = (sizeof(ISBlock)) - 2;
  1498. /* Initialize System Control Block. (SCB) */
  1499. tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_CMD_NOP;
  1500. tp->sclb_ptr->iack_code = 0;
  1501. tp->sclb_ptr->resume_control = 0;
  1502. tp->sclb_ptr->int_mask_control = 0;
  1503. tp->sclb_ptr->int_mask_state = 0;
  1504. /* Initialize Interrupt Status Block. (ISB) */
  1505. for(i = 0; i < NUM_OF_INTERRUPTS; i++)
  1506. {
  1507. tp->isb_ptr->IStatus[i].IType = 0xf0;
  1508. tp->isb_ptr->IStatus[i].ISubtype = 0;
  1509. }
  1510. tp->current_isb_index = 0;
  1511. /* Initialize Action Command Block. (ACB) */
  1512. smctr_init_acbs(dev);
  1513. /* Initialize transmit FCB's and BDB's. */
  1514. smctr_link_tx_fcbs_to_bdbs(dev);
  1515. smctr_init_tx_bdbs(dev);
  1516. smctr_init_tx_fcbs(dev);
  1517. /* Initialize receive FCB's and BDB's. */
  1518. smctr_init_rx_bdbs(dev);
  1519. smctr_init_rx_fcbs(dev);
  1520. return 0;
  1521. }
  1522. static int smctr_init_tx_bdbs(struct net_device *dev)
  1523. {
  1524. struct net_local *tp = netdev_priv(dev);
  1525. unsigned int i, j;
  1526. BDBlock *bdb;
  1527. for(i = 0; i < NUM_TX_QS_USED; i++)
  1528. {
  1529. bdb = tp->tx_bdb_head[i];
  1530. bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING);
  1531. bdb->next_ptr = (BDBlock *)(((char *)bdb) + sizeof(BDBlock));
  1532. bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr);
  1533. for(j = 1; j < tp->num_tx_bdbs[i]; j++)
  1534. {
  1535. bdb->next_ptr->back_ptr = bdb;
  1536. bdb = bdb->next_ptr;
  1537. bdb->info = (BDB_NOT_CHAIN_END | BDB_NO_WARNING);
  1538. bdb->next_ptr
  1539. = (BDBlock *)(((char *)bdb) + sizeof( BDBlock)); bdb->trc_next_ptr = TRC_POINTER(bdb->next_ptr);
  1540. }
  1541. bdb->next_ptr = tp->tx_bdb_head[i];
  1542. bdb->trc_next_ptr = TRC_POINTER(tp->tx_bdb_head[i]);
  1543. tp->tx_bdb_head[i]->back_ptr = bdb;
  1544. }
  1545. return 0;
  1546. }
  1547. static int smctr_init_tx_fcbs(struct net_device *dev)
  1548. {
  1549. struct net_local *tp = netdev_priv(dev);
  1550. unsigned int i, j;
  1551. FCBlock *fcb;
  1552. for(i = 0; i < NUM_TX_QS_USED; i++)
  1553. {
  1554. fcb = tp->tx_fcb_head[i];
  1555. fcb->frame_status = 0;
  1556. fcb->frame_length = 0;
  1557. fcb->info = FCB_CHAIN_END;
  1558. fcb->next_ptr = (FCBlock *)(((char *)fcb) + sizeof(FCBlock));
  1559. fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr);
  1560. for(j = 1; j < tp->num_tx_fcbs[i]; j++)
  1561. {
  1562. fcb->next_ptr->back_ptr = fcb;
  1563. fcb = fcb->next_ptr;
  1564. fcb->frame_status = 0;
  1565. fcb->frame_length = 0;
  1566. fcb->info = FCB_CHAIN_END;
  1567. fcb->next_ptr
  1568. = (FCBlock *)(((char *)fcb) + sizeof(FCBlock));
  1569. fcb->trc_next_ptr = TRC_POINTER(fcb->next_ptr);
  1570. }
  1571. fcb->next_ptr = tp->tx_fcb_head[i];
  1572. fcb->trc_next_ptr = TRC_POINTER(tp->tx_fcb_head[i]);
  1573. tp->tx_fcb_head[i]->back_ptr = fcb;
  1574. tp->tx_fcb_end[i] = tp->tx_fcb_head[i]->next_ptr;
  1575. tp->tx_fcb_curr[i] = tp->tx_fcb_head[i]->next_ptr;
  1576. tp->num_tx_fcbs_used[i] = 0;
  1577. }
  1578. return 0;
  1579. }
  1580. static int smctr_internal_self_test(struct net_device *dev)
  1581. {
  1582. struct net_local *tp = netdev_priv(dev);
  1583. int err;
  1584. if((err = smctr_issue_test_internal_rom_cmd(dev)))
  1585. return err;
  1586. if((err = smctr_wait_cmd(dev)))
  1587. return err;
  1588. if(tp->acb_head->cmd_done_status & 0xff)
  1589. return -1;
  1590. if((err = smctr_issue_test_hic_cmd(dev)))
  1591. return err;
  1592. if((err = smctr_wait_cmd(dev)))
  1593. return err;
  1594. if(tp->acb_head->cmd_done_status & 0xff)
  1595. return -1;
  1596. if((err = smctr_issue_test_mac_reg_cmd(dev)))
  1597. return err;
  1598. if((err = smctr_wait_cmd(dev)))
  1599. return err;
  1600. if(tp->acb_head->cmd_done_status & 0xff)
  1601. return -1;
  1602. return 0;
  1603. }
  1604. /*
  1605. * The typical workload of the driver: Handle the network interface interrupts.
  1606. */
  1607. static irqreturn_t smctr_interrupt(int irq, void *dev_id)
  1608. {
  1609. struct net_device *dev = dev_id;
  1610. struct net_local *tp;
  1611. int ioaddr;
  1612. __u16 interrupt_unmask_bits = 0, interrupt_ack_code = 0xff00;
  1613. __u16 err1, err = NOT_MY_INTERRUPT;
  1614. __u8 isb_type, isb_subtype;
  1615. __u16 isb_index;
  1616. ioaddr = dev->base_addr;
  1617. tp = netdev_priv(dev);
  1618. if(tp->status == NOT_INITIALIZED)
  1619. return IRQ_NONE;
  1620. spin_lock(&tp->lock);
  1621. smctr_disable_bic_int(dev);
  1622. smctr_enable_16bit(dev);
  1623. smctr_clear_int(dev);
  1624. /* First read the LSB */
  1625. while((tp->isb_ptr->IStatus[tp->current_isb_index].IType & 0xf0) == 0)
  1626. {
  1627. isb_index = tp->current_isb_index;
  1628. isb_type = tp->isb_ptr->IStatus[isb_index].IType;
  1629. isb_subtype = tp->isb_ptr->IStatus[isb_index].ISubtype;
  1630. (tp->current_isb_index)++;
  1631. if(tp->current_isb_index == NUM_OF_INTERRUPTS)
  1632. tp->current_isb_index = 0;
  1633. if(isb_type >= 0x10)
  1634. {
  1635. smctr_disable_16bit(dev);
  1636. spin_unlock(&tp->lock);
  1637. return IRQ_HANDLED;
  1638. }
  1639. err = HARDWARE_FAILED;
  1640. interrupt_ack_code = isb_index;
  1641. tp->isb_ptr->IStatus[isb_index].IType |= 0xf0;
  1642. interrupt_unmask_bits |= (1 << (__u16)isb_type);
  1643. switch(isb_type)
  1644. {
  1645. case ISB_IMC_MAC_TYPE_3:
  1646. smctr_disable_16bit(dev);
  1647. switch(isb_subtype)
  1648. {
  1649. case 0:
  1650. tp->monitor_state = MS_MONITOR_FSM_INACTIVE;
  1651. break;
  1652. case 1:
  1653. tp->monitor_state = MS_REPEAT_BEACON_STATE;
  1654. break;
  1655. case 2:
  1656. tp->monitor_state = MS_REPEAT_CLAIM_TOKEN_STATE;
  1657. break;
  1658. case 3:
  1659. tp->monitor_state = MS_TRANSMIT_CLAIM_TOKEN_STATE; break;
  1660. case 4:
  1661. tp->monitor_state = MS_STANDBY_MONITOR_STATE;
  1662. break;
  1663. case 5:
  1664. tp->monitor_state = MS_TRANSMIT_BEACON_STATE;
  1665. break;
  1666. case 6:
  1667. tp->monitor_state = MS_ACTIVE_MONITOR_STATE;
  1668. break;
  1669. case 7:
  1670. tp->monitor_state = MS_TRANSMIT_RING_PURGE_STATE;
  1671. break;
  1672. case 8: /* diagnostic state */
  1673. break;
  1674. case 9:
  1675. tp->monitor_state = MS_BEACON_TEST_STATE;
  1676. if(smctr_lobe_media_test(dev))
  1677. {
  1678. tp->ring_status_flags = RING_STATUS_CHANGED;
  1679. tp->ring_status = AUTO_REMOVAL_ERROR;
  1680. smctr_ring_status_chg(dev);
  1681. smctr_bypass_state(dev);
  1682. }
  1683. else
  1684. smctr_issue_insert_cmd(dev);
  1685. break;
  1686. /* case 0x0a-0xff, illegal states */
  1687. default:
  1688. break;
  1689. }
  1690. tp->ring_status_flags = MONITOR_STATE_CHANGED;
  1691. err = smctr_ring_status_chg(dev);
  1692. smctr_enable_16bit(dev);
  1693. break;
  1694. /* Type 0x02 - MAC Error Counters Interrupt
  1695. * One or more MAC Error Counter is half full
  1696. * MAC Error Counters
  1697. * Lost_FR_Error_Counter
  1698. * RCV_Congestion_Counter
  1699. * FR_copied_Error_Counter
  1700. * FREQ_Error_Counter
  1701. * Token_Error_Counter
  1702. * Line_Error_Counter
  1703. * Internal_Error_Count
  1704. */
  1705. case ISB_IMC_MAC_ERROR_COUNTERS:
  1706. /* Read 802.5 Error Counters */
  1707. err = smctr_issue_read_ring_status_cmd(dev);
  1708. break;
  1709. /* Type 0x04 - MAC Type 2 Interrupt
  1710. * HOST needs to enqueue MAC Frame for transmission
  1711. * SubType Bit 15 - RQ_INIT_PDU( Request Initialization) * Changed from RQ_INIT_PDU to
  1712. * TRC_Status_Changed_Indicate
  1713. */
  1714. case ISB_IMC_MAC_TYPE_2:
  1715. err = smctr_issue_read_ring_status_cmd(dev);
  1716. break;
  1717. /* Type 0x05 - TX Frame Interrupt (FI). */
  1718. case ISB_IMC_TX_FRAME:
  1719. /* BUG QUEUE for TRC stuck receive BUG */
  1720. if(isb_subtype & TX_PENDING_PRIORITY_2)
  1721. {
  1722. if((err = smctr_tx_complete(dev, BUG_QUEUE)) != SUCCESS)
  1723. break;
  1724. }
  1725. /* NON-MAC frames only */
  1726. if(isb_subtype & TX_PENDING_PRIORITY_1)
  1727. {
  1728. if((err = smctr_tx_complete(dev, NON_MAC_QUEUE)) != SUCCESS)
  1729. break;
  1730. }
  1731. /* MAC frames only */
  1732. if(isb_subtype & TX_PENDING_PRIORITY_0)
  1733. err = smctr_tx_complete(dev, MAC_QUEUE); break;
  1734. /* Type 0x06 - TX END OF QUEUE (FE) */
  1735. case ISB_IMC_END_OF_TX_QUEUE:
  1736. /* BUG queue */
  1737. if(isb_subtype & TX_PENDING_PRIORITY_2)
  1738. {
  1739. /* ok to clear Receive FIFO overrun
  1740. * imask send_BUG now completes.
  1741. */
  1742. interrupt_unmask_bits |= 0x800;
  1743. tp->tx_queue_status[BUG_QUEUE] = NOT_TRANSMITING;
  1744. if((err = smctr_tx_complete(dev, BUG_QUEUE)) != SUCCESS)
  1745. break;
  1746. if((err = smctr_restart_tx_chain(dev, BUG_QUEUE)) != SUCCESS)
  1747. break;
  1748. }
  1749. /* NON-MAC queue only */
  1750. if(isb_subtype & TX_PENDING_PRIORITY_1)
  1751. {
  1752. tp->tx_queue_status[NON_MAC_QUEUE] = NOT_TRANSMITING;
  1753. if((err = smctr_tx_complete(dev, NON_MAC_QUEUE)) != SUCCESS)
  1754. break;
  1755. if((err = smctr_restart_tx_chain(dev, NON_MAC_QUEUE)) != SUCCESS)
  1756. break;
  1757. }
  1758. /* MAC queue only */
  1759. if(isb_subtype & TX_PENDING_PRIORITY_0)
  1760. {
  1761. tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING;
  1762. if((err = smctr_tx_complete(dev, MAC_QUEUE)) != SUCCESS)
  1763. break;
  1764. err = smctr_restart_tx_chain(dev, MAC_QUEUE);
  1765. }
  1766. break;
  1767. /* Type 0x07 - NON-MAC RX Resource Interrupt
  1768. * Subtype bit 12 - (BW) BDB warning
  1769. * Subtype bit 13 - (FW) FCB warning
  1770. * Subtype bit 14 - (BE) BDB End of chain
  1771. * Subtype bit 15 - (FE) FCB End of chain
  1772. */
  1773. case ISB_IMC_NON_MAC_RX_RESOURCE:
  1774. tp->rx_fifo_overrun_count = 0;
  1775. tp->receive_queue_number = NON_MAC_QUEUE;
  1776. err1 = smctr_rx_frame(dev);
  1777. if(isb_subtype & NON_MAC_RX_RESOURCE_FE)
  1778. {
  1779. if((err = smctr_issue_resume_rx_fcb_cmd( dev, NON_MAC_QUEUE)) != SUCCESS) break;
  1780. if(tp->ptr_rx_fcb_overruns)
  1781. (*tp->ptr_rx_fcb_overruns)++;
  1782. }
  1783. if(isb_subtype & NON_MAC_RX_RESOURCE_BE)
  1784. {
  1785. if((err = smctr_issue_resume_rx_bdb_cmd( dev, NON_MAC_QUEUE)) != SUCCESS) break;
  1786. if(tp->ptr_rx_bdb_overruns)
  1787. (*tp->ptr_rx_bdb_overruns)++;
  1788. }
  1789. err = err1;
  1790. break;
  1791. /* Type 0x08 - MAC RX Resource Interrupt
  1792. * Subtype bit 12 - (BW) BDB warning
  1793. * Subtype bit 13 - (FW) FCB warning
  1794. * Subtype bit 14 - (BE) BDB End of chain
  1795. * Subtype bit 15 - (FE) FCB End of chain
  1796. */
  1797. case ISB_IMC_MAC_RX_RESOURCE:
  1798. tp->receive_queue_number = MAC_QUEUE;
  1799. err1 = smctr_rx_frame(dev);
  1800. if(isb_subtype & MAC_RX_RESOURCE_FE)
  1801. {
  1802. if((err = smctr_issue_resume_rx_fcb_cmd( dev, MAC_QUEUE)) != SUCCESS)
  1803. break;
  1804. if(tp->ptr_rx_fcb_overruns)
  1805. (*tp->ptr_rx_fcb_overruns)++;
  1806. }
  1807. if(isb_subtype & MAC_RX_RESOURCE_BE)
  1808. {
  1809. if((err = smctr_issue_resume_rx_bdb_cmd( dev, MAC_QUEUE)) != SUCCESS)
  1810. break;
  1811. if(tp->ptr_rx_bdb_overruns)
  1812. (*tp->ptr_rx_bdb_overruns)++;
  1813. }
  1814. err = err1;
  1815. break;
  1816. /* Type 0x09 - NON_MAC RX Frame Interrupt */
  1817. case ISB_IMC_NON_MAC_RX_FRAME:
  1818. tp->rx_fifo_overrun_count = 0;
  1819. tp->receive_queue_number = NON_MAC_QUEUE;
  1820. err = smctr_rx_frame(dev);
  1821. break;
  1822. /* Type 0x0A - MAC RX Frame Interrupt */
  1823. case ISB_IMC_MAC_RX_FRAME:
  1824. tp->receive_queue_number = MAC_QUEUE;
  1825. err = smctr_rx_frame(dev);
  1826. break;
  1827. /* Type 0x0B - TRC status
  1828. * TRC has encountered an error condition
  1829. * subtype bit 14 - transmit FIFO underrun
  1830. * subtype bit 15 - receive FIFO overrun
  1831. */
  1832. case ISB_IMC_TRC_FIFO_STATUS:
  1833. if(isb_subtype & TRC_FIFO_STATUS_TX_UNDERRUN)
  1834. {
  1835. if(tp->ptr_tx_fifo_underruns)
  1836. (*tp->ptr_tx_fifo_underruns)++;
  1837. }
  1838. if(isb_subtype & TRC_FIFO_STATUS_RX_OVERRUN)
  1839. {
  1840. /* update overrun stuck receive counter
  1841. * if >= 3, has to clear it by sending
  1842. * back to back frames. We pick
  1843. * DAT(duplicate address MAC frame)
  1844. */
  1845. tp->rx_fifo_overrun_count++;
  1846. if(tp->rx_fifo_overrun_count >= 3)
  1847. {
  1848. tp->rx_fifo_overrun_count = 0;
  1849. /* delay clearing fifo overrun
  1850. * imask till send_BUG tx
  1851. * complete posted
  1852. */
  1853. interrupt_unmask_bits &= (~0x800);
  1854. printk(KERN_CRIT "Jay please send bug\n");// smctr_send_bug(dev);
  1855. }
  1856. if(tp->ptr_rx_fifo_overruns)
  1857. (*tp->ptr_rx_fifo_overruns)++;
  1858. }
  1859. err = SUCCESS;
  1860. break;
  1861. /* Type 0x0C - Action Command Status Interrupt
  1862. * Subtype bit 14 - CB end of command chain (CE)
  1863. * Subtype bit 15 - CB command interrupt (CI)
  1864. */
  1865. case ISB_IMC_COMMAND_STATUS:
  1866. err = SUCCESS;
  1867. if(tp->acb_head->cmd == ACB_CMD_HIC_NOP)
  1868. {
  1869. printk(KERN_ERR "i1\n");
  1870. smctr_disable_16bit(dev);
  1871. /* XXXXXXXXXXXXXXXXX */
  1872. /* err = UM_Interrupt(dev); */
  1873. smctr_enable_16bit(dev);
  1874. }
  1875. else
  1876. {
  1877. if((tp->acb_head->cmd
  1878. == ACB_CMD_READ_TRC_STATUS) &&
  1879. (tp->acb_head->subcmd
  1880. == RW_TRC_STATUS_BLOCK))
  1881. {
  1882. if(tp->ptr_bcn_type)
  1883. {
  1884. *(tp->ptr_bcn_type)
  1885. = (__u32)((SBlock *)tp->misc_command_data)->BCN_Type;
  1886. }
  1887. if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & ERROR_COUNTERS_CHANGED)
  1888. {
  1889. smctr_update_err_stats(dev);
  1890. }
  1891. if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & TI_NDIS_RING_STATUS_CHANGED)
  1892. {
  1893. tp->ring_status
  1894. = ((SBlock*)tp->misc_command_data)->TI_NDIS_Ring_Status;
  1895. smctr_disable_16bit(dev);
  1896. err = smctr_ring_status_chg(dev);
  1897. smctr_enable_16bit(dev);
  1898. if((tp->ring_status & REMOVE_RECEIVED) &&
  1899. (tp->config_word0 & NO_AUTOREMOVE))
  1900. {
  1901. smctr_issue_remove_cmd(dev);
  1902. }
  1903. if(err != SUCCESS)
  1904. {
  1905. tp->acb_pending = 0;
  1906. break;
  1907. }
  1908. }
  1909. if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & UNA_CHANGED)
  1910. {
  1911. if(tp->ptr_una)
  1912. {
  1913. tp->ptr_una[0] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[0]);
  1914. tp->ptr_una[1] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[1]);
  1915. tp->ptr_una[2] = SWAP_BYTES(((SBlock *)tp->misc_command_data)->UNA[2]);
  1916. }
  1917. }
  1918. if(((SBlock *)tp->misc_command_data)->Status_CHG_Indicate & READY_TO_SEND_RQ_INIT) {
  1919. err = smctr_send_rq_init(dev);
  1920. }
  1921. }
  1922. }
  1923. tp->acb_pending = 0;
  1924. break;
  1925. /* Type 0x0D - MAC Type 1 interrupt
  1926. * Subtype -- 00 FR_BCN received at S12
  1927. * 01 FR_BCN received at S21
  1928. * 02 FR_DAT(DA=MA, A<>0) received at S21
  1929. * 03 TSM_EXP at S21
  1930. * 04 FR_REMOVE received at S42
  1931. * 05 TBR_EXP, BR_FLAG_SET at S42
  1932. * 06 TBT_EXP at S53
  1933. */
  1934. case ISB_IMC_MAC_TYPE_1:
  1935. if(isb_subtype > 8)
  1936. {
  1937. err = HARDWARE_FAILED;
  1938. break;
  1939. }
  1940. err = SUCCESS;
  1941. switch(isb_subtype)
  1942. {
  1943. case 0:
  1944. tp->join_state = JS_BYPASS_STATE;
  1945. if(tp->status != CLOSED)
  1946. {
  1947. tp->status = CLOSED;
  1948. err = smctr_status_chg(dev);
  1949. }
  1950. break;
  1951. case 1:
  1952. tp->join_state = JS_LOBE_TEST_STATE;
  1953. break;
  1954. case 2:
  1955. tp->join_state = JS_DETECT_MONITOR_PRESENT_STATE;
  1956. break;
  1957. case 3:
  1958. tp->join_state = JS_AWAIT_NEW_MONITOR_STATE;
  1959. break;
  1960. case 4:
  1961. tp->join_state = JS_DUPLICATE_ADDRESS_TEST_STATE;
  1962. break;
  1963. case 5:
  1964. tp->join_state = JS_NEIGHBOR_NOTIFICATION_STATE;
  1965. break;
  1966. case 6:
  1967. tp->join_state = JS_REQUEST_INITIALIZATION_STATE;
  1968. break;
  1969. case 7:
  1970. tp->join_state = JS_JOIN_COMPLETE_STATE;
  1971. tp->status = OPEN;
  1972. err = smctr_status_chg(dev);
  1973. break;
  1974. case 8:
  1975. tp->join_state = JS_BYPASS_WAIT_STATE;
  1976. break;
  1977. }
  1978. break ;
  1979. /* Type 0x0E - TRC Initialization Sequence Interrupt
  1980. * Subtype -- 00-FF Initializatin sequence complete
  1981. */
  1982. case ISB_IMC_TRC_INTRNL_TST_STATUS:
  1983. tp->status = INITIALIZED;
  1984. smctr_disable_16bit(dev);
  1985. err = smctr_status_chg(dev);
  1986. smctr_enable_16bit(dev);
  1987. break;
  1988. /* other interrupt types, illegal */
  1989. default:
  1990. break;
  1991. }
  1992. if(err != SUCCESS)
  1993. break;
  1994. }
  1995. /* Checking the ack code instead of the unmask bits here is because :
  1996. * while fixing the stuck receive, DAT frame are sent and mask off
  1997. * FIFO overrun interrupt temporarily (interrupt_unmask_bits = 0)
  1998. * but we still want to issue ack to ISB
  1999. */
  2000. if(!(interrupt_ack_code & 0xff00))
  2001. smctr_issue_int_ack(dev, interrupt_ack_code, interrupt_unmask_bits);
  2002. smctr_disable_16bit(dev);
  2003. smctr_enable_bic_int(dev);
  2004. spin_unlock(&tp->lock);
  2005. return IRQ_HANDLED;
  2006. }
  2007. static int smctr_issue_enable_int_cmd(struct net_device *dev,
  2008. __u16 interrupt_enable_mask)
  2009. {
  2010. struct net_local *tp = netdev_priv(dev);
  2011. int err;
  2012. if((err = smctr_wait_while_cbusy(dev)))
  2013. return err;
  2014. tp->sclb_ptr->int_mask_control = interrupt_enable_mask;
  2015. tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_CMD_CLEAR_INTERRUPT_MASK;
  2016. smctr_set_ctrl_attention(dev);
  2017. return 0;
  2018. }
  2019. static int smctr_issue_int_ack(struct net_device *dev, __u16 iack_code, __u16 ibits)
  2020. {
  2021. struct net_local *tp = netdev_priv(dev);
  2022. if(smctr_wait_while_cbusy(dev))
  2023. return -1;
  2024. tp->sclb_ptr->int_mask_control = ibits;
  2025. tp->sclb_ptr->iack_code = iack_code << 1; /* use the offset from base */ tp->sclb_ptr->resume_control = 0;
  2026. tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_IACK_CODE_VALID | SCLB_CMD_CLEAR_INTERRUPT_MASK;
  2027. smctr_set_ctrl_attention(dev);
  2028. return 0;
  2029. }
  2030. static int smctr_issue_init_timers_cmd(struct net_device *dev)
  2031. {
  2032. struct net_local *tp = netdev_priv(dev);
  2033. unsigned int i;
  2034. int err;
  2035. __u16 *pTimer_Struc = (__u16 *)tp->misc_command_data;
  2036. if((err = smctr_wait_while_cbusy(dev)))
  2037. return err;
  2038. if((err = smctr_wait_cmd(dev)))
  2039. return err;
  2040. tp->config_word0 = THDREN | DMA_TRIGGER | USETPT | NO_AUTOREMOVE;
  2041. tp->config_word1 = 0;
  2042. if((tp->media_type == MEDIA_STP_16) ||
  2043. (tp->media_type == MEDIA_UTP_16) ||
  2044. (tp->media_type == MEDIA_STP_16_UTP_16))
  2045. {
  2046. tp->config_word0 |= FREQ_16MB_BIT;
  2047. }
  2048. if(tp->mode_bits & EARLY_TOKEN_REL)
  2049. tp->config_word0 |= ETREN;
  2050. if(tp->mode_bits & LOOPING_MODE_MASK)
  2051. tp->config_word0 |= RX_OWN_BIT;
  2052. else
  2053. tp->config_word0 &= ~RX_OWN_BIT;
  2054. if(tp->receive_mask & PROMISCUOUS_MODE)
  2055. tp->config_word0 |= PROMISCUOUS_BIT;
  2056. else
  2057. tp->config_word0 &= ~PROMISCUOUS_BIT;
  2058. if(tp->receive_mask & ACCEPT_ERR_PACKETS)
  2059. tp->config_word0 |= SAVBAD_BIT;
  2060. else
  2061. tp->config_word0 &= ~SAVBAD_BIT;
  2062. if(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES)
  2063. tp->config_word0 |= RXATMAC;
  2064. else
  2065. tp->config_word0 &= ~RXATMAC;
  2066. if(tp->receive_mask & ACCEPT_MULTI_PROM)
  2067. tp->config_word1 |= MULTICAST_ADDRESS_BIT;
  2068. else
  2069. tp->config_word1 &= ~MULTICAST_ADDRESS_BIT;
  2070. if(tp->receive_mask & ACCEPT_SOURCE_ROUTING_SPANNING)
  2071. tp->config_word1 |= SOURCE_ROUTING_SPANNING_BITS;
  2072. else
  2073. {
  2074. if(tp->receive_mask & ACCEPT_SOURCE_ROUTING)
  2075. tp->config_word1 |= SOURCE_ROUTING_EXPLORER_BIT;
  2076. else
  2077. tp->config_word1 &= ~SOURCE_ROUTING_SPANNING_BITS;
  2078. }
  2079. if((tp->media_type == MEDIA_STP_16) ||
  2080. (tp->media_type == MEDIA_UTP_16) ||
  2081. (tp->media_type == MEDIA_STP_16_UTP_16))
  2082. {
  2083. tp->config_word1 |= INTERFRAME_SPACING_16;
  2084. }
  2085. else
  2086. tp->config_word1 |= INTERFRAME_SPACING_4;
  2087. *pTimer_Struc++ = tp->config_word0;
  2088. *pTimer_Struc++ = tp->config_word1;
  2089. if((tp->media_type == MEDIA_STP_4) ||
  2090. (tp->media_type == MEDIA_UTP_4) ||
  2091. (tp->media_type == MEDIA_STP_4_UTP_4))
  2092. {
  2093. *pTimer_Struc++ = 0x00FA; /* prescale */
  2094. *pTimer_Struc++ = 0x2710; /* TPT_limit */
  2095. *pTimer_Struc++ = 0x2710; /* TQP_limit */
  2096. *pTimer_Struc++ = 0x0A28; /* TNT_limit */
  2097. *pTimer_Struc++ = 0x3E80; /* TBT_limit */
  2098. *pTimer_Struc++ = 0x3A98; /* TSM_limit */
  2099. *pTimer_Struc++ = 0x1B58; /* TAM_limit */
  2100. *pTimer_Struc++ = 0x00C8; /* TBR_limit */
  2101. *pTimer_Struc++ = 0x07D0; /* TER_limit */
  2102. *pTimer_Struc++ = 0x000A; /* TGT_limit */
  2103. *pTimer_Struc++ = 0x1162; /* THT_limit */
  2104. *pTimer_Struc++ = 0x07D0; /* TRR_limit */
  2105. *pTimer_Struc++ = 0x1388; /* TVX_limit */
  2106. *pTimer_Struc++ = 0x0000; /* reserved */
  2107. }
  2108. else
  2109. {
  2110. *pTimer_Struc++ = 0x03E8; /* prescale */
  2111. *pTimer_Struc++ = 0x9C40; /* TPT_limit */
  2112. *pTimer_Struc++ = 0x9C40; /* TQP_limit */
  2113. *pTimer_Struc++ = 0x0A28; /* TNT_limit */
  2114. *pTimer_Struc++ = 0x3E80; /* TBT_limit */
  2115. *pTimer_Struc++ = 0x3A98; /* TSM_limit */
  2116. *pTimer_Struc++ = 0x1B58; /* TAM_limit */
  2117. *pTimer_Struc++ = 0x00C8; /* TBR_limit */
  2118. *pTimer_Struc++ = 0x07D0; /* TER_limit */
  2119. *pTimer_Struc++ = 0x000A; /* TGT_limit */
  2120. *pTimer_Struc++ = 0x4588; /* THT_limit */
  2121. *pTimer_Struc++ = 0x1F40; /* TRR_limit */
  2122. *pTimer_Struc++ = 0x4E20; /* TVX_limit */
  2123. *pTimer_Struc++ = 0x0000; /* reserved */
  2124. }
  2125. /* Set node address. */
  2126. *pTimer_Struc++ = dev->dev_addr[0] << 8
  2127. | (dev->dev_addr[1] & 0xFF);
  2128. *pTimer_Struc++ = dev->dev_addr[2] << 8
  2129. | (dev->dev_addr[3] & 0xFF);
  2130. *pTimer_Struc++ = dev->dev_addr[4] << 8
  2131. | (dev->dev_addr[5] & 0xFF);
  2132. /* Set group address. */
  2133. *pTimer_Struc++ = tp->group_address_0 << 8
  2134. | tp->group_address_0 >> 8;
  2135. *pTimer_Struc++ = tp->group_address[0] << 8
  2136. | tp->group_address[0] >> 8;
  2137. *pTimer_Struc++ = tp->group_address[1] << 8
  2138. | tp->group_address[1] >> 8;
  2139. /* Set functional address. */
  2140. *pTimer_Struc++ = tp->functional_address_0 << 8
  2141. | tp->functional_address_0 >> 8;
  2142. *pTimer_Struc++ = tp->functional_address[0] << 8
  2143. | tp->functional_address[0] >> 8;
  2144. *pTimer_Struc++ = tp->functional_address[1] << 8
  2145. | tp->functional_address[1] >> 8;
  2146. /* Set Bit-Wise group address. */
  2147. *pTimer_Struc++ = tp->bitwise_group_address[0] << 8
  2148. | tp->bitwise_group_address[0] >> 8;
  2149. *pTimer_Struc++ = tp->bitwise_group_address[1] << 8
  2150. | tp->bitwise_group_address[1] >> 8;
  2151. /* Set ring number address. */
  2152. *pTimer_Struc++ = tp->source_ring_number;
  2153. *pTimer_Struc++ = tp->target_ring_number;
  2154. /* Physical drop number. */
  2155. *pTimer_Struc++ = (unsigned short)0;
  2156. *pTimer_Struc++ = (unsigned short)0;
  2157. /* Product instance ID. */
  2158. for(i = 0; i < 9; i++)
  2159. *pTimer_Struc++ = (unsigned short)0;
  2160. err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_INIT_TRC_TIMERS, 0);
  2161. return err;
  2162. }
  2163. static int smctr_issue_init_txrx_cmd(struct net_device *dev)
  2164. {
  2165. struct net_local *tp = netdev_priv(dev);
  2166. unsigned int i;
  2167. int err;
  2168. void **txrx_ptrs = (void *)tp->misc_command_data;
  2169. if((err = smctr_wait_while_cbusy(dev)))
  2170. return err;
  2171. if((err = smctr_wait_cmd(dev)))
  2172. {
  2173. printk(KERN_ERR "%s: Hardware failure\n", dev->name);
  2174. return err;
  2175. }
  2176. /* Initialize Transmit Queue Pointers that are used, to point to
  2177. * a single FCB.
  2178. */
  2179. for(i = 0; i < NUM_TX_QS_USED; i++)
  2180. *txrx_ptrs++ = (void *)TRC_POINTER(tp->tx_fcb_head[i]);
  2181. /* Initialize Transmit Queue Pointers that are NOT used to ZERO. */
  2182. for(; i < MAX_TX_QS; i++)
  2183. *txrx_ptrs++ = (void *)0;
  2184. /* Initialize Receive Queue Pointers (MAC and Non-MAC) that are
  2185. * used, to point to a single FCB and a BDB chain of buffers.
  2186. */
  2187. for(i = 0; i < NUM_RX_QS_USED; i++)
  2188. {
  2189. *txrx_ptrs++ = (void *)TRC_POINTER(tp->rx_fcb_head[i]);
  2190. *txrx_ptrs++ = (void *)TRC_POINTER(tp->rx_bdb_head[i]);
  2191. }
  2192. /* Initialize Receive Queue Pointers that are NOT used to ZERO. */
  2193. for(; i < MAX_RX_QS; i++)
  2194. {
  2195. *txrx_ptrs++ = (void *)0;
  2196. *txrx_ptrs++ = (void *)0;
  2197. }
  2198. err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_INIT_TX_RX, 0);
  2199. return err;
  2200. }
  2201. static int smctr_issue_insert_cmd(struct net_device *dev)
  2202. {
  2203. int err;
  2204. err = smctr_setup_single_cmd(dev, ACB_CMD_INSERT, ACB_SUB_CMD_NOP);
  2205. return err;
  2206. }
  2207. static int smctr_issue_read_ring_status_cmd(struct net_device *dev)
  2208. {
  2209. int err;
  2210. if((err = smctr_wait_while_cbusy(dev)))
  2211. return err;
  2212. if((err = smctr_wait_cmd(dev)))
  2213. return err;
  2214. err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_READ_TRC_STATUS,
  2215. RW_TRC_STATUS_BLOCK);
  2216. return err;
  2217. }
  2218. static int smctr_issue_read_word_cmd(struct net_device *dev, __u16 aword_cnt)
  2219. {
  2220. int err;
  2221. if((err = smctr_wait_while_cbusy(dev)))
  2222. return err;
  2223. if((err = smctr_wait_cmd(dev)))
  2224. return err;
  2225. err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_READ_VALUE,
  2226. aword_cnt);
  2227. return err;
  2228. }
  2229. static int smctr_issue_remove_cmd(struct net_device *dev)
  2230. {
  2231. struct net_local *tp = netdev_priv(dev);
  2232. int err;
  2233. if((err = smctr_wait_while_cbusy(dev)))
  2234. return err;
  2235. tp->sclb_ptr->resume_control = 0;
  2236. tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_CMD_REMOVE;
  2237. smctr_set_ctrl_attention(dev);
  2238. return 0;
  2239. }
  2240. static int smctr_issue_resume_acb_cmd(struct net_device *dev)
  2241. {
  2242. struct net_local *tp = netdev_priv(dev);
  2243. int err;
  2244. if((err = smctr_wait_while_cbusy(dev)))
  2245. return err;
  2246. tp->sclb_ptr->resume_control = SCLB_RC_ACB;
  2247. tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_RESUME_CONTROL_VALID;
  2248. tp->acb_pending = 1;
  2249. smctr_set_ctrl_attention(dev);
  2250. return 0;
  2251. }
  2252. static int smctr_issue_resume_rx_bdb_cmd(struct net_device *dev, __u16 queue)
  2253. {
  2254. struct net_local *tp = netdev_priv(dev);
  2255. int err;
  2256. if((err = smctr_wait_while_cbusy(dev)))
  2257. return err;
  2258. if(queue == MAC_QUEUE)
  2259. tp->sclb_ptr->resume_control = SCLB_RC_RX_MAC_BDB;
  2260. else
  2261. tp->sclb_ptr->resume_control = SCLB_RC_RX_NON_MAC_BDB;
  2262. tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_RESUME_CONTROL_VALID;
  2263. smctr_set_ctrl_attention(dev);
  2264. return 0;
  2265. }
  2266. static int smctr_issue_resume_rx_fcb_cmd(struct net_device *dev, __u16 queue)
  2267. {
  2268. struct net_local *tp = netdev_priv(dev);
  2269. if(smctr_debug > 10)
  2270. printk(KERN_DEBUG "%s: smctr_issue_resume_rx_fcb_cmd\n", dev->name);
  2271. if(smctr_wait_while_cbusy(dev))
  2272. return -1;
  2273. if(queue == MAC_QUEUE)
  2274. tp->sclb_ptr->resume_control = SCLB_RC_RX_MAC_FCB;
  2275. else
  2276. tp->sclb_ptr->resume_control = SCLB_RC_RX_NON_MAC_FCB;
  2277. tp->sclb_ptr->valid_command = SCLB_VALID | SCLB_RESUME_CONTROL_VALID;
  2278. smctr_set_ctrl_attention(dev);
  2279. return 0;
  2280. }
  2281. static int smctr_issue_resume_tx_fcb_cmd(struct net_device *dev, __u16 queue)
  2282. {
  2283. struct net_local *tp = netdev_priv(dev);
  2284. if(smctr_debug > 10)
  2285. printk(KERN_DEBUG "%s: smctr_issue_resume_tx_fcb_cmd\n", dev->name);
  2286. if(smctr_wait_while_cbusy(dev))
  2287. return -1;
  2288. tp->sclb_ptr->resume_control = (SCLB_RC_TFCB0 << queue);
  2289. tp->sclb_ptr->valid_command = SCLB_RESUME_CONTROL_VALID | SCLB_VALID;
  2290. smctr_set_ctrl_attention(dev);
  2291. return 0;
  2292. }
  2293. static int smctr_issue_test_internal_rom_cmd(struct net_device *dev)
  2294. {
  2295. int err;
  2296. err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
  2297. TRC_INTERNAL_ROM_TEST);
  2298. return err;
  2299. }
  2300. static int smctr_issue_test_hic_cmd(struct net_device *dev)
  2301. {
  2302. int err;
  2303. err = smctr_setup_single_cmd(dev, ACB_CMD_HIC_TEST,
  2304. TRC_HOST_INTERFACE_REG_TEST);
  2305. return err;
  2306. }
  2307. static int smctr_issue_test_mac_reg_cmd(struct net_device *dev)
  2308. {
  2309. int err;
  2310. err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
  2311. TRC_MAC_REGISTERS_TEST);
  2312. return err;
  2313. }
  2314. static int smctr_issue_trc_loopback_cmd(struct net_device *dev)
  2315. {
  2316. int err;
  2317. err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
  2318. TRC_INTERNAL_LOOPBACK);
  2319. return err;
  2320. }
  2321. static int smctr_issue_tri_loopback_cmd(struct net_device *dev)
  2322. {
  2323. int err;
  2324. err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
  2325. TRC_TRI_LOOPBACK);
  2326. return err;
  2327. }
  2328. static int smctr_issue_write_byte_cmd(struct net_device *dev,
  2329. short aword_cnt, void *byte)
  2330. {
  2331. struct net_local *tp = netdev_priv(dev);
  2332. unsigned int iword, ibyte;
  2333. int err;
  2334. if((err = smctr_wait_while_cbusy(dev)))
  2335. return err;
  2336. if((err = smctr_wait_cmd(dev)))
  2337. return err;
  2338. for(iword = 0, ibyte = 0; iword < (unsigned int)(aword_cnt & 0xff);
  2339. iword++, ibyte += 2)
  2340. {
  2341. tp->misc_command_data[iword] = (*((__u8 *)byte + ibyte) << 8)
  2342. | (*((__u8 *)byte + ibyte + 1));
  2343. }
  2344. return smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_WRITE_VALUE,
  2345. aword_cnt);
  2346. }
  2347. static int smctr_issue_write_word_cmd(struct net_device *dev,
  2348. short aword_cnt, void *word)
  2349. {
  2350. struct net_local *tp = netdev_priv(dev);
  2351. unsigned int i, err;
  2352. if((err = smctr_wait_while_cbusy(dev)))
  2353. return err;
  2354. if((err = smctr_wait_cmd(dev)))
  2355. return err;
  2356. for(i = 0; i < (unsigned int)(aword_cnt & 0xff); i++)
  2357. tp->misc_command_data[i] = *((__u16 *)word + i);
  2358. err = smctr_setup_single_cmd_w_data(dev, ACB_CMD_MCT_WRITE_VALUE,
  2359. aword_cnt);
  2360. return err;
  2361. }
  2362. static int smctr_join_complete_state(struct net_device *dev)
  2363. {
  2364. int err;
  2365. err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE,
  2366. JS_JOIN_COMPLETE_STATE);
  2367. return err;
  2368. }
  2369. static int smctr_link_tx_fcbs_to_bdbs(struct net_device *dev)
  2370. {
  2371. struct net_local *tp = netdev_priv(dev);
  2372. unsigned int i, j;
  2373. FCBlock *fcb;
  2374. BDBlock *bdb;
  2375. for(i = 0; i < NUM_TX_QS_USED; i++)
  2376. {
  2377. fcb = tp->tx_fcb_head[i];
  2378. bdb = tp->tx_bdb_head[i];
  2379. for(j = 0; j < tp->num_tx_fcbs[i]; j++)
  2380. {
  2381. fcb->bdb_ptr = bdb;
  2382. fcb->trc_bdb_ptr = TRC_POINTER(bdb);
  2383. fcb = (FCBlock *)((char *)fcb + sizeof(FCBlock));
  2384. bdb = (BDBlock *)((char *)bdb + sizeof(BDBlock));
  2385. }
  2386. }
  2387. return 0;
  2388. }
  2389. static int smctr_load_firmware(struct net_device *dev)
  2390. {
  2391. struct net_local *tp = netdev_priv(dev);
  2392. const struct firmware *fw;
  2393. __u16 i, checksum = 0;
  2394. int err = 0;
  2395. if(smctr_debug > 10)
  2396. printk(KERN_DEBUG "%s: smctr_load_firmware\n", dev->name);
  2397. if (request_firmware(&fw, "tr_smctr.bin", &dev->dev)) {
  2398. printk(KERN_ERR "%s: firmware not found\n", dev->name);
  2399. return UCODE_NOT_PRESENT;
  2400. }
  2401. tp->num_of_tx_buffs = 4;
  2402. tp->mode_bits |= UMAC;
  2403. tp->receive_mask = 0;
  2404. tp->max_packet_size = 4177;
  2405. /* Can only upload the firmware once per adapter reset. */
  2406. if (tp->microcode_version != 0) {
  2407. err = (UCODE_PRESENT);
  2408. goto out;
  2409. }
  2410. /* Verify the firmware exists and is there in the right amount. */
  2411. if (!fw->data ||
  2412. (*(fw->data + UCODE_VERSION_OFFSET) < UCODE_VERSION))
  2413. {
  2414. err = (UCODE_NOT_PRESENT);
  2415. goto out;
  2416. }
  2417. /* UCODE_SIZE is not included in Checksum. */
  2418. for(i = 0; i < *((__u16 *)(fw->data + UCODE_SIZE_OFFSET)); i += 2)
  2419. checksum += *((__u16 *)(fw->data + 2 + i));
  2420. if (checksum) {
  2421. err = (UCODE_NOT_PRESENT);
  2422. goto out;
  2423. }
  2424. /* At this point we have a valid firmware image, lets kick it on up. */
  2425. smctr_enable_adapter_ram(dev);
  2426. smctr_enable_16bit(dev);
  2427. smctr_set_page(dev, (__u8 *)tp->ram_access);
  2428. if((smctr_checksum_firmware(dev)) ||
  2429. (*(fw->data + UCODE_VERSION_OFFSET) > tp->microcode_version))
  2430. {
  2431. smctr_enable_adapter_ctrl_store(dev);
  2432. /* Zero out ram space for firmware. */
  2433. for(i = 0; i < CS_RAM_SIZE; i += 2)
  2434. *((__u16 *)(tp->ram_access + i)) = 0;
  2435. smctr_decode_firmware(dev, fw);
  2436. tp->microcode_version = *(fw->data + UCODE_VERSION_OFFSET); *((__u16 *)(tp->ram_access + CS_RAM_VERSION_OFFSET))
  2437. = (tp->microcode_version << 8);
  2438. *((__u16 *)(tp->ram_access + CS_RAM_CHECKSUM_OFFSET))
  2439. = ~(tp->microcode_version << 8) + 1;
  2440. smctr_disable_adapter_ctrl_store(dev);
  2441. if(smctr_checksum_firmware(dev))
  2442. err = HARDWARE_FAILED;
  2443. }
  2444. else
  2445. err = UCODE_PRESENT;
  2446. smctr_disable_16bit(dev);
  2447. out:
  2448. release_firmware(fw);
  2449. return err;
  2450. }
  2451. static int smctr_load_node_addr(struct net_device *dev)
  2452. {
  2453. int ioaddr = dev->base_addr;
  2454. unsigned int i;
  2455. __u8 r;
  2456. for(i = 0; i < 6; i++)
  2457. {
  2458. r = inb(ioaddr + LAR0 + i);
  2459. dev->dev_addr[i] = (char)r;
  2460. }
  2461. dev->addr_len = 6;
  2462. return 0;
  2463. }
  2464. /* Lobe Media Test.
  2465. * During the transmission of the initial 1500 lobe media MAC frames,
  2466. * the phase lock loop in the 805 chip may lock, and then un-lock, causing
  2467. * the 825 to go into a PURGE state. When performing a PURGE, the MCT
  2468. * microcode will not transmit any frames given to it by the host, and
  2469. * will consequently cause a timeout.
  2470. *
  2471. * NOTE 1: If the monitor_state is MS_BEACON_TEST_STATE, all transmit
  2472. * queues other than the one used for the lobe_media_test should be
  2473. * disabled.!?
  2474. *
  2475. * NOTE 2: If the monitor_state is MS_BEACON_TEST_STATE and the receive_mask
  2476. * has any multi-cast or promiscuous bits set, the receive_mask needs to
  2477. * be changed to clear the multi-cast or promiscuous mode bits, the lobe_test
  2478. * run, and then the receive mask set back to its original value if the test
  2479. * is successful.
  2480. */
  2481. static int smctr_lobe_media_test(struct net_device *dev)
  2482. {
  2483. struct net_local *tp = netdev_priv(dev);
  2484. unsigned int i, perror = 0;
  2485. unsigned short saved_rcv_mask;
  2486. if(smctr_debug > 10)
  2487. printk(KERN_DEBUG "%s: smctr_lobe_media_test\n", dev->name);
  2488. /* Clear receive mask for lobe test. */
  2489. saved_rcv_mask = tp->receive_mask;
  2490. tp->receive_mask = 0;
  2491. smctr_chg_rx_mask(dev);
  2492. /* Setup the lobe media test. */
  2493. smctr_lobe_media_test_cmd(dev);
  2494. if(smctr_wait_cmd(dev))
  2495. goto err;
  2496. /* Tx lobe media test frames. */
  2497. for(i = 0; i < 1500; ++i)
  2498. {
  2499. if(smctr_send_lobe_media_test(dev))
  2500. {
  2501. if(perror)
  2502. goto err;
  2503. else
  2504. {
  2505. perror = 1;
  2506. if(smctr_lobe_media_test_cmd(dev))
  2507. goto err;
  2508. }
  2509. }
  2510. }
  2511. if(smctr_send_dat(dev))
  2512. {
  2513. if(smctr_send_dat(dev))
  2514. goto err;
  2515. }
  2516. /* Check if any frames received during test. */
  2517. if((tp->rx_fcb_curr[MAC_QUEUE]->frame_status) ||
  2518. (tp->rx_fcb_curr[NON_MAC_QUEUE]->frame_status))
  2519. goto err;
  2520. /* Set receive mask to "Promisc" mode. */
  2521. tp->receive_mask = saved_rcv_mask;
  2522. smctr_chg_rx_mask(dev);
  2523. return 0;
  2524. err:
  2525. smctr_reset_adapter(dev);
  2526. tp->status = CLOSED;
  2527. return LOBE_MEDIA_TEST_FAILED;
  2528. }
  2529. static int smctr_lobe_media_test_cmd(struct net_device *dev)
  2530. {
  2531. struct net_local *tp = netdev_priv(dev);
  2532. int err;
  2533. if(smctr_debug > 10)
  2534. printk(KERN_DEBUG "%s: smctr_lobe_media_test_cmd\n", dev->name);
  2535. /* Change to lobe media test state. */
  2536. if(tp->monitor_state != MS_BEACON_TEST_STATE)
  2537. {
  2538. smctr_lobe_media_test_state(dev);
  2539. if(smctr_wait_cmd(dev))
  2540. {
  2541. printk(KERN_ERR "Lobe Failed test state\n");
  2542. return LOBE_MEDIA_TEST_FAILED;
  2543. }
  2544. }
  2545. err = smctr_setup_single_cmd(dev, ACB_CMD_MCT_TEST,
  2546. TRC_LOBE_MEDIA_TEST);
  2547. return err;
  2548. }
  2549. static int smctr_lobe_media_test_state(struct net_device *dev)
  2550. {
  2551. int err;
  2552. err = smctr_setup_single_cmd(dev, ACB_CMD_CHANGE_JOIN_STATE,
  2553. JS_LOBE_TEST_STATE);
  2554. return err;
  2555. }
  2556. static int smctr_make_8025_hdr(struct net_device *dev,
  2557. MAC_HEADER *rmf, MAC_HEADER *tmf, __u16 ac_fc)
  2558. {
  2559. tmf->ac = MSB(ac_fc); /* msb is access control */
  2560. tmf->fc = LSB(ac_fc); /* lsb is frame control */
  2561. tmf->sa[0] = dev->dev_addr[0];
  2562. tmf->sa[1] = dev->dev_addr[1];
  2563. tmf->sa[2] = dev->dev_addr[2];
  2564. tmf->sa[3] = dev->dev_addr[3];
  2565. tmf->sa[4] = dev->dev_addr[4];
  2566. tmf->sa[5] = dev->dev_addr[5];
  2567. switch(tmf->vc)
  2568. {
  2569. /* Send RQ_INIT to RPS */
  2570. case RQ_INIT:
  2571. tmf->da[0] = 0xc0;
  2572. tmf->da[1] = 0x00;
  2573. tmf->da[2] = 0x00;
  2574. tmf->da[3] = 0x00;
  2575. tmf->da[4] = 0x00;
  2576. tmf->da[5] = 0x02;
  2577. break;
  2578. /* Send RPT_TX_FORWARD to CRS */
  2579. case RPT_TX_FORWARD:
  2580. tmf->da[0] = 0xc0;
  2581. tmf->da[1] = 0x00;
  2582. tmf->da[2] = 0x00;
  2583. tmf->da[3] = 0x00;
  2584. tmf->da[4] = 0x00;
  2585. tmf->da[5] = 0x10;
  2586. break;
  2587. /* Everything else goes to sender */
  2588. default:
  2589. tmf->da[0] = rmf->sa[0];
  2590. tmf->da[1] = rmf->sa[1];
  2591. tmf->da[2] = rmf->sa[2];
  2592. tmf->da[3] = rmf->sa[3];
  2593. tmf->da[4] = rmf->sa[4];
  2594. tmf->da[5] = rmf->sa[5];
  2595. break;
  2596. }
  2597. return 0;
  2598. }
  2599. static int smctr_make_access_pri(struct net_device *dev, MAC_SUB_VECTOR *tsv)
  2600. {
  2601. struct net_local *tp = netdev_priv(dev);
  2602. tsv->svi = AUTHORIZED_ACCESS_PRIORITY;
  2603. tsv->svl = S_AUTHORIZED_ACCESS_PRIORITY;
  2604. tsv->svv[0] = MSB(tp->authorized_access_priority);
  2605. tsv->svv[1] = LSB(tp->authorized_access_priority);
  2606. return 0;
  2607. }
  2608. static int smctr_make_addr_mod(struct net_device *dev, MAC_SUB_VECTOR *tsv)
  2609. {
  2610. tsv->svi = ADDRESS_MODIFER;
  2611. tsv->svl = S_ADDRESS_MODIFER;
  2612. tsv->svv[0] = 0;
  2613. tsv->svv[1] = 0;
  2614. return 0;
  2615. }
  2616. static int smctr_make_auth_funct_class(struct net_device *dev,
  2617. MAC_SUB_VECTOR *tsv)
  2618. {
  2619. struct net_local *tp = netdev_priv(dev);
  2620. tsv->svi = AUTHORIZED_FUNCTION_CLASS;
  2621. tsv->svl = S_AUTHORIZED_FUNCTION_CLASS;
  2622. tsv->svv[0] = MSB(tp->authorized_function_classes);
  2623. tsv->svv[1] = LSB(tp->authorized_function_classes);
  2624. return 0;
  2625. }
  2626. static int smctr_make_corr(struct net_device *dev,
  2627. MAC_SUB_VECTOR *tsv, __u16 correlator)
  2628. {
  2629. tsv->svi = CORRELATOR;
  2630. tsv->svl = S_CORRELATOR;
  2631. tsv->svv[0] = MSB(correlator);
  2632. tsv->svv[1] = LSB(correlator);
  2633. return 0;
  2634. }
  2635. static int smctr_make_funct_addr(struct net_device *dev, MAC_SUB_VECTOR *tsv)
  2636. {
  2637. struct net_local *tp = netdev_priv(dev);
  2638. smctr_get_functional_address(dev);
  2639. tsv->svi = FUNCTIONAL_ADDRESS;
  2640. tsv->svl = S_FUNCTIONAL_ADDRESS;
  2641. tsv->svv[0] = MSB(tp->misc_command_data[0]);
  2642. tsv->svv[1] = LSB(tp->misc_command_data[0]);
  2643. tsv->svv[2] = MSB(tp->misc_command_data[1]);
  2644. tsv->svv[3] = LSB(tp->misc_command_data[1]);
  2645. return 0;
  2646. }
  2647. static int smctr_make_group_addr(struct net_device *dev, MAC_SUB_VECTOR *tsv)
  2648. {
  2649. struct net_local *tp = netdev_priv(dev);
  2650. smctr_get_group_address(dev);
  2651. tsv->svi = GROUP_ADDRESS;
  2652. tsv->svl = S_GROUP_ADDRESS;
  2653. tsv->svv[0] = MSB(tp->misc_command_data[0]);
  2654. tsv->svv[1] = LSB(tp->misc_command_data[0]);
  2655. tsv->svv[2] = MSB(tp->misc_command_data[1]);
  2656. tsv->svv[3] = LSB(tp->misc_command_data[1]);
  2657. /* Set Group Address Sub-vector to all zeros if only the
  2658. * Group Address/Functional Address Indicator is set.
  2659. */
  2660. if(tsv->svv[0] == 0x80 && tsv->svv[1] == 0x00 &&
  2661. tsv->svv[2] == 0x00 && tsv->svv[3] == 0x00)
  2662. tsv->svv[0] = 0x00;
  2663. return 0;
  2664. }
  2665. static int smctr_make_phy_drop_num(struct net_device *dev,
  2666. MAC_SUB_VECTOR *tsv)
  2667. {
  2668. struct net_local *tp = netdev_priv(dev);
  2669. smctr_get_physical_drop_number(dev);
  2670. tsv->svi = PHYSICAL_DROP;
  2671. tsv->svl = S_PHYSICAL_DROP;
  2672. tsv->svv[0] = MSB(tp->misc_command_data[0]);
  2673. tsv->svv[1] = LSB(tp->misc_command_data[0]);
  2674. tsv->svv[2] = MSB(tp->misc_command_data[1]);
  2675. tsv->svv[3] = LSB(tp->misc_command_data[1]);
  2676. return 0;
  2677. }
  2678. static int smctr_make_product_id(struct net_device *dev, MAC_SUB_VECTOR *tsv)
  2679. {
  2680. int i;
  2681. tsv->svi = PRODUCT_INSTANCE_ID;
  2682. tsv->svl = S_PRODUCT_INSTANCE_ID;
  2683. for(i = 0; i < 18; i++)
  2684. tsv->svv[i] = 0xF0;
  2685. return 0;
  2686. }
  2687. static int smctr_make_station_id(struct net_device *dev, MAC_SUB_VECTOR *tsv)
  2688. {
  2689. struct net_local *tp = netdev_priv(dev);
  2690. smctr_get_station_id(dev);
  2691. tsv->svi = STATION_IDENTIFER;
  2692. tsv->svl = S_STATION_IDENTIFER;
  2693. tsv->svv[0] = MSB(tp->misc_command_data[0]);
  2694. tsv->svv[1] = LSB(tp->misc_command_data[0]);
  2695. tsv->svv[2] = MSB(tp->misc_command_data[1]);
  2696. tsv->svv[3] = LSB(tp->misc_command_data[1]);
  2697. tsv->svv[4] = MSB(tp->misc_command_data[2]);
  2698. tsv->svv[5] = LSB(tp->misc_command_data[2]);
  2699. return 0;
  2700. }
  2701. static int smctr_make_ring_station_status(struct net_device *dev,
  2702. MAC_SUB_VECTOR * tsv)
  2703. {
  2704. tsv->svi = RING_STATION_STATUS;
  2705. tsv->svl = S_RING_STATION_STATUS;
  2706. tsv->svv[0] = 0;
  2707. tsv->svv[1] = 0;
  2708. tsv->svv[2] = 0;
  2709. tsv->svv[3] = 0;
  2710. tsv->svv[4] = 0;
  2711. tsv->svv[5] = 0;
  2712. return 0;
  2713. }
  2714. static int smctr_make_ring_station_version(struct net_device *dev,
  2715. MAC_SUB_VECTOR *tsv)
  2716. {
  2717. struct net_local *tp = netdev_priv(dev);
  2718. tsv->svi = RING_STATION_VERSION_NUMBER;
  2719. tsv->svl = S_RING_STATION_VERSION_NUMBER;
  2720. tsv->svv[0] = 0xe2; /* EBCDIC - S */
  2721. tsv->svv[1] = 0xd4; /* EBCDIC - M */
  2722. tsv->svv[2] = 0xc3; /* EBCDIC - C */
  2723. tsv->svv[3] = 0x40; /* EBCDIC - */
  2724. tsv->svv[4] = 0xe5; /* EBCDIC - V */
  2725. tsv->svv[5] = 0xF0 + (tp->microcode_version >> 4);
  2726. tsv->svv[6] = 0xF0 + (tp->microcode_version & 0x0f);
  2727. tsv->svv[7] = 0x40; /* EBCDIC - */
  2728. tsv->svv[8] = 0xe7; /* EBCDIC - X */
  2729. if(tp->extra_info & CHIP_REV_MASK)
  2730. tsv->svv[9] = 0xc5; /* EBCDIC - E */
  2731. else
  2732. tsv->svv[9] = 0xc4; /* EBCDIC - D */
  2733. return 0;
  2734. }
  2735. static int smctr_make_tx_status_code(struct net_device *dev,
  2736. MAC_SUB_VECTOR *tsv, __u16 tx_fstatus)
  2737. {
  2738. tsv->svi = TRANSMIT_STATUS_CODE;
  2739. tsv->svl = S_TRANSMIT_STATUS_CODE;
  2740. tsv->svv[0] = ((tx_fstatus & 0x0100 >> 6) | IBM_PASS_SOURCE_ADDR);
  2741. /* Stripped frame status of Transmitted Frame */
  2742. tsv->svv[1] = tx_fstatus & 0xff;
  2743. return 0;
  2744. }
  2745. static int smctr_make_upstream_neighbor_addr(struct net_device *dev,
  2746. MAC_SUB_VECTOR *tsv)
  2747. {
  2748. struct net_local *tp = netdev_priv(dev);
  2749. smctr_get_upstream_neighbor_addr(dev);
  2750. tsv->svi = UPSTREAM_NEIGHBOR_ADDRESS;
  2751. tsv->svl = S_UPSTREAM_NEIGHBOR_ADDRESS;
  2752. tsv->svv[0] = MSB(tp->misc_command_data[0]);
  2753. tsv->svv[1] = LSB(tp->misc_command_data[0]);
  2754. tsv->svv[2] = MSB(tp->misc_command_data[1]);
  2755. tsv->svv[3] = LSB(tp->misc_command_data[1]);
  2756. tsv->svv[4] = MSB(tp->misc_command_data[2]);
  2757. tsv->svv[5] = LSB(tp->misc_command_data[2]);
  2758. return 0;
  2759. }
  2760. static int smctr_make_wrap_data(struct net_device *dev, MAC_SUB_VECTOR *tsv)
  2761. {
  2762. tsv->svi = WRAP_DATA;
  2763. tsv->svl = S_WRAP_DATA;
  2764. return 0;
  2765. }
  2766. /*
  2767. * Open/initialize the board. This is called sometime after
  2768. * booting when the 'ifconfig' program is run.
  2769. *
  2770. * This routine should set everything up anew at each open, even
  2771. * registers that "should" only need to be set once at boot, so that
  2772. * there is non-reboot way to recover if something goes wrong.
  2773. */
  2774. static int smctr_open(struct net_device *dev)
  2775. {
  2776. int err;
  2777. if(smctr_debug > 10)
  2778. printk(KERN_DEBUG "%s: smctr_open\n", dev->name);
  2779. err = smctr_init_adapter(dev);
  2780. if(err < 0)
  2781. return err;
  2782. return err;
  2783. }
  2784. /* Interrupt driven open of Token card. */
  2785. static int smctr_open_tr(struct net_device *dev)
  2786. {
  2787. struct net_local *tp = netdev_priv(dev);
  2788. unsigned long flags;
  2789. int err;
  2790. if(smctr_debug > 10)
  2791. printk(KERN_DEBUG "%s: smctr_open_tr\n", dev->name);
  2792. /* Now we can actually open the adapter. */
  2793. if(tp->status == OPEN)
  2794. return 0;
  2795. if(tp->status != INITIALIZED)
  2796. return -1;
  2797. /* FIXME: it would work a lot better if we masked the irq sources
  2798. on the card here, then we could skip the locking and poll nicely */
  2799. spin_lock_irqsave(&tp->lock, flags);
  2800. smctr_set_page(dev, (__u8 *)tp->ram_access);
  2801. if((err = smctr_issue_resume_rx_fcb_cmd(dev, (short)MAC_QUEUE)))
  2802. goto out;
  2803. if((err = smctr_issue_resume_rx_bdb_cmd(dev, (short)MAC_QUEUE)))
  2804. goto out;
  2805. if((err = smctr_issue_resume_rx_fcb_cmd(dev, (short)NON_MAC_QUEUE)))
  2806. goto out;
  2807. if((err = smctr_issue_resume_rx_bdb_cmd(dev, (short)NON_MAC_QUEUE)))
  2808. goto out;
  2809. tp->status = CLOSED;
  2810. /* Insert into the Ring or Enter Loopback Mode. */
  2811. if((tp->mode_bits & LOOPING_MODE_MASK) == LOOPBACK_MODE_1)
  2812. {
  2813. tp->status = CLOSED;
  2814. if(!(err = smctr_issue_trc_loopback_cmd(dev)))
  2815. {
  2816. if(!(err = smctr_wait_cmd(dev)))
  2817. tp->status = OPEN;
  2818. }
  2819. smctr_status_chg(dev);
  2820. }
  2821. else
  2822. {
  2823. if((tp->mode_bits & LOOPING_MODE_MASK) == LOOPBACK_MODE_2)
  2824. {
  2825. tp->status = CLOSED;
  2826. if(!(err = smctr_issue_tri_loopback_cmd(dev)))
  2827. {
  2828. if(!(err = smctr_wait_cmd(dev)))
  2829. tp->status = OPEN;
  2830. }
  2831. smctr_status_chg(dev);
  2832. }
  2833. else
  2834. {
  2835. if((tp->mode_bits & LOOPING_MODE_MASK)
  2836. == LOOPBACK_MODE_3)
  2837. {
  2838. tp->status = CLOSED;
  2839. if(!(err = smctr_lobe_media_test_cmd(dev)))
  2840. {
  2841. if(!(err = smctr_wait_cmd(dev)))
  2842. tp->status = OPEN;
  2843. }
  2844. smctr_status_chg(dev);
  2845. }
  2846. else
  2847. {
  2848. if(!(err = smctr_lobe_media_test(dev)))
  2849. err = smctr_issue_insert_cmd(dev);
  2850. else
  2851. {
  2852. if(err == LOBE_MEDIA_TEST_FAILED)
  2853. printk(KERN_WARNING "%s: Lobe Media Test Failure - Check cable?\n", dev->name);
  2854. }
  2855. }
  2856. }
  2857. }
  2858. out:
  2859. spin_unlock_irqrestore(&tp->lock, flags);
  2860. return err;
  2861. }
  2862. /* Check for a network adapter of this type,
  2863. * and return device structure if one exists.
  2864. */
  2865. struct net_device __init *smctr_probe(int unit)
  2866. {
  2867. struct net_device *dev = alloc_trdev(sizeof(struct net_local));
  2868. static const unsigned ports[] = {
  2869. 0x200, 0x220, 0x240, 0x260, 0x280, 0x2A0, 0x2C0, 0x2E0, 0x300,
  2870. 0x320, 0x340, 0x360, 0x380, 0
  2871. };
  2872. const unsigned *port;
  2873. int err = 0;
  2874. if (!dev)
  2875. return ERR_PTR(-ENOMEM);
  2876. if (unit >= 0) {
  2877. sprintf(dev->name, "tr%d", unit);
  2878. netdev_boot_setup_check(dev);
  2879. }
  2880. if (dev->base_addr > 0x1ff) /* Check a single specified location. */
  2881. err = smctr_probe1(dev, dev->base_addr);
  2882. else if(dev->base_addr != 0) /* Don't probe at all. */
  2883. err =-ENXIO;
  2884. else {
  2885. for (port = ports; *port; port++) {
  2886. err = smctr_probe1(dev, *port);
  2887. if (!err)
  2888. break;
  2889. }
  2890. }
  2891. if (err)
  2892. goto out;
  2893. err = register_netdev(dev);
  2894. if (err)
  2895. goto out1;
  2896. return dev;
  2897. out1:
  2898. #ifdef CONFIG_MCA_LEGACY
  2899. { struct net_local *tp = netdev_priv(dev);
  2900. if (tp->slot_num)
  2901. mca_mark_as_unused(tp->slot_num);
  2902. }
  2903. #endif
  2904. release_region(dev->base_addr, SMCTR_IO_EXTENT);
  2905. free_irq(dev->irq, dev);
  2906. out:
  2907. free_netdev(dev);
  2908. return ERR_PTR(err);
  2909. }
  2910. static const struct net_device_ops smctr_netdev_ops = {
  2911. .ndo_open = smctr_open,
  2912. .ndo_stop = smctr_close,
  2913. .ndo_start_xmit = smctr_send_packet,
  2914. .ndo_tx_timeout = smctr_timeout,
  2915. .ndo_get_stats = smctr_get_stats,
  2916. .ndo_set_rx_mode = smctr_set_multicast_list,
  2917. };
  2918. static int __init smctr_probe1(struct net_device *dev, int ioaddr)
  2919. {
  2920. static unsigned version_printed;
  2921. struct net_local *tp = netdev_priv(dev);
  2922. int err;
  2923. __u32 *ram;
  2924. if(smctr_debug && version_printed++ == 0)
  2925. printk(version);
  2926. spin_lock_init(&tp->lock);
  2927. dev->base_addr = ioaddr;
  2928. /* Actually detect an adapter now. */
  2929. err = smctr_chk_isa(dev);
  2930. if(err < 0)
  2931. {
  2932. if ((err = smctr_chk_mca(dev)) < 0) {
  2933. err = -ENODEV;
  2934. goto out;
  2935. }
  2936. }
  2937. tp = netdev_priv(dev);
  2938. dev->mem_start = tp->ram_base;
  2939. dev->mem_end = dev->mem_start + 0x10000;
  2940. ram = (__u32 *)phys_to_virt(dev->mem_start);
  2941. tp->ram_access = *(__u32 *)&ram;
  2942. tp->status = NOT_INITIALIZED;
  2943. err = smctr_load_firmware(dev);
  2944. if(err != UCODE_PRESENT && err != SUCCESS)
  2945. {
  2946. printk(KERN_ERR "%s: Firmware load failed (%d)\n", dev->name, err);
  2947. err = -EIO;
  2948. goto out;
  2949. }
  2950. /* Allow user to specify ring speed on module insert. */
  2951. if(ringspeed == 4)
  2952. tp->media_type = MEDIA_UTP_4;
  2953. else
  2954. tp->media_type = MEDIA_UTP_16;
  2955. printk(KERN_INFO "%s: %s %s at Io %#4x, Irq %d, Rom %#4x, Ram %#4x.\n",
  2956. dev->name, smctr_name, smctr_model,
  2957. (unsigned int)dev->base_addr,
  2958. dev->irq, tp->rom_base, tp->ram_base);
  2959. dev->netdev_ops = &smctr_netdev_ops;
  2960. dev->watchdog_timeo = HZ;
  2961. return 0;
  2962. out:
  2963. return err;
  2964. }
  2965. static int smctr_process_rx_packet(MAC_HEADER *rmf, __u16 size,
  2966. struct net_device *dev, __u16 rx_status)
  2967. {
  2968. struct net_local *tp = netdev_priv(dev);
  2969. struct sk_buff *skb;
  2970. __u16 rcode, correlator;
  2971. int err = 0;
  2972. __u8 xframe = 1;
  2973. rmf->vl = SWAP_BYTES(rmf->vl);
  2974. if(rx_status & FCB_RX_STATUS_DA_MATCHED)
  2975. {
  2976. switch(rmf->vc)
  2977. {
  2978. /* Received MAC Frames Processed by RS. */
  2979. case INIT:
  2980. if((rcode = smctr_rcv_init(dev, rmf, &correlator)) == HARDWARE_FAILED)
  2981. {
  2982. return rcode;
  2983. }
  2984. if((err = smctr_send_rsp(dev, rmf, rcode,
  2985. correlator)))
  2986. {
  2987. return err;
  2988. }
  2989. break;
  2990. case CHG_PARM:
  2991. if((rcode = smctr_rcv_chg_param(dev, rmf,
  2992. &correlator)) ==HARDWARE_FAILED)
  2993. {
  2994. return rcode;
  2995. }
  2996. if((err = smctr_send_rsp(dev, rmf, rcode,
  2997. correlator)))
  2998. {
  2999. return err;
  3000. }
  3001. break;
  3002. case RQ_ADDR:
  3003. if((rcode = smctr_rcv_rq_addr_state_attch(dev,
  3004. rmf, &correlator)) != POSITIVE_ACK)
  3005. {
  3006. if(rcode == HARDWARE_FAILED)
  3007. return rcode;
  3008. else
  3009. return smctr_send_rsp(dev, rmf,
  3010. rcode, correlator);
  3011. }
  3012. if((err = smctr_send_rpt_addr(dev, rmf,
  3013. correlator)))
  3014. {
  3015. return err;
  3016. }
  3017. break;
  3018. case RQ_ATTCH:
  3019. if((rcode = smctr_rcv_rq_addr_state_attch(dev,
  3020. rmf, &correlator)) != POSITIVE_ACK)
  3021. {
  3022. if(rcode == HARDWARE_FAILED)
  3023. return rcode;
  3024. else
  3025. return smctr_send_rsp(dev, rmf,
  3026. rcode,
  3027. correlator);
  3028. }
  3029. if((err = smctr_send_rpt_attch(dev, rmf,
  3030. correlator)))
  3031. {
  3032. return err;
  3033. }
  3034. break;
  3035. case RQ_STATE:
  3036. if((rcode = smctr_rcv_rq_addr_state_attch(dev,
  3037. rmf, &correlator)) != POSITIVE_ACK)
  3038. {
  3039. if(rcode == HARDWARE_FAILED)
  3040. return rcode;
  3041. else
  3042. return smctr_send_rsp(dev, rmf,
  3043. rcode,
  3044. correlator);
  3045. }
  3046. if((err = smctr_send_rpt_state(dev, rmf,
  3047. correlator)))
  3048. {
  3049. return err;
  3050. }
  3051. break;
  3052. case TX_FORWARD: {
  3053. __u16 uninitialized_var(tx_fstatus);
  3054. if((rcode = smctr_rcv_tx_forward(dev, rmf))
  3055. != POSITIVE_ACK)
  3056. {
  3057. if(rcode == HARDWARE_FAILED)
  3058. return rcode;
  3059. else
  3060. return smctr_send_rsp(dev, rmf,
  3061. rcode,
  3062. correlator);
  3063. }
  3064. if((err = smctr_send_tx_forward(dev, rmf,
  3065. &tx_fstatus)) == HARDWARE_FAILED)
  3066. {
  3067. return err;
  3068. }
  3069. if(err == A_FRAME_WAS_FORWARDED)
  3070. {
  3071. if((err = smctr_send_rpt_tx_forward(dev,
  3072. rmf, tx_fstatus))
  3073. == HARDWARE_FAILED)
  3074. {
  3075. return err;
  3076. }
  3077. }
  3078. break;
  3079. }
  3080. /* Received MAC Frames Processed by CRS/REM/RPS. */
  3081. case RSP:
  3082. case RQ_INIT:
  3083. case RPT_NEW_MON:
  3084. case RPT_SUA_CHG:
  3085. case RPT_ACTIVE_ERR:
  3086. case RPT_NN_INCMP:
  3087. case RPT_ERROR:
  3088. case RPT_ATTCH:
  3089. case RPT_STATE:
  3090. case RPT_ADDR:
  3091. break;
  3092. /* Rcvd Att. MAC Frame (if RXATMAC set) or UNKNOWN */
  3093. default:
  3094. xframe = 0;
  3095. if(!(tp->receive_mask & ACCEPT_ATT_MAC_FRAMES))
  3096. {
  3097. rcode = smctr_rcv_unknown(dev, rmf,
  3098. &correlator);
  3099. if((err = smctr_send_rsp(dev, rmf,rcode,
  3100. correlator)))
  3101. {
  3102. return err;
  3103. }
  3104. }
  3105. break;
  3106. }
  3107. }
  3108. else
  3109. {
  3110. /* 1. DA doesn't match (Promiscuous Mode).
  3111. * 2. Parse for Extended MAC Frame Type.
  3112. */
  3113. switch(rmf->vc)
  3114. {
  3115. case RSP:
  3116. case INIT:
  3117. case RQ_INIT:
  3118. case RQ_ADDR:
  3119. case RQ_ATTCH:
  3120. case RQ_STATE:
  3121. case CHG_PARM:
  3122. case RPT_ADDR:
  3123. case RPT_ERROR:
  3124. case RPT_ATTCH:
  3125. case RPT_STATE:
  3126. case RPT_NEW_MON:
  3127. case RPT_SUA_CHG:
  3128. case RPT_NN_INCMP:
  3129. case RPT_ACTIVE_ERR:
  3130. break;
  3131. default:
  3132. xframe = 0;
  3133. break;
  3134. }
  3135. }
  3136. /* NOTE: UNKNOWN MAC frames will NOT be passed up unless
  3137. * ACCEPT_ATT_MAC_FRAMES is set.
  3138. */
  3139. if(((tp->receive_mask & ACCEPT_ATT_MAC_FRAMES) &&
  3140. (xframe == (__u8)0)) ||
  3141. ((tp->receive_mask & ACCEPT_EXT_MAC_FRAMES) &&
  3142. (xframe == (__u8)1)))
  3143. {
  3144. rmf->vl = SWAP_BYTES(rmf->vl);
  3145. if (!(skb = dev_alloc_skb(size)))
  3146. return -ENOMEM;
  3147. skb->len = size;
  3148. /* Slide data into a sleek skb. */
  3149. skb_put(skb, skb->len);
  3150. skb_copy_to_linear_data(skb, rmf, skb->len);
  3151. /* Update Counters */
  3152. tp->MacStat.rx_packets++;
  3153. tp->MacStat.rx_bytes += skb->len;
  3154. /* Kick the packet on up. */
  3155. skb->protocol = tr_type_trans(skb, dev);
  3156. netif_rx(skb);
  3157. err = 0;
  3158. }
  3159. return err;
  3160. }
  3161. /* Adapter RAM test. Incremental word ODD boundary data test. */
  3162. static int smctr_ram_memory_test(struct net_device *dev)
  3163. {
  3164. struct net_local *tp = netdev_priv(dev);
  3165. __u16 page, pages_of_ram, start_pattern = 0, word_pattern = 0,
  3166. word_read = 0, err_word = 0, err_pattern = 0;
  3167. unsigned int err_offset;
  3168. __u32 j, pword;
  3169. __u8 err = 0;
  3170. if(smctr_debug > 10)
  3171. printk(KERN_DEBUG "%s: smctr_ram_memory_test\n", dev->name);
  3172. start_pattern = 0x0001;
  3173. pages_of_ram = tp->ram_size / tp->ram_usable;
  3174. pword = tp->ram_access;
  3175. /* Incremental word ODD boundary test. */
  3176. for(page = 0; (page < pages_of_ram) && (~err);
  3177. page++, start_pattern += 0x8000)
  3178. {
  3179. smctr_set_page(dev, (__u8 *)(tp->ram_access
  3180. + (page * tp->ram_usable * 1024) + 1));
  3181. word_pattern = start_pattern;
  3182. for(j = 1; j < (__u32)(tp->ram_usable * 1024) - 1; j += 2)
  3183. *(__u16 *)(pword + j) = word_pattern++;
  3184. word_pattern = start_pattern;
  3185. for(j = 1; j < (__u32)(tp->ram_usable * 1024) - 1 && (~err);
  3186. j += 2, word_pattern++)
  3187. {
  3188. word_read = *(__u16 *)(pword + j);
  3189. if(word_read != word_pattern)
  3190. {
  3191. err = (__u8)1;
  3192. err_offset = j;
  3193. err_word = word_read;
  3194. err_pattern = word_pattern;
  3195. return RAM_TEST_FAILED;
  3196. }
  3197. }
  3198. }
  3199. /* Zero out memory. */
  3200. for(page = 0; page < pages_of_ram && (~err); page++)
  3201. {
  3202. smctr_set_page(dev, (__u8 *)(tp->ram_access
  3203. + (page * tp->ram_usable * 1024)));
  3204. word_pattern = 0;
  3205. for(j = 0; j < (__u32)tp->ram_usable * 1024; j +=2)
  3206. *(__u16 *)(pword + j) = word_pattern;
  3207. for(j =0; j < (__u32)tp->ram_usable * 1024 && (~err); j += 2)
  3208. {
  3209. word_read = *(__u16 *)(pword + j);
  3210. if(word_read != word_pattern)
  3211. {
  3212. err = (__u8)1;
  3213. err_offset = j;
  3214. err_word = word_read;
  3215. err_pattern = word_pattern;
  3216. return RAM_TEST_FAILED;
  3217. }
  3218. }
  3219. }
  3220. smctr_set_page(dev, (__u8 *)tp->ram_access);
  3221. return 0;
  3222. }
  3223. static int smctr_rcv_chg_param(struct net_device *dev, MAC_HEADER *rmf,
  3224. __u16 *correlator)
  3225. {
  3226. MAC_SUB_VECTOR *rsv;
  3227. signed short vlen;
  3228. __u16 rcode = POSITIVE_ACK;
  3229. unsigned int svectors = F_NO_SUB_VECTORS_FOUND;
  3230. /* This Frame can only come from a CRS */
  3231. if((rmf->dc_sc & SC_MASK) != SC_CRS)
  3232. return E_INAPPROPRIATE_SOURCE_CLASS;
  3233. /* Remove MVID Length from total length. */
  3234. vlen = (signed short)rmf->vl - 4;
  3235. /* Point to First SVID */
  3236. rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
  3237. /* Search for Appropriate SVID's. */
  3238. while((vlen > 0) && (rcode == POSITIVE_ACK))
  3239. {
  3240. switch(rsv->svi)
  3241. {
  3242. case CORRELATOR:
  3243. svectors |= F_CORRELATOR;
  3244. rcode = smctr_set_corr(dev, rsv, correlator);
  3245. break;
  3246. case LOCAL_RING_NUMBER:
  3247. svectors |= F_LOCAL_RING_NUMBER;
  3248. rcode = smctr_set_local_ring_num(dev, rsv);
  3249. break;
  3250. case ASSIGN_PHYSICAL_DROP:
  3251. svectors |= F_ASSIGN_PHYSICAL_DROP;
  3252. rcode = smctr_set_phy_drop(dev, rsv);
  3253. break;
  3254. case ERROR_TIMER_VALUE:
  3255. svectors |= F_ERROR_TIMER_VALUE;
  3256. rcode = smctr_set_error_timer_value(dev, rsv);
  3257. break;
  3258. case AUTHORIZED_FUNCTION_CLASS:
  3259. svectors |= F_AUTHORIZED_FUNCTION_CLASS;
  3260. rcode = smctr_set_auth_funct_class(dev, rsv);
  3261. break;
  3262. case AUTHORIZED_ACCESS_PRIORITY:
  3263. svectors |= F_AUTHORIZED_ACCESS_PRIORITY;
  3264. rcode = smctr_set_auth_access_pri(dev, rsv);
  3265. break;
  3266. default:
  3267. rcode = E_SUB_VECTOR_UNKNOWN;
  3268. break;
  3269. }
  3270. /* Let Sender Know if SUM of SV length's is
  3271. * larger then length in MVID length field
  3272. */
  3273. if((vlen -= rsv->svl) < 0)
  3274. rcode = E_VECTOR_LENGTH_ERROR;
  3275. rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
  3276. }
  3277. if(rcode == POSITIVE_ACK)
  3278. {
  3279. /* Let Sender Know if MVID length field
  3280. * is larger then SUM of SV length's
  3281. */
  3282. if(vlen != 0)
  3283. rcode = E_VECTOR_LENGTH_ERROR;
  3284. else
  3285. {
  3286. /* Let Sender Know if Expected SVID Missing */
  3287. if((svectors & R_CHG_PARM) ^ R_CHG_PARM)
  3288. rcode = E_MISSING_SUB_VECTOR;
  3289. }
  3290. }
  3291. return rcode;
  3292. }
  3293. static int smctr_rcv_init(struct net_device *dev, MAC_HEADER *rmf,
  3294. __u16 *correlator)
  3295. {
  3296. MAC_SUB_VECTOR *rsv;
  3297. signed short vlen;
  3298. __u16 rcode = POSITIVE_ACK;
  3299. unsigned int svectors = F_NO_SUB_VECTORS_FOUND;
  3300. /* This Frame can only come from a RPS */
  3301. if((rmf->dc_sc & SC_MASK) != SC_RPS)
  3302. return E_INAPPROPRIATE_SOURCE_CLASS;
  3303. /* Remove MVID Length from total length. */
  3304. vlen = (signed short)rmf->vl - 4;
  3305. /* Point to First SVID */
  3306. rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
  3307. /* Search for Appropriate SVID's */
  3308. while((vlen > 0) && (rcode == POSITIVE_ACK))
  3309. {
  3310. switch(rsv->svi)
  3311. {
  3312. case CORRELATOR:
  3313. svectors |= F_CORRELATOR;
  3314. rcode = smctr_set_corr(dev, rsv, correlator);
  3315. break;
  3316. case LOCAL_RING_NUMBER:
  3317. svectors |= F_LOCAL_RING_NUMBER;
  3318. rcode = smctr_set_local_ring_num(dev, rsv);
  3319. break;
  3320. case ASSIGN_PHYSICAL_DROP:
  3321. svectors |= F_ASSIGN_PHYSICAL_DROP;
  3322. rcode = smctr_set_phy_drop(dev, rsv);
  3323. break;
  3324. case ERROR_TIMER_VALUE:
  3325. svectors |= F_ERROR_TIMER_VALUE;
  3326. rcode = smctr_set_error_timer_value(dev, rsv);
  3327. break;
  3328. default:
  3329. rcode = E_SUB_VECTOR_UNKNOWN;
  3330. break;
  3331. }
  3332. /* Let Sender Know if SUM of SV length's is
  3333. * larger then length in MVID length field
  3334. */
  3335. if((vlen -= rsv->svl) < 0)
  3336. rcode = E_VECTOR_LENGTH_ERROR;
  3337. rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
  3338. }
  3339. if(rcode == POSITIVE_ACK)
  3340. {
  3341. /* Let Sender Know if MVID length field
  3342. * is larger then SUM of SV length's
  3343. */
  3344. if(vlen != 0)
  3345. rcode = E_VECTOR_LENGTH_ERROR;
  3346. else
  3347. {
  3348. /* Let Sender Know if Expected SV Missing */
  3349. if((svectors & R_INIT) ^ R_INIT)
  3350. rcode = E_MISSING_SUB_VECTOR;
  3351. }
  3352. }
  3353. return rcode;
  3354. }
  3355. static int smctr_rcv_tx_forward(struct net_device *dev, MAC_HEADER *rmf)
  3356. {
  3357. MAC_SUB_VECTOR *rsv;
  3358. signed short vlen;
  3359. __u16 rcode = POSITIVE_ACK;
  3360. unsigned int svectors = F_NO_SUB_VECTORS_FOUND;
  3361. /* This Frame can only come from a CRS */
  3362. if((rmf->dc_sc & SC_MASK) != SC_CRS)
  3363. return E_INAPPROPRIATE_SOURCE_CLASS;
  3364. /* Remove MVID Length from total length */
  3365. vlen = (signed short)rmf->vl - 4;
  3366. /* Point to First SVID */
  3367. rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
  3368. /* Search for Appropriate SVID's */
  3369. while((vlen > 0) && (rcode == POSITIVE_ACK))
  3370. {
  3371. switch(rsv->svi)
  3372. {
  3373. case FRAME_FORWARD:
  3374. svectors |= F_FRAME_FORWARD;
  3375. rcode = smctr_set_frame_forward(dev, rsv,
  3376. rmf->dc_sc);
  3377. break;
  3378. default:
  3379. rcode = E_SUB_VECTOR_UNKNOWN;
  3380. break;
  3381. }
  3382. /* Let Sender Know if SUM of SV length's is
  3383. * larger then length in MVID length field
  3384. */
  3385. if((vlen -= rsv->svl) < 0)
  3386. rcode = E_VECTOR_LENGTH_ERROR;
  3387. rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
  3388. }
  3389. if(rcode == POSITIVE_ACK)
  3390. {
  3391. /* Let Sender Know if MVID length field
  3392. * is larger then SUM of SV length's
  3393. */
  3394. if(vlen != 0)
  3395. rcode = E_VECTOR_LENGTH_ERROR;
  3396. else
  3397. {
  3398. /* Let Sender Know if Expected SV Missing */
  3399. if((svectors & R_TX_FORWARD) ^ R_TX_FORWARD)
  3400. rcode = E_MISSING_SUB_VECTOR;
  3401. }
  3402. }
  3403. return rcode;
  3404. }
  3405. static int smctr_rcv_rq_addr_state_attch(struct net_device *dev,
  3406. MAC_HEADER *rmf, __u16 *correlator)
  3407. {
  3408. MAC_SUB_VECTOR *rsv;
  3409. signed short vlen;
  3410. __u16 rcode = POSITIVE_ACK;
  3411. unsigned int svectors = F_NO_SUB_VECTORS_FOUND;
  3412. /* Remove MVID Length from total length */
  3413. vlen = (signed short)rmf->vl - 4;
  3414. /* Point to First SVID */
  3415. rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
  3416. /* Search for Appropriate SVID's */
  3417. while((vlen > 0) && (rcode == POSITIVE_ACK))
  3418. {
  3419. switch(rsv->svi)
  3420. {
  3421. case CORRELATOR:
  3422. svectors |= F_CORRELATOR;
  3423. rcode = smctr_set_corr(dev, rsv, correlator);
  3424. break;
  3425. default:
  3426. rcode = E_SUB_VECTOR_UNKNOWN;
  3427. break;
  3428. }
  3429. /* Let Sender Know if SUM of SV length's is
  3430. * larger then length in MVID length field
  3431. */
  3432. if((vlen -= rsv->svl) < 0)
  3433. rcode = E_VECTOR_LENGTH_ERROR;
  3434. rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
  3435. }
  3436. if(rcode == POSITIVE_ACK)
  3437. {
  3438. /* Let Sender Know if MVID length field
  3439. * is larger then SUM of SV length's
  3440. */
  3441. if(vlen != 0)
  3442. rcode = E_VECTOR_LENGTH_ERROR;
  3443. else
  3444. {
  3445. /* Let Sender Know if Expected SVID Missing */
  3446. if((svectors & R_RQ_ATTCH_STATE_ADDR)
  3447. ^ R_RQ_ATTCH_STATE_ADDR)
  3448. rcode = E_MISSING_SUB_VECTOR;
  3449. }
  3450. }
  3451. return rcode;
  3452. }
  3453. static int smctr_rcv_unknown(struct net_device *dev, MAC_HEADER *rmf,
  3454. __u16 *correlator)
  3455. {
  3456. MAC_SUB_VECTOR *rsv;
  3457. signed short vlen;
  3458. *correlator = 0;
  3459. /* Remove MVID Length from total length */
  3460. vlen = (signed short)rmf->vl - 4;
  3461. /* Point to First SVID */
  3462. rsv = (MAC_SUB_VECTOR *)((__u32)rmf + sizeof(MAC_HEADER));
  3463. /* Search for CORRELATOR for RSP to UNKNOWN */
  3464. while((vlen > 0) && (*correlator == 0))
  3465. {
  3466. switch(rsv->svi)
  3467. {
  3468. case CORRELATOR:
  3469. smctr_set_corr(dev, rsv, correlator);
  3470. break;
  3471. default:
  3472. break;
  3473. }
  3474. vlen -= rsv->svl;
  3475. rsv = (MAC_SUB_VECTOR *)((__u32)rsv + rsv->svl);
  3476. }
  3477. return E_UNRECOGNIZED_VECTOR_ID;
  3478. }
  3479. /*
  3480. * Reset the 825 NIC and exit w:
  3481. * 1. The NIC reset cleared (non-reset state), halted and un-initialized.
  3482. * 2. TINT masked.
  3483. * 3. CBUSY masked.
  3484. * 4. TINT clear.
  3485. * 5. CBUSY clear.
  3486. */
  3487. static int smctr_reset_adapter(struct net_device *dev)
  3488. {
  3489. struct net_local *tp = netdev_priv(dev);
  3490. int ioaddr = dev->base_addr;
  3491. /* Reseting the NIC will put it in a halted and un-initialized state. */ smctr_set_trc_reset(ioaddr);
  3492. mdelay(200); /* ~2 ms */
  3493. smctr_clear_trc_reset(ioaddr);
  3494. mdelay(200); /* ~2 ms */
  3495. /* Remove any latched interrupts that occurred prior to reseting the
  3496. * adapter or possibily caused by line glitches due to the reset.
  3497. */
  3498. outb(tp->trc_mask | CSR_CLRTINT | CSR_CLRCBUSY, ioaddr + CSR);
  3499. return 0;
  3500. }
  3501. static int smctr_restart_tx_chain(struct net_device *dev, short queue)
  3502. {
  3503. struct net_local *tp = netdev_priv(dev);
  3504. int err = 0;
  3505. if(smctr_debug > 10)
  3506. printk(KERN_DEBUG "%s: smctr_restart_tx_chain\n", dev->name);
  3507. if(tp->num_tx_fcbs_used[queue] != 0 &&
  3508. tp->tx_queue_status[queue] == NOT_TRANSMITING)
  3509. {
  3510. tp->tx_queue_status[queue] = TRANSMITING;
  3511. err = smctr_issue_resume_tx_fcb_cmd(dev, queue);
  3512. }
  3513. return err;
  3514. }
  3515. static int smctr_ring_status_chg(struct net_device *dev)
  3516. {
  3517. struct net_local *tp = netdev_priv(dev);
  3518. if(smctr_debug > 10)
  3519. printk(KERN_DEBUG "%s: smctr_ring_status_chg\n", dev->name);
  3520. /* Check for ring_status_flag: whenever MONITOR_STATE_BIT
  3521. * Bit is set, check value of monitor_state, only then we
  3522. * enable and start transmit/receive timeout (if and only
  3523. * if it is MS_ACTIVE_MONITOR_STATE or MS_STANDBY_MONITOR_STATE)
  3524. */
  3525. if(tp->ring_status_flags == MONITOR_STATE_CHANGED)
  3526. {
  3527. if((tp->monitor_state == MS_ACTIVE_MONITOR_STATE) ||
  3528. (tp->monitor_state == MS_STANDBY_MONITOR_STATE))
  3529. {
  3530. tp->monitor_state_ready = 1;
  3531. }
  3532. else
  3533. {
  3534. /* if adapter is NOT in either active monitor
  3535. * or standby monitor state => Disable
  3536. * transmit/receive timeout.
  3537. */
  3538. tp->monitor_state_ready = 0;
  3539. /* Ring speed problem, switching to auto mode. */
  3540. if(tp->monitor_state == MS_MONITOR_FSM_INACTIVE &&
  3541. !tp->cleanup)
  3542. {
  3543. printk(KERN_INFO "%s: Incorrect ring speed switching.\n",
  3544. dev->name);
  3545. smctr_set_ring_speed(dev);
  3546. }
  3547. }
  3548. }
  3549. if(!(tp->ring_status_flags & RING_STATUS_CHANGED))
  3550. return 0;
  3551. switch(tp->ring_status)
  3552. {
  3553. case RING_RECOVERY:
  3554. printk(KERN_INFO "%s: Ring Recovery\n", dev->name);
  3555. break;
  3556. case SINGLE_STATION:
  3557. printk(KERN_INFO "%s: Single Statinon\n", dev->name);
  3558. break;
  3559. case COUNTER_OVERFLOW:
  3560. printk(KERN_INFO "%s: Counter Overflow\n", dev->name);
  3561. break;
  3562. case REMOVE_RECEIVED:
  3563. printk(KERN_INFO "%s: Remove Received\n", dev->name);
  3564. break;
  3565. case AUTO_REMOVAL_ERROR:
  3566. printk(KERN_INFO "%s: Auto Remove Error\n", dev->name);
  3567. break;
  3568. case LOBE_WIRE_FAULT:
  3569. printk(KERN_INFO "%s: Lobe Wire Fault\n", dev->name);
  3570. break;
  3571. case TRANSMIT_BEACON:
  3572. printk(KERN_INFO "%s: Transmit Beacon\n", dev->name);
  3573. break;
  3574. case SOFT_ERROR:
  3575. printk(KERN_INFO "%s: Soft Error\n", dev->name);
  3576. break;
  3577. case HARD_ERROR:
  3578. printk(KERN_INFO "%s: Hard Error\n", dev->name);
  3579. break;
  3580. case SIGNAL_LOSS:
  3581. printk(KERN_INFO "%s: Signal Loss\n", dev->name);
  3582. break;
  3583. default:
  3584. printk(KERN_INFO "%s: Unknown ring status change\n",
  3585. dev->name);
  3586. break;
  3587. }
  3588. return 0;
  3589. }
  3590. static int smctr_rx_frame(struct net_device *dev)
  3591. {
  3592. struct net_local *tp = netdev_priv(dev);
  3593. __u16 queue, status, rx_size, err = 0;
  3594. __u8 *pbuff;
  3595. if(smctr_debug > 10)
  3596. printk(KERN_DEBUG "%s: smctr_rx_frame\n", dev->name);
  3597. queue = tp->receive_queue_number;
  3598. while((status = tp->rx_fcb_curr[queue]->frame_status) != SUCCESS)
  3599. {
  3600. err = HARDWARE_FAILED;
  3601. if(((status & 0x007f) == 0) ||
  3602. ((tp->receive_mask & ACCEPT_ERR_PACKETS) != 0))
  3603. {
  3604. /* frame length less the CRC (4 bytes) + FS (1 byte) */
  3605. rx_size = tp->rx_fcb_curr[queue]->frame_length - 5;
  3606. pbuff = smctr_get_rx_pointer(dev, queue);
  3607. smctr_set_page(dev, pbuff);
  3608. smctr_disable_16bit(dev);
  3609. /* pbuff points to addr within one page */
  3610. pbuff = (__u8 *)PAGE_POINTER(pbuff);
  3611. if(queue == NON_MAC_QUEUE)
  3612. {
  3613. struct sk_buff *skb;
  3614. skb = dev_alloc_skb(rx_size);
  3615. if (skb) {
  3616. skb_put(skb, rx_size);
  3617. skb_copy_to_linear_data(skb, pbuff, rx_size);
  3618. /* Update Counters */
  3619. tp->MacStat.rx_packets++;
  3620. tp->MacStat.rx_bytes += skb->len;
  3621. /* Kick the packet on up. */
  3622. skb->protocol = tr_type_trans(skb, dev);
  3623. netif_rx(skb);
  3624. } else {
  3625. }
  3626. }
  3627. else
  3628. smctr_process_rx_packet((MAC_HEADER *)pbuff,
  3629. rx_size, dev, status);
  3630. }
  3631. smctr_enable_16bit(dev);
  3632. smctr_set_page(dev, (__u8 *)tp->ram_access);
  3633. smctr_update_rx_chain(dev, queue);
  3634. if(err != SUCCESS)
  3635. break;
  3636. }
  3637. return err;
  3638. }
  3639. static int smctr_send_dat(struct net_device *dev)
  3640. {
  3641. struct net_local *tp = netdev_priv(dev);
  3642. unsigned int i, err;
  3643. MAC_HEADER *tmf;
  3644. FCBlock *fcb;
  3645. if(smctr_debug > 10)
  3646. printk(KERN_DEBUG "%s: smctr_send_dat\n", dev->name);
  3647. if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE,
  3648. sizeof(MAC_HEADER))) == (FCBlock *)(-1L))
  3649. {
  3650. return OUT_OF_RESOURCES;
  3651. }
  3652. /* Initialize DAT Data Fields. */
  3653. tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
  3654. tmf->ac = MSB(AC_FC_DAT);
  3655. tmf->fc = LSB(AC_FC_DAT);
  3656. for(i = 0; i < 6; i++)
  3657. {
  3658. tmf->sa[i] = dev->dev_addr[i];
  3659. tmf->da[i] = dev->dev_addr[i];
  3660. }
  3661. tmf->vc = DAT;
  3662. tmf->dc_sc = DC_RS | SC_RS;
  3663. tmf->vl = 4;
  3664. tmf->vl = SWAP_BYTES(tmf->vl);
  3665. /* Start Transmit. */
  3666. if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE)))
  3667. return err;
  3668. /* Wait for Transmit to Complete */
  3669. for(i = 0; i < 10000; i++)
  3670. {
  3671. if(fcb->frame_status & FCB_COMMAND_DONE)
  3672. break;
  3673. mdelay(1);
  3674. }
  3675. /* Check if GOOD frame Tx'ed. */
  3676. if(!(fcb->frame_status & FCB_COMMAND_DONE) ||
  3677. fcb->frame_status & (FCB_TX_STATUS_E | FCB_TX_AC_BITS))
  3678. {
  3679. return INITIALIZE_FAILED;
  3680. }
  3681. /* De-allocated Tx FCB and Frame Buffer
  3682. * The FCB must be de-allocated manually if executing with
  3683. * interrupts disabled, other wise the ISR (LM_Service_Events)
  3684. * will de-allocate it when the interrupt occurs.
  3685. */
  3686. tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING;
  3687. smctr_update_tx_chain(dev, fcb, MAC_QUEUE);
  3688. return 0;
  3689. }
  3690. static void smctr_timeout(struct net_device *dev)
  3691. {
  3692. /*
  3693. * If we get here, some higher level has decided we are broken.
  3694. * There should really be a "kick me" function call instead.
  3695. *
  3696. * Resetting the token ring adapter takes a long time so just
  3697. * fake transmission time and go on trying. Our own timeout
  3698. * routine is in sktr_timer_chk()
  3699. */
  3700. dev->trans_start = jiffies; /* prevent tx timeout */
  3701. netif_wake_queue(dev);
  3702. }
  3703. /*
  3704. * Gets skb from system, queues it and checks if it can be sent
  3705. */
  3706. static netdev_tx_t smctr_send_packet(struct sk_buff *skb,
  3707. struct net_device *dev)
  3708. {
  3709. struct net_local *tp = netdev_priv(dev);
  3710. if(smctr_debug > 10)
  3711. printk(KERN_DEBUG "%s: smctr_send_packet\n", dev->name);
  3712. /*
  3713. * Block a transmit overlap
  3714. */
  3715. netif_stop_queue(dev);
  3716. if(tp->QueueSkb == 0)
  3717. return NETDEV_TX_BUSY; /* Return with tbusy set: queue full */
  3718. tp->QueueSkb--;
  3719. skb_queue_tail(&tp->SendSkbQueue, skb);
  3720. smctr_hardware_send_packet(dev, tp);
  3721. if(tp->QueueSkb > 0)
  3722. netif_wake_queue(dev);
  3723. return NETDEV_TX_OK;
  3724. }
  3725. static int smctr_send_lobe_media_test(struct net_device *dev)
  3726. {
  3727. struct net_local *tp = netdev_priv(dev);
  3728. MAC_SUB_VECTOR *tsv;
  3729. MAC_HEADER *tmf;
  3730. FCBlock *fcb;
  3731. __u32 i;
  3732. int err;
  3733. if(smctr_debug > 15)
  3734. printk(KERN_DEBUG "%s: smctr_send_lobe_media_test\n", dev->name);
  3735. if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(struct trh_hdr)
  3736. + S_WRAP_DATA + S_WRAP_DATA)) == (FCBlock *)(-1L))
  3737. {
  3738. return OUT_OF_RESOURCES;
  3739. }
  3740. /* Initialize DAT Data Fields. */
  3741. tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
  3742. tmf->ac = MSB(AC_FC_LOBE_MEDIA_TEST);
  3743. tmf->fc = LSB(AC_FC_LOBE_MEDIA_TEST);
  3744. for(i = 0; i < 6; i++)
  3745. {
  3746. tmf->da[i] = 0;
  3747. tmf->sa[i] = dev->dev_addr[i];
  3748. }
  3749. tmf->vc = LOBE_MEDIA_TEST;
  3750. tmf->dc_sc = DC_RS | SC_RS;
  3751. tmf->vl = 4;
  3752. tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
  3753. smctr_make_wrap_data(dev, tsv);
  3754. tmf->vl += tsv->svl;
  3755. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3756. smctr_make_wrap_data(dev, tsv);
  3757. tmf->vl += tsv->svl;
  3758. /* Start Transmit. */
  3759. tmf->vl = SWAP_BYTES(tmf->vl);
  3760. if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE)))
  3761. return err;
  3762. /* Wait for Transmit to Complete. (10 ms). */
  3763. for(i=0; i < 10000; i++)
  3764. {
  3765. if(fcb->frame_status & FCB_COMMAND_DONE)
  3766. break;
  3767. mdelay(1);
  3768. }
  3769. /* Check if GOOD frame Tx'ed */
  3770. if(!(fcb->frame_status & FCB_COMMAND_DONE) ||
  3771. fcb->frame_status & (FCB_TX_STATUS_E | FCB_TX_AC_BITS))
  3772. {
  3773. return LOBE_MEDIA_TEST_FAILED;
  3774. }
  3775. /* De-allocated Tx FCB and Frame Buffer
  3776. * The FCB must be de-allocated manually if executing with
  3777. * interrupts disabled, other wise the ISR (LM_Service_Events)
  3778. * will de-allocate it when the interrupt occurs.
  3779. */
  3780. tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING;
  3781. smctr_update_tx_chain(dev, fcb, MAC_QUEUE);
  3782. return 0;
  3783. }
  3784. static int smctr_send_rpt_addr(struct net_device *dev, MAC_HEADER *rmf,
  3785. __u16 correlator)
  3786. {
  3787. MAC_HEADER *tmf;
  3788. MAC_SUB_VECTOR *tsv;
  3789. FCBlock *fcb;
  3790. if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
  3791. + S_CORRELATOR + S_PHYSICAL_DROP + S_UPSTREAM_NEIGHBOR_ADDRESS
  3792. + S_ADDRESS_MODIFER + S_GROUP_ADDRESS + S_FUNCTIONAL_ADDRESS))
  3793. == (FCBlock *)(-1L))
  3794. {
  3795. return 0;
  3796. }
  3797. tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
  3798. tmf->vc = RPT_ADDR;
  3799. tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
  3800. tmf->vl = 4;
  3801. smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_ADDR);
  3802. tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
  3803. smctr_make_corr(dev, tsv, correlator);
  3804. tmf->vl += tsv->svl;
  3805. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3806. smctr_make_phy_drop_num(dev, tsv);
  3807. tmf->vl += tsv->svl;
  3808. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3809. smctr_make_upstream_neighbor_addr(dev, tsv);
  3810. tmf->vl += tsv->svl;
  3811. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3812. smctr_make_addr_mod(dev, tsv);
  3813. tmf->vl += tsv->svl;
  3814. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3815. smctr_make_group_addr(dev, tsv);
  3816. tmf->vl += tsv->svl;
  3817. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3818. smctr_make_funct_addr(dev, tsv);
  3819. tmf->vl += tsv->svl;
  3820. /* Subtract out MVID and MVL which is
  3821. * include in both vl and MAC_HEADER
  3822. */
  3823. /* fcb->frame_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3824. fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3825. */
  3826. tmf->vl = SWAP_BYTES(tmf->vl);
  3827. return smctr_trc_send_packet(dev, fcb, MAC_QUEUE);
  3828. }
  3829. static int smctr_send_rpt_attch(struct net_device *dev, MAC_HEADER *rmf,
  3830. __u16 correlator)
  3831. {
  3832. MAC_HEADER *tmf;
  3833. MAC_SUB_VECTOR *tsv;
  3834. FCBlock *fcb;
  3835. if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
  3836. + S_CORRELATOR + S_PRODUCT_INSTANCE_ID + S_FUNCTIONAL_ADDRESS
  3837. + S_AUTHORIZED_FUNCTION_CLASS + S_AUTHORIZED_ACCESS_PRIORITY))
  3838. == (FCBlock *)(-1L))
  3839. {
  3840. return 0;
  3841. }
  3842. tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
  3843. tmf->vc = RPT_ATTCH;
  3844. tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
  3845. tmf->vl = 4;
  3846. smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_ATTCH);
  3847. tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
  3848. smctr_make_corr(dev, tsv, correlator);
  3849. tmf->vl += tsv->svl;
  3850. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3851. smctr_make_product_id(dev, tsv);
  3852. tmf->vl += tsv->svl;
  3853. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3854. smctr_make_funct_addr(dev, tsv);
  3855. tmf->vl += tsv->svl;
  3856. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3857. smctr_make_auth_funct_class(dev, tsv);
  3858. tmf->vl += tsv->svl;
  3859. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3860. smctr_make_access_pri(dev, tsv);
  3861. tmf->vl += tsv->svl;
  3862. /* Subtract out MVID and MVL which is
  3863. * include in both vl and MAC_HEADER
  3864. */
  3865. /* fcb->frame_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3866. fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3867. */
  3868. tmf->vl = SWAP_BYTES(tmf->vl);
  3869. return smctr_trc_send_packet(dev, fcb, MAC_QUEUE);
  3870. }
  3871. static int smctr_send_rpt_state(struct net_device *dev, MAC_HEADER *rmf,
  3872. __u16 correlator)
  3873. {
  3874. MAC_HEADER *tmf;
  3875. MAC_SUB_VECTOR *tsv;
  3876. FCBlock *fcb;
  3877. if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
  3878. + S_CORRELATOR + S_RING_STATION_VERSION_NUMBER
  3879. + S_RING_STATION_STATUS + S_STATION_IDENTIFER))
  3880. == (FCBlock *)(-1L))
  3881. {
  3882. return 0;
  3883. }
  3884. tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
  3885. tmf->vc = RPT_STATE;
  3886. tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
  3887. tmf->vl = 4;
  3888. smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_STATE);
  3889. tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
  3890. smctr_make_corr(dev, tsv, correlator);
  3891. tmf->vl += tsv->svl;
  3892. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3893. smctr_make_ring_station_version(dev, tsv);
  3894. tmf->vl += tsv->svl;
  3895. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3896. smctr_make_ring_station_status(dev, tsv);
  3897. tmf->vl += tsv->svl;
  3898. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3899. smctr_make_station_id(dev, tsv);
  3900. tmf->vl += tsv->svl;
  3901. /* Subtract out MVID and MVL which is
  3902. * include in both vl and MAC_HEADER
  3903. */
  3904. /* fcb->frame_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3905. fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3906. */
  3907. tmf->vl = SWAP_BYTES(tmf->vl);
  3908. return smctr_trc_send_packet(dev, fcb, MAC_QUEUE);
  3909. }
  3910. static int smctr_send_rpt_tx_forward(struct net_device *dev,
  3911. MAC_HEADER *rmf, __u16 tx_fstatus)
  3912. {
  3913. MAC_HEADER *tmf;
  3914. MAC_SUB_VECTOR *tsv;
  3915. FCBlock *fcb;
  3916. if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
  3917. + S_TRANSMIT_STATUS_CODE)) == (FCBlock *)(-1L))
  3918. {
  3919. return 0;
  3920. }
  3921. tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
  3922. tmf->vc = RPT_TX_FORWARD;
  3923. tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
  3924. tmf->vl = 4;
  3925. smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RPT_TX_FORWARD);
  3926. tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
  3927. smctr_make_tx_status_code(dev, tsv, tx_fstatus);
  3928. tmf->vl += tsv->svl;
  3929. /* Subtract out MVID and MVL which is
  3930. * include in both vl and MAC_HEADER
  3931. */
  3932. /* fcb->frame_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3933. fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3934. */
  3935. tmf->vl = SWAP_BYTES(tmf->vl);
  3936. return smctr_trc_send_packet(dev, fcb, MAC_QUEUE);
  3937. }
  3938. static int smctr_send_rsp(struct net_device *dev, MAC_HEADER *rmf,
  3939. __u16 rcode, __u16 correlator)
  3940. {
  3941. MAC_HEADER *tmf;
  3942. MAC_SUB_VECTOR *tsv;
  3943. FCBlock *fcb;
  3944. if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
  3945. + S_CORRELATOR + S_RESPONSE_CODE)) == (FCBlock *)(-1L))
  3946. {
  3947. return 0;
  3948. }
  3949. tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
  3950. tmf->vc = RSP;
  3951. tmf->dc_sc = (rmf->dc_sc & SC_MASK) << 4;
  3952. tmf->vl = 4;
  3953. smctr_make_8025_hdr(dev, rmf, tmf, AC_FC_RSP);
  3954. tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
  3955. smctr_make_corr(dev, tsv, correlator);
  3956. return 0;
  3957. }
  3958. static int smctr_send_rq_init(struct net_device *dev)
  3959. {
  3960. struct net_local *tp = netdev_priv(dev);
  3961. MAC_HEADER *tmf;
  3962. MAC_SUB_VECTOR *tsv;
  3963. FCBlock *fcb;
  3964. unsigned int i, count = 0;
  3965. __u16 fstatus;
  3966. int err;
  3967. do {
  3968. if(((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, sizeof(MAC_HEADER)
  3969. + S_PRODUCT_INSTANCE_ID + S_UPSTREAM_NEIGHBOR_ADDRESS
  3970. + S_RING_STATION_VERSION_NUMBER + S_ADDRESS_MODIFER))
  3971. == (FCBlock *)(-1L)))
  3972. {
  3973. return 0;
  3974. }
  3975. tmf = (MAC_HEADER *)fcb->bdb_ptr->data_block_ptr;
  3976. tmf->vc = RQ_INIT;
  3977. tmf->dc_sc = DC_RPS | SC_RS;
  3978. tmf->vl = 4;
  3979. smctr_make_8025_hdr(dev, NULL, tmf, AC_FC_RQ_INIT);
  3980. tsv = (MAC_SUB_VECTOR *)((__u32)tmf + sizeof(MAC_HEADER));
  3981. smctr_make_product_id(dev, tsv);
  3982. tmf->vl += tsv->svl;
  3983. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3984. smctr_make_upstream_neighbor_addr(dev, tsv);
  3985. tmf->vl += tsv->svl;
  3986. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3987. smctr_make_ring_station_version(dev, tsv);
  3988. tmf->vl += tsv->svl;
  3989. tsv = (MAC_SUB_VECTOR *)((__u32)tsv + tsv->svl);
  3990. smctr_make_addr_mod(dev, tsv);
  3991. tmf->vl += tsv->svl;
  3992. /* Subtract out MVID and MVL which is
  3993. * include in both vl and MAC_HEADER
  3994. */
  3995. /* fcb->frame_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3996. fcb->bdb_ptr->buffer_length = tmf->vl + sizeof(MAC_HEADER) - 4;
  3997. */
  3998. tmf->vl = SWAP_BYTES(tmf->vl);
  3999. if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE)))
  4000. return err;
  4001. /* Wait for Transmit to Complete */
  4002. for(i = 0; i < 10000; i++)
  4003. {
  4004. if(fcb->frame_status & FCB_COMMAND_DONE)
  4005. break;
  4006. mdelay(1);
  4007. }
  4008. /* Check if GOOD frame Tx'ed */
  4009. fstatus = fcb->frame_status;
  4010. if(!(fstatus & FCB_COMMAND_DONE))
  4011. return HARDWARE_FAILED;
  4012. if(!(fstatus & FCB_TX_STATUS_E))
  4013. count++;
  4014. /* De-allocated Tx FCB and Frame Buffer
  4015. * The FCB must be de-allocated manually if executing with
  4016. * interrupts disabled, other wise the ISR (LM_Service_Events)
  4017. * will de-allocate it when the interrupt occurs.
  4018. */
  4019. tp->tx_queue_status[MAC_QUEUE] = NOT_TRANSMITING;
  4020. smctr_update_tx_chain(dev, fcb, MAC_QUEUE);
  4021. } while(count < 4 && ((fstatus & FCB_TX_AC_BITS) ^ FCB_TX_AC_BITS));
  4022. return smctr_join_complete_state(dev);
  4023. }
  4024. static int smctr_send_tx_forward(struct net_device *dev, MAC_HEADER *rmf,
  4025. __u16 *tx_fstatus)
  4026. {
  4027. struct net_local *tp = netdev_priv(dev);
  4028. FCBlock *fcb;
  4029. unsigned int i;
  4030. int err;
  4031. /* Check if this is the END POINT of the Transmit Forward Chain. */
  4032. if(rmf->vl <= 18)
  4033. return 0;
  4034. /* Allocate Transmit FCB only by requesting 0 bytes
  4035. * of data buffer.
  4036. */
  4037. if((fcb = smctr_get_tx_fcb(dev, MAC_QUEUE, 0)) == (FCBlock *)(-1L))
  4038. return 0;
  4039. /* Set pointer to Transmit Frame Buffer to the data
  4040. * portion of the received TX Forward frame, making
  4041. * sure to skip over the Vector Code (vc) and Vector
  4042. * length (vl).
  4043. */
  4044. fcb->bdb_ptr->trc_data_block_ptr = TRC_POINTER((__u32)rmf
  4045. + sizeof(MAC_HEADER) + 2);
  4046. fcb->bdb_ptr->data_block_ptr = (__u16 *)((__u32)rmf
  4047. + sizeof(MAC_HEADER) + 2);
  4048. fcb->frame_length = rmf->vl - 4 - 2;
  4049. fcb->bdb_ptr->buffer_length = rmf->vl - 4 - 2;
  4050. if((err = smctr_trc_send_packet(dev, fcb, MAC_QUEUE)))
  4051. return err;
  4052. /* Wait for Transmit to Complete */
  4053. for(i = 0; i < 10000; i++)
  4054. {
  4055. if(fcb->frame_status & FCB_COMMAND_DONE)
  4056. break;
  4057. mdelay(1);
  4058. }
  4059. /* Check if GOOD frame Tx'ed */
  4060. if(!(fcb->frame_status & FCB_COMMAND_DONE))
  4061. {
  4062. if((err = smctr_issue_resume_tx_fcb_cmd(dev, MAC_QUEUE)))
  4063. return err;
  4064. for(i = 0; i < 10000; i++)
  4065. {
  4066. if(fcb->frame_status & FCB_COMMAND_DONE)
  4067. break;
  4068. mdelay(1);
  4069. }
  4070. if(!(fcb->frame_status & FCB_COMMAND_DONE))
  4071. return HARDWARE_FAILED;
  4072. }
  4073. *tx_fstatus = fcb->frame_status;
  4074. return A_FRAME_WAS_FORWARDED;
  4075. }
  4076. static int smctr_set_auth_access_pri(struct net_device *dev,
  4077. MAC_SUB_VECTOR *rsv)
  4078. {
  4079. struct net_local *tp = netdev_priv(dev);
  4080. if(rsv->svl != S_AUTHORIZED_ACCESS_PRIORITY)
  4081. return E_SUB_VECTOR_LENGTH_ERROR;
  4082. tp->authorized_access_priority = (rsv->svv[0] << 8 | rsv->svv[1]);
  4083. return POSITIVE_ACK;
  4084. }
  4085. static int smctr_set_auth_funct_class(struct net_device *dev,
  4086. MAC_SUB_VECTOR *rsv)
  4087. {
  4088. struct net_local *tp = netdev_priv(dev);
  4089. if(rsv->svl != S_AUTHORIZED_FUNCTION_CLASS)
  4090. return E_SUB_VECTOR_LENGTH_ERROR;
  4091. tp->authorized_function_classes = (rsv->svv[0] << 8 | rsv->svv[1]);
  4092. return POSITIVE_ACK;
  4093. }
  4094. static int smctr_set_corr(struct net_device *dev, MAC_SUB_VECTOR *rsv,
  4095. __u16 *correlator)
  4096. {
  4097. if(rsv->svl != S_CORRELATOR)
  4098. return E_SUB_VECTOR_LENGTH_ERROR;
  4099. *correlator = (rsv->svv[0] << 8 | rsv->svv[1]);
  4100. return POSITIVE_ACK;
  4101. }
  4102. static int smctr_set_error_timer_value(struct net_device *dev,
  4103. MAC_SUB_VECTOR *rsv)
  4104. {
  4105. __u16 err_tval;
  4106. int err;
  4107. if(rsv->svl != S_ERROR_TIMER_VALUE)
  4108. return E_SUB_VECTOR_LENGTH_ERROR;
  4109. err_tval = (rsv->svv[0] << 8 | rsv->svv[1])*10;
  4110. smctr_issue_write_word_cmd(dev, RW_TER_THRESHOLD, &err_tval);
  4111. if((err = smctr_wait_cmd(dev)))
  4112. return err;
  4113. return POSITIVE_ACK;
  4114. }
  4115. static int smctr_set_frame_forward(struct net_device *dev,
  4116. MAC_SUB_VECTOR *rsv, __u8 dc_sc)
  4117. {
  4118. if((rsv->svl < 2) || (rsv->svl > S_FRAME_FORWARD))
  4119. return E_SUB_VECTOR_LENGTH_ERROR;
  4120. if((dc_sc & DC_MASK) != DC_CRS)
  4121. {
  4122. if(rsv->svl >= 2 && rsv->svl < 20)
  4123. return E_TRANSMIT_FORWARD_INVALID;
  4124. if((rsv->svv[0] != 0) || (rsv->svv[1] != 0))
  4125. return E_TRANSMIT_FORWARD_INVALID;
  4126. }
  4127. return POSITIVE_ACK;
  4128. }
  4129. static int smctr_set_local_ring_num(struct net_device *dev,
  4130. MAC_SUB_VECTOR *rsv)
  4131. {
  4132. struct net_local *tp = netdev_priv(dev);
  4133. if(rsv->svl != S_LOCAL_RING_NUMBER)
  4134. return E_SUB_VECTOR_LENGTH_ERROR;
  4135. if(tp->ptr_local_ring_num)
  4136. *(__u16 *)(tp->ptr_local_ring_num)
  4137. = (rsv->svv[0] << 8 | rsv->svv[1]);
  4138. return POSITIVE_ACK;
  4139. }
  4140. static unsigned short smctr_set_ctrl_attention(struct net_device *dev)
  4141. {
  4142. struct net_local *tp = netdev_priv(dev);
  4143. int ioaddr = dev->base_addr;
  4144. if(tp->bic_type == BIC_585_CHIP)
  4145. outb((tp->trc_mask | HWR_CA), ioaddr + HWR);
  4146. else
  4147. {
  4148. outb((tp->trc_mask | CSR_CA), ioaddr + CSR);
  4149. outb(tp->trc_mask, ioaddr + CSR);
  4150. }
  4151. return 0;
  4152. }
  4153. static void smctr_set_multicast_list(struct net_device *dev)
  4154. {
  4155. if(smctr_debug > 10)
  4156. printk(KERN_DEBUG "%s: smctr_set_multicast_list\n", dev->name);
  4157. }
  4158. static int smctr_set_page(struct net_device *dev, __u8 *buf)
  4159. {
  4160. struct net_local *tp = netdev_priv(dev);
  4161. __u8 amask;
  4162. __u32 tptr;
  4163. tptr = (__u32)buf - (__u32)tp->ram_access;
  4164. amask = (__u8)((tptr & PR_PAGE_MASK) >> 8);
  4165. outb(amask, dev->base_addr + PR);
  4166. return 0;
  4167. }
  4168. static int smctr_set_phy_drop(struct net_device *dev, MAC_SUB_VECTOR *rsv)
  4169. {
  4170. int err;
  4171. if(rsv->svl != S_PHYSICAL_DROP)
  4172. return E_SUB_VECTOR_LENGTH_ERROR;
  4173. smctr_issue_write_byte_cmd(dev, RW_PHYSICAL_DROP_NUMBER, &rsv->svv[0]);
  4174. if((err = smctr_wait_cmd(dev)))
  4175. return err;
  4176. return POSITIVE_ACK;
  4177. }
  4178. /* Reset the ring speed to the opposite of what it was. This auto-pilot
  4179. * mode requires a complete reset and re-init of the adapter.
  4180. */
  4181. static int smctr_set_ring_speed(struct net_device *dev)
  4182. {
  4183. struct net_local *tp = netdev_priv(dev);
  4184. int err;
  4185. if(tp->media_type == MEDIA_UTP_16)
  4186. tp->media_type = MEDIA_UTP_4;
  4187. else
  4188. tp->media_type = MEDIA_UTP_16;
  4189. smctr_enable_16bit(dev);
  4190. /* Re-Initialize adapter's internal registers */
  4191. smctr_reset_adapter(dev);
  4192. if((err = smctr_init_card_real(dev)))
  4193. return err;
  4194. smctr_enable_bic_int(dev);
  4195. if((err = smctr_issue_enable_int_cmd(dev, TRC_INTERRUPT_ENABLE_MASK)))
  4196. return err;
  4197. smctr_disable_16bit(dev);
  4198. return 0;
  4199. }
  4200. static int smctr_set_rx_look_ahead(struct net_device *dev)
  4201. {
  4202. struct net_local *tp = netdev_priv(dev);
  4203. __u16 sword, rword;
  4204. if(smctr_debug > 10)
  4205. printk(KERN_DEBUG "%s: smctr_set_rx_look_ahead_flag\n", dev->name);
  4206. tp->adapter_flags &= ~(FORCED_16BIT_MODE);
  4207. tp->adapter_flags |= RX_VALID_LOOKAHEAD;
  4208. if(tp->adapter_bus == BUS_ISA16_TYPE)
  4209. {
  4210. sword = *((__u16 *)(tp->ram_access));
  4211. *((__u16 *)(tp->ram_access)) = 0x1234;
  4212. smctr_disable_16bit(dev);
  4213. rword = *((__u16 *)(tp->ram_access));
  4214. smctr_enable_16bit(dev);
  4215. if(rword != 0x1234)
  4216. tp->adapter_flags |= FORCED_16BIT_MODE;
  4217. *((__u16 *)(tp->ram_access)) = sword;
  4218. }
  4219. return 0;
  4220. }
  4221. static int smctr_set_trc_reset(int ioaddr)
  4222. {
  4223. __u8 r;
  4224. r = inb(ioaddr + MSR);
  4225. outb(MSR_RST | r, ioaddr + MSR);
  4226. return 0;
  4227. }
  4228. /*
  4229. * This function can be called if the adapter is busy or not.
  4230. */
  4231. static int smctr_setup_single_cmd(struct net_device *dev,
  4232. __u16 command, __u16 subcommand)
  4233. {
  4234. struct net_local *tp = netdev_priv(dev);
  4235. unsigned int err;
  4236. if(smctr_debug > 10)
  4237. printk(KERN_DEBUG "%s: smctr_setup_single_cmd\n", dev->name);
  4238. if((err = smctr_wait_while_cbusy(dev)))
  4239. return err;
  4240. if((err = (unsigned int)smctr_wait_cmd(dev)))
  4241. return err;
  4242. tp->acb_head->cmd_done_status = 0;
  4243. tp->acb_head->cmd = command;
  4244. tp->acb_head->subcmd = subcommand;
  4245. err = smctr_issue_resume_acb_cmd(dev);
  4246. return err;
  4247. }
  4248. /*
  4249. * This function can not be called with the adapter busy.
  4250. */
  4251. static int smctr_setup_single_cmd_w_data(struct net_device *dev,
  4252. __u16 command, __u16 subcommand)
  4253. {
  4254. struct net_local *tp = netdev_priv(dev);
  4255. tp->acb_head->cmd_done_status = ACB_COMMAND_NOT_DONE;
  4256. tp->acb_head->cmd = command;
  4257. tp->acb_head->subcmd = subcommand;
  4258. tp->acb_head->data_offset_lo
  4259. = (__u16)TRC_POINTER(tp->misc_command_data);
  4260. return smctr_issue_resume_acb_cmd(dev);
  4261. }
  4262. static char *smctr_malloc(struct net_device *dev, __u16 size)
  4263. {
  4264. struct net_local *tp = netdev_priv(dev);
  4265. char *m;
  4266. m = (char *)(tp->ram_access + tp->sh_mem_used);
  4267. tp->sh_mem_used += (__u32)size;
  4268. return m;
  4269. }
  4270. static int smctr_status_chg(struct net_device *dev)
  4271. {
  4272. struct net_local *tp = netdev_priv(dev);
  4273. if(smctr_debug > 10)
  4274. printk(KERN_DEBUG "%s: smctr_status_chg\n", dev->name);
  4275. switch(tp->status)
  4276. {
  4277. case OPEN:
  4278. break;
  4279. case CLOSED:
  4280. break;
  4281. /* Interrupt driven open() completion. XXX */
  4282. case INITIALIZED:
  4283. tp->group_address_0 = 0;
  4284. tp->group_address[0] = 0;
  4285. tp->group_address[1] = 0;
  4286. tp->functional_address_0 = 0;
  4287. tp->functional_address[0] = 0;
  4288. tp->functional_address[1] = 0;
  4289. smctr_open_tr(dev);
  4290. break;
  4291. default:
  4292. printk(KERN_INFO "%s: status change unknown %x\n",
  4293. dev->name, tp->status);
  4294. break;
  4295. }
  4296. return 0;
  4297. }
  4298. static int smctr_trc_send_packet(struct net_device *dev, FCBlock *fcb,
  4299. __u16 queue)
  4300. {
  4301. struct net_local *tp = netdev_priv(dev);
  4302. int err = 0;
  4303. if(smctr_debug > 10)
  4304. printk(KERN_DEBUG "%s: smctr_trc_send_packet\n", dev->name);
  4305. fcb->info = FCB_CHAIN_END | FCB_ENABLE_TFS;
  4306. if(tp->num_tx_fcbs[queue] != 1)
  4307. fcb->back_ptr->info = FCB_INTERRUPT_ENABLE | FCB_ENABLE_TFS;
  4308. if(tp->tx_queue_status[queue] == NOT_TRANSMITING)
  4309. {
  4310. tp->tx_queue_status[queue] = TRANSMITING;
  4311. err = smctr_issue_resume_tx_fcb_cmd(dev, queue);
  4312. }
  4313. return err;
  4314. }
  4315. static __u16 smctr_tx_complete(struct net_device *dev, __u16 queue)
  4316. {
  4317. struct net_local *tp = netdev_priv(dev);
  4318. __u16 status, err = 0;
  4319. int cstatus;
  4320. if(smctr_debug > 10)
  4321. printk(KERN_DEBUG "%s: smctr_tx_complete\n", dev->name);
  4322. while((status = tp->tx_fcb_end[queue]->frame_status) != SUCCESS)
  4323. {
  4324. if(status & 0x7e00 )
  4325. {
  4326. err = HARDWARE_FAILED;
  4327. break;
  4328. }
  4329. if((err = smctr_update_tx_chain(dev, tp->tx_fcb_end[queue],
  4330. queue)) != SUCCESS)
  4331. break;
  4332. smctr_disable_16bit(dev);
  4333. if(tp->mode_bits & UMAC)
  4334. {
  4335. if(!(status & (FCB_TX_STATUS_AR1 | FCB_TX_STATUS_AR2)))
  4336. cstatus = NO_SUCH_DESTINATION;
  4337. else
  4338. {
  4339. if(!(status & (FCB_TX_STATUS_CR1 | FCB_TX_STATUS_CR2)))
  4340. cstatus = DEST_OUT_OF_RESOURCES;
  4341. else
  4342. {
  4343. if(status & FCB_TX_STATUS_E)
  4344. cstatus = MAX_COLLISIONS;
  4345. else
  4346. cstatus = SUCCESS;
  4347. }
  4348. }
  4349. }
  4350. else
  4351. cstatus = SUCCESS;
  4352. if(queue == BUG_QUEUE)
  4353. err = SUCCESS;
  4354. smctr_enable_16bit(dev);
  4355. if(err != SUCCESS)
  4356. break;
  4357. }
  4358. return err;
  4359. }
  4360. static unsigned short smctr_tx_move_frame(struct net_device *dev,
  4361. struct sk_buff *skb, __u8 *pbuff, unsigned int bytes)
  4362. {
  4363. struct net_local *tp = netdev_priv(dev);
  4364. unsigned int ram_usable;
  4365. __u32 flen, len, offset = 0;
  4366. __u8 *frag, *page;
  4367. if(smctr_debug > 10)
  4368. printk(KERN_DEBUG "%s: smctr_tx_move_frame\n", dev->name);
  4369. ram_usable = ((unsigned int)tp->ram_usable) << 10;
  4370. frag = skb->data;
  4371. flen = skb->len;
  4372. while(flen > 0 && bytes > 0)
  4373. {
  4374. smctr_set_page(dev, pbuff);
  4375. offset = SMC_PAGE_OFFSET(pbuff);
  4376. if(offset + flen > ram_usable)
  4377. len = ram_usable - offset;
  4378. else
  4379. len = flen;
  4380. if(len > bytes)
  4381. len = bytes;
  4382. page = (char *) (offset + tp->ram_access);
  4383. memcpy(page, frag, len);
  4384. flen -=len;
  4385. bytes -= len;
  4386. frag += len;
  4387. pbuff += len;
  4388. }
  4389. return 0;
  4390. }
  4391. /* Update the error statistic counters for this adapter. */
  4392. static int smctr_update_err_stats(struct net_device *dev)
  4393. {
  4394. struct net_local *tp = netdev_priv(dev);
  4395. struct tr_statistics *tstat = &tp->MacStat;
  4396. if(tstat->internal_errors)
  4397. tstat->internal_errors
  4398. += *(tp->misc_command_data + 0) & 0x00ff;
  4399. if(tstat->line_errors)
  4400. tstat->line_errors += *(tp->misc_command_data + 0) >> 8;
  4401. if(tstat->A_C_errors)
  4402. tstat->A_C_errors += *(tp->misc_command_data + 1) & 0x00ff;
  4403. if(tstat->burst_errors)
  4404. tstat->burst_errors += *(tp->misc_command_data + 1) >> 8;
  4405. if(tstat->abort_delimiters)
  4406. tstat->abort_delimiters += *(tp->misc_command_data + 2) >> 8;
  4407. if(tstat->recv_congest_count)
  4408. tstat->recv_congest_count
  4409. += *(tp->misc_command_data + 3) & 0x00ff;
  4410. if(tstat->lost_frames)
  4411. tstat->lost_frames
  4412. += *(tp->misc_command_data + 3) >> 8;
  4413. if(tstat->frequency_errors)
  4414. tstat->frequency_errors += *(tp->misc_command_data + 4) & 0x00ff;
  4415. if(tstat->frame_copied_errors)
  4416. tstat->frame_copied_errors
  4417. += *(tp->misc_command_data + 4) >> 8;
  4418. if(tstat->token_errors)
  4419. tstat->token_errors += *(tp->misc_command_data + 5) >> 8;
  4420. return 0;
  4421. }
  4422. static int smctr_update_rx_chain(struct net_device *dev, __u16 queue)
  4423. {
  4424. struct net_local *tp = netdev_priv(dev);
  4425. FCBlock *fcb;
  4426. BDBlock *bdb;
  4427. __u16 size, len;
  4428. fcb = tp->rx_fcb_curr[queue];
  4429. len = fcb->frame_length;
  4430. fcb->frame_status = 0;
  4431. fcb->info = FCB_CHAIN_END;
  4432. fcb->back_ptr->info = FCB_WARNING;
  4433. tp->rx_fcb_curr[queue] = tp->rx_fcb_curr[queue]->next_ptr;
  4434. /* update RX BDBs */
  4435. size = (len >> RX_BDB_SIZE_SHIFT);
  4436. if(len & RX_DATA_BUFFER_SIZE_MASK)
  4437. size += sizeof(BDBlock);
  4438. size &= (~RX_BDB_SIZE_MASK);
  4439. /* check if wrap around */
  4440. bdb = (BDBlock *)((__u32)(tp->rx_bdb_curr[queue]) + (__u32)(size));
  4441. if((__u32)bdb >= (__u32)tp->rx_bdb_end[queue])
  4442. {
  4443. bdb = (BDBlock *)((__u32)(tp->rx_bdb_head[queue])
  4444. + (__u32)(bdb) - (__u32)(tp->rx_bdb_end[queue]));
  4445. }
  4446. bdb->back_ptr->info = BDB_CHAIN_END;
  4447. tp->rx_bdb_curr[queue]->back_ptr->info = BDB_NOT_CHAIN_END;
  4448. tp->rx_bdb_curr[queue] = bdb;
  4449. return 0;
  4450. }
  4451. static int smctr_update_tx_chain(struct net_device *dev, FCBlock *fcb,
  4452. __u16 queue)
  4453. {
  4454. struct net_local *tp = netdev_priv(dev);
  4455. if(smctr_debug > 20)
  4456. printk(KERN_DEBUG "smctr_update_tx_chain\n");
  4457. if(tp->num_tx_fcbs_used[queue] <= 0)
  4458. return HARDWARE_FAILED;
  4459. else
  4460. {
  4461. if(tp->tx_buff_used[queue] < fcb->memory_alloc)
  4462. {
  4463. tp->tx_buff_used[queue] = 0;
  4464. return HARDWARE_FAILED;
  4465. }
  4466. tp->tx_buff_used[queue] -= fcb->memory_alloc;
  4467. /* if all transmit buffer are cleared
  4468. * need to set the tx_buff_curr[] to tx_buff_head[]
  4469. * otherwise, tx buffer will be segregate and cannot
  4470. * accommodate and buffer greater than (curr - head) and
  4471. * (end - curr) since we do not allow wrap around allocation.
  4472. */
  4473. if(tp->tx_buff_used[queue] == 0)
  4474. tp->tx_buff_curr[queue] = tp->tx_buff_head[queue];
  4475. tp->num_tx_fcbs_used[queue]--;
  4476. fcb->frame_status = 0;
  4477. tp->tx_fcb_end[queue] = fcb->next_ptr;
  4478. netif_wake_queue(dev);
  4479. return 0;
  4480. }
  4481. }
  4482. static int smctr_wait_cmd(struct net_device *dev)
  4483. {
  4484. struct net_local *tp = netdev_priv(dev);
  4485. unsigned int loop_count = 0x20000;
  4486. if(smctr_debug > 10)
  4487. printk(KERN_DEBUG "%s: smctr_wait_cmd\n", dev->name);
  4488. while(loop_count)
  4489. {
  4490. if(tp->acb_head->cmd_done_status & ACB_COMMAND_DONE)
  4491. break;
  4492. udelay(1);
  4493. loop_count--;
  4494. }
  4495. if(loop_count == 0)
  4496. return HARDWARE_FAILED;
  4497. if(tp->acb_head->cmd_done_status & 0xff)
  4498. return HARDWARE_FAILED;
  4499. return 0;
  4500. }
  4501. static int smctr_wait_while_cbusy(struct net_device *dev)
  4502. {
  4503. struct net_local *tp = netdev_priv(dev);
  4504. unsigned int timeout = 0x20000;
  4505. int ioaddr = dev->base_addr;
  4506. __u8 r;
  4507. if(tp->bic_type == BIC_585_CHIP)
  4508. {
  4509. while(timeout)
  4510. {
  4511. r = inb(ioaddr + HWR);
  4512. if((r & HWR_CBUSY) == 0)
  4513. break;
  4514. timeout--;
  4515. }
  4516. }
  4517. else
  4518. {
  4519. while(timeout)
  4520. {
  4521. r = inb(ioaddr + CSR);
  4522. if((r & CSR_CBUSY) == 0)
  4523. break;
  4524. timeout--;
  4525. }
  4526. }
  4527. if(timeout)
  4528. return 0;
  4529. else
  4530. return HARDWARE_FAILED;
  4531. }
  4532. #ifdef MODULE
  4533. static struct net_device* dev_smctr[SMCTR_MAX_ADAPTERS];
  4534. static int io[SMCTR_MAX_ADAPTERS];
  4535. static int irq[SMCTR_MAX_ADAPTERS];
  4536. MODULE_LICENSE("GPL");
  4537. MODULE_FIRMWARE("tr_smctr.bin");
  4538. module_param_array(io, int, NULL, 0);
  4539. module_param_array(irq, int, NULL, 0);
  4540. module_param(ringspeed, int, 0);
  4541. static struct net_device * __init setup_card(int n)
  4542. {
  4543. struct net_device *dev = alloc_trdev(sizeof(struct net_local));
  4544. int err;
  4545. if (!dev)
  4546. return ERR_PTR(-ENOMEM);
  4547. dev->irq = irq[n];
  4548. err = smctr_probe1(dev, io[n]);
  4549. if (err)
  4550. goto out;
  4551. err = register_netdev(dev);
  4552. if (err)
  4553. goto out1;
  4554. return dev;
  4555. out1:
  4556. #ifdef CONFIG_MCA_LEGACY
  4557. { struct net_local *tp = netdev_priv(dev);
  4558. if (tp->slot_num)
  4559. mca_mark_as_unused(tp->slot_num);
  4560. }
  4561. #endif
  4562. release_region(dev->base_addr, SMCTR_IO_EXTENT);
  4563. free_irq(dev->irq, dev);
  4564. out:
  4565. free_netdev(dev);
  4566. return ERR_PTR(err);
  4567. }
  4568. int __init init_module(void)
  4569. {
  4570. int i, found = 0;
  4571. struct net_device *dev;
  4572. for(i = 0; i < SMCTR_MAX_ADAPTERS; i++) {
  4573. dev = io[0]? setup_card(i) : smctr_probe(-1);
  4574. if (!IS_ERR(dev)) {
  4575. ++found;
  4576. dev_smctr[i] = dev;
  4577. }
  4578. }
  4579. return found ? 0 : -ENODEV;
  4580. }
  4581. void __exit cleanup_module(void)
  4582. {
  4583. int i;
  4584. for(i = 0; i < SMCTR_MAX_ADAPTERS; i++) {
  4585. struct net_device *dev = dev_smctr[i];
  4586. if (dev) {
  4587. unregister_netdev(dev);
  4588. #ifdef CONFIG_MCA_LEGACY
  4589. { struct net_local *tp = netdev_priv(dev);
  4590. if (tp->slot_num)
  4591. mca_mark_as_unused(tp->slot_num);
  4592. }
  4593. #endif
  4594. release_region(dev->base_addr, SMCTR_IO_EXTENT);
  4595. if (dev->irq)
  4596. free_irq(dev->irq, dev);
  4597. free_netdev(dev);
  4598. }
  4599. }
  4600. }
  4601. #endif /* MODULE */