wl_iw.c 171 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598559956005601560256035604560556065607560856095610561156125613561456155616561756185619562056215622562356245625562656275628562956305631563256335634563556365637563856395640564156425643564456455646564756485649565056515652565356545655565656575658565956605661566256635664566556665667566856695670567156725673567456755676567756785679568056815682568356845685568656875688568956905691569256935694569556965697569856995700570157025703570457055706570757085709571057115712571357145715571657175718571957205721572257235724572557265727572857295730573157325733573457355736573757385739574057415742574357445745574657475748574957505751575257535754575557565757575857595760576157625763576457655766576757685769577057715772577357745775577657775778577957805781578257835784578557865787578857895790579157925793579457955796579757985799580058015802580358045805580658075808580958105811581258135814581558165817581858195820582158225823582458255826582758285829583058315832583358345835583658375838583958405841584258435844584558465847584858495850585158525853585458555856585758585859586058615862586358645865586658675868586958705871587258735874587558765877587858795880588158825883588458855886588758885889589058915892589358945895589658975898589959005901590259035904590559065907590859095910591159125913591459155916591759185919592059215922592359245925592659275928592959305931593259335934593559365937593859395940594159425943594459455946594759485949595059515952595359545955595659575958595959605961596259635964596559665967596859695970597159725973597459755976597759785979598059815982598359845985598659875988598959905991599259935994599559965997599859996000600160026003600460056006600760086009601060116012601360146015601660176018601960206021602260236024602560266027602860296030603160326033603460356036603760386039604060416042604360446045604660476048604960506051605260536054605560566057605860596060606160626063606460656066606760686069607060716072607360746075607660776078607960806081608260836084608560866087608860896090609160926093609460956096609760986099610061016102610361046105610661076108610961106111611261136114611561166117611861196120612161226123612461256126612761286129613061316132613361346135613661376138613961406141614261436144614561466147614861496150615161526153615461556156615761586159616061616162616361646165616661676168616961706171617261736174617561766177617861796180618161826183618461856186618761886189619061916192619361946195619661976198619962006201620262036204620562066207620862096210621162126213621462156216621762186219622062216222622362246225622662276228622962306231623262336234623562366237623862396240624162426243624462456246624762486249625062516252625362546255625662576258625962606261626262636264626562666267626862696270627162726273627462756276627762786279628062816282628362846285628662876288628962906291629262936294629562966297629862996300630163026303630463056306630763086309631063116312631363146315631663176318631963206321632263236324632563266327632863296330633163326333633463356336633763386339634063416342634363446345634663476348634963506351635263536354635563566357635863596360636163626363636463656366636763686369637063716372637363746375637663776378637963806381638263836384638563866387638863896390639163926393639463956396639763986399640064016402640364046405640664076408640964106411641264136414641564166417641864196420642164226423642464256426642764286429643064316432643364346435643664376438643964406441644264436444644564466447644864496450645164526453645464556456645764586459646064616462646364646465646664676468646964706471647264736474647564766477647864796480648164826483648464856486648764886489649064916492649364946495649664976498649965006501650265036504650565066507650865096510651165126513651465156516651765186519652065216522652365246525652665276528652965306531653265336534653565366537653865396540654165426543654465456546654765486549655065516552655365546555655665576558655965606561656265636564656565666567656865696570657165726573657465756576657765786579658065816582658365846585658665876588658965906591659265936594659565966597659865996600660166026603660466056606660766086609661066116612661366146615661666176618661966206621662266236624662566266627662866296630663166326633663466356636663766386639664066416642664366446645664666476648664966506651665266536654665566566657665866596660666166626663666466656666666766686669667066716672667366746675667666776678667966806681668266836684668566866687668866896690669166926693669466956696669766986699670067016702670367046705670667076708670967106711671267136714671567166717671867196720672167226723672467256726672767286729673067316732673367346735673667376738673967406741674267436744674567466747674867496750675167526753675467556756675767586759676067616762676367646765676667676768676967706771677267736774677567766777677867796780678167826783678467856786678767886789679067916792679367946795679667976798679968006801680268036804680568066807680868096810681168126813681468156816681768186819682068216822682368246825682668276828682968306831683268336834683568366837683868396840684168426843684468456846684768486849685068516852685368546855685668576858685968606861686268636864686568666867686868696870687168726873687468756876687768786879688068816882688368846885688668876888688968906891689268936894689568966897689868996900690169026903690469056906690769086909691069116912691369146915691669176918691969206921692269236924692569266927692869296930693169326933693469356936693769386939694069416942694369446945694669476948694969506951695269536954695569566957695869596960696169626963696469656966696769686969697069716972697369746975697669776978697969806981698269836984698569866987698869896990699169926993699469956996699769986999700070017002700370047005700670077008700970107011701270137014701570167017701870197020702170227023702470257026702770287029703070317032703370347035703670377038703970407041704270437044704570467047704870497050705170527053705470557056705770587059706070617062706370647065706670677068706970707071707270737074707570767077707870797080708170827083708470857086708770887089709070917092709370947095709670977098709971007101710271037104710571067107710871097110711171127113711471157116711771187119712071217122712371247125712671277128712971307131713271337134713571367137713871397140714171427143714471457146714771487149715071517152715371547155715671577158715971607161716271637164716571667167716871697170717171727173717471757176717771787179718071817182718371847185718671877188718971907191719271937194719571967197719871997200720172027203720472057206720772087209721072117212721372147215721672177218721972207221722272237224722572267227722872297230723172327233723472357236723772387239724072417242724372447245724672477248724972507251725272537254725572567257725872597260726172627263726472657266726772687269727072717272727372747275727672777278727972807281728272837284728572867287728872897290729172927293729472957296729772987299730073017302730373047305730673077308730973107311731273137314731573167317731873197320732173227323732473257326732773287329733073317332733373347335733673377338733973407341734273437344734573467347734873497350735173527353735473557356735773587359736073617362736373647365736673677368736973707371737273737374737573767377737873797380738173827383738473857386738773887389739073917392739373947395739673977398739974007401740274037404740574067407740874097410741174127413741474157416741774187419742074217422742374247425742674277428742974307431743274337434743574367437743874397440744174427443744474457446744774487449745074517452745374547455745674577458745974607461746274637464746574667467746874697470747174727473747474757476747774787479748074817482748374847485748674877488748974907491749274937494749574967497749874997500750175027503750475057506750775087509751075117512751375147515751675177518751975207521752275237524752575267527752875297530753175327533753475357536753775387539754075417542754375447545754675477548754975507551755275537554755575567557755875597560756175627563756475657566756775687569757075717572757375747575757675777578757975807581758275837584758575867587
  1. /*
  2. * Linux Wireless Extensions support
  3. *
  4. * Copyright (C) 1999-2010, Broadcom Corporation
  5. *
  6. * Unless you and Broadcom execute a separate written software license
  7. * agreement governing use of this software, this software is licensed to you
  8. * under the terms of the GNU General Public License version 2 (the "GPL"),
  9. * available at http://www.broadcom.com/licenses/GPLv2.php, with the
  10. * following added to such license:
  11. *
  12. * As a special exception, the copyright holders of this software give you
  13. * permission to link this software with independent modules, and to copy and
  14. * distribute the resulting executable under terms of your choice, provided that
  15. * you also meet, for each linked independent module, the terms and conditions of
  16. * the license of that module. An independent module is a module which is not
  17. * derived from this software. The special exception does not apply to any
  18. * modifications of the software.
  19. *
  20. * Notwithstanding the above, under no circumstances may you combine this
  21. * software in any way with any other Broadcom software provided under a license
  22. * other than the GPL, without Broadcom's express prior written consent.
  23. *
  24. * $Id: wl_iw.c,v 1.51.4.9.2.6.4.126 2010/07/30 21:23:11 Exp $
  25. */
  26. #include <wlioctl.h>
  27. #include <typedefs.h>
  28. #include <linuxver.h>
  29. #include <osl.h>
  30. #include <bcmutils.h>
  31. #include <bcmendian.h>
  32. #include <proto/ethernet.h>
  33. #include <linux/if_arp.h>
  34. #include <asm/uaccess.h>
  35. #include <dngl_stats.h>
  36. #include <dhd.h>
  37. #include <dhdioctl.h>
  38. typedef void wlc_info_t;
  39. typedef void wl_info_t;
  40. typedef const struct si_pub si_t;
  41. #include <wlioctl.h>
  42. #include <proto/ethernet.h>
  43. #include <dngl_stats.h>
  44. #include <dhd.h>
  45. #define WL_ERROR(x) printf x
  46. #define WL_TRACE(x)
  47. #define WL_ASSOC(x)
  48. #define WL_INFORM(x)
  49. #define WL_WSEC(x)
  50. #define WL_SCAN(x)
  51. #include <wl_iw.h>
  52. #ifndef IW_ENCODE_ALG_SM4
  53. #define IW_ENCODE_ALG_SM4 0x20
  54. #endif
  55. #ifndef IW_AUTH_WAPI_ENABLED
  56. #define IW_AUTH_WAPI_ENABLED 0x20
  57. #endif
  58. #ifndef IW_AUTH_WAPI_VERSION_1
  59. #define IW_AUTH_WAPI_VERSION_1 0x00000008
  60. #endif
  61. #ifndef IW_AUTH_CIPHER_SMS4
  62. #define IW_AUTH_CIPHER_SMS4 0x00000020
  63. #endif
  64. #ifndef IW_AUTH_KEY_MGMT_WAPI_PSK
  65. #define IW_AUTH_KEY_MGMT_WAPI_PSK 4
  66. #endif
  67. #ifndef IW_AUTH_KEY_MGMT_WAPI_CERT
  68. #define IW_AUTH_KEY_MGMT_WAPI_CERT 8
  69. #endif
  70. #define IW_WSEC_ENABLED(wsec) ((wsec) & (WEP_ENABLED | TKIP_ENABLED | AES_ENABLED | SMS4_ENABLED))
  71. #include <linux/rtnetlink.h>
  72. #define WL_IW_USE_ISCAN 1
  73. #define ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS 1
  74. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25)) && 1
  75. struct mutex g_wl_ss_scan_lock;
  76. #endif
  77. #if defined(SOFTAP)
  78. #define WL_SOFTAP(x) printk x
  79. static struct net_device *priv_dev;
  80. static bool ap_cfg_running = FALSE;
  81. static bool ap_fw_loaded = FALSE;
  82. struct net_device *ap_net_dev = NULL;
  83. struct semaphore ap_eth_sema;
  84. static int wl_iw_set_ap_security(struct net_device *dev, struct ap_profile *ap);
  85. static int wl_iw_softap_deassoc_stations(struct net_device *dev);
  86. #endif
  87. #define WL_IW_IOCTL_CALL(func_call) \
  88. do { \
  89. func_call; \
  90. } while (0)
  91. static int g_onoff = G_WLAN_SET_ON;
  92. extern bool wl_iw_conn_status_str(uint32 event_type, uint32 status,
  93. uint32 reason, char* stringBuf, uint buflen);
  94. #include <bcmsdbus.h>
  95. extern void dhd_customer_gpio_wlan_ctrl(int onoff);
  96. extern uint dhd_dev_reset(struct net_device *dev, uint8 flag);
  97. extern void dhd_dev_init_ioctl(struct net_device *dev);
  98. int dev_iw_write_cfg1_bss_var(struct net_device *dev, int val);
  99. uint wl_msg_level = WL_ERROR_VAL;
  100. #define MAX_WLIW_IOCTL_LEN 1024
  101. #if defined(IL_BIGENDIAN)
  102. #include <bcmendian.h>
  103. #define htod32(i) (bcmswap32(i))
  104. #define htod16(i) (bcmswap16(i))
  105. #define dtoh32(i) (bcmswap32(i))
  106. #define dtoh16(i) (bcmswap16(i))
  107. #define htodchanspec(i) htod16(i)
  108. #define dtohchanspec(i) dtoh16(i)
  109. #else
  110. #define htod32(i) i
  111. #define htod16(i) i
  112. #define dtoh32(i) i
  113. #define dtoh16(i) i
  114. #define htodchanspec(i) i
  115. #define dtohchanspec(i) i
  116. #endif
  117. #ifdef CONFIG_WIRELESS_EXT
  118. extern struct iw_statistics *dhd_get_wireless_stats(struct net_device *dev);
  119. extern int dhd_wait_pend8021x(struct net_device *dev);
  120. #endif
  121. #if WIRELESS_EXT < 19
  122. #define IW_IOCTL_IDX(cmd) ((cmd) - SIOCIWFIRST)
  123. #define IW_EVENT_IDX(cmd) ((cmd) - IWEVFIRST)
  124. #endif
  125. static void *g_scan = NULL;
  126. static volatile uint g_scan_specified_ssid;
  127. static wlc_ssid_t g_specific_ssid;
  128. static wlc_ssid_t g_ssid;
  129. static wl_iw_ss_cache_ctrl_t g_ss_cache_ctrl;
  130. static volatile uint g_first_broadcast_scan;
  131. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 0))
  132. #define DAEMONIZE(a) daemonize(a); \
  133. allow_signal(SIGKILL); \
  134. allow_signal(SIGTERM);
  135. #else
  136. #define RAISE_RX_SOFTIRQ() \
  137. cpu_raise_softirq(smp_processor_id(), NET_RX_SOFTIRQ)
  138. #define DAEMONIZE(a) daemonize(); \
  139. do { if (a) \
  140. strncpy(current->comm, a, MIN(sizeof(current->comm), (strlen(a) + 1))); \
  141. } while (0);
  142. #endif
  143. #if defined(WL_IW_USE_ISCAN)
  144. #if !defined(CSCAN)
  145. static void wl_iw_free_ss_cache(void);
  146. static int wl_iw_run_ss_cache_timer(int kick_off);
  147. #endif
  148. int wl_iw_iscan_set_scan_broadcast_prep(struct net_device *dev, uint flag);
  149. static int dev_wlc_bufvar_set(struct net_device *dev, char *name, char *buf, int len);
  150. #define ISCAN_STATE_IDLE 0
  151. #define ISCAN_STATE_SCANING 1
  152. #define WLC_IW_ISCAN_MAXLEN 2048
  153. typedef struct iscan_buf {
  154. struct iscan_buf * next;
  155. char iscan_buf[WLC_IW_ISCAN_MAXLEN];
  156. } iscan_buf_t;
  157. typedef struct iscan_info {
  158. struct net_device *dev;
  159. struct timer_list timer;
  160. uint32 timer_ms;
  161. uint32 timer_on;
  162. int iscan_state;
  163. iscan_buf_t * list_hdr;
  164. iscan_buf_t * list_cur;
  165. long sysioc_pid;
  166. struct semaphore sysioc_sem;
  167. struct completion sysioc_exited;
  168. uint32 scan_flag;
  169. #if defined CSCAN
  170. char ioctlbuf[WLC_IOCTL_MEDLEN];
  171. #else
  172. char ioctlbuf[WLC_IOCTL_SMLEN];
  173. #endif
  174. wl_iscan_params_t *iscan_ex_params_p;
  175. int iscan_ex_param_size;
  176. } iscan_info_t;
  177. #define COEX_DHCP 1
  178. static void wl_iw_bt_flag_set(struct net_device *dev, bool set);
  179. static void wl_iw_bt_release(void);
  180. typedef enum bt_coex_status {
  181. BT_DHCP_IDLE = 0,
  182. BT_DHCP_START,
  183. BT_DHCP_OPPORTUNITY_WINDOW,
  184. BT_DHCP_FLAG_FORCE_TIMEOUT
  185. } coex_status_t;
  186. #define BT_DHCP_OPPORTUNITY_WINDOW_TIEM 2500
  187. #define BT_DHCP_FLAG_FORCE_TIME 5500
  188. typedef struct bt_info {
  189. struct net_device *dev;
  190. struct timer_list timer;
  191. uint32 timer_ms;
  192. uint32 timer_on;
  193. int bt_state;
  194. long bt_pid;
  195. struct semaphore bt_sem;
  196. struct completion bt_exited;
  197. } bt_info_t;
  198. bt_info_t *g_bt = NULL;
  199. static void wl_iw_bt_timerfunc(ulong data);
  200. iscan_info_t *g_iscan = NULL;
  201. static void wl_iw_timerfunc(ulong data);
  202. static void wl_iw_set_event_mask(struct net_device *dev);
  203. static int
  204. wl_iw_iscan(iscan_info_t *iscan, wlc_ssid_t *ssid, uint16 action);
  205. #endif
  206. static int
  207. wl_iw_set_scan(
  208. struct net_device *dev,
  209. struct iw_request_info *info,
  210. union iwreq_data *wrqu,
  211. char *extra
  212. );
  213. static int
  214. wl_iw_get_scan(
  215. struct net_device *dev,
  216. struct iw_request_info *info,
  217. struct iw_point *dwrq,
  218. char *extra
  219. );
  220. static uint
  221. wl_iw_get_scan_prep(
  222. wl_scan_results_t *list,
  223. struct iw_request_info *info,
  224. char *extra,
  225. short max_size
  226. );
  227. static void swap_key_from_BE(
  228. wl_wsec_key_t *key
  229. )
  230. {
  231. key->index = htod32(key->index);
  232. key->len = htod32(key->len);
  233. key->algo = htod32(key->algo);
  234. key->flags = htod32(key->flags);
  235. key->rxiv.hi = htod32(key->rxiv.hi);
  236. key->rxiv.lo = htod16(key->rxiv.lo);
  237. key->iv_initialized = htod32(key->iv_initialized);
  238. }
  239. static void swap_key_to_BE(
  240. wl_wsec_key_t *key
  241. )
  242. {
  243. key->index = dtoh32(key->index);
  244. key->len = dtoh32(key->len);
  245. key->algo = dtoh32(key->algo);
  246. key->flags = dtoh32(key->flags);
  247. key->rxiv.hi = dtoh32(key->rxiv.hi);
  248. key->rxiv.lo = dtoh16(key->rxiv.lo);
  249. key->iv_initialized = dtoh32(key->iv_initialized);
  250. }
  251. static int
  252. dev_wlc_ioctl(
  253. struct net_device *dev,
  254. int cmd,
  255. void *arg,
  256. int len
  257. )
  258. {
  259. struct ifreq ifr;
  260. wl_ioctl_t ioc;
  261. mm_segment_t fs;
  262. int ret = -EINVAL;
  263. if (!dev) {
  264. WL_ERROR(("%s: dev is null\n", __FUNCTION__));
  265. return ret;
  266. }
  267. WL_INFORM(("\n%s, PID:%x: send Local IOCTL -> dhd: cmd:0x%x, buf:%p, len:%d ,\n",
  268. __FUNCTION__, current->pid, cmd, arg, len));
  269. if (g_onoff == G_WLAN_SET_ON) {
  270. memset(&ioc, 0, sizeof(ioc));
  271. ioc.cmd = cmd;
  272. ioc.buf = arg;
  273. ioc.len = len;
  274. strcpy(ifr.ifr_name, dev->name);
  275. ifr.ifr_data = (caddr_t) &ioc;
  276. ret = dev_open(dev);
  277. if (ret) {
  278. WL_ERROR(("%s: Error dev_open: %d\n", __func__, ret));
  279. return ret;
  280. }
  281. fs = get_fs();
  282. set_fs(get_ds());
  283. #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 31)
  284. ret = dev->do_ioctl(dev, &ifr, SIOCDEVPRIVATE);
  285. #else
  286. ret = dev->netdev_ops->ndo_do_ioctl(dev, &ifr, SIOCDEVPRIVATE);
  287. #endif
  288. set_fs(fs);
  289. }
  290. else {
  291. WL_TRACE(("%s: call after driver stop : ignored\n", __FUNCTION__));
  292. }
  293. return ret;
  294. }
  295. static int
  296. dev_wlc_intvar_get_reg(
  297. struct net_device *dev,
  298. char *name,
  299. uint reg,
  300. int *retval)
  301. {
  302. union {
  303. char buf[WLC_IOCTL_SMLEN];
  304. int val;
  305. } var;
  306. int error;
  307. uint len;
  308. len = bcm_mkiovar(name, (char *)(&reg), sizeof(reg), (char *)(&var), sizeof(var.buf));
  309. ASSERT(len);
  310. error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)&var, len);
  311. *retval = dtoh32(var.val);
  312. return (error);
  313. }
  314. static int
  315. dev_wlc_intvar_set_reg(
  316. struct net_device *dev,
  317. char *name,
  318. char *addr,
  319. char * val)
  320. {
  321. char reg_addr[8];
  322. memset(reg_addr, 0, sizeof(reg_addr));
  323. memcpy((char *)&reg_addr[0], (char *)addr, 4);
  324. memcpy((char *)&reg_addr[4], (char *)val, 4);
  325. return (dev_wlc_bufvar_set(dev, name, (char *)&reg_addr[0], sizeof(reg_addr)));
  326. }
  327. static int
  328. dev_wlc_intvar_set(
  329. struct net_device *dev,
  330. char *name,
  331. int val)
  332. {
  333. char buf[WLC_IOCTL_SMLEN];
  334. uint len;
  335. val = htod32(val);
  336. len = bcm_mkiovar(name, (char *)(&val), sizeof(val), buf, sizeof(buf));
  337. ASSERT(len);
  338. return (dev_wlc_ioctl(dev, WLC_SET_VAR, buf, len));
  339. }
  340. #if defined(WL_IW_USE_ISCAN)
  341. static int
  342. dev_iw_iovar_setbuf(
  343. struct net_device *dev,
  344. char *iovar,
  345. void *param,
  346. int paramlen,
  347. void *bufptr,
  348. int buflen)
  349. {
  350. int iolen;
  351. iolen = bcm_mkiovar(iovar, param, paramlen, bufptr, buflen);
  352. ASSERT(iolen);
  353. if (iolen == 0)
  354. return 0;
  355. return (dev_wlc_ioctl(dev, WLC_SET_VAR, bufptr, iolen));
  356. }
  357. static int
  358. dev_iw_iovar_getbuf(
  359. struct net_device *dev,
  360. char *iovar,
  361. void *param,
  362. int paramlen,
  363. void *bufptr,
  364. int buflen)
  365. {
  366. int iolen;
  367. iolen = bcm_mkiovar(iovar, param, paramlen, bufptr, buflen);
  368. ASSERT(iolen);
  369. return (dev_wlc_ioctl(dev, WLC_GET_VAR, bufptr, buflen));
  370. }
  371. #endif
  372. #if WIRELESS_EXT > 17
  373. static int
  374. dev_wlc_bufvar_set(
  375. struct net_device *dev,
  376. char *name,
  377. char *buf, int len)
  378. {
  379. #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 31)
  380. char ioctlbuf[MAX_WLIW_IOCTL_LEN];
  381. #else
  382. static char ioctlbuf[MAX_WLIW_IOCTL_LEN];
  383. #endif
  384. uint buflen;
  385. buflen = bcm_mkiovar(name, buf, len, ioctlbuf, sizeof(ioctlbuf));
  386. ASSERT(buflen);
  387. return (dev_wlc_ioctl(dev, WLC_SET_VAR, ioctlbuf, buflen));
  388. }
  389. #endif
  390. static int
  391. dev_wlc_bufvar_get(
  392. struct net_device *dev,
  393. char *name,
  394. char *buf, int buflen)
  395. {
  396. #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 31)
  397. char ioctlbuf[MAX_WLIW_IOCTL_LEN];
  398. #else
  399. static char ioctlbuf[MAX_WLIW_IOCTL_LEN];
  400. #endif
  401. int error;
  402. uint len;
  403. len = bcm_mkiovar(name, NULL, 0, ioctlbuf, sizeof(ioctlbuf));
  404. ASSERT(len);
  405. error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)ioctlbuf, MAX_WLIW_IOCTL_LEN);
  406. if (!error)
  407. bcopy(ioctlbuf, buf, buflen);
  408. return (error);
  409. }
  410. static int
  411. dev_wlc_intvar_get(
  412. struct net_device *dev,
  413. char *name,
  414. int *retval)
  415. {
  416. union {
  417. char buf[WLC_IOCTL_SMLEN];
  418. int val;
  419. } var;
  420. int error;
  421. uint len;
  422. uint data_null;
  423. len = bcm_mkiovar(name, (char *)(&data_null), 0, (char *)(&var), sizeof(var.buf));
  424. ASSERT(len);
  425. error = dev_wlc_ioctl(dev, WLC_GET_VAR, (void *)&var, len);
  426. *retval = dtoh32(var.val);
  427. return (error);
  428. }
  429. #if WIRELESS_EXT > 12
  430. static int
  431. wl_iw_set_active_scan(
  432. struct net_device *dev,
  433. struct iw_request_info *info,
  434. union iwreq_data *wrqu,
  435. char *extra
  436. )
  437. {
  438. int as = 0;
  439. int error = 0;
  440. char *p = extra;
  441. #if defined(WL_IW_USE_ISCAN)
  442. if (g_iscan->iscan_state == ISCAN_STATE_IDLE)
  443. #endif
  444. error = dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &as, sizeof(as));
  445. #if defined(WL_IW_USE_ISCAN)
  446. else
  447. g_iscan->scan_flag = as;
  448. #endif
  449. p += snprintf(p, MAX_WX_STRING, "OK");
  450. wrqu->data.length = p - extra + 1;
  451. return error;
  452. }
  453. static int
  454. wl_iw_set_passive_scan(
  455. struct net_device *dev,
  456. struct iw_request_info *info,
  457. union iwreq_data *wrqu,
  458. char *extra
  459. )
  460. {
  461. int ps = 1;
  462. int error = 0;
  463. char *p = extra;
  464. #if defined(WL_IW_USE_ISCAN)
  465. if (g_iscan->iscan_state == ISCAN_STATE_IDLE) {
  466. #endif
  467. if (g_scan_specified_ssid == 0) {
  468. error = dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &ps, sizeof(ps));
  469. }
  470. #if defined(WL_IW_USE_ISCAN)
  471. }
  472. else
  473. g_iscan->scan_flag = ps;
  474. #endif
  475. p += snprintf(p, MAX_WX_STRING, "OK");
  476. wrqu->data.length = p - extra + 1;
  477. return error;
  478. }
  479. static int
  480. wl_iw_get_macaddr(
  481. struct net_device *dev,
  482. struct iw_request_info *info,
  483. union iwreq_data *wrqu,
  484. char *extra
  485. )
  486. {
  487. int error;
  488. char buf[128];
  489. struct ether_addr *id;
  490. char *p = extra;
  491. strcpy(buf, "cur_etheraddr");
  492. error = dev_wlc_ioctl(dev, WLC_GET_VAR, buf, sizeof(buf));
  493. id = (struct ether_addr *) buf;
  494. p += snprintf(p, MAX_WX_STRING, "Macaddr = %02X:%02X:%02X:%02X:%02X:%02X\n",
  495. id->octet[0], id->octet[1], id->octet[2],
  496. id->octet[3], id->octet[4], id->octet[5]);
  497. wrqu->data.length = p - extra + 1;
  498. return error;
  499. }
  500. static int
  501. wl_iw_set_country(
  502. struct net_device *dev,
  503. struct iw_request_info *info,
  504. union iwreq_data *wrqu,
  505. char *extra
  506. )
  507. {
  508. char country_code[WLC_CNTRY_BUF_SZ];
  509. int error = 0;
  510. char *p = extra;
  511. int country_offset;
  512. int country_code_size;
  513. memset(country_code, 0, sizeof(country_code));
  514. country_offset = strcspn(extra, " ");
  515. country_code_size = strlen(extra) - country_offset;
  516. if (country_offset != 0) {
  517. strncpy(country_code, extra + country_offset +1,
  518. MIN(country_code_size, sizeof(country_code)));
  519. if ((error = dev_wlc_ioctl(dev, WLC_SET_COUNTRY,
  520. &country_code, sizeof(country_code))) >= 0) {
  521. p += snprintf(p, MAX_WX_STRING, "OK");
  522. WL_TRACE(("%s: set country %s OK\n", __FUNCTION__, country_code));
  523. goto exit;
  524. }
  525. }
  526. WL_ERROR(("%s: set country %s failed code %d\n", __FUNCTION__, country_code, error));
  527. p += snprintf(p, MAX_WX_STRING, "FAIL");
  528. exit:
  529. wrqu->data.length = p - extra + 1;
  530. return error;
  531. }
  532. #ifdef CUSTOMER_HW2
  533. static int
  534. wl_iw_set_power_mode(
  535. struct net_device *dev,
  536. struct iw_request_info *info,
  537. union iwreq_data *wrqu,
  538. char *extra
  539. )
  540. {
  541. int error = 0;
  542. char *p = extra;
  543. static int pm = PM_FAST;
  544. int pm_local = PM_OFF;
  545. char powermode_val = 0;
  546. strncpy((char *)&powermode_val, extra + strlen("POWERMODE") +1, 1);
  547. if (strnicmp((char *)&powermode_val, "1", strlen("1")) == 0) {
  548. WL_TRACE(("%s: DHCP session starts\n", __FUNCTION__));
  549. dev_wlc_ioctl(dev, WLC_GET_PM, &pm, sizeof(pm));
  550. dev_wlc_ioctl(dev, WLC_SET_PM, &pm_local, sizeof(pm_local));
  551. }
  552. else if (strnicmp((char *)&powermode_val, "0", strlen("0")) == 0) {
  553. WL_TRACE(("%s: DHCP session done\n", __FUNCTION__));
  554. dev_wlc_ioctl(dev, WLC_SET_PM, &pm, sizeof(pm));
  555. }
  556. else {
  557. WL_ERROR(("Unkwown yet power setting, ignored\n"));
  558. }
  559. p += snprintf(p, MAX_WX_STRING, "OK");
  560. wrqu->data.length = p - extra + 1;
  561. return error;
  562. }
  563. #endif
  564. static int
  565. wl_iw_set_btcoex_dhcp(
  566. struct net_device *dev,
  567. struct iw_request_info *info,
  568. union iwreq_data *wrqu,
  569. char *extra
  570. )
  571. {
  572. int error = 0;
  573. char *p = extra;
  574. #ifndef CUSTOMER_HW2
  575. static int pm = PM_FAST;
  576. int pm_local = PM_OFF;
  577. #endif
  578. char powermode_val = 0;
  579. char buf_reg66va_dhcp_on[8] = { 66, 00, 00, 00, 0x10, 0x27, 0x00, 0x00 };
  580. char buf_reg41va_dhcp_on[8] = { 41, 00, 00, 00, 0x33, 0x00, 0x00, 0x00 };
  581. char buf_reg68va_dhcp_on[8] = { 68, 00, 00, 00, 0x90, 0x01, 0x00, 0x00 };
  582. uint32 regaddr;
  583. static uint32 saved_reg66;
  584. static uint32 saved_reg41;
  585. static uint32 saved_reg68;
  586. static bool saved_status = FALSE;
  587. char buf_flag7_default[8] = { 7, 00, 00, 00, 0x0, 0x00, 0x00, 0x00};
  588. #ifndef CUSTOMER_HW2
  589. uint32 temp1, temp2;
  590. #endif
  591. #ifdef CUSTOMER_HW2
  592. strncpy((char *)&powermode_val, extra + strlen("BTCOEXMODE") +1, 1);
  593. #else
  594. strncpy((char *)&powermode_val, extra + strlen("POWERMODE") +1, 1);
  595. #endif
  596. if (strnicmp((char *)&powermode_val, "1", strlen("1")) == 0) {
  597. WL_TRACE(("%s: DHCP session starts\n", __FUNCTION__));
  598. if ((saved_status == FALSE) &&
  599. #ifndef CUSTOMER_HW2
  600. (!dev_wlc_ioctl(dev, WLC_GET_PM, &pm, sizeof(pm))) &&
  601. #endif
  602. (!dev_wlc_intvar_get_reg(dev, "btc_params", 66, &saved_reg66)) &&
  603. (!dev_wlc_intvar_get_reg(dev, "btc_params", 41, &saved_reg41)) &&
  604. (!dev_wlc_intvar_get_reg(dev, "btc_params", 68, &saved_reg68))) {
  605. saved_status = TRUE;
  606. WL_TRACE(("Saved 0x%x 0x%x 0x%x\n", \
  607. saved_reg66, saved_reg41, saved_reg68));
  608. #ifndef CUSTOMER_HW2
  609. dev_wlc_ioctl(dev, WLC_SET_PM, &pm_local, sizeof(pm_local));
  610. #endif
  611. dev_wlc_bufvar_set(dev, "btc_params", \
  612. (char *)&buf_reg66va_dhcp_on[0], \
  613. sizeof(buf_reg66va_dhcp_on));
  614. dev_wlc_bufvar_set(dev, "btc_params", \
  615. (char *)&buf_reg41va_dhcp_on[0], \
  616. sizeof(buf_reg41va_dhcp_on));
  617. dev_wlc_bufvar_set(dev, "btc_params", \
  618. (char *)&buf_reg68va_dhcp_on[0], \
  619. sizeof(buf_reg68va_dhcp_on));
  620. #ifndef CUSTOMER_HW2
  621. if ((!dev_wlc_intvar_get_reg(dev, "btc_params", 12, &temp1)) &&
  622. (!dev_wlc_intvar_get_reg(dev, "btc_params", 13, &temp2)))
  623. {
  624. if ((temp1 != 0) && (temp2 != 0)) {
  625. #endif
  626. g_bt->bt_state = BT_DHCP_START;
  627. g_bt->timer_on = 1;
  628. mod_timer(&g_bt->timer, g_bt->timer.expires);
  629. WL_TRACE(("%s enable BT DHCP Timer\n", \
  630. __FUNCTION__));
  631. #ifndef CUSTOMER_HW2
  632. }
  633. }
  634. #endif
  635. }
  636. else if (saved_status == TRUE) {
  637. WL_ERROR(("%s was called w/o DHCP OFF. Continue\n", __FUNCTION__));
  638. }
  639. }
  640. #ifdef CUSTOMER_HW2
  641. else if (strnicmp((char *)&powermode_val, "2", strlen("2")) == 0) {
  642. #else
  643. else if (strnicmp((char *)&powermode_val, "0", strlen("0")) == 0) {
  644. #endif
  645. WL_TRACE(("%s: DHCP session done\n", __FUNCTION__));
  646. #ifndef CUSTOMER_HW2
  647. dev_wlc_ioctl(dev, WLC_SET_PM, &pm, sizeof(pm));
  648. #endif
  649. WL_TRACE(("%s disable BT DHCP Timer\n", __FUNCTION__));
  650. if (g_bt->timer_on) {
  651. g_bt->timer_on = 0;
  652. del_timer_sync(&g_bt->timer);
  653. }
  654. dev_wlc_bufvar_set(dev, "btc_flags", \
  655. (char *)&buf_flag7_default[0], sizeof(buf_flag7_default));
  656. if (saved_status) {
  657. regaddr = 66;
  658. dev_wlc_intvar_set_reg(dev, "btc_params", \
  659. (char *)&regaddr, (char *)&saved_reg66);
  660. regaddr = 41;
  661. dev_wlc_intvar_set_reg(dev, "btc_params", \
  662. (char *)&regaddr, (char *)&saved_reg41);
  663. regaddr = 68;
  664. dev_wlc_intvar_set_reg(dev, "btc_params", \
  665. (char *)&regaddr, (char *)&saved_reg68);
  666. }
  667. saved_status = FALSE;
  668. }
  669. else {
  670. WL_ERROR(("Unkwown yet power setting, ignored\n"));
  671. }
  672. p += snprintf(p, MAX_WX_STRING, "OK");
  673. wrqu->data.length = p - extra + 1;
  674. return error;
  675. }
  676. int
  677. wl_format_ssid(char* ssid_buf, uint8* ssid, int ssid_len)
  678. {
  679. int i, c;
  680. char *p = ssid_buf;
  681. if (ssid_len > 32) ssid_len = 32;
  682. for (i = 0; i < ssid_len; i++) {
  683. c = (int)ssid[i];
  684. if (c == '\\') {
  685. *p++ = '\\';
  686. *p++ = '\\';
  687. } else if (isprint((uchar)c)) {
  688. *p++ = (char)c;
  689. } else {
  690. p += sprintf(p, "\\x%02X", c);
  691. }
  692. }
  693. *p = '\0';
  694. return p - ssid_buf;
  695. }
  696. static int
  697. wl_iw_get_link_speed(
  698. struct net_device *dev,
  699. struct iw_request_info *info,
  700. union iwreq_data *wrqu,
  701. char *extra
  702. )
  703. {
  704. int error = 0;
  705. char *p = extra;
  706. static int link_speed;
  707. if (g_onoff == G_WLAN_SET_ON) {
  708. error = dev_wlc_ioctl(dev, WLC_GET_RATE, &link_speed, sizeof(link_speed));
  709. link_speed *= 500000;
  710. }
  711. p += snprintf(p, MAX_WX_STRING, "LinkSpeed %d", link_speed/1000000);
  712. wrqu->data.length = p - extra + 1;
  713. return error;
  714. }
  715. static int
  716. wl_iw_get_band(
  717. struct net_device *dev,
  718. struct iw_request_info *info,
  719. union iwreq_data *wrqu,
  720. char *extra
  721. )
  722. {
  723. int error = -1;
  724. char *p = extra;
  725. static int band;
  726. if (g_onoff == G_WLAN_SET_ON) {
  727. error = dev_wlc_ioctl(dev, WLC_GET_BAND, &band, sizeof(band));
  728. p += snprintf(p, MAX_WX_STRING, "Band %d", band);
  729. wrqu->data.length = p - extra + 1;
  730. }
  731. return error;
  732. }
  733. static int
  734. wl_iw_set_band(
  735. struct net_device *dev,
  736. struct iw_request_info *info,
  737. union iwreq_data *wrqu,
  738. char *extra
  739. )
  740. {
  741. int error = -1;
  742. char *p = extra;
  743. uint band;
  744. if (g_onoff == G_WLAN_SET_ON) {
  745. band = htod32((uint)*(extra + strlen(BAND_SET_CMD) + 1) - '0');
  746. if ((band == WLC_BAND_AUTO) || (band == WLC_BAND_5G) || (band == WLC_BAND_2G)) {
  747. if ((error = dev_wlc_ioctl(dev, WLC_SET_BAND,
  748. &band, sizeof(band))) >= 0) {
  749. p += snprintf(p, MAX_WX_STRING, "OK");
  750. WL_TRACE(("%s: set band %d OK\n", __FUNCTION__, band));
  751. goto exit;
  752. }
  753. else WL_ERROR(("%s: set band %d failed code %d\n", __FUNCTION__, \
  754. band, error));
  755. }
  756. else WL_ERROR(("%s Incorrect band setting %d, ignored\n", __FUNCTION__, band));
  757. }
  758. p += snprintf(p, MAX_WX_STRING, "FAIL");
  759. exit:
  760. wrqu->data.length = p - extra + 1;
  761. return error;
  762. }
  763. static int
  764. wl_iw_get_rssi(
  765. struct net_device *dev,
  766. struct iw_request_info *info,
  767. union iwreq_data *wrqu,
  768. char *extra
  769. )
  770. {
  771. static int rssi = 0;
  772. static wlc_ssid_t ssid = {0};
  773. int error = 0;
  774. char *p = extra;
  775. static char ssidbuf[SSID_FMT_BUF_LEN];
  776. scb_val_t scb_val;
  777. bzero(&scb_val, sizeof(scb_val_t));
  778. if (g_onoff == G_WLAN_SET_ON) {
  779. error = dev_wlc_ioctl(dev, WLC_GET_RSSI, &scb_val, sizeof(scb_val_t));
  780. rssi = dtoh32(scb_val.val);
  781. error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid));
  782. ssid.SSID_len = dtoh32(ssid.SSID_len);
  783. }
  784. wl_format_ssid(ssidbuf, ssid.SSID, dtoh32(ssid.SSID_len));
  785. p += snprintf(p, MAX_WX_STRING, "%s rssi %d ", ssidbuf, rssi);
  786. wrqu->data.length = p - extra + 1;
  787. return error;
  788. }
  789. int
  790. wl_iw_send_priv_event(
  791. struct net_device *dev,
  792. char *flag
  793. )
  794. {
  795. union iwreq_data wrqu;
  796. char extra[IW_CUSTOM_MAX + 1];
  797. int cmd;
  798. cmd = IWEVCUSTOM;
  799. memset(&wrqu, 0, sizeof(wrqu));
  800. if (strlen(flag) > sizeof(extra))
  801. return -1;
  802. strcpy(extra, flag);
  803. wrqu.data.length = strlen(extra);
  804. wireless_send_event(dev, cmd, &wrqu, extra);
  805. WL_TRACE(("Send IWEVCUSTOM Event as %s\n", extra));
  806. return 0;
  807. }
  808. int dhd_deep_sleep(int flag);
  809. int
  810. wl_control_wl_start(struct net_device *dev)
  811. {
  812. int ret = 0;
  813. wl_iw_t *iw;
  814. WL_ERROR(("Enter %s \n", __FUNCTION__));
  815. if (!dev) {
  816. WL_ERROR(("%s: dev is null\n", __FUNCTION__));
  817. return -1;
  818. }
  819. iw = *(wl_iw_t **)netdev_priv(dev);
  820. MUTEX_LOCK(iw->pub);
  821. if (g_onoff == G_WLAN_SET_OFF) {
  822. #ifdef ENABLE_DEEP_SLEEP
  823. dhd_deep_sleep(FALSE);
  824. #else
  825. dhd_customer_gpio_wlan_ctrl(WLAN_RESET_ON);
  826. #if defined(BCMLXSDMMC)
  827. sdioh_start(NULL, 0);
  828. #endif
  829. dhd_dev_reset(dev, 0);
  830. #if defined(BCMLXSDMMC)
  831. sdioh_start(NULL, 1);
  832. #endif
  833. #endif
  834. dhd_dev_init_ioctl(dev);
  835. g_onoff = G_WLAN_SET_ON;
  836. }
  837. WL_ERROR(("Exited %s \n", __FUNCTION__));
  838. MUTEX_UNLOCK(iw->pub);
  839. return ret;
  840. }
  841. static int
  842. wl_iw_control_wl_off(
  843. struct net_device *dev,
  844. struct iw_request_info *info
  845. )
  846. {
  847. int ret = 0;
  848. wl_iw_t *iw;
  849. WL_ERROR(("Enter %s\n", __FUNCTION__));
  850. if (!dev) {
  851. WL_ERROR(("%s: dev is null\n", __FUNCTION__));
  852. return -1;
  853. }
  854. iw = *(wl_iw_t **)netdev_priv(dev);
  855. MUTEX_LOCK(iw->pub);
  856. #ifdef SOFTAP
  857. ap_cfg_running = FALSE;
  858. #endif
  859. if (g_onoff == G_WLAN_SET_ON) {
  860. g_onoff = G_WLAN_SET_OFF;
  861. #if defined(WL_IW_USE_ISCAN)
  862. g_iscan->iscan_state = ISCAN_STATE_IDLE;
  863. #endif
  864. #ifndef ENABLE_DEEP_SLEEP
  865. dhd_dev_reset(dev, 1);
  866. #endif
  867. #if defined(WL_IW_USE_ISCAN)
  868. #if !defined(CSCAN)
  869. wl_iw_free_ss_cache();
  870. wl_iw_run_ss_cache_timer(0);
  871. g_ss_cache_ctrl.m_link_down = 1;
  872. #endif
  873. memset(g_scan, 0, G_SCAN_RESULTS);
  874. g_scan_specified_ssid = 0;
  875. g_first_broadcast_scan = BROADCAST_SCAN_FIRST_IDLE;
  876. #endif
  877. #ifdef ENABLE_DEEP_SLEEP
  878. dhd_deep_sleep(TRUE);
  879. #else
  880. #if defined(BCMLXSDMMC)
  881. sdioh_stop(NULL);
  882. #endif
  883. dhd_customer_gpio_wlan_ctrl(WLAN_RESET_OFF);
  884. #endif
  885. wl_iw_send_priv_event(dev, "STOP");
  886. }
  887. MUTEX_UNLOCK(iw->pub);
  888. WL_TRACE(("Exited %s\n", __FUNCTION__));
  889. return ret;
  890. }
  891. static int
  892. wl_iw_control_wl_on(
  893. struct net_device *dev,
  894. struct iw_request_info *info
  895. )
  896. {
  897. int ret = 0;
  898. WL_TRACE(("Enter %s \n", __FUNCTION__));
  899. ret = wl_control_wl_start(dev);
  900. wl_iw_send_priv_event(dev, "START");
  901. #if !defined(CSCAN)
  902. #ifdef SOFTAP
  903. if (!ap_fw_loaded) {
  904. wl_iw_iscan_set_scan_broadcast_prep(dev, 0);
  905. }
  906. #else
  907. wl_iw_iscan_set_scan_broadcast_prep(dev, 0);
  908. #endif
  909. #endif
  910. WL_TRACE(("Exited %s \n", __FUNCTION__));
  911. return ret;
  912. }
  913. #ifdef SOFTAP
  914. static struct ap_profile my_ap;
  915. static int set_ap_cfg(struct net_device *dev, struct ap_profile *ap);
  916. static int get_assoc_sta_list(struct net_device *dev, char *buf, int len);
  917. static int set_ap_mac_list(struct net_device *dev, char *buf);
  918. #define PTYPE_STRING 0
  919. #define PTYPE_INTDEC 1
  920. #define PTYPE_INTHEX 2
  921. #define PTYPE_STR_HEX 3
  922. int get_parmeter_from_string(
  923. char **str_ptr, const char *token, int param_type, void *dst, int param_max_len);
  924. #endif
  925. int hex2num(char c)
  926. {
  927. if (c >= '0' && c <= '9')
  928. return c - '0';
  929. if (c >= 'a' && c <= 'f')
  930. return c - 'a' + 10;
  931. if (c >= 'A' && c <= 'F')
  932. return c - 'A' + 10;
  933. return -1;
  934. }
  935. int hex2byte(const char *hex)
  936. {
  937. int a, b;
  938. a = hex2num(*hex++);
  939. if (a < 0)
  940. return -1;
  941. b = hex2num(*hex++);
  942. if (b < 0)
  943. return -1;
  944. return (a << 4) | b;
  945. }
  946. int hstr_2_buf(const char *txt, u8 *buf, int len)
  947. {
  948. int i;
  949. for (i = 0; i < len; i++) {
  950. int a, b;
  951. a = hex2num(*txt++);
  952. if (a < 0)
  953. return -1;
  954. b = hex2num(*txt++);
  955. if (b < 0)
  956. return -1;
  957. *buf++ = (a << 4) | b;
  958. }
  959. return 0;
  960. }
  961. #ifdef SOFTAP
  962. int init_ap_profile_from_string(char *param_str, struct ap_profile *ap_cfg)
  963. {
  964. char *str_ptr = param_str;
  965. char sub_cmd[16];
  966. int ret = 0;
  967. memset(sub_cmd, 0, sizeof(sub_cmd));
  968. memset(ap_cfg, 0, sizeof(struct ap_profile));
  969. if (get_parmeter_from_string(&str_ptr, "ASCII_CMD=",
  970. PTYPE_STRING, sub_cmd, SSID_LEN) != 0) {
  971. return -1;
  972. }
  973. if (strncmp(sub_cmd, "AP_CFG", 6)) {
  974. WL_ERROR(("ERROR: sub_cmd:%s != 'AP_CFG'!\n", sub_cmd));
  975. return -1;
  976. }
  977. ret = get_parmeter_from_string(&str_ptr, "SSID=", PTYPE_STRING, ap_cfg->ssid, SSID_LEN);
  978. ret |= get_parmeter_from_string(&str_ptr, "SEC=", PTYPE_STRING, ap_cfg->sec, SEC_LEN);
  979. ret |= get_parmeter_from_string(&str_ptr, "KEY=", PTYPE_STRING, ap_cfg->key, KEY_LEN);
  980. ret |= get_parmeter_from_string(&str_ptr, "CHANNEL=", PTYPE_INTDEC, &ap_cfg->channel, 5);
  981. ret |= get_parmeter_from_string(&str_ptr, "PREAMBLE=", PTYPE_INTDEC, &ap_cfg->preamble, 5);
  982. ret |= get_parmeter_from_string(&str_ptr, "MAX_SCB=", PTYPE_INTDEC, &ap_cfg->max_scb, 5);
  983. return ret;
  984. }
  985. #endif
  986. #ifdef SOFTAP
  987. static int iwpriv_set_ap_config(struct net_device *dev,
  988. struct iw_request_info *info,
  989. union iwreq_data *wrqu,
  990. char *ext)
  991. {
  992. int res = 0;
  993. char *extra = NULL;
  994. struct ap_profile *ap_cfg = &my_ap;
  995. WL_TRACE(("> Got IWPRIV SET_AP IOCTL: info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d\n",
  996. info->cmd, info->flags,
  997. wrqu->data.pointer, wrqu->data.length));
  998. if (wrqu->data.length != 0) {
  999. char *str_ptr;
  1000. if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL)))
  1001. return -ENOMEM;
  1002. if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) {
  1003. kfree(extra);
  1004. return -EFAULT;
  1005. }
  1006. extra[wrqu->data.length] = 0;
  1007. WL_SOFTAP((" Got str param in iw_point:\n %s\n", extra));
  1008. memset(ap_cfg, 0, sizeof(struct ap_profile));
  1009. str_ptr = extra;
  1010. if ((res = init_ap_profile_from_string(extra, ap_cfg)) < 0) {
  1011. WL_ERROR(("%s failed to parse %d\n", __FUNCTION__, res));
  1012. kfree(extra);
  1013. return -1;
  1014. }
  1015. } else {
  1016. WL_ERROR(("IWPRIV argument len = 0 \n"));
  1017. return -1;
  1018. }
  1019. if ((res = set_ap_cfg(dev, ap_cfg)) < 0)
  1020. WL_ERROR(("%s failed to set_ap_cfg %d\n", __FUNCTION__, res));
  1021. kfree(extra);
  1022. return res;
  1023. }
  1024. #endif
  1025. #ifdef SOFTAP
  1026. static int iwpriv_get_assoc_list(struct net_device *dev,
  1027. struct iw_request_info *info,
  1028. union iwreq_data *p_iwrq,
  1029. char *extra)
  1030. {
  1031. int i, ret = 0;
  1032. char mac_buf[256];
  1033. struct maclist *sta_maclist = (struct maclist *)mac_buf;
  1034. char mac_lst[256];
  1035. char *p_mac_str;
  1036. WL_TRACE(("\n %s: IWPRIV IOCTL: cmd:%hx, flags:%hx, extra:%p, iwp.len:%d, \
  1037. iwp.len:%p, iwp.flags:%x \n", __FUNCTION__, info->cmd, info->flags, \
  1038. extra, p_iwrq->data.length, p_iwrq->data.pointer, p_iwrq->data.flags));
  1039. WL_SOFTAP(("extra:%s\n", extra));
  1040. print_buf((u8 *)p_iwrq, 16, 0);
  1041. memset(sta_maclist, 0, sizeof(mac_buf));
  1042. sta_maclist->count = 8;
  1043. WL_TRACE((" net device:%s, buf_sz:%d\n", dev->name, sizeof(mac_buf)));
  1044. get_assoc_sta_list(dev, mac_buf, 256);
  1045. WL_TRACE((" got %d stations\n", sta_maclist->count));
  1046. memset(mac_lst, 0, sizeof(mac_lst));
  1047. p_mac_str = mac_lst;
  1048. for (i = 0; i < 8; i++) {
  1049. struct ether_addr * id = &sta_maclist->ea[i];
  1050. WL_SOFTAP(("dhd_drv>> sta_mac[%d] :", i));
  1051. print_buf((unsigned char *)&sta_maclist->ea[i], 6, 0);
  1052. p_mac_str += snprintf(p_mac_str, MAX_WX_STRING,
  1053. "Mac[%d]=%02X:%02X:%02X:%02X:%02X:%02X\n", i,
  1054. id->octet[0], id->octet[1], id->octet[2],
  1055. id->octet[3], id->octet[4], id->octet[5]);
  1056. }
  1057. p_iwrq->data.length = strlen(mac_lst);
  1058. WL_TRACE(("u.pointer:%p\n", p_iwrq->data.pointer));
  1059. WL_TRACE(("resulting str:\n%s \n len:%d\n\n", mac_lst, p_iwrq->data.length));
  1060. if (p_iwrq->data.length) {
  1061. if (copy_to_user(p_iwrq->data.pointer, mac_lst, p_iwrq->data.length)) {
  1062. WL_ERROR(("%s: Can't copy to user\n", __FUNCTION__));
  1063. return -EFAULT;
  1064. }
  1065. }
  1066. WL_ERROR(("Exited %s \n", __FUNCTION__));
  1067. return ret;
  1068. }
  1069. #endif
  1070. #ifdef SOFTAP
  1071. static int iwpriv_set_mac_filters(struct net_device *dev,
  1072. struct iw_request_info *info,
  1073. union iwreq_data *wrqu,
  1074. char *ext)
  1075. {
  1076. int i, ret = -1;
  1077. char * extra = NULL;
  1078. u8 macfilt[8][6];
  1079. int mac_cnt = 0;
  1080. char sub_cmd[16];
  1081. WL_TRACE((">>> Got IWPRIV SET_MAC_FILTER IOCTL: info->cmd:%x, \
  1082. info->flags:%x, u.data:%p, u.len:%d\n",
  1083. info->cmd, info->flags,
  1084. wrqu->data.pointer, wrqu->data.length));
  1085. if (wrqu->data.length != 0) {
  1086. char *str_ptr;
  1087. if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL)))
  1088. return -ENOMEM;
  1089. if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) {
  1090. kfree(extra);
  1091. return -EFAULT;
  1092. }
  1093. extra[wrqu->data.length] = 0;
  1094. WL_SOFTAP((" Got parameter string in iw_point:\n %s \n", extra));
  1095. memset(macfilt, 0, sizeof(macfilt));
  1096. memset(sub_cmd, 0, sizeof(sub_cmd));
  1097. str_ptr = extra;
  1098. if (get_parmeter_from_string(&str_ptr, "ASCII_CMD=", PTYPE_STRING, sub_cmd, 15) != 0) {
  1099. goto exit_proc;
  1100. }
  1101. #define MAC_FILT_MAX 8
  1102. if (strncmp(sub_cmd, "MAC_FLT_W", strlen("MAC_FLT_W"))) {
  1103. WL_ERROR(("ERROR: sub_cmd:%s != 'MAC_FLT_W'!\n", sub_cmd));
  1104. goto exit_proc;
  1105. }
  1106. if (get_parmeter_from_string(&str_ptr, "MAC_CNT=",
  1107. PTYPE_INTDEC, &mac_cnt, 4) != 0) {
  1108. WL_ERROR(("ERROR: MAC_CNT param is missing \n"));
  1109. goto exit_proc;
  1110. }
  1111. if (mac_cnt > MAC_FILT_MAX) {
  1112. WL_ERROR(("ERROR: number of MAC filters > MAX\n"));
  1113. goto exit_proc;
  1114. }
  1115. for (i=0; i< mac_cnt; i++)
  1116. if (get_parmeter_from_string(&str_ptr, "MAC=",
  1117. PTYPE_STR_HEX, macfilt[i], 12) != 0) {
  1118. WL_ERROR(("ERROR: MAC_filter[%d] is missing !\n", i));
  1119. goto exit_proc;
  1120. }
  1121. for (i = 0; i < mac_cnt; i++) {
  1122. WL_SOFTAP(("mac_filt[%d]:", i));
  1123. print_buf(macfilt[i], 6, 0);
  1124. }
  1125. wrqu->data.pointer = NULL;
  1126. wrqu->data.length = 0;
  1127. ret = 0;
  1128. } else {
  1129. WL_ERROR(("IWPRIV argument len is 0\n"));
  1130. return -1;
  1131. }
  1132. exit_proc:
  1133. kfree(extra);
  1134. return ret;
  1135. }
  1136. #endif
  1137. #endif
  1138. #if WIRELESS_EXT < 13
  1139. struct iw_request_info
  1140. {
  1141. __u16 cmd;
  1142. __u16 flags;
  1143. };
  1144. typedef int (*iw_handler)(struct net_device *dev,
  1145. struct iw_request_info *info,
  1146. void *wrqu,
  1147. char *extra);
  1148. #endif
  1149. static int
  1150. wl_iw_config_commit(
  1151. struct net_device *dev,
  1152. struct iw_request_info *info,
  1153. void *zwrq,
  1154. char *extra
  1155. )
  1156. {
  1157. wlc_ssid_t ssid;
  1158. int error;
  1159. struct sockaddr bssid;
  1160. WL_TRACE(("%s: SIOCSIWCOMMIT\n", dev->name));
  1161. if ((error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid))))
  1162. return error;
  1163. ssid.SSID_len = dtoh32(ssid.SSID_len);
  1164. if (!ssid.SSID_len)
  1165. return 0;
  1166. bzero(&bssid, sizeof(struct sockaddr));
  1167. if ((error = dev_wlc_ioctl(dev, WLC_REASSOC, &bssid, ETHER_ADDR_LEN))) {
  1168. WL_ERROR(("%s: WLC_REASSOC to %s failed \n", __FUNCTION__, ssid.SSID));
  1169. return error;
  1170. }
  1171. return 0;
  1172. }
  1173. static int
  1174. wl_iw_get_name(
  1175. struct net_device *dev,
  1176. struct iw_request_info *info,
  1177. char *cwrq,
  1178. char *extra
  1179. )
  1180. {
  1181. WL_TRACE(("%s: SIOCGIWNAME\n", dev->name));
  1182. strcpy(cwrq, "IEEE 802.11-DS");
  1183. return 0;
  1184. }
  1185. static int
  1186. wl_iw_set_freq(
  1187. struct net_device *dev,
  1188. struct iw_request_info *info,
  1189. struct iw_freq *fwrq,
  1190. char *extra
  1191. )
  1192. {
  1193. int error, chan;
  1194. uint sf = 0;
  1195. WL_TRACE(("\n %s %s: SIOCSIWFREQ\n", __FUNCTION__, dev->name));
  1196. #if defined(SOFTAP)
  1197. if (ap_cfg_running) {
  1198. WL_TRACE(("%s:>> not executed, 'SOFT_AP is active' \n", __FUNCTION__));
  1199. return 0;
  1200. }
  1201. #endif
  1202. if (fwrq->e == 0 && fwrq->m < MAXCHANNEL) {
  1203. chan = fwrq->m;
  1204. }
  1205. else {
  1206. if (fwrq->e >= 6) {
  1207. fwrq->e -= 6;
  1208. while (fwrq->e--)
  1209. fwrq->m *= 10;
  1210. } else if (fwrq->e < 6) {
  1211. while (fwrq->e++ < 6)
  1212. fwrq->m /= 10;
  1213. }
  1214. if (fwrq->m > 4000 && fwrq->m < 5000)
  1215. sf = WF_CHAN_FACTOR_4_G;
  1216. chan = wf_mhz2channel(fwrq->m, sf);
  1217. }
  1218. chan = htod32(chan);
  1219. if ((error = dev_wlc_ioctl(dev, WLC_SET_CHANNEL, &chan, sizeof(chan))))
  1220. return error;
  1221. return -EINPROGRESS;
  1222. }
  1223. static int
  1224. wl_iw_get_freq(
  1225. struct net_device *dev,
  1226. struct iw_request_info *info,
  1227. struct iw_freq *fwrq,
  1228. char *extra
  1229. )
  1230. {
  1231. channel_info_t ci;
  1232. int error;
  1233. WL_TRACE(("%s: SIOCGIWFREQ\n", dev->name));
  1234. if ((error = dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(ci))))
  1235. return error;
  1236. fwrq->m = dtoh32(ci.hw_channel);
  1237. fwrq->e = dtoh32(0);
  1238. return 0;
  1239. }
  1240. static int
  1241. wl_iw_set_mode(
  1242. struct net_device *dev,
  1243. struct iw_request_info *info,
  1244. __u32 *uwrq,
  1245. char *extra
  1246. )
  1247. {
  1248. int infra = 0, ap = 0, error = 0;
  1249. WL_TRACE(("%s: SIOCSIWMODE\n", dev->name));
  1250. switch (*uwrq) {
  1251. case IW_MODE_MASTER:
  1252. infra = ap = 1;
  1253. break;
  1254. case IW_MODE_ADHOC:
  1255. case IW_MODE_AUTO:
  1256. break;
  1257. case IW_MODE_INFRA:
  1258. infra = 1;
  1259. break;
  1260. default:
  1261. return -EINVAL;
  1262. }
  1263. infra = htod32(infra);
  1264. ap = htod32(ap);
  1265. if ((error = dev_wlc_ioctl(dev, WLC_SET_INFRA, &infra, sizeof(infra))) ||
  1266. (error = dev_wlc_ioctl(dev, WLC_SET_AP, &ap, sizeof(ap))))
  1267. return error;
  1268. return -EINPROGRESS;
  1269. }
  1270. static int
  1271. wl_iw_get_mode(
  1272. struct net_device *dev,
  1273. struct iw_request_info *info,
  1274. __u32 *uwrq,
  1275. char *extra
  1276. )
  1277. {
  1278. int error, infra = 0, ap = 0;
  1279. WL_TRACE(("%s: SIOCGIWMODE\n", dev->name));
  1280. if ((error = dev_wlc_ioctl(dev, WLC_GET_INFRA, &infra, sizeof(infra))) ||
  1281. (error = dev_wlc_ioctl(dev, WLC_GET_AP, &ap, sizeof(ap))))
  1282. return error;
  1283. infra = dtoh32(infra);
  1284. ap = dtoh32(ap);
  1285. *uwrq = infra ? ap ? IW_MODE_MASTER : IW_MODE_INFRA : IW_MODE_ADHOC;
  1286. return 0;
  1287. }
  1288. static int
  1289. wl_iw_get_range(
  1290. struct net_device *dev,
  1291. struct iw_request_info *info,
  1292. struct iw_point *dwrq,
  1293. char *extra
  1294. )
  1295. {
  1296. struct iw_range *range = (struct iw_range *) extra;
  1297. wl_uint32_list_t *list;
  1298. wl_rateset_t rateset;
  1299. int8 *channels;
  1300. int error, i, k;
  1301. uint sf, ch;
  1302. int phytype;
  1303. int bw_cap = 0, sgi_tx = 0, nmode = 0;
  1304. channel_info_t ci;
  1305. uint8 nrate_list2copy = 0;
  1306. uint16 nrate_list[4][8] = { {13, 26, 39, 52, 78, 104, 117, 130},
  1307. {14, 29, 43, 58, 87, 116, 130, 144},
  1308. {27, 54, 81, 108, 162, 216, 243, 270},
  1309. {30, 60, 90, 120, 180, 240, 270, 300}};
  1310. WL_TRACE(("%s: SIOCGIWRANGE\n", dev->name));
  1311. if (!extra)
  1312. return -EINVAL;
  1313. channels = kmalloc((MAXCHANNEL+1)*4, GFP_KERNEL);
  1314. if (!channels) {
  1315. WL_ERROR(("Could not alloc channels\n"));
  1316. return -ENOMEM;
  1317. }
  1318. list = (wl_uint32_list_t *)channels;
  1319. dwrq->length = sizeof(struct iw_range);
  1320. memset(range, 0, sizeof(range));
  1321. range->min_nwid = range->max_nwid = 0;
  1322. list->count = htod32(MAXCHANNEL);
  1323. if ((error = dev_wlc_ioctl(dev, WLC_GET_VALID_CHANNELS, channels, (MAXCHANNEL+1)*4))) {
  1324. kfree(channels);
  1325. return error;
  1326. }
  1327. for (i = 0; i < dtoh32(list->count) && i < IW_MAX_FREQUENCIES; i++) {
  1328. range->freq[i].i = dtoh32(list->element[i]);
  1329. ch = dtoh32(list->element[i]);
  1330. if (ch <= CH_MAX_2G_CHANNEL)
  1331. sf = WF_CHAN_FACTOR_2_4_G;
  1332. else
  1333. sf = WF_CHAN_FACTOR_5_G;
  1334. range->freq[i].m = wf_channel2mhz(ch, sf);
  1335. range->freq[i].e = 6;
  1336. }
  1337. range->num_frequency = range->num_channels = i;
  1338. range->max_qual.qual = 5;
  1339. range->max_qual.level = 0x100 - 200;
  1340. range->max_qual.noise = 0x100 - 200;
  1341. range->sensitivity = 65535;
  1342. #if WIRELESS_EXT > 11
  1343. range->avg_qual.qual = 3;
  1344. range->avg_qual.level = 0x100 + WL_IW_RSSI_GOOD;
  1345. range->avg_qual.noise = 0x100 - 75;
  1346. #endif
  1347. if ((error = dev_wlc_ioctl(dev, WLC_GET_CURR_RATESET, &rateset, sizeof(rateset)))) {
  1348. kfree(channels);
  1349. return error;
  1350. }
  1351. rateset.count = dtoh32(rateset.count);
  1352. range->num_bitrates = rateset.count;
  1353. for (i = 0; i < rateset.count && i < IW_MAX_BITRATES; i++)
  1354. range->bitrate[i] = (rateset.rates[i]& 0x7f) * 500000;
  1355. dev_wlc_intvar_get(dev, "nmode", &nmode);
  1356. dev_wlc_ioctl(dev, WLC_GET_PHYTYPE, &phytype, sizeof(phytype));
  1357. if (nmode == 1 && phytype == WLC_PHY_TYPE_SSN) {
  1358. dev_wlc_intvar_get(dev, "mimo_bw_cap", &bw_cap);
  1359. dev_wlc_intvar_get(dev, "sgi_tx", &sgi_tx);
  1360. dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(channel_info_t));
  1361. ci.hw_channel = dtoh32(ci.hw_channel);
  1362. if (bw_cap == 0 ||
  1363. (bw_cap == 2 && ci.hw_channel <= 14)) {
  1364. if (sgi_tx == 0)
  1365. nrate_list2copy = 0;
  1366. else
  1367. nrate_list2copy = 1;
  1368. }
  1369. if (bw_cap == 1 ||
  1370. (bw_cap == 2 && ci.hw_channel >= 36)) {
  1371. if (sgi_tx == 0)
  1372. nrate_list2copy = 2;
  1373. else
  1374. nrate_list2copy = 3;
  1375. }
  1376. range->num_bitrates += 8;
  1377. for (k = 0; i < range->num_bitrates; k++, i++) {
  1378. range->bitrate[i] = (nrate_list[nrate_list2copy][k]) * 500000;
  1379. }
  1380. }
  1381. if ((error = dev_wlc_ioctl(dev, WLC_GET_PHYTYPE, &i, sizeof(i)))) {
  1382. kfree(channels);
  1383. return error;
  1384. }
  1385. i = dtoh32(i);
  1386. if (i == WLC_PHY_TYPE_A)
  1387. range->throughput = 24000000;
  1388. else
  1389. range->throughput = 1500000;
  1390. range->min_rts = 0;
  1391. range->max_rts = 2347;
  1392. range->min_frag = 256;
  1393. range->max_frag = 2346;
  1394. range->max_encoding_tokens = DOT11_MAX_DEFAULT_KEYS;
  1395. range->num_encoding_sizes = 4;
  1396. range->encoding_size[0] = WEP1_KEY_SIZE;
  1397. range->encoding_size[1] = WEP128_KEY_SIZE;
  1398. #if WIRELESS_EXT > 17
  1399. range->encoding_size[2] = TKIP_KEY_SIZE;
  1400. #else
  1401. range->encoding_size[2] = 0;
  1402. #endif
  1403. range->encoding_size[3] = AES_KEY_SIZE;
  1404. range->min_pmp = 0;
  1405. range->max_pmp = 0;
  1406. range->min_pmt = 0;
  1407. range->max_pmt = 0;
  1408. range->pmp_flags = 0;
  1409. range->pm_capa = 0;
  1410. range->num_txpower = 2;
  1411. range->txpower[0] = 1;
  1412. range->txpower[1] = 255;
  1413. range->txpower_capa = IW_TXPOW_MWATT;
  1414. #if WIRELESS_EXT > 10
  1415. range->we_version_compiled = WIRELESS_EXT;
  1416. range->we_version_source = 19;
  1417. range->retry_capa = IW_RETRY_LIMIT;
  1418. range->retry_flags = IW_RETRY_LIMIT;
  1419. range->r_time_flags = 0;
  1420. range->min_retry = 1;
  1421. range->max_retry = 255;
  1422. range->min_r_time = 0;
  1423. range->max_r_time = 0;
  1424. #endif
  1425. #if WIRELESS_EXT > 17
  1426. range->enc_capa = IW_ENC_CAPA_WPA;
  1427. range->enc_capa |= IW_ENC_CAPA_CIPHER_TKIP;
  1428. range->enc_capa |= IW_ENC_CAPA_CIPHER_CCMP;
  1429. #ifdef BCMWPA2
  1430. range->enc_capa |= IW_ENC_CAPA_WPA2;
  1431. #endif
  1432. IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
  1433. IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
  1434. IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
  1435. IW_EVENT_CAPA_SET(range->event_capa, IWEVTXDROP);
  1436. IW_EVENT_CAPA_SET(range->event_capa, IWEVMICHAELMICFAILURE);
  1437. #ifdef BCMWPA2
  1438. IW_EVENT_CAPA_SET(range->event_capa, IWEVPMKIDCAND);
  1439. #endif
  1440. #endif
  1441. kfree(channels);
  1442. return 0;
  1443. }
  1444. static int
  1445. rssi_to_qual(int rssi)
  1446. {
  1447. if (rssi <= WL_IW_RSSI_NO_SIGNAL)
  1448. return 0;
  1449. else if (rssi <= WL_IW_RSSI_VERY_LOW)
  1450. return 1;
  1451. else if (rssi <= WL_IW_RSSI_LOW)
  1452. return 2;
  1453. else if (rssi <= WL_IW_RSSI_GOOD)
  1454. return 3;
  1455. else if (rssi <= WL_IW_RSSI_VERY_GOOD)
  1456. return 4;
  1457. else
  1458. return 5;
  1459. }
  1460. static int
  1461. wl_iw_set_spy(
  1462. struct net_device *dev,
  1463. struct iw_request_info *info,
  1464. struct iw_point *dwrq,
  1465. char *extra
  1466. )
  1467. {
  1468. wl_iw_t *iw = *(wl_iw_t **)netdev_priv(dev);
  1469. struct sockaddr *addr = (struct sockaddr *) extra;
  1470. int i;
  1471. WL_TRACE(("%s: SIOCSIWSPY\n", dev->name));
  1472. if (!extra)
  1473. return -EINVAL;
  1474. iw->spy_num = MIN(ARRAYSIZE(iw->spy_addr), dwrq->length);
  1475. for (i = 0; i < iw->spy_num; i++)
  1476. memcpy(&iw->spy_addr[i], addr[i].sa_data, ETHER_ADDR_LEN);
  1477. memset(iw->spy_qual, 0, sizeof(iw->spy_qual));
  1478. return 0;
  1479. }
  1480. static int
  1481. wl_iw_get_spy(
  1482. struct net_device *dev,
  1483. struct iw_request_info *info,
  1484. struct iw_point *dwrq,
  1485. char *extra
  1486. )
  1487. {
  1488. wl_iw_t *iw = *(wl_iw_t **)netdev_priv(dev);
  1489. struct sockaddr *addr = (struct sockaddr *) extra;
  1490. struct iw_quality *qual = (struct iw_quality *) &addr[iw->spy_num];
  1491. int i;
  1492. WL_TRACE(("%s: SIOCGIWSPY\n", dev->name));
  1493. if (!extra)
  1494. return -EINVAL;
  1495. dwrq->length = iw->spy_num;
  1496. for (i = 0; i < iw->spy_num; i++) {
  1497. memcpy(addr[i].sa_data, &iw->spy_addr[i], ETHER_ADDR_LEN);
  1498. addr[i].sa_family = AF_UNIX;
  1499. memcpy(&qual[i], &iw->spy_qual[i], sizeof(struct iw_quality));
  1500. iw->spy_qual[i].updated = 0;
  1501. }
  1502. return 0;
  1503. }
  1504. static int
  1505. wl_iw_set_wap(
  1506. struct net_device *dev,
  1507. struct iw_request_info *info,
  1508. struct sockaddr *awrq,
  1509. char *extra
  1510. )
  1511. {
  1512. int error = -EINVAL;
  1513. wl_join_params_t join_params;
  1514. WL_TRACE(("%s: SIOCSIWAP\n", dev->name));
  1515. if (awrq->sa_family != ARPHRD_ETHER) {
  1516. WL_ERROR(("Invalid Header...sa_family\n"));
  1517. return -EINVAL;
  1518. }
  1519. if (ETHER_ISBCAST(awrq->sa_data) || ETHER_ISNULLADDR(awrq->sa_data)) {
  1520. scb_val_t scbval;
  1521. bzero(&scbval, sizeof(scb_val_t));
  1522. (void) dev_wlc_ioctl(dev, WLC_DISASSOC, &scbval, sizeof(scb_val_t));
  1523. return 0;
  1524. }
  1525. memset(&join_params, 0, sizeof(join_params));
  1526. memcpy(join_params.ssid.SSID, g_ssid.SSID, g_ssid.SSID_len);
  1527. join_params.ssid.SSID_len = htod32(g_ssid.SSID_len);
  1528. memcpy(&join_params.params.bssid, awrq->sa_data, ETHER_ADDR_LEN);
  1529. if ((error = dev_wlc_ioctl(dev, WLC_SET_SSID, &join_params, sizeof(join_params)))) {
  1530. WL_ERROR(("Invalid ioctl data.\n"));
  1531. return error;
  1532. }
  1533. memset(&g_ssid, 0, sizeof(g_ssid));
  1534. return 0;
  1535. }
  1536. static int
  1537. wl_iw_get_wap(
  1538. struct net_device *dev,
  1539. struct iw_request_info *info,
  1540. struct sockaddr *awrq,
  1541. char *extra
  1542. )
  1543. {
  1544. WL_TRACE(("%s: SIOCGIWAP\n", dev->name));
  1545. awrq->sa_family = ARPHRD_ETHER;
  1546. memset(awrq->sa_data, 0, ETHER_ADDR_LEN);
  1547. (void) dev_wlc_ioctl(dev, WLC_GET_BSSID, awrq->sa_data, ETHER_ADDR_LEN);
  1548. return 0;
  1549. }
  1550. #if WIRELESS_EXT > 17
  1551. static int
  1552. wl_iw_mlme(
  1553. struct net_device *dev,
  1554. struct iw_request_info *info,
  1555. struct sockaddr *awrq,
  1556. char *extra
  1557. )
  1558. {
  1559. struct iw_mlme *mlme;
  1560. scb_val_t scbval;
  1561. int error = -EINVAL;
  1562. WL_TRACE(("%s: SIOCSIWMLME DISASSOC/DEAUTH\n", dev->name));
  1563. mlme = (struct iw_mlme *)extra;
  1564. if (mlme == NULL) {
  1565. WL_ERROR(("Invalid ioctl data.\n"));
  1566. return error;
  1567. }
  1568. scbval.val = mlme->reason_code;
  1569. bcopy(&mlme->addr.sa_data, &scbval.ea, ETHER_ADDR_LEN);
  1570. if (mlme->cmd == IW_MLME_DISASSOC) {
  1571. scbval.val = htod32(scbval.val);
  1572. error = dev_wlc_ioctl(dev, WLC_DISASSOC, &scbval, sizeof(scb_val_t));
  1573. }
  1574. else if (mlme->cmd == IW_MLME_DEAUTH) {
  1575. scbval.val = htod32(scbval.val);
  1576. error = dev_wlc_ioctl(dev, WLC_SCB_DEAUTHENTICATE_FOR_REASON, &scbval,
  1577. sizeof(scb_val_t));
  1578. }
  1579. else {
  1580. WL_ERROR(("Invalid ioctl data.\n"));
  1581. return error;
  1582. }
  1583. return error;
  1584. }
  1585. #endif
  1586. static int
  1587. wl_iw_get_aplist(
  1588. struct net_device *dev,
  1589. struct iw_request_info *info,
  1590. struct iw_point *dwrq,
  1591. char *extra
  1592. )
  1593. {
  1594. wl_scan_results_t *list;
  1595. struct sockaddr *addr = (struct sockaddr *) extra;
  1596. struct iw_quality qual[IW_MAX_AP];
  1597. wl_bss_info_t *bi = NULL;
  1598. int error, i;
  1599. uint buflen = dwrq->length;
  1600. WL_TRACE(("%s: SIOCGIWAPLIST\n", dev->name));
  1601. if (!extra)
  1602. return -EINVAL;
  1603. list = kmalloc(buflen, GFP_KERNEL);
  1604. if (!list)
  1605. return -ENOMEM;
  1606. memset(list, 0, buflen);
  1607. list->buflen = htod32(buflen);
  1608. if ((error = dev_wlc_ioctl(dev, WLC_SCAN_RESULTS, list, buflen))) {
  1609. WL_ERROR(("%d: Scan results error %d\n", __LINE__, error));
  1610. kfree(list);
  1611. return error;
  1612. }
  1613. list->buflen = dtoh32(list->buflen);
  1614. list->version = dtoh32(list->version);
  1615. list->count = dtoh32(list->count);
  1616. if (list->version != WL_BSS_INFO_VERSION) {
  1617. WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", \
  1618. __FUNCTION__, list->version));
  1619. kfree(list);
  1620. return -EINVAL;
  1621. }
  1622. for (i = 0, dwrq->length = 0; i < list->count && dwrq->length < IW_MAX_AP; i++) {
  1623. bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : list->bss_info;
  1624. ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list +
  1625. buflen));
  1626. if (!(dtoh16(bi->capability) & DOT11_CAP_ESS))
  1627. continue;
  1628. memcpy(addr[dwrq->length].sa_data, &bi->BSSID, ETHER_ADDR_LEN);
  1629. addr[dwrq->length].sa_family = ARPHRD_ETHER;
  1630. qual[dwrq->length].qual = rssi_to_qual(dtoh16(bi->RSSI));
  1631. qual[dwrq->length].level = 0x100 + dtoh16(bi->RSSI);
  1632. qual[dwrq->length].noise = 0x100 + bi->phy_noise;
  1633. #if WIRELESS_EXT > 18
  1634. qual[dwrq->length].updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
  1635. #else
  1636. qual[dwrq->length].updated = 7;
  1637. #endif
  1638. dwrq->length++;
  1639. }
  1640. kfree(list);
  1641. if (dwrq->length) {
  1642. memcpy(&addr[dwrq->length], qual, sizeof(struct iw_quality) * dwrq->length);
  1643. dwrq->flags = 1;
  1644. }
  1645. return 0;
  1646. }
  1647. #ifdef WL_IW_USE_ISCAN
  1648. static int
  1649. wl_iw_iscan_get_aplist(
  1650. struct net_device *dev,
  1651. struct iw_request_info *info,
  1652. struct iw_point *dwrq,
  1653. char *extra
  1654. )
  1655. {
  1656. wl_scan_results_t *list;
  1657. iscan_buf_t * buf;
  1658. iscan_info_t *iscan = g_iscan;
  1659. struct sockaddr *addr = (struct sockaddr *) extra;
  1660. struct iw_quality qual[IW_MAX_AP];
  1661. wl_bss_info_t *bi = NULL;
  1662. int i;
  1663. WL_TRACE(("%s: SIOCGIWAPLIST\n", dev->name));
  1664. if (!extra)
  1665. return -EINVAL;
  1666. if ((!iscan) || (iscan->sysioc_pid < 0)) {
  1667. return wl_iw_get_aplist(dev, info, dwrq, extra);
  1668. }
  1669. buf = iscan->list_hdr;
  1670. while (buf) {
  1671. list = &((wl_iscan_results_t*)buf->iscan_buf)->results;
  1672. if (list->version != WL_BSS_INFO_VERSION) {
  1673. WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", \
  1674. __FUNCTION__, list->version));
  1675. return -EINVAL;
  1676. }
  1677. bi = NULL;
  1678. for (i = 0, dwrq->length = 0; i < list->count && dwrq->length < IW_MAX_AP; i++) {
  1679. bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length))
  1680. : list->bss_info;
  1681. ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list +
  1682. WLC_IW_ISCAN_MAXLEN));
  1683. if (!(dtoh16(bi->capability) & DOT11_CAP_ESS))
  1684. continue;
  1685. memcpy(addr[dwrq->length].sa_data, &bi->BSSID, ETHER_ADDR_LEN);
  1686. addr[dwrq->length].sa_family = ARPHRD_ETHER;
  1687. qual[dwrq->length].qual = rssi_to_qual(dtoh16(bi->RSSI));
  1688. qual[dwrq->length].level = 0x100 + dtoh16(bi->RSSI);
  1689. qual[dwrq->length].noise = 0x100 + bi->phy_noise;
  1690. #if WIRELESS_EXT > 18
  1691. qual[dwrq->length].updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
  1692. #else
  1693. qual[dwrq->length].updated = 7;
  1694. #endif
  1695. dwrq->length++;
  1696. }
  1697. buf = buf->next;
  1698. }
  1699. if (dwrq->length) {
  1700. memcpy(&addr[dwrq->length], qual, sizeof(struct iw_quality) * dwrq->length);
  1701. dwrq->flags = 1;
  1702. }
  1703. return 0;
  1704. }
  1705. static int
  1706. wl_iw_iscan_prep(wl_scan_params_t *params, wlc_ssid_t *ssid)
  1707. {
  1708. int err = 0;
  1709. memcpy(&params->bssid, &ether_bcast, ETHER_ADDR_LEN);
  1710. params->bss_type = DOT11_BSSTYPE_ANY;
  1711. params->scan_type = 0;
  1712. params->nprobes = -1;
  1713. params->active_time = -1;
  1714. params->passive_time = -1;
  1715. params->home_time = -1;
  1716. params->channel_num = 0;
  1717. params->nprobes = htod32(params->nprobes);
  1718. params->active_time = htod32(params->active_time);
  1719. params->passive_time = htod32(params->passive_time);
  1720. params->home_time = htod32(params->home_time);
  1721. if (ssid && ssid->SSID_len)
  1722. memcpy(&params->ssid, ssid, sizeof(wlc_ssid_t));
  1723. return err;
  1724. }
  1725. static int
  1726. wl_iw_iscan(iscan_info_t *iscan, wlc_ssid_t *ssid, uint16 action)
  1727. {
  1728. int err = 0;
  1729. iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION);
  1730. iscan->iscan_ex_params_p->action = htod16(action);
  1731. iscan->iscan_ex_params_p->scan_duration = htod16(0);
  1732. WL_SCAN(("%s : nprobes=%d\n", __FUNCTION__, iscan->iscan_ex_params_p->params.nprobes));
  1733. WL_SCAN(("active_time=%d\n", iscan->iscan_ex_params_p->params.active_time));
  1734. WL_SCAN(("passive_time=%d\n", iscan->iscan_ex_params_p->params.passive_time));
  1735. WL_SCAN(("home_time=%d\n", iscan->iscan_ex_params_p->params.home_time));
  1736. WL_SCAN(("scan_type=%d\n", iscan->iscan_ex_params_p->params.scan_type));
  1737. WL_SCAN(("bss_type=%d\n", iscan->iscan_ex_params_p->params.bss_type));
  1738. (void) dev_iw_iovar_setbuf(iscan->dev, "iscan", iscan->iscan_ex_params_p, \
  1739. iscan->iscan_ex_param_size, iscan->ioctlbuf, sizeof(iscan->ioctlbuf));
  1740. return err;
  1741. }
  1742. static void
  1743. wl_iw_timerfunc(ulong data)
  1744. {
  1745. iscan_info_t *iscan = (iscan_info_t *)data;
  1746. if (iscan) {
  1747. iscan->timer_on = 0;
  1748. if (iscan->iscan_state != ISCAN_STATE_IDLE) {
  1749. WL_TRACE(("timer trigger\n"));
  1750. up(&iscan->sysioc_sem);
  1751. }
  1752. }
  1753. }
  1754. static void wl_iw_set_event_mask(struct net_device *dev)
  1755. {
  1756. char eventmask[WL_EVENTING_MASK_LEN];
  1757. char iovbuf[WL_EVENTING_MASK_LEN + 12];
  1758. dev_iw_iovar_getbuf(dev, "event_msgs", "", 0, iovbuf, sizeof(iovbuf));
  1759. bcopy(iovbuf, eventmask, WL_EVENTING_MASK_LEN);
  1760. setbit(eventmask, WLC_E_SCAN_COMPLETE);
  1761. dev_iw_iovar_setbuf(dev, "event_msgs", eventmask, WL_EVENTING_MASK_LEN,
  1762. iovbuf, sizeof(iovbuf));
  1763. }
  1764. static uint32
  1765. wl_iw_iscan_get(iscan_info_t *iscan)
  1766. {
  1767. iscan_buf_t * buf;
  1768. iscan_buf_t * ptr;
  1769. wl_iscan_results_t * list_buf;
  1770. wl_iscan_results_t list;
  1771. wl_scan_results_t *results;
  1772. uint32 status;
  1773. MUTEX_LOCK_WL_SCAN_SET();
  1774. if (iscan->list_cur) {
  1775. buf = iscan->list_cur;
  1776. iscan->list_cur = buf->next;
  1777. }
  1778. else {
  1779. buf = kmalloc(sizeof(iscan_buf_t), GFP_KERNEL);
  1780. if (!buf) {
  1781. WL_ERROR(("%s can't alloc iscan_buf_t : going to abort currect iscan\n", \
  1782. __FUNCTION__));
  1783. MUTEX_UNLOCK_WL_SCAN_SET();
  1784. return WL_SCAN_RESULTS_NO_MEM;
  1785. }
  1786. buf->next = NULL;
  1787. if (!iscan->list_hdr)
  1788. iscan->list_hdr = buf;
  1789. else {
  1790. ptr = iscan->list_hdr;
  1791. while (ptr->next) {
  1792. ptr = ptr->next;
  1793. }
  1794. ptr->next = buf;
  1795. }
  1796. }
  1797. memset(buf->iscan_buf, 0, WLC_IW_ISCAN_MAXLEN);
  1798. list_buf = (wl_iscan_results_t*)buf->iscan_buf;
  1799. results = &list_buf->results;
  1800. results->buflen = WL_ISCAN_RESULTS_FIXED_SIZE;
  1801. results->version = 0;
  1802. results->count = 0;
  1803. memset(&list, 0, sizeof(list));
  1804. list.results.buflen = htod32(WLC_IW_ISCAN_MAXLEN);
  1805. (void) dev_iw_iovar_getbuf(
  1806. iscan->dev,
  1807. "iscanresults",
  1808. &list,
  1809. WL_ISCAN_RESULTS_FIXED_SIZE,
  1810. buf->iscan_buf,
  1811. WLC_IW_ISCAN_MAXLEN);
  1812. results->buflen = dtoh32(results->buflen);
  1813. results->version = dtoh32(results->version);
  1814. results->count = dtoh32(results->count);
  1815. WL_TRACE(("results->count = %d\n", results->count));
  1816. WL_TRACE(("results->buflen = %d\n", results->buflen));
  1817. status = dtoh32(list_buf->status);
  1818. MUTEX_UNLOCK_WL_SCAN_SET();
  1819. return status;
  1820. }
  1821. static void wl_iw_force_specific_scan(iscan_info_t *iscan)
  1822. {
  1823. WL_TRACE(("%s force Specific SCAN for %s\n", __FUNCTION__, g_specific_ssid.SSID));
  1824. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  1825. rtnl_lock();
  1826. #endif
  1827. (void) dev_wlc_ioctl(iscan->dev, WLC_SCAN, &g_specific_ssid, sizeof(g_specific_ssid));
  1828. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  1829. rtnl_unlock();
  1830. #endif
  1831. }
  1832. static void wl_iw_send_scan_complete(iscan_info_t *iscan)
  1833. {
  1834. #ifndef SANDGATE2G
  1835. union iwreq_data wrqu;
  1836. memset(&wrqu, 0, sizeof(wrqu));
  1837. wireless_send_event(iscan->dev, SIOCGIWSCAN, &wrqu, NULL);
  1838. #if !defined(CSCAN)
  1839. if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_STARTED)
  1840. g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_READY;
  1841. #endif
  1842. WL_TRACE(("Send Event ISCAN complete\n"));
  1843. #endif
  1844. }
  1845. static int
  1846. _iscan_sysioc_thread(void *data)
  1847. {
  1848. uint32 status;
  1849. iscan_info_t *iscan = (iscan_info_t *)data;
  1850. static bool iscan_pass_abort = FALSE;
  1851. DAEMONIZE("iscan_sysioc");
  1852. status = WL_SCAN_RESULTS_PARTIAL;
  1853. while (down_interruptible(&iscan->sysioc_sem) == 0) {
  1854. #if defined(SOFTAP)
  1855. if (ap_cfg_running) {
  1856. WL_TRACE(("%s skipping SCAN ops in AP mode !!!\n", __FUNCTION__));
  1857. continue;
  1858. }
  1859. #endif
  1860. if (iscan->timer_on) {
  1861. del_timer(&iscan->timer);
  1862. iscan->timer_on = 0;
  1863. }
  1864. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  1865. rtnl_lock();
  1866. #endif
  1867. status = wl_iw_iscan_get(iscan);
  1868. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  1869. rtnl_unlock();
  1870. #endif
  1871. if (g_scan_specified_ssid && (iscan_pass_abort == TRUE)) {
  1872. WL_TRACE(("%s Get results from specific scan status=%d\n", __FUNCTION__, status));
  1873. wl_iw_send_scan_complete(iscan);
  1874. iscan_pass_abort = FALSE;
  1875. status = -1;
  1876. }
  1877. switch (status) {
  1878. case WL_SCAN_RESULTS_PARTIAL:
  1879. WL_TRACE(("iscanresults incomplete\n"));
  1880. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  1881. rtnl_lock();
  1882. #endif
  1883. wl_iw_iscan(iscan, NULL, WL_SCAN_ACTION_CONTINUE);
  1884. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  1885. rtnl_unlock();
  1886. #endif
  1887. mod_timer(&iscan->timer, jiffies + iscan->timer_ms*HZ/1000);
  1888. iscan->timer_on = 1;
  1889. break;
  1890. case WL_SCAN_RESULTS_SUCCESS:
  1891. WL_TRACE(("iscanresults complete\n"));
  1892. iscan->iscan_state = ISCAN_STATE_IDLE;
  1893. wl_iw_send_scan_complete(iscan);
  1894. break;
  1895. case WL_SCAN_RESULTS_PENDING:
  1896. WL_TRACE(("iscanresults pending\n"));
  1897. mod_timer(&iscan->timer, jiffies + iscan->timer_ms*HZ/1000);
  1898. iscan->timer_on = 1;
  1899. break;
  1900. case WL_SCAN_RESULTS_ABORTED:
  1901. WL_TRACE(("iscanresults aborted\n"));
  1902. iscan->iscan_state = ISCAN_STATE_IDLE;
  1903. if (g_scan_specified_ssid == 0)
  1904. wl_iw_send_scan_complete(iscan);
  1905. else {
  1906. iscan_pass_abort = TRUE;
  1907. wl_iw_force_specific_scan(iscan);
  1908. }
  1909. break;
  1910. case WL_SCAN_RESULTS_NO_MEM:
  1911. WL_TRACE(("iscanresults can't alloc memory: skip\n"));
  1912. iscan->iscan_state = ISCAN_STATE_IDLE;
  1913. break;
  1914. default:
  1915. WL_TRACE(("iscanresults returned unknown status %d\n", status));
  1916. break;
  1917. }
  1918. }
  1919. if (iscan->timer_on) {
  1920. del_timer(&iscan->timer);
  1921. iscan->timer_on = 0;
  1922. }
  1923. complete_and_exit(&iscan->sysioc_exited, 0);
  1924. }
  1925. #endif
  1926. #if !defined(CSCAN)
  1927. static void
  1928. wl_iw_set_ss_cache_timer_flag(void)
  1929. {
  1930. g_ss_cache_ctrl.m_timer_expired = 1;
  1931. WL_TRACE(("%s called\n", __FUNCTION__));
  1932. }
  1933. static int
  1934. wl_iw_init_ss_cache_ctrl(void)
  1935. {
  1936. WL_TRACE(("%s :\n", __FUNCTION__));
  1937. g_ss_cache_ctrl.m_prev_scan_mode = 0;
  1938. g_ss_cache_ctrl.m_cons_br_scan_cnt = 0;
  1939. g_ss_cache_ctrl.m_cache_head = NULL;
  1940. g_ss_cache_ctrl.m_link_down = 0;
  1941. g_ss_cache_ctrl.m_timer_expired = 0;
  1942. memset(g_ss_cache_ctrl.m_active_bssid, 0, ETHER_ADDR_LEN);
  1943. g_ss_cache_ctrl.m_timer = kmalloc(sizeof(struct timer_list), GFP_KERNEL);
  1944. if (!g_ss_cache_ctrl.m_timer) {
  1945. return -ENOMEM;
  1946. }
  1947. g_ss_cache_ctrl.m_timer->function = (void *)wl_iw_set_ss_cache_timer_flag;
  1948. init_timer(g_ss_cache_ctrl.m_timer);
  1949. return 0;
  1950. }
  1951. static void
  1952. wl_iw_free_ss_cache(void)
  1953. {
  1954. wl_iw_ss_cache_t *node, *cur;
  1955. wl_iw_ss_cache_t **spec_scan_head;
  1956. WL_TRACE(("%s called\n", __FUNCTION__));
  1957. MUTEX_LOCK_WL_SCAN_SET();
  1958. spec_scan_head = &g_ss_cache_ctrl.m_cache_head;
  1959. node = *spec_scan_head;
  1960. for (;node;) {
  1961. WL_TRACE(("%s : SSID - %s\n", __FUNCTION__, node->bss_info->SSID));
  1962. cur = node;
  1963. node = cur->next;
  1964. kfree(cur);
  1965. }
  1966. *spec_scan_head = NULL;
  1967. MUTEX_UNLOCK_WL_SCAN_SET();
  1968. }
  1969. static int
  1970. wl_iw_run_ss_cache_timer(int kick_off)
  1971. {
  1972. struct timer_list **timer;
  1973. timer = &g_ss_cache_ctrl.m_timer;
  1974. if (*timer) {
  1975. if (kick_off) {
  1976. (*timer)->expires = jiffies + 30000 * HZ / 1000;
  1977. add_timer(*timer);
  1978. WL_TRACE(("%s : timer starts \n", __FUNCTION__));
  1979. } else {
  1980. del_timer_sync(*timer);
  1981. WL_TRACE(("%s : timer stops \n", __FUNCTION__));
  1982. }
  1983. }
  1984. return 0;
  1985. }
  1986. void
  1987. wl_iw_release_ss_cache_ctrl(void)
  1988. {
  1989. WL_TRACE(("%s :\n", __FUNCTION__));
  1990. wl_iw_free_ss_cache();
  1991. wl_iw_run_ss_cache_timer(0);
  1992. if (g_ss_cache_ctrl.m_timer) {
  1993. kfree(g_ss_cache_ctrl.m_timer);
  1994. }
  1995. }
  1996. static void
  1997. wl_iw_reset_ss_cache(void)
  1998. {
  1999. wl_iw_ss_cache_t *node, *prev, *cur;
  2000. wl_iw_ss_cache_t **spec_scan_head;
  2001. MUTEX_LOCK_WL_SCAN_SET();
  2002. spec_scan_head = &g_ss_cache_ctrl.m_cache_head;
  2003. node = *spec_scan_head;
  2004. prev = node;
  2005. for (;node;) {
  2006. WL_TRACE(("%s : node SSID %s \n", __FUNCTION__, node->bss_info->SSID));
  2007. if (!node->dirty) {
  2008. cur = node;
  2009. if (cur == *spec_scan_head) {
  2010. *spec_scan_head = cur->next;
  2011. prev = *spec_scan_head;
  2012. }
  2013. else {
  2014. prev->next = cur->next;
  2015. }
  2016. node = cur->next;
  2017. WL_TRACE(("%s : Del node : SSID %s\n", __FUNCTION__, cur->bss_info->SSID));
  2018. kfree(cur);
  2019. continue;
  2020. }
  2021. node->dirty = 0;
  2022. prev = node;
  2023. node = node->next;
  2024. }
  2025. MUTEX_UNLOCK_WL_SCAN_SET();
  2026. }
  2027. static int
  2028. wl_iw_add_bss_to_ss_cache(wl_scan_results_t *ss_list)
  2029. {
  2030. wl_iw_ss_cache_t *node, *prev, *leaf;
  2031. wl_iw_ss_cache_t **spec_scan_head;
  2032. wl_bss_info_t *bi = NULL;
  2033. int i;
  2034. if (!ss_list->count) {
  2035. return 0;
  2036. }
  2037. MUTEX_LOCK_WL_SCAN_SET();
  2038. spec_scan_head = &g_ss_cache_ctrl.m_cache_head;
  2039. for (i = 0; i < ss_list->count; i++) {
  2040. node = *spec_scan_head;
  2041. prev = node;
  2042. bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : ss_list->bss_info;
  2043. WL_TRACE(("%s : find %d with specific SSID %s\n", __FUNCTION__, i, bi->SSID));
  2044. for (;node;) {
  2045. if (!memcmp(&node->bss_info->BSSID, &bi->BSSID, ETHER_ADDR_LEN)) {
  2046. WL_TRACE(("dirty marked : SSID %s\n", bi->SSID));
  2047. node->dirty = 1;
  2048. break;
  2049. }
  2050. prev = node;
  2051. node = node->next;
  2052. }
  2053. if (node) {
  2054. continue;
  2055. }
  2056. leaf = kmalloc(bi->length + WLC_IW_SS_CACHE_CTRL_FIELD_MAXLEN, GFP_KERNEL);
  2057. if (!leaf) {
  2058. MUTEX_UNLOCK_WL_SCAN_SET();
  2059. WL_ERROR(("Memory alloc failure %d\n", \
  2060. bi->length + WLC_IW_SS_CACHE_CTRL_FIELD_MAXLEN));
  2061. return -ENOMEM;
  2062. }
  2063. memcpy(leaf->bss_info, bi, bi->length);
  2064. leaf->next = NULL;
  2065. leaf->dirty = 1;
  2066. leaf->count = 1;
  2067. leaf->version = ss_list->version;
  2068. if (!prev) {
  2069. *spec_scan_head = leaf;
  2070. }
  2071. else {
  2072. prev->next = leaf;
  2073. }
  2074. }
  2075. MUTEX_UNLOCK_WL_SCAN_SET();
  2076. return 0;
  2077. }
  2078. static int
  2079. wl_iw_merge_scan_cache(struct iw_request_info *info, char *extra, uint buflen_from_user,
  2080. __u16 *merged_len)
  2081. {
  2082. wl_iw_ss_cache_t *node;
  2083. wl_scan_results_t *list_merge;
  2084. MUTEX_LOCK_WL_SCAN_SET();
  2085. node = g_ss_cache_ctrl.m_cache_head;
  2086. for (;node;) {
  2087. list_merge = (wl_scan_results_t *)node;
  2088. WL_TRACE(("%s: Cached Specific APs list=%d\n", __FUNCTION__, list_merge->count));
  2089. if (buflen_from_user - *merged_len > 0) {
  2090. *merged_len += (__u16) wl_iw_get_scan_prep(list_merge, info,
  2091. extra + *merged_len, buflen_from_user - *merged_len);
  2092. }
  2093. else {
  2094. WL_TRACE(("%s: exit with break\n", __FUNCTION__));
  2095. break;
  2096. }
  2097. node = node->next;
  2098. }
  2099. MUTEX_UNLOCK_WL_SCAN_SET();
  2100. return 0;
  2101. }
  2102. static int
  2103. wl_iw_delete_bss_from_ss_cache(void *addr)
  2104. {
  2105. wl_iw_ss_cache_t *node, *prev;
  2106. wl_iw_ss_cache_t **spec_scan_head;
  2107. MUTEX_LOCK_WL_SCAN_SET();
  2108. spec_scan_head = &g_ss_cache_ctrl.m_cache_head;
  2109. node = *spec_scan_head;
  2110. prev = node;
  2111. for (;node;) {
  2112. if (!memcmp(&node->bss_info->BSSID, addr, ETHER_ADDR_LEN)) {
  2113. if (node == *spec_scan_head) {
  2114. *spec_scan_head = node->next;
  2115. }
  2116. else {
  2117. prev->next = node->next;
  2118. }
  2119. WL_TRACE(("%s : Del node : %s\n", __FUNCTION__, node->bss_info->SSID));
  2120. kfree(node);
  2121. break;
  2122. }
  2123. prev = node;
  2124. node = node->next;
  2125. }
  2126. memset(addr, 0, ETHER_ADDR_LEN);
  2127. MUTEX_UNLOCK_WL_SCAN_SET();
  2128. return 0;
  2129. }
  2130. #endif
  2131. static int
  2132. wl_iw_set_scan(
  2133. struct net_device *dev,
  2134. struct iw_request_info *info,
  2135. union iwreq_data *wrqu,
  2136. char *extra
  2137. )
  2138. {
  2139. int error;
  2140. WL_TRACE(("\n:%s dev:%s: SIOCSIWSCAN : SCAN\n", __FUNCTION__, dev->name));
  2141. #if defined(CSCAN)
  2142. WL_ERROR(("%s: Scan from SIOCGIWSCAN not supported\n", __FUNCTION__));
  2143. return -EINVAL;
  2144. #endif
  2145. #if defined(SOFTAP)
  2146. if (ap_cfg_running) {
  2147. WL_TRACE(("\n>%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__));
  2148. return 0;
  2149. }
  2150. #endif
  2151. if (g_onoff == G_WLAN_SET_OFF)
  2152. return 0;
  2153. memset(&g_specific_ssid, 0, sizeof(g_specific_ssid));
  2154. #ifndef WL_IW_USE_ISCAN
  2155. g_scan_specified_ssid = 0;
  2156. #endif
  2157. #if WIRELESS_EXT > 17
  2158. if (wrqu->data.length == sizeof(struct iw_scan_req)) {
  2159. if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
  2160. struct iw_scan_req *req = (struct iw_scan_req *)extra;
  2161. if (g_first_broadcast_scan != BROADCAST_SCAN_FIRST_RESULT_CONSUMED) {
  2162. WL_TRACE(("%s Ignoring SC %s first BC is not done = %d\n", \
  2163. __FUNCTION__, req->essid, \
  2164. g_first_broadcast_scan));
  2165. return -EBUSY;
  2166. }
  2167. if (g_scan_specified_ssid) {
  2168. WL_TRACE(("%s Specific SCAN is not done ignore scan for = %s \n", \
  2169. __FUNCTION__, req->essid));
  2170. return -EBUSY;
  2171. }
  2172. else {
  2173. g_specific_ssid.SSID_len = MIN(sizeof(g_specific_ssid.SSID), \
  2174. req->essid_len);
  2175. memcpy(g_specific_ssid.SSID, req->essid, g_specific_ssid.SSID_len);
  2176. g_specific_ssid.SSID_len = htod32(g_specific_ssid.SSID_len);
  2177. g_scan_specified_ssid = 1;
  2178. WL_TRACE(("### Specific scan ssid=%s len=%d\n", \
  2179. g_specific_ssid.SSID, g_specific_ssid.SSID_len));
  2180. }
  2181. }
  2182. }
  2183. #endif
  2184. if ((error = dev_wlc_ioctl(dev, WLC_SCAN, &g_specific_ssid, sizeof(g_specific_ssid)))) {
  2185. WL_TRACE(("#### Set SCAN for %s failed with %d\n", g_specific_ssid.SSID, error));
  2186. g_scan_specified_ssid = 0;
  2187. return -EBUSY;
  2188. }
  2189. return 0;
  2190. }
  2191. #ifdef WL_IW_USE_ISCAN
  2192. int
  2193. wl_iw_iscan_set_scan_broadcast_prep(struct net_device *dev, uint flag)
  2194. {
  2195. wlc_ssid_t ssid;
  2196. iscan_info_t *iscan = g_iscan;
  2197. #if !defined(CSCAN)
  2198. if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_IDLE) {
  2199. g_first_broadcast_scan = BROADCAST_SCAN_FIRST_STARTED;
  2200. WL_TRACE(("%s: First Brodcast scan was forced\n", __FUNCTION__));
  2201. }
  2202. else if (g_first_broadcast_scan == BROADCAST_SCAN_FIRST_STARTED) {
  2203. WL_TRACE(("%s: ignore ISCAN request first BS is not done yet\n", __FUNCTION__));
  2204. return 0;
  2205. }
  2206. #endif
  2207. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  2208. if (flag)
  2209. rtnl_lock();
  2210. #endif
  2211. dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &iscan->scan_flag, sizeof(iscan->scan_flag));
  2212. wl_iw_set_event_mask(dev);
  2213. WL_TRACE(("+++: Set Broadcast ISCAN\n"));
  2214. memset(&ssid, 0, sizeof(ssid));
  2215. iscan->list_cur = iscan->list_hdr;
  2216. iscan->iscan_state = ISCAN_STATE_SCANING;
  2217. memset(&iscan->iscan_ex_params_p->params, 0, iscan->iscan_ex_param_size);
  2218. wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, &ssid);
  2219. wl_iw_iscan(iscan, &ssid, WL_SCAN_ACTION_START);
  2220. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  2221. if (flag)
  2222. rtnl_unlock();
  2223. #endif
  2224. mod_timer(&iscan->timer, jiffies + iscan->timer_ms*HZ/1000);
  2225. iscan->timer_on = 1;
  2226. return 0;
  2227. }
  2228. static int
  2229. wl_iw_iscan_set_scan(
  2230. struct net_device *dev,
  2231. struct iw_request_info *info,
  2232. union iwreq_data *wrqu,
  2233. char *extra
  2234. )
  2235. {
  2236. wlc_ssid_t ssid;
  2237. iscan_info_t *iscan = g_iscan;
  2238. WL_TRACE(("%s: SIOCSIWSCAN : ISCAN\n", dev->name));
  2239. #if defined(CSCAN)
  2240. WL_ERROR(("%s: Scan from SIOCGIWSCAN not supported\n", __FUNCTION__));
  2241. return -EINVAL;
  2242. #endif
  2243. #if defined(SOFTAP)
  2244. if (ap_cfg_running) {
  2245. WL_TRACE(("\n>%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__));
  2246. return 0;
  2247. }
  2248. #endif
  2249. if (g_onoff == G_WLAN_SET_OFF) {
  2250. WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__));
  2251. return 0;
  2252. }
  2253. if ((!iscan) || (iscan->sysioc_pid < 0)) {
  2254. WL_TRACE(("%s use backup if iscan thread is not successful\n", \
  2255. __FUNCTION__));
  2256. return wl_iw_set_scan(dev, info, wrqu, extra);
  2257. }
  2258. if (g_scan_specified_ssid) {
  2259. WL_TRACE(("%s Specific SCAN already running ignoring BC scan\n", \
  2260. __FUNCTION__));
  2261. return EBUSY;
  2262. }
  2263. memset(&ssid, 0, sizeof(ssid));
  2264. #if WIRELESS_EXT > 17
  2265. if (wrqu->data.length == sizeof(struct iw_scan_req)) {
  2266. if (wrqu->data.flags & IW_SCAN_THIS_ESSID) {
  2267. int as = 0;
  2268. struct iw_scan_req *req = (struct iw_scan_req *)extra;
  2269. #if !defined(CSCAN)
  2270. if (g_first_broadcast_scan < BROADCAST_SCAN_FIRST_RESULT_CONSUMED) {
  2271. WL_TRACE(("%s First ISCAN in progress : ignoring SC = %s\n", \
  2272. __FUNCTION__, req->essid));
  2273. return -EBUSY;
  2274. }
  2275. #endif
  2276. ssid.SSID_len = MIN(sizeof(ssid.SSID), req->essid_len);
  2277. memcpy(ssid.SSID, req->essid, ssid.SSID_len);
  2278. ssid.SSID_len = htod32(ssid.SSID_len);
  2279. dev_wlc_ioctl(dev, WLC_SET_PASSIVE_SCAN, &as, sizeof(as));
  2280. wl_iw_set_event_mask(dev);
  2281. return wl_iw_set_scan(dev, info, wrqu, extra);
  2282. }
  2283. else {
  2284. g_scan_specified_ssid = 0;
  2285. if (iscan->iscan_state == ISCAN_STATE_SCANING) {
  2286. WL_TRACE(("%s ISCAN already in progress \n", __FUNCTION__));
  2287. return 0;
  2288. }
  2289. }
  2290. }
  2291. #endif
  2292. wl_iw_iscan_set_scan_broadcast_prep(dev, 0);
  2293. return 0;
  2294. }
  2295. #endif
  2296. #if WIRELESS_EXT > 17
  2297. static bool
  2298. ie_is_wpa_ie(uint8 **wpaie, uint8 **tlvs, int *tlvs_len)
  2299. {
  2300. uint8 *ie = *wpaie;
  2301. if ((ie[1] >= 6) &&
  2302. !bcmp((const void *)&ie[2], (const void *)(WPA_OUI "\x01"), 4)) {
  2303. return TRUE;
  2304. }
  2305. ie += ie[1] + 2;
  2306. *tlvs_len -= (int)(ie - *tlvs);
  2307. *tlvs = ie;
  2308. return FALSE;
  2309. }
  2310. static bool
  2311. ie_is_wps_ie(uint8 **wpsie, uint8 **tlvs, int *tlvs_len)
  2312. {
  2313. uint8 *ie = *wpsie;
  2314. if ((ie[1] >= 4) &&
  2315. !bcmp((const void *)&ie[2], (const void *)(WPA_OUI "\x04"), 4)) {
  2316. return TRUE;
  2317. }
  2318. ie += ie[1] + 2;
  2319. *tlvs_len -= (int)(ie - *tlvs);
  2320. *tlvs = ie;
  2321. return FALSE;
  2322. }
  2323. #endif
  2324. static inline int _wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data,
  2325. size_t len, int uppercase)
  2326. {
  2327. size_t i;
  2328. char *pos = buf, *end = buf + buf_size;
  2329. int ret;
  2330. if (buf_size == 0)
  2331. return 0;
  2332. for (i = 0; i < len; i++) {
  2333. ret = snprintf(pos, end - pos, uppercase ? "%02X" : "%02x",
  2334. data[i]);
  2335. if (ret < 0 || ret >= end - pos) {
  2336. end[-1] = '\0';
  2337. return pos - buf;
  2338. }
  2339. pos += ret;
  2340. }
  2341. end[-1] = '\0';
  2342. return pos - buf;
  2343. }
  2344. int wpa_snprintf_hex(char *buf, size_t buf_size, const u8 *data, size_t len)
  2345. {
  2346. return _wpa_snprintf_hex(buf, buf_size, data, len, 0);
  2347. }
  2348. static int
  2349. wl_iw_handle_scanresults_ies(char **event_p, char *end,
  2350. struct iw_request_info *info, wl_bss_info_t *bi)
  2351. {
  2352. #if WIRELESS_EXT > 17
  2353. struct iw_event iwe;
  2354. char *event;
  2355. char *buf;
  2356. int custom_event_len;
  2357. event = *event_p;
  2358. if (bi->ie_length) {
  2359. bcm_tlv_t *ie;
  2360. uint8 *ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t);
  2361. int ptr_len = bi->ie_length;
  2362. #ifdef BCMWPA2
  2363. if ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_RSN_ID))) {
  2364. iwe.cmd = IWEVGENIE;
  2365. iwe.u.data.length = ie->len + 2;
  2366. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie);
  2367. }
  2368. ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t);
  2369. #endif
  2370. while ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_WPA_ID))) {
  2371. if (ie_is_wps_ie(((uint8 **)&ie), &ptr, &ptr_len)) {
  2372. iwe.cmd = IWEVGENIE;
  2373. iwe.u.data.length = ie->len + 2;
  2374. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie);
  2375. break;
  2376. }
  2377. }
  2378. ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t);
  2379. ptr_len = bi->ie_length;
  2380. while ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_WPA_ID))) {
  2381. if (ie_is_wpa_ie(((uint8 **)&ie), &ptr, &ptr_len)) {
  2382. iwe.cmd = IWEVGENIE;
  2383. iwe.u.data.length = ie->len + 2;
  2384. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie);
  2385. break;
  2386. }
  2387. }
  2388. ptr = ((uint8 *)bi) + sizeof(wl_bss_info_t);
  2389. ptr_len = bi->ie_length;
  2390. while ((ie = bcm_parse_tlvs(ptr, ptr_len, DOT11_MNG_WAPI_ID))) {
  2391. WL_TRACE(("%s: found a WAPI IE...\n", __FUNCTION__));
  2392. #ifdef WAPI_IE_USE_GENIE
  2393. iwe.cmd = IWEVGENIE;
  2394. iwe.u.data.length = ie->len + 2;
  2395. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)ie);
  2396. #else
  2397. iwe.cmd = IWEVCUSTOM;
  2398. custom_event_len = strlen("wapi_ie=") + 2*(ie->len + 2);
  2399. iwe.u.data.length = custom_event_len;
  2400. buf = kmalloc(custom_event_len+1, GFP_KERNEL);
  2401. if (buf == NULL)
  2402. {
  2403. WL_ERROR(("malloc(%d) returned NULL...\n", custom_event_len));
  2404. break;
  2405. }
  2406. memcpy(buf, "wapi_ie=", 8);
  2407. wpa_snprintf_hex(buf + 8, 2+1, &(ie->id), 1);
  2408. wpa_snprintf_hex(buf + 10, 2+1, &(ie->len), 1);
  2409. wpa_snprintf_hex(buf + 12, 2*ie->len+1, ie->data, ie->len);
  2410. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, buf);
  2411. #endif
  2412. break;
  2413. }
  2414. *event_p = event;
  2415. }
  2416. #endif
  2417. return 0;
  2418. }
  2419. static uint
  2420. wl_iw_get_scan_prep(
  2421. wl_scan_results_t *list,
  2422. struct iw_request_info *info,
  2423. char *extra,
  2424. short max_size)
  2425. {
  2426. int i, j;
  2427. struct iw_event iwe;
  2428. wl_bss_info_t *bi = NULL;
  2429. char *event = extra, *end = extra + max_size - WE_ADD_EVENT_FIX, *value;
  2430. int ret = 0;
  2431. ASSERT(list);
  2432. for (i = 0; i < list->count && i < IW_MAX_AP; i++)
  2433. {
  2434. if (list->version != WL_BSS_INFO_VERSION) {
  2435. WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", \
  2436. __FUNCTION__, list->version));
  2437. return ret;
  2438. }
  2439. bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : list->bss_info;
  2440. WL_TRACE(("%s : %s\n", __FUNCTION__, bi->SSID));
  2441. iwe.cmd = SIOCGIWAP;
  2442. iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
  2443. memcpy(iwe.u.ap_addr.sa_data, &bi->BSSID, ETHER_ADDR_LEN);
  2444. event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_ADDR_LEN);
  2445. iwe.u.data.length = dtoh32(bi->SSID_len);
  2446. iwe.cmd = SIOCGIWESSID;
  2447. iwe.u.data.flags = 1;
  2448. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, bi->SSID);
  2449. if (dtoh16(bi->capability) & (DOT11_CAP_ESS | DOT11_CAP_IBSS)) {
  2450. iwe.cmd = SIOCGIWMODE;
  2451. if (dtoh16(bi->capability) & DOT11_CAP_ESS)
  2452. iwe.u.mode = IW_MODE_INFRA;
  2453. else
  2454. iwe.u.mode = IW_MODE_ADHOC;
  2455. event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_UINT_LEN);
  2456. }
  2457. iwe.cmd = SIOCGIWFREQ;
  2458. iwe.u.freq.m = wf_channel2mhz(CHSPEC_CHANNEL(bi->chanspec),
  2459. CHSPEC_CHANNEL(bi->chanspec) <= CH_MAX_2G_CHANNEL ?
  2460. WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G);
  2461. iwe.u.freq.e = 6;
  2462. event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_FREQ_LEN);
  2463. iwe.cmd = IWEVQUAL;
  2464. iwe.u.qual.qual = rssi_to_qual(dtoh16(bi->RSSI));
  2465. iwe.u.qual.level = 0x100 + dtoh16(bi->RSSI);
  2466. iwe.u.qual.noise = 0x100 + bi->phy_noise;
  2467. event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_QUAL_LEN);
  2468. wl_iw_handle_scanresults_ies(&event, end, info, bi);
  2469. iwe.cmd = SIOCGIWENCODE;
  2470. if (dtoh16(bi->capability) & DOT11_CAP_PRIVACY)
  2471. iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
  2472. else
  2473. iwe.u.data.flags = IW_ENCODE_DISABLED;
  2474. iwe.u.data.length = 0;
  2475. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)event);
  2476. if (bi->rateset.count) {
  2477. if (((event -extra) + IW_EV_LCP_LEN) <= (uintptr)end) {
  2478. value = event + IW_EV_LCP_LEN;
  2479. iwe.cmd = SIOCGIWRATE;
  2480. iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
  2481. for (j = 0; j < bi->rateset.count && j < IW_MAX_BITRATES; j++) {
  2482. iwe.u.bitrate.value =
  2483. (bi->rateset.rates[j] & 0x7f) * 500000;
  2484. value = IWE_STREAM_ADD_VALUE(info, event, value, end, &iwe,
  2485. IW_EV_PARAM_LEN);
  2486. }
  2487. event = value;
  2488. }
  2489. }
  2490. }
  2491. if ((ret = (event - extra)) < 0) {
  2492. WL_ERROR(("==> Wrong size\n"));
  2493. ret = 0;
  2494. }
  2495. WL_TRACE(("%s: size=%d bytes prepared \n", __FUNCTION__, (unsigned int)(event - extra)));
  2496. return (uint)ret;
  2497. }
  2498. static int
  2499. wl_iw_get_scan(
  2500. struct net_device *dev,
  2501. struct iw_request_info *info,
  2502. struct iw_point *dwrq,
  2503. char *extra
  2504. )
  2505. {
  2506. channel_info_t ci;
  2507. wl_scan_results_t *list_merge;
  2508. wl_scan_results_t *list = (wl_scan_results_t *) g_scan;
  2509. int error;
  2510. uint buflen_from_user = dwrq->length;
  2511. uint len = G_SCAN_RESULTS;
  2512. __u16 len_ret = 0;
  2513. #if !defined(CSCAN)
  2514. __u16 merged_len = 0;
  2515. #endif
  2516. #if defined(WL_IW_USE_ISCAN)
  2517. iscan_info_t *iscan = g_iscan;
  2518. iscan_buf_t * p_buf;
  2519. #if !defined(CSCAN)
  2520. uint32 counter = 0;
  2521. #endif
  2522. #endif
  2523. WL_TRACE(("%s: buflen_from_user %d: \n", dev->name, buflen_from_user));
  2524. if (!extra) {
  2525. WL_TRACE(("%s: wl_iw_get_scan return -EINVAL\n", dev->name));
  2526. return -EINVAL;
  2527. }
  2528. if ((error = dev_wlc_ioctl(dev, WLC_GET_CHANNEL, &ci, sizeof(ci))))
  2529. return error;
  2530. ci.scan_channel = dtoh32(ci.scan_channel);
  2531. if (ci.scan_channel)
  2532. return -EAGAIN;
  2533. #if !defined(CSCAN)
  2534. if (g_ss_cache_ctrl.m_timer_expired) {
  2535. wl_iw_free_ss_cache();
  2536. g_ss_cache_ctrl.m_timer_expired ^= 1;
  2537. }
  2538. if ((!g_scan_specified_ssid && g_ss_cache_ctrl.m_prev_scan_mode) ||
  2539. g_ss_cache_ctrl.m_cons_br_scan_cnt > 4) {
  2540. g_ss_cache_ctrl.m_cons_br_scan_cnt = 0;
  2541. wl_iw_reset_ss_cache();
  2542. }
  2543. g_ss_cache_ctrl.m_prev_scan_mode = g_scan_specified_ssid;
  2544. if (g_scan_specified_ssid) {
  2545. g_ss_cache_ctrl.m_cons_br_scan_cnt = 0;
  2546. }
  2547. else {
  2548. g_ss_cache_ctrl.m_cons_br_scan_cnt++;
  2549. }
  2550. #endif
  2551. if (g_scan_specified_ssid) {
  2552. list = kmalloc(len, GFP_KERNEL);
  2553. if (!list) {
  2554. WL_TRACE(("%s: wl_iw_get_scan return -ENOMEM\n", dev->name));
  2555. g_scan_specified_ssid = 0;
  2556. return -ENOMEM;
  2557. }
  2558. }
  2559. memset(list, 0, len);
  2560. list->buflen = htod32(len);
  2561. if ((error = dev_wlc_ioctl(dev, WLC_SCAN_RESULTS, list, len))) {
  2562. WL_TRACE(("%s: %s : Scan_results ERROR %d\n", dev->name, __FUNCTION__, len));
  2563. dwrq->length = len;
  2564. if (g_scan_specified_ssid)
  2565. kfree(list);
  2566. return 0;
  2567. }
  2568. list->buflen = dtoh32(list->buflen);
  2569. list->version = dtoh32(list->version);
  2570. list->count = dtoh32(list->count);
  2571. if (list->version != WL_BSS_INFO_VERSION) {
  2572. WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", \
  2573. __FUNCTION__, list->version));
  2574. if (g_scan_specified_ssid) {
  2575. g_scan_specified_ssid = 0;
  2576. kfree(list);
  2577. }
  2578. return -EINVAL;
  2579. }
  2580. #if !defined(CSCAN)
  2581. if (g_scan_specified_ssid) {
  2582. wl_iw_add_bss_to_ss_cache(list);
  2583. kfree(list);
  2584. }
  2585. #endif
  2586. #if !defined(CSCAN)
  2587. MUTEX_LOCK_WL_SCAN_SET();
  2588. #if defined(WL_IW_USE_ISCAN)
  2589. if (g_scan_specified_ssid)
  2590. WL_TRACE(("%s: Specified scan APs from scan=%d\n", __FUNCTION__, list->count));
  2591. p_buf = iscan->list_hdr;
  2592. while (p_buf != iscan->list_cur) {
  2593. list_merge = &((wl_iscan_results_t*)p_buf->iscan_buf)->results;
  2594. WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count));
  2595. counter += list_merge->count;
  2596. if (list_merge->count > 0)
  2597. len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info,
  2598. extra+len_ret, buflen_from_user -len_ret);
  2599. p_buf = p_buf->next;
  2600. }
  2601. WL_TRACE(("%s merged with total Bcast APs=%d\n", __FUNCTION__, counter));
  2602. #else
  2603. list_merge = (wl_scan_results_t *) g_scan;
  2604. len_ret = (__u16) wl_iw_get_scan_prep(list_merge, info, extra, buflen_from_user);
  2605. #endif
  2606. MUTEX_UNLOCK_WL_SCAN_SET();
  2607. if (g_ss_cache_ctrl.m_link_down) {
  2608. wl_iw_delete_bss_from_ss_cache(g_ss_cache_ctrl.m_active_bssid);
  2609. }
  2610. wl_iw_merge_scan_cache(info, extra+len_ret, buflen_from_user-len_ret, &merged_len);
  2611. len_ret += merged_len;
  2612. wl_iw_run_ss_cache_timer(0);
  2613. wl_iw_run_ss_cache_timer(1);
  2614. #else
  2615. if (g_scan_specified_ssid) {
  2616. WL_TRACE(("%s: Specified scan APs in the list =%d\n", __FUNCTION__, list->count));
  2617. len_ret = (__u16) wl_iw_get_scan_prep(list, info, extra, buflen_from_user);
  2618. kfree(list);
  2619. #if defined(WL_IW_USE_ISCAN)
  2620. p_buf = iscan->list_hdr;
  2621. while (p_buf != iscan->list_cur) {
  2622. list_merge = &((wl_iscan_results_t*)p_buf->iscan_buf)->results;
  2623. WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count));
  2624. if (list_merge->count > 0)
  2625. len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info,
  2626. extra+len_ret, buflen_from_user -len_ret);
  2627. p_buf = p_buf->next;
  2628. }
  2629. #else
  2630. list_merge = (wl_scan_results_t *) g_scan;
  2631. WL_TRACE(("%s: Bcast APs list=%d\n", __FUNCTION__, list_merge->count));
  2632. if (list_merge->count > 0)
  2633. len_ret += (__u16) wl_iw_get_scan_prep(list_merge, info, extra+len_ret,
  2634. buflen_from_user -len_ret);
  2635. #endif
  2636. }
  2637. else {
  2638. list = (wl_scan_results_t *) g_scan;
  2639. len_ret = (__u16) wl_iw_get_scan_prep(list, info, extra, buflen_from_user);
  2640. }
  2641. #endif
  2642. #if defined(WL_IW_USE_ISCAN)
  2643. g_scan_specified_ssid = 0;
  2644. #endif
  2645. if ((len_ret + WE_ADD_EVENT_FIX) < buflen_from_user)
  2646. len = len_ret;
  2647. dwrq->length = len;
  2648. dwrq->flags = 0;
  2649. WL_TRACE(("%s return to WE %d bytes APs=%d\n", __FUNCTION__, dwrq->length, list->count));
  2650. return 0;
  2651. }
  2652. #if defined(WL_IW_USE_ISCAN)
  2653. static int
  2654. wl_iw_iscan_get_scan(
  2655. struct net_device *dev,
  2656. struct iw_request_info *info,
  2657. struct iw_point *dwrq,
  2658. char *extra
  2659. )
  2660. {
  2661. wl_scan_results_t *list;
  2662. struct iw_event iwe;
  2663. wl_bss_info_t *bi = NULL;
  2664. int ii, j;
  2665. int apcnt;
  2666. char *event = extra, *end = extra + dwrq->length, *value;
  2667. iscan_info_t *iscan = g_iscan;
  2668. iscan_buf_t * p_buf;
  2669. uint32 counter = 0;
  2670. #if !defined(CSCAN)
  2671. __u16 merged_len = 0;
  2672. uint buflen_from_user = dwrq->length;
  2673. #endif
  2674. WL_TRACE(("%s %s buflen_from_user %d:\n", dev->name, __FUNCTION__, dwrq->length));
  2675. #if defined(SOFTAP)
  2676. if (ap_cfg_running) {
  2677. WL_TRACE(("%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__));
  2678. return -EINVAL;
  2679. }
  2680. #endif
  2681. if (!extra) {
  2682. WL_TRACE(("%s: INVALID SIOCGIWSCAN GET bad parameter\n", dev->name));
  2683. return -EINVAL;
  2684. }
  2685. #if !defined(CSCAN)
  2686. if (g_first_broadcast_scan < BROADCAST_SCAN_FIRST_RESULT_READY) {
  2687. WL_TRACE(("%s %s: first ISCAN results are NOT ready yet \n", \
  2688. dev->name, __FUNCTION__));
  2689. return -EAGAIN;
  2690. }
  2691. #endif
  2692. if ((!iscan) || (iscan->sysioc_pid < 0)) {
  2693. WL_TRACE(("%ssysioc_pid\n", __FUNCTION__));
  2694. return wl_iw_get_scan(dev, info, dwrq, extra);
  2695. }
  2696. #if !defined(CSCAN)
  2697. if (g_ss_cache_ctrl.m_timer_expired) {
  2698. wl_iw_free_ss_cache();
  2699. g_ss_cache_ctrl.m_timer_expired ^= 1;
  2700. }
  2701. if (g_scan_specified_ssid) {
  2702. return wl_iw_get_scan(dev, info, dwrq, extra);
  2703. }
  2704. else {
  2705. if (g_ss_cache_ctrl.m_link_down) {
  2706. wl_iw_delete_bss_from_ss_cache(g_ss_cache_ctrl.m_active_bssid);
  2707. }
  2708. if (g_ss_cache_ctrl.m_prev_scan_mode || g_ss_cache_ctrl.m_cons_br_scan_cnt > 4) {
  2709. g_ss_cache_ctrl.m_cons_br_scan_cnt = 0;
  2710. wl_iw_reset_ss_cache();
  2711. }
  2712. g_ss_cache_ctrl.m_prev_scan_mode = g_scan_specified_ssid;
  2713. g_ss_cache_ctrl.m_cons_br_scan_cnt++;
  2714. }
  2715. #endif
  2716. WL_TRACE(("%s: SIOCGIWSCAN GET broadcast results\n", dev->name));
  2717. apcnt = 0;
  2718. p_buf = iscan->list_hdr;
  2719. while (p_buf != iscan->list_cur) {
  2720. list = &((wl_iscan_results_t*)p_buf->iscan_buf)->results;
  2721. counter += list->count;
  2722. if (list->version != WL_BSS_INFO_VERSION) {
  2723. WL_ERROR(("%s : list->version %d != WL_BSS_INFO_VERSION\n", \
  2724. __FUNCTION__, list->version));
  2725. return -EINVAL;
  2726. }
  2727. bi = NULL;
  2728. for (ii = 0; ii < list->count && apcnt < IW_MAX_AP; apcnt++, ii++) {
  2729. bi = bi ? (wl_bss_info_t *)((uintptr)bi + dtoh32(bi->length)) : list->bss_info;
  2730. ASSERT(((uintptr)bi + dtoh32(bi->length)) <= ((uintptr)list +
  2731. WLC_IW_ISCAN_MAXLEN));
  2732. if (event + ETHER_ADDR_LEN + bi->SSID_len + IW_EV_UINT_LEN + IW_EV_FREQ_LEN +
  2733. IW_EV_QUAL_LEN >= end)
  2734. return -E2BIG;
  2735. iwe.cmd = SIOCGIWAP;
  2736. iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
  2737. memcpy(iwe.u.ap_addr.sa_data, &bi->BSSID, ETHER_ADDR_LEN);
  2738. event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_ADDR_LEN);
  2739. iwe.u.data.length = dtoh32(bi->SSID_len);
  2740. iwe.cmd = SIOCGIWESSID;
  2741. iwe.u.data.flags = 1;
  2742. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, bi->SSID);
  2743. if (dtoh16(bi->capability) & (DOT11_CAP_ESS | DOT11_CAP_IBSS)) {
  2744. iwe.cmd = SIOCGIWMODE;
  2745. if (dtoh16(bi->capability) & DOT11_CAP_ESS)
  2746. iwe.u.mode = IW_MODE_INFRA;
  2747. else
  2748. iwe.u.mode = IW_MODE_ADHOC;
  2749. event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_UINT_LEN);
  2750. }
  2751. iwe.cmd = SIOCGIWFREQ;
  2752. iwe.u.freq.m = wf_channel2mhz(CHSPEC_CHANNEL(bi->chanspec),
  2753. CHSPEC_CHANNEL(bi->chanspec) <= CH_MAX_2G_CHANNEL ?
  2754. WF_CHAN_FACTOR_2_4_G : WF_CHAN_FACTOR_5_G);
  2755. iwe.u.freq.e = 6;
  2756. event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_FREQ_LEN);
  2757. iwe.cmd = IWEVQUAL;
  2758. iwe.u.qual.qual = rssi_to_qual(dtoh16(bi->RSSI));
  2759. iwe.u.qual.level = 0x100 + dtoh16(bi->RSSI);
  2760. iwe.u.qual.noise = 0x100 + bi->phy_noise;
  2761. event = IWE_STREAM_ADD_EVENT(info, event, end, &iwe, IW_EV_QUAL_LEN);
  2762. wl_iw_handle_scanresults_ies(&event, end, info, bi);
  2763. iwe.cmd = SIOCGIWENCODE;
  2764. if (dtoh16(bi->capability) & DOT11_CAP_PRIVACY)
  2765. iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
  2766. else
  2767. iwe.u.data.flags = IW_ENCODE_DISABLED;
  2768. iwe.u.data.length = 0;
  2769. event = IWE_STREAM_ADD_POINT(info, event, end, &iwe, (char *)event);
  2770. if (bi->rateset.count) {
  2771. if (event + IW_MAX_BITRATES*IW_EV_PARAM_LEN >= end)
  2772. return -E2BIG;
  2773. value = event + IW_EV_LCP_LEN;
  2774. iwe.cmd = SIOCGIWRATE;
  2775. iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
  2776. for (j = 0; j < bi->rateset.count && j < IW_MAX_BITRATES; j++) {
  2777. iwe.u.bitrate.value = (bi->rateset.rates[j] & 0x7f) * 500000;
  2778. value = IWE_STREAM_ADD_VALUE(info, event, value, end, &iwe,
  2779. IW_EV_PARAM_LEN);
  2780. }
  2781. event = value;
  2782. }
  2783. }
  2784. p_buf = p_buf->next;
  2785. }
  2786. dwrq->length = event - extra;
  2787. dwrq->flags = 0;
  2788. #if !defined(CSCAN)
  2789. wl_iw_merge_scan_cache(info, event, buflen_from_user - dwrq->length, &merged_len);
  2790. dwrq->length += merged_len;
  2791. wl_iw_run_ss_cache_timer(0);
  2792. wl_iw_run_ss_cache_timer(1);
  2793. g_first_broadcast_scan = BROADCAST_SCAN_FIRST_RESULT_CONSUMED;
  2794. #endif
  2795. WL_TRACE(("%s return to WE %d bytes APs=%d\n", __FUNCTION__, dwrq->length, counter));
  2796. if (!dwrq->length)
  2797. return -EAGAIN;
  2798. return 0;
  2799. }
  2800. #endif
  2801. static int
  2802. wl_iw_set_essid(
  2803. struct net_device *dev,
  2804. struct iw_request_info *info,
  2805. struct iw_point *dwrq,
  2806. char *extra
  2807. )
  2808. {
  2809. int error;
  2810. WL_TRACE(("%s: SIOCSIWESSID\n", dev->name));
  2811. memset(&g_ssid, 0, sizeof(g_ssid));
  2812. CHECK_EXTRA_FOR_NULL(extra);
  2813. if (dwrq->length && extra) {
  2814. #if WIRELESS_EXT > 20
  2815. g_ssid.SSID_len = MIN(sizeof(g_ssid.SSID), dwrq->length);
  2816. #else
  2817. g_ssid.SSID_len = MIN(sizeof(g_ssid.SSID), dwrq->length-1);
  2818. #endif
  2819. memcpy(g_ssid.SSID, extra, g_ssid.SSID_len);
  2820. } else {
  2821. g_ssid.SSID_len = 0;
  2822. }
  2823. g_ssid.SSID_len = htod32(g_ssid.SSID_len);
  2824. if ((error = dev_wlc_ioctl(dev, WLC_SET_SSID, &g_ssid, sizeof(g_ssid))))
  2825. return error;
  2826. if (g_ssid.SSID_len) {
  2827. WL_TRACE(("%s: join SSID=%s\n", __FUNCTION__, g_ssid.SSID));
  2828. }
  2829. return 0;
  2830. }
  2831. static int
  2832. wl_iw_get_essid(
  2833. struct net_device *dev,
  2834. struct iw_request_info *info,
  2835. struct iw_point *dwrq,
  2836. char *extra
  2837. )
  2838. {
  2839. wlc_ssid_t ssid;
  2840. int error;
  2841. WL_TRACE(("%s: SIOCGIWESSID\n", dev->name));
  2842. if (!extra)
  2843. return -EINVAL;
  2844. if ((error = dev_wlc_ioctl(dev, WLC_GET_SSID, &ssid, sizeof(ssid)))) {
  2845. WL_ERROR(("Error getting the SSID\n"));
  2846. return error;
  2847. }
  2848. ssid.SSID_len = dtoh32(ssid.SSID_len);
  2849. memcpy(extra, ssid.SSID, ssid.SSID_len);
  2850. dwrq->length = ssid.SSID_len;
  2851. dwrq->flags = 1;
  2852. return 0;
  2853. }
  2854. static int
  2855. wl_iw_set_nick(
  2856. struct net_device *dev,
  2857. struct iw_request_info *info,
  2858. struct iw_point *dwrq,
  2859. char *extra
  2860. )
  2861. {
  2862. wl_iw_t *iw = *(wl_iw_t **)netdev_priv(dev);
  2863. WL_TRACE(("%s: SIOCSIWNICKN\n", dev->name));
  2864. if (!extra)
  2865. return -EINVAL;
  2866. if (dwrq->length > sizeof(iw->nickname))
  2867. return -E2BIG;
  2868. memcpy(iw->nickname, extra, dwrq->length);
  2869. iw->nickname[dwrq->length - 1] = '\0';
  2870. return 0;
  2871. }
  2872. static int
  2873. wl_iw_get_nick(
  2874. struct net_device *dev,
  2875. struct iw_request_info *info,
  2876. struct iw_point *dwrq,
  2877. char *extra
  2878. )
  2879. {
  2880. wl_iw_t *iw = *(wl_iw_t **)netdev_priv(dev);
  2881. WL_TRACE(("%s: SIOCGIWNICKN\n", dev->name));
  2882. if (!extra)
  2883. return -EINVAL;
  2884. strcpy(extra, iw->nickname);
  2885. dwrq->length = strlen(extra) + 1;
  2886. return 0;
  2887. }
  2888. static int wl_iw_set_rate(
  2889. struct net_device *dev,
  2890. struct iw_request_info *info,
  2891. struct iw_param *vwrq,
  2892. char *extra
  2893. )
  2894. {
  2895. wl_rateset_t rateset;
  2896. int error, rate, i, error_bg, error_a;
  2897. WL_TRACE(("%s: SIOCSIWRATE\n", dev->name));
  2898. if ((error = dev_wlc_ioctl(dev, WLC_GET_CURR_RATESET, &rateset, sizeof(rateset))))
  2899. return error;
  2900. rateset.count = dtoh32(rateset.count);
  2901. if (vwrq->value < 0) {
  2902. rate = rateset.rates[rateset.count - 1] & 0x7f;
  2903. } else if (vwrq->value < rateset.count) {
  2904. rate = rateset.rates[vwrq->value] & 0x7f;
  2905. } else {
  2906. rate = vwrq->value / 500000;
  2907. }
  2908. if (vwrq->fixed) {
  2909. error_bg = dev_wlc_intvar_set(dev, "bg_rate", rate);
  2910. error_a = dev_wlc_intvar_set(dev, "a_rate", rate);
  2911. if (error_bg && error_a)
  2912. return (error_bg | error_a);
  2913. } else {
  2914. error_bg = dev_wlc_intvar_set(dev, "bg_rate", 0);
  2915. error_a = dev_wlc_intvar_set(dev, "a_rate", 0);
  2916. if (error_bg && error_a)
  2917. return (error_bg | error_a);
  2918. for (i = 0; i < rateset.count; i++)
  2919. if ((rateset.rates[i] & 0x7f) > rate)
  2920. break;
  2921. rateset.count = htod32(i);
  2922. if ((error = dev_wlc_ioctl(dev, WLC_SET_RATESET, &rateset, sizeof(rateset))))
  2923. return error;
  2924. }
  2925. return 0;
  2926. }
  2927. static int wl_iw_get_rate(
  2928. struct net_device *dev,
  2929. struct iw_request_info *info,
  2930. struct iw_param *vwrq,
  2931. char *extra
  2932. )
  2933. {
  2934. int error, rate;
  2935. WL_TRACE(("%s: SIOCGIWRATE\n", dev->name));
  2936. if ((error = dev_wlc_ioctl(dev, WLC_GET_RATE, &rate, sizeof(rate))))
  2937. return error;
  2938. rate = dtoh32(rate);
  2939. vwrq->value = rate * 500000;
  2940. return 0;
  2941. }
  2942. static int
  2943. wl_iw_set_rts(
  2944. struct net_device *dev,
  2945. struct iw_request_info *info,
  2946. struct iw_param *vwrq,
  2947. char *extra
  2948. )
  2949. {
  2950. int error, rts;
  2951. WL_TRACE(("%s: SIOCSIWRTS\n", dev->name));
  2952. if (vwrq->disabled)
  2953. rts = DOT11_DEFAULT_RTS_LEN;
  2954. else if (vwrq->value < 0 || vwrq->value > DOT11_DEFAULT_RTS_LEN)
  2955. return -EINVAL;
  2956. else
  2957. rts = vwrq->value;
  2958. if ((error = dev_wlc_intvar_set(dev, "rtsthresh", rts)))
  2959. return error;
  2960. return 0;
  2961. }
  2962. static int
  2963. wl_iw_get_rts(
  2964. struct net_device *dev,
  2965. struct iw_request_info *info,
  2966. struct iw_param *vwrq,
  2967. char *extra
  2968. )
  2969. {
  2970. int error, rts;
  2971. WL_TRACE(("%s: SIOCGIWRTS\n", dev->name));
  2972. if ((error = dev_wlc_intvar_get(dev, "rtsthresh", &rts)))
  2973. return error;
  2974. vwrq->value = rts;
  2975. vwrq->disabled = (rts >= DOT11_DEFAULT_RTS_LEN);
  2976. vwrq->fixed = 1;
  2977. return 0;
  2978. }
  2979. static int
  2980. wl_iw_set_frag(
  2981. struct net_device *dev,
  2982. struct iw_request_info *info,
  2983. struct iw_param *vwrq,
  2984. char *extra
  2985. )
  2986. {
  2987. int error, frag;
  2988. WL_TRACE(("%s: SIOCSIWFRAG\n", dev->name));
  2989. if (vwrq->disabled)
  2990. frag = DOT11_DEFAULT_FRAG_LEN;
  2991. else if (vwrq->value < 0 || vwrq->value > DOT11_DEFAULT_FRAG_LEN)
  2992. return -EINVAL;
  2993. else
  2994. frag = vwrq->value;
  2995. if ((error = dev_wlc_intvar_set(dev, "fragthresh", frag)))
  2996. return error;
  2997. return 0;
  2998. }
  2999. static int
  3000. wl_iw_get_frag(
  3001. struct net_device *dev,
  3002. struct iw_request_info *info,
  3003. struct iw_param *vwrq,
  3004. char *extra
  3005. )
  3006. {
  3007. int error, fragthreshold;
  3008. WL_TRACE(("%s: SIOCGIWFRAG\n", dev->name));
  3009. if ((error = dev_wlc_intvar_get(dev, "fragthresh", &fragthreshold)))
  3010. return error;
  3011. vwrq->value = fragthreshold;
  3012. vwrq->disabled = (fragthreshold >= DOT11_DEFAULT_FRAG_LEN);
  3013. vwrq->fixed = 1;
  3014. return 0;
  3015. }
  3016. static int
  3017. wl_iw_set_txpow(
  3018. struct net_device *dev,
  3019. struct iw_request_info *info,
  3020. struct iw_param *vwrq,
  3021. char *extra
  3022. )
  3023. {
  3024. int error, disable;
  3025. uint16 txpwrmw;
  3026. WL_TRACE(("%s: SIOCSIWTXPOW\n", dev->name));
  3027. disable = vwrq->disabled ? WL_RADIO_SW_DISABLE : 0;
  3028. disable += WL_RADIO_SW_DISABLE << 16;
  3029. disable = htod32(disable);
  3030. if ((error = dev_wlc_ioctl(dev, WLC_SET_RADIO, &disable, sizeof(disable))))
  3031. return error;
  3032. if (disable & WL_RADIO_SW_DISABLE)
  3033. return 0;
  3034. if (!(vwrq->flags & IW_TXPOW_MWATT))
  3035. return -EINVAL;
  3036. if (vwrq->value < 0)
  3037. return 0;
  3038. if (vwrq->value > 0xffff) txpwrmw = 0xffff;
  3039. else txpwrmw = (uint16)vwrq->value;
  3040. error = dev_wlc_intvar_set(dev, "qtxpower", (int)(bcm_mw_to_qdbm(txpwrmw)));
  3041. return error;
  3042. }
  3043. static int
  3044. wl_iw_get_txpow(
  3045. struct net_device *dev,
  3046. struct iw_request_info *info,
  3047. struct iw_param *vwrq,
  3048. char *extra
  3049. )
  3050. {
  3051. int error, disable, txpwrdbm;
  3052. uint8 result;
  3053. WL_TRACE(("%s: SIOCGIWTXPOW\n", dev->name));
  3054. if ((error = dev_wlc_ioctl(dev, WLC_GET_RADIO, &disable, sizeof(disable))) ||
  3055. (error = dev_wlc_intvar_get(dev, "qtxpower", &txpwrdbm)))
  3056. return error;
  3057. disable = dtoh32(disable);
  3058. result = (uint8)(txpwrdbm & ~WL_TXPWR_OVERRIDE);
  3059. vwrq->value = (int32)bcm_qdbm_to_mw(result);
  3060. vwrq->fixed = 0;
  3061. vwrq->disabled = (disable & (WL_RADIO_SW_DISABLE | WL_RADIO_HW_DISABLE)) ? 1 : 0;
  3062. vwrq->flags = IW_TXPOW_MWATT;
  3063. return 0;
  3064. }
  3065. #if WIRELESS_EXT > 10
  3066. static int
  3067. wl_iw_set_retry(
  3068. struct net_device *dev,
  3069. struct iw_request_info *info,
  3070. struct iw_param *vwrq,
  3071. char *extra
  3072. )
  3073. {
  3074. int error, lrl, srl;
  3075. WL_TRACE(("%s: SIOCSIWRETRY\n", dev->name));
  3076. if (vwrq->disabled || (vwrq->flags & IW_RETRY_LIFETIME))
  3077. return -EINVAL;
  3078. if (vwrq->flags & IW_RETRY_LIMIT) {
  3079. #if WIRELESS_EXT > 20
  3080. if ((vwrq->flags & IW_RETRY_LONG) ||(vwrq->flags & IW_RETRY_MAX) ||
  3081. !((vwrq->flags & IW_RETRY_SHORT) || (vwrq->flags & IW_RETRY_MIN))) {
  3082. #else
  3083. if ((vwrq->flags & IW_RETRY_MAX) || !(vwrq->flags & IW_RETRY_MIN)) {
  3084. #endif
  3085. lrl = htod32(vwrq->value);
  3086. if ((error = dev_wlc_ioctl(dev, WLC_SET_LRL, &lrl, sizeof(lrl))))
  3087. return error;
  3088. }
  3089. #if WIRELESS_EXT > 20
  3090. if ((vwrq->flags & IW_RETRY_SHORT) ||(vwrq->flags & IW_RETRY_MIN) ||
  3091. !((vwrq->flags & IW_RETRY_LONG) || (vwrq->flags & IW_RETRY_MAX))) {
  3092. #else
  3093. if ((vwrq->flags & IW_RETRY_MIN) || !(vwrq->flags & IW_RETRY_MAX)) {
  3094. #endif
  3095. srl = htod32(vwrq->value);
  3096. if ((error = dev_wlc_ioctl(dev, WLC_SET_SRL, &srl, sizeof(srl))))
  3097. return error;
  3098. }
  3099. }
  3100. return 0;
  3101. }
  3102. static int
  3103. wl_iw_get_retry(
  3104. struct net_device *dev,
  3105. struct iw_request_info *info,
  3106. struct iw_param *vwrq,
  3107. char *extra
  3108. )
  3109. {
  3110. int error, lrl, srl;
  3111. WL_TRACE(("%s: SIOCGIWRETRY\n", dev->name));
  3112. vwrq->disabled = 0;
  3113. if ((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME)
  3114. return -EINVAL;
  3115. if ((error = dev_wlc_ioctl(dev, WLC_GET_LRL, &lrl, sizeof(lrl))) ||
  3116. (error = dev_wlc_ioctl(dev, WLC_GET_SRL, &srl, sizeof(srl))))
  3117. return error;
  3118. lrl = dtoh32(lrl);
  3119. srl = dtoh32(srl);
  3120. if (vwrq->flags & IW_RETRY_MAX) {
  3121. vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
  3122. vwrq->value = lrl;
  3123. } else {
  3124. vwrq->flags = IW_RETRY_LIMIT;
  3125. vwrq->value = srl;
  3126. if (srl != lrl)
  3127. vwrq->flags |= IW_RETRY_MIN;
  3128. }
  3129. return 0;
  3130. }
  3131. #endif
  3132. static int
  3133. wl_iw_set_encode(
  3134. struct net_device *dev,
  3135. struct iw_request_info *info,
  3136. struct iw_point *dwrq,
  3137. char *extra
  3138. )
  3139. {
  3140. wl_wsec_key_t key;
  3141. int error, val, wsec;
  3142. WL_TRACE(("%s: SIOCSIWENCODE\n", dev->name));
  3143. memset(&key, 0, sizeof(key));
  3144. if ((dwrq->flags & IW_ENCODE_INDEX) == 0) {
  3145. for (key.index = 0; key.index < DOT11_MAX_DEFAULT_KEYS; key.index++) {
  3146. val = htod32(key.index);
  3147. if ((error = dev_wlc_ioctl(dev, WLC_GET_KEY_PRIMARY, &val, sizeof(val))))
  3148. return error;
  3149. val = dtoh32(val);
  3150. if (val)
  3151. break;
  3152. }
  3153. if (key.index == DOT11_MAX_DEFAULT_KEYS)
  3154. key.index = 0;
  3155. } else {
  3156. key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
  3157. if (key.index >= DOT11_MAX_DEFAULT_KEYS)
  3158. return -EINVAL;
  3159. }
  3160. if (!extra || !dwrq->length || (dwrq->flags & IW_ENCODE_NOKEY)) {
  3161. val = htod32(key.index);
  3162. if ((error = dev_wlc_ioctl(dev, WLC_SET_KEY_PRIMARY, &val, sizeof(val))))
  3163. return error;
  3164. } else {
  3165. key.len = dwrq->length;
  3166. if (dwrq->length > sizeof(key.data))
  3167. return -EINVAL;
  3168. memcpy(key.data, extra, dwrq->length);
  3169. key.flags = WL_PRIMARY_KEY;
  3170. switch (key.len) {
  3171. case WEP1_KEY_SIZE:
  3172. key.algo = CRYPTO_ALGO_WEP1;
  3173. break;
  3174. case WEP128_KEY_SIZE:
  3175. key.algo = CRYPTO_ALGO_WEP128;
  3176. break;
  3177. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 14)
  3178. case TKIP_KEY_SIZE:
  3179. key.algo = CRYPTO_ALGO_TKIP;
  3180. break;
  3181. #endif
  3182. case AES_KEY_SIZE:
  3183. key.algo = CRYPTO_ALGO_AES_CCM;
  3184. break;
  3185. default:
  3186. return -EINVAL;
  3187. }
  3188. swap_key_from_BE(&key);
  3189. if ((error = dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key))))
  3190. return error;
  3191. }
  3192. val = (dwrq->flags & IW_ENCODE_DISABLED) ? 0 : WEP_ENABLED;
  3193. if ((error = dev_wlc_intvar_get(dev, "wsec", &wsec)))
  3194. return error;
  3195. wsec &= ~(WEP_ENABLED);
  3196. wsec |= val;
  3197. if ((error = dev_wlc_intvar_set(dev, "wsec", wsec)))
  3198. return error;
  3199. val = (dwrq->flags & IW_ENCODE_RESTRICTED) ? 1 : 0;
  3200. val = htod32(val);
  3201. if ((error = dev_wlc_ioctl(dev, WLC_SET_AUTH, &val, sizeof(val))))
  3202. return error;
  3203. return 0;
  3204. }
  3205. static int
  3206. wl_iw_get_encode(
  3207. struct net_device *dev,
  3208. struct iw_request_info *info,
  3209. struct iw_point *dwrq,
  3210. char *extra
  3211. )
  3212. {
  3213. wl_wsec_key_t key;
  3214. int error, val, wsec, auth;
  3215. WL_TRACE(("%s: SIOCGIWENCODE\n", dev->name));
  3216. bzero(&key, sizeof(wl_wsec_key_t));
  3217. if ((dwrq->flags & IW_ENCODE_INDEX) == 0) {
  3218. for (key.index = 0; key.index < DOT11_MAX_DEFAULT_KEYS; key.index++) {
  3219. val = key.index;
  3220. if ((error = dev_wlc_ioctl(dev, WLC_GET_KEY_PRIMARY, &val, sizeof(val))))
  3221. return error;
  3222. val = dtoh32(val);
  3223. if (val)
  3224. break;
  3225. }
  3226. } else
  3227. key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
  3228. if (key.index >= DOT11_MAX_DEFAULT_KEYS)
  3229. key.index = 0;
  3230. if ((error = dev_wlc_ioctl(dev, WLC_GET_WSEC, &wsec, sizeof(wsec))) ||
  3231. (error = dev_wlc_ioctl(dev, WLC_GET_AUTH, &auth, sizeof(auth))))
  3232. return error;
  3233. swap_key_to_BE(&key);
  3234. wsec = dtoh32(wsec);
  3235. auth = dtoh32(auth);
  3236. dwrq->length = MIN(DOT11_MAX_KEY_SIZE, key.len);
  3237. dwrq->flags = key.index + 1;
  3238. if (!(wsec & (WEP_ENABLED | TKIP_ENABLED | AES_ENABLED))) {
  3239. dwrq->flags |= IW_ENCODE_DISABLED;
  3240. }
  3241. if (auth) {
  3242. dwrq->flags |= IW_ENCODE_RESTRICTED;
  3243. }
  3244. if (dwrq->length && extra)
  3245. memcpy(extra, key.data, dwrq->length);
  3246. return 0;
  3247. }
  3248. static int
  3249. wl_iw_set_power(
  3250. struct net_device *dev,
  3251. struct iw_request_info *info,
  3252. struct iw_param *vwrq,
  3253. char *extra
  3254. )
  3255. {
  3256. int error, pm;
  3257. WL_TRACE(("%s: SIOCSIWPOWER\n", dev->name));
  3258. pm = vwrq->disabled ? PM_OFF : PM_MAX;
  3259. pm = htod32(pm);
  3260. if ((error = dev_wlc_ioctl(dev, WLC_SET_PM, &pm, sizeof(pm))))
  3261. return error;
  3262. return 0;
  3263. }
  3264. static int
  3265. wl_iw_get_power(
  3266. struct net_device *dev,
  3267. struct iw_request_info *info,
  3268. struct iw_param *vwrq,
  3269. char *extra
  3270. )
  3271. {
  3272. int error, pm;
  3273. WL_TRACE(("%s: SIOCGIWPOWER\n", dev->name));
  3274. if ((error = dev_wlc_ioctl(dev, WLC_GET_PM, &pm, sizeof(pm))))
  3275. return error;
  3276. pm = dtoh32(pm);
  3277. vwrq->disabled = pm ? 0 : 1;
  3278. vwrq->flags = IW_POWER_ALL_R;
  3279. return 0;
  3280. }
  3281. #if WIRELESS_EXT > 17
  3282. static int
  3283. wl_iw_set_wpaie(
  3284. struct net_device *dev,
  3285. struct iw_request_info *info,
  3286. struct iw_point *iwp,
  3287. char *extra
  3288. )
  3289. {
  3290. uchar buf[WLC_IOCTL_SMLEN] = {0};
  3291. uchar *p = buf;
  3292. int wapi_ie_size;
  3293. WL_TRACE(("%s: SIOCSIWGENIE\n", dev->name));
  3294. CHECK_EXTRA_FOR_NULL(extra);
  3295. if (extra[0] == DOT11_MNG_WAPI_ID)
  3296. {
  3297. wapi_ie_size = iwp->length;
  3298. memcpy(p, extra, iwp->length);
  3299. dev_wlc_bufvar_set(dev, "wapiie", buf, wapi_ie_size);
  3300. }
  3301. else
  3302. dev_wlc_bufvar_set(dev, "wpaie", extra, iwp->length);
  3303. return 0;
  3304. }
  3305. static int
  3306. wl_iw_get_wpaie(
  3307. struct net_device *dev,
  3308. struct iw_request_info *info,
  3309. struct iw_point *iwp,
  3310. char *extra
  3311. )
  3312. {
  3313. WL_TRACE(("%s: SIOCGIWGENIE\n", dev->name));
  3314. iwp->length = 64;
  3315. dev_wlc_bufvar_get(dev, "wpaie", extra, iwp->length);
  3316. return 0;
  3317. }
  3318. static int
  3319. wl_iw_set_encodeext(
  3320. struct net_device *dev,
  3321. struct iw_request_info *info,
  3322. struct iw_point *dwrq,
  3323. char *extra
  3324. )
  3325. {
  3326. wl_wsec_key_t key;
  3327. int error;
  3328. struct iw_encode_ext *iwe;
  3329. WL_TRACE(("%s: SIOCSIWENCODEEXT\n", dev->name));
  3330. CHECK_EXTRA_FOR_NULL(extra);
  3331. memset(&key, 0, sizeof(key));
  3332. iwe = (struct iw_encode_ext *)extra;
  3333. if (dwrq->flags & IW_ENCODE_DISABLED) {
  3334. }
  3335. key.index = 0;
  3336. if (dwrq->flags & IW_ENCODE_INDEX)
  3337. key.index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
  3338. key.len = iwe->key_len;
  3339. if (!ETHER_ISMULTI(iwe->addr.sa_data))
  3340. bcopy((void *)&iwe->addr.sa_data, (char *)&key.ea, ETHER_ADDR_LEN);
  3341. if (key.len == 0) {
  3342. if (iwe->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
  3343. WL_WSEC(("Changing the the primary Key to %d\n", key.index));
  3344. key.index = htod32(key.index);
  3345. error = dev_wlc_ioctl(dev, WLC_SET_KEY_PRIMARY,
  3346. &key.index, sizeof(key.index));
  3347. if (error)
  3348. return error;
  3349. }
  3350. else {
  3351. swap_key_from_BE(&key);
  3352. dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key));
  3353. }
  3354. }
  3355. else {
  3356. if (iwe->key_len > sizeof(key.data))
  3357. return -EINVAL;
  3358. WL_WSEC(("Setting the key index %d\n", key.index));
  3359. if (iwe->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
  3360. WL_WSEC(("key is a Primary Key\n"));
  3361. key.flags = WL_PRIMARY_KEY;
  3362. }
  3363. bcopy((void *)iwe->key, key.data, iwe->key_len);
  3364. if (iwe->alg == IW_ENCODE_ALG_TKIP) {
  3365. uint8 keybuf[8];
  3366. bcopy(&key.data[24], keybuf, sizeof(keybuf));
  3367. bcopy(&key.data[16], &key.data[24], sizeof(keybuf));
  3368. bcopy(keybuf, &key.data[16], sizeof(keybuf));
  3369. }
  3370. if (iwe->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) {
  3371. uchar *ivptr;
  3372. ivptr = (uchar *)iwe->rx_seq;
  3373. key.rxiv.hi = (ivptr[5] << 24) | (ivptr[4] << 16) |
  3374. (ivptr[3] << 8) | ivptr[2];
  3375. key.rxiv.lo = (ivptr[1] << 8) | ivptr[0];
  3376. key.iv_initialized = TRUE;
  3377. }
  3378. switch (iwe->alg) {
  3379. case IW_ENCODE_ALG_NONE:
  3380. key.algo = CRYPTO_ALGO_OFF;
  3381. break;
  3382. case IW_ENCODE_ALG_WEP:
  3383. if (iwe->key_len == WEP1_KEY_SIZE)
  3384. key.algo = CRYPTO_ALGO_WEP1;
  3385. else
  3386. key.algo = CRYPTO_ALGO_WEP128;
  3387. break;
  3388. case IW_ENCODE_ALG_TKIP:
  3389. key.algo = CRYPTO_ALGO_TKIP;
  3390. break;
  3391. case IW_ENCODE_ALG_CCMP:
  3392. key.algo = CRYPTO_ALGO_AES_CCM;
  3393. break;
  3394. case IW_ENCODE_ALG_SM4:
  3395. key.algo = CRYPTO_ALGO_SMS4;
  3396. if (iwe->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
  3397. key.flags &= ~WL_PRIMARY_KEY;
  3398. }
  3399. break;
  3400. default:
  3401. break;
  3402. }
  3403. swap_key_from_BE(&key);
  3404. dhd_wait_pend8021x(dev);
  3405. error = dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key));
  3406. if (error)
  3407. return error;
  3408. }
  3409. return 0;
  3410. }
  3411. #if WIRELESS_EXT > 17
  3412. #ifdef BCMWPA2
  3413. struct {
  3414. pmkid_list_t pmkids;
  3415. pmkid_t foo[MAXPMKID-1];
  3416. } pmkid_list;
  3417. static int
  3418. wl_iw_set_pmksa(
  3419. struct net_device *dev,
  3420. struct iw_request_info *info,
  3421. struct iw_param *vwrq,
  3422. char *extra
  3423. )
  3424. {
  3425. struct iw_pmksa *iwpmksa;
  3426. uint i;
  3427. int ret = 0;
  3428. char eabuf[ETHER_ADDR_STR_LEN];
  3429. WL_WSEC(("%s: SIOCSIWPMKSA\n", dev->name));
  3430. CHECK_EXTRA_FOR_NULL(extra);
  3431. iwpmksa = (struct iw_pmksa *)extra;
  3432. bzero((char *)eabuf, ETHER_ADDR_STR_LEN);
  3433. if (iwpmksa->cmd == IW_PMKSA_FLUSH) {
  3434. WL_WSEC(("wl_iw_set_pmksa - IW_PMKSA_FLUSH\n"));
  3435. bzero((char *)&pmkid_list, sizeof(pmkid_list));
  3436. }
  3437. else if (iwpmksa->cmd == IW_PMKSA_REMOVE) {
  3438. {
  3439. pmkid_list_t pmkid, *pmkidptr;
  3440. uint j;
  3441. pmkidptr = &pmkid;
  3442. bcopy(&iwpmksa->bssid.sa_data[0], &pmkidptr->pmkid[0].BSSID, \
  3443. ETHER_ADDR_LEN);
  3444. bcopy(&iwpmksa->pmkid[0], &pmkidptr->pmkid[0].PMKID, WPA2_PMKID_LEN);
  3445. WL_WSEC(("wl_iw_set_pmksa,IW_PMKSA_REMOVE - PMKID: %s = ",
  3446. bcm_ether_ntoa(&pmkidptr->pmkid[0].BSSID,
  3447. eabuf)));
  3448. for (j = 0; j < WPA2_PMKID_LEN; j++)
  3449. WL_WSEC(("%02x ", pmkidptr->pmkid[0].PMKID[j]));
  3450. WL_WSEC(("\n"));
  3451. }
  3452. for (i = 0; i < pmkid_list.pmkids.npmkid; i++)
  3453. if (!bcmp(&iwpmksa->bssid.sa_data[0], &pmkid_list.pmkids.pmkid[i].BSSID,
  3454. ETHER_ADDR_LEN))
  3455. break;
  3456. if ((pmkid_list.pmkids.npmkid > 0) && (i < pmkid_list.pmkids.npmkid)) {
  3457. bzero(&pmkid_list.pmkids.pmkid[i], sizeof(pmkid_t));
  3458. for (; i < (pmkid_list.pmkids.npmkid - 1); i++) {
  3459. bcopy(&pmkid_list.pmkids.pmkid[i+1].BSSID,
  3460. &pmkid_list.pmkids.pmkid[i].BSSID,
  3461. ETHER_ADDR_LEN);
  3462. bcopy(&pmkid_list.pmkids.pmkid[i+1].PMKID,
  3463. &pmkid_list.pmkids.pmkid[i].PMKID,
  3464. WPA2_PMKID_LEN);
  3465. }
  3466. pmkid_list.pmkids.npmkid--;
  3467. }
  3468. else
  3469. ret = -EINVAL;
  3470. }
  3471. else if (iwpmksa->cmd == IW_PMKSA_ADD) {
  3472. for (i = 0; i < pmkid_list.pmkids.npmkid; i++)
  3473. if (!bcmp(&iwpmksa->bssid.sa_data[0], &pmkid_list.pmkids.pmkid[i].BSSID,
  3474. ETHER_ADDR_LEN))
  3475. break;
  3476. if (i < MAXPMKID) {
  3477. bcopy(&iwpmksa->bssid.sa_data[0],
  3478. &pmkid_list.pmkids.pmkid[i].BSSID,
  3479. ETHER_ADDR_LEN);
  3480. bcopy(&iwpmksa->pmkid[0], &pmkid_list.pmkids.pmkid[i].PMKID,
  3481. WPA2_PMKID_LEN);
  3482. if (i == pmkid_list.pmkids.npmkid)
  3483. pmkid_list.pmkids.npmkid++;
  3484. }
  3485. else
  3486. ret = -EINVAL;
  3487. {
  3488. uint j;
  3489. uint k;
  3490. k = pmkid_list.pmkids.npmkid;
  3491. WL_WSEC(("wl_iw_set_pmksa,IW_PMKSA_ADD - PMKID: %s = ",
  3492. bcm_ether_ntoa(&pmkid_list.pmkids.pmkid[k].BSSID,
  3493. eabuf)));
  3494. for (j = 0; j < WPA2_PMKID_LEN; j++)
  3495. WL_WSEC(("%02x ", pmkid_list.pmkids.pmkid[k].PMKID[j]));
  3496. WL_WSEC(("\n"));
  3497. }
  3498. }
  3499. WL_WSEC(("PRINTING pmkid LIST - No of elements %d\n", pmkid_list.pmkids.npmkid));
  3500. for (i = 0; i < pmkid_list.pmkids.npmkid; i++) {
  3501. uint j;
  3502. WL_WSEC(("PMKID[%d]: %s = ", i,
  3503. bcm_ether_ntoa(&pmkid_list.pmkids.pmkid[i].BSSID,
  3504. eabuf)));
  3505. for (j = 0; j < WPA2_PMKID_LEN; j++)
  3506. WL_WSEC(("%02x ", pmkid_list.pmkids.pmkid[i].PMKID[j]));
  3507. WL_WSEC(("\n"));
  3508. }
  3509. WL_WSEC(("\n"));
  3510. if (!ret)
  3511. ret = dev_wlc_bufvar_set(dev, "pmkid_info", (char *)&pmkid_list, \
  3512. sizeof(pmkid_list));
  3513. return ret;
  3514. }
  3515. #endif
  3516. #endif
  3517. static int
  3518. wl_iw_get_encodeext(
  3519. struct net_device *dev,
  3520. struct iw_request_info *info,
  3521. struct iw_param *vwrq,
  3522. char *extra
  3523. )
  3524. {
  3525. WL_TRACE(("%s: SIOCGIWENCODEEXT\n", dev->name));
  3526. return 0;
  3527. }
  3528. static int
  3529. wl_iw_set_wpaauth(
  3530. struct net_device *dev,
  3531. struct iw_request_info *info,
  3532. struct iw_param *vwrq,
  3533. char *extra
  3534. )
  3535. {
  3536. int error = 0;
  3537. int paramid;
  3538. int paramval;
  3539. int val = 0;
  3540. wl_iw_t *iw = *(wl_iw_t **)netdev_priv(dev);
  3541. WL_TRACE(("%s: SIOCSIWAUTH\n", dev->name));
  3542. #if defined(SOFTAP)
  3543. if (ap_cfg_running) {
  3544. WL_TRACE(("%s: Not executed, reason -'SOFTAP is active'\n", __FUNCTION__));
  3545. return 0;
  3546. }
  3547. #endif
  3548. paramid = vwrq->flags & IW_AUTH_INDEX;
  3549. paramval = vwrq->value;
  3550. WL_TRACE(("%s: SIOCSIWAUTH, paramid = 0x%0x, paramval = 0x%0x\n",
  3551. dev->name, paramid, paramval));
  3552. switch (paramid) {
  3553. case IW_AUTH_WPA_VERSION:
  3554. if (paramval & IW_AUTH_WPA_VERSION_DISABLED)
  3555. val = WPA_AUTH_DISABLED;
  3556. else if (paramval & (IW_AUTH_WPA_VERSION_WPA))
  3557. val = WPA_AUTH_PSK | WPA_AUTH_UNSPECIFIED;
  3558. #ifdef BCMWPA2
  3559. else if (paramval & IW_AUTH_WPA_VERSION_WPA2)
  3560. val = WPA2_AUTH_PSK | WPA2_AUTH_UNSPECIFIED;
  3561. #endif
  3562. else if (paramval & IW_AUTH_WAPI_VERSION_1)
  3563. val = WPA_AUTH_WAPI;
  3564. WL_INFORM(("%s: %d: setting wpa_auth to 0x%0x\n", __FUNCTION__, __LINE__, val));
  3565. if ((error = dev_wlc_intvar_set(dev, "wpa_auth", val)))
  3566. return error;
  3567. break;
  3568. case IW_AUTH_CIPHER_PAIRWISE:
  3569. case IW_AUTH_CIPHER_GROUP:
  3570. if (paramval & (IW_AUTH_CIPHER_WEP40 | IW_AUTH_CIPHER_WEP104))
  3571. val = WEP_ENABLED;
  3572. if (paramval & IW_AUTH_CIPHER_TKIP)
  3573. val = TKIP_ENABLED;
  3574. if (paramval & IW_AUTH_CIPHER_CCMP)
  3575. val = AES_ENABLED;
  3576. if (paramval & IW_AUTH_CIPHER_SMS4)
  3577. val = SMS4_ENABLED;
  3578. if (paramid == IW_AUTH_CIPHER_PAIRWISE) {
  3579. iw->pwsec = val;
  3580. val |= iw->gwsec;
  3581. }
  3582. else {
  3583. iw->gwsec = val;
  3584. val |= iw->pwsec;
  3585. }
  3586. if (iw->privacy_invoked && !val) {
  3587. WL_WSEC(("%s: %s: 'Privacy invoked' TRUE but clearing wsec, assuming "
  3588. "we're a WPS enrollee\n", dev->name, __FUNCTION__));
  3589. if ((error = dev_wlc_intvar_set(dev, "is_WPS_enrollee", TRUE))) {
  3590. WL_WSEC(("Failed to set iovar is_WPS_enrollee\n"));
  3591. return error;
  3592. }
  3593. } else if (val) {
  3594. if ((error = dev_wlc_intvar_set(dev, "is_WPS_enrollee", FALSE))) {
  3595. WL_WSEC(("Failed to clear iovar is_WPS_enrollee\n"));
  3596. return error;
  3597. }
  3598. }
  3599. if ((error = dev_wlc_intvar_set(dev, "wsec", val)))
  3600. return error;
  3601. break;
  3602. case IW_AUTH_KEY_MGMT:
  3603. if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val)))
  3604. return error;
  3605. if (val & (WPA_AUTH_PSK | WPA_AUTH_UNSPECIFIED)) {
  3606. if (paramval & IW_AUTH_KEY_MGMT_PSK)
  3607. val = WPA_AUTH_PSK;
  3608. else
  3609. val = WPA_AUTH_UNSPECIFIED;
  3610. }
  3611. #ifdef BCMWPA2
  3612. else if (val & (WPA2_AUTH_PSK | WPA2_AUTH_UNSPECIFIED)) {
  3613. if (paramval & IW_AUTH_KEY_MGMT_PSK)
  3614. val = WPA2_AUTH_PSK;
  3615. else
  3616. val = WPA2_AUTH_UNSPECIFIED;
  3617. }
  3618. #endif
  3619. if (paramval & (IW_AUTH_KEY_MGMT_WAPI_PSK | IW_AUTH_KEY_MGMT_WAPI_CERT))
  3620. val = WPA_AUTH_WAPI;
  3621. WL_INFORM(("%s: %d: setting wpa_auth to %d\n", __FUNCTION__, __LINE__, val));
  3622. if ((error = dev_wlc_intvar_set(dev, "wpa_auth", val)))
  3623. return error;
  3624. break;
  3625. case IW_AUTH_TKIP_COUNTERMEASURES:
  3626. dev_wlc_bufvar_set(dev, "tkip_countermeasures", (char *)&paramval, 1);
  3627. break;
  3628. case IW_AUTH_80211_AUTH_ALG:
  3629. WL_INFORM(("Setting the D11auth %d\n", paramval));
  3630. if (paramval == IW_AUTH_ALG_OPEN_SYSTEM)
  3631. val = 0;
  3632. else if (paramval == IW_AUTH_ALG_SHARED_KEY)
  3633. val = 1;
  3634. else if (paramval == (IW_AUTH_ALG_OPEN_SYSTEM | IW_AUTH_ALG_SHARED_KEY))
  3635. val = 2;
  3636. else
  3637. error = 1;
  3638. if (!error && (error = dev_wlc_intvar_set(dev, "auth", val)))
  3639. return error;
  3640. break;
  3641. case IW_AUTH_WPA_ENABLED:
  3642. if (paramval == 0) {
  3643. iw->pwsec = 0;
  3644. iw->gwsec = 0;
  3645. if ((error = dev_wlc_intvar_get(dev, "wsec", &val)))
  3646. return error;
  3647. if (val & (TKIP_ENABLED | AES_ENABLED)) {
  3648. val &= ~(TKIP_ENABLED | AES_ENABLED);
  3649. dev_wlc_intvar_set(dev, "wsec", val);
  3650. }
  3651. val = 0;
  3652. WL_INFORM(("%s: %d: setting wpa_auth to %d\n", __FUNCTION__, __LINE__, val));
  3653. dev_wlc_intvar_set(dev, "wpa_auth", 0);
  3654. return error;
  3655. }
  3656. break;
  3657. case IW_AUTH_DROP_UNENCRYPTED:
  3658. dev_wlc_bufvar_set(dev, "wsec_restrict", (char *)&paramval, 1);
  3659. break;
  3660. case IW_AUTH_RX_UNENCRYPTED_EAPOL:
  3661. dev_wlc_bufvar_set(dev, "rx_unencrypted_eapol", (char *)&paramval, 1);
  3662. break;
  3663. #if WIRELESS_EXT > 17
  3664. case IW_AUTH_ROAMING_CONTROL:
  3665. WL_INFORM(("%s: IW_AUTH_ROAMING_CONTROL\n", __FUNCTION__));
  3666. break;
  3667. case IW_AUTH_PRIVACY_INVOKED: {
  3668. int wsec;
  3669. if (paramval == 0) {
  3670. iw->privacy_invoked = FALSE;
  3671. if ((error = dev_wlc_intvar_set(dev, "is_WPS_enrollee", FALSE))) {
  3672. WL_WSEC(("Failed to clear iovar is_WPS_enrollee\n"));
  3673. return error;
  3674. }
  3675. } else {
  3676. iw->privacy_invoked = TRUE;
  3677. if ((error = dev_wlc_intvar_get(dev, "wsec", &wsec)))
  3678. return error;
  3679. if (!(IW_WSEC_ENABLED(wsec))) {
  3680. if ((error = dev_wlc_intvar_set(dev, "is_WPS_enrollee", TRUE))) {
  3681. WL_WSEC(("Failed to set iovar is_WPS_enrollee\n"));
  3682. return error;
  3683. }
  3684. } else {
  3685. if ((error = dev_wlc_intvar_set(dev, "is_WPS_enrollee", FALSE))) {
  3686. WL_WSEC(("Failed to clear iovar is_WPS_enrollee\n"));
  3687. return error;
  3688. }
  3689. }
  3690. }
  3691. break;
  3692. }
  3693. #endif
  3694. case IW_AUTH_WAPI_ENABLED:
  3695. if ((error = dev_wlc_intvar_get(dev, "wsec", &val)))
  3696. return error;
  3697. if (paramval) {
  3698. val |= SMS4_ENABLED;
  3699. if ((error = dev_wlc_intvar_set(dev, "wsec", val))) {
  3700. WL_ERROR(("%s: setting wsec to 0x%0x returned error %d\n",
  3701. __FUNCTION__, val, error));
  3702. return error;
  3703. }
  3704. if ((error = dev_wlc_intvar_set(dev, "wpa_auth", WPA_AUTH_WAPI))) {
  3705. WL_ERROR(("%s: setting wpa_auth(WPA_AUTH_WAPI) returned %d\n",
  3706. __FUNCTION__, error));
  3707. return error;
  3708. }
  3709. }
  3710. break;
  3711. default:
  3712. break;
  3713. }
  3714. return 0;
  3715. }
  3716. #ifdef BCMWPA2
  3717. #define VAL_PSK(_val) (((_val) & WPA_AUTH_PSK) || ((_val) & WPA2_AUTH_PSK))
  3718. #else
  3719. #define VAL_PSK(_val) (((_val) & WPA_AUTH_PSK))
  3720. #endif
  3721. static int
  3722. wl_iw_get_wpaauth(
  3723. struct net_device *dev,
  3724. struct iw_request_info *info,
  3725. struct iw_param *vwrq,
  3726. char *extra
  3727. )
  3728. {
  3729. int error;
  3730. int paramid;
  3731. int paramval = 0;
  3732. int val;
  3733. wl_iw_t *iw = *(wl_iw_t **)netdev_priv(dev);
  3734. WL_TRACE(("%s: SIOCGIWAUTH\n", dev->name));
  3735. paramid = vwrq->flags & IW_AUTH_INDEX;
  3736. switch (paramid) {
  3737. case IW_AUTH_WPA_VERSION:
  3738. if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val)))
  3739. return error;
  3740. if (val & (WPA_AUTH_NONE | WPA_AUTH_DISABLED))
  3741. paramval = IW_AUTH_WPA_VERSION_DISABLED;
  3742. else if (val & (WPA_AUTH_PSK | WPA_AUTH_UNSPECIFIED))
  3743. paramval = IW_AUTH_WPA_VERSION_WPA;
  3744. #ifdef BCMWPA2
  3745. else if (val & (WPA2_AUTH_PSK | WPA2_AUTH_UNSPECIFIED))
  3746. paramval = IW_AUTH_WPA_VERSION_WPA2;
  3747. #endif
  3748. break;
  3749. case IW_AUTH_CIPHER_PAIRWISE:
  3750. case IW_AUTH_CIPHER_GROUP:
  3751. if (paramid == IW_AUTH_CIPHER_PAIRWISE)
  3752. val = iw->pwsec;
  3753. else
  3754. val = iw->gwsec;
  3755. paramval = 0;
  3756. if (val) {
  3757. if (val & WEP_ENABLED)
  3758. paramval |= (IW_AUTH_CIPHER_WEP40 | IW_AUTH_CIPHER_WEP104);
  3759. if (val & TKIP_ENABLED)
  3760. paramval |= (IW_AUTH_CIPHER_TKIP);
  3761. if (val & AES_ENABLED)
  3762. paramval |= (IW_AUTH_CIPHER_CCMP);
  3763. }
  3764. else
  3765. paramval = IW_AUTH_CIPHER_NONE;
  3766. break;
  3767. case IW_AUTH_KEY_MGMT:
  3768. if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val)))
  3769. return error;
  3770. if (VAL_PSK(val))
  3771. paramval = IW_AUTH_KEY_MGMT_PSK;
  3772. else
  3773. paramval = IW_AUTH_KEY_MGMT_802_1X;
  3774. break;
  3775. case IW_AUTH_TKIP_COUNTERMEASURES:
  3776. dev_wlc_bufvar_get(dev, "tkip_countermeasures", (char *)&paramval, 1);
  3777. break;
  3778. case IW_AUTH_DROP_UNENCRYPTED:
  3779. dev_wlc_bufvar_get(dev, "wsec_restrict", (char *)&paramval, 1);
  3780. break;
  3781. case IW_AUTH_RX_UNENCRYPTED_EAPOL:
  3782. dev_wlc_bufvar_get(dev, "rx_unencrypted_eapol", (char *)&paramval, 1);
  3783. break;
  3784. case IW_AUTH_80211_AUTH_ALG:
  3785. if ((error = dev_wlc_intvar_get(dev, "auth", &val)))
  3786. return error;
  3787. if (!val)
  3788. paramval = IW_AUTH_ALG_OPEN_SYSTEM;
  3789. else
  3790. paramval = IW_AUTH_ALG_SHARED_KEY;
  3791. break;
  3792. case IW_AUTH_WPA_ENABLED:
  3793. if ((error = dev_wlc_intvar_get(dev, "wpa_auth", &val)))
  3794. return error;
  3795. if (val)
  3796. paramval = TRUE;
  3797. else
  3798. paramval = FALSE;
  3799. break;
  3800. #if WIRELESS_EXT > 17
  3801. case IW_AUTH_ROAMING_CONTROL:
  3802. WL_ERROR(("%s: IW_AUTH_ROAMING_CONTROL\n", __FUNCTION__));
  3803. break;
  3804. case IW_AUTH_PRIVACY_INVOKED:
  3805. paramval = iw->privacy_invoked;
  3806. break;
  3807. #endif
  3808. }
  3809. vwrq->value = paramval;
  3810. return 0;
  3811. }
  3812. #endif
  3813. #ifdef SOFTAP
  3814. static int ap_macmode = MACLIST_MODE_DISABLED;
  3815. static struct mflist ap_black_list;
  3816. static int
  3817. wl_iw_parse_wep(char *keystr, wl_wsec_key_t *key)
  3818. {
  3819. char hex[] = "XX";
  3820. unsigned char *data = key->data;
  3821. switch (strlen(keystr)) {
  3822. case 5:
  3823. case 13:
  3824. case 16:
  3825. key->len = strlen(keystr);
  3826. memcpy(data, keystr, key->len + 1);
  3827. break;
  3828. case 12:
  3829. case 28:
  3830. case 34:
  3831. case 66:
  3832. if (!strnicmp(keystr, "0x", 2))
  3833. keystr += 2;
  3834. else
  3835. return -1;
  3836. case 10:
  3837. case 26:
  3838. case 32:
  3839. case 64:
  3840. key->len = strlen(keystr) / 2;
  3841. while (*keystr) {
  3842. strncpy(hex, keystr, 2);
  3843. *data++ = (char) bcm_strtoul(hex, NULL, 16);
  3844. keystr += 2;
  3845. }
  3846. break;
  3847. default:
  3848. return -1;
  3849. }
  3850. switch (key->len) {
  3851. case 5:
  3852. key->algo = CRYPTO_ALGO_WEP1;
  3853. break;
  3854. case 13:
  3855. key->algo = CRYPTO_ALGO_WEP128;
  3856. break;
  3857. case 16:
  3858. key->algo = CRYPTO_ALGO_AES_CCM;
  3859. break;
  3860. case 32:
  3861. key->algo = CRYPTO_ALGO_TKIP;
  3862. break;
  3863. default:
  3864. return -1;
  3865. }
  3866. key->flags |= WL_PRIMARY_KEY;
  3867. return 0;
  3868. }
  3869. #ifdef EXT_WPA_CRYPTO
  3870. #define SHA1HashSize 20
  3871. extern void pbkdf2_sha1(const char *passphrase, const char *ssid, size_t ssid_len, \
  3872. int iterations, u8 *buf, size_t buflen);
  3873. #else
  3874. #define SHA1HashSize 20
  3875. int pbkdf2_sha1(const char *passphrase, const char *ssid, size_t ssid_len, \
  3876. int iterations, u8 *buf, size_t buflen)
  3877. {
  3878. WL_ERROR(("WARNING: %s is not implemented !!!\n", __FUNCTION__));
  3879. return -1;
  3880. }
  3881. #endif
  3882. int dev_iw_write_cfg1_bss_var(struct net_device *dev, int val)
  3883. {
  3884. struct {
  3885. int cfg;
  3886. int val;
  3887. } bss_setbuf;
  3888. int bss_set_res;
  3889. char smbuf[WLC_IOCTL_SMLEN];
  3890. memset(smbuf, 0, sizeof(smbuf));
  3891. bss_setbuf.cfg = 1;
  3892. bss_setbuf.val = val;
  3893. bss_set_res = dev_iw_iovar_setbuf(dev, "bss",
  3894. &bss_setbuf, sizeof(bss_setbuf), smbuf, sizeof(smbuf));
  3895. WL_TRACE(("%s: bss_set_result:%d set with %d\n", __FUNCTION__, bss_set_res, val));
  3896. return bss_set_res;
  3897. }
  3898. int dev_iw_read_cfg1_bss_var(struct net_device *dev, int *val)
  3899. {
  3900. int bsscfg_idx = 1;
  3901. int bss_set_res;
  3902. char smbuf[WLC_IOCTL_SMLEN];
  3903. memset(smbuf, 0, sizeof(smbuf));
  3904. bss_set_res = dev_iw_iovar_getbuf(dev, "bss", \
  3905. &bsscfg_idx, sizeof(bsscfg_idx), smbuf, sizeof(smbuf));
  3906. *val = *(int*)smbuf;
  3907. *val = dtoh32(*val);
  3908. WL_TRACE(("%s: status=%d bss_get_result=%d\n", __FUNCTION__, bss_set_res, *val));
  3909. return bss_set_res;
  3910. }
  3911. #ifndef AP_ONLY
  3912. static int wl_bssiovar_mkbuf(
  3913. const char *iovar,
  3914. int bssidx,
  3915. void *param,
  3916. int paramlen,
  3917. void *bufptr,
  3918. int buflen,
  3919. int *perr)
  3920. {
  3921. const char *prefix = "bsscfg:";
  3922. int8* p;
  3923. uint prefixlen;
  3924. uint namelen;
  3925. uint iolen;
  3926. prefixlen = strlen(prefix);
  3927. namelen = strlen(iovar) + 1;
  3928. iolen = prefixlen + namelen + sizeof(int) + paramlen;
  3929. if (buflen < 0 || iolen > (uint)buflen) {
  3930. *perr = BCME_BUFTOOSHORT;
  3931. return 0;
  3932. }
  3933. p = (int8*)bufptr;
  3934. memcpy(p, prefix, prefixlen);
  3935. p += prefixlen;
  3936. memcpy(p, iovar, namelen);
  3937. p += namelen;
  3938. bssidx = htod32(bssidx);
  3939. memcpy(p, &bssidx, sizeof(int32));
  3940. p += sizeof(int32);
  3941. if (paramlen)
  3942. memcpy(p, param, paramlen);
  3943. *perr = 0;
  3944. return iolen;
  3945. }
  3946. #endif
  3947. int get_user_params(char *user_params, struct iw_point *dwrq)
  3948. {
  3949. int ret = 0;
  3950. if (copy_from_user(user_params, dwrq->pointer, dwrq->length)) {
  3951. WL_ERROR(("\n%s: no user params: uptr:%p, ulen:%d\n",
  3952. __FUNCTION__, dwrq->pointer, dwrq->length));
  3953. return -EFAULT;
  3954. }
  3955. WL_TRACE(("\n%s: iwpriv user params:%s\n", __FUNCTION__, user_params));
  3956. return ret;
  3957. }
  3958. #define strtoul(nptr, endptr, base) bcm_strtoul((nptr), (endptr), (base))
  3959. #if defined(CSCAN)
  3960. static int
  3961. wl_iw_combined_scan_set(struct net_device *dev, wlc_ssid_t* ssids_local, int nssid, int nchan)
  3962. {
  3963. int params_size = WL_SCAN_PARAMS_FIXED_SIZE + WL_NUMCHANNELS * sizeof(uint16);
  3964. int err = 0;
  3965. char *p;
  3966. int i;
  3967. iscan_info_t *iscan = g_iscan;
  3968. WL_ERROR(("%s nssid=%d nchan=%d\n", __FUNCTION__, nssid, nchan));
  3969. if ((!dev) && (!g_iscan) && (!iscan->iscan_ex_params_p)) {
  3970. WL_ERROR(("%s error exit\n", __FUNCTION__));
  3971. err = -1;
  3972. }
  3973. params_size += WL_SCAN_PARAMS_SSID_MAX * sizeof(wlc_ssid_t);
  3974. if (nssid > 0) {
  3975. i = OFFSETOF(wl_scan_params_t, channel_list) + nchan * sizeof(uint16);
  3976. i = ROUNDUP(i, sizeof(uint32));
  3977. if (i + nssid * sizeof(wlc_ssid_t) > params_size) {
  3978. printf("additional ssids exceed params_size\n");
  3979. err = -1;
  3980. goto exit;
  3981. }
  3982. p = ((char*)&iscan->iscan_ex_params_p->params) + i;
  3983. memcpy(p, ssids_local, nssid * sizeof(wlc_ssid_t));
  3984. p += nssid * sizeof(wlc_ssid_t);
  3985. } else {
  3986. p = (char*)iscan->iscan_ex_params_p->params.channel_list + nchan * sizeof(uint16);
  3987. }
  3988. iscan->iscan_ex_params_p->params.channel_num = \
  3989. htod32((nssid << WL_SCAN_PARAMS_NSSID_SHIFT) | \
  3990. (nchan & WL_SCAN_PARAMS_COUNT_MASK));
  3991. nssid = \
  3992. (uint)((iscan->iscan_ex_params_p->params.channel_num >> WL_SCAN_PARAMS_NSSID_SHIFT) & \
  3993. WL_SCAN_PARAMS_COUNT_MASK);
  3994. params_size = (int) (p - (char*)iscan->iscan_ex_params_p + nssid * sizeof(wlc_ssid_t));
  3995. iscan->iscan_ex_param_size = params_size;
  3996. iscan->list_cur = iscan->list_hdr;
  3997. iscan->iscan_state = ISCAN_STATE_SCANING;
  3998. wl_iw_set_event_mask(dev);
  3999. mod_timer(&iscan->timer, jiffies + iscan->timer_ms*HZ/1000);
  4000. iscan->timer_on = 1;
  4001. #ifdef SCAN_DUMP
  4002. {
  4003. int i;
  4004. WL_SCAN(("\n### List of SSIDs to scan ###\n"));
  4005. for (i = 0; i < nssid; i++) {
  4006. if (!ssids_local[i].SSID_len)
  4007. WL_SCAN(("%d: Broadcast scan\n", i));
  4008. else
  4009. WL_SCAN(("%d: scan for %s size =%d\n", i, \
  4010. ssids_local[i].SSID, ssids_local[i].SSID_len));
  4011. }
  4012. WL_SCAN(("### List of channels to scan ###\n"));
  4013. for (i = 0; i < nchan; i++)
  4014. {
  4015. WL_SCAN(("%d ", iscan->iscan_ex_params_p->params.channel_list[i]));
  4016. }
  4017. WL_SCAN(("\nnprobes=%d\n", iscan->iscan_ex_params_p->params.nprobes));
  4018. WL_SCAN(("active_time=%d\n", iscan->iscan_ex_params_p->params.active_time));
  4019. WL_SCAN(("passive_time=%d\n", iscan->iscan_ex_params_p->params.passive_time));
  4020. WL_SCAN(("home_time=%d\n", iscan->iscan_ex_params_p->params.home_time));
  4021. WL_SCAN(("scan_type=%d\n", iscan->iscan_ex_params_p->params.scan_type));
  4022. WL_SCAN(("\n###################\n"));
  4023. }
  4024. #endif
  4025. if (params_size > WLC_IOCTL_MEDLEN) {
  4026. WL_ERROR(("Set ISCAN for %s due to params_size=%d \n", \
  4027. __FUNCTION__, params_size));
  4028. err = -1;
  4029. }
  4030. if ((err = dev_iw_iovar_setbuf(dev, "iscan", iscan->iscan_ex_params_p, \
  4031. iscan->iscan_ex_param_size, \
  4032. iscan->ioctlbuf, sizeof(iscan->ioctlbuf)))) {
  4033. WL_TRACE(("Set ISCAN for %s failed with %d\n", __FUNCTION__, err));
  4034. err = -1;
  4035. }
  4036. exit:
  4037. return err;
  4038. }
  4039. static int iwpriv_set_cscan(struct net_device *dev, struct iw_request_info *info, \
  4040. union iwreq_data *wrqu, char *ext)
  4041. {
  4042. int res = 0;
  4043. char *extra = NULL;
  4044. iscan_info_t *iscan = g_iscan;
  4045. wlc_ssid_t ssids_local[WL_SCAN_PARAMS_SSID_MAX];
  4046. int nssid = 0;
  4047. int nchan = 0;
  4048. WL_TRACE(("\%s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n",
  4049. __FUNCTION__, info->cmd, info->flags,
  4050. wrqu->data.pointer, wrqu->data.length));
  4051. if (g_onoff == G_WLAN_SET_OFF) {
  4052. WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__));
  4053. return -1;
  4054. }
  4055. if (wrqu->data.length != 0) {
  4056. char *str_ptr;
  4057. if (!iscan->iscan_ex_params_p) {
  4058. return -EFAULT;
  4059. }
  4060. if (!(extra = kmalloc(wrqu->data.length+1, GFP_KERNEL)))
  4061. return -ENOMEM;
  4062. if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) {
  4063. kfree(extra);
  4064. return -EFAULT;
  4065. }
  4066. extra[wrqu->data.length] = 0;
  4067. WL_ERROR(("Got str param in iw_point:\n %s\n", extra));
  4068. str_ptr = extra;
  4069. if (strncmp(str_ptr, GET_SSID, strlen(GET_SSID))) {
  4070. WL_ERROR(("%s Error: extracting SSID='' string\n", __FUNCTION__));
  4071. goto exit_proc;
  4072. }
  4073. str_ptr += strlen(GET_SSID);
  4074. nssid = wl_iw_parse_ssid_list(&str_ptr, ssids_local, nssid, \
  4075. WL_SCAN_PARAMS_SSID_MAX);
  4076. if (nssid == -1) {
  4077. WL_ERROR(("%s wrong ssid list", __FUNCTION__));
  4078. return -1;
  4079. }
  4080. memset(iscan->iscan_ex_params_p, 0, iscan->iscan_ex_param_size);
  4081. ASSERT(iscan->iscan_ex_param_size < WLC_IOCTL_MAXLEN);
  4082. wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, NULL);
  4083. iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION);
  4084. iscan->iscan_ex_params_p->action = htod16(WL_SCAN_ACTION_START);
  4085. iscan->iscan_ex_params_p->scan_duration = htod16(0);
  4086. if ((nchan = wl_iw_parse_channel_list(&str_ptr, \
  4087. &iscan->iscan_ex_params_p->params.channel_list[0], \
  4088. WL_NUMCHANNELS)) == -1) {
  4089. WL_ERROR(("%s missing channel list\n", __FUNCTION__));
  4090. return -1;
  4091. }
  4092. get_parmeter_from_string(&str_ptr, \
  4093. GET_NPROBE, PTYPE_INTDEC, \
  4094. &iscan->iscan_ex_params_p->params.nprobes, 2);
  4095. get_parmeter_from_string(&str_ptr, GET_ACTIVE_ASSOC_DWELL, PTYPE_INTDEC, \
  4096. &iscan->iscan_ex_params_p->params.active_time, 4);
  4097. get_parmeter_from_string(&str_ptr, GET_PASSIVE_ASSOC_DWELL, PTYPE_INTDEC, \
  4098. &iscan->iscan_ex_params_p->params.passive_time, 4);
  4099. get_parmeter_from_string(&str_ptr, GET_HOME_DWELL, PTYPE_INTDEC, \
  4100. &iscan->iscan_ex_params_p->params.home_time, 4);
  4101. get_parmeter_from_string(&str_ptr, GET_SCAN_TYPE, PTYPE_INTDEC, \
  4102. &iscan->iscan_ex_params_p->params.scan_type, 1);
  4103. res = wl_iw_combined_scan_set(dev, ssids_local, nssid, nchan);
  4104. } else {
  4105. WL_ERROR(("IWPRIV argument len = 0 \n"));
  4106. return -1;
  4107. }
  4108. exit_proc:
  4109. kfree(extra);
  4110. return res;
  4111. }
  4112. static int
  4113. wl_iw_set_cscan(
  4114. struct net_device *dev,
  4115. struct iw_request_info *info,
  4116. union iwreq_data *wrqu,
  4117. char *extra
  4118. )
  4119. {
  4120. int res = -1;
  4121. iscan_info_t *iscan = g_iscan;
  4122. wlc_ssid_t ssids_local[WL_SCAN_PARAMS_SSID_MAX];
  4123. int nssid = 0;
  4124. int nchan = 0;
  4125. cscan_tlv_t *cscan_tlv_temp;
  4126. char type;
  4127. char *str_ptr;
  4128. int tlv_size_left;
  4129. #ifdef TLV_DEBUG
  4130. int i;
  4131. char tlv_in_example[] = { 'C', 'S', 'C', 'A', 'N', ' ', \
  4132. 0x53, 0x01, 0x00, 0x00,
  4133. 'S',
  4134. 0x00,
  4135. 'S',
  4136. 0x04,
  4137. 'B', 'R', 'C', 'M',
  4138. 'C',
  4139. 0x06,
  4140. 'P',
  4141. 0x94,
  4142. 0x11,
  4143. 'T',
  4144. 0x01
  4145. };
  4146. #endif
  4147. WL_TRACE(("\n### %s: info->cmd:%x, info->flags:%x, u.data=0x%p, u.len=%d\n",
  4148. __FUNCTION__, info->cmd, info->flags,
  4149. wrqu->data.pointer, wrqu->data.length));
  4150. if (g_onoff == G_WLAN_SET_OFF) {
  4151. WL_TRACE(("%s: driver is not up yet after START\n", __FUNCTION__));
  4152. return -1;
  4153. }
  4154. if (wrqu->data.length < (strlen(CSCAN_COMMAND) + sizeof(cscan_tlv_t))) {
  4155. WL_ERROR(("%s aggument=%d less %d\n", __FUNCTION__, \
  4156. wrqu->data.length, strlen(CSCAN_COMMAND) + sizeof(cscan_tlv_t)));
  4157. return -1;
  4158. }
  4159. #ifdef TLV_DEBUG
  4160. memcpy(extra, tlv_in_example, sizeof(tlv_in_example));
  4161. wrqu->data.length = sizeof(tlv_in_example);
  4162. for (i = 0; i < wrqu->data.length; i++)
  4163. printf("%02X ", extra[i]);
  4164. printf("\n");
  4165. #endif
  4166. str_ptr = extra;
  4167. str_ptr += strlen(CSCAN_COMMAND);
  4168. tlv_size_left = wrqu->data.length - strlen(CSCAN_COMMAND);
  4169. cscan_tlv_temp = (cscan_tlv_t *)str_ptr;
  4170. memset(ssids_local, 0, sizeof(ssids_local));
  4171. if ((cscan_tlv_temp->prefix == CSCAN_TLV_PREFIX) && \
  4172. (cscan_tlv_temp->version == CSCAN_TLV_VERSION) && \
  4173. (cscan_tlv_temp->subver == CSCAN_TLV_SUBVERSION))
  4174. {
  4175. str_ptr += sizeof(cscan_tlv_t);
  4176. tlv_size_left -= sizeof(cscan_tlv_t);
  4177. if ((nssid = wl_iw_parse_ssid_list_tlv(&str_ptr, ssids_local, \
  4178. WL_SCAN_PARAMS_SSID_MAX, &tlv_size_left)) <= 0) {
  4179. WL_ERROR(("SSID is not presented or corrupted ret=%d\n", nssid));
  4180. goto exit_proc;
  4181. }
  4182. else {
  4183. memset(iscan->iscan_ex_params_p, 0, iscan->iscan_ex_param_size);
  4184. wl_iw_iscan_prep(&iscan->iscan_ex_params_p->params, NULL);
  4185. iscan->iscan_ex_params_p->version = htod32(ISCAN_REQ_VERSION);
  4186. iscan->iscan_ex_params_p->action = htod16(WL_SCAN_ACTION_START);
  4187. iscan->iscan_ex_params_p->scan_duration = htod16(0);
  4188. while (tlv_size_left > 0)
  4189. {
  4190. type = str_ptr[0];
  4191. switch (type) {
  4192. case CSCAN_TLV_TYPE_CHANNEL_IE:
  4193. if ((nchan = wl_iw_parse_channel_list_tlv(&str_ptr, \
  4194. &iscan->iscan_ex_params_p->params.channel_list[0], \
  4195. WL_NUMCHANNELS, &tlv_size_left)) == -1) {
  4196. WL_ERROR(("%s missing channel list\n", \
  4197. __FUNCTION__));
  4198. goto exit_proc;
  4199. }
  4200. break;
  4201. case CSCAN_TLV_TYPE_NPROBE_IE:
  4202. if ((res = wl_iw_parse_data_tlv(&str_ptr, \
  4203. &iscan->iscan_ex_params_p->params.nprobes, \
  4204. sizeof(iscan->iscan_ex_params_p->params.nprobes), \
  4205. type, sizeof(char), &tlv_size_left)) == -1) {
  4206. WL_ERROR(("%s return %d\n", \
  4207. __FUNCTION__, res));
  4208. goto exit_proc;
  4209. }
  4210. break;
  4211. case CSCAN_TLV_TYPE_ACTIVE_IE:
  4212. if ((res = wl_iw_parse_data_tlv(&str_ptr, \
  4213. &iscan->iscan_ex_params_p->params.active_time, \
  4214. sizeof(iscan->iscan_ex_params_p->params.active_time), \
  4215. type, sizeof(short), &tlv_size_left)) == -1) {
  4216. WL_ERROR(("%s return %d\n", \
  4217. __FUNCTION__, res));
  4218. goto exit_proc;
  4219. }
  4220. break;
  4221. case CSCAN_TLV_TYPE_PASSIVE_IE:
  4222. if ((res = wl_iw_parse_data_tlv(&str_ptr, \
  4223. &iscan->iscan_ex_params_p->params.passive_time, \
  4224. sizeof(iscan->iscan_ex_params_p->params.passive_time), \
  4225. type, sizeof(short), &tlv_size_left)) == -1) {
  4226. WL_ERROR(("%s return %d\n", \
  4227. __FUNCTION__, res));
  4228. goto exit_proc;
  4229. }
  4230. break;
  4231. case CSCAN_TLV_TYPE_HOME_IE:
  4232. if ((res = wl_iw_parse_data_tlv(&str_ptr, \
  4233. &iscan->iscan_ex_params_p->params.home_time, \
  4234. sizeof(iscan->iscan_ex_params_p->params.home_time), \
  4235. type, sizeof(short), &tlv_size_left)) == -1) {
  4236. WL_ERROR(("%s return %d\n", \
  4237. __FUNCTION__, res));
  4238. goto exit_proc;
  4239. }
  4240. break;
  4241. case CSCAN_TLV_TYPE_STYPE_IE:
  4242. if ((res = wl_iw_parse_data_tlv(&str_ptr, \
  4243. &iscan->iscan_ex_params_p->params.scan_type, \
  4244. sizeof(iscan->iscan_ex_params_p->params.scan_type), \
  4245. type, sizeof(char), &tlv_size_left)) == -1) {
  4246. WL_ERROR(("%s return %d\n", \
  4247. __FUNCTION__, res));
  4248. goto exit_proc;
  4249. }
  4250. break;
  4251. default :
  4252. WL_ERROR(("%s get unkwown type %X\n", \
  4253. __FUNCTION__, type));
  4254. goto exit_proc;
  4255. break;
  4256. }
  4257. }
  4258. }
  4259. }
  4260. else {
  4261. WL_ERROR(("%s get wrong TLV command\n", __FUNCTION__));
  4262. goto exit_proc;
  4263. }
  4264. res = wl_iw_combined_scan_set(dev, ssids_local, nssid, nchan);
  4265. exit_proc:
  4266. return res;
  4267. }
  4268. #endif
  4269. #ifdef SOFTAP
  4270. #ifndef AP_ONLY
  4271. static int thr_wait_for_2nd_eth_dev(void *data)
  4272. {
  4273. int ret = 0;
  4274. DAEMONIZE("wl0_eth_wthread");
  4275. WL_TRACE(("\n>%s threda started:, PID:%x\n", __FUNCTION__, current->pid));
  4276. if (down_timeout(&ap_eth_sema, msecs_to_jiffies(5000)) != 0) {
  4277. WL_ERROR(("\n%s: sap_eth_sema timeout \n", __FUNCTION__));
  4278. ret = -1;
  4279. goto fail;
  4280. }
  4281. if (!ap_net_dev) {
  4282. WL_ERROR((" ap_net_dev is null !!!"));
  4283. ret = -1;
  4284. goto fail;
  4285. }
  4286. WL_TRACE(("\n>%s: Thread:'softap ethdev IF:%s is detected !!!'\n\n",
  4287. __FUNCTION__, ap_net_dev->name));
  4288. ap_cfg_running = TRUE;
  4289. bcm_mdelay(500);
  4290. wl_iw_send_priv_event(priv_dev, "AP_SET_CFG_OK");
  4291. fail:
  4292. WL_TRACE(("\n>%s, thread completed\n", __FUNCTION__));
  4293. return ret;
  4294. }
  4295. #endif
  4296. #ifndef AP_ONLY
  4297. static int last_auto_channel = 6;
  4298. #endif
  4299. static int get_softap_auto_channel(struct net_device *dev, struct ap_profile *ap)
  4300. {
  4301. int chosen = 0;
  4302. wl_uint32_list_t request;
  4303. int rescan = 0;
  4304. int retry = 0;
  4305. int updown = 0;
  4306. int ret = 0;
  4307. wlc_ssid_t null_ssid;
  4308. int res = 0;
  4309. #ifndef AP_ONLY
  4310. int iolen = 0;
  4311. int mkvar_err = 0;
  4312. int bsscfg_index = 1;
  4313. char buf[WLC_IOCTL_SMLEN];
  4314. #endif
  4315. WL_SOFTAP(("Enter %s\n", __FUNCTION__));
  4316. #ifndef AP_ONLY
  4317. if (ap_cfg_running) {
  4318. ap->channel = last_auto_channel;
  4319. return res;
  4320. }
  4321. #endif
  4322. memset(&null_ssid, 0, sizeof(wlc_ssid_t));
  4323. res |= dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown));
  4324. #ifdef AP_ONLY
  4325. res |= dev_wlc_ioctl(dev, WLC_SET_SSID, &null_ssid, sizeof(null_ssid));
  4326. #else
  4327. iolen = wl_bssiovar_mkbuf("ssid", bsscfg_index, (char *)(&null_ssid), \
  4328. null_ssid.SSID_len+4, buf, sizeof(buf), &mkvar_err);
  4329. ASSERT(iolen);
  4330. res |= dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen);
  4331. #endif
  4332. auto_channel_retry:
  4333. request.count = htod32(0);
  4334. ret = dev_wlc_ioctl(dev, WLC_START_CHANNEL_SEL, &request, sizeof(request));
  4335. if (ret < 0) {
  4336. WL_ERROR(("can't start auto channel scan\n"));
  4337. goto fail;
  4338. }
  4339. get_channel_retry:
  4340. bcm_mdelay(500);
  4341. ret = dev_wlc_ioctl(dev, WLC_GET_CHANNEL_SEL, &chosen, sizeof(chosen));
  4342. if (ret < 0 || dtoh32(chosen) == 0) {
  4343. if (retry++ < 3)
  4344. goto get_channel_retry;
  4345. else {
  4346. WL_ERROR(("can't get auto channel sel, err = %d, \
  4347. chosen = %d\n", ret, chosen));
  4348. goto fail;
  4349. }
  4350. }
  4351. if ((chosen == 1) && (!rescan++))
  4352. goto auto_channel_retry;
  4353. WL_SOFTAP(("Set auto channel = %d\n", chosen));
  4354. ap->channel = chosen;
  4355. if ((res = dev_wlc_ioctl(dev, WLC_DOWN, &updown, sizeof(updown))) < 0) {
  4356. WL_ERROR(("%s fail to set up err =%d\n", __FUNCTION__, res));
  4357. goto fail;
  4358. }
  4359. #ifndef AP_ONLY
  4360. if (!res)
  4361. last_auto_channel = ap->channel;
  4362. #endif
  4363. fail :
  4364. return res;
  4365. }
  4366. static int set_ap_cfg(struct net_device *dev, struct ap_profile *ap)
  4367. {
  4368. int updown = 0;
  4369. int channel = 0;
  4370. wlc_ssid_t ap_ssid;
  4371. int max_assoc = 8;
  4372. int res = 0;
  4373. int apsta_var = 0;
  4374. #ifndef AP_ONLY
  4375. int mpc = 0;
  4376. int iolen = 0;
  4377. int mkvar_err = 0;
  4378. int bsscfg_index = 1;
  4379. char buf[WLC_IOCTL_SMLEN];
  4380. #endif
  4381. wl_iw_t *iw;
  4382. if (!dev) {
  4383. WL_ERROR(("%s: dev is null\n", __FUNCTION__));
  4384. return -1;
  4385. }
  4386. WL_SOFTAP(("wl_iw: set ap profile:\n"));
  4387. WL_SOFTAP((" ssid = '%s'\n", ap->ssid));
  4388. WL_SOFTAP((" security = '%s'\n", ap->sec));
  4389. if (ap->key[0] != '\0')
  4390. WL_SOFTAP((" key = '%s'\n", ap->key));
  4391. WL_SOFTAP((" channel = %d\n", ap->channel));
  4392. WL_SOFTAP((" max scb = %d\n", ap->max_scb));
  4393. iw = *(wl_iw_t **)netdev_priv(dev);
  4394. MUTEX_LOCK_SOFTAP_SET(iw->pub);
  4395. WAKE_LOCK_INIT(iw->pub, WAKE_LOCK_SOFTAP_SET, "SoftAP_SET");
  4396. WAKE_LOCK(iw->pub, WAKE_LOCK_SOFTAP_SET);
  4397. #ifdef AP_ONLY
  4398. if (ap_cfg_running) {
  4399. wl_iw_softap_deassoc_stations(dev);
  4400. ap_cfg_running = FALSE;
  4401. }
  4402. #endif
  4403. if (ap_cfg_running == FALSE) {
  4404. #ifndef AP_ONLY
  4405. sema_init(&ap_eth_sema, 0);
  4406. mpc = 0;
  4407. if ((res = dev_wlc_intvar_set(dev, "mpc", mpc))) {
  4408. WL_ERROR(("%s fail to set mpc\n", __FUNCTION__));
  4409. goto fail;
  4410. }
  4411. #endif
  4412. updown = 0;
  4413. if ((res = dev_wlc_ioctl(dev, WLC_DOWN, &updown, sizeof(updown)))) {
  4414. WL_ERROR(("%s fail to set updown\n", __FUNCTION__));
  4415. goto fail;
  4416. }
  4417. #ifdef AP_ONLY
  4418. apsta_var = 0;
  4419. if ((res = dev_wlc_ioctl(dev, WLC_SET_AP, &apsta_var, sizeof(apsta_var)))) {
  4420. WL_ERROR(("%s fail to set apsta_var 0\n", __FUNCTION__));
  4421. goto fail;
  4422. }
  4423. apsta_var = 1;
  4424. if ((res = dev_wlc_ioctl(dev, WLC_SET_AP, &apsta_var, sizeof(apsta_var)))) {
  4425. WL_ERROR(("%s fail to set apsta_var 1\n", __FUNCTION__));
  4426. goto fail;
  4427. }
  4428. res = dev_wlc_ioctl(dev, WLC_GET_AP, &apsta_var, sizeof(apsta_var));
  4429. #else
  4430. apsta_var = 1;
  4431. iolen = wl_bssiovar_mkbuf("apsta",
  4432. bsscfg_index, &apsta_var, sizeof(apsta_var)+4,
  4433. buf, sizeof(buf), &mkvar_err);
  4434. ASSERT(iolen);
  4435. if ((res = dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen)) < 0) {
  4436. WL_ERROR(("%s fail to set apsta \n", __FUNCTION__));
  4437. goto fail;
  4438. }
  4439. WL_TRACE(("\n>in %s: apsta set result: %d \n", __FUNCTION__, res));
  4440. #endif
  4441. updown = 1;
  4442. if ((res = dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown))) < 0) {
  4443. WL_ERROR(("%s fail to set apsta \n", __FUNCTION__));
  4444. goto fail;
  4445. }
  4446. } else {
  4447. if (!ap_net_dev) {
  4448. WL_ERROR(("%s: ap_net_dev is null\n", __FUNCTION__));
  4449. goto fail;
  4450. }
  4451. res = wl_iw_softap_deassoc_stations(ap_net_dev);
  4452. if ((res = dev_iw_write_cfg1_bss_var(dev, 0)) < 0) {
  4453. WL_ERROR(("%s fail to set bss down\n", __FUNCTION__));
  4454. goto fail;
  4455. }
  4456. }
  4457. if ((ap->channel == 0) && (get_softap_auto_channel(dev, ap) < 0)) {
  4458. ap->channel = 1;
  4459. WL_ERROR(("%s auto channel failed, pick up channel=%d\n", \
  4460. __FUNCTION__, ap->channel));
  4461. }
  4462. channel = ap->channel;
  4463. if ((res = dev_wlc_ioctl(dev, WLC_SET_CHANNEL, &channel, sizeof(channel)))) {
  4464. WL_ERROR(("%s fail to set channel\n", __FUNCTION__));
  4465. goto fail;
  4466. }
  4467. if (ap_cfg_running == FALSE) {
  4468. updown = 0;
  4469. if ((res = dev_wlc_ioctl(dev, WLC_UP, &updown, sizeof(updown)))) {
  4470. WL_ERROR(("%s fail to set up\n", __FUNCTION__));
  4471. goto fail;
  4472. }
  4473. }
  4474. max_assoc = ap->max_scb;
  4475. if ((res = dev_wlc_intvar_set(dev, "maxassoc", max_assoc))) {
  4476. WL_ERROR(("%s fail to set maxassoc\n", __FUNCTION__));
  4477. goto fail;
  4478. }
  4479. ap_ssid.SSID_len = strlen(ap->ssid);
  4480. strncpy(ap_ssid.SSID, ap->ssid, ap_ssid.SSID_len);
  4481. #ifdef AP_ONLY
  4482. if ((res = wl_iw_set_ap_security(dev, &my_ap)) != 0) {
  4483. WL_ERROR(("ERROR:%d in:%s, wl_iw_set_ap_security is skipped\n", \
  4484. res, __FUNCTION__));
  4485. goto fail;
  4486. }
  4487. wl_iw_send_priv_event(dev, "ASCII_CMD=AP_BSS_START");
  4488. ap_cfg_running = TRUE;
  4489. #else
  4490. iolen = wl_bssiovar_mkbuf("ssid", bsscfg_index, (char *)(&ap_ssid),
  4491. ap_ssid.SSID_len+4, buf, sizeof(buf), &mkvar_err);
  4492. ASSERT(iolen);
  4493. if ((res = dev_wlc_ioctl(dev, WLC_SET_VAR, buf, iolen)) != 0) {
  4494. WL_ERROR(("ERROR:%d in:%s, Security & BSS reconfiguration is skipped\n", \
  4495. res, __FUNCTION__));
  4496. goto fail;
  4497. }
  4498. if (ap_cfg_running == FALSE) {
  4499. kernel_thread(thr_wait_for_2nd_eth_dev, 0, 0);
  4500. } else {
  4501. if (ap_net_dev == NULL) {
  4502. WL_ERROR(("%s ERROR: ap_net_dev is NULL !!!\n", __FUNCTION__));
  4503. goto fail;
  4504. }
  4505. WL_ERROR(("%s: %s Configure security & restart AP bss \n", \
  4506. __FUNCTION__, ap_net_dev->name));
  4507. if ((res = wl_iw_set_ap_security(ap_net_dev, &my_ap)) < 0) {
  4508. WL_ERROR(("%s fail to set security : %d\n", __FUNCTION__, res));
  4509. goto fail;
  4510. }
  4511. if ((res = dev_iw_write_cfg1_bss_var(dev, 1)) < 0) {
  4512. WL_ERROR(("%s fail to set bss up\n", __FUNCTION__));
  4513. goto fail;
  4514. }
  4515. }
  4516. #endif
  4517. fail:
  4518. WAKE_UNLOCK(iw->pub, WAKE_LOCK_SOFTAP_SET);
  4519. WAKE_LOCK_DESTROY(iw->pub, WAKE_LOCK_SOFTAP_SET);
  4520. MUTEX_UNLOCK_SOFTAP_SET(iw->pub);
  4521. WL_SOFTAP(("%s exit with %d\n", __FUNCTION__, res));
  4522. return res;
  4523. }
  4524. #endif
  4525. static int wl_iw_set_ap_security(struct net_device *dev, struct ap_profile *ap)
  4526. {
  4527. int wsec = 0;
  4528. int wpa_auth = 0;
  4529. int res = 0;
  4530. int i;
  4531. char *ptr;
  4532. #ifdef AP_ONLY
  4533. int mpc = 0;
  4534. wlc_ssid_t ap_ssid;
  4535. #endif
  4536. wl_wsec_key_t key;
  4537. WL_SOFTAP(("\nsetting SOFTAP security mode:\n"));
  4538. WL_SOFTAP(("wl_iw: set ap profile:\n"));
  4539. WL_SOFTAP((" ssid = '%s'\n", ap->ssid));
  4540. WL_SOFTAP((" security = '%s'\n", ap->sec));
  4541. if (ap->key[0] != '\0')
  4542. WL_SOFTAP((" key = '%s'\n", ap->key));
  4543. WL_SOFTAP((" channel = %d\n", ap->channel));
  4544. WL_SOFTAP((" max scb = %d\n", ap->max_scb));
  4545. if (strnicmp(ap->sec, "open", strlen("open")) == 0) {
  4546. wsec = 0;
  4547. res = dev_wlc_intvar_set(dev, "wsec", wsec);
  4548. wpa_auth = WPA_AUTH_DISABLED;
  4549. res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth);
  4550. WL_SOFTAP(("=====================\n"));
  4551. WL_SOFTAP((" wsec & wpa_auth set 'OPEN', result:&d %d\n", res));
  4552. WL_SOFTAP(("=====================\n"));
  4553. } else if (strnicmp(ap->sec, "wep", strlen("wep")) == 0) {
  4554. memset(&key, 0, sizeof(key));
  4555. wsec = WEP_ENABLED;
  4556. res = dev_wlc_intvar_set(dev, "wsec", wsec);
  4557. key.index = 0;
  4558. if (wl_iw_parse_wep(ap->key, &key)) {
  4559. WL_SOFTAP(("wep key parse err!\n"));
  4560. return -1;
  4561. }
  4562. key.index = htod32(key.index);
  4563. key.len = htod32(key.len);
  4564. key.algo = htod32(key.algo);
  4565. key.flags = htod32(key.flags);
  4566. res |= dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key));
  4567. wpa_auth = WPA_AUTH_DISABLED;
  4568. res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth);
  4569. WL_SOFTAP(("=====================\n"));
  4570. WL_SOFTAP((" wsec & auth set 'WEP', result:&d %d\n", res));
  4571. WL_SOFTAP(("=====================\n"));
  4572. } else if (strnicmp(ap->sec, "wpa2-psk", strlen("wpa2-psk")) == 0) {
  4573. wsec_pmk_t psk;
  4574. size_t key_len;
  4575. wsec = AES_ENABLED;
  4576. dev_wlc_intvar_set(dev, "wsec", wsec);
  4577. key_len = strlen(ap->key);
  4578. if (key_len < WSEC_MIN_PSK_LEN || key_len > WSEC_MAX_PSK_LEN) {
  4579. WL_SOFTAP(("passphrase must be between %d and %d characters long\n",
  4580. WSEC_MIN_PSK_LEN, WSEC_MAX_PSK_LEN));
  4581. return -1;
  4582. }
  4583. if (key_len < WSEC_MAX_PSK_LEN) {
  4584. unsigned char output[2*SHA1HashSize];
  4585. char key_str_buf[WSEC_MAX_PSK_LEN+1];
  4586. memset(output, 0, sizeof(output));
  4587. pbkdf2_sha1(ap->key, ap->ssid, strlen(ap->ssid), 4096, output, 32);
  4588. ptr = key_str_buf;
  4589. for (i = 0; i < (WSEC_MAX_PSK_LEN/8); i++) {
  4590. sprintf(ptr, "%02x%02x%02x%02x", (uint)output[i*4], \
  4591. (uint)output[i*4+1], (uint)output[i*4+2], \
  4592. (uint)output[i*4+3]);
  4593. ptr += 8;
  4594. }
  4595. WL_SOFTAP(("%s: passphase = %s\n", __FUNCTION__, key_str_buf));
  4596. psk.key_len = htod16((ushort)WSEC_MAX_PSK_LEN);
  4597. memcpy(psk.key, key_str_buf, psk.key_len);
  4598. } else {
  4599. psk.key_len = htod16((ushort) key_len);
  4600. memcpy(psk.key, ap->key, key_len);
  4601. }
  4602. psk.flags = htod16(WSEC_PASSPHRASE);
  4603. dev_wlc_ioctl(dev, WLC_SET_WSEC_PMK, &psk, sizeof(psk));
  4604. wpa_auth = WPA2_AUTH_PSK;
  4605. dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth);
  4606. } else if (strnicmp(ap->sec, "wpa-psk", strlen("wpa-psk")) == 0) {
  4607. wsec_pmk_t psk;
  4608. size_t key_len;
  4609. wsec = TKIP_ENABLED;
  4610. res = dev_wlc_intvar_set(dev, "wsec", wsec);
  4611. key_len = strlen(ap->key);
  4612. if (key_len < WSEC_MIN_PSK_LEN || key_len > WSEC_MAX_PSK_LEN) {
  4613. WL_SOFTAP(("passphrase must be between %d and %d characters long\n",
  4614. WSEC_MIN_PSK_LEN, WSEC_MAX_PSK_LEN));
  4615. return -1;
  4616. }
  4617. if (key_len < WSEC_MAX_PSK_LEN) {
  4618. unsigned char output[2*SHA1HashSize];
  4619. char key_str_buf[WSEC_MAX_PSK_LEN+1];
  4620. WL_SOFTAP(("%s: do passhash...\n", __FUNCTION__));
  4621. pbkdf2_sha1(ap->key, ap->ssid, strlen(ap->ssid), 4096, output, 32);
  4622. ptr = key_str_buf;
  4623. for (i = 0; i < (WSEC_MAX_PSK_LEN/8); i++) {
  4624. WL_SOFTAP(("[%02d]: %08x\n", i, *((unsigned int*)&output[i*4])));
  4625. sprintf(ptr, "%02x%02x%02x%02x", (uint)output[i*4], \
  4626. (uint)output[i*4+1], (uint)output[i*4+2], \
  4627. (uint)output[i*4+3]);
  4628. ptr += 8;
  4629. }
  4630. printk("%s: passphase = %s\n", __FUNCTION__, key_str_buf);
  4631. psk.key_len = htod16((ushort)WSEC_MAX_PSK_LEN);
  4632. memcpy(psk.key, key_str_buf, psk.key_len);
  4633. } else {
  4634. psk.key_len = htod16((ushort) key_len);
  4635. memcpy(psk.key, ap->key, key_len);
  4636. }
  4637. psk.flags = htod16(WSEC_PASSPHRASE);
  4638. res |= dev_wlc_ioctl(dev, WLC_SET_WSEC_PMK, &psk, sizeof(psk));
  4639. wpa_auth = WPA_AUTH_PSK;
  4640. res |= dev_wlc_intvar_set(dev, "wpa_auth", wpa_auth);
  4641. WL_SOFTAP((" wsec & auth set 'wpa-psk' (TKIP), result:&d %d\n", res));
  4642. }
  4643. #ifdef AP_ONLY
  4644. ap_ssid.SSID_len = strlen(ap->ssid);
  4645. strncpy(ap_ssid.SSID, ap->ssid, ap_ssid.SSID_len);
  4646. res |= dev_wlc_ioctl(dev, WLC_SET_SSID, &ap_ssid, sizeof(ap_ssid));
  4647. mpc = 0;
  4648. res |= dev_wlc_intvar_set(dev, "mpc", mpc);
  4649. if (strnicmp(ap->sec, "wep", strlen("wep")) == 0) {
  4650. res |= dev_wlc_ioctl(dev, WLC_SET_KEY, &key, sizeof(key));
  4651. }
  4652. #endif
  4653. return res;
  4654. }
  4655. int get_parmeter_from_string(
  4656. char **str_ptr, const char *token,
  4657. int param_type, void *dst, int param_max_len)
  4658. {
  4659. char int_str[7] = "0";
  4660. int parm_str_len;
  4661. char *param_str_begin;
  4662. char *param_str_end;
  4663. char *orig_str = *str_ptr;
  4664. if ((*str_ptr) && !strncmp(*str_ptr, token, strlen(token))) {
  4665. strsep(str_ptr, "=,");
  4666. param_str_begin = *str_ptr;
  4667. strsep(str_ptr, "=,");
  4668. if (*str_ptr == NULL) {
  4669. parm_str_len = strlen(param_str_begin);
  4670. } else {
  4671. param_str_end = *str_ptr-1;
  4672. parm_str_len = param_str_end - param_str_begin;
  4673. }
  4674. WL_TRACE((" 'token:%s', len:%d, ", token, parm_str_len));
  4675. if (parm_str_len > param_max_len) {
  4676. WL_ERROR((" WARNING: extracted param len:%d is > MAX:%d\n",
  4677. parm_str_len, param_max_len));
  4678. parm_str_len = param_max_len;
  4679. }
  4680. switch (param_type) {
  4681. case PTYPE_INTDEC: {
  4682. int *pdst_int = dst;
  4683. char *eptr;
  4684. if (parm_str_len > sizeof(int_str))
  4685. parm_str_len = sizeof(int_str);
  4686. memcpy(int_str, param_str_begin, parm_str_len);
  4687. *pdst_int = simple_strtoul(int_str, &eptr, 10);
  4688. WL_TRACE((" written as integer:%d\n", *pdst_int));
  4689. }
  4690. break;
  4691. case PTYPE_STR_HEX: {
  4692. u8 *buf = dst;
  4693. param_max_len = param_max_len >> 1;
  4694. hstr_2_buf(param_str_begin, buf, param_max_len);
  4695. print_buf(buf, param_max_len, 0);
  4696. }
  4697. break;
  4698. default:
  4699. memcpy(dst, param_str_begin, parm_str_len);
  4700. *((char *)dst + parm_str_len) = 0;
  4701. WL_ERROR((" written as a string:%s\n", (char *)dst));
  4702. break;
  4703. }
  4704. return 0;
  4705. } else {
  4706. WL_ERROR(("\n %s: ERROR: can't find token:%s in str:%s \n",
  4707. __FUNCTION__, token, orig_str));
  4708. return -1;
  4709. }
  4710. }
  4711. static int wl_iw_softap_deassoc_stations(struct net_device *dev)
  4712. {
  4713. int i;
  4714. int res = 0;
  4715. char mac_buf[128] = {0};
  4716. struct maclist *assoc_maclist = (struct maclist *) mac_buf;
  4717. memset(assoc_maclist, 0, sizeof(mac_buf));
  4718. assoc_maclist->count = 8;
  4719. res = dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, assoc_maclist, 128);
  4720. if (res != 0) {
  4721. WL_SOFTAP((" Error:%d in :%s, Couldn't get ASSOC List\n", res, __FUNCTION__));
  4722. return res;
  4723. }
  4724. if (assoc_maclist->count)
  4725. for (i = 0; i < assoc_maclist->count; i++) {
  4726. scb_val_t scbval;
  4727. scbval.val = htod32(1);
  4728. bcopy(&assoc_maclist->ea[i], &scbval.ea, ETHER_ADDR_LEN);
  4729. WL_SOFTAP(("deauth STA:%d \n", i));
  4730. res |= dev_wlc_ioctl(dev, WLC_SCB_DEAUTHENTICATE_FOR_REASON,
  4731. &scbval, sizeof(scb_val_t));
  4732. } else WL_SOFTAP((" STA ASSOC list is empty\n"));
  4733. if (res != 0)
  4734. WL_SOFTAP((" Error:%d in :%s\n", res, __FUNCTION__));
  4735. else if (assoc_maclist->count) {
  4736. bcm_mdelay(200);
  4737. }
  4738. return res;
  4739. }
  4740. static int iwpriv_softap_stop(struct net_device *dev,
  4741. struct iw_request_info *info,
  4742. union iwreq_data *wrqu,
  4743. char *ext)
  4744. {
  4745. int res = 0;
  4746. wl_iw_t *iw;
  4747. WL_SOFTAP(("got iwpriv AP_BSS_STOP \n"));
  4748. if ((!dev) && (!ap_net_dev)) {
  4749. WL_ERROR(("%s: dev is null\n", __FUNCTION__));
  4750. return res;
  4751. }
  4752. iw = *(wl_iw_t **)netdev_priv(dev);
  4753. MUTEX_LOCK_SOFTAP_SET(iw->pub);
  4754. WAKE_LOCK_INIT(iw->pub, WAKE_LOCK_SOFTAP_STOP, "SoftAP_STOP");
  4755. WAKE_LOCK(iw->pub, WAKE_LOCK_SOFTAP_STOP);
  4756. if ((ap_cfg_running == TRUE)) {
  4757. #ifdef AP_ONLY
  4758. wl_iw_softap_deassoc_stations(dev);
  4759. #else
  4760. wl_iw_softap_deassoc_stations(ap_net_dev);
  4761. if ((res = dev_iw_write_cfg1_bss_var(dev, 2)) < 0)
  4762. WL_ERROR(("%s failed to del BSS err = %d", __FUNCTION__, res));
  4763. #endif
  4764. bcm_mdelay(100);
  4765. wrqu->data.length = 0;
  4766. ap_cfg_running = FALSE;
  4767. }
  4768. else
  4769. WL_ERROR(("%s: was called when SoftAP is OFF : move on\n", __FUNCTION__));
  4770. WAKE_UNLOCK(iw->pub, WAKE_LOCK_SOFTAP_STOP);
  4771. WAKE_LOCK_DESTROY(iw->pub, WAKE_LOCK_SOFTAP_STOP);
  4772. MUTEX_UNLOCK_SOFTAP_SET(iw->pub);
  4773. WL_SOFTAP(("%s Done with %d\n", __FUNCTION__, res));
  4774. return res;
  4775. }
  4776. static int iwpriv_fw_reload(struct net_device *dev,
  4777. struct iw_request_info *info,
  4778. union iwreq_data *wrqu,
  4779. char *ext)
  4780. {
  4781. int ret = -1;
  4782. char extra[256];
  4783. char *fwstr = fw_path ;
  4784. WL_SOFTAP(("current firmware_path[]=%s\n", fwstr));
  4785. WL_TRACE((">Got FW_RELOAD cmd:"
  4786. "info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d, \
  4787. fw_path:%p, len:%d \n",
  4788. info->cmd, info->flags,
  4789. wrqu->data.pointer, wrqu->data.length, fwstr, strlen(fwstr)));
  4790. if ((wrqu->data.length > 4) && (wrqu->data.length < sizeof(extra))) {
  4791. char *str_ptr;
  4792. if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) {
  4793. ret = -EFAULT;
  4794. goto exit_proc;
  4795. }
  4796. extra[wrqu->data.length] = 8;
  4797. str_ptr = extra;
  4798. if (get_parmeter_from_string(&str_ptr, "FW_PATH=", PTYPE_STRING, fwstr, 255) != 0) {
  4799. WL_ERROR(("Error: extracting FW_PATH='' string\n"));
  4800. goto exit_proc;
  4801. }
  4802. if (strstr(fwstr, "apsta") != NULL) {
  4803. WL_SOFTAP(("GOT APSTA FIRMWARE\n"));
  4804. ap_fw_loaded = TRUE;
  4805. } else {
  4806. WL_SOFTAP(("GOT STA FIRMWARE\n"));
  4807. ap_fw_loaded = FALSE;
  4808. }
  4809. WL_SOFTAP(("SET firmware_path[]=%s , str_p:%p\n", fwstr, fwstr));
  4810. ret = 0;
  4811. } else {
  4812. WL_ERROR(("Error: ivalid param len:%d\n", wrqu->data.length));
  4813. }
  4814. exit_proc:
  4815. return ret;
  4816. }
  4817. #ifdef SOFTAP
  4818. static int iwpriv_wpasupp_loop_tst(struct net_device *dev,
  4819. struct iw_request_info *info,
  4820. union iwreq_data *wrqu,
  4821. char *ext)
  4822. {
  4823. int res = 0;
  4824. char *params = NULL;
  4825. WL_TRACE((">Got IWPRIV wp_supp loopback cmd test:"
  4826. "info->cmd:%x, info->flags:%x, u.data:%p, u.len:%d\n",
  4827. info->cmd, info->flags,
  4828. wrqu->data.pointer, wrqu->data.length));
  4829. if (wrqu->data.length != 0) {
  4830. if (!(params = kmalloc(wrqu->data.length+1, GFP_KERNEL)))
  4831. return -ENOMEM;
  4832. if (copy_from_user(params, wrqu->data.pointer, wrqu->data.length)) {
  4833. kfree(params);
  4834. return -EFAULT;
  4835. }
  4836. params[wrqu->data.length] = 0;
  4837. WL_SOFTAP(("\n>> copied from user:\n %s\n", params));
  4838. } else {
  4839. WL_ERROR(("ERROR param length is 0\n"));
  4840. return -EFAULT;
  4841. }
  4842. res = wl_iw_send_priv_event(dev, params);
  4843. kfree(params);
  4844. return res;
  4845. }
  4846. #endif
  4847. static int
  4848. iwpriv_en_ap_bss(
  4849. struct net_device *dev,
  4850. struct iw_request_info *info,
  4851. void *wrqu,
  4852. char *extra)
  4853. {
  4854. int res = 0;
  4855. wl_iw_t *iw;
  4856. if (!dev) {
  4857. WL_ERROR(("%s: dev is null\n", __FUNCTION__));
  4858. return -1;
  4859. }
  4860. WL_TRACE(("%s: rcvd IWPRIV IOCTL: for dev:%s\n", __FUNCTION__, dev->name));
  4861. iw = *(wl_iw_t **)netdev_priv(dev);
  4862. MUTEX_LOCK_SOFTAP_SET(iw->pub);
  4863. WAKE_LOCK_INIT(iw->pub, WAKE_LOCK_SOFTAP_START, "SoftAP_START");
  4864. WAKE_LOCK(iw->pub, WAKE_LOCK_SOFTAP_START);
  4865. #ifndef AP_ONLY
  4866. if ((res = wl_iw_set_ap_security(dev, &my_ap)) != 0) {
  4867. WL_ERROR((" %s ERROR setting SOFTAP security in :%d\n", __FUNCTION__, res));
  4868. }
  4869. else {
  4870. if ((res = dev_iw_write_cfg1_bss_var(dev, 1)) < 0)
  4871. WL_ERROR(("%s fail to set bss up err=%d\n", __FUNCTION__, res));
  4872. else
  4873. bcm_mdelay(100);
  4874. }
  4875. #endif
  4876. WL_SOFTAP(("%s done with res %d \n", __FUNCTION__, res));
  4877. WAKE_UNLOCK(iw->pub, WAKE_LOCK_SOFTAP_START);
  4878. WAKE_LOCK_DESTROY(iw->pub, WAKE_LOCK_SOFTAP_START);
  4879. MUTEX_UNLOCK_SOFTAP_SET(iw->pub);
  4880. return res;
  4881. }
  4882. static int
  4883. get_assoc_sta_list(struct net_device *dev, char *buf, int len)
  4884. {
  4885. WL_TRACE(("calling dev_wlc_ioctl(dev:%p, cmd:%d, buf:%p, len:%d)\n",
  4886. dev, WLC_GET_ASSOCLIST, buf, len));
  4887. dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, buf, len);
  4888. return 0;
  4889. }
  4890. static int
  4891. set_ap_mac_list(struct net_device *dev, char *buf)
  4892. {
  4893. struct mac_list_set *mac_list_set = (struct mac_list_set *)buf;
  4894. struct maclist *white_maclist = (struct maclist *)&mac_list_set->white_list;
  4895. struct maclist *black_maclist = (struct maclist *)&mac_list_set->black_list;
  4896. int mac_mode = mac_list_set->mode;
  4897. int length;
  4898. int i;
  4899. ap_macmode = mac_mode;
  4900. if (mac_mode == MACLIST_MODE_DISABLED) {
  4901. bzero(&ap_black_list, sizeof(struct mflist));
  4902. dev_wlc_ioctl(dev, WLC_SET_MACMODE, &mac_mode, sizeof(mac_mode));
  4903. } else {
  4904. scb_val_t scbval;
  4905. char mac_buf[256] = {0};
  4906. struct maclist *assoc_maclist = (struct maclist *) mac_buf;
  4907. mac_mode = MACLIST_MODE_ALLOW;
  4908. dev_wlc_ioctl(dev, WLC_SET_MACMODE, &mac_mode, sizeof(mac_mode));
  4909. length = sizeof(white_maclist->count)+white_maclist->count*ETHER_ADDR_LEN;
  4910. dev_wlc_ioctl(dev, WLC_SET_MACLIST, white_maclist, length);
  4911. WL_SOFTAP(("White List, length %d:\n", length));
  4912. for (i = 0; i < white_maclist->count; i++)
  4913. WL_SOFTAP(("mac %d: %02X:%02X:%02X:%02X:%02X:%02X\n",
  4914. i, white_maclist->ea[i].octet[0], white_maclist->ea[i].octet[1], \
  4915. white_maclist->ea[i].octet[2], \
  4916. white_maclist->ea[i].octet[3], white_maclist->ea[i].octet[4], \
  4917. white_maclist->ea[i].octet[5]));
  4918. bcopy(black_maclist, &ap_black_list, sizeof(ap_black_list));
  4919. WL_SOFTAP(("Black List, size %d:\n", sizeof(ap_black_list)));
  4920. for (i = 0; i < ap_black_list.count; i++)
  4921. WL_SOFTAP(("mac %d: %02X:%02X:%02X:%02X:%02X:%02X\n",
  4922. i, ap_black_list.ea[i].octet[0], ap_black_list.ea[i].octet[1], \
  4923. ap_black_list.ea[i].octet[2], \
  4924. ap_black_list.ea[i].octet[3], \
  4925. ap_black_list.ea[i].octet[4], ap_black_list.ea[i].octet[5]));
  4926. dev_wlc_ioctl(dev, WLC_GET_ASSOCLIST, assoc_maclist, 256);
  4927. if (assoc_maclist->count) {
  4928. int j;
  4929. for (i = 0; i < assoc_maclist->count; i++) {
  4930. for (j = 0; j < white_maclist->count; j++) {
  4931. if (!bcmp(&assoc_maclist->ea[i], &white_maclist->ea[j], \
  4932. ETHER_ADDR_LEN)) {
  4933. WL_SOFTAP(("match allow, let it be\n"));
  4934. break;
  4935. }
  4936. }
  4937. if (j == white_maclist->count) {
  4938. WL_SOFTAP(("match black, deauth it\n"));
  4939. scbval.val = htod32(1);
  4940. bcopy(&assoc_maclist->ea[i], &scbval.ea, \
  4941. ETHER_ADDR_LEN);
  4942. dev_wlc_ioctl(dev, \
  4943. WLC_SCB_DEAUTHENTICATE_FOR_REASON, &scbval,
  4944. sizeof(scb_val_t));
  4945. }
  4946. }
  4947. }
  4948. }
  4949. return 0;
  4950. }
  4951. #endif
  4952. #ifdef SOFTAP
  4953. int set_macfilt_from_string(struct mflist *pmflist, char **param_str)
  4954. {
  4955. return 0;
  4956. }
  4957. #endif
  4958. #ifdef SOFTAP
  4959. #define PARAM_OFFSET PROFILE_OFFSET
  4960. int wl_iw_process_private_ascii_cmd(
  4961. struct net_device *dev,
  4962. struct iw_request_info *info,
  4963. union iwreq_data *dwrq,
  4964. char *cmd_str)
  4965. {
  4966. int ret = 0;
  4967. char *sub_cmd = cmd_str + PROFILE_OFFSET + strlen("ASCII_CMD=");
  4968. WL_SOFTAP(("\n %s: ASCII_CMD: offs_0:%s, offset_32:\n'%s'\n",
  4969. __FUNCTION__, cmd_str, cmd_str + PROFILE_OFFSET));
  4970. if (strnicmp(sub_cmd, "AP_CFG", strlen("AP_CFG")) == 0) {
  4971. WL_SOFTAP((" AP_CFG \n"));
  4972. if (init_ap_profile_from_string(cmd_str+PROFILE_OFFSET, &my_ap) != 0) {
  4973. WL_ERROR(("ERROR: SoftAP CFG prams !\n"));
  4974. ret = -1;
  4975. } else {
  4976. ret = set_ap_cfg(dev, &my_ap);
  4977. }
  4978. } else if (strnicmp(sub_cmd, "AP_BSS_START", strlen("AP_BSS_START")) == 0) {
  4979. WL_SOFTAP(("\n SOFTAP - ENABLE BSS \n"));
  4980. WL_SOFTAP(("\n!!! got 'WL_AP_EN_BSS' from WPA supplicant, dev:%s\n", dev->name));
  4981. #ifndef AP_ONLY
  4982. if (ap_net_dev == NULL) {
  4983. printf("\n ERROR: SOFTAP net_dev* is NULL !!!\n");
  4984. } else {
  4985. if ((ret = iwpriv_en_ap_bss(ap_net_dev, info, dwrq, cmd_str)) < 0)
  4986. WL_ERROR(("%s line %d fail to set bss up\n", \
  4987. __FUNCTION__, __LINE__));
  4988. }
  4989. #else
  4990. if ((ret = iwpriv_en_ap_bss(dev, info, dwrq, cmd_str)) < 0)
  4991. WL_ERROR(("%s line %d fail to set bss up\n", \
  4992. __FUNCTION__, __LINE__));
  4993. #endif
  4994. } else if (strnicmp(sub_cmd, "ASSOC_LST", strlen("ASSOC_LST")) == 0) {
  4995. } else if (strnicmp(sub_cmd, "AP_BSS_STOP", strlen("AP_BSS_STOP")) == 0) {
  4996. WL_SOFTAP((" \n temp DOWN SOFTAP\n"));
  4997. #ifndef AP_ONLY
  4998. if ((ret = dev_iw_write_cfg1_bss_var(dev, 0)) < 0) {
  4999. WL_ERROR(("%s line %d fail to set bss down\n", \
  5000. __FUNCTION__, __LINE__));
  5001. }
  5002. #endif
  5003. }
  5004. return ret;
  5005. }
  5006. #endif
  5007. static int wl_iw_set_priv(
  5008. struct net_device *dev,
  5009. struct iw_request_info *info,
  5010. struct iw_point *dwrq,
  5011. char *ext
  5012. )
  5013. {
  5014. int ret = 0;
  5015. char * extra;
  5016. wl_iw_t *iw = *(wl_iw_t **)netdev_priv(dev);
  5017. if (!(extra = kmalloc(dwrq->length, GFP_KERNEL)))
  5018. return -ENOMEM;
  5019. if (copy_from_user(extra, dwrq->pointer, dwrq->length)) {
  5020. kfree(extra);
  5021. return -EFAULT;
  5022. }
  5023. WL_TRACE(("%s: SIOCSIWPRIV request %s, info->cmd:%x, info->flags:%d\n dwrq->length:%d\n",
  5024. dev->name, extra, info->cmd, info->flags, dwrq->length));
  5025. if (dwrq->length && extra) {
  5026. WAKE_LOCK_INIT(iw->pub, WAKE_LOCK_PRIV, "wl_iw_set_priv");
  5027. WAKE_LOCK(iw->pub, WAKE_LOCK_PRIV);
  5028. if (g_onoff == G_WLAN_SET_OFF) {
  5029. if (strnicmp(extra, "START", strlen("START")) != 0) {
  5030. WL_ERROR(("%s First IOCTL after stop is NOT START \n", \
  5031. __FUNCTION__));
  5032. WAKE_UNLOCK(iw->pub, WAKE_LOCK_PRIV);
  5033. WAKE_LOCK_DESTROY(iw->pub, WAKE_LOCK_PRIV);
  5034. kfree(extra);
  5035. return -EFAULT;
  5036. } else {
  5037. wl_iw_control_wl_on(dev, info);
  5038. WL_TRACE(("%s, Received regular START command\n", __FUNCTION__));
  5039. printk("\n####### %s, Received regular START command #######\n", __FUNCTION__);
  5040. }
  5041. }
  5042. if (strnicmp(extra, "SCAN-ACTIVE", strlen("SCAN-ACTIVE")) == 0) {
  5043. #ifdef ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS
  5044. WL_TRACE(("%s: active scan setting suppressed\n", dev->name));
  5045. #else
  5046. ret = wl_iw_set_active_scan(dev, info, (union iwreq_data *)dwrq, extra);
  5047. #endif
  5048. }
  5049. else if (strnicmp(extra, "SCAN-PASSIVE", strlen("SCAN-PASSIVE")) == 0)
  5050. #ifdef ENABLE_ACTIVE_PASSIVE_SCAN_SUPPRESS
  5051. WL_TRACE(("%s: passive scan setting suppressed\n", dev->name));
  5052. #else
  5053. ret = wl_iw_set_passive_scan(dev, info, (union iwreq_data *)dwrq, extra);
  5054. #endif
  5055. else if (strnicmp(extra, "RSSI", strlen("RSSI")) == 0)
  5056. ret = wl_iw_get_rssi(dev, info, (union iwreq_data *)dwrq, extra);
  5057. else if (strnicmp(extra, "LINKSPEED", strlen("LINKSPEED")) == 0)
  5058. ret = wl_iw_get_link_speed(dev, info, (union iwreq_data *)dwrq, extra);
  5059. else if (strnicmp(extra, "MACADDR", strlen("MACADDR")) == 0)
  5060. ret = wl_iw_get_macaddr(dev, info, (union iwreq_data *)dwrq, extra);
  5061. else if (strnicmp(extra, "COUNTRY", strlen("COUNTRY")) == 0)
  5062. ret = wl_iw_set_country(dev, info, (union iwreq_data *)dwrq, extra);
  5063. else if (strnicmp(extra, "STOP", strlen("STOP")) == 0)
  5064. {
  5065. printk("\n####### STOP ############");
  5066. ret = wl_iw_control_wl_off(dev, info);
  5067. }
  5068. else if (strnicmp(extra, BAND_GET_CMD, strlen(BAND_GET_CMD)) == 0)
  5069. ret = wl_iw_get_band(dev, info, (union iwreq_data *)dwrq, extra);
  5070. else if (strnicmp(extra, BAND_SET_CMD, strlen(BAND_SET_CMD)) == 0)
  5071. ret = wl_iw_set_band(dev, info, (union iwreq_data *)dwrq, extra);
  5072. #if defined(CSCAN)
  5073. else if (strnicmp(extra, CSCAN_COMMAND, strlen(CSCAN_COMMAND)) == 0)
  5074. ret = wl_iw_set_cscan(dev, info, (union iwreq_data *)dwrq, extra);
  5075. #endif
  5076. #ifdef CUSTOMER_HW2
  5077. else if (strnicmp(extra, "POWERMODE", strlen("POWERMODE")) == 0)
  5078. ret = wl_iw_set_power_mode(dev, info, (union iwreq_data *)dwrq, extra);
  5079. else if (strnicmp(extra, "BTCOEXMODE", strlen("BTCOEXMODE")) == 0)
  5080. ret = wl_iw_set_btcoex_dhcp(dev, info, (union iwreq_data *)dwrq, extra);
  5081. #else
  5082. else if (strnicmp(extra, "POWERMODE", strlen("POWERMODE")) == 0)
  5083. ret = wl_iw_set_btcoex_dhcp(dev, info, (union iwreq_data *)dwrq, extra);
  5084. #endif
  5085. #ifdef SOFTAP
  5086. else if (strnicmp(extra, "ASCII_CMD", strlen("ASCII_CMD")) == 0) {
  5087. wl_iw_process_private_ascii_cmd(dev, info, (union iwreq_data *)dwrq, extra);
  5088. }
  5089. else if (strnicmp(extra, "AP_MAC_LIST_SET", strlen("AP_MAC_LIST_SET")) == 0) {
  5090. WL_SOFTAP(("penguin, set AP_MAC_LIST_SET\n"));
  5091. set_ap_mac_list(dev, (extra + PROFILE_OFFSET));
  5092. }
  5093. #endif
  5094. else {
  5095. WL_TRACE(("Unkown PRIVATE command %s\n", extra));
  5096. snprintf(extra, MAX_WX_STRING, "OK");
  5097. dwrq->length = strlen("OK") + 1;
  5098. WL_ERROR(("Unkown PRIVATE command, ignored\n"));
  5099. }
  5100. WAKE_UNLOCK(iw->pub, WAKE_LOCK_PRIV);
  5101. WAKE_LOCK_DESTROY(iw->pub, WAKE_LOCK_PRIV);
  5102. }
  5103. if (extra) {
  5104. if (copy_to_user(dwrq->pointer, extra, dwrq->length)) {
  5105. kfree(extra);
  5106. return -EFAULT;
  5107. }
  5108. kfree(extra);
  5109. }
  5110. return ret;
  5111. }
  5112. static const iw_handler wl_iw_handler[] =
  5113. {
  5114. (iw_handler) wl_iw_config_commit,
  5115. (iw_handler) wl_iw_get_name,
  5116. (iw_handler) NULL,
  5117. (iw_handler) NULL,
  5118. (iw_handler) wl_iw_set_freq,
  5119. (iw_handler) wl_iw_get_freq,
  5120. (iw_handler) wl_iw_set_mode,
  5121. (iw_handler) wl_iw_get_mode,
  5122. (iw_handler) NULL,
  5123. (iw_handler) NULL,
  5124. (iw_handler) NULL,
  5125. (iw_handler) wl_iw_get_range,
  5126. (iw_handler) wl_iw_set_priv,
  5127. (iw_handler) NULL,
  5128. (iw_handler) NULL,
  5129. (iw_handler) NULL,
  5130. (iw_handler) wl_iw_set_spy,
  5131. (iw_handler) wl_iw_get_spy,
  5132. (iw_handler) NULL,
  5133. (iw_handler) NULL,
  5134. (iw_handler) wl_iw_set_wap,
  5135. (iw_handler) wl_iw_get_wap,
  5136. #if WIRELESS_EXT > 17
  5137. (iw_handler) wl_iw_mlme,
  5138. #else
  5139. (iw_handler) NULL,
  5140. #endif
  5141. #if defined(WL_IW_USE_ISCAN)
  5142. (iw_handler) wl_iw_iscan_get_aplist,
  5143. #else
  5144. (iw_handler) wl_iw_get_aplist,
  5145. #endif
  5146. #if WIRELESS_EXT > 13
  5147. #if defined(WL_IW_USE_ISCAN)
  5148. (iw_handler) wl_iw_iscan_set_scan,
  5149. (iw_handler) wl_iw_iscan_get_scan,
  5150. #else
  5151. (iw_handler) wl_iw_set_scan,
  5152. (iw_handler) wl_iw_get_scan,
  5153. #endif
  5154. #else
  5155. (iw_handler) NULL,
  5156. (iw_handler) NULL,
  5157. #endif
  5158. (iw_handler) wl_iw_set_essid,
  5159. (iw_handler) wl_iw_get_essid,
  5160. (iw_handler) wl_iw_set_nick,
  5161. (iw_handler) wl_iw_get_nick,
  5162. (iw_handler) NULL,
  5163. (iw_handler) NULL,
  5164. (iw_handler) wl_iw_set_rate,
  5165. (iw_handler) wl_iw_get_rate,
  5166. (iw_handler) wl_iw_set_rts,
  5167. (iw_handler) wl_iw_get_rts,
  5168. (iw_handler) wl_iw_set_frag,
  5169. (iw_handler) wl_iw_get_frag,
  5170. (iw_handler) wl_iw_set_txpow,
  5171. (iw_handler) wl_iw_get_txpow,
  5172. #if WIRELESS_EXT > 10
  5173. (iw_handler) wl_iw_set_retry,
  5174. (iw_handler) wl_iw_get_retry,
  5175. #endif
  5176. (iw_handler) wl_iw_set_encode,
  5177. (iw_handler) wl_iw_get_encode,
  5178. (iw_handler) wl_iw_set_power,
  5179. (iw_handler) wl_iw_get_power,
  5180. #if WIRELESS_EXT > 17
  5181. (iw_handler) NULL,
  5182. (iw_handler) NULL,
  5183. (iw_handler) wl_iw_set_wpaie,
  5184. (iw_handler) wl_iw_get_wpaie,
  5185. (iw_handler) wl_iw_set_wpaauth,
  5186. (iw_handler) wl_iw_get_wpaauth,
  5187. (iw_handler) wl_iw_set_encodeext,
  5188. (iw_handler) wl_iw_get_encodeext,
  5189. #ifdef BCMWPA2
  5190. (iw_handler) wl_iw_set_pmksa,
  5191. #endif
  5192. #endif
  5193. };
  5194. #if WIRELESS_EXT > 12
  5195. static const iw_handler wl_iw_priv_handler[] = {
  5196. NULL,
  5197. (iw_handler)wl_iw_set_active_scan,
  5198. NULL,
  5199. (iw_handler)wl_iw_get_rssi,
  5200. NULL,
  5201. (iw_handler)wl_iw_set_passive_scan,
  5202. NULL,
  5203. (iw_handler)wl_iw_get_link_speed,
  5204. NULL,
  5205. (iw_handler)wl_iw_get_macaddr,
  5206. NULL,
  5207. (iw_handler)wl_iw_control_wl_off,
  5208. NULL,
  5209. (iw_handler)wl_iw_control_wl_on,
  5210. #ifdef SOFTAP
  5211. NULL,
  5212. (iw_handler)iwpriv_set_ap_config,
  5213. NULL,
  5214. (iw_handler)iwpriv_get_assoc_list,
  5215. NULL,
  5216. (iw_handler)iwpriv_set_mac_filters,
  5217. NULL,
  5218. (iw_handler)iwpriv_en_ap_bss,
  5219. NULL,
  5220. (iw_handler)iwpriv_wpasupp_loop_tst,
  5221. NULL,
  5222. (iw_handler)iwpriv_softap_stop,
  5223. NULL,
  5224. (iw_handler)iwpriv_fw_reload,
  5225. #endif
  5226. #if defined(CSCAN)
  5227. NULL,
  5228. (iw_handler)iwpriv_set_cscan
  5229. #endif
  5230. };
  5231. static const struct iw_priv_args wl_iw_priv_args[] =
  5232. {
  5233. {
  5234. WL_IW_SET_ACTIVE_SCAN,
  5235. 0,
  5236. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
  5237. "SCAN-ACTIVE"
  5238. },
  5239. {
  5240. WL_IW_GET_RSSI,
  5241. 0,
  5242. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
  5243. "RSSI"
  5244. },
  5245. {
  5246. WL_IW_SET_PASSIVE_SCAN,
  5247. 0,
  5248. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
  5249. "SCAN-PASSIVE"
  5250. },
  5251. {
  5252. WL_IW_GET_LINK_SPEED,
  5253. 0,
  5254. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
  5255. "LINKSPEED"
  5256. },
  5257. {
  5258. WL_IW_GET_CURR_MACADDR,
  5259. 0,
  5260. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
  5261. "Macaddr"
  5262. },
  5263. {
  5264. WL_IW_SET_STOP,
  5265. 0,
  5266. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
  5267. "STOP"
  5268. },
  5269. {
  5270. WL_IW_SET_START,
  5271. 0,
  5272. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
  5273. "START"
  5274. },
  5275. #ifdef SOFTAP
  5276. {
  5277. WL_SET_AP_CFG,
  5278. IW_PRIV_TYPE_CHAR | 256,
  5279. 0,
  5280. "AP_SET_CFG"
  5281. },
  5282. {
  5283. WL_AP_STA_LIST,
  5284. 0,
  5285. IW_PRIV_TYPE_CHAR | 0,
  5286. "AP_GET_STA_LIST"
  5287. },
  5288. {
  5289. WL_AP_MAC_FLTR,
  5290. IW_PRIV_TYPE_CHAR | 256,
  5291. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
  5292. "AP_SET_MAC_FLTR"
  5293. },
  5294. {
  5295. WL_AP_BSS_START,
  5296. 0,
  5297. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | MAX_WX_STRING,
  5298. "AP_BSS_START"
  5299. },
  5300. {
  5301. AP_LPB_CMD,
  5302. IW_PRIV_TYPE_CHAR | 256,
  5303. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
  5304. "AP_LPB_CMD"
  5305. },
  5306. {
  5307. WL_AP_STOP,
  5308. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
  5309. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
  5310. "AP_BSS_STOP"
  5311. },
  5312. {
  5313. WL_FW_RELOAD,
  5314. IW_PRIV_TYPE_CHAR | 256,
  5315. IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 0,
  5316. "WL_FW_RELOAD"
  5317. },
  5318. #endif
  5319. #if defined(CSCAN)
  5320. {
  5321. WL_COMBO_SCAN,
  5322. IW_PRIV_TYPE_CHAR | 1024,
  5323. 0,
  5324. "CSCAN"
  5325. },
  5326. #endif
  5327. };
  5328. const struct iw_handler_def wl_iw_handler_def =
  5329. {
  5330. .num_standard = ARRAYSIZE(wl_iw_handler),
  5331. .standard = (iw_handler *) wl_iw_handler,
  5332. .num_private = ARRAYSIZE(wl_iw_priv_handler),
  5333. .num_private_args = ARRAY_SIZE(wl_iw_priv_args),
  5334. .private = (iw_handler *)wl_iw_priv_handler,
  5335. .private_args = (void *) wl_iw_priv_args,
  5336. #if WIRELESS_EXT >= 19
  5337. get_wireless_stats: dhd_get_wireless_stats,
  5338. #endif
  5339. };
  5340. #endif
  5341. int wl_iw_ioctl(
  5342. struct net_device *dev,
  5343. struct ifreq *rq,
  5344. int cmd
  5345. )
  5346. {
  5347. struct iwreq *wrq = (struct iwreq *) rq;
  5348. struct iw_request_info info;
  5349. iw_handler handler;
  5350. char *extra = NULL;
  5351. int token_size = 1, max_tokens = 0, ret = 0;
  5352. WL_TRACE(("\n%s, cmd:%x alled via dhd->do_ioctl()entry point\n", __FUNCTION__, cmd));
  5353. if (cmd < SIOCIWFIRST ||
  5354. IW_IOCTL_IDX(cmd) >= ARRAYSIZE(wl_iw_handler) ||
  5355. !(handler = wl_iw_handler[IW_IOCTL_IDX(cmd)])) {
  5356. WL_ERROR(("%s: error in cmd=%x : not supported\n", __FUNCTION__, cmd));
  5357. return -EOPNOTSUPP;
  5358. }
  5359. switch (cmd) {
  5360. case SIOCSIWESSID:
  5361. case SIOCGIWESSID:
  5362. case SIOCSIWNICKN:
  5363. case SIOCGIWNICKN:
  5364. max_tokens = IW_ESSID_MAX_SIZE + 1;
  5365. break;
  5366. case SIOCSIWENCODE:
  5367. case SIOCGIWENCODE:
  5368. #if WIRELESS_EXT > 17
  5369. case SIOCSIWENCODEEXT:
  5370. case SIOCGIWENCODEEXT:
  5371. #endif
  5372. max_tokens = wrq->u.data.length;
  5373. break;
  5374. case SIOCGIWRANGE:
  5375. max_tokens = sizeof(struct iw_range) + 500;
  5376. break;
  5377. case SIOCGIWAPLIST:
  5378. token_size = sizeof(struct sockaddr) + sizeof(struct iw_quality);
  5379. max_tokens = IW_MAX_AP;
  5380. break;
  5381. #if WIRELESS_EXT > 13
  5382. case SIOCGIWSCAN:
  5383. #if defined(WL_IW_USE_ISCAN)
  5384. if (g_iscan)
  5385. max_tokens = wrq->u.data.length;
  5386. else
  5387. #endif
  5388. max_tokens = IW_SCAN_MAX_DATA;
  5389. break;
  5390. #endif
  5391. case SIOCSIWSPY:
  5392. token_size = sizeof(struct sockaddr);
  5393. max_tokens = IW_MAX_SPY;
  5394. break;
  5395. case SIOCGIWSPY:
  5396. token_size = sizeof(struct sockaddr) + sizeof(struct iw_quality);
  5397. max_tokens = IW_MAX_SPY;
  5398. break;
  5399. #if WIRELESS_EXT > 17
  5400. case SIOCSIWPMKSA:
  5401. case SIOCSIWGENIE:
  5402. #endif
  5403. case SIOCSIWPRIV:
  5404. max_tokens = wrq->u.data.length;
  5405. break;
  5406. }
  5407. if (max_tokens && wrq->u.data.pointer) {
  5408. if (wrq->u.data.length > max_tokens) {
  5409. WL_ERROR(("%s: error in cmd=%x wrq->u.data.length=%d > max_tokens=%d\n", \
  5410. __FUNCTION__, cmd, wrq->u.data.length, max_tokens));
  5411. return -E2BIG;
  5412. }
  5413. if (!(extra = kmalloc(max_tokens * token_size, GFP_KERNEL)))
  5414. return -ENOMEM;
  5415. if (copy_from_user(extra, wrq->u.data.pointer, wrq->u.data.length * token_size)) {
  5416. kfree(extra);
  5417. return -EFAULT;
  5418. }
  5419. }
  5420. info.cmd = cmd;
  5421. info.flags = 0;
  5422. ret = handler(dev, &info, &wrq->u, extra);
  5423. if (extra) {
  5424. if (copy_to_user(wrq->u.data.pointer, extra, wrq->u.data.length * token_size)) {
  5425. kfree(extra);
  5426. return -EFAULT;
  5427. }
  5428. kfree(extra);
  5429. }
  5430. return ret;
  5431. }
  5432. bool
  5433. wl_iw_conn_status_str(uint32 event_type, uint32 status, uint32 reason,
  5434. char* stringBuf, uint buflen)
  5435. {
  5436. typedef struct conn_fail_event_map_t {
  5437. uint32 inEvent;
  5438. uint32 inStatus;
  5439. uint32 inReason;
  5440. const char* outName;
  5441. const char* outCause;
  5442. } conn_fail_event_map_t;
  5443. # define WL_IW_DONT_CARE 9999
  5444. const conn_fail_event_map_t event_map [] = {
  5445. {WLC_E_SET_SSID, WLC_E_STATUS_SUCCESS, WL_IW_DONT_CARE,
  5446. "Conn", "Success"},
  5447. {WLC_E_SET_SSID, WLC_E_STATUS_NO_NETWORKS, WL_IW_DONT_CARE,
  5448. "Conn", "NoNetworks"},
  5449. {WLC_E_SET_SSID, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE,
  5450. "Conn", "ConfigMismatch"},
  5451. {WLC_E_PRUNE, WL_IW_DONT_CARE, WLC_E_PRUNE_ENCR_MISMATCH,
  5452. "Conn", "EncrypMismatch"},
  5453. {WLC_E_PRUNE, WL_IW_DONT_CARE, WLC_E_RSN_MISMATCH,
  5454. "Conn", "RsnMismatch"},
  5455. {WLC_E_AUTH, WLC_E_STATUS_TIMEOUT, WL_IW_DONT_CARE,
  5456. "Conn", "AuthTimeout"},
  5457. {WLC_E_AUTH, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE,
  5458. "Conn", "AuthFail"},
  5459. {WLC_E_AUTH, WLC_E_STATUS_NO_ACK, WL_IW_DONT_CARE,
  5460. "Conn", "AuthNoAck"},
  5461. {WLC_E_REASSOC, WLC_E_STATUS_FAIL, WL_IW_DONT_CARE,
  5462. "Conn", "ReassocFail"},
  5463. {WLC_E_REASSOC, WLC_E_STATUS_TIMEOUT, WL_IW_DONT_CARE,
  5464. "Conn", "ReassocTimeout"},
  5465. {WLC_E_REASSOC, WLC_E_STATUS_ABORT, WL_IW_DONT_CARE,
  5466. "Conn", "ReassocAbort"},
  5467. {WLC_E_PSK_SUP, WLC_SUP_KEYED, WL_IW_DONT_CARE,
  5468. "Sup", "ConnSuccess"},
  5469. {WLC_E_PSK_SUP, WL_IW_DONT_CARE, WL_IW_DONT_CARE,
  5470. "Sup", "WpaHandshakeFail"},
  5471. {WLC_E_DEAUTH_IND, WL_IW_DONT_CARE, WL_IW_DONT_CARE,
  5472. "Conn", "Deauth"},
  5473. {WLC_E_DISASSOC_IND, WL_IW_DONT_CARE, WL_IW_DONT_CARE,
  5474. "Conn", "DisassocInd"},
  5475. {WLC_E_DISASSOC, WL_IW_DONT_CARE, WL_IW_DONT_CARE,
  5476. "Conn", "Disassoc"}
  5477. };
  5478. const char* name = "";
  5479. const char* cause = NULL;
  5480. int i;
  5481. for (i = 0; i < sizeof(event_map)/sizeof(event_map[0]); i++) {
  5482. const conn_fail_event_map_t* row = &event_map[i];
  5483. if (row->inEvent == event_type &&
  5484. (row->inStatus == status || row->inStatus == WL_IW_DONT_CARE) &&
  5485. (row->inReason == reason || row->inReason == WL_IW_DONT_CARE)) {
  5486. name = row->outName;
  5487. cause = row->outCause;
  5488. break;
  5489. }
  5490. }
  5491. if (cause) {
  5492. memset(stringBuf, 0, buflen);
  5493. snprintf(stringBuf, buflen, "%s %s %02d %02d",
  5494. name, cause, status, reason);
  5495. WL_INFORM(("Connection status: %s\n", stringBuf));
  5496. return TRUE;
  5497. } else {
  5498. return FALSE;
  5499. }
  5500. }
  5501. #if WIRELESS_EXT > 14
  5502. static bool
  5503. wl_iw_check_conn_fail(wl_event_msg_t *e, char* stringBuf, uint buflen)
  5504. {
  5505. uint32 event = ntoh32(e->event_type);
  5506. uint32 status = ntoh32(e->status);
  5507. uint32 reason = ntoh32(e->reason);
  5508. if (wl_iw_conn_status_str(event, status, reason, stringBuf, buflen)) {
  5509. return TRUE;
  5510. }
  5511. else
  5512. return FALSE;
  5513. }
  5514. #endif
  5515. #ifndef IW_CUSTOM_MAX
  5516. #define IW_CUSTOM_MAX 256
  5517. #endif
  5518. void
  5519. wl_iw_event(struct net_device *dev, wl_event_msg_t *e, void* data)
  5520. {
  5521. #if WIRELESS_EXT > 13
  5522. union iwreq_data wrqu;
  5523. char extra[IW_CUSTOM_MAX + 1];
  5524. int cmd = 0;
  5525. uint32 event_type = ntoh32(e->event_type);
  5526. uint16 flags = ntoh16(e->flags);
  5527. uint32 datalen = ntoh32(e->datalen);
  5528. uint32 status = ntoh32(e->status);
  5529. wl_iw_t *iw;
  5530. uint32 toto;
  5531. memset(&wrqu, 0, sizeof(wrqu));
  5532. memset(extra, 0, sizeof(extra));
  5533. iw = 0;
  5534. if (!dev) {
  5535. WL_ERROR(("%s: dev is null\n", __FUNCTION__));
  5536. return;
  5537. }
  5538. iw = *(wl_iw_t **)netdev_priv(dev);
  5539. WL_TRACE(("%s: dev=%s event=%d \n", __FUNCTION__, dev->name, event_type));
  5540. switch (event_type) {
  5541. #if defined(SOFTAP)
  5542. case WLC_E_PRUNE:
  5543. if (ap_cfg_running) {
  5544. char *macaddr = (char *)&e->addr;
  5545. WL_SOFTAP(("PRUNE received, %02X:%02X:%02X:%02X:%02X:%02X!\n",
  5546. macaddr[0], macaddr[1], macaddr[2], macaddr[3], \
  5547. macaddr[4], macaddr[5]));
  5548. if (ap_macmode)
  5549. {
  5550. int i;
  5551. for (i = 0; i < ap_black_list.count; i++) {
  5552. if (!bcmp(macaddr, &ap_black_list.ea[i], \
  5553. sizeof(struct ether_addr))) {
  5554. WL_SOFTAP(("mac in black list, ignore it\n"));
  5555. break;
  5556. }
  5557. }
  5558. if (i == ap_black_list.count) {
  5559. char mac_buf[32] = {0};
  5560. sprintf(mac_buf, "STA_BLOCK %02X:%02X:%02X:%02X:%02X:%02X",
  5561. macaddr[0], macaddr[1], macaddr[2],
  5562. macaddr[3], macaddr[4], macaddr[5]);
  5563. wl_iw_send_priv_event(priv_dev, mac_buf);
  5564. }
  5565. }
  5566. }
  5567. break;
  5568. #endif
  5569. case WLC_E_TXFAIL:
  5570. cmd = IWEVTXDROP;
  5571. memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN);
  5572. wrqu.addr.sa_family = ARPHRD_ETHER;
  5573. break;
  5574. #if WIRELESS_EXT > 14
  5575. case WLC_E_JOIN:
  5576. case WLC_E_ASSOC_IND:
  5577. case WLC_E_REASSOC_IND:
  5578. #if defined(SOFTAP)
  5579. WL_SOFTAP(("STA connect received %d\n", event_type));
  5580. if (ap_cfg_running) {
  5581. wl_iw_send_priv_event(priv_dev, "STA_JOIN");
  5582. return;
  5583. }
  5584. #endif
  5585. memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN);
  5586. wrqu.addr.sa_family = ARPHRD_ETHER;
  5587. cmd = IWEVREGISTERED;
  5588. break;
  5589. case WLC_E_DEAUTH_IND:
  5590. case WLC_E_DISASSOC_IND:
  5591. #if defined(SOFTAP)
  5592. WL_SOFTAP(("STA disconnect received %d\n", event_type));
  5593. if (ap_cfg_running) {
  5594. wl_iw_send_priv_event(priv_dev, "STA_LEAVE");
  5595. return;
  5596. }
  5597. #endif
  5598. cmd = SIOCGIWAP;
  5599. bzero(wrqu.addr.sa_data, ETHER_ADDR_LEN);
  5600. wrqu.addr.sa_family = ARPHRD_ETHER;
  5601. bzero(&extra, ETHER_ADDR_LEN);
  5602. break;
  5603. case WLC_E_LINK:
  5604. case WLC_E_NDIS_LINK:
  5605. cmd = SIOCGIWAP;
  5606. if (!(flags & WLC_EVENT_MSG_LINK)) {
  5607. #ifdef SOFTAP
  5608. #ifdef AP_ONLY
  5609. if (ap_cfg_running) {
  5610. #else
  5611. if (ap_cfg_running && !strncmp(dev->name, "wl0.1", 5)) {
  5612. #endif
  5613. WL_SOFTAP(("AP DOWN %d\n", event_type));
  5614. wl_iw_send_priv_event(priv_dev, "AP_DOWN");
  5615. } else {
  5616. WL_TRACE(("STA_Link Down\n"));
  5617. g_ss_cache_ctrl.m_link_down = 1;
  5618. }
  5619. #else
  5620. g_ss_cache_ctrl.m_link_down = 1;
  5621. #endif
  5622. WL_TRACE(("Link Down\n"));
  5623. bzero(wrqu.addr.sa_data, ETHER_ADDR_LEN);
  5624. bzero(&extra, ETHER_ADDR_LEN);
  5625. WAKE_LOCK_TIMEOUT(iw->pub, WAKE_LOCK_LINK_DOWN_TMOUT, 20 * HZ);
  5626. }
  5627. else {
  5628. memcpy(wrqu.addr.sa_data, &e->addr, ETHER_ADDR_LEN);
  5629. g_ss_cache_ctrl.m_link_down = 0;
  5630. memcpy(g_ss_cache_ctrl.m_active_bssid, &e->addr, ETHER_ADDR_LEN);
  5631. #ifdef SOFTAP
  5632. #ifdef AP_ONLY
  5633. if (ap_cfg_running) {
  5634. #else
  5635. if (ap_cfg_running && !strncmp(dev->name, "wl0.1", 5)) {
  5636. #endif
  5637. WL_SOFTAP(("AP UP %d\n", event_type));
  5638. wl_iw_send_priv_event(priv_dev, "AP_UP");
  5639. } else {
  5640. WL_TRACE(("STA_LINK_UP\n"));
  5641. }
  5642. #else
  5643. #endif
  5644. WL_TRACE(("Link UP\n"));
  5645. }
  5646. wrqu.addr.sa_family = ARPHRD_ETHER;
  5647. break;
  5648. case WLC_E_ACTION_FRAME:
  5649. cmd = IWEVCUSTOM;
  5650. if (datalen + 1 <= sizeof(extra)) {
  5651. wrqu.data.length = datalen + 1;
  5652. extra[0] = WLC_E_ACTION_FRAME;
  5653. memcpy(&extra[1], data, datalen);
  5654. WL_TRACE(("WLC_E_ACTION_FRAME len %d \n", wrqu.data.length));
  5655. }
  5656. break;
  5657. case WLC_E_ACTION_FRAME_COMPLETE:
  5658. cmd = IWEVCUSTOM;
  5659. memcpy(&toto, data, 4);
  5660. if (sizeof(status) + 1 <= sizeof(extra)) {
  5661. wrqu.data.length = sizeof(status) + 1;
  5662. extra[0] = WLC_E_ACTION_FRAME_COMPLETE;
  5663. memcpy(&extra[1], &status, sizeof(status));
  5664. printf("wl_iw_event status %d PacketId %d \n", status, toto);
  5665. printf("WLC_E_ACTION_FRAME_COMPLETE len %d \n", wrqu.data.length);
  5666. }
  5667. break;
  5668. #endif
  5669. #if WIRELESS_EXT > 17
  5670. case WLC_E_MIC_ERROR: {
  5671. struct iw_michaelmicfailure *micerrevt = (struct iw_michaelmicfailure *)&extra;
  5672. cmd = IWEVMICHAELMICFAILURE;
  5673. wrqu.data.length = sizeof(struct iw_michaelmicfailure);
  5674. if (flags & WLC_EVENT_MSG_GROUP)
  5675. micerrevt->flags |= IW_MICFAILURE_GROUP;
  5676. else
  5677. micerrevt->flags |= IW_MICFAILURE_PAIRWISE;
  5678. memcpy(micerrevt->src_addr.sa_data, &e->addr, ETHER_ADDR_LEN);
  5679. micerrevt->src_addr.sa_family = ARPHRD_ETHER;
  5680. break;
  5681. }
  5682. #ifdef BCMWPA2
  5683. case WLC_E_PMKID_CACHE: {
  5684. if (data)
  5685. {
  5686. struct iw_pmkid_cand *iwpmkidcand = (struct iw_pmkid_cand *)&extra;
  5687. pmkid_cand_list_t *pmkcandlist;
  5688. pmkid_cand_t *pmkidcand;
  5689. int count;
  5690. cmd = IWEVPMKIDCAND;
  5691. pmkcandlist = data;
  5692. count = ntoh32_ua((uint8 *)&pmkcandlist->npmkid_cand);
  5693. ASSERT(count >= 0);
  5694. wrqu.data.length = sizeof(struct iw_pmkid_cand);
  5695. pmkidcand = pmkcandlist->pmkid_cand;
  5696. while (count) {
  5697. bzero(iwpmkidcand, sizeof(struct iw_pmkid_cand));
  5698. if (pmkidcand->preauth)
  5699. iwpmkidcand->flags |= IW_PMKID_CAND_PREAUTH;
  5700. bcopy(&pmkidcand->BSSID, &iwpmkidcand->bssid.sa_data,
  5701. ETHER_ADDR_LEN);
  5702. #ifndef SANDGATE2G
  5703. wireless_send_event(dev, cmd, &wrqu, extra);
  5704. #endif
  5705. pmkidcand++;
  5706. count--;
  5707. }
  5708. }
  5709. return;
  5710. }
  5711. #endif
  5712. #endif
  5713. case WLC_E_SCAN_COMPLETE:
  5714. #if defined(WL_IW_USE_ISCAN)
  5715. if ((g_iscan) && (g_iscan->sysioc_pid >= 0) &&
  5716. (g_iscan->iscan_state != ISCAN_STATE_IDLE))
  5717. {
  5718. up(&g_iscan->sysioc_sem);
  5719. } else {
  5720. cmd = SIOCGIWSCAN;
  5721. wrqu.data.length = strlen(extra);
  5722. WL_TRACE(("Event WLC_E_SCAN_COMPLETE from specific scan %d\n", \
  5723. g_iscan->iscan_state));
  5724. }
  5725. #else
  5726. cmd = SIOCGIWSCAN;
  5727. wrqu.data.length = strlen(extra);
  5728. WL_TRACE(("Event WLC_E_SCAN_COMPLETE\n"));
  5729. #endif
  5730. break;
  5731. default:
  5732. WL_TRACE(("Unknown Event %d: ignoring\n", event_type));
  5733. break;
  5734. }
  5735. #ifndef SANDGATE2G
  5736. if (cmd) {
  5737. if (cmd == SIOCGIWSCAN)
  5738. wireless_send_event(dev, cmd, &wrqu, NULL);
  5739. else
  5740. wireless_send_event(dev, cmd, &wrqu, extra);
  5741. }
  5742. #endif
  5743. #if WIRELESS_EXT > 14
  5744. memset(extra, 0, sizeof(extra));
  5745. if (wl_iw_check_conn_fail(e, extra, sizeof(extra))) {
  5746. cmd = IWEVCUSTOM;
  5747. wrqu.data.length = strlen(extra);
  5748. #ifndef SANDGATE2G
  5749. wireless_send_event(dev, cmd, &wrqu, extra);
  5750. #endif
  5751. }
  5752. #endif
  5753. #endif
  5754. }
  5755. int wl_iw_get_wireless_stats(struct net_device *dev, struct iw_statistics *wstats)
  5756. {
  5757. int res = 0;
  5758. wl_cnt_t cnt;
  5759. int phy_noise;
  5760. int rssi;
  5761. scb_val_t scb_val;
  5762. phy_noise = 0;
  5763. if ((res = dev_wlc_ioctl(dev, WLC_GET_PHY_NOISE, &phy_noise, sizeof(phy_noise))))
  5764. goto done;
  5765. phy_noise = dtoh32(phy_noise);
  5766. WL_TRACE(("wl_iw_get_wireless_stats phy noise=%d\n", phy_noise));
  5767. bzero(&scb_val, sizeof(scb_val_t));
  5768. if ((res = dev_wlc_ioctl(dev, WLC_GET_RSSI, &scb_val, sizeof(scb_val_t))))
  5769. goto done;
  5770. rssi = dtoh32(scb_val.val);
  5771. WL_TRACE(("wl_iw_get_wireless_stats rssi=%d\n", rssi));
  5772. if (rssi <= WL_IW_RSSI_NO_SIGNAL)
  5773. wstats->qual.qual = 0;
  5774. else if (rssi <= WL_IW_RSSI_VERY_LOW)
  5775. wstats->qual.qual = 1;
  5776. else if (rssi <= WL_IW_RSSI_LOW)
  5777. wstats->qual.qual = 2;
  5778. else if (rssi <= WL_IW_RSSI_GOOD)
  5779. wstats->qual.qual = 3;
  5780. else if (rssi <= WL_IW_RSSI_VERY_GOOD)
  5781. wstats->qual.qual = 4;
  5782. else
  5783. wstats->qual.qual = 5;
  5784. wstats->qual.level = 0x100 + rssi;
  5785. wstats->qual.noise = 0x100 + phy_noise;
  5786. #if WIRELESS_EXT > 18
  5787. wstats->qual.updated |= (IW_QUAL_ALL_UPDATED | IW_QUAL_DBM);
  5788. #else
  5789. wstats->qual.updated |= 7;
  5790. #endif
  5791. #if WIRELESS_EXT > 11
  5792. WL_TRACE(("wl_iw_get_wireless_stats counters=%d\n", (int)sizeof(wl_cnt_t)));
  5793. memset(&cnt, 0, sizeof(wl_cnt_t));
  5794. res = dev_wlc_bufvar_get(dev, "counters", (char *)&cnt, sizeof(wl_cnt_t));
  5795. if (res)
  5796. {
  5797. WL_ERROR(("wl_iw_get_wireless_stats counters failed error=%d\n", res));
  5798. goto done;
  5799. }
  5800. cnt.version = dtoh16(cnt.version);
  5801. if (cnt.version != WL_CNT_T_VERSION) {
  5802. WL_TRACE(("\tIncorrect version of counters struct: expected %d; got %d\n",
  5803. WL_CNT_T_VERSION, cnt.version));
  5804. goto done;
  5805. }
  5806. wstats->discard.nwid = 0;
  5807. wstats->discard.code = dtoh32(cnt.rxundec);
  5808. wstats->discard.fragment = dtoh32(cnt.rxfragerr);
  5809. wstats->discard.retries = dtoh32(cnt.txfail);
  5810. wstats->discard.misc = dtoh32(cnt.rxrunt) + dtoh32(cnt.rxgiant);
  5811. wstats->miss.beacon = 0;
  5812. WL_TRACE(("wl_iw_get_wireless_stats counters txframe=%d txbyte=%d\n",
  5813. dtoh32(cnt.txframe), dtoh32(cnt.txbyte)));
  5814. WL_TRACE(("wl_iw_get_wireless_stats counters rxfrmtoolong=%d\n", dtoh32(cnt.rxfrmtoolong)));
  5815. WL_TRACE(("wl_iw_get_wireless_stats counters rxbadplcp=%d\n", dtoh32(cnt.rxbadplcp)));
  5816. WL_TRACE(("wl_iw_get_wireless_stats counters rxundec=%d\n", dtoh32(cnt.rxundec)));
  5817. WL_TRACE(("wl_iw_get_wireless_stats counters rxfragerr=%d\n", dtoh32(cnt.rxfragerr)));
  5818. WL_TRACE(("wl_iw_get_wireless_stats counters txfail=%d\n", dtoh32(cnt.txfail)));
  5819. WL_TRACE(("wl_iw_get_wireless_stats counters rxrunt=%d\n", dtoh32(cnt.rxrunt)));
  5820. WL_TRACE(("wl_iw_get_wireless_stats counters rxgiant=%d\n", dtoh32(cnt.rxgiant)));
  5821. #endif
  5822. done:
  5823. return res;
  5824. }
  5825. static void
  5826. wl_iw_bt_flag_set(
  5827. struct net_device *dev,
  5828. bool set)
  5829. {
  5830. char buf_flag7_dhcp_on[8] = { 7, 00, 00, 00, 0x1, 0x0, 0x00, 0x00 };
  5831. char buf_flag7_default[8] = { 7, 00, 00, 00, 0x0, 0x00, 0x00, 0x00};
  5832. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  5833. rtnl_lock();
  5834. #endif
  5835. if (set == TRUE) {
  5836. dev_wlc_bufvar_set(dev, "btc_flags", \
  5837. (char *)&buf_flag7_dhcp_on[0], sizeof(buf_flag7_dhcp_on));
  5838. }
  5839. else {
  5840. dev_wlc_bufvar_set(dev, "btc_flags", \
  5841. (char *)&buf_flag7_default[0], sizeof(buf_flag7_default));
  5842. }
  5843. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
  5844. rtnl_unlock();
  5845. #endif
  5846. }
  5847. static void
  5848. wl_iw_bt_timerfunc(ulong data)
  5849. {
  5850. bt_info_t *bt_local = (bt_info_t *)data;
  5851. bt_local->timer_on = 0;
  5852. WL_TRACE(("%s\n", __FUNCTION__));
  5853. up(&bt_local->bt_sem);
  5854. }
  5855. static int
  5856. _bt_dhcp_sysioc_thread(void *data)
  5857. {
  5858. DAEMONIZE("dhcp_sysioc");
  5859. while (down_interruptible(&g_bt->bt_sem) == 0) {
  5860. if (g_bt->timer_on) {
  5861. del_timer(&g_bt->timer);
  5862. g_bt->timer_on = 0;
  5863. }
  5864. switch (g_bt->bt_state) {
  5865. case BT_DHCP_START:
  5866. g_bt->bt_state = BT_DHCP_OPPORTUNITY_WINDOW;
  5867. mod_timer(&g_bt->timer, jiffies + \
  5868. BT_DHCP_OPPORTUNITY_WINDOW_TIEM*HZ/1000);
  5869. g_bt->timer_on = 1;
  5870. break;
  5871. case BT_DHCP_OPPORTUNITY_WINDOW:
  5872. WL_TRACE(("%s waiting for %d msec expired, force bt flag\n", \
  5873. __FUNCTION__, BT_DHCP_OPPORTUNITY_WINDOW_TIEM));
  5874. if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, TRUE);
  5875. g_bt->bt_state = BT_DHCP_FLAG_FORCE_TIMEOUT;
  5876. mod_timer(&g_bt->timer, jiffies + BT_DHCP_FLAG_FORCE_TIME*HZ/1000);
  5877. g_bt->timer_on = 1;
  5878. break;
  5879. case BT_DHCP_FLAG_FORCE_TIMEOUT:
  5880. WL_TRACE(("%s waiting for %d msec expired remove bt flag\n", \
  5881. __FUNCTION__, BT_DHCP_FLAG_FORCE_TIME));
  5882. if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, FALSE);
  5883. g_bt->bt_state = BT_DHCP_IDLE;
  5884. g_bt->timer_on = 0;
  5885. break;
  5886. default:
  5887. WL_ERROR(("%s error g_status=%d !!!\n", __FUNCTION__, \
  5888. g_bt->bt_state));
  5889. if (g_bt->dev) wl_iw_bt_flag_set(g_bt->dev, FALSE);
  5890. g_bt->bt_state = BT_DHCP_IDLE;
  5891. g_bt->timer_on = 0;
  5892. break;
  5893. }
  5894. }
  5895. if (g_bt->timer_on) {
  5896. del_timer(&g_bt->timer);
  5897. g_bt->timer_on = 0;
  5898. }
  5899. complete_and_exit(&g_bt->bt_exited, 0);
  5900. }
  5901. static void
  5902. wl_iw_bt_release(void)
  5903. {
  5904. bt_info_t *bt_local = g_bt;
  5905. if (!bt_local) {
  5906. return;
  5907. }
  5908. if (bt_local->bt_pid >= 0) {
  5909. KILL_PROC(bt_local->bt_pid, SIGTERM);
  5910. wait_for_completion(&bt_local->bt_exited);
  5911. }
  5912. kfree(bt_local);
  5913. g_bt = NULL;
  5914. }
  5915. static struct net_device *my_dev;
  5916. void dhd_store_device(struct net_device *dev)
  5917. {
  5918. my_dev = dev;
  5919. }
  5920. void dhd_tele_on(void)
  5921. {
  5922. if(my_dev)
  5923. wl_iw_control_wl_on(my_dev,NULL);
  5924. }
  5925. void dhd_tele_off(void)
  5926. {
  5927. if(my_dev)
  5928. wl_iw_control_wl_off(my_dev,NULL);
  5929. }
  5930. static int
  5931. wl_iw_bt_init(struct net_device *dev)
  5932. {
  5933. bt_info_t *bt_dhcp = NULL;
  5934. bt_dhcp = kmalloc(sizeof(bt_info_t), GFP_KERNEL);
  5935. if (!bt_dhcp)
  5936. return -ENOMEM;
  5937. memset(bt_dhcp, 0, sizeof(bt_info_t));
  5938. bt_dhcp->bt_pid = -1;
  5939. g_bt = bt_dhcp;
  5940. bt_dhcp->dev = dev;
  5941. bt_dhcp->bt_state = BT_DHCP_IDLE;
  5942. bt_dhcp->timer_ms = 10;
  5943. init_timer(&bt_dhcp->timer);
  5944. bt_dhcp->timer.data = (ulong)bt_dhcp;
  5945. bt_dhcp->timer.function = wl_iw_bt_timerfunc;
  5946. sema_init(&bt_dhcp->bt_sem, 0);
  5947. init_completion(&bt_dhcp->bt_exited);
  5948. bt_dhcp->bt_pid = kernel_thread(_bt_dhcp_sysioc_thread, bt_dhcp, 0);
  5949. if (bt_dhcp->bt_pid < 0) {
  5950. WL_ERROR(("Failed in %s\n", __FUNCTION__));
  5951. return -ENOMEM;
  5952. }
  5953. return 0;
  5954. }
  5955. int wl_iw_attach(struct net_device *dev, void * dhdp)
  5956. {
  5957. int params_size;
  5958. wl_iw_t *iw;
  5959. #if defined(WL_IW_USE_ISCAN)
  5960. iscan_info_t *iscan = NULL;
  5961. if (!dev)
  5962. return 0;
  5963. dhd_store_device(dev);
  5964. #ifdef CSCAN
  5965. params_size = (WL_SCAN_PARAMS_FIXED_SIZE + OFFSETOF(wl_iscan_params_t, params)) +
  5966. (WL_NUMCHANNELS * sizeof(uint16)) + WL_SCAN_PARAMS_SSID_MAX * sizeof(wlc_ssid_t);
  5967. #else
  5968. params_size = (WL_SCAN_PARAMS_FIXED_SIZE + OFFSETOF(wl_iscan_params_t, params));
  5969. #endif
  5970. iscan = kmalloc(sizeof(iscan_info_t), GFP_KERNEL);
  5971. if (!iscan)
  5972. return -ENOMEM;
  5973. memset(iscan, 0, sizeof(iscan_info_t));
  5974. iscan->iscan_ex_params_p = (wl_iscan_params_t*)kmalloc(params_size, GFP_KERNEL);
  5975. if (!iscan->iscan_ex_params_p)
  5976. return -ENOMEM;
  5977. iscan->iscan_ex_param_size = params_size;
  5978. iscan->sysioc_pid = -1;
  5979. g_iscan = iscan;
  5980. iscan->dev = dev;
  5981. iscan->iscan_state = ISCAN_STATE_IDLE;
  5982. g_first_broadcast_scan = BROADCAST_SCAN_FIRST_IDLE;
  5983. g_iscan->scan_flag = 0;
  5984. iscan->timer_ms = 3000;
  5985. init_timer(&iscan->timer);
  5986. iscan->timer.data = (ulong)iscan;
  5987. iscan->timer.function = wl_iw_timerfunc;
  5988. sema_init(&iscan->sysioc_sem, 0);
  5989. init_completion(&iscan->sysioc_exited);
  5990. iscan->sysioc_pid = kernel_thread(_iscan_sysioc_thread, iscan, 0);
  5991. if (iscan->sysioc_pid < 0)
  5992. return -ENOMEM;
  5993. #endif
  5994. iw = *(wl_iw_t **)netdev_priv(dev);
  5995. iw->pub = (dhd_pub_t *)dhdp;
  5996. MUTEX_LOCK_INIT(iw->pub);
  5997. MUTEX_LOCK_WL_SCAN_SET_INIT();
  5998. #ifdef SOFTAP
  5999. priv_dev = dev;
  6000. MUTEX_LOCK_SOFTAP_SET_INIT(iw->pub);
  6001. #endif
  6002. g_scan = NULL;
  6003. g_scan = (void *)kmalloc(G_SCAN_RESULTS, GFP_KERNEL);
  6004. if (!g_scan)
  6005. return -ENOMEM;
  6006. memset(g_scan, 0, G_SCAN_RESULTS);
  6007. g_scan_specified_ssid = 0;
  6008. #if !defined(CSCAN)
  6009. wl_iw_init_ss_cache_ctrl();
  6010. #endif
  6011. wl_iw_bt_init(dev);
  6012. return 0;
  6013. }
  6014. void wl_iw_detach(void)
  6015. {
  6016. #if defined(WL_IW_USE_ISCAN)
  6017. iscan_buf_t *buf;
  6018. iscan_info_t *iscan = g_iscan;
  6019. if (!iscan)
  6020. return;
  6021. if (iscan->sysioc_pid >= 0) {
  6022. KILL_PROC(iscan->sysioc_pid, SIGTERM);
  6023. wait_for_completion(&iscan->sysioc_exited);
  6024. }
  6025. MUTEX_LOCK_WL_SCAN_SET();
  6026. while (iscan->list_hdr) {
  6027. buf = iscan->list_hdr->next;
  6028. kfree(iscan->list_hdr);
  6029. iscan->list_hdr = buf;
  6030. }
  6031. MUTEX_UNLOCK_WL_SCAN_SET();
  6032. kfree(iscan->iscan_ex_params_p);
  6033. kfree(iscan);
  6034. g_iscan = NULL;
  6035. #endif
  6036. if (g_scan)
  6037. kfree(g_scan);
  6038. g_scan = NULL;
  6039. #if !defined(CSCAN)
  6040. wl_iw_release_ss_cache_ctrl();
  6041. #endif
  6042. wl_iw_bt_release();
  6043. #ifdef SOFTAP
  6044. if (ap_cfg_running) {
  6045. WL_TRACE(("\n%s AP is going down\n", __FUNCTION__));
  6046. wl_iw_send_priv_event(priv_dev, "AP_DOWN");
  6047. }
  6048. #endif
  6049. }