wl_iw.c 201 KB

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