nl80211.c 298 KB

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