nl80211.c 175 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598559956005601560256035604560556065607560856095610561156125613561456155616561756185619562056215622562356245625562656275628562956305631563256335634563556365637563856395640564156425643564456455646564756485649565056515652565356545655565656575658565956605661566256635664566556665667566856695670567156725673567456755676567756785679568056815682568356845685568656875688568956905691569256935694569556965697569856995700570157025703570457055706570757085709571057115712571357145715571657175718571957205721572257235724572557265727572857295730573157325733573457355736573757385739574057415742574357445745574657475748574957505751575257535754575557565757575857595760576157625763576457655766576757685769577057715772577357745775577657775778577957805781578257835784578557865787578857895790579157925793579457955796579757985799580058015802580358045805580658075808580958105811581258135814581558165817581858195820582158225823582458255826582758285829583058315832583358345835583658375838583958405841584258435844584558465847584858495850585158525853585458555856585758585859586058615862586358645865586658675868586958705871587258735874587558765877587858795880588158825883588458855886588758885889589058915892589358945895589658975898589959005901590259035904590559065907590859095910591159125913591459155916591759185919592059215922592359245925592659275928592959305931593259335934593559365937593859395940594159425943594459455946594759485949595059515952595359545955595659575958595959605961596259635964596559665967596859695970597159725973597459755976597759785979598059815982598359845985598659875988598959905991599259935994599559965997599859996000600160026003600460056006600760086009601060116012601360146015601660176018601960206021602260236024602560266027602860296030603160326033603460356036603760386039604060416042604360446045604660476048604960506051605260536054605560566057605860596060606160626063606460656066606760686069607060716072607360746075607660776078607960806081608260836084608560866087608860896090609160926093609460956096609760986099610061016102610361046105610661076108610961106111611261136114611561166117611861196120612161226123612461256126612761286129613061316132613361346135613661376138613961406141614261436144614561466147614861496150615161526153615461556156615761586159616061616162616361646165616661676168616961706171617261736174617561766177617861796180618161826183618461856186618761886189619061916192619361946195619661976198619962006201620262036204620562066207620862096210621162126213621462156216621762186219622062216222622362246225622662276228622962306231623262336234623562366237623862396240624162426243624462456246624762486249625062516252625362546255625662576258625962606261626262636264626562666267626862696270627162726273627462756276627762786279628062816282628362846285628662876288628962906291629262936294629562966297629862996300630163026303630463056306630763086309631063116312631363146315631663176318631963206321632263236324632563266327632863296330633163326333633463356336633763386339634063416342634363446345634663476348634963506351635263536354635563566357635863596360636163626363636463656366636763686369637063716372637363746375637663776378637963806381638263836384638563866387638863896390639163926393639463956396639763986399640064016402640364046405640664076408640964106411641264136414641564166417641864196420642164226423642464256426642764286429643064316432643364346435643664376438643964406441644264436444644564466447644864496450645164526453645464556456645764586459646064616462646364646465646664676468646964706471647264736474647564766477647864796480648164826483648464856486648764886489649064916492649364946495649664976498649965006501650265036504650565066507650865096510651165126513651465156516651765186519652065216522652365246525652665276528652965306531653265336534653565366537653865396540654165426543654465456546654765486549655065516552655365546555655665576558655965606561656265636564656565666567656865696570657165726573657465756576657765786579658065816582658365846585658665876588658965906591659265936594659565966597659865996600660166026603660466056606660766086609661066116612661366146615661666176618661966206621662266236624662566266627662866296630663166326633663466356636663766386639664066416642664366446645664666476648664966506651665266536654665566566657665866596660666166626663666466656666666766686669667066716672667366746675667666776678667966806681668266836684668566866687668866896690669166926693669466956696669766986699670067016702670367046705670667076708670967106711671267136714671567166717671867196720672167226723672467256726672767286729673067316732673367346735673667376738673967406741674267436744674567466747674867496750675167526753675467556756675767586759676067616762676367646765676667676768676967706771677267736774677567766777677867796780678167826783678467856786678767886789679067916792679367946795679667976798679968006801680268036804680568066807680868096810681168126813681468156816681768186819682068216822682368246825682668276828682968306831683268336834683568366837683868396840684168426843684468456846684768486849685068516852685368546855685668576858685968606861686268636864686568666867686868696870687168726873687468756876687768786879688068816882688368846885688668876888688968906891689268936894689568966897689868996900
  1. /*
  2. * This is the new netlink-based wireless configuration interface.
  3. *
  4. * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
  5. */
  6. #include <linux/if.h>
  7. #include <linux/module.h>
  8. #include <linux/err.h>
  9. #include <linux/slab.h>
  10. #include <linux/list.h>
  11. #include <linux/if_ether.h>
  12. #include <linux/ieee80211.h>
  13. #include <linux/nl80211.h>
  14. #include <linux/rtnetlink.h>
  15. #include <linux/netlink.h>
  16. #include <linux/etherdevice.h>
  17. #include <net/net_namespace.h>
  18. #include <net/genetlink.h>
  19. #include <net/cfg80211.h>
  20. #include <net/sock.h>
  21. #include "core.h"
  22. #include "nl80211.h"
  23. #include "reg.h"
  24. static int nl80211_pre_doit(struct genl_ops *ops, struct sk_buff *skb,
  25. struct genl_info *info);
  26. static void nl80211_post_doit(struct genl_ops *ops, struct sk_buff *skb,
  27. struct genl_info *info);
  28. /* the netlink family */
  29. static struct genl_family nl80211_fam = {
  30. .id = GENL_ID_GENERATE, /* don't bother with a hardcoded ID */
  31. .name = "nl80211", /* have users key off the name instead */
  32. .hdrsize = 0, /* no private header */
  33. .version = 1, /* no particular meaning now */
  34. .maxattr = NL80211_ATTR_MAX,
  35. .netnsok = true,
  36. .pre_doit = nl80211_pre_doit,
  37. .post_doit = nl80211_post_doit,
  38. };
  39. /* internal helper: get rdev and dev */
  40. static int get_rdev_dev_by_info_ifindex(struct genl_info *info,
  41. struct cfg80211_registered_device **rdev,
  42. struct net_device **dev)
  43. {
  44. struct nlattr **attrs = info->attrs;
  45. int ifindex;
  46. if (!attrs[NL80211_ATTR_IFINDEX])
  47. return -EINVAL;
  48. ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  49. *dev = dev_get_by_index(genl_info_net(info), ifindex);
  50. if (!*dev)
  51. return -ENODEV;
  52. *rdev = cfg80211_get_dev_from_ifindex(genl_info_net(info), ifindex);
  53. if (IS_ERR(*rdev)) {
  54. dev_put(*dev);
  55. return PTR_ERR(*rdev);
  56. }
  57. return 0;
  58. }
  59. /* policy for the attributes */
  60. static const struct nla_policy nl80211_policy[NL80211_ATTR_MAX+1] = {
  61. [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
  62. [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
  63. .len = 20-1 },
  64. [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
  65. [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
  66. [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
  67. [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
  68. [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
  69. [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
  70. [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
  71. [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
  72. [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
  73. [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
  74. [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
  75. [NL80211_ATTR_MAC] = { .type = NLA_BINARY, .len = ETH_ALEN },
  76. [NL80211_ATTR_PREV_BSSID] = { .type = NLA_BINARY, .len = ETH_ALEN },
  77. [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
  78. [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
  79. .len = WLAN_MAX_KEY_LEN },
  80. [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
  81. [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
  82. [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
  83. [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 8 },
  84. [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
  85. [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
  86. [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
  87. [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
  88. .len = IEEE80211_MAX_DATA_LEN },
  89. [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
  90. .len = IEEE80211_MAX_DATA_LEN },
  91. [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
  92. [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
  93. [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
  94. [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
  95. .len = NL80211_MAX_SUPP_RATES },
  96. [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
  97. [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
  98. [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
  99. [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
  100. .len = IEEE80211_MAX_MESH_ID_LEN },
  101. [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
  102. [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
  103. [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
  104. [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
  105. [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
  106. [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
  107. [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
  108. .len = NL80211_MAX_SUPP_RATES },
  109. [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
  110. [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
  111. [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
  112. [NL80211_ATTR_HT_CAPABILITY] = { .type = NLA_BINARY,
  113. .len = NL80211_HT_CAPABILITY_LEN },
  114. [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
  115. [NL80211_ATTR_IE] = { .type = NLA_BINARY,
  116. .len = IEEE80211_MAX_DATA_LEN },
  117. [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
  118. [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
  119. [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
  120. .len = IEEE80211_MAX_SSID_LEN },
  121. [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
  122. [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
  123. [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
  124. [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
  125. [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
  126. [NL80211_ATTR_STA_FLAGS2] = {
  127. .len = sizeof(struct nl80211_sta_flag_update),
  128. },
  129. [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
  130. [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
  131. [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
  132. [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
  133. [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
  134. [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
  135. [NL80211_ATTR_PID] = { .type = NLA_U32 },
  136. [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
  137. [NL80211_ATTR_PMKID] = { .type = NLA_BINARY,
  138. .len = WLAN_PMKID_LEN },
  139. [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
  140. [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
  141. [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
  142. [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
  143. .len = IEEE80211_MAX_DATA_LEN },
  144. [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
  145. [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
  146. [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
  147. [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
  148. [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
  149. [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
  150. [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
  151. [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
  152. [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
  153. [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
  154. [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
  155. [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
  156. [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  157. [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
  158. [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
  159. [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
  160. };
  161. /* policy for the key attributes */
  162. static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
  163. [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
  164. [NL80211_KEY_IDX] = { .type = NLA_U8 },
  165. [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
  166. [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 8 },
  167. [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
  168. [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
  169. [NL80211_KEY_TYPE] = { .type = NLA_U32 },
  170. [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  171. };
  172. /* policy for the key default flags */
  173. static const struct nla_policy
  174. nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
  175. [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
  176. [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
  177. };
  178. /* policy for WoWLAN attributes */
  179. static const struct nla_policy
  180. nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
  181. [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
  182. [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
  183. [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
  184. [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
  185. };
  186. /* ifidx get helper */
  187. static int nl80211_get_ifidx(struct netlink_callback *cb)
  188. {
  189. int res;
  190. res = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
  191. nl80211_fam.attrbuf, nl80211_fam.maxattr,
  192. nl80211_policy);
  193. if (res)
  194. return res;
  195. if (!nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX])
  196. return -EINVAL;
  197. res = nla_get_u32(nl80211_fam.attrbuf[NL80211_ATTR_IFINDEX]);
  198. if (!res)
  199. return -EINVAL;
  200. return res;
  201. }
  202. static int nl80211_prepare_netdev_dump(struct sk_buff *skb,
  203. struct netlink_callback *cb,
  204. struct cfg80211_registered_device **rdev,
  205. struct net_device **dev)
  206. {
  207. int ifidx = cb->args[0];
  208. int err;
  209. if (!ifidx)
  210. ifidx = nl80211_get_ifidx(cb);
  211. if (ifidx < 0)
  212. return ifidx;
  213. cb->args[0] = ifidx;
  214. rtnl_lock();
  215. *dev = __dev_get_by_index(sock_net(skb->sk), ifidx);
  216. if (!*dev) {
  217. err = -ENODEV;
  218. goto out_rtnl;
  219. }
  220. *rdev = cfg80211_get_dev_from_ifindex(sock_net(skb->sk), ifidx);
  221. if (IS_ERR(*rdev)) {
  222. err = PTR_ERR(*rdev);
  223. goto out_rtnl;
  224. }
  225. return 0;
  226. out_rtnl:
  227. rtnl_unlock();
  228. return err;
  229. }
  230. static void nl80211_finish_netdev_dump(struct cfg80211_registered_device *rdev)
  231. {
  232. cfg80211_unlock_rdev(rdev);
  233. rtnl_unlock();
  234. }
  235. /* IE validation */
  236. static bool is_valid_ie_attr(const struct nlattr *attr)
  237. {
  238. const u8 *pos;
  239. int len;
  240. if (!attr)
  241. return true;
  242. pos = nla_data(attr);
  243. len = nla_len(attr);
  244. while (len) {
  245. u8 elemlen;
  246. if (len < 2)
  247. return false;
  248. len -= 2;
  249. elemlen = pos[1];
  250. if (elemlen > len)
  251. return false;
  252. len -= elemlen;
  253. pos += 2 + elemlen;
  254. }
  255. return true;
  256. }
  257. /* message building helper */
  258. static inline void *nl80211hdr_put(struct sk_buff *skb, u32 pid, u32 seq,
  259. int flags, u8 cmd)
  260. {
  261. /* since there is no private header just add the generic one */
  262. return genlmsg_put(skb, pid, seq, &nl80211_fam, flags, cmd);
  263. }
  264. static int nl80211_msg_put_channel(struct sk_buff *msg,
  265. struct ieee80211_channel *chan)
  266. {
  267. NLA_PUT_U32(msg, NL80211_FREQUENCY_ATTR_FREQ,
  268. chan->center_freq);
  269. if (chan->flags & IEEE80211_CHAN_DISABLED)
  270. NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_DISABLED);
  271. if (chan->flags & IEEE80211_CHAN_PASSIVE_SCAN)
  272. NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_PASSIVE_SCAN);
  273. if (chan->flags & IEEE80211_CHAN_NO_IBSS)
  274. NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_NO_IBSS);
  275. if (chan->flags & IEEE80211_CHAN_RADAR)
  276. NLA_PUT_FLAG(msg, NL80211_FREQUENCY_ATTR_RADAR);
  277. NLA_PUT_U32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
  278. DBM_TO_MBM(chan->max_power));
  279. return 0;
  280. nla_put_failure:
  281. return -ENOBUFS;
  282. }
  283. /* netlink command implementations */
  284. struct key_parse {
  285. struct key_params p;
  286. int idx;
  287. int type;
  288. bool def, defmgmt;
  289. bool def_uni, def_multi;
  290. };
  291. static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
  292. {
  293. struct nlattr *tb[NL80211_KEY_MAX + 1];
  294. int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
  295. nl80211_key_policy);
  296. if (err)
  297. return err;
  298. k->def = !!tb[NL80211_KEY_DEFAULT];
  299. k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
  300. if (k->def) {
  301. k->def_uni = true;
  302. k->def_multi = true;
  303. }
  304. if (k->defmgmt)
  305. k->def_multi = true;
  306. if (tb[NL80211_KEY_IDX])
  307. k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
  308. if (tb[NL80211_KEY_DATA]) {
  309. k->p.key = nla_data(tb[NL80211_KEY_DATA]);
  310. k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
  311. }
  312. if (tb[NL80211_KEY_SEQ]) {
  313. k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
  314. k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
  315. }
  316. if (tb[NL80211_KEY_CIPHER])
  317. k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
  318. if (tb[NL80211_KEY_TYPE]) {
  319. k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
  320. if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
  321. return -EINVAL;
  322. }
  323. if (tb[NL80211_KEY_DEFAULT_TYPES]) {
  324. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  325. int err = nla_parse_nested(kdt,
  326. NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  327. tb[NL80211_KEY_DEFAULT_TYPES],
  328. nl80211_key_default_policy);
  329. if (err)
  330. return err;
  331. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  332. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  333. }
  334. return 0;
  335. }
  336. static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
  337. {
  338. if (info->attrs[NL80211_ATTR_KEY_DATA]) {
  339. k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
  340. k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
  341. }
  342. if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
  343. k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
  344. k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
  345. }
  346. if (info->attrs[NL80211_ATTR_KEY_IDX])
  347. k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  348. if (info->attrs[NL80211_ATTR_KEY_CIPHER])
  349. k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
  350. k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
  351. k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
  352. if (k->def) {
  353. k->def_uni = true;
  354. k->def_multi = true;
  355. }
  356. if (k->defmgmt)
  357. k->def_multi = true;
  358. if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
  359. k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  360. if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
  361. return -EINVAL;
  362. }
  363. if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
  364. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  365. int err = nla_parse_nested(
  366. kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  367. info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
  368. nl80211_key_default_policy);
  369. if (err)
  370. return err;
  371. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  372. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  373. }
  374. return 0;
  375. }
  376. static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
  377. {
  378. int err;
  379. memset(k, 0, sizeof(*k));
  380. k->idx = -1;
  381. k->type = -1;
  382. if (info->attrs[NL80211_ATTR_KEY])
  383. err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
  384. else
  385. err = nl80211_parse_key_old(info, k);
  386. if (err)
  387. return err;
  388. if (k->def && k->defmgmt)
  389. return -EINVAL;
  390. if (k->defmgmt) {
  391. if (k->def_uni || !k->def_multi)
  392. return -EINVAL;
  393. }
  394. if (k->idx != -1) {
  395. if (k->defmgmt) {
  396. if (k->idx < 4 || k->idx > 5)
  397. return -EINVAL;
  398. } else if (k->def) {
  399. if (k->idx < 0 || k->idx > 3)
  400. return -EINVAL;
  401. } else {
  402. if (k->idx < 0 || k->idx > 5)
  403. return -EINVAL;
  404. }
  405. }
  406. return 0;
  407. }
  408. static struct cfg80211_cached_keys *
  409. nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
  410. struct nlattr *keys)
  411. {
  412. struct key_parse parse;
  413. struct nlattr *key;
  414. struct cfg80211_cached_keys *result;
  415. int rem, err, def = 0;
  416. result = kzalloc(sizeof(*result), GFP_KERNEL);
  417. if (!result)
  418. return ERR_PTR(-ENOMEM);
  419. result->def = -1;
  420. result->defmgmt = -1;
  421. nla_for_each_nested(key, keys, rem) {
  422. memset(&parse, 0, sizeof(parse));
  423. parse.idx = -1;
  424. err = nl80211_parse_key_new(key, &parse);
  425. if (err)
  426. goto error;
  427. err = -EINVAL;
  428. if (!parse.p.key)
  429. goto error;
  430. if (parse.idx < 0 || parse.idx > 4)
  431. goto error;
  432. if (parse.def) {
  433. if (def)
  434. goto error;
  435. def = 1;
  436. result->def = parse.idx;
  437. if (!parse.def_uni || !parse.def_multi)
  438. goto error;
  439. } else if (parse.defmgmt)
  440. goto error;
  441. err = cfg80211_validate_key_settings(rdev, &parse.p,
  442. parse.idx, false, NULL);
  443. if (err)
  444. goto error;
  445. result->params[parse.idx].cipher = parse.p.cipher;
  446. result->params[parse.idx].key_len = parse.p.key_len;
  447. result->params[parse.idx].key = result->data[parse.idx];
  448. memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
  449. }
  450. return result;
  451. error:
  452. kfree(result);
  453. return ERR_PTR(err);
  454. }
  455. static int nl80211_key_allowed(struct wireless_dev *wdev)
  456. {
  457. ASSERT_WDEV_LOCK(wdev);
  458. switch (wdev->iftype) {
  459. case NL80211_IFTYPE_AP:
  460. case NL80211_IFTYPE_AP_VLAN:
  461. case NL80211_IFTYPE_P2P_GO:
  462. case NL80211_IFTYPE_MESH_POINT:
  463. break;
  464. case NL80211_IFTYPE_ADHOC:
  465. if (!wdev->current_bss)
  466. return -ENOLINK;
  467. break;
  468. case NL80211_IFTYPE_STATION:
  469. case NL80211_IFTYPE_P2P_CLIENT:
  470. if (wdev->sme_state != CFG80211_SME_CONNECTED)
  471. return -ENOLINK;
  472. break;
  473. default:
  474. return -EINVAL;
  475. }
  476. return 0;
  477. }
  478. static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
  479. {
  480. struct nlattr *nl_modes = nla_nest_start(msg, attr);
  481. int i;
  482. if (!nl_modes)
  483. goto nla_put_failure;
  484. i = 0;
  485. while (ifmodes) {
  486. if (ifmodes & 1)
  487. NLA_PUT_FLAG(msg, i);
  488. ifmodes >>= 1;
  489. i++;
  490. }
  491. nla_nest_end(msg, nl_modes);
  492. return 0;
  493. nla_put_failure:
  494. return -ENOBUFS;
  495. }
  496. static int nl80211_put_iface_combinations(struct wiphy *wiphy,
  497. struct sk_buff *msg)
  498. {
  499. struct nlattr *nl_combis;
  500. int i, j;
  501. nl_combis = nla_nest_start(msg,
  502. NL80211_ATTR_INTERFACE_COMBINATIONS);
  503. if (!nl_combis)
  504. goto nla_put_failure;
  505. for (i = 0; i < wiphy->n_iface_combinations; i++) {
  506. const struct ieee80211_iface_combination *c;
  507. struct nlattr *nl_combi, *nl_limits;
  508. c = &wiphy->iface_combinations[i];
  509. nl_combi = nla_nest_start(msg, i + 1);
  510. if (!nl_combi)
  511. goto nla_put_failure;
  512. nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
  513. if (!nl_limits)
  514. goto nla_put_failure;
  515. for (j = 0; j < c->n_limits; j++) {
  516. struct nlattr *nl_limit;
  517. nl_limit = nla_nest_start(msg, j + 1);
  518. if (!nl_limit)
  519. goto nla_put_failure;
  520. NLA_PUT_U32(msg, NL80211_IFACE_LIMIT_MAX,
  521. c->limits[j].max);
  522. if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
  523. c->limits[j].types))
  524. goto nla_put_failure;
  525. nla_nest_end(msg, nl_limit);
  526. }
  527. nla_nest_end(msg, nl_limits);
  528. if (c->beacon_int_infra_match)
  529. NLA_PUT_FLAG(msg,
  530. NL80211_IFACE_COMB_STA_AP_BI_MATCH);
  531. NLA_PUT_U32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
  532. c->num_different_channels);
  533. NLA_PUT_U32(msg, NL80211_IFACE_COMB_MAXNUM,
  534. c->max_interfaces);
  535. nla_nest_end(msg, nl_combi);
  536. }
  537. nla_nest_end(msg, nl_combis);
  538. return 0;
  539. nla_put_failure:
  540. return -ENOBUFS;
  541. }
  542. static int nl80211_send_wiphy(struct sk_buff *msg, u32 pid, u32 seq, int flags,
  543. struct cfg80211_registered_device *dev)
  544. {
  545. void *hdr;
  546. struct nlattr *nl_bands, *nl_band;
  547. struct nlattr *nl_freqs, *nl_freq;
  548. struct nlattr *nl_rates, *nl_rate;
  549. struct nlattr *nl_cmds;
  550. enum ieee80211_band band;
  551. struct ieee80211_channel *chan;
  552. struct ieee80211_rate *rate;
  553. int i;
  554. const struct ieee80211_txrx_stypes *mgmt_stypes =
  555. dev->wiphy.mgmt_stypes;
  556. hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_WIPHY);
  557. if (!hdr)
  558. return -1;
  559. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, dev->wiphy_idx);
  560. NLA_PUT_STRING(msg, NL80211_ATTR_WIPHY_NAME, wiphy_name(&dev->wiphy));
  561. NLA_PUT_U32(msg, NL80211_ATTR_GENERATION,
  562. cfg80211_rdev_list_generation);
  563. NLA_PUT_U8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
  564. dev->wiphy.retry_short);
  565. NLA_PUT_U8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
  566. dev->wiphy.retry_long);
  567. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
  568. dev->wiphy.frag_threshold);
  569. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
  570. dev->wiphy.rts_threshold);
  571. NLA_PUT_U8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
  572. dev->wiphy.coverage_class);
  573. NLA_PUT_U8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
  574. dev->wiphy.max_scan_ssids);
  575. NLA_PUT_U16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
  576. dev->wiphy.max_scan_ie_len);
  577. if (dev->wiphy.flags & WIPHY_FLAG_IBSS_RSN)
  578. NLA_PUT_FLAG(msg, NL80211_ATTR_SUPPORT_IBSS_RSN);
  579. if (dev->wiphy.flags & WIPHY_FLAG_MESH_AUTH)
  580. NLA_PUT_FLAG(msg, NL80211_ATTR_SUPPORT_MESH_AUTH);
  581. NLA_PUT(msg, NL80211_ATTR_CIPHER_SUITES,
  582. sizeof(u32) * dev->wiphy.n_cipher_suites,
  583. dev->wiphy.cipher_suites);
  584. NLA_PUT_U8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
  585. dev->wiphy.max_num_pmkids);
  586. if (dev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL)
  587. NLA_PUT_FLAG(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE);
  588. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
  589. dev->wiphy.available_antennas_tx);
  590. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
  591. dev->wiphy.available_antennas_rx);
  592. if ((dev->wiphy.available_antennas_tx ||
  593. dev->wiphy.available_antennas_rx) && dev->ops->get_antenna) {
  594. u32 tx_ant = 0, rx_ant = 0;
  595. int res;
  596. res = dev->ops->get_antenna(&dev->wiphy, &tx_ant, &rx_ant);
  597. if (!res) {
  598. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_ANTENNA_TX, tx_ant);
  599. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_ANTENNA_RX, rx_ant);
  600. }
  601. }
  602. if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
  603. dev->wiphy.interface_modes))
  604. goto nla_put_failure;
  605. nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
  606. if (!nl_bands)
  607. goto nla_put_failure;
  608. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  609. if (!dev->wiphy.bands[band])
  610. continue;
  611. nl_band = nla_nest_start(msg, band);
  612. if (!nl_band)
  613. goto nla_put_failure;
  614. /* add HT info */
  615. if (dev->wiphy.bands[band]->ht_cap.ht_supported) {
  616. NLA_PUT(msg, NL80211_BAND_ATTR_HT_MCS_SET,
  617. sizeof(dev->wiphy.bands[band]->ht_cap.mcs),
  618. &dev->wiphy.bands[band]->ht_cap.mcs);
  619. NLA_PUT_U16(msg, NL80211_BAND_ATTR_HT_CAPA,
  620. dev->wiphy.bands[band]->ht_cap.cap);
  621. NLA_PUT_U8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
  622. dev->wiphy.bands[band]->ht_cap.ampdu_factor);
  623. NLA_PUT_U8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
  624. dev->wiphy.bands[band]->ht_cap.ampdu_density);
  625. }
  626. /* add frequencies */
  627. nl_freqs = nla_nest_start(msg, NL80211_BAND_ATTR_FREQS);
  628. if (!nl_freqs)
  629. goto nla_put_failure;
  630. for (i = 0; i < dev->wiphy.bands[band]->n_channels; i++) {
  631. nl_freq = nla_nest_start(msg, i);
  632. if (!nl_freq)
  633. goto nla_put_failure;
  634. chan = &dev->wiphy.bands[band]->channels[i];
  635. if (nl80211_msg_put_channel(msg, chan))
  636. goto nla_put_failure;
  637. nla_nest_end(msg, nl_freq);
  638. }
  639. nla_nest_end(msg, nl_freqs);
  640. /* add bitrates */
  641. nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
  642. if (!nl_rates)
  643. goto nla_put_failure;
  644. for (i = 0; i < dev->wiphy.bands[band]->n_bitrates; i++) {
  645. nl_rate = nla_nest_start(msg, i);
  646. if (!nl_rate)
  647. goto nla_put_failure;
  648. rate = &dev->wiphy.bands[band]->bitrates[i];
  649. NLA_PUT_U32(msg, NL80211_BITRATE_ATTR_RATE,
  650. rate->bitrate);
  651. if (rate->flags & IEEE80211_RATE_SHORT_PREAMBLE)
  652. NLA_PUT_FLAG(msg,
  653. NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE);
  654. nla_nest_end(msg, nl_rate);
  655. }
  656. nla_nest_end(msg, nl_rates);
  657. nla_nest_end(msg, nl_band);
  658. }
  659. nla_nest_end(msg, nl_bands);
  660. nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
  661. if (!nl_cmds)
  662. goto nla_put_failure;
  663. i = 0;
  664. #define CMD(op, n) \
  665. do { \
  666. if (dev->ops->op) { \
  667. i++; \
  668. NLA_PUT_U32(msg, i, NL80211_CMD_ ## n); \
  669. } \
  670. } while (0)
  671. CMD(add_virtual_intf, NEW_INTERFACE);
  672. CMD(change_virtual_intf, SET_INTERFACE);
  673. CMD(add_key, NEW_KEY);
  674. CMD(add_beacon, NEW_BEACON);
  675. CMD(add_station, NEW_STATION);
  676. CMD(add_mpath, NEW_MPATH);
  677. CMD(update_mesh_config, SET_MESH_CONFIG);
  678. CMD(change_bss, SET_BSS);
  679. CMD(auth, AUTHENTICATE);
  680. CMD(assoc, ASSOCIATE);
  681. CMD(deauth, DEAUTHENTICATE);
  682. CMD(disassoc, DISASSOCIATE);
  683. CMD(join_ibss, JOIN_IBSS);
  684. CMD(join_mesh, JOIN_MESH);
  685. CMD(set_pmksa, SET_PMKSA);
  686. CMD(del_pmksa, DEL_PMKSA);
  687. CMD(flush_pmksa, FLUSH_PMKSA);
  688. CMD(remain_on_channel, REMAIN_ON_CHANNEL);
  689. CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
  690. CMD(mgmt_tx, FRAME);
  691. CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
  692. if (dev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
  693. i++;
  694. NLA_PUT_U32(msg, i, NL80211_CMD_SET_WIPHY_NETNS);
  695. }
  696. CMD(set_channel, SET_CHANNEL);
  697. CMD(set_wds_peer, SET_WDS_PEER);
  698. if (dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
  699. CMD(sched_scan_start, START_SCHED_SCAN);
  700. #undef CMD
  701. if (dev->ops->connect || dev->ops->auth) {
  702. i++;
  703. NLA_PUT_U32(msg, i, NL80211_CMD_CONNECT);
  704. }
  705. if (dev->ops->disconnect || dev->ops->deauth) {
  706. i++;
  707. NLA_PUT_U32(msg, i, NL80211_CMD_DISCONNECT);
  708. }
  709. nla_nest_end(msg, nl_cmds);
  710. if (dev->ops->remain_on_channel)
  711. NLA_PUT_U32(msg, NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
  712. dev->wiphy.max_remain_on_channel_duration);
  713. /* for now at least assume all drivers have it */
  714. if (dev->ops->mgmt_tx)
  715. NLA_PUT_FLAG(msg, NL80211_ATTR_OFFCHANNEL_TX_OK);
  716. if (mgmt_stypes) {
  717. u16 stypes;
  718. struct nlattr *nl_ftypes, *nl_ifs;
  719. enum nl80211_iftype ift;
  720. nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
  721. if (!nl_ifs)
  722. goto nla_put_failure;
  723. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  724. nl_ftypes = nla_nest_start(msg, ift);
  725. if (!nl_ftypes)
  726. goto nla_put_failure;
  727. i = 0;
  728. stypes = mgmt_stypes[ift].tx;
  729. while (stypes) {
  730. if (stypes & 1)
  731. NLA_PUT_U16(msg, NL80211_ATTR_FRAME_TYPE,
  732. (i << 4) | IEEE80211_FTYPE_MGMT);
  733. stypes >>= 1;
  734. i++;
  735. }
  736. nla_nest_end(msg, nl_ftypes);
  737. }
  738. nla_nest_end(msg, nl_ifs);
  739. nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
  740. if (!nl_ifs)
  741. goto nla_put_failure;
  742. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  743. nl_ftypes = nla_nest_start(msg, ift);
  744. if (!nl_ftypes)
  745. goto nla_put_failure;
  746. i = 0;
  747. stypes = mgmt_stypes[ift].rx;
  748. while (stypes) {
  749. if (stypes & 1)
  750. NLA_PUT_U16(msg, NL80211_ATTR_FRAME_TYPE,
  751. (i << 4) | IEEE80211_FTYPE_MGMT);
  752. stypes >>= 1;
  753. i++;
  754. }
  755. nla_nest_end(msg, nl_ftypes);
  756. }
  757. nla_nest_end(msg, nl_ifs);
  758. }
  759. if (dev->wiphy.wowlan.flags || dev->wiphy.wowlan.n_patterns) {
  760. struct nlattr *nl_wowlan;
  761. nl_wowlan = nla_nest_start(msg,
  762. NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
  763. if (!nl_wowlan)
  764. goto nla_put_failure;
  765. if (dev->wiphy.wowlan.flags & WIPHY_WOWLAN_ANY)
  766. NLA_PUT_FLAG(msg, NL80211_WOWLAN_TRIG_ANY);
  767. if (dev->wiphy.wowlan.flags & WIPHY_WOWLAN_DISCONNECT)
  768. NLA_PUT_FLAG(msg, NL80211_WOWLAN_TRIG_DISCONNECT);
  769. if (dev->wiphy.wowlan.flags & WIPHY_WOWLAN_MAGIC_PKT)
  770. NLA_PUT_FLAG(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT);
  771. if (dev->wiphy.wowlan.n_patterns) {
  772. struct nl80211_wowlan_pattern_support pat = {
  773. .max_patterns = dev->wiphy.wowlan.n_patterns,
  774. .min_pattern_len =
  775. dev->wiphy.wowlan.pattern_min_len,
  776. .max_pattern_len =
  777. dev->wiphy.wowlan.pattern_max_len,
  778. };
  779. NLA_PUT(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  780. sizeof(pat), &pat);
  781. }
  782. nla_nest_end(msg, nl_wowlan);
  783. }
  784. if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
  785. dev->wiphy.software_iftypes))
  786. goto nla_put_failure;
  787. if (nl80211_put_iface_combinations(&dev->wiphy, msg))
  788. goto nla_put_failure;
  789. return genlmsg_end(msg, hdr);
  790. nla_put_failure:
  791. genlmsg_cancel(msg, hdr);
  792. return -EMSGSIZE;
  793. }
  794. static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
  795. {
  796. int idx = 0;
  797. int start = cb->args[0];
  798. struct cfg80211_registered_device *dev;
  799. mutex_lock(&cfg80211_mutex);
  800. list_for_each_entry(dev, &cfg80211_rdev_list, list) {
  801. if (!net_eq(wiphy_net(&dev->wiphy), sock_net(skb->sk)))
  802. continue;
  803. if (++idx <= start)
  804. continue;
  805. if (nl80211_send_wiphy(skb, NETLINK_CB(cb->skb).pid,
  806. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  807. dev) < 0) {
  808. idx--;
  809. break;
  810. }
  811. }
  812. mutex_unlock(&cfg80211_mutex);
  813. cb->args[0] = idx;
  814. return skb->len;
  815. }
  816. static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
  817. {
  818. struct sk_buff *msg;
  819. struct cfg80211_registered_device *dev = info->user_ptr[0];
  820. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  821. if (!msg)
  822. return -ENOMEM;
  823. if (nl80211_send_wiphy(msg, info->snd_pid, info->snd_seq, 0, dev) < 0) {
  824. nlmsg_free(msg);
  825. return -ENOBUFS;
  826. }
  827. return genlmsg_reply(msg, info);
  828. }
  829. static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
  830. [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
  831. [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
  832. [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
  833. [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
  834. [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
  835. };
  836. static int parse_txq_params(struct nlattr *tb[],
  837. struct ieee80211_txq_params *txq_params)
  838. {
  839. if (!tb[NL80211_TXQ_ATTR_QUEUE] || !tb[NL80211_TXQ_ATTR_TXOP] ||
  840. !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
  841. !tb[NL80211_TXQ_ATTR_AIFS])
  842. return -EINVAL;
  843. txq_params->queue = nla_get_u8(tb[NL80211_TXQ_ATTR_QUEUE]);
  844. txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
  845. txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
  846. txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
  847. txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
  848. return 0;
  849. }
  850. static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
  851. {
  852. /*
  853. * You can only set the channel explicitly for AP, mesh
  854. * and WDS type interfaces; all others have their channel
  855. * managed via their respective "establish a connection"
  856. * command (connect, join, ...)
  857. *
  858. * Monitors are special as they are normally slaved to
  859. * whatever else is going on, so they behave as though
  860. * you tried setting the wiphy channel itself.
  861. */
  862. return !wdev ||
  863. wdev->iftype == NL80211_IFTYPE_AP ||
  864. wdev->iftype == NL80211_IFTYPE_WDS ||
  865. wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
  866. wdev->iftype == NL80211_IFTYPE_MONITOR ||
  867. wdev->iftype == NL80211_IFTYPE_P2P_GO;
  868. }
  869. static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
  870. struct wireless_dev *wdev,
  871. struct genl_info *info)
  872. {
  873. enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
  874. u32 freq;
  875. int result;
  876. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  877. return -EINVAL;
  878. if (!nl80211_can_set_dev_channel(wdev))
  879. return -EOPNOTSUPP;
  880. if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
  881. channel_type = nla_get_u32(info->attrs[
  882. NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
  883. if (channel_type != NL80211_CHAN_NO_HT &&
  884. channel_type != NL80211_CHAN_HT20 &&
  885. channel_type != NL80211_CHAN_HT40PLUS &&
  886. channel_type != NL80211_CHAN_HT40MINUS)
  887. return -EINVAL;
  888. }
  889. freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
  890. mutex_lock(&rdev->devlist_mtx);
  891. if (wdev) {
  892. wdev_lock(wdev);
  893. result = cfg80211_set_freq(rdev, wdev, freq, channel_type);
  894. wdev_unlock(wdev);
  895. } else {
  896. result = cfg80211_set_freq(rdev, NULL, freq, channel_type);
  897. }
  898. mutex_unlock(&rdev->devlist_mtx);
  899. return result;
  900. }
  901. static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
  902. {
  903. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  904. struct net_device *netdev = info->user_ptr[1];
  905. return __nl80211_set_channel(rdev, netdev->ieee80211_ptr, info);
  906. }
  907. static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
  908. {
  909. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  910. struct net_device *dev = info->user_ptr[1];
  911. struct wireless_dev *wdev = dev->ieee80211_ptr;
  912. const u8 *bssid;
  913. if (!info->attrs[NL80211_ATTR_MAC])
  914. return -EINVAL;
  915. if (netif_running(dev))
  916. return -EBUSY;
  917. if (!rdev->ops->set_wds_peer)
  918. return -EOPNOTSUPP;
  919. if (wdev->iftype != NL80211_IFTYPE_WDS)
  920. return -EOPNOTSUPP;
  921. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  922. return rdev->ops->set_wds_peer(wdev->wiphy, dev, bssid);
  923. }
  924. static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
  925. {
  926. struct cfg80211_registered_device *rdev;
  927. struct net_device *netdev = NULL;
  928. struct wireless_dev *wdev;
  929. int result = 0, rem_txq_params = 0;
  930. struct nlattr *nl_txq_params;
  931. u32 changed;
  932. u8 retry_short = 0, retry_long = 0;
  933. u32 frag_threshold = 0, rts_threshold = 0;
  934. u8 coverage_class = 0;
  935. /*
  936. * Try to find the wiphy and netdev. Normally this
  937. * function shouldn't need the netdev, but this is
  938. * done for backward compatibility -- previously
  939. * setting the channel was done per wiphy, but now
  940. * it is per netdev. Previous userland like hostapd
  941. * also passed a netdev to set_wiphy, so that it is
  942. * possible to let that go to the right netdev!
  943. */
  944. mutex_lock(&cfg80211_mutex);
  945. if (info->attrs[NL80211_ATTR_IFINDEX]) {
  946. int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
  947. netdev = dev_get_by_index(genl_info_net(info), ifindex);
  948. if (netdev && netdev->ieee80211_ptr) {
  949. rdev = wiphy_to_dev(netdev->ieee80211_ptr->wiphy);
  950. mutex_lock(&rdev->mtx);
  951. } else
  952. netdev = NULL;
  953. }
  954. if (!netdev) {
  955. rdev = __cfg80211_rdev_from_info(info);
  956. if (IS_ERR(rdev)) {
  957. mutex_unlock(&cfg80211_mutex);
  958. return PTR_ERR(rdev);
  959. }
  960. wdev = NULL;
  961. netdev = NULL;
  962. result = 0;
  963. mutex_lock(&rdev->mtx);
  964. } else if (netif_running(netdev) &&
  965. nl80211_can_set_dev_channel(netdev->ieee80211_ptr))
  966. wdev = netdev->ieee80211_ptr;
  967. else
  968. wdev = NULL;
  969. /*
  970. * end workaround code, by now the rdev is available
  971. * and locked, and wdev may or may not be NULL.
  972. */
  973. if (info->attrs[NL80211_ATTR_WIPHY_NAME])
  974. result = cfg80211_dev_rename(
  975. rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
  976. mutex_unlock(&cfg80211_mutex);
  977. if (result)
  978. goto bad_res;
  979. if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
  980. struct ieee80211_txq_params txq_params;
  981. struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
  982. if (!rdev->ops->set_txq_params) {
  983. result = -EOPNOTSUPP;
  984. goto bad_res;
  985. }
  986. nla_for_each_nested(nl_txq_params,
  987. info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
  988. rem_txq_params) {
  989. nla_parse(tb, NL80211_TXQ_ATTR_MAX,
  990. nla_data(nl_txq_params),
  991. nla_len(nl_txq_params),
  992. txq_params_policy);
  993. result = parse_txq_params(tb, &txq_params);
  994. if (result)
  995. goto bad_res;
  996. result = rdev->ops->set_txq_params(&rdev->wiphy,
  997. &txq_params);
  998. if (result)
  999. goto bad_res;
  1000. }
  1001. }
  1002. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  1003. result = __nl80211_set_channel(rdev, wdev, info);
  1004. if (result)
  1005. goto bad_res;
  1006. }
  1007. if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
  1008. enum nl80211_tx_power_setting type;
  1009. int idx, mbm = 0;
  1010. if (!rdev->ops->set_tx_power) {
  1011. result = -EOPNOTSUPP;
  1012. goto bad_res;
  1013. }
  1014. idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
  1015. type = nla_get_u32(info->attrs[idx]);
  1016. if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
  1017. (type != NL80211_TX_POWER_AUTOMATIC)) {
  1018. result = -EINVAL;
  1019. goto bad_res;
  1020. }
  1021. if (type != NL80211_TX_POWER_AUTOMATIC) {
  1022. idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
  1023. mbm = nla_get_u32(info->attrs[idx]);
  1024. }
  1025. result = rdev->ops->set_tx_power(&rdev->wiphy, type, mbm);
  1026. if (result)
  1027. goto bad_res;
  1028. }
  1029. if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
  1030. info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
  1031. u32 tx_ant, rx_ant;
  1032. if ((!rdev->wiphy.available_antennas_tx &&
  1033. !rdev->wiphy.available_antennas_rx) ||
  1034. !rdev->ops->set_antenna) {
  1035. result = -EOPNOTSUPP;
  1036. goto bad_res;
  1037. }
  1038. tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
  1039. rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
  1040. /* reject antenna configurations which don't match the
  1041. * available antenna masks, except for the "all" mask */
  1042. if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
  1043. (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) {
  1044. result = -EINVAL;
  1045. goto bad_res;
  1046. }
  1047. tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
  1048. rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
  1049. result = rdev->ops->set_antenna(&rdev->wiphy, tx_ant, rx_ant);
  1050. if (result)
  1051. goto bad_res;
  1052. }
  1053. changed = 0;
  1054. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
  1055. retry_short = nla_get_u8(
  1056. info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
  1057. if (retry_short == 0) {
  1058. result = -EINVAL;
  1059. goto bad_res;
  1060. }
  1061. changed |= WIPHY_PARAM_RETRY_SHORT;
  1062. }
  1063. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
  1064. retry_long = nla_get_u8(
  1065. info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
  1066. if (retry_long == 0) {
  1067. result = -EINVAL;
  1068. goto bad_res;
  1069. }
  1070. changed |= WIPHY_PARAM_RETRY_LONG;
  1071. }
  1072. if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
  1073. frag_threshold = nla_get_u32(
  1074. info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
  1075. if (frag_threshold < 256) {
  1076. result = -EINVAL;
  1077. goto bad_res;
  1078. }
  1079. if (frag_threshold != (u32) -1) {
  1080. /*
  1081. * Fragments (apart from the last one) are required to
  1082. * have even length. Make the fragmentation code
  1083. * simpler by stripping LSB should someone try to use
  1084. * odd threshold value.
  1085. */
  1086. frag_threshold &= ~0x1;
  1087. }
  1088. changed |= WIPHY_PARAM_FRAG_THRESHOLD;
  1089. }
  1090. if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
  1091. rts_threshold = nla_get_u32(
  1092. info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
  1093. changed |= WIPHY_PARAM_RTS_THRESHOLD;
  1094. }
  1095. if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
  1096. coverage_class = nla_get_u8(
  1097. info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
  1098. changed |= WIPHY_PARAM_COVERAGE_CLASS;
  1099. }
  1100. if (changed) {
  1101. u8 old_retry_short, old_retry_long;
  1102. u32 old_frag_threshold, old_rts_threshold;
  1103. u8 old_coverage_class;
  1104. if (!rdev->ops->set_wiphy_params) {
  1105. result = -EOPNOTSUPP;
  1106. goto bad_res;
  1107. }
  1108. old_retry_short = rdev->wiphy.retry_short;
  1109. old_retry_long = rdev->wiphy.retry_long;
  1110. old_frag_threshold = rdev->wiphy.frag_threshold;
  1111. old_rts_threshold = rdev->wiphy.rts_threshold;
  1112. old_coverage_class = rdev->wiphy.coverage_class;
  1113. if (changed & WIPHY_PARAM_RETRY_SHORT)
  1114. rdev->wiphy.retry_short = retry_short;
  1115. if (changed & WIPHY_PARAM_RETRY_LONG)
  1116. rdev->wiphy.retry_long = retry_long;
  1117. if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
  1118. rdev->wiphy.frag_threshold = frag_threshold;
  1119. if (changed & WIPHY_PARAM_RTS_THRESHOLD)
  1120. rdev->wiphy.rts_threshold = rts_threshold;
  1121. if (changed & WIPHY_PARAM_COVERAGE_CLASS)
  1122. rdev->wiphy.coverage_class = coverage_class;
  1123. result = rdev->ops->set_wiphy_params(&rdev->wiphy, changed);
  1124. if (result) {
  1125. rdev->wiphy.retry_short = old_retry_short;
  1126. rdev->wiphy.retry_long = old_retry_long;
  1127. rdev->wiphy.frag_threshold = old_frag_threshold;
  1128. rdev->wiphy.rts_threshold = old_rts_threshold;
  1129. rdev->wiphy.coverage_class = old_coverage_class;
  1130. }
  1131. }
  1132. bad_res:
  1133. mutex_unlock(&rdev->mtx);
  1134. if (netdev)
  1135. dev_put(netdev);
  1136. return result;
  1137. }
  1138. static int nl80211_send_iface(struct sk_buff *msg, u32 pid, u32 seq, int flags,
  1139. struct cfg80211_registered_device *rdev,
  1140. struct net_device *dev)
  1141. {
  1142. void *hdr;
  1143. hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_INTERFACE);
  1144. if (!hdr)
  1145. return -1;
  1146. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
  1147. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  1148. NLA_PUT_STRING(msg, NL80211_ATTR_IFNAME, dev->name);
  1149. NLA_PUT_U32(msg, NL80211_ATTR_IFTYPE, dev->ieee80211_ptr->iftype);
  1150. NLA_PUT_U32(msg, NL80211_ATTR_GENERATION,
  1151. rdev->devlist_generation ^
  1152. (cfg80211_rdev_list_generation << 2));
  1153. return genlmsg_end(msg, hdr);
  1154. nla_put_failure:
  1155. genlmsg_cancel(msg, hdr);
  1156. return -EMSGSIZE;
  1157. }
  1158. static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
  1159. {
  1160. int wp_idx = 0;
  1161. int if_idx = 0;
  1162. int wp_start = cb->args[0];
  1163. int if_start = cb->args[1];
  1164. struct cfg80211_registered_device *rdev;
  1165. struct wireless_dev *wdev;
  1166. mutex_lock(&cfg80211_mutex);
  1167. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  1168. if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
  1169. continue;
  1170. if (wp_idx < wp_start) {
  1171. wp_idx++;
  1172. continue;
  1173. }
  1174. if_idx = 0;
  1175. mutex_lock(&rdev->devlist_mtx);
  1176. list_for_each_entry(wdev, &rdev->netdev_list, list) {
  1177. if (if_idx < if_start) {
  1178. if_idx++;
  1179. continue;
  1180. }
  1181. if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).pid,
  1182. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  1183. rdev, wdev->netdev) < 0) {
  1184. mutex_unlock(&rdev->devlist_mtx);
  1185. goto out;
  1186. }
  1187. if_idx++;
  1188. }
  1189. mutex_unlock(&rdev->devlist_mtx);
  1190. wp_idx++;
  1191. }
  1192. out:
  1193. mutex_unlock(&cfg80211_mutex);
  1194. cb->args[0] = wp_idx;
  1195. cb->args[1] = if_idx;
  1196. return skb->len;
  1197. }
  1198. static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
  1199. {
  1200. struct sk_buff *msg;
  1201. struct cfg80211_registered_device *dev = info->user_ptr[0];
  1202. struct net_device *netdev = info->user_ptr[1];
  1203. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  1204. if (!msg)
  1205. return -ENOMEM;
  1206. if (nl80211_send_iface(msg, info->snd_pid, info->snd_seq, 0,
  1207. dev, netdev) < 0) {
  1208. nlmsg_free(msg);
  1209. return -ENOBUFS;
  1210. }
  1211. return genlmsg_reply(msg, info);
  1212. }
  1213. static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
  1214. [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
  1215. [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
  1216. [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
  1217. [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
  1218. [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
  1219. };
  1220. static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
  1221. {
  1222. struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
  1223. int flag;
  1224. *mntrflags = 0;
  1225. if (!nla)
  1226. return -EINVAL;
  1227. if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
  1228. nla, mntr_flags_policy))
  1229. return -EINVAL;
  1230. for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
  1231. if (flags[flag])
  1232. *mntrflags |= (1<<flag);
  1233. return 0;
  1234. }
  1235. static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
  1236. struct net_device *netdev, u8 use_4addr,
  1237. enum nl80211_iftype iftype)
  1238. {
  1239. if (!use_4addr) {
  1240. if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
  1241. return -EBUSY;
  1242. return 0;
  1243. }
  1244. switch (iftype) {
  1245. case NL80211_IFTYPE_AP_VLAN:
  1246. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
  1247. return 0;
  1248. break;
  1249. case NL80211_IFTYPE_STATION:
  1250. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
  1251. return 0;
  1252. break;
  1253. default:
  1254. break;
  1255. }
  1256. return -EOPNOTSUPP;
  1257. }
  1258. static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
  1259. {
  1260. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1261. struct vif_params params;
  1262. int err;
  1263. enum nl80211_iftype otype, ntype;
  1264. struct net_device *dev = info->user_ptr[1];
  1265. u32 _flags, *flags = NULL;
  1266. bool change = false;
  1267. memset(&params, 0, sizeof(params));
  1268. otype = ntype = dev->ieee80211_ptr->iftype;
  1269. if (info->attrs[NL80211_ATTR_IFTYPE]) {
  1270. ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  1271. if (otype != ntype)
  1272. change = true;
  1273. if (ntype > NL80211_IFTYPE_MAX)
  1274. return -EINVAL;
  1275. }
  1276. if (info->attrs[NL80211_ATTR_MESH_ID]) {
  1277. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1278. if (ntype != NL80211_IFTYPE_MESH_POINT)
  1279. return -EINVAL;
  1280. if (netif_running(dev))
  1281. return -EBUSY;
  1282. wdev_lock(wdev);
  1283. BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
  1284. IEEE80211_MAX_MESH_ID_LEN);
  1285. wdev->mesh_id_up_len =
  1286. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  1287. memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  1288. wdev->mesh_id_up_len);
  1289. wdev_unlock(wdev);
  1290. }
  1291. if (info->attrs[NL80211_ATTR_4ADDR]) {
  1292. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  1293. change = true;
  1294. err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
  1295. if (err)
  1296. return err;
  1297. } else {
  1298. params.use_4addr = -1;
  1299. }
  1300. if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
  1301. if (ntype != NL80211_IFTYPE_MONITOR)
  1302. return -EINVAL;
  1303. err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
  1304. &_flags);
  1305. if (err)
  1306. return err;
  1307. flags = &_flags;
  1308. change = true;
  1309. }
  1310. if (change)
  1311. err = cfg80211_change_iface(rdev, dev, ntype, flags, &params);
  1312. else
  1313. err = 0;
  1314. if (!err && params.use_4addr != -1)
  1315. dev->ieee80211_ptr->use_4addr = params.use_4addr;
  1316. return err;
  1317. }
  1318. static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
  1319. {
  1320. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1321. struct vif_params params;
  1322. struct net_device *dev;
  1323. int err;
  1324. enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
  1325. u32 flags;
  1326. memset(&params, 0, sizeof(params));
  1327. if (!info->attrs[NL80211_ATTR_IFNAME])
  1328. return -EINVAL;
  1329. if (info->attrs[NL80211_ATTR_IFTYPE]) {
  1330. type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  1331. if (type > NL80211_IFTYPE_MAX)
  1332. return -EINVAL;
  1333. }
  1334. if (!rdev->ops->add_virtual_intf ||
  1335. !(rdev->wiphy.interface_modes & (1 << type)))
  1336. return -EOPNOTSUPP;
  1337. if (info->attrs[NL80211_ATTR_4ADDR]) {
  1338. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  1339. err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
  1340. if (err)
  1341. return err;
  1342. }
  1343. err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
  1344. info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
  1345. &flags);
  1346. dev = rdev->ops->add_virtual_intf(&rdev->wiphy,
  1347. nla_data(info->attrs[NL80211_ATTR_IFNAME]),
  1348. type, err ? NULL : &flags, &params);
  1349. if (IS_ERR(dev))
  1350. return PTR_ERR(dev);
  1351. if (type == NL80211_IFTYPE_MESH_POINT &&
  1352. info->attrs[NL80211_ATTR_MESH_ID]) {
  1353. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1354. wdev_lock(wdev);
  1355. BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
  1356. IEEE80211_MAX_MESH_ID_LEN);
  1357. wdev->mesh_id_up_len =
  1358. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  1359. memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  1360. wdev->mesh_id_up_len);
  1361. wdev_unlock(wdev);
  1362. }
  1363. return 0;
  1364. }
  1365. static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
  1366. {
  1367. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1368. struct net_device *dev = info->user_ptr[1];
  1369. if (!rdev->ops->del_virtual_intf)
  1370. return -EOPNOTSUPP;
  1371. return rdev->ops->del_virtual_intf(&rdev->wiphy, dev);
  1372. }
  1373. struct get_key_cookie {
  1374. struct sk_buff *msg;
  1375. int error;
  1376. int idx;
  1377. };
  1378. static void get_key_callback(void *c, struct key_params *params)
  1379. {
  1380. struct nlattr *key;
  1381. struct get_key_cookie *cookie = c;
  1382. if (params->key)
  1383. NLA_PUT(cookie->msg, NL80211_ATTR_KEY_DATA,
  1384. params->key_len, params->key);
  1385. if (params->seq)
  1386. NLA_PUT(cookie->msg, NL80211_ATTR_KEY_SEQ,
  1387. params->seq_len, params->seq);
  1388. if (params->cipher)
  1389. NLA_PUT_U32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
  1390. params->cipher);
  1391. key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
  1392. if (!key)
  1393. goto nla_put_failure;
  1394. if (params->key)
  1395. NLA_PUT(cookie->msg, NL80211_KEY_DATA,
  1396. params->key_len, params->key);
  1397. if (params->seq)
  1398. NLA_PUT(cookie->msg, NL80211_KEY_SEQ,
  1399. params->seq_len, params->seq);
  1400. if (params->cipher)
  1401. NLA_PUT_U32(cookie->msg, NL80211_KEY_CIPHER,
  1402. params->cipher);
  1403. NLA_PUT_U8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx);
  1404. nla_nest_end(cookie->msg, key);
  1405. return;
  1406. nla_put_failure:
  1407. cookie->error = 1;
  1408. }
  1409. static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
  1410. {
  1411. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1412. int err;
  1413. struct net_device *dev = info->user_ptr[1];
  1414. u8 key_idx = 0;
  1415. const u8 *mac_addr = NULL;
  1416. bool pairwise;
  1417. struct get_key_cookie cookie = {
  1418. .error = 0,
  1419. };
  1420. void *hdr;
  1421. struct sk_buff *msg;
  1422. if (info->attrs[NL80211_ATTR_KEY_IDX])
  1423. key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  1424. if (key_idx > 5)
  1425. return -EINVAL;
  1426. if (info->attrs[NL80211_ATTR_MAC])
  1427. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  1428. pairwise = !!mac_addr;
  1429. if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
  1430. u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  1431. if (kt >= NUM_NL80211_KEYTYPES)
  1432. return -EINVAL;
  1433. if (kt != NL80211_KEYTYPE_GROUP &&
  1434. kt != NL80211_KEYTYPE_PAIRWISE)
  1435. return -EINVAL;
  1436. pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
  1437. }
  1438. if (!rdev->ops->get_key)
  1439. return -EOPNOTSUPP;
  1440. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  1441. if (!msg)
  1442. return -ENOMEM;
  1443. hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
  1444. NL80211_CMD_NEW_KEY);
  1445. if (IS_ERR(hdr))
  1446. return PTR_ERR(hdr);
  1447. cookie.msg = msg;
  1448. cookie.idx = key_idx;
  1449. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
  1450. NLA_PUT_U8(msg, NL80211_ATTR_KEY_IDX, key_idx);
  1451. if (mac_addr)
  1452. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
  1453. if (pairwise && mac_addr &&
  1454. !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  1455. return -ENOENT;
  1456. err = rdev->ops->get_key(&rdev->wiphy, dev, key_idx, pairwise,
  1457. mac_addr, &cookie, get_key_callback);
  1458. if (err)
  1459. goto free_msg;
  1460. if (cookie.error)
  1461. goto nla_put_failure;
  1462. genlmsg_end(msg, hdr);
  1463. return genlmsg_reply(msg, info);
  1464. nla_put_failure:
  1465. err = -ENOBUFS;
  1466. free_msg:
  1467. nlmsg_free(msg);
  1468. return err;
  1469. }
  1470. static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
  1471. {
  1472. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1473. struct key_parse key;
  1474. int err;
  1475. struct net_device *dev = info->user_ptr[1];
  1476. err = nl80211_parse_key(info, &key);
  1477. if (err)
  1478. return err;
  1479. if (key.idx < 0)
  1480. return -EINVAL;
  1481. /* only support setting default key */
  1482. if (!key.def && !key.defmgmt)
  1483. return -EINVAL;
  1484. wdev_lock(dev->ieee80211_ptr);
  1485. if (key.def) {
  1486. if (!rdev->ops->set_default_key) {
  1487. err = -EOPNOTSUPP;
  1488. goto out;
  1489. }
  1490. err = nl80211_key_allowed(dev->ieee80211_ptr);
  1491. if (err)
  1492. goto out;
  1493. err = rdev->ops->set_default_key(&rdev->wiphy, dev, key.idx,
  1494. key.def_uni, key.def_multi);
  1495. if (err)
  1496. goto out;
  1497. #ifdef CONFIG_CFG80211_WEXT
  1498. dev->ieee80211_ptr->wext.default_key = key.idx;
  1499. #endif
  1500. } else {
  1501. if (key.def_uni || !key.def_multi) {
  1502. err = -EINVAL;
  1503. goto out;
  1504. }
  1505. if (!rdev->ops->set_default_mgmt_key) {
  1506. err = -EOPNOTSUPP;
  1507. goto out;
  1508. }
  1509. err = nl80211_key_allowed(dev->ieee80211_ptr);
  1510. if (err)
  1511. goto out;
  1512. err = rdev->ops->set_default_mgmt_key(&rdev->wiphy,
  1513. dev, key.idx);
  1514. if (err)
  1515. goto out;
  1516. #ifdef CONFIG_CFG80211_WEXT
  1517. dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
  1518. #endif
  1519. }
  1520. out:
  1521. wdev_unlock(dev->ieee80211_ptr);
  1522. return err;
  1523. }
  1524. static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
  1525. {
  1526. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1527. int err;
  1528. struct net_device *dev = info->user_ptr[1];
  1529. struct key_parse key;
  1530. const u8 *mac_addr = NULL;
  1531. err = nl80211_parse_key(info, &key);
  1532. if (err)
  1533. return err;
  1534. if (!key.p.key)
  1535. return -EINVAL;
  1536. if (info->attrs[NL80211_ATTR_MAC])
  1537. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  1538. if (key.type == -1) {
  1539. if (mac_addr)
  1540. key.type = NL80211_KEYTYPE_PAIRWISE;
  1541. else
  1542. key.type = NL80211_KEYTYPE_GROUP;
  1543. }
  1544. /* for now */
  1545. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  1546. key.type != NL80211_KEYTYPE_GROUP)
  1547. return -EINVAL;
  1548. if (!rdev->ops->add_key)
  1549. return -EOPNOTSUPP;
  1550. if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
  1551. key.type == NL80211_KEYTYPE_PAIRWISE,
  1552. mac_addr))
  1553. return -EINVAL;
  1554. wdev_lock(dev->ieee80211_ptr);
  1555. err = nl80211_key_allowed(dev->ieee80211_ptr);
  1556. if (!err)
  1557. err = rdev->ops->add_key(&rdev->wiphy, dev, key.idx,
  1558. key.type == NL80211_KEYTYPE_PAIRWISE,
  1559. mac_addr, &key.p);
  1560. wdev_unlock(dev->ieee80211_ptr);
  1561. return err;
  1562. }
  1563. static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
  1564. {
  1565. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1566. int err;
  1567. struct net_device *dev = info->user_ptr[1];
  1568. u8 *mac_addr = NULL;
  1569. struct key_parse key;
  1570. err = nl80211_parse_key(info, &key);
  1571. if (err)
  1572. return err;
  1573. if (info->attrs[NL80211_ATTR_MAC])
  1574. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  1575. if (key.type == -1) {
  1576. if (mac_addr)
  1577. key.type = NL80211_KEYTYPE_PAIRWISE;
  1578. else
  1579. key.type = NL80211_KEYTYPE_GROUP;
  1580. }
  1581. /* for now */
  1582. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  1583. key.type != NL80211_KEYTYPE_GROUP)
  1584. return -EINVAL;
  1585. if (!rdev->ops->del_key)
  1586. return -EOPNOTSUPP;
  1587. wdev_lock(dev->ieee80211_ptr);
  1588. err = nl80211_key_allowed(dev->ieee80211_ptr);
  1589. if (key.type == NL80211_KEYTYPE_PAIRWISE && mac_addr &&
  1590. !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  1591. err = -ENOENT;
  1592. if (!err)
  1593. err = rdev->ops->del_key(&rdev->wiphy, dev, key.idx,
  1594. key.type == NL80211_KEYTYPE_PAIRWISE,
  1595. mac_addr);
  1596. #ifdef CONFIG_CFG80211_WEXT
  1597. if (!err) {
  1598. if (key.idx == dev->ieee80211_ptr->wext.default_key)
  1599. dev->ieee80211_ptr->wext.default_key = -1;
  1600. else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
  1601. dev->ieee80211_ptr->wext.default_mgmt_key = -1;
  1602. }
  1603. #endif
  1604. wdev_unlock(dev->ieee80211_ptr);
  1605. return err;
  1606. }
  1607. static int nl80211_addset_beacon(struct sk_buff *skb, struct genl_info *info)
  1608. {
  1609. int (*call)(struct wiphy *wiphy, struct net_device *dev,
  1610. struct beacon_parameters *info);
  1611. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1612. struct net_device *dev = info->user_ptr[1];
  1613. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1614. struct beacon_parameters params;
  1615. int haveinfo = 0, err;
  1616. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_BEACON_TAIL]))
  1617. return -EINVAL;
  1618. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  1619. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  1620. return -EOPNOTSUPP;
  1621. memset(&params, 0, sizeof(params));
  1622. switch (info->genlhdr->cmd) {
  1623. case NL80211_CMD_NEW_BEACON:
  1624. /* these are required for NEW_BEACON */
  1625. if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
  1626. !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
  1627. !info->attrs[NL80211_ATTR_BEACON_HEAD])
  1628. return -EINVAL;
  1629. params.interval =
  1630. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  1631. params.dtim_period =
  1632. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  1633. err = cfg80211_validate_beacon_int(rdev, params.interval);
  1634. if (err)
  1635. return err;
  1636. call = rdev->ops->add_beacon;
  1637. break;
  1638. case NL80211_CMD_SET_BEACON:
  1639. call = rdev->ops->set_beacon;
  1640. break;
  1641. default:
  1642. WARN_ON(1);
  1643. return -EOPNOTSUPP;
  1644. }
  1645. if (!call)
  1646. return -EOPNOTSUPP;
  1647. if (info->attrs[NL80211_ATTR_BEACON_HEAD]) {
  1648. params.head = nla_data(info->attrs[NL80211_ATTR_BEACON_HEAD]);
  1649. params.head_len =
  1650. nla_len(info->attrs[NL80211_ATTR_BEACON_HEAD]);
  1651. haveinfo = 1;
  1652. }
  1653. if (info->attrs[NL80211_ATTR_BEACON_TAIL]) {
  1654. params.tail = nla_data(info->attrs[NL80211_ATTR_BEACON_TAIL]);
  1655. params.tail_len =
  1656. nla_len(info->attrs[NL80211_ATTR_BEACON_TAIL]);
  1657. haveinfo = 1;
  1658. }
  1659. if (!haveinfo)
  1660. return -EINVAL;
  1661. err = call(&rdev->wiphy, dev, &params);
  1662. if (!err && params.interval)
  1663. wdev->beacon_interval = params.interval;
  1664. return err;
  1665. }
  1666. static int nl80211_del_beacon(struct sk_buff *skb, struct genl_info *info)
  1667. {
  1668. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1669. struct net_device *dev = info->user_ptr[1];
  1670. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1671. int err;
  1672. if (!rdev->ops->del_beacon)
  1673. return -EOPNOTSUPP;
  1674. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  1675. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  1676. return -EOPNOTSUPP;
  1677. err = rdev->ops->del_beacon(&rdev->wiphy, dev);
  1678. if (!err)
  1679. wdev->beacon_interval = 0;
  1680. return err;
  1681. }
  1682. static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
  1683. [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
  1684. [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
  1685. [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
  1686. [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
  1687. [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
  1688. };
  1689. static int parse_station_flags(struct genl_info *info,
  1690. struct station_parameters *params)
  1691. {
  1692. struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
  1693. struct nlattr *nla;
  1694. int flag;
  1695. /*
  1696. * Try parsing the new attribute first so userspace
  1697. * can specify both for older kernels.
  1698. */
  1699. nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
  1700. if (nla) {
  1701. struct nl80211_sta_flag_update *sta_flags;
  1702. sta_flags = nla_data(nla);
  1703. params->sta_flags_mask = sta_flags->mask;
  1704. params->sta_flags_set = sta_flags->set;
  1705. if ((params->sta_flags_mask |
  1706. params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
  1707. return -EINVAL;
  1708. return 0;
  1709. }
  1710. /* if present, parse the old attribute */
  1711. nla = info->attrs[NL80211_ATTR_STA_FLAGS];
  1712. if (!nla)
  1713. return 0;
  1714. if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
  1715. nla, sta_flags_policy))
  1716. return -EINVAL;
  1717. params->sta_flags_mask = (1 << __NL80211_STA_FLAG_AFTER_LAST) - 1;
  1718. params->sta_flags_mask &= ~1;
  1719. for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++)
  1720. if (flags[flag])
  1721. params->sta_flags_set |= (1<<flag);
  1722. return 0;
  1723. }
  1724. static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
  1725. int attr)
  1726. {
  1727. struct nlattr *rate;
  1728. u16 bitrate;
  1729. rate = nla_nest_start(msg, attr);
  1730. if (!rate)
  1731. goto nla_put_failure;
  1732. /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
  1733. bitrate = cfg80211_calculate_bitrate(info);
  1734. if (bitrate > 0)
  1735. NLA_PUT_U16(msg, NL80211_RATE_INFO_BITRATE, bitrate);
  1736. if (info->flags & RATE_INFO_FLAGS_MCS)
  1737. NLA_PUT_U8(msg, NL80211_RATE_INFO_MCS, info->mcs);
  1738. if (info->flags & RATE_INFO_FLAGS_40_MHZ_WIDTH)
  1739. NLA_PUT_FLAG(msg, NL80211_RATE_INFO_40_MHZ_WIDTH);
  1740. if (info->flags & RATE_INFO_FLAGS_SHORT_GI)
  1741. NLA_PUT_FLAG(msg, NL80211_RATE_INFO_SHORT_GI);
  1742. nla_nest_end(msg, rate);
  1743. return true;
  1744. nla_put_failure:
  1745. return false;
  1746. }
  1747. static int nl80211_send_station(struct sk_buff *msg, u32 pid, u32 seq,
  1748. int flags, struct net_device *dev,
  1749. const u8 *mac_addr, struct station_info *sinfo)
  1750. {
  1751. void *hdr;
  1752. struct nlattr *sinfoattr, *bss_param;
  1753. hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_STATION);
  1754. if (!hdr)
  1755. return -1;
  1756. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
  1757. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
  1758. NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, sinfo->generation);
  1759. sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
  1760. if (!sinfoattr)
  1761. goto nla_put_failure;
  1762. if (sinfo->filled & STATION_INFO_CONNECTED_TIME)
  1763. NLA_PUT_U32(msg, NL80211_STA_INFO_CONNECTED_TIME,
  1764. sinfo->connected_time);
  1765. if (sinfo->filled & STATION_INFO_INACTIVE_TIME)
  1766. NLA_PUT_U32(msg, NL80211_STA_INFO_INACTIVE_TIME,
  1767. sinfo->inactive_time);
  1768. if (sinfo->filled & STATION_INFO_RX_BYTES)
  1769. NLA_PUT_U32(msg, NL80211_STA_INFO_RX_BYTES,
  1770. sinfo->rx_bytes);
  1771. if (sinfo->filled & STATION_INFO_TX_BYTES)
  1772. NLA_PUT_U32(msg, NL80211_STA_INFO_TX_BYTES,
  1773. sinfo->tx_bytes);
  1774. if (sinfo->filled & STATION_INFO_LLID)
  1775. NLA_PUT_U16(msg, NL80211_STA_INFO_LLID,
  1776. sinfo->llid);
  1777. if (sinfo->filled & STATION_INFO_PLID)
  1778. NLA_PUT_U16(msg, NL80211_STA_INFO_PLID,
  1779. sinfo->plid);
  1780. if (sinfo->filled & STATION_INFO_PLINK_STATE)
  1781. NLA_PUT_U8(msg, NL80211_STA_INFO_PLINK_STATE,
  1782. sinfo->plink_state);
  1783. if (sinfo->filled & STATION_INFO_SIGNAL)
  1784. NLA_PUT_U8(msg, NL80211_STA_INFO_SIGNAL,
  1785. sinfo->signal);
  1786. if (sinfo->filled & STATION_INFO_SIGNAL_AVG)
  1787. NLA_PUT_U8(msg, NL80211_STA_INFO_SIGNAL_AVG,
  1788. sinfo->signal_avg);
  1789. if (sinfo->filled & STATION_INFO_TX_BITRATE) {
  1790. if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
  1791. NL80211_STA_INFO_TX_BITRATE))
  1792. goto nla_put_failure;
  1793. }
  1794. if (sinfo->filled & STATION_INFO_RX_BITRATE) {
  1795. if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
  1796. NL80211_STA_INFO_RX_BITRATE))
  1797. goto nla_put_failure;
  1798. }
  1799. if (sinfo->filled & STATION_INFO_RX_PACKETS)
  1800. NLA_PUT_U32(msg, NL80211_STA_INFO_RX_PACKETS,
  1801. sinfo->rx_packets);
  1802. if (sinfo->filled & STATION_INFO_TX_PACKETS)
  1803. NLA_PUT_U32(msg, NL80211_STA_INFO_TX_PACKETS,
  1804. sinfo->tx_packets);
  1805. if (sinfo->filled & STATION_INFO_TX_RETRIES)
  1806. NLA_PUT_U32(msg, NL80211_STA_INFO_TX_RETRIES,
  1807. sinfo->tx_retries);
  1808. if (sinfo->filled & STATION_INFO_TX_FAILED)
  1809. NLA_PUT_U32(msg, NL80211_STA_INFO_TX_FAILED,
  1810. sinfo->tx_failed);
  1811. if (sinfo->filled & STATION_INFO_BSS_PARAM) {
  1812. bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
  1813. if (!bss_param)
  1814. goto nla_put_failure;
  1815. if (sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT)
  1816. NLA_PUT_FLAG(msg, NL80211_STA_BSS_PARAM_CTS_PROT);
  1817. if (sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE)
  1818. NLA_PUT_FLAG(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE);
  1819. if (sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME)
  1820. NLA_PUT_FLAG(msg,
  1821. NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME);
  1822. NLA_PUT_U8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
  1823. sinfo->bss_param.dtim_period);
  1824. NLA_PUT_U16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
  1825. sinfo->bss_param.beacon_interval);
  1826. nla_nest_end(msg, bss_param);
  1827. }
  1828. nla_nest_end(msg, sinfoattr);
  1829. return genlmsg_end(msg, hdr);
  1830. nla_put_failure:
  1831. genlmsg_cancel(msg, hdr);
  1832. return -EMSGSIZE;
  1833. }
  1834. static int nl80211_dump_station(struct sk_buff *skb,
  1835. struct netlink_callback *cb)
  1836. {
  1837. struct station_info sinfo;
  1838. struct cfg80211_registered_device *dev;
  1839. struct net_device *netdev;
  1840. u8 mac_addr[ETH_ALEN];
  1841. int sta_idx = cb->args[1];
  1842. int err;
  1843. err = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
  1844. if (err)
  1845. return err;
  1846. if (!dev->ops->dump_station) {
  1847. err = -EOPNOTSUPP;
  1848. goto out_err;
  1849. }
  1850. while (1) {
  1851. err = dev->ops->dump_station(&dev->wiphy, netdev, sta_idx,
  1852. mac_addr, &sinfo);
  1853. if (err == -ENOENT)
  1854. break;
  1855. if (err)
  1856. goto out_err;
  1857. if (nl80211_send_station(skb,
  1858. NETLINK_CB(cb->skb).pid,
  1859. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  1860. netdev, mac_addr,
  1861. &sinfo) < 0)
  1862. goto out;
  1863. sta_idx++;
  1864. }
  1865. out:
  1866. cb->args[1] = sta_idx;
  1867. err = skb->len;
  1868. out_err:
  1869. nl80211_finish_netdev_dump(dev);
  1870. return err;
  1871. }
  1872. static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
  1873. {
  1874. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1875. struct net_device *dev = info->user_ptr[1];
  1876. struct station_info sinfo;
  1877. struct sk_buff *msg;
  1878. u8 *mac_addr = NULL;
  1879. int err;
  1880. memset(&sinfo, 0, sizeof(sinfo));
  1881. if (!info->attrs[NL80211_ATTR_MAC])
  1882. return -EINVAL;
  1883. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  1884. if (!rdev->ops->get_station)
  1885. return -EOPNOTSUPP;
  1886. err = rdev->ops->get_station(&rdev->wiphy, dev, mac_addr, &sinfo);
  1887. if (err)
  1888. return err;
  1889. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  1890. if (!msg)
  1891. return -ENOMEM;
  1892. if (nl80211_send_station(msg, info->snd_pid, info->snd_seq, 0,
  1893. dev, mac_addr, &sinfo) < 0) {
  1894. nlmsg_free(msg);
  1895. return -ENOBUFS;
  1896. }
  1897. return genlmsg_reply(msg, info);
  1898. }
  1899. /*
  1900. * Get vlan interface making sure it is running and on the right wiphy.
  1901. */
  1902. static int get_vlan(struct genl_info *info,
  1903. struct cfg80211_registered_device *rdev,
  1904. struct net_device **vlan)
  1905. {
  1906. struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
  1907. *vlan = NULL;
  1908. if (vlanattr) {
  1909. *vlan = dev_get_by_index(genl_info_net(info),
  1910. nla_get_u32(vlanattr));
  1911. if (!*vlan)
  1912. return -ENODEV;
  1913. if (!(*vlan)->ieee80211_ptr)
  1914. return -EINVAL;
  1915. if ((*vlan)->ieee80211_ptr->wiphy != &rdev->wiphy)
  1916. return -EINVAL;
  1917. if (!netif_running(*vlan))
  1918. return -ENETDOWN;
  1919. }
  1920. return 0;
  1921. }
  1922. static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
  1923. {
  1924. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1925. int err;
  1926. struct net_device *dev = info->user_ptr[1];
  1927. struct station_parameters params;
  1928. u8 *mac_addr = NULL;
  1929. memset(&params, 0, sizeof(params));
  1930. params.listen_interval = -1;
  1931. params.plink_state = -1;
  1932. if (info->attrs[NL80211_ATTR_STA_AID])
  1933. return -EINVAL;
  1934. if (!info->attrs[NL80211_ATTR_MAC])
  1935. return -EINVAL;
  1936. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  1937. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
  1938. params.supported_rates =
  1939. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  1940. params.supported_rates_len =
  1941. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  1942. }
  1943. if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  1944. params.listen_interval =
  1945. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  1946. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  1947. params.ht_capa =
  1948. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  1949. if (parse_station_flags(info, &params))
  1950. return -EINVAL;
  1951. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
  1952. params.plink_action =
  1953. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  1954. if (info->attrs[NL80211_ATTR_STA_PLINK_STATE])
  1955. params.plink_state =
  1956. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
  1957. err = get_vlan(info, rdev, &params.vlan);
  1958. if (err)
  1959. goto out;
  1960. /* validate settings */
  1961. err = 0;
  1962. switch (dev->ieee80211_ptr->iftype) {
  1963. case NL80211_IFTYPE_AP:
  1964. case NL80211_IFTYPE_AP_VLAN:
  1965. case NL80211_IFTYPE_P2P_GO:
  1966. /* disallow mesh-specific things */
  1967. if (params.plink_action)
  1968. err = -EINVAL;
  1969. break;
  1970. case NL80211_IFTYPE_P2P_CLIENT:
  1971. case NL80211_IFTYPE_STATION:
  1972. /* disallow everything but AUTHORIZED flag */
  1973. if (params.plink_action)
  1974. err = -EINVAL;
  1975. if (params.vlan)
  1976. err = -EINVAL;
  1977. if (params.supported_rates)
  1978. err = -EINVAL;
  1979. if (params.ht_capa)
  1980. err = -EINVAL;
  1981. if (params.listen_interval >= 0)
  1982. err = -EINVAL;
  1983. if (params.sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
  1984. err = -EINVAL;
  1985. break;
  1986. case NL80211_IFTYPE_MESH_POINT:
  1987. /* disallow things mesh doesn't support */
  1988. if (params.vlan)
  1989. err = -EINVAL;
  1990. if (params.ht_capa)
  1991. err = -EINVAL;
  1992. if (params.listen_interval >= 0)
  1993. err = -EINVAL;
  1994. if (params.sta_flags_mask &
  1995. ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  1996. BIT(NL80211_STA_FLAG_MFP) |
  1997. BIT(NL80211_STA_FLAG_AUTHORIZED)))
  1998. err = -EINVAL;
  1999. break;
  2000. default:
  2001. err = -EINVAL;
  2002. }
  2003. if (err)
  2004. goto out;
  2005. if (!rdev->ops->change_station) {
  2006. err = -EOPNOTSUPP;
  2007. goto out;
  2008. }
  2009. err = rdev->ops->change_station(&rdev->wiphy, dev, mac_addr, &params);
  2010. out:
  2011. if (params.vlan)
  2012. dev_put(params.vlan);
  2013. return err;
  2014. }
  2015. static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
  2016. {
  2017. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2018. int err;
  2019. struct net_device *dev = info->user_ptr[1];
  2020. struct station_parameters params;
  2021. u8 *mac_addr = NULL;
  2022. memset(&params, 0, sizeof(params));
  2023. if (!info->attrs[NL80211_ATTR_MAC])
  2024. return -EINVAL;
  2025. if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  2026. return -EINVAL;
  2027. if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
  2028. return -EINVAL;
  2029. if (!info->attrs[NL80211_ATTR_STA_AID])
  2030. return -EINVAL;
  2031. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2032. params.supported_rates =
  2033. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  2034. params.supported_rates_len =
  2035. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  2036. params.listen_interval =
  2037. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  2038. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
  2039. if (!params.aid || params.aid > IEEE80211_MAX_AID)
  2040. return -EINVAL;
  2041. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  2042. params.ht_capa =
  2043. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  2044. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
  2045. params.plink_action =
  2046. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  2047. if (parse_station_flags(info, &params))
  2048. return -EINVAL;
  2049. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  2050. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  2051. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  2052. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2053. return -EINVAL;
  2054. err = get_vlan(info, rdev, &params.vlan);
  2055. if (err)
  2056. goto out;
  2057. /* validate settings */
  2058. err = 0;
  2059. if (!rdev->ops->add_station) {
  2060. err = -EOPNOTSUPP;
  2061. goto out;
  2062. }
  2063. err = rdev->ops->add_station(&rdev->wiphy, dev, mac_addr, &params);
  2064. out:
  2065. if (params.vlan)
  2066. dev_put(params.vlan);
  2067. return err;
  2068. }
  2069. static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
  2070. {
  2071. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2072. struct net_device *dev = info->user_ptr[1];
  2073. u8 *mac_addr = NULL;
  2074. if (info->attrs[NL80211_ATTR_MAC])
  2075. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2076. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  2077. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  2078. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  2079. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2080. return -EINVAL;
  2081. if (!rdev->ops->del_station)
  2082. return -EOPNOTSUPP;
  2083. return rdev->ops->del_station(&rdev->wiphy, dev, mac_addr);
  2084. }
  2085. static int nl80211_send_mpath(struct sk_buff *msg, u32 pid, u32 seq,
  2086. int flags, struct net_device *dev,
  2087. u8 *dst, u8 *next_hop,
  2088. struct mpath_info *pinfo)
  2089. {
  2090. void *hdr;
  2091. struct nlattr *pinfoattr;
  2092. hdr = nl80211hdr_put(msg, pid, seq, flags, NL80211_CMD_NEW_STATION);
  2093. if (!hdr)
  2094. return -1;
  2095. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
  2096. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, dst);
  2097. NLA_PUT(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop);
  2098. NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, pinfo->generation);
  2099. pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
  2100. if (!pinfoattr)
  2101. goto nla_put_failure;
  2102. if (pinfo->filled & MPATH_INFO_FRAME_QLEN)
  2103. NLA_PUT_U32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
  2104. pinfo->frame_qlen);
  2105. if (pinfo->filled & MPATH_INFO_SN)
  2106. NLA_PUT_U32(msg, NL80211_MPATH_INFO_SN,
  2107. pinfo->sn);
  2108. if (pinfo->filled & MPATH_INFO_METRIC)
  2109. NLA_PUT_U32(msg, NL80211_MPATH_INFO_METRIC,
  2110. pinfo->metric);
  2111. if (pinfo->filled & MPATH_INFO_EXPTIME)
  2112. NLA_PUT_U32(msg, NL80211_MPATH_INFO_EXPTIME,
  2113. pinfo->exptime);
  2114. if (pinfo->filled & MPATH_INFO_FLAGS)
  2115. NLA_PUT_U8(msg, NL80211_MPATH_INFO_FLAGS,
  2116. pinfo->flags);
  2117. if (pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT)
  2118. NLA_PUT_U32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
  2119. pinfo->discovery_timeout);
  2120. if (pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES)
  2121. NLA_PUT_U8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
  2122. pinfo->discovery_retries);
  2123. nla_nest_end(msg, pinfoattr);
  2124. return genlmsg_end(msg, hdr);
  2125. nla_put_failure:
  2126. genlmsg_cancel(msg, hdr);
  2127. return -EMSGSIZE;
  2128. }
  2129. static int nl80211_dump_mpath(struct sk_buff *skb,
  2130. struct netlink_callback *cb)
  2131. {
  2132. struct mpath_info pinfo;
  2133. struct cfg80211_registered_device *dev;
  2134. struct net_device *netdev;
  2135. u8 dst[ETH_ALEN];
  2136. u8 next_hop[ETH_ALEN];
  2137. int path_idx = cb->args[1];
  2138. int err;
  2139. err = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
  2140. if (err)
  2141. return err;
  2142. if (!dev->ops->dump_mpath) {
  2143. err = -EOPNOTSUPP;
  2144. goto out_err;
  2145. }
  2146. if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT) {
  2147. err = -EOPNOTSUPP;
  2148. goto out_err;
  2149. }
  2150. while (1) {
  2151. err = dev->ops->dump_mpath(&dev->wiphy, netdev, path_idx,
  2152. dst, next_hop, &pinfo);
  2153. if (err == -ENOENT)
  2154. break;
  2155. if (err)
  2156. goto out_err;
  2157. if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).pid,
  2158. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  2159. netdev, dst, next_hop,
  2160. &pinfo) < 0)
  2161. goto out;
  2162. path_idx++;
  2163. }
  2164. out:
  2165. cb->args[1] = path_idx;
  2166. err = skb->len;
  2167. out_err:
  2168. nl80211_finish_netdev_dump(dev);
  2169. return err;
  2170. }
  2171. static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
  2172. {
  2173. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2174. int err;
  2175. struct net_device *dev = info->user_ptr[1];
  2176. struct mpath_info pinfo;
  2177. struct sk_buff *msg;
  2178. u8 *dst = NULL;
  2179. u8 next_hop[ETH_ALEN];
  2180. memset(&pinfo, 0, sizeof(pinfo));
  2181. if (!info->attrs[NL80211_ATTR_MAC])
  2182. return -EINVAL;
  2183. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2184. if (!rdev->ops->get_mpath)
  2185. return -EOPNOTSUPP;
  2186. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  2187. return -EOPNOTSUPP;
  2188. err = rdev->ops->get_mpath(&rdev->wiphy, dev, dst, next_hop, &pinfo);
  2189. if (err)
  2190. return err;
  2191. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  2192. if (!msg)
  2193. return -ENOMEM;
  2194. if (nl80211_send_mpath(msg, info->snd_pid, info->snd_seq, 0,
  2195. dev, dst, next_hop, &pinfo) < 0) {
  2196. nlmsg_free(msg);
  2197. return -ENOBUFS;
  2198. }
  2199. return genlmsg_reply(msg, info);
  2200. }
  2201. static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
  2202. {
  2203. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2204. struct net_device *dev = info->user_ptr[1];
  2205. u8 *dst = NULL;
  2206. u8 *next_hop = NULL;
  2207. if (!info->attrs[NL80211_ATTR_MAC])
  2208. return -EINVAL;
  2209. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  2210. return -EINVAL;
  2211. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2212. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  2213. if (!rdev->ops->change_mpath)
  2214. return -EOPNOTSUPP;
  2215. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  2216. return -EOPNOTSUPP;
  2217. return rdev->ops->change_mpath(&rdev->wiphy, dev, dst, next_hop);
  2218. }
  2219. static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
  2220. {
  2221. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2222. struct net_device *dev = info->user_ptr[1];
  2223. u8 *dst = NULL;
  2224. u8 *next_hop = NULL;
  2225. if (!info->attrs[NL80211_ATTR_MAC])
  2226. return -EINVAL;
  2227. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  2228. return -EINVAL;
  2229. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2230. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  2231. if (!rdev->ops->add_mpath)
  2232. return -EOPNOTSUPP;
  2233. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  2234. return -EOPNOTSUPP;
  2235. return rdev->ops->add_mpath(&rdev->wiphy, dev, dst, next_hop);
  2236. }
  2237. static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
  2238. {
  2239. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2240. struct net_device *dev = info->user_ptr[1];
  2241. u8 *dst = NULL;
  2242. if (info->attrs[NL80211_ATTR_MAC])
  2243. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2244. if (!rdev->ops->del_mpath)
  2245. return -EOPNOTSUPP;
  2246. return rdev->ops->del_mpath(&rdev->wiphy, dev, dst);
  2247. }
  2248. static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
  2249. {
  2250. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2251. struct net_device *dev = info->user_ptr[1];
  2252. struct bss_parameters params;
  2253. memset(&params, 0, sizeof(params));
  2254. /* default to not changing parameters */
  2255. params.use_cts_prot = -1;
  2256. params.use_short_preamble = -1;
  2257. params.use_short_slot_time = -1;
  2258. params.ap_isolate = -1;
  2259. params.ht_opmode = -1;
  2260. if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
  2261. params.use_cts_prot =
  2262. nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
  2263. if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
  2264. params.use_short_preamble =
  2265. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
  2266. if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
  2267. params.use_short_slot_time =
  2268. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
  2269. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  2270. params.basic_rates =
  2271. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  2272. params.basic_rates_len =
  2273. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  2274. }
  2275. if (info->attrs[NL80211_ATTR_AP_ISOLATE])
  2276. params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
  2277. if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
  2278. params.ht_opmode =
  2279. nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
  2280. if (!rdev->ops->change_bss)
  2281. return -EOPNOTSUPP;
  2282. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  2283. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2284. return -EOPNOTSUPP;
  2285. return rdev->ops->change_bss(&rdev->wiphy, dev, &params);
  2286. }
  2287. static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
  2288. [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
  2289. [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
  2290. [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
  2291. [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
  2292. [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
  2293. [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
  2294. };
  2295. static int parse_reg_rule(struct nlattr *tb[],
  2296. struct ieee80211_reg_rule *reg_rule)
  2297. {
  2298. struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
  2299. struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
  2300. if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
  2301. return -EINVAL;
  2302. if (!tb[NL80211_ATTR_FREQ_RANGE_START])
  2303. return -EINVAL;
  2304. if (!tb[NL80211_ATTR_FREQ_RANGE_END])
  2305. return -EINVAL;
  2306. if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
  2307. return -EINVAL;
  2308. if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
  2309. return -EINVAL;
  2310. reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
  2311. freq_range->start_freq_khz =
  2312. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
  2313. freq_range->end_freq_khz =
  2314. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
  2315. freq_range->max_bandwidth_khz =
  2316. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
  2317. power_rule->max_eirp =
  2318. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
  2319. if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
  2320. power_rule->max_antenna_gain =
  2321. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
  2322. return 0;
  2323. }
  2324. static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
  2325. {
  2326. int r;
  2327. char *data = NULL;
  2328. /*
  2329. * You should only get this when cfg80211 hasn't yet initialized
  2330. * completely when built-in to the kernel right between the time
  2331. * window between nl80211_init() and regulatory_init(), if that is
  2332. * even possible.
  2333. */
  2334. mutex_lock(&cfg80211_mutex);
  2335. if (unlikely(!cfg80211_regdomain)) {
  2336. mutex_unlock(&cfg80211_mutex);
  2337. return -EINPROGRESS;
  2338. }
  2339. mutex_unlock(&cfg80211_mutex);
  2340. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  2341. return -EINVAL;
  2342. data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  2343. r = regulatory_hint_user(data);
  2344. return r;
  2345. }
  2346. static int nl80211_get_mesh_config(struct sk_buff *skb,
  2347. struct genl_info *info)
  2348. {
  2349. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2350. struct net_device *dev = info->user_ptr[1];
  2351. struct wireless_dev *wdev = dev->ieee80211_ptr;
  2352. struct mesh_config cur_params;
  2353. int err = 0;
  2354. void *hdr;
  2355. struct nlattr *pinfoattr;
  2356. struct sk_buff *msg;
  2357. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  2358. return -EOPNOTSUPP;
  2359. if (!rdev->ops->get_mesh_config)
  2360. return -EOPNOTSUPP;
  2361. wdev_lock(wdev);
  2362. /* If not connected, get default parameters */
  2363. if (!wdev->mesh_id_len)
  2364. memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
  2365. else
  2366. err = rdev->ops->get_mesh_config(&rdev->wiphy, dev,
  2367. &cur_params);
  2368. wdev_unlock(wdev);
  2369. if (err)
  2370. return err;
  2371. /* Draw up a netlink message to send back */
  2372. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  2373. if (!msg)
  2374. return -ENOMEM;
  2375. hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
  2376. NL80211_CMD_GET_MESH_CONFIG);
  2377. if (!hdr)
  2378. goto out;
  2379. pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
  2380. if (!pinfoattr)
  2381. goto nla_put_failure;
  2382. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
  2383. NLA_PUT_U16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
  2384. cur_params.dot11MeshRetryTimeout);
  2385. NLA_PUT_U16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
  2386. cur_params.dot11MeshConfirmTimeout);
  2387. NLA_PUT_U16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
  2388. cur_params.dot11MeshHoldingTimeout);
  2389. NLA_PUT_U16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
  2390. cur_params.dot11MeshMaxPeerLinks);
  2391. NLA_PUT_U8(msg, NL80211_MESHCONF_MAX_RETRIES,
  2392. cur_params.dot11MeshMaxRetries);
  2393. NLA_PUT_U8(msg, NL80211_MESHCONF_TTL,
  2394. cur_params.dot11MeshTTL);
  2395. NLA_PUT_U8(msg, NL80211_MESHCONF_ELEMENT_TTL,
  2396. cur_params.element_ttl);
  2397. NLA_PUT_U8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  2398. cur_params.auto_open_plinks);
  2399. NLA_PUT_U8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  2400. cur_params.dot11MeshHWMPmaxPREQretries);
  2401. NLA_PUT_U32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
  2402. cur_params.path_refresh_time);
  2403. NLA_PUT_U16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  2404. cur_params.min_discovery_timeout);
  2405. NLA_PUT_U32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  2406. cur_params.dot11MeshHWMPactivePathTimeout);
  2407. NLA_PUT_U16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  2408. cur_params.dot11MeshHWMPpreqMinInterval);
  2409. NLA_PUT_U16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  2410. cur_params.dot11MeshHWMPnetDiameterTraversalTime);
  2411. NLA_PUT_U8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
  2412. cur_params.dot11MeshHWMPRootMode);
  2413. nla_nest_end(msg, pinfoattr);
  2414. genlmsg_end(msg, hdr);
  2415. return genlmsg_reply(msg, info);
  2416. nla_put_failure:
  2417. genlmsg_cancel(msg, hdr);
  2418. out:
  2419. nlmsg_free(msg);
  2420. return -ENOBUFS;
  2421. }
  2422. static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
  2423. [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
  2424. [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
  2425. [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
  2426. [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
  2427. [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
  2428. [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
  2429. [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
  2430. [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
  2431. [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
  2432. [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
  2433. [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
  2434. [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
  2435. [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
  2436. [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
  2437. };
  2438. static const struct nla_policy
  2439. nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
  2440. [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
  2441. [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
  2442. [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
  2443. [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
  2444. .len = IEEE80211_MAX_DATA_LEN },
  2445. [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
  2446. };
  2447. static int nl80211_parse_mesh_config(struct genl_info *info,
  2448. struct mesh_config *cfg,
  2449. u32 *mask_out)
  2450. {
  2451. struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
  2452. u32 mask = 0;
  2453. #define FILL_IN_MESH_PARAM_IF_SET(table, cfg, param, mask, attr_num, nla_fn) \
  2454. do {\
  2455. if (table[attr_num]) {\
  2456. cfg->param = nla_fn(table[attr_num]); \
  2457. mask |= (1 << (attr_num - 1)); \
  2458. } \
  2459. } while (0);\
  2460. if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
  2461. return -EINVAL;
  2462. if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
  2463. info->attrs[NL80211_ATTR_MESH_CONFIG],
  2464. nl80211_meshconf_params_policy))
  2465. return -EINVAL;
  2466. /* This makes sure that there aren't more than 32 mesh config
  2467. * parameters (otherwise our bitfield scheme would not work.) */
  2468. BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
  2469. /* Fill in the params struct */
  2470. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout,
  2471. mask, NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
  2472. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout,
  2473. mask, NL80211_MESHCONF_CONFIRM_TIMEOUT, nla_get_u16);
  2474. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout,
  2475. mask, NL80211_MESHCONF_HOLDING_TIMEOUT, nla_get_u16);
  2476. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks,
  2477. mask, NL80211_MESHCONF_MAX_PEER_LINKS, nla_get_u16);
  2478. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries,
  2479. mask, NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
  2480. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL,
  2481. mask, NL80211_MESHCONF_TTL, nla_get_u8);
  2482. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl,
  2483. mask, NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8);
  2484. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks,
  2485. mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS, nla_get_u8);
  2486. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries,
  2487. mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  2488. nla_get_u8);
  2489. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time,
  2490. mask, NL80211_MESHCONF_PATH_REFRESH_TIME, nla_get_u32);
  2491. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout,
  2492. mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  2493. nla_get_u16);
  2494. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
  2495. mask, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  2496. nla_get_u32);
  2497. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
  2498. mask, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  2499. nla_get_u16);
  2500. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  2501. dot11MeshHWMPnetDiameterTraversalTime,
  2502. mask, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  2503. nla_get_u16);
  2504. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  2505. dot11MeshHWMPRootMode, mask,
  2506. NL80211_MESHCONF_HWMP_ROOTMODE,
  2507. nla_get_u8);
  2508. if (mask_out)
  2509. *mask_out = mask;
  2510. return 0;
  2511. #undef FILL_IN_MESH_PARAM_IF_SET
  2512. }
  2513. static int nl80211_parse_mesh_setup(struct genl_info *info,
  2514. struct mesh_setup *setup)
  2515. {
  2516. struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
  2517. if (!info->attrs[NL80211_ATTR_MESH_SETUP])
  2518. return -EINVAL;
  2519. if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
  2520. info->attrs[NL80211_ATTR_MESH_SETUP],
  2521. nl80211_mesh_setup_params_policy))
  2522. return -EINVAL;
  2523. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
  2524. setup->path_sel_proto =
  2525. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
  2526. IEEE80211_PATH_PROTOCOL_VENDOR :
  2527. IEEE80211_PATH_PROTOCOL_HWMP;
  2528. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
  2529. setup->path_metric =
  2530. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
  2531. IEEE80211_PATH_METRIC_VENDOR :
  2532. IEEE80211_PATH_METRIC_AIRTIME;
  2533. if (tb[NL80211_MESH_SETUP_IE]) {
  2534. struct nlattr *ieattr =
  2535. tb[NL80211_MESH_SETUP_IE];
  2536. if (!is_valid_ie_attr(ieattr))
  2537. return -EINVAL;
  2538. setup->ie = nla_data(ieattr);
  2539. setup->ie_len = nla_len(ieattr);
  2540. }
  2541. setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
  2542. setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
  2543. return 0;
  2544. }
  2545. static int nl80211_update_mesh_config(struct sk_buff *skb,
  2546. struct genl_info *info)
  2547. {
  2548. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2549. struct net_device *dev = info->user_ptr[1];
  2550. struct wireless_dev *wdev = dev->ieee80211_ptr;
  2551. struct mesh_config cfg;
  2552. u32 mask;
  2553. int err;
  2554. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  2555. return -EOPNOTSUPP;
  2556. if (!rdev->ops->update_mesh_config)
  2557. return -EOPNOTSUPP;
  2558. err = nl80211_parse_mesh_config(info, &cfg, &mask);
  2559. if (err)
  2560. return err;
  2561. wdev_lock(wdev);
  2562. if (!wdev->mesh_id_len)
  2563. err = -ENOLINK;
  2564. if (!err)
  2565. err = rdev->ops->update_mesh_config(&rdev->wiphy, dev,
  2566. mask, &cfg);
  2567. wdev_unlock(wdev);
  2568. return err;
  2569. }
  2570. static int nl80211_get_reg(struct sk_buff *skb, struct genl_info *info)
  2571. {
  2572. struct sk_buff *msg;
  2573. void *hdr = NULL;
  2574. struct nlattr *nl_reg_rules;
  2575. unsigned int i;
  2576. int err = -EINVAL;
  2577. mutex_lock(&cfg80211_mutex);
  2578. if (!cfg80211_regdomain)
  2579. goto out;
  2580. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  2581. if (!msg) {
  2582. err = -ENOBUFS;
  2583. goto out;
  2584. }
  2585. hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
  2586. NL80211_CMD_GET_REG);
  2587. if (!hdr)
  2588. goto put_failure;
  2589. NLA_PUT_STRING(msg, NL80211_ATTR_REG_ALPHA2,
  2590. cfg80211_regdomain->alpha2);
  2591. nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
  2592. if (!nl_reg_rules)
  2593. goto nla_put_failure;
  2594. for (i = 0; i < cfg80211_regdomain->n_reg_rules; i++) {
  2595. struct nlattr *nl_reg_rule;
  2596. const struct ieee80211_reg_rule *reg_rule;
  2597. const struct ieee80211_freq_range *freq_range;
  2598. const struct ieee80211_power_rule *power_rule;
  2599. reg_rule = &cfg80211_regdomain->reg_rules[i];
  2600. freq_range = &reg_rule->freq_range;
  2601. power_rule = &reg_rule->power_rule;
  2602. nl_reg_rule = nla_nest_start(msg, i);
  2603. if (!nl_reg_rule)
  2604. goto nla_put_failure;
  2605. NLA_PUT_U32(msg, NL80211_ATTR_REG_RULE_FLAGS,
  2606. reg_rule->flags);
  2607. NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_START,
  2608. freq_range->start_freq_khz);
  2609. NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_END,
  2610. freq_range->end_freq_khz);
  2611. NLA_PUT_U32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
  2612. freq_range->max_bandwidth_khz);
  2613. NLA_PUT_U32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
  2614. power_rule->max_antenna_gain);
  2615. NLA_PUT_U32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
  2616. power_rule->max_eirp);
  2617. nla_nest_end(msg, nl_reg_rule);
  2618. }
  2619. nla_nest_end(msg, nl_reg_rules);
  2620. genlmsg_end(msg, hdr);
  2621. err = genlmsg_reply(msg, info);
  2622. goto out;
  2623. nla_put_failure:
  2624. genlmsg_cancel(msg, hdr);
  2625. put_failure:
  2626. nlmsg_free(msg);
  2627. err = -EMSGSIZE;
  2628. out:
  2629. mutex_unlock(&cfg80211_mutex);
  2630. return err;
  2631. }
  2632. static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
  2633. {
  2634. struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
  2635. struct nlattr *nl_reg_rule;
  2636. char *alpha2 = NULL;
  2637. int rem_reg_rules = 0, r = 0;
  2638. u32 num_rules = 0, rule_idx = 0, size_of_regd;
  2639. struct ieee80211_regdomain *rd = NULL;
  2640. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  2641. return -EINVAL;
  2642. if (!info->attrs[NL80211_ATTR_REG_RULES])
  2643. return -EINVAL;
  2644. alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  2645. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  2646. rem_reg_rules) {
  2647. num_rules++;
  2648. if (num_rules > NL80211_MAX_SUPP_REG_RULES)
  2649. return -EINVAL;
  2650. }
  2651. mutex_lock(&cfg80211_mutex);
  2652. if (!reg_is_valid_request(alpha2)) {
  2653. r = -EINVAL;
  2654. goto bad_reg;
  2655. }
  2656. size_of_regd = sizeof(struct ieee80211_regdomain) +
  2657. (num_rules * sizeof(struct ieee80211_reg_rule));
  2658. rd = kzalloc(size_of_regd, GFP_KERNEL);
  2659. if (!rd) {
  2660. r = -ENOMEM;
  2661. goto bad_reg;
  2662. }
  2663. rd->n_reg_rules = num_rules;
  2664. rd->alpha2[0] = alpha2[0];
  2665. rd->alpha2[1] = alpha2[1];
  2666. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  2667. rem_reg_rules) {
  2668. nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
  2669. nla_data(nl_reg_rule), nla_len(nl_reg_rule),
  2670. reg_rule_policy);
  2671. r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
  2672. if (r)
  2673. goto bad_reg;
  2674. rule_idx++;
  2675. if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
  2676. r = -EINVAL;
  2677. goto bad_reg;
  2678. }
  2679. }
  2680. BUG_ON(rule_idx != num_rules);
  2681. r = set_regdom(rd);
  2682. mutex_unlock(&cfg80211_mutex);
  2683. return r;
  2684. bad_reg:
  2685. mutex_unlock(&cfg80211_mutex);
  2686. kfree(rd);
  2687. return r;
  2688. }
  2689. static int validate_scan_freqs(struct nlattr *freqs)
  2690. {
  2691. struct nlattr *attr1, *attr2;
  2692. int n_channels = 0, tmp1, tmp2;
  2693. nla_for_each_nested(attr1, freqs, tmp1) {
  2694. n_channels++;
  2695. /*
  2696. * Some hardware has a limited channel list for
  2697. * scanning, and it is pretty much nonsensical
  2698. * to scan for a channel twice, so disallow that
  2699. * and don't require drivers to check that the
  2700. * channel list they get isn't longer than what
  2701. * they can scan, as long as they can scan all
  2702. * the channels they registered at once.
  2703. */
  2704. nla_for_each_nested(attr2, freqs, tmp2)
  2705. if (attr1 != attr2 &&
  2706. nla_get_u32(attr1) == nla_get_u32(attr2))
  2707. return 0;
  2708. }
  2709. return n_channels;
  2710. }
  2711. static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
  2712. {
  2713. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2714. struct net_device *dev = info->user_ptr[1];
  2715. struct cfg80211_scan_request *request;
  2716. struct nlattr *attr;
  2717. struct wiphy *wiphy;
  2718. int err, tmp, n_ssids = 0, n_channels, i;
  2719. enum ieee80211_band band;
  2720. size_t ie_len;
  2721. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  2722. return -EINVAL;
  2723. wiphy = &rdev->wiphy;
  2724. if (!rdev->ops->scan)
  2725. return -EOPNOTSUPP;
  2726. if (rdev->scan_req)
  2727. return -EBUSY;
  2728. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  2729. n_channels = validate_scan_freqs(
  2730. info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
  2731. if (!n_channels)
  2732. return -EINVAL;
  2733. } else {
  2734. n_channels = 0;
  2735. for (band = 0; band < IEEE80211_NUM_BANDS; band++)
  2736. if (wiphy->bands[band])
  2737. n_channels += wiphy->bands[band]->n_channels;
  2738. }
  2739. if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
  2740. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
  2741. n_ssids++;
  2742. if (n_ssids > wiphy->max_scan_ssids)
  2743. return -EINVAL;
  2744. if (info->attrs[NL80211_ATTR_IE])
  2745. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  2746. else
  2747. ie_len = 0;
  2748. if (ie_len > wiphy->max_scan_ie_len)
  2749. return -EINVAL;
  2750. request = kzalloc(sizeof(*request)
  2751. + sizeof(*request->ssids) * n_ssids
  2752. + sizeof(*request->channels) * n_channels
  2753. + ie_len, GFP_KERNEL);
  2754. if (!request)
  2755. return -ENOMEM;
  2756. if (n_ssids)
  2757. request->ssids = (void *)&request->channels[n_channels];
  2758. request->n_ssids = n_ssids;
  2759. if (ie_len) {
  2760. if (request->ssids)
  2761. request->ie = (void *)(request->ssids + n_ssids);
  2762. else
  2763. request->ie = (void *)(request->channels + n_channels);
  2764. }
  2765. i = 0;
  2766. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  2767. /* user specified, bail out if channel not found */
  2768. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
  2769. struct ieee80211_channel *chan;
  2770. chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
  2771. if (!chan) {
  2772. err = -EINVAL;
  2773. goto out_free;
  2774. }
  2775. /* ignore disabled channels */
  2776. if (chan->flags & IEEE80211_CHAN_DISABLED)
  2777. continue;
  2778. request->channels[i] = chan;
  2779. i++;
  2780. }
  2781. } else {
  2782. /* all channels */
  2783. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  2784. int j;
  2785. if (!wiphy->bands[band])
  2786. continue;
  2787. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  2788. struct ieee80211_channel *chan;
  2789. chan = &wiphy->bands[band]->channels[j];
  2790. if (chan->flags & IEEE80211_CHAN_DISABLED)
  2791. continue;
  2792. request->channels[i] = chan;
  2793. i++;
  2794. }
  2795. }
  2796. }
  2797. if (!i) {
  2798. err = -EINVAL;
  2799. goto out_free;
  2800. }
  2801. request->n_channels = i;
  2802. i = 0;
  2803. if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
  2804. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
  2805. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  2806. err = -EINVAL;
  2807. goto out_free;
  2808. }
  2809. request->ssids[i].ssid_len = nla_len(attr);
  2810. memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
  2811. i++;
  2812. }
  2813. }
  2814. if (info->attrs[NL80211_ATTR_IE]) {
  2815. request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  2816. memcpy((void *)request->ie,
  2817. nla_data(info->attrs[NL80211_ATTR_IE]),
  2818. request->ie_len);
  2819. }
  2820. request->dev = dev;
  2821. request->wiphy = &rdev->wiphy;
  2822. rdev->scan_req = request;
  2823. err = rdev->ops->scan(&rdev->wiphy, dev, request);
  2824. if (!err) {
  2825. nl80211_send_scan_start(rdev, dev);
  2826. dev_hold(dev);
  2827. } else {
  2828. out_free:
  2829. rdev->scan_req = NULL;
  2830. kfree(request);
  2831. }
  2832. return err;
  2833. }
  2834. static int nl80211_start_sched_scan(struct sk_buff *skb,
  2835. struct genl_info *info)
  2836. {
  2837. struct cfg80211_sched_scan_request *request;
  2838. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2839. struct net_device *dev = info->user_ptr[1];
  2840. struct nlattr *attr;
  2841. struct wiphy *wiphy;
  2842. int err, tmp, n_ssids = 0, n_channels, i;
  2843. u32 interval;
  2844. enum ieee80211_band band;
  2845. size_t ie_len;
  2846. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
  2847. !rdev->ops->sched_scan_start)
  2848. return -EOPNOTSUPP;
  2849. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  2850. return -EINVAL;
  2851. if (rdev->sched_scan_req)
  2852. return -EINPROGRESS;
  2853. if (!info->attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
  2854. return -EINVAL;
  2855. interval = nla_get_u32(info->attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
  2856. if (interval == 0)
  2857. return -EINVAL;
  2858. wiphy = &rdev->wiphy;
  2859. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  2860. n_channels = validate_scan_freqs(
  2861. info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
  2862. if (!n_channels)
  2863. return -EINVAL;
  2864. } else {
  2865. n_channels = 0;
  2866. for (band = 0; band < IEEE80211_NUM_BANDS; band++)
  2867. if (wiphy->bands[band])
  2868. n_channels += wiphy->bands[band]->n_channels;
  2869. }
  2870. if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
  2871. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS],
  2872. tmp)
  2873. n_ssids++;
  2874. if (n_ssids > wiphy->max_scan_ssids)
  2875. return -EINVAL;
  2876. if (info->attrs[NL80211_ATTR_IE])
  2877. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  2878. else
  2879. ie_len = 0;
  2880. if (ie_len > wiphy->max_scan_ie_len)
  2881. return -EINVAL;
  2882. request = kzalloc(sizeof(*request)
  2883. + sizeof(*request->ssids) * n_ssids
  2884. + sizeof(*request->channels) * n_channels
  2885. + ie_len, GFP_KERNEL);
  2886. if (!request)
  2887. return -ENOMEM;
  2888. if (n_ssids)
  2889. request->ssids = (void *)&request->channels[n_channels];
  2890. request->n_ssids = n_ssids;
  2891. if (ie_len) {
  2892. if (request->ssids)
  2893. request->ie = (void *)(request->ssids + n_ssids);
  2894. else
  2895. request->ie = (void *)(request->channels + n_channels);
  2896. }
  2897. i = 0;
  2898. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  2899. /* user specified, bail out if channel not found */
  2900. nla_for_each_nested(attr,
  2901. info->attrs[NL80211_ATTR_SCAN_FREQUENCIES],
  2902. tmp) {
  2903. struct ieee80211_channel *chan;
  2904. chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
  2905. if (!chan) {
  2906. err = -EINVAL;
  2907. goto out_free;
  2908. }
  2909. /* ignore disabled channels */
  2910. if (chan->flags & IEEE80211_CHAN_DISABLED)
  2911. continue;
  2912. request->channels[i] = chan;
  2913. i++;
  2914. }
  2915. } else {
  2916. /* all channels */
  2917. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  2918. int j;
  2919. if (!wiphy->bands[band])
  2920. continue;
  2921. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  2922. struct ieee80211_channel *chan;
  2923. chan = &wiphy->bands[band]->channels[j];
  2924. if (chan->flags & IEEE80211_CHAN_DISABLED)
  2925. continue;
  2926. request->channels[i] = chan;
  2927. i++;
  2928. }
  2929. }
  2930. }
  2931. if (!i) {
  2932. err = -EINVAL;
  2933. goto out_free;
  2934. }
  2935. request->n_channels = i;
  2936. i = 0;
  2937. if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
  2938. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS],
  2939. tmp) {
  2940. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  2941. err = -EINVAL;
  2942. goto out_free;
  2943. }
  2944. request->ssids[i].ssid_len = nla_len(attr);
  2945. memcpy(request->ssids[i].ssid, nla_data(attr),
  2946. nla_len(attr));
  2947. i++;
  2948. }
  2949. }
  2950. if (info->attrs[NL80211_ATTR_IE]) {
  2951. request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  2952. memcpy((void *)request->ie,
  2953. nla_data(info->attrs[NL80211_ATTR_IE]),
  2954. request->ie_len);
  2955. }
  2956. request->dev = dev;
  2957. request->wiphy = &rdev->wiphy;
  2958. request->interval = interval;
  2959. err = rdev->ops->sched_scan_start(&rdev->wiphy, dev, request);
  2960. if (!err) {
  2961. rdev->sched_scan_req = request;
  2962. nl80211_send_sched_scan(rdev, dev,
  2963. NL80211_CMD_START_SCHED_SCAN);
  2964. goto out;
  2965. }
  2966. out_free:
  2967. kfree(request);
  2968. out:
  2969. return err;
  2970. }
  2971. static int nl80211_stop_sched_scan(struct sk_buff *skb,
  2972. struct genl_info *info)
  2973. {
  2974. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2975. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
  2976. !rdev->ops->sched_scan_stop)
  2977. return -EOPNOTSUPP;
  2978. return __cfg80211_stop_sched_scan(rdev, false);
  2979. }
  2980. static int nl80211_send_bss(struct sk_buff *msg, u32 pid, u32 seq, int flags,
  2981. struct cfg80211_registered_device *rdev,
  2982. struct wireless_dev *wdev,
  2983. struct cfg80211_internal_bss *intbss)
  2984. {
  2985. struct cfg80211_bss *res = &intbss->pub;
  2986. void *hdr;
  2987. struct nlattr *bss;
  2988. int i;
  2989. ASSERT_WDEV_LOCK(wdev);
  2990. hdr = nl80211hdr_put(msg, pid, seq, flags,
  2991. NL80211_CMD_NEW_SCAN_RESULTS);
  2992. if (!hdr)
  2993. return -1;
  2994. NLA_PUT_U32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation);
  2995. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex);
  2996. bss = nla_nest_start(msg, NL80211_ATTR_BSS);
  2997. if (!bss)
  2998. goto nla_put_failure;
  2999. if (!is_zero_ether_addr(res->bssid))
  3000. NLA_PUT(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid);
  3001. if (res->information_elements && res->len_information_elements)
  3002. NLA_PUT(msg, NL80211_BSS_INFORMATION_ELEMENTS,
  3003. res->len_information_elements,
  3004. res->information_elements);
  3005. if (res->beacon_ies && res->len_beacon_ies &&
  3006. res->beacon_ies != res->information_elements)
  3007. NLA_PUT(msg, NL80211_BSS_BEACON_IES,
  3008. res->len_beacon_ies, res->beacon_ies);
  3009. if (res->tsf)
  3010. NLA_PUT_U64(msg, NL80211_BSS_TSF, res->tsf);
  3011. if (res->beacon_interval)
  3012. NLA_PUT_U16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval);
  3013. NLA_PUT_U16(msg, NL80211_BSS_CAPABILITY, res->capability);
  3014. NLA_PUT_U32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq);
  3015. NLA_PUT_U32(msg, NL80211_BSS_SEEN_MS_AGO,
  3016. jiffies_to_msecs(jiffies - intbss->ts));
  3017. switch (rdev->wiphy.signal_type) {
  3018. case CFG80211_SIGNAL_TYPE_MBM:
  3019. NLA_PUT_U32(msg, NL80211_BSS_SIGNAL_MBM, res->signal);
  3020. break;
  3021. case CFG80211_SIGNAL_TYPE_UNSPEC:
  3022. NLA_PUT_U8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal);
  3023. break;
  3024. default:
  3025. break;
  3026. }
  3027. switch (wdev->iftype) {
  3028. case NL80211_IFTYPE_P2P_CLIENT:
  3029. case NL80211_IFTYPE_STATION:
  3030. if (intbss == wdev->current_bss)
  3031. NLA_PUT_U32(msg, NL80211_BSS_STATUS,
  3032. NL80211_BSS_STATUS_ASSOCIATED);
  3033. else for (i = 0; i < MAX_AUTH_BSSES; i++) {
  3034. if (intbss != wdev->auth_bsses[i])
  3035. continue;
  3036. NLA_PUT_U32(msg, NL80211_BSS_STATUS,
  3037. NL80211_BSS_STATUS_AUTHENTICATED);
  3038. break;
  3039. }
  3040. break;
  3041. case NL80211_IFTYPE_ADHOC:
  3042. if (intbss == wdev->current_bss)
  3043. NLA_PUT_U32(msg, NL80211_BSS_STATUS,
  3044. NL80211_BSS_STATUS_IBSS_JOINED);
  3045. break;
  3046. default:
  3047. break;
  3048. }
  3049. nla_nest_end(msg, bss);
  3050. return genlmsg_end(msg, hdr);
  3051. nla_put_failure:
  3052. genlmsg_cancel(msg, hdr);
  3053. return -EMSGSIZE;
  3054. }
  3055. static int nl80211_dump_scan(struct sk_buff *skb,
  3056. struct netlink_callback *cb)
  3057. {
  3058. struct cfg80211_registered_device *rdev;
  3059. struct net_device *dev;
  3060. struct cfg80211_internal_bss *scan;
  3061. struct wireless_dev *wdev;
  3062. int start = cb->args[1], idx = 0;
  3063. int err;
  3064. err = nl80211_prepare_netdev_dump(skb, cb, &rdev, &dev);
  3065. if (err)
  3066. return err;
  3067. wdev = dev->ieee80211_ptr;
  3068. wdev_lock(wdev);
  3069. spin_lock_bh(&rdev->bss_lock);
  3070. cfg80211_bss_expire(rdev);
  3071. list_for_each_entry(scan, &rdev->bss_list, list) {
  3072. if (++idx <= start)
  3073. continue;
  3074. if (nl80211_send_bss(skb,
  3075. NETLINK_CB(cb->skb).pid,
  3076. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  3077. rdev, wdev, scan) < 0) {
  3078. idx--;
  3079. break;
  3080. }
  3081. }
  3082. spin_unlock_bh(&rdev->bss_lock);
  3083. wdev_unlock(wdev);
  3084. cb->args[1] = idx;
  3085. nl80211_finish_netdev_dump(rdev);
  3086. return skb->len;
  3087. }
  3088. static int nl80211_send_survey(struct sk_buff *msg, u32 pid, u32 seq,
  3089. int flags, struct net_device *dev,
  3090. struct survey_info *survey)
  3091. {
  3092. void *hdr;
  3093. struct nlattr *infoattr;
  3094. /* Survey without a channel doesn't make sense */
  3095. if (!survey->channel)
  3096. return -EINVAL;
  3097. hdr = nl80211hdr_put(msg, pid, seq, flags,
  3098. NL80211_CMD_NEW_SURVEY_RESULTS);
  3099. if (!hdr)
  3100. return -ENOMEM;
  3101. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
  3102. infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
  3103. if (!infoattr)
  3104. goto nla_put_failure;
  3105. NLA_PUT_U32(msg, NL80211_SURVEY_INFO_FREQUENCY,
  3106. survey->channel->center_freq);
  3107. if (survey->filled & SURVEY_INFO_NOISE_DBM)
  3108. NLA_PUT_U8(msg, NL80211_SURVEY_INFO_NOISE,
  3109. survey->noise);
  3110. if (survey->filled & SURVEY_INFO_IN_USE)
  3111. NLA_PUT_FLAG(msg, NL80211_SURVEY_INFO_IN_USE);
  3112. if (survey->filled & SURVEY_INFO_CHANNEL_TIME)
  3113. NLA_PUT_U64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME,
  3114. survey->channel_time);
  3115. if (survey->filled & SURVEY_INFO_CHANNEL_TIME_BUSY)
  3116. NLA_PUT_U64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_BUSY,
  3117. survey->channel_time_busy);
  3118. if (survey->filled & SURVEY_INFO_CHANNEL_TIME_EXT_BUSY)
  3119. NLA_PUT_U64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_EXT_BUSY,
  3120. survey->channel_time_ext_busy);
  3121. if (survey->filled & SURVEY_INFO_CHANNEL_TIME_RX)
  3122. NLA_PUT_U64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_RX,
  3123. survey->channel_time_rx);
  3124. if (survey->filled & SURVEY_INFO_CHANNEL_TIME_TX)
  3125. NLA_PUT_U64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_TX,
  3126. survey->channel_time_tx);
  3127. nla_nest_end(msg, infoattr);
  3128. return genlmsg_end(msg, hdr);
  3129. nla_put_failure:
  3130. genlmsg_cancel(msg, hdr);
  3131. return -EMSGSIZE;
  3132. }
  3133. static int nl80211_dump_survey(struct sk_buff *skb,
  3134. struct netlink_callback *cb)
  3135. {
  3136. struct survey_info survey;
  3137. struct cfg80211_registered_device *dev;
  3138. struct net_device *netdev;
  3139. int survey_idx = cb->args[1];
  3140. int res;
  3141. res = nl80211_prepare_netdev_dump(skb, cb, &dev, &netdev);
  3142. if (res)
  3143. return res;
  3144. if (!dev->ops->dump_survey) {
  3145. res = -EOPNOTSUPP;
  3146. goto out_err;
  3147. }
  3148. while (1) {
  3149. res = dev->ops->dump_survey(&dev->wiphy, netdev, survey_idx,
  3150. &survey);
  3151. if (res == -ENOENT)
  3152. break;
  3153. if (res)
  3154. goto out_err;
  3155. if (nl80211_send_survey(skb,
  3156. NETLINK_CB(cb->skb).pid,
  3157. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  3158. netdev,
  3159. &survey) < 0)
  3160. goto out;
  3161. survey_idx++;
  3162. }
  3163. out:
  3164. cb->args[1] = survey_idx;
  3165. res = skb->len;
  3166. out_err:
  3167. nl80211_finish_netdev_dump(dev);
  3168. return res;
  3169. }
  3170. static bool nl80211_valid_auth_type(enum nl80211_auth_type auth_type)
  3171. {
  3172. return auth_type <= NL80211_AUTHTYPE_MAX;
  3173. }
  3174. static bool nl80211_valid_wpa_versions(u32 wpa_versions)
  3175. {
  3176. return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
  3177. NL80211_WPA_VERSION_2));
  3178. }
  3179. static bool nl80211_valid_akm_suite(u32 akm)
  3180. {
  3181. return akm == WLAN_AKM_SUITE_8021X ||
  3182. akm == WLAN_AKM_SUITE_PSK;
  3183. }
  3184. static bool nl80211_valid_cipher_suite(u32 cipher)
  3185. {
  3186. return cipher == WLAN_CIPHER_SUITE_WEP40 ||
  3187. cipher == WLAN_CIPHER_SUITE_WEP104 ||
  3188. cipher == WLAN_CIPHER_SUITE_TKIP ||
  3189. cipher == WLAN_CIPHER_SUITE_CCMP ||
  3190. cipher == WLAN_CIPHER_SUITE_AES_CMAC;
  3191. }
  3192. static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
  3193. {
  3194. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3195. struct net_device *dev = info->user_ptr[1];
  3196. struct ieee80211_channel *chan;
  3197. const u8 *bssid, *ssid, *ie = NULL;
  3198. int err, ssid_len, ie_len = 0;
  3199. enum nl80211_auth_type auth_type;
  3200. struct key_parse key;
  3201. bool local_state_change;
  3202. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  3203. return -EINVAL;
  3204. if (!info->attrs[NL80211_ATTR_MAC])
  3205. return -EINVAL;
  3206. if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
  3207. return -EINVAL;
  3208. if (!info->attrs[NL80211_ATTR_SSID])
  3209. return -EINVAL;
  3210. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  3211. return -EINVAL;
  3212. err = nl80211_parse_key(info, &key);
  3213. if (err)
  3214. return err;
  3215. if (key.idx >= 0) {
  3216. if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
  3217. return -EINVAL;
  3218. if (!key.p.key || !key.p.key_len)
  3219. return -EINVAL;
  3220. if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
  3221. key.p.key_len != WLAN_KEY_LEN_WEP40) &&
  3222. (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
  3223. key.p.key_len != WLAN_KEY_LEN_WEP104))
  3224. return -EINVAL;
  3225. if (key.idx > 4)
  3226. return -EINVAL;
  3227. } else {
  3228. key.p.key_len = 0;
  3229. key.p.key = NULL;
  3230. }
  3231. if (key.idx >= 0) {
  3232. int i;
  3233. bool ok = false;
  3234. for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
  3235. if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
  3236. ok = true;
  3237. break;
  3238. }
  3239. }
  3240. if (!ok)
  3241. return -EINVAL;
  3242. }
  3243. if (!rdev->ops->auth)
  3244. return -EOPNOTSUPP;
  3245. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3246. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  3247. return -EOPNOTSUPP;
  3248. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3249. chan = ieee80211_get_channel(&rdev->wiphy,
  3250. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  3251. if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED))
  3252. return -EINVAL;
  3253. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  3254. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  3255. if (info->attrs[NL80211_ATTR_IE]) {
  3256. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  3257. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  3258. }
  3259. auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  3260. if (!nl80211_valid_auth_type(auth_type))
  3261. return -EINVAL;
  3262. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  3263. return cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
  3264. ssid, ssid_len, ie, ie_len,
  3265. key.p.key, key.p.key_len, key.idx,
  3266. local_state_change);
  3267. }
  3268. static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  3269. struct genl_info *info,
  3270. struct cfg80211_crypto_settings *settings,
  3271. int cipher_limit)
  3272. {
  3273. memset(settings, 0, sizeof(*settings));
  3274. settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
  3275. if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
  3276. u16 proto;
  3277. proto = nla_get_u16(
  3278. info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
  3279. settings->control_port_ethertype = cpu_to_be16(proto);
  3280. if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  3281. proto != ETH_P_PAE)
  3282. return -EINVAL;
  3283. if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
  3284. settings->control_port_no_encrypt = true;
  3285. } else
  3286. settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
  3287. if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
  3288. void *data;
  3289. int len, i;
  3290. data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  3291. len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  3292. settings->n_ciphers_pairwise = len / sizeof(u32);
  3293. if (len % sizeof(u32))
  3294. return -EINVAL;
  3295. if (settings->n_ciphers_pairwise > cipher_limit)
  3296. return -EINVAL;
  3297. memcpy(settings->ciphers_pairwise, data, len);
  3298. for (i = 0; i < settings->n_ciphers_pairwise; i++)
  3299. if (!nl80211_valid_cipher_suite(
  3300. settings->ciphers_pairwise[i]))
  3301. return -EINVAL;
  3302. }
  3303. if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
  3304. settings->cipher_group =
  3305. nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
  3306. if (!nl80211_valid_cipher_suite(settings->cipher_group))
  3307. return -EINVAL;
  3308. }
  3309. if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
  3310. settings->wpa_versions =
  3311. nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
  3312. if (!nl80211_valid_wpa_versions(settings->wpa_versions))
  3313. return -EINVAL;
  3314. }
  3315. if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
  3316. void *data;
  3317. int len, i;
  3318. data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
  3319. len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
  3320. settings->n_akm_suites = len / sizeof(u32);
  3321. if (len % sizeof(u32))
  3322. return -EINVAL;
  3323. memcpy(settings->akm_suites, data, len);
  3324. for (i = 0; i < settings->n_ciphers_pairwise; i++)
  3325. if (!nl80211_valid_akm_suite(settings->akm_suites[i]))
  3326. return -EINVAL;
  3327. }
  3328. return 0;
  3329. }
  3330. static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
  3331. {
  3332. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3333. struct net_device *dev = info->user_ptr[1];
  3334. struct cfg80211_crypto_settings crypto;
  3335. struct ieee80211_channel *chan;
  3336. const u8 *bssid, *ssid, *ie = NULL, *prev_bssid = NULL;
  3337. int err, ssid_len, ie_len = 0;
  3338. bool use_mfp = false;
  3339. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  3340. return -EINVAL;
  3341. if (!info->attrs[NL80211_ATTR_MAC] ||
  3342. !info->attrs[NL80211_ATTR_SSID] ||
  3343. !info->attrs[NL80211_ATTR_WIPHY_FREQ])
  3344. return -EINVAL;
  3345. if (!rdev->ops->assoc)
  3346. return -EOPNOTSUPP;
  3347. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3348. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  3349. return -EOPNOTSUPP;
  3350. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3351. chan = ieee80211_get_channel(&rdev->wiphy,
  3352. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  3353. if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED))
  3354. return -EINVAL;
  3355. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  3356. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  3357. if (info->attrs[NL80211_ATTR_IE]) {
  3358. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  3359. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  3360. }
  3361. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  3362. enum nl80211_mfp mfp =
  3363. nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  3364. if (mfp == NL80211_MFP_REQUIRED)
  3365. use_mfp = true;
  3366. else if (mfp != NL80211_MFP_NO)
  3367. return -EINVAL;
  3368. }
  3369. if (info->attrs[NL80211_ATTR_PREV_BSSID])
  3370. prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
  3371. err = nl80211_crypto_settings(rdev, info, &crypto, 1);
  3372. if (!err)
  3373. err = cfg80211_mlme_assoc(rdev, dev, chan, bssid, prev_bssid,
  3374. ssid, ssid_len, ie, ie_len, use_mfp,
  3375. &crypto);
  3376. return err;
  3377. }
  3378. static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
  3379. {
  3380. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3381. struct net_device *dev = info->user_ptr[1];
  3382. const u8 *ie = NULL, *bssid;
  3383. int ie_len = 0;
  3384. u16 reason_code;
  3385. bool local_state_change;
  3386. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  3387. return -EINVAL;
  3388. if (!info->attrs[NL80211_ATTR_MAC])
  3389. return -EINVAL;
  3390. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  3391. return -EINVAL;
  3392. if (!rdev->ops->deauth)
  3393. return -EOPNOTSUPP;
  3394. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3395. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  3396. return -EOPNOTSUPP;
  3397. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3398. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  3399. if (reason_code == 0) {
  3400. /* Reason Code 0 is reserved */
  3401. return -EINVAL;
  3402. }
  3403. if (info->attrs[NL80211_ATTR_IE]) {
  3404. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  3405. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  3406. }
  3407. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  3408. return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
  3409. local_state_change);
  3410. }
  3411. static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
  3412. {
  3413. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3414. struct net_device *dev = info->user_ptr[1];
  3415. const u8 *ie = NULL, *bssid;
  3416. int ie_len = 0;
  3417. u16 reason_code;
  3418. bool local_state_change;
  3419. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  3420. return -EINVAL;
  3421. if (!info->attrs[NL80211_ATTR_MAC])
  3422. return -EINVAL;
  3423. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  3424. return -EINVAL;
  3425. if (!rdev->ops->disassoc)
  3426. return -EOPNOTSUPP;
  3427. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3428. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  3429. return -EOPNOTSUPP;
  3430. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3431. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  3432. if (reason_code == 0) {
  3433. /* Reason Code 0 is reserved */
  3434. return -EINVAL;
  3435. }
  3436. if (info->attrs[NL80211_ATTR_IE]) {
  3437. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  3438. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  3439. }
  3440. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  3441. return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
  3442. local_state_change);
  3443. }
  3444. static bool
  3445. nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
  3446. int mcast_rate[IEEE80211_NUM_BANDS],
  3447. int rateval)
  3448. {
  3449. struct wiphy *wiphy = &rdev->wiphy;
  3450. bool found = false;
  3451. int band, i;
  3452. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  3453. struct ieee80211_supported_band *sband;
  3454. sband = wiphy->bands[band];
  3455. if (!sband)
  3456. continue;
  3457. for (i = 0; i < sband->n_bitrates; i++) {
  3458. if (sband->bitrates[i].bitrate == rateval) {
  3459. mcast_rate[band] = i + 1;
  3460. found = true;
  3461. break;
  3462. }
  3463. }
  3464. }
  3465. return found;
  3466. }
  3467. static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
  3468. {
  3469. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3470. struct net_device *dev = info->user_ptr[1];
  3471. struct cfg80211_ibss_params ibss;
  3472. struct wiphy *wiphy;
  3473. struct cfg80211_cached_keys *connkeys = NULL;
  3474. int err;
  3475. memset(&ibss, 0, sizeof(ibss));
  3476. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  3477. return -EINVAL;
  3478. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  3479. !info->attrs[NL80211_ATTR_SSID] ||
  3480. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  3481. return -EINVAL;
  3482. ibss.beacon_interval = 100;
  3483. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
  3484. ibss.beacon_interval =
  3485. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  3486. if (ibss.beacon_interval < 1 || ibss.beacon_interval > 10000)
  3487. return -EINVAL;
  3488. }
  3489. if (!rdev->ops->join_ibss)
  3490. return -EOPNOTSUPP;
  3491. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  3492. return -EOPNOTSUPP;
  3493. wiphy = &rdev->wiphy;
  3494. if (info->attrs[NL80211_ATTR_MAC])
  3495. ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3496. ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  3497. ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  3498. if (info->attrs[NL80211_ATTR_IE]) {
  3499. ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  3500. ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  3501. }
  3502. ibss.channel = ieee80211_get_channel(wiphy,
  3503. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  3504. if (!ibss.channel ||
  3505. ibss.channel->flags & IEEE80211_CHAN_NO_IBSS ||
  3506. ibss.channel->flags & IEEE80211_CHAN_DISABLED)
  3507. return -EINVAL;
  3508. ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
  3509. ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  3510. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  3511. u8 *rates =
  3512. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  3513. int n_rates =
  3514. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  3515. struct ieee80211_supported_band *sband =
  3516. wiphy->bands[ibss.channel->band];
  3517. int i, j;
  3518. if (n_rates == 0)
  3519. return -EINVAL;
  3520. for (i = 0; i < n_rates; i++) {
  3521. int rate = (rates[i] & 0x7f) * 5;
  3522. bool found = false;
  3523. for (j = 0; j < sband->n_bitrates; j++) {
  3524. if (sband->bitrates[j].bitrate == rate) {
  3525. found = true;
  3526. ibss.basic_rates |= BIT(j);
  3527. break;
  3528. }
  3529. }
  3530. if (!found)
  3531. return -EINVAL;
  3532. }
  3533. }
  3534. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  3535. !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
  3536. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  3537. return -EINVAL;
  3538. if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  3539. connkeys = nl80211_parse_connkeys(rdev,
  3540. info->attrs[NL80211_ATTR_KEYS]);
  3541. if (IS_ERR(connkeys))
  3542. return PTR_ERR(connkeys);
  3543. }
  3544. err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
  3545. if (err)
  3546. kfree(connkeys);
  3547. return err;
  3548. }
  3549. static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
  3550. {
  3551. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3552. struct net_device *dev = info->user_ptr[1];
  3553. if (!rdev->ops->leave_ibss)
  3554. return -EOPNOTSUPP;
  3555. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  3556. return -EOPNOTSUPP;
  3557. return cfg80211_leave_ibss(rdev, dev, false);
  3558. }
  3559. #ifdef CONFIG_NL80211_TESTMODE
  3560. static struct genl_multicast_group nl80211_testmode_mcgrp = {
  3561. .name = "testmode",
  3562. };
  3563. static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
  3564. {
  3565. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3566. int err;
  3567. if (!info->attrs[NL80211_ATTR_TESTDATA])
  3568. return -EINVAL;
  3569. err = -EOPNOTSUPP;
  3570. if (rdev->ops->testmode_cmd) {
  3571. rdev->testmode_info = info;
  3572. err = rdev->ops->testmode_cmd(&rdev->wiphy,
  3573. nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
  3574. nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
  3575. rdev->testmode_info = NULL;
  3576. }
  3577. return err;
  3578. }
  3579. static struct sk_buff *
  3580. __cfg80211_testmode_alloc_skb(struct cfg80211_registered_device *rdev,
  3581. int approxlen, u32 pid, u32 seq, gfp_t gfp)
  3582. {
  3583. struct sk_buff *skb;
  3584. void *hdr;
  3585. struct nlattr *data;
  3586. skb = nlmsg_new(approxlen + 100, gfp);
  3587. if (!skb)
  3588. return NULL;
  3589. hdr = nl80211hdr_put(skb, pid, seq, 0, NL80211_CMD_TESTMODE);
  3590. if (!hdr) {
  3591. kfree_skb(skb);
  3592. return NULL;
  3593. }
  3594. NLA_PUT_U32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  3595. data = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
  3596. ((void **)skb->cb)[0] = rdev;
  3597. ((void **)skb->cb)[1] = hdr;
  3598. ((void **)skb->cb)[2] = data;
  3599. return skb;
  3600. nla_put_failure:
  3601. kfree_skb(skb);
  3602. return NULL;
  3603. }
  3604. struct sk_buff *cfg80211_testmode_alloc_reply_skb(struct wiphy *wiphy,
  3605. int approxlen)
  3606. {
  3607. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  3608. if (WARN_ON(!rdev->testmode_info))
  3609. return NULL;
  3610. return __cfg80211_testmode_alloc_skb(rdev, approxlen,
  3611. rdev->testmode_info->snd_pid,
  3612. rdev->testmode_info->snd_seq,
  3613. GFP_KERNEL);
  3614. }
  3615. EXPORT_SYMBOL(cfg80211_testmode_alloc_reply_skb);
  3616. int cfg80211_testmode_reply(struct sk_buff *skb)
  3617. {
  3618. struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
  3619. void *hdr = ((void **)skb->cb)[1];
  3620. struct nlattr *data = ((void **)skb->cb)[2];
  3621. if (WARN_ON(!rdev->testmode_info)) {
  3622. kfree_skb(skb);
  3623. return -EINVAL;
  3624. }
  3625. nla_nest_end(skb, data);
  3626. genlmsg_end(skb, hdr);
  3627. return genlmsg_reply(skb, rdev->testmode_info);
  3628. }
  3629. EXPORT_SYMBOL(cfg80211_testmode_reply);
  3630. struct sk_buff *cfg80211_testmode_alloc_event_skb(struct wiphy *wiphy,
  3631. int approxlen, gfp_t gfp)
  3632. {
  3633. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  3634. return __cfg80211_testmode_alloc_skb(rdev, approxlen, 0, 0, gfp);
  3635. }
  3636. EXPORT_SYMBOL(cfg80211_testmode_alloc_event_skb);
  3637. void cfg80211_testmode_event(struct sk_buff *skb, gfp_t gfp)
  3638. {
  3639. void *hdr = ((void **)skb->cb)[1];
  3640. struct nlattr *data = ((void **)skb->cb)[2];
  3641. nla_nest_end(skb, data);
  3642. genlmsg_end(skb, hdr);
  3643. genlmsg_multicast(skb, 0, nl80211_testmode_mcgrp.id, gfp);
  3644. }
  3645. EXPORT_SYMBOL(cfg80211_testmode_event);
  3646. #endif
  3647. static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
  3648. {
  3649. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3650. struct net_device *dev = info->user_ptr[1];
  3651. struct cfg80211_connect_params connect;
  3652. struct wiphy *wiphy;
  3653. struct cfg80211_cached_keys *connkeys = NULL;
  3654. int err;
  3655. memset(&connect, 0, sizeof(connect));
  3656. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  3657. return -EINVAL;
  3658. if (!info->attrs[NL80211_ATTR_SSID] ||
  3659. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  3660. return -EINVAL;
  3661. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  3662. connect.auth_type =
  3663. nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  3664. if (!nl80211_valid_auth_type(connect.auth_type))
  3665. return -EINVAL;
  3666. } else
  3667. connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  3668. connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
  3669. err = nl80211_crypto_settings(rdev, info, &connect.crypto,
  3670. NL80211_MAX_NR_CIPHER_SUITES);
  3671. if (err)
  3672. return err;
  3673. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3674. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  3675. return -EOPNOTSUPP;
  3676. wiphy = &rdev->wiphy;
  3677. if (info->attrs[NL80211_ATTR_MAC])
  3678. connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3679. connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  3680. connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  3681. if (info->attrs[NL80211_ATTR_IE]) {
  3682. connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  3683. connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  3684. }
  3685. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  3686. connect.channel =
  3687. ieee80211_get_channel(wiphy,
  3688. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  3689. if (!connect.channel ||
  3690. connect.channel->flags & IEEE80211_CHAN_DISABLED)
  3691. return -EINVAL;
  3692. }
  3693. if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  3694. connkeys = nl80211_parse_connkeys(rdev,
  3695. info->attrs[NL80211_ATTR_KEYS]);
  3696. if (IS_ERR(connkeys))
  3697. return PTR_ERR(connkeys);
  3698. }
  3699. err = cfg80211_connect(rdev, dev, &connect, connkeys);
  3700. if (err)
  3701. kfree(connkeys);
  3702. return err;
  3703. }
  3704. static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
  3705. {
  3706. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3707. struct net_device *dev = info->user_ptr[1];
  3708. u16 reason;
  3709. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  3710. reason = WLAN_REASON_DEAUTH_LEAVING;
  3711. else
  3712. reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  3713. if (reason == 0)
  3714. return -EINVAL;
  3715. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3716. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  3717. return -EOPNOTSUPP;
  3718. return cfg80211_disconnect(rdev, dev, reason, true);
  3719. }
  3720. static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
  3721. {
  3722. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3723. struct net *net;
  3724. int err;
  3725. u32 pid;
  3726. if (!info->attrs[NL80211_ATTR_PID])
  3727. return -EINVAL;
  3728. pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
  3729. net = get_net_ns_by_pid(pid);
  3730. if (IS_ERR(net))
  3731. return PTR_ERR(net);
  3732. err = 0;
  3733. /* check if anything to do */
  3734. if (!net_eq(wiphy_net(&rdev->wiphy), net))
  3735. err = cfg80211_switch_netns(rdev, net);
  3736. put_net(net);
  3737. return err;
  3738. }
  3739. static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
  3740. {
  3741. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3742. int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
  3743. struct cfg80211_pmksa *pmksa) = NULL;
  3744. struct net_device *dev = info->user_ptr[1];
  3745. struct cfg80211_pmksa pmksa;
  3746. memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
  3747. if (!info->attrs[NL80211_ATTR_MAC])
  3748. return -EINVAL;
  3749. if (!info->attrs[NL80211_ATTR_PMKID])
  3750. return -EINVAL;
  3751. pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  3752. pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3753. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3754. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  3755. return -EOPNOTSUPP;
  3756. switch (info->genlhdr->cmd) {
  3757. case NL80211_CMD_SET_PMKSA:
  3758. rdev_ops = rdev->ops->set_pmksa;
  3759. break;
  3760. case NL80211_CMD_DEL_PMKSA:
  3761. rdev_ops = rdev->ops->del_pmksa;
  3762. break;
  3763. default:
  3764. WARN_ON(1);
  3765. break;
  3766. }
  3767. if (!rdev_ops)
  3768. return -EOPNOTSUPP;
  3769. return rdev_ops(&rdev->wiphy, dev, &pmksa);
  3770. }
  3771. static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
  3772. {
  3773. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3774. struct net_device *dev = info->user_ptr[1];
  3775. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3776. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  3777. return -EOPNOTSUPP;
  3778. if (!rdev->ops->flush_pmksa)
  3779. return -EOPNOTSUPP;
  3780. return rdev->ops->flush_pmksa(&rdev->wiphy, dev);
  3781. }
  3782. static int nl80211_remain_on_channel(struct sk_buff *skb,
  3783. struct genl_info *info)
  3784. {
  3785. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3786. struct net_device *dev = info->user_ptr[1];
  3787. struct ieee80211_channel *chan;
  3788. struct sk_buff *msg;
  3789. void *hdr;
  3790. u64 cookie;
  3791. enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
  3792. u32 freq, duration;
  3793. int err;
  3794. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  3795. !info->attrs[NL80211_ATTR_DURATION])
  3796. return -EINVAL;
  3797. duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  3798. /*
  3799. * We should be on that channel for at least one jiffie,
  3800. * and more than 5 seconds seems excessive.
  3801. */
  3802. if (!duration || !msecs_to_jiffies(duration) ||
  3803. duration > rdev->wiphy.max_remain_on_channel_duration)
  3804. return -EINVAL;
  3805. if (!rdev->ops->remain_on_channel)
  3806. return -EOPNOTSUPP;
  3807. if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
  3808. channel_type = nla_get_u32(
  3809. info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
  3810. if (channel_type != NL80211_CHAN_NO_HT &&
  3811. channel_type != NL80211_CHAN_HT20 &&
  3812. channel_type != NL80211_CHAN_HT40PLUS &&
  3813. channel_type != NL80211_CHAN_HT40MINUS)
  3814. return -EINVAL;
  3815. }
  3816. freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
  3817. chan = rdev_freq_to_chan(rdev, freq, channel_type);
  3818. if (chan == NULL)
  3819. return -EINVAL;
  3820. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3821. if (!msg)
  3822. return -ENOMEM;
  3823. hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
  3824. NL80211_CMD_REMAIN_ON_CHANNEL);
  3825. if (IS_ERR(hdr)) {
  3826. err = PTR_ERR(hdr);
  3827. goto free_msg;
  3828. }
  3829. err = rdev->ops->remain_on_channel(&rdev->wiphy, dev, chan,
  3830. channel_type, duration, &cookie);
  3831. if (err)
  3832. goto free_msg;
  3833. NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
  3834. genlmsg_end(msg, hdr);
  3835. return genlmsg_reply(msg, info);
  3836. nla_put_failure:
  3837. err = -ENOBUFS;
  3838. free_msg:
  3839. nlmsg_free(msg);
  3840. return err;
  3841. }
  3842. static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
  3843. struct genl_info *info)
  3844. {
  3845. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3846. struct net_device *dev = info->user_ptr[1];
  3847. u64 cookie;
  3848. if (!info->attrs[NL80211_ATTR_COOKIE])
  3849. return -EINVAL;
  3850. if (!rdev->ops->cancel_remain_on_channel)
  3851. return -EOPNOTSUPP;
  3852. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  3853. return rdev->ops->cancel_remain_on_channel(&rdev->wiphy, dev, cookie);
  3854. }
  3855. static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
  3856. u8 *rates, u8 rates_len)
  3857. {
  3858. u8 i;
  3859. u32 mask = 0;
  3860. for (i = 0; i < rates_len; i++) {
  3861. int rate = (rates[i] & 0x7f) * 5;
  3862. int ridx;
  3863. for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
  3864. struct ieee80211_rate *srate =
  3865. &sband->bitrates[ridx];
  3866. if (rate == srate->bitrate) {
  3867. mask |= 1 << ridx;
  3868. break;
  3869. }
  3870. }
  3871. if (ridx == sband->n_bitrates)
  3872. return 0; /* rate not found */
  3873. }
  3874. return mask;
  3875. }
  3876. static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
  3877. [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
  3878. .len = NL80211_MAX_SUPP_RATES },
  3879. };
  3880. static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
  3881. struct genl_info *info)
  3882. {
  3883. struct nlattr *tb[NL80211_TXRATE_MAX + 1];
  3884. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3885. struct cfg80211_bitrate_mask mask;
  3886. int rem, i;
  3887. struct net_device *dev = info->user_ptr[1];
  3888. struct nlattr *tx_rates;
  3889. struct ieee80211_supported_band *sband;
  3890. if (info->attrs[NL80211_ATTR_TX_RATES] == NULL)
  3891. return -EINVAL;
  3892. if (!rdev->ops->set_bitrate_mask)
  3893. return -EOPNOTSUPP;
  3894. memset(&mask, 0, sizeof(mask));
  3895. /* Default to all rates enabled */
  3896. for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
  3897. sband = rdev->wiphy.bands[i];
  3898. mask.control[i].legacy =
  3899. sband ? (1 << sband->n_bitrates) - 1 : 0;
  3900. }
  3901. /*
  3902. * The nested attribute uses enum nl80211_band as the index. This maps
  3903. * directly to the enum ieee80211_band values used in cfg80211.
  3904. */
  3905. nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem)
  3906. {
  3907. enum ieee80211_band band = nla_type(tx_rates);
  3908. if (band < 0 || band >= IEEE80211_NUM_BANDS)
  3909. return -EINVAL;
  3910. sband = rdev->wiphy.bands[band];
  3911. if (sband == NULL)
  3912. return -EINVAL;
  3913. nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
  3914. nla_len(tx_rates), nl80211_txattr_policy);
  3915. if (tb[NL80211_TXRATE_LEGACY]) {
  3916. mask.control[band].legacy = rateset_to_mask(
  3917. sband,
  3918. nla_data(tb[NL80211_TXRATE_LEGACY]),
  3919. nla_len(tb[NL80211_TXRATE_LEGACY]));
  3920. if (mask.control[band].legacy == 0)
  3921. return -EINVAL;
  3922. }
  3923. }
  3924. return rdev->ops->set_bitrate_mask(&rdev->wiphy, dev, NULL, &mask);
  3925. }
  3926. static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
  3927. {
  3928. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3929. struct net_device *dev = info->user_ptr[1];
  3930. u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
  3931. if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
  3932. return -EINVAL;
  3933. if (info->attrs[NL80211_ATTR_FRAME_TYPE])
  3934. frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
  3935. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3936. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
  3937. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
  3938. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3939. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  3940. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  3941. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3942. return -EOPNOTSUPP;
  3943. /* not much point in registering if we can't reply */
  3944. if (!rdev->ops->mgmt_tx)
  3945. return -EOPNOTSUPP;
  3946. return cfg80211_mlme_register_mgmt(dev->ieee80211_ptr, info->snd_pid,
  3947. frame_type,
  3948. nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
  3949. nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
  3950. }
  3951. static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
  3952. {
  3953. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3954. struct net_device *dev = info->user_ptr[1];
  3955. struct ieee80211_channel *chan;
  3956. enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
  3957. bool channel_type_valid = false;
  3958. u32 freq;
  3959. int err;
  3960. void *hdr;
  3961. u64 cookie;
  3962. struct sk_buff *msg;
  3963. unsigned int wait = 0;
  3964. bool offchan;
  3965. if (!info->attrs[NL80211_ATTR_FRAME] ||
  3966. !info->attrs[NL80211_ATTR_WIPHY_FREQ])
  3967. return -EINVAL;
  3968. if (!rdev->ops->mgmt_tx)
  3969. return -EOPNOTSUPP;
  3970. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  3971. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
  3972. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
  3973. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3974. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  3975. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  3976. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3977. return -EOPNOTSUPP;
  3978. if (info->attrs[NL80211_ATTR_DURATION]) {
  3979. if (!rdev->ops->mgmt_tx_cancel_wait)
  3980. return -EINVAL;
  3981. wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  3982. }
  3983. if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
  3984. channel_type = nla_get_u32(
  3985. info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
  3986. if (channel_type != NL80211_CHAN_NO_HT &&
  3987. channel_type != NL80211_CHAN_HT20 &&
  3988. channel_type != NL80211_CHAN_HT40PLUS &&
  3989. channel_type != NL80211_CHAN_HT40MINUS)
  3990. return -EINVAL;
  3991. channel_type_valid = true;
  3992. }
  3993. offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
  3994. freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
  3995. chan = rdev_freq_to_chan(rdev, freq, channel_type);
  3996. if (chan == NULL)
  3997. return -EINVAL;
  3998. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3999. if (!msg)
  4000. return -ENOMEM;
  4001. hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
  4002. NL80211_CMD_FRAME);
  4003. if (IS_ERR(hdr)) {
  4004. err = PTR_ERR(hdr);
  4005. goto free_msg;
  4006. }
  4007. err = cfg80211_mlme_mgmt_tx(rdev, dev, chan, offchan, channel_type,
  4008. channel_type_valid, wait,
  4009. nla_data(info->attrs[NL80211_ATTR_FRAME]),
  4010. nla_len(info->attrs[NL80211_ATTR_FRAME]),
  4011. &cookie);
  4012. if (err)
  4013. goto free_msg;
  4014. NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
  4015. genlmsg_end(msg, hdr);
  4016. return genlmsg_reply(msg, info);
  4017. nla_put_failure:
  4018. err = -ENOBUFS;
  4019. free_msg:
  4020. nlmsg_free(msg);
  4021. return err;
  4022. }
  4023. static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
  4024. {
  4025. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4026. struct net_device *dev = info->user_ptr[1];
  4027. u64 cookie;
  4028. if (!info->attrs[NL80211_ATTR_COOKIE])
  4029. return -EINVAL;
  4030. if (!rdev->ops->mgmt_tx_cancel_wait)
  4031. return -EOPNOTSUPP;
  4032. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  4033. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
  4034. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
  4035. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  4036. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  4037. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  4038. return -EOPNOTSUPP;
  4039. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  4040. return rdev->ops->mgmt_tx_cancel_wait(&rdev->wiphy, dev, cookie);
  4041. }
  4042. static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
  4043. {
  4044. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4045. struct wireless_dev *wdev;
  4046. struct net_device *dev = info->user_ptr[1];
  4047. u8 ps_state;
  4048. bool state;
  4049. int err;
  4050. if (!info->attrs[NL80211_ATTR_PS_STATE])
  4051. return -EINVAL;
  4052. ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
  4053. if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
  4054. return -EINVAL;
  4055. wdev = dev->ieee80211_ptr;
  4056. if (!rdev->ops->set_power_mgmt)
  4057. return -EOPNOTSUPP;
  4058. state = (ps_state == NL80211_PS_ENABLED) ? true : false;
  4059. if (state == wdev->ps)
  4060. return 0;
  4061. err = rdev->ops->set_power_mgmt(wdev->wiphy, dev, state,
  4062. wdev->ps_timeout);
  4063. if (!err)
  4064. wdev->ps = state;
  4065. return err;
  4066. }
  4067. static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
  4068. {
  4069. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4070. enum nl80211_ps_state ps_state;
  4071. struct wireless_dev *wdev;
  4072. struct net_device *dev = info->user_ptr[1];
  4073. struct sk_buff *msg;
  4074. void *hdr;
  4075. int err;
  4076. wdev = dev->ieee80211_ptr;
  4077. if (!rdev->ops->set_power_mgmt)
  4078. return -EOPNOTSUPP;
  4079. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4080. if (!msg)
  4081. return -ENOMEM;
  4082. hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
  4083. NL80211_CMD_GET_POWER_SAVE);
  4084. if (!hdr) {
  4085. err = -ENOBUFS;
  4086. goto free_msg;
  4087. }
  4088. if (wdev->ps)
  4089. ps_state = NL80211_PS_ENABLED;
  4090. else
  4091. ps_state = NL80211_PS_DISABLED;
  4092. NLA_PUT_U32(msg, NL80211_ATTR_PS_STATE, ps_state);
  4093. genlmsg_end(msg, hdr);
  4094. return genlmsg_reply(msg, info);
  4095. nla_put_failure:
  4096. err = -ENOBUFS;
  4097. free_msg:
  4098. nlmsg_free(msg);
  4099. return err;
  4100. }
  4101. static struct nla_policy
  4102. nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] __read_mostly = {
  4103. [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
  4104. [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
  4105. [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
  4106. };
  4107. static int nl80211_set_cqm_rssi(struct genl_info *info,
  4108. s32 threshold, u32 hysteresis)
  4109. {
  4110. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4111. struct wireless_dev *wdev;
  4112. struct net_device *dev = info->user_ptr[1];
  4113. if (threshold > 0)
  4114. return -EINVAL;
  4115. wdev = dev->ieee80211_ptr;
  4116. if (!rdev->ops->set_cqm_rssi_config)
  4117. return -EOPNOTSUPP;
  4118. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  4119. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  4120. return -EOPNOTSUPP;
  4121. return rdev->ops->set_cqm_rssi_config(wdev->wiphy, dev,
  4122. threshold, hysteresis);
  4123. }
  4124. static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
  4125. {
  4126. struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
  4127. struct nlattr *cqm;
  4128. int err;
  4129. cqm = info->attrs[NL80211_ATTR_CQM];
  4130. if (!cqm) {
  4131. err = -EINVAL;
  4132. goto out;
  4133. }
  4134. err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
  4135. nl80211_attr_cqm_policy);
  4136. if (err)
  4137. goto out;
  4138. if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
  4139. attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
  4140. s32 threshold;
  4141. u32 hysteresis;
  4142. threshold = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
  4143. hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
  4144. err = nl80211_set_cqm_rssi(info, threshold, hysteresis);
  4145. } else
  4146. err = -EINVAL;
  4147. out:
  4148. return err;
  4149. }
  4150. static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
  4151. {
  4152. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4153. struct net_device *dev = info->user_ptr[1];
  4154. struct mesh_config cfg;
  4155. struct mesh_setup setup;
  4156. int err;
  4157. /* start with default */
  4158. memcpy(&cfg, &default_mesh_config, sizeof(cfg));
  4159. memcpy(&setup, &default_mesh_setup, sizeof(setup));
  4160. if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
  4161. /* and parse parameters if given */
  4162. err = nl80211_parse_mesh_config(info, &cfg, NULL);
  4163. if (err)
  4164. return err;
  4165. }
  4166. if (!info->attrs[NL80211_ATTR_MESH_ID] ||
  4167. !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
  4168. return -EINVAL;
  4169. setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
  4170. setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  4171. if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
  4172. /* parse additional setup parameters if given */
  4173. err = nl80211_parse_mesh_setup(info, &setup);
  4174. if (err)
  4175. return err;
  4176. }
  4177. return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
  4178. }
  4179. static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
  4180. {
  4181. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4182. struct net_device *dev = info->user_ptr[1];
  4183. return cfg80211_leave_mesh(rdev, dev);
  4184. }
  4185. static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
  4186. {
  4187. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4188. struct sk_buff *msg;
  4189. void *hdr;
  4190. if (!rdev->wiphy.wowlan.flags && !rdev->wiphy.wowlan.n_patterns)
  4191. return -EOPNOTSUPP;
  4192. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4193. if (!msg)
  4194. return -ENOMEM;
  4195. hdr = nl80211hdr_put(msg, info->snd_pid, info->snd_seq, 0,
  4196. NL80211_CMD_GET_WOWLAN);
  4197. if (!hdr)
  4198. goto nla_put_failure;
  4199. if (rdev->wowlan) {
  4200. struct nlattr *nl_wowlan;
  4201. nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
  4202. if (!nl_wowlan)
  4203. goto nla_put_failure;
  4204. if (rdev->wowlan->any)
  4205. NLA_PUT_FLAG(msg, NL80211_WOWLAN_TRIG_ANY);
  4206. if (rdev->wowlan->disconnect)
  4207. NLA_PUT_FLAG(msg, NL80211_WOWLAN_TRIG_DISCONNECT);
  4208. if (rdev->wowlan->magic_pkt)
  4209. NLA_PUT_FLAG(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT);
  4210. if (rdev->wowlan->n_patterns) {
  4211. struct nlattr *nl_pats, *nl_pat;
  4212. int i, pat_len;
  4213. nl_pats = nla_nest_start(msg,
  4214. NL80211_WOWLAN_TRIG_PKT_PATTERN);
  4215. if (!nl_pats)
  4216. goto nla_put_failure;
  4217. for (i = 0; i < rdev->wowlan->n_patterns; i++) {
  4218. nl_pat = nla_nest_start(msg, i + 1);
  4219. if (!nl_pat)
  4220. goto nla_put_failure;
  4221. pat_len = rdev->wowlan->patterns[i].pattern_len;
  4222. NLA_PUT(msg, NL80211_WOWLAN_PKTPAT_MASK,
  4223. DIV_ROUND_UP(pat_len, 8),
  4224. rdev->wowlan->patterns[i].mask);
  4225. NLA_PUT(msg, NL80211_WOWLAN_PKTPAT_PATTERN,
  4226. pat_len,
  4227. rdev->wowlan->patterns[i].pattern);
  4228. nla_nest_end(msg, nl_pat);
  4229. }
  4230. nla_nest_end(msg, nl_pats);
  4231. }
  4232. nla_nest_end(msg, nl_wowlan);
  4233. }
  4234. genlmsg_end(msg, hdr);
  4235. return genlmsg_reply(msg, info);
  4236. nla_put_failure:
  4237. nlmsg_free(msg);
  4238. return -ENOBUFS;
  4239. }
  4240. static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
  4241. {
  4242. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4243. struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
  4244. struct cfg80211_wowlan no_triggers = {};
  4245. struct cfg80211_wowlan new_triggers = {};
  4246. struct wiphy_wowlan_support *wowlan = &rdev->wiphy.wowlan;
  4247. int err, i;
  4248. if (!rdev->wiphy.wowlan.flags && !rdev->wiphy.wowlan.n_patterns)
  4249. return -EOPNOTSUPP;
  4250. if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS])
  4251. goto no_triggers;
  4252. err = nla_parse(tb, MAX_NL80211_WOWLAN_TRIG,
  4253. nla_data(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
  4254. nla_len(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
  4255. nl80211_wowlan_policy);
  4256. if (err)
  4257. return err;
  4258. if (tb[NL80211_WOWLAN_TRIG_ANY]) {
  4259. if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
  4260. return -EINVAL;
  4261. new_triggers.any = true;
  4262. }
  4263. if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
  4264. if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
  4265. return -EINVAL;
  4266. new_triggers.disconnect = true;
  4267. }
  4268. if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
  4269. if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
  4270. return -EINVAL;
  4271. new_triggers.magic_pkt = true;
  4272. }
  4273. if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
  4274. struct nlattr *pat;
  4275. int n_patterns = 0;
  4276. int rem, pat_len, mask_len;
  4277. struct nlattr *pat_tb[NUM_NL80211_WOWLAN_PKTPAT];
  4278. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  4279. rem)
  4280. n_patterns++;
  4281. if (n_patterns > wowlan->n_patterns)
  4282. return -EINVAL;
  4283. new_triggers.patterns = kcalloc(n_patterns,
  4284. sizeof(new_triggers.patterns[0]),
  4285. GFP_KERNEL);
  4286. if (!new_triggers.patterns)
  4287. return -ENOMEM;
  4288. new_triggers.n_patterns = n_patterns;
  4289. i = 0;
  4290. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  4291. rem) {
  4292. nla_parse(pat_tb, MAX_NL80211_WOWLAN_PKTPAT,
  4293. nla_data(pat), nla_len(pat), NULL);
  4294. err = -EINVAL;
  4295. if (!pat_tb[NL80211_WOWLAN_PKTPAT_MASK] ||
  4296. !pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN])
  4297. goto error;
  4298. pat_len = nla_len(pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN]);
  4299. mask_len = DIV_ROUND_UP(pat_len, 8);
  4300. if (nla_len(pat_tb[NL80211_WOWLAN_PKTPAT_MASK]) !=
  4301. mask_len)
  4302. goto error;
  4303. if (pat_len > wowlan->pattern_max_len ||
  4304. pat_len < wowlan->pattern_min_len)
  4305. goto error;
  4306. new_triggers.patterns[i].mask =
  4307. kmalloc(mask_len + pat_len, GFP_KERNEL);
  4308. if (!new_triggers.patterns[i].mask) {
  4309. err = -ENOMEM;
  4310. goto error;
  4311. }
  4312. new_triggers.patterns[i].pattern =
  4313. new_triggers.patterns[i].mask + mask_len;
  4314. memcpy(new_triggers.patterns[i].mask,
  4315. nla_data(pat_tb[NL80211_WOWLAN_PKTPAT_MASK]),
  4316. mask_len);
  4317. new_triggers.patterns[i].pattern_len = pat_len;
  4318. memcpy(new_triggers.patterns[i].pattern,
  4319. nla_data(pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN]),
  4320. pat_len);
  4321. i++;
  4322. }
  4323. }
  4324. if (memcmp(&new_triggers, &no_triggers, sizeof(new_triggers))) {
  4325. struct cfg80211_wowlan *ntrig;
  4326. ntrig = kmemdup(&new_triggers, sizeof(new_triggers),
  4327. GFP_KERNEL);
  4328. if (!ntrig) {
  4329. err = -ENOMEM;
  4330. goto error;
  4331. }
  4332. cfg80211_rdev_free_wowlan(rdev);
  4333. rdev->wowlan = ntrig;
  4334. } else {
  4335. no_triggers:
  4336. cfg80211_rdev_free_wowlan(rdev);
  4337. rdev->wowlan = NULL;
  4338. }
  4339. return 0;
  4340. error:
  4341. for (i = 0; i < new_triggers.n_patterns; i++)
  4342. kfree(new_triggers.patterns[i].mask);
  4343. kfree(new_triggers.patterns);
  4344. return err;
  4345. }
  4346. #define NL80211_FLAG_NEED_WIPHY 0x01
  4347. #define NL80211_FLAG_NEED_NETDEV 0x02
  4348. #define NL80211_FLAG_NEED_RTNL 0x04
  4349. #define NL80211_FLAG_CHECK_NETDEV_UP 0x08
  4350. #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
  4351. NL80211_FLAG_CHECK_NETDEV_UP)
  4352. static int nl80211_pre_doit(struct genl_ops *ops, struct sk_buff *skb,
  4353. struct genl_info *info)
  4354. {
  4355. struct cfg80211_registered_device *rdev;
  4356. struct net_device *dev;
  4357. int err;
  4358. bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
  4359. if (rtnl)
  4360. rtnl_lock();
  4361. if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
  4362. rdev = cfg80211_get_dev_from_info(info);
  4363. if (IS_ERR(rdev)) {
  4364. if (rtnl)
  4365. rtnl_unlock();
  4366. return PTR_ERR(rdev);
  4367. }
  4368. info->user_ptr[0] = rdev;
  4369. } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
  4370. err = get_rdev_dev_by_info_ifindex(info, &rdev, &dev);
  4371. if (err) {
  4372. if (rtnl)
  4373. rtnl_unlock();
  4374. return err;
  4375. }
  4376. if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
  4377. !netif_running(dev)) {
  4378. cfg80211_unlock_rdev(rdev);
  4379. dev_put(dev);
  4380. if (rtnl)
  4381. rtnl_unlock();
  4382. return -ENETDOWN;
  4383. }
  4384. info->user_ptr[0] = rdev;
  4385. info->user_ptr[1] = dev;
  4386. }
  4387. return 0;
  4388. }
  4389. static void nl80211_post_doit(struct genl_ops *ops, struct sk_buff *skb,
  4390. struct genl_info *info)
  4391. {
  4392. if (info->user_ptr[0])
  4393. cfg80211_unlock_rdev(info->user_ptr[0]);
  4394. if (info->user_ptr[1])
  4395. dev_put(info->user_ptr[1]);
  4396. if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
  4397. rtnl_unlock();
  4398. }
  4399. static struct genl_ops nl80211_ops[] = {
  4400. {
  4401. .cmd = NL80211_CMD_GET_WIPHY,
  4402. .doit = nl80211_get_wiphy,
  4403. .dumpit = nl80211_dump_wiphy,
  4404. .policy = nl80211_policy,
  4405. /* can be retrieved by unprivileged users */
  4406. .internal_flags = NL80211_FLAG_NEED_WIPHY,
  4407. },
  4408. {
  4409. .cmd = NL80211_CMD_SET_WIPHY,
  4410. .doit = nl80211_set_wiphy,
  4411. .policy = nl80211_policy,
  4412. .flags = GENL_ADMIN_PERM,
  4413. .internal_flags = NL80211_FLAG_NEED_RTNL,
  4414. },
  4415. {
  4416. .cmd = NL80211_CMD_GET_INTERFACE,
  4417. .doit = nl80211_get_interface,
  4418. .dumpit = nl80211_dump_interface,
  4419. .policy = nl80211_policy,
  4420. /* can be retrieved by unprivileged users */
  4421. .internal_flags = NL80211_FLAG_NEED_NETDEV,
  4422. },
  4423. {
  4424. .cmd = NL80211_CMD_SET_INTERFACE,
  4425. .doit = nl80211_set_interface,
  4426. .policy = nl80211_policy,
  4427. .flags = GENL_ADMIN_PERM,
  4428. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4429. NL80211_FLAG_NEED_RTNL,
  4430. },
  4431. {
  4432. .cmd = NL80211_CMD_NEW_INTERFACE,
  4433. .doit = nl80211_new_interface,
  4434. .policy = nl80211_policy,
  4435. .flags = GENL_ADMIN_PERM,
  4436. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  4437. NL80211_FLAG_NEED_RTNL,
  4438. },
  4439. {
  4440. .cmd = NL80211_CMD_DEL_INTERFACE,
  4441. .doit = nl80211_del_interface,
  4442. .policy = nl80211_policy,
  4443. .flags = GENL_ADMIN_PERM,
  4444. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4445. NL80211_FLAG_NEED_RTNL,
  4446. },
  4447. {
  4448. .cmd = NL80211_CMD_GET_KEY,
  4449. .doit = nl80211_get_key,
  4450. .policy = nl80211_policy,
  4451. .flags = GENL_ADMIN_PERM,
  4452. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4453. NL80211_FLAG_NEED_RTNL,
  4454. },
  4455. {
  4456. .cmd = NL80211_CMD_SET_KEY,
  4457. .doit = nl80211_set_key,
  4458. .policy = nl80211_policy,
  4459. .flags = GENL_ADMIN_PERM,
  4460. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4461. NL80211_FLAG_NEED_RTNL,
  4462. },
  4463. {
  4464. .cmd = NL80211_CMD_NEW_KEY,
  4465. .doit = nl80211_new_key,
  4466. .policy = nl80211_policy,
  4467. .flags = GENL_ADMIN_PERM,
  4468. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4469. NL80211_FLAG_NEED_RTNL,
  4470. },
  4471. {
  4472. .cmd = NL80211_CMD_DEL_KEY,
  4473. .doit = nl80211_del_key,
  4474. .policy = nl80211_policy,
  4475. .flags = GENL_ADMIN_PERM,
  4476. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4477. NL80211_FLAG_NEED_RTNL,
  4478. },
  4479. {
  4480. .cmd = NL80211_CMD_SET_BEACON,
  4481. .policy = nl80211_policy,
  4482. .flags = GENL_ADMIN_PERM,
  4483. .doit = nl80211_addset_beacon,
  4484. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4485. NL80211_FLAG_NEED_RTNL,
  4486. },
  4487. {
  4488. .cmd = NL80211_CMD_NEW_BEACON,
  4489. .policy = nl80211_policy,
  4490. .flags = GENL_ADMIN_PERM,
  4491. .doit = nl80211_addset_beacon,
  4492. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4493. NL80211_FLAG_NEED_RTNL,
  4494. },
  4495. {
  4496. .cmd = NL80211_CMD_DEL_BEACON,
  4497. .policy = nl80211_policy,
  4498. .flags = GENL_ADMIN_PERM,
  4499. .doit = nl80211_del_beacon,
  4500. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4501. NL80211_FLAG_NEED_RTNL,
  4502. },
  4503. {
  4504. .cmd = NL80211_CMD_GET_STATION,
  4505. .doit = nl80211_get_station,
  4506. .dumpit = nl80211_dump_station,
  4507. .policy = nl80211_policy,
  4508. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4509. NL80211_FLAG_NEED_RTNL,
  4510. },
  4511. {
  4512. .cmd = NL80211_CMD_SET_STATION,
  4513. .doit = nl80211_set_station,
  4514. .policy = nl80211_policy,
  4515. .flags = GENL_ADMIN_PERM,
  4516. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4517. NL80211_FLAG_NEED_RTNL,
  4518. },
  4519. {
  4520. .cmd = NL80211_CMD_NEW_STATION,
  4521. .doit = nl80211_new_station,
  4522. .policy = nl80211_policy,
  4523. .flags = GENL_ADMIN_PERM,
  4524. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4525. NL80211_FLAG_NEED_RTNL,
  4526. },
  4527. {
  4528. .cmd = NL80211_CMD_DEL_STATION,
  4529. .doit = nl80211_del_station,
  4530. .policy = nl80211_policy,
  4531. .flags = GENL_ADMIN_PERM,
  4532. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4533. NL80211_FLAG_NEED_RTNL,
  4534. },
  4535. {
  4536. .cmd = NL80211_CMD_GET_MPATH,
  4537. .doit = nl80211_get_mpath,
  4538. .dumpit = nl80211_dump_mpath,
  4539. .policy = nl80211_policy,
  4540. .flags = GENL_ADMIN_PERM,
  4541. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4542. NL80211_FLAG_NEED_RTNL,
  4543. },
  4544. {
  4545. .cmd = NL80211_CMD_SET_MPATH,
  4546. .doit = nl80211_set_mpath,
  4547. .policy = nl80211_policy,
  4548. .flags = GENL_ADMIN_PERM,
  4549. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4550. NL80211_FLAG_NEED_RTNL,
  4551. },
  4552. {
  4553. .cmd = NL80211_CMD_NEW_MPATH,
  4554. .doit = nl80211_new_mpath,
  4555. .policy = nl80211_policy,
  4556. .flags = GENL_ADMIN_PERM,
  4557. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4558. NL80211_FLAG_NEED_RTNL,
  4559. },
  4560. {
  4561. .cmd = NL80211_CMD_DEL_MPATH,
  4562. .doit = nl80211_del_mpath,
  4563. .policy = nl80211_policy,
  4564. .flags = GENL_ADMIN_PERM,
  4565. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4566. NL80211_FLAG_NEED_RTNL,
  4567. },
  4568. {
  4569. .cmd = NL80211_CMD_SET_BSS,
  4570. .doit = nl80211_set_bss,
  4571. .policy = nl80211_policy,
  4572. .flags = GENL_ADMIN_PERM,
  4573. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4574. NL80211_FLAG_NEED_RTNL,
  4575. },
  4576. {
  4577. .cmd = NL80211_CMD_GET_REG,
  4578. .doit = nl80211_get_reg,
  4579. .policy = nl80211_policy,
  4580. /* can be retrieved by unprivileged users */
  4581. },
  4582. {
  4583. .cmd = NL80211_CMD_SET_REG,
  4584. .doit = nl80211_set_reg,
  4585. .policy = nl80211_policy,
  4586. .flags = GENL_ADMIN_PERM,
  4587. },
  4588. {
  4589. .cmd = NL80211_CMD_REQ_SET_REG,
  4590. .doit = nl80211_req_set_reg,
  4591. .policy = nl80211_policy,
  4592. .flags = GENL_ADMIN_PERM,
  4593. },
  4594. {
  4595. .cmd = NL80211_CMD_GET_MESH_CONFIG,
  4596. .doit = nl80211_get_mesh_config,
  4597. .policy = nl80211_policy,
  4598. /* can be retrieved by unprivileged users */
  4599. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4600. NL80211_FLAG_NEED_RTNL,
  4601. },
  4602. {
  4603. .cmd = NL80211_CMD_SET_MESH_CONFIG,
  4604. .doit = nl80211_update_mesh_config,
  4605. .policy = nl80211_policy,
  4606. .flags = GENL_ADMIN_PERM,
  4607. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4608. NL80211_FLAG_NEED_RTNL,
  4609. },
  4610. {
  4611. .cmd = NL80211_CMD_TRIGGER_SCAN,
  4612. .doit = nl80211_trigger_scan,
  4613. .policy = nl80211_policy,
  4614. .flags = GENL_ADMIN_PERM,
  4615. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4616. NL80211_FLAG_NEED_RTNL,
  4617. },
  4618. {
  4619. .cmd = NL80211_CMD_GET_SCAN,
  4620. .policy = nl80211_policy,
  4621. .dumpit = nl80211_dump_scan,
  4622. },
  4623. {
  4624. .cmd = NL80211_CMD_START_SCHED_SCAN,
  4625. .doit = nl80211_start_sched_scan,
  4626. .policy = nl80211_policy,
  4627. .flags = GENL_ADMIN_PERM,
  4628. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4629. NL80211_FLAG_NEED_RTNL,
  4630. },
  4631. {
  4632. .cmd = NL80211_CMD_STOP_SCHED_SCAN,
  4633. .doit = nl80211_stop_sched_scan,
  4634. .policy = nl80211_policy,
  4635. .flags = GENL_ADMIN_PERM,
  4636. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4637. NL80211_FLAG_NEED_RTNL,
  4638. },
  4639. {
  4640. .cmd = NL80211_CMD_AUTHENTICATE,
  4641. .doit = nl80211_authenticate,
  4642. .policy = nl80211_policy,
  4643. .flags = GENL_ADMIN_PERM,
  4644. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4645. NL80211_FLAG_NEED_RTNL,
  4646. },
  4647. {
  4648. .cmd = NL80211_CMD_ASSOCIATE,
  4649. .doit = nl80211_associate,
  4650. .policy = nl80211_policy,
  4651. .flags = GENL_ADMIN_PERM,
  4652. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4653. NL80211_FLAG_NEED_RTNL,
  4654. },
  4655. {
  4656. .cmd = NL80211_CMD_DEAUTHENTICATE,
  4657. .doit = nl80211_deauthenticate,
  4658. .policy = nl80211_policy,
  4659. .flags = GENL_ADMIN_PERM,
  4660. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4661. NL80211_FLAG_NEED_RTNL,
  4662. },
  4663. {
  4664. .cmd = NL80211_CMD_DISASSOCIATE,
  4665. .doit = nl80211_disassociate,
  4666. .policy = nl80211_policy,
  4667. .flags = GENL_ADMIN_PERM,
  4668. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4669. NL80211_FLAG_NEED_RTNL,
  4670. },
  4671. {
  4672. .cmd = NL80211_CMD_JOIN_IBSS,
  4673. .doit = nl80211_join_ibss,
  4674. .policy = nl80211_policy,
  4675. .flags = GENL_ADMIN_PERM,
  4676. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4677. NL80211_FLAG_NEED_RTNL,
  4678. },
  4679. {
  4680. .cmd = NL80211_CMD_LEAVE_IBSS,
  4681. .doit = nl80211_leave_ibss,
  4682. .policy = nl80211_policy,
  4683. .flags = GENL_ADMIN_PERM,
  4684. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4685. NL80211_FLAG_NEED_RTNL,
  4686. },
  4687. #ifdef CONFIG_NL80211_TESTMODE
  4688. {
  4689. .cmd = NL80211_CMD_TESTMODE,
  4690. .doit = nl80211_testmode_do,
  4691. .policy = nl80211_policy,
  4692. .flags = GENL_ADMIN_PERM,
  4693. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  4694. NL80211_FLAG_NEED_RTNL,
  4695. },
  4696. #endif
  4697. {
  4698. .cmd = NL80211_CMD_CONNECT,
  4699. .doit = nl80211_connect,
  4700. .policy = nl80211_policy,
  4701. .flags = GENL_ADMIN_PERM,
  4702. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4703. NL80211_FLAG_NEED_RTNL,
  4704. },
  4705. {
  4706. .cmd = NL80211_CMD_DISCONNECT,
  4707. .doit = nl80211_disconnect,
  4708. .policy = nl80211_policy,
  4709. .flags = GENL_ADMIN_PERM,
  4710. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4711. NL80211_FLAG_NEED_RTNL,
  4712. },
  4713. {
  4714. .cmd = NL80211_CMD_SET_WIPHY_NETNS,
  4715. .doit = nl80211_wiphy_netns,
  4716. .policy = nl80211_policy,
  4717. .flags = GENL_ADMIN_PERM,
  4718. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  4719. NL80211_FLAG_NEED_RTNL,
  4720. },
  4721. {
  4722. .cmd = NL80211_CMD_GET_SURVEY,
  4723. .policy = nl80211_policy,
  4724. .dumpit = nl80211_dump_survey,
  4725. },
  4726. {
  4727. .cmd = NL80211_CMD_SET_PMKSA,
  4728. .doit = nl80211_setdel_pmksa,
  4729. .policy = nl80211_policy,
  4730. .flags = GENL_ADMIN_PERM,
  4731. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4732. NL80211_FLAG_NEED_RTNL,
  4733. },
  4734. {
  4735. .cmd = NL80211_CMD_DEL_PMKSA,
  4736. .doit = nl80211_setdel_pmksa,
  4737. .policy = nl80211_policy,
  4738. .flags = GENL_ADMIN_PERM,
  4739. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4740. NL80211_FLAG_NEED_RTNL,
  4741. },
  4742. {
  4743. .cmd = NL80211_CMD_FLUSH_PMKSA,
  4744. .doit = nl80211_flush_pmksa,
  4745. .policy = nl80211_policy,
  4746. .flags = GENL_ADMIN_PERM,
  4747. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4748. NL80211_FLAG_NEED_RTNL,
  4749. },
  4750. {
  4751. .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
  4752. .doit = nl80211_remain_on_channel,
  4753. .policy = nl80211_policy,
  4754. .flags = GENL_ADMIN_PERM,
  4755. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4756. NL80211_FLAG_NEED_RTNL,
  4757. },
  4758. {
  4759. .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  4760. .doit = nl80211_cancel_remain_on_channel,
  4761. .policy = nl80211_policy,
  4762. .flags = GENL_ADMIN_PERM,
  4763. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4764. NL80211_FLAG_NEED_RTNL,
  4765. },
  4766. {
  4767. .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
  4768. .doit = nl80211_set_tx_bitrate_mask,
  4769. .policy = nl80211_policy,
  4770. .flags = GENL_ADMIN_PERM,
  4771. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4772. NL80211_FLAG_NEED_RTNL,
  4773. },
  4774. {
  4775. .cmd = NL80211_CMD_REGISTER_FRAME,
  4776. .doit = nl80211_register_mgmt,
  4777. .policy = nl80211_policy,
  4778. .flags = GENL_ADMIN_PERM,
  4779. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4780. NL80211_FLAG_NEED_RTNL,
  4781. },
  4782. {
  4783. .cmd = NL80211_CMD_FRAME,
  4784. .doit = nl80211_tx_mgmt,
  4785. .policy = nl80211_policy,
  4786. .flags = GENL_ADMIN_PERM,
  4787. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4788. NL80211_FLAG_NEED_RTNL,
  4789. },
  4790. {
  4791. .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
  4792. .doit = nl80211_tx_mgmt_cancel_wait,
  4793. .policy = nl80211_policy,
  4794. .flags = GENL_ADMIN_PERM,
  4795. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4796. NL80211_FLAG_NEED_RTNL,
  4797. },
  4798. {
  4799. .cmd = NL80211_CMD_SET_POWER_SAVE,
  4800. .doit = nl80211_set_power_save,
  4801. .policy = nl80211_policy,
  4802. .flags = GENL_ADMIN_PERM,
  4803. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4804. NL80211_FLAG_NEED_RTNL,
  4805. },
  4806. {
  4807. .cmd = NL80211_CMD_GET_POWER_SAVE,
  4808. .doit = nl80211_get_power_save,
  4809. .policy = nl80211_policy,
  4810. /* can be retrieved by unprivileged users */
  4811. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4812. NL80211_FLAG_NEED_RTNL,
  4813. },
  4814. {
  4815. .cmd = NL80211_CMD_SET_CQM,
  4816. .doit = nl80211_set_cqm,
  4817. .policy = nl80211_policy,
  4818. .flags = GENL_ADMIN_PERM,
  4819. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4820. NL80211_FLAG_NEED_RTNL,
  4821. },
  4822. {
  4823. .cmd = NL80211_CMD_SET_CHANNEL,
  4824. .doit = nl80211_set_channel,
  4825. .policy = nl80211_policy,
  4826. .flags = GENL_ADMIN_PERM,
  4827. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4828. NL80211_FLAG_NEED_RTNL,
  4829. },
  4830. {
  4831. .cmd = NL80211_CMD_SET_WDS_PEER,
  4832. .doit = nl80211_set_wds_peer,
  4833. .policy = nl80211_policy,
  4834. .flags = GENL_ADMIN_PERM,
  4835. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  4836. NL80211_FLAG_NEED_RTNL,
  4837. },
  4838. {
  4839. .cmd = NL80211_CMD_JOIN_MESH,
  4840. .doit = nl80211_join_mesh,
  4841. .policy = nl80211_policy,
  4842. .flags = GENL_ADMIN_PERM,
  4843. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4844. NL80211_FLAG_NEED_RTNL,
  4845. },
  4846. {
  4847. .cmd = NL80211_CMD_LEAVE_MESH,
  4848. .doit = nl80211_leave_mesh,
  4849. .policy = nl80211_policy,
  4850. .flags = GENL_ADMIN_PERM,
  4851. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  4852. NL80211_FLAG_NEED_RTNL,
  4853. },
  4854. {
  4855. .cmd = NL80211_CMD_GET_WOWLAN,
  4856. .doit = nl80211_get_wowlan,
  4857. .policy = nl80211_policy,
  4858. /* can be retrieved by unprivileged users */
  4859. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  4860. NL80211_FLAG_NEED_RTNL,
  4861. },
  4862. {
  4863. .cmd = NL80211_CMD_SET_WOWLAN,
  4864. .doit = nl80211_set_wowlan,
  4865. .policy = nl80211_policy,
  4866. .flags = GENL_ADMIN_PERM,
  4867. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  4868. NL80211_FLAG_NEED_RTNL,
  4869. },
  4870. };
  4871. static struct genl_multicast_group nl80211_mlme_mcgrp = {
  4872. .name = "mlme",
  4873. };
  4874. /* multicast groups */
  4875. static struct genl_multicast_group nl80211_config_mcgrp = {
  4876. .name = "config",
  4877. };
  4878. static struct genl_multicast_group nl80211_scan_mcgrp = {
  4879. .name = "scan",
  4880. };
  4881. static struct genl_multicast_group nl80211_regulatory_mcgrp = {
  4882. .name = "regulatory",
  4883. };
  4884. /* notification functions */
  4885. void nl80211_notify_dev_rename(struct cfg80211_registered_device *rdev)
  4886. {
  4887. struct sk_buff *msg;
  4888. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4889. if (!msg)
  4890. return;
  4891. if (nl80211_send_wiphy(msg, 0, 0, 0, rdev) < 0) {
  4892. nlmsg_free(msg);
  4893. return;
  4894. }
  4895. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  4896. nl80211_config_mcgrp.id, GFP_KERNEL);
  4897. }
  4898. static int nl80211_add_scan_req(struct sk_buff *msg,
  4899. struct cfg80211_registered_device *rdev)
  4900. {
  4901. struct cfg80211_scan_request *req = rdev->scan_req;
  4902. struct nlattr *nest;
  4903. int i;
  4904. ASSERT_RDEV_LOCK(rdev);
  4905. if (WARN_ON(!req))
  4906. return 0;
  4907. nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
  4908. if (!nest)
  4909. goto nla_put_failure;
  4910. for (i = 0; i < req->n_ssids; i++)
  4911. NLA_PUT(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid);
  4912. nla_nest_end(msg, nest);
  4913. nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
  4914. if (!nest)
  4915. goto nla_put_failure;
  4916. for (i = 0; i < req->n_channels; i++)
  4917. NLA_PUT_U32(msg, i, req->channels[i]->center_freq);
  4918. nla_nest_end(msg, nest);
  4919. if (req->ie)
  4920. NLA_PUT(msg, NL80211_ATTR_IE, req->ie_len, req->ie);
  4921. return 0;
  4922. nla_put_failure:
  4923. return -ENOBUFS;
  4924. }
  4925. static int nl80211_send_scan_msg(struct sk_buff *msg,
  4926. struct cfg80211_registered_device *rdev,
  4927. struct net_device *netdev,
  4928. u32 pid, u32 seq, int flags,
  4929. u32 cmd)
  4930. {
  4931. void *hdr;
  4932. hdr = nl80211hdr_put(msg, pid, seq, flags, cmd);
  4933. if (!hdr)
  4934. return -1;
  4935. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  4936. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  4937. /* ignore errors and send incomplete event anyway */
  4938. nl80211_add_scan_req(msg, rdev);
  4939. return genlmsg_end(msg, hdr);
  4940. nla_put_failure:
  4941. genlmsg_cancel(msg, hdr);
  4942. return -EMSGSIZE;
  4943. }
  4944. static int
  4945. nl80211_send_sched_scan_msg(struct sk_buff *msg,
  4946. struct cfg80211_registered_device *rdev,
  4947. struct net_device *netdev,
  4948. u32 pid, u32 seq, int flags, u32 cmd)
  4949. {
  4950. void *hdr;
  4951. hdr = nl80211hdr_put(msg, pid, seq, flags, cmd);
  4952. if (!hdr)
  4953. return -1;
  4954. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  4955. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  4956. return genlmsg_end(msg, hdr);
  4957. nla_put_failure:
  4958. genlmsg_cancel(msg, hdr);
  4959. return -EMSGSIZE;
  4960. }
  4961. void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
  4962. struct net_device *netdev)
  4963. {
  4964. struct sk_buff *msg;
  4965. msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
  4966. if (!msg)
  4967. return;
  4968. if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
  4969. NL80211_CMD_TRIGGER_SCAN) < 0) {
  4970. nlmsg_free(msg);
  4971. return;
  4972. }
  4973. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  4974. nl80211_scan_mcgrp.id, GFP_KERNEL);
  4975. }
  4976. void nl80211_send_scan_done(struct cfg80211_registered_device *rdev,
  4977. struct net_device *netdev)
  4978. {
  4979. struct sk_buff *msg;
  4980. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4981. if (!msg)
  4982. return;
  4983. if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
  4984. NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
  4985. nlmsg_free(msg);
  4986. return;
  4987. }
  4988. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  4989. nl80211_scan_mcgrp.id, GFP_KERNEL);
  4990. }
  4991. void nl80211_send_scan_aborted(struct cfg80211_registered_device *rdev,
  4992. struct net_device *netdev)
  4993. {
  4994. struct sk_buff *msg;
  4995. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4996. if (!msg)
  4997. return;
  4998. if (nl80211_send_scan_msg(msg, rdev, netdev, 0, 0, 0,
  4999. NL80211_CMD_SCAN_ABORTED) < 0) {
  5000. nlmsg_free(msg);
  5001. return;
  5002. }
  5003. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5004. nl80211_scan_mcgrp.id, GFP_KERNEL);
  5005. }
  5006. void nl80211_send_sched_scan_results(struct cfg80211_registered_device *rdev,
  5007. struct net_device *netdev)
  5008. {
  5009. struct sk_buff *msg;
  5010. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  5011. if (!msg)
  5012. return;
  5013. if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0,
  5014. NL80211_CMD_SCHED_SCAN_RESULTS) < 0) {
  5015. nlmsg_free(msg);
  5016. return;
  5017. }
  5018. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5019. nl80211_scan_mcgrp.id, GFP_KERNEL);
  5020. }
  5021. void nl80211_send_sched_scan(struct cfg80211_registered_device *rdev,
  5022. struct net_device *netdev, u32 cmd)
  5023. {
  5024. struct sk_buff *msg;
  5025. msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
  5026. if (!msg)
  5027. return;
  5028. if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0, cmd) < 0) {
  5029. nlmsg_free(msg);
  5030. return;
  5031. }
  5032. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5033. nl80211_scan_mcgrp.id, GFP_KERNEL);
  5034. }
  5035. /*
  5036. * This can happen on global regulatory changes or device specific settings
  5037. * based on custom world regulatory domains.
  5038. */
  5039. void nl80211_send_reg_change_event(struct regulatory_request *request)
  5040. {
  5041. struct sk_buff *msg;
  5042. void *hdr;
  5043. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  5044. if (!msg)
  5045. return;
  5046. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_CHANGE);
  5047. if (!hdr) {
  5048. nlmsg_free(msg);
  5049. return;
  5050. }
  5051. /* Userspace can always count this one always being set */
  5052. NLA_PUT_U8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator);
  5053. if (request->alpha2[0] == '0' && request->alpha2[1] == '0')
  5054. NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
  5055. NL80211_REGDOM_TYPE_WORLD);
  5056. else if (request->alpha2[0] == '9' && request->alpha2[1] == '9')
  5057. NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
  5058. NL80211_REGDOM_TYPE_CUSTOM_WORLD);
  5059. else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
  5060. request->intersect)
  5061. NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
  5062. NL80211_REGDOM_TYPE_INTERSECTION);
  5063. else {
  5064. NLA_PUT_U8(msg, NL80211_ATTR_REG_TYPE,
  5065. NL80211_REGDOM_TYPE_COUNTRY);
  5066. NLA_PUT_STRING(msg, NL80211_ATTR_REG_ALPHA2, request->alpha2);
  5067. }
  5068. if (wiphy_idx_valid(request->wiphy_idx))
  5069. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx);
  5070. if (genlmsg_end(msg, hdr) < 0) {
  5071. nlmsg_free(msg);
  5072. return;
  5073. }
  5074. rcu_read_lock();
  5075. genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
  5076. GFP_ATOMIC);
  5077. rcu_read_unlock();
  5078. return;
  5079. nla_put_failure:
  5080. genlmsg_cancel(msg, hdr);
  5081. nlmsg_free(msg);
  5082. }
  5083. static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
  5084. struct net_device *netdev,
  5085. const u8 *buf, size_t len,
  5086. enum nl80211_commands cmd, gfp_t gfp)
  5087. {
  5088. struct sk_buff *msg;
  5089. void *hdr;
  5090. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  5091. if (!msg)
  5092. return;
  5093. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  5094. if (!hdr) {
  5095. nlmsg_free(msg);
  5096. return;
  5097. }
  5098. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5099. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5100. NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
  5101. if (genlmsg_end(msg, hdr) < 0) {
  5102. nlmsg_free(msg);
  5103. return;
  5104. }
  5105. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5106. nl80211_mlme_mcgrp.id, gfp);
  5107. return;
  5108. nla_put_failure:
  5109. genlmsg_cancel(msg, hdr);
  5110. nlmsg_free(msg);
  5111. }
  5112. void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
  5113. struct net_device *netdev, const u8 *buf,
  5114. size_t len, gfp_t gfp)
  5115. {
  5116. nl80211_send_mlme_event(rdev, netdev, buf, len,
  5117. NL80211_CMD_AUTHENTICATE, gfp);
  5118. }
  5119. void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
  5120. struct net_device *netdev, const u8 *buf,
  5121. size_t len, gfp_t gfp)
  5122. {
  5123. nl80211_send_mlme_event(rdev, netdev, buf, len,
  5124. NL80211_CMD_ASSOCIATE, gfp);
  5125. }
  5126. void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
  5127. struct net_device *netdev, const u8 *buf,
  5128. size_t len, gfp_t gfp)
  5129. {
  5130. nl80211_send_mlme_event(rdev, netdev, buf, len,
  5131. NL80211_CMD_DEAUTHENTICATE, gfp);
  5132. }
  5133. void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
  5134. struct net_device *netdev, const u8 *buf,
  5135. size_t len, gfp_t gfp)
  5136. {
  5137. nl80211_send_mlme_event(rdev, netdev, buf, len,
  5138. NL80211_CMD_DISASSOCIATE, gfp);
  5139. }
  5140. void nl80211_send_unprot_deauth(struct cfg80211_registered_device *rdev,
  5141. struct net_device *netdev, const u8 *buf,
  5142. size_t len, gfp_t gfp)
  5143. {
  5144. nl80211_send_mlme_event(rdev, netdev, buf, len,
  5145. NL80211_CMD_UNPROT_DEAUTHENTICATE, gfp);
  5146. }
  5147. void nl80211_send_unprot_disassoc(struct cfg80211_registered_device *rdev,
  5148. struct net_device *netdev, const u8 *buf,
  5149. size_t len, gfp_t gfp)
  5150. {
  5151. nl80211_send_mlme_event(rdev, netdev, buf, len,
  5152. NL80211_CMD_UNPROT_DISASSOCIATE, gfp);
  5153. }
  5154. static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
  5155. struct net_device *netdev, int cmd,
  5156. const u8 *addr, gfp_t gfp)
  5157. {
  5158. struct sk_buff *msg;
  5159. void *hdr;
  5160. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  5161. if (!msg)
  5162. return;
  5163. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  5164. if (!hdr) {
  5165. nlmsg_free(msg);
  5166. return;
  5167. }
  5168. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5169. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5170. NLA_PUT_FLAG(msg, NL80211_ATTR_TIMED_OUT);
  5171. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, addr);
  5172. if (genlmsg_end(msg, hdr) < 0) {
  5173. nlmsg_free(msg);
  5174. return;
  5175. }
  5176. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5177. nl80211_mlme_mcgrp.id, gfp);
  5178. return;
  5179. nla_put_failure:
  5180. genlmsg_cancel(msg, hdr);
  5181. nlmsg_free(msg);
  5182. }
  5183. void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
  5184. struct net_device *netdev, const u8 *addr,
  5185. gfp_t gfp)
  5186. {
  5187. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
  5188. addr, gfp);
  5189. }
  5190. void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
  5191. struct net_device *netdev, const u8 *addr,
  5192. gfp_t gfp)
  5193. {
  5194. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
  5195. addr, gfp);
  5196. }
  5197. void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
  5198. struct net_device *netdev, const u8 *bssid,
  5199. const u8 *req_ie, size_t req_ie_len,
  5200. const u8 *resp_ie, size_t resp_ie_len,
  5201. u16 status, gfp_t gfp)
  5202. {
  5203. struct sk_buff *msg;
  5204. void *hdr;
  5205. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  5206. if (!msg)
  5207. return;
  5208. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
  5209. if (!hdr) {
  5210. nlmsg_free(msg);
  5211. return;
  5212. }
  5213. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5214. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5215. if (bssid)
  5216. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
  5217. NLA_PUT_U16(msg, NL80211_ATTR_STATUS_CODE, status);
  5218. if (req_ie)
  5219. NLA_PUT(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie);
  5220. if (resp_ie)
  5221. NLA_PUT(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie);
  5222. if (genlmsg_end(msg, hdr) < 0) {
  5223. nlmsg_free(msg);
  5224. return;
  5225. }
  5226. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5227. nl80211_mlme_mcgrp.id, gfp);
  5228. return;
  5229. nla_put_failure:
  5230. genlmsg_cancel(msg, hdr);
  5231. nlmsg_free(msg);
  5232. }
  5233. void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
  5234. struct net_device *netdev, const u8 *bssid,
  5235. const u8 *req_ie, size_t req_ie_len,
  5236. const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
  5237. {
  5238. struct sk_buff *msg;
  5239. void *hdr;
  5240. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  5241. if (!msg)
  5242. return;
  5243. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
  5244. if (!hdr) {
  5245. nlmsg_free(msg);
  5246. return;
  5247. }
  5248. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5249. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5250. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
  5251. if (req_ie)
  5252. NLA_PUT(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie);
  5253. if (resp_ie)
  5254. NLA_PUT(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie);
  5255. if (genlmsg_end(msg, hdr) < 0) {
  5256. nlmsg_free(msg);
  5257. return;
  5258. }
  5259. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5260. nl80211_mlme_mcgrp.id, gfp);
  5261. return;
  5262. nla_put_failure:
  5263. genlmsg_cancel(msg, hdr);
  5264. nlmsg_free(msg);
  5265. }
  5266. void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
  5267. struct net_device *netdev, u16 reason,
  5268. const u8 *ie, size_t ie_len, bool from_ap)
  5269. {
  5270. struct sk_buff *msg;
  5271. void *hdr;
  5272. msg = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
  5273. if (!msg)
  5274. return;
  5275. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
  5276. if (!hdr) {
  5277. nlmsg_free(msg);
  5278. return;
  5279. }
  5280. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5281. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5282. if (from_ap && reason)
  5283. NLA_PUT_U16(msg, NL80211_ATTR_REASON_CODE, reason);
  5284. if (from_ap)
  5285. NLA_PUT_FLAG(msg, NL80211_ATTR_DISCONNECTED_BY_AP);
  5286. if (ie)
  5287. NLA_PUT(msg, NL80211_ATTR_IE, ie_len, ie);
  5288. if (genlmsg_end(msg, hdr) < 0) {
  5289. nlmsg_free(msg);
  5290. return;
  5291. }
  5292. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5293. nl80211_mlme_mcgrp.id, GFP_KERNEL);
  5294. return;
  5295. nla_put_failure:
  5296. genlmsg_cancel(msg, hdr);
  5297. nlmsg_free(msg);
  5298. }
  5299. void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
  5300. struct net_device *netdev, const u8 *bssid,
  5301. gfp_t gfp)
  5302. {
  5303. struct sk_buff *msg;
  5304. void *hdr;
  5305. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  5306. if (!msg)
  5307. return;
  5308. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
  5309. if (!hdr) {
  5310. nlmsg_free(msg);
  5311. return;
  5312. }
  5313. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5314. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5315. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid);
  5316. if (genlmsg_end(msg, hdr) < 0) {
  5317. nlmsg_free(msg);
  5318. return;
  5319. }
  5320. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5321. nl80211_mlme_mcgrp.id, gfp);
  5322. return;
  5323. nla_put_failure:
  5324. genlmsg_cancel(msg, hdr);
  5325. nlmsg_free(msg);
  5326. }
  5327. void nl80211_send_new_peer_candidate(struct cfg80211_registered_device *rdev,
  5328. struct net_device *netdev,
  5329. const u8 *macaddr, const u8* ie, u8 ie_len,
  5330. gfp_t gfp)
  5331. {
  5332. struct sk_buff *msg;
  5333. void *hdr;
  5334. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  5335. if (!msg)
  5336. return;
  5337. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
  5338. if (!hdr) {
  5339. nlmsg_free(msg);
  5340. return;
  5341. }
  5342. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5343. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5344. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, macaddr);
  5345. if (ie_len && ie)
  5346. NLA_PUT(msg, NL80211_ATTR_IE, ie_len , ie);
  5347. if (genlmsg_end(msg, hdr) < 0) {
  5348. nlmsg_free(msg);
  5349. return;
  5350. }
  5351. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5352. nl80211_mlme_mcgrp.id, gfp);
  5353. return;
  5354. nla_put_failure:
  5355. genlmsg_cancel(msg, hdr);
  5356. nlmsg_free(msg);
  5357. }
  5358. void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
  5359. struct net_device *netdev, const u8 *addr,
  5360. enum nl80211_key_type key_type, int key_id,
  5361. const u8 *tsc, gfp_t gfp)
  5362. {
  5363. struct sk_buff *msg;
  5364. void *hdr;
  5365. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  5366. if (!msg)
  5367. return;
  5368. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
  5369. if (!hdr) {
  5370. nlmsg_free(msg);
  5371. return;
  5372. }
  5373. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5374. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5375. if (addr)
  5376. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, addr);
  5377. NLA_PUT_U32(msg, NL80211_ATTR_KEY_TYPE, key_type);
  5378. NLA_PUT_U8(msg, NL80211_ATTR_KEY_IDX, key_id);
  5379. if (tsc)
  5380. NLA_PUT(msg, NL80211_ATTR_KEY_SEQ, 6, tsc);
  5381. if (genlmsg_end(msg, hdr) < 0) {
  5382. nlmsg_free(msg);
  5383. return;
  5384. }
  5385. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5386. nl80211_mlme_mcgrp.id, gfp);
  5387. return;
  5388. nla_put_failure:
  5389. genlmsg_cancel(msg, hdr);
  5390. nlmsg_free(msg);
  5391. }
  5392. void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
  5393. struct ieee80211_channel *channel_before,
  5394. struct ieee80211_channel *channel_after)
  5395. {
  5396. struct sk_buff *msg;
  5397. void *hdr;
  5398. struct nlattr *nl_freq;
  5399. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
  5400. if (!msg)
  5401. return;
  5402. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
  5403. if (!hdr) {
  5404. nlmsg_free(msg);
  5405. return;
  5406. }
  5407. /*
  5408. * Since we are applying the beacon hint to a wiphy we know its
  5409. * wiphy_idx is valid
  5410. */
  5411. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy));
  5412. /* Before */
  5413. nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
  5414. if (!nl_freq)
  5415. goto nla_put_failure;
  5416. if (nl80211_msg_put_channel(msg, channel_before))
  5417. goto nla_put_failure;
  5418. nla_nest_end(msg, nl_freq);
  5419. /* After */
  5420. nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
  5421. if (!nl_freq)
  5422. goto nla_put_failure;
  5423. if (nl80211_msg_put_channel(msg, channel_after))
  5424. goto nla_put_failure;
  5425. nla_nest_end(msg, nl_freq);
  5426. if (genlmsg_end(msg, hdr) < 0) {
  5427. nlmsg_free(msg);
  5428. return;
  5429. }
  5430. rcu_read_lock();
  5431. genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
  5432. GFP_ATOMIC);
  5433. rcu_read_unlock();
  5434. return;
  5435. nla_put_failure:
  5436. genlmsg_cancel(msg, hdr);
  5437. nlmsg_free(msg);
  5438. }
  5439. static void nl80211_send_remain_on_chan_event(
  5440. int cmd, struct cfg80211_registered_device *rdev,
  5441. struct net_device *netdev, u64 cookie,
  5442. struct ieee80211_channel *chan,
  5443. enum nl80211_channel_type channel_type,
  5444. unsigned int duration, gfp_t gfp)
  5445. {
  5446. struct sk_buff *msg;
  5447. void *hdr;
  5448. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  5449. if (!msg)
  5450. return;
  5451. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  5452. if (!hdr) {
  5453. nlmsg_free(msg);
  5454. return;
  5455. }
  5456. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5457. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5458. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq);
  5459. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE, channel_type);
  5460. NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
  5461. if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL)
  5462. NLA_PUT_U32(msg, NL80211_ATTR_DURATION, duration);
  5463. if (genlmsg_end(msg, hdr) < 0) {
  5464. nlmsg_free(msg);
  5465. return;
  5466. }
  5467. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5468. nl80211_mlme_mcgrp.id, gfp);
  5469. return;
  5470. nla_put_failure:
  5471. genlmsg_cancel(msg, hdr);
  5472. nlmsg_free(msg);
  5473. }
  5474. void nl80211_send_remain_on_channel(struct cfg80211_registered_device *rdev,
  5475. struct net_device *netdev, u64 cookie,
  5476. struct ieee80211_channel *chan,
  5477. enum nl80211_channel_type channel_type,
  5478. unsigned int duration, gfp_t gfp)
  5479. {
  5480. nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
  5481. rdev, netdev, cookie, chan,
  5482. channel_type, duration, gfp);
  5483. }
  5484. void nl80211_send_remain_on_channel_cancel(
  5485. struct cfg80211_registered_device *rdev, struct net_device *netdev,
  5486. u64 cookie, struct ieee80211_channel *chan,
  5487. enum nl80211_channel_type channel_type, gfp_t gfp)
  5488. {
  5489. nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  5490. rdev, netdev, cookie, chan,
  5491. channel_type, 0, gfp);
  5492. }
  5493. void nl80211_send_sta_event(struct cfg80211_registered_device *rdev,
  5494. struct net_device *dev, const u8 *mac_addr,
  5495. struct station_info *sinfo, gfp_t gfp)
  5496. {
  5497. struct sk_buff *msg;
  5498. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  5499. if (!msg)
  5500. return;
  5501. if (nl80211_send_station(msg, 0, 0, 0, dev, mac_addr, sinfo) < 0) {
  5502. nlmsg_free(msg);
  5503. return;
  5504. }
  5505. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5506. nl80211_mlme_mcgrp.id, gfp);
  5507. }
  5508. void nl80211_send_sta_del_event(struct cfg80211_registered_device *rdev,
  5509. struct net_device *dev, const u8 *mac_addr,
  5510. gfp_t gfp)
  5511. {
  5512. struct sk_buff *msg;
  5513. void *hdr;
  5514. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  5515. if (!msg)
  5516. return;
  5517. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_STATION);
  5518. if (!hdr) {
  5519. nlmsg_free(msg);
  5520. return;
  5521. }
  5522. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, dev->ifindex);
  5523. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr);
  5524. if (genlmsg_end(msg, hdr) < 0) {
  5525. nlmsg_free(msg);
  5526. return;
  5527. }
  5528. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5529. nl80211_mlme_mcgrp.id, gfp);
  5530. return;
  5531. nla_put_failure:
  5532. genlmsg_cancel(msg, hdr);
  5533. nlmsg_free(msg);
  5534. }
  5535. int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
  5536. struct net_device *netdev, u32 nlpid,
  5537. int freq, const u8 *buf, size_t len, gfp_t gfp)
  5538. {
  5539. struct sk_buff *msg;
  5540. void *hdr;
  5541. int err;
  5542. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  5543. if (!msg)
  5544. return -ENOMEM;
  5545. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  5546. if (!hdr) {
  5547. nlmsg_free(msg);
  5548. return -ENOMEM;
  5549. }
  5550. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5551. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5552. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY_FREQ, freq);
  5553. NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
  5554. err = genlmsg_end(msg, hdr);
  5555. if (err < 0) {
  5556. nlmsg_free(msg);
  5557. return err;
  5558. }
  5559. err = genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlpid);
  5560. if (err < 0)
  5561. return err;
  5562. return 0;
  5563. nla_put_failure:
  5564. genlmsg_cancel(msg, hdr);
  5565. nlmsg_free(msg);
  5566. return -ENOBUFS;
  5567. }
  5568. void nl80211_send_mgmt_tx_status(struct cfg80211_registered_device *rdev,
  5569. struct net_device *netdev, u64 cookie,
  5570. const u8 *buf, size_t len, bool ack,
  5571. gfp_t gfp)
  5572. {
  5573. struct sk_buff *msg;
  5574. void *hdr;
  5575. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  5576. if (!msg)
  5577. return;
  5578. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
  5579. if (!hdr) {
  5580. nlmsg_free(msg);
  5581. return;
  5582. }
  5583. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5584. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5585. NLA_PUT(msg, NL80211_ATTR_FRAME, len, buf);
  5586. NLA_PUT_U64(msg, NL80211_ATTR_COOKIE, cookie);
  5587. if (ack)
  5588. NLA_PUT_FLAG(msg, NL80211_ATTR_ACK);
  5589. if (genlmsg_end(msg, hdr) < 0) {
  5590. nlmsg_free(msg);
  5591. return;
  5592. }
  5593. genlmsg_multicast(msg, 0, nl80211_mlme_mcgrp.id, gfp);
  5594. return;
  5595. nla_put_failure:
  5596. genlmsg_cancel(msg, hdr);
  5597. nlmsg_free(msg);
  5598. }
  5599. void
  5600. nl80211_send_cqm_rssi_notify(struct cfg80211_registered_device *rdev,
  5601. struct net_device *netdev,
  5602. enum nl80211_cqm_rssi_threshold_event rssi_event,
  5603. gfp_t gfp)
  5604. {
  5605. struct sk_buff *msg;
  5606. struct nlattr *pinfoattr;
  5607. void *hdr;
  5608. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  5609. if (!msg)
  5610. return;
  5611. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
  5612. if (!hdr) {
  5613. nlmsg_free(msg);
  5614. return;
  5615. }
  5616. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5617. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5618. pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
  5619. if (!pinfoattr)
  5620. goto nla_put_failure;
  5621. NLA_PUT_U32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
  5622. rssi_event);
  5623. nla_nest_end(msg, pinfoattr);
  5624. if (genlmsg_end(msg, hdr) < 0) {
  5625. nlmsg_free(msg);
  5626. return;
  5627. }
  5628. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5629. nl80211_mlme_mcgrp.id, gfp);
  5630. return;
  5631. nla_put_failure:
  5632. genlmsg_cancel(msg, hdr);
  5633. nlmsg_free(msg);
  5634. }
  5635. void
  5636. nl80211_send_cqm_pktloss_notify(struct cfg80211_registered_device *rdev,
  5637. struct net_device *netdev, const u8 *peer,
  5638. u32 num_packets, gfp_t gfp)
  5639. {
  5640. struct sk_buff *msg;
  5641. struct nlattr *pinfoattr;
  5642. void *hdr;
  5643. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  5644. if (!msg)
  5645. return;
  5646. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
  5647. if (!hdr) {
  5648. nlmsg_free(msg);
  5649. return;
  5650. }
  5651. NLA_PUT_U32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  5652. NLA_PUT_U32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  5653. NLA_PUT(msg, NL80211_ATTR_MAC, ETH_ALEN, peer);
  5654. pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
  5655. if (!pinfoattr)
  5656. goto nla_put_failure;
  5657. NLA_PUT_U32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets);
  5658. nla_nest_end(msg, pinfoattr);
  5659. if (genlmsg_end(msg, hdr) < 0) {
  5660. nlmsg_free(msg);
  5661. return;
  5662. }
  5663. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  5664. nl80211_mlme_mcgrp.id, gfp);
  5665. return;
  5666. nla_put_failure:
  5667. genlmsg_cancel(msg, hdr);
  5668. nlmsg_free(msg);
  5669. }
  5670. static int nl80211_netlink_notify(struct notifier_block * nb,
  5671. unsigned long state,
  5672. void *_notify)
  5673. {
  5674. struct netlink_notify *notify = _notify;
  5675. struct cfg80211_registered_device *rdev;
  5676. struct wireless_dev *wdev;
  5677. if (state != NETLINK_URELEASE)
  5678. return NOTIFY_DONE;
  5679. rcu_read_lock();
  5680. list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list)
  5681. list_for_each_entry_rcu(wdev, &rdev->netdev_list, list)
  5682. cfg80211_mlme_unregister_socket(wdev, notify->pid);
  5683. rcu_read_unlock();
  5684. return NOTIFY_DONE;
  5685. }
  5686. static struct notifier_block nl80211_netlink_notifier = {
  5687. .notifier_call = nl80211_netlink_notify,
  5688. };
  5689. /* initialisation/exit functions */
  5690. int nl80211_init(void)
  5691. {
  5692. int err;
  5693. err = genl_register_family_with_ops(&nl80211_fam,
  5694. nl80211_ops, ARRAY_SIZE(nl80211_ops));
  5695. if (err)
  5696. return err;
  5697. err = genl_register_mc_group(&nl80211_fam, &nl80211_config_mcgrp);
  5698. if (err)
  5699. goto err_out;
  5700. err = genl_register_mc_group(&nl80211_fam, &nl80211_scan_mcgrp);
  5701. if (err)
  5702. goto err_out;
  5703. err = genl_register_mc_group(&nl80211_fam, &nl80211_regulatory_mcgrp);
  5704. if (err)
  5705. goto err_out;
  5706. err = genl_register_mc_group(&nl80211_fam, &nl80211_mlme_mcgrp);
  5707. if (err)
  5708. goto err_out;
  5709. #ifdef CONFIG_NL80211_TESTMODE
  5710. err = genl_register_mc_group(&nl80211_fam, &nl80211_testmode_mcgrp);
  5711. if (err)
  5712. goto err_out;
  5713. #endif
  5714. err = netlink_register_notifier(&nl80211_netlink_notifier);
  5715. if (err)
  5716. goto err_out;
  5717. return 0;
  5718. err_out:
  5719. genl_unregister_family(&nl80211_fam);
  5720. return err;
  5721. }
  5722. void nl80211_exit(void)
  5723. {
  5724. netlink_unregister_notifier(&nl80211_netlink_notifier);
  5725. genl_unregister_family(&nl80211_fam);
  5726. }