nl80211.c 284 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220422142224223422442254226422742284229423042314232423342344235423642374238423942404241424242434244424542464247424842494250425142524253425442554256425742584259426042614262426342644265426642674268426942704271427242734274427542764277427842794280428142824283428442854286428742884289429042914292429342944295429642974298429943004301430243034304430543064307430843094310431143124313431443154316431743184319432043214322432343244325432643274328432943304331433243334334433543364337433843394340434143424343434443454346434743484349435043514352435343544355435643574358435943604361436243634364436543664367436843694370437143724373437443754376437743784379438043814382438343844385438643874388438943904391439243934394439543964397439843994400440144024403440444054406440744084409441044114412441344144415441644174418441944204421442244234424442544264427442844294430443144324433443444354436443744384439444044414442444344444445444644474448444944504451445244534454445544564457445844594460446144624463446444654466446744684469447044714472447344744475447644774478447944804481448244834484448544864487448844894490449144924493449444954496449744984499450045014502450345044505450645074508450945104511451245134514451545164517451845194520452145224523452445254526452745284529453045314532453345344535453645374538453945404541454245434544454545464547454845494550455145524553455445554556455745584559456045614562456345644565456645674568456945704571457245734574457545764577457845794580458145824583458445854586458745884589459045914592459345944595459645974598459946004601460246034604460546064607460846094610461146124613461446154616461746184619462046214622462346244625462646274628462946304631463246334634463546364637463846394640464146424643464446454646464746484649465046514652465346544655465646574658465946604661466246634664466546664667466846694670467146724673467446754676467746784679468046814682468346844685468646874688468946904691469246934694469546964697469846994700470147024703470447054706470747084709471047114712471347144715471647174718471947204721472247234724472547264727472847294730473147324733473447354736473747384739474047414742474347444745474647474748474947504751475247534754475547564757475847594760476147624763476447654766476747684769477047714772477347744775477647774778477947804781478247834784478547864787478847894790479147924793479447954796479747984799480048014802480348044805480648074808480948104811481248134814481548164817481848194820482148224823482448254826482748284829483048314832483348344835483648374838483948404841484248434844484548464847484848494850485148524853485448554856485748584859486048614862486348644865486648674868486948704871487248734874487548764877487848794880488148824883488448854886488748884889489048914892489348944895489648974898489949004901490249034904490549064907490849094910491149124913491449154916491749184919492049214922492349244925492649274928492949304931493249334934493549364937493849394940494149424943494449454946494749484949495049514952495349544955495649574958495949604961496249634964496549664967496849694970497149724973497449754976497749784979498049814982498349844985498649874988498949904991499249934994499549964997499849995000500150025003500450055006500750085009501050115012501350145015501650175018501950205021502250235024502550265027502850295030503150325033503450355036503750385039504050415042504350445045504650475048504950505051505250535054505550565057505850595060506150625063506450655066506750685069507050715072507350745075507650775078507950805081508250835084508550865087508850895090509150925093509450955096509750985099510051015102510351045105510651075108510951105111511251135114511551165117511851195120512151225123512451255126512751285129513051315132513351345135513651375138513951405141514251435144514551465147514851495150515151525153515451555156515751585159516051615162516351645165516651675168516951705171517251735174517551765177517851795180518151825183518451855186518751885189519051915192519351945195519651975198519952005201520252035204520552065207520852095210521152125213521452155216521752185219522052215222522352245225522652275228522952305231523252335234523552365237523852395240524152425243524452455246524752485249525052515252525352545255525652575258525952605261526252635264526552665267526852695270527152725273527452755276527752785279528052815282528352845285528652875288528952905291529252935294529552965297529852995300530153025303530453055306530753085309531053115312531353145315531653175318531953205321532253235324532553265327532853295330533153325333533453355336533753385339534053415342534353445345534653475348534953505351535253535354535553565357535853595360536153625363536453655366536753685369537053715372537353745375537653775378537953805381538253835384538553865387538853895390539153925393539453955396539753985399540054015402540354045405540654075408540954105411541254135414541554165417541854195420542154225423542454255426542754285429543054315432543354345435543654375438543954405441544254435444544554465447544854495450545154525453545454555456545754585459546054615462546354645465546654675468546954705471547254735474547554765477547854795480548154825483548454855486548754885489549054915492549354945495549654975498549955005501550255035504550555065507550855095510551155125513551455155516551755185519552055215522552355245525552655275528552955305531553255335534553555365537553855395540554155425543554455455546554755485549555055515552555355545555555655575558555955605561556255635564556555665567556855695570557155725573557455755576557755785579558055815582558355845585558655875588558955905591559255935594559555965597559855995600560156025603560456055606560756085609561056115612561356145615561656175618561956205621562256235624562556265627562856295630563156325633563456355636563756385639564056415642564356445645564656475648564956505651565256535654565556565657565856595660566156625663566456655666566756685669567056715672567356745675567656775678567956805681568256835684568556865687568856895690569156925693569456955696569756985699570057015702570357045705570657075708570957105711571257135714571557165717571857195720572157225723572457255726572757285729573057315732573357345735573657375738573957405741574257435744574557465747574857495750575157525753575457555756575757585759576057615762576357645765576657675768576957705771577257735774577557765777577857795780578157825783578457855786578757885789579057915792579357945795579657975798579958005801580258035804580558065807580858095810581158125813581458155816581758185819582058215822582358245825582658275828582958305831583258335834583558365837583858395840584158425843584458455846584758485849585058515852585358545855585658575858585958605861586258635864586558665867586858695870587158725873587458755876587758785879588058815882588358845885588658875888588958905891589258935894589558965897589858995900590159025903590459055906590759085909591059115912591359145915591659175918591959205921592259235924592559265927592859295930593159325933593459355936593759385939594059415942594359445945594659475948594959505951595259535954595559565957595859595960596159625963596459655966596759685969597059715972597359745975597659775978597959805981598259835984598559865987598859895990599159925993599459955996599759985999600060016002600360046005600660076008600960106011601260136014601560166017601860196020602160226023602460256026602760286029603060316032603360346035603660376038603960406041604260436044604560466047604860496050605160526053605460556056605760586059606060616062606360646065606660676068606960706071607260736074607560766077607860796080608160826083608460856086608760886089609060916092609360946095609660976098609961006101610261036104610561066107610861096110611161126113611461156116611761186119612061216122612361246125612661276128612961306131613261336134613561366137613861396140614161426143614461456146614761486149615061516152615361546155615661576158615961606161616261636164616561666167616861696170617161726173617461756176617761786179618061816182618361846185618661876188618961906191619261936194619561966197619861996200620162026203620462056206620762086209621062116212621362146215621662176218621962206221622262236224622562266227622862296230623162326233623462356236623762386239624062416242624362446245624662476248624962506251625262536254625562566257625862596260626162626263626462656266626762686269627062716272627362746275627662776278627962806281628262836284628562866287628862896290629162926293629462956296629762986299630063016302630363046305630663076308630963106311631263136314631563166317631863196320632163226323632463256326632763286329633063316332633363346335633663376338633963406341634263436344634563466347634863496350635163526353635463556356635763586359636063616362636363646365636663676368636963706371637263736374637563766377637863796380638163826383638463856386638763886389639063916392639363946395639663976398639964006401640264036404640564066407640864096410641164126413641464156416641764186419642064216422642364246425642664276428642964306431643264336434643564366437643864396440644164426443644464456446644764486449645064516452645364546455645664576458645964606461646264636464646564666467646864696470647164726473647464756476647764786479648064816482648364846485648664876488648964906491649264936494649564966497649864996500650165026503650465056506650765086509651065116512651365146515651665176518651965206521652265236524652565266527652865296530653165326533653465356536653765386539654065416542654365446545654665476548654965506551655265536554655565566557655865596560656165626563656465656566656765686569657065716572657365746575657665776578657965806581658265836584658565866587658865896590659165926593659465956596659765986599660066016602660366046605660666076608660966106611661266136614661566166617661866196620662166226623662466256626662766286629663066316632663366346635663666376638663966406641664266436644664566466647664866496650665166526653665466556656665766586659666066616662666366646665666666676668666966706671667266736674667566766677667866796680668166826683668466856686668766886689669066916692669366946695669666976698669967006701670267036704670567066707670867096710671167126713671467156716671767186719672067216722672367246725672667276728672967306731673267336734673567366737673867396740674167426743674467456746674767486749675067516752675367546755675667576758675967606761676267636764676567666767676867696770677167726773677467756776677767786779678067816782678367846785678667876788678967906791679267936794679567966797679867996800680168026803680468056806680768086809681068116812681368146815681668176818681968206821682268236824682568266827682868296830683168326833683468356836683768386839684068416842684368446845684668476848684968506851685268536854685568566857685868596860686168626863686468656866686768686869687068716872687368746875687668776878687968806881688268836884688568866887688868896890689168926893689468956896689768986899690069016902690369046905690669076908690969106911691269136914691569166917691869196920692169226923692469256926692769286929693069316932693369346935693669376938693969406941694269436944694569466947694869496950695169526953695469556956695769586959696069616962696369646965696669676968696969706971697269736974697569766977697869796980698169826983698469856986698769886989699069916992699369946995699669976998699970007001700270037004700570067007700870097010701170127013701470157016701770187019702070217022702370247025702670277028702970307031703270337034703570367037703870397040704170427043704470457046704770487049705070517052705370547055705670577058705970607061706270637064706570667067706870697070707170727073707470757076707770787079708070817082708370847085708670877088708970907091709270937094709570967097709870997100710171027103710471057106710771087109711071117112711371147115711671177118711971207121712271237124712571267127712871297130713171327133713471357136713771387139714071417142714371447145714671477148714971507151715271537154715571567157715871597160716171627163716471657166716771687169717071717172717371747175717671777178717971807181718271837184718571867187718871897190719171927193719471957196719771987199720072017202720372047205720672077208720972107211721272137214721572167217721872197220722172227223722472257226722772287229723072317232723372347235723672377238723972407241724272437244724572467247724872497250725172527253725472557256725772587259726072617262726372647265726672677268726972707271727272737274727572767277727872797280728172827283728472857286728772887289729072917292729372947295729672977298729973007301730273037304730573067307730873097310731173127313731473157316731773187319732073217322732373247325732673277328732973307331733273337334733573367337733873397340734173427343734473457346734773487349735073517352735373547355735673577358735973607361736273637364736573667367736873697370737173727373737473757376737773787379738073817382738373847385738673877388738973907391739273937394739573967397739873997400740174027403740474057406740774087409741074117412741374147415741674177418741974207421742274237424742574267427742874297430743174327433743474357436743774387439744074417442744374447445744674477448744974507451745274537454745574567457745874597460746174627463746474657466746774687469747074717472747374747475747674777478747974807481748274837484748574867487748874897490749174927493749474957496749774987499750075017502750375047505750675077508750975107511751275137514751575167517751875197520752175227523752475257526752775287529753075317532753375347535753675377538753975407541754275437544754575467547754875497550755175527553755475557556755775587559756075617562756375647565756675677568756975707571757275737574757575767577757875797580758175827583758475857586758775887589759075917592759375947595759675977598759976007601760276037604760576067607760876097610761176127613761476157616761776187619762076217622762376247625762676277628762976307631763276337634763576367637763876397640764176427643764476457646764776487649765076517652765376547655765676577658765976607661766276637664766576667667766876697670767176727673767476757676767776787679768076817682768376847685768676877688768976907691769276937694769576967697769876997700770177027703770477057706770777087709771077117712771377147715771677177718771977207721772277237724772577267727772877297730773177327733773477357736773777387739774077417742774377447745774677477748774977507751775277537754775577567757775877597760776177627763776477657766776777687769777077717772777377747775777677777778777977807781778277837784778577867787778877897790779177927793779477957796779777987799780078017802780378047805780678077808780978107811781278137814781578167817781878197820782178227823782478257826782778287829783078317832783378347835783678377838783978407841784278437844784578467847784878497850785178527853785478557856785778587859786078617862786378647865786678677868786978707871787278737874787578767877787878797880788178827883788478857886788778887889789078917892789378947895789678977898789979007901790279037904790579067907790879097910791179127913791479157916791779187919792079217922792379247925792679277928792979307931793279337934793579367937793879397940794179427943794479457946794779487949795079517952795379547955795679577958795979607961796279637964796579667967796879697970797179727973797479757976797779787979798079817982798379847985798679877988798979907991799279937994799579967997799879998000800180028003800480058006800780088009801080118012801380148015801680178018801980208021802280238024802580268027802880298030803180328033803480358036803780388039804080418042804380448045804680478048804980508051805280538054805580568057805880598060806180628063806480658066806780688069807080718072807380748075807680778078807980808081808280838084808580868087808880898090809180928093809480958096809780988099810081018102810381048105810681078108810981108111811281138114811581168117811881198120812181228123812481258126812781288129813081318132813381348135813681378138813981408141814281438144814581468147814881498150815181528153815481558156815781588159816081618162816381648165816681678168816981708171817281738174817581768177817881798180818181828183818481858186818781888189819081918192819381948195819681978198819982008201820282038204820582068207820882098210821182128213821482158216821782188219822082218222822382248225822682278228822982308231823282338234823582368237823882398240824182428243824482458246824782488249825082518252825382548255825682578258825982608261826282638264826582668267826882698270827182728273827482758276827782788279828082818282828382848285828682878288828982908291829282938294829582968297829882998300830183028303830483058306830783088309831083118312831383148315831683178318831983208321832283238324832583268327832883298330833183328333833483358336833783388339834083418342834383448345834683478348834983508351835283538354835583568357835883598360836183628363836483658366836783688369837083718372837383748375837683778378837983808381838283838384838583868387838883898390839183928393839483958396839783988399840084018402840384048405840684078408840984108411841284138414841584168417841884198420842184228423842484258426842784288429843084318432843384348435843684378438843984408441844284438444844584468447844884498450845184528453845484558456845784588459846084618462846384648465846684678468846984708471847284738474847584768477847884798480848184828483848484858486848784888489849084918492849384948495849684978498849985008501850285038504850585068507850885098510851185128513851485158516851785188519852085218522852385248525852685278528852985308531853285338534853585368537853885398540854185428543854485458546854785488549855085518552855385548555855685578558855985608561856285638564856585668567856885698570857185728573857485758576857785788579858085818582858385848585858685878588858985908591859285938594859585968597859885998600860186028603860486058606860786088609861086118612861386148615861686178618861986208621862286238624862586268627862886298630863186328633863486358636863786388639864086418642864386448645864686478648864986508651865286538654865586568657865886598660866186628663866486658666866786688669867086718672867386748675867686778678867986808681868286838684868586868687868886898690869186928693869486958696869786988699870087018702870387048705870687078708870987108711871287138714871587168717871887198720872187228723872487258726872787288729873087318732873387348735873687378738873987408741874287438744874587468747874887498750875187528753875487558756875787588759876087618762876387648765876687678768876987708771877287738774877587768777877887798780878187828783878487858786878787888789879087918792879387948795879687978798879988008801880288038804880588068807880888098810881188128813881488158816881788188819882088218822882388248825882688278828882988308831883288338834883588368837883888398840884188428843884488458846884788488849885088518852885388548855885688578858885988608861886288638864886588668867886888698870887188728873887488758876887788788879888088818882888388848885888688878888888988908891889288938894889588968897889888998900890189028903890489058906890789088909891089118912891389148915891689178918891989208921892289238924892589268927892889298930893189328933893489358936893789388939894089418942894389448945894689478948894989508951895289538954895589568957895889598960896189628963896489658966896789688969897089718972897389748975897689778978897989808981898289838984898589868987898889898990899189928993899489958996899789988999900090019002900390049005900690079008900990109011901290139014901590169017901890199020902190229023902490259026902790289029903090319032903390349035903690379038903990409041904290439044904590469047904890499050905190529053905490559056905790589059906090619062906390649065906690679068906990709071907290739074907590769077907890799080908190829083908490859086908790889089909090919092909390949095909690979098909991009101910291039104910591069107910891099110911191129113911491159116911791189119912091219122912391249125912691279128912991309131913291339134913591369137913891399140914191429143914491459146914791489149915091519152915391549155915691579158915991609161916291639164916591669167916891699170917191729173917491759176917791789179918091819182918391849185918691879188918991909191919291939194919591969197919891999200920192029203920492059206920792089209921092119212921392149215921692179218921992209221922292239224922592269227922892299230923192329233923492359236923792389239924092419242924392449245924692479248924992509251925292539254925592569257925892599260926192629263926492659266926792689269927092719272927392749275927692779278927992809281928292839284928592869287928892899290929192929293929492959296929792989299930093019302930393049305930693079308930993109311931293139314931593169317931893199320932193229323932493259326932793289329933093319332933393349335933693379338933993409341934293439344934593469347934893499350935193529353935493559356935793589359936093619362936393649365936693679368936993709371937293739374937593769377937893799380938193829383938493859386938793889389939093919392939393949395939693979398939994009401940294039404940594069407940894099410941194129413941494159416941794189419942094219422942394249425942694279428942994309431943294339434943594369437943894399440944194429443944494459446944794489449945094519452945394549455945694579458945994609461946294639464946594669467946894699470947194729473947494759476947794789479948094819482948394849485948694879488948994909491949294939494949594969497949894999500950195029503950495059506950795089509951095119512951395149515951695179518951995209521952295239524952595269527952895299530953195329533953495359536953795389539954095419542954395449545954695479548954995509551955295539554955595569557955895599560956195629563956495659566956795689569957095719572957395749575957695779578957995809581958295839584958595869587958895899590959195929593959495959596959795989599960096019602960396049605960696079608960996109611961296139614961596169617961896199620962196229623962496259626962796289629963096319632963396349635963696379638963996409641964296439644964596469647964896499650965196529653965496559656965796589659966096619662966396649665966696679668966996709671967296739674967596769677967896799680968196829683968496859686968796889689969096919692969396949695969696979698969997009701970297039704970597069707970897099710971197129713971497159716971797189719972097219722972397249725972697279728972997309731973297339734973597369737973897399740974197429743974497459746974797489749975097519752975397549755975697579758975997609761976297639764976597669767976897699770977197729773977497759776977797789779978097819782978397849785978697879788978997909791979297939794979597969797979897999800980198029803980498059806980798089809981098119812981398149815981698179818981998209821982298239824982598269827982898299830983198329833983498359836983798389839984098419842984398449845984698479848984998509851985298539854985598569857985898599860986198629863986498659866986798689869987098719872987398749875987698779878987998809881988298839884988598869887988898899890989198929893989498959896989798989899990099019902990399049905990699079908990999109911991299139914991599169917991899199920992199229923992499259926992799289929993099319932993399349935993699379938993999409941994299439944994599469947994899499950995199529953995499559956995799589959996099619962996399649965996699679968996999709971997299739974997599769977997899799980998199829983998499859986998799889989999099919992999399949995999699979998999910000100011000210003100041000510006100071000810009100101001110012100131001410015100161001710018100191002010021100221002310024100251002610027100281002910030100311003210033100341003510036100371003810039100401004110042100431004410045100461004710048100491005010051100521005310054100551005610057100581005910060100611006210063100641006510066100671006810069100701007110072100731007410075100761007710078100791008010081100821008310084100851008610087100881008910090100911009210093100941009510096100971009810099101001010110102101031010410105101061010710108101091011010111101121011310114101151011610117101181011910120101211012210123101241012510126101271012810129101301013110132101331013410135101361013710138101391014010141101421014310144101451014610147101481014910150101511015210153101541015510156101571015810159101601016110162101631016410165101661016710168101691017010171101721017310174101751017610177101781017910180101811018210183101841018510186101871018810189101901019110192101931019410195101961019710198101991020010201102021020310204102051020610207102081020910210102111021210213102141021510216102171021810219102201022110222102231022410225102261022710228102291023010231102321023310234102351023610237102381023910240102411024210243102441024510246102471024810249102501025110252102531025410255102561025710258102591026010261102621026310264102651026610267102681026910270102711027210273102741027510276102771027810279102801028110282102831028410285102861028710288102891029010291102921029310294102951029610297102981029910300103011030210303103041030510306103071030810309103101031110312103131031410315103161031710318103191032010321103221032310324103251032610327103281032910330103311033210333103341033510336103371033810339103401034110342103431034410345103461034710348103491035010351103521035310354103551035610357103581035910360103611036210363103641036510366103671036810369103701037110372103731037410375103761037710378103791038010381103821038310384103851038610387103881038910390103911039210393103941039510396103971039810399104001040110402104031040410405104061040710408104091041010411104121041310414104151041610417104181041910420104211042210423104241042510426104271042810429104301043110432104331043410435104361043710438104391044010441104421044310444104451044610447104481044910450104511045210453104541045510456104571045810459104601046110462104631046410465104661046710468104691047010471104721047310474104751047610477104781047910480104811048210483104841048510486104871048810489104901049110492104931049410495104961049710498104991050010501105021050310504105051050610507105081050910510105111051210513105141051510516105171051810519105201052110522105231052410525105261052710528105291053010531105321053310534105351053610537105381053910540105411054210543105441054510546105471054810549105501055110552105531055410555105561055710558105591056010561105621056310564105651056610567105681056910570105711057210573105741057510576105771057810579105801058110582105831058410585105861058710588105891059010591105921059310594105951059610597105981059910600106011060210603106041060510606106071060810609106101061110612106131061410615106161061710618106191062010621106221062310624106251062610627106281062910630106311063210633106341063510636106371063810639106401064110642106431064410645106461064710648106491065010651106521065310654106551065610657106581065910660106611066210663106641066510666106671066810669106701067110672106731067410675106761067710678106791068010681106821068310684106851068610687106881068910690106911069210693106941069510696106971069810699107001070110702107031070410705107061070710708107091071010711107121071310714107151071610717107181071910720107211072210723107241072510726107271072810729107301073110732107331073410735107361073710738107391074010741107421074310744107451074610747107481074910750107511075210753107541075510756107571075810759107601076110762107631076410765107661076710768107691077010771107721077310774107751077610777107781077910780107811078210783107841078510786107871078810789107901079110792107931079410795107961079710798107991080010801108021080310804108051080610807108081080910810108111081210813108141081510816108171081810819108201082110822108231082410825108261082710828
  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 <net/inet_connection_sock.h>
  22. #include "core.h"
  23. #include "nl80211.h"
  24. #include "reg.h"
  25. #include "rdev-ops.h"
  26. static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  27. struct genl_info *info,
  28. struct cfg80211_crypto_settings *settings,
  29. int cipher_limit);
  30. static int nl80211_pre_doit(struct genl_ops *ops, struct sk_buff *skb,
  31. struct genl_info *info);
  32. static void nl80211_post_doit(struct genl_ops *ops, struct sk_buff *skb,
  33. struct genl_info *info);
  34. /* the netlink family */
  35. static struct genl_family nl80211_fam = {
  36. .id = GENL_ID_GENERATE, /* don't bother with a hardcoded ID */
  37. .name = "nl80211", /* have users key off the name instead */
  38. .hdrsize = 0, /* no private header */
  39. .version = 1, /* no particular meaning now */
  40. .maxattr = NL80211_ATTR_MAX,
  41. .netnsok = true,
  42. .pre_doit = nl80211_pre_doit,
  43. .post_doit = nl80211_post_doit,
  44. };
  45. /* returns ERR_PTR values */
  46. static struct wireless_dev *
  47. __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
  48. {
  49. struct cfg80211_registered_device *rdev;
  50. struct wireless_dev *result = NULL;
  51. bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
  52. bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
  53. u64 wdev_id;
  54. int wiphy_idx = -1;
  55. int ifidx = -1;
  56. assert_cfg80211_lock();
  57. if (!have_ifidx && !have_wdev_id)
  58. return ERR_PTR(-EINVAL);
  59. if (have_ifidx)
  60. ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  61. if (have_wdev_id) {
  62. wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  63. wiphy_idx = wdev_id >> 32;
  64. }
  65. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  66. struct wireless_dev *wdev;
  67. if (wiphy_net(&rdev->wiphy) != netns)
  68. continue;
  69. if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
  70. continue;
  71. mutex_lock(&rdev->devlist_mtx);
  72. list_for_each_entry(wdev, &rdev->wdev_list, list) {
  73. if (have_ifidx && wdev->netdev &&
  74. wdev->netdev->ifindex == ifidx) {
  75. result = wdev;
  76. break;
  77. }
  78. if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
  79. result = wdev;
  80. break;
  81. }
  82. }
  83. mutex_unlock(&rdev->devlist_mtx);
  84. if (result)
  85. break;
  86. }
  87. if (result)
  88. return result;
  89. return ERR_PTR(-ENODEV);
  90. }
  91. static struct cfg80211_registered_device *
  92. __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
  93. {
  94. struct cfg80211_registered_device *rdev = NULL, *tmp;
  95. struct net_device *netdev;
  96. assert_cfg80211_lock();
  97. if (!attrs[NL80211_ATTR_WIPHY] &&
  98. !attrs[NL80211_ATTR_IFINDEX] &&
  99. !attrs[NL80211_ATTR_WDEV])
  100. return ERR_PTR(-EINVAL);
  101. if (attrs[NL80211_ATTR_WIPHY])
  102. rdev = cfg80211_rdev_by_wiphy_idx(
  103. nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
  104. if (attrs[NL80211_ATTR_WDEV]) {
  105. u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  106. struct wireless_dev *wdev;
  107. bool found = false;
  108. tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
  109. if (tmp) {
  110. /* make sure wdev exists */
  111. mutex_lock(&tmp->devlist_mtx);
  112. list_for_each_entry(wdev, &tmp->wdev_list, list) {
  113. if (wdev->identifier != (u32)wdev_id)
  114. continue;
  115. found = true;
  116. break;
  117. }
  118. mutex_unlock(&tmp->devlist_mtx);
  119. if (!found)
  120. tmp = NULL;
  121. if (rdev && tmp != rdev)
  122. return ERR_PTR(-EINVAL);
  123. rdev = tmp;
  124. }
  125. }
  126. if (attrs[NL80211_ATTR_IFINDEX]) {
  127. int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  128. netdev = dev_get_by_index(netns, ifindex);
  129. if (netdev) {
  130. if (netdev->ieee80211_ptr)
  131. tmp = wiphy_to_dev(
  132. netdev->ieee80211_ptr->wiphy);
  133. else
  134. tmp = NULL;
  135. dev_put(netdev);
  136. /* not wireless device -- return error */
  137. if (!tmp)
  138. return ERR_PTR(-EINVAL);
  139. /* mismatch -- return error */
  140. if (rdev && tmp != rdev)
  141. return ERR_PTR(-EINVAL);
  142. rdev = tmp;
  143. }
  144. }
  145. if (!rdev)
  146. return ERR_PTR(-ENODEV);
  147. if (netns != wiphy_net(&rdev->wiphy))
  148. return ERR_PTR(-ENODEV);
  149. return rdev;
  150. }
  151. /*
  152. * This function returns a pointer to the driver
  153. * that the genl_info item that is passed refers to.
  154. * If successful, it returns non-NULL and also locks
  155. * the driver's mutex!
  156. *
  157. * This means that you need to call cfg80211_unlock_rdev()
  158. * before being allowed to acquire &cfg80211_mutex!
  159. *
  160. * This is necessary because we need to lock the global
  161. * mutex to get an item off the list safely, and then
  162. * we lock the rdev mutex so it doesn't go away under us.
  163. *
  164. * We don't want to keep cfg80211_mutex locked
  165. * for all the time in order to allow requests on
  166. * other interfaces to go through at the same time.
  167. *
  168. * The result of this can be a PTR_ERR and hence must
  169. * be checked with IS_ERR() for errors.
  170. */
  171. static struct cfg80211_registered_device *
  172. cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
  173. {
  174. struct cfg80211_registered_device *rdev;
  175. mutex_lock(&cfg80211_mutex);
  176. rdev = __cfg80211_rdev_from_attrs(netns, info->attrs);
  177. /* if it is not an error we grab the lock on
  178. * it to assure it won't be going away while
  179. * we operate on it */
  180. if (!IS_ERR(rdev))
  181. mutex_lock(&rdev->mtx);
  182. mutex_unlock(&cfg80211_mutex);
  183. return rdev;
  184. }
  185. /* policy for the attributes */
  186. static const struct nla_policy nl80211_policy[NL80211_ATTR_MAX+1] = {
  187. [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
  188. [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
  189. .len = 20-1 },
  190. [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
  191. [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
  192. [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
  193. [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
  194. [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
  195. [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
  196. [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
  197. [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
  198. [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
  199. [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
  200. [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
  201. [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
  202. [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
  203. [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
  204. [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
  205. [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
  206. [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
  207. [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
  208. .len = WLAN_MAX_KEY_LEN },
  209. [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
  210. [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
  211. [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
  212. [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
  213. [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
  214. [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
  215. [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
  216. [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
  217. .len = IEEE80211_MAX_DATA_LEN },
  218. [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
  219. .len = IEEE80211_MAX_DATA_LEN },
  220. [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
  221. [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
  222. [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
  223. [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
  224. .len = NL80211_MAX_SUPP_RATES },
  225. [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
  226. [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
  227. [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
  228. [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
  229. .len = IEEE80211_MAX_MESH_ID_LEN },
  230. [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
  231. [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
  232. [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
  233. [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
  234. [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
  235. [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
  236. [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
  237. .len = NL80211_MAX_SUPP_RATES },
  238. [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
  239. [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
  240. [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
  241. [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
  242. [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
  243. [NL80211_ATTR_IE] = { .type = NLA_BINARY,
  244. .len = IEEE80211_MAX_DATA_LEN },
  245. [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
  246. [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
  247. [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
  248. .len = IEEE80211_MAX_SSID_LEN },
  249. [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
  250. [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
  251. [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
  252. [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
  253. [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
  254. [NL80211_ATTR_STA_FLAGS2] = {
  255. .len = sizeof(struct nl80211_sta_flag_update),
  256. },
  257. [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
  258. [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
  259. [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
  260. [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
  261. [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
  262. [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
  263. [NL80211_ATTR_PID] = { .type = NLA_U32 },
  264. [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
  265. [NL80211_ATTR_PMKID] = { .type = NLA_BINARY,
  266. .len = WLAN_PMKID_LEN },
  267. [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
  268. [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
  269. [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
  270. [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
  271. .len = IEEE80211_MAX_DATA_LEN },
  272. [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
  273. [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
  274. [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
  275. [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
  276. [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
  277. [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
  278. [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
  279. [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
  280. [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
  281. [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
  282. [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
  283. [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
  284. [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  285. [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
  286. [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
  287. [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
  288. [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
  289. [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
  290. [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
  291. [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
  292. .len = IEEE80211_MAX_DATA_LEN },
  293. [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
  294. .len = IEEE80211_MAX_DATA_LEN },
  295. [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
  296. [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
  297. [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
  298. [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
  299. [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
  300. [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
  301. [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
  302. [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
  303. [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
  304. [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
  305. .len = IEEE80211_MAX_DATA_LEN },
  306. [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
  307. [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
  308. [NL80211_ATTR_HT_CAPABILITY_MASK] = {
  309. .len = NL80211_HT_CAPABILITY_LEN
  310. },
  311. [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
  312. [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
  313. [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
  314. [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
  315. [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
  316. [NL80211_ATTR_SAE_DATA] = { .type = NLA_BINARY, },
  317. [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
  318. [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
  319. [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
  320. [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
  321. [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
  322. [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
  323. [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
  324. [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
  325. [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
  326. [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
  327. [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
  328. .len = NL80211_VHT_CAPABILITY_LEN,
  329. },
  330. [NL80211_ATTR_MDID] = { .type = NLA_U16 },
  331. [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
  332. .len = IEEE80211_MAX_DATA_LEN },
  333. };
  334. /* policy for the key attributes */
  335. static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
  336. [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
  337. [NL80211_KEY_IDX] = { .type = NLA_U8 },
  338. [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
  339. [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
  340. [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
  341. [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
  342. [NL80211_KEY_TYPE] = { .type = NLA_U32 },
  343. [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  344. };
  345. /* policy for the key default flags */
  346. static const struct nla_policy
  347. nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
  348. [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
  349. [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
  350. };
  351. /* policy for WoWLAN attributes */
  352. static const struct nla_policy
  353. nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
  354. [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
  355. [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
  356. [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
  357. [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
  358. [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
  359. [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
  360. [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
  361. [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
  362. [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
  363. };
  364. static const struct nla_policy
  365. nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
  366. [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
  367. [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
  368. [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
  369. [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
  370. [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
  371. [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
  372. [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
  373. .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
  374. },
  375. [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
  376. .len = sizeof(struct nl80211_wowlan_tcp_data_token)
  377. },
  378. [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
  379. [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
  380. [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
  381. };
  382. /* policy for GTK rekey offload attributes */
  383. static const struct nla_policy
  384. nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
  385. [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
  386. [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
  387. [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
  388. };
  389. static const struct nla_policy
  390. nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
  391. [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
  392. .len = IEEE80211_MAX_SSID_LEN },
  393. [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
  394. };
  395. static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
  396. struct netlink_callback *cb,
  397. struct cfg80211_registered_device **rdev,
  398. struct wireless_dev **wdev)
  399. {
  400. int err;
  401. rtnl_lock();
  402. mutex_lock(&cfg80211_mutex);
  403. if (!cb->args[0]) {
  404. err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
  405. nl80211_fam.attrbuf, nl80211_fam.maxattr,
  406. nl80211_policy);
  407. if (err)
  408. goto out_unlock;
  409. *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk),
  410. nl80211_fam.attrbuf);
  411. if (IS_ERR(*wdev)) {
  412. err = PTR_ERR(*wdev);
  413. goto out_unlock;
  414. }
  415. *rdev = wiphy_to_dev((*wdev)->wiphy);
  416. cb->args[0] = (*rdev)->wiphy_idx;
  417. cb->args[1] = (*wdev)->identifier;
  418. } else {
  419. struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0]);
  420. struct wireless_dev *tmp;
  421. if (!wiphy) {
  422. err = -ENODEV;
  423. goto out_unlock;
  424. }
  425. *rdev = wiphy_to_dev(wiphy);
  426. *wdev = NULL;
  427. mutex_lock(&(*rdev)->devlist_mtx);
  428. list_for_each_entry(tmp, &(*rdev)->wdev_list, list) {
  429. if (tmp->identifier == cb->args[1]) {
  430. *wdev = tmp;
  431. break;
  432. }
  433. }
  434. mutex_unlock(&(*rdev)->devlist_mtx);
  435. if (!*wdev) {
  436. err = -ENODEV;
  437. goto out_unlock;
  438. }
  439. }
  440. cfg80211_lock_rdev(*rdev);
  441. mutex_unlock(&cfg80211_mutex);
  442. return 0;
  443. out_unlock:
  444. mutex_unlock(&cfg80211_mutex);
  445. rtnl_unlock();
  446. return err;
  447. }
  448. static void nl80211_finish_wdev_dump(struct cfg80211_registered_device *rdev)
  449. {
  450. cfg80211_unlock_rdev(rdev);
  451. rtnl_unlock();
  452. }
  453. /* IE validation */
  454. static bool is_valid_ie_attr(const struct nlattr *attr)
  455. {
  456. const u8 *pos;
  457. int len;
  458. if (!attr)
  459. return true;
  460. pos = nla_data(attr);
  461. len = nla_len(attr);
  462. while (len) {
  463. u8 elemlen;
  464. if (len < 2)
  465. return false;
  466. len -= 2;
  467. elemlen = pos[1];
  468. if (elemlen > len)
  469. return false;
  470. len -= elemlen;
  471. pos += 2 + elemlen;
  472. }
  473. return true;
  474. }
  475. /* message building helper */
  476. static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
  477. int flags, u8 cmd)
  478. {
  479. /* since there is no private header just add the generic one */
  480. return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
  481. }
  482. static int nl80211_msg_put_channel(struct sk_buff *msg,
  483. struct ieee80211_channel *chan,
  484. bool large)
  485. {
  486. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
  487. chan->center_freq))
  488. goto nla_put_failure;
  489. if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
  490. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
  491. goto nla_put_failure;
  492. if ((chan->flags & IEEE80211_CHAN_PASSIVE_SCAN) &&
  493. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_PASSIVE_SCAN))
  494. goto nla_put_failure;
  495. if ((chan->flags & IEEE80211_CHAN_NO_IBSS) &&
  496. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IBSS))
  497. goto nla_put_failure;
  498. if (chan->flags & IEEE80211_CHAN_RADAR) {
  499. if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
  500. goto nla_put_failure;
  501. if (large) {
  502. u32 time;
  503. time = elapsed_jiffies_msecs(chan->dfs_state_entered);
  504. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
  505. chan->dfs_state))
  506. goto nla_put_failure;
  507. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
  508. time))
  509. goto nla_put_failure;
  510. }
  511. }
  512. if (large) {
  513. if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
  514. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
  515. goto nla_put_failure;
  516. if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
  517. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
  518. goto nla_put_failure;
  519. if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
  520. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
  521. goto nla_put_failure;
  522. if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
  523. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
  524. goto nla_put_failure;
  525. }
  526. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
  527. DBM_TO_MBM(chan->max_power)))
  528. goto nla_put_failure;
  529. return 0;
  530. nla_put_failure:
  531. return -ENOBUFS;
  532. }
  533. /* netlink command implementations */
  534. struct key_parse {
  535. struct key_params p;
  536. int idx;
  537. int type;
  538. bool def, defmgmt;
  539. bool def_uni, def_multi;
  540. };
  541. static int nl80211_parse_key_new(struct nlattr *key, struct key_parse *k)
  542. {
  543. struct nlattr *tb[NL80211_KEY_MAX + 1];
  544. int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
  545. nl80211_key_policy);
  546. if (err)
  547. return err;
  548. k->def = !!tb[NL80211_KEY_DEFAULT];
  549. k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
  550. if (k->def) {
  551. k->def_uni = true;
  552. k->def_multi = true;
  553. }
  554. if (k->defmgmt)
  555. k->def_multi = true;
  556. if (tb[NL80211_KEY_IDX])
  557. k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
  558. if (tb[NL80211_KEY_DATA]) {
  559. k->p.key = nla_data(tb[NL80211_KEY_DATA]);
  560. k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
  561. }
  562. if (tb[NL80211_KEY_SEQ]) {
  563. k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
  564. k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
  565. }
  566. if (tb[NL80211_KEY_CIPHER])
  567. k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
  568. if (tb[NL80211_KEY_TYPE]) {
  569. k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
  570. if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
  571. return -EINVAL;
  572. }
  573. if (tb[NL80211_KEY_DEFAULT_TYPES]) {
  574. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  575. err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  576. tb[NL80211_KEY_DEFAULT_TYPES],
  577. nl80211_key_default_policy);
  578. if (err)
  579. return err;
  580. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  581. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  582. }
  583. return 0;
  584. }
  585. static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
  586. {
  587. if (info->attrs[NL80211_ATTR_KEY_DATA]) {
  588. k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
  589. k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
  590. }
  591. if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
  592. k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
  593. k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
  594. }
  595. if (info->attrs[NL80211_ATTR_KEY_IDX])
  596. k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  597. if (info->attrs[NL80211_ATTR_KEY_CIPHER])
  598. k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
  599. k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
  600. k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
  601. if (k->def) {
  602. k->def_uni = true;
  603. k->def_multi = true;
  604. }
  605. if (k->defmgmt)
  606. k->def_multi = true;
  607. if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
  608. k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  609. if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
  610. return -EINVAL;
  611. }
  612. if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
  613. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  614. int err = nla_parse_nested(
  615. kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  616. info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
  617. nl80211_key_default_policy);
  618. if (err)
  619. return err;
  620. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  621. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  622. }
  623. return 0;
  624. }
  625. static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
  626. {
  627. int err;
  628. memset(k, 0, sizeof(*k));
  629. k->idx = -1;
  630. k->type = -1;
  631. if (info->attrs[NL80211_ATTR_KEY])
  632. err = nl80211_parse_key_new(info->attrs[NL80211_ATTR_KEY], k);
  633. else
  634. err = nl80211_parse_key_old(info, k);
  635. if (err)
  636. return err;
  637. if (k->def && k->defmgmt)
  638. return -EINVAL;
  639. if (k->defmgmt) {
  640. if (k->def_uni || !k->def_multi)
  641. return -EINVAL;
  642. }
  643. if (k->idx != -1) {
  644. if (k->defmgmt) {
  645. if (k->idx < 4 || k->idx > 5)
  646. return -EINVAL;
  647. } else if (k->def) {
  648. if (k->idx < 0 || k->idx > 3)
  649. return -EINVAL;
  650. } else {
  651. if (k->idx < 0 || k->idx > 5)
  652. return -EINVAL;
  653. }
  654. }
  655. return 0;
  656. }
  657. static struct cfg80211_cached_keys *
  658. nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
  659. struct nlattr *keys, bool *no_ht)
  660. {
  661. struct key_parse parse;
  662. struct nlattr *key;
  663. struct cfg80211_cached_keys *result;
  664. int rem, err, def = 0;
  665. result = kzalloc(sizeof(*result), GFP_KERNEL);
  666. if (!result)
  667. return ERR_PTR(-ENOMEM);
  668. result->def = -1;
  669. result->defmgmt = -1;
  670. nla_for_each_nested(key, keys, rem) {
  671. memset(&parse, 0, sizeof(parse));
  672. parse.idx = -1;
  673. err = nl80211_parse_key_new(key, &parse);
  674. if (err)
  675. goto error;
  676. err = -EINVAL;
  677. if (!parse.p.key)
  678. goto error;
  679. if (parse.idx < 0 || parse.idx > 4)
  680. goto error;
  681. if (parse.def) {
  682. if (def)
  683. goto error;
  684. def = 1;
  685. result->def = parse.idx;
  686. if (!parse.def_uni || !parse.def_multi)
  687. goto error;
  688. } else if (parse.defmgmt)
  689. goto error;
  690. err = cfg80211_validate_key_settings(rdev, &parse.p,
  691. parse.idx, false, NULL);
  692. if (err)
  693. goto error;
  694. result->params[parse.idx].cipher = parse.p.cipher;
  695. result->params[parse.idx].key_len = parse.p.key_len;
  696. result->params[parse.idx].key = result->data[parse.idx];
  697. memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
  698. if (parse.p.cipher == WLAN_CIPHER_SUITE_WEP40 ||
  699. parse.p.cipher == WLAN_CIPHER_SUITE_WEP104) {
  700. if (no_ht)
  701. *no_ht = true;
  702. }
  703. }
  704. return result;
  705. error:
  706. kfree(result);
  707. return ERR_PTR(err);
  708. }
  709. static int nl80211_key_allowed(struct wireless_dev *wdev)
  710. {
  711. ASSERT_WDEV_LOCK(wdev);
  712. switch (wdev->iftype) {
  713. case NL80211_IFTYPE_AP:
  714. case NL80211_IFTYPE_AP_VLAN:
  715. case NL80211_IFTYPE_P2P_GO:
  716. case NL80211_IFTYPE_MESH_POINT:
  717. break;
  718. case NL80211_IFTYPE_ADHOC:
  719. if (!wdev->current_bss)
  720. return -ENOLINK;
  721. break;
  722. case NL80211_IFTYPE_STATION:
  723. case NL80211_IFTYPE_P2P_CLIENT:
  724. if (wdev->sme_state != CFG80211_SME_CONNECTED)
  725. return -ENOLINK;
  726. break;
  727. default:
  728. return -EINVAL;
  729. }
  730. return 0;
  731. }
  732. static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
  733. {
  734. struct nlattr *nl_modes = nla_nest_start(msg, attr);
  735. int i;
  736. if (!nl_modes)
  737. goto nla_put_failure;
  738. i = 0;
  739. while (ifmodes) {
  740. if ((ifmodes & 1) && nla_put_flag(msg, i))
  741. goto nla_put_failure;
  742. ifmodes >>= 1;
  743. i++;
  744. }
  745. nla_nest_end(msg, nl_modes);
  746. return 0;
  747. nla_put_failure:
  748. return -ENOBUFS;
  749. }
  750. static int nl80211_put_iface_combinations(struct wiphy *wiphy,
  751. struct sk_buff *msg,
  752. bool large)
  753. {
  754. struct nlattr *nl_combis;
  755. int i, j;
  756. nl_combis = nla_nest_start(msg,
  757. NL80211_ATTR_INTERFACE_COMBINATIONS);
  758. if (!nl_combis)
  759. goto nla_put_failure;
  760. for (i = 0; i < wiphy->n_iface_combinations; i++) {
  761. const struct ieee80211_iface_combination *c;
  762. struct nlattr *nl_combi, *nl_limits;
  763. c = &wiphy->iface_combinations[i];
  764. nl_combi = nla_nest_start(msg, i + 1);
  765. if (!nl_combi)
  766. goto nla_put_failure;
  767. nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
  768. if (!nl_limits)
  769. goto nla_put_failure;
  770. for (j = 0; j < c->n_limits; j++) {
  771. struct nlattr *nl_limit;
  772. nl_limit = nla_nest_start(msg, j + 1);
  773. if (!nl_limit)
  774. goto nla_put_failure;
  775. if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
  776. c->limits[j].max))
  777. goto nla_put_failure;
  778. if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
  779. c->limits[j].types))
  780. goto nla_put_failure;
  781. nla_nest_end(msg, nl_limit);
  782. }
  783. nla_nest_end(msg, nl_limits);
  784. if (c->beacon_int_infra_match &&
  785. nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
  786. goto nla_put_failure;
  787. if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
  788. c->num_different_channels) ||
  789. nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
  790. c->max_interfaces))
  791. goto nla_put_failure;
  792. if (large &&
  793. nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
  794. c->radar_detect_widths))
  795. goto nla_put_failure;
  796. nla_nest_end(msg, nl_combi);
  797. }
  798. nla_nest_end(msg, nl_combis);
  799. return 0;
  800. nla_put_failure:
  801. return -ENOBUFS;
  802. }
  803. #ifdef CONFIG_PM
  804. static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
  805. struct sk_buff *msg)
  806. {
  807. const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan.tcp;
  808. struct nlattr *nl_tcp;
  809. if (!tcp)
  810. return 0;
  811. nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
  812. if (!nl_tcp)
  813. return -ENOBUFS;
  814. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  815. tcp->data_payload_max))
  816. return -ENOBUFS;
  817. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  818. tcp->data_payload_max))
  819. return -ENOBUFS;
  820. if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
  821. return -ENOBUFS;
  822. if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
  823. sizeof(*tcp->tok), tcp->tok))
  824. return -ENOBUFS;
  825. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
  826. tcp->data_interval_max))
  827. return -ENOBUFS;
  828. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
  829. tcp->wake_payload_max))
  830. return -ENOBUFS;
  831. nla_nest_end(msg, nl_tcp);
  832. return 0;
  833. }
  834. static int nl80211_send_wowlan(struct sk_buff *msg,
  835. struct cfg80211_registered_device *dev,
  836. bool large)
  837. {
  838. struct nlattr *nl_wowlan;
  839. if (!dev->wiphy.wowlan.flags && !dev->wiphy.wowlan.n_patterns)
  840. return 0;
  841. nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
  842. if (!nl_wowlan)
  843. return -ENOBUFS;
  844. if (((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_ANY) &&
  845. nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
  846. ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_DISCONNECT) &&
  847. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
  848. ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_MAGIC_PKT) &&
  849. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
  850. ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
  851. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
  852. ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
  853. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
  854. ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
  855. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
  856. ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
  857. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
  858. ((dev->wiphy.wowlan.flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
  859. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
  860. return -ENOBUFS;
  861. if (dev->wiphy.wowlan.n_patterns) {
  862. struct nl80211_wowlan_pattern_support pat = {
  863. .max_patterns = dev->wiphy.wowlan.n_patterns,
  864. .min_pattern_len = dev->wiphy.wowlan.pattern_min_len,
  865. .max_pattern_len = dev->wiphy.wowlan.pattern_max_len,
  866. .max_pkt_offset = dev->wiphy.wowlan.max_pkt_offset,
  867. };
  868. if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  869. sizeof(pat), &pat))
  870. return -ENOBUFS;
  871. }
  872. if (large && nl80211_send_wowlan_tcp_caps(dev, msg))
  873. return -ENOBUFS;
  874. nla_nest_end(msg, nl_wowlan);
  875. return 0;
  876. }
  877. #endif
  878. static int nl80211_send_band_rateinfo(struct sk_buff *msg,
  879. struct ieee80211_supported_band *sband)
  880. {
  881. struct nlattr *nl_rates, *nl_rate;
  882. struct ieee80211_rate *rate;
  883. int i;
  884. /* add HT info */
  885. if (sband->ht_cap.ht_supported &&
  886. (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
  887. sizeof(sband->ht_cap.mcs),
  888. &sband->ht_cap.mcs) ||
  889. nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
  890. sband->ht_cap.cap) ||
  891. nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
  892. sband->ht_cap.ampdu_factor) ||
  893. nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
  894. sband->ht_cap.ampdu_density)))
  895. return -ENOBUFS;
  896. /* add VHT info */
  897. if (sband->vht_cap.vht_supported &&
  898. (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
  899. sizeof(sband->vht_cap.vht_mcs),
  900. &sband->vht_cap.vht_mcs) ||
  901. nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
  902. sband->vht_cap.cap)))
  903. return -ENOBUFS;
  904. /* add bitrates */
  905. nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
  906. if (!nl_rates)
  907. return -ENOBUFS;
  908. for (i = 0; i < sband->n_bitrates; i++) {
  909. nl_rate = nla_nest_start(msg, i);
  910. if (!nl_rate)
  911. return -ENOBUFS;
  912. rate = &sband->bitrates[i];
  913. if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
  914. rate->bitrate))
  915. return -ENOBUFS;
  916. if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
  917. nla_put_flag(msg,
  918. NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
  919. return -ENOBUFS;
  920. nla_nest_end(msg, nl_rate);
  921. }
  922. nla_nest_end(msg, nl_rates);
  923. return 0;
  924. }
  925. static int
  926. nl80211_send_mgmt_stypes(struct sk_buff *msg,
  927. const struct ieee80211_txrx_stypes *mgmt_stypes)
  928. {
  929. u16 stypes;
  930. struct nlattr *nl_ftypes, *nl_ifs;
  931. enum nl80211_iftype ift;
  932. int i;
  933. if (!mgmt_stypes)
  934. return 0;
  935. nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
  936. if (!nl_ifs)
  937. return -ENOBUFS;
  938. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  939. nl_ftypes = nla_nest_start(msg, ift);
  940. if (!nl_ftypes)
  941. return -ENOBUFS;
  942. i = 0;
  943. stypes = mgmt_stypes[ift].tx;
  944. while (stypes) {
  945. if ((stypes & 1) &&
  946. nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
  947. (i << 4) | IEEE80211_FTYPE_MGMT))
  948. return -ENOBUFS;
  949. stypes >>= 1;
  950. i++;
  951. }
  952. nla_nest_end(msg, nl_ftypes);
  953. }
  954. nla_nest_end(msg, nl_ifs);
  955. nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
  956. if (!nl_ifs)
  957. return -ENOBUFS;
  958. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  959. nl_ftypes = nla_nest_start(msg, ift);
  960. if (!nl_ftypes)
  961. return -ENOBUFS;
  962. i = 0;
  963. stypes = mgmt_stypes[ift].rx;
  964. while (stypes) {
  965. if ((stypes & 1) &&
  966. nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
  967. (i << 4) | IEEE80211_FTYPE_MGMT))
  968. return -ENOBUFS;
  969. stypes >>= 1;
  970. i++;
  971. }
  972. nla_nest_end(msg, nl_ftypes);
  973. }
  974. nla_nest_end(msg, nl_ifs);
  975. return 0;
  976. }
  977. static int nl80211_send_wiphy(struct cfg80211_registered_device *dev,
  978. struct sk_buff *msg, u32 portid, u32 seq,
  979. int flags, bool split, long *split_start,
  980. long *band_start, long *chan_start)
  981. {
  982. void *hdr;
  983. struct nlattr *nl_bands, *nl_band;
  984. struct nlattr *nl_freqs, *nl_freq;
  985. struct nlattr *nl_cmds;
  986. enum ieee80211_band band;
  987. struct ieee80211_channel *chan;
  988. int i;
  989. const struct ieee80211_txrx_stypes *mgmt_stypes =
  990. dev->wiphy.mgmt_stypes;
  991. long start = 0, start_chan = 0, start_band = 0;
  992. u32 features;
  993. hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_WIPHY);
  994. if (!hdr)
  995. return -ENOBUFS;
  996. /* allow always using the variables */
  997. if (!split) {
  998. split_start = &start;
  999. band_start = &start_band;
  1000. chan_start = &start_chan;
  1001. }
  1002. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, dev->wiphy_idx) ||
  1003. nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
  1004. wiphy_name(&dev->wiphy)) ||
  1005. nla_put_u32(msg, NL80211_ATTR_GENERATION,
  1006. cfg80211_rdev_list_generation))
  1007. goto nla_put_failure;
  1008. switch (*split_start) {
  1009. case 0:
  1010. if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
  1011. dev->wiphy.retry_short) ||
  1012. nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
  1013. dev->wiphy.retry_long) ||
  1014. nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
  1015. dev->wiphy.frag_threshold) ||
  1016. nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
  1017. dev->wiphy.rts_threshold) ||
  1018. nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
  1019. dev->wiphy.coverage_class) ||
  1020. nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
  1021. dev->wiphy.max_scan_ssids) ||
  1022. nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
  1023. dev->wiphy.max_sched_scan_ssids) ||
  1024. nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
  1025. dev->wiphy.max_scan_ie_len) ||
  1026. nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
  1027. dev->wiphy.max_sched_scan_ie_len) ||
  1028. nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
  1029. dev->wiphy.max_match_sets))
  1030. goto nla_put_failure;
  1031. if ((dev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
  1032. nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
  1033. goto nla_put_failure;
  1034. if ((dev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
  1035. nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
  1036. goto nla_put_failure;
  1037. if ((dev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
  1038. nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
  1039. goto nla_put_failure;
  1040. if ((dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
  1041. nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
  1042. goto nla_put_failure;
  1043. if ((dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
  1044. nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
  1045. goto nla_put_failure;
  1046. if ((dev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
  1047. nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
  1048. goto nla_put_failure;
  1049. (*split_start)++;
  1050. if (split)
  1051. break;
  1052. case 1:
  1053. if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
  1054. sizeof(u32) * dev->wiphy.n_cipher_suites,
  1055. dev->wiphy.cipher_suites))
  1056. goto nla_put_failure;
  1057. if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
  1058. dev->wiphy.max_num_pmkids))
  1059. goto nla_put_failure;
  1060. if ((dev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  1061. nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
  1062. goto nla_put_failure;
  1063. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
  1064. dev->wiphy.available_antennas_tx) ||
  1065. nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
  1066. dev->wiphy.available_antennas_rx))
  1067. goto nla_put_failure;
  1068. if ((dev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
  1069. nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
  1070. dev->wiphy.probe_resp_offload))
  1071. goto nla_put_failure;
  1072. if ((dev->wiphy.available_antennas_tx ||
  1073. dev->wiphy.available_antennas_rx) &&
  1074. dev->ops->get_antenna) {
  1075. u32 tx_ant = 0, rx_ant = 0;
  1076. int res;
  1077. res = rdev_get_antenna(dev, &tx_ant, &rx_ant);
  1078. if (!res) {
  1079. if (nla_put_u32(msg,
  1080. NL80211_ATTR_WIPHY_ANTENNA_TX,
  1081. tx_ant) ||
  1082. nla_put_u32(msg,
  1083. NL80211_ATTR_WIPHY_ANTENNA_RX,
  1084. rx_ant))
  1085. goto nla_put_failure;
  1086. }
  1087. }
  1088. (*split_start)++;
  1089. if (split)
  1090. break;
  1091. case 2:
  1092. if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
  1093. dev->wiphy.interface_modes))
  1094. goto nla_put_failure;
  1095. (*split_start)++;
  1096. if (split)
  1097. break;
  1098. case 3:
  1099. nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
  1100. if (!nl_bands)
  1101. goto nla_put_failure;
  1102. for (band = *band_start; band < IEEE80211_NUM_BANDS; band++) {
  1103. struct ieee80211_supported_band *sband;
  1104. sband = dev->wiphy.bands[band];
  1105. if (!sband)
  1106. continue;
  1107. nl_band = nla_nest_start(msg, band);
  1108. if (!nl_band)
  1109. goto nla_put_failure;
  1110. switch (*chan_start) {
  1111. case 0:
  1112. if (nl80211_send_band_rateinfo(msg, sband))
  1113. goto nla_put_failure;
  1114. (*chan_start)++;
  1115. if (split)
  1116. break;
  1117. default:
  1118. /* add frequencies */
  1119. nl_freqs = nla_nest_start(
  1120. msg, NL80211_BAND_ATTR_FREQS);
  1121. if (!nl_freqs)
  1122. goto nla_put_failure;
  1123. for (i = *chan_start - 1;
  1124. i < sband->n_channels;
  1125. i++) {
  1126. nl_freq = nla_nest_start(msg, i);
  1127. if (!nl_freq)
  1128. goto nla_put_failure;
  1129. chan = &sband->channels[i];
  1130. if (nl80211_msg_put_channel(msg, chan,
  1131. split))
  1132. goto nla_put_failure;
  1133. nla_nest_end(msg, nl_freq);
  1134. if (split)
  1135. break;
  1136. }
  1137. if (i < sband->n_channels)
  1138. *chan_start = i + 2;
  1139. else
  1140. *chan_start = 0;
  1141. nla_nest_end(msg, nl_freqs);
  1142. }
  1143. nla_nest_end(msg, nl_band);
  1144. if (split) {
  1145. /* start again here */
  1146. if (*chan_start)
  1147. band--;
  1148. break;
  1149. }
  1150. }
  1151. nla_nest_end(msg, nl_bands);
  1152. if (band < IEEE80211_NUM_BANDS)
  1153. *band_start = band + 1;
  1154. else
  1155. *band_start = 0;
  1156. /* if bands & channels are done, continue outside */
  1157. if (*band_start == 0 && *chan_start == 0)
  1158. (*split_start)++;
  1159. if (split)
  1160. break;
  1161. case 4:
  1162. nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
  1163. if (!nl_cmds)
  1164. goto nla_put_failure;
  1165. i = 0;
  1166. #define CMD(op, n) \
  1167. do { \
  1168. if (dev->ops->op) { \
  1169. i++; \
  1170. if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
  1171. goto nla_put_failure; \
  1172. } \
  1173. } while (0)
  1174. CMD(add_virtual_intf, NEW_INTERFACE);
  1175. CMD(change_virtual_intf, SET_INTERFACE);
  1176. CMD(add_key, NEW_KEY);
  1177. CMD(start_ap, START_AP);
  1178. CMD(add_station, NEW_STATION);
  1179. CMD(add_mpath, NEW_MPATH);
  1180. CMD(update_mesh_config, SET_MESH_CONFIG);
  1181. CMD(change_bss, SET_BSS);
  1182. CMD(auth, AUTHENTICATE);
  1183. CMD(assoc, ASSOCIATE);
  1184. CMD(deauth, DEAUTHENTICATE);
  1185. CMD(disassoc, DISASSOCIATE);
  1186. CMD(join_ibss, JOIN_IBSS);
  1187. CMD(join_mesh, JOIN_MESH);
  1188. CMD(set_pmksa, SET_PMKSA);
  1189. CMD(del_pmksa, DEL_PMKSA);
  1190. CMD(flush_pmksa, FLUSH_PMKSA);
  1191. if (dev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
  1192. CMD(remain_on_channel, REMAIN_ON_CHANNEL);
  1193. CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
  1194. CMD(mgmt_tx, FRAME);
  1195. CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
  1196. if (dev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
  1197. i++;
  1198. if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
  1199. goto nla_put_failure;
  1200. }
  1201. if (dev->ops->set_monitor_channel || dev->ops->start_ap ||
  1202. dev->ops->join_mesh) {
  1203. i++;
  1204. if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
  1205. goto nla_put_failure;
  1206. }
  1207. CMD(set_wds_peer, SET_WDS_PEER);
  1208. if (dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
  1209. CMD(tdls_mgmt, TDLS_MGMT);
  1210. CMD(tdls_oper, TDLS_OPER);
  1211. }
  1212. if (dev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN)
  1213. CMD(sched_scan_start, START_SCHED_SCAN);
  1214. CMD(probe_client, PROBE_CLIENT);
  1215. CMD(set_noack_map, SET_NOACK_MAP);
  1216. if (dev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
  1217. i++;
  1218. if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
  1219. goto nla_put_failure;
  1220. }
  1221. CMD(start_p2p_device, START_P2P_DEVICE);
  1222. CMD(set_mcast_rate, SET_MCAST_RATE);
  1223. if (split) {
  1224. CMD(crit_proto_start, CRIT_PROTOCOL_START);
  1225. CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
  1226. }
  1227. #ifdef CONFIG_NL80211_TESTMODE
  1228. CMD(testmode_cmd, TESTMODE);
  1229. #endif
  1230. #undef CMD
  1231. if (dev->ops->connect || dev->ops->auth) {
  1232. i++;
  1233. if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
  1234. goto nla_put_failure;
  1235. }
  1236. if (dev->ops->disconnect || dev->ops->deauth) {
  1237. i++;
  1238. if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
  1239. goto nla_put_failure;
  1240. }
  1241. nla_nest_end(msg, nl_cmds);
  1242. (*split_start)++;
  1243. if (split)
  1244. break;
  1245. case 5:
  1246. if (dev->ops->remain_on_channel &&
  1247. (dev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
  1248. nla_put_u32(msg,
  1249. NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
  1250. dev->wiphy.max_remain_on_channel_duration))
  1251. goto nla_put_failure;
  1252. if ((dev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
  1253. nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
  1254. goto nla_put_failure;
  1255. if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
  1256. goto nla_put_failure;
  1257. (*split_start)++;
  1258. if (split)
  1259. break;
  1260. case 6:
  1261. #ifdef CONFIG_PM
  1262. if (nl80211_send_wowlan(msg, dev, split))
  1263. goto nla_put_failure;
  1264. (*split_start)++;
  1265. if (split)
  1266. break;
  1267. #else
  1268. (*split_start)++;
  1269. #endif
  1270. case 7:
  1271. if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
  1272. dev->wiphy.software_iftypes))
  1273. goto nla_put_failure;
  1274. if (nl80211_put_iface_combinations(&dev->wiphy, msg, split))
  1275. goto nla_put_failure;
  1276. (*split_start)++;
  1277. if (split)
  1278. break;
  1279. case 8:
  1280. if ((dev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
  1281. nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
  1282. dev->wiphy.ap_sme_capa))
  1283. goto nla_put_failure;
  1284. features = dev->wiphy.features;
  1285. /*
  1286. * We can only add the per-channel limit information if the
  1287. * dump is split, otherwise it makes it too big. Therefore
  1288. * only advertise it in that case.
  1289. */
  1290. if (split)
  1291. features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
  1292. if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
  1293. goto nla_put_failure;
  1294. if (dev->wiphy.ht_capa_mod_mask &&
  1295. nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
  1296. sizeof(*dev->wiphy.ht_capa_mod_mask),
  1297. dev->wiphy.ht_capa_mod_mask))
  1298. goto nla_put_failure;
  1299. if (dev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
  1300. dev->wiphy.max_acl_mac_addrs &&
  1301. nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
  1302. dev->wiphy.max_acl_mac_addrs))
  1303. goto nla_put_failure;
  1304. /*
  1305. * Any information below this point is only available to
  1306. * applications that can deal with it being split. This
  1307. * helps ensure that newly added capabilities don't break
  1308. * older tools by overrunning their buffers.
  1309. *
  1310. * We still increment split_start so that in the split
  1311. * case we'll continue with more data in the next round,
  1312. * but break unconditionally so unsplit data stops here.
  1313. */
  1314. (*split_start)++;
  1315. break;
  1316. case 9:
  1317. if (dev->wiphy.extended_capabilities &&
  1318. (nla_put(msg, NL80211_ATTR_EXT_CAPA,
  1319. dev->wiphy.extended_capabilities_len,
  1320. dev->wiphy.extended_capabilities) ||
  1321. nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
  1322. dev->wiphy.extended_capabilities_len,
  1323. dev->wiphy.extended_capabilities_mask)))
  1324. goto nla_put_failure;
  1325. if (dev->wiphy.vht_capa_mod_mask &&
  1326. nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
  1327. sizeof(*dev->wiphy.vht_capa_mod_mask),
  1328. dev->wiphy.vht_capa_mod_mask))
  1329. goto nla_put_failure;
  1330. /* done */
  1331. *split_start = 0;
  1332. break;
  1333. }
  1334. return genlmsg_end(msg, hdr);
  1335. nla_put_failure:
  1336. genlmsg_cancel(msg, hdr);
  1337. return -EMSGSIZE;
  1338. }
  1339. static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
  1340. {
  1341. int idx = 0, ret;
  1342. int start = cb->args[0];
  1343. struct cfg80211_registered_device *dev;
  1344. s64 filter_wiphy = -1;
  1345. bool split = false;
  1346. struct nlattr **tb;
  1347. int res;
  1348. /* will be zeroed in nlmsg_parse() */
  1349. tb = kmalloc(sizeof(*tb) * (NL80211_ATTR_MAX + 1), GFP_KERNEL);
  1350. if (!tb)
  1351. return -ENOMEM;
  1352. mutex_lock(&cfg80211_mutex);
  1353. res = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
  1354. tb, NL80211_ATTR_MAX, nl80211_policy);
  1355. if (res == 0) {
  1356. split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
  1357. if (tb[NL80211_ATTR_WIPHY])
  1358. filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
  1359. if (tb[NL80211_ATTR_WDEV])
  1360. filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
  1361. if (tb[NL80211_ATTR_IFINDEX]) {
  1362. struct net_device *netdev;
  1363. int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
  1364. netdev = dev_get_by_index(sock_net(skb->sk), ifidx);
  1365. if (!netdev) {
  1366. mutex_unlock(&cfg80211_mutex);
  1367. kfree(tb);
  1368. return -ENODEV;
  1369. }
  1370. if (netdev->ieee80211_ptr) {
  1371. dev = wiphy_to_dev(
  1372. netdev->ieee80211_ptr->wiphy);
  1373. filter_wiphy = dev->wiphy_idx;
  1374. }
  1375. dev_put(netdev);
  1376. }
  1377. }
  1378. kfree(tb);
  1379. list_for_each_entry(dev, &cfg80211_rdev_list, list) {
  1380. if (!net_eq(wiphy_net(&dev->wiphy), sock_net(skb->sk)))
  1381. continue;
  1382. if (++idx <= start)
  1383. continue;
  1384. if (filter_wiphy != -1 && dev->wiphy_idx != filter_wiphy)
  1385. continue;
  1386. /* attempt to fit multiple wiphy data chunks into the skb */
  1387. do {
  1388. ret = nl80211_send_wiphy(dev, skb,
  1389. NETLINK_CB(cb->skb).portid,
  1390. cb->nlh->nlmsg_seq,
  1391. NLM_F_MULTI,
  1392. split, &cb->args[1],
  1393. &cb->args[2],
  1394. &cb->args[3]);
  1395. if (ret < 0) {
  1396. /*
  1397. * If sending the wiphy data didn't fit (ENOBUFS
  1398. * or EMSGSIZE returned), this SKB is still
  1399. * empty (so it's not too big because another
  1400. * wiphy dataset is already in the skb) and
  1401. * we've not tried to adjust the dump allocation
  1402. * yet ... then adjust the alloc size to be
  1403. * bigger, and return 1 but with the empty skb.
  1404. * This results in an empty message being RX'ed
  1405. * in userspace, but that is ignored.
  1406. *
  1407. * We can then retry with the larger buffer.
  1408. */
  1409. if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
  1410. !skb->len &&
  1411. cb->min_dump_alloc < 4096) {
  1412. cb->min_dump_alloc = 4096;
  1413. mutex_unlock(&cfg80211_mutex);
  1414. return 1;
  1415. }
  1416. idx--;
  1417. break;
  1418. }
  1419. } while (cb->args[1] > 0);
  1420. break;
  1421. }
  1422. mutex_unlock(&cfg80211_mutex);
  1423. cb->args[0] = idx;
  1424. return skb->len;
  1425. }
  1426. static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
  1427. {
  1428. struct sk_buff *msg;
  1429. struct cfg80211_registered_device *dev = info->user_ptr[0];
  1430. msg = nlmsg_new(4096, GFP_KERNEL);
  1431. if (!msg)
  1432. return -ENOMEM;
  1433. if (nl80211_send_wiphy(dev, msg, info->snd_portid, info->snd_seq, 0,
  1434. false, NULL, NULL, NULL) < 0) {
  1435. nlmsg_free(msg);
  1436. return -ENOBUFS;
  1437. }
  1438. return genlmsg_reply(msg, info);
  1439. }
  1440. static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
  1441. [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
  1442. [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
  1443. [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
  1444. [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
  1445. [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
  1446. };
  1447. static int parse_txq_params(struct nlattr *tb[],
  1448. struct ieee80211_txq_params *txq_params)
  1449. {
  1450. if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
  1451. !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
  1452. !tb[NL80211_TXQ_ATTR_AIFS])
  1453. return -EINVAL;
  1454. txq_params->ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
  1455. txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
  1456. txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
  1457. txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
  1458. txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
  1459. if (txq_params->ac >= NL80211_NUM_ACS)
  1460. return -EINVAL;
  1461. return 0;
  1462. }
  1463. static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
  1464. {
  1465. /*
  1466. * You can only set the channel explicitly for WDS interfaces,
  1467. * all others have their channel managed via their respective
  1468. * "establish a connection" command (connect, join, ...)
  1469. *
  1470. * For AP/GO and mesh mode, the channel can be set with the
  1471. * channel userspace API, but is only stored and passed to the
  1472. * low-level driver when the AP starts or the mesh is joined.
  1473. * This is for backward compatibility, userspace can also give
  1474. * the channel in the start-ap or join-mesh commands instead.
  1475. *
  1476. * Monitors are special as they are normally slaved to
  1477. * whatever else is going on, so they have their own special
  1478. * operation to set the monitor channel if possible.
  1479. */
  1480. return !wdev ||
  1481. wdev->iftype == NL80211_IFTYPE_AP ||
  1482. wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
  1483. wdev->iftype == NL80211_IFTYPE_MONITOR ||
  1484. wdev->iftype == NL80211_IFTYPE_P2P_GO;
  1485. }
  1486. static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
  1487. struct genl_info *info,
  1488. struct cfg80211_chan_def *chandef)
  1489. {
  1490. u32 control_freq;
  1491. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  1492. return -EINVAL;
  1493. control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
  1494. chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
  1495. chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
  1496. chandef->center_freq1 = control_freq;
  1497. chandef->center_freq2 = 0;
  1498. /* Primary channel not allowed */
  1499. if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
  1500. return -EINVAL;
  1501. if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
  1502. enum nl80211_channel_type chantype;
  1503. chantype = nla_get_u32(
  1504. info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
  1505. switch (chantype) {
  1506. case NL80211_CHAN_NO_HT:
  1507. case NL80211_CHAN_HT20:
  1508. case NL80211_CHAN_HT40PLUS:
  1509. case NL80211_CHAN_HT40MINUS:
  1510. cfg80211_chandef_create(chandef, chandef->chan,
  1511. chantype);
  1512. break;
  1513. default:
  1514. return -EINVAL;
  1515. }
  1516. } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
  1517. chandef->width =
  1518. nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
  1519. if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
  1520. chandef->center_freq1 =
  1521. nla_get_u32(
  1522. info->attrs[NL80211_ATTR_CENTER_FREQ1]);
  1523. if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
  1524. chandef->center_freq2 =
  1525. nla_get_u32(
  1526. info->attrs[NL80211_ATTR_CENTER_FREQ2]);
  1527. }
  1528. if (!cfg80211_chandef_valid(chandef))
  1529. return -EINVAL;
  1530. if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
  1531. IEEE80211_CHAN_DISABLED))
  1532. return -EINVAL;
  1533. return 0;
  1534. }
  1535. static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
  1536. struct wireless_dev *wdev,
  1537. struct genl_info *info)
  1538. {
  1539. struct cfg80211_chan_def chandef;
  1540. int result;
  1541. enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
  1542. if (wdev)
  1543. iftype = wdev->iftype;
  1544. if (!nl80211_can_set_dev_channel(wdev))
  1545. return -EOPNOTSUPP;
  1546. result = nl80211_parse_chandef(rdev, info, &chandef);
  1547. if (result)
  1548. return result;
  1549. mutex_lock(&rdev->devlist_mtx);
  1550. switch (iftype) {
  1551. case NL80211_IFTYPE_AP:
  1552. case NL80211_IFTYPE_P2P_GO:
  1553. if (wdev->beacon_interval) {
  1554. result = -EBUSY;
  1555. break;
  1556. }
  1557. if (!cfg80211_reg_can_beacon(&rdev->wiphy, &chandef)) {
  1558. result = -EINVAL;
  1559. break;
  1560. }
  1561. wdev->preset_chandef = chandef;
  1562. result = 0;
  1563. break;
  1564. case NL80211_IFTYPE_MESH_POINT:
  1565. result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
  1566. break;
  1567. case NL80211_IFTYPE_MONITOR:
  1568. result = cfg80211_set_monitor_channel(rdev, &chandef);
  1569. break;
  1570. default:
  1571. result = -EINVAL;
  1572. }
  1573. mutex_unlock(&rdev->devlist_mtx);
  1574. return result;
  1575. }
  1576. static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
  1577. {
  1578. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1579. struct net_device *netdev = info->user_ptr[1];
  1580. return __nl80211_set_channel(rdev, netdev->ieee80211_ptr, info);
  1581. }
  1582. static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
  1583. {
  1584. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1585. struct net_device *dev = info->user_ptr[1];
  1586. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1587. const u8 *bssid;
  1588. if (!info->attrs[NL80211_ATTR_MAC])
  1589. return -EINVAL;
  1590. if (netif_running(dev))
  1591. return -EBUSY;
  1592. if (!rdev->ops->set_wds_peer)
  1593. return -EOPNOTSUPP;
  1594. if (wdev->iftype != NL80211_IFTYPE_WDS)
  1595. return -EOPNOTSUPP;
  1596. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  1597. return rdev_set_wds_peer(rdev, dev, bssid);
  1598. }
  1599. static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
  1600. {
  1601. struct cfg80211_registered_device *rdev;
  1602. struct net_device *netdev = NULL;
  1603. struct wireless_dev *wdev;
  1604. int result = 0, rem_txq_params = 0;
  1605. struct nlattr *nl_txq_params;
  1606. u32 changed;
  1607. u8 retry_short = 0, retry_long = 0;
  1608. u32 frag_threshold = 0, rts_threshold = 0;
  1609. u8 coverage_class = 0;
  1610. /*
  1611. * Try to find the wiphy and netdev. Normally this
  1612. * function shouldn't need the netdev, but this is
  1613. * done for backward compatibility -- previously
  1614. * setting the channel was done per wiphy, but now
  1615. * it is per netdev. Previous userland like hostapd
  1616. * also passed a netdev to set_wiphy, so that it is
  1617. * possible to let that go to the right netdev!
  1618. */
  1619. mutex_lock(&cfg80211_mutex);
  1620. if (info->attrs[NL80211_ATTR_IFINDEX]) {
  1621. int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
  1622. netdev = dev_get_by_index(genl_info_net(info), ifindex);
  1623. if (netdev && netdev->ieee80211_ptr) {
  1624. rdev = wiphy_to_dev(netdev->ieee80211_ptr->wiphy);
  1625. mutex_lock(&rdev->mtx);
  1626. } else
  1627. netdev = NULL;
  1628. }
  1629. if (!netdev) {
  1630. rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
  1631. info->attrs);
  1632. if (IS_ERR(rdev)) {
  1633. mutex_unlock(&cfg80211_mutex);
  1634. return PTR_ERR(rdev);
  1635. }
  1636. wdev = NULL;
  1637. netdev = NULL;
  1638. result = 0;
  1639. mutex_lock(&rdev->mtx);
  1640. } else
  1641. wdev = netdev->ieee80211_ptr;
  1642. /*
  1643. * end workaround code, by now the rdev is available
  1644. * and locked, and wdev may or may not be NULL.
  1645. */
  1646. if (info->attrs[NL80211_ATTR_WIPHY_NAME])
  1647. result = cfg80211_dev_rename(
  1648. rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
  1649. mutex_unlock(&cfg80211_mutex);
  1650. if (result)
  1651. goto bad_res;
  1652. if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
  1653. struct ieee80211_txq_params txq_params;
  1654. struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
  1655. if (!rdev->ops->set_txq_params) {
  1656. result = -EOPNOTSUPP;
  1657. goto bad_res;
  1658. }
  1659. if (!netdev) {
  1660. result = -EINVAL;
  1661. goto bad_res;
  1662. }
  1663. if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  1664. netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  1665. result = -EINVAL;
  1666. goto bad_res;
  1667. }
  1668. if (!netif_running(netdev)) {
  1669. result = -ENETDOWN;
  1670. goto bad_res;
  1671. }
  1672. nla_for_each_nested(nl_txq_params,
  1673. info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
  1674. rem_txq_params) {
  1675. nla_parse(tb, NL80211_TXQ_ATTR_MAX,
  1676. nla_data(nl_txq_params),
  1677. nla_len(nl_txq_params),
  1678. txq_params_policy);
  1679. result = parse_txq_params(tb, &txq_params);
  1680. if (result)
  1681. goto bad_res;
  1682. result = rdev_set_txq_params(rdev, netdev,
  1683. &txq_params);
  1684. if (result)
  1685. goto bad_res;
  1686. }
  1687. }
  1688. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  1689. result = __nl80211_set_channel(rdev,
  1690. nl80211_can_set_dev_channel(wdev) ? wdev : NULL,
  1691. info);
  1692. if (result)
  1693. goto bad_res;
  1694. }
  1695. if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
  1696. struct wireless_dev *txp_wdev = wdev;
  1697. enum nl80211_tx_power_setting type;
  1698. int idx, mbm = 0;
  1699. if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
  1700. txp_wdev = NULL;
  1701. if (!rdev->ops->set_tx_power) {
  1702. result = -EOPNOTSUPP;
  1703. goto bad_res;
  1704. }
  1705. idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
  1706. type = nla_get_u32(info->attrs[idx]);
  1707. if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
  1708. (type != NL80211_TX_POWER_AUTOMATIC)) {
  1709. result = -EINVAL;
  1710. goto bad_res;
  1711. }
  1712. if (type != NL80211_TX_POWER_AUTOMATIC) {
  1713. idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
  1714. mbm = nla_get_u32(info->attrs[idx]);
  1715. }
  1716. result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
  1717. if (result)
  1718. goto bad_res;
  1719. }
  1720. if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
  1721. info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
  1722. u32 tx_ant, rx_ant;
  1723. if ((!rdev->wiphy.available_antennas_tx &&
  1724. !rdev->wiphy.available_antennas_rx) ||
  1725. !rdev->ops->set_antenna) {
  1726. result = -EOPNOTSUPP;
  1727. goto bad_res;
  1728. }
  1729. tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
  1730. rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
  1731. /* reject antenna configurations which don't match the
  1732. * available antenna masks, except for the "all" mask */
  1733. if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
  1734. (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) {
  1735. result = -EINVAL;
  1736. goto bad_res;
  1737. }
  1738. tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
  1739. rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
  1740. result = rdev_set_antenna(rdev, tx_ant, rx_ant);
  1741. if (result)
  1742. goto bad_res;
  1743. }
  1744. changed = 0;
  1745. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
  1746. retry_short = nla_get_u8(
  1747. info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
  1748. if (retry_short == 0) {
  1749. result = -EINVAL;
  1750. goto bad_res;
  1751. }
  1752. changed |= WIPHY_PARAM_RETRY_SHORT;
  1753. }
  1754. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
  1755. retry_long = nla_get_u8(
  1756. info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
  1757. if (retry_long == 0) {
  1758. result = -EINVAL;
  1759. goto bad_res;
  1760. }
  1761. changed |= WIPHY_PARAM_RETRY_LONG;
  1762. }
  1763. if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
  1764. frag_threshold = nla_get_u32(
  1765. info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
  1766. if (frag_threshold < 256) {
  1767. result = -EINVAL;
  1768. goto bad_res;
  1769. }
  1770. if (frag_threshold != (u32) -1) {
  1771. /*
  1772. * Fragments (apart from the last one) are required to
  1773. * have even length. Make the fragmentation code
  1774. * simpler by stripping LSB should someone try to use
  1775. * odd threshold value.
  1776. */
  1777. frag_threshold &= ~0x1;
  1778. }
  1779. changed |= WIPHY_PARAM_FRAG_THRESHOLD;
  1780. }
  1781. if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
  1782. rts_threshold = nla_get_u32(
  1783. info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
  1784. changed |= WIPHY_PARAM_RTS_THRESHOLD;
  1785. }
  1786. if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
  1787. coverage_class = nla_get_u8(
  1788. info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
  1789. changed |= WIPHY_PARAM_COVERAGE_CLASS;
  1790. }
  1791. if (changed) {
  1792. u8 old_retry_short, old_retry_long;
  1793. u32 old_frag_threshold, old_rts_threshold;
  1794. u8 old_coverage_class;
  1795. if (!rdev->ops->set_wiphy_params) {
  1796. result = -EOPNOTSUPP;
  1797. goto bad_res;
  1798. }
  1799. old_retry_short = rdev->wiphy.retry_short;
  1800. old_retry_long = rdev->wiphy.retry_long;
  1801. old_frag_threshold = rdev->wiphy.frag_threshold;
  1802. old_rts_threshold = rdev->wiphy.rts_threshold;
  1803. old_coverage_class = rdev->wiphy.coverage_class;
  1804. if (changed & WIPHY_PARAM_RETRY_SHORT)
  1805. rdev->wiphy.retry_short = retry_short;
  1806. if (changed & WIPHY_PARAM_RETRY_LONG)
  1807. rdev->wiphy.retry_long = retry_long;
  1808. if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
  1809. rdev->wiphy.frag_threshold = frag_threshold;
  1810. if (changed & WIPHY_PARAM_RTS_THRESHOLD)
  1811. rdev->wiphy.rts_threshold = rts_threshold;
  1812. if (changed & WIPHY_PARAM_COVERAGE_CLASS)
  1813. rdev->wiphy.coverage_class = coverage_class;
  1814. result = rdev_set_wiphy_params(rdev, changed);
  1815. if (result) {
  1816. rdev->wiphy.retry_short = old_retry_short;
  1817. rdev->wiphy.retry_long = old_retry_long;
  1818. rdev->wiphy.frag_threshold = old_frag_threshold;
  1819. rdev->wiphy.rts_threshold = old_rts_threshold;
  1820. rdev->wiphy.coverage_class = old_coverage_class;
  1821. }
  1822. }
  1823. bad_res:
  1824. mutex_unlock(&rdev->mtx);
  1825. if (netdev)
  1826. dev_put(netdev);
  1827. return result;
  1828. }
  1829. static inline u64 wdev_id(struct wireless_dev *wdev)
  1830. {
  1831. return (u64)wdev->identifier |
  1832. ((u64)wiphy_to_dev(wdev->wiphy)->wiphy_idx << 32);
  1833. }
  1834. static int nl80211_send_chandef(struct sk_buff *msg,
  1835. struct cfg80211_chan_def *chandef)
  1836. {
  1837. WARN_ON(!cfg80211_chandef_valid(chandef));
  1838. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
  1839. chandef->chan->center_freq))
  1840. return -ENOBUFS;
  1841. switch (chandef->width) {
  1842. case NL80211_CHAN_WIDTH_20_NOHT:
  1843. case NL80211_CHAN_WIDTH_20:
  1844. case NL80211_CHAN_WIDTH_40:
  1845. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
  1846. cfg80211_get_chandef_type(chandef)))
  1847. return -ENOBUFS;
  1848. break;
  1849. default:
  1850. break;
  1851. }
  1852. if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
  1853. return -ENOBUFS;
  1854. if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
  1855. return -ENOBUFS;
  1856. if (chandef->center_freq2 &&
  1857. nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
  1858. return -ENOBUFS;
  1859. return 0;
  1860. }
  1861. static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
  1862. struct cfg80211_registered_device *rdev,
  1863. struct wireless_dev *wdev)
  1864. {
  1865. struct net_device *dev = wdev->netdev;
  1866. void *hdr;
  1867. hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_INTERFACE);
  1868. if (!hdr)
  1869. return -1;
  1870. if (dev &&
  1871. (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  1872. nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
  1873. goto nla_put_failure;
  1874. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  1875. nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
  1876. nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)) ||
  1877. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
  1878. nla_put_u32(msg, NL80211_ATTR_GENERATION,
  1879. rdev->devlist_generation ^
  1880. (cfg80211_rdev_list_generation << 2)))
  1881. goto nla_put_failure;
  1882. if (rdev->ops->get_channel) {
  1883. int ret;
  1884. struct cfg80211_chan_def chandef;
  1885. ret = rdev_get_channel(rdev, wdev, &chandef);
  1886. if (ret == 0) {
  1887. if (nl80211_send_chandef(msg, &chandef))
  1888. goto nla_put_failure;
  1889. }
  1890. }
  1891. if (wdev->ssid_len) {
  1892. if (nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
  1893. goto nla_put_failure;
  1894. }
  1895. return genlmsg_end(msg, hdr);
  1896. nla_put_failure:
  1897. genlmsg_cancel(msg, hdr);
  1898. return -EMSGSIZE;
  1899. }
  1900. static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
  1901. {
  1902. int wp_idx = 0;
  1903. int if_idx = 0;
  1904. int wp_start = cb->args[0];
  1905. int if_start = cb->args[1];
  1906. struct cfg80211_registered_device *rdev;
  1907. struct wireless_dev *wdev;
  1908. mutex_lock(&cfg80211_mutex);
  1909. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  1910. if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
  1911. continue;
  1912. if (wp_idx < wp_start) {
  1913. wp_idx++;
  1914. continue;
  1915. }
  1916. if_idx = 0;
  1917. mutex_lock(&rdev->devlist_mtx);
  1918. list_for_each_entry(wdev, &rdev->wdev_list, list) {
  1919. if (if_idx < if_start) {
  1920. if_idx++;
  1921. continue;
  1922. }
  1923. if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
  1924. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  1925. rdev, wdev) < 0) {
  1926. mutex_unlock(&rdev->devlist_mtx);
  1927. goto out;
  1928. }
  1929. if_idx++;
  1930. }
  1931. mutex_unlock(&rdev->devlist_mtx);
  1932. wp_idx++;
  1933. }
  1934. out:
  1935. mutex_unlock(&cfg80211_mutex);
  1936. cb->args[0] = wp_idx;
  1937. cb->args[1] = if_idx;
  1938. return skb->len;
  1939. }
  1940. static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
  1941. {
  1942. struct sk_buff *msg;
  1943. struct cfg80211_registered_device *dev = info->user_ptr[0];
  1944. struct wireless_dev *wdev = info->user_ptr[1];
  1945. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  1946. if (!msg)
  1947. return -ENOMEM;
  1948. if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  1949. dev, wdev) < 0) {
  1950. nlmsg_free(msg);
  1951. return -ENOBUFS;
  1952. }
  1953. return genlmsg_reply(msg, info);
  1954. }
  1955. static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
  1956. [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
  1957. [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
  1958. [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
  1959. [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
  1960. [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
  1961. };
  1962. static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
  1963. {
  1964. struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
  1965. int flag;
  1966. *mntrflags = 0;
  1967. if (!nla)
  1968. return -EINVAL;
  1969. if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX,
  1970. nla, mntr_flags_policy))
  1971. return -EINVAL;
  1972. for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
  1973. if (flags[flag])
  1974. *mntrflags |= (1<<flag);
  1975. return 0;
  1976. }
  1977. static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
  1978. struct net_device *netdev, u8 use_4addr,
  1979. enum nl80211_iftype iftype)
  1980. {
  1981. if (!use_4addr) {
  1982. if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
  1983. return -EBUSY;
  1984. return 0;
  1985. }
  1986. switch (iftype) {
  1987. case NL80211_IFTYPE_AP_VLAN:
  1988. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
  1989. return 0;
  1990. break;
  1991. case NL80211_IFTYPE_STATION:
  1992. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
  1993. return 0;
  1994. break;
  1995. default:
  1996. break;
  1997. }
  1998. return -EOPNOTSUPP;
  1999. }
  2000. static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
  2001. {
  2002. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2003. struct vif_params params;
  2004. int err;
  2005. enum nl80211_iftype otype, ntype;
  2006. struct net_device *dev = info->user_ptr[1];
  2007. u32 _flags, *flags = NULL;
  2008. bool change = false;
  2009. memset(&params, 0, sizeof(params));
  2010. otype = ntype = dev->ieee80211_ptr->iftype;
  2011. if (info->attrs[NL80211_ATTR_IFTYPE]) {
  2012. ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  2013. if (otype != ntype)
  2014. change = true;
  2015. if (ntype > NL80211_IFTYPE_MAX)
  2016. return -EINVAL;
  2017. }
  2018. if (info->attrs[NL80211_ATTR_MESH_ID]) {
  2019. struct wireless_dev *wdev = dev->ieee80211_ptr;
  2020. if (ntype != NL80211_IFTYPE_MESH_POINT)
  2021. return -EINVAL;
  2022. if (netif_running(dev))
  2023. return -EBUSY;
  2024. wdev_lock(wdev);
  2025. BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
  2026. IEEE80211_MAX_MESH_ID_LEN);
  2027. wdev->mesh_id_up_len =
  2028. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  2029. memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  2030. wdev->mesh_id_up_len);
  2031. wdev_unlock(wdev);
  2032. }
  2033. if (info->attrs[NL80211_ATTR_4ADDR]) {
  2034. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  2035. change = true;
  2036. err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
  2037. if (err)
  2038. return err;
  2039. } else {
  2040. params.use_4addr = -1;
  2041. }
  2042. if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
  2043. if (ntype != NL80211_IFTYPE_MONITOR)
  2044. return -EINVAL;
  2045. err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
  2046. &_flags);
  2047. if (err)
  2048. return err;
  2049. flags = &_flags;
  2050. change = true;
  2051. }
  2052. if (change)
  2053. err = cfg80211_change_iface(rdev, dev, ntype, flags, &params);
  2054. else
  2055. err = 0;
  2056. if (!err && params.use_4addr != -1)
  2057. dev->ieee80211_ptr->use_4addr = params.use_4addr;
  2058. return err;
  2059. }
  2060. static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
  2061. {
  2062. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2063. struct vif_params params;
  2064. struct wireless_dev *wdev;
  2065. struct sk_buff *msg;
  2066. int err;
  2067. enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
  2068. u32 flags;
  2069. memset(&params, 0, sizeof(params));
  2070. if (!info->attrs[NL80211_ATTR_IFNAME])
  2071. return -EINVAL;
  2072. if (info->attrs[NL80211_ATTR_IFTYPE]) {
  2073. type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  2074. if (type > NL80211_IFTYPE_MAX)
  2075. return -EINVAL;
  2076. }
  2077. if (!rdev->ops->add_virtual_intf ||
  2078. !(rdev->wiphy.interface_modes & (1 << type)))
  2079. return -EOPNOTSUPP;
  2080. if (type == NL80211_IFTYPE_P2P_DEVICE && info->attrs[NL80211_ATTR_MAC]) {
  2081. nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
  2082. ETH_ALEN);
  2083. if (!is_valid_ether_addr(params.macaddr))
  2084. return -EADDRNOTAVAIL;
  2085. }
  2086. if (info->attrs[NL80211_ATTR_4ADDR]) {
  2087. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  2088. err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
  2089. if (err)
  2090. return err;
  2091. }
  2092. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  2093. if (!msg)
  2094. return -ENOMEM;
  2095. err = parse_monitor_flags(type == NL80211_IFTYPE_MONITOR ?
  2096. info->attrs[NL80211_ATTR_MNTR_FLAGS] : NULL,
  2097. &flags);
  2098. wdev = rdev_add_virtual_intf(rdev,
  2099. nla_data(info->attrs[NL80211_ATTR_IFNAME]),
  2100. type, err ? NULL : &flags, &params);
  2101. if (IS_ERR(wdev)) {
  2102. nlmsg_free(msg);
  2103. return PTR_ERR(wdev);
  2104. }
  2105. switch (type) {
  2106. case NL80211_IFTYPE_MESH_POINT:
  2107. if (!info->attrs[NL80211_ATTR_MESH_ID])
  2108. break;
  2109. wdev_lock(wdev);
  2110. BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
  2111. IEEE80211_MAX_MESH_ID_LEN);
  2112. wdev->mesh_id_up_len =
  2113. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  2114. memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  2115. wdev->mesh_id_up_len);
  2116. wdev_unlock(wdev);
  2117. break;
  2118. case NL80211_IFTYPE_P2P_DEVICE:
  2119. /*
  2120. * P2P Device doesn't have a netdev, so doesn't go
  2121. * through the netdev notifier and must be added here
  2122. */
  2123. mutex_init(&wdev->mtx);
  2124. INIT_LIST_HEAD(&wdev->event_list);
  2125. spin_lock_init(&wdev->event_lock);
  2126. INIT_LIST_HEAD(&wdev->mgmt_registrations);
  2127. spin_lock_init(&wdev->mgmt_registrations_lock);
  2128. mutex_lock(&rdev->devlist_mtx);
  2129. wdev->identifier = ++rdev->wdev_id;
  2130. list_add_rcu(&wdev->list, &rdev->wdev_list);
  2131. rdev->devlist_generation++;
  2132. mutex_unlock(&rdev->devlist_mtx);
  2133. break;
  2134. default:
  2135. break;
  2136. }
  2137. if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  2138. rdev, wdev) < 0) {
  2139. nlmsg_free(msg);
  2140. return -ENOBUFS;
  2141. }
  2142. return genlmsg_reply(msg, info);
  2143. }
  2144. static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
  2145. {
  2146. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2147. struct wireless_dev *wdev = info->user_ptr[1];
  2148. if (!rdev->ops->del_virtual_intf)
  2149. return -EOPNOTSUPP;
  2150. /*
  2151. * If we remove a wireless device without a netdev then clear
  2152. * user_ptr[1] so that nl80211_post_doit won't dereference it
  2153. * to check if it needs to do dev_put(). Otherwise it crashes
  2154. * since the wdev has been freed, unlike with a netdev where
  2155. * we need the dev_put() for the netdev to really be freed.
  2156. */
  2157. if (!wdev->netdev)
  2158. info->user_ptr[1] = NULL;
  2159. return rdev_del_virtual_intf(rdev, wdev);
  2160. }
  2161. static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
  2162. {
  2163. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2164. struct net_device *dev = info->user_ptr[1];
  2165. u16 noack_map;
  2166. if (!info->attrs[NL80211_ATTR_NOACK_MAP])
  2167. return -EINVAL;
  2168. if (!rdev->ops->set_noack_map)
  2169. return -EOPNOTSUPP;
  2170. noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
  2171. return rdev_set_noack_map(rdev, dev, noack_map);
  2172. }
  2173. struct get_key_cookie {
  2174. struct sk_buff *msg;
  2175. int error;
  2176. int idx;
  2177. };
  2178. static void get_key_callback(void *c, struct key_params *params)
  2179. {
  2180. struct nlattr *key;
  2181. struct get_key_cookie *cookie = c;
  2182. if ((params->key &&
  2183. nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
  2184. params->key_len, params->key)) ||
  2185. (params->seq &&
  2186. nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
  2187. params->seq_len, params->seq)) ||
  2188. (params->cipher &&
  2189. nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
  2190. params->cipher)))
  2191. goto nla_put_failure;
  2192. key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
  2193. if (!key)
  2194. goto nla_put_failure;
  2195. if ((params->key &&
  2196. nla_put(cookie->msg, NL80211_KEY_DATA,
  2197. params->key_len, params->key)) ||
  2198. (params->seq &&
  2199. nla_put(cookie->msg, NL80211_KEY_SEQ,
  2200. params->seq_len, params->seq)) ||
  2201. (params->cipher &&
  2202. nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
  2203. params->cipher)))
  2204. goto nla_put_failure;
  2205. if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
  2206. goto nla_put_failure;
  2207. nla_nest_end(cookie->msg, key);
  2208. return;
  2209. nla_put_failure:
  2210. cookie->error = 1;
  2211. }
  2212. static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
  2213. {
  2214. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2215. int err;
  2216. struct net_device *dev = info->user_ptr[1];
  2217. u8 key_idx = 0;
  2218. const u8 *mac_addr = NULL;
  2219. bool pairwise;
  2220. struct get_key_cookie cookie = {
  2221. .error = 0,
  2222. };
  2223. void *hdr;
  2224. struct sk_buff *msg;
  2225. if (info->attrs[NL80211_ATTR_KEY_IDX])
  2226. key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  2227. if (key_idx > 5)
  2228. return -EINVAL;
  2229. if (info->attrs[NL80211_ATTR_MAC])
  2230. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2231. pairwise = !!mac_addr;
  2232. if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
  2233. u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  2234. if (kt >= NUM_NL80211_KEYTYPES)
  2235. return -EINVAL;
  2236. if (kt != NL80211_KEYTYPE_GROUP &&
  2237. kt != NL80211_KEYTYPE_PAIRWISE)
  2238. return -EINVAL;
  2239. pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
  2240. }
  2241. if (!rdev->ops->get_key)
  2242. return -EOPNOTSUPP;
  2243. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  2244. if (!msg)
  2245. return -ENOMEM;
  2246. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  2247. NL80211_CMD_NEW_KEY);
  2248. if (IS_ERR(hdr))
  2249. return PTR_ERR(hdr);
  2250. cookie.msg = msg;
  2251. cookie.idx = key_idx;
  2252. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  2253. nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
  2254. goto nla_put_failure;
  2255. if (mac_addr &&
  2256. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
  2257. goto nla_put_failure;
  2258. if (pairwise && mac_addr &&
  2259. !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  2260. return -ENOENT;
  2261. err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
  2262. get_key_callback);
  2263. if (err)
  2264. goto free_msg;
  2265. if (cookie.error)
  2266. goto nla_put_failure;
  2267. genlmsg_end(msg, hdr);
  2268. return genlmsg_reply(msg, info);
  2269. nla_put_failure:
  2270. err = -ENOBUFS;
  2271. free_msg:
  2272. nlmsg_free(msg);
  2273. return err;
  2274. }
  2275. static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
  2276. {
  2277. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2278. struct key_parse key;
  2279. int err;
  2280. struct net_device *dev = info->user_ptr[1];
  2281. err = nl80211_parse_key(info, &key);
  2282. if (err)
  2283. return err;
  2284. if (key.idx < 0)
  2285. return -EINVAL;
  2286. /* only support setting default key */
  2287. if (!key.def && !key.defmgmt)
  2288. return -EINVAL;
  2289. wdev_lock(dev->ieee80211_ptr);
  2290. if (key.def) {
  2291. if (!rdev->ops->set_default_key) {
  2292. err = -EOPNOTSUPP;
  2293. goto out;
  2294. }
  2295. err = nl80211_key_allowed(dev->ieee80211_ptr);
  2296. if (err)
  2297. goto out;
  2298. err = rdev_set_default_key(rdev, dev, key.idx,
  2299. key.def_uni, key.def_multi);
  2300. if (err)
  2301. goto out;
  2302. #ifdef CONFIG_CFG80211_WEXT
  2303. dev->ieee80211_ptr->wext.default_key = key.idx;
  2304. #endif
  2305. } else {
  2306. if (key.def_uni || !key.def_multi) {
  2307. err = -EINVAL;
  2308. goto out;
  2309. }
  2310. if (!rdev->ops->set_default_mgmt_key) {
  2311. err = -EOPNOTSUPP;
  2312. goto out;
  2313. }
  2314. err = nl80211_key_allowed(dev->ieee80211_ptr);
  2315. if (err)
  2316. goto out;
  2317. err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
  2318. if (err)
  2319. goto out;
  2320. #ifdef CONFIG_CFG80211_WEXT
  2321. dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
  2322. #endif
  2323. }
  2324. out:
  2325. wdev_unlock(dev->ieee80211_ptr);
  2326. return err;
  2327. }
  2328. static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
  2329. {
  2330. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2331. int err;
  2332. struct net_device *dev = info->user_ptr[1];
  2333. struct key_parse key;
  2334. const u8 *mac_addr = NULL;
  2335. err = nl80211_parse_key(info, &key);
  2336. if (err)
  2337. return err;
  2338. if (!key.p.key)
  2339. return -EINVAL;
  2340. if (info->attrs[NL80211_ATTR_MAC])
  2341. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2342. if (key.type == -1) {
  2343. if (mac_addr)
  2344. key.type = NL80211_KEYTYPE_PAIRWISE;
  2345. else
  2346. key.type = NL80211_KEYTYPE_GROUP;
  2347. }
  2348. /* for now */
  2349. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  2350. key.type != NL80211_KEYTYPE_GROUP)
  2351. return -EINVAL;
  2352. if (!rdev->ops->add_key)
  2353. return -EOPNOTSUPP;
  2354. if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
  2355. key.type == NL80211_KEYTYPE_PAIRWISE,
  2356. mac_addr))
  2357. return -EINVAL;
  2358. wdev_lock(dev->ieee80211_ptr);
  2359. err = nl80211_key_allowed(dev->ieee80211_ptr);
  2360. if (!err)
  2361. err = rdev_add_key(rdev, dev, key.idx,
  2362. key.type == NL80211_KEYTYPE_PAIRWISE,
  2363. mac_addr, &key.p);
  2364. wdev_unlock(dev->ieee80211_ptr);
  2365. return err;
  2366. }
  2367. static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
  2368. {
  2369. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2370. int err;
  2371. struct net_device *dev = info->user_ptr[1];
  2372. u8 *mac_addr = NULL;
  2373. struct key_parse key;
  2374. err = nl80211_parse_key(info, &key);
  2375. if (err)
  2376. return err;
  2377. if (info->attrs[NL80211_ATTR_MAC])
  2378. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2379. if (key.type == -1) {
  2380. if (mac_addr)
  2381. key.type = NL80211_KEYTYPE_PAIRWISE;
  2382. else
  2383. key.type = NL80211_KEYTYPE_GROUP;
  2384. }
  2385. /* for now */
  2386. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  2387. key.type != NL80211_KEYTYPE_GROUP)
  2388. return -EINVAL;
  2389. if (!rdev->ops->del_key)
  2390. return -EOPNOTSUPP;
  2391. wdev_lock(dev->ieee80211_ptr);
  2392. err = nl80211_key_allowed(dev->ieee80211_ptr);
  2393. if (key.type == NL80211_KEYTYPE_PAIRWISE && mac_addr &&
  2394. !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  2395. err = -ENOENT;
  2396. if (!err)
  2397. err = rdev_del_key(rdev, dev, key.idx,
  2398. key.type == NL80211_KEYTYPE_PAIRWISE,
  2399. mac_addr);
  2400. #ifdef CONFIG_CFG80211_WEXT
  2401. if (!err) {
  2402. if (key.idx == dev->ieee80211_ptr->wext.default_key)
  2403. dev->ieee80211_ptr->wext.default_key = -1;
  2404. else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
  2405. dev->ieee80211_ptr->wext.default_mgmt_key = -1;
  2406. }
  2407. #endif
  2408. wdev_unlock(dev->ieee80211_ptr);
  2409. return err;
  2410. }
  2411. /* This function returns an error or the number of nested attributes */
  2412. static int validate_acl_mac_addrs(struct nlattr *nl_attr)
  2413. {
  2414. struct nlattr *attr;
  2415. int n_entries = 0, tmp;
  2416. nla_for_each_nested(attr, nl_attr, tmp) {
  2417. if (nla_len(attr) != ETH_ALEN)
  2418. return -EINVAL;
  2419. n_entries++;
  2420. }
  2421. return n_entries;
  2422. }
  2423. /*
  2424. * This function parses ACL information and allocates memory for ACL data.
  2425. * On successful return, the calling function is responsible to free the
  2426. * ACL buffer returned by this function.
  2427. */
  2428. static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
  2429. struct genl_info *info)
  2430. {
  2431. enum nl80211_acl_policy acl_policy;
  2432. struct nlattr *attr;
  2433. struct cfg80211_acl_data *acl;
  2434. int i = 0, n_entries, tmp;
  2435. if (!wiphy->max_acl_mac_addrs)
  2436. return ERR_PTR(-EOPNOTSUPP);
  2437. if (!info->attrs[NL80211_ATTR_ACL_POLICY])
  2438. return ERR_PTR(-EINVAL);
  2439. acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
  2440. if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
  2441. acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
  2442. return ERR_PTR(-EINVAL);
  2443. if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
  2444. return ERR_PTR(-EINVAL);
  2445. n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
  2446. if (n_entries < 0)
  2447. return ERR_PTR(n_entries);
  2448. if (n_entries > wiphy->max_acl_mac_addrs)
  2449. return ERR_PTR(-ENOTSUPP);
  2450. acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
  2451. GFP_KERNEL);
  2452. if (!acl)
  2453. return ERR_PTR(-ENOMEM);
  2454. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
  2455. memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
  2456. i++;
  2457. }
  2458. acl->n_acl_entries = n_entries;
  2459. acl->acl_policy = acl_policy;
  2460. return acl;
  2461. }
  2462. static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
  2463. {
  2464. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2465. struct net_device *dev = info->user_ptr[1];
  2466. struct cfg80211_acl_data *acl;
  2467. int err;
  2468. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  2469. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2470. return -EOPNOTSUPP;
  2471. if (!dev->ieee80211_ptr->beacon_interval)
  2472. return -EINVAL;
  2473. acl = parse_acl_data(&rdev->wiphy, info);
  2474. if (IS_ERR(acl))
  2475. return PTR_ERR(acl);
  2476. err = rdev_set_mac_acl(rdev, dev, acl);
  2477. kfree(acl);
  2478. return err;
  2479. }
  2480. static int nl80211_parse_beacon(struct genl_info *info,
  2481. struct cfg80211_beacon_data *bcn)
  2482. {
  2483. bool haveinfo = false;
  2484. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_BEACON_TAIL]) ||
  2485. !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]) ||
  2486. !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
  2487. !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]))
  2488. return -EINVAL;
  2489. memset(bcn, 0, sizeof(*bcn));
  2490. if (info->attrs[NL80211_ATTR_BEACON_HEAD]) {
  2491. bcn->head = nla_data(info->attrs[NL80211_ATTR_BEACON_HEAD]);
  2492. bcn->head_len = nla_len(info->attrs[NL80211_ATTR_BEACON_HEAD]);
  2493. if (!bcn->head_len)
  2494. return -EINVAL;
  2495. haveinfo = true;
  2496. }
  2497. if (info->attrs[NL80211_ATTR_BEACON_TAIL]) {
  2498. bcn->tail = nla_data(info->attrs[NL80211_ATTR_BEACON_TAIL]);
  2499. bcn->tail_len =
  2500. nla_len(info->attrs[NL80211_ATTR_BEACON_TAIL]);
  2501. haveinfo = true;
  2502. }
  2503. if (!haveinfo)
  2504. return -EINVAL;
  2505. if (info->attrs[NL80211_ATTR_IE]) {
  2506. bcn->beacon_ies = nla_data(info->attrs[NL80211_ATTR_IE]);
  2507. bcn->beacon_ies_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  2508. }
  2509. if (info->attrs[NL80211_ATTR_IE_PROBE_RESP]) {
  2510. bcn->proberesp_ies =
  2511. nla_data(info->attrs[NL80211_ATTR_IE_PROBE_RESP]);
  2512. bcn->proberesp_ies_len =
  2513. nla_len(info->attrs[NL80211_ATTR_IE_PROBE_RESP]);
  2514. }
  2515. if (info->attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
  2516. bcn->assocresp_ies =
  2517. nla_data(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]);
  2518. bcn->assocresp_ies_len =
  2519. nla_len(info->attrs[NL80211_ATTR_IE_ASSOC_RESP]);
  2520. }
  2521. if (info->attrs[NL80211_ATTR_PROBE_RESP]) {
  2522. bcn->probe_resp =
  2523. nla_data(info->attrs[NL80211_ATTR_PROBE_RESP]);
  2524. bcn->probe_resp_len =
  2525. nla_len(info->attrs[NL80211_ATTR_PROBE_RESP]);
  2526. }
  2527. return 0;
  2528. }
  2529. static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
  2530. struct cfg80211_ap_settings *params)
  2531. {
  2532. struct wireless_dev *wdev;
  2533. bool ret = false;
  2534. mutex_lock(&rdev->devlist_mtx);
  2535. list_for_each_entry(wdev, &rdev->wdev_list, list) {
  2536. if (wdev->iftype != NL80211_IFTYPE_AP &&
  2537. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  2538. continue;
  2539. if (!wdev->preset_chandef.chan)
  2540. continue;
  2541. params->chandef = wdev->preset_chandef;
  2542. ret = true;
  2543. break;
  2544. }
  2545. mutex_unlock(&rdev->devlist_mtx);
  2546. return ret;
  2547. }
  2548. static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
  2549. enum nl80211_auth_type auth_type,
  2550. enum nl80211_commands cmd)
  2551. {
  2552. if (auth_type > NL80211_AUTHTYPE_MAX)
  2553. return false;
  2554. switch (cmd) {
  2555. case NL80211_CMD_AUTHENTICATE:
  2556. if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
  2557. auth_type == NL80211_AUTHTYPE_SAE)
  2558. return false;
  2559. return true;
  2560. case NL80211_CMD_CONNECT:
  2561. case NL80211_CMD_START_AP:
  2562. /* SAE not supported yet */
  2563. if (auth_type == NL80211_AUTHTYPE_SAE)
  2564. return false;
  2565. return true;
  2566. default:
  2567. return false;
  2568. }
  2569. }
  2570. static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
  2571. {
  2572. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2573. struct net_device *dev = info->user_ptr[1];
  2574. struct wireless_dev *wdev = dev->ieee80211_ptr;
  2575. struct cfg80211_ap_settings params;
  2576. int err;
  2577. u8 radar_detect_width = 0;
  2578. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  2579. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2580. return -EOPNOTSUPP;
  2581. if (!rdev->ops->start_ap)
  2582. return -EOPNOTSUPP;
  2583. if (wdev->beacon_interval)
  2584. return -EALREADY;
  2585. memset(&params, 0, sizeof(params));
  2586. /* these are required for START_AP */
  2587. if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
  2588. !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
  2589. !info->attrs[NL80211_ATTR_BEACON_HEAD])
  2590. return -EINVAL;
  2591. err = nl80211_parse_beacon(info, &params.beacon);
  2592. if (err)
  2593. return err;
  2594. params.beacon_interval =
  2595. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  2596. params.dtim_period =
  2597. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  2598. err = cfg80211_validate_beacon_int(rdev, params.beacon_interval);
  2599. if (err)
  2600. return err;
  2601. /*
  2602. * In theory, some of these attributes should be required here
  2603. * but since they were not used when the command was originally
  2604. * added, keep them optional for old user space programs to let
  2605. * them continue to work with drivers that do not need the
  2606. * additional information -- drivers must check!
  2607. */
  2608. if (info->attrs[NL80211_ATTR_SSID]) {
  2609. params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  2610. params.ssid_len =
  2611. nla_len(info->attrs[NL80211_ATTR_SSID]);
  2612. if (params.ssid_len == 0 ||
  2613. params.ssid_len > IEEE80211_MAX_SSID_LEN)
  2614. return -EINVAL;
  2615. }
  2616. if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
  2617. params.hidden_ssid = nla_get_u32(
  2618. info->attrs[NL80211_ATTR_HIDDEN_SSID]);
  2619. if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
  2620. params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
  2621. params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
  2622. return -EINVAL;
  2623. }
  2624. params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  2625. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  2626. params.auth_type = nla_get_u32(
  2627. info->attrs[NL80211_ATTR_AUTH_TYPE]);
  2628. if (!nl80211_valid_auth_type(rdev, params.auth_type,
  2629. NL80211_CMD_START_AP))
  2630. return -EINVAL;
  2631. } else
  2632. params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  2633. err = nl80211_crypto_settings(rdev, info, &params.crypto,
  2634. NL80211_MAX_NR_CIPHER_SUITES);
  2635. if (err)
  2636. return err;
  2637. if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
  2638. if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
  2639. return -EOPNOTSUPP;
  2640. params.inactivity_timeout = nla_get_u16(
  2641. info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
  2642. }
  2643. if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
  2644. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2645. return -EINVAL;
  2646. params.p2p_ctwindow =
  2647. nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
  2648. if (params.p2p_ctwindow > 127)
  2649. return -EINVAL;
  2650. if (params.p2p_ctwindow != 0 &&
  2651. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
  2652. return -EINVAL;
  2653. }
  2654. if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
  2655. u8 tmp;
  2656. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2657. return -EINVAL;
  2658. tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
  2659. if (tmp > 1)
  2660. return -EINVAL;
  2661. params.p2p_opp_ps = tmp;
  2662. if (params.p2p_opp_ps != 0 &&
  2663. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
  2664. return -EINVAL;
  2665. }
  2666. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  2667. err = nl80211_parse_chandef(rdev, info, &params.chandef);
  2668. if (err)
  2669. return err;
  2670. } else if (wdev->preset_chandef.chan) {
  2671. params.chandef = wdev->preset_chandef;
  2672. } else if (!nl80211_get_ap_channel(rdev, &params))
  2673. return -EINVAL;
  2674. if (!cfg80211_reg_can_beacon(&rdev->wiphy, &params.chandef))
  2675. return -EINVAL;
  2676. err = cfg80211_chandef_dfs_required(wdev->wiphy, &params.chandef);
  2677. if (err < 0)
  2678. return err;
  2679. if (err) {
  2680. radar_detect_width = BIT(params.chandef.width);
  2681. params.radar_required = true;
  2682. }
  2683. mutex_lock(&rdev->devlist_mtx);
  2684. err = cfg80211_can_use_iftype_chan(rdev, wdev, wdev->iftype,
  2685. params.chandef.chan,
  2686. CHAN_MODE_SHARED,
  2687. radar_detect_width);
  2688. mutex_unlock(&rdev->devlist_mtx);
  2689. if (err)
  2690. return err;
  2691. if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
  2692. params.acl = parse_acl_data(&rdev->wiphy, info);
  2693. if (IS_ERR(params.acl))
  2694. return PTR_ERR(params.acl);
  2695. }
  2696. err = rdev_start_ap(rdev, dev, &params);
  2697. if (!err) {
  2698. wdev->preset_chandef = params.chandef;
  2699. wdev->beacon_interval = params.beacon_interval;
  2700. wdev->channel = params.chandef.chan;
  2701. wdev->ssid_len = params.ssid_len;
  2702. memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
  2703. }
  2704. kfree(params.acl);
  2705. return err;
  2706. }
  2707. static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
  2708. {
  2709. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2710. struct net_device *dev = info->user_ptr[1];
  2711. struct wireless_dev *wdev = dev->ieee80211_ptr;
  2712. struct cfg80211_beacon_data params;
  2713. int err;
  2714. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  2715. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2716. return -EOPNOTSUPP;
  2717. if (!rdev->ops->change_beacon)
  2718. return -EOPNOTSUPP;
  2719. if (!wdev->beacon_interval)
  2720. return -EINVAL;
  2721. err = nl80211_parse_beacon(info, &params);
  2722. if (err)
  2723. return err;
  2724. return rdev_change_beacon(rdev, dev, &params);
  2725. }
  2726. static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
  2727. {
  2728. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2729. struct net_device *dev = info->user_ptr[1];
  2730. return cfg80211_stop_ap(rdev, dev);
  2731. }
  2732. static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
  2733. [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
  2734. [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
  2735. [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
  2736. [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
  2737. [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
  2738. [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
  2739. };
  2740. static int parse_station_flags(struct genl_info *info,
  2741. enum nl80211_iftype iftype,
  2742. struct station_parameters *params)
  2743. {
  2744. struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
  2745. struct nlattr *nla;
  2746. int flag;
  2747. /*
  2748. * Try parsing the new attribute first so userspace
  2749. * can specify both for older kernels.
  2750. */
  2751. nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
  2752. if (nla) {
  2753. struct nl80211_sta_flag_update *sta_flags;
  2754. sta_flags = nla_data(nla);
  2755. params->sta_flags_mask = sta_flags->mask;
  2756. params->sta_flags_set = sta_flags->set;
  2757. params->sta_flags_set &= params->sta_flags_mask;
  2758. if ((params->sta_flags_mask |
  2759. params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
  2760. return -EINVAL;
  2761. return 0;
  2762. }
  2763. /* if present, parse the old attribute */
  2764. nla = info->attrs[NL80211_ATTR_STA_FLAGS];
  2765. if (!nla)
  2766. return 0;
  2767. if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX,
  2768. nla, sta_flags_policy))
  2769. return -EINVAL;
  2770. /*
  2771. * Only allow certain flags for interface types so that
  2772. * other attributes are silently ignored. Remember that
  2773. * this is backward compatibility code with old userspace
  2774. * and shouldn't be hit in other cases anyway.
  2775. */
  2776. switch (iftype) {
  2777. case NL80211_IFTYPE_AP:
  2778. case NL80211_IFTYPE_AP_VLAN:
  2779. case NL80211_IFTYPE_P2P_GO:
  2780. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
  2781. BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
  2782. BIT(NL80211_STA_FLAG_WME) |
  2783. BIT(NL80211_STA_FLAG_MFP);
  2784. break;
  2785. case NL80211_IFTYPE_P2P_CLIENT:
  2786. case NL80211_IFTYPE_STATION:
  2787. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
  2788. BIT(NL80211_STA_FLAG_TDLS_PEER);
  2789. break;
  2790. case NL80211_IFTYPE_MESH_POINT:
  2791. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  2792. BIT(NL80211_STA_FLAG_MFP) |
  2793. BIT(NL80211_STA_FLAG_AUTHORIZED);
  2794. default:
  2795. return -EINVAL;
  2796. }
  2797. for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
  2798. if (flags[flag]) {
  2799. params->sta_flags_set |= (1<<flag);
  2800. /* no longer support new API additions in old API */
  2801. if (flag > NL80211_STA_FLAG_MAX_OLD_API)
  2802. return -EINVAL;
  2803. }
  2804. }
  2805. return 0;
  2806. }
  2807. static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
  2808. int attr)
  2809. {
  2810. struct nlattr *rate;
  2811. u32 bitrate;
  2812. u16 bitrate_compat;
  2813. rate = nla_nest_start(msg, attr);
  2814. if (!rate)
  2815. return false;
  2816. /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
  2817. bitrate = cfg80211_calculate_bitrate(info);
  2818. /* report 16-bit bitrate only if we can */
  2819. bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
  2820. if (bitrate > 0 &&
  2821. nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
  2822. return false;
  2823. if (bitrate_compat > 0 &&
  2824. nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
  2825. return false;
  2826. if (info->flags & RATE_INFO_FLAGS_MCS) {
  2827. if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
  2828. return false;
  2829. if (info->flags & RATE_INFO_FLAGS_40_MHZ_WIDTH &&
  2830. nla_put_flag(msg, NL80211_RATE_INFO_40_MHZ_WIDTH))
  2831. return false;
  2832. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  2833. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  2834. return false;
  2835. } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
  2836. if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
  2837. return false;
  2838. if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
  2839. return false;
  2840. if (info->flags & RATE_INFO_FLAGS_40_MHZ_WIDTH &&
  2841. nla_put_flag(msg, NL80211_RATE_INFO_40_MHZ_WIDTH))
  2842. return false;
  2843. if (info->flags & RATE_INFO_FLAGS_80_MHZ_WIDTH &&
  2844. nla_put_flag(msg, NL80211_RATE_INFO_80_MHZ_WIDTH))
  2845. return false;
  2846. if (info->flags & RATE_INFO_FLAGS_80P80_MHZ_WIDTH &&
  2847. nla_put_flag(msg, NL80211_RATE_INFO_80P80_MHZ_WIDTH))
  2848. return false;
  2849. if (info->flags & RATE_INFO_FLAGS_160_MHZ_WIDTH &&
  2850. nla_put_flag(msg, NL80211_RATE_INFO_160_MHZ_WIDTH))
  2851. return false;
  2852. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  2853. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  2854. return false;
  2855. }
  2856. nla_nest_end(msg, rate);
  2857. return true;
  2858. }
  2859. static int nl80211_send_station(struct sk_buff *msg, u32 portid, u32 seq,
  2860. int flags,
  2861. struct cfg80211_registered_device *rdev,
  2862. struct net_device *dev,
  2863. const u8 *mac_addr, struct station_info *sinfo)
  2864. {
  2865. void *hdr;
  2866. struct nlattr *sinfoattr, *bss_param;
  2867. hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_STATION);
  2868. if (!hdr)
  2869. return -1;
  2870. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  2871. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
  2872. nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
  2873. goto nla_put_failure;
  2874. sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
  2875. if (!sinfoattr)
  2876. goto nla_put_failure;
  2877. if ((sinfo->filled & STATION_INFO_CONNECTED_TIME) &&
  2878. nla_put_u32(msg, NL80211_STA_INFO_CONNECTED_TIME,
  2879. sinfo->connected_time))
  2880. goto nla_put_failure;
  2881. if ((sinfo->filled & STATION_INFO_INACTIVE_TIME) &&
  2882. nla_put_u32(msg, NL80211_STA_INFO_INACTIVE_TIME,
  2883. sinfo->inactive_time))
  2884. goto nla_put_failure;
  2885. if ((sinfo->filled & (STATION_INFO_RX_BYTES |
  2886. STATION_INFO_RX_BYTES64)) &&
  2887. nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
  2888. (u32)sinfo->rx_bytes))
  2889. goto nla_put_failure;
  2890. if ((sinfo->filled & (STATION_INFO_TX_BYTES |
  2891. STATION_INFO_TX_BYTES64)) &&
  2892. nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
  2893. (u32)sinfo->tx_bytes))
  2894. goto nla_put_failure;
  2895. if ((sinfo->filled & STATION_INFO_RX_BYTES64) &&
  2896. nla_put_u64(msg, NL80211_STA_INFO_RX_BYTES64,
  2897. sinfo->rx_bytes))
  2898. goto nla_put_failure;
  2899. if ((sinfo->filled & STATION_INFO_TX_BYTES64) &&
  2900. nla_put_u64(msg, NL80211_STA_INFO_TX_BYTES64,
  2901. sinfo->tx_bytes))
  2902. goto nla_put_failure;
  2903. if ((sinfo->filled & STATION_INFO_LLID) &&
  2904. nla_put_u16(msg, NL80211_STA_INFO_LLID, sinfo->llid))
  2905. goto nla_put_failure;
  2906. if ((sinfo->filled & STATION_INFO_PLID) &&
  2907. nla_put_u16(msg, NL80211_STA_INFO_PLID, sinfo->plid))
  2908. goto nla_put_failure;
  2909. if ((sinfo->filled & STATION_INFO_PLINK_STATE) &&
  2910. nla_put_u8(msg, NL80211_STA_INFO_PLINK_STATE,
  2911. sinfo->plink_state))
  2912. goto nla_put_failure;
  2913. switch (rdev->wiphy.signal_type) {
  2914. case CFG80211_SIGNAL_TYPE_MBM:
  2915. if ((sinfo->filled & STATION_INFO_SIGNAL) &&
  2916. nla_put_u8(msg, NL80211_STA_INFO_SIGNAL,
  2917. sinfo->signal))
  2918. goto nla_put_failure;
  2919. if ((sinfo->filled & STATION_INFO_SIGNAL_AVG) &&
  2920. nla_put_u8(msg, NL80211_STA_INFO_SIGNAL_AVG,
  2921. sinfo->signal_avg))
  2922. goto nla_put_failure;
  2923. break;
  2924. default:
  2925. break;
  2926. }
  2927. if (sinfo->filled & STATION_INFO_TX_BITRATE) {
  2928. if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
  2929. NL80211_STA_INFO_TX_BITRATE))
  2930. goto nla_put_failure;
  2931. }
  2932. if (sinfo->filled & STATION_INFO_RX_BITRATE) {
  2933. if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
  2934. NL80211_STA_INFO_RX_BITRATE))
  2935. goto nla_put_failure;
  2936. }
  2937. if ((sinfo->filled & STATION_INFO_RX_PACKETS) &&
  2938. nla_put_u32(msg, NL80211_STA_INFO_RX_PACKETS,
  2939. sinfo->rx_packets))
  2940. goto nla_put_failure;
  2941. if ((sinfo->filled & STATION_INFO_TX_PACKETS) &&
  2942. nla_put_u32(msg, NL80211_STA_INFO_TX_PACKETS,
  2943. sinfo->tx_packets))
  2944. goto nla_put_failure;
  2945. if ((sinfo->filled & STATION_INFO_TX_RETRIES) &&
  2946. nla_put_u32(msg, NL80211_STA_INFO_TX_RETRIES,
  2947. sinfo->tx_retries))
  2948. goto nla_put_failure;
  2949. if ((sinfo->filled & STATION_INFO_TX_FAILED) &&
  2950. nla_put_u32(msg, NL80211_STA_INFO_TX_FAILED,
  2951. sinfo->tx_failed))
  2952. goto nla_put_failure;
  2953. if ((sinfo->filled & STATION_INFO_BEACON_LOSS_COUNT) &&
  2954. nla_put_u32(msg, NL80211_STA_INFO_BEACON_LOSS,
  2955. sinfo->beacon_loss_count))
  2956. goto nla_put_failure;
  2957. if ((sinfo->filled & STATION_INFO_LOCAL_PM) &&
  2958. nla_put_u32(msg, NL80211_STA_INFO_LOCAL_PM,
  2959. sinfo->local_pm))
  2960. goto nla_put_failure;
  2961. if ((sinfo->filled & STATION_INFO_PEER_PM) &&
  2962. nla_put_u32(msg, NL80211_STA_INFO_PEER_PM,
  2963. sinfo->peer_pm))
  2964. goto nla_put_failure;
  2965. if ((sinfo->filled & STATION_INFO_NONPEER_PM) &&
  2966. nla_put_u32(msg, NL80211_STA_INFO_NONPEER_PM,
  2967. sinfo->nonpeer_pm))
  2968. goto nla_put_failure;
  2969. if (sinfo->filled & STATION_INFO_BSS_PARAM) {
  2970. bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
  2971. if (!bss_param)
  2972. goto nla_put_failure;
  2973. if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
  2974. nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
  2975. ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
  2976. nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
  2977. ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
  2978. nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
  2979. nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
  2980. sinfo->bss_param.dtim_period) ||
  2981. nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
  2982. sinfo->bss_param.beacon_interval))
  2983. goto nla_put_failure;
  2984. nla_nest_end(msg, bss_param);
  2985. }
  2986. if ((sinfo->filled & STATION_INFO_STA_FLAGS) &&
  2987. nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
  2988. sizeof(struct nl80211_sta_flag_update),
  2989. &sinfo->sta_flags))
  2990. goto nla_put_failure;
  2991. if ((sinfo->filled & STATION_INFO_T_OFFSET) &&
  2992. nla_put_u64(msg, NL80211_STA_INFO_T_OFFSET,
  2993. sinfo->t_offset))
  2994. goto nla_put_failure;
  2995. nla_nest_end(msg, sinfoattr);
  2996. if ((sinfo->filled & STATION_INFO_ASSOC_REQ_IES) &&
  2997. nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
  2998. sinfo->assoc_req_ies))
  2999. goto nla_put_failure;
  3000. return genlmsg_end(msg, hdr);
  3001. nla_put_failure:
  3002. genlmsg_cancel(msg, hdr);
  3003. return -EMSGSIZE;
  3004. }
  3005. static int nl80211_dump_station(struct sk_buff *skb,
  3006. struct netlink_callback *cb)
  3007. {
  3008. struct station_info sinfo;
  3009. struct cfg80211_registered_device *dev;
  3010. struct wireless_dev *wdev;
  3011. u8 mac_addr[ETH_ALEN];
  3012. int sta_idx = cb->args[2];
  3013. int err;
  3014. err = nl80211_prepare_wdev_dump(skb, cb, &dev, &wdev);
  3015. if (err)
  3016. return err;
  3017. if (!wdev->netdev) {
  3018. err = -EINVAL;
  3019. goto out_err;
  3020. }
  3021. if (!dev->ops->dump_station) {
  3022. err = -EOPNOTSUPP;
  3023. goto out_err;
  3024. }
  3025. while (1) {
  3026. memset(&sinfo, 0, sizeof(sinfo));
  3027. err = rdev_dump_station(dev, wdev->netdev, sta_idx,
  3028. mac_addr, &sinfo);
  3029. if (err == -ENOENT)
  3030. break;
  3031. if (err)
  3032. goto out_err;
  3033. if (nl80211_send_station(skb,
  3034. NETLINK_CB(cb->skb).portid,
  3035. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  3036. dev, wdev->netdev, mac_addr,
  3037. &sinfo) < 0)
  3038. goto out;
  3039. sta_idx++;
  3040. }
  3041. out:
  3042. cb->args[2] = sta_idx;
  3043. err = skb->len;
  3044. out_err:
  3045. nl80211_finish_wdev_dump(dev);
  3046. return err;
  3047. }
  3048. static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
  3049. {
  3050. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3051. struct net_device *dev = info->user_ptr[1];
  3052. struct station_info sinfo;
  3053. struct sk_buff *msg;
  3054. u8 *mac_addr = NULL;
  3055. int err;
  3056. memset(&sinfo, 0, sizeof(sinfo));
  3057. if (!info->attrs[NL80211_ATTR_MAC])
  3058. return -EINVAL;
  3059. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3060. if (!rdev->ops->get_station)
  3061. return -EOPNOTSUPP;
  3062. err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
  3063. if (err)
  3064. return err;
  3065. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3066. if (!msg)
  3067. return -ENOMEM;
  3068. if (nl80211_send_station(msg, info->snd_portid, info->snd_seq, 0,
  3069. rdev, dev, mac_addr, &sinfo) < 0) {
  3070. nlmsg_free(msg);
  3071. return -ENOBUFS;
  3072. }
  3073. return genlmsg_reply(msg, info);
  3074. }
  3075. int cfg80211_check_station_change(struct wiphy *wiphy,
  3076. struct station_parameters *params,
  3077. enum cfg80211_station_type statype)
  3078. {
  3079. if (params->listen_interval != -1)
  3080. return -EINVAL;
  3081. if (params->aid)
  3082. return -EINVAL;
  3083. /* When you run into this, adjust the code below for the new flag */
  3084. BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
  3085. switch (statype) {
  3086. case CFG80211_STA_MESH_PEER_KERNEL:
  3087. case CFG80211_STA_MESH_PEER_USER:
  3088. /*
  3089. * No ignoring the TDLS flag here -- the userspace mesh
  3090. * code doesn't have the bug of including TDLS in the
  3091. * mask everywhere.
  3092. */
  3093. if (params->sta_flags_mask &
  3094. ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  3095. BIT(NL80211_STA_FLAG_MFP) |
  3096. BIT(NL80211_STA_FLAG_AUTHORIZED)))
  3097. return -EINVAL;
  3098. break;
  3099. case CFG80211_STA_TDLS_PEER_SETUP:
  3100. case CFG80211_STA_TDLS_PEER_ACTIVE:
  3101. if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
  3102. return -EINVAL;
  3103. /* ignore since it can't change */
  3104. params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  3105. break;
  3106. default:
  3107. /* disallow mesh-specific things */
  3108. if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
  3109. return -EINVAL;
  3110. if (params->local_pm)
  3111. return -EINVAL;
  3112. if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
  3113. return -EINVAL;
  3114. }
  3115. if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
  3116. statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
  3117. /* TDLS can't be set, ... */
  3118. if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
  3119. return -EINVAL;
  3120. /*
  3121. * ... but don't bother the driver with it. This works around
  3122. * a hostapd/wpa_supplicant issue -- it always includes the
  3123. * TLDS_PEER flag in the mask even for AP mode.
  3124. */
  3125. params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  3126. }
  3127. if (statype != CFG80211_STA_TDLS_PEER_SETUP) {
  3128. /* reject other things that can't change */
  3129. if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
  3130. return -EINVAL;
  3131. if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
  3132. return -EINVAL;
  3133. if (params->supported_rates)
  3134. return -EINVAL;
  3135. if (params->ext_capab || params->ht_capa || params->vht_capa)
  3136. return -EINVAL;
  3137. }
  3138. if (statype != CFG80211_STA_AP_CLIENT) {
  3139. if (params->vlan)
  3140. return -EINVAL;
  3141. }
  3142. switch (statype) {
  3143. case CFG80211_STA_AP_MLME_CLIENT:
  3144. /* Use this only for authorizing/unauthorizing a station */
  3145. if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
  3146. return -EOPNOTSUPP;
  3147. break;
  3148. case CFG80211_STA_AP_CLIENT:
  3149. /* accept only the listed bits */
  3150. if (params->sta_flags_mask &
  3151. ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
  3152. BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  3153. BIT(NL80211_STA_FLAG_ASSOCIATED) |
  3154. BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
  3155. BIT(NL80211_STA_FLAG_WME) |
  3156. BIT(NL80211_STA_FLAG_MFP)))
  3157. return -EINVAL;
  3158. /* but authenticated/associated only if driver handles it */
  3159. if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
  3160. params->sta_flags_mask &
  3161. (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  3162. BIT(NL80211_STA_FLAG_ASSOCIATED)))
  3163. return -EINVAL;
  3164. break;
  3165. case CFG80211_STA_IBSS:
  3166. case CFG80211_STA_AP_STA:
  3167. /* reject any changes other than AUTHORIZED */
  3168. if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
  3169. return -EINVAL;
  3170. break;
  3171. case CFG80211_STA_TDLS_PEER_SETUP:
  3172. /* reject any changes other than AUTHORIZED or WME */
  3173. if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
  3174. BIT(NL80211_STA_FLAG_WME)))
  3175. return -EINVAL;
  3176. /* force (at least) rates when authorizing */
  3177. if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
  3178. !params->supported_rates)
  3179. return -EINVAL;
  3180. break;
  3181. case CFG80211_STA_TDLS_PEER_ACTIVE:
  3182. /* reject any changes */
  3183. return -EINVAL;
  3184. case CFG80211_STA_MESH_PEER_KERNEL:
  3185. if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
  3186. return -EINVAL;
  3187. break;
  3188. case CFG80211_STA_MESH_PEER_USER:
  3189. if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
  3190. return -EINVAL;
  3191. break;
  3192. }
  3193. return 0;
  3194. }
  3195. EXPORT_SYMBOL(cfg80211_check_station_change);
  3196. /*
  3197. * Get vlan interface making sure it is running and on the right wiphy.
  3198. */
  3199. static struct net_device *get_vlan(struct genl_info *info,
  3200. struct cfg80211_registered_device *rdev)
  3201. {
  3202. struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
  3203. struct net_device *v;
  3204. int ret;
  3205. if (!vlanattr)
  3206. return NULL;
  3207. v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
  3208. if (!v)
  3209. return ERR_PTR(-ENODEV);
  3210. if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
  3211. ret = -EINVAL;
  3212. goto error;
  3213. }
  3214. if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  3215. v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3216. v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  3217. ret = -EINVAL;
  3218. goto error;
  3219. }
  3220. if (!netif_running(v)) {
  3221. ret = -ENETDOWN;
  3222. goto error;
  3223. }
  3224. return v;
  3225. error:
  3226. dev_put(v);
  3227. return ERR_PTR(ret);
  3228. }
  3229. static struct nla_policy
  3230. nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] __read_mostly = {
  3231. [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
  3232. [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
  3233. };
  3234. static int nl80211_parse_sta_wme(struct genl_info *info,
  3235. struct station_parameters *params)
  3236. {
  3237. struct nlattr *tb[NL80211_STA_WME_MAX + 1];
  3238. struct nlattr *nla;
  3239. int err;
  3240. /* parse WME attributes if present */
  3241. if (!info->attrs[NL80211_ATTR_STA_WME])
  3242. return 0;
  3243. nla = info->attrs[NL80211_ATTR_STA_WME];
  3244. err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
  3245. nl80211_sta_wme_policy);
  3246. if (err)
  3247. return err;
  3248. if (tb[NL80211_STA_WME_UAPSD_QUEUES])
  3249. params->uapsd_queues = nla_get_u8(
  3250. tb[NL80211_STA_WME_UAPSD_QUEUES]);
  3251. if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
  3252. return -EINVAL;
  3253. if (tb[NL80211_STA_WME_MAX_SP])
  3254. params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
  3255. if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
  3256. return -EINVAL;
  3257. params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
  3258. return 0;
  3259. }
  3260. static int nl80211_set_station_tdls(struct genl_info *info,
  3261. struct station_parameters *params)
  3262. {
  3263. /* Dummy STA entry gets updated once the peer capabilities are known */
  3264. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  3265. params->ht_capa =
  3266. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  3267. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  3268. params->vht_capa =
  3269. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  3270. return nl80211_parse_sta_wme(info, params);
  3271. }
  3272. static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
  3273. {
  3274. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3275. struct net_device *dev = info->user_ptr[1];
  3276. struct station_parameters params;
  3277. u8 *mac_addr;
  3278. int err;
  3279. memset(&params, 0, sizeof(params));
  3280. params.listen_interval = -1;
  3281. if (!rdev->ops->change_station)
  3282. return -EOPNOTSUPP;
  3283. if (info->attrs[NL80211_ATTR_STA_AID])
  3284. return -EINVAL;
  3285. if (!info->attrs[NL80211_ATTR_MAC])
  3286. return -EINVAL;
  3287. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3288. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
  3289. params.supported_rates =
  3290. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  3291. params.supported_rates_len =
  3292. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  3293. }
  3294. if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
  3295. params.capability =
  3296. nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
  3297. params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
  3298. }
  3299. if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
  3300. params.ext_capab =
  3301. nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  3302. params.ext_capab_len =
  3303. nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  3304. }
  3305. if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  3306. return -EINVAL;
  3307. if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
  3308. return -EINVAL;
  3309. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
  3310. params.plink_action =
  3311. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  3312. if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
  3313. return -EINVAL;
  3314. }
  3315. if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
  3316. params.plink_state =
  3317. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
  3318. if (params.plink_state >= NUM_NL80211_PLINK_STATES)
  3319. return -EINVAL;
  3320. params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
  3321. }
  3322. if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
  3323. enum nl80211_mesh_power_mode pm = nla_get_u32(
  3324. info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
  3325. if (pm <= NL80211_MESH_POWER_UNKNOWN ||
  3326. pm > NL80211_MESH_POWER_MAX)
  3327. return -EINVAL;
  3328. params.local_pm = pm;
  3329. }
  3330. /* Include parameters for TDLS peer (will check later) */
  3331. err = nl80211_set_station_tdls(info, &params);
  3332. if (err)
  3333. return err;
  3334. params.vlan = get_vlan(info, rdev);
  3335. if (IS_ERR(params.vlan))
  3336. return PTR_ERR(params.vlan);
  3337. switch (dev->ieee80211_ptr->iftype) {
  3338. case NL80211_IFTYPE_AP:
  3339. case NL80211_IFTYPE_AP_VLAN:
  3340. case NL80211_IFTYPE_P2P_GO:
  3341. case NL80211_IFTYPE_P2P_CLIENT:
  3342. case NL80211_IFTYPE_STATION:
  3343. case NL80211_IFTYPE_ADHOC:
  3344. case NL80211_IFTYPE_MESH_POINT:
  3345. break;
  3346. default:
  3347. err = -EOPNOTSUPP;
  3348. goto out_put_vlan;
  3349. }
  3350. /* driver will call cfg80211_check_station_change() */
  3351. err = rdev_change_station(rdev, dev, mac_addr, &params);
  3352. out_put_vlan:
  3353. if (params.vlan)
  3354. dev_put(params.vlan);
  3355. return err;
  3356. }
  3357. static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
  3358. {
  3359. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3360. int err;
  3361. struct net_device *dev = info->user_ptr[1];
  3362. struct station_parameters params;
  3363. u8 *mac_addr = NULL;
  3364. memset(&params, 0, sizeof(params));
  3365. if (!rdev->ops->add_station)
  3366. return -EOPNOTSUPP;
  3367. if (!info->attrs[NL80211_ATTR_MAC])
  3368. return -EINVAL;
  3369. if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  3370. return -EINVAL;
  3371. if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
  3372. return -EINVAL;
  3373. if (!info->attrs[NL80211_ATTR_STA_AID])
  3374. return -EINVAL;
  3375. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3376. params.supported_rates =
  3377. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  3378. params.supported_rates_len =
  3379. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  3380. params.listen_interval =
  3381. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  3382. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
  3383. if (!params.aid || params.aid > IEEE80211_MAX_AID)
  3384. return -EINVAL;
  3385. if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
  3386. params.capability =
  3387. nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
  3388. params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
  3389. }
  3390. if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
  3391. params.ext_capab =
  3392. nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  3393. params.ext_capab_len =
  3394. nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  3395. }
  3396. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  3397. params.ht_capa =
  3398. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  3399. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  3400. params.vht_capa =
  3401. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  3402. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
  3403. params.plink_action =
  3404. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  3405. if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
  3406. return -EINVAL;
  3407. }
  3408. err = nl80211_parse_sta_wme(info, &params);
  3409. if (err)
  3410. return err;
  3411. if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
  3412. return -EINVAL;
  3413. /* When you run into this, adjust the code below for the new flag */
  3414. BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
  3415. switch (dev->ieee80211_ptr->iftype) {
  3416. case NL80211_IFTYPE_AP:
  3417. case NL80211_IFTYPE_AP_VLAN:
  3418. case NL80211_IFTYPE_P2P_GO:
  3419. /* ignore WME attributes if iface/sta is not capable */
  3420. if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
  3421. !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
  3422. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  3423. /* TDLS peers cannot be added */
  3424. if (params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
  3425. return -EINVAL;
  3426. /* but don't bother the driver with it */
  3427. params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  3428. /* allow authenticated/associated only if driver handles it */
  3429. if (!(rdev->wiphy.features &
  3430. NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
  3431. params.sta_flags_mask &
  3432. (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  3433. BIT(NL80211_STA_FLAG_ASSOCIATED)))
  3434. return -EINVAL;
  3435. /* must be last in here for error handling */
  3436. params.vlan = get_vlan(info, rdev);
  3437. if (IS_ERR(params.vlan))
  3438. return PTR_ERR(params.vlan);
  3439. break;
  3440. case NL80211_IFTYPE_MESH_POINT:
  3441. /* ignore uAPSD data */
  3442. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  3443. /* associated is disallowed */
  3444. if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
  3445. return -EINVAL;
  3446. /* TDLS peers cannot be added */
  3447. if (params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
  3448. return -EINVAL;
  3449. break;
  3450. case NL80211_IFTYPE_STATION:
  3451. case NL80211_IFTYPE_P2P_CLIENT:
  3452. /* ignore uAPSD data */
  3453. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  3454. /* these are disallowed */
  3455. if (params.sta_flags_mask &
  3456. (BIT(NL80211_STA_FLAG_ASSOCIATED) |
  3457. BIT(NL80211_STA_FLAG_AUTHENTICATED)))
  3458. return -EINVAL;
  3459. /* Only TDLS peers can be added */
  3460. if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
  3461. return -EINVAL;
  3462. /* Can only add if TDLS ... */
  3463. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
  3464. return -EOPNOTSUPP;
  3465. /* ... with external setup is supported */
  3466. if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
  3467. return -EOPNOTSUPP;
  3468. /*
  3469. * Older wpa_supplicant versions always mark the TDLS peer
  3470. * as authorized, but it shouldn't yet be.
  3471. */
  3472. params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
  3473. break;
  3474. default:
  3475. return -EOPNOTSUPP;
  3476. }
  3477. /* be aware of params.vlan when changing code here */
  3478. err = rdev_add_station(rdev, dev, mac_addr, &params);
  3479. if (params.vlan)
  3480. dev_put(params.vlan);
  3481. return err;
  3482. }
  3483. static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
  3484. {
  3485. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3486. struct net_device *dev = info->user_ptr[1];
  3487. u8 *mac_addr = NULL;
  3488. if (info->attrs[NL80211_ATTR_MAC])
  3489. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3490. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3491. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  3492. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  3493. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3494. return -EINVAL;
  3495. if (!rdev->ops->del_station)
  3496. return -EOPNOTSUPP;
  3497. return rdev_del_station(rdev, dev, mac_addr);
  3498. }
  3499. static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
  3500. int flags, struct net_device *dev,
  3501. u8 *dst, u8 *next_hop,
  3502. struct mpath_info *pinfo)
  3503. {
  3504. void *hdr;
  3505. struct nlattr *pinfoattr;
  3506. hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_STATION);
  3507. if (!hdr)
  3508. return -1;
  3509. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  3510. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
  3511. nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
  3512. nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
  3513. goto nla_put_failure;
  3514. pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
  3515. if (!pinfoattr)
  3516. goto nla_put_failure;
  3517. if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
  3518. nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
  3519. pinfo->frame_qlen))
  3520. goto nla_put_failure;
  3521. if (((pinfo->filled & MPATH_INFO_SN) &&
  3522. nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
  3523. ((pinfo->filled & MPATH_INFO_METRIC) &&
  3524. nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
  3525. pinfo->metric)) ||
  3526. ((pinfo->filled & MPATH_INFO_EXPTIME) &&
  3527. nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
  3528. pinfo->exptime)) ||
  3529. ((pinfo->filled & MPATH_INFO_FLAGS) &&
  3530. nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
  3531. pinfo->flags)) ||
  3532. ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
  3533. nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
  3534. pinfo->discovery_timeout)) ||
  3535. ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
  3536. nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
  3537. pinfo->discovery_retries)))
  3538. goto nla_put_failure;
  3539. nla_nest_end(msg, pinfoattr);
  3540. return genlmsg_end(msg, hdr);
  3541. nla_put_failure:
  3542. genlmsg_cancel(msg, hdr);
  3543. return -EMSGSIZE;
  3544. }
  3545. static int nl80211_dump_mpath(struct sk_buff *skb,
  3546. struct netlink_callback *cb)
  3547. {
  3548. struct mpath_info pinfo;
  3549. struct cfg80211_registered_device *dev;
  3550. struct wireless_dev *wdev;
  3551. u8 dst[ETH_ALEN];
  3552. u8 next_hop[ETH_ALEN];
  3553. int path_idx = cb->args[2];
  3554. int err;
  3555. err = nl80211_prepare_wdev_dump(skb, cb, &dev, &wdev);
  3556. if (err)
  3557. return err;
  3558. if (!dev->ops->dump_mpath) {
  3559. err = -EOPNOTSUPP;
  3560. goto out_err;
  3561. }
  3562. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
  3563. err = -EOPNOTSUPP;
  3564. goto out_err;
  3565. }
  3566. while (1) {
  3567. err = rdev_dump_mpath(dev, wdev->netdev, path_idx, dst,
  3568. next_hop, &pinfo);
  3569. if (err == -ENOENT)
  3570. break;
  3571. if (err)
  3572. goto out_err;
  3573. if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
  3574. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  3575. wdev->netdev, dst, next_hop,
  3576. &pinfo) < 0)
  3577. goto out;
  3578. path_idx++;
  3579. }
  3580. out:
  3581. cb->args[2] = path_idx;
  3582. err = skb->len;
  3583. out_err:
  3584. nl80211_finish_wdev_dump(dev);
  3585. return err;
  3586. }
  3587. static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
  3588. {
  3589. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3590. int err;
  3591. struct net_device *dev = info->user_ptr[1];
  3592. struct mpath_info pinfo;
  3593. struct sk_buff *msg;
  3594. u8 *dst = NULL;
  3595. u8 next_hop[ETH_ALEN];
  3596. memset(&pinfo, 0, sizeof(pinfo));
  3597. if (!info->attrs[NL80211_ATTR_MAC])
  3598. return -EINVAL;
  3599. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3600. if (!rdev->ops->get_mpath)
  3601. return -EOPNOTSUPP;
  3602. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  3603. return -EOPNOTSUPP;
  3604. err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
  3605. if (err)
  3606. return err;
  3607. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3608. if (!msg)
  3609. return -ENOMEM;
  3610. if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
  3611. dev, dst, next_hop, &pinfo) < 0) {
  3612. nlmsg_free(msg);
  3613. return -ENOBUFS;
  3614. }
  3615. return genlmsg_reply(msg, info);
  3616. }
  3617. static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
  3618. {
  3619. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3620. struct net_device *dev = info->user_ptr[1];
  3621. u8 *dst = NULL;
  3622. u8 *next_hop = NULL;
  3623. if (!info->attrs[NL80211_ATTR_MAC])
  3624. return -EINVAL;
  3625. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  3626. return -EINVAL;
  3627. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3628. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  3629. if (!rdev->ops->change_mpath)
  3630. return -EOPNOTSUPP;
  3631. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  3632. return -EOPNOTSUPP;
  3633. return rdev_change_mpath(rdev, dev, dst, next_hop);
  3634. }
  3635. static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
  3636. {
  3637. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3638. struct net_device *dev = info->user_ptr[1];
  3639. u8 *dst = NULL;
  3640. u8 *next_hop = NULL;
  3641. if (!info->attrs[NL80211_ATTR_MAC])
  3642. return -EINVAL;
  3643. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  3644. return -EINVAL;
  3645. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3646. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  3647. if (!rdev->ops->add_mpath)
  3648. return -EOPNOTSUPP;
  3649. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  3650. return -EOPNOTSUPP;
  3651. return rdev_add_mpath(rdev, dev, dst, next_hop);
  3652. }
  3653. static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
  3654. {
  3655. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3656. struct net_device *dev = info->user_ptr[1];
  3657. u8 *dst = NULL;
  3658. if (info->attrs[NL80211_ATTR_MAC])
  3659. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3660. if (!rdev->ops->del_mpath)
  3661. return -EOPNOTSUPP;
  3662. return rdev_del_mpath(rdev, dev, dst);
  3663. }
  3664. static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
  3665. {
  3666. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3667. struct net_device *dev = info->user_ptr[1];
  3668. struct bss_parameters params;
  3669. memset(&params, 0, sizeof(params));
  3670. /* default to not changing parameters */
  3671. params.use_cts_prot = -1;
  3672. params.use_short_preamble = -1;
  3673. params.use_short_slot_time = -1;
  3674. params.ap_isolate = -1;
  3675. params.ht_opmode = -1;
  3676. params.p2p_ctwindow = -1;
  3677. params.p2p_opp_ps = -1;
  3678. if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
  3679. params.use_cts_prot =
  3680. nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
  3681. if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
  3682. params.use_short_preamble =
  3683. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
  3684. if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
  3685. params.use_short_slot_time =
  3686. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
  3687. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  3688. params.basic_rates =
  3689. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  3690. params.basic_rates_len =
  3691. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  3692. }
  3693. if (info->attrs[NL80211_ATTR_AP_ISOLATE])
  3694. params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
  3695. if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
  3696. params.ht_opmode =
  3697. nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
  3698. if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
  3699. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3700. return -EINVAL;
  3701. params.p2p_ctwindow =
  3702. nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
  3703. if (params.p2p_ctwindow < 0)
  3704. return -EINVAL;
  3705. if (params.p2p_ctwindow != 0 &&
  3706. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
  3707. return -EINVAL;
  3708. }
  3709. if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
  3710. u8 tmp;
  3711. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3712. return -EINVAL;
  3713. tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
  3714. if (tmp > 1)
  3715. return -EINVAL;
  3716. params.p2p_opp_ps = tmp;
  3717. if (params.p2p_opp_ps &&
  3718. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
  3719. return -EINVAL;
  3720. }
  3721. if (!rdev->ops->change_bss)
  3722. return -EOPNOTSUPP;
  3723. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3724. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3725. return -EOPNOTSUPP;
  3726. return rdev_change_bss(rdev, dev, &params);
  3727. }
  3728. static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
  3729. [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
  3730. [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
  3731. [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
  3732. [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
  3733. [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
  3734. [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
  3735. };
  3736. static int parse_reg_rule(struct nlattr *tb[],
  3737. struct ieee80211_reg_rule *reg_rule)
  3738. {
  3739. struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
  3740. struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
  3741. if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
  3742. return -EINVAL;
  3743. if (!tb[NL80211_ATTR_FREQ_RANGE_START])
  3744. return -EINVAL;
  3745. if (!tb[NL80211_ATTR_FREQ_RANGE_END])
  3746. return -EINVAL;
  3747. if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
  3748. return -EINVAL;
  3749. if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
  3750. return -EINVAL;
  3751. reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
  3752. freq_range->start_freq_khz =
  3753. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
  3754. freq_range->end_freq_khz =
  3755. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
  3756. freq_range->max_bandwidth_khz =
  3757. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
  3758. power_rule->max_eirp =
  3759. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
  3760. if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
  3761. power_rule->max_antenna_gain =
  3762. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
  3763. return 0;
  3764. }
  3765. static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
  3766. {
  3767. int r;
  3768. char *data = NULL;
  3769. enum nl80211_user_reg_hint_type user_reg_hint_type;
  3770. /*
  3771. * You should only get this when cfg80211 hasn't yet initialized
  3772. * completely when built-in to the kernel right between the time
  3773. * window between nl80211_init() and regulatory_init(), if that is
  3774. * even possible.
  3775. */
  3776. if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
  3777. return -EINPROGRESS;
  3778. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  3779. return -EINVAL;
  3780. data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  3781. if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
  3782. user_reg_hint_type =
  3783. nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
  3784. else
  3785. user_reg_hint_type = NL80211_USER_REG_HINT_USER;
  3786. switch (user_reg_hint_type) {
  3787. case NL80211_USER_REG_HINT_USER:
  3788. case NL80211_USER_REG_HINT_CELL_BASE:
  3789. break;
  3790. default:
  3791. return -EINVAL;
  3792. }
  3793. r = regulatory_hint_user(data, user_reg_hint_type);
  3794. return r;
  3795. }
  3796. static int nl80211_get_mesh_config(struct sk_buff *skb,
  3797. struct genl_info *info)
  3798. {
  3799. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3800. struct net_device *dev = info->user_ptr[1];
  3801. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3802. struct mesh_config cur_params;
  3803. int err = 0;
  3804. void *hdr;
  3805. struct nlattr *pinfoattr;
  3806. struct sk_buff *msg;
  3807. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  3808. return -EOPNOTSUPP;
  3809. if (!rdev->ops->get_mesh_config)
  3810. return -EOPNOTSUPP;
  3811. wdev_lock(wdev);
  3812. /* If not connected, get default parameters */
  3813. if (!wdev->mesh_id_len)
  3814. memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
  3815. else
  3816. err = rdev_get_mesh_config(rdev, dev, &cur_params);
  3817. wdev_unlock(wdev);
  3818. if (err)
  3819. return err;
  3820. /* Draw up a netlink message to send back */
  3821. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3822. if (!msg)
  3823. return -ENOMEM;
  3824. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  3825. NL80211_CMD_GET_MESH_CONFIG);
  3826. if (!hdr)
  3827. goto out;
  3828. pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
  3829. if (!pinfoattr)
  3830. goto nla_put_failure;
  3831. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  3832. nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
  3833. cur_params.dot11MeshRetryTimeout) ||
  3834. nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
  3835. cur_params.dot11MeshConfirmTimeout) ||
  3836. nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
  3837. cur_params.dot11MeshHoldingTimeout) ||
  3838. nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
  3839. cur_params.dot11MeshMaxPeerLinks) ||
  3840. nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
  3841. cur_params.dot11MeshMaxRetries) ||
  3842. nla_put_u8(msg, NL80211_MESHCONF_TTL,
  3843. cur_params.dot11MeshTTL) ||
  3844. nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
  3845. cur_params.element_ttl) ||
  3846. nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  3847. cur_params.auto_open_plinks) ||
  3848. nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
  3849. cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
  3850. nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  3851. cur_params.dot11MeshHWMPmaxPREQretries) ||
  3852. nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
  3853. cur_params.path_refresh_time) ||
  3854. nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  3855. cur_params.min_discovery_timeout) ||
  3856. nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  3857. cur_params.dot11MeshHWMPactivePathTimeout) ||
  3858. nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  3859. cur_params.dot11MeshHWMPpreqMinInterval) ||
  3860. nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
  3861. cur_params.dot11MeshHWMPperrMinInterval) ||
  3862. nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  3863. cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
  3864. nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
  3865. cur_params.dot11MeshHWMPRootMode) ||
  3866. nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
  3867. cur_params.dot11MeshHWMPRannInterval) ||
  3868. nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
  3869. cur_params.dot11MeshGateAnnouncementProtocol) ||
  3870. nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
  3871. cur_params.dot11MeshForwarding) ||
  3872. nla_put_u32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
  3873. cur_params.rssi_threshold) ||
  3874. nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
  3875. cur_params.ht_opmode) ||
  3876. nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
  3877. cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
  3878. nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
  3879. cur_params.dot11MeshHWMProotInterval) ||
  3880. nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
  3881. cur_params.dot11MeshHWMPconfirmationInterval) ||
  3882. nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
  3883. cur_params.power_mode) ||
  3884. nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
  3885. cur_params.dot11MeshAwakeWindowDuration))
  3886. goto nla_put_failure;
  3887. nla_nest_end(msg, pinfoattr);
  3888. genlmsg_end(msg, hdr);
  3889. return genlmsg_reply(msg, info);
  3890. nla_put_failure:
  3891. genlmsg_cancel(msg, hdr);
  3892. out:
  3893. nlmsg_free(msg);
  3894. return -ENOBUFS;
  3895. }
  3896. static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
  3897. [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
  3898. [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
  3899. [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
  3900. [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
  3901. [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
  3902. [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
  3903. [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
  3904. [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
  3905. [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
  3906. [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
  3907. [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
  3908. [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
  3909. [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
  3910. [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
  3911. [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
  3912. [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
  3913. [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
  3914. [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
  3915. [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
  3916. [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
  3917. [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
  3918. [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
  3919. [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
  3920. [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
  3921. [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
  3922. [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
  3923. [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
  3924. };
  3925. static const struct nla_policy
  3926. nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
  3927. [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
  3928. [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
  3929. [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
  3930. [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
  3931. [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
  3932. [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
  3933. .len = IEEE80211_MAX_DATA_LEN },
  3934. [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
  3935. };
  3936. static int nl80211_parse_mesh_config(struct genl_info *info,
  3937. struct mesh_config *cfg,
  3938. u32 *mask_out)
  3939. {
  3940. struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
  3941. u32 mask = 0;
  3942. #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
  3943. do { \
  3944. if (tb[attr]) { \
  3945. if (fn(tb[attr]) < min || fn(tb[attr]) > max) \
  3946. return -EINVAL; \
  3947. cfg->param = fn(tb[attr]); \
  3948. mask |= (1 << (attr - 1)); \
  3949. } \
  3950. } while (0)
  3951. if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
  3952. return -EINVAL;
  3953. if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
  3954. info->attrs[NL80211_ATTR_MESH_CONFIG],
  3955. nl80211_meshconf_params_policy))
  3956. return -EINVAL;
  3957. /* This makes sure that there aren't more than 32 mesh config
  3958. * parameters (otherwise our bitfield scheme would not work.) */
  3959. BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
  3960. /* Fill in the params struct */
  3961. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
  3962. mask, NL80211_MESHCONF_RETRY_TIMEOUT,
  3963. nla_get_u16);
  3964. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
  3965. mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
  3966. nla_get_u16);
  3967. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
  3968. mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
  3969. nla_get_u16);
  3970. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
  3971. mask, NL80211_MESHCONF_MAX_PEER_LINKS,
  3972. nla_get_u16);
  3973. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
  3974. mask, NL80211_MESHCONF_MAX_RETRIES,
  3975. nla_get_u8);
  3976. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
  3977. mask, NL80211_MESHCONF_TTL, nla_get_u8);
  3978. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
  3979. mask, NL80211_MESHCONF_ELEMENT_TTL,
  3980. nla_get_u8);
  3981. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
  3982. mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  3983. nla_get_u8);
  3984. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
  3985. 1, 255, mask,
  3986. NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
  3987. nla_get_u32);
  3988. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
  3989. mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  3990. nla_get_u8);
  3991. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
  3992. mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
  3993. nla_get_u32);
  3994. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
  3995. mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  3996. nla_get_u16);
  3997. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
  3998. 1, 65535, mask,
  3999. NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  4000. nla_get_u32);
  4001. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
  4002. 1, 65535, mask,
  4003. NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  4004. nla_get_u16);
  4005. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
  4006. 1, 65535, mask,
  4007. NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
  4008. nla_get_u16);
  4009. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  4010. dot11MeshHWMPnetDiameterTraversalTime,
  4011. 1, 65535, mask,
  4012. NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  4013. nla_get_u16);
  4014. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
  4015. mask, NL80211_MESHCONF_HWMP_ROOTMODE,
  4016. nla_get_u8);
  4017. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
  4018. mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
  4019. nla_get_u16);
  4020. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  4021. dot11MeshGateAnnouncementProtocol, 0, 1,
  4022. mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
  4023. nla_get_u8);
  4024. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
  4025. mask, NL80211_MESHCONF_FORWARDING,
  4026. nla_get_u8);
  4027. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, 1, 255,
  4028. mask, NL80211_MESHCONF_RSSI_THRESHOLD,
  4029. nla_get_u32);
  4030. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, ht_opmode, 0, 16,
  4031. mask, NL80211_MESHCONF_HT_OPMODE,
  4032. nla_get_u16);
  4033. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
  4034. 1, 65535, mask,
  4035. NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
  4036. nla_get_u32);
  4037. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
  4038. mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
  4039. nla_get_u16);
  4040. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  4041. dot11MeshHWMPconfirmationInterval,
  4042. 1, 65535, mask,
  4043. NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
  4044. nla_get_u16);
  4045. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
  4046. NL80211_MESH_POWER_ACTIVE,
  4047. NL80211_MESH_POWER_MAX,
  4048. mask, NL80211_MESHCONF_POWER_MODE,
  4049. nla_get_u32);
  4050. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
  4051. 0, 65535, mask,
  4052. NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16);
  4053. if (mask_out)
  4054. *mask_out = mask;
  4055. return 0;
  4056. #undef FILL_IN_MESH_PARAM_IF_SET
  4057. }
  4058. static int nl80211_parse_mesh_setup(struct genl_info *info,
  4059. struct mesh_setup *setup)
  4060. {
  4061. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4062. struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
  4063. if (!info->attrs[NL80211_ATTR_MESH_SETUP])
  4064. return -EINVAL;
  4065. if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
  4066. info->attrs[NL80211_ATTR_MESH_SETUP],
  4067. nl80211_mesh_setup_params_policy))
  4068. return -EINVAL;
  4069. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
  4070. setup->sync_method =
  4071. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
  4072. IEEE80211_SYNC_METHOD_VENDOR :
  4073. IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
  4074. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
  4075. setup->path_sel_proto =
  4076. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
  4077. IEEE80211_PATH_PROTOCOL_VENDOR :
  4078. IEEE80211_PATH_PROTOCOL_HWMP;
  4079. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
  4080. setup->path_metric =
  4081. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
  4082. IEEE80211_PATH_METRIC_VENDOR :
  4083. IEEE80211_PATH_METRIC_AIRTIME;
  4084. if (tb[NL80211_MESH_SETUP_IE]) {
  4085. struct nlattr *ieattr =
  4086. tb[NL80211_MESH_SETUP_IE];
  4087. if (!is_valid_ie_attr(ieattr))
  4088. return -EINVAL;
  4089. setup->ie = nla_data(ieattr);
  4090. setup->ie_len = nla_len(ieattr);
  4091. }
  4092. if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
  4093. !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
  4094. return -EINVAL;
  4095. setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
  4096. setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
  4097. setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
  4098. if (setup->is_secure)
  4099. setup->user_mpm = true;
  4100. return 0;
  4101. }
  4102. static int nl80211_update_mesh_config(struct sk_buff *skb,
  4103. struct genl_info *info)
  4104. {
  4105. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4106. struct net_device *dev = info->user_ptr[1];
  4107. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4108. struct mesh_config cfg;
  4109. u32 mask;
  4110. int err;
  4111. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  4112. return -EOPNOTSUPP;
  4113. if (!rdev->ops->update_mesh_config)
  4114. return -EOPNOTSUPP;
  4115. err = nl80211_parse_mesh_config(info, &cfg, &mask);
  4116. if (err)
  4117. return err;
  4118. wdev_lock(wdev);
  4119. if (!wdev->mesh_id_len)
  4120. err = -ENOLINK;
  4121. if (!err)
  4122. err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
  4123. wdev_unlock(wdev);
  4124. return err;
  4125. }
  4126. static int nl80211_get_reg(struct sk_buff *skb, struct genl_info *info)
  4127. {
  4128. const struct ieee80211_regdomain *regdom;
  4129. struct sk_buff *msg;
  4130. void *hdr = NULL;
  4131. struct nlattr *nl_reg_rules;
  4132. unsigned int i;
  4133. int err = -EINVAL;
  4134. mutex_lock(&cfg80211_mutex);
  4135. if (!cfg80211_regdomain)
  4136. goto out;
  4137. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4138. if (!msg) {
  4139. err = -ENOBUFS;
  4140. goto out;
  4141. }
  4142. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  4143. NL80211_CMD_GET_REG);
  4144. if (!hdr)
  4145. goto put_failure;
  4146. if (reg_last_request_cell_base() &&
  4147. nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
  4148. NL80211_USER_REG_HINT_CELL_BASE))
  4149. goto nla_put_failure;
  4150. rcu_read_lock();
  4151. regdom = rcu_dereference(cfg80211_regdomain);
  4152. if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
  4153. (regdom->dfs_region &&
  4154. nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
  4155. goto nla_put_failure_rcu;
  4156. nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
  4157. if (!nl_reg_rules)
  4158. goto nla_put_failure_rcu;
  4159. for (i = 0; i < regdom->n_reg_rules; i++) {
  4160. struct nlattr *nl_reg_rule;
  4161. const struct ieee80211_reg_rule *reg_rule;
  4162. const struct ieee80211_freq_range *freq_range;
  4163. const struct ieee80211_power_rule *power_rule;
  4164. reg_rule = &regdom->reg_rules[i];
  4165. freq_range = &reg_rule->freq_range;
  4166. power_rule = &reg_rule->power_rule;
  4167. nl_reg_rule = nla_nest_start(msg, i);
  4168. if (!nl_reg_rule)
  4169. goto nla_put_failure_rcu;
  4170. if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
  4171. reg_rule->flags) ||
  4172. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
  4173. freq_range->start_freq_khz) ||
  4174. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
  4175. freq_range->end_freq_khz) ||
  4176. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
  4177. freq_range->max_bandwidth_khz) ||
  4178. nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
  4179. power_rule->max_antenna_gain) ||
  4180. nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
  4181. power_rule->max_eirp))
  4182. goto nla_put_failure_rcu;
  4183. nla_nest_end(msg, nl_reg_rule);
  4184. }
  4185. rcu_read_unlock();
  4186. nla_nest_end(msg, nl_reg_rules);
  4187. genlmsg_end(msg, hdr);
  4188. err = genlmsg_reply(msg, info);
  4189. goto out;
  4190. nla_put_failure_rcu:
  4191. rcu_read_unlock();
  4192. nla_put_failure:
  4193. genlmsg_cancel(msg, hdr);
  4194. put_failure:
  4195. nlmsg_free(msg);
  4196. err = -EMSGSIZE;
  4197. out:
  4198. mutex_unlock(&cfg80211_mutex);
  4199. return err;
  4200. }
  4201. static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
  4202. {
  4203. struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
  4204. struct nlattr *nl_reg_rule;
  4205. char *alpha2 = NULL;
  4206. int rem_reg_rules = 0, r = 0;
  4207. u32 num_rules = 0, rule_idx = 0, size_of_regd;
  4208. u8 dfs_region = 0;
  4209. struct ieee80211_regdomain *rd = NULL;
  4210. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  4211. return -EINVAL;
  4212. if (!info->attrs[NL80211_ATTR_REG_RULES])
  4213. return -EINVAL;
  4214. alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  4215. if (info->attrs[NL80211_ATTR_DFS_REGION])
  4216. dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
  4217. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  4218. rem_reg_rules) {
  4219. num_rules++;
  4220. if (num_rules > NL80211_MAX_SUPP_REG_RULES)
  4221. return -EINVAL;
  4222. }
  4223. size_of_regd = sizeof(struct ieee80211_regdomain) +
  4224. num_rules * sizeof(struct ieee80211_reg_rule);
  4225. rd = kzalloc(size_of_regd, GFP_KERNEL);
  4226. if (!rd)
  4227. return -ENOMEM;
  4228. rd->n_reg_rules = num_rules;
  4229. rd->alpha2[0] = alpha2[0];
  4230. rd->alpha2[1] = alpha2[1];
  4231. /*
  4232. * Disable DFS master mode if the DFS region was
  4233. * not supported or known on this kernel.
  4234. */
  4235. if (reg_supported_dfs_region(dfs_region))
  4236. rd->dfs_region = dfs_region;
  4237. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  4238. rem_reg_rules) {
  4239. nla_parse(tb, NL80211_REG_RULE_ATTR_MAX,
  4240. nla_data(nl_reg_rule), nla_len(nl_reg_rule),
  4241. reg_rule_policy);
  4242. r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
  4243. if (r)
  4244. goto bad_reg;
  4245. rule_idx++;
  4246. if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
  4247. r = -EINVAL;
  4248. goto bad_reg;
  4249. }
  4250. }
  4251. mutex_lock(&cfg80211_mutex);
  4252. r = set_regdom(rd);
  4253. /* set_regdom took ownership */
  4254. rd = NULL;
  4255. mutex_unlock(&cfg80211_mutex);
  4256. bad_reg:
  4257. kfree(rd);
  4258. return r;
  4259. }
  4260. static int validate_scan_freqs(struct nlattr *freqs)
  4261. {
  4262. struct nlattr *attr1, *attr2;
  4263. int n_channels = 0, tmp1, tmp2;
  4264. nla_for_each_nested(attr1, freqs, tmp1) {
  4265. n_channels++;
  4266. /*
  4267. * Some hardware has a limited channel list for
  4268. * scanning, and it is pretty much nonsensical
  4269. * to scan for a channel twice, so disallow that
  4270. * and don't require drivers to check that the
  4271. * channel list they get isn't longer than what
  4272. * they can scan, as long as they can scan all
  4273. * the channels they registered at once.
  4274. */
  4275. nla_for_each_nested(attr2, freqs, tmp2)
  4276. if (attr1 != attr2 &&
  4277. nla_get_u32(attr1) == nla_get_u32(attr2))
  4278. return 0;
  4279. }
  4280. return n_channels;
  4281. }
  4282. static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
  4283. {
  4284. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4285. struct wireless_dev *wdev = info->user_ptr[1];
  4286. struct cfg80211_scan_request *request;
  4287. struct nlattr *attr;
  4288. struct wiphy *wiphy;
  4289. int err, tmp, n_ssids = 0, n_channels, i;
  4290. size_t ie_len;
  4291. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  4292. return -EINVAL;
  4293. wiphy = &rdev->wiphy;
  4294. if (!rdev->ops->scan)
  4295. return -EOPNOTSUPP;
  4296. mutex_lock(&rdev->sched_scan_mtx);
  4297. if (rdev->scan_req) {
  4298. err = -EBUSY;
  4299. goto unlock;
  4300. }
  4301. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  4302. n_channels = validate_scan_freqs(
  4303. info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
  4304. if (!n_channels) {
  4305. err = -EINVAL;
  4306. goto unlock;
  4307. }
  4308. } else {
  4309. enum ieee80211_band band;
  4310. n_channels = 0;
  4311. for (band = 0; band < IEEE80211_NUM_BANDS; band++)
  4312. if (wiphy->bands[band])
  4313. n_channels += wiphy->bands[band]->n_channels;
  4314. }
  4315. if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
  4316. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
  4317. n_ssids++;
  4318. if (n_ssids > wiphy->max_scan_ssids) {
  4319. err = -EINVAL;
  4320. goto unlock;
  4321. }
  4322. if (info->attrs[NL80211_ATTR_IE])
  4323. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  4324. else
  4325. ie_len = 0;
  4326. if (ie_len > wiphy->max_scan_ie_len) {
  4327. err = -EINVAL;
  4328. goto unlock;
  4329. }
  4330. request = kzalloc(sizeof(*request)
  4331. + sizeof(*request->ssids) * n_ssids
  4332. + sizeof(*request->channels) * n_channels
  4333. + ie_len, GFP_KERNEL);
  4334. if (!request) {
  4335. err = -ENOMEM;
  4336. goto unlock;
  4337. }
  4338. if (n_ssids)
  4339. request->ssids = (void *)&request->channels[n_channels];
  4340. request->n_ssids = n_ssids;
  4341. if (ie_len) {
  4342. if (request->ssids)
  4343. request->ie = (void *)(request->ssids + n_ssids);
  4344. else
  4345. request->ie = (void *)(request->channels + n_channels);
  4346. }
  4347. i = 0;
  4348. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  4349. /* user specified, bail out if channel not found */
  4350. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
  4351. struct ieee80211_channel *chan;
  4352. chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
  4353. if (!chan) {
  4354. err = -EINVAL;
  4355. goto out_free;
  4356. }
  4357. /* ignore disabled channels */
  4358. if (chan->flags & IEEE80211_CHAN_DISABLED)
  4359. continue;
  4360. request->channels[i] = chan;
  4361. i++;
  4362. }
  4363. } else {
  4364. enum ieee80211_band band;
  4365. /* all channels */
  4366. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  4367. int j;
  4368. if (!wiphy->bands[band])
  4369. continue;
  4370. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  4371. struct ieee80211_channel *chan;
  4372. chan = &wiphy->bands[band]->channels[j];
  4373. if (chan->flags & IEEE80211_CHAN_DISABLED)
  4374. continue;
  4375. request->channels[i] = chan;
  4376. i++;
  4377. }
  4378. }
  4379. }
  4380. if (!i) {
  4381. err = -EINVAL;
  4382. goto out_free;
  4383. }
  4384. request->n_channels = i;
  4385. i = 0;
  4386. if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
  4387. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
  4388. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  4389. err = -EINVAL;
  4390. goto out_free;
  4391. }
  4392. request->ssids[i].ssid_len = nla_len(attr);
  4393. memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
  4394. i++;
  4395. }
  4396. }
  4397. if (info->attrs[NL80211_ATTR_IE]) {
  4398. request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  4399. memcpy((void *)request->ie,
  4400. nla_data(info->attrs[NL80211_ATTR_IE]),
  4401. request->ie_len);
  4402. }
  4403. for (i = 0; i < IEEE80211_NUM_BANDS; i++)
  4404. if (wiphy->bands[i])
  4405. request->rates[i] =
  4406. (1 << wiphy->bands[i]->n_bitrates) - 1;
  4407. if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
  4408. nla_for_each_nested(attr,
  4409. info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
  4410. tmp) {
  4411. enum ieee80211_band band = nla_type(attr);
  4412. if (band < 0 || band >= IEEE80211_NUM_BANDS) {
  4413. err = -EINVAL;
  4414. goto out_free;
  4415. }
  4416. err = ieee80211_get_ratemask(wiphy->bands[band],
  4417. nla_data(attr),
  4418. nla_len(attr),
  4419. &request->rates[band]);
  4420. if (err)
  4421. goto out_free;
  4422. }
  4423. }
  4424. if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
  4425. request->flags = nla_get_u32(
  4426. info->attrs[NL80211_ATTR_SCAN_FLAGS]);
  4427. if (((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
  4428. !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
  4429. ((request->flags & NL80211_SCAN_FLAG_FLUSH) &&
  4430. !(wiphy->features & NL80211_FEATURE_SCAN_FLUSH))) {
  4431. err = -EOPNOTSUPP;
  4432. goto out_free;
  4433. }
  4434. }
  4435. request->no_cck =
  4436. nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
  4437. request->wdev = wdev;
  4438. request->wiphy = &rdev->wiphy;
  4439. request->scan_start = jiffies;
  4440. rdev->scan_req = request;
  4441. err = rdev_scan(rdev, request);
  4442. if (!err) {
  4443. nl80211_send_scan_start(rdev, wdev);
  4444. if (wdev->netdev)
  4445. dev_hold(wdev->netdev);
  4446. } else {
  4447. out_free:
  4448. rdev->scan_req = NULL;
  4449. kfree(request);
  4450. }
  4451. unlock:
  4452. mutex_unlock(&rdev->sched_scan_mtx);
  4453. return err;
  4454. }
  4455. static int nl80211_start_sched_scan(struct sk_buff *skb,
  4456. struct genl_info *info)
  4457. {
  4458. struct cfg80211_sched_scan_request *request;
  4459. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4460. struct net_device *dev = info->user_ptr[1];
  4461. struct nlattr *attr;
  4462. struct wiphy *wiphy;
  4463. int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i;
  4464. u32 interval;
  4465. enum ieee80211_band band;
  4466. size_t ie_len;
  4467. struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
  4468. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
  4469. !rdev->ops->sched_scan_start)
  4470. return -EOPNOTSUPP;
  4471. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  4472. return -EINVAL;
  4473. if (!info->attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
  4474. return -EINVAL;
  4475. interval = nla_get_u32(info->attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
  4476. if (interval == 0)
  4477. return -EINVAL;
  4478. wiphy = &rdev->wiphy;
  4479. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  4480. n_channels = validate_scan_freqs(
  4481. info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
  4482. if (!n_channels)
  4483. return -EINVAL;
  4484. } else {
  4485. n_channels = 0;
  4486. for (band = 0; band < IEEE80211_NUM_BANDS; band++)
  4487. if (wiphy->bands[band])
  4488. n_channels += wiphy->bands[band]->n_channels;
  4489. }
  4490. if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
  4491. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS],
  4492. tmp)
  4493. n_ssids++;
  4494. if (n_ssids > wiphy->max_sched_scan_ssids)
  4495. return -EINVAL;
  4496. if (info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH])
  4497. nla_for_each_nested(attr,
  4498. info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
  4499. tmp)
  4500. n_match_sets++;
  4501. if (n_match_sets > wiphy->max_match_sets)
  4502. return -EINVAL;
  4503. if (info->attrs[NL80211_ATTR_IE])
  4504. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  4505. else
  4506. ie_len = 0;
  4507. if (ie_len > wiphy->max_sched_scan_ie_len)
  4508. return -EINVAL;
  4509. mutex_lock(&rdev->sched_scan_mtx);
  4510. if (rdev->sched_scan_req) {
  4511. err = -EINPROGRESS;
  4512. goto out;
  4513. }
  4514. request = kzalloc(sizeof(*request)
  4515. + sizeof(*request->ssids) * n_ssids
  4516. + sizeof(*request->match_sets) * n_match_sets
  4517. + sizeof(*request->channels) * n_channels
  4518. + ie_len, GFP_KERNEL);
  4519. if (!request) {
  4520. err = -ENOMEM;
  4521. goto out;
  4522. }
  4523. if (n_ssids)
  4524. request->ssids = (void *)&request->channels[n_channels];
  4525. request->n_ssids = n_ssids;
  4526. if (ie_len) {
  4527. if (request->ssids)
  4528. request->ie = (void *)(request->ssids + n_ssids);
  4529. else
  4530. request->ie = (void *)(request->channels + n_channels);
  4531. }
  4532. if (n_match_sets) {
  4533. if (request->ie)
  4534. request->match_sets = (void *)(request->ie + ie_len);
  4535. else if (request->ssids)
  4536. request->match_sets =
  4537. (void *)(request->ssids + n_ssids);
  4538. else
  4539. request->match_sets =
  4540. (void *)(request->channels + n_channels);
  4541. }
  4542. request->n_match_sets = n_match_sets;
  4543. i = 0;
  4544. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  4545. /* user specified, bail out if channel not found */
  4546. nla_for_each_nested(attr,
  4547. info->attrs[NL80211_ATTR_SCAN_FREQUENCIES],
  4548. tmp) {
  4549. struct ieee80211_channel *chan;
  4550. chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
  4551. if (!chan) {
  4552. err = -EINVAL;
  4553. goto out_free;
  4554. }
  4555. /* ignore disabled channels */
  4556. if (chan->flags & IEEE80211_CHAN_DISABLED)
  4557. continue;
  4558. request->channels[i] = chan;
  4559. i++;
  4560. }
  4561. } else {
  4562. /* all channels */
  4563. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  4564. int j;
  4565. if (!wiphy->bands[band])
  4566. continue;
  4567. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  4568. struct ieee80211_channel *chan;
  4569. chan = &wiphy->bands[band]->channels[j];
  4570. if (chan->flags & IEEE80211_CHAN_DISABLED)
  4571. continue;
  4572. request->channels[i] = chan;
  4573. i++;
  4574. }
  4575. }
  4576. }
  4577. if (!i) {
  4578. err = -EINVAL;
  4579. goto out_free;
  4580. }
  4581. request->n_channels = i;
  4582. i = 0;
  4583. if (info->attrs[NL80211_ATTR_SCAN_SSIDS]) {
  4584. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS],
  4585. tmp) {
  4586. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  4587. err = -EINVAL;
  4588. goto out_free;
  4589. }
  4590. request->ssids[i].ssid_len = nla_len(attr);
  4591. memcpy(request->ssids[i].ssid, nla_data(attr),
  4592. nla_len(attr));
  4593. i++;
  4594. }
  4595. }
  4596. i = 0;
  4597. if (info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
  4598. nla_for_each_nested(attr,
  4599. info->attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
  4600. tmp) {
  4601. struct nlattr *ssid, *rssi;
  4602. nla_parse(tb, NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
  4603. nla_data(attr), nla_len(attr),
  4604. nl80211_match_policy);
  4605. ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
  4606. if (ssid) {
  4607. if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
  4608. err = -EINVAL;
  4609. goto out_free;
  4610. }
  4611. memcpy(request->match_sets[i].ssid.ssid,
  4612. nla_data(ssid), nla_len(ssid));
  4613. request->match_sets[i].ssid.ssid_len =
  4614. nla_len(ssid);
  4615. }
  4616. rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
  4617. if (rssi)
  4618. request->rssi_thold = nla_get_u32(rssi);
  4619. else
  4620. request->rssi_thold =
  4621. NL80211_SCAN_RSSI_THOLD_OFF;
  4622. i++;
  4623. }
  4624. }
  4625. if (info->attrs[NL80211_ATTR_IE]) {
  4626. request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  4627. memcpy((void *)request->ie,
  4628. nla_data(info->attrs[NL80211_ATTR_IE]),
  4629. request->ie_len);
  4630. }
  4631. if (info->attrs[NL80211_ATTR_SCAN_FLAGS]) {
  4632. request->flags = nla_get_u32(
  4633. info->attrs[NL80211_ATTR_SCAN_FLAGS]);
  4634. if (((request->flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
  4635. !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
  4636. ((request->flags & NL80211_SCAN_FLAG_FLUSH) &&
  4637. !(wiphy->features & NL80211_FEATURE_SCAN_FLUSH))) {
  4638. err = -EOPNOTSUPP;
  4639. goto out_free;
  4640. }
  4641. }
  4642. request->dev = dev;
  4643. request->wiphy = &rdev->wiphy;
  4644. request->interval = interval;
  4645. request->scan_start = jiffies;
  4646. err = rdev_sched_scan_start(rdev, dev, request);
  4647. if (!err) {
  4648. rdev->sched_scan_req = request;
  4649. nl80211_send_sched_scan(rdev, dev,
  4650. NL80211_CMD_START_SCHED_SCAN);
  4651. goto out;
  4652. }
  4653. out_free:
  4654. kfree(request);
  4655. out:
  4656. mutex_unlock(&rdev->sched_scan_mtx);
  4657. return err;
  4658. }
  4659. static int nl80211_stop_sched_scan(struct sk_buff *skb,
  4660. struct genl_info *info)
  4661. {
  4662. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4663. int err;
  4664. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_SCHED_SCAN) ||
  4665. !rdev->ops->sched_scan_stop)
  4666. return -EOPNOTSUPP;
  4667. mutex_lock(&rdev->sched_scan_mtx);
  4668. err = __cfg80211_stop_sched_scan(rdev, false);
  4669. mutex_unlock(&rdev->sched_scan_mtx);
  4670. return err;
  4671. }
  4672. static int nl80211_start_radar_detection(struct sk_buff *skb,
  4673. struct genl_info *info)
  4674. {
  4675. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4676. struct net_device *dev = info->user_ptr[1];
  4677. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4678. struct cfg80211_chan_def chandef;
  4679. int err;
  4680. err = nl80211_parse_chandef(rdev, info, &chandef);
  4681. if (err)
  4682. return err;
  4683. if (wdev->cac_started)
  4684. return -EBUSY;
  4685. err = cfg80211_chandef_dfs_required(wdev->wiphy, &chandef);
  4686. if (err < 0)
  4687. return err;
  4688. if (err == 0)
  4689. return -EINVAL;
  4690. if (chandef.chan->dfs_state != NL80211_DFS_USABLE)
  4691. return -EINVAL;
  4692. if (!rdev->ops->start_radar_detection)
  4693. return -EOPNOTSUPP;
  4694. mutex_lock(&rdev->devlist_mtx);
  4695. err = cfg80211_can_use_iftype_chan(rdev, wdev, wdev->iftype,
  4696. chandef.chan, CHAN_MODE_SHARED,
  4697. BIT(chandef.width));
  4698. if (err)
  4699. goto err_locked;
  4700. err = rdev->ops->start_radar_detection(&rdev->wiphy, dev, &chandef);
  4701. if (!err) {
  4702. wdev->channel = chandef.chan;
  4703. wdev->cac_started = true;
  4704. wdev->cac_start_time = jiffies;
  4705. }
  4706. err_locked:
  4707. mutex_unlock(&rdev->devlist_mtx);
  4708. return err;
  4709. }
  4710. static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
  4711. u32 seq, int flags,
  4712. struct cfg80211_registered_device *rdev,
  4713. struct wireless_dev *wdev,
  4714. struct cfg80211_internal_bss *intbss)
  4715. {
  4716. struct cfg80211_bss *res = &intbss->pub;
  4717. const struct cfg80211_bss_ies *ies;
  4718. void *hdr;
  4719. struct nlattr *bss;
  4720. bool tsf = false;
  4721. ASSERT_WDEV_LOCK(wdev);
  4722. hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
  4723. NL80211_CMD_NEW_SCAN_RESULTS);
  4724. if (!hdr)
  4725. return -1;
  4726. genl_dump_check_consistent(cb, hdr, &nl80211_fam);
  4727. if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
  4728. goto nla_put_failure;
  4729. if (wdev->netdev &&
  4730. nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
  4731. goto nla_put_failure;
  4732. if (nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
  4733. goto nla_put_failure;
  4734. bss = nla_nest_start(msg, NL80211_ATTR_BSS);
  4735. if (!bss)
  4736. goto nla_put_failure;
  4737. if ((!is_zero_ether_addr(res->bssid) &&
  4738. nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
  4739. goto nla_put_failure;
  4740. rcu_read_lock();
  4741. ies = rcu_dereference(res->ies);
  4742. if (ies) {
  4743. if (nla_put_u64(msg, NL80211_BSS_TSF, ies->tsf))
  4744. goto fail_unlock_rcu;
  4745. tsf = true;
  4746. if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
  4747. ies->len, ies->data))
  4748. goto fail_unlock_rcu;
  4749. }
  4750. ies = rcu_dereference(res->beacon_ies);
  4751. if (ies) {
  4752. if (!tsf && nla_put_u64(msg, NL80211_BSS_TSF, ies->tsf))
  4753. goto fail_unlock_rcu;
  4754. if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
  4755. ies->len, ies->data))
  4756. goto fail_unlock_rcu;
  4757. }
  4758. rcu_read_unlock();
  4759. if (res->beacon_interval &&
  4760. nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
  4761. goto nla_put_failure;
  4762. if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
  4763. nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
  4764. nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
  4765. jiffies_to_msecs(jiffies - intbss->ts)))
  4766. goto nla_put_failure;
  4767. switch (rdev->wiphy.signal_type) {
  4768. case CFG80211_SIGNAL_TYPE_MBM:
  4769. if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
  4770. goto nla_put_failure;
  4771. break;
  4772. case CFG80211_SIGNAL_TYPE_UNSPEC:
  4773. if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
  4774. goto nla_put_failure;
  4775. break;
  4776. default:
  4777. break;
  4778. }
  4779. switch (wdev->iftype) {
  4780. case NL80211_IFTYPE_P2P_CLIENT:
  4781. case NL80211_IFTYPE_STATION:
  4782. if (intbss == wdev->current_bss &&
  4783. nla_put_u32(msg, NL80211_BSS_STATUS,
  4784. NL80211_BSS_STATUS_ASSOCIATED))
  4785. goto nla_put_failure;
  4786. break;
  4787. case NL80211_IFTYPE_ADHOC:
  4788. if (intbss == wdev->current_bss &&
  4789. nla_put_u32(msg, NL80211_BSS_STATUS,
  4790. NL80211_BSS_STATUS_IBSS_JOINED))
  4791. goto nla_put_failure;
  4792. break;
  4793. default:
  4794. break;
  4795. }
  4796. nla_nest_end(msg, bss);
  4797. return genlmsg_end(msg, hdr);
  4798. fail_unlock_rcu:
  4799. rcu_read_unlock();
  4800. nla_put_failure:
  4801. genlmsg_cancel(msg, hdr);
  4802. return -EMSGSIZE;
  4803. }
  4804. static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
  4805. {
  4806. struct cfg80211_registered_device *rdev;
  4807. struct cfg80211_internal_bss *scan;
  4808. struct wireless_dev *wdev;
  4809. int start = cb->args[2], idx = 0;
  4810. int err;
  4811. err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
  4812. if (err)
  4813. return err;
  4814. wdev_lock(wdev);
  4815. spin_lock_bh(&rdev->bss_lock);
  4816. cfg80211_bss_expire(rdev);
  4817. cb->seq = rdev->bss_generation;
  4818. list_for_each_entry(scan, &rdev->bss_list, list) {
  4819. if (++idx <= start)
  4820. continue;
  4821. if (nl80211_send_bss(skb, cb,
  4822. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  4823. rdev, wdev, scan) < 0) {
  4824. idx--;
  4825. break;
  4826. }
  4827. }
  4828. spin_unlock_bh(&rdev->bss_lock);
  4829. wdev_unlock(wdev);
  4830. cb->args[2] = idx;
  4831. nl80211_finish_wdev_dump(rdev);
  4832. return skb->len;
  4833. }
  4834. static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
  4835. int flags, struct net_device *dev,
  4836. struct survey_info *survey)
  4837. {
  4838. void *hdr;
  4839. struct nlattr *infoattr;
  4840. hdr = nl80211hdr_put(msg, portid, seq, flags,
  4841. NL80211_CMD_NEW_SURVEY_RESULTS);
  4842. if (!hdr)
  4843. return -ENOMEM;
  4844. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  4845. goto nla_put_failure;
  4846. infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
  4847. if (!infoattr)
  4848. goto nla_put_failure;
  4849. if (nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
  4850. survey->channel->center_freq))
  4851. goto nla_put_failure;
  4852. if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
  4853. nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
  4854. goto nla_put_failure;
  4855. if ((survey->filled & SURVEY_INFO_IN_USE) &&
  4856. nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
  4857. goto nla_put_failure;
  4858. if ((survey->filled & SURVEY_INFO_CHANNEL_TIME) &&
  4859. nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME,
  4860. survey->channel_time))
  4861. goto nla_put_failure;
  4862. if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_BUSY) &&
  4863. nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_BUSY,
  4864. survey->channel_time_busy))
  4865. goto nla_put_failure;
  4866. if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_EXT_BUSY) &&
  4867. nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_EXT_BUSY,
  4868. survey->channel_time_ext_busy))
  4869. goto nla_put_failure;
  4870. if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_RX) &&
  4871. nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_RX,
  4872. survey->channel_time_rx))
  4873. goto nla_put_failure;
  4874. if ((survey->filled & SURVEY_INFO_CHANNEL_TIME_TX) &&
  4875. nla_put_u64(msg, NL80211_SURVEY_INFO_CHANNEL_TIME_TX,
  4876. survey->channel_time_tx))
  4877. goto nla_put_failure;
  4878. nla_nest_end(msg, infoattr);
  4879. return genlmsg_end(msg, hdr);
  4880. nla_put_failure:
  4881. genlmsg_cancel(msg, hdr);
  4882. return -EMSGSIZE;
  4883. }
  4884. static int nl80211_dump_survey(struct sk_buff *skb,
  4885. struct netlink_callback *cb)
  4886. {
  4887. struct survey_info survey;
  4888. struct cfg80211_registered_device *dev;
  4889. struct wireless_dev *wdev;
  4890. int survey_idx = cb->args[2];
  4891. int res;
  4892. res = nl80211_prepare_wdev_dump(skb, cb, &dev, &wdev);
  4893. if (res)
  4894. return res;
  4895. if (!wdev->netdev) {
  4896. res = -EINVAL;
  4897. goto out_err;
  4898. }
  4899. if (!dev->ops->dump_survey) {
  4900. res = -EOPNOTSUPP;
  4901. goto out_err;
  4902. }
  4903. while (1) {
  4904. struct ieee80211_channel *chan;
  4905. res = rdev_dump_survey(dev, wdev->netdev, survey_idx, &survey);
  4906. if (res == -ENOENT)
  4907. break;
  4908. if (res)
  4909. goto out_err;
  4910. /* Survey without a channel doesn't make sense */
  4911. if (!survey.channel) {
  4912. res = -EINVAL;
  4913. goto out;
  4914. }
  4915. chan = ieee80211_get_channel(&dev->wiphy,
  4916. survey.channel->center_freq);
  4917. if (!chan || chan->flags & IEEE80211_CHAN_DISABLED) {
  4918. survey_idx++;
  4919. continue;
  4920. }
  4921. if (nl80211_send_survey(skb,
  4922. NETLINK_CB(cb->skb).portid,
  4923. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  4924. wdev->netdev, &survey) < 0)
  4925. goto out;
  4926. survey_idx++;
  4927. }
  4928. out:
  4929. cb->args[2] = survey_idx;
  4930. res = skb->len;
  4931. out_err:
  4932. nl80211_finish_wdev_dump(dev);
  4933. return res;
  4934. }
  4935. static bool nl80211_valid_wpa_versions(u32 wpa_versions)
  4936. {
  4937. return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
  4938. NL80211_WPA_VERSION_2));
  4939. }
  4940. static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
  4941. {
  4942. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4943. struct net_device *dev = info->user_ptr[1];
  4944. struct ieee80211_channel *chan;
  4945. const u8 *bssid, *ssid, *ie = NULL, *sae_data = NULL;
  4946. int err, ssid_len, ie_len = 0, sae_data_len = 0;
  4947. enum nl80211_auth_type auth_type;
  4948. struct key_parse key;
  4949. bool local_state_change;
  4950. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  4951. return -EINVAL;
  4952. if (!info->attrs[NL80211_ATTR_MAC])
  4953. return -EINVAL;
  4954. if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
  4955. return -EINVAL;
  4956. if (!info->attrs[NL80211_ATTR_SSID])
  4957. return -EINVAL;
  4958. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  4959. return -EINVAL;
  4960. err = nl80211_parse_key(info, &key);
  4961. if (err)
  4962. return err;
  4963. if (key.idx >= 0) {
  4964. if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
  4965. return -EINVAL;
  4966. if (!key.p.key || !key.p.key_len)
  4967. return -EINVAL;
  4968. if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
  4969. key.p.key_len != WLAN_KEY_LEN_WEP40) &&
  4970. (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
  4971. key.p.key_len != WLAN_KEY_LEN_WEP104))
  4972. return -EINVAL;
  4973. if (key.idx > 4)
  4974. return -EINVAL;
  4975. } else {
  4976. key.p.key_len = 0;
  4977. key.p.key = NULL;
  4978. }
  4979. if (key.idx >= 0) {
  4980. int i;
  4981. bool ok = false;
  4982. for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
  4983. if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
  4984. ok = true;
  4985. break;
  4986. }
  4987. }
  4988. if (!ok)
  4989. return -EINVAL;
  4990. }
  4991. if (!rdev->ops->auth)
  4992. return -EOPNOTSUPP;
  4993. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  4994. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  4995. return -EOPNOTSUPP;
  4996. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4997. chan = ieee80211_get_channel(&rdev->wiphy,
  4998. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  4999. if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED))
  5000. return -EINVAL;
  5001. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  5002. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  5003. if (info->attrs[NL80211_ATTR_IE]) {
  5004. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  5005. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  5006. }
  5007. auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  5008. if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
  5009. return -EINVAL;
  5010. if (auth_type == NL80211_AUTHTYPE_SAE &&
  5011. !info->attrs[NL80211_ATTR_SAE_DATA])
  5012. return -EINVAL;
  5013. if (info->attrs[NL80211_ATTR_SAE_DATA]) {
  5014. if (auth_type != NL80211_AUTHTYPE_SAE)
  5015. return -EINVAL;
  5016. sae_data = nla_data(info->attrs[NL80211_ATTR_SAE_DATA]);
  5017. sae_data_len = nla_len(info->attrs[NL80211_ATTR_SAE_DATA]);
  5018. /* need to include at least Auth Transaction and Status Code */
  5019. if (sae_data_len < 4)
  5020. return -EINVAL;
  5021. }
  5022. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  5023. /*
  5024. * Since we no longer track auth state, ignore
  5025. * requests to only change local state.
  5026. */
  5027. if (local_state_change)
  5028. return 0;
  5029. return cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
  5030. ssid, ssid_len, ie, ie_len,
  5031. key.p.key, key.p.key_len, key.idx,
  5032. sae_data, sae_data_len);
  5033. }
  5034. static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  5035. struct genl_info *info,
  5036. struct cfg80211_crypto_settings *settings,
  5037. int cipher_limit)
  5038. {
  5039. memset(settings, 0, sizeof(*settings));
  5040. settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
  5041. if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
  5042. u16 proto;
  5043. proto = nla_get_u16(
  5044. info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
  5045. settings->control_port_ethertype = cpu_to_be16(proto);
  5046. if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  5047. proto != ETH_P_PAE)
  5048. return -EINVAL;
  5049. if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
  5050. settings->control_port_no_encrypt = true;
  5051. } else
  5052. settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
  5053. if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
  5054. void *data;
  5055. int len, i;
  5056. data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  5057. len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  5058. settings->n_ciphers_pairwise = len / sizeof(u32);
  5059. if (len % sizeof(u32))
  5060. return -EINVAL;
  5061. if (settings->n_ciphers_pairwise > cipher_limit)
  5062. return -EINVAL;
  5063. memcpy(settings->ciphers_pairwise, data, len);
  5064. for (i = 0; i < settings->n_ciphers_pairwise; i++)
  5065. if (!cfg80211_supported_cipher_suite(
  5066. &rdev->wiphy,
  5067. settings->ciphers_pairwise[i]))
  5068. return -EINVAL;
  5069. }
  5070. if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
  5071. settings->cipher_group =
  5072. nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
  5073. if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
  5074. settings->cipher_group))
  5075. return -EINVAL;
  5076. }
  5077. if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
  5078. settings->wpa_versions =
  5079. nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
  5080. if (!nl80211_valid_wpa_versions(settings->wpa_versions))
  5081. return -EINVAL;
  5082. }
  5083. if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
  5084. void *data;
  5085. int len;
  5086. data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
  5087. len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
  5088. settings->n_akm_suites = len / sizeof(u32);
  5089. if (len % sizeof(u32))
  5090. return -EINVAL;
  5091. if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
  5092. return -EINVAL;
  5093. memcpy(settings->akm_suites, data, len);
  5094. }
  5095. return 0;
  5096. }
  5097. static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
  5098. {
  5099. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5100. struct net_device *dev = info->user_ptr[1];
  5101. struct ieee80211_channel *chan;
  5102. struct cfg80211_assoc_request req = {};
  5103. const u8 *bssid, *ssid;
  5104. int err, ssid_len = 0;
  5105. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  5106. return -EINVAL;
  5107. if (!info->attrs[NL80211_ATTR_MAC] ||
  5108. !info->attrs[NL80211_ATTR_SSID] ||
  5109. !info->attrs[NL80211_ATTR_WIPHY_FREQ])
  5110. return -EINVAL;
  5111. if (!rdev->ops->assoc)
  5112. return -EOPNOTSUPP;
  5113. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  5114. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  5115. return -EOPNOTSUPP;
  5116. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5117. chan = ieee80211_get_channel(&rdev->wiphy,
  5118. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  5119. if (!chan || (chan->flags & IEEE80211_CHAN_DISABLED))
  5120. return -EINVAL;
  5121. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  5122. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  5123. if (info->attrs[NL80211_ATTR_IE]) {
  5124. req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  5125. req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  5126. }
  5127. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  5128. enum nl80211_mfp mfp =
  5129. nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  5130. if (mfp == NL80211_MFP_REQUIRED)
  5131. req.use_mfp = true;
  5132. else if (mfp != NL80211_MFP_NO)
  5133. return -EINVAL;
  5134. }
  5135. if (info->attrs[NL80211_ATTR_PREV_BSSID])
  5136. req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
  5137. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
  5138. req.flags |= ASSOC_REQ_DISABLE_HT;
  5139. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  5140. memcpy(&req.ht_capa_mask,
  5141. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  5142. sizeof(req.ht_capa_mask));
  5143. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  5144. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  5145. return -EINVAL;
  5146. memcpy(&req.ht_capa,
  5147. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  5148. sizeof(req.ht_capa));
  5149. }
  5150. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
  5151. req.flags |= ASSOC_REQ_DISABLE_VHT;
  5152. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  5153. memcpy(&req.vht_capa_mask,
  5154. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
  5155. sizeof(req.vht_capa_mask));
  5156. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
  5157. if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  5158. return -EINVAL;
  5159. memcpy(&req.vht_capa,
  5160. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
  5161. sizeof(req.vht_capa));
  5162. }
  5163. err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
  5164. if (!err)
  5165. err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
  5166. ssid, ssid_len, &req);
  5167. return err;
  5168. }
  5169. static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
  5170. {
  5171. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5172. struct net_device *dev = info->user_ptr[1];
  5173. const u8 *ie = NULL, *bssid;
  5174. int ie_len = 0;
  5175. u16 reason_code;
  5176. bool local_state_change;
  5177. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  5178. return -EINVAL;
  5179. if (!info->attrs[NL80211_ATTR_MAC])
  5180. return -EINVAL;
  5181. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  5182. return -EINVAL;
  5183. if (!rdev->ops->deauth)
  5184. return -EOPNOTSUPP;
  5185. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  5186. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  5187. return -EOPNOTSUPP;
  5188. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5189. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  5190. if (reason_code == 0) {
  5191. /* Reason Code 0 is reserved */
  5192. return -EINVAL;
  5193. }
  5194. if (info->attrs[NL80211_ATTR_IE]) {
  5195. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  5196. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  5197. }
  5198. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  5199. return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
  5200. local_state_change);
  5201. }
  5202. static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
  5203. {
  5204. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5205. struct net_device *dev = info->user_ptr[1];
  5206. const u8 *ie = NULL, *bssid;
  5207. int ie_len = 0;
  5208. u16 reason_code;
  5209. bool local_state_change;
  5210. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  5211. return -EINVAL;
  5212. if (!info->attrs[NL80211_ATTR_MAC])
  5213. return -EINVAL;
  5214. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  5215. return -EINVAL;
  5216. if (!rdev->ops->disassoc)
  5217. return -EOPNOTSUPP;
  5218. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  5219. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  5220. return -EOPNOTSUPP;
  5221. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5222. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  5223. if (reason_code == 0) {
  5224. /* Reason Code 0 is reserved */
  5225. return -EINVAL;
  5226. }
  5227. if (info->attrs[NL80211_ATTR_IE]) {
  5228. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  5229. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  5230. }
  5231. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  5232. return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
  5233. local_state_change);
  5234. }
  5235. static bool
  5236. nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
  5237. int mcast_rate[IEEE80211_NUM_BANDS],
  5238. int rateval)
  5239. {
  5240. struct wiphy *wiphy = &rdev->wiphy;
  5241. bool found = false;
  5242. int band, i;
  5243. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  5244. struct ieee80211_supported_band *sband;
  5245. sband = wiphy->bands[band];
  5246. if (!sband)
  5247. continue;
  5248. for (i = 0; i < sband->n_bitrates; i++) {
  5249. if (sband->bitrates[i].bitrate == rateval) {
  5250. mcast_rate[band] = i + 1;
  5251. found = true;
  5252. break;
  5253. }
  5254. }
  5255. }
  5256. return found;
  5257. }
  5258. static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
  5259. {
  5260. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5261. struct net_device *dev = info->user_ptr[1];
  5262. struct cfg80211_ibss_params ibss;
  5263. struct wiphy *wiphy;
  5264. struct cfg80211_cached_keys *connkeys = NULL;
  5265. int err;
  5266. memset(&ibss, 0, sizeof(ibss));
  5267. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  5268. return -EINVAL;
  5269. if (!info->attrs[NL80211_ATTR_SSID] ||
  5270. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  5271. return -EINVAL;
  5272. ibss.beacon_interval = 100;
  5273. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
  5274. ibss.beacon_interval =
  5275. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  5276. if (ibss.beacon_interval < 1 || ibss.beacon_interval > 10000)
  5277. return -EINVAL;
  5278. }
  5279. if (!rdev->ops->join_ibss)
  5280. return -EOPNOTSUPP;
  5281. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  5282. return -EOPNOTSUPP;
  5283. wiphy = &rdev->wiphy;
  5284. if (info->attrs[NL80211_ATTR_MAC]) {
  5285. ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5286. if (!is_valid_ether_addr(ibss.bssid))
  5287. return -EINVAL;
  5288. }
  5289. ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  5290. ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  5291. if (info->attrs[NL80211_ATTR_IE]) {
  5292. ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  5293. ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  5294. }
  5295. err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
  5296. if (err)
  5297. return err;
  5298. if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef))
  5299. return -EINVAL;
  5300. if (ibss.chandef.width > NL80211_CHAN_WIDTH_40)
  5301. return -EINVAL;
  5302. if (ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
  5303. !(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
  5304. return -EINVAL;
  5305. ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
  5306. ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  5307. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  5308. u8 *rates =
  5309. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  5310. int n_rates =
  5311. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  5312. struct ieee80211_supported_band *sband =
  5313. wiphy->bands[ibss.chandef.chan->band];
  5314. err = ieee80211_get_ratemask(sband, rates, n_rates,
  5315. &ibss.basic_rates);
  5316. if (err)
  5317. return err;
  5318. }
  5319. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  5320. !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
  5321. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  5322. return -EINVAL;
  5323. if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  5324. bool no_ht = false;
  5325. connkeys = nl80211_parse_connkeys(rdev,
  5326. info->attrs[NL80211_ATTR_KEYS],
  5327. &no_ht);
  5328. if (IS_ERR(connkeys))
  5329. return PTR_ERR(connkeys);
  5330. if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
  5331. no_ht) {
  5332. kfree(connkeys);
  5333. return -EINVAL;
  5334. }
  5335. }
  5336. ibss.control_port =
  5337. nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
  5338. err = cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
  5339. if (err)
  5340. kfree(connkeys);
  5341. return err;
  5342. }
  5343. static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
  5344. {
  5345. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5346. struct net_device *dev = info->user_ptr[1];
  5347. if (!rdev->ops->leave_ibss)
  5348. return -EOPNOTSUPP;
  5349. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  5350. return -EOPNOTSUPP;
  5351. return cfg80211_leave_ibss(rdev, dev, false);
  5352. }
  5353. static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
  5354. {
  5355. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5356. struct net_device *dev = info->user_ptr[1];
  5357. int mcast_rate[IEEE80211_NUM_BANDS];
  5358. u32 nla_rate;
  5359. int err;
  5360. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
  5361. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  5362. return -EOPNOTSUPP;
  5363. if (!rdev->ops->set_mcast_rate)
  5364. return -EOPNOTSUPP;
  5365. memset(mcast_rate, 0, sizeof(mcast_rate));
  5366. if (!info->attrs[NL80211_ATTR_MCAST_RATE])
  5367. return -EINVAL;
  5368. nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
  5369. if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
  5370. return -EINVAL;
  5371. err = rdev->ops->set_mcast_rate(&rdev->wiphy, dev, mcast_rate);
  5372. return err;
  5373. }
  5374. #ifdef CONFIG_NL80211_TESTMODE
  5375. static struct genl_multicast_group nl80211_testmode_mcgrp = {
  5376. .name = "testmode",
  5377. };
  5378. static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
  5379. {
  5380. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5381. int err;
  5382. if (!info->attrs[NL80211_ATTR_TESTDATA])
  5383. return -EINVAL;
  5384. err = -EOPNOTSUPP;
  5385. if (rdev->ops->testmode_cmd) {
  5386. rdev->testmode_info = info;
  5387. err = rdev_testmode_cmd(rdev,
  5388. nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
  5389. nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
  5390. rdev->testmode_info = NULL;
  5391. }
  5392. return err;
  5393. }
  5394. static int nl80211_testmode_dump(struct sk_buff *skb,
  5395. struct netlink_callback *cb)
  5396. {
  5397. struct cfg80211_registered_device *rdev;
  5398. int err;
  5399. long phy_idx;
  5400. void *data = NULL;
  5401. int data_len = 0;
  5402. if (cb->args[0]) {
  5403. /*
  5404. * 0 is a valid index, but not valid for args[0],
  5405. * so we need to offset by 1.
  5406. */
  5407. phy_idx = cb->args[0] - 1;
  5408. } else {
  5409. err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
  5410. nl80211_fam.attrbuf, nl80211_fam.maxattr,
  5411. nl80211_policy);
  5412. if (err)
  5413. return err;
  5414. mutex_lock(&cfg80211_mutex);
  5415. rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk),
  5416. nl80211_fam.attrbuf);
  5417. if (IS_ERR(rdev)) {
  5418. mutex_unlock(&cfg80211_mutex);
  5419. return PTR_ERR(rdev);
  5420. }
  5421. phy_idx = rdev->wiphy_idx;
  5422. rdev = NULL;
  5423. mutex_unlock(&cfg80211_mutex);
  5424. if (nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA])
  5425. cb->args[1] =
  5426. (long)nl80211_fam.attrbuf[NL80211_ATTR_TESTDATA];
  5427. }
  5428. if (cb->args[1]) {
  5429. data = nla_data((void *)cb->args[1]);
  5430. data_len = nla_len((void *)cb->args[1]);
  5431. }
  5432. mutex_lock(&cfg80211_mutex);
  5433. rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
  5434. if (!rdev) {
  5435. mutex_unlock(&cfg80211_mutex);
  5436. return -ENOENT;
  5437. }
  5438. cfg80211_lock_rdev(rdev);
  5439. mutex_unlock(&cfg80211_mutex);
  5440. if (!rdev->ops->testmode_dump) {
  5441. err = -EOPNOTSUPP;
  5442. goto out_err;
  5443. }
  5444. while (1) {
  5445. void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
  5446. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  5447. NL80211_CMD_TESTMODE);
  5448. struct nlattr *tmdata;
  5449. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
  5450. genlmsg_cancel(skb, hdr);
  5451. break;
  5452. }
  5453. tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
  5454. if (!tmdata) {
  5455. genlmsg_cancel(skb, hdr);
  5456. break;
  5457. }
  5458. err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
  5459. nla_nest_end(skb, tmdata);
  5460. if (err == -ENOBUFS || err == -ENOENT) {
  5461. genlmsg_cancel(skb, hdr);
  5462. break;
  5463. } else if (err) {
  5464. genlmsg_cancel(skb, hdr);
  5465. goto out_err;
  5466. }
  5467. genlmsg_end(skb, hdr);
  5468. }
  5469. err = skb->len;
  5470. /* see above */
  5471. cb->args[0] = phy_idx + 1;
  5472. out_err:
  5473. cfg80211_unlock_rdev(rdev);
  5474. return err;
  5475. }
  5476. static struct sk_buff *
  5477. __cfg80211_testmode_alloc_skb(struct cfg80211_registered_device *rdev,
  5478. int approxlen, u32 portid, u32 seq, gfp_t gfp)
  5479. {
  5480. struct sk_buff *skb;
  5481. void *hdr;
  5482. struct nlattr *data;
  5483. skb = nlmsg_new(approxlen + 100, gfp);
  5484. if (!skb)
  5485. return NULL;
  5486. hdr = nl80211hdr_put(skb, portid, seq, 0, NL80211_CMD_TESTMODE);
  5487. if (!hdr) {
  5488. kfree_skb(skb);
  5489. return NULL;
  5490. }
  5491. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  5492. goto nla_put_failure;
  5493. data = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
  5494. ((void **)skb->cb)[0] = rdev;
  5495. ((void **)skb->cb)[1] = hdr;
  5496. ((void **)skb->cb)[2] = data;
  5497. return skb;
  5498. nla_put_failure:
  5499. kfree_skb(skb);
  5500. return NULL;
  5501. }
  5502. struct sk_buff *cfg80211_testmode_alloc_reply_skb(struct wiphy *wiphy,
  5503. int approxlen)
  5504. {
  5505. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  5506. if (WARN_ON(!rdev->testmode_info))
  5507. return NULL;
  5508. return __cfg80211_testmode_alloc_skb(rdev, approxlen,
  5509. rdev->testmode_info->snd_portid,
  5510. rdev->testmode_info->snd_seq,
  5511. GFP_KERNEL);
  5512. }
  5513. EXPORT_SYMBOL(cfg80211_testmode_alloc_reply_skb);
  5514. int cfg80211_testmode_reply(struct sk_buff *skb)
  5515. {
  5516. struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
  5517. void *hdr = ((void **)skb->cb)[1];
  5518. struct nlattr *data = ((void **)skb->cb)[2];
  5519. if (WARN_ON(!rdev->testmode_info)) {
  5520. kfree_skb(skb);
  5521. return -EINVAL;
  5522. }
  5523. nla_nest_end(skb, data);
  5524. genlmsg_end(skb, hdr);
  5525. return genlmsg_reply(skb, rdev->testmode_info);
  5526. }
  5527. EXPORT_SYMBOL(cfg80211_testmode_reply);
  5528. struct sk_buff *cfg80211_testmode_alloc_event_skb(struct wiphy *wiphy,
  5529. int approxlen, gfp_t gfp)
  5530. {
  5531. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  5532. return __cfg80211_testmode_alloc_skb(rdev, approxlen, 0, 0, gfp);
  5533. }
  5534. EXPORT_SYMBOL(cfg80211_testmode_alloc_event_skb);
  5535. void cfg80211_testmode_event(struct sk_buff *skb, gfp_t gfp)
  5536. {
  5537. void *hdr = ((void **)skb->cb)[1];
  5538. struct nlattr *data = ((void **)skb->cb)[2];
  5539. nla_nest_end(skb, data);
  5540. genlmsg_end(skb, hdr);
  5541. genlmsg_multicast(skb, 0, nl80211_testmode_mcgrp.id, gfp);
  5542. }
  5543. EXPORT_SYMBOL(cfg80211_testmode_event);
  5544. #endif
  5545. static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
  5546. {
  5547. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5548. struct net_device *dev = info->user_ptr[1];
  5549. struct cfg80211_connect_params connect;
  5550. struct wiphy *wiphy;
  5551. struct cfg80211_cached_keys *connkeys = NULL;
  5552. int err;
  5553. memset(&connect, 0, sizeof(connect));
  5554. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  5555. return -EINVAL;
  5556. if (!info->attrs[NL80211_ATTR_SSID] ||
  5557. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  5558. return -EINVAL;
  5559. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  5560. connect.auth_type =
  5561. nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  5562. if (!nl80211_valid_auth_type(rdev, connect.auth_type,
  5563. NL80211_CMD_CONNECT))
  5564. return -EINVAL;
  5565. } else
  5566. connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  5567. connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
  5568. err = nl80211_crypto_settings(rdev, info, &connect.crypto,
  5569. NL80211_MAX_NR_CIPHER_SUITES);
  5570. if (err)
  5571. return err;
  5572. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  5573. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  5574. return -EOPNOTSUPP;
  5575. wiphy = &rdev->wiphy;
  5576. connect.bg_scan_period = -1;
  5577. if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
  5578. (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
  5579. connect.bg_scan_period =
  5580. nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
  5581. }
  5582. if (info->attrs[NL80211_ATTR_MAC])
  5583. connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5584. connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  5585. connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  5586. if (info->attrs[NL80211_ATTR_IE]) {
  5587. connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  5588. connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  5589. }
  5590. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  5591. connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  5592. if (connect.mfp != NL80211_MFP_REQUIRED &&
  5593. connect.mfp != NL80211_MFP_NO)
  5594. return -EINVAL;
  5595. } else {
  5596. connect.mfp = NL80211_MFP_NO;
  5597. }
  5598. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  5599. connect.channel =
  5600. ieee80211_get_channel(wiphy,
  5601. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  5602. if (!connect.channel ||
  5603. connect.channel->flags & IEEE80211_CHAN_DISABLED)
  5604. return -EINVAL;
  5605. }
  5606. if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  5607. connkeys = nl80211_parse_connkeys(rdev,
  5608. info->attrs[NL80211_ATTR_KEYS], NULL);
  5609. if (IS_ERR(connkeys))
  5610. return PTR_ERR(connkeys);
  5611. }
  5612. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
  5613. connect.flags |= ASSOC_REQ_DISABLE_HT;
  5614. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  5615. memcpy(&connect.ht_capa_mask,
  5616. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  5617. sizeof(connect.ht_capa_mask));
  5618. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  5619. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
  5620. kfree(connkeys);
  5621. return -EINVAL;
  5622. }
  5623. memcpy(&connect.ht_capa,
  5624. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  5625. sizeof(connect.ht_capa));
  5626. }
  5627. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
  5628. connect.flags |= ASSOC_REQ_DISABLE_VHT;
  5629. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  5630. memcpy(&connect.vht_capa_mask,
  5631. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
  5632. sizeof(connect.vht_capa_mask));
  5633. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
  5634. if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
  5635. kfree(connkeys);
  5636. return -EINVAL;
  5637. }
  5638. memcpy(&connect.vht_capa,
  5639. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
  5640. sizeof(connect.vht_capa));
  5641. }
  5642. err = cfg80211_connect(rdev, dev, &connect, connkeys);
  5643. if (err)
  5644. kfree(connkeys);
  5645. return err;
  5646. }
  5647. static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
  5648. {
  5649. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5650. struct net_device *dev = info->user_ptr[1];
  5651. u16 reason;
  5652. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  5653. reason = WLAN_REASON_DEAUTH_LEAVING;
  5654. else
  5655. reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  5656. if (reason == 0)
  5657. return -EINVAL;
  5658. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  5659. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  5660. return -EOPNOTSUPP;
  5661. return cfg80211_disconnect(rdev, dev, reason, true);
  5662. }
  5663. static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
  5664. {
  5665. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5666. struct net *net;
  5667. int err;
  5668. u32 pid;
  5669. if (!info->attrs[NL80211_ATTR_PID])
  5670. return -EINVAL;
  5671. pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
  5672. net = get_net_ns_by_pid(pid);
  5673. if (IS_ERR(net))
  5674. return PTR_ERR(net);
  5675. err = 0;
  5676. /* check if anything to do */
  5677. if (!net_eq(wiphy_net(&rdev->wiphy), net))
  5678. err = cfg80211_switch_netns(rdev, net);
  5679. put_net(net);
  5680. return err;
  5681. }
  5682. static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
  5683. {
  5684. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5685. int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
  5686. struct cfg80211_pmksa *pmksa) = NULL;
  5687. struct net_device *dev = info->user_ptr[1];
  5688. struct cfg80211_pmksa pmksa;
  5689. memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
  5690. if (!info->attrs[NL80211_ATTR_MAC])
  5691. return -EINVAL;
  5692. if (!info->attrs[NL80211_ATTR_PMKID])
  5693. return -EINVAL;
  5694. pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  5695. pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5696. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  5697. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  5698. return -EOPNOTSUPP;
  5699. switch (info->genlhdr->cmd) {
  5700. case NL80211_CMD_SET_PMKSA:
  5701. rdev_ops = rdev->ops->set_pmksa;
  5702. break;
  5703. case NL80211_CMD_DEL_PMKSA:
  5704. rdev_ops = rdev->ops->del_pmksa;
  5705. break;
  5706. default:
  5707. WARN_ON(1);
  5708. break;
  5709. }
  5710. if (!rdev_ops)
  5711. return -EOPNOTSUPP;
  5712. return rdev_ops(&rdev->wiphy, dev, &pmksa);
  5713. }
  5714. static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
  5715. {
  5716. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5717. struct net_device *dev = info->user_ptr[1];
  5718. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  5719. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  5720. return -EOPNOTSUPP;
  5721. if (!rdev->ops->flush_pmksa)
  5722. return -EOPNOTSUPP;
  5723. return rdev_flush_pmksa(rdev, dev);
  5724. }
  5725. static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
  5726. {
  5727. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5728. struct net_device *dev = info->user_ptr[1];
  5729. u8 action_code, dialog_token;
  5730. u16 status_code;
  5731. u8 *peer;
  5732. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
  5733. !rdev->ops->tdls_mgmt)
  5734. return -EOPNOTSUPP;
  5735. if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
  5736. !info->attrs[NL80211_ATTR_STATUS_CODE] ||
  5737. !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
  5738. !info->attrs[NL80211_ATTR_IE] ||
  5739. !info->attrs[NL80211_ATTR_MAC])
  5740. return -EINVAL;
  5741. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5742. action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
  5743. status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  5744. dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
  5745. return rdev_tdls_mgmt(rdev, dev, peer, action_code,
  5746. dialog_token, status_code,
  5747. nla_data(info->attrs[NL80211_ATTR_IE]),
  5748. nla_len(info->attrs[NL80211_ATTR_IE]));
  5749. }
  5750. static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
  5751. {
  5752. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5753. struct net_device *dev = info->user_ptr[1];
  5754. enum nl80211_tdls_operation operation;
  5755. u8 *peer;
  5756. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
  5757. !rdev->ops->tdls_oper)
  5758. return -EOPNOTSUPP;
  5759. if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
  5760. !info->attrs[NL80211_ATTR_MAC])
  5761. return -EINVAL;
  5762. operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
  5763. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5764. return rdev_tdls_oper(rdev, dev, peer, operation);
  5765. }
  5766. static int nl80211_remain_on_channel(struct sk_buff *skb,
  5767. struct genl_info *info)
  5768. {
  5769. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5770. struct wireless_dev *wdev = info->user_ptr[1];
  5771. struct cfg80211_chan_def chandef;
  5772. struct sk_buff *msg;
  5773. void *hdr;
  5774. u64 cookie;
  5775. u32 duration;
  5776. int err;
  5777. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  5778. !info->attrs[NL80211_ATTR_DURATION])
  5779. return -EINVAL;
  5780. duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  5781. if (!rdev->ops->remain_on_channel ||
  5782. !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
  5783. return -EOPNOTSUPP;
  5784. /*
  5785. * We should be on that channel for at least a minimum amount of
  5786. * time (10ms) but no longer than the driver supports.
  5787. */
  5788. if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
  5789. duration > rdev->wiphy.max_remain_on_channel_duration)
  5790. return -EINVAL;
  5791. err = nl80211_parse_chandef(rdev, info, &chandef);
  5792. if (err)
  5793. return err;
  5794. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  5795. if (!msg)
  5796. return -ENOMEM;
  5797. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  5798. NL80211_CMD_REMAIN_ON_CHANNEL);
  5799. if (IS_ERR(hdr)) {
  5800. err = PTR_ERR(hdr);
  5801. goto free_msg;
  5802. }
  5803. err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
  5804. duration, &cookie);
  5805. if (err)
  5806. goto free_msg;
  5807. if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
  5808. goto nla_put_failure;
  5809. genlmsg_end(msg, hdr);
  5810. return genlmsg_reply(msg, info);
  5811. nla_put_failure:
  5812. err = -ENOBUFS;
  5813. free_msg:
  5814. nlmsg_free(msg);
  5815. return err;
  5816. }
  5817. static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
  5818. struct genl_info *info)
  5819. {
  5820. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5821. struct wireless_dev *wdev = info->user_ptr[1];
  5822. u64 cookie;
  5823. if (!info->attrs[NL80211_ATTR_COOKIE])
  5824. return -EINVAL;
  5825. if (!rdev->ops->cancel_remain_on_channel)
  5826. return -EOPNOTSUPP;
  5827. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  5828. return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
  5829. }
  5830. static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
  5831. u8 *rates, u8 rates_len)
  5832. {
  5833. u8 i;
  5834. u32 mask = 0;
  5835. for (i = 0; i < rates_len; i++) {
  5836. int rate = (rates[i] & 0x7f) * 5;
  5837. int ridx;
  5838. for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
  5839. struct ieee80211_rate *srate =
  5840. &sband->bitrates[ridx];
  5841. if (rate == srate->bitrate) {
  5842. mask |= 1 << ridx;
  5843. break;
  5844. }
  5845. }
  5846. if (ridx == sband->n_bitrates)
  5847. return 0; /* rate not found */
  5848. }
  5849. return mask;
  5850. }
  5851. static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
  5852. u8 *rates, u8 rates_len,
  5853. u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
  5854. {
  5855. u8 i;
  5856. memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
  5857. for (i = 0; i < rates_len; i++) {
  5858. int ridx, rbit;
  5859. ridx = rates[i] / 8;
  5860. rbit = BIT(rates[i] % 8);
  5861. /* check validity */
  5862. if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
  5863. return false;
  5864. /* check availability */
  5865. if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
  5866. mcs[ridx] |= rbit;
  5867. else
  5868. return false;
  5869. }
  5870. return true;
  5871. }
  5872. static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
  5873. [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
  5874. .len = NL80211_MAX_SUPP_RATES },
  5875. [NL80211_TXRATE_MCS] = { .type = NLA_BINARY,
  5876. .len = NL80211_MAX_SUPP_HT_RATES },
  5877. };
  5878. static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
  5879. struct genl_info *info)
  5880. {
  5881. struct nlattr *tb[NL80211_TXRATE_MAX + 1];
  5882. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5883. struct cfg80211_bitrate_mask mask;
  5884. int rem, i;
  5885. struct net_device *dev = info->user_ptr[1];
  5886. struct nlattr *tx_rates;
  5887. struct ieee80211_supported_band *sband;
  5888. if (info->attrs[NL80211_ATTR_TX_RATES] == NULL)
  5889. return -EINVAL;
  5890. if (!rdev->ops->set_bitrate_mask)
  5891. return -EOPNOTSUPP;
  5892. memset(&mask, 0, sizeof(mask));
  5893. /* Default to all rates enabled */
  5894. for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
  5895. sband = rdev->wiphy.bands[i];
  5896. mask.control[i].legacy =
  5897. sband ? (1 << sband->n_bitrates) - 1 : 0;
  5898. if (sband)
  5899. memcpy(mask.control[i].mcs,
  5900. sband->ht_cap.mcs.rx_mask,
  5901. sizeof(mask.control[i].mcs));
  5902. else
  5903. memset(mask.control[i].mcs, 0,
  5904. sizeof(mask.control[i].mcs));
  5905. }
  5906. /*
  5907. * The nested attribute uses enum nl80211_band as the index. This maps
  5908. * directly to the enum ieee80211_band values used in cfg80211.
  5909. */
  5910. BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
  5911. nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem)
  5912. {
  5913. enum ieee80211_band band = nla_type(tx_rates);
  5914. if (band < 0 || band >= IEEE80211_NUM_BANDS)
  5915. return -EINVAL;
  5916. sband = rdev->wiphy.bands[band];
  5917. if (sband == NULL)
  5918. return -EINVAL;
  5919. nla_parse(tb, NL80211_TXRATE_MAX, nla_data(tx_rates),
  5920. nla_len(tx_rates), nl80211_txattr_policy);
  5921. if (tb[NL80211_TXRATE_LEGACY]) {
  5922. mask.control[band].legacy = rateset_to_mask(
  5923. sband,
  5924. nla_data(tb[NL80211_TXRATE_LEGACY]),
  5925. nla_len(tb[NL80211_TXRATE_LEGACY]));
  5926. if ((mask.control[band].legacy == 0) &&
  5927. nla_len(tb[NL80211_TXRATE_LEGACY]))
  5928. return -EINVAL;
  5929. }
  5930. if (tb[NL80211_TXRATE_MCS]) {
  5931. if (!ht_rateset_to_mask(
  5932. sband,
  5933. nla_data(tb[NL80211_TXRATE_MCS]),
  5934. nla_len(tb[NL80211_TXRATE_MCS]),
  5935. mask.control[band].mcs))
  5936. return -EINVAL;
  5937. }
  5938. if (mask.control[band].legacy == 0) {
  5939. /* don't allow empty legacy rates if HT
  5940. * is not even supported. */
  5941. if (!rdev->wiphy.bands[band]->ht_cap.ht_supported)
  5942. return -EINVAL;
  5943. for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
  5944. if (mask.control[band].mcs[i])
  5945. break;
  5946. /* legacy and mcs rates may not be both empty */
  5947. if (i == IEEE80211_HT_MCS_MASK_LEN)
  5948. return -EINVAL;
  5949. }
  5950. }
  5951. return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
  5952. }
  5953. static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
  5954. {
  5955. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5956. struct wireless_dev *wdev = info->user_ptr[1];
  5957. u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
  5958. if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
  5959. return -EINVAL;
  5960. if (info->attrs[NL80211_ATTR_FRAME_TYPE])
  5961. frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
  5962. switch (wdev->iftype) {
  5963. case NL80211_IFTYPE_STATION:
  5964. case NL80211_IFTYPE_ADHOC:
  5965. case NL80211_IFTYPE_P2P_CLIENT:
  5966. case NL80211_IFTYPE_AP:
  5967. case NL80211_IFTYPE_AP_VLAN:
  5968. case NL80211_IFTYPE_MESH_POINT:
  5969. case NL80211_IFTYPE_P2P_GO:
  5970. case NL80211_IFTYPE_P2P_DEVICE:
  5971. break;
  5972. default:
  5973. return -EOPNOTSUPP;
  5974. }
  5975. /* not much point in registering if we can't reply */
  5976. if (!rdev->ops->mgmt_tx)
  5977. return -EOPNOTSUPP;
  5978. return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
  5979. nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
  5980. nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
  5981. }
  5982. static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
  5983. {
  5984. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5985. struct wireless_dev *wdev = info->user_ptr[1];
  5986. struct cfg80211_chan_def chandef;
  5987. int err;
  5988. void *hdr = NULL;
  5989. u64 cookie;
  5990. struct sk_buff *msg = NULL;
  5991. unsigned int wait = 0;
  5992. bool offchan, no_cck, dont_wait_for_ack;
  5993. dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK];
  5994. if (!info->attrs[NL80211_ATTR_FRAME])
  5995. return -EINVAL;
  5996. if (!rdev->ops->mgmt_tx)
  5997. return -EOPNOTSUPP;
  5998. switch (wdev->iftype) {
  5999. case NL80211_IFTYPE_STATION:
  6000. case NL80211_IFTYPE_ADHOC:
  6001. case NL80211_IFTYPE_P2P_CLIENT:
  6002. case NL80211_IFTYPE_AP:
  6003. case NL80211_IFTYPE_AP_VLAN:
  6004. case NL80211_IFTYPE_MESH_POINT:
  6005. case NL80211_IFTYPE_P2P_GO:
  6006. case NL80211_IFTYPE_P2P_DEVICE:
  6007. break;
  6008. default:
  6009. return -EOPNOTSUPP;
  6010. }
  6011. if (info->attrs[NL80211_ATTR_DURATION]) {
  6012. if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
  6013. return -EINVAL;
  6014. wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  6015. /*
  6016. * We should wait on the channel for at least a minimum amount
  6017. * of time (10ms) but no longer than the driver supports.
  6018. */
  6019. if (wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
  6020. wait > rdev->wiphy.max_remain_on_channel_duration)
  6021. return -EINVAL;
  6022. }
  6023. offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
  6024. if (offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
  6025. return -EINVAL;
  6026. no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
  6027. err = nl80211_parse_chandef(rdev, info, &chandef);
  6028. if (err)
  6029. return err;
  6030. if (!dont_wait_for_ack) {
  6031. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6032. if (!msg)
  6033. return -ENOMEM;
  6034. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  6035. NL80211_CMD_FRAME);
  6036. if (IS_ERR(hdr)) {
  6037. err = PTR_ERR(hdr);
  6038. goto free_msg;
  6039. }
  6040. }
  6041. err = cfg80211_mlme_mgmt_tx(rdev, wdev, chandef.chan, offchan, wait,
  6042. nla_data(info->attrs[NL80211_ATTR_FRAME]),
  6043. nla_len(info->attrs[NL80211_ATTR_FRAME]),
  6044. no_cck, dont_wait_for_ack, &cookie);
  6045. if (err)
  6046. goto free_msg;
  6047. if (msg) {
  6048. if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
  6049. goto nla_put_failure;
  6050. genlmsg_end(msg, hdr);
  6051. return genlmsg_reply(msg, info);
  6052. }
  6053. return 0;
  6054. nla_put_failure:
  6055. err = -ENOBUFS;
  6056. free_msg:
  6057. nlmsg_free(msg);
  6058. return err;
  6059. }
  6060. static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
  6061. {
  6062. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6063. struct wireless_dev *wdev = info->user_ptr[1];
  6064. u64 cookie;
  6065. if (!info->attrs[NL80211_ATTR_COOKIE])
  6066. return -EINVAL;
  6067. if (!rdev->ops->mgmt_tx_cancel_wait)
  6068. return -EOPNOTSUPP;
  6069. switch (wdev->iftype) {
  6070. case NL80211_IFTYPE_STATION:
  6071. case NL80211_IFTYPE_ADHOC:
  6072. case NL80211_IFTYPE_P2P_CLIENT:
  6073. case NL80211_IFTYPE_AP:
  6074. case NL80211_IFTYPE_AP_VLAN:
  6075. case NL80211_IFTYPE_P2P_GO:
  6076. case NL80211_IFTYPE_P2P_DEVICE:
  6077. break;
  6078. default:
  6079. return -EOPNOTSUPP;
  6080. }
  6081. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  6082. return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
  6083. }
  6084. static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
  6085. {
  6086. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6087. struct wireless_dev *wdev;
  6088. struct net_device *dev = info->user_ptr[1];
  6089. u8 ps_state;
  6090. bool state;
  6091. int err;
  6092. if (!info->attrs[NL80211_ATTR_PS_STATE])
  6093. return -EINVAL;
  6094. ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
  6095. if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
  6096. return -EINVAL;
  6097. wdev = dev->ieee80211_ptr;
  6098. if (!rdev->ops->set_power_mgmt)
  6099. return -EOPNOTSUPP;
  6100. state = (ps_state == NL80211_PS_ENABLED) ? true : false;
  6101. if (state == wdev->ps)
  6102. return 0;
  6103. err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
  6104. if (!err)
  6105. wdev->ps = state;
  6106. return err;
  6107. }
  6108. static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
  6109. {
  6110. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6111. enum nl80211_ps_state ps_state;
  6112. struct wireless_dev *wdev;
  6113. struct net_device *dev = info->user_ptr[1];
  6114. struct sk_buff *msg;
  6115. void *hdr;
  6116. int err;
  6117. wdev = dev->ieee80211_ptr;
  6118. if (!rdev->ops->set_power_mgmt)
  6119. return -EOPNOTSUPP;
  6120. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6121. if (!msg)
  6122. return -ENOMEM;
  6123. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  6124. NL80211_CMD_GET_POWER_SAVE);
  6125. if (!hdr) {
  6126. err = -ENOBUFS;
  6127. goto free_msg;
  6128. }
  6129. if (wdev->ps)
  6130. ps_state = NL80211_PS_ENABLED;
  6131. else
  6132. ps_state = NL80211_PS_DISABLED;
  6133. if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
  6134. goto nla_put_failure;
  6135. genlmsg_end(msg, hdr);
  6136. return genlmsg_reply(msg, info);
  6137. nla_put_failure:
  6138. err = -ENOBUFS;
  6139. free_msg:
  6140. nlmsg_free(msg);
  6141. return err;
  6142. }
  6143. static struct nla_policy
  6144. nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] __read_mostly = {
  6145. [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
  6146. [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
  6147. [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
  6148. [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
  6149. [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
  6150. [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
  6151. };
  6152. static int nl80211_set_cqm_txe(struct genl_info *info,
  6153. u32 rate, u32 pkts, u32 intvl)
  6154. {
  6155. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6156. struct wireless_dev *wdev;
  6157. struct net_device *dev = info->user_ptr[1];
  6158. if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
  6159. return -EINVAL;
  6160. wdev = dev->ieee80211_ptr;
  6161. if (!rdev->ops->set_cqm_txe_config)
  6162. return -EOPNOTSUPP;
  6163. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  6164. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  6165. return -EOPNOTSUPP;
  6166. return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
  6167. }
  6168. static int nl80211_set_cqm_rssi(struct genl_info *info,
  6169. s32 threshold, u32 hysteresis)
  6170. {
  6171. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6172. struct wireless_dev *wdev;
  6173. struct net_device *dev = info->user_ptr[1];
  6174. if (threshold > 0)
  6175. return -EINVAL;
  6176. wdev = dev->ieee80211_ptr;
  6177. if (!rdev->ops->set_cqm_rssi_config)
  6178. return -EOPNOTSUPP;
  6179. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  6180. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  6181. return -EOPNOTSUPP;
  6182. return rdev_set_cqm_rssi_config(rdev, dev, threshold, hysteresis);
  6183. }
  6184. static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
  6185. {
  6186. struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
  6187. struct nlattr *cqm;
  6188. int err;
  6189. cqm = info->attrs[NL80211_ATTR_CQM];
  6190. if (!cqm) {
  6191. err = -EINVAL;
  6192. goto out;
  6193. }
  6194. err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
  6195. nl80211_attr_cqm_policy);
  6196. if (err)
  6197. goto out;
  6198. if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
  6199. attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
  6200. s32 threshold;
  6201. u32 hysteresis;
  6202. threshold = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
  6203. hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
  6204. err = nl80211_set_cqm_rssi(info, threshold, hysteresis);
  6205. } else if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
  6206. attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
  6207. attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
  6208. u32 rate, pkts, intvl;
  6209. rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
  6210. pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
  6211. intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
  6212. err = nl80211_set_cqm_txe(info, rate, pkts, intvl);
  6213. } else
  6214. err = -EINVAL;
  6215. out:
  6216. return err;
  6217. }
  6218. static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
  6219. {
  6220. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6221. struct net_device *dev = info->user_ptr[1];
  6222. struct mesh_config cfg;
  6223. struct mesh_setup setup;
  6224. int err;
  6225. /* start with default */
  6226. memcpy(&cfg, &default_mesh_config, sizeof(cfg));
  6227. memcpy(&setup, &default_mesh_setup, sizeof(setup));
  6228. if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
  6229. /* and parse parameters if given */
  6230. err = nl80211_parse_mesh_config(info, &cfg, NULL);
  6231. if (err)
  6232. return err;
  6233. }
  6234. if (!info->attrs[NL80211_ATTR_MESH_ID] ||
  6235. !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
  6236. return -EINVAL;
  6237. setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
  6238. setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  6239. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  6240. !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
  6241. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  6242. return -EINVAL;
  6243. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
  6244. setup.beacon_interval =
  6245. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  6246. if (setup.beacon_interval < 10 ||
  6247. setup.beacon_interval > 10000)
  6248. return -EINVAL;
  6249. }
  6250. if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
  6251. setup.dtim_period =
  6252. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  6253. if (setup.dtim_period < 1 || setup.dtim_period > 100)
  6254. return -EINVAL;
  6255. }
  6256. if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
  6257. /* parse additional setup parameters if given */
  6258. err = nl80211_parse_mesh_setup(info, &setup);
  6259. if (err)
  6260. return err;
  6261. }
  6262. if (setup.user_mpm)
  6263. cfg.auto_open_plinks = false;
  6264. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  6265. err = nl80211_parse_chandef(rdev, info, &setup.chandef);
  6266. if (err)
  6267. return err;
  6268. } else {
  6269. /* cfg80211_join_mesh() will sort it out */
  6270. setup.chandef.chan = NULL;
  6271. }
  6272. return cfg80211_join_mesh(rdev, dev, &setup, &cfg);
  6273. }
  6274. static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
  6275. {
  6276. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6277. struct net_device *dev = info->user_ptr[1];
  6278. return cfg80211_leave_mesh(rdev, dev);
  6279. }
  6280. #ifdef CONFIG_PM
  6281. static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
  6282. struct cfg80211_registered_device *rdev)
  6283. {
  6284. struct nlattr *nl_pats, *nl_pat;
  6285. int i, pat_len;
  6286. if (!rdev->wowlan->n_patterns)
  6287. return 0;
  6288. nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
  6289. if (!nl_pats)
  6290. return -ENOBUFS;
  6291. for (i = 0; i < rdev->wowlan->n_patterns; i++) {
  6292. nl_pat = nla_nest_start(msg, i + 1);
  6293. if (!nl_pat)
  6294. return -ENOBUFS;
  6295. pat_len = rdev->wowlan->patterns[i].pattern_len;
  6296. if (nla_put(msg, NL80211_WOWLAN_PKTPAT_MASK,
  6297. DIV_ROUND_UP(pat_len, 8),
  6298. rdev->wowlan->patterns[i].mask) ||
  6299. nla_put(msg, NL80211_WOWLAN_PKTPAT_PATTERN,
  6300. pat_len, rdev->wowlan->patterns[i].pattern) ||
  6301. nla_put_u32(msg, NL80211_WOWLAN_PKTPAT_OFFSET,
  6302. rdev->wowlan->patterns[i].pkt_offset))
  6303. return -ENOBUFS;
  6304. nla_nest_end(msg, nl_pat);
  6305. }
  6306. nla_nest_end(msg, nl_pats);
  6307. return 0;
  6308. }
  6309. static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
  6310. struct cfg80211_wowlan_tcp *tcp)
  6311. {
  6312. struct nlattr *nl_tcp;
  6313. if (!tcp)
  6314. return 0;
  6315. nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
  6316. if (!nl_tcp)
  6317. return -ENOBUFS;
  6318. if (nla_put_be32(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
  6319. nla_put_be32(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
  6320. nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
  6321. nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
  6322. nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
  6323. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  6324. tcp->payload_len, tcp->payload) ||
  6325. nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
  6326. tcp->data_interval) ||
  6327. nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
  6328. tcp->wake_len, tcp->wake_data) ||
  6329. nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
  6330. DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
  6331. return -ENOBUFS;
  6332. if (tcp->payload_seq.len &&
  6333. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
  6334. sizeof(tcp->payload_seq), &tcp->payload_seq))
  6335. return -ENOBUFS;
  6336. if (tcp->payload_tok.len &&
  6337. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
  6338. sizeof(tcp->payload_tok) + tcp->tokens_size,
  6339. &tcp->payload_tok))
  6340. return -ENOBUFS;
  6341. nla_nest_end(msg, nl_tcp);
  6342. return 0;
  6343. }
  6344. static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
  6345. {
  6346. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6347. struct sk_buff *msg;
  6348. void *hdr;
  6349. u32 size = NLMSG_DEFAULT_SIZE;
  6350. if (!rdev->wiphy.wowlan.flags && !rdev->wiphy.wowlan.n_patterns &&
  6351. !rdev->wiphy.wowlan.tcp)
  6352. return -EOPNOTSUPP;
  6353. if (rdev->wowlan && rdev->wowlan->tcp) {
  6354. /* adjust size to have room for all the data */
  6355. size += rdev->wowlan->tcp->tokens_size +
  6356. rdev->wowlan->tcp->payload_len +
  6357. rdev->wowlan->tcp->wake_len +
  6358. rdev->wowlan->tcp->wake_len / 8;
  6359. }
  6360. msg = nlmsg_new(size, GFP_KERNEL);
  6361. if (!msg)
  6362. return -ENOMEM;
  6363. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  6364. NL80211_CMD_GET_WOWLAN);
  6365. if (!hdr)
  6366. goto nla_put_failure;
  6367. if (rdev->wowlan) {
  6368. struct nlattr *nl_wowlan;
  6369. nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
  6370. if (!nl_wowlan)
  6371. goto nla_put_failure;
  6372. if ((rdev->wowlan->any &&
  6373. nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
  6374. (rdev->wowlan->disconnect &&
  6375. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
  6376. (rdev->wowlan->magic_pkt &&
  6377. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
  6378. (rdev->wowlan->gtk_rekey_failure &&
  6379. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
  6380. (rdev->wowlan->eap_identity_req &&
  6381. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
  6382. (rdev->wowlan->four_way_handshake &&
  6383. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
  6384. (rdev->wowlan->rfkill_release &&
  6385. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
  6386. goto nla_put_failure;
  6387. if (nl80211_send_wowlan_patterns(msg, rdev))
  6388. goto nla_put_failure;
  6389. if (nl80211_send_wowlan_tcp(msg, rdev->wowlan->tcp))
  6390. goto nla_put_failure;
  6391. nla_nest_end(msg, nl_wowlan);
  6392. }
  6393. genlmsg_end(msg, hdr);
  6394. return genlmsg_reply(msg, info);
  6395. nla_put_failure:
  6396. nlmsg_free(msg);
  6397. return -ENOBUFS;
  6398. }
  6399. static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
  6400. struct nlattr *attr,
  6401. struct cfg80211_wowlan *trig)
  6402. {
  6403. struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
  6404. struct cfg80211_wowlan_tcp *cfg;
  6405. struct nl80211_wowlan_tcp_data_token *tok = NULL;
  6406. struct nl80211_wowlan_tcp_data_seq *seq = NULL;
  6407. u32 size;
  6408. u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
  6409. int err, port;
  6410. if (!rdev->wiphy.wowlan.tcp)
  6411. return -EINVAL;
  6412. err = nla_parse(tb, MAX_NL80211_WOWLAN_TCP,
  6413. nla_data(attr), nla_len(attr),
  6414. nl80211_wowlan_tcp_policy);
  6415. if (err)
  6416. return err;
  6417. if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
  6418. !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
  6419. !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
  6420. !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
  6421. !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
  6422. !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
  6423. !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
  6424. !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
  6425. return -EINVAL;
  6426. data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
  6427. if (data_size > rdev->wiphy.wowlan.tcp->data_payload_max)
  6428. return -EINVAL;
  6429. if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
  6430. rdev->wiphy.wowlan.tcp->data_interval_max ||
  6431. nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
  6432. return -EINVAL;
  6433. wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
  6434. if (wake_size > rdev->wiphy.wowlan.tcp->wake_payload_max)
  6435. return -EINVAL;
  6436. wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
  6437. if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
  6438. return -EINVAL;
  6439. if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
  6440. u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
  6441. tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
  6442. tokens_size = tokln - sizeof(*tok);
  6443. if (!tok->len || tokens_size % tok->len)
  6444. return -EINVAL;
  6445. if (!rdev->wiphy.wowlan.tcp->tok)
  6446. return -EINVAL;
  6447. if (tok->len > rdev->wiphy.wowlan.tcp->tok->max_len)
  6448. return -EINVAL;
  6449. if (tok->len < rdev->wiphy.wowlan.tcp->tok->min_len)
  6450. return -EINVAL;
  6451. if (tokens_size > rdev->wiphy.wowlan.tcp->tok->bufsize)
  6452. return -EINVAL;
  6453. if (tok->offset + tok->len > data_size)
  6454. return -EINVAL;
  6455. }
  6456. if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
  6457. seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
  6458. if (!rdev->wiphy.wowlan.tcp->seq)
  6459. return -EINVAL;
  6460. if (seq->len == 0 || seq->len > 4)
  6461. return -EINVAL;
  6462. if (seq->len + seq->offset > data_size)
  6463. return -EINVAL;
  6464. }
  6465. size = sizeof(*cfg);
  6466. size += data_size;
  6467. size += wake_size + wake_mask_size;
  6468. size += tokens_size;
  6469. cfg = kzalloc(size, GFP_KERNEL);
  6470. if (!cfg)
  6471. return -ENOMEM;
  6472. cfg->src = nla_get_be32(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
  6473. cfg->dst = nla_get_be32(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
  6474. memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
  6475. ETH_ALEN);
  6476. if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
  6477. port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
  6478. else
  6479. port = 0;
  6480. #ifdef CONFIG_INET
  6481. /* allocate a socket and port for it and use it */
  6482. err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
  6483. IPPROTO_TCP, &cfg->sock, 1);
  6484. if (err) {
  6485. kfree(cfg);
  6486. return err;
  6487. }
  6488. if (inet_csk_get_port(cfg->sock->sk, port)) {
  6489. sock_release(cfg->sock);
  6490. kfree(cfg);
  6491. return -EADDRINUSE;
  6492. }
  6493. cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
  6494. #else
  6495. if (!port) {
  6496. kfree(cfg);
  6497. return -EINVAL;
  6498. }
  6499. cfg->src_port = port;
  6500. #endif
  6501. cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
  6502. cfg->payload_len = data_size;
  6503. cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
  6504. memcpy((void *)cfg->payload,
  6505. nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
  6506. data_size);
  6507. if (seq)
  6508. cfg->payload_seq = *seq;
  6509. cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
  6510. cfg->wake_len = wake_size;
  6511. cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
  6512. memcpy((void *)cfg->wake_data,
  6513. nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
  6514. wake_size);
  6515. cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
  6516. data_size + wake_size;
  6517. memcpy((void *)cfg->wake_mask,
  6518. nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
  6519. wake_mask_size);
  6520. if (tok) {
  6521. cfg->tokens_size = tokens_size;
  6522. memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
  6523. }
  6524. trig->tcp = cfg;
  6525. return 0;
  6526. }
  6527. static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
  6528. {
  6529. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6530. struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
  6531. struct cfg80211_wowlan new_triggers = {};
  6532. struct cfg80211_wowlan *ntrig;
  6533. struct wiphy_wowlan_support *wowlan = &rdev->wiphy.wowlan;
  6534. int err, i;
  6535. bool prev_enabled = rdev->wowlan;
  6536. if (!rdev->wiphy.wowlan.flags && !rdev->wiphy.wowlan.n_patterns &&
  6537. !rdev->wiphy.wowlan.tcp)
  6538. return -EOPNOTSUPP;
  6539. if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
  6540. cfg80211_rdev_free_wowlan(rdev);
  6541. rdev->wowlan = NULL;
  6542. goto set_wakeup;
  6543. }
  6544. err = nla_parse(tb, MAX_NL80211_WOWLAN_TRIG,
  6545. nla_data(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
  6546. nla_len(info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]),
  6547. nl80211_wowlan_policy);
  6548. if (err)
  6549. return err;
  6550. if (tb[NL80211_WOWLAN_TRIG_ANY]) {
  6551. if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
  6552. return -EINVAL;
  6553. new_triggers.any = true;
  6554. }
  6555. if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
  6556. if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
  6557. return -EINVAL;
  6558. new_triggers.disconnect = true;
  6559. }
  6560. if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
  6561. if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
  6562. return -EINVAL;
  6563. new_triggers.magic_pkt = true;
  6564. }
  6565. if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
  6566. return -EINVAL;
  6567. if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
  6568. if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
  6569. return -EINVAL;
  6570. new_triggers.gtk_rekey_failure = true;
  6571. }
  6572. if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
  6573. if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
  6574. return -EINVAL;
  6575. new_triggers.eap_identity_req = true;
  6576. }
  6577. if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
  6578. if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
  6579. return -EINVAL;
  6580. new_triggers.four_way_handshake = true;
  6581. }
  6582. if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
  6583. if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
  6584. return -EINVAL;
  6585. new_triggers.rfkill_release = true;
  6586. }
  6587. if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
  6588. struct nlattr *pat;
  6589. int n_patterns = 0;
  6590. int rem, pat_len, mask_len, pkt_offset;
  6591. struct nlattr *pat_tb[NUM_NL80211_WOWLAN_PKTPAT];
  6592. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  6593. rem)
  6594. n_patterns++;
  6595. if (n_patterns > wowlan->n_patterns)
  6596. return -EINVAL;
  6597. new_triggers.patterns = kcalloc(n_patterns,
  6598. sizeof(new_triggers.patterns[0]),
  6599. GFP_KERNEL);
  6600. if (!new_triggers.patterns)
  6601. return -ENOMEM;
  6602. new_triggers.n_patterns = n_patterns;
  6603. i = 0;
  6604. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  6605. rem) {
  6606. nla_parse(pat_tb, MAX_NL80211_WOWLAN_PKTPAT,
  6607. nla_data(pat), nla_len(pat), NULL);
  6608. err = -EINVAL;
  6609. if (!pat_tb[NL80211_WOWLAN_PKTPAT_MASK] ||
  6610. !pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN])
  6611. goto error;
  6612. pat_len = nla_len(pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN]);
  6613. mask_len = DIV_ROUND_UP(pat_len, 8);
  6614. if (nla_len(pat_tb[NL80211_WOWLAN_PKTPAT_MASK]) !=
  6615. mask_len)
  6616. goto error;
  6617. if (pat_len > wowlan->pattern_max_len ||
  6618. pat_len < wowlan->pattern_min_len)
  6619. goto error;
  6620. if (!pat_tb[NL80211_WOWLAN_PKTPAT_OFFSET])
  6621. pkt_offset = 0;
  6622. else
  6623. pkt_offset = nla_get_u32(
  6624. pat_tb[NL80211_WOWLAN_PKTPAT_OFFSET]);
  6625. if (pkt_offset > wowlan->max_pkt_offset)
  6626. goto error;
  6627. new_triggers.patterns[i].pkt_offset = pkt_offset;
  6628. new_triggers.patterns[i].mask =
  6629. kmalloc(mask_len + pat_len, GFP_KERNEL);
  6630. if (!new_triggers.patterns[i].mask) {
  6631. err = -ENOMEM;
  6632. goto error;
  6633. }
  6634. new_triggers.patterns[i].pattern =
  6635. new_triggers.patterns[i].mask + mask_len;
  6636. memcpy(new_triggers.patterns[i].mask,
  6637. nla_data(pat_tb[NL80211_WOWLAN_PKTPAT_MASK]),
  6638. mask_len);
  6639. new_triggers.patterns[i].pattern_len = pat_len;
  6640. memcpy(new_triggers.patterns[i].pattern,
  6641. nla_data(pat_tb[NL80211_WOWLAN_PKTPAT_PATTERN]),
  6642. pat_len);
  6643. i++;
  6644. }
  6645. }
  6646. if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
  6647. err = nl80211_parse_wowlan_tcp(
  6648. rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
  6649. &new_triggers);
  6650. if (err)
  6651. goto error;
  6652. }
  6653. ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
  6654. if (!ntrig) {
  6655. err = -ENOMEM;
  6656. goto error;
  6657. }
  6658. cfg80211_rdev_free_wowlan(rdev);
  6659. rdev->wowlan = ntrig;
  6660. set_wakeup:
  6661. if (rdev->ops->set_wakeup && prev_enabled != !!rdev->wowlan)
  6662. rdev_set_wakeup(rdev, rdev->wowlan);
  6663. return 0;
  6664. error:
  6665. for (i = 0; i < new_triggers.n_patterns; i++)
  6666. kfree(new_triggers.patterns[i].mask);
  6667. kfree(new_triggers.patterns);
  6668. if (new_triggers.tcp && new_triggers.tcp->sock)
  6669. sock_release(new_triggers.tcp->sock);
  6670. kfree(new_triggers.tcp);
  6671. return err;
  6672. }
  6673. #endif
  6674. static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
  6675. {
  6676. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6677. struct net_device *dev = info->user_ptr[1];
  6678. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6679. struct nlattr *tb[NUM_NL80211_REKEY_DATA];
  6680. struct cfg80211_gtk_rekey_data rekey_data;
  6681. int err;
  6682. if (!info->attrs[NL80211_ATTR_REKEY_DATA])
  6683. return -EINVAL;
  6684. err = nla_parse(tb, MAX_NL80211_REKEY_DATA,
  6685. nla_data(info->attrs[NL80211_ATTR_REKEY_DATA]),
  6686. nla_len(info->attrs[NL80211_ATTR_REKEY_DATA]),
  6687. nl80211_rekey_policy);
  6688. if (err)
  6689. return err;
  6690. if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
  6691. return -ERANGE;
  6692. if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
  6693. return -ERANGE;
  6694. if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
  6695. return -ERANGE;
  6696. memcpy(rekey_data.kek, nla_data(tb[NL80211_REKEY_DATA_KEK]),
  6697. NL80211_KEK_LEN);
  6698. memcpy(rekey_data.kck, nla_data(tb[NL80211_REKEY_DATA_KCK]),
  6699. NL80211_KCK_LEN);
  6700. memcpy(rekey_data.replay_ctr,
  6701. nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]),
  6702. NL80211_REPLAY_CTR_LEN);
  6703. wdev_lock(wdev);
  6704. if (!wdev->current_bss) {
  6705. err = -ENOTCONN;
  6706. goto out;
  6707. }
  6708. if (!rdev->ops->set_rekey_data) {
  6709. err = -EOPNOTSUPP;
  6710. goto out;
  6711. }
  6712. err = rdev_set_rekey_data(rdev, dev, &rekey_data);
  6713. out:
  6714. wdev_unlock(wdev);
  6715. return err;
  6716. }
  6717. static int nl80211_register_unexpected_frame(struct sk_buff *skb,
  6718. struct genl_info *info)
  6719. {
  6720. struct net_device *dev = info->user_ptr[1];
  6721. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6722. if (wdev->iftype != NL80211_IFTYPE_AP &&
  6723. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  6724. return -EINVAL;
  6725. if (wdev->ap_unexpected_nlportid)
  6726. return -EBUSY;
  6727. wdev->ap_unexpected_nlportid = info->snd_portid;
  6728. return 0;
  6729. }
  6730. static int nl80211_probe_client(struct sk_buff *skb,
  6731. struct genl_info *info)
  6732. {
  6733. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6734. struct net_device *dev = info->user_ptr[1];
  6735. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6736. struct sk_buff *msg;
  6737. void *hdr;
  6738. const u8 *addr;
  6739. u64 cookie;
  6740. int err;
  6741. if (wdev->iftype != NL80211_IFTYPE_AP &&
  6742. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  6743. return -EOPNOTSUPP;
  6744. if (!info->attrs[NL80211_ATTR_MAC])
  6745. return -EINVAL;
  6746. if (!rdev->ops->probe_client)
  6747. return -EOPNOTSUPP;
  6748. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6749. if (!msg)
  6750. return -ENOMEM;
  6751. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  6752. NL80211_CMD_PROBE_CLIENT);
  6753. if (IS_ERR(hdr)) {
  6754. err = PTR_ERR(hdr);
  6755. goto free_msg;
  6756. }
  6757. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6758. err = rdev_probe_client(rdev, dev, addr, &cookie);
  6759. if (err)
  6760. goto free_msg;
  6761. if (nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
  6762. goto nla_put_failure;
  6763. genlmsg_end(msg, hdr);
  6764. return genlmsg_reply(msg, info);
  6765. nla_put_failure:
  6766. err = -ENOBUFS;
  6767. free_msg:
  6768. nlmsg_free(msg);
  6769. return err;
  6770. }
  6771. static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
  6772. {
  6773. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6774. struct cfg80211_beacon_registration *reg, *nreg;
  6775. int rv;
  6776. if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
  6777. return -EOPNOTSUPP;
  6778. nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
  6779. if (!nreg)
  6780. return -ENOMEM;
  6781. /* First, check if already registered. */
  6782. spin_lock_bh(&rdev->beacon_registrations_lock);
  6783. list_for_each_entry(reg, &rdev->beacon_registrations, list) {
  6784. if (reg->nlportid == info->snd_portid) {
  6785. rv = -EALREADY;
  6786. goto out_err;
  6787. }
  6788. }
  6789. /* Add it to the list */
  6790. nreg->nlportid = info->snd_portid;
  6791. list_add(&nreg->list, &rdev->beacon_registrations);
  6792. spin_unlock_bh(&rdev->beacon_registrations_lock);
  6793. return 0;
  6794. out_err:
  6795. spin_unlock_bh(&rdev->beacon_registrations_lock);
  6796. kfree(nreg);
  6797. return rv;
  6798. }
  6799. static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
  6800. {
  6801. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6802. struct wireless_dev *wdev = info->user_ptr[1];
  6803. int err;
  6804. if (!rdev->ops->start_p2p_device)
  6805. return -EOPNOTSUPP;
  6806. if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
  6807. return -EOPNOTSUPP;
  6808. if (wdev->p2p_started)
  6809. return 0;
  6810. mutex_lock(&rdev->devlist_mtx);
  6811. err = cfg80211_can_add_interface(rdev, wdev->iftype);
  6812. mutex_unlock(&rdev->devlist_mtx);
  6813. if (err)
  6814. return err;
  6815. err = rdev_start_p2p_device(rdev, wdev);
  6816. if (err)
  6817. return err;
  6818. wdev->p2p_started = true;
  6819. mutex_lock(&rdev->devlist_mtx);
  6820. rdev->opencount++;
  6821. mutex_unlock(&rdev->devlist_mtx);
  6822. return 0;
  6823. }
  6824. static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
  6825. {
  6826. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6827. struct wireless_dev *wdev = info->user_ptr[1];
  6828. if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
  6829. return -EOPNOTSUPP;
  6830. if (!rdev->ops->stop_p2p_device)
  6831. return -EOPNOTSUPP;
  6832. mutex_lock(&rdev->devlist_mtx);
  6833. mutex_lock(&rdev->sched_scan_mtx);
  6834. cfg80211_stop_p2p_device(rdev, wdev);
  6835. mutex_unlock(&rdev->sched_scan_mtx);
  6836. mutex_unlock(&rdev->devlist_mtx);
  6837. return 0;
  6838. }
  6839. static int nl80211_get_protocol_features(struct sk_buff *skb,
  6840. struct genl_info *info)
  6841. {
  6842. void *hdr;
  6843. struct sk_buff *msg;
  6844. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6845. if (!msg)
  6846. return -ENOMEM;
  6847. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  6848. NL80211_CMD_GET_PROTOCOL_FEATURES);
  6849. if (!hdr)
  6850. goto nla_put_failure;
  6851. if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
  6852. NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
  6853. goto nla_put_failure;
  6854. genlmsg_end(msg, hdr);
  6855. return genlmsg_reply(msg, info);
  6856. nla_put_failure:
  6857. kfree_skb(msg);
  6858. return -ENOBUFS;
  6859. }
  6860. static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
  6861. {
  6862. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6863. struct cfg80211_update_ft_ies_params ft_params;
  6864. struct net_device *dev = info->user_ptr[1];
  6865. if (!rdev->ops->update_ft_ies)
  6866. return -EOPNOTSUPP;
  6867. if (!info->attrs[NL80211_ATTR_MDID] ||
  6868. !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  6869. return -EINVAL;
  6870. memset(&ft_params, 0, sizeof(ft_params));
  6871. ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
  6872. ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  6873. ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  6874. return rdev_update_ft_ies(rdev, dev, &ft_params);
  6875. }
  6876. static int nl80211_crit_protocol_start(struct sk_buff *skb,
  6877. struct genl_info *info)
  6878. {
  6879. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6880. struct wireless_dev *wdev = info->user_ptr[1];
  6881. enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
  6882. u16 duration;
  6883. int ret;
  6884. if (!rdev->ops->crit_proto_start)
  6885. return -EOPNOTSUPP;
  6886. if (WARN_ON(!rdev->ops->crit_proto_stop))
  6887. return -EINVAL;
  6888. if (rdev->crit_proto_nlportid)
  6889. return -EBUSY;
  6890. /* determine protocol if provided */
  6891. if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
  6892. proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
  6893. if (proto >= NUM_NL80211_CRIT_PROTO)
  6894. return -EINVAL;
  6895. /* timeout must be provided */
  6896. if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
  6897. return -EINVAL;
  6898. duration =
  6899. nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
  6900. if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
  6901. return -ERANGE;
  6902. ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
  6903. if (!ret)
  6904. rdev->crit_proto_nlportid = info->snd_portid;
  6905. return ret;
  6906. }
  6907. static int nl80211_crit_protocol_stop(struct sk_buff *skb,
  6908. struct genl_info *info)
  6909. {
  6910. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6911. struct wireless_dev *wdev = info->user_ptr[1];
  6912. if (!rdev->ops->crit_proto_stop)
  6913. return -EOPNOTSUPP;
  6914. if (rdev->crit_proto_nlportid) {
  6915. rdev->crit_proto_nlportid = 0;
  6916. rdev_crit_proto_stop(rdev, wdev);
  6917. }
  6918. return 0;
  6919. }
  6920. #define NL80211_FLAG_NEED_WIPHY 0x01
  6921. #define NL80211_FLAG_NEED_NETDEV 0x02
  6922. #define NL80211_FLAG_NEED_RTNL 0x04
  6923. #define NL80211_FLAG_CHECK_NETDEV_UP 0x08
  6924. #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
  6925. NL80211_FLAG_CHECK_NETDEV_UP)
  6926. #define NL80211_FLAG_NEED_WDEV 0x10
  6927. /* If a netdev is associated, it must be UP, P2P must be started */
  6928. #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
  6929. NL80211_FLAG_CHECK_NETDEV_UP)
  6930. static int nl80211_pre_doit(struct genl_ops *ops, struct sk_buff *skb,
  6931. struct genl_info *info)
  6932. {
  6933. struct cfg80211_registered_device *rdev;
  6934. struct wireless_dev *wdev;
  6935. struct net_device *dev;
  6936. bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
  6937. if (rtnl)
  6938. rtnl_lock();
  6939. if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
  6940. rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
  6941. if (IS_ERR(rdev)) {
  6942. if (rtnl)
  6943. rtnl_unlock();
  6944. return PTR_ERR(rdev);
  6945. }
  6946. info->user_ptr[0] = rdev;
  6947. } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
  6948. ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
  6949. mutex_lock(&cfg80211_mutex);
  6950. wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
  6951. info->attrs);
  6952. if (IS_ERR(wdev)) {
  6953. mutex_unlock(&cfg80211_mutex);
  6954. if (rtnl)
  6955. rtnl_unlock();
  6956. return PTR_ERR(wdev);
  6957. }
  6958. dev = wdev->netdev;
  6959. rdev = wiphy_to_dev(wdev->wiphy);
  6960. if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
  6961. if (!dev) {
  6962. mutex_unlock(&cfg80211_mutex);
  6963. if (rtnl)
  6964. rtnl_unlock();
  6965. return -EINVAL;
  6966. }
  6967. info->user_ptr[1] = dev;
  6968. } else {
  6969. info->user_ptr[1] = wdev;
  6970. }
  6971. if (dev) {
  6972. if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
  6973. !netif_running(dev)) {
  6974. mutex_unlock(&cfg80211_mutex);
  6975. if (rtnl)
  6976. rtnl_unlock();
  6977. return -ENETDOWN;
  6978. }
  6979. dev_hold(dev);
  6980. } else if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP) {
  6981. if (!wdev->p2p_started) {
  6982. mutex_unlock(&cfg80211_mutex);
  6983. if (rtnl)
  6984. rtnl_unlock();
  6985. return -ENETDOWN;
  6986. }
  6987. }
  6988. cfg80211_lock_rdev(rdev);
  6989. mutex_unlock(&cfg80211_mutex);
  6990. info->user_ptr[0] = rdev;
  6991. }
  6992. return 0;
  6993. }
  6994. static void nl80211_post_doit(struct genl_ops *ops, struct sk_buff *skb,
  6995. struct genl_info *info)
  6996. {
  6997. if (info->user_ptr[0])
  6998. cfg80211_unlock_rdev(info->user_ptr[0]);
  6999. if (info->user_ptr[1]) {
  7000. if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
  7001. struct wireless_dev *wdev = info->user_ptr[1];
  7002. if (wdev->netdev)
  7003. dev_put(wdev->netdev);
  7004. } else {
  7005. dev_put(info->user_ptr[1]);
  7006. }
  7007. }
  7008. if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
  7009. rtnl_unlock();
  7010. }
  7011. static struct genl_ops nl80211_ops[] = {
  7012. {
  7013. .cmd = NL80211_CMD_GET_WIPHY,
  7014. .doit = nl80211_get_wiphy,
  7015. .dumpit = nl80211_dump_wiphy,
  7016. .policy = nl80211_policy,
  7017. /* can be retrieved by unprivileged users */
  7018. .internal_flags = NL80211_FLAG_NEED_WIPHY,
  7019. },
  7020. {
  7021. .cmd = NL80211_CMD_SET_WIPHY,
  7022. .doit = nl80211_set_wiphy,
  7023. .policy = nl80211_policy,
  7024. .flags = GENL_ADMIN_PERM,
  7025. .internal_flags = NL80211_FLAG_NEED_RTNL,
  7026. },
  7027. {
  7028. .cmd = NL80211_CMD_GET_INTERFACE,
  7029. .doit = nl80211_get_interface,
  7030. .dumpit = nl80211_dump_interface,
  7031. .policy = nl80211_policy,
  7032. /* can be retrieved by unprivileged users */
  7033. .internal_flags = NL80211_FLAG_NEED_WDEV,
  7034. },
  7035. {
  7036. .cmd = NL80211_CMD_SET_INTERFACE,
  7037. .doit = nl80211_set_interface,
  7038. .policy = nl80211_policy,
  7039. .flags = GENL_ADMIN_PERM,
  7040. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7041. NL80211_FLAG_NEED_RTNL,
  7042. },
  7043. {
  7044. .cmd = NL80211_CMD_NEW_INTERFACE,
  7045. .doit = nl80211_new_interface,
  7046. .policy = nl80211_policy,
  7047. .flags = GENL_ADMIN_PERM,
  7048. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  7049. NL80211_FLAG_NEED_RTNL,
  7050. },
  7051. {
  7052. .cmd = NL80211_CMD_DEL_INTERFACE,
  7053. .doit = nl80211_del_interface,
  7054. .policy = nl80211_policy,
  7055. .flags = GENL_ADMIN_PERM,
  7056. .internal_flags = NL80211_FLAG_NEED_WDEV |
  7057. NL80211_FLAG_NEED_RTNL,
  7058. },
  7059. {
  7060. .cmd = NL80211_CMD_GET_KEY,
  7061. .doit = nl80211_get_key,
  7062. .policy = nl80211_policy,
  7063. .flags = GENL_ADMIN_PERM,
  7064. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7065. NL80211_FLAG_NEED_RTNL,
  7066. },
  7067. {
  7068. .cmd = NL80211_CMD_SET_KEY,
  7069. .doit = nl80211_set_key,
  7070. .policy = nl80211_policy,
  7071. .flags = GENL_ADMIN_PERM,
  7072. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7073. NL80211_FLAG_NEED_RTNL,
  7074. },
  7075. {
  7076. .cmd = NL80211_CMD_NEW_KEY,
  7077. .doit = nl80211_new_key,
  7078. .policy = nl80211_policy,
  7079. .flags = GENL_ADMIN_PERM,
  7080. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7081. NL80211_FLAG_NEED_RTNL,
  7082. },
  7083. {
  7084. .cmd = NL80211_CMD_DEL_KEY,
  7085. .doit = nl80211_del_key,
  7086. .policy = nl80211_policy,
  7087. .flags = GENL_ADMIN_PERM,
  7088. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7089. NL80211_FLAG_NEED_RTNL,
  7090. },
  7091. {
  7092. .cmd = NL80211_CMD_SET_BEACON,
  7093. .policy = nl80211_policy,
  7094. .flags = GENL_ADMIN_PERM,
  7095. .doit = nl80211_set_beacon,
  7096. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7097. NL80211_FLAG_NEED_RTNL,
  7098. },
  7099. {
  7100. .cmd = NL80211_CMD_START_AP,
  7101. .policy = nl80211_policy,
  7102. .flags = GENL_ADMIN_PERM,
  7103. .doit = nl80211_start_ap,
  7104. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7105. NL80211_FLAG_NEED_RTNL,
  7106. },
  7107. {
  7108. .cmd = NL80211_CMD_STOP_AP,
  7109. .policy = nl80211_policy,
  7110. .flags = GENL_ADMIN_PERM,
  7111. .doit = nl80211_stop_ap,
  7112. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7113. NL80211_FLAG_NEED_RTNL,
  7114. },
  7115. {
  7116. .cmd = NL80211_CMD_GET_STATION,
  7117. .doit = nl80211_get_station,
  7118. .dumpit = nl80211_dump_station,
  7119. .policy = nl80211_policy,
  7120. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7121. NL80211_FLAG_NEED_RTNL,
  7122. },
  7123. {
  7124. .cmd = NL80211_CMD_SET_STATION,
  7125. .doit = nl80211_set_station,
  7126. .policy = nl80211_policy,
  7127. .flags = GENL_ADMIN_PERM,
  7128. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7129. NL80211_FLAG_NEED_RTNL,
  7130. },
  7131. {
  7132. .cmd = NL80211_CMD_NEW_STATION,
  7133. .doit = nl80211_new_station,
  7134. .policy = nl80211_policy,
  7135. .flags = GENL_ADMIN_PERM,
  7136. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7137. NL80211_FLAG_NEED_RTNL,
  7138. },
  7139. {
  7140. .cmd = NL80211_CMD_DEL_STATION,
  7141. .doit = nl80211_del_station,
  7142. .policy = nl80211_policy,
  7143. .flags = GENL_ADMIN_PERM,
  7144. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7145. NL80211_FLAG_NEED_RTNL,
  7146. },
  7147. {
  7148. .cmd = NL80211_CMD_GET_MPATH,
  7149. .doit = nl80211_get_mpath,
  7150. .dumpit = nl80211_dump_mpath,
  7151. .policy = nl80211_policy,
  7152. .flags = GENL_ADMIN_PERM,
  7153. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7154. NL80211_FLAG_NEED_RTNL,
  7155. },
  7156. {
  7157. .cmd = NL80211_CMD_SET_MPATH,
  7158. .doit = nl80211_set_mpath,
  7159. .policy = nl80211_policy,
  7160. .flags = GENL_ADMIN_PERM,
  7161. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7162. NL80211_FLAG_NEED_RTNL,
  7163. },
  7164. {
  7165. .cmd = NL80211_CMD_NEW_MPATH,
  7166. .doit = nl80211_new_mpath,
  7167. .policy = nl80211_policy,
  7168. .flags = GENL_ADMIN_PERM,
  7169. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7170. NL80211_FLAG_NEED_RTNL,
  7171. },
  7172. {
  7173. .cmd = NL80211_CMD_DEL_MPATH,
  7174. .doit = nl80211_del_mpath,
  7175. .policy = nl80211_policy,
  7176. .flags = GENL_ADMIN_PERM,
  7177. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7178. NL80211_FLAG_NEED_RTNL,
  7179. },
  7180. {
  7181. .cmd = NL80211_CMD_SET_BSS,
  7182. .doit = nl80211_set_bss,
  7183. .policy = nl80211_policy,
  7184. .flags = GENL_ADMIN_PERM,
  7185. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7186. NL80211_FLAG_NEED_RTNL,
  7187. },
  7188. {
  7189. .cmd = NL80211_CMD_GET_REG,
  7190. .doit = nl80211_get_reg,
  7191. .policy = nl80211_policy,
  7192. /* can be retrieved by unprivileged users */
  7193. },
  7194. {
  7195. .cmd = NL80211_CMD_SET_REG,
  7196. .doit = nl80211_set_reg,
  7197. .policy = nl80211_policy,
  7198. .flags = GENL_ADMIN_PERM,
  7199. },
  7200. {
  7201. .cmd = NL80211_CMD_REQ_SET_REG,
  7202. .doit = nl80211_req_set_reg,
  7203. .policy = nl80211_policy,
  7204. .flags = GENL_ADMIN_PERM,
  7205. },
  7206. {
  7207. .cmd = NL80211_CMD_GET_MESH_CONFIG,
  7208. .doit = nl80211_get_mesh_config,
  7209. .policy = nl80211_policy,
  7210. /* can be retrieved by unprivileged users */
  7211. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7212. NL80211_FLAG_NEED_RTNL,
  7213. },
  7214. {
  7215. .cmd = NL80211_CMD_SET_MESH_CONFIG,
  7216. .doit = nl80211_update_mesh_config,
  7217. .policy = nl80211_policy,
  7218. .flags = GENL_ADMIN_PERM,
  7219. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7220. NL80211_FLAG_NEED_RTNL,
  7221. },
  7222. {
  7223. .cmd = NL80211_CMD_TRIGGER_SCAN,
  7224. .doit = nl80211_trigger_scan,
  7225. .policy = nl80211_policy,
  7226. .flags = GENL_ADMIN_PERM,
  7227. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  7228. NL80211_FLAG_NEED_RTNL,
  7229. },
  7230. {
  7231. .cmd = NL80211_CMD_GET_SCAN,
  7232. .policy = nl80211_policy,
  7233. .dumpit = nl80211_dump_scan,
  7234. },
  7235. {
  7236. .cmd = NL80211_CMD_START_SCHED_SCAN,
  7237. .doit = nl80211_start_sched_scan,
  7238. .policy = nl80211_policy,
  7239. .flags = GENL_ADMIN_PERM,
  7240. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7241. NL80211_FLAG_NEED_RTNL,
  7242. },
  7243. {
  7244. .cmd = NL80211_CMD_STOP_SCHED_SCAN,
  7245. .doit = nl80211_stop_sched_scan,
  7246. .policy = nl80211_policy,
  7247. .flags = GENL_ADMIN_PERM,
  7248. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7249. NL80211_FLAG_NEED_RTNL,
  7250. },
  7251. {
  7252. .cmd = NL80211_CMD_AUTHENTICATE,
  7253. .doit = nl80211_authenticate,
  7254. .policy = nl80211_policy,
  7255. .flags = GENL_ADMIN_PERM,
  7256. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7257. NL80211_FLAG_NEED_RTNL,
  7258. },
  7259. {
  7260. .cmd = NL80211_CMD_ASSOCIATE,
  7261. .doit = nl80211_associate,
  7262. .policy = nl80211_policy,
  7263. .flags = GENL_ADMIN_PERM,
  7264. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7265. NL80211_FLAG_NEED_RTNL,
  7266. },
  7267. {
  7268. .cmd = NL80211_CMD_DEAUTHENTICATE,
  7269. .doit = nl80211_deauthenticate,
  7270. .policy = nl80211_policy,
  7271. .flags = GENL_ADMIN_PERM,
  7272. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7273. NL80211_FLAG_NEED_RTNL,
  7274. },
  7275. {
  7276. .cmd = NL80211_CMD_DISASSOCIATE,
  7277. .doit = nl80211_disassociate,
  7278. .policy = nl80211_policy,
  7279. .flags = GENL_ADMIN_PERM,
  7280. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7281. NL80211_FLAG_NEED_RTNL,
  7282. },
  7283. {
  7284. .cmd = NL80211_CMD_JOIN_IBSS,
  7285. .doit = nl80211_join_ibss,
  7286. .policy = nl80211_policy,
  7287. .flags = GENL_ADMIN_PERM,
  7288. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7289. NL80211_FLAG_NEED_RTNL,
  7290. },
  7291. {
  7292. .cmd = NL80211_CMD_LEAVE_IBSS,
  7293. .doit = nl80211_leave_ibss,
  7294. .policy = nl80211_policy,
  7295. .flags = GENL_ADMIN_PERM,
  7296. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7297. NL80211_FLAG_NEED_RTNL,
  7298. },
  7299. #ifdef CONFIG_NL80211_TESTMODE
  7300. {
  7301. .cmd = NL80211_CMD_TESTMODE,
  7302. .doit = nl80211_testmode_do,
  7303. .dumpit = nl80211_testmode_dump,
  7304. .policy = nl80211_policy,
  7305. .flags = GENL_ADMIN_PERM,
  7306. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  7307. NL80211_FLAG_NEED_RTNL,
  7308. },
  7309. #endif
  7310. {
  7311. .cmd = NL80211_CMD_CONNECT,
  7312. .doit = nl80211_connect,
  7313. .policy = nl80211_policy,
  7314. .flags = GENL_ADMIN_PERM,
  7315. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7316. NL80211_FLAG_NEED_RTNL,
  7317. },
  7318. {
  7319. .cmd = NL80211_CMD_DISCONNECT,
  7320. .doit = nl80211_disconnect,
  7321. .policy = nl80211_policy,
  7322. .flags = GENL_ADMIN_PERM,
  7323. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7324. NL80211_FLAG_NEED_RTNL,
  7325. },
  7326. {
  7327. .cmd = NL80211_CMD_SET_WIPHY_NETNS,
  7328. .doit = nl80211_wiphy_netns,
  7329. .policy = nl80211_policy,
  7330. .flags = GENL_ADMIN_PERM,
  7331. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  7332. NL80211_FLAG_NEED_RTNL,
  7333. },
  7334. {
  7335. .cmd = NL80211_CMD_GET_SURVEY,
  7336. .policy = nl80211_policy,
  7337. .dumpit = nl80211_dump_survey,
  7338. },
  7339. {
  7340. .cmd = NL80211_CMD_SET_PMKSA,
  7341. .doit = nl80211_setdel_pmksa,
  7342. .policy = nl80211_policy,
  7343. .flags = GENL_ADMIN_PERM,
  7344. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7345. NL80211_FLAG_NEED_RTNL,
  7346. },
  7347. {
  7348. .cmd = NL80211_CMD_DEL_PMKSA,
  7349. .doit = nl80211_setdel_pmksa,
  7350. .policy = nl80211_policy,
  7351. .flags = GENL_ADMIN_PERM,
  7352. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7353. NL80211_FLAG_NEED_RTNL,
  7354. },
  7355. {
  7356. .cmd = NL80211_CMD_FLUSH_PMKSA,
  7357. .doit = nl80211_flush_pmksa,
  7358. .policy = nl80211_policy,
  7359. .flags = GENL_ADMIN_PERM,
  7360. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7361. NL80211_FLAG_NEED_RTNL,
  7362. },
  7363. {
  7364. .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
  7365. .doit = nl80211_remain_on_channel,
  7366. .policy = nl80211_policy,
  7367. .flags = GENL_ADMIN_PERM,
  7368. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  7369. NL80211_FLAG_NEED_RTNL,
  7370. },
  7371. {
  7372. .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  7373. .doit = nl80211_cancel_remain_on_channel,
  7374. .policy = nl80211_policy,
  7375. .flags = GENL_ADMIN_PERM,
  7376. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  7377. NL80211_FLAG_NEED_RTNL,
  7378. },
  7379. {
  7380. .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
  7381. .doit = nl80211_set_tx_bitrate_mask,
  7382. .policy = nl80211_policy,
  7383. .flags = GENL_ADMIN_PERM,
  7384. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7385. NL80211_FLAG_NEED_RTNL,
  7386. },
  7387. {
  7388. .cmd = NL80211_CMD_REGISTER_FRAME,
  7389. .doit = nl80211_register_mgmt,
  7390. .policy = nl80211_policy,
  7391. .flags = GENL_ADMIN_PERM,
  7392. .internal_flags = NL80211_FLAG_NEED_WDEV |
  7393. NL80211_FLAG_NEED_RTNL,
  7394. },
  7395. {
  7396. .cmd = NL80211_CMD_FRAME,
  7397. .doit = nl80211_tx_mgmt,
  7398. .policy = nl80211_policy,
  7399. .flags = GENL_ADMIN_PERM,
  7400. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  7401. NL80211_FLAG_NEED_RTNL,
  7402. },
  7403. {
  7404. .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
  7405. .doit = nl80211_tx_mgmt_cancel_wait,
  7406. .policy = nl80211_policy,
  7407. .flags = GENL_ADMIN_PERM,
  7408. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  7409. NL80211_FLAG_NEED_RTNL,
  7410. },
  7411. {
  7412. .cmd = NL80211_CMD_SET_POWER_SAVE,
  7413. .doit = nl80211_set_power_save,
  7414. .policy = nl80211_policy,
  7415. .flags = GENL_ADMIN_PERM,
  7416. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7417. NL80211_FLAG_NEED_RTNL,
  7418. },
  7419. {
  7420. .cmd = NL80211_CMD_GET_POWER_SAVE,
  7421. .doit = nl80211_get_power_save,
  7422. .policy = nl80211_policy,
  7423. /* can be retrieved by unprivileged users */
  7424. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7425. NL80211_FLAG_NEED_RTNL,
  7426. },
  7427. {
  7428. .cmd = NL80211_CMD_SET_CQM,
  7429. .doit = nl80211_set_cqm,
  7430. .policy = nl80211_policy,
  7431. .flags = GENL_ADMIN_PERM,
  7432. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7433. NL80211_FLAG_NEED_RTNL,
  7434. },
  7435. {
  7436. .cmd = NL80211_CMD_SET_CHANNEL,
  7437. .doit = nl80211_set_channel,
  7438. .policy = nl80211_policy,
  7439. .flags = GENL_ADMIN_PERM,
  7440. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7441. NL80211_FLAG_NEED_RTNL,
  7442. },
  7443. {
  7444. .cmd = NL80211_CMD_SET_WDS_PEER,
  7445. .doit = nl80211_set_wds_peer,
  7446. .policy = nl80211_policy,
  7447. .flags = GENL_ADMIN_PERM,
  7448. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7449. NL80211_FLAG_NEED_RTNL,
  7450. },
  7451. {
  7452. .cmd = NL80211_CMD_JOIN_MESH,
  7453. .doit = nl80211_join_mesh,
  7454. .policy = nl80211_policy,
  7455. .flags = GENL_ADMIN_PERM,
  7456. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7457. NL80211_FLAG_NEED_RTNL,
  7458. },
  7459. {
  7460. .cmd = NL80211_CMD_LEAVE_MESH,
  7461. .doit = nl80211_leave_mesh,
  7462. .policy = nl80211_policy,
  7463. .flags = GENL_ADMIN_PERM,
  7464. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7465. NL80211_FLAG_NEED_RTNL,
  7466. },
  7467. #ifdef CONFIG_PM
  7468. {
  7469. .cmd = NL80211_CMD_GET_WOWLAN,
  7470. .doit = nl80211_get_wowlan,
  7471. .policy = nl80211_policy,
  7472. /* can be retrieved by unprivileged users */
  7473. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  7474. NL80211_FLAG_NEED_RTNL,
  7475. },
  7476. {
  7477. .cmd = NL80211_CMD_SET_WOWLAN,
  7478. .doit = nl80211_set_wowlan,
  7479. .policy = nl80211_policy,
  7480. .flags = GENL_ADMIN_PERM,
  7481. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  7482. NL80211_FLAG_NEED_RTNL,
  7483. },
  7484. #endif
  7485. {
  7486. .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
  7487. .doit = nl80211_set_rekey_data,
  7488. .policy = nl80211_policy,
  7489. .flags = GENL_ADMIN_PERM,
  7490. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7491. NL80211_FLAG_NEED_RTNL,
  7492. },
  7493. {
  7494. .cmd = NL80211_CMD_TDLS_MGMT,
  7495. .doit = nl80211_tdls_mgmt,
  7496. .policy = nl80211_policy,
  7497. .flags = GENL_ADMIN_PERM,
  7498. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7499. NL80211_FLAG_NEED_RTNL,
  7500. },
  7501. {
  7502. .cmd = NL80211_CMD_TDLS_OPER,
  7503. .doit = nl80211_tdls_oper,
  7504. .policy = nl80211_policy,
  7505. .flags = GENL_ADMIN_PERM,
  7506. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7507. NL80211_FLAG_NEED_RTNL,
  7508. },
  7509. {
  7510. .cmd = NL80211_CMD_UNEXPECTED_FRAME,
  7511. .doit = nl80211_register_unexpected_frame,
  7512. .policy = nl80211_policy,
  7513. .flags = GENL_ADMIN_PERM,
  7514. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7515. NL80211_FLAG_NEED_RTNL,
  7516. },
  7517. {
  7518. .cmd = NL80211_CMD_PROBE_CLIENT,
  7519. .doit = nl80211_probe_client,
  7520. .policy = nl80211_policy,
  7521. .flags = GENL_ADMIN_PERM,
  7522. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7523. NL80211_FLAG_NEED_RTNL,
  7524. },
  7525. {
  7526. .cmd = NL80211_CMD_REGISTER_BEACONS,
  7527. .doit = nl80211_register_beacons,
  7528. .policy = nl80211_policy,
  7529. .flags = GENL_ADMIN_PERM,
  7530. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  7531. NL80211_FLAG_NEED_RTNL,
  7532. },
  7533. {
  7534. .cmd = NL80211_CMD_SET_NOACK_MAP,
  7535. .doit = nl80211_set_noack_map,
  7536. .policy = nl80211_policy,
  7537. .flags = GENL_ADMIN_PERM,
  7538. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7539. NL80211_FLAG_NEED_RTNL,
  7540. },
  7541. {
  7542. .cmd = NL80211_CMD_START_P2P_DEVICE,
  7543. .doit = nl80211_start_p2p_device,
  7544. .policy = nl80211_policy,
  7545. .flags = GENL_ADMIN_PERM,
  7546. .internal_flags = NL80211_FLAG_NEED_WDEV |
  7547. NL80211_FLAG_NEED_RTNL,
  7548. },
  7549. {
  7550. .cmd = NL80211_CMD_STOP_P2P_DEVICE,
  7551. .doit = nl80211_stop_p2p_device,
  7552. .policy = nl80211_policy,
  7553. .flags = GENL_ADMIN_PERM,
  7554. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  7555. NL80211_FLAG_NEED_RTNL,
  7556. },
  7557. {
  7558. .cmd = NL80211_CMD_SET_MCAST_RATE,
  7559. .doit = nl80211_set_mcast_rate,
  7560. .policy = nl80211_policy,
  7561. .flags = GENL_ADMIN_PERM,
  7562. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7563. NL80211_FLAG_NEED_RTNL,
  7564. },
  7565. {
  7566. .cmd = NL80211_CMD_SET_MAC_ACL,
  7567. .doit = nl80211_set_mac_acl,
  7568. .policy = nl80211_policy,
  7569. .flags = GENL_ADMIN_PERM,
  7570. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  7571. NL80211_FLAG_NEED_RTNL,
  7572. },
  7573. {
  7574. .cmd = NL80211_CMD_RADAR_DETECT,
  7575. .doit = nl80211_start_radar_detection,
  7576. .policy = nl80211_policy,
  7577. .flags = GENL_ADMIN_PERM,
  7578. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7579. NL80211_FLAG_NEED_RTNL,
  7580. },
  7581. {
  7582. .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
  7583. .doit = nl80211_get_protocol_features,
  7584. .policy = nl80211_policy,
  7585. },
  7586. {
  7587. .cmd = NL80211_CMD_UPDATE_FT_IES,
  7588. .doit = nl80211_update_ft_ies,
  7589. .policy = nl80211_policy,
  7590. .flags = GENL_ADMIN_PERM,
  7591. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  7592. NL80211_FLAG_NEED_RTNL,
  7593. },
  7594. {
  7595. .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
  7596. .doit = nl80211_crit_protocol_start,
  7597. .policy = nl80211_policy,
  7598. .flags = GENL_ADMIN_PERM,
  7599. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  7600. NL80211_FLAG_NEED_RTNL,
  7601. },
  7602. {
  7603. .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
  7604. .doit = nl80211_crit_protocol_stop,
  7605. .policy = nl80211_policy,
  7606. .flags = GENL_ADMIN_PERM,
  7607. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  7608. NL80211_FLAG_NEED_RTNL,
  7609. }
  7610. };
  7611. static struct genl_multicast_group nl80211_mlme_mcgrp = {
  7612. .name = "mlme",
  7613. };
  7614. /* multicast groups */
  7615. static struct genl_multicast_group nl80211_config_mcgrp = {
  7616. .name = "config",
  7617. };
  7618. static struct genl_multicast_group nl80211_scan_mcgrp = {
  7619. .name = "scan",
  7620. };
  7621. static struct genl_multicast_group nl80211_regulatory_mcgrp = {
  7622. .name = "regulatory",
  7623. };
  7624. /* notification functions */
  7625. void nl80211_notify_dev_rename(struct cfg80211_registered_device *rdev)
  7626. {
  7627. struct sk_buff *msg;
  7628. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7629. if (!msg)
  7630. return;
  7631. if (nl80211_send_wiphy(rdev, msg, 0, 0, 0,
  7632. false, NULL, NULL, NULL) < 0) {
  7633. nlmsg_free(msg);
  7634. return;
  7635. }
  7636. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7637. nl80211_config_mcgrp.id, GFP_KERNEL);
  7638. }
  7639. static int nl80211_add_scan_req(struct sk_buff *msg,
  7640. struct cfg80211_registered_device *rdev)
  7641. {
  7642. struct cfg80211_scan_request *req = rdev->scan_req;
  7643. struct nlattr *nest;
  7644. int i;
  7645. lockdep_assert_held(&rdev->sched_scan_mtx);
  7646. if (WARN_ON(!req))
  7647. return 0;
  7648. nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
  7649. if (!nest)
  7650. goto nla_put_failure;
  7651. for (i = 0; i < req->n_ssids; i++) {
  7652. if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
  7653. goto nla_put_failure;
  7654. }
  7655. nla_nest_end(msg, nest);
  7656. nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
  7657. if (!nest)
  7658. goto nla_put_failure;
  7659. for (i = 0; i < req->n_channels; i++) {
  7660. if (nla_put_u32(msg, i, req->channels[i]->center_freq))
  7661. goto nla_put_failure;
  7662. }
  7663. nla_nest_end(msg, nest);
  7664. if (req->ie &&
  7665. nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
  7666. goto nla_put_failure;
  7667. if (req->flags)
  7668. nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags);
  7669. return 0;
  7670. nla_put_failure:
  7671. return -ENOBUFS;
  7672. }
  7673. static int nl80211_send_scan_msg(struct sk_buff *msg,
  7674. struct cfg80211_registered_device *rdev,
  7675. struct wireless_dev *wdev,
  7676. u32 portid, u32 seq, int flags,
  7677. u32 cmd)
  7678. {
  7679. void *hdr;
  7680. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  7681. if (!hdr)
  7682. return -1;
  7683. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  7684. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  7685. wdev->netdev->ifindex)) ||
  7686. nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
  7687. goto nla_put_failure;
  7688. /* ignore errors and send incomplete event anyway */
  7689. nl80211_add_scan_req(msg, rdev);
  7690. return genlmsg_end(msg, hdr);
  7691. nla_put_failure:
  7692. genlmsg_cancel(msg, hdr);
  7693. return -EMSGSIZE;
  7694. }
  7695. static int
  7696. nl80211_send_sched_scan_msg(struct sk_buff *msg,
  7697. struct cfg80211_registered_device *rdev,
  7698. struct net_device *netdev,
  7699. u32 portid, u32 seq, int flags, u32 cmd)
  7700. {
  7701. void *hdr;
  7702. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  7703. if (!hdr)
  7704. return -1;
  7705. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  7706. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  7707. goto nla_put_failure;
  7708. return genlmsg_end(msg, hdr);
  7709. nla_put_failure:
  7710. genlmsg_cancel(msg, hdr);
  7711. return -EMSGSIZE;
  7712. }
  7713. void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
  7714. struct wireless_dev *wdev)
  7715. {
  7716. struct sk_buff *msg;
  7717. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7718. if (!msg)
  7719. return;
  7720. if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
  7721. NL80211_CMD_TRIGGER_SCAN) < 0) {
  7722. nlmsg_free(msg);
  7723. return;
  7724. }
  7725. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7726. nl80211_scan_mcgrp.id, GFP_KERNEL);
  7727. }
  7728. void nl80211_send_scan_done(struct cfg80211_registered_device *rdev,
  7729. struct wireless_dev *wdev)
  7730. {
  7731. struct sk_buff *msg;
  7732. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7733. if (!msg)
  7734. return;
  7735. if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
  7736. NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
  7737. nlmsg_free(msg);
  7738. return;
  7739. }
  7740. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7741. nl80211_scan_mcgrp.id, GFP_KERNEL);
  7742. }
  7743. void nl80211_send_scan_aborted(struct cfg80211_registered_device *rdev,
  7744. struct wireless_dev *wdev)
  7745. {
  7746. struct sk_buff *msg;
  7747. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7748. if (!msg)
  7749. return;
  7750. if (nl80211_send_scan_msg(msg, rdev, wdev, 0, 0, 0,
  7751. NL80211_CMD_SCAN_ABORTED) < 0) {
  7752. nlmsg_free(msg);
  7753. return;
  7754. }
  7755. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7756. nl80211_scan_mcgrp.id, GFP_KERNEL);
  7757. }
  7758. void nl80211_send_sched_scan_results(struct cfg80211_registered_device *rdev,
  7759. struct net_device *netdev)
  7760. {
  7761. struct sk_buff *msg;
  7762. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7763. if (!msg)
  7764. return;
  7765. if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0,
  7766. NL80211_CMD_SCHED_SCAN_RESULTS) < 0) {
  7767. nlmsg_free(msg);
  7768. return;
  7769. }
  7770. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7771. nl80211_scan_mcgrp.id, GFP_KERNEL);
  7772. }
  7773. void nl80211_send_sched_scan(struct cfg80211_registered_device *rdev,
  7774. struct net_device *netdev, u32 cmd)
  7775. {
  7776. struct sk_buff *msg;
  7777. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7778. if (!msg)
  7779. return;
  7780. if (nl80211_send_sched_scan_msg(msg, rdev, netdev, 0, 0, 0, cmd) < 0) {
  7781. nlmsg_free(msg);
  7782. return;
  7783. }
  7784. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7785. nl80211_scan_mcgrp.id, GFP_KERNEL);
  7786. }
  7787. /*
  7788. * This can happen on global regulatory changes or device specific settings
  7789. * based on custom world regulatory domains.
  7790. */
  7791. void nl80211_send_reg_change_event(struct regulatory_request *request)
  7792. {
  7793. struct sk_buff *msg;
  7794. void *hdr;
  7795. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7796. if (!msg)
  7797. return;
  7798. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_CHANGE);
  7799. if (!hdr) {
  7800. nlmsg_free(msg);
  7801. return;
  7802. }
  7803. /* Userspace can always count this one always being set */
  7804. if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
  7805. goto nla_put_failure;
  7806. if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
  7807. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  7808. NL80211_REGDOM_TYPE_WORLD))
  7809. goto nla_put_failure;
  7810. } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
  7811. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  7812. NL80211_REGDOM_TYPE_CUSTOM_WORLD))
  7813. goto nla_put_failure;
  7814. } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
  7815. request->intersect) {
  7816. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  7817. NL80211_REGDOM_TYPE_INTERSECTION))
  7818. goto nla_put_failure;
  7819. } else {
  7820. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  7821. NL80211_REGDOM_TYPE_COUNTRY) ||
  7822. nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
  7823. request->alpha2))
  7824. goto nla_put_failure;
  7825. }
  7826. if (request->wiphy_idx != WIPHY_IDX_INVALID &&
  7827. nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
  7828. goto nla_put_failure;
  7829. genlmsg_end(msg, hdr);
  7830. rcu_read_lock();
  7831. genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
  7832. GFP_ATOMIC);
  7833. rcu_read_unlock();
  7834. return;
  7835. nla_put_failure:
  7836. genlmsg_cancel(msg, hdr);
  7837. nlmsg_free(msg);
  7838. }
  7839. static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
  7840. struct net_device *netdev,
  7841. const u8 *buf, size_t len,
  7842. enum nl80211_commands cmd, gfp_t gfp)
  7843. {
  7844. struct sk_buff *msg;
  7845. void *hdr;
  7846. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  7847. if (!msg)
  7848. return;
  7849. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  7850. if (!hdr) {
  7851. nlmsg_free(msg);
  7852. return;
  7853. }
  7854. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  7855. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  7856. nla_put(msg, NL80211_ATTR_FRAME, len, buf))
  7857. goto nla_put_failure;
  7858. genlmsg_end(msg, hdr);
  7859. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7860. nl80211_mlme_mcgrp.id, gfp);
  7861. return;
  7862. nla_put_failure:
  7863. genlmsg_cancel(msg, hdr);
  7864. nlmsg_free(msg);
  7865. }
  7866. void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
  7867. struct net_device *netdev, const u8 *buf,
  7868. size_t len, gfp_t gfp)
  7869. {
  7870. nl80211_send_mlme_event(rdev, netdev, buf, len,
  7871. NL80211_CMD_AUTHENTICATE, gfp);
  7872. }
  7873. void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
  7874. struct net_device *netdev, const u8 *buf,
  7875. size_t len, gfp_t gfp)
  7876. {
  7877. nl80211_send_mlme_event(rdev, netdev, buf, len,
  7878. NL80211_CMD_ASSOCIATE, gfp);
  7879. }
  7880. void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
  7881. struct net_device *netdev, const u8 *buf,
  7882. size_t len, gfp_t gfp)
  7883. {
  7884. nl80211_send_mlme_event(rdev, netdev, buf, len,
  7885. NL80211_CMD_DEAUTHENTICATE, gfp);
  7886. }
  7887. void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
  7888. struct net_device *netdev, const u8 *buf,
  7889. size_t len, gfp_t gfp)
  7890. {
  7891. nl80211_send_mlme_event(rdev, netdev, buf, len,
  7892. NL80211_CMD_DISASSOCIATE, gfp);
  7893. }
  7894. void cfg80211_send_unprot_deauth(struct net_device *dev, const u8 *buf,
  7895. size_t len)
  7896. {
  7897. struct wireless_dev *wdev = dev->ieee80211_ptr;
  7898. struct wiphy *wiphy = wdev->wiphy;
  7899. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  7900. trace_cfg80211_send_unprot_deauth(dev);
  7901. nl80211_send_mlme_event(rdev, dev, buf, len,
  7902. NL80211_CMD_UNPROT_DEAUTHENTICATE, GFP_ATOMIC);
  7903. }
  7904. EXPORT_SYMBOL(cfg80211_send_unprot_deauth);
  7905. void cfg80211_send_unprot_disassoc(struct net_device *dev, const u8 *buf,
  7906. size_t len)
  7907. {
  7908. struct wireless_dev *wdev = dev->ieee80211_ptr;
  7909. struct wiphy *wiphy = wdev->wiphy;
  7910. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  7911. trace_cfg80211_send_unprot_disassoc(dev);
  7912. nl80211_send_mlme_event(rdev, dev, buf, len,
  7913. NL80211_CMD_UNPROT_DISASSOCIATE, GFP_ATOMIC);
  7914. }
  7915. EXPORT_SYMBOL(cfg80211_send_unprot_disassoc);
  7916. static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
  7917. struct net_device *netdev, int cmd,
  7918. const u8 *addr, gfp_t gfp)
  7919. {
  7920. struct sk_buff *msg;
  7921. void *hdr;
  7922. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  7923. if (!msg)
  7924. return;
  7925. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  7926. if (!hdr) {
  7927. nlmsg_free(msg);
  7928. return;
  7929. }
  7930. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  7931. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  7932. nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
  7933. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
  7934. goto nla_put_failure;
  7935. genlmsg_end(msg, hdr);
  7936. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7937. nl80211_mlme_mcgrp.id, gfp);
  7938. return;
  7939. nla_put_failure:
  7940. genlmsg_cancel(msg, hdr);
  7941. nlmsg_free(msg);
  7942. }
  7943. void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
  7944. struct net_device *netdev, const u8 *addr,
  7945. gfp_t gfp)
  7946. {
  7947. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
  7948. addr, gfp);
  7949. }
  7950. void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
  7951. struct net_device *netdev, const u8 *addr,
  7952. gfp_t gfp)
  7953. {
  7954. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
  7955. addr, gfp);
  7956. }
  7957. void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
  7958. struct net_device *netdev, const u8 *bssid,
  7959. const u8 *req_ie, size_t req_ie_len,
  7960. const u8 *resp_ie, size_t resp_ie_len,
  7961. u16 status, gfp_t gfp)
  7962. {
  7963. struct sk_buff *msg;
  7964. void *hdr;
  7965. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  7966. if (!msg)
  7967. return;
  7968. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
  7969. if (!hdr) {
  7970. nlmsg_free(msg);
  7971. return;
  7972. }
  7973. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  7974. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  7975. (bssid && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid)) ||
  7976. nla_put_u16(msg, NL80211_ATTR_STATUS_CODE, status) ||
  7977. (req_ie &&
  7978. nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
  7979. (resp_ie &&
  7980. nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
  7981. goto nla_put_failure;
  7982. genlmsg_end(msg, hdr);
  7983. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  7984. nl80211_mlme_mcgrp.id, gfp);
  7985. return;
  7986. nla_put_failure:
  7987. genlmsg_cancel(msg, hdr);
  7988. nlmsg_free(msg);
  7989. }
  7990. void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
  7991. struct net_device *netdev, const u8 *bssid,
  7992. const u8 *req_ie, size_t req_ie_len,
  7993. const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
  7994. {
  7995. struct sk_buff *msg;
  7996. void *hdr;
  7997. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  7998. if (!msg)
  7999. return;
  8000. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
  8001. if (!hdr) {
  8002. nlmsg_free(msg);
  8003. return;
  8004. }
  8005. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8006. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  8007. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
  8008. (req_ie &&
  8009. nla_put(msg, NL80211_ATTR_REQ_IE, req_ie_len, req_ie)) ||
  8010. (resp_ie &&
  8011. nla_put(msg, NL80211_ATTR_RESP_IE, resp_ie_len, resp_ie)))
  8012. goto nla_put_failure;
  8013. genlmsg_end(msg, hdr);
  8014. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8015. nl80211_mlme_mcgrp.id, gfp);
  8016. return;
  8017. nla_put_failure:
  8018. genlmsg_cancel(msg, hdr);
  8019. nlmsg_free(msg);
  8020. }
  8021. void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
  8022. struct net_device *netdev, u16 reason,
  8023. const u8 *ie, size_t ie_len, bool from_ap)
  8024. {
  8025. struct sk_buff *msg;
  8026. void *hdr;
  8027. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  8028. if (!msg)
  8029. return;
  8030. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
  8031. if (!hdr) {
  8032. nlmsg_free(msg);
  8033. return;
  8034. }
  8035. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8036. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  8037. (from_ap && reason &&
  8038. nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
  8039. (from_ap &&
  8040. nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
  8041. (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
  8042. goto nla_put_failure;
  8043. genlmsg_end(msg, hdr);
  8044. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8045. nl80211_mlme_mcgrp.id, GFP_KERNEL);
  8046. return;
  8047. nla_put_failure:
  8048. genlmsg_cancel(msg, hdr);
  8049. nlmsg_free(msg);
  8050. }
  8051. void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
  8052. struct net_device *netdev, const u8 *bssid,
  8053. gfp_t gfp)
  8054. {
  8055. struct sk_buff *msg;
  8056. void *hdr;
  8057. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8058. if (!msg)
  8059. return;
  8060. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
  8061. if (!hdr) {
  8062. nlmsg_free(msg);
  8063. return;
  8064. }
  8065. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8066. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  8067. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  8068. goto nla_put_failure;
  8069. genlmsg_end(msg, hdr);
  8070. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8071. nl80211_mlme_mcgrp.id, gfp);
  8072. return;
  8073. nla_put_failure:
  8074. genlmsg_cancel(msg, hdr);
  8075. nlmsg_free(msg);
  8076. }
  8077. void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
  8078. const u8* ie, u8 ie_len, gfp_t gfp)
  8079. {
  8080. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8081. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  8082. struct sk_buff *msg;
  8083. void *hdr;
  8084. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
  8085. return;
  8086. trace_cfg80211_notify_new_peer_candidate(dev, addr);
  8087. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8088. if (!msg)
  8089. return;
  8090. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
  8091. if (!hdr) {
  8092. nlmsg_free(msg);
  8093. return;
  8094. }
  8095. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8096. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  8097. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  8098. (ie_len && ie &&
  8099. nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
  8100. goto nla_put_failure;
  8101. genlmsg_end(msg, hdr);
  8102. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8103. nl80211_mlme_mcgrp.id, gfp);
  8104. return;
  8105. nla_put_failure:
  8106. genlmsg_cancel(msg, hdr);
  8107. nlmsg_free(msg);
  8108. }
  8109. EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
  8110. void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
  8111. struct net_device *netdev, const u8 *addr,
  8112. enum nl80211_key_type key_type, int key_id,
  8113. const u8 *tsc, gfp_t gfp)
  8114. {
  8115. struct sk_buff *msg;
  8116. void *hdr;
  8117. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8118. if (!msg)
  8119. return;
  8120. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
  8121. if (!hdr) {
  8122. nlmsg_free(msg);
  8123. return;
  8124. }
  8125. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8126. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  8127. (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
  8128. nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
  8129. (key_id != -1 &&
  8130. nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
  8131. (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
  8132. goto nla_put_failure;
  8133. genlmsg_end(msg, hdr);
  8134. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8135. nl80211_mlme_mcgrp.id, gfp);
  8136. return;
  8137. nla_put_failure:
  8138. genlmsg_cancel(msg, hdr);
  8139. nlmsg_free(msg);
  8140. }
  8141. void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
  8142. struct ieee80211_channel *channel_before,
  8143. struct ieee80211_channel *channel_after)
  8144. {
  8145. struct sk_buff *msg;
  8146. void *hdr;
  8147. struct nlattr *nl_freq;
  8148. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
  8149. if (!msg)
  8150. return;
  8151. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
  8152. if (!hdr) {
  8153. nlmsg_free(msg);
  8154. return;
  8155. }
  8156. /*
  8157. * Since we are applying the beacon hint to a wiphy we know its
  8158. * wiphy_idx is valid
  8159. */
  8160. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  8161. goto nla_put_failure;
  8162. /* Before */
  8163. nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
  8164. if (!nl_freq)
  8165. goto nla_put_failure;
  8166. if (nl80211_msg_put_channel(msg, channel_before, false))
  8167. goto nla_put_failure;
  8168. nla_nest_end(msg, nl_freq);
  8169. /* After */
  8170. nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
  8171. if (!nl_freq)
  8172. goto nla_put_failure;
  8173. if (nl80211_msg_put_channel(msg, channel_after, false))
  8174. goto nla_put_failure;
  8175. nla_nest_end(msg, nl_freq);
  8176. genlmsg_end(msg, hdr);
  8177. rcu_read_lock();
  8178. genlmsg_multicast_allns(msg, 0, nl80211_regulatory_mcgrp.id,
  8179. GFP_ATOMIC);
  8180. rcu_read_unlock();
  8181. return;
  8182. nla_put_failure:
  8183. genlmsg_cancel(msg, hdr);
  8184. nlmsg_free(msg);
  8185. }
  8186. static void nl80211_send_remain_on_chan_event(
  8187. int cmd, struct cfg80211_registered_device *rdev,
  8188. struct wireless_dev *wdev, u64 cookie,
  8189. struct ieee80211_channel *chan,
  8190. unsigned int duration, gfp_t gfp)
  8191. {
  8192. struct sk_buff *msg;
  8193. void *hdr;
  8194. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8195. if (!msg)
  8196. return;
  8197. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  8198. if (!hdr) {
  8199. nlmsg_free(msg);
  8200. return;
  8201. }
  8202. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8203. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  8204. wdev->netdev->ifindex)) ||
  8205. nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)) ||
  8206. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
  8207. nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
  8208. NL80211_CHAN_NO_HT) ||
  8209. nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie))
  8210. goto nla_put_failure;
  8211. if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
  8212. nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
  8213. goto nla_put_failure;
  8214. genlmsg_end(msg, hdr);
  8215. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8216. nl80211_mlme_mcgrp.id, gfp);
  8217. return;
  8218. nla_put_failure:
  8219. genlmsg_cancel(msg, hdr);
  8220. nlmsg_free(msg);
  8221. }
  8222. void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
  8223. struct ieee80211_channel *chan,
  8224. unsigned int duration, gfp_t gfp)
  8225. {
  8226. struct wiphy *wiphy = wdev->wiphy;
  8227. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8228. trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
  8229. nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
  8230. rdev, wdev, cookie, chan,
  8231. duration, gfp);
  8232. }
  8233. EXPORT_SYMBOL(cfg80211_ready_on_channel);
  8234. void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
  8235. struct ieee80211_channel *chan,
  8236. gfp_t gfp)
  8237. {
  8238. struct wiphy *wiphy = wdev->wiphy;
  8239. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8240. trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
  8241. nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  8242. rdev, wdev, cookie, chan, 0, gfp);
  8243. }
  8244. EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
  8245. void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
  8246. struct station_info *sinfo, gfp_t gfp)
  8247. {
  8248. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  8249. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8250. struct sk_buff *msg;
  8251. trace_cfg80211_new_sta(dev, mac_addr, sinfo);
  8252. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8253. if (!msg)
  8254. return;
  8255. if (nl80211_send_station(msg, 0, 0, 0,
  8256. rdev, dev, mac_addr, sinfo) < 0) {
  8257. nlmsg_free(msg);
  8258. return;
  8259. }
  8260. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8261. nl80211_mlme_mcgrp.id, gfp);
  8262. }
  8263. EXPORT_SYMBOL(cfg80211_new_sta);
  8264. void cfg80211_del_sta(struct net_device *dev, const u8 *mac_addr, gfp_t gfp)
  8265. {
  8266. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  8267. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8268. struct sk_buff *msg;
  8269. void *hdr;
  8270. trace_cfg80211_del_sta(dev, mac_addr);
  8271. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8272. if (!msg)
  8273. return;
  8274. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_STATION);
  8275. if (!hdr) {
  8276. nlmsg_free(msg);
  8277. return;
  8278. }
  8279. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  8280. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
  8281. goto nla_put_failure;
  8282. genlmsg_end(msg, hdr);
  8283. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8284. nl80211_mlme_mcgrp.id, gfp);
  8285. return;
  8286. nla_put_failure:
  8287. genlmsg_cancel(msg, hdr);
  8288. nlmsg_free(msg);
  8289. }
  8290. EXPORT_SYMBOL(cfg80211_del_sta);
  8291. void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
  8292. enum nl80211_connect_failed_reason reason,
  8293. gfp_t gfp)
  8294. {
  8295. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  8296. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8297. struct sk_buff *msg;
  8298. void *hdr;
  8299. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  8300. if (!msg)
  8301. return;
  8302. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
  8303. if (!hdr) {
  8304. nlmsg_free(msg);
  8305. return;
  8306. }
  8307. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  8308. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
  8309. nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
  8310. goto nla_put_failure;
  8311. genlmsg_end(msg, hdr);
  8312. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8313. nl80211_mlme_mcgrp.id, gfp);
  8314. return;
  8315. nla_put_failure:
  8316. genlmsg_cancel(msg, hdr);
  8317. nlmsg_free(msg);
  8318. }
  8319. EXPORT_SYMBOL(cfg80211_conn_failed);
  8320. static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
  8321. const u8 *addr, gfp_t gfp)
  8322. {
  8323. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8324. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  8325. struct sk_buff *msg;
  8326. void *hdr;
  8327. int err;
  8328. u32 nlportid = ACCESS_ONCE(wdev->ap_unexpected_nlportid);
  8329. if (!nlportid)
  8330. return false;
  8331. msg = nlmsg_new(100, gfp);
  8332. if (!msg)
  8333. return true;
  8334. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  8335. if (!hdr) {
  8336. nlmsg_free(msg);
  8337. return true;
  8338. }
  8339. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8340. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  8341. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
  8342. goto nla_put_failure;
  8343. err = genlmsg_end(msg, hdr);
  8344. if (err < 0) {
  8345. nlmsg_free(msg);
  8346. return true;
  8347. }
  8348. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  8349. return true;
  8350. nla_put_failure:
  8351. genlmsg_cancel(msg, hdr);
  8352. nlmsg_free(msg);
  8353. return true;
  8354. }
  8355. bool cfg80211_rx_spurious_frame(struct net_device *dev,
  8356. const u8 *addr, gfp_t gfp)
  8357. {
  8358. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8359. bool ret;
  8360. trace_cfg80211_rx_spurious_frame(dev, addr);
  8361. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  8362. wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
  8363. trace_cfg80211_return_bool(false);
  8364. return false;
  8365. }
  8366. ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
  8367. addr, gfp);
  8368. trace_cfg80211_return_bool(ret);
  8369. return ret;
  8370. }
  8371. EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
  8372. bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
  8373. const u8 *addr, gfp_t gfp)
  8374. {
  8375. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8376. bool ret;
  8377. trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
  8378. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  8379. wdev->iftype != NL80211_IFTYPE_P2P_GO &&
  8380. wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
  8381. trace_cfg80211_return_bool(false);
  8382. return false;
  8383. }
  8384. ret = __nl80211_unexpected_frame(dev,
  8385. NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
  8386. addr, gfp);
  8387. trace_cfg80211_return_bool(ret);
  8388. return ret;
  8389. }
  8390. EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
  8391. int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
  8392. struct wireless_dev *wdev, u32 nlportid,
  8393. int freq, int sig_dbm,
  8394. const u8 *buf, size_t len, gfp_t gfp)
  8395. {
  8396. struct net_device *netdev = wdev->netdev;
  8397. struct sk_buff *msg;
  8398. void *hdr;
  8399. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8400. if (!msg)
  8401. return -ENOMEM;
  8402. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  8403. if (!hdr) {
  8404. nlmsg_free(msg);
  8405. return -ENOMEM;
  8406. }
  8407. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8408. (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  8409. netdev->ifindex)) ||
  8410. nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)) ||
  8411. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
  8412. (sig_dbm &&
  8413. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
  8414. nla_put(msg, NL80211_ATTR_FRAME, len, buf))
  8415. goto nla_put_failure;
  8416. genlmsg_end(msg, hdr);
  8417. return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  8418. nla_put_failure:
  8419. genlmsg_cancel(msg, hdr);
  8420. nlmsg_free(msg);
  8421. return -ENOBUFS;
  8422. }
  8423. void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
  8424. const u8 *buf, size_t len, bool ack, gfp_t gfp)
  8425. {
  8426. struct wiphy *wiphy = wdev->wiphy;
  8427. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8428. struct net_device *netdev = wdev->netdev;
  8429. struct sk_buff *msg;
  8430. void *hdr;
  8431. trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
  8432. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8433. if (!msg)
  8434. return;
  8435. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
  8436. if (!hdr) {
  8437. nlmsg_free(msg);
  8438. return;
  8439. }
  8440. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8441. (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  8442. netdev->ifindex)) ||
  8443. nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)) ||
  8444. nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
  8445. nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie) ||
  8446. (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
  8447. goto nla_put_failure;
  8448. genlmsg_end(msg, hdr);
  8449. genlmsg_multicast(msg, 0, nl80211_mlme_mcgrp.id, gfp);
  8450. return;
  8451. nla_put_failure:
  8452. genlmsg_cancel(msg, hdr);
  8453. nlmsg_free(msg);
  8454. }
  8455. EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
  8456. void cfg80211_cqm_rssi_notify(struct net_device *dev,
  8457. enum nl80211_cqm_rssi_threshold_event rssi_event,
  8458. gfp_t gfp)
  8459. {
  8460. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8461. struct wiphy *wiphy = wdev->wiphy;
  8462. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8463. struct sk_buff *msg;
  8464. struct nlattr *pinfoattr;
  8465. void *hdr;
  8466. trace_cfg80211_cqm_rssi_notify(dev, rssi_event);
  8467. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8468. if (!msg)
  8469. return;
  8470. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
  8471. if (!hdr) {
  8472. nlmsg_free(msg);
  8473. return;
  8474. }
  8475. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8476. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  8477. goto nla_put_failure;
  8478. pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
  8479. if (!pinfoattr)
  8480. goto nla_put_failure;
  8481. if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
  8482. rssi_event))
  8483. goto nla_put_failure;
  8484. nla_nest_end(msg, pinfoattr);
  8485. genlmsg_end(msg, hdr);
  8486. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8487. nl80211_mlme_mcgrp.id, gfp);
  8488. return;
  8489. nla_put_failure:
  8490. genlmsg_cancel(msg, hdr);
  8491. nlmsg_free(msg);
  8492. }
  8493. EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
  8494. static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
  8495. struct net_device *netdev, const u8 *bssid,
  8496. const u8 *replay_ctr, gfp_t gfp)
  8497. {
  8498. struct sk_buff *msg;
  8499. struct nlattr *rekey_attr;
  8500. void *hdr;
  8501. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8502. if (!msg)
  8503. return;
  8504. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
  8505. if (!hdr) {
  8506. nlmsg_free(msg);
  8507. return;
  8508. }
  8509. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8510. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  8511. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  8512. goto nla_put_failure;
  8513. rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
  8514. if (!rekey_attr)
  8515. goto nla_put_failure;
  8516. if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
  8517. NL80211_REPLAY_CTR_LEN, replay_ctr))
  8518. goto nla_put_failure;
  8519. nla_nest_end(msg, rekey_attr);
  8520. genlmsg_end(msg, hdr);
  8521. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8522. nl80211_mlme_mcgrp.id, gfp);
  8523. return;
  8524. nla_put_failure:
  8525. genlmsg_cancel(msg, hdr);
  8526. nlmsg_free(msg);
  8527. }
  8528. void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
  8529. const u8 *replay_ctr, gfp_t gfp)
  8530. {
  8531. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8532. struct wiphy *wiphy = wdev->wiphy;
  8533. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8534. trace_cfg80211_gtk_rekey_notify(dev, bssid);
  8535. nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
  8536. }
  8537. EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
  8538. static void
  8539. nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
  8540. struct net_device *netdev, int index,
  8541. const u8 *bssid, bool preauth, gfp_t gfp)
  8542. {
  8543. struct sk_buff *msg;
  8544. struct nlattr *attr;
  8545. void *hdr;
  8546. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8547. if (!msg)
  8548. return;
  8549. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
  8550. if (!hdr) {
  8551. nlmsg_free(msg);
  8552. return;
  8553. }
  8554. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8555. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  8556. goto nla_put_failure;
  8557. attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
  8558. if (!attr)
  8559. goto nla_put_failure;
  8560. if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
  8561. nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
  8562. (preauth &&
  8563. nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
  8564. goto nla_put_failure;
  8565. nla_nest_end(msg, attr);
  8566. genlmsg_end(msg, hdr);
  8567. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8568. nl80211_mlme_mcgrp.id, gfp);
  8569. return;
  8570. nla_put_failure:
  8571. genlmsg_cancel(msg, hdr);
  8572. nlmsg_free(msg);
  8573. }
  8574. void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
  8575. const u8 *bssid, bool preauth, gfp_t gfp)
  8576. {
  8577. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8578. struct wiphy *wiphy = wdev->wiphy;
  8579. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8580. trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
  8581. nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
  8582. }
  8583. EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
  8584. static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
  8585. struct net_device *netdev,
  8586. struct cfg80211_chan_def *chandef,
  8587. gfp_t gfp)
  8588. {
  8589. struct sk_buff *msg;
  8590. void *hdr;
  8591. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8592. if (!msg)
  8593. return;
  8594. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CH_SWITCH_NOTIFY);
  8595. if (!hdr) {
  8596. nlmsg_free(msg);
  8597. return;
  8598. }
  8599. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  8600. goto nla_put_failure;
  8601. if (nl80211_send_chandef(msg, chandef))
  8602. goto nla_put_failure;
  8603. genlmsg_end(msg, hdr);
  8604. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8605. nl80211_mlme_mcgrp.id, gfp);
  8606. return;
  8607. nla_put_failure:
  8608. genlmsg_cancel(msg, hdr);
  8609. nlmsg_free(msg);
  8610. }
  8611. void cfg80211_ch_switch_notify(struct net_device *dev,
  8612. struct cfg80211_chan_def *chandef)
  8613. {
  8614. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8615. struct wiphy *wiphy = wdev->wiphy;
  8616. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8617. trace_cfg80211_ch_switch_notify(dev, chandef);
  8618. wdev_lock(wdev);
  8619. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  8620. wdev->iftype != NL80211_IFTYPE_P2P_GO))
  8621. goto out;
  8622. wdev->channel = chandef->chan;
  8623. nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL);
  8624. out:
  8625. wdev_unlock(wdev);
  8626. return;
  8627. }
  8628. EXPORT_SYMBOL(cfg80211_ch_switch_notify);
  8629. void cfg80211_cqm_txe_notify(struct net_device *dev,
  8630. const u8 *peer, u32 num_packets,
  8631. u32 rate, u32 intvl, gfp_t gfp)
  8632. {
  8633. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8634. struct wiphy *wiphy = wdev->wiphy;
  8635. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8636. struct sk_buff *msg;
  8637. struct nlattr *pinfoattr;
  8638. void *hdr;
  8639. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  8640. if (!msg)
  8641. return;
  8642. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
  8643. if (!hdr) {
  8644. nlmsg_free(msg);
  8645. return;
  8646. }
  8647. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8648. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  8649. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer))
  8650. goto nla_put_failure;
  8651. pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
  8652. if (!pinfoattr)
  8653. goto nla_put_failure;
  8654. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
  8655. goto nla_put_failure;
  8656. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
  8657. goto nla_put_failure;
  8658. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
  8659. goto nla_put_failure;
  8660. nla_nest_end(msg, pinfoattr);
  8661. genlmsg_end(msg, hdr);
  8662. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8663. nl80211_mlme_mcgrp.id, gfp);
  8664. return;
  8665. nla_put_failure:
  8666. genlmsg_cancel(msg, hdr);
  8667. nlmsg_free(msg);
  8668. }
  8669. EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
  8670. void
  8671. nl80211_radar_notify(struct cfg80211_registered_device *rdev,
  8672. struct cfg80211_chan_def *chandef,
  8673. enum nl80211_radar_event event,
  8674. struct net_device *netdev, gfp_t gfp)
  8675. {
  8676. struct sk_buff *msg;
  8677. void *hdr;
  8678. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8679. if (!msg)
  8680. return;
  8681. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
  8682. if (!hdr) {
  8683. nlmsg_free(msg);
  8684. return;
  8685. }
  8686. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  8687. goto nla_put_failure;
  8688. /* NOP and radar events don't need a netdev parameter */
  8689. if (netdev) {
  8690. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  8691. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  8692. nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
  8693. goto nla_put_failure;
  8694. }
  8695. if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
  8696. goto nla_put_failure;
  8697. if (nl80211_send_chandef(msg, chandef))
  8698. goto nla_put_failure;
  8699. if (genlmsg_end(msg, hdr) < 0) {
  8700. nlmsg_free(msg);
  8701. return;
  8702. }
  8703. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8704. nl80211_mlme_mcgrp.id, gfp);
  8705. return;
  8706. nla_put_failure:
  8707. genlmsg_cancel(msg, hdr);
  8708. nlmsg_free(msg);
  8709. }
  8710. void cfg80211_cqm_pktloss_notify(struct net_device *dev,
  8711. const u8 *peer, u32 num_packets, gfp_t gfp)
  8712. {
  8713. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8714. struct wiphy *wiphy = wdev->wiphy;
  8715. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8716. struct sk_buff *msg;
  8717. struct nlattr *pinfoattr;
  8718. void *hdr;
  8719. trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
  8720. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8721. if (!msg)
  8722. return;
  8723. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
  8724. if (!hdr) {
  8725. nlmsg_free(msg);
  8726. return;
  8727. }
  8728. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8729. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  8730. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer))
  8731. goto nla_put_failure;
  8732. pinfoattr = nla_nest_start(msg, NL80211_ATTR_CQM);
  8733. if (!pinfoattr)
  8734. goto nla_put_failure;
  8735. if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
  8736. goto nla_put_failure;
  8737. nla_nest_end(msg, pinfoattr);
  8738. genlmsg_end(msg, hdr);
  8739. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8740. nl80211_mlme_mcgrp.id, gfp);
  8741. return;
  8742. nla_put_failure:
  8743. genlmsg_cancel(msg, hdr);
  8744. nlmsg_free(msg);
  8745. }
  8746. EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
  8747. void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
  8748. u64 cookie, bool acked, gfp_t gfp)
  8749. {
  8750. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8751. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  8752. struct sk_buff *msg;
  8753. void *hdr;
  8754. int err;
  8755. trace_cfg80211_probe_status(dev, addr, cookie, acked);
  8756. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8757. if (!msg)
  8758. return;
  8759. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
  8760. if (!hdr) {
  8761. nlmsg_free(msg);
  8762. return;
  8763. }
  8764. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8765. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  8766. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  8767. nla_put_u64(msg, NL80211_ATTR_COOKIE, cookie) ||
  8768. (acked && nla_put_flag(msg, NL80211_ATTR_ACK)))
  8769. goto nla_put_failure;
  8770. err = genlmsg_end(msg, hdr);
  8771. if (err < 0) {
  8772. nlmsg_free(msg);
  8773. return;
  8774. }
  8775. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8776. nl80211_mlme_mcgrp.id, gfp);
  8777. return;
  8778. nla_put_failure:
  8779. genlmsg_cancel(msg, hdr);
  8780. nlmsg_free(msg);
  8781. }
  8782. EXPORT_SYMBOL(cfg80211_probe_status);
  8783. void cfg80211_report_obss_beacon(struct wiphy *wiphy,
  8784. const u8 *frame, size_t len,
  8785. int freq, int sig_dbm)
  8786. {
  8787. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8788. struct sk_buff *msg;
  8789. void *hdr;
  8790. struct cfg80211_beacon_registration *reg;
  8791. trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
  8792. spin_lock_bh(&rdev->beacon_registrations_lock);
  8793. list_for_each_entry(reg, &rdev->beacon_registrations, list) {
  8794. msg = nlmsg_new(len + 100, GFP_ATOMIC);
  8795. if (!msg) {
  8796. spin_unlock_bh(&rdev->beacon_registrations_lock);
  8797. return;
  8798. }
  8799. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  8800. if (!hdr)
  8801. goto nla_put_failure;
  8802. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8803. (freq &&
  8804. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
  8805. (sig_dbm &&
  8806. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
  8807. nla_put(msg, NL80211_ATTR_FRAME, len, frame))
  8808. goto nla_put_failure;
  8809. genlmsg_end(msg, hdr);
  8810. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
  8811. }
  8812. spin_unlock_bh(&rdev->beacon_registrations_lock);
  8813. return;
  8814. nla_put_failure:
  8815. spin_unlock_bh(&rdev->beacon_registrations_lock);
  8816. if (hdr)
  8817. genlmsg_cancel(msg, hdr);
  8818. nlmsg_free(msg);
  8819. }
  8820. EXPORT_SYMBOL(cfg80211_report_obss_beacon);
  8821. #ifdef CONFIG_PM
  8822. void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
  8823. struct cfg80211_wowlan_wakeup *wakeup,
  8824. gfp_t gfp)
  8825. {
  8826. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  8827. struct sk_buff *msg;
  8828. void *hdr;
  8829. int err, size = 200;
  8830. trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
  8831. if (wakeup)
  8832. size += wakeup->packet_present_len;
  8833. msg = nlmsg_new(size, gfp);
  8834. if (!msg)
  8835. return;
  8836. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
  8837. if (!hdr)
  8838. goto free_msg;
  8839. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8840. nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
  8841. goto free_msg;
  8842. if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  8843. wdev->netdev->ifindex))
  8844. goto free_msg;
  8845. if (wakeup) {
  8846. struct nlattr *reasons;
  8847. reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
  8848. if (wakeup->disconnect &&
  8849. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
  8850. goto free_msg;
  8851. if (wakeup->magic_pkt &&
  8852. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
  8853. goto free_msg;
  8854. if (wakeup->gtk_rekey_failure &&
  8855. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
  8856. goto free_msg;
  8857. if (wakeup->eap_identity_req &&
  8858. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
  8859. goto free_msg;
  8860. if (wakeup->four_way_handshake &&
  8861. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
  8862. goto free_msg;
  8863. if (wakeup->rfkill_release &&
  8864. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
  8865. goto free_msg;
  8866. if (wakeup->pattern_idx >= 0 &&
  8867. nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  8868. wakeup->pattern_idx))
  8869. goto free_msg;
  8870. if (wakeup->tcp_match)
  8871. nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH);
  8872. if (wakeup->tcp_connlost)
  8873. nla_put_flag(msg,
  8874. NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST);
  8875. if (wakeup->tcp_nomoretokens)
  8876. nla_put_flag(msg,
  8877. NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS);
  8878. if (wakeup->packet) {
  8879. u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
  8880. u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
  8881. if (!wakeup->packet_80211) {
  8882. pkt_attr =
  8883. NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
  8884. len_attr =
  8885. NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
  8886. }
  8887. if (wakeup->packet_len &&
  8888. nla_put_u32(msg, len_attr, wakeup->packet_len))
  8889. goto free_msg;
  8890. if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
  8891. wakeup->packet))
  8892. goto free_msg;
  8893. }
  8894. nla_nest_end(msg, reasons);
  8895. }
  8896. err = genlmsg_end(msg, hdr);
  8897. if (err < 0)
  8898. goto free_msg;
  8899. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8900. nl80211_mlme_mcgrp.id, gfp);
  8901. return;
  8902. free_msg:
  8903. nlmsg_free(msg);
  8904. }
  8905. EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
  8906. #endif
  8907. void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
  8908. enum nl80211_tdls_operation oper,
  8909. u16 reason_code, gfp_t gfp)
  8910. {
  8911. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8912. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  8913. struct sk_buff *msg;
  8914. void *hdr;
  8915. int err;
  8916. trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
  8917. reason_code);
  8918. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  8919. if (!msg)
  8920. return;
  8921. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
  8922. if (!hdr) {
  8923. nlmsg_free(msg);
  8924. return;
  8925. }
  8926. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  8927. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  8928. nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
  8929. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
  8930. (reason_code > 0 &&
  8931. nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
  8932. goto nla_put_failure;
  8933. err = genlmsg_end(msg, hdr);
  8934. if (err < 0) {
  8935. nlmsg_free(msg);
  8936. return;
  8937. }
  8938. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  8939. nl80211_mlme_mcgrp.id, gfp);
  8940. return;
  8941. nla_put_failure:
  8942. genlmsg_cancel(msg, hdr);
  8943. nlmsg_free(msg);
  8944. }
  8945. EXPORT_SYMBOL(cfg80211_tdls_oper_request);
  8946. static int nl80211_netlink_notify(struct notifier_block * nb,
  8947. unsigned long state,
  8948. void *_notify)
  8949. {
  8950. struct netlink_notify *notify = _notify;
  8951. struct cfg80211_registered_device *rdev;
  8952. struct wireless_dev *wdev;
  8953. struct cfg80211_beacon_registration *reg, *tmp;
  8954. if (state != NETLINK_URELEASE)
  8955. return NOTIFY_DONE;
  8956. rcu_read_lock();
  8957. list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
  8958. list_for_each_entry_rcu(wdev, &rdev->wdev_list, list)
  8959. cfg80211_mlme_unregister_socket(wdev, notify->portid);
  8960. spin_lock_bh(&rdev->beacon_registrations_lock);
  8961. list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
  8962. list) {
  8963. if (reg->nlportid == notify->portid) {
  8964. list_del(&reg->list);
  8965. kfree(reg);
  8966. break;
  8967. }
  8968. }
  8969. spin_unlock_bh(&rdev->beacon_registrations_lock);
  8970. }
  8971. rcu_read_unlock();
  8972. return NOTIFY_DONE;
  8973. }
  8974. static struct notifier_block nl80211_netlink_notifier = {
  8975. .notifier_call = nl80211_netlink_notify,
  8976. };
  8977. void cfg80211_ft_event(struct net_device *netdev,
  8978. struct cfg80211_ft_event_params *ft_event)
  8979. {
  8980. struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
  8981. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  8982. struct sk_buff *msg;
  8983. void *hdr;
  8984. int err;
  8985. trace_cfg80211_ft_event(wiphy, netdev, ft_event);
  8986. if (!ft_event->target_ap)
  8987. return;
  8988. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  8989. if (!msg)
  8990. return;
  8991. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
  8992. if (!hdr) {
  8993. nlmsg_free(msg);
  8994. return;
  8995. }
  8996. nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx);
  8997. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex);
  8998. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap);
  8999. if (ft_event->ies)
  9000. nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies);
  9001. if (ft_event->ric_ies)
  9002. nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
  9003. ft_event->ric_ies);
  9004. err = genlmsg_end(msg, hdr);
  9005. if (err < 0) {
  9006. nlmsg_free(msg);
  9007. return;
  9008. }
  9009. genlmsg_multicast_netns(wiphy_net(&rdev->wiphy), msg, 0,
  9010. nl80211_mlme_mcgrp.id, GFP_KERNEL);
  9011. }
  9012. EXPORT_SYMBOL(cfg80211_ft_event);
  9013. void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
  9014. {
  9015. struct cfg80211_registered_device *rdev;
  9016. struct sk_buff *msg;
  9017. void *hdr;
  9018. u32 nlportid;
  9019. rdev = wiphy_to_dev(wdev->wiphy);
  9020. if (!rdev->crit_proto_nlportid)
  9021. return;
  9022. nlportid = rdev->crit_proto_nlportid;
  9023. rdev->crit_proto_nlportid = 0;
  9024. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  9025. if (!msg)
  9026. return;
  9027. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
  9028. if (!hdr)
  9029. goto nla_put_failure;
  9030. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  9031. nla_put_u64(msg, NL80211_ATTR_WDEV, wdev_id(wdev)))
  9032. goto nla_put_failure;
  9033. genlmsg_end(msg, hdr);
  9034. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  9035. return;
  9036. nla_put_failure:
  9037. if (hdr)
  9038. genlmsg_cancel(msg, hdr);
  9039. nlmsg_free(msg);
  9040. }
  9041. EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
  9042. /* initialisation/exit functions */
  9043. int nl80211_init(void)
  9044. {
  9045. int err;
  9046. err = genl_register_family_with_ops(&nl80211_fam,
  9047. nl80211_ops, ARRAY_SIZE(nl80211_ops));
  9048. if (err)
  9049. return err;
  9050. err = genl_register_mc_group(&nl80211_fam, &nl80211_config_mcgrp);
  9051. if (err)
  9052. goto err_out;
  9053. err = genl_register_mc_group(&nl80211_fam, &nl80211_scan_mcgrp);
  9054. if (err)
  9055. goto err_out;
  9056. err = genl_register_mc_group(&nl80211_fam, &nl80211_regulatory_mcgrp);
  9057. if (err)
  9058. goto err_out;
  9059. err = genl_register_mc_group(&nl80211_fam, &nl80211_mlme_mcgrp);
  9060. if (err)
  9061. goto err_out;
  9062. #ifdef CONFIG_NL80211_TESTMODE
  9063. err = genl_register_mc_group(&nl80211_fam, &nl80211_testmode_mcgrp);
  9064. if (err)
  9065. goto err_out;
  9066. #endif
  9067. err = netlink_register_notifier(&nl80211_netlink_notifier);
  9068. if (err)
  9069. goto err_out;
  9070. return 0;
  9071. err_out:
  9072. genl_unregister_family(&nl80211_fam);
  9073. return err;
  9074. }
  9075. void nl80211_exit(void)
  9076. {
  9077. netlink_unregister_notifier(&nl80211_netlink_notifier);
  9078. genl_unregister_family(&nl80211_fam);
  9079. }