nl80211.c 423 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598559956005601560256035604560556065607560856095610561156125613561456155616561756185619562056215622562356245625562656275628562956305631563256335634563556365637563856395640564156425643564456455646564756485649565056515652565356545655565656575658565956605661566256635664566556665667566856695670567156725673567456755676567756785679568056815682568356845685568656875688568956905691569256935694569556965697569856995700570157025703570457055706570757085709571057115712571357145715571657175718571957205721572257235724572557265727572857295730573157325733573457355736573757385739574057415742574357445745574657475748574957505751575257535754575557565757575857595760576157625763576457655766576757685769577057715772577357745775577657775778577957805781578257835784578557865787578857895790579157925793579457955796579757985799580058015802580358045805580658075808580958105811581258135814581558165817581858195820582158225823582458255826582758285829583058315832583358345835583658375838583958405841584258435844584558465847584858495850585158525853585458555856585758585859586058615862586358645865586658675868586958705871587258735874587558765877587858795880588158825883588458855886588758885889589058915892589358945895589658975898589959005901590259035904590559065907590859095910591159125913591459155916591759185919592059215922592359245925592659275928592959305931593259335934593559365937593859395940594159425943594459455946594759485949595059515952595359545955595659575958595959605961596259635964596559665967596859695970597159725973597459755976597759785979598059815982598359845985598659875988598959905991599259935994599559965997599859996000600160026003600460056006600760086009601060116012601360146015601660176018601960206021602260236024602560266027602860296030603160326033603460356036603760386039604060416042604360446045604660476048604960506051605260536054605560566057605860596060606160626063606460656066606760686069607060716072607360746075607660776078607960806081608260836084608560866087608860896090609160926093609460956096609760986099610061016102610361046105610661076108610961106111611261136114611561166117611861196120612161226123612461256126612761286129613061316132613361346135613661376138613961406141614261436144614561466147614861496150615161526153615461556156615761586159616061616162616361646165616661676168616961706171617261736174617561766177617861796180618161826183618461856186618761886189619061916192619361946195619661976198619962006201620262036204620562066207620862096210621162126213621462156216621762186219622062216222622362246225622662276228622962306231623262336234623562366237623862396240624162426243624462456246624762486249625062516252625362546255625662576258625962606261626262636264626562666267626862696270627162726273627462756276627762786279628062816282628362846285628662876288628962906291629262936294629562966297629862996300630163026303630463056306630763086309631063116312631363146315631663176318631963206321632263236324632563266327632863296330633163326333633463356336633763386339634063416342634363446345634663476348634963506351635263536354635563566357635863596360636163626363636463656366636763686369637063716372637363746375637663776378637963806381638263836384638563866387638863896390639163926393639463956396639763986399640064016402640364046405640664076408640964106411641264136414641564166417641864196420642164226423642464256426642764286429643064316432643364346435643664376438643964406441644264436444644564466447644864496450645164526453645464556456645764586459646064616462646364646465646664676468646964706471647264736474647564766477647864796480648164826483648464856486648764886489649064916492649364946495649664976498649965006501650265036504650565066507650865096510651165126513651465156516651765186519652065216522652365246525652665276528652965306531653265336534653565366537653865396540654165426543654465456546654765486549655065516552655365546555655665576558655965606561656265636564656565666567656865696570657165726573657465756576657765786579658065816582658365846585658665876588658965906591659265936594659565966597659865996600660166026603660466056606660766086609661066116612661366146615661666176618661966206621662266236624662566266627662866296630663166326633663466356636663766386639664066416642664366446645664666476648664966506651665266536654665566566657665866596660666166626663666466656666666766686669667066716672667366746675667666776678667966806681668266836684668566866687668866896690669166926693669466956696669766986699670067016702670367046705670667076708670967106711671267136714671567166717671867196720672167226723672467256726672767286729673067316732673367346735673667376738673967406741674267436744674567466747674867496750675167526753675467556756675767586759676067616762676367646765676667676768676967706771677267736774677567766777677867796780678167826783678467856786678767886789679067916792679367946795679667976798679968006801680268036804680568066807680868096810681168126813681468156816681768186819682068216822682368246825682668276828682968306831683268336834683568366837683868396840684168426843684468456846684768486849685068516852685368546855685668576858685968606861686268636864686568666867686868696870687168726873687468756876687768786879688068816882688368846885688668876888688968906891689268936894689568966897689868996900690169026903690469056906690769086909691069116912691369146915691669176918691969206921692269236924692569266927692869296930693169326933693469356936693769386939694069416942694369446945694669476948694969506951695269536954695569566957695869596960696169626963696469656966696769686969697069716972697369746975697669776978697969806981698269836984698569866987698869896990699169926993699469956996699769986999700070017002700370047005700670077008700970107011701270137014701570167017701870197020702170227023702470257026702770287029703070317032703370347035703670377038703970407041704270437044704570467047704870497050705170527053705470557056705770587059706070617062706370647065706670677068706970707071707270737074707570767077707870797080708170827083708470857086708770887089709070917092709370947095709670977098709971007101710271037104710571067107710871097110711171127113711471157116711771187119712071217122712371247125712671277128712971307131713271337134713571367137713871397140714171427143714471457146714771487149715071517152715371547155715671577158715971607161716271637164716571667167716871697170717171727173717471757176717771787179718071817182718371847185718671877188718971907191719271937194719571967197719871997200720172027203720472057206720772087209721072117212721372147215721672177218721972207221722272237224722572267227722872297230723172327233723472357236723772387239724072417242724372447245724672477248724972507251725272537254725572567257725872597260726172627263726472657266726772687269727072717272727372747275727672777278727972807281728272837284728572867287728872897290729172927293729472957296729772987299730073017302730373047305730673077308730973107311731273137314731573167317731873197320732173227323732473257326732773287329733073317332733373347335733673377338733973407341734273437344734573467347734873497350735173527353735473557356735773587359736073617362736373647365736673677368736973707371737273737374737573767377737873797380738173827383738473857386738773887389739073917392739373947395739673977398739974007401740274037404740574067407740874097410741174127413741474157416741774187419742074217422742374247425742674277428742974307431743274337434743574367437743874397440744174427443744474457446744774487449745074517452745374547455745674577458745974607461746274637464746574667467746874697470747174727473747474757476747774787479748074817482748374847485748674877488748974907491749274937494749574967497749874997500750175027503750475057506750775087509751075117512751375147515751675177518751975207521752275237524752575267527752875297530753175327533753475357536753775387539754075417542754375447545754675477548754975507551755275537554755575567557755875597560756175627563756475657566756775687569757075717572757375747575757675777578757975807581758275837584758575867587758875897590759175927593759475957596759775987599760076017602760376047605760676077608760976107611761276137614761576167617761876197620762176227623762476257626762776287629763076317632763376347635763676377638763976407641764276437644764576467647764876497650765176527653765476557656765776587659766076617662766376647665766676677668766976707671767276737674767576767677767876797680768176827683768476857686768776887689769076917692769376947695769676977698769977007701770277037704770577067707770877097710771177127713771477157716771777187719772077217722772377247725772677277728772977307731773277337734773577367737773877397740774177427743774477457746774777487749775077517752775377547755775677577758775977607761776277637764776577667767776877697770777177727773777477757776777777787779778077817782778377847785778677877788778977907791779277937794779577967797779877997800780178027803780478057806780778087809781078117812781378147815781678177818781978207821782278237824782578267827782878297830783178327833783478357836783778387839784078417842784378447845784678477848784978507851785278537854785578567857785878597860786178627863786478657866786778687869787078717872787378747875787678777878787978807881788278837884788578867887788878897890789178927893789478957896789778987899790079017902790379047905790679077908790979107911791279137914791579167917791879197920792179227923792479257926792779287929793079317932793379347935793679377938793979407941794279437944794579467947794879497950795179527953795479557956795779587959796079617962796379647965796679677968796979707971797279737974797579767977797879797980798179827983798479857986798779887989799079917992799379947995799679977998799980008001800280038004800580068007800880098010801180128013801480158016801780188019802080218022802380248025802680278028802980308031803280338034803580368037803880398040804180428043804480458046804780488049805080518052805380548055805680578058805980608061806280638064806580668067806880698070807180728073807480758076807780788079808080818082808380848085808680878088808980908091809280938094809580968097809880998100810181028103810481058106810781088109811081118112811381148115811681178118811981208121812281238124812581268127812881298130813181328133813481358136813781388139814081418142814381448145814681478148814981508151815281538154815581568157815881598160816181628163816481658166816781688169817081718172817381748175817681778178817981808181818281838184818581868187818881898190819181928193819481958196819781988199820082018202820382048205820682078208820982108211821282138214821582168217821882198220822182228223822482258226822782288229823082318232823382348235823682378238823982408241824282438244824582468247824882498250825182528253825482558256825782588259826082618262826382648265826682678268826982708271827282738274827582768277827882798280828182828283828482858286828782888289829082918292829382948295829682978298829983008301830283038304830583068307830883098310831183128313831483158316831783188319832083218322832383248325832683278328832983308331833283338334833583368337833883398340834183428343834483458346834783488349835083518352835383548355835683578358835983608361836283638364836583668367836883698370837183728373837483758376837783788379838083818382838383848385838683878388838983908391839283938394839583968397839883998400840184028403840484058406840784088409841084118412841384148415841684178418841984208421842284238424842584268427842884298430843184328433843484358436843784388439844084418442844384448445844684478448844984508451845284538454845584568457845884598460846184628463846484658466846784688469847084718472847384748475847684778478847984808481848284838484848584868487848884898490849184928493849484958496849784988499850085018502850385048505850685078508850985108511851285138514851585168517851885198520852185228523852485258526852785288529853085318532853385348535853685378538853985408541854285438544854585468547854885498550855185528553855485558556855785588559856085618562856385648565856685678568856985708571857285738574857585768577857885798580858185828583858485858586858785888589859085918592859385948595859685978598859986008601860286038604860586068607860886098610861186128613861486158616861786188619862086218622862386248625862686278628862986308631863286338634863586368637863886398640864186428643864486458646864786488649865086518652865386548655865686578658865986608661866286638664866586668667866886698670867186728673867486758676867786788679868086818682868386848685868686878688868986908691869286938694869586968697869886998700870187028703870487058706870787088709871087118712871387148715871687178718871987208721872287238724872587268727872887298730873187328733873487358736873787388739874087418742874387448745874687478748874987508751875287538754875587568757875887598760876187628763876487658766876787688769877087718772877387748775877687778778877987808781878287838784878587868787878887898790879187928793879487958796879787988799880088018802880388048805880688078808880988108811881288138814881588168817881888198820882188228823882488258826882788288829883088318832883388348835883688378838883988408841884288438844884588468847884888498850885188528853885488558856885788588859886088618862886388648865886688678868886988708871887288738874887588768877887888798880888188828883888488858886888788888889889088918892889388948895889688978898889989008901890289038904890589068907890889098910891189128913891489158916891789188919892089218922892389248925892689278928892989308931893289338934893589368937893889398940894189428943894489458946894789488949895089518952895389548955895689578958895989608961896289638964896589668967896889698970897189728973897489758976897789788979898089818982898389848985898689878988898989908991899289938994899589968997899889999000900190029003900490059006900790089009901090119012901390149015901690179018901990209021902290239024902590269027902890299030903190329033903490359036903790389039904090419042904390449045904690479048904990509051905290539054905590569057905890599060906190629063906490659066906790689069907090719072907390749075907690779078907990809081908290839084908590869087908890899090909190929093909490959096909790989099910091019102910391049105910691079108910991109111911291139114911591169117911891199120912191229123912491259126912791289129913091319132913391349135913691379138913991409141914291439144914591469147914891499150915191529153915491559156915791589159916091619162916391649165916691679168916991709171917291739174917591769177917891799180918191829183918491859186918791889189919091919192919391949195919691979198919992009201920292039204920592069207920892099210921192129213921492159216921792189219922092219222922392249225922692279228922992309231923292339234923592369237923892399240924192429243924492459246924792489249925092519252925392549255925692579258925992609261926292639264926592669267926892699270927192729273927492759276927792789279928092819282928392849285928692879288928992909291929292939294929592969297929892999300930193029303930493059306930793089309931093119312931393149315931693179318931993209321932293239324932593269327932893299330933193329333933493359336933793389339934093419342934393449345934693479348934993509351935293539354935593569357935893599360936193629363936493659366936793689369937093719372937393749375937693779378937993809381938293839384938593869387938893899390939193929393939493959396939793989399940094019402940394049405940694079408940994109411941294139414941594169417941894199420942194229423942494259426942794289429943094319432943394349435943694379438943994409441944294439444944594469447944894499450945194529453945494559456945794589459946094619462946394649465946694679468946994709471947294739474947594769477947894799480948194829483948494859486948794889489949094919492949394949495949694979498949995009501950295039504950595069507950895099510951195129513951495159516951795189519952095219522952395249525952695279528952995309531953295339534953595369537953895399540954195429543954495459546954795489549955095519552955395549555955695579558955995609561956295639564956595669567956895699570957195729573957495759576957795789579958095819582958395849585958695879588958995909591959295939594959595969597959895999600960196029603960496059606960796089609961096119612961396149615961696179618961996209621962296239624962596269627962896299630963196329633963496359636963796389639964096419642964396449645964696479648964996509651965296539654965596569657965896599660966196629663966496659666966796689669967096719672967396749675967696779678967996809681968296839684968596869687968896899690969196929693969496959696969796989699970097019702970397049705970697079708970997109711971297139714971597169717971897199720972197229723972497259726972797289729973097319732973397349735973697379738973997409741974297439744974597469747974897499750975197529753975497559756975797589759976097619762976397649765976697679768976997709771977297739774977597769777977897799780978197829783978497859786978797889789979097919792979397949795979697979798979998009801980298039804980598069807980898099810981198129813981498159816981798189819982098219822982398249825982698279828982998309831983298339834983598369837983898399840984198429843984498459846984798489849985098519852985398549855985698579858985998609861986298639864986598669867986898699870987198729873987498759876987798789879988098819882988398849885988698879888988998909891989298939894989598969897989898999900990199029903990499059906990799089909991099119912991399149915991699179918991999209921992299239924992599269927992899299930993199329933993499359936993799389939994099419942994399449945994699479948994999509951995299539954995599569957995899599960996199629963996499659966996799689969997099719972997399749975997699779978997999809981998299839984998599869987998899899990999199929993999499959996999799989999100001000110002100031000410005100061000710008100091001010011100121001310014100151001610017100181001910020100211002210023100241002510026100271002810029100301003110032100331003410035100361003710038100391004010041100421004310044100451004610047100481004910050100511005210053100541005510056100571005810059100601006110062100631006410065100661006710068100691007010071100721007310074100751007610077100781007910080100811008210083100841008510086100871008810089100901009110092100931009410095100961009710098100991010010101101021010310104101051010610107101081010910110101111011210113101141011510116101171011810119101201012110122101231012410125101261012710128101291013010131101321013310134101351013610137101381013910140101411014210143101441014510146101471014810149101501015110152101531015410155101561015710158101591016010161101621016310164101651016610167101681016910170101711017210173101741017510176101771017810179101801018110182101831018410185101861018710188101891019010191101921019310194101951019610197101981019910200102011020210203102041020510206102071020810209102101021110212102131021410215102161021710218102191022010221102221022310224102251022610227102281022910230102311023210233102341023510236102371023810239102401024110242102431024410245102461024710248102491025010251102521025310254102551025610257102581025910260102611026210263102641026510266102671026810269102701027110272102731027410275102761027710278102791028010281102821028310284102851028610287102881028910290102911029210293102941029510296102971029810299103001030110302103031030410305103061030710308103091031010311103121031310314103151031610317103181031910320103211032210323103241032510326103271032810329103301033110332103331033410335103361033710338103391034010341103421034310344103451034610347103481034910350103511035210353103541035510356103571035810359103601036110362103631036410365103661036710368103691037010371103721037310374103751037610377103781037910380103811038210383103841038510386103871038810389103901039110392103931039410395103961039710398103991040010401104021040310404104051040610407104081040910410104111041210413104141041510416104171041810419104201042110422104231042410425104261042710428104291043010431104321043310434104351043610437104381043910440104411044210443104441044510446104471044810449104501045110452104531045410455104561045710458104591046010461104621046310464104651046610467104681046910470104711047210473104741047510476104771047810479104801048110482104831048410485104861048710488104891049010491104921049310494104951049610497104981049910500105011050210503105041050510506105071050810509105101051110512105131051410515105161051710518105191052010521105221052310524105251052610527105281052910530105311053210533105341053510536105371053810539105401054110542105431054410545105461054710548105491055010551105521055310554105551055610557105581055910560105611056210563105641056510566105671056810569105701057110572105731057410575105761057710578105791058010581105821058310584105851058610587105881058910590105911059210593105941059510596105971059810599106001060110602106031060410605106061060710608106091061010611106121061310614106151061610617106181061910620106211062210623106241062510626106271062810629106301063110632106331063410635106361063710638106391064010641106421064310644106451064610647106481064910650106511065210653106541065510656106571065810659106601066110662106631066410665106661066710668106691067010671106721067310674106751067610677106781067910680106811068210683106841068510686106871068810689106901069110692106931069410695106961069710698106991070010701107021070310704107051070610707107081070910710107111071210713107141071510716107171071810719107201072110722107231072410725107261072710728107291073010731107321073310734107351073610737107381073910740107411074210743107441074510746107471074810749107501075110752107531075410755107561075710758107591076010761107621076310764107651076610767107681076910770107711077210773107741077510776107771077810779107801078110782107831078410785107861078710788107891079010791107921079310794107951079610797107981079910800108011080210803108041080510806108071080810809108101081110812108131081410815108161081710818108191082010821108221082310824108251082610827108281082910830108311083210833108341083510836108371083810839108401084110842108431084410845108461084710848108491085010851108521085310854108551085610857108581085910860108611086210863108641086510866108671086810869108701087110872108731087410875108761087710878108791088010881108821088310884108851088610887108881088910890108911089210893108941089510896108971089810899109001090110902109031090410905109061090710908109091091010911109121091310914109151091610917109181091910920109211092210923109241092510926109271092810929109301093110932109331093410935109361093710938109391094010941109421094310944109451094610947109481094910950109511095210953109541095510956109571095810959109601096110962109631096410965109661096710968109691097010971109721097310974109751097610977109781097910980109811098210983109841098510986109871098810989109901099110992109931099410995109961099710998109991100011001110021100311004110051100611007110081100911010110111101211013110141101511016110171101811019110201102111022110231102411025110261102711028110291103011031110321103311034110351103611037110381103911040110411104211043110441104511046110471104811049110501105111052110531105411055110561105711058110591106011061110621106311064110651106611067110681106911070110711107211073110741107511076110771107811079110801108111082110831108411085110861108711088110891109011091110921109311094110951109611097110981109911100111011110211103111041110511106111071110811109111101111111112111131111411115111161111711118111191112011121111221112311124111251112611127111281112911130111311113211133111341113511136111371113811139111401114111142111431114411145111461114711148111491115011151111521115311154111551115611157111581115911160111611116211163111641116511166111671116811169111701117111172111731117411175111761117711178111791118011181111821118311184111851118611187111881118911190111911119211193111941119511196111971119811199112001120111202112031120411205112061120711208112091121011211112121121311214112151121611217112181121911220112211122211223112241122511226112271122811229112301123111232112331123411235112361123711238112391124011241112421124311244112451124611247112481124911250112511125211253112541125511256112571125811259112601126111262112631126411265112661126711268112691127011271112721127311274112751127611277112781127911280112811128211283112841128511286112871128811289112901129111292112931129411295112961129711298112991130011301113021130311304113051130611307113081130911310113111131211313113141131511316113171131811319113201132111322113231132411325113261132711328113291133011331113321133311334113351133611337113381133911340113411134211343113441134511346113471134811349113501135111352113531135411355113561135711358113591136011361113621136311364113651136611367113681136911370113711137211373113741137511376113771137811379113801138111382113831138411385113861138711388113891139011391113921139311394113951139611397113981139911400114011140211403114041140511406114071140811409114101141111412114131141411415114161141711418114191142011421114221142311424114251142611427114281142911430114311143211433114341143511436114371143811439114401144111442114431144411445114461144711448114491145011451114521145311454114551145611457114581145911460114611146211463114641146511466114671146811469114701147111472114731147411475114761147711478114791148011481114821148311484114851148611487114881148911490114911149211493114941149511496114971149811499115001150111502115031150411505115061150711508115091151011511115121151311514115151151611517115181151911520115211152211523115241152511526115271152811529115301153111532115331153411535115361153711538115391154011541115421154311544115451154611547115481154911550115511155211553115541155511556115571155811559115601156111562115631156411565115661156711568115691157011571115721157311574115751157611577115781157911580115811158211583115841158511586115871158811589115901159111592115931159411595115961159711598115991160011601116021160311604116051160611607116081160911610116111161211613116141161511616116171161811619116201162111622116231162411625116261162711628116291163011631116321163311634116351163611637116381163911640116411164211643116441164511646116471164811649116501165111652116531165411655116561165711658116591166011661116621166311664116651166611667116681166911670116711167211673116741167511676116771167811679116801168111682116831168411685116861168711688116891169011691116921169311694116951169611697116981169911700117011170211703117041170511706117071170811709117101171111712117131171411715117161171711718117191172011721117221172311724117251172611727117281172911730117311173211733117341173511736117371173811739117401174111742117431174411745117461174711748117491175011751117521175311754117551175611757117581175911760117611176211763117641176511766117671176811769117701177111772117731177411775117761177711778117791178011781117821178311784117851178611787117881178911790117911179211793117941179511796117971179811799118001180111802118031180411805118061180711808118091181011811118121181311814118151181611817118181181911820118211182211823118241182511826118271182811829118301183111832118331183411835118361183711838118391184011841118421184311844118451184611847118481184911850118511185211853118541185511856118571185811859118601186111862118631186411865118661186711868118691187011871118721187311874118751187611877118781187911880118811188211883118841188511886118871188811889118901189111892118931189411895118961189711898118991190011901119021190311904119051190611907119081190911910119111191211913119141191511916119171191811919119201192111922119231192411925119261192711928119291193011931119321193311934119351193611937119381193911940119411194211943119441194511946119471194811949119501195111952119531195411955119561195711958119591196011961119621196311964119651196611967119681196911970119711197211973119741197511976119771197811979119801198111982119831198411985119861198711988119891199011991119921199311994119951199611997119981199912000120011200212003120041200512006120071200812009120101201112012120131201412015120161201712018120191202012021120221202312024120251202612027120281202912030120311203212033120341203512036120371203812039120401204112042120431204412045120461204712048120491205012051120521205312054120551205612057120581205912060120611206212063120641206512066120671206812069120701207112072120731207412075120761207712078120791208012081120821208312084120851208612087120881208912090120911209212093120941209512096120971209812099121001210112102121031210412105121061210712108121091211012111121121211312114121151211612117121181211912120121211212212123121241212512126121271212812129121301213112132121331213412135121361213712138121391214012141121421214312144121451214612147121481214912150121511215212153121541215512156121571215812159121601216112162121631216412165121661216712168121691217012171121721217312174121751217612177121781217912180121811218212183121841218512186121871218812189121901219112192121931219412195121961219712198121991220012201122021220312204122051220612207122081220912210122111221212213122141221512216122171221812219122201222112222122231222412225122261222712228122291223012231122321223312234122351223612237122381223912240122411224212243122441224512246122471224812249122501225112252122531225412255122561225712258122591226012261122621226312264122651226612267122681226912270122711227212273122741227512276122771227812279122801228112282122831228412285122861228712288122891229012291122921229312294122951229612297122981229912300123011230212303123041230512306123071230812309123101231112312123131231412315123161231712318123191232012321123221232312324123251232612327123281232912330123311233212333123341233512336123371233812339123401234112342123431234412345123461234712348123491235012351123521235312354123551235612357123581235912360123611236212363123641236512366123671236812369123701237112372123731237412375123761237712378123791238012381123821238312384123851238612387123881238912390123911239212393123941239512396123971239812399124001240112402124031240412405124061240712408124091241012411124121241312414124151241612417124181241912420124211242212423124241242512426124271242812429124301243112432124331243412435124361243712438124391244012441124421244312444124451244612447124481244912450124511245212453124541245512456124571245812459124601246112462124631246412465124661246712468124691247012471124721247312474124751247612477124781247912480124811248212483124841248512486124871248812489124901249112492124931249412495124961249712498124991250012501125021250312504125051250612507125081250912510125111251212513125141251512516125171251812519125201252112522125231252412525125261252712528125291253012531125321253312534125351253612537125381253912540125411254212543125441254512546125471254812549125501255112552125531255412555125561255712558125591256012561125621256312564125651256612567125681256912570125711257212573125741257512576125771257812579125801258112582125831258412585125861258712588125891259012591125921259312594125951259612597125981259912600126011260212603126041260512606126071260812609126101261112612126131261412615126161261712618126191262012621126221262312624126251262612627126281262912630126311263212633126341263512636126371263812639126401264112642126431264412645126461264712648126491265012651126521265312654126551265612657126581265912660126611266212663126641266512666126671266812669126701267112672126731267412675126761267712678126791268012681126821268312684126851268612687126881268912690126911269212693126941269512696126971269812699127001270112702127031270412705127061270712708127091271012711127121271312714127151271612717127181271912720127211272212723127241272512726127271272812729127301273112732127331273412735127361273712738127391274012741127421274312744127451274612747127481274912750127511275212753127541275512756127571275812759127601276112762127631276412765127661276712768127691277012771127721277312774127751277612777127781277912780127811278212783127841278512786127871278812789127901279112792127931279412795127961279712798127991280012801128021280312804128051280612807128081280912810128111281212813128141281512816128171281812819128201282112822128231282412825128261282712828128291283012831128321283312834128351283612837128381283912840128411284212843128441284512846128471284812849128501285112852128531285412855128561285712858128591286012861128621286312864128651286612867128681286912870128711287212873128741287512876128771287812879128801288112882128831288412885128861288712888128891289012891128921289312894128951289612897128981289912900129011290212903129041290512906129071290812909129101291112912129131291412915129161291712918129191292012921129221292312924129251292612927129281292912930129311293212933129341293512936129371293812939129401294112942129431294412945129461294712948129491295012951129521295312954129551295612957129581295912960129611296212963129641296512966129671296812969129701297112972129731297412975129761297712978129791298012981129821298312984129851298612987129881298912990129911299212993129941299512996129971299812999130001300113002130031300413005130061300713008130091301013011130121301313014130151301613017130181301913020130211302213023130241302513026130271302813029130301303113032130331303413035130361303713038130391304013041130421304313044130451304613047130481304913050130511305213053130541305513056130571305813059130601306113062130631306413065130661306713068130691307013071130721307313074130751307613077130781307913080130811308213083130841308513086130871308813089130901309113092130931309413095130961309713098130991310013101131021310313104131051310613107131081310913110131111311213113131141311513116131171311813119131201312113122131231312413125131261312713128131291313013131131321313313134131351313613137131381313913140131411314213143131441314513146131471314813149131501315113152131531315413155131561315713158131591316013161131621316313164131651316613167131681316913170131711317213173131741317513176131771317813179131801318113182131831318413185131861318713188131891319013191131921319313194131951319613197131981319913200132011320213203132041320513206132071320813209132101321113212132131321413215132161321713218132191322013221132221322313224132251322613227132281322913230132311323213233132341323513236132371323813239132401324113242132431324413245132461324713248132491325013251132521325313254132551325613257132581325913260132611326213263132641326513266132671326813269132701327113272132731327413275132761327713278132791328013281132821328313284132851328613287132881328913290132911329213293132941329513296132971329813299133001330113302133031330413305133061330713308133091331013311133121331313314133151331613317133181331913320133211332213323133241332513326133271332813329133301333113332133331333413335133361333713338133391334013341133421334313344133451334613347133481334913350133511335213353133541335513356133571335813359133601336113362133631336413365133661336713368133691337013371133721337313374133751337613377133781337913380133811338213383133841338513386133871338813389133901339113392133931339413395133961339713398133991340013401134021340313404134051340613407134081340913410134111341213413134141341513416134171341813419134201342113422134231342413425134261342713428134291343013431134321343313434134351343613437134381343913440134411344213443134441344513446134471344813449134501345113452134531345413455134561345713458134591346013461134621346313464134651346613467134681346913470134711347213473134741347513476134771347813479134801348113482134831348413485134861348713488134891349013491134921349313494134951349613497134981349913500135011350213503135041350513506135071350813509135101351113512135131351413515135161351713518135191352013521135221352313524135251352613527135281352913530135311353213533135341353513536135371353813539135401354113542135431354413545135461354713548135491355013551135521355313554135551355613557135581355913560135611356213563135641356513566135671356813569135701357113572135731357413575135761357713578135791358013581135821358313584135851358613587135881358913590135911359213593135941359513596135971359813599136001360113602136031360413605136061360713608136091361013611136121361313614136151361613617136181361913620136211362213623136241362513626136271362813629136301363113632136331363413635136361363713638136391364013641136421364313644136451364613647136481364913650136511365213653136541365513656136571365813659136601366113662136631366413665136661366713668136691367013671136721367313674136751367613677136781367913680136811368213683136841368513686136871368813689136901369113692136931369413695136961369713698136991370013701137021370313704137051370613707137081370913710137111371213713137141371513716137171371813719137201372113722137231372413725137261372713728137291373013731137321373313734137351373613737137381373913740137411374213743137441374513746137471374813749137501375113752137531375413755137561375713758137591376013761137621376313764137651376613767137681376913770137711377213773137741377513776137771377813779137801378113782137831378413785137861378713788137891379013791137921379313794137951379613797137981379913800138011380213803138041380513806138071380813809138101381113812138131381413815138161381713818138191382013821138221382313824138251382613827138281382913830138311383213833138341383513836138371383813839138401384113842138431384413845138461384713848138491385013851138521385313854138551385613857138581385913860138611386213863138641386513866138671386813869138701387113872138731387413875138761387713878138791388013881138821388313884138851388613887138881388913890138911389213893138941389513896138971389813899139001390113902139031390413905139061390713908139091391013911139121391313914139151391613917139181391913920139211392213923139241392513926139271392813929139301393113932139331393413935139361393713938139391394013941139421394313944139451394613947139481394913950139511395213953139541395513956139571395813959139601396113962139631396413965139661396713968139691397013971139721397313974139751397613977139781397913980139811398213983139841398513986139871398813989139901399113992139931399413995139961399713998139991400014001140021400314004140051400614007140081400914010140111401214013140141401514016140171401814019140201402114022140231402414025140261402714028140291403014031140321403314034140351403614037140381403914040140411404214043140441404514046140471404814049140501405114052140531405414055140561405714058140591406014061140621406314064140651406614067140681406914070140711407214073140741407514076140771407814079140801408114082140831408414085140861408714088140891409014091140921409314094140951409614097140981409914100141011410214103141041410514106141071410814109141101411114112141131411414115141161411714118141191412014121141221412314124141251412614127141281412914130141311413214133141341413514136141371413814139141401414114142141431414414145141461414714148141491415014151141521415314154141551415614157141581415914160141611416214163141641416514166141671416814169141701417114172141731417414175141761417714178141791418014181141821418314184141851418614187141881418914190141911419214193141941419514196141971419814199142001420114202142031420414205142061420714208142091421014211142121421314214142151421614217142181421914220142211422214223142241422514226142271422814229142301423114232142331423414235142361423714238142391424014241142421424314244142451424614247142481424914250142511425214253142541425514256142571425814259142601426114262142631426414265142661426714268142691427014271142721427314274142751427614277142781427914280142811428214283142841428514286142871428814289142901429114292142931429414295142961429714298142991430014301143021430314304143051430614307143081430914310143111431214313143141431514316143171431814319143201432114322143231432414325143261432714328143291433014331143321433314334143351433614337143381433914340143411434214343143441434514346143471434814349143501435114352143531435414355143561435714358143591436014361143621436314364143651436614367143681436914370143711437214373143741437514376143771437814379143801438114382143831438414385143861438714388143891439014391143921439314394143951439614397143981439914400144011440214403144041440514406144071440814409144101441114412144131441414415144161441714418144191442014421144221442314424144251442614427144281442914430144311443214433144341443514436144371443814439144401444114442144431444414445144461444714448144491445014451144521445314454144551445614457144581445914460144611446214463144641446514466144671446814469144701447114472144731447414475144761447714478144791448014481144821448314484144851448614487144881448914490144911449214493144941449514496144971449814499145001450114502145031450414505145061450714508145091451014511145121451314514145151451614517145181451914520145211452214523145241452514526145271452814529145301453114532145331453414535145361453714538145391454014541145421454314544145451454614547145481454914550145511455214553145541455514556145571455814559145601456114562145631456414565145661456714568145691457014571145721457314574145751457614577145781457914580145811458214583145841458514586145871458814589145901459114592145931459414595145961459714598145991460014601146021460314604146051460614607146081460914610146111461214613146141461514616146171461814619146201462114622146231462414625146261462714628146291463014631146321463314634146351463614637146381463914640146411464214643146441464514646146471464814649146501465114652146531465414655146561465714658146591466014661146621466314664146651466614667146681466914670146711467214673146741467514676146771467814679146801468114682146831468414685146861468714688146891469014691146921469314694146951469614697146981469914700147011470214703147041470514706147071470814709147101471114712147131471414715147161471714718147191472014721147221472314724147251472614727147281472914730147311473214733147341473514736147371473814739147401474114742147431474414745147461474714748147491475014751147521475314754147551475614757147581475914760147611476214763147641476514766147671476814769147701477114772147731477414775147761477714778147791478014781147821478314784147851478614787147881478914790147911479214793147941479514796147971479814799148001480114802148031480414805148061480714808148091481014811148121481314814148151481614817148181481914820148211482214823148241482514826148271482814829148301483114832148331483414835148361483714838148391484014841148421484314844148451484614847148481484914850148511485214853148541485514856148571485814859148601486114862148631486414865148661486714868148691487014871148721487314874148751487614877148781487914880148811488214883148841488514886148871488814889148901489114892148931489414895148961489714898148991490014901149021490314904149051490614907149081490914910149111491214913149141491514916149171491814919149201492114922149231492414925149261492714928149291493014931149321493314934149351493614937149381493914940149411494214943149441494514946149471494814949149501495114952149531495414955149561495714958149591496014961149621496314964149651496614967149681496914970149711497214973149741497514976149771497814979149801498114982149831498414985149861498714988149891499014991149921499314994149951499614997149981499915000150011500215003150041500515006150071500815009150101501115012150131501415015150161501715018150191502015021150221502315024150251502615027150281502915030150311503215033150341503515036150371503815039150401504115042150431504415045150461504715048150491505015051150521505315054150551505615057150581505915060150611506215063150641506515066150671506815069150701507115072150731507415075150761507715078150791508015081150821508315084150851508615087150881508915090150911509215093150941509515096150971509815099151001510115102151031510415105151061510715108151091511015111151121511315114151151511615117151181511915120151211512215123151241512515126151271512815129151301513115132151331513415135151361513715138151391514015141151421514315144151451514615147151481514915150151511515215153151541515515156151571515815159151601516115162151631516415165151661516715168151691517015171151721517315174151751517615177151781517915180151811518215183151841518515186151871518815189151901519115192151931519415195151961519715198151991520015201152021520315204152051520615207152081520915210152111521215213152141521515216152171521815219152201522115222152231522415225152261522715228152291523015231152321523315234152351523615237152381523915240152411524215243152441524515246152471524815249152501525115252152531525415255152561525715258152591526015261152621526315264152651526615267152681526915270152711527215273152741527515276152771527815279152801528115282152831528415285152861528715288152891529015291152921529315294152951529615297152981529915300153011530215303153041530515306153071530815309153101531115312153131531415315153161531715318153191532015321153221532315324153251532615327153281532915330153311533215333153341533515336153371533815339153401534115342153431534415345153461534715348153491535015351153521535315354153551535615357153581535915360153611536215363153641536515366153671536815369153701537115372153731537415375153761537715378153791538015381153821538315384153851538615387153881538915390153911539215393153941539515396153971539815399154001540115402154031540415405154061540715408154091541015411154121541315414154151541615417154181541915420154211542215423154241542515426154271542815429154301543115432154331543415435154361543715438154391544015441154421544315444154451544615447154481544915450154511545215453154541545515456154571545815459154601546115462154631546415465154661546715468154691547015471154721547315474154751547615477154781547915480154811548215483154841548515486154871548815489154901549115492154931549415495154961549715498154991550015501155021550315504155051550615507155081550915510155111551215513155141551515516155171551815519155201552115522155231552415525155261552715528155291553015531155321553315534155351553615537155381553915540155411554215543155441554515546155471554815549155501555115552155531555415555155561555715558155591556015561155621556315564155651556615567155681556915570155711557215573155741557515576155771557815579155801558115582155831558415585155861558715588155891559015591155921559315594155951559615597155981559915600156011560215603156041560515606156071560815609156101561115612156131561415615156161561715618156191562015621156221562315624156251562615627156281562915630156311563215633156341563515636156371563815639156401564115642156431564415645156461564715648156491565015651156521565315654156551565615657156581565915660156611566215663156641566515666156671566815669156701567115672156731567415675156761567715678156791568015681156821568315684156851568615687156881568915690156911569215693156941569515696156971569815699157001570115702157031570415705157061570715708157091571015711157121571315714157151571615717157181571915720157211572215723157241572515726157271572815729157301573115732157331573415735157361573715738157391574015741157421574315744157451574615747157481574915750157511575215753157541575515756157571575815759157601576115762157631576415765157661576715768157691577015771157721577315774157751577615777157781577915780157811578215783157841578515786157871578815789157901579115792157931579415795157961579715798157991580015801158021580315804158051580615807158081580915810158111581215813158141581515816158171581815819158201582115822158231582415825158261582715828158291583015831158321583315834158351583615837158381583915840158411584215843158441584515846158471584815849158501585115852158531585415855158561585715858158591586015861158621586315864158651586615867158681586915870158711587215873158741587515876158771587815879158801588115882158831588415885158861588715888158891589015891158921589315894158951589615897158981589915900159011590215903159041590515906159071590815909159101591115912159131591415915159161591715918159191592015921159221592315924159251592615927159281592915930159311593215933159341593515936159371593815939159401594115942159431594415945159461594715948159491595015951159521595315954159551595615957159581595915960159611596215963159641596515966159671596815969159701597115972159731597415975159761597715978159791598015981159821598315984
  1. /*
  2. * This is the new netlink-based wireless configuration interface.
  3. *
  4. * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net>
  5. * Copyright 2013-2014 Intel Mobile Communications GmbH
  6. * Copyright 2015-2017 Intel Deutschland GmbH
  7. * Copyright (C) 2018 Intel Corporation
  8. */
  9. #include <linux/if.h>
  10. #include <linux/module.h>
  11. #include <linux/err.h>
  12. #include <linux/slab.h>
  13. #include <linux/list.h>
  14. #include <linux/if_ether.h>
  15. #include <linux/ieee80211.h>
  16. #include <linux/nl80211.h>
  17. #include <linux/rtnetlink.h>
  18. #include <linux/netlink.h>
  19. #include <linux/nospec.h>
  20. #include <linux/etherdevice.h>
  21. #include <net/net_namespace.h>
  22. #include <net/genetlink.h>
  23. #include <net/cfg80211.h>
  24. #include <net/sock.h>
  25. #include <net/inet_connection_sock.h>
  26. #include "core.h"
  27. #include "nl80211.h"
  28. #include "reg.h"
  29. #include "rdev-ops.h"
  30. static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  31. struct genl_info *info,
  32. struct cfg80211_crypto_settings *settings,
  33. int cipher_limit);
  34. /* the netlink family */
  35. static struct genl_family nl80211_fam;
  36. /* multicast groups */
  37. enum nl80211_multicast_groups {
  38. NL80211_MCGRP_CONFIG,
  39. NL80211_MCGRP_SCAN,
  40. NL80211_MCGRP_REGULATORY,
  41. NL80211_MCGRP_MLME,
  42. NL80211_MCGRP_VENDOR,
  43. NL80211_MCGRP_NAN,
  44. NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
  45. };
  46. static const struct genl_multicast_group nl80211_mcgrps[] = {
  47. [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
  48. [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
  49. [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
  50. [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
  51. [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
  52. [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
  53. #ifdef CONFIG_NL80211_TESTMODE
  54. [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
  55. #endif
  56. };
  57. /* returns ERR_PTR values */
  58. static struct wireless_dev *
  59. __cfg80211_wdev_from_attrs(struct net *netns, struct nlattr **attrs)
  60. {
  61. struct cfg80211_registered_device *rdev;
  62. struct wireless_dev *result = NULL;
  63. bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
  64. bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
  65. u64 wdev_id;
  66. int wiphy_idx = -1;
  67. int ifidx = -1;
  68. ASSERT_RTNL();
  69. if (!have_ifidx && !have_wdev_id)
  70. return ERR_PTR(-EINVAL);
  71. if (have_ifidx)
  72. ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  73. if (have_wdev_id) {
  74. wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  75. wiphy_idx = wdev_id >> 32;
  76. }
  77. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  78. struct wireless_dev *wdev;
  79. if (wiphy_net(&rdev->wiphy) != netns)
  80. continue;
  81. if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
  82. continue;
  83. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  84. if (have_ifidx && wdev->netdev &&
  85. wdev->netdev->ifindex == ifidx) {
  86. result = wdev;
  87. break;
  88. }
  89. if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
  90. result = wdev;
  91. break;
  92. }
  93. }
  94. if (result)
  95. break;
  96. }
  97. if (result)
  98. return result;
  99. return ERR_PTR(-ENODEV);
  100. }
  101. static struct cfg80211_registered_device *
  102. __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
  103. {
  104. struct cfg80211_registered_device *rdev = NULL, *tmp;
  105. struct net_device *netdev;
  106. ASSERT_RTNL();
  107. if (!attrs[NL80211_ATTR_WIPHY] &&
  108. !attrs[NL80211_ATTR_IFINDEX] &&
  109. !attrs[NL80211_ATTR_WDEV])
  110. return ERR_PTR(-EINVAL);
  111. if (attrs[NL80211_ATTR_WIPHY])
  112. rdev = cfg80211_rdev_by_wiphy_idx(
  113. nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
  114. if (attrs[NL80211_ATTR_WDEV]) {
  115. u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  116. struct wireless_dev *wdev;
  117. bool found = false;
  118. tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
  119. if (tmp) {
  120. /* make sure wdev exists */
  121. list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
  122. if (wdev->identifier != (u32)wdev_id)
  123. continue;
  124. found = true;
  125. break;
  126. }
  127. if (!found)
  128. tmp = NULL;
  129. if (rdev && tmp != rdev)
  130. return ERR_PTR(-EINVAL);
  131. rdev = tmp;
  132. }
  133. }
  134. if (attrs[NL80211_ATTR_IFINDEX]) {
  135. int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  136. netdev = __dev_get_by_index(netns, ifindex);
  137. if (netdev) {
  138. if (netdev->ieee80211_ptr)
  139. tmp = wiphy_to_rdev(
  140. netdev->ieee80211_ptr->wiphy);
  141. else
  142. tmp = NULL;
  143. /* not wireless device -- return error */
  144. if (!tmp)
  145. return ERR_PTR(-EINVAL);
  146. /* mismatch -- return error */
  147. if (rdev && tmp != rdev)
  148. return ERR_PTR(-EINVAL);
  149. rdev = tmp;
  150. }
  151. }
  152. if (!rdev)
  153. return ERR_PTR(-ENODEV);
  154. if (netns != wiphy_net(&rdev->wiphy))
  155. return ERR_PTR(-ENODEV);
  156. return rdev;
  157. }
  158. /*
  159. * This function returns a pointer to the driver
  160. * that the genl_info item that is passed refers to.
  161. *
  162. * The result of this can be a PTR_ERR and hence must
  163. * be checked with IS_ERR() for errors.
  164. */
  165. static struct cfg80211_registered_device *
  166. cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
  167. {
  168. return __cfg80211_rdev_from_attrs(netns, info->attrs);
  169. }
  170. /* policy for the attributes */
  171. static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
  172. [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
  173. [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
  174. .len = 20-1 },
  175. [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
  176. [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
  177. [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
  178. [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
  179. [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
  180. [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
  181. [NL80211_ATTR_WIPHY_RETRY_SHORT] = { .type = NLA_U8 },
  182. [NL80211_ATTR_WIPHY_RETRY_LONG] = { .type = NLA_U8 },
  183. [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
  184. [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
  185. [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
  186. [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
  187. [NL80211_ATTR_IFTYPE] = { .type = NLA_U32 },
  188. [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
  189. [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
  190. [NL80211_ATTR_MAC] = { .len = ETH_ALEN },
  191. [NL80211_ATTR_PREV_BSSID] = { .len = ETH_ALEN },
  192. [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
  193. [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
  194. .len = WLAN_MAX_KEY_LEN },
  195. [NL80211_ATTR_KEY_IDX] = { .type = NLA_U8 },
  196. [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
  197. [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
  198. [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
  199. [NL80211_ATTR_KEY_TYPE] = { .type = NLA_U32 },
  200. [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
  201. [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
  202. [NL80211_ATTR_BEACON_HEAD] = { .type = NLA_BINARY,
  203. .len = IEEE80211_MAX_DATA_LEN },
  204. [NL80211_ATTR_BEACON_TAIL] = { .type = NLA_BINARY,
  205. .len = IEEE80211_MAX_DATA_LEN },
  206. [NL80211_ATTR_STA_AID] = { .type = NLA_U16 },
  207. [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
  208. [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
  209. [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
  210. .len = NL80211_MAX_SUPP_RATES },
  211. [NL80211_ATTR_STA_PLINK_ACTION] = { .type = NLA_U8 },
  212. [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
  213. [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
  214. [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
  215. .len = IEEE80211_MAX_MESH_ID_LEN },
  216. [NL80211_ATTR_MPATH_NEXT_HOP] = { .type = NLA_U32 },
  217. [NL80211_ATTR_REG_ALPHA2] = { .type = NLA_STRING, .len = 2 },
  218. [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
  219. [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
  220. [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
  221. [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
  222. [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
  223. .len = NL80211_MAX_SUPP_RATES },
  224. [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
  225. [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
  226. [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
  227. [NL80211_ATTR_HT_CAPABILITY] = { .len = NL80211_HT_CAPABILITY_LEN },
  228. [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
  229. [NL80211_ATTR_IE] = { .type = NLA_BINARY,
  230. .len = IEEE80211_MAX_DATA_LEN },
  231. [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
  232. [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
  233. [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
  234. .len = IEEE80211_MAX_SSID_LEN },
  235. [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
  236. [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
  237. [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
  238. [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
  239. [NL80211_ATTR_USE_MFP] = { .type = NLA_U32 },
  240. [NL80211_ATTR_STA_FLAGS2] = {
  241. .len = sizeof(struct nl80211_sta_flag_update),
  242. },
  243. [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
  244. [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
  245. [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
  246. [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG },
  247. [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
  248. [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
  249. [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
  250. [NL80211_ATTR_PID] = { .type = NLA_U32 },
  251. [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
  252. [NL80211_ATTR_PMKID] = { .len = WLAN_PMKID_LEN },
  253. [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
  254. [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
  255. [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
  256. [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
  257. .len = IEEE80211_MAX_DATA_LEN },
  258. [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
  259. [NL80211_ATTR_PS_STATE] = { .type = NLA_U32 },
  260. [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
  261. [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
  262. [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
  263. [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
  264. [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
  265. [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
  266. [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
  267. [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
  268. [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
  269. [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
  270. [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  271. [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
  272. [NL80211_ATTR_STA_PLINK_STATE] = { .type = NLA_U8 },
  273. [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
  274. [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
  275. [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
  276. [NL80211_ATTR_HIDDEN_SSID] = { .type = NLA_U32 },
  277. [NL80211_ATTR_IE_PROBE_RESP] = { .type = NLA_BINARY,
  278. .len = IEEE80211_MAX_DATA_LEN },
  279. [NL80211_ATTR_IE_ASSOC_RESP] = { .type = NLA_BINARY,
  280. .len = IEEE80211_MAX_DATA_LEN },
  281. [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
  282. [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
  283. [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
  284. [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
  285. [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
  286. [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
  287. [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
  288. [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
  289. [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
  290. [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
  291. [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
  292. .len = IEEE80211_MAX_DATA_LEN },
  293. [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
  294. [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
  295. [NL80211_ATTR_HT_CAPABILITY_MASK] = {
  296. .len = NL80211_HT_CAPABILITY_LEN
  297. },
  298. [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
  299. [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
  300. [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
  301. [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
  302. [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
  303. [NL80211_ATTR_AUTH_DATA] = { .type = NLA_BINARY, },
  304. [NL80211_ATTR_VHT_CAPABILITY] = { .len = NL80211_VHT_CAPABILITY_LEN },
  305. [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
  306. [NL80211_ATTR_P2P_CTWINDOW] = { .type = NLA_U8 },
  307. [NL80211_ATTR_P2P_OPPPS] = { .type = NLA_U8 },
  308. [NL80211_ATTR_LOCAL_MESH_POWER_MODE] = {. type = NLA_U32 },
  309. [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
  310. [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
  311. [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
  312. [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
  313. [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
  314. [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
  315. [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
  316. .len = NL80211_VHT_CAPABILITY_LEN,
  317. },
  318. [NL80211_ATTR_MDID] = { .type = NLA_U16 },
  319. [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
  320. .len = IEEE80211_MAX_DATA_LEN },
  321. [NL80211_ATTR_PEER_AID] = { .type = NLA_U16 },
  322. [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
  323. [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
  324. [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
  325. [NL80211_ATTR_CSA_C_OFF_BEACON] = { .type = NLA_BINARY },
  326. [NL80211_ATTR_CSA_C_OFF_PRESP] = { .type = NLA_BINARY },
  327. [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = { .type = NLA_BINARY },
  328. [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] = { .type = NLA_BINARY },
  329. [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
  330. [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
  331. [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
  332. [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
  333. [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
  334. [NL80211_ATTR_QOS_MAP] = { .type = NLA_BINARY,
  335. .len = IEEE80211_QOS_MAP_LEN_MAX },
  336. [NL80211_ATTR_MAC_HINT] = { .len = ETH_ALEN },
  337. [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
  338. [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
  339. [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
  340. [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
  341. [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
  342. [NL80211_ATTR_TSID] = { .type = NLA_U8 },
  343. [NL80211_ATTR_USER_PRIO] = { .type = NLA_U8 },
  344. [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
  345. [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
  346. [NL80211_ATTR_MAC_MASK] = { .len = ETH_ALEN },
  347. [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
  348. [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
  349. [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
  350. [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
  351. [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
  352. [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
  353. [NL80211_ATTR_STA_SUPPORT_P2P_PS] = { .type = NLA_U8 },
  354. [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
  355. .len = VHT_MUMIMO_GROUPS_DATA_LEN
  356. },
  357. [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = { .len = ETH_ALEN },
  358. [NL80211_ATTR_NAN_MASTER_PREF] = { .type = NLA_U8 },
  359. [NL80211_ATTR_BANDS] = { .type = NLA_U32 },
  360. [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
  361. [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
  362. .len = FILS_MAX_KEK_LEN },
  363. [NL80211_ATTR_FILS_NONCES] = { .len = 2 * FILS_NONCE_LEN },
  364. [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
  365. [NL80211_ATTR_BSSID] = { .len = ETH_ALEN },
  366. [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
  367. [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
  368. .len = sizeof(struct nl80211_bss_select_rssi_adjust)
  369. },
  370. [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
  371. [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
  372. .len = FILS_ERP_MAX_USERNAME_LEN },
  373. [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
  374. .len = FILS_ERP_MAX_REALM_LEN },
  375. [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
  376. [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
  377. .len = FILS_ERP_MAX_RRK_LEN },
  378. [NL80211_ATTR_FILS_CACHE_ID] = { .len = 2 },
  379. [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
  380. [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
  381. [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
  382. [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 },
  383. [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 },
  384. [NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 },
  385. };
  386. /* policy for the key attributes */
  387. static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
  388. [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
  389. [NL80211_KEY_IDX] = { .type = NLA_U8 },
  390. [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
  391. [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
  392. [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
  393. [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
  394. [NL80211_KEY_TYPE] = { .type = NLA_U32 },
  395. [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  396. };
  397. /* policy for the key default flags */
  398. static const struct nla_policy
  399. nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
  400. [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
  401. [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
  402. };
  403. #ifdef CONFIG_PM
  404. /* policy for WoWLAN attributes */
  405. static const struct nla_policy
  406. nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
  407. [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
  408. [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
  409. [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
  410. [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
  411. [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
  412. [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
  413. [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
  414. [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
  415. [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
  416. [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
  417. };
  418. static const struct nla_policy
  419. nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
  420. [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
  421. [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
  422. [NL80211_WOWLAN_TCP_DST_MAC] = { .len = ETH_ALEN },
  423. [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
  424. [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
  425. [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = { .len = 1 },
  426. [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
  427. .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
  428. },
  429. [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
  430. .len = sizeof(struct nl80211_wowlan_tcp_data_token)
  431. },
  432. [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
  433. [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = { .len = 1 },
  434. [NL80211_WOWLAN_TCP_WAKE_MASK] = { .len = 1 },
  435. };
  436. #endif /* CONFIG_PM */
  437. /* policy for coalesce rule attributes */
  438. static const struct nla_policy
  439. nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
  440. [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
  441. [NL80211_ATTR_COALESCE_RULE_CONDITION] = { .type = NLA_U32 },
  442. [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
  443. };
  444. /* policy for GTK rekey offload attributes */
  445. static const struct nla_policy
  446. nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
  447. [NL80211_REKEY_DATA_KEK] = { .len = NL80211_KEK_LEN },
  448. [NL80211_REKEY_DATA_KCK] = { .len = NL80211_KCK_LEN },
  449. [NL80211_REKEY_DATA_REPLAY_CTR] = { .len = NL80211_REPLAY_CTR_LEN },
  450. };
  451. static const struct nla_policy
  452. nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
  453. [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
  454. .len = IEEE80211_MAX_SSID_LEN },
  455. [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = { .len = ETH_ALEN },
  456. [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
  457. };
  458. static const struct nla_policy
  459. nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
  460. [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
  461. [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
  462. };
  463. static const struct nla_policy
  464. nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
  465. [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
  466. [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
  467. [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
  468. .len = sizeof(struct nl80211_bss_select_rssi_adjust)
  469. },
  470. };
  471. /* policy for NAN function attributes */
  472. static const struct nla_policy
  473. nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
  474. [NL80211_NAN_FUNC_TYPE] = { .type = NLA_U8 },
  475. [NL80211_NAN_FUNC_SERVICE_ID] = {
  476. .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
  477. [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
  478. [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
  479. [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
  480. [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
  481. [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
  482. [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = { .len = ETH_ALEN },
  483. [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
  484. [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
  485. [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
  486. .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
  487. [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
  488. [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
  489. [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
  490. [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
  491. [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
  492. };
  493. /* policy for Service Response Filter attributes */
  494. static const struct nla_policy
  495. nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
  496. [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
  497. [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
  498. .len = NL80211_NAN_FUNC_SRF_MAX_LEN },
  499. [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
  500. [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
  501. };
  502. /* policy for packet pattern attributes */
  503. static const struct nla_policy
  504. nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
  505. [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
  506. [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
  507. [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
  508. };
  509. static int nl80211_prepare_wdev_dump(struct sk_buff *skb,
  510. struct netlink_callback *cb,
  511. struct cfg80211_registered_device **rdev,
  512. struct wireless_dev **wdev)
  513. {
  514. int err;
  515. if (!cb->args[0]) {
  516. err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
  517. genl_family_attrbuf(&nl80211_fam),
  518. nl80211_fam.maxattr, nl80211_policy, NULL);
  519. if (err)
  520. return err;
  521. *wdev = __cfg80211_wdev_from_attrs(
  522. sock_net(skb->sk),
  523. genl_family_attrbuf(&nl80211_fam));
  524. if (IS_ERR(*wdev))
  525. return PTR_ERR(*wdev);
  526. *rdev = wiphy_to_rdev((*wdev)->wiphy);
  527. /* 0 is the first index - add 1 to parse only once */
  528. cb->args[0] = (*rdev)->wiphy_idx + 1;
  529. cb->args[1] = (*wdev)->identifier;
  530. } else {
  531. /* subtract the 1 again here */
  532. struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
  533. struct wireless_dev *tmp;
  534. if (!wiphy)
  535. return -ENODEV;
  536. *rdev = wiphy_to_rdev(wiphy);
  537. *wdev = NULL;
  538. list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
  539. if (tmp->identifier == cb->args[1]) {
  540. *wdev = tmp;
  541. break;
  542. }
  543. }
  544. if (!*wdev)
  545. return -ENODEV;
  546. }
  547. return 0;
  548. }
  549. /* IE validation */
  550. static bool is_valid_ie_attr(const struct nlattr *attr)
  551. {
  552. const u8 *pos;
  553. int len;
  554. if (!attr)
  555. return true;
  556. pos = nla_data(attr);
  557. len = nla_len(attr);
  558. while (len) {
  559. u8 elemlen;
  560. if (len < 2)
  561. return false;
  562. len -= 2;
  563. elemlen = pos[1];
  564. if (elemlen > len)
  565. return false;
  566. len -= elemlen;
  567. pos += 2 + elemlen;
  568. }
  569. return true;
  570. }
  571. /* message building helper */
  572. static inline void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
  573. int flags, u8 cmd)
  574. {
  575. /* since there is no private header just add the generic one */
  576. return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
  577. }
  578. static int nl80211_msg_put_wmm_rules(struct sk_buff *msg,
  579. const struct ieee80211_reg_rule *rule)
  580. {
  581. int j;
  582. struct nlattr *nl_wmm_rules =
  583. nla_nest_start(msg, NL80211_FREQUENCY_ATTR_WMM);
  584. if (!nl_wmm_rules)
  585. goto nla_put_failure;
  586. for (j = 0; j < IEEE80211_NUM_ACS; j++) {
  587. struct nlattr *nl_wmm_rule = nla_nest_start(msg, j);
  588. if (!nl_wmm_rule)
  589. goto nla_put_failure;
  590. if (nla_put_u16(msg, NL80211_WMMR_CW_MIN,
  591. rule->wmm_rule->client[j].cw_min) ||
  592. nla_put_u16(msg, NL80211_WMMR_CW_MAX,
  593. rule->wmm_rule->client[j].cw_max) ||
  594. nla_put_u8(msg, NL80211_WMMR_AIFSN,
  595. rule->wmm_rule->client[j].aifsn) ||
  596. nla_put_u8(msg, NL80211_WMMR_TXOP,
  597. rule->wmm_rule->client[j].cot))
  598. goto nla_put_failure;
  599. nla_nest_end(msg, nl_wmm_rule);
  600. }
  601. nla_nest_end(msg, nl_wmm_rules);
  602. return 0;
  603. nla_put_failure:
  604. return -ENOBUFS;
  605. }
  606. static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy,
  607. struct ieee80211_channel *chan,
  608. bool large)
  609. {
  610. /* Some channels must be completely excluded from the
  611. * list to protect old user-space tools from breaking
  612. */
  613. if (!large && chan->flags &
  614. (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
  615. return 0;
  616. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
  617. chan->center_freq))
  618. goto nla_put_failure;
  619. if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
  620. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
  621. goto nla_put_failure;
  622. if (chan->flags & IEEE80211_CHAN_NO_IR) {
  623. if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
  624. goto nla_put_failure;
  625. if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
  626. goto nla_put_failure;
  627. }
  628. if (chan->flags & IEEE80211_CHAN_RADAR) {
  629. if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
  630. goto nla_put_failure;
  631. if (large) {
  632. u32 time;
  633. time = elapsed_jiffies_msecs(chan->dfs_state_entered);
  634. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
  635. chan->dfs_state))
  636. goto nla_put_failure;
  637. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
  638. time))
  639. goto nla_put_failure;
  640. if (nla_put_u32(msg,
  641. NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
  642. chan->dfs_cac_ms))
  643. goto nla_put_failure;
  644. }
  645. }
  646. if (large) {
  647. if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
  648. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
  649. goto nla_put_failure;
  650. if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
  651. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
  652. goto nla_put_failure;
  653. if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
  654. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
  655. goto nla_put_failure;
  656. if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
  657. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
  658. goto nla_put_failure;
  659. if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
  660. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
  661. goto nla_put_failure;
  662. if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
  663. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
  664. goto nla_put_failure;
  665. if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
  666. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
  667. goto nla_put_failure;
  668. if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
  669. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
  670. goto nla_put_failure;
  671. }
  672. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
  673. DBM_TO_MBM(chan->max_power)))
  674. goto nla_put_failure;
  675. if (large) {
  676. const struct ieee80211_reg_rule *rule =
  677. freq_reg_info(wiphy, chan->center_freq);
  678. if (!IS_ERR(rule) && rule->wmm_rule) {
  679. if (nl80211_msg_put_wmm_rules(msg, rule))
  680. goto nla_put_failure;
  681. }
  682. }
  683. return 0;
  684. nla_put_failure:
  685. return -ENOBUFS;
  686. }
  687. static bool nl80211_put_txq_stats(struct sk_buff *msg,
  688. struct cfg80211_txq_stats *txqstats,
  689. int attrtype)
  690. {
  691. struct nlattr *txqattr;
  692. #define PUT_TXQVAL_U32(attr, memb) do { \
  693. if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \
  694. nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \
  695. return false; \
  696. } while (0)
  697. txqattr = nla_nest_start(msg, attrtype);
  698. if (!txqattr)
  699. return false;
  700. PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes);
  701. PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets);
  702. PUT_TXQVAL_U32(FLOWS, flows);
  703. PUT_TXQVAL_U32(DROPS, drops);
  704. PUT_TXQVAL_U32(ECN_MARKS, ecn_marks);
  705. PUT_TXQVAL_U32(OVERLIMIT, overlimit);
  706. PUT_TXQVAL_U32(OVERMEMORY, overmemory);
  707. PUT_TXQVAL_U32(COLLISIONS, collisions);
  708. PUT_TXQVAL_U32(TX_BYTES, tx_bytes);
  709. PUT_TXQVAL_U32(TX_PACKETS, tx_packets);
  710. PUT_TXQVAL_U32(MAX_FLOWS, max_flows);
  711. nla_nest_end(msg, txqattr);
  712. #undef PUT_TXQVAL_U32
  713. return true;
  714. }
  715. /* netlink command implementations */
  716. struct key_parse {
  717. struct key_params p;
  718. int idx;
  719. int type;
  720. bool def, defmgmt;
  721. bool def_uni, def_multi;
  722. };
  723. static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
  724. struct key_parse *k)
  725. {
  726. struct nlattr *tb[NL80211_KEY_MAX + 1];
  727. int err = nla_parse_nested(tb, NL80211_KEY_MAX, key,
  728. nl80211_key_policy, info->extack);
  729. if (err)
  730. return err;
  731. k->def = !!tb[NL80211_KEY_DEFAULT];
  732. k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
  733. if (k->def) {
  734. k->def_uni = true;
  735. k->def_multi = true;
  736. }
  737. if (k->defmgmt)
  738. k->def_multi = true;
  739. if (tb[NL80211_KEY_IDX])
  740. k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
  741. if (tb[NL80211_KEY_DATA]) {
  742. k->p.key = nla_data(tb[NL80211_KEY_DATA]);
  743. k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
  744. }
  745. if (tb[NL80211_KEY_SEQ]) {
  746. k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
  747. k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
  748. }
  749. if (tb[NL80211_KEY_CIPHER])
  750. k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
  751. if (tb[NL80211_KEY_TYPE]) {
  752. k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
  753. if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES)
  754. return genl_err_attr(info, -EINVAL,
  755. tb[NL80211_KEY_TYPE]);
  756. }
  757. if (tb[NL80211_KEY_DEFAULT_TYPES]) {
  758. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  759. err = nla_parse_nested(kdt, NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  760. tb[NL80211_KEY_DEFAULT_TYPES],
  761. nl80211_key_default_policy,
  762. info->extack);
  763. if (err)
  764. return err;
  765. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  766. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  767. }
  768. return 0;
  769. }
  770. static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
  771. {
  772. if (info->attrs[NL80211_ATTR_KEY_DATA]) {
  773. k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
  774. k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
  775. }
  776. if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
  777. k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
  778. k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
  779. }
  780. if (info->attrs[NL80211_ATTR_KEY_IDX])
  781. k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  782. if (info->attrs[NL80211_ATTR_KEY_CIPHER])
  783. k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
  784. k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
  785. k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
  786. if (k->def) {
  787. k->def_uni = true;
  788. k->def_multi = true;
  789. }
  790. if (k->defmgmt)
  791. k->def_multi = true;
  792. if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
  793. k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  794. if (k->type < 0 || k->type >= NUM_NL80211_KEYTYPES) {
  795. GENL_SET_ERR_MSG(info, "key type out of range");
  796. return -EINVAL;
  797. }
  798. }
  799. if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
  800. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  801. int err = nla_parse_nested(kdt,
  802. NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  803. info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
  804. nl80211_key_default_policy,
  805. info->extack);
  806. if (err)
  807. return err;
  808. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  809. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  810. }
  811. return 0;
  812. }
  813. static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
  814. {
  815. int err;
  816. memset(k, 0, sizeof(*k));
  817. k->idx = -1;
  818. k->type = -1;
  819. if (info->attrs[NL80211_ATTR_KEY])
  820. err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
  821. else
  822. err = nl80211_parse_key_old(info, k);
  823. if (err)
  824. return err;
  825. if (k->def && k->defmgmt) {
  826. GENL_SET_ERR_MSG(info, "key with def && defmgmt is invalid");
  827. return -EINVAL;
  828. }
  829. if (k->defmgmt) {
  830. if (k->def_uni || !k->def_multi) {
  831. GENL_SET_ERR_MSG(info, "defmgmt key must be mcast");
  832. return -EINVAL;
  833. }
  834. }
  835. if (k->idx != -1) {
  836. if (k->defmgmt) {
  837. if (k->idx < 4 || k->idx > 5) {
  838. GENL_SET_ERR_MSG(info,
  839. "defmgmt key idx not 4 or 5");
  840. return -EINVAL;
  841. }
  842. } else if (k->def) {
  843. if (k->idx < 0 || k->idx > 3) {
  844. GENL_SET_ERR_MSG(info, "def key idx not 0-3");
  845. return -EINVAL;
  846. }
  847. } else {
  848. if (k->idx < 0 || k->idx > 5) {
  849. GENL_SET_ERR_MSG(info, "key idx not 0-5");
  850. return -EINVAL;
  851. }
  852. }
  853. }
  854. return 0;
  855. }
  856. static struct cfg80211_cached_keys *
  857. nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
  858. struct genl_info *info, bool *no_ht)
  859. {
  860. struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
  861. struct key_parse parse;
  862. struct nlattr *key;
  863. struct cfg80211_cached_keys *result;
  864. int rem, err, def = 0;
  865. bool have_key = false;
  866. nla_for_each_nested(key, keys, rem) {
  867. have_key = true;
  868. break;
  869. }
  870. if (!have_key)
  871. return NULL;
  872. result = kzalloc(sizeof(*result), GFP_KERNEL);
  873. if (!result)
  874. return ERR_PTR(-ENOMEM);
  875. result->def = -1;
  876. nla_for_each_nested(key, keys, rem) {
  877. memset(&parse, 0, sizeof(parse));
  878. parse.idx = -1;
  879. err = nl80211_parse_key_new(info, key, &parse);
  880. if (err)
  881. goto error;
  882. err = -EINVAL;
  883. if (!parse.p.key)
  884. goto error;
  885. if (parse.idx < 0 || parse.idx > 3) {
  886. GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
  887. goto error;
  888. }
  889. if (parse.def) {
  890. if (def) {
  891. GENL_SET_ERR_MSG(info,
  892. "only one key can be default");
  893. goto error;
  894. }
  895. def = 1;
  896. result->def = parse.idx;
  897. if (!parse.def_uni || !parse.def_multi)
  898. goto error;
  899. } else if (parse.defmgmt)
  900. goto error;
  901. err = cfg80211_validate_key_settings(rdev, &parse.p,
  902. parse.idx, false, NULL);
  903. if (err)
  904. goto error;
  905. if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
  906. parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
  907. GENL_SET_ERR_MSG(info, "connect key must be WEP");
  908. err = -EINVAL;
  909. goto error;
  910. }
  911. result->params[parse.idx].cipher = parse.p.cipher;
  912. result->params[parse.idx].key_len = parse.p.key_len;
  913. result->params[parse.idx].key = result->data[parse.idx];
  914. memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
  915. /* must be WEP key if we got here */
  916. if (no_ht)
  917. *no_ht = true;
  918. }
  919. if (result->def < 0) {
  920. err = -EINVAL;
  921. GENL_SET_ERR_MSG(info, "need a default/TX key");
  922. goto error;
  923. }
  924. return result;
  925. error:
  926. kfree(result);
  927. return ERR_PTR(err);
  928. }
  929. static int nl80211_key_allowed(struct wireless_dev *wdev)
  930. {
  931. ASSERT_WDEV_LOCK(wdev);
  932. switch (wdev->iftype) {
  933. case NL80211_IFTYPE_AP:
  934. case NL80211_IFTYPE_AP_VLAN:
  935. case NL80211_IFTYPE_P2P_GO:
  936. case NL80211_IFTYPE_MESH_POINT:
  937. break;
  938. case NL80211_IFTYPE_ADHOC:
  939. case NL80211_IFTYPE_STATION:
  940. case NL80211_IFTYPE_P2P_CLIENT:
  941. if (!wdev->current_bss)
  942. return -ENOLINK;
  943. break;
  944. case NL80211_IFTYPE_UNSPECIFIED:
  945. case NL80211_IFTYPE_OCB:
  946. case NL80211_IFTYPE_MONITOR:
  947. case NL80211_IFTYPE_NAN:
  948. case NL80211_IFTYPE_P2P_DEVICE:
  949. case NL80211_IFTYPE_WDS:
  950. case NUM_NL80211_IFTYPES:
  951. return -EINVAL;
  952. }
  953. return 0;
  954. }
  955. static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
  956. struct nlattr *tb)
  957. {
  958. struct ieee80211_channel *chan;
  959. if (tb == NULL)
  960. return NULL;
  961. chan = ieee80211_get_channel(wiphy, nla_get_u32(tb));
  962. if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
  963. return NULL;
  964. return chan;
  965. }
  966. static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
  967. {
  968. struct nlattr *nl_modes = nla_nest_start(msg, attr);
  969. int i;
  970. if (!nl_modes)
  971. goto nla_put_failure;
  972. i = 0;
  973. while (ifmodes) {
  974. if ((ifmodes & 1) && nla_put_flag(msg, i))
  975. goto nla_put_failure;
  976. ifmodes >>= 1;
  977. i++;
  978. }
  979. nla_nest_end(msg, nl_modes);
  980. return 0;
  981. nla_put_failure:
  982. return -ENOBUFS;
  983. }
  984. static int nl80211_put_iface_combinations(struct wiphy *wiphy,
  985. struct sk_buff *msg,
  986. bool large)
  987. {
  988. struct nlattr *nl_combis;
  989. int i, j;
  990. nl_combis = nla_nest_start(msg,
  991. NL80211_ATTR_INTERFACE_COMBINATIONS);
  992. if (!nl_combis)
  993. goto nla_put_failure;
  994. for (i = 0; i < wiphy->n_iface_combinations; i++) {
  995. const struct ieee80211_iface_combination *c;
  996. struct nlattr *nl_combi, *nl_limits;
  997. c = &wiphy->iface_combinations[i];
  998. nl_combi = nla_nest_start(msg, i + 1);
  999. if (!nl_combi)
  1000. goto nla_put_failure;
  1001. nl_limits = nla_nest_start(msg, NL80211_IFACE_COMB_LIMITS);
  1002. if (!nl_limits)
  1003. goto nla_put_failure;
  1004. for (j = 0; j < c->n_limits; j++) {
  1005. struct nlattr *nl_limit;
  1006. nl_limit = nla_nest_start(msg, j + 1);
  1007. if (!nl_limit)
  1008. goto nla_put_failure;
  1009. if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
  1010. c->limits[j].max))
  1011. goto nla_put_failure;
  1012. if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
  1013. c->limits[j].types))
  1014. goto nla_put_failure;
  1015. nla_nest_end(msg, nl_limit);
  1016. }
  1017. nla_nest_end(msg, nl_limits);
  1018. if (c->beacon_int_infra_match &&
  1019. nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
  1020. goto nla_put_failure;
  1021. if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
  1022. c->num_different_channels) ||
  1023. nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
  1024. c->max_interfaces))
  1025. goto nla_put_failure;
  1026. if (large &&
  1027. (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
  1028. c->radar_detect_widths) ||
  1029. nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
  1030. c->radar_detect_regions)))
  1031. goto nla_put_failure;
  1032. if (c->beacon_int_min_gcd &&
  1033. nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
  1034. c->beacon_int_min_gcd))
  1035. goto nla_put_failure;
  1036. nla_nest_end(msg, nl_combi);
  1037. }
  1038. nla_nest_end(msg, nl_combis);
  1039. return 0;
  1040. nla_put_failure:
  1041. return -ENOBUFS;
  1042. }
  1043. #ifdef CONFIG_PM
  1044. static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
  1045. struct sk_buff *msg)
  1046. {
  1047. const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
  1048. struct nlattr *nl_tcp;
  1049. if (!tcp)
  1050. return 0;
  1051. nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
  1052. if (!nl_tcp)
  1053. return -ENOBUFS;
  1054. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  1055. tcp->data_payload_max))
  1056. return -ENOBUFS;
  1057. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  1058. tcp->data_payload_max))
  1059. return -ENOBUFS;
  1060. if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
  1061. return -ENOBUFS;
  1062. if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
  1063. sizeof(*tcp->tok), tcp->tok))
  1064. return -ENOBUFS;
  1065. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
  1066. tcp->data_interval_max))
  1067. return -ENOBUFS;
  1068. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
  1069. tcp->wake_payload_max))
  1070. return -ENOBUFS;
  1071. nla_nest_end(msg, nl_tcp);
  1072. return 0;
  1073. }
  1074. static int nl80211_send_wowlan(struct sk_buff *msg,
  1075. struct cfg80211_registered_device *rdev,
  1076. bool large)
  1077. {
  1078. struct nlattr *nl_wowlan;
  1079. if (!rdev->wiphy.wowlan)
  1080. return 0;
  1081. nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
  1082. if (!nl_wowlan)
  1083. return -ENOBUFS;
  1084. if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
  1085. nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
  1086. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
  1087. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
  1088. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
  1089. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
  1090. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
  1091. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
  1092. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
  1093. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
  1094. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
  1095. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
  1096. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
  1097. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
  1098. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
  1099. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
  1100. return -ENOBUFS;
  1101. if (rdev->wiphy.wowlan->n_patterns) {
  1102. struct nl80211_pattern_support pat = {
  1103. .max_patterns = rdev->wiphy.wowlan->n_patterns,
  1104. .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
  1105. .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
  1106. .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
  1107. };
  1108. if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  1109. sizeof(pat), &pat))
  1110. return -ENOBUFS;
  1111. }
  1112. if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
  1113. nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
  1114. rdev->wiphy.wowlan->max_nd_match_sets))
  1115. return -ENOBUFS;
  1116. if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
  1117. return -ENOBUFS;
  1118. nla_nest_end(msg, nl_wowlan);
  1119. return 0;
  1120. }
  1121. #endif
  1122. static int nl80211_send_coalesce(struct sk_buff *msg,
  1123. struct cfg80211_registered_device *rdev)
  1124. {
  1125. struct nl80211_coalesce_rule_support rule;
  1126. if (!rdev->wiphy.coalesce)
  1127. return 0;
  1128. rule.max_rules = rdev->wiphy.coalesce->n_rules;
  1129. rule.max_delay = rdev->wiphy.coalesce->max_delay;
  1130. rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
  1131. rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
  1132. rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
  1133. rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
  1134. if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
  1135. return -ENOBUFS;
  1136. return 0;
  1137. }
  1138. static int nl80211_send_band_rateinfo(struct sk_buff *msg,
  1139. struct ieee80211_supported_band *sband)
  1140. {
  1141. struct nlattr *nl_rates, *nl_rate;
  1142. struct ieee80211_rate *rate;
  1143. int i;
  1144. /* add HT info */
  1145. if (sband->ht_cap.ht_supported &&
  1146. (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
  1147. sizeof(sband->ht_cap.mcs),
  1148. &sband->ht_cap.mcs) ||
  1149. nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
  1150. sband->ht_cap.cap) ||
  1151. nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
  1152. sband->ht_cap.ampdu_factor) ||
  1153. nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
  1154. sband->ht_cap.ampdu_density)))
  1155. return -ENOBUFS;
  1156. /* add VHT info */
  1157. if (sband->vht_cap.vht_supported &&
  1158. (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
  1159. sizeof(sband->vht_cap.vht_mcs),
  1160. &sband->vht_cap.vht_mcs) ||
  1161. nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
  1162. sband->vht_cap.cap)))
  1163. return -ENOBUFS;
  1164. /* add bitrates */
  1165. nl_rates = nla_nest_start(msg, NL80211_BAND_ATTR_RATES);
  1166. if (!nl_rates)
  1167. return -ENOBUFS;
  1168. for (i = 0; i < sband->n_bitrates; i++) {
  1169. nl_rate = nla_nest_start(msg, i);
  1170. if (!nl_rate)
  1171. return -ENOBUFS;
  1172. rate = &sband->bitrates[i];
  1173. if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
  1174. rate->bitrate))
  1175. return -ENOBUFS;
  1176. if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
  1177. nla_put_flag(msg,
  1178. NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
  1179. return -ENOBUFS;
  1180. nla_nest_end(msg, nl_rate);
  1181. }
  1182. nla_nest_end(msg, nl_rates);
  1183. return 0;
  1184. }
  1185. static int
  1186. nl80211_send_mgmt_stypes(struct sk_buff *msg,
  1187. const struct ieee80211_txrx_stypes *mgmt_stypes)
  1188. {
  1189. u16 stypes;
  1190. struct nlattr *nl_ftypes, *nl_ifs;
  1191. enum nl80211_iftype ift;
  1192. int i;
  1193. if (!mgmt_stypes)
  1194. return 0;
  1195. nl_ifs = nla_nest_start(msg, NL80211_ATTR_TX_FRAME_TYPES);
  1196. if (!nl_ifs)
  1197. return -ENOBUFS;
  1198. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  1199. nl_ftypes = nla_nest_start(msg, ift);
  1200. if (!nl_ftypes)
  1201. return -ENOBUFS;
  1202. i = 0;
  1203. stypes = mgmt_stypes[ift].tx;
  1204. while (stypes) {
  1205. if ((stypes & 1) &&
  1206. nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
  1207. (i << 4) | IEEE80211_FTYPE_MGMT))
  1208. return -ENOBUFS;
  1209. stypes >>= 1;
  1210. i++;
  1211. }
  1212. nla_nest_end(msg, nl_ftypes);
  1213. }
  1214. nla_nest_end(msg, nl_ifs);
  1215. nl_ifs = nla_nest_start(msg, NL80211_ATTR_RX_FRAME_TYPES);
  1216. if (!nl_ifs)
  1217. return -ENOBUFS;
  1218. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  1219. nl_ftypes = nla_nest_start(msg, ift);
  1220. if (!nl_ftypes)
  1221. return -ENOBUFS;
  1222. i = 0;
  1223. stypes = mgmt_stypes[ift].rx;
  1224. while (stypes) {
  1225. if ((stypes & 1) &&
  1226. nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
  1227. (i << 4) | IEEE80211_FTYPE_MGMT))
  1228. return -ENOBUFS;
  1229. stypes >>= 1;
  1230. i++;
  1231. }
  1232. nla_nest_end(msg, nl_ftypes);
  1233. }
  1234. nla_nest_end(msg, nl_ifs);
  1235. return 0;
  1236. }
  1237. #define CMD(op, n) \
  1238. do { \
  1239. if (rdev->ops->op) { \
  1240. i++; \
  1241. if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
  1242. goto nla_put_failure; \
  1243. } \
  1244. } while (0)
  1245. static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
  1246. struct sk_buff *msg)
  1247. {
  1248. int i = 0;
  1249. /*
  1250. * do *NOT* add anything into this function, new things need to be
  1251. * advertised only to new versions of userspace that can deal with
  1252. * the split (and they can't possibly care about new features...
  1253. */
  1254. CMD(add_virtual_intf, NEW_INTERFACE);
  1255. CMD(change_virtual_intf, SET_INTERFACE);
  1256. CMD(add_key, NEW_KEY);
  1257. CMD(start_ap, START_AP);
  1258. CMD(add_station, NEW_STATION);
  1259. CMD(add_mpath, NEW_MPATH);
  1260. CMD(update_mesh_config, SET_MESH_CONFIG);
  1261. CMD(change_bss, SET_BSS);
  1262. CMD(auth, AUTHENTICATE);
  1263. CMD(assoc, ASSOCIATE);
  1264. CMD(deauth, DEAUTHENTICATE);
  1265. CMD(disassoc, DISASSOCIATE);
  1266. CMD(join_ibss, JOIN_IBSS);
  1267. CMD(join_mesh, JOIN_MESH);
  1268. CMD(set_pmksa, SET_PMKSA);
  1269. CMD(del_pmksa, DEL_PMKSA);
  1270. CMD(flush_pmksa, FLUSH_PMKSA);
  1271. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
  1272. CMD(remain_on_channel, REMAIN_ON_CHANNEL);
  1273. CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
  1274. CMD(mgmt_tx, FRAME);
  1275. CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
  1276. if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
  1277. i++;
  1278. if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
  1279. goto nla_put_failure;
  1280. }
  1281. if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
  1282. rdev->ops->join_mesh) {
  1283. i++;
  1284. if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
  1285. goto nla_put_failure;
  1286. }
  1287. CMD(set_wds_peer, SET_WDS_PEER);
  1288. if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
  1289. CMD(tdls_mgmt, TDLS_MGMT);
  1290. CMD(tdls_oper, TDLS_OPER);
  1291. }
  1292. if (rdev->wiphy.max_sched_scan_reqs)
  1293. CMD(sched_scan_start, START_SCHED_SCAN);
  1294. CMD(probe_client, PROBE_CLIENT);
  1295. CMD(set_noack_map, SET_NOACK_MAP);
  1296. if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
  1297. i++;
  1298. if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
  1299. goto nla_put_failure;
  1300. }
  1301. CMD(start_p2p_device, START_P2P_DEVICE);
  1302. CMD(set_mcast_rate, SET_MCAST_RATE);
  1303. #ifdef CONFIG_NL80211_TESTMODE
  1304. CMD(testmode_cmd, TESTMODE);
  1305. #endif
  1306. if (rdev->ops->connect || rdev->ops->auth) {
  1307. i++;
  1308. if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
  1309. goto nla_put_failure;
  1310. }
  1311. if (rdev->ops->disconnect || rdev->ops->deauth) {
  1312. i++;
  1313. if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
  1314. goto nla_put_failure;
  1315. }
  1316. return i;
  1317. nla_put_failure:
  1318. return -ENOBUFS;
  1319. }
  1320. struct nl80211_dump_wiphy_state {
  1321. s64 filter_wiphy;
  1322. long start;
  1323. long split_start, band_start, chan_start, capa_start;
  1324. bool split;
  1325. };
  1326. static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
  1327. enum nl80211_commands cmd,
  1328. struct sk_buff *msg, u32 portid, u32 seq,
  1329. int flags, struct nl80211_dump_wiphy_state *state)
  1330. {
  1331. void *hdr;
  1332. struct nlattr *nl_bands, *nl_band;
  1333. struct nlattr *nl_freqs, *nl_freq;
  1334. struct nlattr *nl_cmds;
  1335. enum nl80211_band band;
  1336. struct ieee80211_channel *chan;
  1337. int i;
  1338. const struct ieee80211_txrx_stypes *mgmt_stypes =
  1339. rdev->wiphy.mgmt_stypes;
  1340. u32 features;
  1341. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  1342. if (!hdr)
  1343. return -ENOBUFS;
  1344. if (WARN_ON(!state))
  1345. return -EINVAL;
  1346. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  1347. nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
  1348. wiphy_name(&rdev->wiphy)) ||
  1349. nla_put_u32(msg, NL80211_ATTR_GENERATION,
  1350. cfg80211_rdev_list_generation))
  1351. goto nla_put_failure;
  1352. if (cmd != NL80211_CMD_NEW_WIPHY)
  1353. goto finish;
  1354. switch (state->split_start) {
  1355. case 0:
  1356. if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
  1357. rdev->wiphy.retry_short) ||
  1358. nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
  1359. rdev->wiphy.retry_long) ||
  1360. nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
  1361. rdev->wiphy.frag_threshold) ||
  1362. nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
  1363. rdev->wiphy.rts_threshold) ||
  1364. nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
  1365. rdev->wiphy.coverage_class) ||
  1366. nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
  1367. rdev->wiphy.max_scan_ssids) ||
  1368. nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
  1369. rdev->wiphy.max_sched_scan_ssids) ||
  1370. nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
  1371. rdev->wiphy.max_scan_ie_len) ||
  1372. nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
  1373. rdev->wiphy.max_sched_scan_ie_len) ||
  1374. nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
  1375. rdev->wiphy.max_match_sets) ||
  1376. nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
  1377. rdev->wiphy.max_sched_scan_plans) ||
  1378. nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
  1379. rdev->wiphy.max_sched_scan_plan_interval) ||
  1380. nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
  1381. rdev->wiphy.max_sched_scan_plan_iterations))
  1382. goto nla_put_failure;
  1383. if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
  1384. nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
  1385. goto nla_put_failure;
  1386. if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
  1387. nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
  1388. goto nla_put_failure;
  1389. if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
  1390. nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
  1391. goto nla_put_failure;
  1392. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
  1393. nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
  1394. goto nla_put_failure;
  1395. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
  1396. nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
  1397. goto nla_put_failure;
  1398. if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
  1399. nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
  1400. goto nla_put_failure;
  1401. state->split_start++;
  1402. if (state->split)
  1403. break;
  1404. case 1:
  1405. if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
  1406. sizeof(u32) * rdev->wiphy.n_cipher_suites,
  1407. rdev->wiphy.cipher_suites))
  1408. goto nla_put_failure;
  1409. if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
  1410. rdev->wiphy.max_num_pmkids))
  1411. goto nla_put_failure;
  1412. if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  1413. nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
  1414. goto nla_put_failure;
  1415. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
  1416. rdev->wiphy.available_antennas_tx) ||
  1417. nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
  1418. rdev->wiphy.available_antennas_rx))
  1419. goto nla_put_failure;
  1420. if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
  1421. nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
  1422. rdev->wiphy.probe_resp_offload))
  1423. goto nla_put_failure;
  1424. if ((rdev->wiphy.available_antennas_tx ||
  1425. rdev->wiphy.available_antennas_rx) &&
  1426. rdev->ops->get_antenna) {
  1427. u32 tx_ant = 0, rx_ant = 0;
  1428. int res;
  1429. res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
  1430. if (!res) {
  1431. if (nla_put_u32(msg,
  1432. NL80211_ATTR_WIPHY_ANTENNA_TX,
  1433. tx_ant) ||
  1434. nla_put_u32(msg,
  1435. NL80211_ATTR_WIPHY_ANTENNA_RX,
  1436. rx_ant))
  1437. goto nla_put_failure;
  1438. }
  1439. }
  1440. state->split_start++;
  1441. if (state->split)
  1442. break;
  1443. case 2:
  1444. if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
  1445. rdev->wiphy.interface_modes))
  1446. goto nla_put_failure;
  1447. state->split_start++;
  1448. if (state->split)
  1449. break;
  1450. case 3:
  1451. nl_bands = nla_nest_start(msg, NL80211_ATTR_WIPHY_BANDS);
  1452. if (!nl_bands)
  1453. goto nla_put_failure;
  1454. for (band = state->band_start;
  1455. band < NUM_NL80211_BANDS; band++) {
  1456. struct ieee80211_supported_band *sband;
  1457. sband = rdev->wiphy.bands[band];
  1458. if (!sband)
  1459. continue;
  1460. nl_band = nla_nest_start(msg, band);
  1461. if (!nl_band)
  1462. goto nla_put_failure;
  1463. switch (state->chan_start) {
  1464. case 0:
  1465. if (nl80211_send_band_rateinfo(msg, sband))
  1466. goto nla_put_failure;
  1467. state->chan_start++;
  1468. if (state->split)
  1469. break;
  1470. default:
  1471. /* add frequencies */
  1472. nl_freqs = nla_nest_start(
  1473. msg, NL80211_BAND_ATTR_FREQS);
  1474. if (!nl_freqs)
  1475. goto nla_put_failure;
  1476. for (i = state->chan_start - 1;
  1477. i < sband->n_channels;
  1478. i++) {
  1479. nl_freq = nla_nest_start(msg, i);
  1480. if (!nl_freq)
  1481. goto nla_put_failure;
  1482. chan = &sband->channels[i];
  1483. if (nl80211_msg_put_channel(
  1484. msg, &rdev->wiphy, chan,
  1485. state->split))
  1486. goto nla_put_failure;
  1487. nla_nest_end(msg, nl_freq);
  1488. if (state->split)
  1489. break;
  1490. }
  1491. if (i < sband->n_channels)
  1492. state->chan_start = i + 2;
  1493. else
  1494. state->chan_start = 0;
  1495. nla_nest_end(msg, nl_freqs);
  1496. }
  1497. nla_nest_end(msg, nl_band);
  1498. if (state->split) {
  1499. /* start again here */
  1500. if (state->chan_start)
  1501. band--;
  1502. break;
  1503. }
  1504. }
  1505. nla_nest_end(msg, nl_bands);
  1506. if (band < NUM_NL80211_BANDS)
  1507. state->band_start = band + 1;
  1508. else
  1509. state->band_start = 0;
  1510. /* if bands & channels are done, continue outside */
  1511. if (state->band_start == 0 && state->chan_start == 0)
  1512. state->split_start++;
  1513. if (state->split)
  1514. break;
  1515. case 4:
  1516. nl_cmds = nla_nest_start(msg, NL80211_ATTR_SUPPORTED_COMMANDS);
  1517. if (!nl_cmds)
  1518. goto nla_put_failure;
  1519. i = nl80211_add_commands_unsplit(rdev, msg);
  1520. if (i < 0)
  1521. goto nla_put_failure;
  1522. if (state->split) {
  1523. CMD(crit_proto_start, CRIT_PROTOCOL_START);
  1524. CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
  1525. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
  1526. CMD(channel_switch, CHANNEL_SWITCH);
  1527. CMD(set_qos_map, SET_QOS_MAP);
  1528. if (rdev->wiphy.features &
  1529. NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
  1530. CMD(add_tx_ts, ADD_TX_TS);
  1531. CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
  1532. CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
  1533. }
  1534. #undef CMD
  1535. nla_nest_end(msg, nl_cmds);
  1536. state->split_start++;
  1537. if (state->split)
  1538. break;
  1539. case 5:
  1540. if (rdev->ops->remain_on_channel &&
  1541. (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
  1542. nla_put_u32(msg,
  1543. NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
  1544. rdev->wiphy.max_remain_on_channel_duration))
  1545. goto nla_put_failure;
  1546. if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
  1547. nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
  1548. goto nla_put_failure;
  1549. if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
  1550. goto nla_put_failure;
  1551. state->split_start++;
  1552. if (state->split)
  1553. break;
  1554. case 6:
  1555. #ifdef CONFIG_PM
  1556. if (nl80211_send_wowlan(msg, rdev, state->split))
  1557. goto nla_put_failure;
  1558. state->split_start++;
  1559. if (state->split)
  1560. break;
  1561. #else
  1562. state->split_start++;
  1563. #endif
  1564. case 7:
  1565. if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
  1566. rdev->wiphy.software_iftypes))
  1567. goto nla_put_failure;
  1568. if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
  1569. state->split))
  1570. goto nla_put_failure;
  1571. state->split_start++;
  1572. if (state->split)
  1573. break;
  1574. case 8:
  1575. if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
  1576. nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
  1577. rdev->wiphy.ap_sme_capa))
  1578. goto nla_put_failure;
  1579. features = rdev->wiphy.features;
  1580. /*
  1581. * We can only add the per-channel limit information if the
  1582. * dump is split, otherwise it makes it too big. Therefore
  1583. * only advertise it in that case.
  1584. */
  1585. if (state->split)
  1586. features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
  1587. if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
  1588. goto nla_put_failure;
  1589. if (rdev->wiphy.ht_capa_mod_mask &&
  1590. nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
  1591. sizeof(*rdev->wiphy.ht_capa_mod_mask),
  1592. rdev->wiphy.ht_capa_mod_mask))
  1593. goto nla_put_failure;
  1594. if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
  1595. rdev->wiphy.max_acl_mac_addrs &&
  1596. nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
  1597. rdev->wiphy.max_acl_mac_addrs))
  1598. goto nla_put_failure;
  1599. /*
  1600. * Any information below this point is only available to
  1601. * applications that can deal with it being split. This
  1602. * helps ensure that newly added capabilities don't break
  1603. * older tools by overrunning their buffers.
  1604. *
  1605. * We still increment split_start so that in the split
  1606. * case we'll continue with more data in the next round,
  1607. * but break unconditionally so unsplit data stops here.
  1608. */
  1609. state->split_start++;
  1610. break;
  1611. case 9:
  1612. if (rdev->wiphy.extended_capabilities &&
  1613. (nla_put(msg, NL80211_ATTR_EXT_CAPA,
  1614. rdev->wiphy.extended_capabilities_len,
  1615. rdev->wiphy.extended_capabilities) ||
  1616. nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
  1617. rdev->wiphy.extended_capabilities_len,
  1618. rdev->wiphy.extended_capabilities_mask)))
  1619. goto nla_put_failure;
  1620. if (rdev->wiphy.vht_capa_mod_mask &&
  1621. nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
  1622. sizeof(*rdev->wiphy.vht_capa_mod_mask),
  1623. rdev->wiphy.vht_capa_mod_mask))
  1624. goto nla_put_failure;
  1625. state->split_start++;
  1626. break;
  1627. case 10:
  1628. if (nl80211_send_coalesce(msg, rdev))
  1629. goto nla_put_failure;
  1630. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
  1631. (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
  1632. nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
  1633. goto nla_put_failure;
  1634. if (rdev->wiphy.max_ap_assoc_sta &&
  1635. nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
  1636. rdev->wiphy.max_ap_assoc_sta))
  1637. goto nla_put_failure;
  1638. state->split_start++;
  1639. break;
  1640. case 11:
  1641. if (rdev->wiphy.n_vendor_commands) {
  1642. const struct nl80211_vendor_cmd_info *info;
  1643. struct nlattr *nested;
  1644. nested = nla_nest_start(msg, NL80211_ATTR_VENDOR_DATA);
  1645. if (!nested)
  1646. goto nla_put_failure;
  1647. for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
  1648. info = &rdev->wiphy.vendor_commands[i].info;
  1649. if (nla_put(msg, i + 1, sizeof(*info), info))
  1650. goto nla_put_failure;
  1651. }
  1652. nla_nest_end(msg, nested);
  1653. }
  1654. if (rdev->wiphy.n_vendor_events) {
  1655. const struct nl80211_vendor_cmd_info *info;
  1656. struct nlattr *nested;
  1657. nested = nla_nest_start(msg,
  1658. NL80211_ATTR_VENDOR_EVENTS);
  1659. if (!nested)
  1660. goto nla_put_failure;
  1661. for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
  1662. info = &rdev->wiphy.vendor_events[i];
  1663. if (nla_put(msg, i + 1, sizeof(*info), info))
  1664. goto nla_put_failure;
  1665. }
  1666. nla_nest_end(msg, nested);
  1667. }
  1668. state->split_start++;
  1669. break;
  1670. case 12:
  1671. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
  1672. nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
  1673. rdev->wiphy.max_num_csa_counters))
  1674. goto nla_put_failure;
  1675. if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  1676. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  1677. goto nla_put_failure;
  1678. if (rdev->wiphy.max_sched_scan_reqs &&
  1679. nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
  1680. rdev->wiphy.max_sched_scan_reqs))
  1681. goto nla_put_failure;
  1682. if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
  1683. sizeof(rdev->wiphy.ext_features),
  1684. rdev->wiphy.ext_features))
  1685. goto nla_put_failure;
  1686. if (rdev->wiphy.bss_select_support) {
  1687. struct nlattr *nested;
  1688. u32 bss_select_support = rdev->wiphy.bss_select_support;
  1689. nested = nla_nest_start(msg, NL80211_ATTR_BSS_SELECT);
  1690. if (!nested)
  1691. goto nla_put_failure;
  1692. i = 0;
  1693. while (bss_select_support) {
  1694. if ((bss_select_support & 1) &&
  1695. nla_put_flag(msg, i))
  1696. goto nla_put_failure;
  1697. i++;
  1698. bss_select_support >>= 1;
  1699. }
  1700. nla_nest_end(msg, nested);
  1701. }
  1702. state->split_start++;
  1703. break;
  1704. case 13:
  1705. if (rdev->wiphy.num_iftype_ext_capab &&
  1706. rdev->wiphy.iftype_ext_capab) {
  1707. struct nlattr *nested_ext_capab, *nested;
  1708. nested = nla_nest_start(msg,
  1709. NL80211_ATTR_IFTYPE_EXT_CAPA);
  1710. if (!nested)
  1711. goto nla_put_failure;
  1712. for (i = state->capa_start;
  1713. i < rdev->wiphy.num_iftype_ext_capab; i++) {
  1714. const struct wiphy_iftype_ext_capab *capab;
  1715. capab = &rdev->wiphy.iftype_ext_capab[i];
  1716. nested_ext_capab = nla_nest_start(msg, i);
  1717. if (!nested_ext_capab ||
  1718. nla_put_u32(msg, NL80211_ATTR_IFTYPE,
  1719. capab->iftype) ||
  1720. nla_put(msg, NL80211_ATTR_EXT_CAPA,
  1721. capab->extended_capabilities_len,
  1722. capab->extended_capabilities) ||
  1723. nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
  1724. capab->extended_capabilities_len,
  1725. capab->extended_capabilities_mask))
  1726. goto nla_put_failure;
  1727. nla_nest_end(msg, nested_ext_capab);
  1728. if (state->split)
  1729. break;
  1730. }
  1731. nla_nest_end(msg, nested);
  1732. if (i < rdev->wiphy.num_iftype_ext_capab) {
  1733. state->capa_start = i + 1;
  1734. break;
  1735. }
  1736. }
  1737. if (nla_put_u32(msg, NL80211_ATTR_BANDS,
  1738. rdev->wiphy.nan_supported_bands))
  1739. goto nla_put_failure;
  1740. if (wiphy_ext_feature_isset(&rdev->wiphy,
  1741. NL80211_EXT_FEATURE_TXQS)) {
  1742. struct cfg80211_txq_stats txqstats = {};
  1743. int res;
  1744. res = rdev_get_txq_stats(rdev, NULL, &txqstats);
  1745. if (!res &&
  1746. !nl80211_put_txq_stats(msg, &txqstats,
  1747. NL80211_ATTR_TXQ_STATS))
  1748. goto nla_put_failure;
  1749. if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT,
  1750. rdev->wiphy.txq_limit))
  1751. goto nla_put_failure;
  1752. if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT,
  1753. rdev->wiphy.txq_memory_limit))
  1754. goto nla_put_failure;
  1755. if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM,
  1756. rdev->wiphy.txq_quantum))
  1757. goto nla_put_failure;
  1758. }
  1759. /* done */
  1760. state->split_start = 0;
  1761. break;
  1762. }
  1763. finish:
  1764. genlmsg_end(msg, hdr);
  1765. return 0;
  1766. nla_put_failure:
  1767. genlmsg_cancel(msg, hdr);
  1768. return -EMSGSIZE;
  1769. }
  1770. static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
  1771. struct netlink_callback *cb,
  1772. struct nl80211_dump_wiphy_state *state)
  1773. {
  1774. struct nlattr **tb = genl_family_attrbuf(&nl80211_fam);
  1775. int ret = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, tb,
  1776. nl80211_fam.maxattr, nl80211_policy, NULL);
  1777. /* ignore parse errors for backward compatibility */
  1778. if (ret)
  1779. return 0;
  1780. state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
  1781. if (tb[NL80211_ATTR_WIPHY])
  1782. state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
  1783. if (tb[NL80211_ATTR_WDEV])
  1784. state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
  1785. if (tb[NL80211_ATTR_IFINDEX]) {
  1786. struct net_device *netdev;
  1787. struct cfg80211_registered_device *rdev;
  1788. int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
  1789. netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
  1790. if (!netdev)
  1791. return -ENODEV;
  1792. if (netdev->ieee80211_ptr) {
  1793. rdev = wiphy_to_rdev(
  1794. netdev->ieee80211_ptr->wiphy);
  1795. state->filter_wiphy = rdev->wiphy_idx;
  1796. }
  1797. }
  1798. return 0;
  1799. }
  1800. static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
  1801. {
  1802. int idx = 0, ret;
  1803. struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
  1804. struct cfg80211_registered_device *rdev;
  1805. rtnl_lock();
  1806. if (!state) {
  1807. state = kzalloc(sizeof(*state), GFP_KERNEL);
  1808. if (!state) {
  1809. rtnl_unlock();
  1810. return -ENOMEM;
  1811. }
  1812. state->filter_wiphy = -1;
  1813. ret = nl80211_dump_wiphy_parse(skb, cb, state);
  1814. if (ret) {
  1815. kfree(state);
  1816. rtnl_unlock();
  1817. return ret;
  1818. }
  1819. cb->args[0] = (long)state;
  1820. }
  1821. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  1822. if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
  1823. continue;
  1824. if (++idx <= state->start)
  1825. continue;
  1826. if (state->filter_wiphy != -1 &&
  1827. state->filter_wiphy != rdev->wiphy_idx)
  1828. continue;
  1829. /* attempt to fit multiple wiphy data chunks into the skb */
  1830. do {
  1831. ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
  1832. skb,
  1833. NETLINK_CB(cb->skb).portid,
  1834. cb->nlh->nlmsg_seq,
  1835. NLM_F_MULTI, state);
  1836. if (ret < 0) {
  1837. /*
  1838. * If sending the wiphy data didn't fit (ENOBUFS
  1839. * or EMSGSIZE returned), this SKB is still
  1840. * empty (so it's not too big because another
  1841. * wiphy dataset is already in the skb) and
  1842. * we've not tried to adjust the dump allocation
  1843. * yet ... then adjust the alloc size to be
  1844. * bigger, and return 1 but with the empty skb.
  1845. * This results in an empty message being RX'ed
  1846. * in userspace, but that is ignored.
  1847. *
  1848. * We can then retry with the larger buffer.
  1849. */
  1850. if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
  1851. !skb->len && !state->split &&
  1852. cb->min_dump_alloc < 4096) {
  1853. cb->min_dump_alloc = 4096;
  1854. state->split_start = 0;
  1855. rtnl_unlock();
  1856. return 1;
  1857. }
  1858. idx--;
  1859. break;
  1860. }
  1861. } while (state->split_start > 0);
  1862. break;
  1863. }
  1864. rtnl_unlock();
  1865. state->start = idx;
  1866. return skb->len;
  1867. }
  1868. static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
  1869. {
  1870. kfree((void *)cb->args[0]);
  1871. return 0;
  1872. }
  1873. static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
  1874. {
  1875. struct sk_buff *msg;
  1876. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  1877. struct nl80211_dump_wiphy_state state = {};
  1878. msg = nlmsg_new(4096, GFP_KERNEL);
  1879. if (!msg)
  1880. return -ENOMEM;
  1881. if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
  1882. info->snd_portid, info->snd_seq, 0,
  1883. &state) < 0) {
  1884. nlmsg_free(msg);
  1885. return -ENOBUFS;
  1886. }
  1887. return genlmsg_reply(msg, info);
  1888. }
  1889. static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
  1890. [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
  1891. [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
  1892. [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
  1893. [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
  1894. [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
  1895. };
  1896. static int parse_txq_params(struct nlattr *tb[],
  1897. struct ieee80211_txq_params *txq_params)
  1898. {
  1899. u8 ac;
  1900. if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
  1901. !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
  1902. !tb[NL80211_TXQ_ATTR_AIFS])
  1903. return -EINVAL;
  1904. ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
  1905. txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
  1906. txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
  1907. txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
  1908. txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
  1909. if (ac >= NL80211_NUM_ACS)
  1910. return -EINVAL;
  1911. txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
  1912. return 0;
  1913. }
  1914. static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
  1915. {
  1916. /*
  1917. * You can only set the channel explicitly for WDS interfaces,
  1918. * all others have their channel managed via their respective
  1919. * "establish a connection" command (connect, join, ...)
  1920. *
  1921. * For AP/GO and mesh mode, the channel can be set with the
  1922. * channel userspace API, but is only stored and passed to the
  1923. * low-level driver when the AP starts or the mesh is joined.
  1924. * This is for backward compatibility, userspace can also give
  1925. * the channel in the start-ap or join-mesh commands instead.
  1926. *
  1927. * Monitors are special as they are normally slaved to
  1928. * whatever else is going on, so they have their own special
  1929. * operation to set the monitor channel if possible.
  1930. */
  1931. return !wdev ||
  1932. wdev->iftype == NL80211_IFTYPE_AP ||
  1933. wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
  1934. wdev->iftype == NL80211_IFTYPE_MONITOR ||
  1935. wdev->iftype == NL80211_IFTYPE_P2P_GO;
  1936. }
  1937. static int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
  1938. struct genl_info *info,
  1939. struct cfg80211_chan_def *chandef)
  1940. {
  1941. u32 control_freq;
  1942. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  1943. return -EINVAL;
  1944. control_freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]);
  1945. chandef->chan = ieee80211_get_channel(&rdev->wiphy, control_freq);
  1946. chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
  1947. chandef->center_freq1 = control_freq;
  1948. chandef->center_freq2 = 0;
  1949. /* Primary channel not allowed */
  1950. if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED)
  1951. return -EINVAL;
  1952. if (info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
  1953. enum nl80211_channel_type chantype;
  1954. chantype = nla_get_u32(
  1955. info->attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
  1956. switch (chantype) {
  1957. case NL80211_CHAN_NO_HT:
  1958. case NL80211_CHAN_HT20:
  1959. case NL80211_CHAN_HT40PLUS:
  1960. case NL80211_CHAN_HT40MINUS:
  1961. cfg80211_chandef_create(chandef, chandef->chan,
  1962. chantype);
  1963. /* user input for center_freq is incorrect */
  1964. if (info->attrs[NL80211_ATTR_CENTER_FREQ1] &&
  1965. chandef->center_freq1 != nla_get_u32(
  1966. info->attrs[NL80211_ATTR_CENTER_FREQ1]))
  1967. return -EINVAL;
  1968. /* center_freq2 must be zero */
  1969. if (info->attrs[NL80211_ATTR_CENTER_FREQ2] &&
  1970. nla_get_u32(info->attrs[NL80211_ATTR_CENTER_FREQ2]))
  1971. return -EINVAL;
  1972. break;
  1973. default:
  1974. return -EINVAL;
  1975. }
  1976. } else if (info->attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
  1977. chandef->width =
  1978. nla_get_u32(info->attrs[NL80211_ATTR_CHANNEL_WIDTH]);
  1979. if (info->attrs[NL80211_ATTR_CENTER_FREQ1])
  1980. chandef->center_freq1 =
  1981. nla_get_u32(
  1982. info->attrs[NL80211_ATTR_CENTER_FREQ1]);
  1983. if (info->attrs[NL80211_ATTR_CENTER_FREQ2])
  1984. chandef->center_freq2 =
  1985. nla_get_u32(
  1986. info->attrs[NL80211_ATTR_CENTER_FREQ2]);
  1987. }
  1988. if (!cfg80211_chandef_valid(chandef))
  1989. return -EINVAL;
  1990. if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
  1991. IEEE80211_CHAN_DISABLED))
  1992. return -EINVAL;
  1993. if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
  1994. chandef->width == NL80211_CHAN_WIDTH_10) &&
  1995. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ))
  1996. return -EINVAL;
  1997. return 0;
  1998. }
  1999. static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
  2000. struct net_device *dev,
  2001. struct genl_info *info)
  2002. {
  2003. struct cfg80211_chan_def chandef;
  2004. int result;
  2005. enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
  2006. struct wireless_dev *wdev = NULL;
  2007. if (dev)
  2008. wdev = dev->ieee80211_ptr;
  2009. if (!nl80211_can_set_dev_channel(wdev))
  2010. return -EOPNOTSUPP;
  2011. if (wdev)
  2012. iftype = wdev->iftype;
  2013. result = nl80211_parse_chandef(rdev, info, &chandef);
  2014. if (result)
  2015. return result;
  2016. switch (iftype) {
  2017. case NL80211_IFTYPE_AP:
  2018. case NL80211_IFTYPE_P2P_GO:
  2019. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
  2020. iftype)) {
  2021. result = -EINVAL;
  2022. break;
  2023. }
  2024. if (wdev->beacon_interval) {
  2025. if (!dev || !rdev->ops->set_ap_chanwidth ||
  2026. !(rdev->wiphy.features &
  2027. NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE)) {
  2028. result = -EBUSY;
  2029. break;
  2030. }
  2031. /* Only allow dynamic channel width changes */
  2032. if (chandef.chan != wdev->preset_chandef.chan) {
  2033. result = -EBUSY;
  2034. break;
  2035. }
  2036. result = rdev_set_ap_chanwidth(rdev, dev, &chandef);
  2037. if (result)
  2038. break;
  2039. }
  2040. wdev->preset_chandef = chandef;
  2041. result = 0;
  2042. break;
  2043. case NL80211_IFTYPE_MESH_POINT:
  2044. result = cfg80211_set_mesh_channel(rdev, wdev, &chandef);
  2045. break;
  2046. case NL80211_IFTYPE_MONITOR:
  2047. result = cfg80211_set_monitor_channel(rdev, &chandef);
  2048. break;
  2049. default:
  2050. result = -EINVAL;
  2051. }
  2052. return result;
  2053. }
  2054. static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
  2055. {
  2056. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2057. struct net_device *netdev = info->user_ptr[1];
  2058. return __nl80211_set_channel(rdev, netdev, info);
  2059. }
  2060. static int nl80211_set_wds_peer(struct sk_buff *skb, struct genl_info *info)
  2061. {
  2062. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2063. struct net_device *dev = info->user_ptr[1];
  2064. struct wireless_dev *wdev = dev->ieee80211_ptr;
  2065. const u8 *bssid;
  2066. if (!info->attrs[NL80211_ATTR_MAC])
  2067. return -EINVAL;
  2068. if (netif_running(dev))
  2069. return -EBUSY;
  2070. if (!rdev->ops->set_wds_peer)
  2071. return -EOPNOTSUPP;
  2072. if (wdev->iftype != NL80211_IFTYPE_WDS)
  2073. return -EOPNOTSUPP;
  2074. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2075. return rdev_set_wds_peer(rdev, dev, bssid);
  2076. }
  2077. static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
  2078. {
  2079. struct cfg80211_registered_device *rdev;
  2080. struct net_device *netdev = NULL;
  2081. struct wireless_dev *wdev;
  2082. int result = 0, rem_txq_params = 0;
  2083. struct nlattr *nl_txq_params;
  2084. u32 changed;
  2085. u8 retry_short = 0, retry_long = 0;
  2086. u32 frag_threshold = 0, rts_threshold = 0;
  2087. u8 coverage_class = 0;
  2088. u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0;
  2089. ASSERT_RTNL();
  2090. /*
  2091. * Try to find the wiphy and netdev. Normally this
  2092. * function shouldn't need the netdev, but this is
  2093. * done for backward compatibility -- previously
  2094. * setting the channel was done per wiphy, but now
  2095. * it is per netdev. Previous userland like hostapd
  2096. * also passed a netdev to set_wiphy, so that it is
  2097. * possible to let that go to the right netdev!
  2098. */
  2099. if (info->attrs[NL80211_ATTR_IFINDEX]) {
  2100. int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
  2101. netdev = __dev_get_by_index(genl_info_net(info), ifindex);
  2102. if (netdev && netdev->ieee80211_ptr)
  2103. rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
  2104. else
  2105. netdev = NULL;
  2106. }
  2107. if (!netdev) {
  2108. rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
  2109. info->attrs);
  2110. if (IS_ERR(rdev))
  2111. return PTR_ERR(rdev);
  2112. wdev = NULL;
  2113. netdev = NULL;
  2114. result = 0;
  2115. } else
  2116. wdev = netdev->ieee80211_ptr;
  2117. /*
  2118. * end workaround code, by now the rdev is available
  2119. * and locked, and wdev may or may not be NULL.
  2120. */
  2121. if (info->attrs[NL80211_ATTR_WIPHY_NAME])
  2122. result = cfg80211_dev_rename(
  2123. rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
  2124. if (result)
  2125. return result;
  2126. if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
  2127. struct ieee80211_txq_params txq_params;
  2128. struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
  2129. if (!rdev->ops->set_txq_params)
  2130. return -EOPNOTSUPP;
  2131. if (!netdev)
  2132. return -EINVAL;
  2133. if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  2134. netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  2135. return -EINVAL;
  2136. if (!netif_running(netdev))
  2137. return -ENETDOWN;
  2138. nla_for_each_nested(nl_txq_params,
  2139. info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
  2140. rem_txq_params) {
  2141. result = nla_parse_nested(tb, NL80211_TXQ_ATTR_MAX,
  2142. nl_txq_params,
  2143. txq_params_policy,
  2144. info->extack);
  2145. if (result)
  2146. return result;
  2147. result = parse_txq_params(tb, &txq_params);
  2148. if (result)
  2149. return result;
  2150. result = rdev_set_txq_params(rdev, netdev,
  2151. &txq_params);
  2152. if (result)
  2153. return result;
  2154. }
  2155. }
  2156. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  2157. result = __nl80211_set_channel(
  2158. rdev,
  2159. nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
  2160. info);
  2161. if (result)
  2162. return result;
  2163. }
  2164. if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
  2165. struct wireless_dev *txp_wdev = wdev;
  2166. enum nl80211_tx_power_setting type;
  2167. int idx, mbm = 0;
  2168. if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
  2169. txp_wdev = NULL;
  2170. if (!rdev->ops->set_tx_power)
  2171. return -EOPNOTSUPP;
  2172. idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
  2173. type = nla_get_u32(info->attrs[idx]);
  2174. if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
  2175. (type != NL80211_TX_POWER_AUTOMATIC))
  2176. return -EINVAL;
  2177. if (type != NL80211_TX_POWER_AUTOMATIC) {
  2178. idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
  2179. mbm = nla_get_u32(info->attrs[idx]);
  2180. }
  2181. result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
  2182. if (result)
  2183. return result;
  2184. }
  2185. if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
  2186. info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
  2187. u32 tx_ant, rx_ant;
  2188. if ((!rdev->wiphy.available_antennas_tx &&
  2189. !rdev->wiphy.available_antennas_rx) ||
  2190. !rdev->ops->set_antenna)
  2191. return -EOPNOTSUPP;
  2192. tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
  2193. rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
  2194. /* reject antenna configurations which don't match the
  2195. * available antenna masks, except for the "all" mask */
  2196. if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
  2197. (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx)))
  2198. return -EINVAL;
  2199. tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
  2200. rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
  2201. result = rdev_set_antenna(rdev, tx_ant, rx_ant);
  2202. if (result)
  2203. return result;
  2204. }
  2205. changed = 0;
  2206. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
  2207. retry_short = nla_get_u8(
  2208. info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
  2209. if (retry_short == 0)
  2210. return -EINVAL;
  2211. changed |= WIPHY_PARAM_RETRY_SHORT;
  2212. }
  2213. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
  2214. retry_long = nla_get_u8(
  2215. info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
  2216. if (retry_long == 0)
  2217. return -EINVAL;
  2218. changed |= WIPHY_PARAM_RETRY_LONG;
  2219. }
  2220. if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
  2221. frag_threshold = nla_get_u32(
  2222. info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
  2223. if (frag_threshold < 256)
  2224. return -EINVAL;
  2225. if (frag_threshold != (u32) -1) {
  2226. /*
  2227. * Fragments (apart from the last one) are required to
  2228. * have even length. Make the fragmentation code
  2229. * simpler by stripping LSB should someone try to use
  2230. * odd threshold value.
  2231. */
  2232. frag_threshold &= ~0x1;
  2233. }
  2234. changed |= WIPHY_PARAM_FRAG_THRESHOLD;
  2235. }
  2236. if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
  2237. rts_threshold = nla_get_u32(
  2238. info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
  2239. changed |= WIPHY_PARAM_RTS_THRESHOLD;
  2240. }
  2241. if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
  2242. if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK])
  2243. return -EINVAL;
  2244. coverage_class = nla_get_u8(
  2245. info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
  2246. changed |= WIPHY_PARAM_COVERAGE_CLASS;
  2247. }
  2248. if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
  2249. if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION))
  2250. return -EOPNOTSUPP;
  2251. changed |= WIPHY_PARAM_DYN_ACK;
  2252. }
  2253. if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) {
  2254. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  2255. NL80211_EXT_FEATURE_TXQS))
  2256. return -EOPNOTSUPP;
  2257. txq_limit = nla_get_u32(
  2258. info->attrs[NL80211_ATTR_TXQ_LIMIT]);
  2259. changed |= WIPHY_PARAM_TXQ_LIMIT;
  2260. }
  2261. if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) {
  2262. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  2263. NL80211_EXT_FEATURE_TXQS))
  2264. return -EOPNOTSUPP;
  2265. txq_memory_limit = nla_get_u32(
  2266. info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]);
  2267. changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT;
  2268. }
  2269. if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) {
  2270. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  2271. NL80211_EXT_FEATURE_TXQS))
  2272. return -EOPNOTSUPP;
  2273. txq_quantum = nla_get_u32(
  2274. info->attrs[NL80211_ATTR_TXQ_QUANTUM]);
  2275. changed |= WIPHY_PARAM_TXQ_QUANTUM;
  2276. }
  2277. if (changed) {
  2278. u8 old_retry_short, old_retry_long;
  2279. u32 old_frag_threshold, old_rts_threshold;
  2280. u8 old_coverage_class;
  2281. u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum;
  2282. if (!rdev->ops->set_wiphy_params)
  2283. return -EOPNOTSUPP;
  2284. old_retry_short = rdev->wiphy.retry_short;
  2285. old_retry_long = rdev->wiphy.retry_long;
  2286. old_frag_threshold = rdev->wiphy.frag_threshold;
  2287. old_rts_threshold = rdev->wiphy.rts_threshold;
  2288. old_coverage_class = rdev->wiphy.coverage_class;
  2289. old_txq_limit = rdev->wiphy.txq_limit;
  2290. old_txq_memory_limit = rdev->wiphy.txq_memory_limit;
  2291. old_txq_quantum = rdev->wiphy.txq_quantum;
  2292. if (changed & WIPHY_PARAM_RETRY_SHORT)
  2293. rdev->wiphy.retry_short = retry_short;
  2294. if (changed & WIPHY_PARAM_RETRY_LONG)
  2295. rdev->wiphy.retry_long = retry_long;
  2296. if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
  2297. rdev->wiphy.frag_threshold = frag_threshold;
  2298. if (changed & WIPHY_PARAM_RTS_THRESHOLD)
  2299. rdev->wiphy.rts_threshold = rts_threshold;
  2300. if (changed & WIPHY_PARAM_COVERAGE_CLASS)
  2301. rdev->wiphy.coverage_class = coverage_class;
  2302. if (changed & WIPHY_PARAM_TXQ_LIMIT)
  2303. rdev->wiphy.txq_limit = txq_limit;
  2304. if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT)
  2305. rdev->wiphy.txq_memory_limit = txq_memory_limit;
  2306. if (changed & WIPHY_PARAM_TXQ_QUANTUM)
  2307. rdev->wiphy.txq_quantum = txq_quantum;
  2308. result = rdev_set_wiphy_params(rdev, changed);
  2309. if (result) {
  2310. rdev->wiphy.retry_short = old_retry_short;
  2311. rdev->wiphy.retry_long = old_retry_long;
  2312. rdev->wiphy.frag_threshold = old_frag_threshold;
  2313. rdev->wiphy.rts_threshold = old_rts_threshold;
  2314. rdev->wiphy.coverage_class = old_coverage_class;
  2315. rdev->wiphy.txq_limit = old_txq_limit;
  2316. rdev->wiphy.txq_memory_limit = old_txq_memory_limit;
  2317. rdev->wiphy.txq_quantum = old_txq_quantum;
  2318. return result;
  2319. }
  2320. }
  2321. return 0;
  2322. }
  2323. static inline u64 wdev_id(struct wireless_dev *wdev)
  2324. {
  2325. return (u64)wdev->identifier |
  2326. ((u64)wiphy_to_rdev(wdev->wiphy)->wiphy_idx << 32);
  2327. }
  2328. static int nl80211_send_chandef(struct sk_buff *msg,
  2329. const struct cfg80211_chan_def *chandef)
  2330. {
  2331. if (WARN_ON(!cfg80211_chandef_valid(chandef)))
  2332. return -EINVAL;
  2333. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
  2334. chandef->chan->center_freq))
  2335. return -ENOBUFS;
  2336. switch (chandef->width) {
  2337. case NL80211_CHAN_WIDTH_20_NOHT:
  2338. case NL80211_CHAN_WIDTH_20:
  2339. case NL80211_CHAN_WIDTH_40:
  2340. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
  2341. cfg80211_get_chandef_type(chandef)))
  2342. return -ENOBUFS;
  2343. break;
  2344. default:
  2345. break;
  2346. }
  2347. if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
  2348. return -ENOBUFS;
  2349. if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
  2350. return -ENOBUFS;
  2351. if (chandef->center_freq2 &&
  2352. nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
  2353. return -ENOBUFS;
  2354. return 0;
  2355. }
  2356. static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
  2357. struct cfg80211_registered_device *rdev,
  2358. struct wireless_dev *wdev, bool removal)
  2359. {
  2360. struct net_device *dev = wdev->netdev;
  2361. u8 cmd = NL80211_CMD_NEW_INTERFACE;
  2362. void *hdr;
  2363. if (removal)
  2364. cmd = NL80211_CMD_DEL_INTERFACE;
  2365. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  2366. if (!hdr)
  2367. return -1;
  2368. if (dev &&
  2369. (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  2370. nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
  2371. goto nla_put_failure;
  2372. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  2373. nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
  2374. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  2375. NL80211_ATTR_PAD) ||
  2376. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
  2377. nla_put_u32(msg, NL80211_ATTR_GENERATION,
  2378. rdev->devlist_generation ^
  2379. (cfg80211_rdev_list_generation << 2)))
  2380. goto nla_put_failure;
  2381. if (rdev->ops->get_channel) {
  2382. int ret;
  2383. struct cfg80211_chan_def chandef;
  2384. ret = rdev_get_channel(rdev, wdev, &chandef);
  2385. if (ret == 0) {
  2386. if (nl80211_send_chandef(msg, &chandef))
  2387. goto nla_put_failure;
  2388. }
  2389. }
  2390. if (rdev->ops->get_tx_power) {
  2391. int dbm, ret;
  2392. ret = rdev_get_tx_power(rdev, wdev, &dbm);
  2393. if (ret == 0 &&
  2394. nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
  2395. DBM_TO_MBM(dbm)))
  2396. goto nla_put_failure;
  2397. }
  2398. wdev_lock(wdev);
  2399. switch (wdev->iftype) {
  2400. case NL80211_IFTYPE_AP:
  2401. if (wdev->ssid_len &&
  2402. nla_put(msg, NL80211_ATTR_SSID, wdev->ssid_len, wdev->ssid))
  2403. goto nla_put_failure_locked;
  2404. break;
  2405. case NL80211_IFTYPE_STATION:
  2406. case NL80211_IFTYPE_P2P_CLIENT:
  2407. case NL80211_IFTYPE_ADHOC: {
  2408. const u8 *ssid_ie;
  2409. if (!wdev->current_bss)
  2410. break;
  2411. rcu_read_lock();
  2412. ssid_ie = ieee80211_bss_get_ie(&wdev->current_bss->pub,
  2413. WLAN_EID_SSID);
  2414. if (ssid_ie &&
  2415. nla_put(msg, NL80211_ATTR_SSID, ssid_ie[1], ssid_ie + 2))
  2416. goto nla_put_failure_rcu_locked;
  2417. rcu_read_unlock();
  2418. break;
  2419. }
  2420. default:
  2421. /* nothing */
  2422. break;
  2423. }
  2424. wdev_unlock(wdev);
  2425. if (rdev->ops->get_txq_stats) {
  2426. struct cfg80211_txq_stats txqstats = {};
  2427. int ret = rdev_get_txq_stats(rdev, wdev, &txqstats);
  2428. if (ret == 0 &&
  2429. !nl80211_put_txq_stats(msg, &txqstats,
  2430. NL80211_ATTR_TXQ_STATS))
  2431. goto nla_put_failure;
  2432. }
  2433. genlmsg_end(msg, hdr);
  2434. return 0;
  2435. nla_put_failure_rcu_locked:
  2436. rcu_read_unlock();
  2437. nla_put_failure_locked:
  2438. wdev_unlock(wdev);
  2439. nla_put_failure:
  2440. genlmsg_cancel(msg, hdr);
  2441. return -EMSGSIZE;
  2442. }
  2443. static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
  2444. {
  2445. int wp_idx = 0;
  2446. int if_idx = 0;
  2447. int wp_start = cb->args[0];
  2448. int if_start = cb->args[1];
  2449. int filter_wiphy = -1;
  2450. struct cfg80211_registered_device *rdev;
  2451. struct wireless_dev *wdev;
  2452. int ret;
  2453. rtnl_lock();
  2454. if (!cb->args[2]) {
  2455. struct nl80211_dump_wiphy_state state = {
  2456. .filter_wiphy = -1,
  2457. };
  2458. ret = nl80211_dump_wiphy_parse(skb, cb, &state);
  2459. if (ret)
  2460. goto out_unlock;
  2461. filter_wiphy = state.filter_wiphy;
  2462. /*
  2463. * if filtering, set cb->args[2] to +1 since 0 is the default
  2464. * value needed to determine that parsing is necessary.
  2465. */
  2466. if (filter_wiphy >= 0)
  2467. cb->args[2] = filter_wiphy + 1;
  2468. else
  2469. cb->args[2] = -1;
  2470. } else if (cb->args[2] > 0) {
  2471. filter_wiphy = cb->args[2] - 1;
  2472. }
  2473. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  2474. if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
  2475. continue;
  2476. if (wp_idx < wp_start) {
  2477. wp_idx++;
  2478. continue;
  2479. }
  2480. if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
  2481. continue;
  2482. if_idx = 0;
  2483. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  2484. if (if_idx < if_start) {
  2485. if_idx++;
  2486. continue;
  2487. }
  2488. if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
  2489. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  2490. rdev, wdev, false) < 0) {
  2491. goto out;
  2492. }
  2493. if_idx++;
  2494. }
  2495. wp_idx++;
  2496. }
  2497. out:
  2498. cb->args[0] = wp_idx;
  2499. cb->args[1] = if_idx;
  2500. ret = skb->len;
  2501. out_unlock:
  2502. rtnl_unlock();
  2503. return ret;
  2504. }
  2505. static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
  2506. {
  2507. struct sk_buff *msg;
  2508. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2509. struct wireless_dev *wdev = info->user_ptr[1];
  2510. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  2511. if (!msg)
  2512. return -ENOMEM;
  2513. if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  2514. rdev, wdev, false) < 0) {
  2515. nlmsg_free(msg);
  2516. return -ENOBUFS;
  2517. }
  2518. return genlmsg_reply(msg, info);
  2519. }
  2520. static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
  2521. [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
  2522. [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
  2523. [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
  2524. [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
  2525. [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
  2526. [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
  2527. };
  2528. static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
  2529. {
  2530. struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
  2531. int flag;
  2532. *mntrflags = 0;
  2533. if (!nla)
  2534. return -EINVAL;
  2535. if (nla_parse_nested(flags, NL80211_MNTR_FLAG_MAX, nla,
  2536. mntr_flags_policy, NULL))
  2537. return -EINVAL;
  2538. for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
  2539. if (flags[flag])
  2540. *mntrflags |= (1<<flag);
  2541. *mntrflags |= MONITOR_FLAG_CHANGED;
  2542. return 0;
  2543. }
  2544. static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
  2545. enum nl80211_iftype type,
  2546. struct genl_info *info,
  2547. struct vif_params *params)
  2548. {
  2549. bool change = false;
  2550. int err;
  2551. if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
  2552. if (type != NL80211_IFTYPE_MONITOR)
  2553. return -EINVAL;
  2554. err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
  2555. &params->flags);
  2556. if (err)
  2557. return err;
  2558. change = true;
  2559. }
  2560. if (params->flags & MONITOR_FLAG_ACTIVE &&
  2561. !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
  2562. return -EOPNOTSUPP;
  2563. if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
  2564. const u8 *mumimo_groups;
  2565. u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
  2566. if (type != NL80211_IFTYPE_MONITOR)
  2567. return -EINVAL;
  2568. if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
  2569. return -EOPNOTSUPP;
  2570. mumimo_groups =
  2571. nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
  2572. /* bits 0 and 63 are reserved and must be zero */
  2573. if ((mumimo_groups[0] & BIT(0)) ||
  2574. (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
  2575. return -EINVAL;
  2576. params->vht_mumimo_groups = mumimo_groups;
  2577. change = true;
  2578. }
  2579. if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
  2580. u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
  2581. if (type != NL80211_IFTYPE_MONITOR)
  2582. return -EINVAL;
  2583. if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
  2584. return -EOPNOTSUPP;
  2585. params->vht_mumimo_follow_addr =
  2586. nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
  2587. change = true;
  2588. }
  2589. return change ? 1 : 0;
  2590. }
  2591. static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
  2592. struct net_device *netdev, u8 use_4addr,
  2593. enum nl80211_iftype iftype)
  2594. {
  2595. if (!use_4addr) {
  2596. if (netdev && (netdev->priv_flags & IFF_BRIDGE_PORT))
  2597. return -EBUSY;
  2598. return 0;
  2599. }
  2600. switch (iftype) {
  2601. case NL80211_IFTYPE_AP_VLAN:
  2602. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
  2603. return 0;
  2604. break;
  2605. case NL80211_IFTYPE_STATION:
  2606. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
  2607. return 0;
  2608. break;
  2609. default:
  2610. break;
  2611. }
  2612. return -EOPNOTSUPP;
  2613. }
  2614. static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
  2615. {
  2616. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2617. struct vif_params params;
  2618. int err;
  2619. enum nl80211_iftype otype, ntype;
  2620. struct net_device *dev = info->user_ptr[1];
  2621. bool change = false;
  2622. memset(&params, 0, sizeof(params));
  2623. otype = ntype = dev->ieee80211_ptr->iftype;
  2624. if (info->attrs[NL80211_ATTR_IFTYPE]) {
  2625. ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  2626. if (otype != ntype)
  2627. change = true;
  2628. if (ntype > NL80211_IFTYPE_MAX)
  2629. return -EINVAL;
  2630. }
  2631. if (info->attrs[NL80211_ATTR_MESH_ID]) {
  2632. struct wireless_dev *wdev = dev->ieee80211_ptr;
  2633. if (ntype != NL80211_IFTYPE_MESH_POINT)
  2634. return -EINVAL;
  2635. if (netif_running(dev))
  2636. return -EBUSY;
  2637. wdev_lock(wdev);
  2638. BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
  2639. IEEE80211_MAX_MESH_ID_LEN);
  2640. wdev->mesh_id_up_len =
  2641. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  2642. memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  2643. wdev->mesh_id_up_len);
  2644. wdev_unlock(wdev);
  2645. }
  2646. if (info->attrs[NL80211_ATTR_4ADDR]) {
  2647. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  2648. change = true;
  2649. err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
  2650. if (err)
  2651. return err;
  2652. } else {
  2653. params.use_4addr = -1;
  2654. }
  2655. err = nl80211_parse_mon_options(rdev, ntype, info, &params);
  2656. if (err < 0)
  2657. return err;
  2658. if (err > 0)
  2659. change = true;
  2660. if (change)
  2661. err = cfg80211_change_iface(rdev, dev, ntype, &params);
  2662. else
  2663. err = 0;
  2664. if (!err && params.use_4addr != -1)
  2665. dev->ieee80211_ptr->use_4addr = params.use_4addr;
  2666. return err;
  2667. }
  2668. static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
  2669. {
  2670. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2671. struct vif_params params;
  2672. struct wireless_dev *wdev;
  2673. struct sk_buff *msg;
  2674. int err;
  2675. enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
  2676. /* to avoid failing a new interface creation due to pending removal */
  2677. cfg80211_destroy_ifaces(rdev);
  2678. memset(&params, 0, sizeof(params));
  2679. if (!info->attrs[NL80211_ATTR_IFNAME])
  2680. return -EINVAL;
  2681. if (info->attrs[NL80211_ATTR_IFTYPE]) {
  2682. type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  2683. if (type > NL80211_IFTYPE_MAX)
  2684. return -EINVAL;
  2685. }
  2686. if (!rdev->ops->add_virtual_intf ||
  2687. !(rdev->wiphy.interface_modes & (1 << type)))
  2688. return -EOPNOTSUPP;
  2689. if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
  2690. rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
  2691. info->attrs[NL80211_ATTR_MAC]) {
  2692. nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
  2693. ETH_ALEN);
  2694. if (!is_valid_ether_addr(params.macaddr))
  2695. return -EADDRNOTAVAIL;
  2696. }
  2697. if (info->attrs[NL80211_ATTR_4ADDR]) {
  2698. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  2699. err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
  2700. if (err)
  2701. return err;
  2702. }
  2703. err = nl80211_parse_mon_options(rdev, type, info, &params);
  2704. if (err < 0)
  2705. return err;
  2706. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  2707. if (!msg)
  2708. return -ENOMEM;
  2709. wdev = rdev_add_virtual_intf(rdev,
  2710. nla_data(info->attrs[NL80211_ATTR_IFNAME]),
  2711. NET_NAME_USER, type, &params);
  2712. if (WARN_ON(!wdev)) {
  2713. nlmsg_free(msg);
  2714. return -EPROTO;
  2715. } else if (IS_ERR(wdev)) {
  2716. nlmsg_free(msg);
  2717. return PTR_ERR(wdev);
  2718. }
  2719. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  2720. wdev->owner_nlportid = info->snd_portid;
  2721. switch (type) {
  2722. case NL80211_IFTYPE_MESH_POINT:
  2723. if (!info->attrs[NL80211_ATTR_MESH_ID])
  2724. break;
  2725. wdev_lock(wdev);
  2726. BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
  2727. IEEE80211_MAX_MESH_ID_LEN);
  2728. wdev->mesh_id_up_len =
  2729. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  2730. memcpy(wdev->ssid, nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  2731. wdev->mesh_id_up_len);
  2732. wdev_unlock(wdev);
  2733. break;
  2734. case NL80211_IFTYPE_NAN:
  2735. case NL80211_IFTYPE_P2P_DEVICE:
  2736. /*
  2737. * P2P Device and NAN do not have a netdev, so don't go
  2738. * through the netdev notifier and must be added here
  2739. */
  2740. mutex_init(&wdev->mtx);
  2741. INIT_LIST_HEAD(&wdev->event_list);
  2742. spin_lock_init(&wdev->event_lock);
  2743. INIT_LIST_HEAD(&wdev->mgmt_registrations);
  2744. spin_lock_init(&wdev->mgmt_registrations_lock);
  2745. wdev->identifier = ++rdev->wdev_id;
  2746. list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
  2747. rdev->devlist_generation++;
  2748. break;
  2749. default:
  2750. break;
  2751. }
  2752. if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  2753. rdev, wdev, false) < 0) {
  2754. nlmsg_free(msg);
  2755. return -ENOBUFS;
  2756. }
  2757. /*
  2758. * For wdevs which have no associated netdev object (e.g. of type
  2759. * NL80211_IFTYPE_P2P_DEVICE), emit the NEW_INTERFACE event here.
  2760. * For all other types, the event will be generated from the
  2761. * netdev notifier
  2762. */
  2763. if (!wdev->netdev)
  2764. nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
  2765. return genlmsg_reply(msg, info);
  2766. }
  2767. static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
  2768. {
  2769. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2770. struct wireless_dev *wdev = info->user_ptr[1];
  2771. if (!rdev->ops->del_virtual_intf)
  2772. return -EOPNOTSUPP;
  2773. /*
  2774. * If we remove a wireless device without a netdev then clear
  2775. * user_ptr[1] so that nl80211_post_doit won't dereference it
  2776. * to check if it needs to do dev_put(). Otherwise it crashes
  2777. * since the wdev has been freed, unlike with a netdev where
  2778. * we need the dev_put() for the netdev to really be freed.
  2779. */
  2780. if (!wdev->netdev)
  2781. info->user_ptr[1] = NULL;
  2782. return rdev_del_virtual_intf(rdev, wdev);
  2783. }
  2784. static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
  2785. {
  2786. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2787. struct net_device *dev = info->user_ptr[1];
  2788. u16 noack_map;
  2789. if (!info->attrs[NL80211_ATTR_NOACK_MAP])
  2790. return -EINVAL;
  2791. if (!rdev->ops->set_noack_map)
  2792. return -EOPNOTSUPP;
  2793. noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
  2794. return rdev_set_noack_map(rdev, dev, noack_map);
  2795. }
  2796. struct get_key_cookie {
  2797. struct sk_buff *msg;
  2798. int error;
  2799. int idx;
  2800. };
  2801. static void get_key_callback(void *c, struct key_params *params)
  2802. {
  2803. struct nlattr *key;
  2804. struct get_key_cookie *cookie = c;
  2805. if ((params->key &&
  2806. nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
  2807. params->key_len, params->key)) ||
  2808. (params->seq &&
  2809. nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
  2810. params->seq_len, params->seq)) ||
  2811. (params->cipher &&
  2812. nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
  2813. params->cipher)))
  2814. goto nla_put_failure;
  2815. key = nla_nest_start(cookie->msg, NL80211_ATTR_KEY);
  2816. if (!key)
  2817. goto nla_put_failure;
  2818. if ((params->key &&
  2819. nla_put(cookie->msg, NL80211_KEY_DATA,
  2820. params->key_len, params->key)) ||
  2821. (params->seq &&
  2822. nla_put(cookie->msg, NL80211_KEY_SEQ,
  2823. params->seq_len, params->seq)) ||
  2824. (params->cipher &&
  2825. nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
  2826. params->cipher)))
  2827. goto nla_put_failure;
  2828. if (nla_put_u8(cookie->msg, NL80211_ATTR_KEY_IDX, cookie->idx))
  2829. goto nla_put_failure;
  2830. nla_nest_end(cookie->msg, key);
  2831. return;
  2832. nla_put_failure:
  2833. cookie->error = 1;
  2834. }
  2835. static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
  2836. {
  2837. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2838. int err;
  2839. struct net_device *dev = info->user_ptr[1];
  2840. u8 key_idx = 0;
  2841. const u8 *mac_addr = NULL;
  2842. bool pairwise;
  2843. struct get_key_cookie cookie = {
  2844. .error = 0,
  2845. };
  2846. void *hdr;
  2847. struct sk_buff *msg;
  2848. if (info->attrs[NL80211_ATTR_KEY_IDX])
  2849. key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  2850. if (key_idx > 5)
  2851. return -EINVAL;
  2852. if (info->attrs[NL80211_ATTR_MAC])
  2853. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2854. pairwise = !!mac_addr;
  2855. if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
  2856. u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  2857. if (kt >= NUM_NL80211_KEYTYPES)
  2858. return -EINVAL;
  2859. if (kt != NL80211_KEYTYPE_GROUP &&
  2860. kt != NL80211_KEYTYPE_PAIRWISE)
  2861. return -EINVAL;
  2862. pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
  2863. }
  2864. if (!rdev->ops->get_key)
  2865. return -EOPNOTSUPP;
  2866. if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  2867. return -ENOENT;
  2868. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  2869. if (!msg)
  2870. return -ENOMEM;
  2871. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  2872. NL80211_CMD_NEW_KEY);
  2873. if (!hdr)
  2874. goto nla_put_failure;
  2875. cookie.msg = msg;
  2876. cookie.idx = key_idx;
  2877. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  2878. nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
  2879. goto nla_put_failure;
  2880. if (mac_addr &&
  2881. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
  2882. goto nla_put_failure;
  2883. err = rdev_get_key(rdev, dev, key_idx, pairwise, mac_addr, &cookie,
  2884. get_key_callback);
  2885. if (err)
  2886. goto free_msg;
  2887. if (cookie.error)
  2888. goto nla_put_failure;
  2889. genlmsg_end(msg, hdr);
  2890. return genlmsg_reply(msg, info);
  2891. nla_put_failure:
  2892. err = -ENOBUFS;
  2893. free_msg:
  2894. nlmsg_free(msg);
  2895. return err;
  2896. }
  2897. static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
  2898. {
  2899. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2900. struct key_parse key;
  2901. int err;
  2902. struct net_device *dev = info->user_ptr[1];
  2903. err = nl80211_parse_key(info, &key);
  2904. if (err)
  2905. return err;
  2906. if (key.idx < 0)
  2907. return -EINVAL;
  2908. /* only support setting default key */
  2909. if (!key.def && !key.defmgmt)
  2910. return -EINVAL;
  2911. wdev_lock(dev->ieee80211_ptr);
  2912. if (key.def) {
  2913. if (!rdev->ops->set_default_key) {
  2914. err = -EOPNOTSUPP;
  2915. goto out;
  2916. }
  2917. err = nl80211_key_allowed(dev->ieee80211_ptr);
  2918. if (err)
  2919. goto out;
  2920. err = rdev_set_default_key(rdev, dev, key.idx,
  2921. key.def_uni, key.def_multi);
  2922. if (err)
  2923. goto out;
  2924. #ifdef CONFIG_CFG80211_WEXT
  2925. dev->ieee80211_ptr->wext.default_key = key.idx;
  2926. #endif
  2927. } else {
  2928. if (key.def_uni || !key.def_multi) {
  2929. err = -EINVAL;
  2930. goto out;
  2931. }
  2932. if (!rdev->ops->set_default_mgmt_key) {
  2933. err = -EOPNOTSUPP;
  2934. goto out;
  2935. }
  2936. err = nl80211_key_allowed(dev->ieee80211_ptr);
  2937. if (err)
  2938. goto out;
  2939. err = rdev_set_default_mgmt_key(rdev, dev, key.idx);
  2940. if (err)
  2941. goto out;
  2942. #ifdef CONFIG_CFG80211_WEXT
  2943. dev->ieee80211_ptr->wext.default_mgmt_key = key.idx;
  2944. #endif
  2945. }
  2946. out:
  2947. wdev_unlock(dev->ieee80211_ptr);
  2948. return err;
  2949. }
  2950. static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
  2951. {
  2952. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2953. int err;
  2954. struct net_device *dev = info->user_ptr[1];
  2955. struct key_parse key;
  2956. const u8 *mac_addr = NULL;
  2957. err = nl80211_parse_key(info, &key);
  2958. if (err)
  2959. return err;
  2960. if (!key.p.key)
  2961. return -EINVAL;
  2962. if (info->attrs[NL80211_ATTR_MAC])
  2963. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  2964. if (key.type == -1) {
  2965. if (mac_addr)
  2966. key.type = NL80211_KEYTYPE_PAIRWISE;
  2967. else
  2968. key.type = NL80211_KEYTYPE_GROUP;
  2969. }
  2970. /* for now */
  2971. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  2972. key.type != NL80211_KEYTYPE_GROUP)
  2973. return -EINVAL;
  2974. if (!rdev->ops->add_key)
  2975. return -EOPNOTSUPP;
  2976. if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
  2977. key.type == NL80211_KEYTYPE_PAIRWISE,
  2978. mac_addr))
  2979. return -EINVAL;
  2980. wdev_lock(dev->ieee80211_ptr);
  2981. err = nl80211_key_allowed(dev->ieee80211_ptr);
  2982. if (!err)
  2983. err = rdev_add_key(rdev, dev, key.idx,
  2984. key.type == NL80211_KEYTYPE_PAIRWISE,
  2985. mac_addr, &key.p);
  2986. wdev_unlock(dev->ieee80211_ptr);
  2987. return err;
  2988. }
  2989. static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
  2990. {
  2991. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2992. int err;
  2993. struct net_device *dev = info->user_ptr[1];
  2994. u8 *mac_addr = NULL;
  2995. struct key_parse key;
  2996. err = nl80211_parse_key(info, &key);
  2997. if (err)
  2998. return err;
  2999. if (info->attrs[NL80211_ATTR_MAC])
  3000. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3001. if (key.type == -1) {
  3002. if (mac_addr)
  3003. key.type = NL80211_KEYTYPE_PAIRWISE;
  3004. else
  3005. key.type = NL80211_KEYTYPE_GROUP;
  3006. }
  3007. /* for now */
  3008. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  3009. key.type != NL80211_KEYTYPE_GROUP)
  3010. return -EINVAL;
  3011. if (!rdev->ops->del_key)
  3012. return -EOPNOTSUPP;
  3013. wdev_lock(dev->ieee80211_ptr);
  3014. err = nl80211_key_allowed(dev->ieee80211_ptr);
  3015. if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
  3016. !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  3017. err = -ENOENT;
  3018. if (!err)
  3019. err = rdev_del_key(rdev, dev, key.idx,
  3020. key.type == NL80211_KEYTYPE_PAIRWISE,
  3021. mac_addr);
  3022. #ifdef CONFIG_CFG80211_WEXT
  3023. if (!err) {
  3024. if (key.idx == dev->ieee80211_ptr->wext.default_key)
  3025. dev->ieee80211_ptr->wext.default_key = -1;
  3026. else if (key.idx == dev->ieee80211_ptr->wext.default_mgmt_key)
  3027. dev->ieee80211_ptr->wext.default_mgmt_key = -1;
  3028. }
  3029. #endif
  3030. wdev_unlock(dev->ieee80211_ptr);
  3031. return err;
  3032. }
  3033. /* This function returns an error or the number of nested attributes */
  3034. static int validate_acl_mac_addrs(struct nlattr *nl_attr)
  3035. {
  3036. struct nlattr *attr;
  3037. int n_entries = 0, tmp;
  3038. nla_for_each_nested(attr, nl_attr, tmp) {
  3039. if (nla_len(attr) != ETH_ALEN)
  3040. return -EINVAL;
  3041. n_entries++;
  3042. }
  3043. return n_entries;
  3044. }
  3045. /*
  3046. * This function parses ACL information and allocates memory for ACL data.
  3047. * On successful return, the calling function is responsible to free the
  3048. * ACL buffer returned by this function.
  3049. */
  3050. static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
  3051. struct genl_info *info)
  3052. {
  3053. enum nl80211_acl_policy acl_policy;
  3054. struct nlattr *attr;
  3055. struct cfg80211_acl_data *acl;
  3056. int i = 0, n_entries, tmp;
  3057. if (!wiphy->max_acl_mac_addrs)
  3058. return ERR_PTR(-EOPNOTSUPP);
  3059. if (!info->attrs[NL80211_ATTR_ACL_POLICY])
  3060. return ERR_PTR(-EINVAL);
  3061. acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
  3062. if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
  3063. acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
  3064. return ERR_PTR(-EINVAL);
  3065. if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
  3066. return ERR_PTR(-EINVAL);
  3067. n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
  3068. if (n_entries < 0)
  3069. return ERR_PTR(n_entries);
  3070. if (n_entries > wiphy->max_acl_mac_addrs)
  3071. return ERR_PTR(-ENOTSUPP);
  3072. acl = kzalloc(sizeof(*acl) + (sizeof(struct mac_address) * n_entries),
  3073. GFP_KERNEL);
  3074. if (!acl)
  3075. return ERR_PTR(-ENOMEM);
  3076. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
  3077. memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
  3078. i++;
  3079. }
  3080. acl->n_acl_entries = n_entries;
  3081. acl->acl_policy = acl_policy;
  3082. return acl;
  3083. }
  3084. static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
  3085. {
  3086. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3087. struct net_device *dev = info->user_ptr[1];
  3088. struct cfg80211_acl_data *acl;
  3089. int err;
  3090. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3091. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3092. return -EOPNOTSUPP;
  3093. if (!dev->ieee80211_ptr->beacon_interval)
  3094. return -EINVAL;
  3095. acl = parse_acl_data(&rdev->wiphy, info);
  3096. if (IS_ERR(acl))
  3097. return PTR_ERR(acl);
  3098. err = rdev_set_mac_acl(rdev, dev, acl);
  3099. kfree(acl);
  3100. return err;
  3101. }
  3102. static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
  3103. u8 *rates, u8 rates_len)
  3104. {
  3105. u8 i;
  3106. u32 mask = 0;
  3107. for (i = 0; i < rates_len; i++) {
  3108. int rate = (rates[i] & 0x7f) * 5;
  3109. int ridx;
  3110. for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
  3111. struct ieee80211_rate *srate =
  3112. &sband->bitrates[ridx];
  3113. if (rate == srate->bitrate) {
  3114. mask |= 1 << ridx;
  3115. break;
  3116. }
  3117. }
  3118. if (ridx == sband->n_bitrates)
  3119. return 0; /* rate not found */
  3120. }
  3121. return mask;
  3122. }
  3123. static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
  3124. u8 *rates, u8 rates_len,
  3125. u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
  3126. {
  3127. u8 i;
  3128. memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
  3129. for (i = 0; i < rates_len; i++) {
  3130. int ridx, rbit;
  3131. ridx = rates[i] / 8;
  3132. rbit = BIT(rates[i] % 8);
  3133. /* check validity */
  3134. if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
  3135. return false;
  3136. /* check availability */
  3137. if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
  3138. mcs[ridx] |= rbit;
  3139. else
  3140. return false;
  3141. }
  3142. return true;
  3143. }
  3144. static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
  3145. {
  3146. u16 mcs_mask = 0;
  3147. switch (vht_mcs_map) {
  3148. case IEEE80211_VHT_MCS_NOT_SUPPORTED:
  3149. break;
  3150. case IEEE80211_VHT_MCS_SUPPORT_0_7:
  3151. mcs_mask = 0x00FF;
  3152. break;
  3153. case IEEE80211_VHT_MCS_SUPPORT_0_8:
  3154. mcs_mask = 0x01FF;
  3155. break;
  3156. case IEEE80211_VHT_MCS_SUPPORT_0_9:
  3157. mcs_mask = 0x03FF;
  3158. break;
  3159. default:
  3160. break;
  3161. }
  3162. return mcs_mask;
  3163. }
  3164. static void vht_build_mcs_mask(u16 vht_mcs_map,
  3165. u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
  3166. {
  3167. u8 nss;
  3168. for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
  3169. vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
  3170. vht_mcs_map >>= 2;
  3171. }
  3172. }
  3173. static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
  3174. struct nl80211_txrate_vht *txrate,
  3175. u16 mcs[NL80211_VHT_NSS_MAX])
  3176. {
  3177. u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
  3178. u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
  3179. u8 i;
  3180. if (!sband->vht_cap.vht_supported)
  3181. return false;
  3182. memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
  3183. /* Build vht_mcs_mask from VHT capabilities */
  3184. vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
  3185. for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
  3186. if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
  3187. mcs[i] = txrate->mcs[i];
  3188. else
  3189. return false;
  3190. }
  3191. return true;
  3192. }
  3193. static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
  3194. [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
  3195. .len = NL80211_MAX_SUPP_RATES },
  3196. [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
  3197. .len = NL80211_MAX_SUPP_HT_RATES },
  3198. [NL80211_TXRATE_VHT] = { .len = sizeof(struct nl80211_txrate_vht)},
  3199. [NL80211_TXRATE_GI] = { .type = NLA_U8 },
  3200. };
  3201. static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
  3202. struct cfg80211_bitrate_mask *mask)
  3203. {
  3204. struct nlattr *tb[NL80211_TXRATE_MAX + 1];
  3205. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3206. int rem, i;
  3207. struct nlattr *tx_rates;
  3208. struct ieee80211_supported_band *sband;
  3209. u16 vht_tx_mcs_map;
  3210. memset(mask, 0, sizeof(*mask));
  3211. /* Default to all rates enabled */
  3212. for (i = 0; i < NUM_NL80211_BANDS; i++) {
  3213. sband = rdev->wiphy.bands[i];
  3214. if (!sband)
  3215. continue;
  3216. mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
  3217. memcpy(mask->control[i].ht_mcs,
  3218. sband->ht_cap.mcs.rx_mask,
  3219. sizeof(mask->control[i].ht_mcs));
  3220. if (!sband->vht_cap.vht_supported)
  3221. continue;
  3222. vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
  3223. vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
  3224. }
  3225. /* if no rates are given set it back to the defaults */
  3226. if (!info->attrs[NL80211_ATTR_TX_RATES])
  3227. goto out;
  3228. /* The nested attribute uses enum nl80211_band as the index. This maps
  3229. * directly to the enum nl80211_band values used in cfg80211.
  3230. */
  3231. BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
  3232. nla_for_each_nested(tx_rates, info->attrs[NL80211_ATTR_TX_RATES], rem) {
  3233. enum nl80211_band band = nla_type(tx_rates);
  3234. int err;
  3235. if (band < 0 || band >= NUM_NL80211_BANDS)
  3236. return -EINVAL;
  3237. sband = rdev->wiphy.bands[band];
  3238. if (sband == NULL)
  3239. return -EINVAL;
  3240. err = nla_parse_nested(tb, NL80211_TXRATE_MAX, tx_rates,
  3241. nl80211_txattr_policy, info->extack);
  3242. if (err)
  3243. return err;
  3244. if (tb[NL80211_TXRATE_LEGACY]) {
  3245. mask->control[band].legacy = rateset_to_mask(
  3246. sband,
  3247. nla_data(tb[NL80211_TXRATE_LEGACY]),
  3248. nla_len(tb[NL80211_TXRATE_LEGACY]));
  3249. if ((mask->control[band].legacy == 0) &&
  3250. nla_len(tb[NL80211_TXRATE_LEGACY]))
  3251. return -EINVAL;
  3252. }
  3253. if (tb[NL80211_TXRATE_HT]) {
  3254. if (!ht_rateset_to_mask(
  3255. sband,
  3256. nla_data(tb[NL80211_TXRATE_HT]),
  3257. nla_len(tb[NL80211_TXRATE_HT]),
  3258. mask->control[band].ht_mcs))
  3259. return -EINVAL;
  3260. }
  3261. if (tb[NL80211_TXRATE_VHT]) {
  3262. if (!vht_set_mcs_mask(
  3263. sband,
  3264. nla_data(tb[NL80211_TXRATE_VHT]),
  3265. mask->control[band].vht_mcs))
  3266. return -EINVAL;
  3267. }
  3268. if (tb[NL80211_TXRATE_GI]) {
  3269. mask->control[band].gi =
  3270. nla_get_u8(tb[NL80211_TXRATE_GI]);
  3271. if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
  3272. return -EINVAL;
  3273. }
  3274. if (mask->control[band].legacy == 0) {
  3275. /* don't allow empty legacy rates if HT or VHT
  3276. * are not even supported.
  3277. */
  3278. if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
  3279. rdev->wiphy.bands[band]->vht_cap.vht_supported))
  3280. return -EINVAL;
  3281. for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
  3282. if (mask->control[band].ht_mcs[i])
  3283. goto out;
  3284. for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
  3285. if (mask->control[band].vht_mcs[i])
  3286. goto out;
  3287. /* legacy and mcs rates may not be both empty */
  3288. return -EINVAL;
  3289. }
  3290. }
  3291. out:
  3292. return 0;
  3293. }
  3294. static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
  3295. enum nl80211_band band,
  3296. struct cfg80211_bitrate_mask *beacon_rate)
  3297. {
  3298. u32 count_ht, count_vht, i;
  3299. u32 rate = beacon_rate->control[band].legacy;
  3300. /* Allow only one rate */
  3301. if (hweight32(rate) > 1)
  3302. return -EINVAL;
  3303. count_ht = 0;
  3304. for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
  3305. if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
  3306. return -EINVAL;
  3307. } else if (beacon_rate->control[band].ht_mcs[i]) {
  3308. count_ht++;
  3309. if (count_ht > 1)
  3310. return -EINVAL;
  3311. }
  3312. if (count_ht && rate)
  3313. return -EINVAL;
  3314. }
  3315. count_vht = 0;
  3316. for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
  3317. if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
  3318. return -EINVAL;
  3319. } else if (beacon_rate->control[band].vht_mcs[i]) {
  3320. count_vht++;
  3321. if (count_vht > 1)
  3322. return -EINVAL;
  3323. }
  3324. if (count_vht && rate)
  3325. return -EINVAL;
  3326. }
  3327. if ((count_ht && count_vht) || (!rate && !count_ht && !count_vht))
  3328. return -EINVAL;
  3329. if (rate &&
  3330. !wiphy_ext_feature_isset(&rdev->wiphy,
  3331. NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
  3332. return -EINVAL;
  3333. if (count_ht &&
  3334. !wiphy_ext_feature_isset(&rdev->wiphy,
  3335. NL80211_EXT_FEATURE_BEACON_RATE_HT))
  3336. return -EINVAL;
  3337. if (count_vht &&
  3338. !wiphy_ext_feature_isset(&rdev->wiphy,
  3339. NL80211_EXT_FEATURE_BEACON_RATE_VHT))
  3340. return -EINVAL;
  3341. return 0;
  3342. }
  3343. static int nl80211_parse_beacon(struct nlattr *attrs[],
  3344. struct cfg80211_beacon_data *bcn)
  3345. {
  3346. bool haveinfo = false;
  3347. if (!is_valid_ie_attr(attrs[NL80211_ATTR_BEACON_TAIL]) ||
  3348. !is_valid_ie_attr(attrs[NL80211_ATTR_IE]) ||
  3349. !is_valid_ie_attr(attrs[NL80211_ATTR_IE_PROBE_RESP]) ||
  3350. !is_valid_ie_attr(attrs[NL80211_ATTR_IE_ASSOC_RESP]))
  3351. return -EINVAL;
  3352. memset(bcn, 0, sizeof(*bcn));
  3353. if (attrs[NL80211_ATTR_BEACON_HEAD]) {
  3354. bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
  3355. bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
  3356. if (!bcn->head_len)
  3357. return -EINVAL;
  3358. haveinfo = true;
  3359. }
  3360. if (attrs[NL80211_ATTR_BEACON_TAIL]) {
  3361. bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
  3362. bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
  3363. haveinfo = true;
  3364. }
  3365. if (!haveinfo)
  3366. return -EINVAL;
  3367. if (attrs[NL80211_ATTR_IE]) {
  3368. bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
  3369. bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
  3370. }
  3371. if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
  3372. bcn->proberesp_ies =
  3373. nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
  3374. bcn->proberesp_ies_len =
  3375. nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
  3376. }
  3377. if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
  3378. bcn->assocresp_ies =
  3379. nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
  3380. bcn->assocresp_ies_len =
  3381. nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
  3382. }
  3383. if (attrs[NL80211_ATTR_PROBE_RESP]) {
  3384. bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
  3385. bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
  3386. }
  3387. return 0;
  3388. }
  3389. static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
  3390. const u8 *rates)
  3391. {
  3392. int i;
  3393. if (!rates)
  3394. return;
  3395. for (i = 0; i < rates[1]; i++) {
  3396. if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
  3397. params->ht_required = true;
  3398. if (rates[2 + i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
  3399. params->vht_required = true;
  3400. }
  3401. }
  3402. /*
  3403. * Since the nl80211 API didn't include, from the beginning, attributes about
  3404. * HT/VHT requirements/capabilities, we parse them out of the IEs for the
  3405. * benefit of drivers that rebuild IEs in the firmware.
  3406. */
  3407. static void nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
  3408. {
  3409. const struct cfg80211_beacon_data *bcn = &params->beacon;
  3410. size_t ies_len = bcn->tail_len;
  3411. const u8 *ies = bcn->tail;
  3412. const u8 *rates;
  3413. const u8 *cap;
  3414. rates = cfg80211_find_ie(WLAN_EID_SUPP_RATES, ies, ies_len);
  3415. nl80211_check_ap_rate_selectors(params, rates);
  3416. rates = cfg80211_find_ie(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
  3417. nl80211_check_ap_rate_selectors(params, rates);
  3418. cap = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, ies, ies_len);
  3419. if (cap && cap[1] >= sizeof(*params->ht_cap))
  3420. params->ht_cap = (void *)(cap + 2);
  3421. cap = cfg80211_find_ie(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
  3422. if (cap && cap[1] >= sizeof(*params->vht_cap))
  3423. params->vht_cap = (void *)(cap + 2);
  3424. }
  3425. static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
  3426. struct cfg80211_ap_settings *params)
  3427. {
  3428. struct wireless_dev *wdev;
  3429. bool ret = false;
  3430. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  3431. if (wdev->iftype != NL80211_IFTYPE_AP &&
  3432. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  3433. continue;
  3434. if (!wdev->preset_chandef.chan)
  3435. continue;
  3436. params->chandef = wdev->preset_chandef;
  3437. ret = true;
  3438. break;
  3439. }
  3440. return ret;
  3441. }
  3442. static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
  3443. enum nl80211_auth_type auth_type,
  3444. enum nl80211_commands cmd)
  3445. {
  3446. if (auth_type > NL80211_AUTHTYPE_MAX)
  3447. return false;
  3448. switch (cmd) {
  3449. case NL80211_CMD_AUTHENTICATE:
  3450. if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
  3451. auth_type == NL80211_AUTHTYPE_SAE)
  3452. return false;
  3453. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  3454. NL80211_EXT_FEATURE_FILS_STA) &&
  3455. (auth_type == NL80211_AUTHTYPE_FILS_SK ||
  3456. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  3457. auth_type == NL80211_AUTHTYPE_FILS_PK))
  3458. return false;
  3459. return true;
  3460. case NL80211_CMD_CONNECT:
  3461. if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
  3462. auth_type == NL80211_AUTHTYPE_SAE)
  3463. return false;
  3464. /* FILS with SK PFS or PK not supported yet */
  3465. if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  3466. auth_type == NL80211_AUTHTYPE_FILS_PK)
  3467. return false;
  3468. if (!wiphy_ext_feature_isset(
  3469. &rdev->wiphy,
  3470. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
  3471. auth_type == NL80211_AUTHTYPE_FILS_SK)
  3472. return false;
  3473. return true;
  3474. case NL80211_CMD_START_AP:
  3475. /* SAE not supported yet */
  3476. if (auth_type == NL80211_AUTHTYPE_SAE)
  3477. return false;
  3478. /* FILS not supported yet */
  3479. if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
  3480. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  3481. auth_type == NL80211_AUTHTYPE_FILS_PK)
  3482. return false;
  3483. return true;
  3484. default:
  3485. return false;
  3486. }
  3487. }
  3488. static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
  3489. {
  3490. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3491. struct net_device *dev = info->user_ptr[1];
  3492. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3493. struct cfg80211_ap_settings params;
  3494. int err;
  3495. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3496. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3497. return -EOPNOTSUPP;
  3498. if (!rdev->ops->start_ap)
  3499. return -EOPNOTSUPP;
  3500. if (wdev->beacon_interval)
  3501. return -EALREADY;
  3502. memset(&params, 0, sizeof(params));
  3503. /* these are required for START_AP */
  3504. if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
  3505. !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
  3506. !info->attrs[NL80211_ATTR_BEACON_HEAD])
  3507. return -EINVAL;
  3508. err = nl80211_parse_beacon(info->attrs, &params.beacon);
  3509. if (err)
  3510. return err;
  3511. params.beacon_interval =
  3512. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  3513. params.dtim_period =
  3514. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  3515. err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
  3516. params.beacon_interval);
  3517. if (err)
  3518. return err;
  3519. /*
  3520. * In theory, some of these attributes should be required here
  3521. * but since they were not used when the command was originally
  3522. * added, keep them optional for old user space programs to let
  3523. * them continue to work with drivers that do not need the
  3524. * additional information -- drivers must check!
  3525. */
  3526. if (info->attrs[NL80211_ATTR_SSID]) {
  3527. params.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  3528. params.ssid_len =
  3529. nla_len(info->attrs[NL80211_ATTR_SSID]);
  3530. if (params.ssid_len == 0 ||
  3531. params.ssid_len > IEEE80211_MAX_SSID_LEN)
  3532. return -EINVAL;
  3533. }
  3534. if (info->attrs[NL80211_ATTR_HIDDEN_SSID]) {
  3535. params.hidden_ssid = nla_get_u32(
  3536. info->attrs[NL80211_ATTR_HIDDEN_SSID]);
  3537. if (params.hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE &&
  3538. params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_LEN &&
  3539. params.hidden_ssid != NL80211_HIDDEN_SSID_ZERO_CONTENTS)
  3540. return -EINVAL;
  3541. }
  3542. params.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  3543. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  3544. params.auth_type = nla_get_u32(
  3545. info->attrs[NL80211_ATTR_AUTH_TYPE]);
  3546. if (!nl80211_valid_auth_type(rdev, params.auth_type,
  3547. NL80211_CMD_START_AP))
  3548. return -EINVAL;
  3549. } else
  3550. params.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  3551. err = nl80211_crypto_settings(rdev, info, &params.crypto,
  3552. NL80211_MAX_NR_CIPHER_SUITES);
  3553. if (err)
  3554. return err;
  3555. if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
  3556. if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER))
  3557. return -EOPNOTSUPP;
  3558. params.inactivity_timeout = nla_get_u16(
  3559. info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
  3560. }
  3561. if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
  3562. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3563. return -EINVAL;
  3564. params.p2p_ctwindow =
  3565. nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
  3566. if (params.p2p_ctwindow > 127)
  3567. return -EINVAL;
  3568. if (params.p2p_ctwindow != 0 &&
  3569. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
  3570. return -EINVAL;
  3571. }
  3572. if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
  3573. u8 tmp;
  3574. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3575. return -EINVAL;
  3576. tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
  3577. if (tmp > 1)
  3578. return -EINVAL;
  3579. params.p2p_opp_ps = tmp;
  3580. if (params.p2p_opp_ps != 0 &&
  3581. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
  3582. return -EINVAL;
  3583. }
  3584. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  3585. err = nl80211_parse_chandef(rdev, info, &params.chandef);
  3586. if (err)
  3587. return err;
  3588. } else if (wdev->preset_chandef.chan) {
  3589. params.chandef = wdev->preset_chandef;
  3590. } else if (!nl80211_get_ap_channel(rdev, &params))
  3591. return -EINVAL;
  3592. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
  3593. wdev->iftype))
  3594. return -EINVAL;
  3595. if (info->attrs[NL80211_ATTR_TX_RATES]) {
  3596. err = nl80211_parse_tx_bitrate_mask(info, &params.beacon_rate);
  3597. if (err)
  3598. return err;
  3599. err = validate_beacon_tx_rate(rdev, params.chandef.chan->band,
  3600. &params.beacon_rate);
  3601. if (err)
  3602. return err;
  3603. }
  3604. if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
  3605. params.smps_mode =
  3606. nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
  3607. switch (params.smps_mode) {
  3608. case NL80211_SMPS_OFF:
  3609. break;
  3610. case NL80211_SMPS_STATIC:
  3611. if (!(rdev->wiphy.features &
  3612. NL80211_FEATURE_STATIC_SMPS))
  3613. return -EINVAL;
  3614. break;
  3615. case NL80211_SMPS_DYNAMIC:
  3616. if (!(rdev->wiphy.features &
  3617. NL80211_FEATURE_DYNAMIC_SMPS))
  3618. return -EINVAL;
  3619. break;
  3620. default:
  3621. return -EINVAL;
  3622. }
  3623. } else {
  3624. params.smps_mode = NL80211_SMPS_OFF;
  3625. }
  3626. params.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
  3627. if (params.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ])
  3628. return -EOPNOTSUPP;
  3629. if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
  3630. params.acl = parse_acl_data(&rdev->wiphy, info);
  3631. if (IS_ERR(params.acl))
  3632. return PTR_ERR(params.acl);
  3633. }
  3634. nl80211_calculate_ap_params(&params);
  3635. wdev_lock(wdev);
  3636. err = rdev_start_ap(rdev, dev, &params);
  3637. if (!err) {
  3638. wdev->preset_chandef = params.chandef;
  3639. wdev->beacon_interval = params.beacon_interval;
  3640. wdev->chandef = params.chandef;
  3641. wdev->ssid_len = params.ssid_len;
  3642. memcpy(wdev->ssid, params.ssid, wdev->ssid_len);
  3643. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  3644. wdev->conn_owner_nlportid = info->snd_portid;
  3645. }
  3646. wdev_unlock(wdev);
  3647. kfree(params.acl);
  3648. return err;
  3649. }
  3650. static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
  3651. {
  3652. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3653. struct net_device *dev = info->user_ptr[1];
  3654. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3655. struct cfg80211_beacon_data params;
  3656. int err;
  3657. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3658. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  3659. return -EOPNOTSUPP;
  3660. if (!rdev->ops->change_beacon)
  3661. return -EOPNOTSUPP;
  3662. if (!wdev->beacon_interval)
  3663. return -EINVAL;
  3664. err = nl80211_parse_beacon(info->attrs, &params);
  3665. if (err)
  3666. return err;
  3667. wdev_lock(wdev);
  3668. err = rdev_change_beacon(rdev, dev, &params);
  3669. wdev_unlock(wdev);
  3670. return err;
  3671. }
  3672. static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
  3673. {
  3674. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3675. struct net_device *dev = info->user_ptr[1];
  3676. return cfg80211_stop_ap(rdev, dev, false);
  3677. }
  3678. static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
  3679. [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
  3680. [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
  3681. [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
  3682. [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
  3683. [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
  3684. [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
  3685. };
  3686. static int parse_station_flags(struct genl_info *info,
  3687. enum nl80211_iftype iftype,
  3688. struct station_parameters *params)
  3689. {
  3690. struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
  3691. struct nlattr *nla;
  3692. int flag;
  3693. /*
  3694. * Try parsing the new attribute first so userspace
  3695. * can specify both for older kernels.
  3696. */
  3697. nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
  3698. if (nla) {
  3699. struct nl80211_sta_flag_update *sta_flags;
  3700. sta_flags = nla_data(nla);
  3701. params->sta_flags_mask = sta_flags->mask;
  3702. params->sta_flags_set = sta_flags->set;
  3703. params->sta_flags_set &= params->sta_flags_mask;
  3704. if ((params->sta_flags_mask |
  3705. params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
  3706. return -EINVAL;
  3707. return 0;
  3708. }
  3709. /* if present, parse the old attribute */
  3710. nla = info->attrs[NL80211_ATTR_STA_FLAGS];
  3711. if (!nla)
  3712. return 0;
  3713. if (nla_parse_nested(flags, NL80211_STA_FLAG_MAX, nla,
  3714. sta_flags_policy, info->extack))
  3715. return -EINVAL;
  3716. /*
  3717. * Only allow certain flags for interface types so that
  3718. * other attributes are silently ignored. Remember that
  3719. * this is backward compatibility code with old userspace
  3720. * and shouldn't be hit in other cases anyway.
  3721. */
  3722. switch (iftype) {
  3723. case NL80211_IFTYPE_AP:
  3724. case NL80211_IFTYPE_AP_VLAN:
  3725. case NL80211_IFTYPE_P2P_GO:
  3726. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
  3727. BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
  3728. BIT(NL80211_STA_FLAG_WME) |
  3729. BIT(NL80211_STA_FLAG_MFP);
  3730. break;
  3731. case NL80211_IFTYPE_P2P_CLIENT:
  3732. case NL80211_IFTYPE_STATION:
  3733. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
  3734. BIT(NL80211_STA_FLAG_TDLS_PEER);
  3735. break;
  3736. case NL80211_IFTYPE_MESH_POINT:
  3737. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  3738. BIT(NL80211_STA_FLAG_MFP) |
  3739. BIT(NL80211_STA_FLAG_AUTHORIZED);
  3740. default:
  3741. return -EINVAL;
  3742. }
  3743. for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
  3744. if (flags[flag]) {
  3745. params->sta_flags_set |= (1<<flag);
  3746. /* no longer support new API additions in old API */
  3747. if (flag > NL80211_STA_FLAG_MAX_OLD_API)
  3748. return -EINVAL;
  3749. }
  3750. }
  3751. return 0;
  3752. }
  3753. static bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info,
  3754. int attr)
  3755. {
  3756. struct nlattr *rate;
  3757. u32 bitrate;
  3758. u16 bitrate_compat;
  3759. enum nl80211_rate_info rate_flg;
  3760. rate = nla_nest_start(msg, attr);
  3761. if (!rate)
  3762. return false;
  3763. /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
  3764. bitrate = cfg80211_calculate_bitrate(info);
  3765. /* report 16-bit bitrate only if we can */
  3766. bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
  3767. if (bitrate > 0 &&
  3768. nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
  3769. return false;
  3770. if (bitrate_compat > 0 &&
  3771. nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
  3772. return false;
  3773. switch (info->bw) {
  3774. case RATE_INFO_BW_5:
  3775. rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
  3776. break;
  3777. case RATE_INFO_BW_10:
  3778. rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
  3779. break;
  3780. default:
  3781. WARN_ON(1);
  3782. /* fall through */
  3783. case RATE_INFO_BW_20:
  3784. rate_flg = 0;
  3785. break;
  3786. case RATE_INFO_BW_40:
  3787. rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
  3788. break;
  3789. case RATE_INFO_BW_80:
  3790. rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
  3791. break;
  3792. case RATE_INFO_BW_160:
  3793. rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
  3794. break;
  3795. }
  3796. if (rate_flg && nla_put_flag(msg, rate_flg))
  3797. return false;
  3798. if (info->flags & RATE_INFO_FLAGS_MCS) {
  3799. if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
  3800. return false;
  3801. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  3802. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  3803. return false;
  3804. } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
  3805. if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
  3806. return false;
  3807. if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
  3808. return false;
  3809. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  3810. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  3811. return false;
  3812. }
  3813. nla_nest_end(msg, rate);
  3814. return true;
  3815. }
  3816. static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
  3817. int id)
  3818. {
  3819. void *attr;
  3820. int i = 0;
  3821. if (!mask)
  3822. return true;
  3823. attr = nla_nest_start(msg, id);
  3824. if (!attr)
  3825. return false;
  3826. for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
  3827. if (!(mask & BIT(i)))
  3828. continue;
  3829. if (nla_put_u8(msg, i, signal[i]))
  3830. return false;
  3831. }
  3832. nla_nest_end(msg, attr);
  3833. return true;
  3834. }
  3835. static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
  3836. u32 seq, int flags,
  3837. struct cfg80211_registered_device *rdev,
  3838. struct net_device *dev,
  3839. const u8 *mac_addr, struct station_info *sinfo)
  3840. {
  3841. void *hdr;
  3842. struct nlattr *sinfoattr, *bss_param;
  3843. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  3844. if (!hdr)
  3845. return -1;
  3846. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  3847. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
  3848. nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
  3849. goto nla_put_failure;
  3850. sinfoattr = nla_nest_start(msg, NL80211_ATTR_STA_INFO);
  3851. if (!sinfoattr)
  3852. goto nla_put_failure;
  3853. #define PUT_SINFO(attr, memb, type) do { \
  3854. BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \
  3855. if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
  3856. nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \
  3857. sinfo->memb)) \
  3858. goto nla_put_failure; \
  3859. } while (0)
  3860. #define PUT_SINFO_U64(attr, memb) do { \
  3861. if (sinfo->filled & (1ULL << NL80211_STA_INFO_ ## attr) && \
  3862. nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \
  3863. sinfo->memb, NL80211_STA_INFO_PAD)) \
  3864. goto nla_put_failure; \
  3865. } while (0)
  3866. PUT_SINFO(CONNECTED_TIME, connected_time, u32);
  3867. PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
  3868. if (sinfo->filled & (BIT(NL80211_STA_INFO_RX_BYTES) |
  3869. BIT(NL80211_STA_INFO_RX_BYTES64)) &&
  3870. nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
  3871. (u32)sinfo->rx_bytes))
  3872. goto nla_put_failure;
  3873. if (sinfo->filled & (BIT(NL80211_STA_INFO_TX_BYTES) |
  3874. BIT(NL80211_STA_INFO_TX_BYTES64)) &&
  3875. nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
  3876. (u32)sinfo->tx_bytes))
  3877. goto nla_put_failure;
  3878. PUT_SINFO_U64(RX_BYTES64, rx_bytes);
  3879. PUT_SINFO_U64(TX_BYTES64, tx_bytes);
  3880. PUT_SINFO(LLID, llid, u16);
  3881. PUT_SINFO(PLID, plid, u16);
  3882. PUT_SINFO(PLINK_STATE, plink_state, u8);
  3883. PUT_SINFO_U64(RX_DURATION, rx_duration);
  3884. switch (rdev->wiphy.signal_type) {
  3885. case CFG80211_SIGNAL_TYPE_MBM:
  3886. PUT_SINFO(SIGNAL, signal, u8);
  3887. PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
  3888. break;
  3889. default:
  3890. break;
  3891. }
  3892. if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL)) {
  3893. if (!nl80211_put_signal(msg, sinfo->chains,
  3894. sinfo->chain_signal,
  3895. NL80211_STA_INFO_CHAIN_SIGNAL))
  3896. goto nla_put_failure;
  3897. }
  3898. if (sinfo->filled & BIT(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
  3899. if (!nl80211_put_signal(msg, sinfo->chains,
  3900. sinfo->chain_signal_avg,
  3901. NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
  3902. goto nla_put_failure;
  3903. }
  3904. if (sinfo->filled & BIT(NL80211_STA_INFO_TX_BITRATE)) {
  3905. if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
  3906. NL80211_STA_INFO_TX_BITRATE))
  3907. goto nla_put_failure;
  3908. }
  3909. if (sinfo->filled & BIT(NL80211_STA_INFO_RX_BITRATE)) {
  3910. if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
  3911. NL80211_STA_INFO_RX_BITRATE))
  3912. goto nla_put_failure;
  3913. }
  3914. PUT_SINFO(RX_PACKETS, rx_packets, u32);
  3915. PUT_SINFO(TX_PACKETS, tx_packets, u32);
  3916. PUT_SINFO(TX_RETRIES, tx_retries, u32);
  3917. PUT_SINFO(TX_FAILED, tx_failed, u32);
  3918. PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
  3919. PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
  3920. PUT_SINFO(LOCAL_PM, local_pm, u32);
  3921. PUT_SINFO(PEER_PM, peer_pm, u32);
  3922. PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
  3923. if (sinfo->filled & BIT(NL80211_STA_INFO_BSS_PARAM)) {
  3924. bss_param = nla_nest_start(msg, NL80211_STA_INFO_BSS_PARAM);
  3925. if (!bss_param)
  3926. goto nla_put_failure;
  3927. if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
  3928. nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
  3929. ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
  3930. nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
  3931. ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
  3932. nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
  3933. nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
  3934. sinfo->bss_param.dtim_period) ||
  3935. nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
  3936. sinfo->bss_param.beacon_interval))
  3937. goto nla_put_failure;
  3938. nla_nest_end(msg, bss_param);
  3939. }
  3940. if ((sinfo->filled & BIT(NL80211_STA_INFO_STA_FLAGS)) &&
  3941. nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
  3942. sizeof(struct nl80211_sta_flag_update),
  3943. &sinfo->sta_flags))
  3944. goto nla_put_failure;
  3945. PUT_SINFO_U64(T_OFFSET, t_offset);
  3946. PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
  3947. PUT_SINFO_U64(BEACON_RX, rx_beacon);
  3948. PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
  3949. PUT_SINFO(ACK_SIGNAL, ack_signal, u8);
  3950. if (wiphy_ext_feature_isset(&rdev->wiphy,
  3951. NL80211_EXT_FEATURE_DATA_ACK_SIGNAL_SUPPORT))
  3952. PUT_SINFO(DATA_ACK_SIGNAL_AVG, avg_ack_signal, s8);
  3953. #undef PUT_SINFO
  3954. #undef PUT_SINFO_U64
  3955. if (sinfo->pertid) {
  3956. struct nlattr *tidsattr;
  3957. int tid;
  3958. tidsattr = nla_nest_start(msg, NL80211_STA_INFO_TID_STATS);
  3959. if (!tidsattr)
  3960. goto nla_put_failure;
  3961. for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
  3962. struct cfg80211_tid_stats *tidstats;
  3963. struct nlattr *tidattr;
  3964. tidstats = &sinfo->pertid[tid];
  3965. if (!tidstats->filled)
  3966. continue;
  3967. tidattr = nla_nest_start(msg, tid + 1);
  3968. if (!tidattr)
  3969. goto nla_put_failure;
  3970. #define PUT_TIDVAL_U64(attr, memb) do { \
  3971. if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \
  3972. nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \
  3973. tidstats->memb, NL80211_TID_STATS_PAD)) \
  3974. goto nla_put_failure; \
  3975. } while (0)
  3976. PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
  3977. PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
  3978. PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
  3979. PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
  3980. #undef PUT_TIDVAL_U64
  3981. if ((tidstats->filled &
  3982. BIT(NL80211_TID_STATS_TXQ_STATS)) &&
  3983. !nl80211_put_txq_stats(msg, &tidstats->txq_stats,
  3984. NL80211_TID_STATS_TXQ_STATS))
  3985. goto nla_put_failure;
  3986. nla_nest_end(msg, tidattr);
  3987. }
  3988. nla_nest_end(msg, tidsattr);
  3989. }
  3990. nla_nest_end(msg, sinfoattr);
  3991. if (sinfo->assoc_req_ies_len &&
  3992. nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
  3993. sinfo->assoc_req_ies))
  3994. goto nla_put_failure;
  3995. cfg80211_sinfo_release_content(sinfo);
  3996. genlmsg_end(msg, hdr);
  3997. return 0;
  3998. nla_put_failure:
  3999. cfg80211_sinfo_release_content(sinfo);
  4000. genlmsg_cancel(msg, hdr);
  4001. return -EMSGSIZE;
  4002. }
  4003. static int nl80211_dump_station(struct sk_buff *skb,
  4004. struct netlink_callback *cb)
  4005. {
  4006. struct station_info sinfo;
  4007. struct cfg80211_registered_device *rdev;
  4008. struct wireless_dev *wdev;
  4009. u8 mac_addr[ETH_ALEN];
  4010. int sta_idx = cb->args[2];
  4011. int err;
  4012. rtnl_lock();
  4013. err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
  4014. if (err)
  4015. goto out_err;
  4016. if (!wdev->netdev) {
  4017. err = -EINVAL;
  4018. goto out_err;
  4019. }
  4020. if (!rdev->ops->dump_station) {
  4021. err = -EOPNOTSUPP;
  4022. goto out_err;
  4023. }
  4024. while (1) {
  4025. memset(&sinfo, 0, sizeof(sinfo));
  4026. err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
  4027. mac_addr, &sinfo);
  4028. if (err == -ENOENT)
  4029. break;
  4030. if (err)
  4031. goto out_err;
  4032. if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
  4033. NETLINK_CB(cb->skb).portid,
  4034. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  4035. rdev, wdev->netdev, mac_addr,
  4036. &sinfo) < 0)
  4037. goto out;
  4038. sta_idx++;
  4039. }
  4040. out:
  4041. cb->args[2] = sta_idx;
  4042. err = skb->len;
  4043. out_err:
  4044. rtnl_unlock();
  4045. return err;
  4046. }
  4047. static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
  4048. {
  4049. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4050. struct net_device *dev = info->user_ptr[1];
  4051. struct station_info sinfo;
  4052. struct sk_buff *msg;
  4053. u8 *mac_addr = NULL;
  4054. int err;
  4055. memset(&sinfo, 0, sizeof(sinfo));
  4056. if (!info->attrs[NL80211_ATTR_MAC])
  4057. return -EINVAL;
  4058. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4059. if (!rdev->ops->get_station)
  4060. return -EOPNOTSUPP;
  4061. err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
  4062. if (err)
  4063. return err;
  4064. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4065. if (!msg) {
  4066. cfg80211_sinfo_release_content(&sinfo);
  4067. return -ENOMEM;
  4068. }
  4069. if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
  4070. info->snd_portid, info->snd_seq, 0,
  4071. rdev, dev, mac_addr, &sinfo) < 0) {
  4072. nlmsg_free(msg);
  4073. return -ENOBUFS;
  4074. }
  4075. return genlmsg_reply(msg, info);
  4076. }
  4077. int cfg80211_check_station_change(struct wiphy *wiphy,
  4078. struct station_parameters *params,
  4079. enum cfg80211_station_type statype)
  4080. {
  4081. if (params->listen_interval != -1 &&
  4082. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  4083. return -EINVAL;
  4084. if (params->support_p2p_ps != -1 &&
  4085. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  4086. return -EINVAL;
  4087. if (params->aid &&
  4088. !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
  4089. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  4090. return -EINVAL;
  4091. /* When you run into this, adjust the code below for the new flag */
  4092. BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
  4093. switch (statype) {
  4094. case CFG80211_STA_MESH_PEER_KERNEL:
  4095. case CFG80211_STA_MESH_PEER_USER:
  4096. /*
  4097. * No ignoring the TDLS flag here -- the userspace mesh
  4098. * code doesn't have the bug of including TDLS in the
  4099. * mask everywhere.
  4100. */
  4101. if (params->sta_flags_mask &
  4102. ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  4103. BIT(NL80211_STA_FLAG_MFP) |
  4104. BIT(NL80211_STA_FLAG_AUTHORIZED)))
  4105. return -EINVAL;
  4106. break;
  4107. case CFG80211_STA_TDLS_PEER_SETUP:
  4108. case CFG80211_STA_TDLS_PEER_ACTIVE:
  4109. if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
  4110. return -EINVAL;
  4111. /* ignore since it can't change */
  4112. params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  4113. break;
  4114. default:
  4115. /* disallow mesh-specific things */
  4116. if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
  4117. return -EINVAL;
  4118. if (params->local_pm)
  4119. return -EINVAL;
  4120. if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
  4121. return -EINVAL;
  4122. }
  4123. if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
  4124. statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
  4125. /* TDLS can't be set, ... */
  4126. if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
  4127. return -EINVAL;
  4128. /*
  4129. * ... but don't bother the driver with it. This works around
  4130. * a hostapd/wpa_supplicant issue -- it always includes the
  4131. * TLDS_PEER flag in the mask even for AP mode.
  4132. */
  4133. params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  4134. }
  4135. if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
  4136. statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
  4137. /* reject other things that can't change */
  4138. if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
  4139. return -EINVAL;
  4140. if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
  4141. return -EINVAL;
  4142. if (params->supported_rates)
  4143. return -EINVAL;
  4144. if (params->ext_capab || params->ht_capa || params->vht_capa)
  4145. return -EINVAL;
  4146. }
  4147. if (statype != CFG80211_STA_AP_CLIENT &&
  4148. statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
  4149. if (params->vlan)
  4150. return -EINVAL;
  4151. }
  4152. switch (statype) {
  4153. case CFG80211_STA_AP_MLME_CLIENT:
  4154. /* Use this only for authorizing/unauthorizing a station */
  4155. if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
  4156. return -EOPNOTSUPP;
  4157. break;
  4158. case CFG80211_STA_AP_CLIENT:
  4159. case CFG80211_STA_AP_CLIENT_UNASSOC:
  4160. /* accept only the listed bits */
  4161. if (params->sta_flags_mask &
  4162. ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
  4163. BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  4164. BIT(NL80211_STA_FLAG_ASSOCIATED) |
  4165. BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
  4166. BIT(NL80211_STA_FLAG_WME) |
  4167. BIT(NL80211_STA_FLAG_MFP)))
  4168. return -EINVAL;
  4169. /* but authenticated/associated only if driver handles it */
  4170. if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
  4171. params->sta_flags_mask &
  4172. (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  4173. BIT(NL80211_STA_FLAG_ASSOCIATED)))
  4174. return -EINVAL;
  4175. break;
  4176. case CFG80211_STA_IBSS:
  4177. case CFG80211_STA_AP_STA:
  4178. /* reject any changes other than AUTHORIZED */
  4179. if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
  4180. return -EINVAL;
  4181. break;
  4182. case CFG80211_STA_TDLS_PEER_SETUP:
  4183. /* reject any changes other than AUTHORIZED or WME */
  4184. if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
  4185. BIT(NL80211_STA_FLAG_WME)))
  4186. return -EINVAL;
  4187. /* force (at least) rates when authorizing */
  4188. if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
  4189. !params->supported_rates)
  4190. return -EINVAL;
  4191. break;
  4192. case CFG80211_STA_TDLS_PEER_ACTIVE:
  4193. /* reject any changes */
  4194. return -EINVAL;
  4195. case CFG80211_STA_MESH_PEER_KERNEL:
  4196. if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
  4197. return -EINVAL;
  4198. break;
  4199. case CFG80211_STA_MESH_PEER_USER:
  4200. if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
  4201. params->plink_action != NL80211_PLINK_ACTION_BLOCK)
  4202. return -EINVAL;
  4203. break;
  4204. }
  4205. /*
  4206. * Older kernel versions ignored this attribute entirely, so don't
  4207. * reject attempts to update it but mark it as unused instead so the
  4208. * driver won't look at the data.
  4209. */
  4210. if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
  4211. statype != CFG80211_STA_TDLS_PEER_SETUP)
  4212. params->opmode_notif_used = false;
  4213. return 0;
  4214. }
  4215. EXPORT_SYMBOL(cfg80211_check_station_change);
  4216. /*
  4217. * Get vlan interface making sure it is running and on the right wiphy.
  4218. */
  4219. static struct net_device *get_vlan(struct genl_info *info,
  4220. struct cfg80211_registered_device *rdev)
  4221. {
  4222. struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
  4223. struct net_device *v;
  4224. int ret;
  4225. if (!vlanattr)
  4226. return NULL;
  4227. v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
  4228. if (!v)
  4229. return ERR_PTR(-ENODEV);
  4230. if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
  4231. ret = -EINVAL;
  4232. goto error;
  4233. }
  4234. if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  4235. v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  4236. v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  4237. ret = -EINVAL;
  4238. goto error;
  4239. }
  4240. if (!netif_running(v)) {
  4241. ret = -ENETDOWN;
  4242. goto error;
  4243. }
  4244. return v;
  4245. error:
  4246. dev_put(v);
  4247. return ERR_PTR(ret);
  4248. }
  4249. static const struct nla_policy
  4250. nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
  4251. [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
  4252. [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
  4253. };
  4254. static int nl80211_parse_sta_wme(struct genl_info *info,
  4255. struct station_parameters *params)
  4256. {
  4257. struct nlattr *tb[NL80211_STA_WME_MAX + 1];
  4258. struct nlattr *nla;
  4259. int err;
  4260. /* parse WME attributes if present */
  4261. if (!info->attrs[NL80211_ATTR_STA_WME])
  4262. return 0;
  4263. nla = info->attrs[NL80211_ATTR_STA_WME];
  4264. err = nla_parse_nested(tb, NL80211_STA_WME_MAX, nla,
  4265. nl80211_sta_wme_policy, info->extack);
  4266. if (err)
  4267. return err;
  4268. if (tb[NL80211_STA_WME_UAPSD_QUEUES])
  4269. params->uapsd_queues = nla_get_u8(
  4270. tb[NL80211_STA_WME_UAPSD_QUEUES]);
  4271. if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
  4272. return -EINVAL;
  4273. if (tb[NL80211_STA_WME_MAX_SP])
  4274. params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
  4275. if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
  4276. return -EINVAL;
  4277. params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
  4278. return 0;
  4279. }
  4280. static int nl80211_parse_sta_channel_info(struct genl_info *info,
  4281. struct station_parameters *params)
  4282. {
  4283. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
  4284. params->supported_channels =
  4285. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
  4286. params->supported_channels_len =
  4287. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
  4288. /*
  4289. * Need to include at least one (first channel, number of
  4290. * channels) tuple for each subband, and must have proper
  4291. * tuples for the rest of the data as well.
  4292. */
  4293. if (params->supported_channels_len < 2)
  4294. return -EINVAL;
  4295. if (params->supported_channels_len % 2)
  4296. return -EINVAL;
  4297. }
  4298. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
  4299. params->supported_oper_classes =
  4300. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
  4301. params->supported_oper_classes_len =
  4302. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
  4303. /*
  4304. * The value of the Length field of the Supported Operating
  4305. * Classes element is between 2 and 253.
  4306. */
  4307. if (params->supported_oper_classes_len < 2 ||
  4308. params->supported_oper_classes_len > 253)
  4309. return -EINVAL;
  4310. }
  4311. return 0;
  4312. }
  4313. static int nl80211_set_station_tdls(struct genl_info *info,
  4314. struct station_parameters *params)
  4315. {
  4316. int err;
  4317. /* Dummy STA entry gets updated once the peer capabilities are known */
  4318. if (info->attrs[NL80211_ATTR_PEER_AID])
  4319. params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
  4320. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  4321. params->ht_capa =
  4322. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  4323. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  4324. params->vht_capa =
  4325. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  4326. err = nl80211_parse_sta_channel_info(info, params);
  4327. if (err)
  4328. return err;
  4329. return nl80211_parse_sta_wme(info, params);
  4330. }
  4331. static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
  4332. {
  4333. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4334. struct net_device *dev = info->user_ptr[1];
  4335. struct station_parameters params;
  4336. u8 *mac_addr;
  4337. int err;
  4338. memset(&params, 0, sizeof(params));
  4339. if (!rdev->ops->change_station)
  4340. return -EOPNOTSUPP;
  4341. /*
  4342. * AID and listen_interval properties can be set only for unassociated
  4343. * station. Include these parameters here and will check them in
  4344. * cfg80211_check_station_change().
  4345. */
  4346. if (info->attrs[NL80211_ATTR_STA_AID])
  4347. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
  4348. if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  4349. params.listen_interval =
  4350. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  4351. else
  4352. params.listen_interval = -1;
  4353. if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
  4354. u8 tmp;
  4355. tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
  4356. if (tmp >= NUM_NL80211_P2P_PS_STATUS)
  4357. return -EINVAL;
  4358. params.support_p2p_ps = tmp;
  4359. } else {
  4360. params.support_p2p_ps = -1;
  4361. }
  4362. if (!info->attrs[NL80211_ATTR_MAC])
  4363. return -EINVAL;
  4364. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4365. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
  4366. params.supported_rates =
  4367. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  4368. params.supported_rates_len =
  4369. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  4370. }
  4371. if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
  4372. params.capability =
  4373. nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
  4374. params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
  4375. }
  4376. if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
  4377. params.ext_capab =
  4378. nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  4379. params.ext_capab_len =
  4380. nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  4381. }
  4382. if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
  4383. return -EINVAL;
  4384. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
  4385. params.plink_action =
  4386. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  4387. if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
  4388. return -EINVAL;
  4389. }
  4390. if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
  4391. params.plink_state =
  4392. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
  4393. if (params.plink_state >= NUM_NL80211_PLINK_STATES)
  4394. return -EINVAL;
  4395. if (info->attrs[NL80211_ATTR_MESH_PEER_AID]) {
  4396. params.peer_aid = nla_get_u16(
  4397. info->attrs[NL80211_ATTR_MESH_PEER_AID]);
  4398. if (params.peer_aid > IEEE80211_MAX_AID)
  4399. return -EINVAL;
  4400. }
  4401. params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
  4402. }
  4403. if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]) {
  4404. enum nl80211_mesh_power_mode pm = nla_get_u32(
  4405. info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
  4406. if (pm <= NL80211_MESH_POWER_UNKNOWN ||
  4407. pm > NL80211_MESH_POWER_MAX)
  4408. return -EINVAL;
  4409. params.local_pm = pm;
  4410. }
  4411. if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
  4412. params.opmode_notif_used = true;
  4413. params.opmode_notif =
  4414. nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
  4415. }
  4416. /* Include parameters for TDLS peer (will check later) */
  4417. err = nl80211_set_station_tdls(info, &params);
  4418. if (err)
  4419. return err;
  4420. params.vlan = get_vlan(info, rdev);
  4421. if (IS_ERR(params.vlan))
  4422. return PTR_ERR(params.vlan);
  4423. switch (dev->ieee80211_ptr->iftype) {
  4424. case NL80211_IFTYPE_AP:
  4425. case NL80211_IFTYPE_AP_VLAN:
  4426. case NL80211_IFTYPE_P2P_GO:
  4427. case NL80211_IFTYPE_P2P_CLIENT:
  4428. case NL80211_IFTYPE_STATION:
  4429. case NL80211_IFTYPE_ADHOC:
  4430. case NL80211_IFTYPE_MESH_POINT:
  4431. break;
  4432. default:
  4433. err = -EOPNOTSUPP;
  4434. goto out_put_vlan;
  4435. }
  4436. /* driver will call cfg80211_check_station_change() */
  4437. err = rdev_change_station(rdev, dev, mac_addr, &params);
  4438. out_put_vlan:
  4439. if (params.vlan)
  4440. dev_put(params.vlan);
  4441. return err;
  4442. }
  4443. static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
  4444. {
  4445. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4446. int err;
  4447. struct net_device *dev = info->user_ptr[1];
  4448. struct station_parameters params;
  4449. u8 *mac_addr = NULL;
  4450. u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  4451. BIT(NL80211_STA_FLAG_ASSOCIATED);
  4452. memset(&params, 0, sizeof(params));
  4453. if (!rdev->ops->add_station)
  4454. return -EOPNOTSUPP;
  4455. if (!info->attrs[NL80211_ATTR_MAC])
  4456. return -EINVAL;
  4457. if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  4458. return -EINVAL;
  4459. if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
  4460. return -EINVAL;
  4461. if (!info->attrs[NL80211_ATTR_STA_AID] &&
  4462. !info->attrs[NL80211_ATTR_PEER_AID])
  4463. return -EINVAL;
  4464. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4465. params.supported_rates =
  4466. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  4467. params.supported_rates_len =
  4468. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  4469. params.listen_interval =
  4470. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  4471. if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
  4472. u8 tmp;
  4473. tmp = nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
  4474. if (tmp >= NUM_NL80211_P2P_PS_STATUS)
  4475. return -EINVAL;
  4476. params.support_p2p_ps = tmp;
  4477. } else {
  4478. /*
  4479. * if not specified, assume it's supported for P2P GO interface,
  4480. * and is NOT supported for AP interface
  4481. */
  4482. params.support_p2p_ps =
  4483. dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
  4484. }
  4485. if (info->attrs[NL80211_ATTR_PEER_AID])
  4486. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
  4487. else
  4488. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
  4489. if (!params.aid || params.aid > IEEE80211_MAX_AID)
  4490. return -EINVAL;
  4491. if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
  4492. params.capability =
  4493. nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
  4494. params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
  4495. }
  4496. if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
  4497. params.ext_capab =
  4498. nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  4499. params.ext_capab_len =
  4500. nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  4501. }
  4502. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  4503. params.ht_capa =
  4504. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  4505. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  4506. params.vht_capa =
  4507. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  4508. if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
  4509. params.opmode_notif_used = true;
  4510. params.opmode_notif =
  4511. nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
  4512. }
  4513. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION]) {
  4514. params.plink_action =
  4515. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  4516. if (params.plink_action >= NUM_NL80211_PLINK_ACTIONS)
  4517. return -EINVAL;
  4518. }
  4519. err = nl80211_parse_sta_channel_info(info, &params);
  4520. if (err)
  4521. return err;
  4522. err = nl80211_parse_sta_wme(info, &params);
  4523. if (err)
  4524. return err;
  4525. if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
  4526. return -EINVAL;
  4527. /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
  4528. * as userspace might just pass through the capabilities from the IEs
  4529. * directly, rather than enforcing this restriction and returning an
  4530. * error in this case.
  4531. */
  4532. if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
  4533. params.ht_capa = NULL;
  4534. params.vht_capa = NULL;
  4535. }
  4536. /* When you run into this, adjust the code below for the new flag */
  4537. BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
  4538. switch (dev->ieee80211_ptr->iftype) {
  4539. case NL80211_IFTYPE_AP:
  4540. case NL80211_IFTYPE_AP_VLAN:
  4541. case NL80211_IFTYPE_P2P_GO:
  4542. /* ignore WME attributes if iface/sta is not capable */
  4543. if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
  4544. !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
  4545. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  4546. /* TDLS peers cannot be added */
  4547. if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
  4548. info->attrs[NL80211_ATTR_PEER_AID])
  4549. return -EINVAL;
  4550. /* but don't bother the driver with it */
  4551. params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  4552. /* allow authenticated/associated only if driver handles it */
  4553. if (!(rdev->wiphy.features &
  4554. NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
  4555. params.sta_flags_mask & auth_assoc)
  4556. return -EINVAL;
  4557. /* Older userspace, or userspace wanting to be compatible with
  4558. * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
  4559. * and assoc flags in the mask, but assumes the station will be
  4560. * added as associated anyway since this was the required driver
  4561. * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
  4562. * introduced.
  4563. * In order to not bother drivers with this quirk in the API
  4564. * set the flags in both the mask and set for new stations in
  4565. * this case.
  4566. */
  4567. if (!(params.sta_flags_mask & auth_assoc)) {
  4568. params.sta_flags_mask |= auth_assoc;
  4569. params.sta_flags_set |= auth_assoc;
  4570. }
  4571. /* must be last in here for error handling */
  4572. params.vlan = get_vlan(info, rdev);
  4573. if (IS_ERR(params.vlan))
  4574. return PTR_ERR(params.vlan);
  4575. break;
  4576. case NL80211_IFTYPE_MESH_POINT:
  4577. /* ignore uAPSD data */
  4578. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  4579. /* associated is disallowed */
  4580. if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
  4581. return -EINVAL;
  4582. /* TDLS peers cannot be added */
  4583. if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
  4584. info->attrs[NL80211_ATTR_PEER_AID])
  4585. return -EINVAL;
  4586. break;
  4587. case NL80211_IFTYPE_STATION:
  4588. case NL80211_IFTYPE_P2P_CLIENT:
  4589. /* ignore uAPSD data */
  4590. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  4591. /* these are disallowed */
  4592. if (params.sta_flags_mask &
  4593. (BIT(NL80211_STA_FLAG_ASSOCIATED) |
  4594. BIT(NL80211_STA_FLAG_AUTHENTICATED)))
  4595. return -EINVAL;
  4596. /* Only TDLS peers can be added */
  4597. if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
  4598. return -EINVAL;
  4599. /* Can only add if TDLS ... */
  4600. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
  4601. return -EOPNOTSUPP;
  4602. /* ... with external setup is supported */
  4603. if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
  4604. return -EOPNOTSUPP;
  4605. /*
  4606. * Older wpa_supplicant versions always mark the TDLS peer
  4607. * as authorized, but it shouldn't yet be.
  4608. */
  4609. params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
  4610. break;
  4611. default:
  4612. return -EOPNOTSUPP;
  4613. }
  4614. /* be aware of params.vlan when changing code here */
  4615. err = rdev_add_station(rdev, dev, mac_addr, &params);
  4616. if (params.vlan)
  4617. dev_put(params.vlan);
  4618. return err;
  4619. }
  4620. static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
  4621. {
  4622. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4623. struct net_device *dev = info->user_ptr[1];
  4624. struct station_del_parameters params;
  4625. memset(&params, 0, sizeof(params));
  4626. if (info->attrs[NL80211_ATTR_MAC])
  4627. params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4628. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  4629. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  4630. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  4631. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  4632. return -EINVAL;
  4633. if (!rdev->ops->del_station)
  4634. return -EOPNOTSUPP;
  4635. if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
  4636. params.subtype =
  4637. nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
  4638. if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
  4639. params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
  4640. return -EINVAL;
  4641. } else {
  4642. /* Default to Deauthentication frame */
  4643. params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
  4644. }
  4645. if (info->attrs[NL80211_ATTR_REASON_CODE]) {
  4646. params.reason_code =
  4647. nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  4648. if (params.reason_code == 0)
  4649. return -EINVAL; /* 0 is reserved */
  4650. } else {
  4651. /* Default to reason code 2 */
  4652. params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
  4653. }
  4654. return rdev_del_station(rdev, dev, &params);
  4655. }
  4656. static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
  4657. int flags, struct net_device *dev,
  4658. u8 *dst, u8 *next_hop,
  4659. struct mpath_info *pinfo)
  4660. {
  4661. void *hdr;
  4662. struct nlattr *pinfoattr;
  4663. hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
  4664. if (!hdr)
  4665. return -1;
  4666. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  4667. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
  4668. nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
  4669. nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
  4670. goto nla_put_failure;
  4671. pinfoattr = nla_nest_start(msg, NL80211_ATTR_MPATH_INFO);
  4672. if (!pinfoattr)
  4673. goto nla_put_failure;
  4674. if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
  4675. nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
  4676. pinfo->frame_qlen))
  4677. goto nla_put_failure;
  4678. if (((pinfo->filled & MPATH_INFO_SN) &&
  4679. nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
  4680. ((pinfo->filled & MPATH_INFO_METRIC) &&
  4681. nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
  4682. pinfo->metric)) ||
  4683. ((pinfo->filled & MPATH_INFO_EXPTIME) &&
  4684. nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
  4685. pinfo->exptime)) ||
  4686. ((pinfo->filled & MPATH_INFO_FLAGS) &&
  4687. nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
  4688. pinfo->flags)) ||
  4689. ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
  4690. nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
  4691. pinfo->discovery_timeout)) ||
  4692. ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
  4693. nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
  4694. pinfo->discovery_retries)))
  4695. goto nla_put_failure;
  4696. nla_nest_end(msg, pinfoattr);
  4697. genlmsg_end(msg, hdr);
  4698. return 0;
  4699. nla_put_failure:
  4700. genlmsg_cancel(msg, hdr);
  4701. return -EMSGSIZE;
  4702. }
  4703. static int nl80211_dump_mpath(struct sk_buff *skb,
  4704. struct netlink_callback *cb)
  4705. {
  4706. struct mpath_info pinfo;
  4707. struct cfg80211_registered_device *rdev;
  4708. struct wireless_dev *wdev;
  4709. u8 dst[ETH_ALEN];
  4710. u8 next_hop[ETH_ALEN];
  4711. int path_idx = cb->args[2];
  4712. int err;
  4713. rtnl_lock();
  4714. err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
  4715. if (err)
  4716. goto out_err;
  4717. if (!rdev->ops->dump_mpath) {
  4718. err = -EOPNOTSUPP;
  4719. goto out_err;
  4720. }
  4721. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
  4722. err = -EOPNOTSUPP;
  4723. goto out_err;
  4724. }
  4725. while (1) {
  4726. err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
  4727. next_hop, &pinfo);
  4728. if (err == -ENOENT)
  4729. break;
  4730. if (err)
  4731. goto out_err;
  4732. if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
  4733. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  4734. wdev->netdev, dst, next_hop,
  4735. &pinfo) < 0)
  4736. goto out;
  4737. path_idx++;
  4738. }
  4739. out:
  4740. cb->args[2] = path_idx;
  4741. err = skb->len;
  4742. out_err:
  4743. rtnl_unlock();
  4744. return err;
  4745. }
  4746. static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
  4747. {
  4748. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4749. int err;
  4750. struct net_device *dev = info->user_ptr[1];
  4751. struct mpath_info pinfo;
  4752. struct sk_buff *msg;
  4753. u8 *dst = NULL;
  4754. u8 next_hop[ETH_ALEN];
  4755. memset(&pinfo, 0, sizeof(pinfo));
  4756. if (!info->attrs[NL80211_ATTR_MAC])
  4757. return -EINVAL;
  4758. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4759. if (!rdev->ops->get_mpath)
  4760. return -EOPNOTSUPP;
  4761. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  4762. return -EOPNOTSUPP;
  4763. err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
  4764. if (err)
  4765. return err;
  4766. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4767. if (!msg)
  4768. return -ENOMEM;
  4769. if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
  4770. dev, dst, next_hop, &pinfo) < 0) {
  4771. nlmsg_free(msg);
  4772. return -ENOBUFS;
  4773. }
  4774. return genlmsg_reply(msg, info);
  4775. }
  4776. static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
  4777. {
  4778. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4779. struct net_device *dev = info->user_ptr[1];
  4780. u8 *dst = NULL;
  4781. u8 *next_hop = NULL;
  4782. if (!info->attrs[NL80211_ATTR_MAC])
  4783. return -EINVAL;
  4784. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  4785. return -EINVAL;
  4786. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4787. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  4788. if (!rdev->ops->change_mpath)
  4789. return -EOPNOTSUPP;
  4790. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  4791. return -EOPNOTSUPP;
  4792. return rdev_change_mpath(rdev, dev, dst, next_hop);
  4793. }
  4794. static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
  4795. {
  4796. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4797. struct net_device *dev = info->user_ptr[1];
  4798. u8 *dst = NULL;
  4799. u8 *next_hop = NULL;
  4800. if (!info->attrs[NL80211_ATTR_MAC])
  4801. return -EINVAL;
  4802. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  4803. return -EINVAL;
  4804. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4805. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  4806. if (!rdev->ops->add_mpath)
  4807. return -EOPNOTSUPP;
  4808. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  4809. return -EOPNOTSUPP;
  4810. return rdev_add_mpath(rdev, dev, dst, next_hop);
  4811. }
  4812. static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
  4813. {
  4814. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4815. struct net_device *dev = info->user_ptr[1];
  4816. u8 *dst = NULL;
  4817. if (info->attrs[NL80211_ATTR_MAC])
  4818. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4819. if (!rdev->ops->del_mpath)
  4820. return -EOPNOTSUPP;
  4821. return rdev_del_mpath(rdev, dev, dst);
  4822. }
  4823. static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
  4824. {
  4825. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4826. int err;
  4827. struct net_device *dev = info->user_ptr[1];
  4828. struct mpath_info pinfo;
  4829. struct sk_buff *msg;
  4830. u8 *dst = NULL;
  4831. u8 mpp[ETH_ALEN];
  4832. memset(&pinfo, 0, sizeof(pinfo));
  4833. if (!info->attrs[NL80211_ATTR_MAC])
  4834. return -EINVAL;
  4835. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4836. if (!rdev->ops->get_mpp)
  4837. return -EOPNOTSUPP;
  4838. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  4839. return -EOPNOTSUPP;
  4840. err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
  4841. if (err)
  4842. return err;
  4843. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4844. if (!msg)
  4845. return -ENOMEM;
  4846. if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
  4847. dev, dst, mpp, &pinfo) < 0) {
  4848. nlmsg_free(msg);
  4849. return -ENOBUFS;
  4850. }
  4851. return genlmsg_reply(msg, info);
  4852. }
  4853. static int nl80211_dump_mpp(struct sk_buff *skb,
  4854. struct netlink_callback *cb)
  4855. {
  4856. struct mpath_info pinfo;
  4857. struct cfg80211_registered_device *rdev;
  4858. struct wireless_dev *wdev;
  4859. u8 dst[ETH_ALEN];
  4860. u8 mpp[ETH_ALEN];
  4861. int path_idx = cb->args[2];
  4862. int err;
  4863. rtnl_lock();
  4864. err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
  4865. if (err)
  4866. goto out_err;
  4867. if (!rdev->ops->dump_mpp) {
  4868. err = -EOPNOTSUPP;
  4869. goto out_err;
  4870. }
  4871. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
  4872. err = -EOPNOTSUPP;
  4873. goto out_err;
  4874. }
  4875. while (1) {
  4876. err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
  4877. mpp, &pinfo);
  4878. if (err == -ENOENT)
  4879. break;
  4880. if (err)
  4881. goto out_err;
  4882. if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
  4883. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  4884. wdev->netdev, dst, mpp,
  4885. &pinfo) < 0)
  4886. goto out;
  4887. path_idx++;
  4888. }
  4889. out:
  4890. cb->args[2] = path_idx;
  4891. err = skb->len;
  4892. out_err:
  4893. rtnl_unlock();
  4894. return err;
  4895. }
  4896. static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
  4897. {
  4898. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4899. struct net_device *dev = info->user_ptr[1];
  4900. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4901. struct bss_parameters params;
  4902. int err;
  4903. memset(&params, 0, sizeof(params));
  4904. /* default to not changing parameters */
  4905. params.use_cts_prot = -1;
  4906. params.use_short_preamble = -1;
  4907. params.use_short_slot_time = -1;
  4908. params.ap_isolate = -1;
  4909. params.ht_opmode = -1;
  4910. params.p2p_ctwindow = -1;
  4911. params.p2p_opp_ps = -1;
  4912. if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
  4913. params.use_cts_prot =
  4914. nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
  4915. if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
  4916. params.use_short_preamble =
  4917. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
  4918. if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
  4919. params.use_short_slot_time =
  4920. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
  4921. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  4922. params.basic_rates =
  4923. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  4924. params.basic_rates_len =
  4925. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  4926. }
  4927. if (info->attrs[NL80211_ATTR_AP_ISOLATE])
  4928. params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
  4929. if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
  4930. params.ht_opmode =
  4931. nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
  4932. if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
  4933. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  4934. return -EINVAL;
  4935. params.p2p_ctwindow =
  4936. nla_get_s8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
  4937. if (params.p2p_ctwindow < 0)
  4938. return -EINVAL;
  4939. if (params.p2p_ctwindow != 0 &&
  4940. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
  4941. return -EINVAL;
  4942. }
  4943. if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
  4944. u8 tmp;
  4945. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  4946. return -EINVAL;
  4947. tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
  4948. if (tmp > 1)
  4949. return -EINVAL;
  4950. params.p2p_opp_ps = tmp;
  4951. if (params.p2p_opp_ps &&
  4952. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
  4953. return -EINVAL;
  4954. }
  4955. if (!rdev->ops->change_bss)
  4956. return -EOPNOTSUPP;
  4957. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  4958. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  4959. return -EOPNOTSUPP;
  4960. wdev_lock(wdev);
  4961. err = rdev_change_bss(rdev, dev, &params);
  4962. wdev_unlock(wdev);
  4963. return err;
  4964. }
  4965. static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
  4966. {
  4967. char *data = NULL;
  4968. bool is_indoor;
  4969. enum nl80211_user_reg_hint_type user_reg_hint_type;
  4970. u32 owner_nlportid;
  4971. /*
  4972. * You should only get this when cfg80211 hasn't yet initialized
  4973. * completely when built-in to the kernel right between the time
  4974. * window between nl80211_init() and regulatory_init(), if that is
  4975. * even possible.
  4976. */
  4977. if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
  4978. return -EINPROGRESS;
  4979. if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
  4980. user_reg_hint_type =
  4981. nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
  4982. else
  4983. user_reg_hint_type = NL80211_USER_REG_HINT_USER;
  4984. switch (user_reg_hint_type) {
  4985. case NL80211_USER_REG_HINT_USER:
  4986. case NL80211_USER_REG_HINT_CELL_BASE:
  4987. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  4988. return -EINVAL;
  4989. data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  4990. return regulatory_hint_user(data, user_reg_hint_type);
  4991. case NL80211_USER_REG_HINT_INDOOR:
  4992. if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  4993. owner_nlportid = info->snd_portid;
  4994. is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
  4995. } else {
  4996. owner_nlportid = 0;
  4997. is_indoor = true;
  4998. }
  4999. return regulatory_hint_indoor(is_indoor, owner_nlportid);
  5000. default:
  5001. return -EINVAL;
  5002. }
  5003. }
  5004. static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
  5005. {
  5006. return reg_reload_regdb();
  5007. }
  5008. static int nl80211_get_mesh_config(struct sk_buff *skb,
  5009. struct genl_info *info)
  5010. {
  5011. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5012. struct net_device *dev = info->user_ptr[1];
  5013. struct wireless_dev *wdev = dev->ieee80211_ptr;
  5014. struct mesh_config cur_params;
  5015. int err = 0;
  5016. void *hdr;
  5017. struct nlattr *pinfoattr;
  5018. struct sk_buff *msg;
  5019. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  5020. return -EOPNOTSUPP;
  5021. if (!rdev->ops->get_mesh_config)
  5022. return -EOPNOTSUPP;
  5023. wdev_lock(wdev);
  5024. /* If not connected, get default parameters */
  5025. if (!wdev->mesh_id_len)
  5026. memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
  5027. else
  5028. err = rdev_get_mesh_config(rdev, dev, &cur_params);
  5029. wdev_unlock(wdev);
  5030. if (err)
  5031. return err;
  5032. /* Draw up a netlink message to send back */
  5033. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  5034. if (!msg)
  5035. return -ENOMEM;
  5036. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  5037. NL80211_CMD_GET_MESH_CONFIG);
  5038. if (!hdr)
  5039. goto out;
  5040. pinfoattr = nla_nest_start(msg, NL80211_ATTR_MESH_CONFIG);
  5041. if (!pinfoattr)
  5042. goto nla_put_failure;
  5043. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  5044. nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
  5045. cur_params.dot11MeshRetryTimeout) ||
  5046. nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
  5047. cur_params.dot11MeshConfirmTimeout) ||
  5048. nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
  5049. cur_params.dot11MeshHoldingTimeout) ||
  5050. nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
  5051. cur_params.dot11MeshMaxPeerLinks) ||
  5052. nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
  5053. cur_params.dot11MeshMaxRetries) ||
  5054. nla_put_u8(msg, NL80211_MESHCONF_TTL,
  5055. cur_params.dot11MeshTTL) ||
  5056. nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
  5057. cur_params.element_ttl) ||
  5058. nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  5059. cur_params.auto_open_plinks) ||
  5060. nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
  5061. cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
  5062. nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  5063. cur_params.dot11MeshHWMPmaxPREQretries) ||
  5064. nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
  5065. cur_params.path_refresh_time) ||
  5066. nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  5067. cur_params.min_discovery_timeout) ||
  5068. nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  5069. cur_params.dot11MeshHWMPactivePathTimeout) ||
  5070. nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  5071. cur_params.dot11MeshHWMPpreqMinInterval) ||
  5072. nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
  5073. cur_params.dot11MeshHWMPperrMinInterval) ||
  5074. nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  5075. cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
  5076. nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
  5077. cur_params.dot11MeshHWMPRootMode) ||
  5078. nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
  5079. cur_params.dot11MeshHWMPRannInterval) ||
  5080. nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
  5081. cur_params.dot11MeshGateAnnouncementProtocol) ||
  5082. nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
  5083. cur_params.dot11MeshForwarding) ||
  5084. nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
  5085. cur_params.rssi_threshold) ||
  5086. nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
  5087. cur_params.ht_opmode) ||
  5088. nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
  5089. cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
  5090. nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
  5091. cur_params.dot11MeshHWMProotInterval) ||
  5092. nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
  5093. cur_params.dot11MeshHWMPconfirmationInterval) ||
  5094. nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
  5095. cur_params.power_mode) ||
  5096. nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
  5097. cur_params.dot11MeshAwakeWindowDuration) ||
  5098. nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
  5099. cur_params.plink_timeout))
  5100. goto nla_put_failure;
  5101. nla_nest_end(msg, pinfoattr);
  5102. genlmsg_end(msg, hdr);
  5103. return genlmsg_reply(msg, info);
  5104. nla_put_failure:
  5105. out:
  5106. nlmsg_free(msg);
  5107. return -ENOBUFS;
  5108. }
  5109. static const struct nla_policy nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
  5110. [NL80211_MESHCONF_RETRY_TIMEOUT] = { .type = NLA_U16 },
  5111. [NL80211_MESHCONF_CONFIRM_TIMEOUT] = { .type = NLA_U16 },
  5112. [NL80211_MESHCONF_HOLDING_TIMEOUT] = { .type = NLA_U16 },
  5113. [NL80211_MESHCONF_MAX_PEER_LINKS] = { .type = NLA_U16 },
  5114. [NL80211_MESHCONF_MAX_RETRIES] = { .type = NLA_U8 },
  5115. [NL80211_MESHCONF_TTL] = { .type = NLA_U8 },
  5116. [NL80211_MESHCONF_ELEMENT_TTL] = { .type = NLA_U8 },
  5117. [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = { .type = NLA_U8 },
  5118. [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] = { .type = NLA_U32 },
  5119. [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
  5120. [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
  5121. [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = { .type = NLA_U16 },
  5122. [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
  5123. [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] = { .type = NLA_U16 },
  5124. [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] = { .type = NLA_U16 },
  5125. [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] = { .type = NLA_U16 },
  5126. [NL80211_MESHCONF_HWMP_ROOTMODE] = { .type = NLA_U8 },
  5127. [NL80211_MESHCONF_HWMP_RANN_INTERVAL] = { .type = NLA_U16 },
  5128. [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = { .type = NLA_U8 },
  5129. [NL80211_MESHCONF_FORWARDING] = { .type = NLA_U8 },
  5130. [NL80211_MESHCONF_RSSI_THRESHOLD] = { .type = NLA_U32 },
  5131. [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
  5132. [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
  5133. [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] = { .type = NLA_U16 },
  5134. [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] = { .type = NLA_U16 },
  5135. [NL80211_MESHCONF_POWER_MODE] = { .type = NLA_U32 },
  5136. [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
  5137. [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
  5138. };
  5139. static const struct nla_policy
  5140. nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
  5141. [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
  5142. [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
  5143. [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
  5144. [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
  5145. [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
  5146. [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
  5147. [NL80211_MESH_SETUP_IE] = { .type = NLA_BINARY,
  5148. .len = IEEE80211_MAX_DATA_LEN },
  5149. [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
  5150. };
  5151. static int nl80211_check_bool(const struct nlattr *nla, u8 min, u8 max, bool *out)
  5152. {
  5153. u8 val = nla_get_u8(nla);
  5154. if (val < min || val > max)
  5155. return -EINVAL;
  5156. *out = val;
  5157. return 0;
  5158. }
  5159. static int nl80211_check_u8(const struct nlattr *nla, u8 min, u8 max, u8 *out)
  5160. {
  5161. u8 val = nla_get_u8(nla);
  5162. if (val < min || val > max)
  5163. return -EINVAL;
  5164. *out = val;
  5165. return 0;
  5166. }
  5167. static int nl80211_check_u16(const struct nlattr *nla, u16 min, u16 max, u16 *out)
  5168. {
  5169. u16 val = nla_get_u16(nla);
  5170. if (val < min || val > max)
  5171. return -EINVAL;
  5172. *out = val;
  5173. return 0;
  5174. }
  5175. static int nl80211_check_u32(const struct nlattr *nla, u32 min, u32 max, u32 *out)
  5176. {
  5177. u32 val = nla_get_u32(nla);
  5178. if (val < min || val > max)
  5179. return -EINVAL;
  5180. *out = val;
  5181. return 0;
  5182. }
  5183. static int nl80211_check_s32(const struct nlattr *nla, s32 min, s32 max, s32 *out)
  5184. {
  5185. s32 val = nla_get_s32(nla);
  5186. if (val < min || val > max)
  5187. return -EINVAL;
  5188. *out = val;
  5189. return 0;
  5190. }
  5191. static int nl80211_check_power_mode(const struct nlattr *nla,
  5192. enum nl80211_mesh_power_mode min,
  5193. enum nl80211_mesh_power_mode max,
  5194. enum nl80211_mesh_power_mode *out)
  5195. {
  5196. u32 val = nla_get_u32(nla);
  5197. if (val < min || val > max)
  5198. return -EINVAL;
  5199. *out = val;
  5200. return 0;
  5201. }
  5202. static int nl80211_parse_mesh_config(struct genl_info *info,
  5203. struct mesh_config *cfg,
  5204. u32 *mask_out)
  5205. {
  5206. struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
  5207. u32 mask = 0;
  5208. u16 ht_opmode;
  5209. #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, min, max, mask, attr, fn) \
  5210. do { \
  5211. if (tb[attr]) { \
  5212. if (fn(tb[attr], min, max, &cfg->param)) \
  5213. return -EINVAL; \
  5214. mask |= (1 << (attr - 1)); \
  5215. } \
  5216. } while (0)
  5217. if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
  5218. return -EINVAL;
  5219. if (nla_parse_nested(tb, NL80211_MESHCONF_ATTR_MAX,
  5220. info->attrs[NL80211_ATTR_MESH_CONFIG],
  5221. nl80211_meshconf_params_policy, info->extack))
  5222. return -EINVAL;
  5223. /* This makes sure that there aren't more than 32 mesh config
  5224. * parameters (otherwise our bitfield scheme would not work.) */
  5225. BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
  5226. /* Fill in the params struct */
  5227. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, 1, 255,
  5228. mask, NL80211_MESHCONF_RETRY_TIMEOUT,
  5229. nl80211_check_u16);
  5230. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, 1, 255,
  5231. mask, NL80211_MESHCONF_CONFIRM_TIMEOUT,
  5232. nl80211_check_u16);
  5233. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, 1, 255,
  5234. mask, NL80211_MESHCONF_HOLDING_TIMEOUT,
  5235. nl80211_check_u16);
  5236. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, 0, 255,
  5237. mask, NL80211_MESHCONF_MAX_PEER_LINKS,
  5238. nl80211_check_u16);
  5239. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, 0, 16,
  5240. mask, NL80211_MESHCONF_MAX_RETRIES,
  5241. nl80211_check_u8);
  5242. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, 1, 255,
  5243. mask, NL80211_MESHCONF_TTL, nl80211_check_u8);
  5244. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, 1, 255,
  5245. mask, NL80211_MESHCONF_ELEMENT_TTL,
  5246. nl80211_check_u8);
  5247. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, 0, 1,
  5248. mask, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  5249. nl80211_check_bool);
  5250. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
  5251. 1, 255, mask,
  5252. NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
  5253. nl80211_check_u32);
  5254. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, 0, 255,
  5255. mask, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  5256. nl80211_check_u8);
  5257. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, 1, 65535,
  5258. mask, NL80211_MESHCONF_PATH_REFRESH_TIME,
  5259. nl80211_check_u32);
  5260. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, 1, 65535,
  5261. mask, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  5262. nl80211_check_u16);
  5263. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
  5264. 1, 65535, mask,
  5265. NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  5266. nl80211_check_u32);
  5267. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval,
  5268. 1, 65535, mask,
  5269. NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  5270. nl80211_check_u16);
  5271. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval,
  5272. 1, 65535, mask,
  5273. NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
  5274. nl80211_check_u16);
  5275. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  5276. dot11MeshHWMPnetDiameterTraversalTime,
  5277. 1, 65535, mask,
  5278. NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  5279. nl80211_check_u16);
  5280. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, 0, 4,
  5281. mask, NL80211_MESHCONF_HWMP_ROOTMODE,
  5282. nl80211_check_u8);
  5283. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, 1, 65535,
  5284. mask, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
  5285. nl80211_check_u16);
  5286. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  5287. dot11MeshGateAnnouncementProtocol, 0, 1,
  5288. mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
  5289. nl80211_check_bool);
  5290. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, 0, 1,
  5291. mask, NL80211_MESHCONF_FORWARDING,
  5292. nl80211_check_bool);
  5293. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, -255, 0,
  5294. mask, NL80211_MESHCONF_RSSI_THRESHOLD,
  5295. nl80211_check_s32);
  5296. /*
  5297. * Check HT operation mode based on
  5298. * IEEE 802.11 2012 8.4.2.59 HT Operation element.
  5299. */
  5300. if (tb[NL80211_MESHCONF_HT_OPMODE]) {
  5301. ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
  5302. if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
  5303. IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
  5304. IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
  5305. return -EINVAL;
  5306. if ((ht_opmode & IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT) &&
  5307. (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
  5308. return -EINVAL;
  5309. switch (ht_opmode & IEEE80211_HT_OP_MODE_PROTECTION) {
  5310. case IEEE80211_HT_OP_MODE_PROTECTION_NONE:
  5311. case IEEE80211_HT_OP_MODE_PROTECTION_20MHZ:
  5312. if (ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT)
  5313. return -EINVAL;
  5314. break;
  5315. case IEEE80211_HT_OP_MODE_PROTECTION_NONMEMBER:
  5316. case IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED:
  5317. if (!(ht_opmode & IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
  5318. return -EINVAL;
  5319. break;
  5320. }
  5321. cfg->ht_opmode = ht_opmode;
  5322. mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
  5323. }
  5324. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathToRootTimeout,
  5325. 1, 65535, mask,
  5326. NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
  5327. nl80211_check_u32);
  5328. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, 1, 65535,
  5329. mask, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
  5330. nl80211_check_u16);
  5331. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  5332. dot11MeshHWMPconfirmationInterval,
  5333. 1, 65535, mask,
  5334. NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
  5335. nl80211_check_u16);
  5336. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode,
  5337. NL80211_MESH_POWER_ACTIVE,
  5338. NL80211_MESH_POWER_MAX,
  5339. mask, NL80211_MESHCONF_POWER_MODE,
  5340. nl80211_check_power_mode);
  5341. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration,
  5342. 0, 65535, mask,
  5343. NL80211_MESHCONF_AWAKE_WINDOW, nl80211_check_u16);
  5344. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, 0, 0xffffffff,
  5345. mask, NL80211_MESHCONF_PLINK_TIMEOUT,
  5346. nl80211_check_u32);
  5347. if (mask_out)
  5348. *mask_out = mask;
  5349. return 0;
  5350. #undef FILL_IN_MESH_PARAM_IF_SET
  5351. }
  5352. static int nl80211_parse_mesh_setup(struct genl_info *info,
  5353. struct mesh_setup *setup)
  5354. {
  5355. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5356. struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
  5357. if (!info->attrs[NL80211_ATTR_MESH_SETUP])
  5358. return -EINVAL;
  5359. if (nla_parse_nested(tb, NL80211_MESH_SETUP_ATTR_MAX,
  5360. info->attrs[NL80211_ATTR_MESH_SETUP],
  5361. nl80211_mesh_setup_params_policy, info->extack))
  5362. return -EINVAL;
  5363. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
  5364. setup->sync_method =
  5365. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
  5366. IEEE80211_SYNC_METHOD_VENDOR :
  5367. IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
  5368. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
  5369. setup->path_sel_proto =
  5370. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
  5371. IEEE80211_PATH_PROTOCOL_VENDOR :
  5372. IEEE80211_PATH_PROTOCOL_HWMP;
  5373. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
  5374. setup->path_metric =
  5375. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
  5376. IEEE80211_PATH_METRIC_VENDOR :
  5377. IEEE80211_PATH_METRIC_AIRTIME;
  5378. if (tb[NL80211_MESH_SETUP_IE]) {
  5379. struct nlattr *ieattr =
  5380. tb[NL80211_MESH_SETUP_IE];
  5381. if (!is_valid_ie_attr(ieattr))
  5382. return -EINVAL;
  5383. setup->ie = nla_data(ieattr);
  5384. setup->ie_len = nla_len(ieattr);
  5385. }
  5386. if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
  5387. !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
  5388. return -EINVAL;
  5389. setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
  5390. setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
  5391. setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
  5392. if (setup->is_secure)
  5393. setup->user_mpm = true;
  5394. if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
  5395. if (!setup->user_mpm)
  5396. return -EINVAL;
  5397. setup->auth_id =
  5398. nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
  5399. }
  5400. return 0;
  5401. }
  5402. static int nl80211_update_mesh_config(struct sk_buff *skb,
  5403. struct genl_info *info)
  5404. {
  5405. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5406. struct net_device *dev = info->user_ptr[1];
  5407. struct wireless_dev *wdev = dev->ieee80211_ptr;
  5408. struct mesh_config cfg;
  5409. u32 mask;
  5410. int err;
  5411. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  5412. return -EOPNOTSUPP;
  5413. if (!rdev->ops->update_mesh_config)
  5414. return -EOPNOTSUPP;
  5415. err = nl80211_parse_mesh_config(info, &cfg, &mask);
  5416. if (err)
  5417. return err;
  5418. wdev_lock(wdev);
  5419. if (!wdev->mesh_id_len)
  5420. err = -ENOLINK;
  5421. if (!err)
  5422. err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
  5423. wdev_unlock(wdev);
  5424. return err;
  5425. }
  5426. static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
  5427. struct sk_buff *msg)
  5428. {
  5429. struct nlattr *nl_reg_rules;
  5430. unsigned int i;
  5431. if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
  5432. (regdom->dfs_region &&
  5433. nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
  5434. goto nla_put_failure;
  5435. nl_reg_rules = nla_nest_start(msg, NL80211_ATTR_REG_RULES);
  5436. if (!nl_reg_rules)
  5437. goto nla_put_failure;
  5438. for (i = 0; i < regdom->n_reg_rules; i++) {
  5439. struct nlattr *nl_reg_rule;
  5440. const struct ieee80211_reg_rule *reg_rule;
  5441. const struct ieee80211_freq_range *freq_range;
  5442. const struct ieee80211_power_rule *power_rule;
  5443. unsigned int max_bandwidth_khz;
  5444. reg_rule = &regdom->reg_rules[i];
  5445. freq_range = &reg_rule->freq_range;
  5446. power_rule = &reg_rule->power_rule;
  5447. nl_reg_rule = nla_nest_start(msg, i);
  5448. if (!nl_reg_rule)
  5449. goto nla_put_failure;
  5450. max_bandwidth_khz = freq_range->max_bandwidth_khz;
  5451. if (!max_bandwidth_khz)
  5452. max_bandwidth_khz = reg_get_max_bandwidth(regdom,
  5453. reg_rule);
  5454. if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
  5455. reg_rule->flags) ||
  5456. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
  5457. freq_range->start_freq_khz) ||
  5458. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
  5459. freq_range->end_freq_khz) ||
  5460. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
  5461. max_bandwidth_khz) ||
  5462. nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
  5463. power_rule->max_antenna_gain) ||
  5464. nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
  5465. power_rule->max_eirp) ||
  5466. nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
  5467. reg_rule->dfs_cac_ms))
  5468. goto nla_put_failure;
  5469. nla_nest_end(msg, nl_reg_rule);
  5470. }
  5471. nla_nest_end(msg, nl_reg_rules);
  5472. return 0;
  5473. nla_put_failure:
  5474. return -EMSGSIZE;
  5475. }
  5476. static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
  5477. {
  5478. const struct ieee80211_regdomain *regdom = NULL;
  5479. struct cfg80211_registered_device *rdev;
  5480. struct wiphy *wiphy = NULL;
  5481. struct sk_buff *msg;
  5482. void *hdr;
  5483. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  5484. if (!msg)
  5485. return -ENOBUFS;
  5486. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  5487. NL80211_CMD_GET_REG);
  5488. if (!hdr)
  5489. goto put_failure;
  5490. if (info->attrs[NL80211_ATTR_WIPHY]) {
  5491. bool self_managed;
  5492. rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
  5493. if (IS_ERR(rdev)) {
  5494. nlmsg_free(msg);
  5495. return PTR_ERR(rdev);
  5496. }
  5497. wiphy = &rdev->wiphy;
  5498. self_managed = wiphy->regulatory_flags &
  5499. REGULATORY_WIPHY_SELF_MANAGED;
  5500. regdom = get_wiphy_regdom(wiphy);
  5501. /* a self-managed-reg device must have a private regdom */
  5502. if (WARN_ON(!regdom && self_managed)) {
  5503. nlmsg_free(msg);
  5504. return -EINVAL;
  5505. }
  5506. if (regdom &&
  5507. nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  5508. goto nla_put_failure;
  5509. }
  5510. if (!wiphy && reg_last_request_cell_base() &&
  5511. nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
  5512. NL80211_USER_REG_HINT_CELL_BASE))
  5513. goto nla_put_failure;
  5514. rcu_read_lock();
  5515. if (!regdom)
  5516. regdom = rcu_dereference(cfg80211_regdomain);
  5517. if (nl80211_put_regdom(regdom, msg))
  5518. goto nla_put_failure_rcu;
  5519. rcu_read_unlock();
  5520. genlmsg_end(msg, hdr);
  5521. return genlmsg_reply(msg, info);
  5522. nla_put_failure_rcu:
  5523. rcu_read_unlock();
  5524. nla_put_failure:
  5525. put_failure:
  5526. nlmsg_free(msg);
  5527. return -EMSGSIZE;
  5528. }
  5529. static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
  5530. u32 seq, int flags, struct wiphy *wiphy,
  5531. const struct ieee80211_regdomain *regdom)
  5532. {
  5533. void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
  5534. NL80211_CMD_GET_REG);
  5535. if (!hdr)
  5536. return -1;
  5537. genl_dump_check_consistent(cb, hdr);
  5538. if (nl80211_put_regdom(regdom, msg))
  5539. goto nla_put_failure;
  5540. if (!wiphy && reg_last_request_cell_base() &&
  5541. nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
  5542. NL80211_USER_REG_HINT_CELL_BASE))
  5543. goto nla_put_failure;
  5544. if (wiphy &&
  5545. nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  5546. goto nla_put_failure;
  5547. if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  5548. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  5549. goto nla_put_failure;
  5550. genlmsg_end(msg, hdr);
  5551. return 0;
  5552. nla_put_failure:
  5553. genlmsg_cancel(msg, hdr);
  5554. return -EMSGSIZE;
  5555. }
  5556. static int nl80211_get_reg_dump(struct sk_buff *skb,
  5557. struct netlink_callback *cb)
  5558. {
  5559. const struct ieee80211_regdomain *regdom = NULL;
  5560. struct cfg80211_registered_device *rdev;
  5561. int err, reg_idx, start = cb->args[2];
  5562. rtnl_lock();
  5563. if (cfg80211_regdomain && start == 0) {
  5564. err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
  5565. NLM_F_MULTI, NULL,
  5566. rtnl_dereference(cfg80211_regdomain));
  5567. if (err < 0)
  5568. goto out_err;
  5569. }
  5570. /* the global regdom is idx 0 */
  5571. reg_idx = 1;
  5572. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  5573. regdom = get_wiphy_regdom(&rdev->wiphy);
  5574. if (!regdom)
  5575. continue;
  5576. if (++reg_idx <= start)
  5577. continue;
  5578. err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
  5579. NLM_F_MULTI, &rdev->wiphy, regdom);
  5580. if (err < 0) {
  5581. reg_idx--;
  5582. break;
  5583. }
  5584. }
  5585. cb->args[2] = reg_idx;
  5586. err = skb->len;
  5587. out_err:
  5588. rtnl_unlock();
  5589. return err;
  5590. }
  5591. #ifdef CONFIG_CFG80211_CRDA_SUPPORT
  5592. static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
  5593. [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
  5594. [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
  5595. [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
  5596. [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
  5597. [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
  5598. [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
  5599. [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
  5600. };
  5601. static int parse_reg_rule(struct nlattr *tb[],
  5602. struct ieee80211_reg_rule *reg_rule)
  5603. {
  5604. struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
  5605. struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
  5606. if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
  5607. return -EINVAL;
  5608. if (!tb[NL80211_ATTR_FREQ_RANGE_START])
  5609. return -EINVAL;
  5610. if (!tb[NL80211_ATTR_FREQ_RANGE_END])
  5611. return -EINVAL;
  5612. if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
  5613. return -EINVAL;
  5614. if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
  5615. return -EINVAL;
  5616. reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
  5617. freq_range->start_freq_khz =
  5618. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
  5619. freq_range->end_freq_khz =
  5620. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
  5621. freq_range->max_bandwidth_khz =
  5622. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
  5623. power_rule->max_eirp =
  5624. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
  5625. if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
  5626. power_rule->max_antenna_gain =
  5627. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
  5628. if (tb[NL80211_ATTR_DFS_CAC_TIME])
  5629. reg_rule->dfs_cac_ms =
  5630. nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
  5631. return 0;
  5632. }
  5633. static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
  5634. {
  5635. struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
  5636. struct nlattr *nl_reg_rule;
  5637. char *alpha2;
  5638. int rem_reg_rules, r;
  5639. u32 num_rules = 0, rule_idx = 0, size_of_regd;
  5640. enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
  5641. struct ieee80211_regdomain *rd;
  5642. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  5643. return -EINVAL;
  5644. if (!info->attrs[NL80211_ATTR_REG_RULES])
  5645. return -EINVAL;
  5646. alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  5647. if (info->attrs[NL80211_ATTR_DFS_REGION])
  5648. dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
  5649. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  5650. rem_reg_rules) {
  5651. num_rules++;
  5652. if (num_rules > NL80211_MAX_SUPP_REG_RULES)
  5653. return -EINVAL;
  5654. }
  5655. if (!reg_is_valid_request(alpha2))
  5656. return -EINVAL;
  5657. size_of_regd = sizeof(struct ieee80211_regdomain) +
  5658. num_rules * sizeof(struct ieee80211_reg_rule);
  5659. rd = kzalloc(size_of_regd, GFP_KERNEL);
  5660. if (!rd)
  5661. return -ENOMEM;
  5662. rd->n_reg_rules = num_rules;
  5663. rd->alpha2[0] = alpha2[0];
  5664. rd->alpha2[1] = alpha2[1];
  5665. /*
  5666. * Disable DFS master mode if the DFS region was
  5667. * not supported or known on this kernel.
  5668. */
  5669. if (reg_supported_dfs_region(dfs_region))
  5670. rd->dfs_region = dfs_region;
  5671. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  5672. rem_reg_rules) {
  5673. r = nla_parse_nested(tb, NL80211_REG_RULE_ATTR_MAX,
  5674. nl_reg_rule, reg_rule_policy,
  5675. info->extack);
  5676. if (r)
  5677. goto bad_reg;
  5678. r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
  5679. if (r)
  5680. goto bad_reg;
  5681. rule_idx++;
  5682. if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
  5683. r = -EINVAL;
  5684. goto bad_reg;
  5685. }
  5686. }
  5687. /* set_regdom takes ownership of rd */
  5688. return set_regdom(rd, REGD_SOURCE_CRDA);
  5689. bad_reg:
  5690. kfree(rd);
  5691. return r;
  5692. }
  5693. #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
  5694. static int validate_scan_freqs(struct nlattr *freqs)
  5695. {
  5696. struct nlattr *attr1, *attr2;
  5697. int n_channels = 0, tmp1, tmp2;
  5698. nla_for_each_nested(attr1, freqs, tmp1)
  5699. if (nla_len(attr1) != sizeof(u32))
  5700. return 0;
  5701. nla_for_each_nested(attr1, freqs, tmp1) {
  5702. n_channels++;
  5703. /*
  5704. * Some hardware has a limited channel list for
  5705. * scanning, and it is pretty much nonsensical
  5706. * to scan for a channel twice, so disallow that
  5707. * and don't require drivers to check that the
  5708. * channel list they get isn't longer than what
  5709. * they can scan, as long as they can scan all
  5710. * the channels they registered at once.
  5711. */
  5712. nla_for_each_nested(attr2, freqs, tmp2)
  5713. if (attr1 != attr2 &&
  5714. nla_get_u32(attr1) == nla_get_u32(attr2))
  5715. return 0;
  5716. }
  5717. return n_channels;
  5718. }
  5719. static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
  5720. {
  5721. return b < NUM_NL80211_BANDS && wiphy->bands[b];
  5722. }
  5723. static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
  5724. struct cfg80211_bss_selection *bss_select)
  5725. {
  5726. struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
  5727. struct nlattr *nest;
  5728. int err;
  5729. bool found = false;
  5730. int i;
  5731. /* only process one nested attribute */
  5732. nest = nla_data(nla);
  5733. if (!nla_ok(nest, nla_len(nest)))
  5734. return -EINVAL;
  5735. err = nla_parse_nested(attr, NL80211_BSS_SELECT_ATTR_MAX, nest,
  5736. nl80211_bss_select_policy, NULL);
  5737. if (err)
  5738. return err;
  5739. /* only one attribute may be given */
  5740. for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
  5741. if (attr[i]) {
  5742. if (found)
  5743. return -EINVAL;
  5744. found = true;
  5745. }
  5746. }
  5747. bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
  5748. if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
  5749. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
  5750. if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
  5751. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
  5752. bss_select->param.band_pref =
  5753. nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
  5754. if (!is_band_valid(wiphy, bss_select->param.band_pref))
  5755. return -EINVAL;
  5756. }
  5757. if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
  5758. struct nl80211_bss_select_rssi_adjust *adj_param;
  5759. adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
  5760. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
  5761. bss_select->param.adjust.band = adj_param->band;
  5762. bss_select->param.adjust.delta = adj_param->delta;
  5763. if (!is_band_valid(wiphy, bss_select->param.adjust.band))
  5764. return -EINVAL;
  5765. }
  5766. /* user-space did not provide behaviour attribute */
  5767. if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
  5768. return -EINVAL;
  5769. if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
  5770. return -EINVAL;
  5771. return 0;
  5772. }
  5773. static int nl80211_parse_random_mac(struct nlattr **attrs,
  5774. u8 *mac_addr, u8 *mac_addr_mask)
  5775. {
  5776. int i;
  5777. if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
  5778. eth_zero_addr(mac_addr);
  5779. eth_zero_addr(mac_addr_mask);
  5780. mac_addr[0] = 0x2;
  5781. mac_addr_mask[0] = 0x3;
  5782. return 0;
  5783. }
  5784. /* need both or none */
  5785. if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
  5786. return -EINVAL;
  5787. memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
  5788. memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
  5789. /* don't allow or configure an mcast address */
  5790. if (!is_multicast_ether_addr(mac_addr_mask) ||
  5791. is_multicast_ether_addr(mac_addr))
  5792. return -EINVAL;
  5793. /*
  5794. * allow users to pass a MAC address that has bits set outside
  5795. * of the mask, but don't bother drivers with having to deal
  5796. * with such bits
  5797. */
  5798. for (i = 0; i < ETH_ALEN; i++)
  5799. mac_addr[i] &= mac_addr_mask[i];
  5800. return 0;
  5801. }
  5802. static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev)
  5803. {
  5804. ASSERT_WDEV_LOCK(wdev);
  5805. if (!cfg80211_beaconing_iface_active(wdev))
  5806. return true;
  5807. if (!(wdev->chandef.chan->flags & IEEE80211_CHAN_RADAR))
  5808. return true;
  5809. return regulatory_pre_cac_allowed(wdev->wiphy);
  5810. }
  5811. static int
  5812. nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
  5813. void *request, struct nlattr **attrs,
  5814. bool is_sched_scan)
  5815. {
  5816. u8 *mac_addr, *mac_addr_mask;
  5817. u32 *flags;
  5818. enum nl80211_feature_flags randomness_flag;
  5819. if (!attrs[NL80211_ATTR_SCAN_FLAGS])
  5820. return 0;
  5821. if (is_sched_scan) {
  5822. struct cfg80211_sched_scan_request *req = request;
  5823. randomness_flag = wdev ?
  5824. NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
  5825. NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
  5826. flags = &req->flags;
  5827. mac_addr = req->mac_addr;
  5828. mac_addr_mask = req->mac_addr_mask;
  5829. } else {
  5830. struct cfg80211_scan_request *req = request;
  5831. randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
  5832. flags = &req->flags;
  5833. mac_addr = req->mac_addr;
  5834. mac_addr_mask = req->mac_addr_mask;
  5835. }
  5836. *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
  5837. if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
  5838. !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
  5839. ((*flags & NL80211_SCAN_FLAG_LOW_SPAN) &&
  5840. !wiphy_ext_feature_isset(wiphy,
  5841. NL80211_EXT_FEATURE_LOW_SPAN_SCAN)) ||
  5842. ((*flags & NL80211_SCAN_FLAG_LOW_POWER) &&
  5843. !wiphy_ext_feature_isset(wiphy,
  5844. NL80211_EXT_FEATURE_LOW_POWER_SCAN)) ||
  5845. ((*flags & NL80211_SCAN_FLAG_HIGH_ACCURACY) &&
  5846. !wiphy_ext_feature_isset(wiphy,
  5847. NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN)))
  5848. return -EOPNOTSUPP;
  5849. if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
  5850. int err;
  5851. if (!(wiphy->features & randomness_flag) ||
  5852. (wdev && wdev->current_bss))
  5853. return -EOPNOTSUPP;
  5854. err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
  5855. if (err)
  5856. return err;
  5857. }
  5858. if ((*flags & NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME) &&
  5859. !wiphy_ext_feature_isset(wiphy,
  5860. NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME))
  5861. return -EOPNOTSUPP;
  5862. if ((*flags & NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP) &&
  5863. !wiphy_ext_feature_isset(wiphy,
  5864. NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP))
  5865. return -EOPNOTSUPP;
  5866. if ((*flags & NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) &&
  5867. !wiphy_ext_feature_isset(wiphy,
  5868. NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION))
  5869. return -EOPNOTSUPP;
  5870. if ((*flags & NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE) &&
  5871. !wiphy_ext_feature_isset(wiphy,
  5872. NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE))
  5873. return -EOPNOTSUPP;
  5874. return 0;
  5875. }
  5876. static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
  5877. {
  5878. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5879. struct wireless_dev *wdev = info->user_ptr[1];
  5880. struct cfg80211_scan_request *request;
  5881. struct nlattr *attr;
  5882. struct wiphy *wiphy;
  5883. int err, tmp, n_ssids = 0, n_channels, i;
  5884. size_t ie_len;
  5885. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  5886. return -EINVAL;
  5887. wiphy = &rdev->wiphy;
  5888. if (wdev->iftype == NL80211_IFTYPE_NAN)
  5889. return -EOPNOTSUPP;
  5890. if (!rdev->ops->scan)
  5891. return -EOPNOTSUPP;
  5892. if (rdev->scan_req || rdev->scan_msg) {
  5893. err = -EBUSY;
  5894. goto unlock;
  5895. }
  5896. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  5897. n_channels = validate_scan_freqs(
  5898. info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
  5899. if (!n_channels) {
  5900. err = -EINVAL;
  5901. goto unlock;
  5902. }
  5903. } else {
  5904. n_channels = ieee80211_get_num_supported_channels(wiphy);
  5905. }
  5906. if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
  5907. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
  5908. n_ssids++;
  5909. if (n_ssids > wiphy->max_scan_ssids) {
  5910. err = -EINVAL;
  5911. goto unlock;
  5912. }
  5913. if (info->attrs[NL80211_ATTR_IE])
  5914. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  5915. else
  5916. ie_len = 0;
  5917. if (ie_len > wiphy->max_scan_ie_len) {
  5918. err = -EINVAL;
  5919. goto unlock;
  5920. }
  5921. request = kzalloc(sizeof(*request)
  5922. + sizeof(*request->ssids) * n_ssids
  5923. + sizeof(*request->channels) * n_channels
  5924. + ie_len, GFP_KERNEL);
  5925. if (!request) {
  5926. err = -ENOMEM;
  5927. goto unlock;
  5928. }
  5929. if (n_ssids)
  5930. request->ssids = (void *)&request->channels[n_channels];
  5931. request->n_ssids = n_ssids;
  5932. if (ie_len) {
  5933. if (n_ssids)
  5934. request->ie = (void *)(request->ssids + n_ssids);
  5935. else
  5936. request->ie = (void *)(request->channels + n_channels);
  5937. }
  5938. i = 0;
  5939. if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  5940. /* user specified, bail out if channel not found */
  5941. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_FREQUENCIES], tmp) {
  5942. struct ieee80211_channel *chan;
  5943. chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
  5944. if (!chan) {
  5945. err = -EINVAL;
  5946. goto out_free;
  5947. }
  5948. /* ignore disabled channels */
  5949. if (chan->flags & IEEE80211_CHAN_DISABLED)
  5950. continue;
  5951. request->channels[i] = chan;
  5952. i++;
  5953. }
  5954. } else {
  5955. enum nl80211_band band;
  5956. /* all channels */
  5957. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  5958. int j;
  5959. if (!wiphy->bands[band])
  5960. continue;
  5961. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  5962. struct ieee80211_channel *chan;
  5963. chan = &wiphy->bands[band]->channels[j];
  5964. if (chan->flags & IEEE80211_CHAN_DISABLED)
  5965. continue;
  5966. request->channels[i] = chan;
  5967. i++;
  5968. }
  5969. }
  5970. }
  5971. if (!i) {
  5972. err = -EINVAL;
  5973. goto out_free;
  5974. }
  5975. request->n_channels = i;
  5976. wdev_lock(wdev);
  5977. if (!cfg80211_off_channel_oper_allowed(wdev)) {
  5978. struct ieee80211_channel *chan;
  5979. if (request->n_channels != 1) {
  5980. wdev_unlock(wdev);
  5981. err = -EBUSY;
  5982. goto out_free;
  5983. }
  5984. chan = request->channels[0];
  5985. if (chan->center_freq != wdev->chandef.chan->center_freq) {
  5986. wdev_unlock(wdev);
  5987. err = -EBUSY;
  5988. goto out_free;
  5989. }
  5990. }
  5991. wdev_unlock(wdev);
  5992. i = 0;
  5993. if (n_ssids) {
  5994. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
  5995. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  5996. err = -EINVAL;
  5997. goto out_free;
  5998. }
  5999. request->ssids[i].ssid_len = nla_len(attr);
  6000. memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
  6001. i++;
  6002. }
  6003. }
  6004. if (info->attrs[NL80211_ATTR_IE]) {
  6005. request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  6006. memcpy((void *)request->ie,
  6007. nla_data(info->attrs[NL80211_ATTR_IE]),
  6008. request->ie_len);
  6009. }
  6010. for (i = 0; i < NUM_NL80211_BANDS; i++)
  6011. if (wiphy->bands[i])
  6012. request->rates[i] =
  6013. (1 << wiphy->bands[i]->n_bitrates) - 1;
  6014. if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
  6015. nla_for_each_nested(attr,
  6016. info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
  6017. tmp) {
  6018. enum nl80211_band band = nla_type(attr);
  6019. if (band < 0 || band >= NUM_NL80211_BANDS) {
  6020. err = -EINVAL;
  6021. goto out_free;
  6022. }
  6023. if (!wiphy->bands[band])
  6024. continue;
  6025. err = ieee80211_get_ratemask(wiphy->bands[band],
  6026. nla_data(attr),
  6027. nla_len(attr),
  6028. &request->rates[band]);
  6029. if (err)
  6030. goto out_free;
  6031. }
  6032. }
  6033. if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
  6034. if (!wiphy_ext_feature_isset(wiphy,
  6035. NL80211_EXT_FEATURE_SET_SCAN_DWELL)) {
  6036. err = -EOPNOTSUPP;
  6037. goto out_free;
  6038. }
  6039. request->duration =
  6040. nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
  6041. request->duration_mandatory =
  6042. nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
  6043. }
  6044. err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
  6045. false);
  6046. if (err)
  6047. goto out_free;
  6048. request->no_cck =
  6049. nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
  6050. /* Initial implementation used NL80211_ATTR_MAC to set the specific
  6051. * BSSID to scan for. This was problematic because that same attribute
  6052. * was already used for another purpose (local random MAC address). The
  6053. * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
  6054. * compatibility with older userspace components, also use the
  6055. * NL80211_ATTR_MAC value here if it can be determined to be used for
  6056. * the specific BSSID use case instead of the random MAC address
  6057. * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
  6058. */
  6059. if (info->attrs[NL80211_ATTR_BSSID])
  6060. memcpy(request->bssid,
  6061. nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
  6062. else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
  6063. info->attrs[NL80211_ATTR_MAC])
  6064. memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
  6065. ETH_ALEN);
  6066. else
  6067. eth_broadcast_addr(request->bssid);
  6068. request->wdev = wdev;
  6069. request->wiphy = &rdev->wiphy;
  6070. request->scan_start = jiffies;
  6071. rdev->scan_req = request;
  6072. err = rdev_scan(rdev, request);
  6073. if (!err) {
  6074. nl80211_send_scan_start(rdev, wdev);
  6075. if (wdev->netdev)
  6076. dev_hold(wdev->netdev);
  6077. } else {
  6078. out_free:
  6079. rdev->scan_req = NULL;
  6080. kfree(request);
  6081. }
  6082. unlock:
  6083. return err;
  6084. }
  6085. static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
  6086. {
  6087. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6088. struct wireless_dev *wdev = info->user_ptr[1];
  6089. if (!rdev->ops->abort_scan)
  6090. return -EOPNOTSUPP;
  6091. if (rdev->scan_msg)
  6092. return 0;
  6093. if (!rdev->scan_req)
  6094. return -ENOENT;
  6095. rdev_abort_scan(rdev, wdev);
  6096. return 0;
  6097. }
  6098. static int
  6099. nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
  6100. struct cfg80211_sched_scan_request *request,
  6101. struct nlattr **attrs)
  6102. {
  6103. int tmp, err, i = 0;
  6104. struct nlattr *attr;
  6105. if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
  6106. u32 interval;
  6107. /*
  6108. * If scan plans are not specified,
  6109. * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
  6110. * case one scan plan will be set with the specified scan
  6111. * interval and infinite number of iterations.
  6112. */
  6113. interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
  6114. if (!interval)
  6115. return -EINVAL;
  6116. request->scan_plans[0].interval =
  6117. DIV_ROUND_UP(interval, MSEC_PER_SEC);
  6118. if (!request->scan_plans[0].interval)
  6119. return -EINVAL;
  6120. if (request->scan_plans[0].interval >
  6121. wiphy->max_sched_scan_plan_interval)
  6122. request->scan_plans[0].interval =
  6123. wiphy->max_sched_scan_plan_interval;
  6124. return 0;
  6125. }
  6126. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
  6127. struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
  6128. if (WARN_ON(i >= n_plans))
  6129. return -EINVAL;
  6130. err = nla_parse_nested(plan, NL80211_SCHED_SCAN_PLAN_MAX,
  6131. attr, nl80211_plan_policy, NULL);
  6132. if (err)
  6133. return err;
  6134. if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
  6135. return -EINVAL;
  6136. request->scan_plans[i].interval =
  6137. nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
  6138. if (!request->scan_plans[i].interval ||
  6139. request->scan_plans[i].interval >
  6140. wiphy->max_sched_scan_plan_interval)
  6141. return -EINVAL;
  6142. if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
  6143. request->scan_plans[i].iterations =
  6144. nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
  6145. if (!request->scan_plans[i].iterations ||
  6146. (request->scan_plans[i].iterations >
  6147. wiphy->max_sched_scan_plan_iterations))
  6148. return -EINVAL;
  6149. } else if (i < n_plans - 1) {
  6150. /*
  6151. * All scan plans but the last one must specify
  6152. * a finite number of iterations
  6153. */
  6154. return -EINVAL;
  6155. }
  6156. i++;
  6157. }
  6158. /*
  6159. * The last scan plan must not specify the number of
  6160. * iterations, it is supposed to run infinitely
  6161. */
  6162. if (request->scan_plans[n_plans - 1].iterations)
  6163. return -EINVAL;
  6164. return 0;
  6165. }
  6166. static struct cfg80211_sched_scan_request *
  6167. nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
  6168. struct nlattr **attrs, int max_match_sets)
  6169. {
  6170. struct cfg80211_sched_scan_request *request;
  6171. struct nlattr *attr;
  6172. int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
  6173. enum nl80211_band band;
  6174. size_t ie_len;
  6175. struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
  6176. s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
  6177. if (!is_valid_ie_attr(attrs[NL80211_ATTR_IE]))
  6178. return ERR_PTR(-EINVAL);
  6179. if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  6180. n_channels = validate_scan_freqs(
  6181. attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
  6182. if (!n_channels)
  6183. return ERR_PTR(-EINVAL);
  6184. } else {
  6185. n_channels = ieee80211_get_num_supported_channels(wiphy);
  6186. }
  6187. if (attrs[NL80211_ATTR_SCAN_SSIDS])
  6188. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
  6189. tmp)
  6190. n_ssids++;
  6191. if (n_ssids > wiphy->max_sched_scan_ssids)
  6192. return ERR_PTR(-EINVAL);
  6193. /*
  6194. * First, count the number of 'real' matchsets. Due to an issue with
  6195. * the old implementation, matchsets containing only the RSSI attribute
  6196. * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
  6197. * RSSI for all matchsets, rather than their own matchset for reporting
  6198. * all APs with a strong RSSI. This is needed to be compatible with
  6199. * older userspace that treated a matchset with only the RSSI as the
  6200. * global RSSI for all other matchsets - if there are other matchsets.
  6201. */
  6202. if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
  6203. nla_for_each_nested(attr,
  6204. attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
  6205. tmp) {
  6206. struct nlattr *rssi;
  6207. err = nla_parse_nested(tb,
  6208. NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
  6209. attr, nl80211_match_policy,
  6210. NULL);
  6211. if (err)
  6212. return ERR_PTR(err);
  6213. /* SSID and BSSID are mutually exclusive */
  6214. if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
  6215. tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
  6216. return ERR_PTR(-EINVAL);
  6217. /* add other standalone attributes here */
  6218. if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
  6219. tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
  6220. n_match_sets++;
  6221. continue;
  6222. }
  6223. rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
  6224. if (rssi)
  6225. default_match_rssi = nla_get_s32(rssi);
  6226. }
  6227. }
  6228. /* However, if there's no other matchset, add the RSSI one */
  6229. if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
  6230. n_match_sets = 1;
  6231. if (n_match_sets > max_match_sets)
  6232. return ERR_PTR(-EINVAL);
  6233. if (attrs[NL80211_ATTR_IE])
  6234. ie_len = nla_len(attrs[NL80211_ATTR_IE]);
  6235. else
  6236. ie_len = 0;
  6237. if (ie_len > wiphy->max_sched_scan_ie_len)
  6238. return ERR_PTR(-EINVAL);
  6239. if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
  6240. /*
  6241. * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
  6242. * each scan plan already specifies its own interval
  6243. */
  6244. if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
  6245. return ERR_PTR(-EINVAL);
  6246. nla_for_each_nested(attr,
  6247. attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
  6248. n_plans++;
  6249. } else {
  6250. /*
  6251. * The scan interval attribute is kept for backward
  6252. * compatibility. If no scan plans are specified and sched scan
  6253. * interval is specified, one scan plan will be set with this
  6254. * scan interval and infinite number of iterations.
  6255. */
  6256. if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
  6257. return ERR_PTR(-EINVAL);
  6258. n_plans = 1;
  6259. }
  6260. if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
  6261. return ERR_PTR(-EINVAL);
  6262. if (!wiphy_ext_feature_isset(
  6263. wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
  6264. (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
  6265. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
  6266. return ERR_PTR(-EINVAL);
  6267. request = kzalloc(sizeof(*request)
  6268. + sizeof(*request->ssids) * n_ssids
  6269. + sizeof(*request->match_sets) * n_match_sets
  6270. + sizeof(*request->scan_plans) * n_plans
  6271. + sizeof(*request->channels) * n_channels
  6272. + ie_len, GFP_KERNEL);
  6273. if (!request)
  6274. return ERR_PTR(-ENOMEM);
  6275. if (n_ssids)
  6276. request->ssids = (void *)&request->channels[n_channels];
  6277. request->n_ssids = n_ssids;
  6278. if (ie_len) {
  6279. if (n_ssids)
  6280. request->ie = (void *)(request->ssids + n_ssids);
  6281. else
  6282. request->ie = (void *)(request->channels + n_channels);
  6283. }
  6284. if (n_match_sets) {
  6285. if (request->ie)
  6286. request->match_sets = (void *)(request->ie + ie_len);
  6287. else if (n_ssids)
  6288. request->match_sets =
  6289. (void *)(request->ssids + n_ssids);
  6290. else
  6291. request->match_sets =
  6292. (void *)(request->channels + n_channels);
  6293. }
  6294. request->n_match_sets = n_match_sets;
  6295. if (n_match_sets)
  6296. request->scan_plans = (void *)(request->match_sets +
  6297. n_match_sets);
  6298. else if (request->ie)
  6299. request->scan_plans = (void *)(request->ie + ie_len);
  6300. else if (n_ssids)
  6301. request->scan_plans = (void *)(request->ssids + n_ssids);
  6302. else
  6303. request->scan_plans = (void *)(request->channels + n_channels);
  6304. request->n_scan_plans = n_plans;
  6305. i = 0;
  6306. if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  6307. /* user specified, bail out if channel not found */
  6308. nla_for_each_nested(attr,
  6309. attrs[NL80211_ATTR_SCAN_FREQUENCIES],
  6310. tmp) {
  6311. struct ieee80211_channel *chan;
  6312. chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
  6313. if (!chan) {
  6314. err = -EINVAL;
  6315. goto out_free;
  6316. }
  6317. /* ignore disabled channels */
  6318. if (chan->flags & IEEE80211_CHAN_DISABLED)
  6319. continue;
  6320. request->channels[i] = chan;
  6321. i++;
  6322. }
  6323. } else {
  6324. /* all channels */
  6325. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  6326. int j;
  6327. if (!wiphy->bands[band])
  6328. continue;
  6329. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  6330. struct ieee80211_channel *chan;
  6331. chan = &wiphy->bands[band]->channels[j];
  6332. if (chan->flags & IEEE80211_CHAN_DISABLED)
  6333. continue;
  6334. request->channels[i] = chan;
  6335. i++;
  6336. }
  6337. }
  6338. }
  6339. if (!i) {
  6340. err = -EINVAL;
  6341. goto out_free;
  6342. }
  6343. request->n_channels = i;
  6344. i = 0;
  6345. if (n_ssids) {
  6346. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
  6347. tmp) {
  6348. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  6349. err = -EINVAL;
  6350. goto out_free;
  6351. }
  6352. request->ssids[i].ssid_len = nla_len(attr);
  6353. memcpy(request->ssids[i].ssid, nla_data(attr),
  6354. nla_len(attr));
  6355. i++;
  6356. }
  6357. }
  6358. i = 0;
  6359. if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
  6360. nla_for_each_nested(attr,
  6361. attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
  6362. tmp) {
  6363. struct nlattr *ssid, *bssid, *rssi;
  6364. err = nla_parse_nested(tb,
  6365. NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
  6366. attr, nl80211_match_policy,
  6367. NULL);
  6368. if (err)
  6369. goto out_free;
  6370. ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
  6371. bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
  6372. if (ssid || bssid) {
  6373. if (WARN_ON(i >= n_match_sets)) {
  6374. /* this indicates a programming error,
  6375. * the loop above should have verified
  6376. * things properly
  6377. */
  6378. err = -EINVAL;
  6379. goto out_free;
  6380. }
  6381. if (ssid) {
  6382. if (nla_len(ssid) > IEEE80211_MAX_SSID_LEN) {
  6383. err = -EINVAL;
  6384. goto out_free;
  6385. }
  6386. memcpy(request->match_sets[i].ssid.ssid,
  6387. nla_data(ssid), nla_len(ssid));
  6388. request->match_sets[i].ssid.ssid_len =
  6389. nla_len(ssid);
  6390. }
  6391. if (bssid) {
  6392. if (nla_len(bssid) != ETH_ALEN) {
  6393. err = -EINVAL;
  6394. goto out_free;
  6395. }
  6396. memcpy(request->match_sets[i].bssid,
  6397. nla_data(bssid), ETH_ALEN);
  6398. }
  6399. /* special attribute - old implementation w/a */
  6400. request->match_sets[i].rssi_thold =
  6401. default_match_rssi;
  6402. rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
  6403. if (rssi)
  6404. request->match_sets[i].rssi_thold =
  6405. nla_get_s32(rssi);
  6406. }
  6407. i++;
  6408. }
  6409. /* there was no other matchset, so the RSSI one is alone */
  6410. if (i == 0 && n_match_sets)
  6411. request->match_sets[0].rssi_thold = default_match_rssi;
  6412. request->min_rssi_thold = INT_MAX;
  6413. for (i = 0; i < n_match_sets; i++)
  6414. request->min_rssi_thold =
  6415. min(request->match_sets[i].rssi_thold,
  6416. request->min_rssi_thold);
  6417. } else {
  6418. request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
  6419. }
  6420. if (ie_len) {
  6421. request->ie_len = ie_len;
  6422. memcpy((void *)request->ie,
  6423. nla_data(attrs[NL80211_ATTR_IE]),
  6424. request->ie_len);
  6425. }
  6426. err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
  6427. if (err)
  6428. goto out_free;
  6429. if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
  6430. request->delay =
  6431. nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
  6432. if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
  6433. request->relative_rssi = nla_get_s8(
  6434. attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
  6435. request->relative_rssi_set = true;
  6436. }
  6437. if (request->relative_rssi_set &&
  6438. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
  6439. struct nl80211_bss_select_rssi_adjust *rssi_adjust;
  6440. rssi_adjust = nla_data(
  6441. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
  6442. request->rssi_adjust.band = rssi_adjust->band;
  6443. request->rssi_adjust.delta = rssi_adjust->delta;
  6444. if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
  6445. err = -EINVAL;
  6446. goto out_free;
  6447. }
  6448. }
  6449. err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
  6450. if (err)
  6451. goto out_free;
  6452. request->scan_start = jiffies;
  6453. return request;
  6454. out_free:
  6455. kfree(request);
  6456. return ERR_PTR(err);
  6457. }
  6458. static int nl80211_start_sched_scan(struct sk_buff *skb,
  6459. struct genl_info *info)
  6460. {
  6461. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6462. struct net_device *dev = info->user_ptr[1];
  6463. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6464. struct cfg80211_sched_scan_request *sched_scan_req;
  6465. bool want_multi;
  6466. int err;
  6467. if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
  6468. return -EOPNOTSUPP;
  6469. want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
  6470. err = cfg80211_sched_scan_req_possible(rdev, want_multi);
  6471. if (err)
  6472. return err;
  6473. sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
  6474. info->attrs,
  6475. rdev->wiphy.max_match_sets);
  6476. err = PTR_ERR_OR_ZERO(sched_scan_req);
  6477. if (err)
  6478. goto out_err;
  6479. /* leave request id zero for legacy request
  6480. * or if driver does not support multi-scheduled scan
  6481. */
  6482. if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1) {
  6483. while (!sched_scan_req->reqid)
  6484. sched_scan_req->reqid = rdev->wiphy.cookie_counter++;
  6485. }
  6486. err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
  6487. if (err)
  6488. goto out_free;
  6489. sched_scan_req->dev = dev;
  6490. sched_scan_req->wiphy = &rdev->wiphy;
  6491. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  6492. sched_scan_req->owner_nlportid = info->snd_portid;
  6493. cfg80211_add_sched_scan_req(rdev, sched_scan_req);
  6494. nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
  6495. return 0;
  6496. out_free:
  6497. kfree(sched_scan_req);
  6498. out_err:
  6499. return err;
  6500. }
  6501. static int nl80211_stop_sched_scan(struct sk_buff *skb,
  6502. struct genl_info *info)
  6503. {
  6504. struct cfg80211_sched_scan_request *req;
  6505. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6506. u64 cookie;
  6507. if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
  6508. return -EOPNOTSUPP;
  6509. if (info->attrs[NL80211_ATTR_COOKIE]) {
  6510. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  6511. return __cfg80211_stop_sched_scan(rdev, cookie, false);
  6512. }
  6513. req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
  6514. struct cfg80211_sched_scan_request,
  6515. list);
  6516. if (!req || req->reqid ||
  6517. (req->owner_nlportid &&
  6518. req->owner_nlportid != info->snd_portid))
  6519. return -ENOENT;
  6520. return cfg80211_stop_sched_scan_req(rdev, req, false);
  6521. }
  6522. static int nl80211_start_radar_detection(struct sk_buff *skb,
  6523. struct genl_info *info)
  6524. {
  6525. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6526. struct net_device *dev = info->user_ptr[1];
  6527. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6528. struct wiphy *wiphy = wdev->wiphy;
  6529. struct cfg80211_chan_def chandef;
  6530. enum nl80211_dfs_regions dfs_region;
  6531. unsigned int cac_time_ms;
  6532. int err;
  6533. dfs_region = reg_get_dfs_region(wiphy);
  6534. if (dfs_region == NL80211_DFS_UNSET)
  6535. return -EINVAL;
  6536. err = nl80211_parse_chandef(rdev, info, &chandef);
  6537. if (err)
  6538. return err;
  6539. if (netif_carrier_ok(dev))
  6540. return -EBUSY;
  6541. if (wdev->cac_started)
  6542. return -EBUSY;
  6543. err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
  6544. if (err < 0)
  6545. return err;
  6546. if (err == 0)
  6547. return -EINVAL;
  6548. if (!cfg80211_chandef_dfs_usable(wiphy, &chandef))
  6549. return -EINVAL;
  6550. /* CAC start is offloaded to HW and can't be started manually */
  6551. if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD))
  6552. return -EOPNOTSUPP;
  6553. if (!rdev->ops->start_radar_detection)
  6554. return -EOPNOTSUPP;
  6555. cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
  6556. if (WARN_ON(!cac_time_ms))
  6557. cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
  6558. err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
  6559. if (!err) {
  6560. wdev->chandef = chandef;
  6561. wdev->cac_started = true;
  6562. wdev->cac_start_time = jiffies;
  6563. wdev->cac_time_ms = cac_time_ms;
  6564. }
  6565. return err;
  6566. }
  6567. static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
  6568. {
  6569. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6570. struct net_device *dev = info->user_ptr[1];
  6571. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6572. struct cfg80211_csa_settings params;
  6573. /* csa_attrs is defined static to avoid waste of stack size - this
  6574. * function is called under RTNL lock, so this should not be a problem.
  6575. */
  6576. static struct nlattr *csa_attrs[NL80211_ATTR_MAX+1];
  6577. int err;
  6578. bool need_new_beacon = false;
  6579. bool need_handle_dfs_flag = true;
  6580. int len, i;
  6581. u32 cs_count;
  6582. if (!rdev->ops->channel_switch ||
  6583. !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
  6584. return -EOPNOTSUPP;
  6585. switch (dev->ieee80211_ptr->iftype) {
  6586. case NL80211_IFTYPE_AP:
  6587. case NL80211_IFTYPE_P2P_GO:
  6588. need_new_beacon = true;
  6589. /* For all modes except AP the handle_dfs flag needs to be
  6590. * supplied to tell the kernel that userspace will handle radar
  6591. * events when they happen. Otherwise a switch to a channel
  6592. * requiring DFS will be rejected.
  6593. */
  6594. need_handle_dfs_flag = false;
  6595. /* useless if AP is not running */
  6596. if (!wdev->beacon_interval)
  6597. return -ENOTCONN;
  6598. break;
  6599. case NL80211_IFTYPE_ADHOC:
  6600. if (!wdev->ssid_len)
  6601. return -ENOTCONN;
  6602. break;
  6603. case NL80211_IFTYPE_MESH_POINT:
  6604. if (!wdev->mesh_id_len)
  6605. return -ENOTCONN;
  6606. break;
  6607. default:
  6608. return -EOPNOTSUPP;
  6609. }
  6610. memset(&params, 0, sizeof(params));
  6611. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  6612. !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
  6613. return -EINVAL;
  6614. /* only important for AP, IBSS and mesh create IEs internally */
  6615. if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
  6616. return -EINVAL;
  6617. /* Even though the attribute is u32, the specification says
  6618. * u8, so let's make sure we don't overflow.
  6619. */
  6620. cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
  6621. if (cs_count > 255)
  6622. return -EINVAL;
  6623. params.count = cs_count;
  6624. if (!need_new_beacon)
  6625. goto skip_beacons;
  6626. err = nl80211_parse_beacon(info->attrs, &params.beacon_after);
  6627. if (err)
  6628. return err;
  6629. err = nla_parse_nested(csa_attrs, NL80211_ATTR_MAX,
  6630. info->attrs[NL80211_ATTR_CSA_IES],
  6631. nl80211_policy, info->extack);
  6632. if (err)
  6633. return err;
  6634. err = nl80211_parse_beacon(csa_attrs, &params.beacon_csa);
  6635. if (err)
  6636. return err;
  6637. if (!csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON])
  6638. return -EINVAL;
  6639. len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
  6640. if (!len || (len % sizeof(u16)))
  6641. return -EINVAL;
  6642. params.n_counter_offsets_beacon = len / sizeof(u16);
  6643. if (rdev->wiphy.max_num_csa_counters &&
  6644. (params.n_counter_offsets_beacon >
  6645. rdev->wiphy.max_num_csa_counters))
  6646. return -EINVAL;
  6647. params.counter_offsets_beacon =
  6648. nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_BEACON]);
  6649. /* sanity checks - counters should fit and be the same */
  6650. for (i = 0; i < params.n_counter_offsets_beacon; i++) {
  6651. u16 offset = params.counter_offsets_beacon[i];
  6652. if (offset >= params.beacon_csa.tail_len)
  6653. return -EINVAL;
  6654. if (params.beacon_csa.tail[offset] != params.count)
  6655. return -EINVAL;
  6656. }
  6657. if (csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]) {
  6658. len = nla_len(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
  6659. if (!len || (len % sizeof(u16)))
  6660. return -EINVAL;
  6661. params.n_counter_offsets_presp = len / sizeof(u16);
  6662. if (rdev->wiphy.max_num_csa_counters &&
  6663. (params.n_counter_offsets_presp >
  6664. rdev->wiphy.max_num_csa_counters))
  6665. return -EINVAL;
  6666. params.counter_offsets_presp =
  6667. nla_data(csa_attrs[NL80211_ATTR_CSA_C_OFF_PRESP]);
  6668. /* sanity checks - counters should fit and be the same */
  6669. for (i = 0; i < params.n_counter_offsets_presp; i++) {
  6670. u16 offset = params.counter_offsets_presp[i];
  6671. if (offset >= params.beacon_csa.probe_resp_len)
  6672. return -EINVAL;
  6673. if (params.beacon_csa.probe_resp[offset] !=
  6674. params.count)
  6675. return -EINVAL;
  6676. }
  6677. }
  6678. skip_beacons:
  6679. err = nl80211_parse_chandef(rdev, info, &params.chandef);
  6680. if (err)
  6681. return err;
  6682. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
  6683. wdev->iftype))
  6684. return -EINVAL;
  6685. err = cfg80211_chandef_dfs_required(wdev->wiphy,
  6686. &params.chandef,
  6687. wdev->iftype);
  6688. if (err < 0)
  6689. return err;
  6690. if (err > 0) {
  6691. params.radar_required = true;
  6692. if (need_handle_dfs_flag &&
  6693. !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
  6694. return -EINVAL;
  6695. }
  6696. }
  6697. if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
  6698. params.block_tx = true;
  6699. wdev_lock(wdev);
  6700. err = rdev_channel_switch(rdev, dev, &params);
  6701. wdev_unlock(wdev);
  6702. return err;
  6703. }
  6704. static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
  6705. u32 seq, int flags,
  6706. struct cfg80211_registered_device *rdev,
  6707. struct wireless_dev *wdev,
  6708. struct cfg80211_internal_bss *intbss)
  6709. {
  6710. struct cfg80211_bss *res = &intbss->pub;
  6711. const struct cfg80211_bss_ies *ies;
  6712. void *hdr;
  6713. struct nlattr *bss;
  6714. ASSERT_WDEV_LOCK(wdev);
  6715. hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
  6716. NL80211_CMD_NEW_SCAN_RESULTS);
  6717. if (!hdr)
  6718. return -1;
  6719. genl_dump_check_consistent(cb, hdr);
  6720. if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
  6721. goto nla_put_failure;
  6722. if (wdev->netdev &&
  6723. nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
  6724. goto nla_put_failure;
  6725. if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  6726. NL80211_ATTR_PAD))
  6727. goto nla_put_failure;
  6728. bss = nla_nest_start(msg, NL80211_ATTR_BSS);
  6729. if (!bss)
  6730. goto nla_put_failure;
  6731. if ((!is_zero_ether_addr(res->bssid) &&
  6732. nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
  6733. goto nla_put_failure;
  6734. rcu_read_lock();
  6735. /* indicate whether we have probe response data or not */
  6736. if (rcu_access_pointer(res->proberesp_ies) &&
  6737. nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
  6738. goto fail_unlock_rcu;
  6739. /* this pointer prefers to be pointed to probe response data
  6740. * but is always valid
  6741. */
  6742. ies = rcu_dereference(res->ies);
  6743. if (ies) {
  6744. if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
  6745. NL80211_BSS_PAD))
  6746. goto fail_unlock_rcu;
  6747. if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
  6748. ies->len, ies->data))
  6749. goto fail_unlock_rcu;
  6750. }
  6751. /* and this pointer is always (unless driver didn't know) beacon data */
  6752. ies = rcu_dereference(res->beacon_ies);
  6753. if (ies && ies->from_beacon) {
  6754. if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
  6755. NL80211_BSS_PAD))
  6756. goto fail_unlock_rcu;
  6757. if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
  6758. ies->len, ies->data))
  6759. goto fail_unlock_rcu;
  6760. }
  6761. rcu_read_unlock();
  6762. if (res->beacon_interval &&
  6763. nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
  6764. goto nla_put_failure;
  6765. if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
  6766. nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
  6767. nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
  6768. nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
  6769. jiffies_to_msecs(jiffies - intbss->ts)))
  6770. goto nla_put_failure;
  6771. if (intbss->parent_tsf &&
  6772. (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
  6773. intbss->parent_tsf, NL80211_BSS_PAD) ||
  6774. nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
  6775. intbss->parent_bssid)))
  6776. goto nla_put_failure;
  6777. if (intbss->ts_boottime &&
  6778. nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
  6779. intbss->ts_boottime, NL80211_BSS_PAD))
  6780. goto nla_put_failure;
  6781. if (!nl80211_put_signal(msg, intbss->pub.chains,
  6782. intbss->pub.chain_signal,
  6783. NL80211_BSS_CHAIN_SIGNAL))
  6784. goto nla_put_failure;
  6785. switch (rdev->wiphy.signal_type) {
  6786. case CFG80211_SIGNAL_TYPE_MBM:
  6787. if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
  6788. goto nla_put_failure;
  6789. break;
  6790. case CFG80211_SIGNAL_TYPE_UNSPEC:
  6791. if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
  6792. goto nla_put_failure;
  6793. break;
  6794. default:
  6795. break;
  6796. }
  6797. switch (wdev->iftype) {
  6798. case NL80211_IFTYPE_P2P_CLIENT:
  6799. case NL80211_IFTYPE_STATION:
  6800. if (intbss == wdev->current_bss &&
  6801. nla_put_u32(msg, NL80211_BSS_STATUS,
  6802. NL80211_BSS_STATUS_ASSOCIATED))
  6803. goto nla_put_failure;
  6804. break;
  6805. case NL80211_IFTYPE_ADHOC:
  6806. if (intbss == wdev->current_bss &&
  6807. nla_put_u32(msg, NL80211_BSS_STATUS,
  6808. NL80211_BSS_STATUS_IBSS_JOINED))
  6809. goto nla_put_failure;
  6810. break;
  6811. default:
  6812. break;
  6813. }
  6814. nla_nest_end(msg, bss);
  6815. genlmsg_end(msg, hdr);
  6816. return 0;
  6817. fail_unlock_rcu:
  6818. rcu_read_unlock();
  6819. nla_put_failure:
  6820. genlmsg_cancel(msg, hdr);
  6821. return -EMSGSIZE;
  6822. }
  6823. static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
  6824. {
  6825. struct cfg80211_registered_device *rdev;
  6826. struct cfg80211_internal_bss *scan;
  6827. struct wireless_dev *wdev;
  6828. int start = cb->args[2], idx = 0;
  6829. int err;
  6830. rtnl_lock();
  6831. err = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
  6832. if (err) {
  6833. rtnl_unlock();
  6834. return err;
  6835. }
  6836. wdev_lock(wdev);
  6837. spin_lock_bh(&rdev->bss_lock);
  6838. /*
  6839. * dump_scan will be called multiple times to break up the scan results
  6840. * into multiple messages. It is unlikely that any more bss-es will be
  6841. * expired after the first call, so only call only call this on the
  6842. * first dump_scan invocation.
  6843. */
  6844. if (start == 0)
  6845. cfg80211_bss_expire(rdev);
  6846. cb->seq = rdev->bss_generation;
  6847. list_for_each_entry(scan, &rdev->bss_list, list) {
  6848. if (++idx <= start)
  6849. continue;
  6850. if (nl80211_send_bss(skb, cb,
  6851. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  6852. rdev, wdev, scan) < 0) {
  6853. idx--;
  6854. break;
  6855. }
  6856. }
  6857. spin_unlock_bh(&rdev->bss_lock);
  6858. wdev_unlock(wdev);
  6859. cb->args[2] = idx;
  6860. rtnl_unlock();
  6861. return skb->len;
  6862. }
  6863. static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
  6864. int flags, struct net_device *dev,
  6865. bool allow_radio_stats,
  6866. struct survey_info *survey)
  6867. {
  6868. void *hdr;
  6869. struct nlattr *infoattr;
  6870. /* skip radio stats if userspace didn't request them */
  6871. if (!survey->channel && !allow_radio_stats)
  6872. return 0;
  6873. hdr = nl80211hdr_put(msg, portid, seq, flags,
  6874. NL80211_CMD_NEW_SURVEY_RESULTS);
  6875. if (!hdr)
  6876. return -ENOMEM;
  6877. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  6878. goto nla_put_failure;
  6879. infoattr = nla_nest_start(msg, NL80211_ATTR_SURVEY_INFO);
  6880. if (!infoattr)
  6881. goto nla_put_failure;
  6882. if (survey->channel &&
  6883. nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
  6884. survey->channel->center_freq))
  6885. goto nla_put_failure;
  6886. if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
  6887. nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
  6888. goto nla_put_failure;
  6889. if ((survey->filled & SURVEY_INFO_IN_USE) &&
  6890. nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
  6891. goto nla_put_failure;
  6892. if ((survey->filled & SURVEY_INFO_TIME) &&
  6893. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
  6894. survey->time, NL80211_SURVEY_INFO_PAD))
  6895. goto nla_put_failure;
  6896. if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
  6897. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
  6898. survey->time_busy, NL80211_SURVEY_INFO_PAD))
  6899. goto nla_put_failure;
  6900. if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
  6901. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
  6902. survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
  6903. goto nla_put_failure;
  6904. if ((survey->filled & SURVEY_INFO_TIME_RX) &&
  6905. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
  6906. survey->time_rx, NL80211_SURVEY_INFO_PAD))
  6907. goto nla_put_failure;
  6908. if ((survey->filled & SURVEY_INFO_TIME_TX) &&
  6909. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
  6910. survey->time_tx, NL80211_SURVEY_INFO_PAD))
  6911. goto nla_put_failure;
  6912. if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
  6913. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
  6914. survey->time_scan, NL80211_SURVEY_INFO_PAD))
  6915. goto nla_put_failure;
  6916. nla_nest_end(msg, infoattr);
  6917. genlmsg_end(msg, hdr);
  6918. return 0;
  6919. nla_put_failure:
  6920. genlmsg_cancel(msg, hdr);
  6921. return -EMSGSIZE;
  6922. }
  6923. static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
  6924. {
  6925. struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
  6926. struct survey_info survey;
  6927. struct cfg80211_registered_device *rdev;
  6928. struct wireless_dev *wdev;
  6929. int survey_idx = cb->args[2];
  6930. int res;
  6931. bool radio_stats;
  6932. rtnl_lock();
  6933. res = nl80211_prepare_wdev_dump(skb, cb, &rdev, &wdev);
  6934. if (res)
  6935. goto out_err;
  6936. /* prepare_wdev_dump parsed the attributes */
  6937. radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
  6938. if (!wdev->netdev) {
  6939. res = -EINVAL;
  6940. goto out_err;
  6941. }
  6942. if (!rdev->ops->dump_survey) {
  6943. res = -EOPNOTSUPP;
  6944. goto out_err;
  6945. }
  6946. while (1) {
  6947. res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
  6948. if (res == -ENOENT)
  6949. break;
  6950. if (res)
  6951. goto out_err;
  6952. /* don't send disabled channels, but do send non-channel data */
  6953. if (survey.channel &&
  6954. survey.channel->flags & IEEE80211_CHAN_DISABLED) {
  6955. survey_idx++;
  6956. continue;
  6957. }
  6958. if (nl80211_send_survey(skb,
  6959. NETLINK_CB(cb->skb).portid,
  6960. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  6961. wdev->netdev, radio_stats, &survey) < 0)
  6962. goto out;
  6963. survey_idx++;
  6964. }
  6965. out:
  6966. cb->args[2] = survey_idx;
  6967. res = skb->len;
  6968. out_err:
  6969. rtnl_unlock();
  6970. return res;
  6971. }
  6972. static bool nl80211_valid_wpa_versions(u32 wpa_versions)
  6973. {
  6974. return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
  6975. NL80211_WPA_VERSION_2));
  6976. }
  6977. static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
  6978. {
  6979. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6980. struct net_device *dev = info->user_ptr[1];
  6981. struct ieee80211_channel *chan;
  6982. const u8 *bssid, *ssid, *ie = NULL, *auth_data = NULL;
  6983. int err, ssid_len, ie_len = 0, auth_data_len = 0;
  6984. enum nl80211_auth_type auth_type;
  6985. struct key_parse key;
  6986. bool local_state_change;
  6987. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  6988. return -EINVAL;
  6989. if (!info->attrs[NL80211_ATTR_MAC])
  6990. return -EINVAL;
  6991. if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
  6992. return -EINVAL;
  6993. if (!info->attrs[NL80211_ATTR_SSID])
  6994. return -EINVAL;
  6995. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  6996. return -EINVAL;
  6997. err = nl80211_parse_key(info, &key);
  6998. if (err)
  6999. return err;
  7000. if (key.idx >= 0) {
  7001. if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
  7002. return -EINVAL;
  7003. if (!key.p.key || !key.p.key_len)
  7004. return -EINVAL;
  7005. if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
  7006. key.p.key_len != WLAN_KEY_LEN_WEP40) &&
  7007. (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
  7008. key.p.key_len != WLAN_KEY_LEN_WEP104))
  7009. return -EINVAL;
  7010. if (key.idx > 3)
  7011. return -EINVAL;
  7012. } else {
  7013. key.p.key_len = 0;
  7014. key.p.key = NULL;
  7015. }
  7016. if (key.idx >= 0) {
  7017. int i;
  7018. bool ok = false;
  7019. for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
  7020. if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
  7021. ok = true;
  7022. break;
  7023. }
  7024. }
  7025. if (!ok)
  7026. return -EINVAL;
  7027. }
  7028. if (!rdev->ops->auth)
  7029. return -EOPNOTSUPP;
  7030. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  7031. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  7032. return -EOPNOTSUPP;
  7033. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  7034. chan = nl80211_get_valid_chan(&rdev->wiphy,
  7035. info->attrs[NL80211_ATTR_WIPHY_FREQ]);
  7036. if (!chan)
  7037. return -EINVAL;
  7038. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  7039. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  7040. if (info->attrs[NL80211_ATTR_IE]) {
  7041. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  7042. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7043. }
  7044. auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  7045. if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
  7046. return -EINVAL;
  7047. if ((auth_type == NL80211_AUTHTYPE_SAE ||
  7048. auth_type == NL80211_AUTHTYPE_FILS_SK ||
  7049. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  7050. auth_type == NL80211_AUTHTYPE_FILS_PK) &&
  7051. !info->attrs[NL80211_ATTR_AUTH_DATA])
  7052. return -EINVAL;
  7053. if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
  7054. if (auth_type != NL80211_AUTHTYPE_SAE &&
  7055. auth_type != NL80211_AUTHTYPE_FILS_SK &&
  7056. auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
  7057. auth_type != NL80211_AUTHTYPE_FILS_PK)
  7058. return -EINVAL;
  7059. auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
  7060. auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
  7061. /* need to include at least Auth Transaction and Status Code */
  7062. if (auth_data_len < 4)
  7063. return -EINVAL;
  7064. }
  7065. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  7066. /*
  7067. * Since we no longer track auth state, ignore
  7068. * requests to only change local state.
  7069. */
  7070. if (local_state_change)
  7071. return 0;
  7072. wdev_lock(dev->ieee80211_ptr);
  7073. err = cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
  7074. ssid, ssid_len, ie, ie_len,
  7075. key.p.key, key.p.key_len, key.idx,
  7076. auth_data, auth_data_len);
  7077. wdev_unlock(dev->ieee80211_ptr);
  7078. return err;
  7079. }
  7080. static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev,
  7081. struct genl_info *info)
  7082. {
  7083. if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  7084. GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set");
  7085. return -EINVAL;
  7086. }
  7087. if (!rdev->ops->tx_control_port ||
  7088. !wiphy_ext_feature_isset(&rdev->wiphy,
  7089. NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
  7090. return -EOPNOTSUPP;
  7091. return 0;
  7092. }
  7093. static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  7094. struct genl_info *info,
  7095. struct cfg80211_crypto_settings *settings,
  7096. int cipher_limit)
  7097. {
  7098. memset(settings, 0, sizeof(*settings));
  7099. settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
  7100. if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
  7101. u16 proto;
  7102. proto = nla_get_u16(
  7103. info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
  7104. settings->control_port_ethertype = cpu_to_be16(proto);
  7105. if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  7106. proto != ETH_P_PAE)
  7107. return -EINVAL;
  7108. if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
  7109. settings->control_port_no_encrypt = true;
  7110. } else
  7111. settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
  7112. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  7113. int r = validate_pae_over_nl80211(rdev, info);
  7114. if (r < 0)
  7115. return r;
  7116. settings->control_port_over_nl80211 = true;
  7117. }
  7118. if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
  7119. void *data;
  7120. int len, i;
  7121. data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  7122. len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  7123. settings->n_ciphers_pairwise = len / sizeof(u32);
  7124. if (len % sizeof(u32))
  7125. return -EINVAL;
  7126. if (settings->n_ciphers_pairwise > cipher_limit)
  7127. return -EINVAL;
  7128. memcpy(settings->ciphers_pairwise, data, len);
  7129. for (i = 0; i < settings->n_ciphers_pairwise; i++)
  7130. if (!cfg80211_supported_cipher_suite(
  7131. &rdev->wiphy,
  7132. settings->ciphers_pairwise[i]))
  7133. return -EINVAL;
  7134. }
  7135. if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
  7136. settings->cipher_group =
  7137. nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
  7138. if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
  7139. settings->cipher_group))
  7140. return -EINVAL;
  7141. }
  7142. if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
  7143. settings->wpa_versions =
  7144. nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
  7145. if (!nl80211_valid_wpa_versions(settings->wpa_versions))
  7146. return -EINVAL;
  7147. }
  7148. if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
  7149. void *data;
  7150. int len;
  7151. data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
  7152. len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
  7153. settings->n_akm_suites = len / sizeof(u32);
  7154. if (len % sizeof(u32))
  7155. return -EINVAL;
  7156. if (settings->n_akm_suites > NL80211_MAX_NR_AKM_SUITES)
  7157. return -EINVAL;
  7158. memcpy(settings->akm_suites, data, len);
  7159. }
  7160. if (info->attrs[NL80211_ATTR_PMK]) {
  7161. if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
  7162. return -EINVAL;
  7163. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  7164. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK))
  7165. return -EINVAL;
  7166. settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  7167. }
  7168. return 0;
  7169. }
  7170. static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
  7171. {
  7172. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7173. struct net_device *dev = info->user_ptr[1];
  7174. struct ieee80211_channel *chan;
  7175. struct cfg80211_assoc_request req = {};
  7176. const u8 *bssid, *ssid;
  7177. int err, ssid_len = 0;
  7178. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  7179. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  7180. return -EPERM;
  7181. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  7182. return -EINVAL;
  7183. if (!info->attrs[NL80211_ATTR_MAC] ||
  7184. !info->attrs[NL80211_ATTR_SSID] ||
  7185. !info->attrs[NL80211_ATTR_WIPHY_FREQ])
  7186. return -EINVAL;
  7187. if (!rdev->ops->assoc)
  7188. return -EOPNOTSUPP;
  7189. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  7190. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  7191. return -EOPNOTSUPP;
  7192. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  7193. chan = nl80211_get_valid_chan(&rdev->wiphy,
  7194. info->attrs[NL80211_ATTR_WIPHY_FREQ]);
  7195. if (!chan)
  7196. return -EINVAL;
  7197. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  7198. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  7199. if (info->attrs[NL80211_ATTR_IE]) {
  7200. req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  7201. req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7202. }
  7203. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  7204. enum nl80211_mfp mfp =
  7205. nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  7206. if (mfp == NL80211_MFP_REQUIRED)
  7207. req.use_mfp = true;
  7208. else if (mfp != NL80211_MFP_NO)
  7209. return -EINVAL;
  7210. }
  7211. if (info->attrs[NL80211_ATTR_PREV_BSSID])
  7212. req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
  7213. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
  7214. req.flags |= ASSOC_REQ_DISABLE_HT;
  7215. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  7216. memcpy(&req.ht_capa_mask,
  7217. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  7218. sizeof(req.ht_capa_mask));
  7219. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  7220. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  7221. return -EINVAL;
  7222. memcpy(&req.ht_capa,
  7223. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  7224. sizeof(req.ht_capa));
  7225. }
  7226. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
  7227. req.flags |= ASSOC_REQ_DISABLE_VHT;
  7228. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  7229. memcpy(&req.vht_capa_mask,
  7230. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
  7231. sizeof(req.vht_capa_mask));
  7232. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
  7233. if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  7234. return -EINVAL;
  7235. memcpy(&req.vht_capa,
  7236. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
  7237. sizeof(req.vht_capa));
  7238. }
  7239. if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
  7240. if (!((rdev->wiphy.features &
  7241. NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
  7242. (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
  7243. !wiphy_ext_feature_isset(&rdev->wiphy,
  7244. NL80211_EXT_FEATURE_RRM))
  7245. return -EINVAL;
  7246. req.flags |= ASSOC_REQ_USE_RRM;
  7247. }
  7248. if (info->attrs[NL80211_ATTR_FILS_KEK]) {
  7249. req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
  7250. req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
  7251. if (!info->attrs[NL80211_ATTR_FILS_NONCES])
  7252. return -EINVAL;
  7253. req.fils_nonces =
  7254. nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
  7255. }
  7256. err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
  7257. if (!err) {
  7258. wdev_lock(dev->ieee80211_ptr);
  7259. err = cfg80211_mlme_assoc(rdev, dev, chan, bssid,
  7260. ssid, ssid_len, &req);
  7261. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  7262. dev->ieee80211_ptr->conn_owner_nlportid =
  7263. info->snd_portid;
  7264. memcpy(dev->ieee80211_ptr->disconnect_bssid,
  7265. bssid, ETH_ALEN);
  7266. }
  7267. wdev_unlock(dev->ieee80211_ptr);
  7268. }
  7269. return err;
  7270. }
  7271. static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
  7272. {
  7273. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7274. struct net_device *dev = info->user_ptr[1];
  7275. const u8 *ie = NULL, *bssid;
  7276. int ie_len = 0, err;
  7277. u16 reason_code;
  7278. bool local_state_change;
  7279. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  7280. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  7281. return -EPERM;
  7282. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  7283. return -EINVAL;
  7284. if (!info->attrs[NL80211_ATTR_MAC])
  7285. return -EINVAL;
  7286. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  7287. return -EINVAL;
  7288. if (!rdev->ops->deauth)
  7289. return -EOPNOTSUPP;
  7290. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  7291. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  7292. return -EOPNOTSUPP;
  7293. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  7294. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  7295. if (reason_code == 0) {
  7296. /* Reason Code 0 is reserved */
  7297. return -EINVAL;
  7298. }
  7299. if (info->attrs[NL80211_ATTR_IE]) {
  7300. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  7301. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7302. }
  7303. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  7304. wdev_lock(dev->ieee80211_ptr);
  7305. err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
  7306. local_state_change);
  7307. wdev_unlock(dev->ieee80211_ptr);
  7308. return err;
  7309. }
  7310. static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
  7311. {
  7312. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7313. struct net_device *dev = info->user_ptr[1];
  7314. const u8 *ie = NULL, *bssid;
  7315. int ie_len = 0, err;
  7316. u16 reason_code;
  7317. bool local_state_change;
  7318. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  7319. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  7320. return -EPERM;
  7321. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  7322. return -EINVAL;
  7323. if (!info->attrs[NL80211_ATTR_MAC])
  7324. return -EINVAL;
  7325. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  7326. return -EINVAL;
  7327. if (!rdev->ops->disassoc)
  7328. return -EOPNOTSUPP;
  7329. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  7330. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  7331. return -EOPNOTSUPP;
  7332. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  7333. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  7334. if (reason_code == 0) {
  7335. /* Reason Code 0 is reserved */
  7336. return -EINVAL;
  7337. }
  7338. if (info->attrs[NL80211_ATTR_IE]) {
  7339. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  7340. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7341. }
  7342. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  7343. wdev_lock(dev->ieee80211_ptr);
  7344. err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
  7345. local_state_change);
  7346. wdev_unlock(dev->ieee80211_ptr);
  7347. return err;
  7348. }
  7349. static bool
  7350. nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
  7351. int mcast_rate[NUM_NL80211_BANDS],
  7352. int rateval)
  7353. {
  7354. struct wiphy *wiphy = &rdev->wiphy;
  7355. bool found = false;
  7356. int band, i;
  7357. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  7358. struct ieee80211_supported_band *sband;
  7359. sband = wiphy->bands[band];
  7360. if (!sband)
  7361. continue;
  7362. for (i = 0; i < sband->n_bitrates; i++) {
  7363. if (sband->bitrates[i].bitrate == rateval) {
  7364. mcast_rate[band] = i + 1;
  7365. found = true;
  7366. break;
  7367. }
  7368. }
  7369. }
  7370. return found;
  7371. }
  7372. static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
  7373. {
  7374. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7375. struct net_device *dev = info->user_ptr[1];
  7376. struct cfg80211_ibss_params ibss;
  7377. struct wiphy *wiphy;
  7378. struct cfg80211_cached_keys *connkeys = NULL;
  7379. int err;
  7380. memset(&ibss, 0, sizeof(ibss));
  7381. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  7382. return -EINVAL;
  7383. if (!info->attrs[NL80211_ATTR_SSID] ||
  7384. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  7385. return -EINVAL;
  7386. ibss.beacon_interval = 100;
  7387. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
  7388. ibss.beacon_interval =
  7389. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  7390. err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
  7391. ibss.beacon_interval);
  7392. if (err)
  7393. return err;
  7394. if (!rdev->ops->join_ibss)
  7395. return -EOPNOTSUPP;
  7396. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  7397. return -EOPNOTSUPP;
  7398. wiphy = &rdev->wiphy;
  7399. if (info->attrs[NL80211_ATTR_MAC]) {
  7400. ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  7401. if (!is_valid_ether_addr(ibss.bssid))
  7402. return -EINVAL;
  7403. }
  7404. ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  7405. ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  7406. if (info->attrs[NL80211_ATTR_IE]) {
  7407. ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  7408. ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7409. }
  7410. err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
  7411. if (err)
  7412. return err;
  7413. if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
  7414. NL80211_IFTYPE_ADHOC))
  7415. return -EINVAL;
  7416. switch (ibss.chandef.width) {
  7417. case NL80211_CHAN_WIDTH_5:
  7418. case NL80211_CHAN_WIDTH_10:
  7419. case NL80211_CHAN_WIDTH_20_NOHT:
  7420. break;
  7421. case NL80211_CHAN_WIDTH_20:
  7422. case NL80211_CHAN_WIDTH_40:
  7423. if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
  7424. return -EINVAL;
  7425. break;
  7426. case NL80211_CHAN_WIDTH_80:
  7427. case NL80211_CHAN_WIDTH_80P80:
  7428. case NL80211_CHAN_WIDTH_160:
  7429. if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
  7430. return -EINVAL;
  7431. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  7432. NL80211_EXT_FEATURE_VHT_IBSS))
  7433. return -EINVAL;
  7434. break;
  7435. default:
  7436. return -EINVAL;
  7437. }
  7438. ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
  7439. ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  7440. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  7441. u8 *rates =
  7442. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  7443. int n_rates =
  7444. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  7445. struct ieee80211_supported_band *sband =
  7446. wiphy->bands[ibss.chandef.chan->band];
  7447. err = ieee80211_get_ratemask(sband, rates, n_rates,
  7448. &ibss.basic_rates);
  7449. if (err)
  7450. return err;
  7451. }
  7452. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  7453. memcpy(&ibss.ht_capa_mask,
  7454. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  7455. sizeof(ibss.ht_capa_mask));
  7456. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  7457. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  7458. return -EINVAL;
  7459. memcpy(&ibss.ht_capa,
  7460. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  7461. sizeof(ibss.ht_capa));
  7462. }
  7463. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  7464. !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
  7465. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  7466. return -EINVAL;
  7467. if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  7468. bool no_ht = false;
  7469. connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
  7470. if (IS_ERR(connkeys))
  7471. return PTR_ERR(connkeys);
  7472. if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
  7473. no_ht) {
  7474. kzfree(connkeys);
  7475. return -EINVAL;
  7476. }
  7477. }
  7478. ibss.control_port =
  7479. nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
  7480. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  7481. int r = validate_pae_over_nl80211(rdev, info);
  7482. if (r < 0)
  7483. return r;
  7484. ibss.control_port_over_nl80211 = true;
  7485. }
  7486. ibss.userspace_handles_dfs =
  7487. nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
  7488. wdev_lock(dev->ieee80211_ptr);
  7489. err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
  7490. if (err)
  7491. kzfree(connkeys);
  7492. else if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  7493. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  7494. wdev_unlock(dev->ieee80211_ptr);
  7495. return err;
  7496. }
  7497. static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
  7498. {
  7499. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7500. struct net_device *dev = info->user_ptr[1];
  7501. if (!rdev->ops->leave_ibss)
  7502. return -EOPNOTSUPP;
  7503. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  7504. return -EOPNOTSUPP;
  7505. return cfg80211_leave_ibss(rdev, dev, false);
  7506. }
  7507. static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
  7508. {
  7509. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7510. struct net_device *dev = info->user_ptr[1];
  7511. int mcast_rate[NUM_NL80211_BANDS];
  7512. u32 nla_rate;
  7513. int err;
  7514. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
  7515. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  7516. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
  7517. return -EOPNOTSUPP;
  7518. if (!rdev->ops->set_mcast_rate)
  7519. return -EOPNOTSUPP;
  7520. memset(mcast_rate, 0, sizeof(mcast_rate));
  7521. if (!info->attrs[NL80211_ATTR_MCAST_RATE])
  7522. return -EINVAL;
  7523. nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
  7524. if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
  7525. return -EINVAL;
  7526. err = rdev_set_mcast_rate(rdev, dev, mcast_rate);
  7527. return err;
  7528. }
  7529. static struct sk_buff *
  7530. __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
  7531. struct wireless_dev *wdev, int approxlen,
  7532. u32 portid, u32 seq, enum nl80211_commands cmd,
  7533. enum nl80211_attrs attr,
  7534. const struct nl80211_vendor_cmd_info *info,
  7535. gfp_t gfp)
  7536. {
  7537. struct sk_buff *skb;
  7538. void *hdr;
  7539. struct nlattr *data;
  7540. skb = nlmsg_new(approxlen + 100, gfp);
  7541. if (!skb)
  7542. return NULL;
  7543. hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
  7544. if (!hdr) {
  7545. kfree_skb(skb);
  7546. return NULL;
  7547. }
  7548. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  7549. goto nla_put_failure;
  7550. if (info) {
  7551. if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
  7552. info->vendor_id))
  7553. goto nla_put_failure;
  7554. if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
  7555. info->subcmd))
  7556. goto nla_put_failure;
  7557. }
  7558. if (wdev) {
  7559. if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
  7560. wdev_id(wdev), NL80211_ATTR_PAD))
  7561. goto nla_put_failure;
  7562. if (wdev->netdev &&
  7563. nla_put_u32(skb, NL80211_ATTR_IFINDEX,
  7564. wdev->netdev->ifindex))
  7565. goto nla_put_failure;
  7566. }
  7567. data = nla_nest_start(skb, attr);
  7568. if (!data)
  7569. goto nla_put_failure;
  7570. ((void **)skb->cb)[0] = rdev;
  7571. ((void **)skb->cb)[1] = hdr;
  7572. ((void **)skb->cb)[2] = data;
  7573. return skb;
  7574. nla_put_failure:
  7575. kfree_skb(skb);
  7576. return NULL;
  7577. }
  7578. struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
  7579. struct wireless_dev *wdev,
  7580. enum nl80211_commands cmd,
  7581. enum nl80211_attrs attr,
  7582. int vendor_event_idx,
  7583. int approxlen, gfp_t gfp)
  7584. {
  7585. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  7586. const struct nl80211_vendor_cmd_info *info;
  7587. switch (cmd) {
  7588. case NL80211_CMD_TESTMODE:
  7589. if (WARN_ON(vendor_event_idx != -1))
  7590. return NULL;
  7591. info = NULL;
  7592. break;
  7593. case NL80211_CMD_VENDOR:
  7594. if (WARN_ON(vendor_event_idx < 0 ||
  7595. vendor_event_idx >= wiphy->n_vendor_events))
  7596. return NULL;
  7597. info = &wiphy->vendor_events[vendor_event_idx];
  7598. break;
  7599. default:
  7600. WARN_ON(1);
  7601. return NULL;
  7602. }
  7603. return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, 0, 0,
  7604. cmd, attr, info, gfp);
  7605. }
  7606. EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
  7607. void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
  7608. {
  7609. struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
  7610. void *hdr = ((void **)skb->cb)[1];
  7611. struct nlattr *data = ((void **)skb->cb)[2];
  7612. enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
  7613. /* clear CB data for netlink core to own from now on */
  7614. memset(skb->cb, 0, sizeof(skb->cb));
  7615. nla_nest_end(skb, data);
  7616. genlmsg_end(skb, hdr);
  7617. if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
  7618. mcgrp = NL80211_MCGRP_VENDOR;
  7619. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), skb, 0,
  7620. mcgrp, gfp);
  7621. }
  7622. EXPORT_SYMBOL(__cfg80211_send_event_skb);
  7623. #ifdef CONFIG_NL80211_TESTMODE
  7624. static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
  7625. {
  7626. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7627. struct wireless_dev *wdev =
  7628. __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
  7629. int err;
  7630. if (!rdev->ops->testmode_cmd)
  7631. return -EOPNOTSUPP;
  7632. if (IS_ERR(wdev)) {
  7633. err = PTR_ERR(wdev);
  7634. if (err != -EINVAL)
  7635. return err;
  7636. wdev = NULL;
  7637. } else if (wdev->wiphy != &rdev->wiphy) {
  7638. return -EINVAL;
  7639. }
  7640. if (!info->attrs[NL80211_ATTR_TESTDATA])
  7641. return -EINVAL;
  7642. rdev->cur_cmd_info = info;
  7643. err = rdev_testmode_cmd(rdev, wdev,
  7644. nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
  7645. nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
  7646. rdev->cur_cmd_info = NULL;
  7647. return err;
  7648. }
  7649. static int nl80211_testmode_dump(struct sk_buff *skb,
  7650. struct netlink_callback *cb)
  7651. {
  7652. struct cfg80211_registered_device *rdev;
  7653. int err;
  7654. long phy_idx;
  7655. void *data = NULL;
  7656. int data_len = 0;
  7657. rtnl_lock();
  7658. if (cb->args[0]) {
  7659. /*
  7660. * 0 is a valid index, but not valid for args[0],
  7661. * so we need to offset by 1.
  7662. */
  7663. phy_idx = cb->args[0] - 1;
  7664. rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
  7665. if (!rdev) {
  7666. err = -ENOENT;
  7667. goto out_err;
  7668. }
  7669. } else {
  7670. struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
  7671. err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize,
  7672. attrbuf, nl80211_fam.maxattr,
  7673. nl80211_policy, NULL);
  7674. if (err)
  7675. goto out_err;
  7676. rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
  7677. if (IS_ERR(rdev)) {
  7678. err = PTR_ERR(rdev);
  7679. goto out_err;
  7680. }
  7681. phy_idx = rdev->wiphy_idx;
  7682. if (attrbuf[NL80211_ATTR_TESTDATA])
  7683. cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
  7684. }
  7685. if (cb->args[1]) {
  7686. data = nla_data((void *)cb->args[1]);
  7687. data_len = nla_len((void *)cb->args[1]);
  7688. }
  7689. if (!rdev->ops->testmode_dump) {
  7690. err = -EOPNOTSUPP;
  7691. goto out_err;
  7692. }
  7693. while (1) {
  7694. void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
  7695. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  7696. NL80211_CMD_TESTMODE);
  7697. struct nlattr *tmdata;
  7698. if (!hdr)
  7699. break;
  7700. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
  7701. genlmsg_cancel(skb, hdr);
  7702. break;
  7703. }
  7704. tmdata = nla_nest_start(skb, NL80211_ATTR_TESTDATA);
  7705. if (!tmdata) {
  7706. genlmsg_cancel(skb, hdr);
  7707. break;
  7708. }
  7709. err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
  7710. nla_nest_end(skb, tmdata);
  7711. if (err == -ENOBUFS || err == -ENOENT) {
  7712. genlmsg_cancel(skb, hdr);
  7713. break;
  7714. } else if (err) {
  7715. genlmsg_cancel(skb, hdr);
  7716. goto out_err;
  7717. }
  7718. genlmsg_end(skb, hdr);
  7719. }
  7720. err = skb->len;
  7721. /* see above */
  7722. cb->args[0] = phy_idx + 1;
  7723. out_err:
  7724. rtnl_unlock();
  7725. return err;
  7726. }
  7727. #endif
  7728. static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
  7729. {
  7730. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7731. struct net_device *dev = info->user_ptr[1];
  7732. struct cfg80211_connect_params connect;
  7733. struct wiphy *wiphy;
  7734. struct cfg80211_cached_keys *connkeys = NULL;
  7735. int err;
  7736. memset(&connect, 0, sizeof(connect));
  7737. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  7738. return -EINVAL;
  7739. if (!info->attrs[NL80211_ATTR_SSID] ||
  7740. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  7741. return -EINVAL;
  7742. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  7743. connect.auth_type =
  7744. nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  7745. if (!nl80211_valid_auth_type(rdev, connect.auth_type,
  7746. NL80211_CMD_CONNECT))
  7747. return -EINVAL;
  7748. } else
  7749. connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  7750. connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
  7751. if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
  7752. !wiphy_ext_feature_isset(&rdev->wiphy,
  7753. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  7754. return -EINVAL;
  7755. connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
  7756. err = nl80211_crypto_settings(rdev, info, &connect.crypto,
  7757. NL80211_MAX_NR_CIPHER_SUITES);
  7758. if (err)
  7759. return err;
  7760. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  7761. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  7762. return -EOPNOTSUPP;
  7763. wiphy = &rdev->wiphy;
  7764. connect.bg_scan_period = -1;
  7765. if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
  7766. (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
  7767. connect.bg_scan_period =
  7768. nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
  7769. }
  7770. if (info->attrs[NL80211_ATTR_MAC])
  7771. connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  7772. else if (info->attrs[NL80211_ATTR_MAC_HINT])
  7773. connect.bssid_hint =
  7774. nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
  7775. connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  7776. connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  7777. if (info->attrs[NL80211_ATTR_IE]) {
  7778. connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  7779. connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7780. }
  7781. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  7782. connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  7783. if (connect.mfp == NL80211_MFP_OPTIONAL &&
  7784. !wiphy_ext_feature_isset(&rdev->wiphy,
  7785. NL80211_EXT_FEATURE_MFP_OPTIONAL))
  7786. return -EOPNOTSUPP;
  7787. if (connect.mfp != NL80211_MFP_REQUIRED &&
  7788. connect.mfp != NL80211_MFP_NO &&
  7789. connect.mfp != NL80211_MFP_OPTIONAL)
  7790. return -EINVAL;
  7791. } else {
  7792. connect.mfp = NL80211_MFP_NO;
  7793. }
  7794. if (info->attrs[NL80211_ATTR_PREV_BSSID])
  7795. connect.prev_bssid =
  7796. nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
  7797. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  7798. connect.channel = nl80211_get_valid_chan(
  7799. wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ]);
  7800. if (!connect.channel)
  7801. return -EINVAL;
  7802. } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
  7803. connect.channel_hint = nl80211_get_valid_chan(
  7804. wiphy, info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
  7805. if (!connect.channel_hint)
  7806. return -EINVAL;
  7807. }
  7808. if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  7809. connkeys = nl80211_parse_connkeys(rdev, info, NULL);
  7810. if (IS_ERR(connkeys))
  7811. return PTR_ERR(connkeys);
  7812. }
  7813. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
  7814. connect.flags |= ASSOC_REQ_DISABLE_HT;
  7815. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  7816. memcpy(&connect.ht_capa_mask,
  7817. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  7818. sizeof(connect.ht_capa_mask));
  7819. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  7820. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
  7821. kzfree(connkeys);
  7822. return -EINVAL;
  7823. }
  7824. memcpy(&connect.ht_capa,
  7825. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  7826. sizeof(connect.ht_capa));
  7827. }
  7828. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
  7829. connect.flags |= ASSOC_REQ_DISABLE_VHT;
  7830. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  7831. memcpy(&connect.vht_capa_mask,
  7832. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
  7833. sizeof(connect.vht_capa_mask));
  7834. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
  7835. if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
  7836. kzfree(connkeys);
  7837. return -EINVAL;
  7838. }
  7839. memcpy(&connect.vht_capa,
  7840. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
  7841. sizeof(connect.vht_capa));
  7842. }
  7843. if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
  7844. if (!((rdev->wiphy.features &
  7845. NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
  7846. (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
  7847. !wiphy_ext_feature_isset(&rdev->wiphy,
  7848. NL80211_EXT_FEATURE_RRM)) {
  7849. kzfree(connkeys);
  7850. return -EINVAL;
  7851. }
  7852. connect.flags |= ASSOC_REQ_USE_RRM;
  7853. }
  7854. connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
  7855. if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
  7856. kzfree(connkeys);
  7857. return -EOPNOTSUPP;
  7858. }
  7859. if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
  7860. /* bss selection makes no sense if bssid is set */
  7861. if (connect.bssid) {
  7862. kzfree(connkeys);
  7863. return -EINVAL;
  7864. }
  7865. err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
  7866. wiphy, &connect.bss_select);
  7867. if (err) {
  7868. kzfree(connkeys);
  7869. return err;
  7870. }
  7871. }
  7872. if (wiphy_ext_feature_isset(&rdev->wiphy,
  7873. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
  7874. info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
  7875. info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
  7876. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
  7877. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  7878. connect.fils_erp_username =
  7879. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  7880. connect.fils_erp_username_len =
  7881. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  7882. connect.fils_erp_realm =
  7883. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  7884. connect.fils_erp_realm_len =
  7885. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  7886. connect.fils_erp_next_seq_num =
  7887. nla_get_u16(
  7888. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
  7889. connect.fils_erp_rrk =
  7890. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  7891. connect.fils_erp_rrk_len =
  7892. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  7893. } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
  7894. info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
  7895. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
  7896. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  7897. kzfree(connkeys);
  7898. return -EINVAL;
  7899. }
  7900. if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
  7901. if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  7902. kzfree(connkeys);
  7903. GENL_SET_ERR_MSG(info,
  7904. "external auth requires connection ownership");
  7905. return -EINVAL;
  7906. }
  7907. connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
  7908. }
  7909. wdev_lock(dev->ieee80211_ptr);
  7910. err = cfg80211_connect(rdev, dev, &connect, connkeys,
  7911. connect.prev_bssid);
  7912. if (err)
  7913. kzfree(connkeys);
  7914. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  7915. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  7916. if (connect.bssid)
  7917. memcpy(dev->ieee80211_ptr->disconnect_bssid,
  7918. connect.bssid, ETH_ALEN);
  7919. else
  7920. memset(dev->ieee80211_ptr->disconnect_bssid,
  7921. 0, ETH_ALEN);
  7922. }
  7923. wdev_unlock(dev->ieee80211_ptr);
  7924. return err;
  7925. }
  7926. static int nl80211_update_connect_params(struct sk_buff *skb,
  7927. struct genl_info *info)
  7928. {
  7929. struct cfg80211_connect_params connect = {};
  7930. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7931. struct net_device *dev = info->user_ptr[1];
  7932. struct wireless_dev *wdev = dev->ieee80211_ptr;
  7933. bool fils_sk_offload;
  7934. u32 auth_type;
  7935. u32 changed = 0;
  7936. int ret;
  7937. if (!rdev->ops->update_connect_params)
  7938. return -EOPNOTSUPP;
  7939. if (info->attrs[NL80211_ATTR_IE]) {
  7940. if (!is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  7941. return -EINVAL;
  7942. connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  7943. connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7944. changed |= UPDATE_ASSOC_IES;
  7945. }
  7946. fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy,
  7947. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD);
  7948. /*
  7949. * when driver supports fils-sk offload all attributes must be
  7950. * provided. So the else covers "fils-sk-not-all" and
  7951. * "no-fils-sk-any".
  7952. */
  7953. if (fils_sk_offload &&
  7954. info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
  7955. info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
  7956. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
  7957. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  7958. connect.fils_erp_username =
  7959. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  7960. connect.fils_erp_username_len =
  7961. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  7962. connect.fils_erp_realm =
  7963. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  7964. connect.fils_erp_realm_len =
  7965. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  7966. connect.fils_erp_next_seq_num =
  7967. nla_get_u16(
  7968. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
  7969. connect.fils_erp_rrk =
  7970. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  7971. connect.fils_erp_rrk_len =
  7972. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  7973. changed |= UPDATE_FILS_ERP_INFO;
  7974. } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
  7975. info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
  7976. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
  7977. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  7978. return -EINVAL;
  7979. }
  7980. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  7981. auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  7982. if (!nl80211_valid_auth_type(rdev, auth_type,
  7983. NL80211_CMD_CONNECT))
  7984. return -EINVAL;
  7985. if (auth_type == NL80211_AUTHTYPE_FILS_SK &&
  7986. fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO))
  7987. return -EINVAL;
  7988. connect.auth_type = auth_type;
  7989. changed |= UPDATE_AUTH_TYPE;
  7990. }
  7991. wdev_lock(dev->ieee80211_ptr);
  7992. if (!wdev->current_bss)
  7993. ret = -ENOLINK;
  7994. else
  7995. ret = rdev_update_connect_params(rdev, dev, &connect, changed);
  7996. wdev_unlock(dev->ieee80211_ptr);
  7997. return ret;
  7998. }
  7999. static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
  8000. {
  8001. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8002. struct net_device *dev = info->user_ptr[1];
  8003. u16 reason;
  8004. int ret;
  8005. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  8006. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  8007. return -EPERM;
  8008. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  8009. reason = WLAN_REASON_DEAUTH_LEAVING;
  8010. else
  8011. reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  8012. if (reason == 0)
  8013. return -EINVAL;
  8014. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  8015. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  8016. return -EOPNOTSUPP;
  8017. wdev_lock(dev->ieee80211_ptr);
  8018. ret = cfg80211_disconnect(rdev, dev, reason, true);
  8019. wdev_unlock(dev->ieee80211_ptr);
  8020. return ret;
  8021. }
  8022. static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
  8023. {
  8024. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8025. struct net *net;
  8026. int err;
  8027. if (info->attrs[NL80211_ATTR_PID]) {
  8028. u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
  8029. net = get_net_ns_by_pid(pid);
  8030. } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
  8031. u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
  8032. net = get_net_ns_by_fd(fd);
  8033. } else {
  8034. return -EINVAL;
  8035. }
  8036. if (IS_ERR(net))
  8037. return PTR_ERR(net);
  8038. err = 0;
  8039. /* check if anything to do */
  8040. if (!net_eq(wiphy_net(&rdev->wiphy), net))
  8041. err = cfg80211_switch_netns(rdev, net);
  8042. put_net(net);
  8043. return err;
  8044. }
  8045. static int nl80211_setdel_pmksa(struct sk_buff *skb, struct genl_info *info)
  8046. {
  8047. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8048. int (*rdev_ops)(struct wiphy *wiphy, struct net_device *dev,
  8049. struct cfg80211_pmksa *pmksa) = NULL;
  8050. struct net_device *dev = info->user_ptr[1];
  8051. struct cfg80211_pmksa pmksa;
  8052. memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
  8053. if (!info->attrs[NL80211_ATTR_PMKID])
  8054. return -EINVAL;
  8055. pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  8056. if (info->attrs[NL80211_ATTR_MAC]) {
  8057. pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  8058. } else if (info->attrs[NL80211_ATTR_SSID] &&
  8059. info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
  8060. (info->genlhdr->cmd == NL80211_CMD_DEL_PMKSA ||
  8061. info->attrs[NL80211_ATTR_PMK])) {
  8062. pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  8063. pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  8064. pmksa.cache_id =
  8065. nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
  8066. } else {
  8067. return -EINVAL;
  8068. }
  8069. if (info->attrs[NL80211_ATTR_PMK]) {
  8070. pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  8071. pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
  8072. }
  8073. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  8074. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  8075. return -EOPNOTSUPP;
  8076. switch (info->genlhdr->cmd) {
  8077. case NL80211_CMD_SET_PMKSA:
  8078. rdev_ops = rdev->ops->set_pmksa;
  8079. break;
  8080. case NL80211_CMD_DEL_PMKSA:
  8081. rdev_ops = rdev->ops->del_pmksa;
  8082. break;
  8083. default:
  8084. WARN_ON(1);
  8085. break;
  8086. }
  8087. if (!rdev_ops)
  8088. return -EOPNOTSUPP;
  8089. return rdev_ops(&rdev->wiphy, dev, &pmksa);
  8090. }
  8091. static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
  8092. {
  8093. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8094. struct net_device *dev = info->user_ptr[1];
  8095. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  8096. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  8097. return -EOPNOTSUPP;
  8098. if (!rdev->ops->flush_pmksa)
  8099. return -EOPNOTSUPP;
  8100. return rdev_flush_pmksa(rdev, dev);
  8101. }
  8102. static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
  8103. {
  8104. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8105. struct net_device *dev = info->user_ptr[1];
  8106. u8 action_code, dialog_token;
  8107. u32 peer_capability = 0;
  8108. u16 status_code;
  8109. u8 *peer;
  8110. bool initiator;
  8111. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
  8112. !rdev->ops->tdls_mgmt)
  8113. return -EOPNOTSUPP;
  8114. if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
  8115. !info->attrs[NL80211_ATTR_STATUS_CODE] ||
  8116. !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
  8117. !info->attrs[NL80211_ATTR_IE] ||
  8118. !info->attrs[NL80211_ATTR_MAC])
  8119. return -EINVAL;
  8120. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  8121. action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
  8122. status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  8123. dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
  8124. initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
  8125. if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
  8126. peer_capability =
  8127. nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
  8128. return rdev_tdls_mgmt(rdev, dev, peer, action_code,
  8129. dialog_token, status_code, peer_capability,
  8130. initiator,
  8131. nla_data(info->attrs[NL80211_ATTR_IE]),
  8132. nla_len(info->attrs[NL80211_ATTR_IE]));
  8133. }
  8134. static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
  8135. {
  8136. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8137. struct net_device *dev = info->user_ptr[1];
  8138. enum nl80211_tdls_operation operation;
  8139. u8 *peer;
  8140. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
  8141. !rdev->ops->tdls_oper)
  8142. return -EOPNOTSUPP;
  8143. if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
  8144. !info->attrs[NL80211_ATTR_MAC])
  8145. return -EINVAL;
  8146. operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
  8147. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  8148. return rdev_tdls_oper(rdev, dev, peer, operation);
  8149. }
  8150. static int nl80211_remain_on_channel(struct sk_buff *skb,
  8151. struct genl_info *info)
  8152. {
  8153. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8154. struct wireless_dev *wdev = info->user_ptr[1];
  8155. struct cfg80211_chan_def chandef;
  8156. const struct cfg80211_chan_def *compat_chandef;
  8157. struct sk_buff *msg;
  8158. void *hdr;
  8159. u64 cookie;
  8160. u32 duration;
  8161. int err;
  8162. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  8163. !info->attrs[NL80211_ATTR_DURATION])
  8164. return -EINVAL;
  8165. duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  8166. if (!rdev->ops->remain_on_channel ||
  8167. !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
  8168. return -EOPNOTSUPP;
  8169. /*
  8170. * We should be on that channel for at least a minimum amount of
  8171. * time (10ms) but no longer than the driver supports.
  8172. */
  8173. if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
  8174. duration > rdev->wiphy.max_remain_on_channel_duration)
  8175. return -EINVAL;
  8176. err = nl80211_parse_chandef(rdev, info, &chandef);
  8177. if (err)
  8178. return err;
  8179. wdev_lock(wdev);
  8180. if (!cfg80211_off_channel_oper_allowed(wdev) &&
  8181. !cfg80211_chandef_identical(&wdev->chandef, &chandef)) {
  8182. compat_chandef = cfg80211_chandef_compatible(&wdev->chandef,
  8183. &chandef);
  8184. if (compat_chandef != &chandef) {
  8185. wdev_unlock(wdev);
  8186. return -EBUSY;
  8187. }
  8188. }
  8189. wdev_unlock(wdev);
  8190. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  8191. if (!msg)
  8192. return -ENOMEM;
  8193. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  8194. NL80211_CMD_REMAIN_ON_CHANNEL);
  8195. if (!hdr) {
  8196. err = -ENOBUFS;
  8197. goto free_msg;
  8198. }
  8199. err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
  8200. duration, &cookie);
  8201. if (err)
  8202. goto free_msg;
  8203. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  8204. NL80211_ATTR_PAD))
  8205. goto nla_put_failure;
  8206. genlmsg_end(msg, hdr);
  8207. return genlmsg_reply(msg, info);
  8208. nla_put_failure:
  8209. err = -ENOBUFS;
  8210. free_msg:
  8211. nlmsg_free(msg);
  8212. return err;
  8213. }
  8214. static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
  8215. struct genl_info *info)
  8216. {
  8217. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8218. struct wireless_dev *wdev = info->user_ptr[1];
  8219. u64 cookie;
  8220. if (!info->attrs[NL80211_ATTR_COOKIE])
  8221. return -EINVAL;
  8222. if (!rdev->ops->cancel_remain_on_channel)
  8223. return -EOPNOTSUPP;
  8224. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  8225. return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
  8226. }
  8227. static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
  8228. struct genl_info *info)
  8229. {
  8230. struct cfg80211_bitrate_mask mask;
  8231. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8232. struct net_device *dev = info->user_ptr[1];
  8233. int err;
  8234. if (!rdev->ops->set_bitrate_mask)
  8235. return -EOPNOTSUPP;
  8236. err = nl80211_parse_tx_bitrate_mask(info, &mask);
  8237. if (err)
  8238. return err;
  8239. return rdev_set_bitrate_mask(rdev, dev, NULL, &mask);
  8240. }
  8241. static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
  8242. {
  8243. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8244. struct wireless_dev *wdev = info->user_ptr[1];
  8245. u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
  8246. if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
  8247. return -EINVAL;
  8248. if (info->attrs[NL80211_ATTR_FRAME_TYPE])
  8249. frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
  8250. switch (wdev->iftype) {
  8251. case NL80211_IFTYPE_STATION:
  8252. case NL80211_IFTYPE_ADHOC:
  8253. case NL80211_IFTYPE_P2P_CLIENT:
  8254. case NL80211_IFTYPE_AP:
  8255. case NL80211_IFTYPE_AP_VLAN:
  8256. case NL80211_IFTYPE_MESH_POINT:
  8257. case NL80211_IFTYPE_P2P_GO:
  8258. case NL80211_IFTYPE_P2P_DEVICE:
  8259. break;
  8260. case NL80211_IFTYPE_NAN:
  8261. default:
  8262. return -EOPNOTSUPP;
  8263. }
  8264. /* not much point in registering if we can't reply */
  8265. if (!rdev->ops->mgmt_tx)
  8266. return -EOPNOTSUPP;
  8267. return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
  8268. nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
  8269. nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]));
  8270. }
  8271. static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
  8272. {
  8273. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8274. struct wireless_dev *wdev = info->user_ptr[1];
  8275. struct cfg80211_chan_def chandef;
  8276. int err;
  8277. void *hdr = NULL;
  8278. u64 cookie;
  8279. struct sk_buff *msg = NULL;
  8280. struct cfg80211_mgmt_tx_params params = {
  8281. .dont_wait_for_ack =
  8282. info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
  8283. };
  8284. if (!info->attrs[NL80211_ATTR_FRAME])
  8285. return -EINVAL;
  8286. if (!rdev->ops->mgmt_tx)
  8287. return -EOPNOTSUPP;
  8288. switch (wdev->iftype) {
  8289. case NL80211_IFTYPE_P2P_DEVICE:
  8290. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  8291. return -EINVAL;
  8292. case NL80211_IFTYPE_STATION:
  8293. case NL80211_IFTYPE_ADHOC:
  8294. case NL80211_IFTYPE_P2P_CLIENT:
  8295. case NL80211_IFTYPE_AP:
  8296. case NL80211_IFTYPE_AP_VLAN:
  8297. case NL80211_IFTYPE_MESH_POINT:
  8298. case NL80211_IFTYPE_P2P_GO:
  8299. break;
  8300. case NL80211_IFTYPE_NAN:
  8301. default:
  8302. return -EOPNOTSUPP;
  8303. }
  8304. if (info->attrs[NL80211_ATTR_DURATION]) {
  8305. if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
  8306. return -EINVAL;
  8307. params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  8308. /*
  8309. * We should wait on the channel for at least a minimum amount
  8310. * of time (10ms) but no longer than the driver supports.
  8311. */
  8312. if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
  8313. params.wait > rdev->wiphy.max_remain_on_channel_duration)
  8314. return -EINVAL;
  8315. }
  8316. params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
  8317. if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
  8318. return -EINVAL;
  8319. params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
  8320. /* get the channel if any has been specified, otherwise pass NULL to
  8321. * the driver. The latter will use the current one
  8322. */
  8323. chandef.chan = NULL;
  8324. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  8325. err = nl80211_parse_chandef(rdev, info, &chandef);
  8326. if (err)
  8327. return err;
  8328. }
  8329. if (!chandef.chan && params.offchan)
  8330. return -EINVAL;
  8331. wdev_lock(wdev);
  8332. if (params.offchan && !cfg80211_off_channel_oper_allowed(wdev)) {
  8333. wdev_unlock(wdev);
  8334. return -EBUSY;
  8335. }
  8336. wdev_unlock(wdev);
  8337. params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
  8338. params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
  8339. if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
  8340. int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
  8341. int i;
  8342. if (len % sizeof(u16))
  8343. return -EINVAL;
  8344. params.n_csa_offsets = len / sizeof(u16);
  8345. params.csa_offsets =
  8346. nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
  8347. /* check that all the offsets fit the frame */
  8348. for (i = 0; i < params.n_csa_offsets; i++) {
  8349. if (params.csa_offsets[i] >= params.len)
  8350. return -EINVAL;
  8351. }
  8352. }
  8353. if (!params.dont_wait_for_ack) {
  8354. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  8355. if (!msg)
  8356. return -ENOMEM;
  8357. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  8358. NL80211_CMD_FRAME);
  8359. if (!hdr) {
  8360. err = -ENOBUFS;
  8361. goto free_msg;
  8362. }
  8363. }
  8364. params.chan = chandef.chan;
  8365. err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
  8366. if (err)
  8367. goto free_msg;
  8368. if (msg) {
  8369. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  8370. NL80211_ATTR_PAD))
  8371. goto nla_put_failure;
  8372. genlmsg_end(msg, hdr);
  8373. return genlmsg_reply(msg, info);
  8374. }
  8375. return 0;
  8376. nla_put_failure:
  8377. err = -ENOBUFS;
  8378. free_msg:
  8379. nlmsg_free(msg);
  8380. return err;
  8381. }
  8382. static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
  8383. {
  8384. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8385. struct wireless_dev *wdev = info->user_ptr[1];
  8386. u64 cookie;
  8387. if (!info->attrs[NL80211_ATTR_COOKIE])
  8388. return -EINVAL;
  8389. if (!rdev->ops->mgmt_tx_cancel_wait)
  8390. return -EOPNOTSUPP;
  8391. switch (wdev->iftype) {
  8392. case NL80211_IFTYPE_STATION:
  8393. case NL80211_IFTYPE_ADHOC:
  8394. case NL80211_IFTYPE_P2P_CLIENT:
  8395. case NL80211_IFTYPE_AP:
  8396. case NL80211_IFTYPE_AP_VLAN:
  8397. case NL80211_IFTYPE_P2P_GO:
  8398. case NL80211_IFTYPE_P2P_DEVICE:
  8399. break;
  8400. case NL80211_IFTYPE_NAN:
  8401. default:
  8402. return -EOPNOTSUPP;
  8403. }
  8404. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  8405. return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
  8406. }
  8407. static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
  8408. {
  8409. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8410. struct wireless_dev *wdev;
  8411. struct net_device *dev = info->user_ptr[1];
  8412. u8 ps_state;
  8413. bool state;
  8414. int err;
  8415. if (!info->attrs[NL80211_ATTR_PS_STATE])
  8416. return -EINVAL;
  8417. ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
  8418. if (ps_state != NL80211_PS_DISABLED && ps_state != NL80211_PS_ENABLED)
  8419. return -EINVAL;
  8420. wdev = dev->ieee80211_ptr;
  8421. if (!rdev->ops->set_power_mgmt)
  8422. return -EOPNOTSUPP;
  8423. state = (ps_state == NL80211_PS_ENABLED) ? true : false;
  8424. if (state == wdev->ps)
  8425. return 0;
  8426. err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
  8427. if (!err)
  8428. wdev->ps = state;
  8429. return err;
  8430. }
  8431. static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
  8432. {
  8433. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8434. enum nl80211_ps_state ps_state;
  8435. struct wireless_dev *wdev;
  8436. struct net_device *dev = info->user_ptr[1];
  8437. struct sk_buff *msg;
  8438. void *hdr;
  8439. int err;
  8440. wdev = dev->ieee80211_ptr;
  8441. if (!rdev->ops->set_power_mgmt)
  8442. return -EOPNOTSUPP;
  8443. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  8444. if (!msg)
  8445. return -ENOMEM;
  8446. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  8447. NL80211_CMD_GET_POWER_SAVE);
  8448. if (!hdr) {
  8449. err = -ENOBUFS;
  8450. goto free_msg;
  8451. }
  8452. if (wdev->ps)
  8453. ps_state = NL80211_PS_ENABLED;
  8454. else
  8455. ps_state = NL80211_PS_DISABLED;
  8456. if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
  8457. goto nla_put_failure;
  8458. genlmsg_end(msg, hdr);
  8459. return genlmsg_reply(msg, info);
  8460. nla_put_failure:
  8461. err = -ENOBUFS;
  8462. free_msg:
  8463. nlmsg_free(msg);
  8464. return err;
  8465. }
  8466. static const struct nla_policy
  8467. nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
  8468. [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
  8469. [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
  8470. [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
  8471. [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
  8472. [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
  8473. [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
  8474. [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
  8475. };
  8476. static int nl80211_set_cqm_txe(struct genl_info *info,
  8477. u32 rate, u32 pkts, u32 intvl)
  8478. {
  8479. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8480. struct net_device *dev = info->user_ptr[1];
  8481. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8482. if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
  8483. return -EINVAL;
  8484. if (!rdev->ops->set_cqm_txe_config)
  8485. return -EOPNOTSUPP;
  8486. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  8487. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  8488. return -EOPNOTSUPP;
  8489. return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
  8490. }
  8491. static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
  8492. struct net_device *dev)
  8493. {
  8494. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8495. s32 last, low, high;
  8496. u32 hyst;
  8497. int i, n;
  8498. int err;
  8499. /* RSSI reporting disabled? */
  8500. if (!wdev->cqm_config)
  8501. return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
  8502. /*
  8503. * Obtain current RSSI value if possible, if not and no RSSI threshold
  8504. * event has been received yet, we should receive an event after a
  8505. * connection is established and enough beacons received to calculate
  8506. * the average.
  8507. */
  8508. if (!wdev->cqm_config->last_rssi_event_value && wdev->current_bss &&
  8509. rdev->ops->get_station) {
  8510. struct station_info sinfo = {};
  8511. u8 *mac_addr;
  8512. mac_addr = wdev->current_bss->pub.bssid;
  8513. err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
  8514. if (err)
  8515. return err;
  8516. if (sinfo.filled & BIT(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
  8517. wdev->cqm_config->last_rssi_event_value =
  8518. (s8) sinfo.rx_beacon_signal_avg;
  8519. }
  8520. last = wdev->cqm_config->last_rssi_event_value;
  8521. hyst = wdev->cqm_config->rssi_hyst;
  8522. n = wdev->cqm_config->n_rssi_thresholds;
  8523. for (i = 0; i < n; i++)
  8524. if (last < wdev->cqm_config->rssi_thresholds[i])
  8525. break;
  8526. low = i > 0 ?
  8527. (wdev->cqm_config->rssi_thresholds[i - 1] - hyst) : S32_MIN;
  8528. high = i < n ?
  8529. (wdev->cqm_config->rssi_thresholds[i] + hyst - 1) : S32_MAX;
  8530. return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
  8531. }
  8532. static int nl80211_set_cqm_rssi(struct genl_info *info,
  8533. const s32 *thresholds, int n_thresholds,
  8534. u32 hysteresis)
  8535. {
  8536. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8537. struct net_device *dev = info->user_ptr[1];
  8538. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8539. int i, err;
  8540. s32 prev = S32_MIN;
  8541. /* Check all values negative and sorted */
  8542. for (i = 0; i < n_thresholds; i++) {
  8543. if (thresholds[i] > 0 || thresholds[i] <= prev)
  8544. return -EINVAL;
  8545. prev = thresholds[i];
  8546. }
  8547. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  8548. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  8549. return -EOPNOTSUPP;
  8550. wdev_lock(wdev);
  8551. cfg80211_cqm_config_free(wdev);
  8552. wdev_unlock(wdev);
  8553. if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
  8554. if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
  8555. return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
  8556. return rdev_set_cqm_rssi_config(rdev, dev,
  8557. thresholds[0], hysteresis);
  8558. }
  8559. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  8560. NL80211_EXT_FEATURE_CQM_RSSI_LIST))
  8561. return -EOPNOTSUPP;
  8562. if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
  8563. n_thresholds = 0;
  8564. wdev_lock(wdev);
  8565. if (n_thresholds) {
  8566. struct cfg80211_cqm_config *cqm_config;
  8567. cqm_config = kzalloc(sizeof(struct cfg80211_cqm_config) +
  8568. n_thresholds * sizeof(s32), GFP_KERNEL);
  8569. if (!cqm_config) {
  8570. err = -ENOMEM;
  8571. goto unlock;
  8572. }
  8573. cqm_config->rssi_hyst = hysteresis;
  8574. cqm_config->n_rssi_thresholds = n_thresholds;
  8575. memcpy(cqm_config->rssi_thresholds, thresholds,
  8576. n_thresholds * sizeof(s32));
  8577. wdev->cqm_config = cqm_config;
  8578. }
  8579. err = cfg80211_cqm_rssi_update(rdev, dev);
  8580. unlock:
  8581. wdev_unlock(wdev);
  8582. return err;
  8583. }
  8584. static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
  8585. {
  8586. struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
  8587. struct nlattr *cqm;
  8588. int err;
  8589. cqm = info->attrs[NL80211_ATTR_CQM];
  8590. if (!cqm)
  8591. return -EINVAL;
  8592. err = nla_parse_nested(attrs, NL80211_ATTR_CQM_MAX, cqm,
  8593. nl80211_attr_cqm_policy, info->extack);
  8594. if (err)
  8595. return err;
  8596. if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
  8597. attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
  8598. const s32 *thresholds =
  8599. nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
  8600. int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
  8601. u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
  8602. if (len % 4)
  8603. return -EINVAL;
  8604. return nl80211_set_cqm_rssi(info, thresholds, len / 4,
  8605. hysteresis);
  8606. }
  8607. if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
  8608. attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
  8609. attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
  8610. u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
  8611. u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
  8612. u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
  8613. return nl80211_set_cqm_txe(info, rate, pkts, intvl);
  8614. }
  8615. return -EINVAL;
  8616. }
  8617. static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
  8618. {
  8619. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8620. struct net_device *dev = info->user_ptr[1];
  8621. struct ocb_setup setup = {};
  8622. int err;
  8623. err = nl80211_parse_chandef(rdev, info, &setup.chandef);
  8624. if (err)
  8625. return err;
  8626. return cfg80211_join_ocb(rdev, dev, &setup);
  8627. }
  8628. static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
  8629. {
  8630. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8631. struct net_device *dev = info->user_ptr[1];
  8632. return cfg80211_leave_ocb(rdev, dev);
  8633. }
  8634. static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
  8635. {
  8636. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8637. struct net_device *dev = info->user_ptr[1];
  8638. struct mesh_config cfg;
  8639. struct mesh_setup setup;
  8640. int err;
  8641. /* start with default */
  8642. memcpy(&cfg, &default_mesh_config, sizeof(cfg));
  8643. memcpy(&setup, &default_mesh_setup, sizeof(setup));
  8644. if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
  8645. /* and parse parameters if given */
  8646. err = nl80211_parse_mesh_config(info, &cfg, NULL);
  8647. if (err)
  8648. return err;
  8649. }
  8650. if (!info->attrs[NL80211_ATTR_MESH_ID] ||
  8651. !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
  8652. return -EINVAL;
  8653. setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
  8654. setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  8655. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  8656. !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
  8657. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  8658. return -EINVAL;
  8659. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
  8660. setup.beacon_interval =
  8661. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  8662. err = cfg80211_validate_beacon_int(rdev,
  8663. NL80211_IFTYPE_MESH_POINT,
  8664. setup.beacon_interval);
  8665. if (err)
  8666. return err;
  8667. }
  8668. if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
  8669. setup.dtim_period =
  8670. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  8671. if (setup.dtim_period < 1 || setup.dtim_period > 100)
  8672. return -EINVAL;
  8673. }
  8674. if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
  8675. /* parse additional setup parameters if given */
  8676. err = nl80211_parse_mesh_setup(info, &setup);
  8677. if (err)
  8678. return err;
  8679. }
  8680. if (setup.user_mpm)
  8681. cfg.auto_open_plinks = false;
  8682. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  8683. err = nl80211_parse_chandef(rdev, info, &setup.chandef);
  8684. if (err)
  8685. return err;
  8686. } else {
  8687. /* __cfg80211_join_mesh() will sort it out */
  8688. setup.chandef.chan = NULL;
  8689. }
  8690. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  8691. u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  8692. int n_rates =
  8693. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  8694. struct ieee80211_supported_band *sband;
  8695. if (!setup.chandef.chan)
  8696. return -EINVAL;
  8697. sband = rdev->wiphy.bands[setup.chandef.chan->band];
  8698. err = ieee80211_get_ratemask(sband, rates, n_rates,
  8699. &setup.basic_rates);
  8700. if (err)
  8701. return err;
  8702. }
  8703. if (info->attrs[NL80211_ATTR_TX_RATES]) {
  8704. err = nl80211_parse_tx_bitrate_mask(info, &setup.beacon_rate);
  8705. if (err)
  8706. return err;
  8707. if (!setup.chandef.chan)
  8708. return -EINVAL;
  8709. err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
  8710. &setup.beacon_rate);
  8711. if (err)
  8712. return err;
  8713. }
  8714. setup.userspace_handles_dfs =
  8715. nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
  8716. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  8717. int r = validate_pae_over_nl80211(rdev, info);
  8718. if (r < 0)
  8719. return r;
  8720. setup.control_port_over_nl80211 = true;
  8721. }
  8722. wdev_lock(dev->ieee80211_ptr);
  8723. err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg);
  8724. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER])
  8725. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  8726. wdev_unlock(dev->ieee80211_ptr);
  8727. return err;
  8728. }
  8729. static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
  8730. {
  8731. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8732. struct net_device *dev = info->user_ptr[1];
  8733. return cfg80211_leave_mesh(rdev, dev);
  8734. }
  8735. #ifdef CONFIG_PM
  8736. static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
  8737. struct cfg80211_registered_device *rdev)
  8738. {
  8739. struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
  8740. struct nlattr *nl_pats, *nl_pat;
  8741. int i, pat_len;
  8742. if (!wowlan->n_patterns)
  8743. return 0;
  8744. nl_pats = nla_nest_start(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
  8745. if (!nl_pats)
  8746. return -ENOBUFS;
  8747. for (i = 0; i < wowlan->n_patterns; i++) {
  8748. nl_pat = nla_nest_start(msg, i + 1);
  8749. if (!nl_pat)
  8750. return -ENOBUFS;
  8751. pat_len = wowlan->patterns[i].pattern_len;
  8752. if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
  8753. wowlan->patterns[i].mask) ||
  8754. nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
  8755. wowlan->patterns[i].pattern) ||
  8756. nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
  8757. wowlan->patterns[i].pkt_offset))
  8758. return -ENOBUFS;
  8759. nla_nest_end(msg, nl_pat);
  8760. }
  8761. nla_nest_end(msg, nl_pats);
  8762. return 0;
  8763. }
  8764. static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
  8765. struct cfg80211_wowlan_tcp *tcp)
  8766. {
  8767. struct nlattr *nl_tcp;
  8768. if (!tcp)
  8769. return 0;
  8770. nl_tcp = nla_nest_start(msg, NL80211_WOWLAN_TRIG_TCP_CONNECTION);
  8771. if (!nl_tcp)
  8772. return -ENOBUFS;
  8773. if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
  8774. nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
  8775. nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
  8776. nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
  8777. nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
  8778. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  8779. tcp->payload_len, tcp->payload) ||
  8780. nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
  8781. tcp->data_interval) ||
  8782. nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
  8783. tcp->wake_len, tcp->wake_data) ||
  8784. nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
  8785. DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
  8786. return -ENOBUFS;
  8787. if (tcp->payload_seq.len &&
  8788. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
  8789. sizeof(tcp->payload_seq), &tcp->payload_seq))
  8790. return -ENOBUFS;
  8791. if (tcp->payload_tok.len &&
  8792. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
  8793. sizeof(tcp->payload_tok) + tcp->tokens_size,
  8794. &tcp->payload_tok))
  8795. return -ENOBUFS;
  8796. nla_nest_end(msg, nl_tcp);
  8797. return 0;
  8798. }
  8799. static int nl80211_send_wowlan_nd(struct sk_buff *msg,
  8800. struct cfg80211_sched_scan_request *req)
  8801. {
  8802. struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
  8803. int i;
  8804. if (!req)
  8805. return 0;
  8806. nd = nla_nest_start(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
  8807. if (!nd)
  8808. return -ENOBUFS;
  8809. if (req->n_scan_plans == 1 &&
  8810. nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
  8811. req->scan_plans[0].interval * 1000))
  8812. return -ENOBUFS;
  8813. if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
  8814. return -ENOBUFS;
  8815. if (req->relative_rssi_set) {
  8816. struct nl80211_bss_select_rssi_adjust rssi_adjust;
  8817. if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
  8818. req->relative_rssi))
  8819. return -ENOBUFS;
  8820. rssi_adjust.band = req->rssi_adjust.band;
  8821. rssi_adjust.delta = req->rssi_adjust.delta;
  8822. if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
  8823. sizeof(rssi_adjust), &rssi_adjust))
  8824. return -ENOBUFS;
  8825. }
  8826. freqs = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
  8827. if (!freqs)
  8828. return -ENOBUFS;
  8829. for (i = 0; i < req->n_channels; i++) {
  8830. if (nla_put_u32(msg, i, req->channels[i]->center_freq))
  8831. return -ENOBUFS;
  8832. }
  8833. nla_nest_end(msg, freqs);
  8834. if (req->n_match_sets) {
  8835. matches = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_MATCH);
  8836. if (!matches)
  8837. return -ENOBUFS;
  8838. for (i = 0; i < req->n_match_sets; i++) {
  8839. match = nla_nest_start(msg, i);
  8840. if (!match)
  8841. return -ENOBUFS;
  8842. if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
  8843. req->match_sets[i].ssid.ssid_len,
  8844. req->match_sets[i].ssid.ssid))
  8845. return -ENOBUFS;
  8846. nla_nest_end(msg, match);
  8847. }
  8848. nla_nest_end(msg, matches);
  8849. }
  8850. scan_plans = nla_nest_start(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
  8851. if (!scan_plans)
  8852. return -ENOBUFS;
  8853. for (i = 0; i < req->n_scan_plans; i++) {
  8854. scan_plan = nla_nest_start(msg, i + 1);
  8855. if (!scan_plan)
  8856. return -ENOBUFS;
  8857. if (!scan_plan ||
  8858. nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
  8859. req->scan_plans[i].interval) ||
  8860. (req->scan_plans[i].iterations &&
  8861. nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
  8862. req->scan_plans[i].iterations)))
  8863. return -ENOBUFS;
  8864. nla_nest_end(msg, scan_plan);
  8865. }
  8866. nla_nest_end(msg, scan_plans);
  8867. nla_nest_end(msg, nd);
  8868. return 0;
  8869. }
  8870. static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
  8871. {
  8872. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8873. struct sk_buff *msg;
  8874. void *hdr;
  8875. u32 size = NLMSG_DEFAULT_SIZE;
  8876. if (!rdev->wiphy.wowlan)
  8877. return -EOPNOTSUPP;
  8878. if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
  8879. /* adjust size to have room for all the data */
  8880. size += rdev->wiphy.wowlan_config->tcp->tokens_size +
  8881. rdev->wiphy.wowlan_config->tcp->payload_len +
  8882. rdev->wiphy.wowlan_config->tcp->wake_len +
  8883. rdev->wiphy.wowlan_config->tcp->wake_len / 8;
  8884. }
  8885. msg = nlmsg_new(size, GFP_KERNEL);
  8886. if (!msg)
  8887. return -ENOMEM;
  8888. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  8889. NL80211_CMD_GET_WOWLAN);
  8890. if (!hdr)
  8891. goto nla_put_failure;
  8892. if (rdev->wiphy.wowlan_config) {
  8893. struct nlattr *nl_wowlan;
  8894. nl_wowlan = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
  8895. if (!nl_wowlan)
  8896. goto nla_put_failure;
  8897. if ((rdev->wiphy.wowlan_config->any &&
  8898. nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
  8899. (rdev->wiphy.wowlan_config->disconnect &&
  8900. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
  8901. (rdev->wiphy.wowlan_config->magic_pkt &&
  8902. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
  8903. (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
  8904. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
  8905. (rdev->wiphy.wowlan_config->eap_identity_req &&
  8906. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
  8907. (rdev->wiphy.wowlan_config->four_way_handshake &&
  8908. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
  8909. (rdev->wiphy.wowlan_config->rfkill_release &&
  8910. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
  8911. goto nla_put_failure;
  8912. if (nl80211_send_wowlan_patterns(msg, rdev))
  8913. goto nla_put_failure;
  8914. if (nl80211_send_wowlan_tcp(msg,
  8915. rdev->wiphy.wowlan_config->tcp))
  8916. goto nla_put_failure;
  8917. if (nl80211_send_wowlan_nd(
  8918. msg,
  8919. rdev->wiphy.wowlan_config->nd_config))
  8920. goto nla_put_failure;
  8921. nla_nest_end(msg, nl_wowlan);
  8922. }
  8923. genlmsg_end(msg, hdr);
  8924. return genlmsg_reply(msg, info);
  8925. nla_put_failure:
  8926. nlmsg_free(msg);
  8927. return -ENOBUFS;
  8928. }
  8929. static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
  8930. struct nlattr *attr,
  8931. struct cfg80211_wowlan *trig)
  8932. {
  8933. struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
  8934. struct cfg80211_wowlan_tcp *cfg;
  8935. struct nl80211_wowlan_tcp_data_token *tok = NULL;
  8936. struct nl80211_wowlan_tcp_data_seq *seq = NULL;
  8937. u32 size;
  8938. u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
  8939. int err, port;
  8940. if (!rdev->wiphy.wowlan->tcp)
  8941. return -EINVAL;
  8942. err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TCP, attr,
  8943. nl80211_wowlan_tcp_policy, NULL);
  8944. if (err)
  8945. return err;
  8946. if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
  8947. !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
  8948. !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
  8949. !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
  8950. !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
  8951. !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
  8952. !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
  8953. !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
  8954. return -EINVAL;
  8955. data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
  8956. if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
  8957. return -EINVAL;
  8958. if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
  8959. rdev->wiphy.wowlan->tcp->data_interval_max ||
  8960. nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
  8961. return -EINVAL;
  8962. wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
  8963. if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
  8964. return -EINVAL;
  8965. wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
  8966. if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
  8967. return -EINVAL;
  8968. if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
  8969. u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
  8970. tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
  8971. tokens_size = tokln - sizeof(*tok);
  8972. if (!tok->len || tokens_size % tok->len)
  8973. return -EINVAL;
  8974. if (!rdev->wiphy.wowlan->tcp->tok)
  8975. return -EINVAL;
  8976. if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
  8977. return -EINVAL;
  8978. if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
  8979. return -EINVAL;
  8980. if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
  8981. return -EINVAL;
  8982. if (tok->offset + tok->len > data_size)
  8983. return -EINVAL;
  8984. }
  8985. if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
  8986. seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
  8987. if (!rdev->wiphy.wowlan->tcp->seq)
  8988. return -EINVAL;
  8989. if (seq->len == 0 || seq->len > 4)
  8990. return -EINVAL;
  8991. if (seq->len + seq->offset > data_size)
  8992. return -EINVAL;
  8993. }
  8994. size = sizeof(*cfg);
  8995. size += data_size;
  8996. size += wake_size + wake_mask_size;
  8997. size += tokens_size;
  8998. cfg = kzalloc(size, GFP_KERNEL);
  8999. if (!cfg)
  9000. return -ENOMEM;
  9001. cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
  9002. cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
  9003. memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
  9004. ETH_ALEN);
  9005. if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
  9006. port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
  9007. else
  9008. port = 0;
  9009. #ifdef CONFIG_INET
  9010. /* allocate a socket and port for it and use it */
  9011. err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
  9012. IPPROTO_TCP, &cfg->sock, 1);
  9013. if (err) {
  9014. kfree(cfg);
  9015. return err;
  9016. }
  9017. if (inet_csk_get_port(cfg->sock->sk, port)) {
  9018. sock_release(cfg->sock);
  9019. kfree(cfg);
  9020. return -EADDRINUSE;
  9021. }
  9022. cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
  9023. #else
  9024. if (!port) {
  9025. kfree(cfg);
  9026. return -EINVAL;
  9027. }
  9028. cfg->src_port = port;
  9029. #endif
  9030. cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
  9031. cfg->payload_len = data_size;
  9032. cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
  9033. memcpy((void *)cfg->payload,
  9034. nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
  9035. data_size);
  9036. if (seq)
  9037. cfg->payload_seq = *seq;
  9038. cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
  9039. cfg->wake_len = wake_size;
  9040. cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
  9041. memcpy((void *)cfg->wake_data,
  9042. nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
  9043. wake_size);
  9044. cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
  9045. data_size + wake_size;
  9046. memcpy((void *)cfg->wake_mask,
  9047. nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
  9048. wake_mask_size);
  9049. if (tok) {
  9050. cfg->tokens_size = tokens_size;
  9051. memcpy(&cfg->payload_tok, tok, sizeof(*tok) + tokens_size);
  9052. }
  9053. trig->tcp = cfg;
  9054. return 0;
  9055. }
  9056. static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
  9057. const struct wiphy_wowlan_support *wowlan,
  9058. struct nlattr *attr,
  9059. struct cfg80211_wowlan *trig)
  9060. {
  9061. struct nlattr **tb;
  9062. int err;
  9063. tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
  9064. if (!tb)
  9065. return -ENOMEM;
  9066. if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
  9067. err = -EOPNOTSUPP;
  9068. goto out;
  9069. }
  9070. err = nla_parse_nested(tb, NL80211_ATTR_MAX, attr, nl80211_policy,
  9071. NULL);
  9072. if (err)
  9073. goto out;
  9074. trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
  9075. wowlan->max_nd_match_sets);
  9076. err = PTR_ERR_OR_ZERO(trig->nd_config);
  9077. if (err)
  9078. trig->nd_config = NULL;
  9079. out:
  9080. kfree(tb);
  9081. return err;
  9082. }
  9083. static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
  9084. {
  9085. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9086. struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
  9087. struct cfg80211_wowlan new_triggers = {};
  9088. struct cfg80211_wowlan *ntrig;
  9089. const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
  9090. int err, i;
  9091. bool prev_enabled = rdev->wiphy.wowlan_config;
  9092. bool regular = false;
  9093. if (!wowlan)
  9094. return -EOPNOTSUPP;
  9095. if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
  9096. cfg80211_rdev_free_wowlan(rdev);
  9097. rdev->wiphy.wowlan_config = NULL;
  9098. goto set_wakeup;
  9099. }
  9100. err = nla_parse_nested(tb, MAX_NL80211_WOWLAN_TRIG,
  9101. info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
  9102. nl80211_wowlan_policy, info->extack);
  9103. if (err)
  9104. return err;
  9105. if (tb[NL80211_WOWLAN_TRIG_ANY]) {
  9106. if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
  9107. return -EINVAL;
  9108. new_triggers.any = true;
  9109. }
  9110. if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
  9111. if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
  9112. return -EINVAL;
  9113. new_triggers.disconnect = true;
  9114. regular = true;
  9115. }
  9116. if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
  9117. if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
  9118. return -EINVAL;
  9119. new_triggers.magic_pkt = true;
  9120. regular = true;
  9121. }
  9122. if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
  9123. return -EINVAL;
  9124. if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
  9125. if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
  9126. return -EINVAL;
  9127. new_triggers.gtk_rekey_failure = true;
  9128. regular = true;
  9129. }
  9130. if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
  9131. if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
  9132. return -EINVAL;
  9133. new_triggers.eap_identity_req = true;
  9134. regular = true;
  9135. }
  9136. if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
  9137. if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
  9138. return -EINVAL;
  9139. new_triggers.four_way_handshake = true;
  9140. regular = true;
  9141. }
  9142. if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
  9143. if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
  9144. return -EINVAL;
  9145. new_triggers.rfkill_release = true;
  9146. regular = true;
  9147. }
  9148. if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
  9149. struct nlattr *pat;
  9150. int n_patterns = 0;
  9151. int rem, pat_len, mask_len, pkt_offset;
  9152. struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
  9153. regular = true;
  9154. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  9155. rem)
  9156. n_patterns++;
  9157. if (n_patterns > wowlan->n_patterns)
  9158. return -EINVAL;
  9159. new_triggers.patterns = kcalloc(n_patterns,
  9160. sizeof(new_triggers.patterns[0]),
  9161. GFP_KERNEL);
  9162. if (!new_triggers.patterns)
  9163. return -ENOMEM;
  9164. new_triggers.n_patterns = n_patterns;
  9165. i = 0;
  9166. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  9167. rem) {
  9168. u8 *mask_pat;
  9169. nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
  9170. nl80211_packet_pattern_policy,
  9171. info->extack);
  9172. err = -EINVAL;
  9173. if (!pat_tb[NL80211_PKTPAT_MASK] ||
  9174. !pat_tb[NL80211_PKTPAT_PATTERN])
  9175. goto error;
  9176. pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
  9177. mask_len = DIV_ROUND_UP(pat_len, 8);
  9178. if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
  9179. goto error;
  9180. if (pat_len > wowlan->pattern_max_len ||
  9181. pat_len < wowlan->pattern_min_len)
  9182. goto error;
  9183. if (!pat_tb[NL80211_PKTPAT_OFFSET])
  9184. pkt_offset = 0;
  9185. else
  9186. pkt_offset = nla_get_u32(
  9187. pat_tb[NL80211_PKTPAT_OFFSET]);
  9188. if (pkt_offset > wowlan->max_pkt_offset)
  9189. goto error;
  9190. new_triggers.patterns[i].pkt_offset = pkt_offset;
  9191. mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
  9192. if (!mask_pat) {
  9193. err = -ENOMEM;
  9194. goto error;
  9195. }
  9196. new_triggers.patterns[i].mask = mask_pat;
  9197. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
  9198. mask_len);
  9199. mask_pat += mask_len;
  9200. new_triggers.patterns[i].pattern = mask_pat;
  9201. new_triggers.patterns[i].pattern_len = pat_len;
  9202. memcpy(mask_pat,
  9203. nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
  9204. pat_len);
  9205. i++;
  9206. }
  9207. }
  9208. if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
  9209. regular = true;
  9210. err = nl80211_parse_wowlan_tcp(
  9211. rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
  9212. &new_triggers);
  9213. if (err)
  9214. goto error;
  9215. }
  9216. if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
  9217. regular = true;
  9218. err = nl80211_parse_wowlan_nd(
  9219. rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
  9220. &new_triggers);
  9221. if (err)
  9222. goto error;
  9223. }
  9224. /* The 'any' trigger means the device continues operating more or less
  9225. * as in its normal operation mode and wakes up the host on most of the
  9226. * normal interrupts (like packet RX, ...)
  9227. * It therefore makes little sense to combine with the more constrained
  9228. * wakeup trigger modes.
  9229. */
  9230. if (new_triggers.any && regular) {
  9231. err = -EINVAL;
  9232. goto error;
  9233. }
  9234. ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
  9235. if (!ntrig) {
  9236. err = -ENOMEM;
  9237. goto error;
  9238. }
  9239. cfg80211_rdev_free_wowlan(rdev);
  9240. rdev->wiphy.wowlan_config = ntrig;
  9241. set_wakeup:
  9242. if (rdev->ops->set_wakeup &&
  9243. prev_enabled != !!rdev->wiphy.wowlan_config)
  9244. rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
  9245. return 0;
  9246. error:
  9247. for (i = 0; i < new_triggers.n_patterns; i++)
  9248. kfree(new_triggers.patterns[i].mask);
  9249. kfree(new_triggers.patterns);
  9250. if (new_triggers.tcp && new_triggers.tcp->sock)
  9251. sock_release(new_triggers.tcp->sock);
  9252. kfree(new_triggers.tcp);
  9253. kfree(new_triggers.nd_config);
  9254. return err;
  9255. }
  9256. #endif
  9257. static int nl80211_send_coalesce_rules(struct sk_buff *msg,
  9258. struct cfg80211_registered_device *rdev)
  9259. {
  9260. struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
  9261. int i, j, pat_len;
  9262. struct cfg80211_coalesce_rules *rule;
  9263. if (!rdev->coalesce->n_rules)
  9264. return 0;
  9265. nl_rules = nla_nest_start(msg, NL80211_ATTR_COALESCE_RULE);
  9266. if (!nl_rules)
  9267. return -ENOBUFS;
  9268. for (i = 0; i < rdev->coalesce->n_rules; i++) {
  9269. nl_rule = nla_nest_start(msg, i + 1);
  9270. if (!nl_rule)
  9271. return -ENOBUFS;
  9272. rule = &rdev->coalesce->rules[i];
  9273. if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
  9274. rule->delay))
  9275. return -ENOBUFS;
  9276. if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
  9277. rule->condition))
  9278. return -ENOBUFS;
  9279. nl_pats = nla_nest_start(msg,
  9280. NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
  9281. if (!nl_pats)
  9282. return -ENOBUFS;
  9283. for (j = 0; j < rule->n_patterns; j++) {
  9284. nl_pat = nla_nest_start(msg, j + 1);
  9285. if (!nl_pat)
  9286. return -ENOBUFS;
  9287. pat_len = rule->patterns[j].pattern_len;
  9288. if (nla_put(msg, NL80211_PKTPAT_MASK,
  9289. DIV_ROUND_UP(pat_len, 8),
  9290. rule->patterns[j].mask) ||
  9291. nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
  9292. rule->patterns[j].pattern) ||
  9293. nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
  9294. rule->patterns[j].pkt_offset))
  9295. return -ENOBUFS;
  9296. nla_nest_end(msg, nl_pat);
  9297. }
  9298. nla_nest_end(msg, nl_pats);
  9299. nla_nest_end(msg, nl_rule);
  9300. }
  9301. nla_nest_end(msg, nl_rules);
  9302. return 0;
  9303. }
  9304. static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
  9305. {
  9306. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9307. struct sk_buff *msg;
  9308. void *hdr;
  9309. if (!rdev->wiphy.coalesce)
  9310. return -EOPNOTSUPP;
  9311. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  9312. if (!msg)
  9313. return -ENOMEM;
  9314. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  9315. NL80211_CMD_GET_COALESCE);
  9316. if (!hdr)
  9317. goto nla_put_failure;
  9318. if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
  9319. goto nla_put_failure;
  9320. genlmsg_end(msg, hdr);
  9321. return genlmsg_reply(msg, info);
  9322. nla_put_failure:
  9323. nlmsg_free(msg);
  9324. return -ENOBUFS;
  9325. }
  9326. void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
  9327. {
  9328. struct cfg80211_coalesce *coalesce = rdev->coalesce;
  9329. int i, j;
  9330. struct cfg80211_coalesce_rules *rule;
  9331. if (!coalesce)
  9332. return;
  9333. for (i = 0; i < coalesce->n_rules; i++) {
  9334. rule = &coalesce->rules[i];
  9335. for (j = 0; j < rule->n_patterns; j++)
  9336. kfree(rule->patterns[j].mask);
  9337. kfree(rule->patterns);
  9338. }
  9339. kfree(coalesce->rules);
  9340. kfree(coalesce);
  9341. rdev->coalesce = NULL;
  9342. }
  9343. static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
  9344. struct nlattr *rule,
  9345. struct cfg80211_coalesce_rules *new_rule)
  9346. {
  9347. int err, i;
  9348. const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
  9349. struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
  9350. int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
  9351. struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
  9352. err = nla_parse_nested(tb, NL80211_ATTR_COALESCE_RULE_MAX, rule,
  9353. nl80211_coalesce_policy, NULL);
  9354. if (err)
  9355. return err;
  9356. if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
  9357. new_rule->delay =
  9358. nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
  9359. if (new_rule->delay > coalesce->max_delay)
  9360. return -EINVAL;
  9361. if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
  9362. new_rule->condition =
  9363. nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
  9364. if (new_rule->condition != NL80211_COALESCE_CONDITION_MATCH &&
  9365. new_rule->condition != NL80211_COALESCE_CONDITION_NO_MATCH)
  9366. return -EINVAL;
  9367. if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
  9368. return -EINVAL;
  9369. nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
  9370. rem)
  9371. n_patterns++;
  9372. if (n_patterns > coalesce->n_patterns)
  9373. return -EINVAL;
  9374. new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
  9375. GFP_KERNEL);
  9376. if (!new_rule->patterns)
  9377. return -ENOMEM;
  9378. new_rule->n_patterns = n_patterns;
  9379. i = 0;
  9380. nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
  9381. rem) {
  9382. u8 *mask_pat;
  9383. nla_parse_nested(pat_tb, MAX_NL80211_PKTPAT, pat,
  9384. nl80211_packet_pattern_policy, NULL);
  9385. if (!pat_tb[NL80211_PKTPAT_MASK] ||
  9386. !pat_tb[NL80211_PKTPAT_PATTERN])
  9387. return -EINVAL;
  9388. pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
  9389. mask_len = DIV_ROUND_UP(pat_len, 8);
  9390. if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
  9391. return -EINVAL;
  9392. if (pat_len > coalesce->pattern_max_len ||
  9393. pat_len < coalesce->pattern_min_len)
  9394. return -EINVAL;
  9395. if (!pat_tb[NL80211_PKTPAT_OFFSET])
  9396. pkt_offset = 0;
  9397. else
  9398. pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
  9399. if (pkt_offset > coalesce->max_pkt_offset)
  9400. return -EINVAL;
  9401. new_rule->patterns[i].pkt_offset = pkt_offset;
  9402. mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
  9403. if (!mask_pat)
  9404. return -ENOMEM;
  9405. new_rule->patterns[i].mask = mask_pat;
  9406. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
  9407. mask_len);
  9408. mask_pat += mask_len;
  9409. new_rule->patterns[i].pattern = mask_pat;
  9410. new_rule->patterns[i].pattern_len = pat_len;
  9411. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
  9412. pat_len);
  9413. i++;
  9414. }
  9415. return 0;
  9416. }
  9417. static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
  9418. {
  9419. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9420. const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
  9421. struct cfg80211_coalesce new_coalesce = {};
  9422. struct cfg80211_coalesce *n_coalesce;
  9423. int err, rem_rule, n_rules = 0, i, j;
  9424. struct nlattr *rule;
  9425. struct cfg80211_coalesce_rules *tmp_rule;
  9426. if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
  9427. return -EOPNOTSUPP;
  9428. if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
  9429. cfg80211_rdev_free_coalesce(rdev);
  9430. rdev_set_coalesce(rdev, NULL);
  9431. return 0;
  9432. }
  9433. nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
  9434. rem_rule)
  9435. n_rules++;
  9436. if (n_rules > coalesce->n_rules)
  9437. return -EINVAL;
  9438. new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
  9439. GFP_KERNEL);
  9440. if (!new_coalesce.rules)
  9441. return -ENOMEM;
  9442. new_coalesce.n_rules = n_rules;
  9443. i = 0;
  9444. nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
  9445. rem_rule) {
  9446. err = nl80211_parse_coalesce_rule(rdev, rule,
  9447. &new_coalesce.rules[i]);
  9448. if (err)
  9449. goto error;
  9450. i++;
  9451. }
  9452. err = rdev_set_coalesce(rdev, &new_coalesce);
  9453. if (err)
  9454. goto error;
  9455. n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
  9456. if (!n_coalesce) {
  9457. err = -ENOMEM;
  9458. goto error;
  9459. }
  9460. cfg80211_rdev_free_coalesce(rdev);
  9461. rdev->coalesce = n_coalesce;
  9462. return 0;
  9463. error:
  9464. for (i = 0; i < new_coalesce.n_rules; i++) {
  9465. tmp_rule = &new_coalesce.rules[i];
  9466. for (j = 0; j < tmp_rule->n_patterns; j++)
  9467. kfree(tmp_rule->patterns[j].mask);
  9468. kfree(tmp_rule->patterns);
  9469. }
  9470. kfree(new_coalesce.rules);
  9471. return err;
  9472. }
  9473. static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
  9474. {
  9475. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9476. struct net_device *dev = info->user_ptr[1];
  9477. struct wireless_dev *wdev = dev->ieee80211_ptr;
  9478. struct nlattr *tb[NUM_NL80211_REKEY_DATA];
  9479. struct cfg80211_gtk_rekey_data rekey_data;
  9480. int err;
  9481. if (!info->attrs[NL80211_ATTR_REKEY_DATA])
  9482. return -EINVAL;
  9483. err = nla_parse_nested(tb, MAX_NL80211_REKEY_DATA,
  9484. info->attrs[NL80211_ATTR_REKEY_DATA],
  9485. nl80211_rekey_policy, info->extack);
  9486. if (err)
  9487. return err;
  9488. if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
  9489. !tb[NL80211_REKEY_DATA_KCK])
  9490. return -EINVAL;
  9491. if (nla_len(tb[NL80211_REKEY_DATA_REPLAY_CTR]) != NL80211_REPLAY_CTR_LEN)
  9492. return -ERANGE;
  9493. if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN)
  9494. return -ERANGE;
  9495. if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN)
  9496. return -ERANGE;
  9497. rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
  9498. rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
  9499. rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
  9500. wdev_lock(wdev);
  9501. if (!wdev->current_bss) {
  9502. err = -ENOTCONN;
  9503. goto out;
  9504. }
  9505. if (!rdev->ops->set_rekey_data) {
  9506. err = -EOPNOTSUPP;
  9507. goto out;
  9508. }
  9509. err = rdev_set_rekey_data(rdev, dev, &rekey_data);
  9510. out:
  9511. wdev_unlock(wdev);
  9512. return err;
  9513. }
  9514. static int nl80211_register_unexpected_frame(struct sk_buff *skb,
  9515. struct genl_info *info)
  9516. {
  9517. struct net_device *dev = info->user_ptr[1];
  9518. struct wireless_dev *wdev = dev->ieee80211_ptr;
  9519. if (wdev->iftype != NL80211_IFTYPE_AP &&
  9520. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  9521. return -EINVAL;
  9522. if (wdev->ap_unexpected_nlportid)
  9523. return -EBUSY;
  9524. wdev->ap_unexpected_nlportid = info->snd_portid;
  9525. return 0;
  9526. }
  9527. static int nl80211_probe_client(struct sk_buff *skb,
  9528. struct genl_info *info)
  9529. {
  9530. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9531. struct net_device *dev = info->user_ptr[1];
  9532. struct wireless_dev *wdev = dev->ieee80211_ptr;
  9533. struct sk_buff *msg;
  9534. void *hdr;
  9535. const u8 *addr;
  9536. u64 cookie;
  9537. int err;
  9538. if (wdev->iftype != NL80211_IFTYPE_AP &&
  9539. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  9540. return -EOPNOTSUPP;
  9541. if (!info->attrs[NL80211_ATTR_MAC])
  9542. return -EINVAL;
  9543. if (!rdev->ops->probe_client)
  9544. return -EOPNOTSUPP;
  9545. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  9546. if (!msg)
  9547. return -ENOMEM;
  9548. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  9549. NL80211_CMD_PROBE_CLIENT);
  9550. if (!hdr) {
  9551. err = -ENOBUFS;
  9552. goto free_msg;
  9553. }
  9554. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9555. err = rdev_probe_client(rdev, dev, addr, &cookie);
  9556. if (err)
  9557. goto free_msg;
  9558. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  9559. NL80211_ATTR_PAD))
  9560. goto nla_put_failure;
  9561. genlmsg_end(msg, hdr);
  9562. return genlmsg_reply(msg, info);
  9563. nla_put_failure:
  9564. err = -ENOBUFS;
  9565. free_msg:
  9566. nlmsg_free(msg);
  9567. return err;
  9568. }
  9569. static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
  9570. {
  9571. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9572. struct cfg80211_beacon_registration *reg, *nreg;
  9573. int rv;
  9574. if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
  9575. return -EOPNOTSUPP;
  9576. nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
  9577. if (!nreg)
  9578. return -ENOMEM;
  9579. /* First, check if already registered. */
  9580. spin_lock_bh(&rdev->beacon_registrations_lock);
  9581. list_for_each_entry(reg, &rdev->beacon_registrations, list) {
  9582. if (reg->nlportid == info->snd_portid) {
  9583. rv = -EALREADY;
  9584. goto out_err;
  9585. }
  9586. }
  9587. /* Add it to the list */
  9588. nreg->nlportid = info->snd_portid;
  9589. list_add(&nreg->list, &rdev->beacon_registrations);
  9590. spin_unlock_bh(&rdev->beacon_registrations_lock);
  9591. return 0;
  9592. out_err:
  9593. spin_unlock_bh(&rdev->beacon_registrations_lock);
  9594. kfree(nreg);
  9595. return rv;
  9596. }
  9597. static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
  9598. {
  9599. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9600. struct wireless_dev *wdev = info->user_ptr[1];
  9601. int err;
  9602. if (!rdev->ops->start_p2p_device)
  9603. return -EOPNOTSUPP;
  9604. if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
  9605. return -EOPNOTSUPP;
  9606. if (wdev_running(wdev))
  9607. return 0;
  9608. if (rfkill_blocked(rdev->rfkill))
  9609. return -ERFKILL;
  9610. err = rdev_start_p2p_device(rdev, wdev);
  9611. if (err)
  9612. return err;
  9613. wdev->is_running = true;
  9614. rdev->opencount++;
  9615. return 0;
  9616. }
  9617. static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
  9618. {
  9619. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9620. struct wireless_dev *wdev = info->user_ptr[1];
  9621. if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
  9622. return -EOPNOTSUPP;
  9623. if (!rdev->ops->stop_p2p_device)
  9624. return -EOPNOTSUPP;
  9625. cfg80211_stop_p2p_device(rdev, wdev);
  9626. return 0;
  9627. }
  9628. static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
  9629. {
  9630. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9631. struct wireless_dev *wdev = info->user_ptr[1];
  9632. struct cfg80211_nan_conf conf = {};
  9633. int err;
  9634. if (wdev->iftype != NL80211_IFTYPE_NAN)
  9635. return -EOPNOTSUPP;
  9636. if (wdev_running(wdev))
  9637. return -EEXIST;
  9638. if (rfkill_blocked(rdev->rfkill))
  9639. return -ERFKILL;
  9640. if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
  9641. return -EINVAL;
  9642. conf.master_pref =
  9643. nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
  9644. if (!conf.master_pref)
  9645. return -EINVAL;
  9646. if (info->attrs[NL80211_ATTR_BANDS]) {
  9647. u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
  9648. if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
  9649. return -EOPNOTSUPP;
  9650. if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
  9651. return -EINVAL;
  9652. conf.bands = bands;
  9653. }
  9654. err = rdev_start_nan(rdev, wdev, &conf);
  9655. if (err)
  9656. return err;
  9657. wdev->is_running = true;
  9658. rdev->opencount++;
  9659. return 0;
  9660. }
  9661. static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
  9662. {
  9663. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9664. struct wireless_dev *wdev = info->user_ptr[1];
  9665. if (wdev->iftype != NL80211_IFTYPE_NAN)
  9666. return -EOPNOTSUPP;
  9667. cfg80211_stop_nan(rdev, wdev);
  9668. return 0;
  9669. }
  9670. static int validate_nan_filter(struct nlattr *filter_attr)
  9671. {
  9672. struct nlattr *attr;
  9673. int len = 0, n_entries = 0, rem;
  9674. nla_for_each_nested(attr, filter_attr, rem) {
  9675. len += nla_len(attr);
  9676. n_entries++;
  9677. }
  9678. if (len >= U8_MAX)
  9679. return -EINVAL;
  9680. return n_entries;
  9681. }
  9682. static int handle_nan_filter(struct nlattr *attr_filter,
  9683. struct cfg80211_nan_func *func,
  9684. bool tx)
  9685. {
  9686. struct nlattr *attr;
  9687. int n_entries, rem, i;
  9688. struct cfg80211_nan_func_filter *filter;
  9689. n_entries = validate_nan_filter(attr_filter);
  9690. if (n_entries < 0)
  9691. return n_entries;
  9692. BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
  9693. filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
  9694. if (!filter)
  9695. return -ENOMEM;
  9696. i = 0;
  9697. nla_for_each_nested(attr, attr_filter, rem) {
  9698. filter[i].filter = nla_memdup(attr, GFP_KERNEL);
  9699. filter[i].len = nla_len(attr);
  9700. i++;
  9701. }
  9702. if (tx) {
  9703. func->num_tx_filters = n_entries;
  9704. func->tx_filters = filter;
  9705. } else {
  9706. func->num_rx_filters = n_entries;
  9707. func->rx_filters = filter;
  9708. }
  9709. return 0;
  9710. }
  9711. static int nl80211_nan_add_func(struct sk_buff *skb,
  9712. struct genl_info *info)
  9713. {
  9714. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9715. struct wireless_dev *wdev = info->user_ptr[1];
  9716. struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
  9717. struct cfg80211_nan_func *func;
  9718. struct sk_buff *msg = NULL;
  9719. void *hdr = NULL;
  9720. int err = 0;
  9721. if (wdev->iftype != NL80211_IFTYPE_NAN)
  9722. return -EOPNOTSUPP;
  9723. if (!wdev_running(wdev))
  9724. return -ENOTCONN;
  9725. if (!info->attrs[NL80211_ATTR_NAN_FUNC])
  9726. return -EINVAL;
  9727. err = nla_parse_nested(tb, NL80211_NAN_FUNC_ATTR_MAX,
  9728. info->attrs[NL80211_ATTR_NAN_FUNC],
  9729. nl80211_nan_func_policy, info->extack);
  9730. if (err)
  9731. return err;
  9732. func = kzalloc(sizeof(*func), GFP_KERNEL);
  9733. if (!func)
  9734. return -ENOMEM;
  9735. func->cookie = wdev->wiphy->cookie_counter++;
  9736. if (!tb[NL80211_NAN_FUNC_TYPE] ||
  9737. nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]) > NL80211_NAN_FUNC_MAX_TYPE) {
  9738. err = -EINVAL;
  9739. goto out;
  9740. }
  9741. func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
  9742. if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
  9743. err = -EINVAL;
  9744. goto out;
  9745. }
  9746. memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
  9747. sizeof(func->service_id));
  9748. func->close_range =
  9749. nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
  9750. if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
  9751. func->serv_spec_info_len =
  9752. nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
  9753. func->serv_spec_info =
  9754. kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
  9755. func->serv_spec_info_len,
  9756. GFP_KERNEL);
  9757. if (!func->serv_spec_info) {
  9758. err = -ENOMEM;
  9759. goto out;
  9760. }
  9761. }
  9762. if (tb[NL80211_NAN_FUNC_TTL])
  9763. func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
  9764. switch (func->type) {
  9765. case NL80211_NAN_FUNC_PUBLISH:
  9766. if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
  9767. err = -EINVAL;
  9768. goto out;
  9769. }
  9770. func->publish_type =
  9771. nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
  9772. func->publish_bcast =
  9773. nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
  9774. if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
  9775. func->publish_bcast) {
  9776. err = -EINVAL;
  9777. goto out;
  9778. }
  9779. break;
  9780. case NL80211_NAN_FUNC_SUBSCRIBE:
  9781. func->subscribe_active =
  9782. nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
  9783. break;
  9784. case NL80211_NAN_FUNC_FOLLOW_UP:
  9785. if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
  9786. !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
  9787. !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
  9788. err = -EINVAL;
  9789. goto out;
  9790. }
  9791. func->followup_id =
  9792. nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
  9793. func->followup_reqid =
  9794. nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
  9795. memcpy(func->followup_dest.addr,
  9796. nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
  9797. sizeof(func->followup_dest.addr));
  9798. if (func->ttl) {
  9799. err = -EINVAL;
  9800. goto out;
  9801. }
  9802. break;
  9803. default:
  9804. err = -EINVAL;
  9805. goto out;
  9806. }
  9807. if (tb[NL80211_NAN_FUNC_SRF]) {
  9808. struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
  9809. err = nla_parse_nested(srf_tb, NL80211_NAN_SRF_ATTR_MAX,
  9810. tb[NL80211_NAN_FUNC_SRF],
  9811. nl80211_nan_srf_policy, info->extack);
  9812. if (err)
  9813. goto out;
  9814. func->srf_include =
  9815. nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
  9816. if (srf_tb[NL80211_NAN_SRF_BF]) {
  9817. if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
  9818. !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
  9819. err = -EINVAL;
  9820. goto out;
  9821. }
  9822. func->srf_bf_len =
  9823. nla_len(srf_tb[NL80211_NAN_SRF_BF]);
  9824. func->srf_bf =
  9825. kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
  9826. func->srf_bf_len, GFP_KERNEL);
  9827. if (!func->srf_bf) {
  9828. err = -ENOMEM;
  9829. goto out;
  9830. }
  9831. func->srf_bf_idx =
  9832. nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
  9833. } else {
  9834. struct nlattr *attr, *mac_attr =
  9835. srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
  9836. int n_entries, rem, i = 0;
  9837. if (!mac_attr) {
  9838. err = -EINVAL;
  9839. goto out;
  9840. }
  9841. n_entries = validate_acl_mac_addrs(mac_attr);
  9842. if (n_entries <= 0) {
  9843. err = -EINVAL;
  9844. goto out;
  9845. }
  9846. func->srf_num_macs = n_entries;
  9847. func->srf_macs =
  9848. kcalloc(n_entries, sizeof(*func->srf_macs),
  9849. GFP_KERNEL);
  9850. if (!func->srf_macs) {
  9851. err = -ENOMEM;
  9852. goto out;
  9853. }
  9854. nla_for_each_nested(attr, mac_attr, rem)
  9855. memcpy(func->srf_macs[i++].addr, nla_data(attr),
  9856. sizeof(*func->srf_macs));
  9857. }
  9858. }
  9859. if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
  9860. err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
  9861. func, true);
  9862. if (err)
  9863. goto out;
  9864. }
  9865. if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
  9866. err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
  9867. func, false);
  9868. if (err)
  9869. goto out;
  9870. }
  9871. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  9872. if (!msg) {
  9873. err = -ENOMEM;
  9874. goto out;
  9875. }
  9876. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  9877. NL80211_CMD_ADD_NAN_FUNCTION);
  9878. /* This can't really happen - we just allocated 4KB */
  9879. if (WARN_ON(!hdr)) {
  9880. err = -ENOMEM;
  9881. goto out;
  9882. }
  9883. err = rdev_add_nan_func(rdev, wdev, func);
  9884. out:
  9885. if (err < 0) {
  9886. cfg80211_free_nan_func(func);
  9887. nlmsg_free(msg);
  9888. return err;
  9889. }
  9890. /* propagate the instance id and cookie to userspace */
  9891. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
  9892. NL80211_ATTR_PAD))
  9893. goto nla_put_failure;
  9894. func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
  9895. if (!func_attr)
  9896. goto nla_put_failure;
  9897. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
  9898. func->instance_id))
  9899. goto nla_put_failure;
  9900. nla_nest_end(msg, func_attr);
  9901. genlmsg_end(msg, hdr);
  9902. return genlmsg_reply(msg, info);
  9903. nla_put_failure:
  9904. nlmsg_free(msg);
  9905. return -ENOBUFS;
  9906. }
  9907. static int nl80211_nan_del_func(struct sk_buff *skb,
  9908. struct genl_info *info)
  9909. {
  9910. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9911. struct wireless_dev *wdev = info->user_ptr[1];
  9912. u64 cookie;
  9913. if (wdev->iftype != NL80211_IFTYPE_NAN)
  9914. return -EOPNOTSUPP;
  9915. if (!wdev_running(wdev))
  9916. return -ENOTCONN;
  9917. if (!info->attrs[NL80211_ATTR_COOKIE])
  9918. return -EINVAL;
  9919. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  9920. rdev_del_nan_func(rdev, wdev, cookie);
  9921. return 0;
  9922. }
  9923. static int nl80211_nan_change_config(struct sk_buff *skb,
  9924. struct genl_info *info)
  9925. {
  9926. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9927. struct wireless_dev *wdev = info->user_ptr[1];
  9928. struct cfg80211_nan_conf conf = {};
  9929. u32 changed = 0;
  9930. if (wdev->iftype != NL80211_IFTYPE_NAN)
  9931. return -EOPNOTSUPP;
  9932. if (!wdev_running(wdev))
  9933. return -ENOTCONN;
  9934. if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
  9935. conf.master_pref =
  9936. nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
  9937. if (conf.master_pref <= 1 || conf.master_pref == 255)
  9938. return -EINVAL;
  9939. changed |= CFG80211_NAN_CONF_CHANGED_PREF;
  9940. }
  9941. if (info->attrs[NL80211_ATTR_BANDS]) {
  9942. u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
  9943. if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
  9944. return -EOPNOTSUPP;
  9945. if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
  9946. return -EINVAL;
  9947. conf.bands = bands;
  9948. changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
  9949. }
  9950. if (!changed)
  9951. return -EINVAL;
  9952. return rdev_nan_change_conf(rdev, wdev, &conf, changed);
  9953. }
  9954. void cfg80211_nan_match(struct wireless_dev *wdev,
  9955. struct cfg80211_nan_match_params *match, gfp_t gfp)
  9956. {
  9957. struct wiphy *wiphy = wdev->wiphy;
  9958. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  9959. struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
  9960. struct sk_buff *msg;
  9961. void *hdr;
  9962. if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
  9963. return;
  9964. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  9965. if (!msg)
  9966. return;
  9967. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
  9968. if (!hdr) {
  9969. nlmsg_free(msg);
  9970. return;
  9971. }
  9972. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  9973. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  9974. wdev->netdev->ifindex)) ||
  9975. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  9976. NL80211_ATTR_PAD))
  9977. goto nla_put_failure;
  9978. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
  9979. NL80211_ATTR_PAD) ||
  9980. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
  9981. goto nla_put_failure;
  9982. match_attr = nla_nest_start(msg, NL80211_ATTR_NAN_MATCH);
  9983. if (!match_attr)
  9984. goto nla_put_failure;
  9985. local_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_LOCAL);
  9986. if (!local_func_attr)
  9987. goto nla_put_failure;
  9988. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
  9989. goto nla_put_failure;
  9990. nla_nest_end(msg, local_func_attr);
  9991. peer_func_attr = nla_nest_start(msg, NL80211_NAN_MATCH_FUNC_PEER);
  9992. if (!peer_func_attr)
  9993. goto nla_put_failure;
  9994. if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
  9995. nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
  9996. goto nla_put_failure;
  9997. if (match->info && match->info_len &&
  9998. nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
  9999. match->info))
  10000. goto nla_put_failure;
  10001. nla_nest_end(msg, peer_func_attr);
  10002. nla_nest_end(msg, match_attr);
  10003. genlmsg_end(msg, hdr);
  10004. if (!wdev->owner_nlportid)
  10005. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  10006. msg, 0, NL80211_MCGRP_NAN, gfp);
  10007. else
  10008. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  10009. wdev->owner_nlportid);
  10010. return;
  10011. nla_put_failure:
  10012. nlmsg_free(msg);
  10013. }
  10014. EXPORT_SYMBOL(cfg80211_nan_match);
  10015. void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
  10016. u8 inst_id,
  10017. enum nl80211_nan_func_term_reason reason,
  10018. u64 cookie, gfp_t gfp)
  10019. {
  10020. struct wiphy *wiphy = wdev->wiphy;
  10021. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  10022. struct sk_buff *msg;
  10023. struct nlattr *func_attr;
  10024. void *hdr;
  10025. if (WARN_ON(!inst_id))
  10026. return;
  10027. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  10028. if (!msg)
  10029. return;
  10030. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
  10031. if (!hdr) {
  10032. nlmsg_free(msg);
  10033. return;
  10034. }
  10035. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  10036. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  10037. wdev->netdev->ifindex)) ||
  10038. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  10039. NL80211_ATTR_PAD))
  10040. goto nla_put_failure;
  10041. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  10042. NL80211_ATTR_PAD))
  10043. goto nla_put_failure;
  10044. func_attr = nla_nest_start(msg, NL80211_ATTR_NAN_FUNC);
  10045. if (!func_attr)
  10046. goto nla_put_failure;
  10047. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
  10048. nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
  10049. goto nla_put_failure;
  10050. nla_nest_end(msg, func_attr);
  10051. genlmsg_end(msg, hdr);
  10052. if (!wdev->owner_nlportid)
  10053. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  10054. msg, 0, NL80211_MCGRP_NAN, gfp);
  10055. else
  10056. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  10057. wdev->owner_nlportid);
  10058. return;
  10059. nla_put_failure:
  10060. nlmsg_free(msg);
  10061. }
  10062. EXPORT_SYMBOL(cfg80211_nan_func_terminated);
  10063. static int nl80211_get_protocol_features(struct sk_buff *skb,
  10064. struct genl_info *info)
  10065. {
  10066. void *hdr;
  10067. struct sk_buff *msg;
  10068. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  10069. if (!msg)
  10070. return -ENOMEM;
  10071. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  10072. NL80211_CMD_GET_PROTOCOL_FEATURES);
  10073. if (!hdr)
  10074. goto nla_put_failure;
  10075. if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
  10076. NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
  10077. goto nla_put_failure;
  10078. genlmsg_end(msg, hdr);
  10079. return genlmsg_reply(msg, info);
  10080. nla_put_failure:
  10081. kfree_skb(msg);
  10082. return -ENOBUFS;
  10083. }
  10084. static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
  10085. {
  10086. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10087. struct cfg80211_update_ft_ies_params ft_params;
  10088. struct net_device *dev = info->user_ptr[1];
  10089. if (!rdev->ops->update_ft_ies)
  10090. return -EOPNOTSUPP;
  10091. if (!info->attrs[NL80211_ATTR_MDID] ||
  10092. !is_valid_ie_attr(info->attrs[NL80211_ATTR_IE]))
  10093. return -EINVAL;
  10094. memset(&ft_params, 0, sizeof(ft_params));
  10095. ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
  10096. ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  10097. ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  10098. return rdev_update_ft_ies(rdev, dev, &ft_params);
  10099. }
  10100. static int nl80211_crit_protocol_start(struct sk_buff *skb,
  10101. struct genl_info *info)
  10102. {
  10103. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10104. struct wireless_dev *wdev = info->user_ptr[1];
  10105. enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
  10106. u16 duration;
  10107. int ret;
  10108. if (!rdev->ops->crit_proto_start)
  10109. return -EOPNOTSUPP;
  10110. if (WARN_ON(!rdev->ops->crit_proto_stop))
  10111. return -EINVAL;
  10112. if (rdev->crit_proto_nlportid)
  10113. return -EBUSY;
  10114. /* determine protocol if provided */
  10115. if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
  10116. proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
  10117. if (proto >= NUM_NL80211_CRIT_PROTO)
  10118. return -EINVAL;
  10119. /* timeout must be provided */
  10120. if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
  10121. return -EINVAL;
  10122. duration =
  10123. nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
  10124. if (duration > NL80211_CRIT_PROTO_MAX_DURATION)
  10125. return -ERANGE;
  10126. ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
  10127. if (!ret)
  10128. rdev->crit_proto_nlportid = info->snd_portid;
  10129. return ret;
  10130. }
  10131. static int nl80211_crit_protocol_stop(struct sk_buff *skb,
  10132. struct genl_info *info)
  10133. {
  10134. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10135. struct wireless_dev *wdev = info->user_ptr[1];
  10136. if (!rdev->ops->crit_proto_stop)
  10137. return -EOPNOTSUPP;
  10138. if (rdev->crit_proto_nlportid) {
  10139. rdev->crit_proto_nlportid = 0;
  10140. rdev_crit_proto_stop(rdev, wdev);
  10141. }
  10142. return 0;
  10143. }
  10144. static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
  10145. {
  10146. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10147. struct wireless_dev *wdev =
  10148. __cfg80211_wdev_from_attrs(genl_info_net(info), info->attrs);
  10149. int i, err;
  10150. u32 vid, subcmd;
  10151. if (!rdev->wiphy.vendor_commands)
  10152. return -EOPNOTSUPP;
  10153. if (IS_ERR(wdev)) {
  10154. err = PTR_ERR(wdev);
  10155. if (err != -EINVAL)
  10156. return err;
  10157. wdev = NULL;
  10158. } else if (wdev->wiphy != &rdev->wiphy) {
  10159. return -EINVAL;
  10160. }
  10161. if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
  10162. !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
  10163. return -EINVAL;
  10164. vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
  10165. subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
  10166. for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
  10167. const struct wiphy_vendor_command *vcmd;
  10168. void *data = NULL;
  10169. int len = 0;
  10170. vcmd = &rdev->wiphy.vendor_commands[i];
  10171. if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
  10172. continue;
  10173. if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
  10174. WIPHY_VENDOR_CMD_NEED_NETDEV)) {
  10175. if (!wdev)
  10176. return -EINVAL;
  10177. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
  10178. !wdev->netdev)
  10179. return -EINVAL;
  10180. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
  10181. if (!wdev_running(wdev))
  10182. return -ENETDOWN;
  10183. }
  10184. if (!vcmd->doit)
  10185. return -EOPNOTSUPP;
  10186. } else {
  10187. wdev = NULL;
  10188. }
  10189. if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
  10190. data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
  10191. len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
  10192. }
  10193. rdev->cur_cmd_info = info;
  10194. err = rdev->wiphy.vendor_commands[i].doit(&rdev->wiphy, wdev,
  10195. data, len);
  10196. rdev->cur_cmd_info = NULL;
  10197. return err;
  10198. }
  10199. return -EOPNOTSUPP;
  10200. }
  10201. static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
  10202. struct netlink_callback *cb,
  10203. struct cfg80211_registered_device **rdev,
  10204. struct wireless_dev **wdev)
  10205. {
  10206. struct nlattr **attrbuf = genl_family_attrbuf(&nl80211_fam);
  10207. u32 vid, subcmd;
  10208. unsigned int i;
  10209. int vcmd_idx = -1;
  10210. int err;
  10211. void *data = NULL;
  10212. unsigned int data_len = 0;
  10213. if (cb->args[0]) {
  10214. /* subtract the 1 again here */
  10215. struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
  10216. struct wireless_dev *tmp;
  10217. if (!wiphy)
  10218. return -ENODEV;
  10219. *rdev = wiphy_to_rdev(wiphy);
  10220. *wdev = NULL;
  10221. if (cb->args[1]) {
  10222. list_for_each_entry(tmp, &wiphy->wdev_list, list) {
  10223. if (tmp->identifier == cb->args[1] - 1) {
  10224. *wdev = tmp;
  10225. break;
  10226. }
  10227. }
  10228. }
  10229. /* keep rtnl locked in successful case */
  10230. return 0;
  10231. }
  10232. err = nlmsg_parse(cb->nlh, GENL_HDRLEN + nl80211_fam.hdrsize, attrbuf,
  10233. nl80211_fam.maxattr, nl80211_policy, NULL);
  10234. if (err)
  10235. return err;
  10236. if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
  10237. !attrbuf[NL80211_ATTR_VENDOR_SUBCMD])
  10238. return -EINVAL;
  10239. *wdev = __cfg80211_wdev_from_attrs(sock_net(skb->sk), attrbuf);
  10240. if (IS_ERR(*wdev))
  10241. *wdev = NULL;
  10242. *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
  10243. if (IS_ERR(*rdev))
  10244. return PTR_ERR(*rdev);
  10245. vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
  10246. subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
  10247. for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
  10248. const struct wiphy_vendor_command *vcmd;
  10249. vcmd = &(*rdev)->wiphy.vendor_commands[i];
  10250. if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
  10251. continue;
  10252. if (!vcmd->dumpit)
  10253. return -EOPNOTSUPP;
  10254. vcmd_idx = i;
  10255. break;
  10256. }
  10257. if (vcmd_idx < 0)
  10258. return -EOPNOTSUPP;
  10259. if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
  10260. data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
  10261. data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
  10262. }
  10263. /* 0 is the first index - add 1 to parse only once */
  10264. cb->args[0] = (*rdev)->wiphy_idx + 1;
  10265. /* add 1 to know if it was NULL */
  10266. cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
  10267. cb->args[2] = vcmd_idx;
  10268. cb->args[3] = (unsigned long)data;
  10269. cb->args[4] = data_len;
  10270. /* keep rtnl locked in successful case */
  10271. return 0;
  10272. }
  10273. static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
  10274. struct netlink_callback *cb)
  10275. {
  10276. struct cfg80211_registered_device *rdev;
  10277. struct wireless_dev *wdev;
  10278. unsigned int vcmd_idx;
  10279. const struct wiphy_vendor_command *vcmd;
  10280. void *data;
  10281. int data_len;
  10282. int err;
  10283. struct nlattr *vendor_data;
  10284. rtnl_lock();
  10285. err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
  10286. if (err)
  10287. goto out;
  10288. vcmd_idx = cb->args[2];
  10289. data = (void *)cb->args[3];
  10290. data_len = cb->args[4];
  10291. vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
  10292. if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
  10293. WIPHY_VENDOR_CMD_NEED_NETDEV)) {
  10294. if (!wdev) {
  10295. err = -EINVAL;
  10296. goto out;
  10297. }
  10298. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
  10299. !wdev->netdev) {
  10300. err = -EINVAL;
  10301. goto out;
  10302. }
  10303. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
  10304. if (!wdev_running(wdev)) {
  10305. err = -ENETDOWN;
  10306. goto out;
  10307. }
  10308. }
  10309. }
  10310. while (1) {
  10311. void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
  10312. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  10313. NL80211_CMD_VENDOR);
  10314. if (!hdr)
  10315. break;
  10316. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  10317. (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
  10318. wdev_id(wdev),
  10319. NL80211_ATTR_PAD))) {
  10320. genlmsg_cancel(skb, hdr);
  10321. break;
  10322. }
  10323. vendor_data = nla_nest_start(skb, NL80211_ATTR_VENDOR_DATA);
  10324. if (!vendor_data) {
  10325. genlmsg_cancel(skb, hdr);
  10326. break;
  10327. }
  10328. err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
  10329. (unsigned long *)&cb->args[5]);
  10330. nla_nest_end(skb, vendor_data);
  10331. if (err == -ENOBUFS || err == -ENOENT) {
  10332. genlmsg_cancel(skb, hdr);
  10333. break;
  10334. } else if (err) {
  10335. genlmsg_cancel(skb, hdr);
  10336. goto out;
  10337. }
  10338. genlmsg_end(skb, hdr);
  10339. }
  10340. err = skb->len;
  10341. out:
  10342. rtnl_unlock();
  10343. return err;
  10344. }
  10345. struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
  10346. enum nl80211_commands cmd,
  10347. enum nl80211_attrs attr,
  10348. int approxlen)
  10349. {
  10350. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  10351. if (WARN_ON(!rdev->cur_cmd_info))
  10352. return NULL;
  10353. return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
  10354. rdev->cur_cmd_info->snd_portid,
  10355. rdev->cur_cmd_info->snd_seq,
  10356. cmd, attr, NULL, GFP_KERNEL);
  10357. }
  10358. EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
  10359. int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
  10360. {
  10361. struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
  10362. void *hdr = ((void **)skb->cb)[1];
  10363. struct nlattr *data = ((void **)skb->cb)[2];
  10364. /* clear CB data for netlink core to own from now on */
  10365. memset(skb->cb, 0, sizeof(skb->cb));
  10366. if (WARN_ON(!rdev->cur_cmd_info)) {
  10367. kfree_skb(skb);
  10368. return -EINVAL;
  10369. }
  10370. nla_nest_end(skb, data);
  10371. genlmsg_end(skb, hdr);
  10372. return genlmsg_reply(skb, rdev->cur_cmd_info);
  10373. }
  10374. EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
  10375. static int nl80211_set_qos_map(struct sk_buff *skb,
  10376. struct genl_info *info)
  10377. {
  10378. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10379. struct cfg80211_qos_map *qos_map = NULL;
  10380. struct net_device *dev = info->user_ptr[1];
  10381. u8 *pos, len, num_des, des_len, des;
  10382. int ret;
  10383. if (!rdev->ops->set_qos_map)
  10384. return -EOPNOTSUPP;
  10385. if (info->attrs[NL80211_ATTR_QOS_MAP]) {
  10386. pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
  10387. len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
  10388. if (len % 2 || len < IEEE80211_QOS_MAP_LEN_MIN ||
  10389. len > IEEE80211_QOS_MAP_LEN_MAX)
  10390. return -EINVAL;
  10391. qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
  10392. if (!qos_map)
  10393. return -ENOMEM;
  10394. num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
  10395. if (num_des) {
  10396. des_len = num_des *
  10397. sizeof(struct cfg80211_dscp_exception);
  10398. memcpy(qos_map->dscp_exception, pos, des_len);
  10399. qos_map->num_des = num_des;
  10400. for (des = 0; des < num_des; des++) {
  10401. if (qos_map->dscp_exception[des].up > 7) {
  10402. kfree(qos_map);
  10403. return -EINVAL;
  10404. }
  10405. }
  10406. pos += des_len;
  10407. }
  10408. memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
  10409. }
  10410. wdev_lock(dev->ieee80211_ptr);
  10411. ret = nl80211_key_allowed(dev->ieee80211_ptr);
  10412. if (!ret)
  10413. ret = rdev_set_qos_map(rdev, dev, qos_map);
  10414. wdev_unlock(dev->ieee80211_ptr);
  10415. kfree(qos_map);
  10416. return ret;
  10417. }
  10418. static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
  10419. {
  10420. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10421. struct net_device *dev = info->user_ptr[1];
  10422. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10423. const u8 *peer;
  10424. u8 tsid, up;
  10425. u16 admitted_time = 0;
  10426. int err;
  10427. if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
  10428. return -EOPNOTSUPP;
  10429. if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
  10430. !info->attrs[NL80211_ATTR_USER_PRIO])
  10431. return -EINVAL;
  10432. tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
  10433. if (tsid >= IEEE80211_NUM_TIDS)
  10434. return -EINVAL;
  10435. up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
  10436. if (up >= IEEE80211_NUM_UPS)
  10437. return -EINVAL;
  10438. /* WMM uses TIDs 0-7 even for TSPEC */
  10439. if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
  10440. /* TODO: handle 802.11 TSPEC/admission control
  10441. * need more attributes for that (e.g. BA session requirement);
  10442. * change the WMM adminssion test above to allow both then
  10443. */
  10444. return -EINVAL;
  10445. }
  10446. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10447. if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
  10448. admitted_time =
  10449. nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
  10450. if (!admitted_time)
  10451. return -EINVAL;
  10452. }
  10453. wdev_lock(wdev);
  10454. switch (wdev->iftype) {
  10455. case NL80211_IFTYPE_STATION:
  10456. case NL80211_IFTYPE_P2P_CLIENT:
  10457. if (wdev->current_bss)
  10458. break;
  10459. err = -ENOTCONN;
  10460. goto out;
  10461. default:
  10462. err = -EOPNOTSUPP;
  10463. goto out;
  10464. }
  10465. err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
  10466. out:
  10467. wdev_unlock(wdev);
  10468. return err;
  10469. }
  10470. static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
  10471. {
  10472. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10473. struct net_device *dev = info->user_ptr[1];
  10474. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10475. const u8 *peer;
  10476. u8 tsid;
  10477. int err;
  10478. if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
  10479. return -EINVAL;
  10480. tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
  10481. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10482. wdev_lock(wdev);
  10483. err = rdev_del_tx_ts(rdev, dev, tsid, peer);
  10484. wdev_unlock(wdev);
  10485. return err;
  10486. }
  10487. static int nl80211_tdls_channel_switch(struct sk_buff *skb,
  10488. struct genl_info *info)
  10489. {
  10490. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10491. struct net_device *dev = info->user_ptr[1];
  10492. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10493. struct cfg80211_chan_def chandef = {};
  10494. const u8 *addr;
  10495. u8 oper_class;
  10496. int err;
  10497. if (!rdev->ops->tdls_channel_switch ||
  10498. !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
  10499. return -EOPNOTSUPP;
  10500. switch (dev->ieee80211_ptr->iftype) {
  10501. case NL80211_IFTYPE_STATION:
  10502. case NL80211_IFTYPE_P2P_CLIENT:
  10503. break;
  10504. default:
  10505. return -EOPNOTSUPP;
  10506. }
  10507. if (!info->attrs[NL80211_ATTR_MAC] ||
  10508. !info->attrs[NL80211_ATTR_OPER_CLASS])
  10509. return -EINVAL;
  10510. err = nl80211_parse_chandef(rdev, info, &chandef);
  10511. if (err)
  10512. return err;
  10513. /*
  10514. * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
  10515. * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
  10516. * specification is not defined for them.
  10517. */
  10518. if (chandef.chan->band == NL80211_BAND_2GHZ &&
  10519. chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
  10520. chandef.width != NL80211_CHAN_WIDTH_20)
  10521. return -EINVAL;
  10522. /* we will be active on the TDLS link */
  10523. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
  10524. wdev->iftype))
  10525. return -EINVAL;
  10526. /* don't allow switching to DFS channels */
  10527. if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
  10528. return -EINVAL;
  10529. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10530. oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
  10531. wdev_lock(wdev);
  10532. err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
  10533. wdev_unlock(wdev);
  10534. return err;
  10535. }
  10536. static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
  10537. struct genl_info *info)
  10538. {
  10539. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10540. struct net_device *dev = info->user_ptr[1];
  10541. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10542. const u8 *addr;
  10543. if (!rdev->ops->tdls_channel_switch ||
  10544. !rdev->ops->tdls_cancel_channel_switch ||
  10545. !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
  10546. return -EOPNOTSUPP;
  10547. switch (dev->ieee80211_ptr->iftype) {
  10548. case NL80211_IFTYPE_STATION:
  10549. case NL80211_IFTYPE_P2P_CLIENT:
  10550. break;
  10551. default:
  10552. return -EOPNOTSUPP;
  10553. }
  10554. if (!info->attrs[NL80211_ATTR_MAC])
  10555. return -EINVAL;
  10556. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10557. wdev_lock(wdev);
  10558. rdev_tdls_cancel_channel_switch(rdev, dev, addr);
  10559. wdev_unlock(wdev);
  10560. return 0;
  10561. }
  10562. static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
  10563. struct genl_info *info)
  10564. {
  10565. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10566. struct net_device *dev = info->user_ptr[1];
  10567. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10568. const struct nlattr *nla;
  10569. bool enabled;
  10570. if (!rdev->ops->set_multicast_to_unicast)
  10571. return -EOPNOTSUPP;
  10572. if (wdev->iftype != NL80211_IFTYPE_AP &&
  10573. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  10574. return -EOPNOTSUPP;
  10575. nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
  10576. enabled = nla_get_flag(nla);
  10577. return rdev_set_multicast_to_unicast(rdev, dev, enabled);
  10578. }
  10579. static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
  10580. {
  10581. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10582. struct net_device *dev = info->user_ptr[1];
  10583. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10584. struct cfg80211_pmk_conf pmk_conf = {};
  10585. int ret;
  10586. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  10587. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10588. return -EOPNOTSUPP;
  10589. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  10590. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  10591. return -EOPNOTSUPP;
  10592. if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
  10593. return -EINVAL;
  10594. wdev_lock(wdev);
  10595. if (!wdev->current_bss) {
  10596. ret = -ENOTCONN;
  10597. goto out;
  10598. }
  10599. pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10600. if (memcmp(pmk_conf.aa, wdev->current_bss->pub.bssid, ETH_ALEN)) {
  10601. ret = -EINVAL;
  10602. goto out;
  10603. }
  10604. pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  10605. pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
  10606. if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
  10607. pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) {
  10608. ret = -EINVAL;
  10609. goto out;
  10610. }
  10611. if (info->attrs[NL80211_ATTR_PMKR0_NAME]) {
  10612. int r0_name_len = nla_len(info->attrs[NL80211_ATTR_PMKR0_NAME]);
  10613. if (r0_name_len != WLAN_PMK_NAME_LEN) {
  10614. ret = -EINVAL;
  10615. goto out;
  10616. }
  10617. pmk_conf.pmk_r0_name =
  10618. nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
  10619. }
  10620. ret = rdev_set_pmk(rdev, dev, &pmk_conf);
  10621. out:
  10622. wdev_unlock(wdev);
  10623. return ret;
  10624. }
  10625. static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
  10626. {
  10627. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10628. struct net_device *dev = info->user_ptr[1];
  10629. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10630. const u8 *aa;
  10631. int ret;
  10632. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  10633. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10634. return -EOPNOTSUPP;
  10635. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  10636. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  10637. return -EOPNOTSUPP;
  10638. if (!info->attrs[NL80211_ATTR_MAC])
  10639. return -EINVAL;
  10640. wdev_lock(wdev);
  10641. aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10642. ret = rdev_del_pmk(rdev, dev, aa);
  10643. wdev_unlock(wdev);
  10644. return ret;
  10645. }
  10646. static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
  10647. {
  10648. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10649. struct net_device *dev = info->user_ptr[1];
  10650. struct cfg80211_external_auth_params params;
  10651. if (!rdev->ops->external_auth)
  10652. return -EOPNOTSUPP;
  10653. if (!info->attrs[NL80211_ATTR_SSID])
  10654. return -EINVAL;
  10655. if (!info->attrs[NL80211_ATTR_BSSID])
  10656. return -EINVAL;
  10657. if (!info->attrs[NL80211_ATTR_STATUS_CODE])
  10658. return -EINVAL;
  10659. memset(&params, 0, sizeof(params));
  10660. params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  10661. if (params.ssid.ssid_len == 0 ||
  10662. params.ssid.ssid_len > IEEE80211_MAX_SSID_LEN)
  10663. return -EINVAL;
  10664. memcpy(params.ssid.ssid, nla_data(info->attrs[NL80211_ATTR_SSID]),
  10665. params.ssid.ssid_len);
  10666. memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
  10667. ETH_ALEN);
  10668. params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  10669. return rdev_external_auth(rdev, dev, &params);
  10670. }
  10671. static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info)
  10672. {
  10673. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10674. struct net_device *dev = info->user_ptr[1];
  10675. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10676. const u8 *buf;
  10677. size_t len;
  10678. u8 *dest;
  10679. u16 proto;
  10680. bool noencrypt;
  10681. int err;
  10682. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  10683. NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
  10684. return -EOPNOTSUPP;
  10685. if (!rdev->ops->tx_control_port)
  10686. return -EOPNOTSUPP;
  10687. if (!info->attrs[NL80211_ATTR_FRAME] ||
  10688. !info->attrs[NL80211_ATTR_MAC] ||
  10689. !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
  10690. GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing");
  10691. return -EINVAL;
  10692. }
  10693. wdev_lock(wdev);
  10694. switch (wdev->iftype) {
  10695. case NL80211_IFTYPE_AP:
  10696. case NL80211_IFTYPE_P2P_GO:
  10697. case NL80211_IFTYPE_MESH_POINT:
  10698. break;
  10699. case NL80211_IFTYPE_ADHOC:
  10700. case NL80211_IFTYPE_STATION:
  10701. case NL80211_IFTYPE_P2P_CLIENT:
  10702. if (wdev->current_bss)
  10703. break;
  10704. err = -ENOTCONN;
  10705. goto out;
  10706. default:
  10707. err = -EOPNOTSUPP;
  10708. goto out;
  10709. }
  10710. wdev_unlock(wdev);
  10711. buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
  10712. len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
  10713. dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10714. proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
  10715. noencrypt =
  10716. nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]);
  10717. return rdev_tx_control_port(rdev, dev, buf, len,
  10718. dest, cpu_to_be16(proto), noencrypt);
  10719. out:
  10720. wdev_unlock(wdev);
  10721. return err;
  10722. }
  10723. #define NL80211_FLAG_NEED_WIPHY 0x01
  10724. #define NL80211_FLAG_NEED_NETDEV 0x02
  10725. #define NL80211_FLAG_NEED_RTNL 0x04
  10726. #define NL80211_FLAG_CHECK_NETDEV_UP 0x08
  10727. #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
  10728. NL80211_FLAG_CHECK_NETDEV_UP)
  10729. #define NL80211_FLAG_NEED_WDEV 0x10
  10730. /* If a netdev is associated, it must be UP, P2P must be started */
  10731. #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
  10732. NL80211_FLAG_CHECK_NETDEV_UP)
  10733. #define NL80211_FLAG_CLEAR_SKB 0x20
  10734. static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
  10735. struct genl_info *info)
  10736. {
  10737. struct cfg80211_registered_device *rdev;
  10738. struct wireless_dev *wdev;
  10739. struct net_device *dev;
  10740. bool rtnl = ops->internal_flags & NL80211_FLAG_NEED_RTNL;
  10741. if (rtnl)
  10742. rtnl_lock();
  10743. if (ops->internal_flags & NL80211_FLAG_NEED_WIPHY) {
  10744. rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
  10745. if (IS_ERR(rdev)) {
  10746. if (rtnl)
  10747. rtnl_unlock();
  10748. return PTR_ERR(rdev);
  10749. }
  10750. info->user_ptr[0] = rdev;
  10751. } else if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV ||
  10752. ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
  10753. ASSERT_RTNL();
  10754. wdev = __cfg80211_wdev_from_attrs(genl_info_net(info),
  10755. info->attrs);
  10756. if (IS_ERR(wdev)) {
  10757. if (rtnl)
  10758. rtnl_unlock();
  10759. return PTR_ERR(wdev);
  10760. }
  10761. dev = wdev->netdev;
  10762. rdev = wiphy_to_rdev(wdev->wiphy);
  10763. if (ops->internal_flags & NL80211_FLAG_NEED_NETDEV) {
  10764. if (!dev) {
  10765. if (rtnl)
  10766. rtnl_unlock();
  10767. return -EINVAL;
  10768. }
  10769. info->user_ptr[1] = dev;
  10770. } else {
  10771. info->user_ptr[1] = wdev;
  10772. }
  10773. if (ops->internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
  10774. !wdev_running(wdev)) {
  10775. if (rtnl)
  10776. rtnl_unlock();
  10777. return -ENETDOWN;
  10778. }
  10779. if (dev)
  10780. dev_hold(dev);
  10781. info->user_ptr[0] = rdev;
  10782. }
  10783. return 0;
  10784. }
  10785. static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
  10786. struct genl_info *info)
  10787. {
  10788. if (info->user_ptr[1]) {
  10789. if (ops->internal_flags & NL80211_FLAG_NEED_WDEV) {
  10790. struct wireless_dev *wdev = info->user_ptr[1];
  10791. if (wdev->netdev)
  10792. dev_put(wdev->netdev);
  10793. } else {
  10794. dev_put(info->user_ptr[1]);
  10795. }
  10796. }
  10797. if (ops->internal_flags & NL80211_FLAG_NEED_RTNL)
  10798. rtnl_unlock();
  10799. /* If needed, clear the netlink message payload from the SKB
  10800. * as it might contain key data that shouldn't stick around on
  10801. * the heap after the SKB is freed. The netlink message header
  10802. * is still needed for further processing, so leave it intact.
  10803. */
  10804. if (ops->internal_flags & NL80211_FLAG_CLEAR_SKB) {
  10805. struct nlmsghdr *nlh = nlmsg_hdr(skb);
  10806. memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
  10807. }
  10808. }
  10809. static const struct genl_ops nl80211_ops[] = {
  10810. {
  10811. .cmd = NL80211_CMD_GET_WIPHY,
  10812. .doit = nl80211_get_wiphy,
  10813. .dumpit = nl80211_dump_wiphy,
  10814. .done = nl80211_dump_wiphy_done,
  10815. .policy = nl80211_policy,
  10816. /* can be retrieved by unprivileged users */
  10817. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  10818. NL80211_FLAG_NEED_RTNL,
  10819. },
  10820. {
  10821. .cmd = NL80211_CMD_SET_WIPHY,
  10822. .doit = nl80211_set_wiphy,
  10823. .policy = nl80211_policy,
  10824. .flags = GENL_UNS_ADMIN_PERM,
  10825. .internal_flags = NL80211_FLAG_NEED_RTNL,
  10826. },
  10827. {
  10828. .cmd = NL80211_CMD_GET_INTERFACE,
  10829. .doit = nl80211_get_interface,
  10830. .dumpit = nl80211_dump_interface,
  10831. .policy = nl80211_policy,
  10832. /* can be retrieved by unprivileged users */
  10833. .internal_flags = NL80211_FLAG_NEED_WDEV |
  10834. NL80211_FLAG_NEED_RTNL,
  10835. },
  10836. {
  10837. .cmd = NL80211_CMD_SET_INTERFACE,
  10838. .doit = nl80211_set_interface,
  10839. .policy = nl80211_policy,
  10840. .flags = GENL_UNS_ADMIN_PERM,
  10841. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  10842. NL80211_FLAG_NEED_RTNL,
  10843. },
  10844. {
  10845. .cmd = NL80211_CMD_NEW_INTERFACE,
  10846. .doit = nl80211_new_interface,
  10847. .policy = nl80211_policy,
  10848. .flags = GENL_UNS_ADMIN_PERM,
  10849. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  10850. NL80211_FLAG_NEED_RTNL,
  10851. },
  10852. {
  10853. .cmd = NL80211_CMD_DEL_INTERFACE,
  10854. .doit = nl80211_del_interface,
  10855. .policy = nl80211_policy,
  10856. .flags = GENL_UNS_ADMIN_PERM,
  10857. .internal_flags = NL80211_FLAG_NEED_WDEV |
  10858. NL80211_FLAG_NEED_RTNL,
  10859. },
  10860. {
  10861. .cmd = NL80211_CMD_GET_KEY,
  10862. .doit = nl80211_get_key,
  10863. .policy = nl80211_policy,
  10864. .flags = GENL_UNS_ADMIN_PERM,
  10865. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10866. NL80211_FLAG_NEED_RTNL,
  10867. },
  10868. {
  10869. .cmd = NL80211_CMD_SET_KEY,
  10870. .doit = nl80211_set_key,
  10871. .policy = nl80211_policy,
  10872. .flags = GENL_UNS_ADMIN_PERM,
  10873. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10874. NL80211_FLAG_NEED_RTNL |
  10875. NL80211_FLAG_CLEAR_SKB,
  10876. },
  10877. {
  10878. .cmd = NL80211_CMD_NEW_KEY,
  10879. .doit = nl80211_new_key,
  10880. .policy = nl80211_policy,
  10881. .flags = GENL_UNS_ADMIN_PERM,
  10882. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10883. NL80211_FLAG_NEED_RTNL |
  10884. NL80211_FLAG_CLEAR_SKB,
  10885. },
  10886. {
  10887. .cmd = NL80211_CMD_DEL_KEY,
  10888. .doit = nl80211_del_key,
  10889. .policy = nl80211_policy,
  10890. .flags = GENL_UNS_ADMIN_PERM,
  10891. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10892. NL80211_FLAG_NEED_RTNL,
  10893. },
  10894. {
  10895. .cmd = NL80211_CMD_SET_BEACON,
  10896. .policy = nl80211_policy,
  10897. .flags = GENL_UNS_ADMIN_PERM,
  10898. .doit = nl80211_set_beacon,
  10899. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10900. NL80211_FLAG_NEED_RTNL,
  10901. },
  10902. {
  10903. .cmd = NL80211_CMD_START_AP,
  10904. .policy = nl80211_policy,
  10905. .flags = GENL_UNS_ADMIN_PERM,
  10906. .doit = nl80211_start_ap,
  10907. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10908. NL80211_FLAG_NEED_RTNL,
  10909. },
  10910. {
  10911. .cmd = NL80211_CMD_STOP_AP,
  10912. .policy = nl80211_policy,
  10913. .flags = GENL_UNS_ADMIN_PERM,
  10914. .doit = nl80211_stop_ap,
  10915. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10916. NL80211_FLAG_NEED_RTNL,
  10917. },
  10918. {
  10919. .cmd = NL80211_CMD_GET_STATION,
  10920. .doit = nl80211_get_station,
  10921. .dumpit = nl80211_dump_station,
  10922. .policy = nl80211_policy,
  10923. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  10924. NL80211_FLAG_NEED_RTNL,
  10925. },
  10926. {
  10927. .cmd = NL80211_CMD_SET_STATION,
  10928. .doit = nl80211_set_station,
  10929. .policy = nl80211_policy,
  10930. .flags = GENL_UNS_ADMIN_PERM,
  10931. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10932. NL80211_FLAG_NEED_RTNL,
  10933. },
  10934. {
  10935. .cmd = NL80211_CMD_NEW_STATION,
  10936. .doit = nl80211_new_station,
  10937. .policy = nl80211_policy,
  10938. .flags = GENL_UNS_ADMIN_PERM,
  10939. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10940. NL80211_FLAG_NEED_RTNL,
  10941. },
  10942. {
  10943. .cmd = NL80211_CMD_DEL_STATION,
  10944. .doit = nl80211_del_station,
  10945. .policy = nl80211_policy,
  10946. .flags = GENL_UNS_ADMIN_PERM,
  10947. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10948. NL80211_FLAG_NEED_RTNL,
  10949. },
  10950. {
  10951. .cmd = NL80211_CMD_GET_MPATH,
  10952. .doit = nl80211_get_mpath,
  10953. .dumpit = nl80211_dump_mpath,
  10954. .policy = nl80211_policy,
  10955. .flags = GENL_UNS_ADMIN_PERM,
  10956. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10957. NL80211_FLAG_NEED_RTNL,
  10958. },
  10959. {
  10960. .cmd = NL80211_CMD_GET_MPP,
  10961. .doit = nl80211_get_mpp,
  10962. .dumpit = nl80211_dump_mpp,
  10963. .policy = nl80211_policy,
  10964. .flags = GENL_UNS_ADMIN_PERM,
  10965. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10966. NL80211_FLAG_NEED_RTNL,
  10967. },
  10968. {
  10969. .cmd = NL80211_CMD_SET_MPATH,
  10970. .doit = nl80211_set_mpath,
  10971. .policy = nl80211_policy,
  10972. .flags = GENL_UNS_ADMIN_PERM,
  10973. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10974. NL80211_FLAG_NEED_RTNL,
  10975. },
  10976. {
  10977. .cmd = NL80211_CMD_NEW_MPATH,
  10978. .doit = nl80211_new_mpath,
  10979. .policy = nl80211_policy,
  10980. .flags = GENL_UNS_ADMIN_PERM,
  10981. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10982. NL80211_FLAG_NEED_RTNL,
  10983. },
  10984. {
  10985. .cmd = NL80211_CMD_DEL_MPATH,
  10986. .doit = nl80211_del_mpath,
  10987. .policy = nl80211_policy,
  10988. .flags = GENL_UNS_ADMIN_PERM,
  10989. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10990. NL80211_FLAG_NEED_RTNL,
  10991. },
  10992. {
  10993. .cmd = NL80211_CMD_SET_BSS,
  10994. .doit = nl80211_set_bss,
  10995. .policy = nl80211_policy,
  10996. .flags = GENL_UNS_ADMIN_PERM,
  10997. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  10998. NL80211_FLAG_NEED_RTNL,
  10999. },
  11000. {
  11001. .cmd = NL80211_CMD_GET_REG,
  11002. .doit = nl80211_get_reg_do,
  11003. .dumpit = nl80211_get_reg_dump,
  11004. .policy = nl80211_policy,
  11005. .internal_flags = NL80211_FLAG_NEED_RTNL,
  11006. /* can be retrieved by unprivileged users */
  11007. },
  11008. #ifdef CONFIG_CFG80211_CRDA_SUPPORT
  11009. {
  11010. .cmd = NL80211_CMD_SET_REG,
  11011. .doit = nl80211_set_reg,
  11012. .policy = nl80211_policy,
  11013. .flags = GENL_ADMIN_PERM,
  11014. .internal_flags = NL80211_FLAG_NEED_RTNL,
  11015. },
  11016. #endif
  11017. {
  11018. .cmd = NL80211_CMD_REQ_SET_REG,
  11019. .doit = nl80211_req_set_reg,
  11020. .policy = nl80211_policy,
  11021. .flags = GENL_ADMIN_PERM,
  11022. },
  11023. {
  11024. .cmd = NL80211_CMD_RELOAD_REGDB,
  11025. .doit = nl80211_reload_regdb,
  11026. .policy = nl80211_policy,
  11027. .flags = GENL_ADMIN_PERM,
  11028. },
  11029. {
  11030. .cmd = NL80211_CMD_GET_MESH_CONFIG,
  11031. .doit = nl80211_get_mesh_config,
  11032. .policy = nl80211_policy,
  11033. /* can be retrieved by unprivileged users */
  11034. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11035. NL80211_FLAG_NEED_RTNL,
  11036. },
  11037. {
  11038. .cmd = NL80211_CMD_SET_MESH_CONFIG,
  11039. .doit = nl80211_update_mesh_config,
  11040. .policy = nl80211_policy,
  11041. .flags = GENL_UNS_ADMIN_PERM,
  11042. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11043. NL80211_FLAG_NEED_RTNL,
  11044. },
  11045. {
  11046. .cmd = NL80211_CMD_TRIGGER_SCAN,
  11047. .doit = nl80211_trigger_scan,
  11048. .policy = nl80211_policy,
  11049. .flags = GENL_UNS_ADMIN_PERM,
  11050. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11051. NL80211_FLAG_NEED_RTNL,
  11052. },
  11053. {
  11054. .cmd = NL80211_CMD_ABORT_SCAN,
  11055. .doit = nl80211_abort_scan,
  11056. .policy = nl80211_policy,
  11057. .flags = GENL_UNS_ADMIN_PERM,
  11058. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11059. NL80211_FLAG_NEED_RTNL,
  11060. },
  11061. {
  11062. .cmd = NL80211_CMD_GET_SCAN,
  11063. .policy = nl80211_policy,
  11064. .dumpit = nl80211_dump_scan,
  11065. },
  11066. {
  11067. .cmd = NL80211_CMD_START_SCHED_SCAN,
  11068. .doit = nl80211_start_sched_scan,
  11069. .policy = nl80211_policy,
  11070. .flags = GENL_UNS_ADMIN_PERM,
  11071. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11072. NL80211_FLAG_NEED_RTNL,
  11073. },
  11074. {
  11075. .cmd = NL80211_CMD_STOP_SCHED_SCAN,
  11076. .doit = nl80211_stop_sched_scan,
  11077. .policy = nl80211_policy,
  11078. .flags = GENL_UNS_ADMIN_PERM,
  11079. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11080. NL80211_FLAG_NEED_RTNL,
  11081. },
  11082. {
  11083. .cmd = NL80211_CMD_AUTHENTICATE,
  11084. .doit = nl80211_authenticate,
  11085. .policy = nl80211_policy,
  11086. .flags = GENL_UNS_ADMIN_PERM,
  11087. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11088. NL80211_FLAG_NEED_RTNL |
  11089. NL80211_FLAG_CLEAR_SKB,
  11090. },
  11091. {
  11092. .cmd = NL80211_CMD_ASSOCIATE,
  11093. .doit = nl80211_associate,
  11094. .policy = nl80211_policy,
  11095. .flags = GENL_UNS_ADMIN_PERM,
  11096. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11097. NL80211_FLAG_NEED_RTNL,
  11098. },
  11099. {
  11100. .cmd = NL80211_CMD_DEAUTHENTICATE,
  11101. .doit = nl80211_deauthenticate,
  11102. .policy = nl80211_policy,
  11103. .flags = GENL_UNS_ADMIN_PERM,
  11104. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11105. NL80211_FLAG_NEED_RTNL,
  11106. },
  11107. {
  11108. .cmd = NL80211_CMD_DISASSOCIATE,
  11109. .doit = nl80211_disassociate,
  11110. .policy = nl80211_policy,
  11111. .flags = GENL_UNS_ADMIN_PERM,
  11112. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11113. NL80211_FLAG_NEED_RTNL,
  11114. },
  11115. {
  11116. .cmd = NL80211_CMD_JOIN_IBSS,
  11117. .doit = nl80211_join_ibss,
  11118. .policy = nl80211_policy,
  11119. .flags = GENL_UNS_ADMIN_PERM,
  11120. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11121. NL80211_FLAG_NEED_RTNL,
  11122. },
  11123. {
  11124. .cmd = NL80211_CMD_LEAVE_IBSS,
  11125. .doit = nl80211_leave_ibss,
  11126. .policy = nl80211_policy,
  11127. .flags = GENL_UNS_ADMIN_PERM,
  11128. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11129. NL80211_FLAG_NEED_RTNL,
  11130. },
  11131. #ifdef CONFIG_NL80211_TESTMODE
  11132. {
  11133. .cmd = NL80211_CMD_TESTMODE,
  11134. .doit = nl80211_testmode_do,
  11135. .dumpit = nl80211_testmode_dump,
  11136. .policy = nl80211_policy,
  11137. .flags = GENL_UNS_ADMIN_PERM,
  11138. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  11139. NL80211_FLAG_NEED_RTNL,
  11140. },
  11141. #endif
  11142. {
  11143. .cmd = NL80211_CMD_CONNECT,
  11144. .doit = nl80211_connect,
  11145. .policy = nl80211_policy,
  11146. .flags = GENL_UNS_ADMIN_PERM,
  11147. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11148. NL80211_FLAG_NEED_RTNL,
  11149. },
  11150. {
  11151. .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
  11152. .doit = nl80211_update_connect_params,
  11153. .policy = nl80211_policy,
  11154. .flags = GENL_ADMIN_PERM,
  11155. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11156. NL80211_FLAG_NEED_RTNL,
  11157. },
  11158. {
  11159. .cmd = NL80211_CMD_DISCONNECT,
  11160. .doit = nl80211_disconnect,
  11161. .policy = nl80211_policy,
  11162. .flags = GENL_UNS_ADMIN_PERM,
  11163. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11164. NL80211_FLAG_NEED_RTNL,
  11165. },
  11166. {
  11167. .cmd = NL80211_CMD_SET_WIPHY_NETNS,
  11168. .doit = nl80211_wiphy_netns,
  11169. .policy = nl80211_policy,
  11170. .flags = GENL_UNS_ADMIN_PERM,
  11171. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  11172. NL80211_FLAG_NEED_RTNL,
  11173. },
  11174. {
  11175. .cmd = NL80211_CMD_GET_SURVEY,
  11176. .policy = nl80211_policy,
  11177. .dumpit = nl80211_dump_survey,
  11178. },
  11179. {
  11180. .cmd = NL80211_CMD_SET_PMKSA,
  11181. .doit = nl80211_setdel_pmksa,
  11182. .policy = nl80211_policy,
  11183. .flags = GENL_UNS_ADMIN_PERM,
  11184. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11185. NL80211_FLAG_NEED_RTNL,
  11186. },
  11187. {
  11188. .cmd = NL80211_CMD_DEL_PMKSA,
  11189. .doit = nl80211_setdel_pmksa,
  11190. .policy = nl80211_policy,
  11191. .flags = GENL_UNS_ADMIN_PERM,
  11192. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11193. NL80211_FLAG_NEED_RTNL,
  11194. },
  11195. {
  11196. .cmd = NL80211_CMD_FLUSH_PMKSA,
  11197. .doit = nl80211_flush_pmksa,
  11198. .policy = nl80211_policy,
  11199. .flags = GENL_UNS_ADMIN_PERM,
  11200. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11201. NL80211_FLAG_NEED_RTNL,
  11202. },
  11203. {
  11204. .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
  11205. .doit = nl80211_remain_on_channel,
  11206. .policy = nl80211_policy,
  11207. .flags = GENL_UNS_ADMIN_PERM,
  11208. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11209. NL80211_FLAG_NEED_RTNL,
  11210. },
  11211. {
  11212. .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  11213. .doit = nl80211_cancel_remain_on_channel,
  11214. .policy = nl80211_policy,
  11215. .flags = GENL_UNS_ADMIN_PERM,
  11216. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11217. NL80211_FLAG_NEED_RTNL,
  11218. },
  11219. {
  11220. .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
  11221. .doit = nl80211_set_tx_bitrate_mask,
  11222. .policy = nl80211_policy,
  11223. .flags = GENL_UNS_ADMIN_PERM,
  11224. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11225. NL80211_FLAG_NEED_RTNL,
  11226. },
  11227. {
  11228. .cmd = NL80211_CMD_REGISTER_FRAME,
  11229. .doit = nl80211_register_mgmt,
  11230. .policy = nl80211_policy,
  11231. .flags = GENL_UNS_ADMIN_PERM,
  11232. .internal_flags = NL80211_FLAG_NEED_WDEV |
  11233. NL80211_FLAG_NEED_RTNL,
  11234. },
  11235. {
  11236. .cmd = NL80211_CMD_FRAME,
  11237. .doit = nl80211_tx_mgmt,
  11238. .policy = nl80211_policy,
  11239. .flags = GENL_UNS_ADMIN_PERM,
  11240. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11241. NL80211_FLAG_NEED_RTNL,
  11242. },
  11243. {
  11244. .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
  11245. .doit = nl80211_tx_mgmt_cancel_wait,
  11246. .policy = nl80211_policy,
  11247. .flags = GENL_UNS_ADMIN_PERM,
  11248. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11249. NL80211_FLAG_NEED_RTNL,
  11250. },
  11251. {
  11252. .cmd = NL80211_CMD_SET_POWER_SAVE,
  11253. .doit = nl80211_set_power_save,
  11254. .policy = nl80211_policy,
  11255. .flags = GENL_UNS_ADMIN_PERM,
  11256. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11257. NL80211_FLAG_NEED_RTNL,
  11258. },
  11259. {
  11260. .cmd = NL80211_CMD_GET_POWER_SAVE,
  11261. .doit = nl80211_get_power_save,
  11262. .policy = nl80211_policy,
  11263. /* can be retrieved by unprivileged users */
  11264. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11265. NL80211_FLAG_NEED_RTNL,
  11266. },
  11267. {
  11268. .cmd = NL80211_CMD_SET_CQM,
  11269. .doit = nl80211_set_cqm,
  11270. .policy = nl80211_policy,
  11271. .flags = GENL_UNS_ADMIN_PERM,
  11272. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11273. NL80211_FLAG_NEED_RTNL,
  11274. },
  11275. {
  11276. .cmd = NL80211_CMD_SET_CHANNEL,
  11277. .doit = nl80211_set_channel,
  11278. .policy = nl80211_policy,
  11279. .flags = GENL_UNS_ADMIN_PERM,
  11280. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11281. NL80211_FLAG_NEED_RTNL,
  11282. },
  11283. {
  11284. .cmd = NL80211_CMD_SET_WDS_PEER,
  11285. .doit = nl80211_set_wds_peer,
  11286. .policy = nl80211_policy,
  11287. .flags = GENL_UNS_ADMIN_PERM,
  11288. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11289. NL80211_FLAG_NEED_RTNL,
  11290. },
  11291. {
  11292. .cmd = NL80211_CMD_JOIN_MESH,
  11293. .doit = nl80211_join_mesh,
  11294. .policy = nl80211_policy,
  11295. .flags = GENL_UNS_ADMIN_PERM,
  11296. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11297. NL80211_FLAG_NEED_RTNL,
  11298. },
  11299. {
  11300. .cmd = NL80211_CMD_LEAVE_MESH,
  11301. .doit = nl80211_leave_mesh,
  11302. .policy = nl80211_policy,
  11303. .flags = GENL_UNS_ADMIN_PERM,
  11304. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11305. NL80211_FLAG_NEED_RTNL,
  11306. },
  11307. {
  11308. .cmd = NL80211_CMD_JOIN_OCB,
  11309. .doit = nl80211_join_ocb,
  11310. .policy = nl80211_policy,
  11311. .flags = GENL_UNS_ADMIN_PERM,
  11312. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11313. NL80211_FLAG_NEED_RTNL,
  11314. },
  11315. {
  11316. .cmd = NL80211_CMD_LEAVE_OCB,
  11317. .doit = nl80211_leave_ocb,
  11318. .policy = nl80211_policy,
  11319. .flags = GENL_UNS_ADMIN_PERM,
  11320. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11321. NL80211_FLAG_NEED_RTNL,
  11322. },
  11323. #ifdef CONFIG_PM
  11324. {
  11325. .cmd = NL80211_CMD_GET_WOWLAN,
  11326. .doit = nl80211_get_wowlan,
  11327. .policy = nl80211_policy,
  11328. /* can be retrieved by unprivileged users */
  11329. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  11330. NL80211_FLAG_NEED_RTNL,
  11331. },
  11332. {
  11333. .cmd = NL80211_CMD_SET_WOWLAN,
  11334. .doit = nl80211_set_wowlan,
  11335. .policy = nl80211_policy,
  11336. .flags = GENL_UNS_ADMIN_PERM,
  11337. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  11338. NL80211_FLAG_NEED_RTNL,
  11339. },
  11340. #endif
  11341. {
  11342. .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
  11343. .doit = nl80211_set_rekey_data,
  11344. .policy = nl80211_policy,
  11345. .flags = GENL_UNS_ADMIN_PERM,
  11346. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11347. NL80211_FLAG_NEED_RTNL |
  11348. NL80211_FLAG_CLEAR_SKB,
  11349. },
  11350. {
  11351. .cmd = NL80211_CMD_TDLS_MGMT,
  11352. .doit = nl80211_tdls_mgmt,
  11353. .policy = nl80211_policy,
  11354. .flags = GENL_UNS_ADMIN_PERM,
  11355. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11356. NL80211_FLAG_NEED_RTNL,
  11357. },
  11358. {
  11359. .cmd = NL80211_CMD_TDLS_OPER,
  11360. .doit = nl80211_tdls_oper,
  11361. .policy = nl80211_policy,
  11362. .flags = GENL_UNS_ADMIN_PERM,
  11363. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11364. NL80211_FLAG_NEED_RTNL,
  11365. },
  11366. {
  11367. .cmd = NL80211_CMD_UNEXPECTED_FRAME,
  11368. .doit = nl80211_register_unexpected_frame,
  11369. .policy = nl80211_policy,
  11370. .flags = GENL_UNS_ADMIN_PERM,
  11371. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11372. NL80211_FLAG_NEED_RTNL,
  11373. },
  11374. {
  11375. .cmd = NL80211_CMD_PROBE_CLIENT,
  11376. .doit = nl80211_probe_client,
  11377. .policy = nl80211_policy,
  11378. .flags = GENL_UNS_ADMIN_PERM,
  11379. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11380. NL80211_FLAG_NEED_RTNL,
  11381. },
  11382. {
  11383. .cmd = NL80211_CMD_REGISTER_BEACONS,
  11384. .doit = nl80211_register_beacons,
  11385. .policy = nl80211_policy,
  11386. .flags = GENL_UNS_ADMIN_PERM,
  11387. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  11388. NL80211_FLAG_NEED_RTNL,
  11389. },
  11390. {
  11391. .cmd = NL80211_CMD_SET_NOACK_MAP,
  11392. .doit = nl80211_set_noack_map,
  11393. .policy = nl80211_policy,
  11394. .flags = GENL_UNS_ADMIN_PERM,
  11395. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11396. NL80211_FLAG_NEED_RTNL,
  11397. },
  11398. {
  11399. .cmd = NL80211_CMD_START_P2P_DEVICE,
  11400. .doit = nl80211_start_p2p_device,
  11401. .policy = nl80211_policy,
  11402. .flags = GENL_UNS_ADMIN_PERM,
  11403. .internal_flags = NL80211_FLAG_NEED_WDEV |
  11404. NL80211_FLAG_NEED_RTNL,
  11405. },
  11406. {
  11407. .cmd = NL80211_CMD_STOP_P2P_DEVICE,
  11408. .doit = nl80211_stop_p2p_device,
  11409. .policy = nl80211_policy,
  11410. .flags = GENL_UNS_ADMIN_PERM,
  11411. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11412. NL80211_FLAG_NEED_RTNL,
  11413. },
  11414. {
  11415. .cmd = NL80211_CMD_START_NAN,
  11416. .doit = nl80211_start_nan,
  11417. .policy = nl80211_policy,
  11418. .flags = GENL_ADMIN_PERM,
  11419. .internal_flags = NL80211_FLAG_NEED_WDEV |
  11420. NL80211_FLAG_NEED_RTNL,
  11421. },
  11422. {
  11423. .cmd = NL80211_CMD_STOP_NAN,
  11424. .doit = nl80211_stop_nan,
  11425. .policy = nl80211_policy,
  11426. .flags = GENL_ADMIN_PERM,
  11427. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11428. NL80211_FLAG_NEED_RTNL,
  11429. },
  11430. {
  11431. .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
  11432. .doit = nl80211_nan_add_func,
  11433. .policy = nl80211_policy,
  11434. .flags = GENL_ADMIN_PERM,
  11435. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11436. NL80211_FLAG_NEED_RTNL,
  11437. },
  11438. {
  11439. .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
  11440. .doit = nl80211_nan_del_func,
  11441. .policy = nl80211_policy,
  11442. .flags = GENL_ADMIN_PERM,
  11443. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11444. NL80211_FLAG_NEED_RTNL,
  11445. },
  11446. {
  11447. .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
  11448. .doit = nl80211_nan_change_config,
  11449. .policy = nl80211_policy,
  11450. .flags = GENL_ADMIN_PERM,
  11451. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11452. NL80211_FLAG_NEED_RTNL,
  11453. },
  11454. {
  11455. .cmd = NL80211_CMD_SET_MCAST_RATE,
  11456. .doit = nl80211_set_mcast_rate,
  11457. .policy = nl80211_policy,
  11458. .flags = GENL_UNS_ADMIN_PERM,
  11459. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11460. NL80211_FLAG_NEED_RTNL,
  11461. },
  11462. {
  11463. .cmd = NL80211_CMD_SET_MAC_ACL,
  11464. .doit = nl80211_set_mac_acl,
  11465. .policy = nl80211_policy,
  11466. .flags = GENL_UNS_ADMIN_PERM,
  11467. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11468. NL80211_FLAG_NEED_RTNL,
  11469. },
  11470. {
  11471. .cmd = NL80211_CMD_RADAR_DETECT,
  11472. .doit = nl80211_start_radar_detection,
  11473. .policy = nl80211_policy,
  11474. .flags = GENL_UNS_ADMIN_PERM,
  11475. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11476. NL80211_FLAG_NEED_RTNL,
  11477. },
  11478. {
  11479. .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
  11480. .doit = nl80211_get_protocol_features,
  11481. .policy = nl80211_policy,
  11482. },
  11483. {
  11484. .cmd = NL80211_CMD_UPDATE_FT_IES,
  11485. .doit = nl80211_update_ft_ies,
  11486. .policy = nl80211_policy,
  11487. .flags = GENL_UNS_ADMIN_PERM,
  11488. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11489. NL80211_FLAG_NEED_RTNL,
  11490. },
  11491. {
  11492. .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
  11493. .doit = nl80211_crit_protocol_start,
  11494. .policy = nl80211_policy,
  11495. .flags = GENL_UNS_ADMIN_PERM,
  11496. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11497. NL80211_FLAG_NEED_RTNL,
  11498. },
  11499. {
  11500. .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
  11501. .doit = nl80211_crit_protocol_stop,
  11502. .policy = nl80211_policy,
  11503. .flags = GENL_UNS_ADMIN_PERM,
  11504. .internal_flags = NL80211_FLAG_NEED_WDEV_UP |
  11505. NL80211_FLAG_NEED_RTNL,
  11506. },
  11507. {
  11508. .cmd = NL80211_CMD_GET_COALESCE,
  11509. .doit = nl80211_get_coalesce,
  11510. .policy = nl80211_policy,
  11511. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  11512. NL80211_FLAG_NEED_RTNL,
  11513. },
  11514. {
  11515. .cmd = NL80211_CMD_SET_COALESCE,
  11516. .doit = nl80211_set_coalesce,
  11517. .policy = nl80211_policy,
  11518. .flags = GENL_UNS_ADMIN_PERM,
  11519. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  11520. NL80211_FLAG_NEED_RTNL,
  11521. },
  11522. {
  11523. .cmd = NL80211_CMD_CHANNEL_SWITCH,
  11524. .doit = nl80211_channel_switch,
  11525. .policy = nl80211_policy,
  11526. .flags = GENL_UNS_ADMIN_PERM,
  11527. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11528. NL80211_FLAG_NEED_RTNL,
  11529. },
  11530. {
  11531. .cmd = NL80211_CMD_VENDOR,
  11532. .doit = nl80211_vendor_cmd,
  11533. .dumpit = nl80211_vendor_cmd_dump,
  11534. .policy = nl80211_policy,
  11535. .flags = GENL_UNS_ADMIN_PERM,
  11536. .internal_flags = NL80211_FLAG_NEED_WIPHY |
  11537. NL80211_FLAG_NEED_RTNL,
  11538. },
  11539. {
  11540. .cmd = NL80211_CMD_SET_QOS_MAP,
  11541. .doit = nl80211_set_qos_map,
  11542. .policy = nl80211_policy,
  11543. .flags = GENL_UNS_ADMIN_PERM,
  11544. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11545. NL80211_FLAG_NEED_RTNL,
  11546. },
  11547. {
  11548. .cmd = NL80211_CMD_ADD_TX_TS,
  11549. .doit = nl80211_add_tx_ts,
  11550. .policy = nl80211_policy,
  11551. .flags = GENL_UNS_ADMIN_PERM,
  11552. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11553. NL80211_FLAG_NEED_RTNL,
  11554. },
  11555. {
  11556. .cmd = NL80211_CMD_DEL_TX_TS,
  11557. .doit = nl80211_del_tx_ts,
  11558. .policy = nl80211_policy,
  11559. .flags = GENL_UNS_ADMIN_PERM,
  11560. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11561. NL80211_FLAG_NEED_RTNL,
  11562. },
  11563. {
  11564. .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
  11565. .doit = nl80211_tdls_channel_switch,
  11566. .policy = nl80211_policy,
  11567. .flags = GENL_UNS_ADMIN_PERM,
  11568. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11569. NL80211_FLAG_NEED_RTNL,
  11570. },
  11571. {
  11572. .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
  11573. .doit = nl80211_tdls_cancel_channel_switch,
  11574. .policy = nl80211_policy,
  11575. .flags = GENL_UNS_ADMIN_PERM,
  11576. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11577. NL80211_FLAG_NEED_RTNL,
  11578. },
  11579. {
  11580. .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
  11581. .doit = nl80211_set_multicast_to_unicast,
  11582. .policy = nl80211_policy,
  11583. .flags = GENL_UNS_ADMIN_PERM,
  11584. .internal_flags = NL80211_FLAG_NEED_NETDEV |
  11585. NL80211_FLAG_NEED_RTNL,
  11586. },
  11587. {
  11588. .cmd = NL80211_CMD_SET_PMK,
  11589. .doit = nl80211_set_pmk,
  11590. .policy = nl80211_policy,
  11591. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11592. NL80211_FLAG_NEED_RTNL,
  11593. },
  11594. {
  11595. .cmd = NL80211_CMD_DEL_PMK,
  11596. .doit = nl80211_del_pmk,
  11597. .policy = nl80211_policy,
  11598. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11599. NL80211_FLAG_NEED_RTNL,
  11600. },
  11601. {
  11602. .cmd = NL80211_CMD_EXTERNAL_AUTH,
  11603. .doit = nl80211_external_auth,
  11604. .policy = nl80211_policy,
  11605. .flags = GENL_ADMIN_PERM,
  11606. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11607. NL80211_FLAG_NEED_RTNL,
  11608. },
  11609. {
  11610. .cmd = NL80211_CMD_CONTROL_PORT_FRAME,
  11611. .doit = nl80211_tx_control_port,
  11612. .policy = nl80211_policy,
  11613. .flags = GENL_UNS_ADMIN_PERM,
  11614. .internal_flags = NL80211_FLAG_NEED_NETDEV_UP |
  11615. NL80211_FLAG_NEED_RTNL,
  11616. },
  11617. };
  11618. static struct genl_family nl80211_fam __ro_after_init = {
  11619. .name = NL80211_GENL_NAME, /* have users key off the name instead */
  11620. .hdrsize = 0, /* no private header */
  11621. .version = 1, /* no particular meaning now */
  11622. .maxattr = NL80211_ATTR_MAX,
  11623. .netnsok = true,
  11624. .pre_doit = nl80211_pre_doit,
  11625. .post_doit = nl80211_post_doit,
  11626. .module = THIS_MODULE,
  11627. .ops = nl80211_ops,
  11628. .n_ops = ARRAY_SIZE(nl80211_ops),
  11629. .mcgrps = nl80211_mcgrps,
  11630. .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
  11631. };
  11632. /* notification functions */
  11633. void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
  11634. enum nl80211_commands cmd)
  11635. {
  11636. struct sk_buff *msg;
  11637. struct nl80211_dump_wiphy_state state = {};
  11638. WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
  11639. cmd != NL80211_CMD_DEL_WIPHY);
  11640. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11641. if (!msg)
  11642. return;
  11643. if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
  11644. nlmsg_free(msg);
  11645. return;
  11646. }
  11647. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  11648. NL80211_MCGRP_CONFIG, GFP_KERNEL);
  11649. }
  11650. void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
  11651. struct wireless_dev *wdev,
  11652. enum nl80211_commands cmd)
  11653. {
  11654. struct sk_buff *msg;
  11655. WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
  11656. cmd != NL80211_CMD_DEL_INTERFACE);
  11657. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11658. if (!msg)
  11659. return;
  11660. if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev,
  11661. cmd == NL80211_CMD_DEL_INTERFACE) < 0) {
  11662. nlmsg_free(msg);
  11663. return;
  11664. }
  11665. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  11666. NL80211_MCGRP_CONFIG, GFP_KERNEL);
  11667. }
  11668. static int nl80211_add_scan_req(struct sk_buff *msg,
  11669. struct cfg80211_registered_device *rdev)
  11670. {
  11671. struct cfg80211_scan_request *req = rdev->scan_req;
  11672. struct nlattr *nest;
  11673. int i;
  11674. if (WARN_ON(!req))
  11675. return 0;
  11676. nest = nla_nest_start(msg, NL80211_ATTR_SCAN_SSIDS);
  11677. if (!nest)
  11678. goto nla_put_failure;
  11679. for (i = 0; i < req->n_ssids; i++) {
  11680. if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
  11681. goto nla_put_failure;
  11682. }
  11683. nla_nest_end(msg, nest);
  11684. nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQUENCIES);
  11685. if (!nest)
  11686. goto nla_put_failure;
  11687. for (i = 0; i < req->n_channels; i++) {
  11688. if (nla_put_u32(msg, i, req->channels[i]->center_freq))
  11689. goto nla_put_failure;
  11690. }
  11691. nla_nest_end(msg, nest);
  11692. if (req->ie &&
  11693. nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
  11694. goto nla_put_failure;
  11695. if (req->flags &&
  11696. nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
  11697. goto nla_put_failure;
  11698. if (req->info.scan_start_tsf &&
  11699. (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
  11700. req->info.scan_start_tsf, NL80211_BSS_PAD) ||
  11701. nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
  11702. req->info.tsf_bssid)))
  11703. goto nla_put_failure;
  11704. return 0;
  11705. nla_put_failure:
  11706. return -ENOBUFS;
  11707. }
  11708. static int nl80211_prep_scan_msg(struct sk_buff *msg,
  11709. struct cfg80211_registered_device *rdev,
  11710. struct wireless_dev *wdev,
  11711. u32 portid, u32 seq, int flags,
  11712. u32 cmd)
  11713. {
  11714. void *hdr;
  11715. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  11716. if (!hdr)
  11717. return -1;
  11718. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  11719. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  11720. wdev->netdev->ifindex)) ||
  11721. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  11722. NL80211_ATTR_PAD))
  11723. goto nla_put_failure;
  11724. /* ignore errors and send incomplete event anyway */
  11725. nl80211_add_scan_req(msg, rdev);
  11726. genlmsg_end(msg, hdr);
  11727. return 0;
  11728. nla_put_failure:
  11729. genlmsg_cancel(msg, hdr);
  11730. return -EMSGSIZE;
  11731. }
  11732. static int
  11733. nl80211_prep_sched_scan_msg(struct sk_buff *msg,
  11734. struct cfg80211_sched_scan_request *req, u32 cmd)
  11735. {
  11736. void *hdr;
  11737. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  11738. if (!hdr)
  11739. return -1;
  11740. if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
  11741. wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
  11742. nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
  11743. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
  11744. NL80211_ATTR_PAD))
  11745. goto nla_put_failure;
  11746. genlmsg_end(msg, hdr);
  11747. return 0;
  11748. nla_put_failure:
  11749. genlmsg_cancel(msg, hdr);
  11750. return -EMSGSIZE;
  11751. }
  11752. void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
  11753. struct wireless_dev *wdev)
  11754. {
  11755. struct sk_buff *msg;
  11756. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11757. if (!msg)
  11758. return;
  11759. if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
  11760. NL80211_CMD_TRIGGER_SCAN) < 0) {
  11761. nlmsg_free(msg);
  11762. return;
  11763. }
  11764. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  11765. NL80211_MCGRP_SCAN, GFP_KERNEL);
  11766. }
  11767. struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
  11768. struct wireless_dev *wdev, bool aborted)
  11769. {
  11770. struct sk_buff *msg;
  11771. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11772. if (!msg)
  11773. return NULL;
  11774. if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
  11775. aborted ? NL80211_CMD_SCAN_ABORTED :
  11776. NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
  11777. nlmsg_free(msg);
  11778. return NULL;
  11779. }
  11780. return msg;
  11781. }
  11782. /* send message created by nl80211_build_scan_msg() */
  11783. void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
  11784. struct sk_buff *msg)
  11785. {
  11786. if (!msg)
  11787. return;
  11788. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  11789. NL80211_MCGRP_SCAN, GFP_KERNEL);
  11790. }
  11791. void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
  11792. {
  11793. struct sk_buff *msg;
  11794. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11795. if (!msg)
  11796. return;
  11797. if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
  11798. nlmsg_free(msg);
  11799. return;
  11800. }
  11801. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
  11802. NL80211_MCGRP_SCAN, GFP_KERNEL);
  11803. }
  11804. static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
  11805. struct regulatory_request *request)
  11806. {
  11807. /* Userspace can always count this one always being set */
  11808. if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
  11809. goto nla_put_failure;
  11810. if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
  11811. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  11812. NL80211_REGDOM_TYPE_WORLD))
  11813. goto nla_put_failure;
  11814. } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
  11815. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  11816. NL80211_REGDOM_TYPE_CUSTOM_WORLD))
  11817. goto nla_put_failure;
  11818. } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
  11819. request->intersect) {
  11820. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  11821. NL80211_REGDOM_TYPE_INTERSECTION))
  11822. goto nla_put_failure;
  11823. } else {
  11824. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  11825. NL80211_REGDOM_TYPE_COUNTRY) ||
  11826. nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
  11827. request->alpha2))
  11828. goto nla_put_failure;
  11829. }
  11830. if (request->wiphy_idx != WIPHY_IDX_INVALID) {
  11831. struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
  11832. if (wiphy &&
  11833. nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
  11834. goto nla_put_failure;
  11835. if (wiphy &&
  11836. wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  11837. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  11838. goto nla_put_failure;
  11839. }
  11840. return true;
  11841. nla_put_failure:
  11842. return false;
  11843. }
  11844. /*
  11845. * This can happen on global regulatory changes or device specific settings
  11846. * based on custom regulatory domains.
  11847. */
  11848. void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
  11849. struct regulatory_request *request)
  11850. {
  11851. struct sk_buff *msg;
  11852. void *hdr;
  11853. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11854. if (!msg)
  11855. return;
  11856. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
  11857. if (!hdr) {
  11858. nlmsg_free(msg);
  11859. return;
  11860. }
  11861. if (nl80211_reg_change_event_fill(msg, request) == false)
  11862. goto nla_put_failure;
  11863. genlmsg_end(msg, hdr);
  11864. rcu_read_lock();
  11865. genlmsg_multicast_allns(&nl80211_fam, msg, 0,
  11866. NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
  11867. rcu_read_unlock();
  11868. return;
  11869. nla_put_failure:
  11870. nlmsg_free(msg);
  11871. }
  11872. static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
  11873. struct net_device *netdev,
  11874. const u8 *buf, size_t len,
  11875. enum nl80211_commands cmd, gfp_t gfp,
  11876. int uapsd_queues)
  11877. {
  11878. struct sk_buff *msg;
  11879. void *hdr;
  11880. msg = nlmsg_new(100 + len, gfp);
  11881. if (!msg)
  11882. return;
  11883. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  11884. if (!hdr) {
  11885. nlmsg_free(msg);
  11886. return;
  11887. }
  11888. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  11889. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  11890. nla_put(msg, NL80211_ATTR_FRAME, len, buf))
  11891. goto nla_put_failure;
  11892. if (uapsd_queues >= 0) {
  11893. struct nlattr *nla_wmm =
  11894. nla_nest_start(msg, NL80211_ATTR_STA_WME);
  11895. if (!nla_wmm)
  11896. goto nla_put_failure;
  11897. if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
  11898. uapsd_queues))
  11899. goto nla_put_failure;
  11900. nla_nest_end(msg, nla_wmm);
  11901. }
  11902. genlmsg_end(msg, hdr);
  11903. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  11904. NL80211_MCGRP_MLME, gfp);
  11905. return;
  11906. nla_put_failure:
  11907. nlmsg_free(msg);
  11908. }
  11909. void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
  11910. struct net_device *netdev, const u8 *buf,
  11911. size_t len, gfp_t gfp)
  11912. {
  11913. nl80211_send_mlme_event(rdev, netdev, buf, len,
  11914. NL80211_CMD_AUTHENTICATE, gfp, -1);
  11915. }
  11916. void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
  11917. struct net_device *netdev, const u8 *buf,
  11918. size_t len, gfp_t gfp, int uapsd_queues)
  11919. {
  11920. nl80211_send_mlme_event(rdev, netdev, buf, len,
  11921. NL80211_CMD_ASSOCIATE, gfp, uapsd_queues);
  11922. }
  11923. void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
  11924. struct net_device *netdev, const u8 *buf,
  11925. size_t len, gfp_t gfp)
  11926. {
  11927. nl80211_send_mlme_event(rdev, netdev, buf, len,
  11928. NL80211_CMD_DEAUTHENTICATE, gfp, -1);
  11929. }
  11930. void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
  11931. struct net_device *netdev, const u8 *buf,
  11932. size_t len, gfp_t gfp)
  11933. {
  11934. nl80211_send_mlme_event(rdev, netdev, buf, len,
  11935. NL80211_CMD_DISASSOCIATE, gfp, -1);
  11936. }
  11937. void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
  11938. size_t len)
  11939. {
  11940. struct wireless_dev *wdev = dev->ieee80211_ptr;
  11941. struct wiphy *wiphy = wdev->wiphy;
  11942. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  11943. const struct ieee80211_mgmt *mgmt = (void *)buf;
  11944. u32 cmd;
  11945. if (WARN_ON(len < 2))
  11946. return;
  11947. if (ieee80211_is_deauth(mgmt->frame_control))
  11948. cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
  11949. else
  11950. cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
  11951. trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
  11952. nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1);
  11953. }
  11954. EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
  11955. static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
  11956. struct net_device *netdev, int cmd,
  11957. const u8 *addr, gfp_t gfp)
  11958. {
  11959. struct sk_buff *msg;
  11960. void *hdr;
  11961. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  11962. if (!msg)
  11963. return;
  11964. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  11965. if (!hdr) {
  11966. nlmsg_free(msg);
  11967. return;
  11968. }
  11969. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  11970. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  11971. nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
  11972. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
  11973. goto nla_put_failure;
  11974. genlmsg_end(msg, hdr);
  11975. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  11976. NL80211_MCGRP_MLME, gfp);
  11977. return;
  11978. nla_put_failure:
  11979. nlmsg_free(msg);
  11980. }
  11981. void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
  11982. struct net_device *netdev, const u8 *addr,
  11983. gfp_t gfp)
  11984. {
  11985. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
  11986. addr, gfp);
  11987. }
  11988. void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
  11989. struct net_device *netdev, const u8 *addr,
  11990. gfp_t gfp)
  11991. {
  11992. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
  11993. addr, gfp);
  11994. }
  11995. void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
  11996. struct net_device *netdev,
  11997. struct cfg80211_connect_resp_params *cr,
  11998. gfp_t gfp)
  11999. {
  12000. struct sk_buff *msg;
  12001. void *hdr;
  12002. msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
  12003. cr->fils.kek_len + cr->fils.pmk_len +
  12004. (cr->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
  12005. if (!msg)
  12006. return;
  12007. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
  12008. if (!hdr) {
  12009. nlmsg_free(msg);
  12010. return;
  12011. }
  12012. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12013. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  12014. (cr->bssid &&
  12015. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, cr->bssid)) ||
  12016. nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
  12017. cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
  12018. cr->status) ||
  12019. (cr->status < 0 &&
  12020. (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
  12021. nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
  12022. cr->timeout_reason))) ||
  12023. (cr->req_ie &&
  12024. nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
  12025. (cr->resp_ie &&
  12026. nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
  12027. cr->resp_ie)) ||
  12028. (cr->fils.update_erp_next_seq_num &&
  12029. nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
  12030. cr->fils.erp_next_seq_num)) ||
  12031. (cr->status == WLAN_STATUS_SUCCESS &&
  12032. ((cr->fils.kek &&
  12033. nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len,
  12034. cr->fils.kek)) ||
  12035. (cr->fils.pmk &&
  12036. nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) ||
  12037. (cr->fils.pmkid &&
  12038. nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid)))))
  12039. goto nla_put_failure;
  12040. genlmsg_end(msg, hdr);
  12041. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12042. NL80211_MCGRP_MLME, gfp);
  12043. return;
  12044. nla_put_failure:
  12045. nlmsg_free(msg);
  12046. }
  12047. void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
  12048. struct net_device *netdev,
  12049. struct cfg80211_roam_info *info, gfp_t gfp)
  12050. {
  12051. struct sk_buff *msg;
  12052. void *hdr;
  12053. const u8 *bssid = info->bss ? info->bss->bssid : info->bssid;
  12054. msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len +
  12055. info->fils.kek_len + info->fils.pmk_len +
  12056. (info->fils.pmkid ? WLAN_PMKID_LEN : 0), gfp);
  12057. if (!msg)
  12058. return;
  12059. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
  12060. if (!hdr) {
  12061. nlmsg_free(msg);
  12062. return;
  12063. }
  12064. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12065. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  12066. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid) ||
  12067. (info->req_ie &&
  12068. nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
  12069. info->req_ie)) ||
  12070. (info->resp_ie &&
  12071. nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
  12072. info->resp_ie)) ||
  12073. (info->fils.update_erp_next_seq_num &&
  12074. nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
  12075. info->fils.erp_next_seq_num)) ||
  12076. (info->fils.kek &&
  12077. nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len,
  12078. info->fils.kek)) ||
  12079. (info->fils.pmk &&
  12080. nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) ||
  12081. (info->fils.pmkid &&
  12082. nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid)))
  12083. goto nla_put_failure;
  12084. genlmsg_end(msg, hdr);
  12085. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12086. NL80211_MCGRP_MLME, gfp);
  12087. return;
  12088. nla_put_failure:
  12089. nlmsg_free(msg);
  12090. }
  12091. void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
  12092. struct net_device *netdev, const u8 *bssid)
  12093. {
  12094. struct sk_buff *msg;
  12095. void *hdr;
  12096. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  12097. if (!msg)
  12098. return;
  12099. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
  12100. if (!hdr) {
  12101. nlmsg_free(msg);
  12102. return;
  12103. }
  12104. if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  12105. goto nla_put_failure;
  12106. genlmsg_end(msg, hdr);
  12107. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12108. NL80211_MCGRP_MLME, GFP_KERNEL);
  12109. return;
  12110. nla_put_failure:
  12111. nlmsg_free(msg);
  12112. }
  12113. void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
  12114. struct net_device *netdev, u16 reason,
  12115. const u8 *ie, size_t ie_len, bool from_ap)
  12116. {
  12117. struct sk_buff *msg;
  12118. void *hdr;
  12119. msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
  12120. if (!msg)
  12121. return;
  12122. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
  12123. if (!hdr) {
  12124. nlmsg_free(msg);
  12125. return;
  12126. }
  12127. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12128. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  12129. (reason &&
  12130. nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
  12131. (from_ap &&
  12132. nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
  12133. (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
  12134. goto nla_put_failure;
  12135. genlmsg_end(msg, hdr);
  12136. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12137. NL80211_MCGRP_MLME, GFP_KERNEL);
  12138. return;
  12139. nla_put_failure:
  12140. nlmsg_free(msg);
  12141. }
  12142. void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
  12143. struct net_device *netdev, const u8 *bssid,
  12144. gfp_t gfp)
  12145. {
  12146. struct sk_buff *msg;
  12147. void *hdr;
  12148. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12149. if (!msg)
  12150. return;
  12151. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
  12152. if (!hdr) {
  12153. nlmsg_free(msg);
  12154. return;
  12155. }
  12156. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12157. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  12158. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  12159. goto nla_put_failure;
  12160. genlmsg_end(msg, hdr);
  12161. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12162. NL80211_MCGRP_MLME, gfp);
  12163. return;
  12164. nla_put_failure:
  12165. nlmsg_free(msg);
  12166. }
  12167. void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
  12168. const u8* ie, u8 ie_len, gfp_t gfp)
  12169. {
  12170. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12171. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  12172. struct sk_buff *msg;
  12173. void *hdr;
  12174. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
  12175. return;
  12176. trace_cfg80211_notify_new_peer_candidate(dev, addr);
  12177. msg = nlmsg_new(100 + ie_len, gfp);
  12178. if (!msg)
  12179. return;
  12180. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
  12181. if (!hdr) {
  12182. nlmsg_free(msg);
  12183. return;
  12184. }
  12185. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12186. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  12187. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  12188. (ie_len && ie &&
  12189. nla_put(msg, NL80211_ATTR_IE, ie_len , ie)))
  12190. goto nla_put_failure;
  12191. genlmsg_end(msg, hdr);
  12192. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12193. NL80211_MCGRP_MLME, gfp);
  12194. return;
  12195. nla_put_failure:
  12196. nlmsg_free(msg);
  12197. }
  12198. EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
  12199. void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
  12200. struct net_device *netdev, const u8 *addr,
  12201. enum nl80211_key_type key_type, int key_id,
  12202. const u8 *tsc, gfp_t gfp)
  12203. {
  12204. struct sk_buff *msg;
  12205. void *hdr;
  12206. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12207. if (!msg)
  12208. return;
  12209. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
  12210. if (!hdr) {
  12211. nlmsg_free(msg);
  12212. return;
  12213. }
  12214. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12215. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  12216. (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
  12217. nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
  12218. (key_id != -1 &&
  12219. nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
  12220. (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
  12221. goto nla_put_failure;
  12222. genlmsg_end(msg, hdr);
  12223. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12224. NL80211_MCGRP_MLME, gfp);
  12225. return;
  12226. nla_put_failure:
  12227. nlmsg_free(msg);
  12228. }
  12229. void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
  12230. struct ieee80211_channel *channel_before,
  12231. struct ieee80211_channel *channel_after)
  12232. {
  12233. struct sk_buff *msg;
  12234. void *hdr;
  12235. struct nlattr *nl_freq;
  12236. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
  12237. if (!msg)
  12238. return;
  12239. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
  12240. if (!hdr) {
  12241. nlmsg_free(msg);
  12242. return;
  12243. }
  12244. /*
  12245. * Since we are applying the beacon hint to a wiphy we know its
  12246. * wiphy_idx is valid
  12247. */
  12248. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  12249. goto nla_put_failure;
  12250. /* Before */
  12251. nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_BEFORE);
  12252. if (!nl_freq)
  12253. goto nla_put_failure;
  12254. if (nl80211_msg_put_channel(msg, wiphy, channel_before, false))
  12255. goto nla_put_failure;
  12256. nla_nest_end(msg, nl_freq);
  12257. /* After */
  12258. nl_freq = nla_nest_start(msg, NL80211_ATTR_FREQ_AFTER);
  12259. if (!nl_freq)
  12260. goto nla_put_failure;
  12261. if (nl80211_msg_put_channel(msg, wiphy, channel_after, false))
  12262. goto nla_put_failure;
  12263. nla_nest_end(msg, nl_freq);
  12264. genlmsg_end(msg, hdr);
  12265. rcu_read_lock();
  12266. genlmsg_multicast_allns(&nl80211_fam, msg, 0,
  12267. NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
  12268. rcu_read_unlock();
  12269. return;
  12270. nla_put_failure:
  12271. nlmsg_free(msg);
  12272. }
  12273. static void nl80211_send_remain_on_chan_event(
  12274. int cmd, struct cfg80211_registered_device *rdev,
  12275. struct wireless_dev *wdev, u64 cookie,
  12276. struct ieee80211_channel *chan,
  12277. unsigned int duration, gfp_t gfp)
  12278. {
  12279. struct sk_buff *msg;
  12280. void *hdr;
  12281. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12282. if (!msg)
  12283. return;
  12284. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  12285. if (!hdr) {
  12286. nlmsg_free(msg);
  12287. return;
  12288. }
  12289. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12290. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  12291. wdev->netdev->ifindex)) ||
  12292. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12293. NL80211_ATTR_PAD) ||
  12294. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
  12295. nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
  12296. NL80211_CHAN_NO_HT) ||
  12297. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  12298. NL80211_ATTR_PAD))
  12299. goto nla_put_failure;
  12300. if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
  12301. nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
  12302. goto nla_put_failure;
  12303. genlmsg_end(msg, hdr);
  12304. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12305. NL80211_MCGRP_MLME, gfp);
  12306. return;
  12307. nla_put_failure:
  12308. nlmsg_free(msg);
  12309. }
  12310. void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
  12311. struct ieee80211_channel *chan,
  12312. unsigned int duration, gfp_t gfp)
  12313. {
  12314. struct wiphy *wiphy = wdev->wiphy;
  12315. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12316. trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
  12317. nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
  12318. rdev, wdev, cookie, chan,
  12319. duration, gfp);
  12320. }
  12321. EXPORT_SYMBOL(cfg80211_ready_on_channel);
  12322. void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
  12323. struct ieee80211_channel *chan,
  12324. gfp_t gfp)
  12325. {
  12326. struct wiphy *wiphy = wdev->wiphy;
  12327. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12328. trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
  12329. nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  12330. rdev, wdev, cookie, chan, 0, gfp);
  12331. }
  12332. EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
  12333. void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
  12334. struct station_info *sinfo, gfp_t gfp)
  12335. {
  12336. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  12337. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12338. struct sk_buff *msg;
  12339. trace_cfg80211_new_sta(dev, mac_addr, sinfo);
  12340. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12341. if (!msg)
  12342. return;
  12343. if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
  12344. rdev, dev, mac_addr, sinfo) < 0) {
  12345. nlmsg_free(msg);
  12346. return;
  12347. }
  12348. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12349. NL80211_MCGRP_MLME, gfp);
  12350. }
  12351. EXPORT_SYMBOL(cfg80211_new_sta);
  12352. void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
  12353. struct station_info *sinfo, gfp_t gfp)
  12354. {
  12355. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  12356. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12357. struct sk_buff *msg;
  12358. struct station_info empty_sinfo = {};
  12359. if (!sinfo)
  12360. sinfo = &empty_sinfo;
  12361. trace_cfg80211_del_sta(dev, mac_addr);
  12362. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12363. if (!msg) {
  12364. cfg80211_sinfo_release_content(sinfo);
  12365. return;
  12366. }
  12367. if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
  12368. rdev, dev, mac_addr, sinfo) < 0) {
  12369. nlmsg_free(msg);
  12370. return;
  12371. }
  12372. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12373. NL80211_MCGRP_MLME, gfp);
  12374. }
  12375. EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
  12376. void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
  12377. enum nl80211_connect_failed_reason reason,
  12378. gfp_t gfp)
  12379. {
  12380. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  12381. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12382. struct sk_buff *msg;
  12383. void *hdr;
  12384. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  12385. if (!msg)
  12386. return;
  12387. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
  12388. if (!hdr) {
  12389. nlmsg_free(msg);
  12390. return;
  12391. }
  12392. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  12393. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
  12394. nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
  12395. goto nla_put_failure;
  12396. genlmsg_end(msg, hdr);
  12397. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12398. NL80211_MCGRP_MLME, gfp);
  12399. return;
  12400. nla_put_failure:
  12401. nlmsg_free(msg);
  12402. }
  12403. EXPORT_SYMBOL(cfg80211_conn_failed);
  12404. static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
  12405. const u8 *addr, gfp_t gfp)
  12406. {
  12407. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12408. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  12409. struct sk_buff *msg;
  12410. void *hdr;
  12411. u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
  12412. if (!nlportid)
  12413. return false;
  12414. msg = nlmsg_new(100, gfp);
  12415. if (!msg)
  12416. return true;
  12417. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  12418. if (!hdr) {
  12419. nlmsg_free(msg);
  12420. return true;
  12421. }
  12422. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12423. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  12424. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
  12425. goto nla_put_failure;
  12426. genlmsg_end(msg, hdr);
  12427. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  12428. return true;
  12429. nla_put_failure:
  12430. nlmsg_free(msg);
  12431. return true;
  12432. }
  12433. bool cfg80211_rx_spurious_frame(struct net_device *dev,
  12434. const u8 *addr, gfp_t gfp)
  12435. {
  12436. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12437. bool ret;
  12438. trace_cfg80211_rx_spurious_frame(dev, addr);
  12439. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  12440. wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
  12441. trace_cfg80211_return_bool(false);
  12442. return false;
  12443. }
  12444. ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
  12445. addr, gfp);
  12446. trace_cfg80211_return_bool(ret);
  12447. return ret;
  12448. }
  12449. EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
  12450. bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
  12451. const u8 *addr, gfp_t gfp)
  12452. {
  12453. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12454. bool ret;
  12455. trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
  12456. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  12457. wdev->iftype != NL80211_IFTYPE_P2P_GO &&
  12458. wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
  12459. trace_cfg80211_return_bool(false);
  12460. return false;
  12461. }
  12462. ret = __nl80211_unexpected_frame(dev,
  12463. NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
  12464. addr, gfp);
  12465. trace_cfg80211_return_bool(ret);
  12466. return ret;
  12467. }
  12468. EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
  12469. int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
  12470. struct wireless_dev *wdev, u32 nlportid,
  12471. int freq, int sig_dbm,
  12472. const u8 *buf, size_t len, u32 flags, gfp_t gfp)
  12473. {
  12474. struct net_device *netdev = wdev->netdev;
  12475. struct sk_buff *msg;
  12476. void *hdr;
  12477. msg = nlmsg_new(100 + len, gfp);
  12478. if (!msg)
  12479. return -ENOMEM;
  12480. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  12481. if (!hdr) {
  12482. nlmsg_free(msg);
  12483. return -ENOMEM;
  12484. }
  12485. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12486. (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  12487. netdev->ifindex)) ||
  12488. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12489. NL80211_ATTR_PAD) ||
  12490. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq) ||
  12491. (sig_dbm &&
  12492. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
  12493. nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
  12494. (flags &&
  12495. nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, flags)))
  12496. goto nla_put_failure;
  12497. genlmsg_end(msg, hdr);
  12498. return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  12499. nla_put_failure:
  12500. nlmsg_free(msg);
  12501. return -ENOBUFS;
  12502. }
  12503. void cfg80211_mgmt_tx_status(struct wireless_dev *wdev, u64 cookie,
  12504. const u8 *buf, size_t len, bool ack, gfp_t gfp)
  12505. {
  12506. struct wiphy *wiphy = wdev->wiphy;
  12507. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12508. struct net_device *netdev = wdev->netdev;
  12509. struct sk_buff *msg;
  12510. void *hdr;
  12511. trace_cfg80211_mgmt_tx_status(wdev, cookie, ack);
  12512. msg = nlmsg_new(100 + len, gfp);
  12513. if (!msg)
  12514. return;
  12515. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME_TX_STATUS);
  12516. if (!hdr) {
  12517. nlmsg_free(msg);
  12518. return;
  12519. }
  12520. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12521. (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  12522. netdev->ifindex)) ||
  12523. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12524. NL80211_ATTR_PAD) ||
  12525. nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
  12526. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  12527. NL80211_ATTR_PAD) ||
  12528. (ack && nla_put_flag(msg, NL80211_ATTR_ACK)))
  12529. goto nla_put_failure;
  12530. genlmsg_end(msg, hdr);
  12531. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12532. NL80211_MCGRP_MLME, gfp);
  12533. return;
  12534. nla_put_failure:
  12535. nlmsg_free(msg);
  12536. }
  12537. EXPORT_SYMBOL(cfg80211_mgmt_tx_status);
  12538. static int __nl80211_rx_control_port(struct net_device *dev,
  12539. const u8 *buf, size_t len,
  12540. const u8 *addr, u16 proto,
  12541. bool unencrypted, gfp_t gfp)
  12542. {
  12543. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12544. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  12545. struct sk_buff *msg;
  12546. void *hdr;
  12547. u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid);
  12548. if (!nlportid)
  12549. return -ENOENT;
  12550. msg = nlmsg_new(100 + len, gfp);
  12551. if (!msg)
  12552. return -ENOMEM;
  12553. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME);
  12554. if (!hdr) {
  12555. nlmsg_free(msg);
  12556. return -ENOBUFS;
  12557. }
  12558. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12559. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  12560. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12561. NL80211_ATTR_PAD) ||
  12562. nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
  12563. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  12564. nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) ||
  12565. (unencrypted && nla_put_flag(msg,
  12566. NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT)))
  12567. goto nla_put_failure;
  12568. genlmsg_end(msg, hdr);
  12569. return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  12570. nla_put_failure:
  12571. nlmsg_free(msg);
  12572. return -ENOBUFS;
  12573. }
  12574. bool cfg80211_rx_control_port(struct net_device *dev,
  12575. const u8 *buf, size_t len,
  12576. const u8 *addr, u16 proto, bool unencrypted)
  12577. {
  12578. int ret;
  12579. trace_cfg80211_rx_control_port(dev, buf, len, addr, proto, unencrypted);
  12580. ret = __nl80211_rx_control_port(dev, buf, len, addr, proto,
  12581. unencrypted, GFP_ATOMIC);
  12582. trace_cfg80211_return_bool(ret == 0);
  12583. return ret == 0;
  12584. }
  12585. EXPORT_SYMBOL(cfg80211_rx_control_port);
  12586. static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
  12587. const char *mac, gfp_t gfp)
  12588. {
  12589. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12590. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  12591. struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12592. void **cb;
  12593. if (!msg)
  12594. return NULL;
  12595. cb = (void **)msg->cb;
  12596. cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
  12597. if (!cb[0]) {
  12598. nlmsg_free(msg);
  12599. return NULL;
  12600. }
  12601. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12602. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  12603. goto nla_put_failure;
  12604. if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
  12605. goto nla_put_failure;
  12606. cb[1] = nla_nest_start(msg, NL80211_ATTR_CQM);
  12607. if (!cb[1])
  12608. goto nla_put_failure;
  12609. cb[2] = rdev;
  12610. return msg;
  12611. nla_put_failure:
  12612. nlmsg_free(msg);
  12613. return NULL;
  12614. }
  12615. static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
  12616. {
  12617. void **cb = (void **)msg->cb;
  12618. struct cfg80211_registered_device *rdev = cb[2];
  12619. nla_nest_end(msg, cb[1]);
  12620. genlmsg_end(msg, cb[0]);
  12621. memset(msg->cb, 0, sizeof(msg->cb));
  12622. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12623. NL80211_MCGRP_MLME, gfp);
  12624. }
  12625. void cfg80211_cqm_rssi_notify(struct net_device *dev,
  12626. enum nl80211_cqm_rssi_threshold_event rssi_event,
  12627. s32 rssi_level, gfp_t gfp)
  12628. {
  12629. struct sk_buff *msg;
  12630. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12631. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  12632. trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
  12633. if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
  12634. rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
  12635. return;
  12636. if (wdev->cqm_config) {
  12637. wdev->cqm_config->last_rssi_event_value = rssi_level;
  12638. cfg80211_cqm_rssi_update(rdev, dev);
  12639. if (rssi_level == 0)
  12640. rssi_level = wdev->cqm_config->last_rssi_event_value;
  12641. }
  12642. msg = cfg80211_prepare_cqm(dev, NULL, gfp);
  12643. if (!msg)
  12644. return;
  12645. if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
  12646. rssi_event))
  12647. goto nla_put_failure;
  12648. if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
  12649. rssi_level))
  12650. goto nla_put_failure;
  12651. cfg80211_send_cqm(msg, gfp);
  12652. return;
  12653. nla_put_failure:
  12654. nlmsg_free(msg);
  12655. }
  12656. EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
  12657. void cfg80211_cqm_txe_notify(struct net_device *dev,
  12658. const u8 *peer, u32 num_packets,
  12659. u32 rate, u32 intvl, gfp_t gfp)
  12660. {
  12661. struct sk_buff *msg;
  12662. msg = cfg80211_prepare_cqm(dev, peer, gfp);
  12663. if (!msg)
  12664. return;
  12665. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
  12666. goto nla_put_failure;
  12667. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
  12668. goto nla_put_failure;
  12669. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
  12670. goto nla_put_failure;
  12671. cfg80211_send_cqm(msg, gfp);
  12672. return;
  12673. nla_put_failure:
  12674. nlmsg_free(msg);
  12675. }
  12676. EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
  12677. void cfg80211_cqm_pktloss_notify(struct net_device *dev,
  12678. const u8 *peer, u32 num_packets, gfp_t gfp)
  12679. {
  12680. struct sk_buff *msg;
  12681. trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
  12682. msg = cfg80211_prepare_cqm(dev, peer, gfp);
  12683. if (!msg)
  12684. return;
  12685. if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
  12686. goto nla_put_failure;
  12687. cfg80211_send_cqm(msg, gfp);
  12688. return;
  12689. nla_put_failure:
  12690. nlmsg_free(msg);
  12691. }
  12692. EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
  12693. void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
  12694. {
  12695. struct sk_buff *msg;
  12696. msg = cfg80211_prepare_cqm(dev, NULL, gfp);
  12697. if (!msg)
  12698. return;
  12699. if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
  12700. goto nla_put_failure;
  12701. cfg80211_send_cqm(msg, gfp);
  12702. return;
  12703. nla_put_failure:
  12704. nlmsg_free(msg);
  12705. }
  12706. EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
  12707. static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
  12708. struct net_device *netdev, const u8 *bssid,
  12709. const u8 *replay_ctr, gfp_t gfp)
  12710. {
  12711. struct sk_buff *msg;
  12712. struct nlattr *rekey_attr;
  12713. void *hdr;
  12714. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12715. if (!msg)
  12716. return;
  12717. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
  12718. if (!hdr) {
  12719. nlmsg_free(msg);
  12720. return;
  12721. }
  12722. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12723. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  12724. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  12725. goto nla_put_failure;
  12726. rekey_attr = nla_nest_start(msg, NL80211_ATTR_REKEY_DATA);
  12727. if (!rekey_attr)
  12728. goto nla_put_failure;
  12729. if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
  12730. NL80211_REPLAY_CTR_LEN, replay_ctr))
  12731. goto nla_put_failure;
  12732. nla_nest_end(msg, rekey_attr);
  12733. genlmsg_end(msg, hdr);
  12734. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12735. NL80211_MCGRP_MLME, gfp);
  12736. return;
  12737. nla_put_failure:
  12738. nlmsg_free(msg);
  12739. }
  12740. void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
  12741. const u8 *replay_ctr, gfp_t gfp)
  12742. {
  12743. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12744. struct wiphy *wiphy = wdev->wiphy;
  12745. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12746. trace_cfg80211_gtk_rekey_notify(dev, bssid);
  12747. nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
  12748. }
  12749. EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
  12750. static void
  12751. nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
  12752. struct net_device *netdev, int index,
  12753. const u8 *bssid, bool preauth, gfp_t gfp)
  12754. {
  12755. struct sk_buff *msg;
  12756. struct nlattr *attr;
  12757. void *hdr;
  12758. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12759. if (!msg)
  12760. return;
  12761. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
  12762. if (!hdr) {
  12763. nlmsg_free(msg);
  12764. return;
  12765. }
  12766. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12767. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  12768. goto nla_put_failure;
  12769. attr = nla_nest_start(msg, NL80211_ATTR_PMKSA_CANDIDATE);
  12770. if (!attr)
  12771. goto nla_put_failure;
  12772. if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
  12773. nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
  12774. (preauth &&
  12775. nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
  12776. goto nla_put_failure;
  12777. nla_nest_end(msg, attr);
  12778. genlmsg_end(msg, hdr);
  12779. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12780. NL80211_MCGRP_MLME, gfp);
  12781. return;
  12782. nla_put_failure:
  12783. nlmsg_free(msg);
  12784. }
  12785. void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
  12786. const u8 *bssid, bool preauth, gfp_t gfp)
  12787. {
  12788. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12789. struct wiphy *wiphy = wdev->wiphy;
  12790. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12791. trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
  12792. nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
  12793. }
  12794. EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
  12795. static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
  12796. struct net_device *netdev,
  12797. struct cfg80211_chan_def *chandef,
  12798. gfp_t gfp,
  12799. enum nl80211_commands notif,
  12800. u8 count)
  12801. {
  12802. struct sk_buff *msg;
  12803. void *hdr;
  12804. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12805. if (!msg)
  12806. return;
  12807. hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
  12808. if (!hdr) {
  12809. nlmsg_free(msg);
  12810. return;
  12811. }
  12812. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  12813. goto nla_put_failure;
  12814. if (nl80211_send_chandef(msg, chandef))
  12815. goto nla_put_failure;
  12816. if ((notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) &&
  12817. (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count)))
  12818. goto nla_put_failure;
  12819. genlmsg_end(msg, hdr);
  12820. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12821. NL80211_MCGRP_MLME, gfp);
  12822. return;
  12823. nla_put_failure:
  12824. nlmsg_free(msg);
  12825. }
  12826. void cfg80211_ch_switch_notify(struct net_device *dev,
  12827. struct cfg80211_chan_def *chandef)
  12828. {
  12829. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12830. struct wiphy *wiphy = wdev->wiphy;
  12831. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12832. ASSERT_WDEV_LOCK(wdev);
  12833. trace_cfg80211_ch_switch_notify(dev, chandef);
  12834. wdev->chandef = *chandef;
  12835. wdev->preset_chandef = *chandef;
  12836. nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
  12837. NL80211_CMD_CH_SWITCH_NOTIFY, 0);
  12838. }
  12839. EXPORT_SYMBOL(cfg80211_ch_switch_notify);
  12840. void cfg80211_ch_switch_started_notify(struct net_device *dev,
  12841. struct cfg80211_chan_def *chandef,
  12842. u8 count)
  12843. {
  12844. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12845. struct wiphy *wiphy = wdev->wiphy;
  12846. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12847. trace_cfg80211_ch_switch_started_notify(dev, chandef);
  12848. nl80211_ch_switch_notify(rdev, dev, chandef, GFP_KERNEL,
  12849. NL80211_CMD_CH_SWITCH_STARTED_NOTIFY, count);
  12850. }
  12851. EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
  12852. void
  12853. nl80211_radar_notify(struct cfg80211_registered_device *rdev,
  12854. const struct cfg80211_chan_def *chandef,
  12855. enum nl80211_radar_event event,
  12856. struct net_device *netdev, gfp_t gfp)
  12857. {
  12858. struct sk_buff *msg;
  12859. void *hdr;
  12860. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12861. if (!msg)
  12862. return;
  12863. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
  12864. if (!hdr) {
  12865. nlmsg_free(msg);
  12866. return;
  12867. }
  12868. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  12869. goto nla_put_failure;
  12870. /* NOP and radar events don't need a netdev parameter */
  12871. if (netdev) {
  12872. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  12873. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  12874. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12875. NL80211_ATTR_PAD))
  12876. goto nla_put_failure;
  12877. }
  12878. if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
  12879. goto nla_put_failure;
  12880. if (nl80211_send_chandef(msg, chandef))
  12881. goto nla_put_failure;
  12882. genlmsg_end(msg, hdr);
  12883. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12884. NL80211_MCGRP_MLME, gfp);
  12885. return;
  12886. nla_put_failure:
  12887. nlmsg_free(msg);
  12888. }
  12889. void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac,
  12890. struct sta_opmode_info *sta_opmode,
  12891. gfp_t gfp)
  12892. {
  12893. struct sk_buff *msg;
  12894. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12895. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  12896. void *hdr;
  12897. if (WARN_ON(!mac))
  12898. return;
  12899. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12900. if (!msg)
  12901. return;
  12902. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED);
  12903. if (!hdr) {
  12904. nlmsg_free(msg);
  12905. return;
  12906. }
  12907. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  12908. goto nla_put_failure;
  12909. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  12910. goto nla_put_failure;
  12911. if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
  12912. goto nla_put_failure;
  12913. if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) &&
  12914. nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode))
  12915. goto nla_put_failure;
  12916. if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) &&
  12917. nla_put_u8(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw))
  12918. goto nla_put_failure;
  12919. if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) &&
  12920. nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss))
  12921. goto nla_put_failure;
  12922. genlmsg_end(msg, hdr);
  12923. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12924. NL80211_MCGRP_MLME, gfp);
  12925. return;
  12926. nla_put_failure:
  12927. nlmsg_free(msg);
  12928. }
  12929. EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify);
  12930. void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
  12931. u64 cookie, bool acked, s32 ack_signal,
  12932. bool is_valid_ack_signal, gfp_t gfp)
  12933. {
  12934. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12935. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  12936. struct sk_buff *msg;
  12937. void *hdr;
  12938. trace_cfg80211_probe_status(dev, addr, cookie, acked);
  12939. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12940. if (!msg)
  12941. return;
  12942. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
  12943. if (!hdr) {
  12944. nlmsg_free(msg);
  12945. return;
  12946. }
  12947. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12948. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  12949. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  12950. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  12951. NL80211_ATTR_PAD) ||
  12952. (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
  12953. (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL,
  12954. ack_signal)))
  12955. goto nla_put_failure;
  12956. genlmsg_end(msg, hdr);
  12957. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  12958. NL80211_MCGRP_MLME, gfp);
  12959. return;
  12960. nla_put_failure:
  12961. nlmsg_free(msg);
  12962. }
  12963. EXPORT_SYMBOL(cfg80211_probe_status);
  12964. void cfg80211_report_obss_beacon(struct wiphy *wiphy,
  12965. const u8 *frame, size_t len,
  12966. int freq, int sig_dbm)
  12967. {
  12968. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12969. struct sk_buff *msg;
  12970. void *hdr;
  12971. struct cfg80211_beacon_registration *reg;
  12972. trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
  12973. spin_lock_bh(&rdev->beacon_registrations_lock);
  12974. list_for_each_entry(reg, &rdev->beacon_registrations, list) {
  12975. msg = nlmsg_new(len + 100, GFP_ATOMIC);
  12976. if (!msg) {
  12977. spin_unlock_bh(&rdev->beacon_registrations_lock);
  12978. return;
  12979. }
  12980. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  12981. if (!hdr)
  12982. goto nla_put_failure;
  12983. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12984. (freq &&
  12985. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, freq)) ||
  12986. (sig_dbm &&
  12987. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
  12988. nla_put(msg, NL80211_ATTR_FRAME, len, frame))
  12989. goto nla_put_failure;
  12990. genlmsg_end(msg, hdr);
  12991. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
  12992. }
  12993. spin_unlock_bh(&rdev->beacon_registrations_lock);
  12994. return;
  12995. nla_put_failure:
  12996. spin_unlock_bh(&rdev->beacon_registrations_lock);
  12997. nlmsg_free(msg);
  12998. }
  12999. EXPORT_SYMBOL(cfg80211_report_obss_beacon);
  13000. #ifdef CONFIG_PM
  13001. static int cfg80211_net_detect_results(struct sk_buff *msg,
  13002. struct cfg80211_wowlan_wakeup *wakeup)
  13003. {
  13004. struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
  13005. struct nlattr *nl_results, *nl_match, *nl_freqs;
  13006. int i, j;
  13007. nl_results = nla_nest_start(
  13008. msg, NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
  13009. if (!nl_results)
  13010. return -EMSGSIZE;
  13011. for (i = 0; i < nd->n_matches; i++) {
  13012. struct cfg80211_wowlan_nd_match *match = nd->matches[i];
  13013. nl_match = nla_nest_start(msg, i);
  13014. if (!nl_match)
  13015. break;
  13016. /* The SSID attribute is optional in nl80211, but for
  13017. * simplicity reasons it's always present in the
  13018. * cfg80211 structure. If a driver can't pass the
  13019. * SSID, that needs to be changed. A zero length SSID
  13020. * is still a valid SSID (wildcard), so it cannot be
  13021. * used for this purpose.
  13022. */
  13023. if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
  13024. match->ssid.ssid)) {
  13025. nla_nest_cancel(msg, nl_match);
  13026. goto out;
  13027. }
  13028. if (match->n_channels) {
  13029. nl_freqs = nla_nest_start(
  13030. msg, NL80211_ATTR_SCAN_FREQUENCIES);
  13031. if (!nl_freqs) {
  13032. nla_nest_cancel(msg, nl_match);
  13033. goto out;
  13034. }
  13035. for (j = 0; j < match->n_channels; j++) {
  13036. if (nla_put_u32(msg, j, match->channels[j])) {
  13037. nla_nest_cancel(msg, nl_freqs);
  13038. nla_nest_cancel(msg, nl_match);
  13039. goto out;
  13040. }
  13041. }
  13042. nla_nest_end(msg, nl_freqs);
  13043. }
  13044. nla_nest_end(msg, nl_match);
  13045. }
  13046. out:
  13047. nla_nest_end(msg, nl_results);
  13048. return 0;
  13049. }
  13050. void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
  13051. struct cfg80211_wowlan_wakeup *wakeup,
  13052. gfp_t gfp)
  13053. {
  13054. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  13055. struct sk_buff *msg;
  13056. void *hdr;
  13057. int size = 200;
  13058. trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
  13059. if (wakeup)
  13060. size += wakeup->packet_present_len;
  13061. msg = nlmsg_new(size, gfp);
  13062. if (!msg)
  13063. return;
  13064. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
  13065. if (!hdr)
  13066. goto free_msg;
  13067. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  13068. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  13069. NL80211_ATTR_PAD))
  13070. goto free_msg;
  13071. if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  13072. wdev->netdev->ifindex))
  13073. goto free_msg;
  13074. if (wakeup) {
  13075. struct nlattr *reasons;
  13076. reasons = nla_nest_start(msg, NL80211_ATTR_WOWLAN_TRIGGERS);
  13077. if (!reasons)
  13078. goto free_msg;
  13079. if (wakeup->disconnect &&
  13080. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
  13081. goto free_msg;
  13082. if (wakeup->magic_pkt &&
  13083. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
  13084. goto free_msg;
  13085. if (wakeup->gtk_rekey_failure &&
  13086. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
  13087. goto free_msg;
  13088. if (wakeup->eap_identity_req &&
  13089. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
  13090. goto free_msg;
  13091. if (wakeup->four_way_handshake &&
  13092. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
  13093. goto free_msg;
  13094. if (wakeup->rfkill_release &&
  13095. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
  13096. goto free_msg;
  13097. if (wakeup->pattern_idx >= 0 &&
  13098. nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  13099. wakeup->pattern_idx))
  13100. goto free_msg;
  13101. if (wakeup->tcp_match &&
  13102. nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
  13103. goto free_msg;
  13104. if (wakeup->tcp_connlost &&
  13105. nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
  13106. goto free_msg;
  13107. if (wakeup->tcp_nomoretokens &&
  13108. nla_put_flag(msg,
  13109. NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
  13110. goto free_msg;
  13111. if (wakeup->packet) {
  13112. u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
  13113. u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
  13114. if (!wakeup->packet_80211) {
  13115. pkt_attr =
  13116. NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
  13117. len_attr =
  13118. NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
  13119. }
  13120. if (wakeup->packet_len &&
  13121. nla_put_u32(msg, len_attr, wakeup->packet_len))
  13122. goto free_msg;
  13123. if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
  13124. wakeup->packet))
  13125. goto free_msg;
  13126. }
  13127. if (wakeup->net_detect &&
  13128. cfg80211_net_detect_results(msg, wakeup))
  13129. goto free_msg;
  13130. nla_nest_end(msg, reasons);
  13131. }
  13132. genlmsg_end(msg, hdr);
  13133. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  13134. NL80211_MCGRP_MLME, gfp);
  13135. return;
  13136. free_msg:
  13137. nlmsg_free(msg);
  13138. }
  13139. EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
  13140. #endif
  13141. void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
  13142. enum nl80211_tdls_operation oper,
  13143. u16 reason_code, gfp_t gfp)
  13144. {
  13145. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13146. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  13147. struct sk_buff *msg;
  13148. void *hdr;
  13149. trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
  13150. reason_code);
  13151. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  13152. if (!msg)
  13153. return;
  13154. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
  13155. if (!hdr) {
  13156. nlmsg_free(msg);
  13157. return;
  13158. }
  13159. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  13160. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  13161. nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
  13162. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
  13163. (reason_code > 0 &&
  13164. nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
  13165. goto nla_put_failure;
  13166. genlmsg_end(msg, hdr);
  13167. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  13168. NL80211_MCGRP_MLME, gfp);
  13169. return;
  13170. nla_put_failure:
  13171. nlmsg_free(msg);
  13172. }
  13173. EXPORT_SYMBOL(cfg80211_tdls_oper_request);
  13174. static int nl80211_netlink_notify(struct notifier_block * nb,
  13175. unsigned long state,
  13176. void *_notify)
  13177. {
  13178. struct netlink_notify *notify = _notify;
  13179. struct cfg80211_registered_device *rdev;
  13180. struct wireless_dev *wdev;
  13181. struct cfg80211_beacon_registration *reg, *tmp;
  13182. if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
  13183. return NOTIFY_DONE;
  13184. rcu_read_lock();
  13185. list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
  13186. struct cfg80211_sched_scan_request *sched_scan_req;
  13187. list_for_each_entry_rcu(sched_scan_req,
  13188. &rdev->sched_scan_req_list,
  13189. list) {
  13190. if (sched_scan_req->owner_nlportid == notify->portid) {
  13191. sched_scan_req->nl_owner_dead = true;
  13192. schedule_work(&rdev->sched_scan_stop_wk);
  13193. }
  13194. }
  13195. list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
  13196. cfg80211_mlme_unregister_socket(wdev, notify->portid);
  13197. if (wdev->owner_nlportid == notify->portid) {
  13198. wdev->nl_owner_dead = true;
  13199. schedule_work(&rdev->destroy_work);
  13200. } else if (wdev->conn_owner_nlportid == notify->portid) {
  13201. schedule_work(&wdev->disconnect_wk);
  13202. }
  13203. }
  13204. spin_lock_bh(&rdev->beacon_registrations_lock);
  13205. list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
  13206. list) {
  13207. if (reg->nlportid == notify->portid) {
  13208. list_del(&reg->list);
  13209. kfree(reg);
  13210. break;
  13211. }
  13212. }
  13213. spin_unlock_bh(&rdev->beacon_registrations_lock);
  13214. }
  13215. rcu_read_unlock();
  13216. /*
  13217. * It is possible that the user space process that is controlling the
  13218. * indoor setting disappeared, so notify the regulatory core.
  13219. */
  13220. regulatory_netlink_notify(notify->portid);
  13221. return NOTIFY_OK;
  13222. }
  13223. static struct notifier_block nl80211_netlink_notifier = {
  13224. .notifier_call = nl80211_netlink_notify,
  13225. };
  13226. void cfg80211_ft_event(struct net_device *netdev,
  13227. struct cfg80211_ft_event_params *ft_event)
  13228. {
  13229. struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
  13230. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  13231. struct sk_buff *msg;
  13232. void *hdr;
  13233. trace_cfg80211_ft_event(wiphy, netdev, ft_event);
  13234. if (!ft_event->target_ap)
  13235. return;
  13236. msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len,
  13237. GFP_KERNEL);
  13238. if (!msg)
  13239. return;
  13240. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
  13241. if (!hdr)
  13242. goto out;
  13243. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  13244. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  13245. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
  13246. goto out;
  13247. if (ft_event->ies &&
  13248. nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
  13249. goto out;
  13250. if (ft_event->ric_ies &&
  13251. nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
  13252. ft_event->ric_ies))
  13253. goto out;
  13254. genlmsg_end(msg, hdr);
  13255. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  13256. NL80211_MCGRP_MLME, GFP_KERNEL);
  13257. return;
  13258. out:
  13259. nlmsg_free(msg);
  13260. }
  13261. EXPORT_SYMBOL(cfg80211_ft_event);
  13262. void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
  13263. {
  13264. struct cfg80211_registered_device *rdev;
  13265. struct sk_buff *msg;
  13266. void *hdr;
  13267. u32 nlportid;
  13268. rdev = wiphy_to_rdev(wdev->wiphy);
  13269. if (!rdev->crit_proto_nlportid)
  13270. return;
  13271. nlportid = rdev->crit_proto_nlportid;
  13272. rdev->crit_proto_nlportid = 0;
  13273. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  13274. if (!msg)
  13275. return;
  13276. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
  13277. if (!hdr)
  13278. goto nla_put_failure;
  13279. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  13280. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  13281. NL80211_ATTR_PAD))
  13282. goto nla_put_failure;
  13283. genlmsg_end(msg, hdr);
  13284. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  13285. return;
  13286. nla_put_failure:
  13287. nlmsg_free(msg);
  13288. }
  13289. EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
  13290. void nl80211_send_ap_stopped(struct wireless_dev *wdev)
  13291. {
  13292. struct wiphy *wiphy = wdev->wiphy;
  13293. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  13294. struct sk_buff *msg;
  13295. void *hdr;
  13296. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  13297. if (!msg)
  13298. return;
  13299. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
  13300. if (!hdr)
  13301. goto out;
  13302. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  13303. nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
  13304. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  13305. NL80211_ATTR_PAD))
  13306. goto out;
  13307. genlmsg_end(msg, hdr);
  13308. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
  13309. NL80211_MCGRP_MLME, GFP_KERNEL);
  13310. return;
  13311. out:
  13312. nlmsg_free(msg);
  13313. }
  13314. int cfg80211_external_auth_request(struct net_device *dev,
  13315. struct cfg80211_external_auth_params *params,
  13316. gfp_t gfp)
  13317. {
  13318. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13319. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  13320. struct sk_buff *msg;
  13321. void *hdr;
  13322. if (!wdev->conn_owner_nlportid)
  13323. return -EINVAL;
  13324. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  13325. if (!msg)
  13326. return -ENOMEM;
  13327. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
  13328. if (!hdr)
  13329. goto nla_put_failure;
  13330. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  13331. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  13332. nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) ||
  13333. nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
  13334. params->action) ||
  13335. nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
  13336. nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
  13337. params->ssid.ssid))
  13338. goto nla_put_failure;
  13339. genlmsg_end(msg, hdr);
  13340. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  13341. wdev->conn_owner_nlportid);
  13342. return 0;
  13343. nla_put_failure:
  13344. nlmsg_free(msg);
  13345. return -ENOBUFS;
  13346. }
  13347. EXPORT_SYMBOL(cfg80211_external_auth_request);
  13348. /* initialisation/exit functions */
  13349. int __init nl80211_init(void)
  13350. {
  13351. int err;
  13352. err = genl_register_family(&nl80211_fam);
  13353. if (err)
  13354. return err;
  13355. err = netlink_register_notifier(&nl80211_netlink_notifier);
  13356. if (err)
  13357. goto err_out;
  13358. return 0;
  13359. err_out:
  13360. genl_unregister_family(&nl80211_fam);
  13361. return err;
  13362. }
  13363. void nl80211_exit(void)
  13364. {
  13365. netlink_unregister_notifier(&nl80211_netlink_notifier);
  13366. genl_unregister_family(&nl80211_fam);
  13367. }