nl80211.c 540 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220422142224223422442254226422742284229423042314232423342344235423642374238423942404241424242434244424542464247424842494250425142524253425442554256425742584259426042614262426342644265426642674268426942704271427242734274427542764277427842794280428142824283428442854286428742884289429042914292429342944295429642974298429943004301430243034304430543064307430843094310431143124313431443154316431743184319432043214322432343244325432643274328432943304331433243334334433543364337433843394340434143424343434443454346434743484349435043514352435343544355435643574358435943604361436243634364436543664367436843694370437143724373437443754376437743784379438043814382438343844385438643874388438943904391439243934394439543964397439843994400440144024403440444054406440744084409441044114412441344144415441644174418441944204421442244234424442544264427442844294430443144324433443444354436443744384439444044414442444344444445444644474448444944504451445244534454445544564457445844594460446144624463446444654466446744684469447044714472447344744475447644774478447944804481448244834484448544864487448844894490449144924493449444954496449744984499450045014502450345044505450645074508450945104511451245134514451545164517451845194520452145224523452445254526452745284529453045314532453345344535453645374538453945404541454245434544454545464547454845494550455145524553455445554556455745584559456045614562456345644565456645674568456945704571457245734574457545764577457845794580458145824583458445854586458745884589459045914592459345944595459645974598459946004601460246034604460546064607460846094610461146124613461446154616461746184619462046214622462346244625462646274628462946304631463246334634463546364637463846394640464146424643464446454646464746484649465046514652465346544655465646574658465946604661466246634664466546664667466846694670467146724673467446754676467746784679468046814682468346844685468646874688468946904691469246934694469546964697469846994700470147024703470447054706470747084709471047114712471347144715471647174718471947204721472247234724472547264727472847294730473147324733473447354736473747384739474047414742474347444745474647474748474947504751475247534754475547564757475847594760476147624763476447654766476747684769477047714772477347744775477647774778477947804781478247834784478547864787478847894790479147924793479447954796479747984799480048014802480348044805480648074808480948104811481248134814481548164817481848194820482148224823482448254826482748284829483048314832483348344835483648374838483948404841484248434844484548464847484848494850485148524853485448554856485748584859486048614862486348644865486648674868486948704871487248734874487548764877487848794880488148824883488448854886488748884889489048914892489348944895489648974898489949004901490249034904490549064907490849094910491149124913491449154916491749184919492049214922492349244925492649274928492949304931493249334934493549364937493849394940494149424943494449454946494749484949495049514952495349544955495649574958495949604961496249634964496549664967496849694970497149724973497449754976497749784979498049814982498349844985498649874988498949904991499249934994499549964997499849995000500150025003500450055006500750085009501050115012501350145015501650175018501950205021502250235024502550265027502850295030503150325033503450355036503750385039504050415042504350445045504650475048504950505051505250535054505550565057505850595060506150625063506450655066506750685069507050715072507350745075507650775078507950805081508250835084508550865087508850895090509150925093509450955096509750985099510051015102510351045105510651075108510951105111511251135114511551165117511851195120512151225123512451255126512751285129513051315132513351345135513651375138513951405141514251435144514551465147514851495150515151525153515451555156515751585159516051615162516351645165516651675168516951705171517251735174517551765177517851795180518151825183518451855186518751885189519051915192519351945195519651975198519952005201520252035204520552065207520852095210521152125213521452155216521752185219522052215222522352245225522652275228522952305231523252335234523552365237523852395240524152425243524452455246524752485249525052515252525352545255525652575258525952605261526252635264526552665267526852695270527152725273527452755276527752785279528052815282528352845285528652875288528952905291529252935294529552965297529852995300530153025303530453055306530753085309531053115312531353145315531653175318531953205321532253235324532553265327532853295330533153325333533453355336533753385339534053415342534353445345534653475348534953505351535253535354535553565357535853595360536153625363536453655366536753685369537053715372537353745375537653775378537953805381538253835384538553865387538853895390539153925393539453955396539753985399540054015402540354045405540654075408540954105411541254135414541554165417541854195420542154225423542454255426542754285429543054315432543354345435543654375438543954405441544254435444544554465447544854495450545154525453545454555456545754585459546054615462546354645465546654675468546954705471547254735474547554765477547854795480548154825483548454855486548754885489549054915492549354945495549654975498549955005501550255035504550555065507550855095510551155125513551455155516551755185519552055215522552355245525552655275528552955305531553255335534553555365537553855395540554155425543554455455546554755485549555055515552555355545555555655575558555955605561556255635564556555665567556855695570557155725573557455755576557755785579558055815582558355845585558655875588558955905591559255935594559555965597559855995600560156025603560456055606560756085609561056115612561356145615561656175618561956205621562256235624562556265627562856295630563156325633563456355636563756385639564056415642564356445645564656475648564956505651565256535654565556565657565856595660566156625663566456655666566756685669567056715672567356745675567656775678567956805681568256835684568556865687568856895690569156925693569456955696569756985699570057015702570357045705570657075708570957105711571257135714571557165717571857195720572157225723572457255726572757285729573057315732573357345735573657375738573957405741574257435744574557465747574857495750575157525753575457555756575757585759576057615762576357645765576657675768576957705771577257735774577557765777577857795780578157825783578457855786578757885789579057915792579357945795579657975798579958005801580258035804580558065807580858095810581158125813581458155816581758185819582058215822582358245825582658275828582958305831583258335834583558365837583858395840584158425843584458455846584758485849585058515852585358545855585658575858585958605861586258635864586558665867586858695870587158725873587458755876587758785879588058815882588358845885588658875888588958905891589258935894589558965897589858995900590159025903590459055906590759085909591059115912591359145915591659175918591959205921592259235924592559265927592859295930593159325933593459355936593759385939594059415942594359445945594659475948594959505951595259535954595559565957595859595960596159625963596459655966596759685969597059715972597359745975597659775978597959805981598259835984598559865987598859895990599159925993599459955996599759985999600060016002600360046005600660076008600960106011601260136014601560166017601860196020602160226023602460256026602760286029603060316032603360346035603660376038603960406041604260436044604560466047604860496050605160526053605460556056605760586059606060616062606360646065606660676068606960706071607260736074607560766077607860796080608160826083608460856086608760886089609060916092609360946095609660976098609961006101610261036104610561066107610861096110611161126113611461156116611761186119612061216122612361246125612661276128612961306131613261336134613561366137613861396140614161426143614461456146614761486149615061516152615361546155615661576158615961606161616261636164616561666167616861696170617161726173617461756176617761786179618061816182618361846185618661876188618961906191619261936194619561966197619861996200620162026203620462056206620762086209621062116212621362146215621662176218621962206221622262236224622562266227622862296230623162326233623462356236623762386239624062416242624362446245624662476248624962506251625262536254625562566257625862596260626162626263626462656266626762686269627062716272627362746275627662776278627962806281628262836284628562866287628862896290629162926293629462956296629762986299630063016302630363046305630663076308630963106311631263136314631563166317631863196320632163226323632463256326632763286329633063316332633363346335633663376338633963406341634263436344634563466347634863496350635163526353635463556356635763586359636063616362636363646365636663676368636963706371637263736374637563766377637863796380638163826383638463856386638763886389639063916392639363946395639663976398639964006401640264036404640564066407640864096410641164126413641464156416641764186419642064216422642364246425642664276428642964306431643264336434643564366437643864396440644164426443644464456446644764486449645064516452645364546455645664576458645964606461646264636464646564666467646864696470647164726473647464756476647764786479648064816482648364846485648664876488648964906491649264936494649564966497649864996500650165026503650465056506650765086509651065116512651365146515651665176518651965206521652265236524652565266527652865296530653165326533653465356536653765386539654065416542654365446545654665476548654965506551655265536554655565566557655865596560656165626563656465656566656765686569657065716572657365746575657665776578657965806581658265836584658565866587658865896590659165926593659465956596659765986599660066016602660366046605660666076608660966106611661266136614661566166617661866196620662166226623662466256626662766286629663066316632663366346635663666376638663966406641664266436644664566466647664866496650665166526653665466556656665766586659666066616662666366646665666666676668666966706671667266736674667566766677667866796680668166826683668466856686668766886689669066916692669366946695669666976698669967006701670267036704670567066707670867096710671167126713671467156716671767186719672067216722672367246725672667276728672967306731673267336734673567366737673867396740674167426743674467456746674767486749675067516752675367546755675667576758675967606761676267636764676567666767676867696770677167726773677467756776677767786779678067816782678367846785678667876788678967906791679267936794679567966797679867996800680168026803680468056806680768086809681068116812681368146815681668176818681968206821682268236824682568266827682868296830683168326833683468356836683768386839684068416842684368446845684668476848684968506851685268536854685568566857685868596860686168626863686468656866686768686869687068716872687368746875687668776878687968806881688268836884688568866887688868896890689168926893689468956896689768986899690069016902690369046905690669076908690969106911691269136914691569166917691869196920692169226923692469256926692769286929693069316932693369346935693669376938693969406941694269436944694569466947694869496950695169526953695469556956695769586959696069616962696369646965696669676968696969706971697269736974697569766977697869796980698169826983698469856986698769886989699069916992699369946995699669976998699970007001700270037004700570067007700870097010701170127013701470157016701770187019702070217022702370247025702670277028702970307031703270337034703570367037703870397040704170427043704470457046704770487049705070517052705370547055705670577058705970607061706270637064706570667067706870697070707170727073707470757076707770787079708070817082708370847085708670877088708970907091709270937094709570967097709870997100710171027103710471057106710771087109711071117112711371147115711671177118711971207121712271237124712571267127712871297130713171327133713471357136713771387139714071417142714371447145714671477148714971507151715271537154715571567157715871597160716171627163716471657166716771687169717071717172717371747175717671777178717971807181718271837184718571867187718871897190719171927193719471957196719771987199720072017202720372047205720672077208720972107211721272137214721572167217721872197220722172227223722472257226722772287229723072317232723372347235723672377238723972407241724272437244724572467247724872497250725172527253725472557256725772587259726072617262726372647265726672677268726972707271727272737274727572767277727872797280728172827283728472857286728772887289729072917292729372947295729672977298729973007301730273037304730573067307730873097310731173127313731473157316731773187319732073217322732373247325732673277328732973307331733273337334733573367337733873397340734173427343734473457346734773487349735073517352735373547355735673577358735973607361736273637364736573667367736873697370737173727373737473757376737773787379738073817382738373847385738673877388738973907391739273937394739573967397739873997400740174027403740474057406740774087409741074117412741374147415741674177418741974207421742274237424742574267427742874297430743174327433743474357436743774387439744074417442744374447445744674477448744974507451745274537454745574567457745874597460746174627463746474657466746774687469747074717472747374747475747674777478747974807481748274837484748574867487748874897490749174927493749474957496749774987499750075017502750375047505750675077508750975107511751275137514751575167517751875197520752175227523752475257526752775287529753075317532753375347535753675377538753975407541754275437544754575467547754875497550755175527553755475557556755775587559756075617562756375647565756675677568756975707571757275737574757575767577757875797580758175827583758475857586758775887589759075917592759375947595759675977598759976007601760276037604760576067607760876097610761176127613761476157616761776187619762076217622762376247625762676277628762976307631763276337634763576367637763876397640764176427643764476457646764776487649765076517652765376547655765676577658765976607661766276637664766576667667766876697670767176727673767476757676767776787679768076817682768376847685768676877688768976907691769276937694769576967697769876997700770177027703770477057706770777087709771077117712771377147715771677177718771977207721772277237724772577267727772877297730773177327733773477357736773777387739774077417742774377447745774677477748774977507751775277537754775577567757775877597760776177627763776477657766776777687769777077717772777377747775777677777778777977807781778277837784778577867787778877897790779177927793779477957796779777987799780078017802780378047805780678077808780978107811781278137814781578167817781878197820782178227823782478257826782778287829783078317832783378347835783678377838783978407841784278437844784578467847784878497850785178527853785478557856785778587859786078617862786378647865786678677868786978707871787278737874787578767877787878797880788178827883788478857886788778887889789078917892789378947895789678977898789979007901790279037904790579067907790879097910791179127913791479157916791779187919792079217922792379247925792679277928792979307931793279337934793579367937793879397940794179427943794479457946794779487949795079517952795379547955795679577958795979607961796279637964796579667967796879697970797179727973797479757976797779787979798079817982798379847985798679877988798979907991799279937994799579967997799879998000800180028003800480058006800780088009801080118012801380148015801680178018801980208021802280238024802580268027802880298030803180328033803480358036803780388039804080418042804380448045804680478048804980508051805280538054805580568057805880598060806180628063806480658066806780688069807080718072807380748075807680778078807980808081808280838084808580868087808880898090809180928093809480958096809780988099810081018102810381048105810681078108810981108111811281138114811581168117811881198120812181228123812481258126812781288129813081318132813381348135813681378138813981408141814281438144814581468147814881498150815181528153815481558156815781588159816081618162816381648165816681678168816981708171817281738174817581768177817881798180818181828183818481858186818781888189819081918192819381948195819681978198819982008201820282038204820582068207820882098210821182128213821482158216821782188219822082218222822382248225822682278228822982308231823282338234823582368237823882398240824182428243824482458246824782488249825082518252825382548255825682578258825982608261826282638264826582668267826882698270827182728273827482758276827782788279828082818282828382848285828682878288828982908291829282938294829582968297829882998300830183028303830483058306830783088309831083118312831383148315831683178318831983208321832283238324832583268327832883298330833183328333833483358336833783388339834083418342834383448345834683478348834983508351835283538354835583568357835883598360836183628363836483658366836783688369837083718372837383748375837683778378837983808381838283838384838583868387838883898390839183928393839483958396839783988399840084018402840384048405840684078408840984108411841284138414841584168417841884198420842184228423842484258426842784288429843084318432843384348435843684378438843984408441844284438444844584468447844884498450845184528453845484558456845784588459846084618462846384648465846684678468846984708471847284738474847584768477847884798480848184828483848484858486848784888489849084918492849384948495849684978498849985008501850285038504850585068507850885098510851185128513851485158516851785188519852085218522852385248525852685278528852985308531853285338534853585368537853885398540854185428543854485458546854785488549855085518552855385548555855685578558855985608561856285638564856585668567856885698570857185728573857485758576857785788579858085818582858385848585858685878588858985908591859285938594859585968597859885998600860186028603860486058606860786088609861086118612861386148615861686178618861986208621862286238624862586268627862886298630863186328633863486358636863786388639864086418642864386448645864686478648864986508651865286538654865586568657865886598660866186628663866486658666866786688669867086718672867386748675867686778678867986808681868286838684868586868687868886898690869186928693869486958696869786988699870087018702870387048705870687078708870987108711871287138714871587168717871887198720872187228723872487258726872787288729873087318732873387348735873687378738873987408741874287438744874587468747874887498750875187528753875487558756875787588759876087618762876387648765876687678768876987708771877287738774877587768777877887798780878187828783878487858786878787888789879087918792879387948795879687978798879988008801880288038804880588068807880888098810881188128813881488158816881788188819882088218822882388248825882688278828882988308831883288338834883588368837883888398840884188428843884488458846884788488849885088518852885388548855885688578858885988608861886288638864886588668867886888698870887188728873887488758876887788788879888088818882888388848885888688878888888988908891889288938894889588968897889888998900890189028903890489058906890789088909891089118912891389148915891689178918891989208921892289238924892589268927892889298930893189328933893489358936893789388939894089418942894389448945894689478948894989508951895289538954895589568957895889598960896189628963896489658966896789688969897089718972897389748975897689778978897989808981898289838984898589868987898889898990899189928993899489958996899789988999900090019002900390049005900690079008900990109011901290139014901590169017901890199020902190229023902490259026902790289029903090319032903390349035903690379038903990409041904290439044904590469047904890499050905190529053905490559056905790589059906090619062906390649065906690679068906990709071907290739074907590769077907890799080908190829083908490859086908790889089909090919092909390949095909690979098909991009101910291039104910591069107910891099110911191129113911491159116911791189119912091219122912391249125912691279128912991309131913291339134913591369137913891399140914191429143914491459146914791489149915091519152915391549155915691579158915991609161916291639164916591669167916891699170917191729173917491759176917791789179918091819182918391849185918691879188918991909191919291939194919591969197919891999200920192029203920492059206920792089209921092119212921392149215921692179218921992209221922292239224922592269227922892299230923192329233923492359236923792389239924092419242924392449245924692479248924992509251925292539254925592569257925892599260926192629263926492659266926792689269927092719272927392749275927692779278927992809281928292839284928592869287928892899290929192929293929492959296929792989299930093019302930393049305930693079308930993109311931293139314931593169317931893199320932193229323932493259326932793289329933093319332933393349335933693379338933993409341934293439344934593469347934893499350935193529353935493559356935793589359936093619362936393649365936693679368936993709371937293739374937593769377937893799380938193829383938493859386938793889389939093919392939393949395939693979398939994009401940294039404940594069407940894099410941194129413941494159416941794189419942094219422942394249425942694279428942994309431943294339434943594369437943894399440944194429443944494459446944794489449945094519452945394549455945694579458945994609461946294639464946594669467946894699470947194729473947494759476947794789479948094819482948394849485948694879488948994909491949294939494949594969497949894999500950195029503950495059506950795089509951095119512951395149515951695179518951995209521952295239524952595269527952895299530953195329533953495359536953795389539954095419542954395449545954695479548954995509551955295539554955595569557955895599560956195629563956495659566956795689569957095719572957395749575957695779578957995809581958295839584958595869587958895899590959195929593959495959596959795989599960096019602960396049605960696079608960996109611961296139614961596169617961896199620962196229623962496259626962796289629963096319632963396349635963696379638963996409641964296439644964596469647964896499650965196529653965496559656965796589659966096619662966396649665966696679668966996709671967296739674967596769677967896799680968196829683968496859686968796889689969096919692969396949695969696979698969997009701970297039704970597069707970897099710971197129713971497159716971797189719972097219722972397249725972697279728972997309731973297339734973597369737973897399740974197429743974497459746974797489749975097519752975397549755975697579758975997609761976297639764976597669767976897699770977197729773977497759776977797789779978097819782978397849785978697879788978997909791979297939794979597969797979897999800980198029803980498059806980798089809981098119812981398149815981698179818981998209821982298239824982598269827982898299830983198329833983498359836983798389839984098419842984398449845984698479848984998509851985298539854985598569857985898599860986198629863986498659866986798689869987098719872987398749875987698779878987998809881988298839884988598869887988898899890989198929893989498959896989798989899990099019902990399049905990699079908990999109911991299139914991599169917991899199920992199229923992499259926992799289929993099319932993399349935993699379938993999409941994299439944994599469947994899499950995199529953995499559956995799589959996099619962996399649965996699679968996999709971997299739974997599769977997899799980998199829983998499859986998799889989999099919992999399949995999699979998999910000100011000210003100041000510006100071000810009100101001110012100131001410015100161001710018100191002010021100221002310024100251002610027100281002910030100311003210033100341003510036100371003810039100401004110042100431004410045100461004710048100491005010051100521005310054100551005610057100581005910060100611006210063100641006510066100671006810069100701007110072100731007410075100761007710078100791008010081100821008310084100851008610087100881008910090100911009210093100941009510096100971009810099101001010110102101031010410105101061010710108101091011010111101121011310114101151011610117101181011910120101211012210123101241012510126101271012810129101301013110132101331013410135101361013710138101391014010141101421014310144101451014610147101481014910150101511015210153101541015510156101571015810159101601016110162101631016410165101661016710168101691017010171101721017310174101751017610177101781017910180101811018210183101841018510186101871018810189101901019110192101931019410195101961019710198101991020010201102021020310204102051020610207102081020910210102111021210213102141021510216102171021810219102201022110222102231022410225102261022710228102291023010231102321023310234102351023610237102381023910240102411024210243102441024510246102471024810249102501025110252102531025410255102561025710258102591026010261102621026310264102651026610267102681026910270102711027210273102741027510276102771027810279102801028110282102831028410285102861028710288102891029010291102921029310294102951029610297102981029910300103011030210303103041030510306103071030810309103101031110312103131031410315103161031710318103191032010321103221032310324103251032610327103281032910330103311033210333103341033510336103371033810339103401034110342103431034410345103461034710348103491035010351103521035310354103551035610357103581035910360103611036210363103641036510366103671036810369103701037110372103731037410375103761037710378103791038010381103821038310384103851038610387103881038910390103911039210393103941039510396103971039810399104001040110402104031040410405104061040710408104091041010411104121041310414104151041610417104181041910420104211042210423104241042510426104271042810429104301043110432104331043410435104361043710438104391044010441104421044310444104451044610447104481044910450104511045210453104541045510456104571045810459104601046110462104631046410465104661046710468104691047010471104721047310474104751047610477104781047910480104811048210483104841048510486104871048810489104901049110492104931049410495104961049710498104991050010501105021050310504105051050610507105081050910510105111051210513105141051510516105171051810519105201052110522105231052410525105261052710528105291053010531105321053310534105351053610537105381053910540105411054210543105441054510546105471054810549105501055110552105531055410555105561055710558105591056010561105621056310564105651056610567105681056910570105711057210573105741057510576105771057810579105801058110582105831058410585105861058710588105891059010591105921059310594105951059610597105981059910600106011060210603106041060510606106071060810609106101061110612106131061410615106161061710618106191062010621106221062310624106251062610627106281062910630106311063210633106341063510636106371063810639106401064110642106431064410645106461064710648106491065010651106521065310654106551065610657106581065910660106611066210663106641066510666106671066810669106701067110672106731067410675106761067710678106791068010681106821068310684106851068610687106881068910690106911069210693106941069510696106971069810699107001070110702107031070410705107061070710708107091071010711107121071310714107151071610717107181071910720107211072210723107241072510726107271072810729107301073110732107331073410735107361073710738107391074010741107421074310744107451074610747107481074910750107511075210753107541075510756107571075810759107601076110762107631076410765107661076710768107691077010771107721077310774107751077610777107781077910780107811078210783107841078510786107871078810789107901079110792107931079410795107961079710798107991080010801108021080310804108051080610807108081080910810108111081210813108141081510816108171081810819108201082110822108231082410825108261082710828108291083010831108321083310834108351083610837108381083910840108411084210843108441084510846108471084810849108501085110852108531085410855108561085710858108591086010861108621086310864108651086610867108681086910870108711087210873108741087510876108771087810879108801088110882108831088410885108861088710888108891089010891108921089310894108951089610897108981089910900109011090210903109041090510906109071090810909109101091110912109131091410915109161091710918109191092010921109221092310924109251092610927109281092910930109311093210933109341093510936109371093810939109401094110942109431094410945109461094710948109491095010951109521095310954109551095610957109581095910960109611096210963109641096510966109671096810969109701097110972109731097410975109761097710978109791098010981109821098310984109851098610987109881098910990109911099210993109941099510996109971099810999110001100111002110031100411005110061100711008110091101011011110121101311014110151101611017110181101911020110211102211023110241102511026110271102811029110301103111032110331103411035110361103711038110391104011041110421104311044110451104611047110481104911050110511105211053110541105511056110571105811059110601106111062110631106411065110661106711068110691107011071110721107311074110751107611077110781107911080110811108211083110841108511086110871108811089110901109111092110931109411095110961109711098110991110011101111021110311104111051110611107111081110911110111111111211113111141111511116111171111811119111201112111122111231112411125111261112711128111291113011131111321113311134111351113611137111381113911140111411114211143111441114511146111471114811149111501115111152111531115411155111561115711158111591116011161111621116311164111651116611167111681116911170111711117211173111741117511176111771117811179111801118111182111831118411185111861118711188111891119011191111921119311194111951119611197111981119911200112011120211203112041120511206112071120811209112101121111212112131121411215112161121711218112191122011221112221122311224112251122611227112281122911230112311123211233112341123511236112371123811239112401124111242112431124411245112461124711248112491125011251112521125311254112551125611257112581125911260112611126211263112641126511266112671126811269112701127111272112731127411275112761127711278112791128011281112821128311284112851128611287112881128911290112911129211293112941129511296112971129811299113001130111302113031130411305113061130711308113091131011311113121131311314113151131611317113181131911320113211132211323113241132511326113271132811329113301133111332113331133411335113361133711338113391134011341113421134311344113451134611347113481134911350113511135211353113541135511356113571135811359113601136111362113631136411365113661136711368113691137011371113721137311374113751137611377113781137911380113811138211383113841138511386113871138811389113901139111392113931139411395113961139711398113991140011401114021140311404114051140611407114081140911410114111141211413114141141511416114171141811419114201142111422114231142411425114261142711428114291143011431114321143311434114351143611437114381143911440114411144211443114441144511446114471144811449114501145111452114531145411455114561145711458114591146011461114621146311464114651146611467114681146911470114711147211473114741147511476114771147811479114801148111482114831148411485114861148711488114891149011491114921149311494114951149611497114981149911500115011150211503115041150511506115071150811509115101151111512115131151411515115161151711518115191152011521115221152311524115251152611527115281152911530115311153211533115341153511536115371153811539115401154111542115431154411545115461154711548115491155011551115521155311554115551155611557115581155911560115611156211563115641156511566115671156811569115701157111572115731157411575115761157711578115791158011581115821158311584115851158611587115881158911590115911159211593115941159511596115971159811599116001160111602116031160411605116061160711608116091161011611116121161311614116151161611617116181161911620116211162211623116241162511626116271162811629116301163111632116331163411635116361163711638116391164011641116421164311644116451164611647116481164911650116511165211653116541165511656116571165811659116601166111662116631166411665116661166711668116691167011671116721167311674116751167611677116781167911680116811168211683116841168511686116871168811689116901169111692116931169411695116961169711698116991170011701117021170311704117051170611707117081170911710117111171211713117141171511716117171171811719117201172111722117231172411725117261172711728117291173011731117321173311734117351173611737117381173911740117411174211743117441174511746117471174811749117501175111752117531175411755117561175711758117591176011761117621176311764117651176611767117681176911770117711177211773117741177511776117771177811779117801178111782117831178411785117861178711788117891179011791117921179311794117951179611797117981179911800118011180211803118041180511806118071180811809118101181111812118131181411815118161181711818118191182011821118221182311824118251182611827118281182911830118311183211833118341183511836118371183811839118401184111842118431184411845118461184711848118491185011851118521185311854118551185611857118581185911860118611186211863118641186511866118671186811869118701187111872118731187411875118761187711878118791188011881118821188311884118851188611887118881188911890118911189211893118941189511896118971189811899119001190111902119031190411905119061190711908119091191011911119121191311914119151191611917119181191911920119211192211923119241192511926119271192811929119301193111932119331193411935119361193711938119391194011941119421194311944119451194611947119481194911950119511195211953119541195511956119571195811959119601196111962119631196411965119661196711968119691197011971119721197311974119751197611977119781197911980119811198211983119841198511986119871198811989119901199111992119931199411995119961199711998119991200012001120021200312004120051200612007120081200912010120111201212013120141201512016120171201812019120201202112022120231202412025120261202712028120291203012031120321203312034120351203612037120381203912040120411204212043120441204512046120471204812049120501205112052120531205412055120561205712058120591206012061120621206312064120651206612067120681206912070120711207212073120741207512076120771207812079120801208112082120831208412085120861208712088120891209012091120921209312094120951209612097120981209912100121011210212103121041210512106121071210812109121101211112112121131211412115121161211712118121191212012121121221212312124121251212612127121281212912130121311213212133121341213512136121371213812139121401214112142121431214412145121461214712148121491215012151121521215312154121551215612157121581215912160121611216212163121641216512166121671216812169121701217112172121731217412175121761217712178121791218012181121821218312184121851218612187121881218912190121911219212193121941219512196121971219812199122001220112202122031220412205122061220712208122091221012211122121221312214122151221612217122181221912220122211222212223122241222512226122271222812229122301223112232122331223412235122361223712238122391224012241122421224312244122451224612247122481224912250122511225212253122541225512256122571225812259122601226112262122631226412265122661226712268122691227012271122721227312274122751227612277122781227912280122811228212283122841228512286122871228812289122901229112292122931229412295122961229712298122991230012301123021230312304123051230612307123081230912310123111231212313123141231512316123171231812319123201232112322123231232412325123261232712328123291233012331123321233312334123351233612337123381233912340123411234212343123441234512346123471234812349123501235112352123531235412355123561235712358123591236012361123621236312364123651236612367123681236912370123711237212373123741237512376123771237812379123801238112382123831238412385123861238712388123891239012391123921239312394123951239612397123981239912400124011240212403124041240512406124071240812409124101241112412124131241412415124161241712418124191242012421124221242312424124251242612427124281242912430124311243212433124341243512436124371243812439124401244112442124431244412445124461244712448124491245012451124521245312454124551245612457124581245912460124611246212463124641246512466124671246812469124701247112472124731247412475124761247712478124791248012481124821248312484124851248612487124881248912490124911249212493124941249512496124971249812499125001250112502125031250412505125061250712508125091251012511125121251312514125151251612517125181251912520125211252212523125241252512526125271252812529125301253112532125331253412535125361253712538125391254012541125421254312544125451254612547125481254912550125511255212553125541255512556125571255812559125601256112562125631256412565125661256712568125691257012571125721257312574125751257612577125781257912580125811258212583125841258512586125871258812589125901259112592125931259412595125961259712598125991260012601126021260312604126051260612607126081260912610126111261212613126141261512616126171261812619126201262112622126231262412625126261262712628126291263012631126321263312634126351263612637126381263912640126411264212643126441264512646126471264812649126501265112652126531265412655126561265712658126591266012661126621266312664126651266612667126681266912670126711267212673126741267512676126771267812679126801268112682126831268412685126861268712688126891269012691126921269312694126951269612697126981269912700127011270212703127041270512706127071270812709127101271112712127131271412715127161271712718127191272012721127221272312724127251272612727127281272912730127311273212733127341273512736127371273812739127401274112742127431274412745127461274712748127491275012751127521275312754127551275612757127581275912760127611276212763127641276512766127671276812769127701277112772127731277412775127761277712778127791278012781127821278312784127851278612787127881278912790127911279212793127941279512796127971279812799128001280112802128031280412805128061280712808128091281012811128121281312814128151281612817128181281912820128211282212823128241282512826128271282812829128301283112832128331283412835128361283712838128391284012841128421284312844128451284612847128481284912850128511285212853128541285512856128571285812859128601286112862128631286412865128661286712868128691287012871128721287312874128751287612877128781287912880128811288212883128841288512886128871288812889128901289112892128931289412895128961289712898128991290012901129021290312904129051290612907129081290912910129111291212913129141291512916129171291812919129201292112922129231292412925129261292712928129291293012931129321293312934129351293612937129381293912940129411294212943129441294512946129471294812949129501295112952129531295412955129561295712958129591296012961129621296312964129651296612967129681296912970129711297212973129741297512976129771297812979129801298112982129831298412985129861298712988129891299012991129921299312994129951299612997129981299913000130011300213003130041300513006130071300813009130101301113012130131301413015130161301713018130191302013021130221302313024130251302613027130281302913030130311303213033130341303513036130371303813039130401304113042130431304413045130461304713048130491305013051130521305313054130551305613057130581305913060130611306213063130641306513066130671306813069130701307113072130731307413075130761307713078130791308013081130821308313084130851308613087130881308913090130911309213093130941309513096130971309813099131001310113102131031310413105131061310713108131091311013111131121311313114131151311613117131181311913120131211312213123131241312513126131271312813129131301313113132131331313413135131361313713138131391314013141131421314313144131451314613147131481314913150131511315213153131541315513156131571315813159131601316113162131631316413165131661316713168131691317013171131721317313174131751317613177131781317913180131811318213183131841318513186131871318813189131901319113192131931319413195131961319713198131991320013201132021320313204132051320613207132081320913210132111321213213132141321513216132171321813219132201322113222132231322413225132261322713228132291323013231132321323313234132351323613237132381323913240132411324213243132441324513246132471324813249132501325113252132531325413255132561325713258132591326013261132621326313264132651326613267132681326913270132711327213273132741327513276132771327813279132801328113282132831328413285132861328713288132891329013291132921329313294132951329613297132981329913300133011330213303133041330513306133071330813309133101331113312133131331413315133161331713318133191332013321133221332313324133251332613327133281332913330133311333213333133341333513336133371333813339133401334113342133431334413345133461334713348133491335013351133521335313354133551335613357133581335913360133611336213363133641336513366133671336813369133701337113372133731337413375133761337713378133791338013381133821338313384133851338613387133881338913390133911339213393133941339513396133971339813399134001340113402134031340413405134061340713408134091341013411134121341313414134151341613417134181341913420134211342213423134241342513426134271342813429134301343113432134331343413435134361343713438134391344013441134421344313444134451344613447134481344913450134511345213453134541345513456134571345813459134601346113462134631346413465134661346713468134691347013471134721347313474134751347613477134781347913480134811348213483134841348513486134871348813489134901349113492134931349413495134961349713498134991350013501135021350313504135051350613507135081350913510135111351213513135141351513516135171351813519135201352113522135231352413525135261352713528135291353013531135321353313534135351353613537135381353913540135411354213543135441354513546135471354813549135501355113552135531355413555135561355713558135591356013561135621356313564135651356613567135681356913570135711357213573135741357513576135771357813579135801358113582135831358413585135861358713588135891359013591135921359313594135951359613597135981359913600136011360213603136041360513606136071360813609136101361113612136131361413615136161361713618136191362013621136221362313624136251362613627136281362913630136311363213633136341363513636136371363813639136401364113642136431364413645136461364713648136491365013651136521365313654136551365613657136581365913660136611366213663136641366513666136671366813669136701367113672136731367413675136761367713678136791368013681136821368313684136851368613687136881368913690136911369213693136941369513696136971369813699137001370113702137031370413705137061370713708137091371013711137121371313714137151371613717137181371913720137211372213723137241372513726137271372813729137301373113732137331373413735137361373713738137391374013741137421374313744137451374613747137481374913750137511375213753137541375513756137571375813759137601376113762137631376413765137661376713768137691377013771137721377313774137751377613777137781377913780137811378213783137841378513786137871378813789137901379113792137931379413795137961379713798137991380013801138021380313804138051380613807138081380913810138111381213813138141381513816138171381813819138201382113822138231382413825138261382713828138291383013831138321383313834138351383613837138381383913840138411384213843138441384513846138471384813849138501385113852138531385413855138561385713858138591386013861138621386313864138651386613867138681386913870138711387213873138741387513876138771387813879138801388113882138831388413885138861388713888138891389013891138921389313894138951389613897138981389913900139011390213903139041390513906139071390813909139101391113912139131391413915139161391713918139191392013921139221392313924139251392613927139281392913930139311393213933139341393513936139371393813939139401394113942139431394413945139461394713948139491395013951139521395313954139551395613957139581395913960139611396213963139641396513966139671396813969139701397113972139731397413975139761397713978139791398013981139821398313984139851398613987139881398913990139911399213993139941399513996139971399813999140001400114002140031400414005140061400714008140091401014011140121401314014140151401614017140181401914020140211402214023140241402514026140271402814029140301403114032140331403414035140361403714038140391404014041140421404314044140451404614047140481404914050140511405214053140541405514056140571405814059140601406114062140631406414065140661406714068140691407014071140721407314074140751407614077140781407914080140811408214083140841408514086140871408814089140901409114092140931409414095140961409714098140991410014101141021410314104141051410614107141081410914110141111411214113141141411514116141171411814119141201412114122141231412414125141261412714128141291413014131141321413314134141351413614137141381413914140141411414214143141441414514146141471414814149141501415114152141531415414155141561415714158141591416014161141621416314164141651416614167141681416914170141711417214173141741417514176141771417814179141801418114182141831418414185141861418714188141891419014191141921419314194141951419614197141981419914200142011420214203142041420514206142071420814209142101421114212142131421414215142161421714218142191422014221142221422314224142251422614227142281422914230142311423214233142341423514236142371423814239142401424114242142431424414245142461424714248142491425014251142521425314254142551425614257142581425914260142611426214263142641426514266142671426814269142701427114272142731427414275142761427714278142791428014281142821428314284142851428614287142881428914290142911429214293142941429514296142971429814299143001430114302143031430414305143061430714308143091431014311143121431314314143151431614317143181431914320143211432214323143241432514326143271432814329143301433114332143331433414335143361433714338143391434014341143421434314344143451434614347143481434914350143511435214353143541435514356143571435814359143601436114362143631436414365143661436714368143691437014371143721437314374143751437614377143781437914380143811438214383143841438514386143871438814389143901439114392143931439414395143961439714398143991440014401144021440314404144051440614407144081440914410144111441214413144141441514416144171441814419144201442114422144231442414425144261442714428144291443014431144321443314434144351443614437144381443914440144411444214443144441444514446144471444814449144501445114452144531445414455144561445714458144591446014461144621446314464144651446614467144681446914470144711447214473144741447514476144771447814479144801448114482144831448414485144861448714488144891449014491144921449314494144951449614497144981449914500145011450214503145041450514506145071450814509145101451114512145131451414515145161451714518145191452014521145221452314524145251452614527145281452914530145311453214533145341453514536145371453814539145401454114542145431454414545145461454714548145491455014551145521455314554145551455614557145581455914560145611456214563145641456514566145671456814569145701457114572145731457414575145761457714578145791458014581145821458314584145851458614587145881458914590145911459214593145941459514596145971459814599146001460114602146031460414605146061460714608146091461014611146121461314614146151461614617146181461914620146211462214623146241462514626146271462814629146301463114632146331463414635146361463714638146391464014641146421464314644146451464614647146481464914650146511465214653146541465514656146571465814659146601466114662146631466414665146661466714668146691467014671146721467314674146751467614677146781467914680146811468214683146841468514686146871468814689146901469114692146931469414695146961469714698146991470014701147021470314704147051470614707147081470914710147111471214713147141471514716147171471814719147201472114722147231472414725147261472714728147291473014731147321473314734147351473614737147381473914740147411474214743147441474514746147471474814749147501475114752147531475414755147561475714758147591476014761147621476314764147651476614767147681476914770147711477214773147741477514776147771477814779147801478114782147831478414785147861478714788147891479014791147921479314794147951479614797147981479914800148011480214803148041480514806148071480814809148101481114812148131481414815148161481714818148191482014821148221482314824148251482614827148281482914830148311483214833148341483514836148371483814839148401484114842148431484414845148461484714848148491485014851148521485314854148551485614857148581485914860148611486214863148641486514866148671486814869148701487114872148731487414875148761487714878148791488014881148821488314884148851488614887148881488914890148911489214893148941489514896148971489814899149001490114902149031490414905149061490714908149091491014911149121491314914149151491614917149181491914920149211492214923149241492514926149271492814929149301493114932149331493414935149361493714938149391494014941149421494314944149451494614947149481494914950149511495214953149541495514956149571495814959149601496114962149631496414965149661496714968149691497014971149721497314974149751497614977149781497914980149811498214983149841498514986149871498814989149901499114992149931499414995149961499714998149991500015001150021500315004150051500615007150081500915010150111501215013150141501515016150171501815019150201502115022150231502415025150261502715028150291503015031150321503315034150351503615037150381503915040150411504215043150441504515046150471504815049150501505115052150531505415055150561505715058150591506015061150621506315064150651506615067150681506915070150711507215073150741507515076150771507815079150801508115082150831508415085150861508715088150891509015091150921509315094150951509615097150981509915100151011510215103151041510515106151071510815109151101511115112151131511415115151161511715118151191512015121151221512315124151251512615127151281512915130151311513215133151341513515136151371513815139151401514115142151431514415145151461514715148151491515015151151521515315154151551515615157151581515915160151611516215163151641516515166151671516815169151701517115172151731517415175151761517715178151791518015181151821518315184151851518615187151881518915190151911519215193151941519515196151971519815199152001520115202152031520415205152061520715208152091521015211152121521315214152151521615217152181521915220152211522215223152241522515226152271522815229152301523115232152331523415235152361523715238152391524015241152421524315244152451524615247152481524915250152511525215253152541525515256152571525815259152601526115262152631526415265152661526715268152691527015271152721527315274152751527615277152781527915280152811528215283152841528515286152871528815289152901529115292152931529415295152961529715298152991530015301153021530315304153051530615307153081530915310153111531215313153141531515316153171531815319153201532115322153231532415325153261532715328153291533015331153321533315334153351533615337153381533915340153411534215343153441534515346153471534815349153501535115352153531535415355153561535715358153591536015361153621536315364153651536615367153681536915370153711537215373153741537515376153771537815379153801538115382153831538415385153861538715388153891539015391153921539315394153951539615397153981539915400154011540215403154041540515406154071540815409154101541115412154131541415415154161541715418154191542015421154221542315424154251542615427154281542915430154311543215433154341543515436154371543815439154401544115442154431544415445154461544715448154491545015451154521545315454154551545615457154581545915460154611546215463154641546515466154671546815469154701547115472154731547415475154761547715478154791548015481154821548315484154851548615487154881548915490154911549215493154941549515496154971549815499155001550115502155031550415505155061550715508155091551015511155121551315514155151551615517155181551915520155211552215523155241552515526155271552815529155301553115532155331553415535155361553715538155391554015541155421554315544155451554615547155481554915550155511555215553155541555515556155571555815559155601556115562155631556415565155661556715568155691557015571155721557315574155751557615577155781557915580155811558215583155841558515586155871558815589155901559115592155931559415595155961559715598155991560015601156021560315604156051560615607156081560915610156111561215613156141561515616156171561815619156201562115622156231562415625156261562715628156291563015631156321563315634156351563615637156381563915640156411564215643156441564515646156471564815649156501565115652156531565415655156561565715658156591566015661156621566315664156651566615667156681566915670156711567215673156741567515676156771567815679156801568115682156831568415685156861568715688156891569015691156921569315694156951569615697156981569915700157011570215703157041570515706157071570815709157101571115712157131571415715157161571715718157191572015721157221572315724157251572615727157281572915730157311573215733157341573515736157371573815739157401574115742157431574415745157461574715748157491575015751157521575315754157551575615757157581575915760157611576215763157641576515766157671576815769157701577115772157731577415775157761577715778157791578015781157821578315784157851578615787157881578915790157911579215793157941579515796157971579815799158001580115802158031580415805158061580715808158091581015811158121581315814158151581615817158181581915820158211582215823158241582515826158271582815829158301583115832158331583415835158361583715838158391584015841158421584315844158451584615847158481584915850158511585215853158541585515856158571585815859158601586115862158631586415865158661586715868158691587015871158721587315874158751587615877158781587915880158811588215883158841588515886158871588815889158901589115892158931589415895158961589715898158991590015901159021590315904159051590615907159081590915910159111591215913159141591515916159171591815919159201592115922159231592415925159261592715928159291593015931159321593315934159351593615937159381593915940159411594215943159441594515946159471594815949159501595115952159531595415955159561595715958159591596015961159621596315964159651596615967159681596915970159711597215973159741597515976159771597815979159801598115982159831598415985159861598715988159891599015991159921599315994159951599615997159981599916000160011600216003160041600516006160071600816009160101601116012160131601416015160161601716018160191602016021160221602316024160251602616027160281602916030160311603216033160341603516036160371603816039160401604116042160431604416045160461604716048160491605016051160521605316054160551605616057160581605916060160611606216063160641606516066160671606816069160701607116072160731607416075160761607716078160791608016081160821608316084160851608616087160881608916090160911609216093160941609516096160971609816099161001610116102161031610416105161061610716108161091611016111161121611316114161151611616117161181611916120161211612216123161241612516126161271612816129161301613116132161331613416135161361613716138161391614016141161421614316144161451614616147161481614916150161511615216153161541615516156161571615816159161601616116162161631616416165161661616716168161691617016171161721617316174161751617616177161781617916180161811618216183161841618516186161871618816189161901619116192161931619416195161961619716198161991620016201162021620316204162051620616207162081620916210162111621216213162141621516216162171621816219162201622116222162231622416225162261622716228162291623016231162321623316234162351623616237162381623916240162411624216243162441624516246162471624816249162501625116252162531625416255162561625716258162591626016261162621626316264162651626616267162681626916270162711627216273162741627516276162771627816279162801628116282162831628416285162861628716288162891629016291162921629316294162951629616297162981629916300163011630216303163041630516306163071630816309163101631116312163131631416315163161631716318163191632016321163221632316324163251632616327163281632916330163311633216333163341633516336163371633816339163401634116342163431634416345163461634716348163491635016351163521635316354163551635616357163581635916360163611636216363163641636516366163671636816369163701637116372163731637416375163761637716378163791638016381163821638316384163851638616387163881638916390163911639216393163941639516396163971639816399164001640116402164031640416405164061640716408164091641016411164121641316414164151641616417164181641916420164211642216423164241642516426164271642816429164301643116432164331643416435164361643716438164391644016441164421644316444164451644616447164481644916450164511645216453164541645516456164571645816459164601646116462164631646416465164661646716468164691647016471164721647316474164751647616477164781647916480164811648216483164841648516486164871648816489164901649116492164931649416495164961649716498164991650016501165021650316504165051650616507165081650916510165111651216513165141651516516165171651816519165201652116522165231652416525165261652716528165291653016531165321653316534165351653616537165381653916540165411654216543165441654516546165471654816549165501655116552165531655416555165561655716558165591656016561165621656316564165651656616567165681656916570165711657216573165741657516576165771657816579165801658116582165831658416585165861658716588165891659016591165921659316594165951659616597165981659916600166011660216603166041660516606166071660816609166101661116612166131661416615166161661716618166191662016621166221662316624166251662616627166281662916630166311663216633166341663516636166371663816639166401664116642166431664416645166461664716648166491665016651166521665316654166551665616657166581665916660166611666216663166641666516666166671666816669166701667116672166731667416675166761667716678166791668016681166821668316684166851668616687166881668916690166911669216693166941669516696166971669816699167001670116702167031670416705167061670716708167091671016711167121671316714167151671616717167181671916720167211672216723167241672516726167271672816729167301673116732167331673416735167361673716738167391674016741167421674316744167451674616747167481674916750167511675216753167541675516756167571675816759167601676116762167631676416765167661676716768167691677016771167721677316774167751677616777167781677916780167811678216783167841678516786167871678816789167901679116792167931679416795167961679716798167991680016801168021680316804168051680616807168081680916810168111681216813168141681516816168171681816819168201682116822168231682416825168261682716828168291683016831168321683316834168351683616837168381683916840168411684216843168441684516846168471684816849168501685116852168531685416855168561685716858168591686016861168621686316864168651686616867168681686916870168711687216873168741687516876168771687816879168801688116882168831688416885168861688716888168891689016891168921689316894168951689616897168981689916900169011690216903169041690516906169071690816909169101691116912169131691416915169161691716918169191692016921169221692316924169251692616927169281692916930169311693216933169341693516936169371693816939169401694116942169431694416945169461694716948169491695016951169521695316954169551695616957169581695916960169611696216963169641696516966169671696816969169701697116972169731697416975169761697716978169791698016981169821698316984169851698616987169881698916990169911699216993169941699516996169971699816999170001700117002170031700417005170061700717008170091701017011170121701317014170151701617017170181701917020170211702217023170241702517026170271702817029170301703117032170331703417035170361703717038170391704017041170421704317044170451704617047170481704917050170511705217053170541705517056170571705817059170601706117062170631706417065170661706717068170691707017071170721707317074170751707617077170781707917080170811708217083170841708517086170871708817089170901709117092170931709417095170961709717098170991710017101171021710317104171051710617107171081710917110171111711217113171141711517116171171711817119171201712117122171231712417125171261712717128171291713017131171321713317134171351713617137171381713917140171411714217143171441714517146171471714817149171501715117152171531715417155171561715717158171591716017161171621716317164171651716617167171681716917170171711717217173171741717517176171771717817179171801718117182171831718417185171861718717188171891719017191171921719317194171951719617197171981719917200172011720217203172041720517206172071720817209172101721117212172131721417215172161721717218172191722017221172221722317224172251722617227172281722917230172311723217233172341723517236172371723817239172401724117242172431724417245172461724717248172491725017251172521725317254172551725617257172581725917260172611726217263172641726517266172671726817269172701727117272172731727417275172761727717278172791728017281172821728317284172851728617287172881728917290172911729217293172941729517296172971729817299173001730117302173031730417305173061730717308173091731017311173121731317314173151731617317173181731917320173211732217323173241732517326173271732817329173301733117332173331733417335173361733717338173391734017341173421734317344173451734617347173481734917350173511735217353173541735517356173571735817359173601736117362173631736417365173661736717368173691737017371173721737317374173751737617377173781737917380173811738217383173841738517386173871738817389173901739117392173931739417395173961739717398173991740017401174021740317404174051740617407174081740917410174111741217413174141741517416174171741817419174201742117422174231742417425174261742717428174291743017431174321743317434174351743617437174381743917440174411744217443174441744517446174471744817449174501745117452174531745417455174561745717458174591746017461174621746317464174651746617467174681746917470174711747217473174741747517476174771747817479174801748117482174831748417485174861748717488174891749017491174921749317494174951749617497174981749917500175011750217503175041750517506175071750817509175101751117512175131751417515175161751717518175191752017521175221752317524175251752617527175281752917530175311753217533175341753517536175371753817539175401754117542175431754417545175461754717548175491755017551175521755317554175551755617557175581755917560175611756217563175641756517566175671756817569175701757117572175731757417575175761757717578175791758017581175821758317584175851758617587175881758917590175911759217593175941759517596175971759817599176001760117602176031760417605176061760717608176091761017611176121761317614176151761617617176181761917620176211762217623176241762517626176271762817629176301763117632176331763417635176361763717638176391764017641176421764317644176451764617647176481764917650176511765217653176541765517656176571765817659176601766117662176631766417665176661766717668176691767017671176721767317674176751767617677176781767917680176811768217683176841768517686176871768817689176901769117692176931769417695176961769717698176991770017701177021770317704177051770617707177081770917710177111771217713177141771517716177171771817719177201772117722177231772417725177261772717728177291773017731177321773317734177351773617737177381773917740177411774217743177441774517746177471774817749177501775117752177531775417755177561775717758177591776017761177621776317764177651776617767177681776917770177711777217773177741777517776177771777817779177801778117782177831778417785177861778717788177891779017791177921779317794177951779617797177981779917800178011780217803178041780517806178071780817809178101781117812178131781417815178161781717818178191782017821178221782317824178251782617827178281782917830178311783217833178341783517836178371783817839178401784117842178431784417845178461784717848178491785017851178521785317854178551785617857178581785917860178611786217863178641786517866178671786817869178701787117872178731787417875178761787717878178791788017881178821788317884178851788617887178881788917890178911789217893178941789517896178971789817899179001790117902179031790417905179061790717908179091791017911179121791317914179151791617917179181791917920179211792217923179241792517926179271792817929179301793117932179331793417935179361793717938179391794017941179421794317944179451794617947179481794917950179511795217953179541795517956179571795817959179601796117962179631796417965179661796717968179691797017971179721797317974179751797617977179781797917980179811798217983179841798517986179871798817989179901799117992179931799417995179961799717998179991800018001180021800318004180051800618007180081800918010180111801218013180141801518016180171801818019180201802118022180231802418025180261802718028180291803018031180321803318034180351803618037180381803918040180411804218043180441804518046180471804818049180501805118052180531805418055180561805718058180591806018061180621806318064180651806618067180681806918070180711807218073180741807518076180771807818079180801808118082180831808418085180861808718088180891809018091180921809318094180951809618097180981809918100181011810218103181041810518106181071810818109181101811118112181131811418115181161811718118181191812018121181221812318124181251812618127181281812918130181311813218133181341813518136181371813818139181401814118142181431814418145181461814718148181491815018151181521815318154181551815618157181581815918160181611816218163181641816518166181671816818169181701817118172181731817418175181761817718178181791818018181181821818318184181851818618187181881818918190181911819218193181941819518196181971819818199182001820118202182031820418205182061820718208182091821018211182121821318214182151821618217182181821918220182211822218223182241822518226182271822818229182301823118232182331823418235182361823718238182391824018241182421824318244182451824618247182481824918250182511825218253182541825518256182571825818259182601826118262182631826418265182661826718268182691827018271182721827318274182751827618277182781827918280182811828218283182841828518286182871828818289182901829118292182931829418295182961829718298182991830018301183021830318304183051830618307183081830918310183111831218313183141831518316183171831818319183201832118322183231832418325183261832718328183291833018331183321833318334183351833618337183381833918340183411834218343183441834518346183471834818349183501835118352183531835418355183561835718358183591836018361183621836318364183651836618367183681836918370183711837218373183741837518376183771837818379183801838118382183831838418385183861838718388183891839018391183921839318394183951839618397183981839918400184011840218403184041840518406184071840818409184101841118412184131841418415184161841718418184191842018421184221842318424184251842618427184281842918430184311843218433184341843518436184371843818439184401844118442184431844418445184461844718448184491845018451184521845318454184551845618457184581845918460184611846218463184641846518466184671846818469184701847118472184731847418475184761847718478184791848018481184821848318484184851848618487184881848918490184911849218493184941849518496184971849818499185001850118502185031850418505185061850718508185091851018511185121851318514185151851618517185181851918520185211852218523185241852518526185271852818529185301853118532185331853418535185361853718538185391854018541185421854318544185451854618547185481854918550185511855218553185541855518556185571855818559185601856118562185631856418565185661856718568185691857018571185721857318574185751857618577185781857918580185811858218583185841858518586185871858818589185901859118592185931859418595185961859718598185991860018601186021860318604186051860618607186081860918610186111861218613186141861518616186171861818619186201862118622186231862418625186261862718628186291863018631186321863318634186351863618637186381863918640186411864218643186441864518646186471864818649186501865118652186531865418655186561865718658186591866018661186621866318664186651866618667186681866918670186711867218673186741867518676186771867818679186801868118682186831868418685186861868718688186891869018691186921869318694186951869618697186981869918700187011870218703187041870518706187071870818709187101871118712187131871418715187161871718718187191872018721187221872318724187251872618727187281872918730187311873218733187341873518736187371873818739187401874118742187431874418745187461874718748187491875018751187521875318754187551875618757187581875918760187611876218763187641876518766187671876818769187701877118772187731877418775187761877718778187791878018781187821878318784187851878618787187881878918790187911879218793187941879518796187971879818799188001880118802188031880418805188061880718808188091881018811188121881318814188151881618817188181881918820188211882218823188241882518826188271882818829188301883118832188331883418835188361883718838188391884018841188421884318844188451884618847188481884918850188511885218853188541885518856188571885818859188601886118862188631886418865188661886718868188691887018871188721887318874188751887618877188781887918880188811888218883188841888518886188871888818889188901889118892188931889418895188961889718898188991890018901189021890318904189051890618907189081890918910189111891218913189141891518916189171891818919189201892118922189231892418925189261892718928189291893018931189321893318934189351893618937189381893918940189411894218943189441894518946189471894818949189501895118952189531895418955189561895718958189591896018961189621896318964189651896618967189681896918970189711897218973189741897518976189771897818979189801898118982189831898418985189861898718988189891899018991189921899318994189951899618997189981899919000190011900219003190041900519006190071900819009190101901119012190131901419015190161901719018190191902019021190221902319024190251902619027190281902919030190311903219033190341903519036190371903819039190401904119042190431904419045190461904719048190491905019051190521905319054190551905619057190581905919060190611906219063190641906519066190671906819069190701907119072190731907419075190761907719078190791908019081190821908319084190851908619087190881908919090190911909219093190941909519096190971909819099191001910119102191031910419105191061910719108191091911019111191121911319114191151911619117191181911919120191211912219123191241912519126191271912819129191301913119132191331913419135191361913719138191391914019141191421914319144191451914619147191481914919150191511915219153191541915519156191571915819159191601916119162191631916419165191661916719168191691917019171191721917319174191751917619177191781917919180191811918219183191841918519186191871918819189191901919119192191931919419195191961919719198191991920019201192021920319204192051920619207192081920919210192111921219213192141921519216192171921819219192201922119222192231922419225192261922719228192291923019231192321923319234192351923619237192381923919240192411924219243192441924519246192471924819249192501925119252192531925419255192561925719258192591926019261192621926319264192651926619267192681926919270192711927219273192741927519276192771927819279192801928119282192831928419285192861928719288192891929019291192921929319294192951929619297192981929919300193011930219303193041930519306193071930819309193101931119312193131931419315193161931719318193191932019321193221932319324193251932619327193281932919330193311933219333193341933519336193371933819339193401934119342193431934419345193461934719348193491935019351193521935319354193551935619357193581935919360193611936219363193641936519366193671936819369193701937119372193731937419375193761937719378193791938019381193821938319384193851938619387193881938919390193911939219393193941939519396193971939819399194001940119402194031940419405194061940719408194091941019411194121941319414194151941619417194181941919420194211942219423194241942519426194271942819429194301943119432194331943419435194361943719438194391944019441194421944319444194451944619447194481944919450194511945219453194541945519456194571945819459194601946119462194631946419465194661946719468194691947019471194721947319474194751947619477194781947919480194811948219483194841948519486194871948819489194901949119492194931949419495194961949719498194991950019501195021950319504195051950619507195081950919510195111951219513195141951519516195171951819519195201952119522195231952419525195261952719528195291953019531195321953319534195351953619537195381953919540195411954219543195441954519546195471954819549195501955119552195531955419555195561955719558195591956019561195621956319564195651956619567195681956919570195711957219573195741957519576195771957819579195801958119582195831958419585195861958719588195891959019591195921959319594195951959619597195981959919600196011960219603196041960519606196071960819609196101961119612196131961419615196161961719618196191962019621196221962319624196251962619627196281962919630196311963219633196341963519636196371963819639196401964119642196431964419645196461964719648196491965019651196521965319654196551965619657196581965919660196611966219663196641966519666196671966819669196701967119672196731967419675196761967719678196791968019681196821968319684196851968619687196881968919690196911969219693196941969519696196971969819699197001970119702197031970419705197061970719708197091971019711197121971319714197151971619717197181971919720197211972219723197241972519726197271972819729197301973119732197331973419735197361973719738197391974019741197421974319744197451974619747197481974919750197511975219753197541975519756197571975819759197601976119762197631976419765197661976719768197691977019771197721977319774197751977619777197781977919780197811978219783197841978519786197871978819789197901979119792197931979419795197961979719798197991980019801198021980319804198051980619807198081980919810198111981219813198141981519816198171981819819198201982119822198231982419825198261982719828198291983019831198321983319834198351983619837198381983919840198411984219843198441984519846198471984819849198501985119852198531985419855198561985719858198591986019861198621986319864198651986619867198681986919870198711987219873198741987519876198771987819879198801988119882198831988419885198861988719888198891989019891198921989319894198951989619897198981989919900199011990219903199041990519906199071990819909199101991119912199131991419915199161991719918199191992019921199221992319924199251992619927199281992919930199311993219933199341993519936199371993819939
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * This is the new netlink-based wireless configuration interface.
  4. *
  5. * Copyright 2006-2010 Johannes Berg <[email protected]>
  6. * Copyright 2013-2014 Intel Mobile Communications GmbH
  7. * Copyright 2015-2017 Intel Deutschland GmbH
  8. * Copyright (C) 2018-2022 Intel Corporation
  9. */
  10. #include <linux/if.h>
  11. #include <linux/module.h>
  12. #include <linux/err.h>
  13. #include <linux/slab.h>
  14. #include <linux/list.h>
  15. #include <linux/if_ether.h>
  16. #include <linux/ieee80211.h>
  17. #include <linux/nl80211.h>
  18. #include <linux/rtnetlink.h>
  19. #include <linux/netlink.h>
  20. #include <linux/nospec.h>
  21. #include <linux/etherdevice.h>
  22. #include <linux/if_vlan.h>
  23. #include <net/net_namespace.h>
  24. #include <net/genetlink.h>
  25. #include <net/cfg80211.h>
  26. #include <net/sock.h>
  27. #include <net/inet_connection_sock.h>
  28. #include "core.h"
  29. #include "nl80211.h"
  30. #include "reg.h"
  31. #include "rdev-ops.h"
  32. static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  33. struct genl_info *info,
  34. struct cfg80211_crypto_settings *settings,
  35. int cipher_limit);
  36. /* the netlink family */
  37. static struct genl_family nl80211_fam;
  38. /* multicast groups */
  39. enum nl80211_multicast_groups {
  40. NL80211_MCGRP_CONFIG,
  41. NL80211_MCGRP_SCAN,
  42. NL80211_MCGRP_REGULATORY,
  43. NL80211_MCGRP_MLME,
  44. NL80211_MCGRP_VENDOR,
  45. NL80211_MCGRP_NAN,
  46. NL80211_MCGRP_TESTMODE /* keep last - ifdef! */
  47. };
  48. static const struct genl_multicast_group nl80211_mcgrps[] = {
  49. [NL80211_MCGRP_CONFIG] = { .name = NL80211_MULTICAST_GROUP_CONFIG },
  50. [NL80211_MCGRP_SCAN] = { .name = NL80211_MULTICAST_GROUP_SCAN },
  51. [NL80211_MCGRP_REGULATORY] = { .name = NL80211_MULTICAST_GROUP_REG },
  52. [NL80211_MCGRP_MLME] = { .name = NL80211_MULTICAST_GROUP_MLME },
  53. [NL80211_MCGRP_VENDOR] = { .name = NL80211_MULTICAST_GROUP_VENDOR },
  54. [NL80211_MCGRP_NAN] = { .name = NL80211_MULTICAST_GROUP_NAN },
  55. #ifdef CONFIG_NL80211_TESTMODE
  56. [NL80211_MCGRP_TESTMODE] = { .name = NL80211_MULTICAST_GROUP_TESTMODE }
  57. #endif
  58. };
  59. /* returns ERR_PTR values */
  60. static struct wireless_dev *
  61. __cfg80211_wdev_from_attrs(struct cfg80211_registered_device *rdev,
  62. struct net *netns, struct nlattr **attrs)
  63. {
  64. struct wireless_dev *result = NULL;
  65. bool have_ifidx = attrs[NL80211_ATTR_IFINDEX];
  66. bool have_wdev_id = attrs[NL80211_ATTR_WDEV];
  67. u64 wdev_id = 0;
  68. int wiphy_idx = -1;
  69. int ifidx = -1;
  70. if (!have_ifidx && !have_wdev_id)
  71. return ERR_PTR(-EINVAL);
  72. if (have_ifidx)
  73. ifidx = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  74. if (have_wdev_id) {
  75. wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  76. wiphy_idx = wdev_id >> 32;
  77. }
  78. if (rdev) {
  79. struct wireless_dev *wdev;
  80. lockdep_assert_held(&rdev->wiphy.mtx);
  81. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  82. if (have_ifidx && wdev->netdev &&
  83. wdev->netdev->ifindex == ifidx) {
  84. result = wdev;
  85. break;
  86. }
  87. if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
  88. result = wdev;
  89. break;
  90. }
  91. }
  92. return result ?: ERR_PTR(-ENODEV);
  93. }
  94. ASSERT_RTNL();
  95. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  96. struct wireless_dev *wdev;
  97. if (wiphy_net(&rdev->wiphy) != netns)
  98. continue;
  99. if (have_wdev_id && rdev->wiphy_idx != wiphy_idx)
  100. continue;
  101. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  102. if (have_ifidx && wdev->netdev &&
  103. wdev->netdev->ifindex == ifidx) {
  104. result = wdev;
  105. break;
  106. }
  107. if (have_wdev_id && wdev->identifier == (u32)wdev_id) {
  108. result = wdev;
  109. break;
  110. }
  111. }
  112. if (result)
  113. break;
  114. }
  115. if (result)
  116. return result;
  117. return ERR_PTR(-ENODEV);
  118. }
  119. static struct cfg80211_registered_device *
  120. __cfg80211_rdev_from_attrs(struct net *netns, struct nlattr **attrs)
  121. {
  122. struct cfg80211_registered_device *rdev = NULL, *tmp;
  123. struct net_device *netdev;
  124. ASSERT_RTNL();
  125. if (!attrs[NL80211_ATTR_WIPHY] &&
  126. !attrs[NL80211_ATTR_IFINDEX] &&
  127. !attrs[NL80211_ATTR_WDEV])
  128. return ERR_PTR(-EINVAL);
  129. if (attrs[NL80211_ATTR_WIPHY])
  130. rdev = cfg80211_rdev_by_wiphy_idx(
  131. nla_get_u32(attrs[NL80211_ATTR_WIPHY]));
  132. if (attrs[NL80211_ATTR_WDEV]) {
  133. u64 wdev_id = nla_get_u64(attrs[NL80211_ATTR_WDEV]);
  134. struct wireless_dev *wdev;
  135. bool found = false;
  136. tmp = cfg80211_rdev_by_wiphy_idx(wdev_id >> 32);
  137. if (tmp) {
  138. /* make sure wdev exists */
  139. list_for_each_entry(wdev, &tmp->wiphy.wdev_list, list) {
  140. if (wdev->identifier != (u32)wdev_id)
  141. continue;
  142. found = true;
  143. break;
  144. }
  145. if (!found)
  146. tmp = NULL;
  147. if (rdev && tmp != rdev)
  148. return ERR_PTR(-EINVAL);
  149. rdev = tmp;
  150. }
  151. }
  152. if (attrs[NL80211_ATTR_IFINDEX]) {
  153. int ifindex = nla_get_u32(attrs[NL80211_ATTR_IFINDEX]);
  154. netdev = __dev_get_by_index(netns, ifindex);
  155. if (netdev) {
  156. if (netdev->ieee80211_ptr)
  157. tmp = wiphy_to_rdev(
  158. netdev->ieee80211_ptr->wiphy);
  159. else
  160. tmp = NULL;
  161. /* not wireless device -- return error */
  162. if (!tmp)
  163. return ERR_PTR(-EINVAL);
  164. /* mismatch -- return error */
  165. if (rdev && tmp != rdev)
  166. return ERR_PTR(-EINVAL);
  167. rdev = tmp;
  168. }
  169. }
  170. if (!rdev)
  171. return ERR_PTR(-ENODEV);
  172. if (netns != wiphy_net(&rdev->wiphy))
  173. return ERR_PTR(-ENODEV);
  174. return rdev;
  175. }
  176. /*
  177. * This function returns a pointer to the driver
  178. * that the genl_info item that is passed refers to.
  179. *
  180. * The result of this can be a PTR_ERR and hence must
  181. * be checked with IS_ERR() for errors.
  182. */
  183. static struct cfg80211_registered_device *
  184. cfg80211_get_dev_from_info(struct net *netns, struct genl_info *info)
  185. {
  186. return __cfg80211_rdev_from_attrs(netns, info->attrs);
  187. }
  188. static int validate_beacon_head(const struct nlattr *attr,
  189. struct netlink_ext_ack *extack)
  190. {
  191. const u8 *data = nla_data(attr);
  192. unsigned int len = nla_len(attr);
  193. const struct element *elem;
  194. const struct ieee80211_mgmt *mgmt = (void *)data;
  195. unsigned int fixedlen, hdrlen;
  196. bool s1g_bcn;
  197. if (len < offsetofend(typeof(*mgmt), frame_control))
  198. goto err;
  199. s1g_bcn = ieee80211_is_s1g_beacon(mgmt->frame_control);
  200. if (s1g_bcn) {
  201. fixedlen = offsetof(struct ieee80211_ext,
  202. u.s1g_beacon.variable);
  203. hdrlen = offsetof(struct ieee80211_ext, u.s1g_beacon);
  204. } else {
  205. fixedlen = offsetof(struct ieee80211_mgmt,
  206. u.beacon.variable);
  207. hdrlen = offsetof(struct ieee80211_mgmt, u.beacon);
  208. }
  209. if (len < fixedlen)
  210. goto err;
  211. if (ieee80211_hdrlen(mgmt->frame_control) != hdrlen)
  212. goto err;
  213. data += fixedlen;
  214. len -= fixedlen;
  215. for_each_element(elem, data, len) {
  216. /* nothing */
  217. }
  218. if (for_each_element_completed(elem, data, len))
  219. return 0;
  220. err:
  221. NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head");
  222. return -EINVAL;
  223. }
  224. static int validate_ie_attr(const struct nlattr *attr,
  225. struct netlink_ext_ack *extack)
  226. {
  227. const u8 *data = nla_data(attr);
  228. unsigned int len = nla_len(attr);
  229. const struct element *elem;
  230. for_each_element(elem, data, len) {
  231. /* nothing */
  232. }
  233. if (for_each_element_completed(elem, data, len))
  234. return 0;
  235. NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements");
  236. return -EINVAL;
  237. }
  238. static int validate_he_capa(const struct nlattr *attr,
  239. struct netlink_ext_ack *extack)
  240. {
  241. if (!ieee80211_he_capa_size_ok(nla_data(attr), nla_len(attr)))
  242. return -EINVAL;
  243. return 0;
  244. }
  245. /* policy for the attributes */
  246. static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR];
  247. static const struct nla_policy
  248. nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = {
  249. [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, },
  250. [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY,
  251. .len = U8_MAX },
  252. [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY,
  253. .len = U8_MAX },
  254. };
  255. static const struct nla_policy
  256. nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = {
  257. [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG },
  258. [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 },
  259. [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] =
  260. NLA_POLICY_MAX(NLA_U8, 15),
  261. [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 },
  262. [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] =
  263. NLA_POLICY_MAX(NLA_U8, 15),
  264. [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] =
  265. NLA_POLICY_MAX(NLA_U8, 31),
  266. [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 },
  267. [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG },
  268. [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG },
  269. [NL80211_PMSR_FTM_REQ_ATTR_TRIGGER_BASED] = { .type = NLA_FLAG },
  270. [NL80211_PMSR_FTM_REQ_ATTR_NON_TRIGGER_BASED] = { .type = NLA_FLAG },
  271. [NL80211_PMSR_FTM_REQ_ATTR_LMR_FEEDBACK] = { .type = NLA_FLAG },
  272. [NL80211_PMSR_FTM_REQ_ATTR_BSS_COLOR] = { .type = NLA_U8 },
  273. };
  274. static const struct nla_policy
  275. nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = {
  276. [NL80211_PMSR_TYPE_FTM] =
  277. NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy),
  278. };
  279. static const struct nla_policy
  280. nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = {
  281. [NL80211_PMSR_REQ_ATTR_DATA] =
  282. NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy),
  283. [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG },
  284. };
  285. static const struct nla_policy
  286. nl80211_pmsr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = {
  287. [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR,
  288. [NL80211_PMSR_PEER_ATTR_CHAN] = NLA_POLICY_NESTED(nl80211_policy),
  289. [NL80211_PMSR_PEER_ATTR_REQ] =
  290. NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy),
  291. [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT },
  292. };
  293. static const struct nla_policy
  294. nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = {
  295. [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT },
  296. [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT },
  297. [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT },
  298. [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT },
  299. [NL80211_PMSR_ATTR_PEERS] =
  300. NLA_POLICY_NESTED_ARRAY(nl80211_pmsr_peer_attr_policy),
  301. };
  302. static const struct nla_policy
  303. he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = {
  304. [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] =
  305. NLA_POLICY_RANGE(NLA_U8, 1, 20),
  306. [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] =
  307. NLA_POLICY_RANGE(NLA_U8, 1, 20),
  308. [NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET] =
  309. NLA_POLICY_RANGE(NLA_U8, 1, 20),
  310. [NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP] =
  311. NLA_POLICY_EXACT_LEN(8),
  312. [NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP] =
  313. NLA_POLICY_EXACT_LEN(8),
  314. [NL80211_HE_OBSS_PD_ATTR_SR_CTRL] = { .type = NLA_U8 },
  315. };
  316. static const struct nla_policy
  317. he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = {
  318. [NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63),
  319. [NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG },
  320. [NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG },
  321. };
  322. static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
  323. [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
  324. .len = NL80211_MAX_SUPP_RATES },
  325. [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
  326. .len = NL80211_MAX_SUPP_HT_RATES },
  327. [NL80211_TXRATE_VHT] = NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_txrate_vht)),
  328. [NL80211_TXRATE_GI] = { .type = NLA_U8 },
  329. [NL80211_TXRATE_HE] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_he)),
  330. [NL80211_TXRATE_HE_GI] = NLA_POLICY_RANGE(NLA_U8,
  331. NL80211_RATE_INFO_HE_GI_0_8,
  332. NL80211_RATE_INFO_HE_GI_3_2),
  333. [NL80211_TXRATE_HE_LTF] = NLA_POLICY_RANGE(NLA_U8,
  334. NL80211_RATE_INFO_HE_1XLTF,
  335. NL80211_RATE_INFO_HE_4XLTF),
  336. };
  337. static const struct nla_policy
  338. nl80211_tid_config_attr_policy[NL80211_TID_CONFIG_ATTR_MAX + 1] = {
  339. [NL80211_TID_CONFIG_ATTR_VIF_SUPP] = { .type = NLA_U64 },
  340. [NL80211_TID_CONFIG_ATTR_PEER_SUPP] = { .type = NLA_U64 },
  341. [NL80211_TID_CONFIG_ATTR_OVERRIDE] = { .type = NLA_FLAG },
  342. [NL80211_TID_CONFIG_ATTR_TIDS] = NLA_POLICY_RANGE(NLA_U16, 1, 0xff),
  343. [NL80211_TID_CONFIG_ATTR_NOACK] =
  344. NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
  345. [NL80211_TID_CONFIG_ATTR_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
  346. [NL80211_TID_CONFIG_ATTR_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
  347. [NL80211_TID_CONFIG_ATTR_AMPDU_CTRL] =
  348. NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
  349. [NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL] =
  350. NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
  351. [NL80211_TID_CONFIG_ATTR_AMSDU_CTRL] =
  352. NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
  353. [NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE] =
  354. NLA_POLICY_MAX(NLA_U8, NL80211_TX_RATE_FIXED),
  355. [NL80211_TID_CONFIG_ATTR_TX_RATE] =
  356. NLA_POLICY_NESTED(nl80211_txattr_policy),
  357. };
  358. static const struct nla_policy
  359. nl80211_fils_discovery_policy[NL80211_FILS_DISCOVERY_ATTR_MAX + 1] = {
  360. [NL80211_FILS_DISCOVERY_ATTR_INT_MIN] = NLA_POLICY_MAX(NLA_U32, 10000),
  361. [NL80211_FILS_DISCOVERY_ATTR_INT_MAX] = NLA_POLICY_MAX(NLA_U32, 10000),
  362. [NL80211_FILS_DISCOVERY_ATTR_TMPL] =
  363. NLA_POLICY_RANGE(NLA_BINARY,
  364. NL80211_FILS_DISCOVERY_TMPL_MIN_LEN,
  365. IEEE80211_MAX_DATA_LEN),
  366. };
  367. static const struct nla_policy
  368. nl80211_unsol_bcast_probe_resp_policy[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1] = {
  369. [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] = NLA_POLICY_MAX(NLA_U32, 20),
  370. [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL] = { .type = NLA_BINARY,
  371. .len = IEEE80211_MAX_DATA_LEN }
  372. };
  373. static const struct nla_policy
  374. sar_specs_policy[NL80211_SAR_ATTR_SPECS_MAX + 1] = {
  375. [NL80211_SAR_ATTR_SPECS_POWER] = { .type = NLA_S32 },
  376. [NL80211_SAR_ATTR_SPECS_RANGE_INDEX] = {.type = NLA_U32 },
  377. };
  378. static const struct nla_policy
  379. sar_policy[NL80211_SAR_ATTR_MAX + 1] = {
  380. [NL80211_SAR_ATTR_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_SAR_TYPE),
  381. [NL80211_SAR_ATTR_SPECS] = NLA_POLICY_NESTED_ARRAY(sar_specs_policy),
  382. };
  383. static const struct nla_policy
  384. nl80211_mbssid_config_policy[NL80211_MBSSID_CONFIG_ATTR_MAX + 1] = {
  385. [NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES] = NLA_POLICY_MIN(NLA_U8, 2),
  386. [NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY] =
  387. NLA_POLICY_MIN(NLA_U8, 1),
  388. [NL80211_MBSSID_CONFIG_ATTR_INDEX] = { .type = NLA_U8 },
  389. [NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX] = { .type = NLA_U32 },
  390. [NL80211_MBSSID_CONFIG_ATTR_EMA] = { .type = NLA_FLAG },
  391. };
  392. static const struct nla_policy
  393. nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
  394. [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
  395. [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
  396. };
  397. static struct netlink_range_validation nl80211_punct_bitmap_range = {
  398. .min = 0,
  399. .max = 0xffff,
  400. };
  401. static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
  402. [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD },
  403. [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
  404. [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
  405. .len = 20-1 },
  406. [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
  407. [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
  408. [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
  409. [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8,
  410. NL80211_EDMG_CHANNELS_MIN,
  411. NL80211_EDMG_CHANNELS_MAX),
  412. [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8,
  413. NL80211_EDMG_BW_CONFIG_MIN,
  414. NL80211_EDMG_BW_CONFIG_MAX),
  415. [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
  416. [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
  417. [NL80211_ATTR_CENTER_FREQ1_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999),
  418. [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
  419. [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
  420. [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
  421. [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
  422. [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
  423. [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
  424. [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
  425. [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX),
  426. [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
  427. [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
  428. [NL80211_ATTR_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  429. [NL80211_ATTR_PREV_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  430. [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
  431. [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
  432. .len = WLAN_MAX_KEY_LEN },
  433. [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 7),
  434. [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
  435. [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
  436. [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
  437. [NL80211_ATTR_KEY_TYPE] =
  438. NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES),
  439. [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
  440. [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
  441. [NL80211_ATTR_BEACON_HEAD] =
  442. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head,
  443. IEEE80211_MAX_DATA_LEN),
  444. [NL80211_ATTR_BEACON_TAIL] =
  445. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
  446. IEEE80211_MAX_DATA_LEN),
  447. [NL80211_ATTR_STA_AID] =
  448. NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
  449. [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
  450. [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
  451. [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
  452. .len = NL80211_MAX_SUPP_RATES },
  453. [NL80211_ATTR_STA_PLINK_ACTION] =
  454. NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1),
  455. [NL80211_ATTR_STA_TX_POWER_SETTING] =
  456. NLA_POLICY_RANGE(NLA_U8,
  457. NL80211_TX_POWER_AUTOMATIC,
  458. NL80211_TX_POWER_FIXED),
  459. [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 },
  460. [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
  461. [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
  462. [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
  463. .len = IEEE80211_MAX_MESH_ID_LEN },
  464. [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT,
  465. /* allow 3 for NUL-termination, we used to declare this NLA_STRING */
  466. [NL80211_ATTR_REG_ALPHA2] = NLA_POLICY_RANGE(NLA_BINARY, 2, 3),
  467. [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
  468. [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
  469. [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
  470. [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
  471. [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
  472. .len = NL80211_MAX_SUPP_RATES },
  473. [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
  474. [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
  475. [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
  476. [NL80211_ATTR_HT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_HT_CAPABILITY_LEN),
  477. [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
  478. [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY,
  479. validate_ie_attr,
  480. IEEE80211_MAX_DATA_LEN),
  481. [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
  482. [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
  483. [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
  484. .len = IEEE80211_MAX_SSID_LEN },
  485. [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
  486. [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
  487. [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
  488. [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
  489. [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32,
  490. NL80211_MFP_NO,
  491. NL80211_MFP_OPTIONAL),
  492. [NL80211_ATTR_STA_FLAGS2] =
  493. NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_sta_flag_update)),
  494. [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
  495. [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
  496. [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
  497. [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG },
  498. [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
  499. [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 },
  500. [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
  501. [NL80211_ATTR_WPA_VERSIONS] = { .type = NLA_U32 },
  502. [NL80211_ATTR_PID] = { .type = NLA_U32 },
  503. [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
  504. [NL80211_ATTR_PMKID] = NLA_POLICY_EXACT_LEN_WARN(WLAN_PMKID_LEN),
  505. [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
  506. [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
  507. [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
  508. [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
  509. .len = IEEE80211_MAX_DATA_LEN },
  510. [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
  511. [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32,
  512. NL80211_PS_DISABLED,
  513. NL80211_PS_ENABLED),
  514. [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
  515. [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
  516. [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
  517. [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
  518. [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
  519. [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
  520. [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
  521. [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
  522. [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
  523. [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
  524. [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  525. [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
  526. [NL80211_ATTR_STA_PLINK_STATE] =
  527. NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1),
  528. [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 },
  529. [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG },
  530. [NL80211_ATTR_MESH_PEER_AID] =
  531. NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
  532. [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
  533. [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
  534. [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
  535. [NL80211_ATTR_HIDDEN_SSID] =
  536. NLA_POLICY_RANGE(NLA_U32,
  537. NL80211_HIDDEN_SSID_NOT_IN_USE,
  538. NL80211_HIDDEN_SSID_ZERO_CONTENTS),
  539. [NL80211_ATTR_IE_PROBE_RESP] =
  540. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
  541. IEEE80211_MAX_DATA_LEN),
  542. [NL80211_ATTR_IE_ASSOC_RESP] =
  543. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
  544. IEEE80211_MAX_DATA_LEN),
  545. [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
  546. [NL80211_ATTR_STA_WME] = NLA_POLICY_NESTED(nl80211_sta_wme_policy),
  547. [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
  548. [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
  549. [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
  550. [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
  551. [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
  552. [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
  553. [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
  554. [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
  555. [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
  556. [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
  557. .len = IEEE80211_MAX_DATA_LEN },
  558. [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
  559. [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
  560. [NL80211_ATTR_HT_CAPABILITY_MASK] = {
  561. .len = NL80211_HT_CAPABILITY_LEN
  562. },
  563. [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
  564. [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
  565. [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
  566. [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
  567. [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
  568. /* need to include at least Auth Transaction and Status Code */
  569. [NL80211_ATTR_AUTH_DATA] = NLA_POLICY_MIN_LEN(4),
  570. [NL80211_ATTR_VHT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_VHT_CAPABILITY_LEN),
  571. [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
  572. [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127),
  573. [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1),
  574. [NL80211_ATTR_LOCAL_MESH_POWER_MODE] =
  575. NLA_POLICY_RANGE(NLA_U32,
  576. NL80211_MESH_POWER_UNKNOWN + 1,
  577. NL80211_MESH_POWER_MAX),
  578. [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
  579. [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
  580. [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
  581. [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
  582. [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
  583. [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
  584. [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
  585. .len = NL80211_VHT_CAPABILITY_LEN,
  586. },
  587. [NL80211_ATTR_MDID] = { .type = NLA_U16 },
  588. [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
  589. .len = IEEE80211_MAX_DATA_LEN },
  590. [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 },
  591. [NL80211_ATTR_MAX_CRIT_PROT_DURATION] =
  592. NLA_POLICY_MAX(NLA_U16, NL80211_CRIT_PROTO_MAX_DURATION),
  593. [NL80211_ATTR_PEER_AID] =
  594. NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
  595. [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
  596. [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
  597. [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
  598. [NL80211_ATTR_CNTDWN_OFFS_BEACON] = { .type = NLA_BINARY },
  599. [NL80211_ATTR_CNTDWN_OFFS_PRESP] = { .type = NLA_BINARY },
  600. [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = NLA_POLICY_MIN_LEN(2),
  601. /*
  602. * The value of the Length field of the Supported Operating
  603. * Classes element is between 2 and 253.
  604. */
  605. [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] =
  606. NLA_POLICY_RANGE(NLA_BINARY, 2, 253),
  607. [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
  608. [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
  609. [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
  610. [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
  611. [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
  612. [NL80211_ATTR_QOS_MAP] = NLA_POLICY_RANGE(NLA_BINARY,
  613. IEEE80211_QOS_MAP_LEN_MIN,
  614. IEEE80211_QOS_MAP_LEN_MAX),
  615. [NL80211_ATTR_MAC_HINT] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  616. [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
  617. [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
  618. [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
  619. [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
  620. [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
  621. [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1),
  622. [NL80211_ATTR_USER_PRIO] =
  623. NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1),
  624. [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
  625. [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
  626. [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 },
  627. [NL80211_ATTR_MAC_MASK] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  628. [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
  629. [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
  630. [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
  631. [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
  632. [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
  633. [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
  634. [NL80211_ATTR_STA_SUPPORT_P2P_PS] =
  635. NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1),
  636. [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
  637. .len = VHT_MUMIMO_GROUPS_DATA_LEN
  638. },
  639. [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  640. [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1),
  641. [NL80211_ATTR_BANDS] = { .type = NLA_U32 },
  642. [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
  643. [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
  644. .len = FILS_MAX_KEK_LEN },
  645. [NL80211_ATTR_FILS_NONCES] = NLA_POLICY_EXACT_LEN_WARN(2 * FILS_NONCE_LEN),
  646. [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
  647. [NL80211_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  648. [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
  649. [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
  650. .len = sizeof(struct nl80211_bss_select_rssi_adjust)
  651. },
  652. [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
  653. [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
  654. .len = FILS_ERP_MAX_USERNAME_LEN },
  655. [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
  656. .len = FILS_ERP_MAX_REALM_LEN },
  657. [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
  658. [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
  659. .len = FILS_ERP_MAX_RRK_LEN },
  660. [NL80211_ATTR_FILS_CACHE_ID] = NLA_POLICY_EXACT_LEN_WARN(2),
  661. [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
  662. [NL80211_ATTR_PMKR0_NAME] = NLA_POLICY_EXACT_LEN(WLAN_PMK_NAME_LEN),
  663. [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
  664. [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
  665. [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 },
  666. [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 },
  667. [NL80211_ATTR_TXQ_QUANTUM] = { .type = NLA_U32 },
  668. [NL80211_ATTR_HE_CAPABILITY] =
  669. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_he_capa,
  670. NL80211_HE_MAX_CAPABILITY_LEN),
  671. [NL80211_ATTR_FTM_RESPONDER] =
  672. NLA_POLICY_NESTED(nl80211_ftm_responder_policy),
  673. [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1),
  674. [NL80211_ATTR_PEER_MEASUREMENTS] =
  675. NLA_POLICY_NESTED(nl80211_pmsr_attr_policy),
  676. [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1),
  677. [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY,
  678. .len = SAE_PASSWORD_MAX_LEN },
  679. [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG },
  680. [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy),
  681. [NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2),
  682. [NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy),
  683. [NL80211_ATTR_TID_CONFIG] =
  684. NLA_POLICY_NESTED_ARRAY(nl80211_tid_config_attr_policy),
  685. [NL80211_ATTR_CONTROL_PORT_NO_PREAUTH] = { .type = NLA_FLAG },
  686. [NL80211_ATTR_PMK_LIFETIME] = NLA_POLICY_MIN(NLA_U32, 1),
  687. [NL80211_ATTR_PMK_REAUTH_THRESHOLD] = NLA_POLICY_RANGE(NLA_U8, 1, 100),
  688. [NL80211_ATTR_RECEIVE_MULTICAST] = { .type = NLA_FLAG },
  689. [NL80211_ATTR_WIPHY_FREQ_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999),
  690. [NL80211_ATTR_SCAN_FREQ_KHZ] = { .type = NLA_NESTED },
  691. [NL80211_ATTR_HE_6GHZ_CAPABILITY] =
  692. NLA_POLICY_EXACT_LEN(sizeof(struct ieee80211_he_6ghz_capa)),
  693. [NL80211_ATTR_FILS_DISCOVERY] =
  694. NLA_POLICY_NESTED(nl80211_fils_discovery_policy),
  695. [NL80211_ATTR_UNSOL_BCAST_PROBE_RESP] =
  696. NLA_POLICY_NESTED(nl80211_unsol_bcast_probe_resp_policy),
  697. [NL80211_ATTR_S1G_CAPABILITY] =
  698. NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN),
  699. [NL80211_ATTR_S1G_CAPABILITY_MASK] =
  700. NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN),
  701. [NL80211_ATTR_SAE_PWE] =
  702. NLA_POLICY_RANGE(NLA_U8, NL80211_SAE_PWE_HUNT_AND_PECK,
  703. NL80211_SAE_PWE_BOTH),
  704. [NL80211_ATTR_RECONNECT_REQUESTED] = { .type = NLA_REJECT },
  705. [NL80211_ATTR_SAR_SPEC] = NLA_POLICY_NESTED(sar_policy),
  706. [NL80211_ATTR_DISABLE_HE] = { .type = NLA_FLAG },
  707. [NL80211_ATTR_OBSS_COLOR_BITMAP] = { .type = NLA_U64 },
  708. [NL80211_ATTR_COLOR_CHANGE_COUNT] = { .type = NLA_U8 },
  709. [NL80211_ATTR_COLOR_CHANGE_COLOR] = { .type = NLA_U8 },
  710. [NL80211_ATTR_COLOR_CHANGE_ELEMS] = NLA_POLICY_NESTED(nl80211_policy),
  711. [NL80211_ATTR_MBSSID_CONFIG] =
  712. NLA_POLICY_NESTED(nl80211_mbssid_config_policy),
  713. [NL80211_ATTR_MBSSID_ELEMS] = { .type = NLA_NESTED },
  714. [NL80211_ATTR_RADAR_BACKGROUND] = { .type = NLA_FLAG },
  715. [NL80211_ATTR_AP_SETTINGS_FLAGS] = { .type = NLA_U32 },
  716. [NL80211_ATTR_EHT_CAPABILITY] =
  717. NLA_POLICY_RANGE(NLA_BINARY,
  718. NL80211_EHT_MIN_CAPABILITY_LEN,
  719. NL80211_EHT_MAX_CAPABILITY_LEN),
  720. [NL80211_ATTR_DISABLE_EHT] = { .type = NLA_FLAG },
  721. [NL80211_ATTR_MLO_LINKS] =
  722. NLA_POLICY_NESTED_ARRAY(nl80211_policy),
  723. [NL80211_ATTR_MLO_LINK_ID] =
  724. NLA_POLICY_RANGE(NLA_U8, 0, IEEE80211_MLD_MAX_NUM_LINKS),
  725. [NL80211_ATTR_MLD_ADDR] = NLA_POLICY_EXACT_LEN(ETH_ALEN),
  726. [NL80211_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG },
  727. [NL80211_ATTR_MAX_NUM_AKM_SUITES] = { .type = NLA_REJECT },
  728. [NL80211_ATTR_PUNCT_BITMAP] =
  729. NLA_POLICY_FULL_RANGE(NLA_U32, &nl80211_punct_bitmap_range),
  730. };
  731. /* policy for the key attributes */
  732. static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
  733. [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
  734. [NL80211_KEY_IDX] = { .type = NLA_U8 },
  735. [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
  736. [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
  737. [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
  738. [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
  739. [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1),
  740. [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  741. [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX),
  742. };
  743. /* policy for the key default flags */
  744. static const struct nla_policy
  745. nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
  746. [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
  747. [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
  748. };
  749. #ifdef CONFIG_PM
  750. /* policy for WoWLAN attributes */
  751. static const struct nla_policy
  752. nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
  753. [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
  754. [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
  755. [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
  756. [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
  757. [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
  758. [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
  759. [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
  760. [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
  761. [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
  762. [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
  763. };
  764. static const struct nla_policy
  765. nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
  766. [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
  767. [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
  768. [NL80211_WOWLAN_TCP_DST_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  769. [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
  770. [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
  771. [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = NLA_POLICY_MIN_LEN(1),
  772. [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
  773. .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
  774. },
  775. [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
  776. .len = sizeof(struct nl80211_wowlan_tcp_data_token)
  777. },
  778. [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
  779. [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = NLA_POLICY_MIN_LEN(1),
  780. [NL80211_WOWLAN_TCP_WAKE_MASK] = NLA_POLICY_MIN_LEN(1),
  781. };
  782. #endif /* CONFIG_PM */
  783. /* policy for coalesce rule attributes */
  784. static const struct nla_policy
  785. nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
  786. [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
  787. [NL80211_ATTR_COALESCE_RULE_CONDITION] =
  788. NLA_POLICY_RANGE(NLA_U32,
  789. NL80211_COALESCE_CONDITION_MATCH,
  790. NL80211_COALESCE_CONDITION_NO_MATCH),
  791. [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
  792. };
  793. /* policy for GTK rekey offload attributes */
  794. static const struct nla_policy
  795. nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
  796. [NL80211_REKEY_DATA_KEK] = {
  797. .type = NLA_BINARY,
  798. .len = NL80211_KEK_EXT_LEN
  799. },
  800. [NL80211_REKEY_DATA_KCK] = {
  801. .type = NLA_BINARY,
  802. .len = NL80211_KCK_EXT_LEN_32
  803. },
  804. [NL80211_REKEY_DATA_REPLAY_CTR] = NLA_POLICY_EXACT_LEN(NL80211_REPLAY_CTR_LEN),
  805. [NL80211_REKEY_DATA_AKM] = { .type = NLA_U32 },
  806. };
  807. static const struct nla_policy
  808. nl80211_match_band_rssi_policy[NUM_NL80211_BANDS] = {
  809. [NL80211_BAND_2GHZ] = { .type = NLA_S32 },
  810. [NL80211_BAND_5GHZ] = { .type = NLA_S32 },
  811. [NL80211_BAND_6GHZ] = { .type = NLA_S32 },
  812. [NL80211_BAND_60GHZ] = { .type = NLA_S32 },
  813. [NL80211_BAND_LC] = { .type = NLA_S32 },
  814. };
  815. static const struct nla_policy
  816. nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
  817. [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
  818. .len = IEEE80211_MAX_SSID_LEN },
  819. [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  820. [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
  821. [NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI] =
  822. NLA_POLICY_NESTED(nl80211_match_band_rssi_policy),
  823. };
  824. static const struct nla_policy
  825. nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
  826. [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
  827. [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
  828. };
  829. static const struct nla_policy
  830. nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
  831. [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
  832. [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
  833. [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
  834. .len = sizeof(struct nl80211_bss_select_rssi_adjust)
  835. },
  836. };
  837. /* policy for NAN function attributes */
  838. static const struct nla_policy
  839. nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
  840. [NL80211_NAN_FUNC_TYPE] =
  841. NLA_POLICY_MAX(NLA_U8, NL80211_NAN_FUNC_MAX_TYPE),
  842. [NL80211_NAN_FUNC_SERVICE_ID] = {
  843. .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
  844. [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
  845. [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
  846. [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
  847. [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
  848. [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
  849. [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  850. [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
  851. [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
  852. [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
  853. .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
  854. [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
  855. [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
  856. [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
  857. [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
  858. [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
  859. };
  860. /* policy for Service Response Filter attributes */
  861. static const struct nla_policy
  862. nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
  863. [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
  864. [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
  865. .len = NL80211_NAN_FUNC_SRF_MAX_LEN },
  866. [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
  867. [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
  868. };
  869. /* policy for packet pattern attributes */
  870. static const struct nla_policy
  871. nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
  872. [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
  873. [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
  874. [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
  875. };
  876. static int nl80211_prepare_wdev_dump(struct netlink_callback *cb,
  877. struct cfg80211_registered_device **rdev,
  878. struct wireless_dev **wdev,
  879. struct nlattr **attrbuf)
  880. {
  881. int err;
  882. if (!cb->args[0]) {
  883. struct nlattr **attrbuf_free = NULL;
  884. if (!attrbuf) {
  885. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
  886. GFP_KERNEL);
  887. if (!attrbuf)
  888. return -ENOMEM;
  889. attrbuf_free = attrbuf;
  890. }
  891. err = nlmsg_parse_deprecated(cb->nlh,
  892. GENL_HDRLEN + nl80211_fam.hdrsize,
  893. attrbuf, nl80211_fam.maxattr,
  894. nl80211_policy, NULL);
  895. if (err) {
  896. kfree(attrbuf_free);
  897. return err;
  898. }
  899. rtnl_lock();
  900. *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(cb->skb->sk),
  901. attrbuf);
  902. kfree(attrbuf_free);
  903. if (IS_ERR(*wdev)) {
  904. rtnl_unlock();
  905. return PTR_ERR(*wdev);
  906. }
  907. *rdev = wiphy_to_rdev((*wdev)->wiphy);
  908. mutex_lock(&(*rdev)->wiphy.mtx);
  909. rtnl_unlock();
  910. /* 0 is the first index - add 1 to parse only once */
  911. cb->args[0] = (*rdev)->wiphy_idx + 1;
  912. cb->args[1] = (*wdev)->identifier;
  913. } else {
  914. /* subtract the 1 again here */
  915. struct wiphy *wiphy;
  916. struct wireless_dev *tmp;
  917. rtnl_lock();
  918. wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
  919. if (!wiphy) {
  920. rtnl_unlock();
  921. return -ENODEV;
  922. }
  923. *rdev = wiphy_to_rdev(wiphy);
  924. *wdev = NULL;
  925. list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
  926. if (tmp->identifier == cb->args[1]) {
  927. *wdev = tmp;
  928. break;
  929. }
  930. }
  931. if (!*wdev) {
  932. rtnl_unlock();
  933. return -ENODEV;
  934. }
  935. mutex_lock(&(*rdev)->wiphy.mtx);
  936. rtnl_unlock();
  937. }
  938. return 0;
  939. }
  940. /* message building helper */
  941. void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
  942. int flags, u8 cmd)
  943. {
  944. /* since there is no private header just add the generic one */
  945. return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
  946. }
  947. static int nl80211_msg_put_wmm_rules(struct sk_buff *msg,
  948. const struct ieee80211_reg_rule *rule)
  949. {
  950. int j;
  951. struct nlattr *nl_wmm_rules =
  952. nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM);
  953. if (!nl_wmm_rules)
  954. goto nla_put_failure;
  955. for (j = 0; j < IEEE80211_NUM_ACS; j++) {
  956. struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j);
  957. if (!nl_wmm_rule)
  958. goto nla_put_failure;
  959. if (nla_put_u16(msg, NL80211_WMMR_CW_MIN,
  960. rule->wmm_rule.client[j].cw_min) ||
  961. nla_put_u16(msg, NL80211_WMMR_CW_MAX,
  962. rule->wmm_rule.client[j].cw_max) ||
  963. nla_put_u8(msg, NL80211_WMMR_AIFSN,
  964. rule->wmm_rule.client[j].aifsn) ||
  965. nla_put_u16(msg, NL80211_WMMR_TXOP,
  966. rule->wmm_rule.client[j].cot))
  967. goto nla_put_failure;
  968. nla_nest_end(msg, nl_wmm_rule);
  969. }
  970. nla_nest_end(msg, nl_wmm_rules);
  971. return 0;
  972. nla_put_failure:
  973. return -ENOBUFS;
  974. }
  975. static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy,
  976. struct ieee80211_channel *chan,
  977. bool large)
  978. {
  979. /* Some channels must be completely excluded from the
  980. * list to protect old user-space tools from breaking
  981. */
  982. if (!large && chan->flags &
  983. (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
  984. return 0;
  985. if (!large && chan->freq_offset)
  986. return 0;
  987. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
  988. chan->center_freq))
  989. goto nla_put_failure;
  990. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_OFFSET, chan->freq_offset))
  991. goto nla_put_failure;
  992. if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
  993. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
  994. goto nla_put_failure;
  995. if (chan->flags & IEEE80211_CHAN_NO_IR) {
  996. if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
  997. goto nla_put_failure;
  998. if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
  999. goto nla_put_failure;
  1000. }
  1001. if (chan->flags & IEEE80211_CHAN_RADAR) {
  1002. if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
  1003. goto nla_put_failure;
  1004. if (large) {
  1005. u32 time;
  1006. time = elapsed_jiffies_msecs(chan->dfs_state_entered);
  1007. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
  1008. chan->dfs_state))
  1009. goto nla_put_failure;
  1010. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
  1011. time))
  1012. goto nla_put_failure;
  1013. if (nla_put_u32(msg,
  1014. NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
  1015. chan->dfs_cac_ms))
  1016. goto nla_put_failure;
  1017. }
  1018. }
  1019. if (large) {
  1020. if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
  1021. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
  1022. goto nla_put_failure;
  1023. if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
  1024. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
  1025. goto nla_put_failure;
  1026. if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
  1027. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
  1028. goto nla_put_failure;
  1029. if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
  1030. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
  1031. goto nla_put_failure;
  1032. if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
  1033. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
  1034. goto nla_put_failure;
  1035. if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
  1036. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
  1037. goto nla_put_failure;
  1038. if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
  1039. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
  1040. goto nla_put_failure;
  1041. if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
  1042. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
  1043. goto nla_put_failure;
  1044. if ((chan->flags & IEEE80211_CHAN_NO_HE) &&
  1045. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE))
  1046. goto nla_put_failure;
  1047. if ((chan->flags & IEEE80211_CHAN_1MHZ) &&
  1048. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_1MHZ))
  1049. goto nla_put_failure;
  1050. if ((chan->flags & IEEE80211_CHAN_2MHZ) &&
  1051. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_2MHZ))
  1052. goto nla_put_failure;
  1053. if ((chan->flags & IEEE80211_CHAN_4MHZ) &&
  1054. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_4MHZ))
  1055. goto nla_put_failure;
  1056. if ((chan->flags & IEEE80211_CHAN_8MHZ) &&
  1057. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_8MHZ))
  1058. goto nla_put_failure;
  1059. if ((chan->flags & IEEE80211_CHAN_16MHZ) &&
  1060. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_16MHZ))
  1061. goto nla_put_failure;
  1062. if ((chan->flags & IEEE80211_CHAN_NO_320MHZ) &&
  1063. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_320MHZ))
  1064. goto nla_put_failure;
  1065. if ((chan->flags & IEEE80211_CHAN_NO_EHT) &&
  1066. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_EHT))
  1067. goto nla_put_failure;
  1068. }
  1069. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
  1070. DBM_TO_MBM(chan->max_power)))
  1071. goto nla_put_failure;
  1072. if (large) {
  1073. const struct ieee80211_reg_rule *rule =
  1074. freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq));
  1075. if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) {
  1076. if (nl80211_msg_put_wmm_rules(msg, rule))
  1077. goto nla_put_failure;
  1078. }
  1079. }
  1080. return 0;
  1081. nla_put_failure:
  1082. return -ENOBUFS;
  1083. }
  1084. static bool nl80211_put_txq_stats(struct sk_buff *msg,
  1085. struct cfg80211_txq_stats *txqstats,
  1086. int attrtype)
  1087. {
  1088. struct nlattr *txqattr;
  1089. #define PUT_TXQVAL_U32(attr, memb) do { \
  1090. if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \
  1091. nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \
  1092. return false; \
  1093. } while (0)
  1094. txqattr = nla_nest_start_noflag(msg, attrtype);
  1095. if (!txqattr)
  1096. return false;
  1097. PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes);
  1098. PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets);
  1099. PUT_TXQVAL_U32(FLOWS, flows);
  1100. PUT_TXQVAL_U32(DROPS, drops);
  1101. PUT_TXQVAL_U32(ECN_MARKS, ecn_marks);
  1102. PUT_TXQVAL_U32(OVERLIMIT, overlimit);
  1103. PUT_TXQVAL_U32(OVERMEMORY, overmemory);
  1104. PUT_TXQVAL_U32(COLLISIONS, collisions);
  1105. PUT_TXQVAL_U32(TX_BYTES, tx_bytes);
  1106. PUT_TXQVAL_U32(TX_PACKETS, tx_packets);
  1107. PUT_TXQVAL_U32(MAX_FLOWS, max_flows);
  1108. nla_nest_end(msg, txqattr);
  1109. #undef PUT_TXQVAL_U32
  1110. return true;
  1111. }
  1112. /* netlink command implementations */
  1113. /**
  1114. * nl80211_link_id - return link ID
  1115. * @attrs: attributes to look at
  1116. *
  1117. * Returns: the link ID or 0 if not given
  1118. *
  1119. * Note this function doesn't do any validation of the link
  1120. * ID validity wrt. links that were actually added, so it must
  1121. * be called only from ops with %NL80211_FLAG_MLO_VALID_LINK_ID
  1122. * or if additional validation is done.
  1123. */
  1124. static unsigned int nl80211_link_id(struct nlattr **attrs)
  1125. {
  1126. struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID];
  1127. if (!linkid)
  1128. return 0;
  1129. return nla_get_u8(linkid);
  1130. }
  1131. static int nl80211_link_id_or_invalid(struct nlattr **attrs)
  1132. {
  1133. struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID];
  1134. if (!linkid)
  1135. return -1;
  1136. return nla_get_u8(linkid);
  1137. }
  1138. struct key_parse {
  1139. struct key_params p;
  1140. int idx;
  1141. int type;
  1142. bool def, defmgmt, defbeacon;
  1143. bool def_uni, def_multi;
  1144. };
  1145. static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
  1146. struct key_parse *k)
  1147. {
  1148. struct nlattr *tb[NL80211_KEY_MAX + 1];
  1149. int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key,
  1150. nl80211_key_policy,
  1151. info->extack);
  1152. if (err)
  1153. return err;
  1154. k->def = !!tb[NL80211_KEY_DEFAULT];
  1155. k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
  1156. k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON];
  1157. if (k->def) {
  1158. k->def_uni = true;
  1159. k->def_multi = true;
  1160. }
  1161. if (k->defmgmt || k->defbeacon)
  1162. k->def_multi = true;
  1163. if (tb[NL80211_KEY_IDX])
  1164. k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
  1165. if (tb[NL80211_KEY_DATA]) {
  1166. k->p.key = nla_data(tb[NL80211_KEY_DATA]);
  1167. k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
  1168. }
  1169. if (tb[NL80211_KEY_SEQ]) {
  1170. k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
  1171. k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
  1172. }
  1173. if (tb[NL80211_KEY_CIPHER])
  1174. k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
  1175. if (tb[NL80211_KEY_TYPE])
  1176. k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
  1177. if (tb[NL80211_KEY_DEFAULT_TYPES]) {
  1178. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  1179. err = nla_parse_nested_deprecated(kdt,
  1180. NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  1181. tb[NL80211_KEY_DEFAULT_TYPES],
  1182. nl80211_key_default_policy,
  1183. info->extack);
  1184. if (err)
  1185. return err;
  1186. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  1187. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  1188. }
  1189. if (tb[NL80211_KEY_MODE])
  1190. k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]);
  1191. return 0;
  1192. }
  1193. static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
  1194. {
  1195. if (info->attrs[NL80211_ATTR_KEY_DATA]) {
  1196. k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
  1197. k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
  1198. }
  1199. if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
  1200. k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
  1201. k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
  1202. }
  1203. if (info->attrs[NL80211_ATTR_KEY_IDX])
  1204. k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  1205. if (info->attrs[NL80211_ATTR_KEY_CIPHER])
  1206. k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
  1207. k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
  1208. k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
  1209. if (k->def) {
  1210. k->def_uni = true;
  1211. k->def_multi = true;
  1212. }
  1213. if (k->defmgmt)
  1214. k->def_multi = true;
  1215. if (info->attrs[NL80211_ATTR_KEY_TYPE])
  1216. k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  1217. if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
  1218. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  1219. int err = nla_parse_nested_deprecated(kdt,
  1220. NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  1221. info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
  1222. nl80211_key_default_policy,
  1223. info->extack);
  1224. if (err)
  1225. return err;
  1226. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  1227. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  1228. }
  1229. return 0;
  1230. }
  1231. static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
  1232. {
  1233. int err;
  1234. memset(k, 0, sizeof(*k));
  1235. k->idx = -1;
  1236. k->type = -1;
  1237. if (info->attrs[NL80211_ATTR_KEY])
  1238. err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
  1239. else
  1240. err = nl80211_parse_key_old(info, k);
  1241. if (err)
  1242. return err;
  1243. if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) +
  1244. (k->defbeacon ? 1 : 0) > 1) {
  1245. GENL_SET_ERR_MSG(info,
  1246. "key with multiple default flags is invalid");
  1247. return -EINVAL;
  1248. }
  1249. if (k->defmgmt || k->defbeacon) {
  1250. if (k->def_uni || !k->def_multi) {
  1251. GENL_SET_ERR_MSG(info,
  1252. "defmgmt/defbeacon key must be mcast");
  1253. return -EINVAL;
  1254. }
  1255. }
  1256. if (k->idx != -1) {
  1257. if (k->defmgmt) {
  1258. if (k->idx < 4 || k->idx > 5) {
  1259. GENL_SET_ERR_MSG(info,
  1260. "defmgmt key idx not 4 or 5");
  1261. return -EINVAL;
  1262. }
  1263. } else if (k->defbeacon) {
  1264. if (k->idx < 6 || k->idx > 7) {
  1265. GENL_SET_ERR_MSG(info,
  1266. "defbeacon key idx not 6 or 7");
  1267. return -EINVAL;
  1268. }
  1269. } else if (k->def) {
  1270. if (k->idx < 0 || k->idx > 3) {
  1271. GENL_SET_ERR_MSG(info, "def key idx not 0-3");
  1272. return -EINVAL;
  1273. }
  1274. } else {
  1275. if (k->idx < 0 || k->idx > 7) {
  1276. GENL_SET_ERR_MSG(info, "key idx not 0-7");
  1277. return -EINVAL;
  1278. }
  1279. }
  1280. }
  1281. return 0;
  1282. }
  1283. static struct cfg80211_cached_keys *
  1284. nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
  1285. struct genl_info *info, bool *no_ht)
  1286. {
  1287. struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
  1288. struct key_parse parse;
  1289. struct nlattr *key;
  1290. struct cfg80211_cached_keys *result;
  1291. int rem, err, def = 0;
  1292. bool have_key = false;
  1293. nla_for_each_nested(key, keys, rem) {
  1294. have_key = true;
  1295. break;
  1296. }
  1297. if (!have_key)
  1298. return NULL;
  1299. result = kzalloc(sizeof(*result), GFP_KERNEL);
  1300. if (!result)
  1301. return ERR_PTR(-ENOMEM);
  1302. result->def = -1;
  1303. nla_for_each_nested(key, keys, rem) {
  1304. memset(&parse, 0, sizeof(parse));
  1305. parse.idx = -1;
  1306. err = nl80211_parse_key_new(info, key, &parse);
  1307. if (err)
  1308. goto error;
  1309. err = -EINVAL;
  1310. if (!parse.p.key)
  1311. goto error;
  1312. if (parse.idx < 0 || parse.idx > 3) {
  1313. GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
  1314. goto error;
  1315. }
  1316. if (parse.def) {
  1317. if (def) {
  1318. GENL_SET_ERR_MSG(info,
  1319. "only one key can be default");
  1320. goto error;
  1321. }
  1322. def = 1;
  1323. result->def = parse.idx;
  1324. if (!parse.def_uni || !parse.def_multi)
  1325. goto error;
  1326. } else if (parse.defmgmt)
  1327. goto error;
  1328. err = cfg80211_validate_key_settings(rdev, &parse.p,
  1329. parse.idx, false, NULL);
  1330. if (err)
  1331. goto error;
  1332. if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
  1333. parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
  1334. GENL_SET_ERR_MSG(info, "connect key must be WEP");
  1335. err = -EINVAL;
  1336. goto error;
  1337. }
  1338. result->params[parse.idx].cipher = parse.p.cipher;
  1339. result->params[parse.idx].key_len = parse.p.key_len;
  1340. result->params[parse.idx].key = result->data[parse.idx];
  1341. memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
  1342. /* must be WEP key if we got here */
  1343. if (no_ht)
  1344. *no_ht = true;
  1345. }
  1346. if (result->def < 0) {
  1347. err = -EINVAL;
  1348. GENL_SET_ERR_MSG(info, "need a default/TX key");
  1349. goto error;
  1350. }
  1351. return result;
  1352. error:
  1353. kfree(result);
  1354. return ERR_PTR(err);
  1355. }
  1356. static int nl80211_key_allowed(struct wireless_dev *wdev)
  1357. {
  1358. ASSERT_WDEV_LOCK(wdev);
  1359. switch (wdev->iftype) {
  1360. case NL80211_IFTYPE_AP:
  1361. case NL80211_IFTYPE_AP_VLAN:
  1362. case NL80211_IFTYPE_P2P_GO:
  1363. case NL80211_IFTYPE_MESH_POINT:
  1364. break;
  1365. case NL80211_IFTYPE_ADHOC:
  1366. if (wdev->u.ibss.current_bss)
  1367. return 0;
  1368. return -ENOLINK;
  1369. case NL80211_IFTYPE_STATION:
  1370. case NL80211_IFTYPE_P2P_CLIENT:
  1371. if (wdev->connected)
  1372. return 0;
  1373. return -ENOLINK;
  1374. case NL80211_IFTYPE_NAN:
  1375. if (wiphy_ext_feature_isset(wdev->wiphy,
  1376. NL80211_EXT_FEATURE_SECURE_NAN))
  1377. return 0;
  1378. return -EINVAL;
  1379. case NL80211_IFTYPE_UNSPECIFIED:
  1380. case NL80211_IFTYPE_OCB:
  1381. case NL80211_IFTYPE_MONITOR:
  1382. case NL80211_IFTYPE_P2P_DEVICE:
  1383. case NL80211_IFTYPE_WDS:
  1384. case NUM_NL80211_IFTYPES:
  1385. return -EINVAL;
  1386. }
  1387. return 0;
  1388. }
  1389. static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
  1390. u32 freq)
  1391. {
  1392. struct ieee80211_channel *chan;
  1393. chan = ieee80211_get_channel_khz(wiphy, freq);
  1394. if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
  1395. return NULL;
  1396. return chan;
  1397. }
  1398. static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
  1399. {
  1400. struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr);
  1401. int i;
  1402. if (!nl_modes)
  1403. goto nla_put_failure;
  1404. i = 0;
  1405. while (ifmodes) {
  1406. if ((ifmodes & 1) && nla_put_flag(msg, i))
  1407. goto nla_put_failure;
  1408. ifmodes >>= 1;
  1409. i++;
  1410. }
  1411. nla_nest_end(msg, nl_modes);
  1412. return 0;
  1413. nla_put_failure:
  1414. return -ENOBUFS;
  1415. }
  1416. static int nl80211_put_iface_combinations(struct wiphy *wiphy,
  1417. struct sk_buff *msg,
  1418. bool large)
  1419. {
  1420. struct nlattr *nl_combis;
  1421. int i, j;
  1422. nl_combis = nla_nest_start_noflag(msg,
  1423. NL80211_ATTR_INTERFACE_COMBINATIONS);
  1424. if (!nl_combis)
  1425. goto nla_put_failure;
  1426. for (i = 0; i < wiphy->n_iface_combinations; i++) {
  1427. const struct ieee80211_iface_combination *c;
  1428. struct nlattr *nl_combi, *nl_limits;
  1429. c = &wiphy->iface_combinations[i];
  1430. nl_combi = nla_nest_start_noflag(msg, i + 1);
  1431. if (!nl_combi)
  1432. goto nla_put_failure;
  1433. nl_limits = nla_nest_start_noflag(msg,
  1434. NL80211_IFACE_COMB_LIMITS);
  1435. if (!nl_limits)
  1436. goto nla_put_failure;
  1437. for (j = 0; j < c->n_limits; j++) {
  1438. struct nlattr *nl_limit;
  1439. nl_limit = nla_nest_start_noflag(msg, j + 1);
  1440. if (!nl_limit)
  1441. goto nla_put_failure;
  1442. if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX,
  1443. c->limits[j].max))
  1444. goto nla_put_failure;
  1445. if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
  1446. c->limits[j].types))
  1447. goto nla_put_failure;
  1448. nla_nest_end(msg, nl_limit);
  1449. }
  1450. nla_nest_end(msg, nl_limits);
  1451. if (c->beacon_int_infra_match &&
  1452. nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
  1453. goto nla_put_failure;
  1454. if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
  1455. c->num_different_channels) ||
  1456. nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
  1457. c->max_interfaces))
  1458. goto nla_put_failure;
  1459. if (large &&
  1460. (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
  1461. c->radar_detect_widths) ||
  1462. nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
  1463. c->radar_detect_regions)))
  1464. goto nla_put_failure;
  1465. if (c->beacon_int_min_gcd &&
  1466. nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
  1467. c->beacon_int_min_gcd))
  1468. goto nla_put_failure;
  1469. nla_nest_end(msg, nl_combi);
  1470. }
  1471. nla_nest_end(msg, nl_combis);
  1472. return 0;
  1473. nla_put_failure:
  1474. return -ENOBUFS;
  1475. }
  1476. #ifdef CONFIG_PM
  1477. static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
  1478. struct sk_buff *msg)
  1479. {
  1480. const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
  1481. struct nlattr *nl_tcp;
  1482. if (!tcp)
  1483. return 0;
  1484. nl_tcp = nla_nest_start_noflag(msg,
  1485. NL80211_WOWLAN_TRIG_TCP_CONNECTION);
  1486. if (!nl_tcp)
  1487. return -ENOBUFS;
  1488. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  1489. tcp->data_payload_max))
  1490. return -ENOBUFS;
  1491. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  1492. tcp->data_payload_max))
  1493. return -ENOBUFS;
  1494. if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
  1495. return -ENOBUFS;
  1496. if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
  1497. sizeof(*tcp->tok), tcp->tok))
  1498. return -ENOBUFS;
  1499. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
  1500. tcp->data_interval_max))
  1501. return -ENOBUFS;
  1502. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
  1503. tcp->wake_payload_max))
  1504. return -ENOBUFS;
  1505. nla_nest_end(msg, nl_tcp);
  1506. return 0;
  1507. }
  1508. static int nl80211_send_wowlan(struct sk_buff *msg,
  1509. struct cfg80211_registered_device *rdev,
  1510. bool large)
  1511. {
  1512. struct nlattr *nl_wowlan;
  1513. if (!rdev->wiphy.wowlan)
  1514. return 0;
  1515. nl_wowlan = nla_nest_start_noflag(msg,
  1516. NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
  1517. if (!nl_wowlan)
  1518. return -ENOBUFS;
  1519. if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
  1520. nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
  1521. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
  1522. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
  1523. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
  1524. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
  1525. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
  1526. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
  1527. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
  1528. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
  1529. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
  1530. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
  1531. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
  1532. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
  1533. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
  1534. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
  1535. return -ENOBUFS;
  1536. if (rdev->wiphy.wowlan->n_patterns) {
  1537. struct nl80211_pattern_support pat = {
  1538. .max_patterns = rdev->wiphy.wowlan->n_patterns,
  1539. .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
  1540. .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
  1541. .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
  1542. };
  1543. if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  1544. sizeof(pat), &pat))
  1545. return -ENOBUFS;
  1546. }
  1547. if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
  1548. nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
  1549. rdev->wiphy.wowlan->max_nd_match_sets))
  1550. return -ENOBUFS;
  1551. if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
  1552. return -ENOBUFS;
  1553. nla_nest_end(msg, nl_wowlan);
  1554. return 0;
  1555. }
  1556. #endif
  1557. static int nl80211_send_coalesce(struct sk_buff *msg,
  1558. struct cfg80211_registered_device *rdev)
  1559. {
  1560. struct nl80211_coalesce_rule_support rule;
  1561. if (!rdev->wiphy.coalesce)
  1562. return 0;
  1563. rule.max_rules = rdev->wiphy.coalesce->n_rules;
  1564. rule.max_delay = rdev->wiphy.coalesce->max_delay;
  1565. rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
  1566. rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
  1567. rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
  1568. rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
  1569. if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
  1570. return -ENOBUFS;
  1571. return 0;
  1572. }
  1573. static int
  1574. nl80211_send_iftype_data(struct sk_buff *msg,
  1575. const struct ieee80211_supported_band *sband,
  1576. const struct ieee80211_sband_iftype_data *iftdata)
  1577. {
  1578. const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap;
  1579. const struct ieee80211_sta_eht_cap *eht_cap = &iftdata->eht_cap;
  1580. if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES,
  1581. iftdata->types_mask))
  1582. return -ENOBUFS;
  1583. if (he_cap->has_he) {
  1584. if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC,
  1585. sizeof(he_cap->he_cap_elem.mac_cap_info),
  1586. he_cap->he_cap_elem.mac_cap_info) ||
  1587. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY,
  1588. sizeof(he_cap->he_cap_elem.phy_cap_info),
  1589. he_cap->he_cap_elem.phy_cap_info) ||
  1590. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET,
  1591. sizeof(he_cap->he_mcs_nss_supp),
  1592. &he_cap->he_mcs_nss_supp) ||
  1593. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE,
  1594. sizeof(he_cap->ppe_thres), he_cap->ppe_thres))
  1595. return -ENOBUFS;
  1596. }
  1597. if (eht_cap->has_eht && he_cap->has_he) {
  1598. u8 mcs_nss_size, ppe_thresh_size;
  1599. u16 ppe_thres_hdr;
  1600. bool is_ap;
  1601. is_ap = iftdata->types_mask & BIT(NL80211_IFTYPE_AP) ||
  1602. iftdata->types_mask & BIT(NL80211_IFTYPE_P2P_GO);
  1603. mcs_nss_size =
  1604. ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem,
  1605. &eht_cap->eht_cap_elem,
  1606. is_ap);
  1607. ppe_thres_hdr = get_unaligned_le16(&eht_cap->eht_ppe_thres[0]);
  1608. ppe_thresh_size =
  1609. ieee80211_eht_ppe_size(ppe_thres_hdr,
  1610. eht_cap->eht_cap_elem.phy_cap_info);
  1611. if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MAC,
  1612. sizeof(eht_cap->eht_cap_elem.mac_cap_info),
  1613. eht_cap->eht_cap_elem.mac_cap_info) ||
  1614. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PHY,
  1615. sizeof(eht_cap->eht_cap_elem.phy_cap_info),
  1616. eht_cap->eht_cap_elem.phy_cap_info) ||
  1617. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MCS_SET,
  1618. mcs_nss_size, &eht_cap->eht_mcs_nss_supp) ||
  1619. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PPE,
  1620. ppe_thresh_size, eht_cap->eht_ppe_thres))
  1621. return -ENOBUFS;
  1622. }
  1623. if (sband->band == NL80211_BAND_6GHZ &&
  1624. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_6GHZ_CAPA,
  1625. sizeof(iftdata->he_6ghz_capa),
  1626. &iftdata->he_6ghz_capa))
  1627. return -ENOBUFS;
  1628. if (iftdata->vendor_elems.data && iftdata->vendor_elems.len &&
  1629. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_VENDOR_ELEMS,
  1630. iftdata->vendor_elems.len, iftdata->vendor_elems.data))
  1631. return -ENOBUFS;
  1632. return 0;
  1633. }
  1634. static int nl80211_send_band_rateinfo(struct sk_buff *msg,
  1635. struct ieee80211_supported_band *sband,
  1636. bool large)
  1637. {
  1638. struct nlattr *nl_rates, *nl_rate;
  1639. struct ieee80211_rate *rate;
  1640. int i;
  1641. /* add HT info */
  1642. if (sband->ht_cap.ht_supported &&
  1643. (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
  1644. sizeof(sband->ht_cap.mcs),
  1645. &sband->ht_cap.mcs) ||
  1646. nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
  1647. sband->ht_cap.cap) ||
  1648. nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
  1649. sband->ht_cap.ampdu_factor) ||
  1650. nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
  1651. sband->ht_cap.ampdu_density)))
  1652. return -ENOBUFS;
  1653. /* add VHT info */
  1654. if (sband->vht_cap.vht_supported &&
  1655. (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
  1656. sizeof(sband->vht_cap.vht_mcs),
  1657. &sband->vht_cap.vht_mcs) ||
  1658. nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
  1659. sband->vht_cap.cap)))
  1660. return -ENOBUFS;
  1661. if (large && sband->n_iftype_data) {
  1662. struct nlattr *nl_iftype_data =
  1663. nla_nest_start_noflag(msg,
  1664. NL80211_BAND_ATTR_IFTYPE_DATA);
  1665. int err;
  1666. if (!nl_iftype_data)
  1667. return -ENOBUFS;
  1668. for (i = 0; i < sband->n_iftype_data; i++) {
  1669. struct nlattr *iftdata;
  1670. iftdata = nla_nest_start_noflag(msg, i + 1);
  1671. if (!iftdata)
  1672. return -ENOBUFS;
  1673. err = nl80211_send_iftype_data(msg, sband,
  1674. &sband->iftype_data[i]);
  1675. if (err)
  1676. return err;
  1677. nla_nest_end(msg, iftdata);
  1678. }
  1679. nla_nest_end(msg, nl_iftype_data);
  1680. }
  1681. /* add EDMG info */
  1682. if (large && sband->edmg_cap.channels &&
  1683. (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS,
  1684. sband->edmg_cap.channels) ||
  1685. nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG,
  1686. sband->edmg_cap.bw_config)))
  1687. return -ENOBUFS;
  1688. /* add bitrates */
  1689. nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES);
  1690. if (!nl_rates)
  1691. return -ENOBUFS;
  1692. for (i = 0; i < sband->n_bitrates; i++) {
  1693. nl_rate = nla_nest_start_noflag(msg, i);
  1694. if (!nl_rate)
  1695. return -ENOBUFS;
  1696. rate = &sband->bitrates[i];
  1697. if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
  1698. rate->bitrate))
  1699. return -ENOBUFS;
  1700. if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
  1701. nla_put_flag(msg,
  1702. NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
  1703. return -ENOBUFS;
  1704. nla_nest_end(msg, nl_rate);
  1705. }
  1706. nla_nest_end(msg, nl_rates);
  1707. return 0;
  1708. }
  1709. static int
  1710. nl80211_send_mgmt_stypes(struct sk_buff *msg,
  1711. const struct ieee80211_txrx_stypes *mgmt_stypes)
  1712. {
  1713. u16 stypes;
  1714. struct nlattr *nl_ftypes, *nl_ifs;
  1715. enum nl80211_iftype ift;
  1716. int i;
  1717. if (!mgmt_stypes)
  1718. return 0;
  1719. nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES);
  1720. if (!nl_ifs)
  1721. return -ENOBUFS;
  1722. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  1723. nl_ftypes = nla_nest_start_noflag(msg, ift);
  1724. if (!nl_ftypes)
  1725. return -ENOBUFS;
  1726. i = 0;
  1727. stypes = mgmt_stypes[ift].tx;
  1728. while (stypes) {
  1729. if ((stypes & 1) &&
  1730. nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
  1731. (i << 4) | IEEE80211_FTYPE_MGMT))
  1732. return -ENOBUFS;
  1733. stypes >>= 1;
  1734. i++;
  1735. }
  1736. nla_nest_end(msg, nl_ftypes);
  1737. }
  1738. nla_nest_end(msg, nl_ifs);
  1739. nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES);
  1740. if (!nl_ifs)
  1741. return -ENOBUFS;
  1742. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  1743. nl_ftypes = nla_nest_start_noflag(msg, ift);
  1744. if (!nl_ftypes)
  1745. return -ENOBUFS;
  1746. i = 0;
  1747. stypes = mgmt_stypes[ift].rx;
  1748. while (stypes) {
  1749. if ((stypes & 1) &&
  1750. nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
  1751. (i << 4) | IEEE80211_FTYPE_MGMT))
  1752. return -ENOBUFS;
  1753. stypes >>= 1;
  1754. i++;
  1755. }
  1756. nla_nest_end(msg, nl_ftypes);
  1757. }
  1758. nla_nest_end(msg, nl_ifs);
  1759. return 0;
  1760. }
  1761. #define CMD(op, n) \
  1762. do { \
  1763. if (rdev->ops->op) { \
  1764. i++; \
  1765. if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
  1766. goto nla_put_failure; \
  1767. } \
  1768. } while (0)
  1769. static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
  1770. struct sk_buff *msg)
  1771. {
  1772. int i = 0;
  1773. /*
  1774. * do *NOT* add anything into this function, new things need to be
  1775. * advertised only to new versions of userspace that can deal with
  1776. * the split (and they can't possibly care about new features...
  1777. */
  1778. CMD(add_virtual_intf, NEW_INTERFACE);
  1779. CMD(change_virtual_intf, SET_INTERFACE);
  1780. CMD(add_key, NEW_KEY);
  1781. CMD(start_ap, START_AP);
  1782. CMD(add_station, NEW_STATION);
  1783. CMD(add_mpath, NEW_MPATH);
  1784. CMD(update_mesh_config, SET_MESH_CONFIG);
  1785. CMD(change_bss, SET_BSS);
  1786. CMD(auth, AUTHENTICATE);
  1787. CMD(assoc, ASSOCIATE);
  1788. CMD(deauth, DEAUTHENTICATE);
  1789. CMD(disassoc, DISASSOCIATE);
  1790. CMD(join_ibss, JOIN_IBSS);
  1791. CMD(join_mesh, JOIN_MESH);
  1792. CMD(set_pmksa, SET_PMKSA);
  1793. CMD(del_pmksa, DEL_PMKSA);
  1794. CMD(flush_pmksa, FLUSH_PMKSA);
  1795. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
  1796. CMD(remain_on_channel, REMAIN_ON_CHANNEL);
  1797. CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
  1798. CMD(mgmt_tx, FRAME);
  1799. CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
  1800. if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
  1801. i++;
  1802. if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
  1803. goto nla_put_failure;
  1804. }
  1805. if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
  1806. rdev->ops->join_mesh) {
  1807. i++;
  1808. if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
  1809. goto nla_put_failure;
  1810. }
  1811. if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
  1812. CMD(tdls_mgmt, TDLS_MGMT);
  1813. CMD(tdls_oper, TDLS_OPER);
  1814. }
  1815. if (rdev->wiphy.max_sched_scan_reqs)
  1816. CMD(sched_scan_start, START_SCHED_SCAN);
  1817. CMD(probe_client, PROBE_CLIENT);
  1818. CMD(set_noack_map, SET_NOACK_MAP);
  1819. if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
  1820. i++;
  1821. if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
  1822. goto nla_put_failure;
  1823. }
  1824. CMD(start_p2p_device, START_P2P_DEVICE);
  1825. CMD(set_mcast_rate, SET_MCAST_RATE);
  1826. #ifdef CONFIG_NL80211_TESTMODE
  1827. CMD(testmode_cmd, TESTMODE);
  1828. #endif
  1829. if (rdev->ops->connect || rdev->ops->auth) {
  1830. i++;
  1831. if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
  1832. goto nla_put_failure;
  1833. }
  1834. if (rdev->ops->disconnect || rdev->ops->deauth) {
  1835. i++;
  1836. if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
  1837. goto nla_put_failure;
  1838. }
  1839. return i;
  1840. nla_put_failure:
  1841. return -ENOBUFS;
  1842. }
  1843. static int
  1844. nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap,
  1845. struct sk_buff *msg)
  1846. {
  1847. struct nlattr *ftm;
  1848. if (!cap->ftm.supported)
  1849. return 0;
  1850. ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM);
  1851. if (!ftm)
  1852. return -ENOBUFS;
  1853. if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP))
  1854. return -ENOBUFS;
  1855. if (cap->ftm.non_asap &&
  1856. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP))
  1857. return -ENOBUFS;
  1858. if (cap->ftm.request_lci &&
  1859. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI))
  1860. return -ENOBUFS;
  1861. if (cap->ftm.request_civicloc &&
  1862. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC))
  1863. return -ENOBUFS;
  1864. if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES,
  1865. cap->ftm.preambles))
  1866. return -ENOBUFS;
  1867. if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS,
  1868. cap->ftm.bandwidths))
  1869. return -ENOBUFS;
  1870. if (cap->ftm.max_bursts_exponent >= 0 &&
  1871. nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT,
  1872. cap->ftm.max_bursts_exponent))
  1873. return -ENOBUFS;
  1874. if (cap->ftm.max_ftms_per_burst &&
  1875. nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST,
  1876. cap->ftm.max_ftms_per_burst))
  1877. return -ENOBUFS;
  1878. if (cap->ftm.trigger_based &&
  1879. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_TRIGGER_BASED))
  1880. return -ENOBUFS;
  1881. if (cap->ftm.non_trigger_based &&
  1882. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_TRIGGER_BASED))
  1883. return -ENOBUFS;
  1884. nla_nest_end(msg, ftm);
  1885. return 0;
  1886. }
  1887. static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev,
  1888. struct sk_buff *msg)
  1889. {
  1890. const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa;
  1891. struct nlattr *pmsr, *caps;
  1892. if (!cap)
  1893. return 0;
  1894. /*
  1895. * we don't need to clean up anything here since the caller
  1896. * will genlmsg_cancel() if we fail
  1897. */
  1898. pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS);
  1899. if (!pmsr)
  1900. return -ENOBUFS;
  1901. if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers))
  1902. return -ENOBUFS;
  1903. if (cap->report_ap_tsf &&
  1904. nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF))
  1905. return -ENOBUFS;
  1906. if (cap->randomize_mac_addr &&
  1907. nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR))
  1908. return -ENOBUFS;
  1909. caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA);
  1910. if (!caps)
  1911. return -ENOBUFS;
  1912. if (nl80211_send_pmsr_ftm_capa(cap, msg))
  1913. return -ENOBUFS;
  1914. nla_nest_end(msg, caps);
  1915. nla_nest_end(msg, pmsr);
  1916. return 0;
  1917. }
  1918. static int
  1919. nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev,
  1920. struct sk_buff *msg)
  1921. {
  1922. int i;
  1923. struct nlattr *nested, *nested_akms;
  1924. const struct wiphy_iftype_akm_suites *iftype_akms;
  1925. if (!rdev->wiphy.num_iftype_akm_suites ||
  1926. !rdev->wiphy.iftype_akm_suites)
  1927. return 0;
  1928. nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES);
  1929. if (!nested)
  1930. return -ENOBUFS;
  1931. for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) {
  1932. nested_akms = nla_nest_start(msg, i + 1);
  1933. if (!nested_akms)
  1934. return -ENOBUFS;
  1935. iftype_akms = &rdev->wiphy.iftype_akm_suites[i];
  1936. if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES,
  1937. iftype_akms->iftypes_mask))
  1938. return -ENOBUFS;
  1939. if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES,
  1940. sizeof(u32) * iftype_akms->n_akm_suites,
  1941. iftype_akms->akm_suites)) {
  1942. return -ENOBUFS;
  1943. }
  1944. nla_nest_end(msg, nested_akms);
  1945. }
  1946. nla_nest_end(msg, nested);
  1947. return 0;
  1948. }
  1949. static int
  1950. nl80211_put_tid_config_support(struct cfg80211_registered_device *rdev,
  1951. struct sk_buff *msg)
  1952. {
  1953. struct nlattr *supp;
  1954. if (!rdev->wiphy.tid_config_support.vif &&
  1955. !rdev->wiphy.tid_config_support.peer)
  1956. return 0;
  1957. supp = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG);
  1958. if (!supp)
  1959. return -ENOSPC;
  1960. if (rdev->wiphy.tid_config_support.vif &&
  1961. nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_VIF_SUPP,
  1962. rdev->wiphy.tid_config_support.vif,
  1963. NL80211_TID_CONFIG_ATTR_PAD))
  1964. goto fail;
  1965. if (rdev->wiphy.tid_config_support.peer &&
  1966. nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_PEER_SUPP,
  1967. rdev->wiphy.tid_config_support.peer,
  1968. NL80211_TID_CONFIG_ATTR_PAD))
  1969. goto fail;
  1970. /* for now we just use the same value ... makes more sense */
  1971. if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT,
  1972. rdev->wiphy.tid_config_support.max_retry))
  1973. goto fail;
  1974. if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG,
  1975. rdev->wiphy.tid_config_support.max_retry))
  1976. goto fail;
  1977. nla_nest_end(msg, supp);
  1978. return 0;
  1979. fail:
  1980. nla_nest_cancel(msg, supp);
  1981. return -ENOBUFS;
  1982. }
  1983. static int
  1984. nl80211_put_sar_specs(struct cfg80211_registered_device *rdev,
  1985. struct sk_buff *msg)
  1986. {
  1987. struct nlattr *sar_capa, *specs, *sub_freq_range;
  1988. u8 num_freq_ranges;
  1989. int i;
  1990. if (!rdev->wiphy.sar_capa)
  1991. return 0;
  1992. num_freq_ranges = rdev->wiphy.sar_capa->num_freq_ranges;
  1993. sar_capa = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC);
  1994. if (!sar_capa)
  1995. return -ENOSPC;
  1996. if (nla_put_u32(msg, NL80211_SAR_ATTR_TYPE, rdev->wiphy.sar_capa->type))
  1997. goto fail;
  1998. specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS);
  1999. if (!specs)
  2000. goto fail;
  2001. /* report supported freq_ranges */
  2002. for (i = 0; i < num_freq_ranges; i++) {
  2003. sub_freq_range = nla_nest_start(msg, i + 1);
  2004. if (!sub_freq_range)
  2005. goto fail;
  2006. if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_START_FREQ,
  2007. rdev->wiphy.sar_capa->freq_ranges[i].start_freq))
  2008. goto fail;
  2009. if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_END_FREQ,
  2010. rdev->wiphy.sar_capa->freq_ranges[i].end_freq))
  2011. goto fail;
  2012. nla_nest_end(msg, sub_freq_range);
  2013. }
  2014. nla_nest_end(msg, specs);
  2015. nla_nest_end(msg, sar_capa);
  2016. return 0;
  2017. fail:
  2018. nla_nest_cancel(msg, sar_capa);
  2019. return -ENOBUFS;
  2020. }
  2021. static int nl80211_put_mbssid_support(struct wiphy *wiphy, struct sk_buff *msg)
  2022. {
  2023. struct nlattr *config;
  2024. if (!wiphy->mbssid_max_interfaces)
  2025. return 0;
  2026. config = nla_nest_start(msg, NL80211_ATTR_MBSSID_CONFIG);
  2027. if (!config)
  2028. return -ENOBUFS;
  2029. if (nla_put_u8(msg, NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES,
  2030. wiphy->mbssid_max_interfaces))
  2031. goto fail;
  2032. if (wiphy->ema_max_profile_periodicity &&
  2033. nla_put_u8(msg,
  2034. NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY,
  2035. wiphy->ema_max_profile_periodicity))
  2036. goto fail;
  2037. nla_nest_end(msg, config);
  2038. return 0;
  2039. fail:
  2040. nla_nest_cancel(msg, config);
  2041. return -ENOBUFS;
  2042. }
  2043. struct nl80211_dump_wiphy_state {
  2044. s64 filter_wiphy;
  2045. long start;
  2046. long split_start, band_start, chan_start, capa_start;
  2047. bool split;
  2048. };
  2049. static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
  2050. enum nl80211_commands cmd,
  2051. struct sk_buff *msg, u32 portid, u32 seq,
  2052. int flags, struct nl80211_dump_wiphy_state *state)
  2053. {
  2054. void *hdr;
  2055. struct nlattr *nl_bands, *nl_band;
  2056. struct nlattr *nl_freqs, *nl_freq;
  2057. struct nlattr *nl_cmds;
  2058. enum nl80211_band band;
  2059. struct ieee80211_channel *chan;
  2060. int i;
  2061. const struct ieee80211_txrx_stypes *mgmt_stypes =
  2062. rdev->wiphy.mgmt_stypes;
  2063. u32 features;
  2064. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  2065. if (!hdr)
  2066. return -ENOBUFS;
  2067. if (WARN_ON(!state))
  2068. return -EINVAL;
  2069. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  2070. nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
  2071. wiphy_name(&rdev->wiphy)) ||
  2072. nla_put_u32(msg, NL80211_ATTR_GENERATION,
  2073. cfg80211_rdev_list_generation))
  2074. goto nla_put_failure;
  2075. if (cmd != NL80211_CMD_NEW_WIPHY)
  2076. goto finish;
  2077. switch (state->split_start) {
  2078. case 0:
  2079. if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
  2080. rdev->wiphy.retry_short) ||
  2081. nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
  2082. rdev->wiphy.retry_long) ||
  2083. nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
  2084. rdev->wiphy.frag_threshold) ||
  2085. nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
  2086. rdev->wiphy.rts_threshold) ||
  2087. nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
  2088. rdev->wiphy.coverage_class) ||
  2089. nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
  2090. rdev->wiphy.max_scan_ssids) ||
  2091. nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
  2092. rdev->wiphy.max_sched_scan_ssids) ||
  2093. nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
  2094. rdev->wiphy.max_scan_ie_len) ||
  2095. nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
  2096. rdev->wiphy.max_sched_scan_ie_len) ||
  2097. nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
  2098. rdev->wiphy.max_match_sets))
  2099. goto nla_put_failure;
  2100. if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
  2101. nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
  2102. goto nla_put_failure;
  2103. if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
  2104. nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
  2105. goto nla_put_failure;
  2106. if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
  2107. nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
  2108. goto nla_put_failure;
  2109. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
  2110. nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
  2111. goto nla_put_failure;
  2112. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
  2113. nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
  2114. goto nla_put_failure;
  2115. if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
  2116. nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
  2117. goto nla_put_failure;
  2118. state->split_start++;
  2119. if (state->split)
  2120. break;
  2121. fallthrough;
  2122. case 1:
  2123. if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
  2124. sizeof(u32) * rdev->wiphy.n_cipher_suites,
  2125. rdev->wiphy.cipher_suites))
  2126. goto nla_put_failure;
  2127. if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
  2128. rdev->wiphy.max_num_pmkids))
  2129. goto nla_put_failure;
  2130. if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  2131. nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
  2132. goto nla_put_failure;
  2133. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
  2134. rdev->wiphy.available_antennas_tx) ||
  2135. nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
  2136. rdev->wiphy.available_antennas_rx))
  2137. goto nla_put_failure;
  2138. if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
  2139. nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
  2140. rdev->wiphy.probe_resp_offload))
  2141. goto nla_put_failure;
  2142. if ((rdev->wiphy.available_antennas_tx ||
  2143. rdev->wiphy.available_antennas_rx) &&
  2144. rdev->ops->get_antenna) {
  2145. u32 tx_ant = 0, rx_ant = 0;
  2146. int res;
  2147. res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
  2148. if (!res) {
  2149. if (nla_put_u32(msg,
  2150. NL80211_ATTR_WIPHY_ANTENNA_TX,
  2151. tx_ant) ||
  2152. nla_put_u32(msg,
  2153. NL80211_ATTR_WIPHY_ANTENNA_RX,
  2154. rx_ant))
  2155. goto nla_put_failure;
  2156. }
  2157. }
  2158. state->split_start++;
  2159. if (state->split)
  2160. break;
  2161. fallthrough;
  2162. case 2:
  2163. if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
  2164. rdev->wiphy.interface_modes))
  2165. goto nla_put_failure;
  2166. state->split_start++;
  2167. if (state->split)
  2168. break;
  2169. fallthrough;
  2170. case 3:
  2171. nl_bands = nla_nest_start_noflag(msg,
  2172. NL80211_ATTR_WIPHY_BANDS);
  2173. if (!nl_bands)
  2174. goto nla_put_failure;
  2175. for (band = state->band_start;
  2176. band < (state->split ?
  2177. NUM_NL80211_BANDS :
  2178. NL80211_BAND_60GHZ + 1);
  2179. band++) {
  2180. struct ieee80211_supported_band *sband;
  2181. /* omit higher bands for ancient software */
  2182. if (band > NL80211_BAND_5GHZ && !state->split)
  2183. break;
  2184. sband = rdev->wiphy.bands[band];
  2185. if (!sband)
  2186. continue;
  2187. nl_band = nla_nest_start_noflag(msg, band);
  2188. if (!nl_band)
  2189. goto nla_put_failure;
  2190. switch (state->chan_start) {
  2191. case 0:
  2192. if (nl80211_send_band_rateinfo(msg, sband,
  2193. state->split))
  2194. goto nla_put_failure;
  2195. state->chan_start++;
  2196. if (state->split)
  2197. break;
  2198. fallthrough;
  2199. default:
  2200. /* add frequencies */
  2201. nl_freqs = nla_nest_start_noflag(msg,
  2202. NL80211_BAND_ATTR_FREQS);
  2203. if (!nl_freqs)
  2204. goto nla_put_failure;
  2205. for (i = state->chan_start - 1;
  2206. i < sband->n_channels;
  2207. i++) {
  2208. nl_freq = nla_nest_start_noflag(msg,
  2209. i);
  2210. if (!nl_freq)
  2211. goto nla_put_failure;
  2212. chan = &sband->channels[i];
  2213. if (nl80211_msg_put_channel(
  2214. msg, &rdev->wiphy, chan,
  2215. state->split))
  2216. goto nla_put_failure;
  2217. nla_nest_end(msg, nl_freq);
  2218. if (state->split)
  2219. break;
  2220. }
  2221. if (i < sband->n_channels)
  2222. state->chan_start = i + 2;
  2223. else
  2224. state->chan_start = 0;
  2225. nla_nest_end(msg, nl_freqs);
  2226. }
  2227. nla_nest_end(msg, nl_band);
  2228. if (state->split) {
  2229. /* start again here */
  2230. if (state->chan_start)
  2231. band--;
  2232. break;
  2233. }
  2234. }
  2235. nla_nest_end(msg, nl_bands);
  2236. if (band < NUM_NL80211_BANDS)
  2237. state->band_start = band + 1;
  2238. else
  2239. state->band_start = 0;
  2240. /* if bands & channels are done, continue outside */
  2241. if (state->band_start == 0 && state->chan_start == 0)
  2242. state->split_start++;
  2243. if (state->split)
  2244. break;
  2245. fallthrough;
  2246. case 4:
  2247. nl_cmds = nla_nest_start_noflag(msg,
  2248. NL80211_ATTR_SUPPORTED_COMMANDS);
  2249. if (!nl_cmds)
  2250. goto nla_put_failure;
  2251. i = nl80211_add_commands_unsplit(rdev, msg);
  2252. if (i < 0)
  2253. goto nla_put_failure;
  2254. if (state->split) {
  2255. CMD(crit_proto_start, CRIT_PROTOCOL_START);
  2256. CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
  2257. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
  2258. CMD(channel_switch, CHANNEL_SWITCH);
  2259. CMD(set_qos_map, SET_QOS_MAP);
  2260. if (rdev->wiphy.features &
  2261. NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
  2262. CMD(add_tx_ts, ADD_TX_TS);
  2263. CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
  2264. CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
  2265. CMD(update_ft_ies, UPDATE_FT_IES);
  2266. if (rdev->wiphy.sar_capa)
  2267. CMD(set_sar_specs, SET_SAR_SPECS);
  2268. }
  2269. #undef CMD
  2270. nla_nest_end(msg, nl_cmds);
  2271. state->split_start++;
  2272. if (state->split)
  2273. break;
  2274. fallthrough;
  2275. case 5:
  2276. if (rdev->ops->remain_on_channel &&
  2277. (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
  2278. nla_put_u32(msg,
  2279. NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
  2280. rdev->wiphy.max_remain_on_channel_duration))
  2281. goto nla_put_failure;
  2282. if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
  2283. nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
  2284. goto nla_put_failure;
  2285. state->split_start++;
  2286. if (state->split)
  2287. break;
  2288. fallthrough;
  2289. case 6:
  2290. #ifdef CONFIG_PM
  2291. if (nl80211_send_wowlan(msg, rdev, state->split))
  2292. goto nla_put_failure;
  2293. state->split_start++;
  2294. if (state->split)
  2295. break;
  2296. #else
  2297. state->split_start++;
  2298. #endif
  2299. fallthrough;
  2300. case 7:
  2301. if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
  2302. rdev->wiphy.software_iftypes))
  2303. goto nla_put_failure;
  2304. if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
  2305. state->split))
  2306. goto nla_put_failure;
  2307. state->split_start++;
  2308. if (state->split)
  2309. break;
  2310. fallthrough;
  2311. case 8:
  2312. if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
  2313. nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
  2314. rdev->wiphy.ap_sme_capa))
  2315. goto nla_put_failure;
  2316. features = rdev->wiphy.features;
  2317. /*
  2318. * We can only add the per-channel limit information if the
  2319. * dump is split, otherwise it makes it too big. Therefore
  2320. * only advertise it in that case.
  2321. */
  2322. if (state->split)
  2323. features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
  2324. if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
  2325. goto nla_put_failure;
  2326. if (rdev->wiphy.ht_capa_mod_mask &&
  2327. nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
  2328. sizeof(*rdev->wiphy.ht_capa_mod_mask),
  2329. rdev->wiphy.ht_capa_mod_mask))
  2330. goto nla_put_failure;
  2331. if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
  2332. rdev->wiphy.max_acl_mac_addrs &&
  2333. nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
  2334. rdev->wiphy.max_acl_mac_addrs))
  2335. goto nla_put_failure;
  2336. /*
  2337. * Any information below this point is only available to
  2338. * applications that can deal with it being split. This
  2339. * helps ensure that newly added capabilities don't break
  2340. * older tools by overrunning their buffers.
  2341. *
  2342. * We still increment split_start so that in the split
  2343. * case we'll continue with more data in the next round,
  2344. * but break unconditionally so unsplit data stops here.
  2345. */
  2346. if (state->split)
  2347. state->split_start++;
  2348. else
  2349. state->split_start = 0;
  2350. break;
  2351. case 9:
  2352. if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
  2353. goto nla_put_failure;
  2354. if (nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
  2355. rdev->wiphy.max_sched_scan_plans) ||
  2356. nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
  2357. rdev->wiphy.max_sched_scan_plan_interval) ||
  2358. nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
  2359. rdev->wiphy.max_sched_scan_plan_iterations))
  2360. goto nla_put_failure;
  2361. if (rdev->wiphy.extended_capabilities &&
  2362. (nla_put(msg, NL80211_ATTR_EXT_CAPA,
  2363. rdev->wiphy.extended_capabilities_len,
  2364. rdev->wiphy.extended_capabilities) ||
  2365. nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
  2366. rdev->wiphy.extended_capabilities_len,
  2367. rdev->wiphy.extended_capabilities_mask)))
  2368. goto nla_put_failure;
  2369. if (rdev->wiphy.vht_capa_mod_mask &&
  2370. nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
  2371. sizeof(*rdev->wiphy.vht_capa_mod_mask),
  2372. rdev->wiphy.vht_capa_mod_mask))
  2373. goto nla_put_failure;
  2374. if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
  2375. rdev->wiphy.perm_addr))
  2376. goto nla_put_failure;
  2377. if (!is_zero_ether_addr(rdev->wiphy.addr_mask) &&
  2378. nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN,
  2379. rdev->wiphy.addr_mask))
  2380. goto nla_put_failure;
  2381. if (rdev->wiphy.n_addresses > 1) {
  2382. void *attr;
  2383. attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS);
  2384. if (!attr)
  2385. goto nla_put_failure;
  2386. for (i = 0; i < rdev->wiphy.n_addresses; i++)
  2387. if (nla_put(msg, i + 1, ETH_ALEN,
  2388. rdev->wiphy.addresses[i].addr))
  2389. goto nla_put_failure;
  2390. nla_nest_end(msg, attr);
  2391. }
  2392. state->split_start++;
  2393. break;
  2394. case 10:
  2395. if (nl80211_send_coalesce(msg, rdev))
  2396. goto nla_put_failure;
  2397. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
  2398. (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
  2399. nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
  2400. goto nla_put_failure;
  2401. if (rdev->wiphy.max_ap_assoc_sta &&
  2402. nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
  2403. rdev->wiphy.max_ap_assoc_sta))
  2404. goto nla_put_failure;
  2405. state->split_start++;
  2406. break;
  2407. case 11:
  2408. if (rdev->wiphy.n_vendor_commands) {
  2409. const struct nl80211_vendor_cmd_info *info;
  2410. struct nlattr *nested;
  2411. nested = nla_nest_start_noflag(msg,
  2412. NL80211_ATTR_VENDOR_DATA);
  2413. if (!nested)
  2414. goto nla_put_failure;
  2415. for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
  2416. info = &rdev->wiphy.vendor_commands[i].info;
  2417. if (nla_put(msg, i + 1, sizeof(*info), info))
  2418. goto nla_put_failure;
  2419. }
  2420. nla_nest_end(msg, nested);
  2421. }
  2422. if (rdev->wiphy.n_vendor_events) {
  2423. const struct nl80211_vendor_cmd_info *info;
  2424. struct nlattr *nested;
  2425. nested = nla_nest_start_noflag(msg,
  2426. NL80211_ATTR_VENDOR_EVENTS);
  2427. if (!nested)
  2428. goto nla_put_failure;
  2429. for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
  2430. info = &rdev->wiphy.vendor_events[i];
  2431. if (nla_put(msg, i + 1, sizeof(*info), info))
  2432. goto nla_put_failure;
  2433. }
  2434. nla_nest_end(msg, nested);
  2435. }
  2436. state->split_start++;
  2437. break;
  2438. case 12:
  2439. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
  2440. nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
  2441. rdev->wiphy.max_num_csa_counters))
  2442. goto nla_put_failure;
  2443. if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  2444. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  2445. goto nla_put_failure;
  2446. if (rdev->wiphy.max_sched_scan_reqs &&
  2447. nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
  2448. rdev->wiphy.max_sched_scan_reqs))
  2449. goto nla_put_failure;
  2450. if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
  2451. sizeof(rdev->wiphy.ext_features),
  2452. rdev->wiphy.ext_features))
  2453. goto nla_put_failure;
  2454. if (rdev->wiphy.bss_select_support) {
  2455. struct nlattr *nested;
  2456. u32 bss_select_support = rdev->wiphy.bss_select_support;
  2457. nested = nla_nest_start_noflag(msg,
  2458. NL80211_ATTR_BSS_SELECT);
  2459. if (!nested)
  2460. goto nla_put_failure;
  2461. i = 0;
  2462. while (bss_select_support) {
  2463. if ((bss_select_support & 1) &&
  2464. nla_put_flag(msg, i))
  2465. goto nla_put_failure;
  2466. i++;
  2467. bss_select_support >>= 1;
  2468. }
  2469. nla_nest_end(msg, nested);
  2470. }
  2471. state->split_start++;
  2472. break;
  2473. case 13:
  2474. if (rdev->wiphy.num_iftype_ext_capab &&
  2475. rdev->wiphy.iftype_ext_capab) {
  2476. struct nlattr *nested_ext_capab, *nested;
  2477. nested = nla_nest_start_noflag(msg,
  2478. NL80211_ATTR_IFTYPE_EXT_CAPA);
  2479. if (!nested)
  2480. goto nla_put_failure;
  2481. for (i = state->capa_start;
  2482. i < rdev->wiphy.num_iftype_ext_capab; i++) {
  2483. const struct wiphy_iftype_ext_capab *capab;
  2484. capab = &rdev->wiphy.iftype_ext_capab[i];
  2485. nested_ext_capab = nla_nest_start_noflag(msg,
  2486. i);
  2487. if (!nested_ext_capab ||
  2488. nla_put_u32(msg, NL80211_ATTR_IFTYPE,
  2489. capab->iftype) ||
  2490. nla_put(msg, NL80211_ATTR_EXT_CAPA,
  2491. capab->extended_capabilities_len,
  2492. capab->extended_capabilities) ||
  2493. nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
  2494. capab->extended_capabilities_len,
  2495. capab->extended_capabilities_mask))
  2496. goto nla_put_failure;
  2497. if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO &&
  2498. (nla_put_u16(msg,
  2499. NL80211_ATTR_EML_CAPABILITY,
  2500. capab->eml_capabilities) ||
  2501. nla_put_u16(msg,
  2502. NL80211_ATTR_MLD_CAPA_AND_OPS,
  2503. capab->mld_capa_and_ops)))
  2504. goto nla_put_failure;
  2505. nla_nest_end(msg, nested_ext_capab);
  2506. if (state->split)
  2507. break;
  2508. }
  2509. nla_nest_end(msg, nested);
  2510. if (i < rdev->wiphy.num_iftype_ext_capab) {
  2511. state->capa_start = i + 1;
  2512. break;
  2513. }
  2514. }
  2515. if (nla_put_u32(msg, NL80211_ATTR_BANDS,
  2516. rdev->wiphy.nan_supported_bands))
  2517. goto nla_put_failure;
  2518. if (wiphy_ext_feature_isset(&rdev->wiphy,
  2519. NL80211_EXT_FEATURE_TXQS)) {
  2520. struct cfg80211_txq_stats txqstats = {};
  2521. int res;
  2522. res = rdev_get_txq_stats(rdev, NULL, &txqstats);
  2523. if (!res &&
  2524. !nl80211_put_txq_stats(msg, &txqstats,
  2525. NL80211_ATTR_TXQ_STATS))
  2526. goto nla_put_failure;
  2527. if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT,
  2528. rdev->wiphy.txq_limit))
  2529. goto nla_put_failure;
  2530. if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT,
  2531. rdev->wiphy.txq_memory_limit))
  2532. goto nla_put_failure;
  2533. if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM,
  2534. rdev->wiphy.txq_quantum))
  2535. goto nla_put_failure;
  2536. }
  2537. state->split_start++;
  2538. break;
  2539. case 14:
  2540. if (nl80211_send_pmsr_capa(rdev, msg))
  2541. goto nla_put_failure;
  2542. state->split_start++;
  2543. break;
  2544. case 15:
  2545. if (rdev->wiphy.akm_suites &&
  2546. nla_put(msg, NL80211_ATTR_AKM_SUITES,
  2547. sizeof(u32) * rdev->wiphy.n_akm_suites,
  2548. rdev->wiphy.akm_suites))
  2549. goto nla_put_failure;
  2550. if (nl80211_put_iftype_akm_suites(rdev, msg))
  2551. goto nla_put_failure;
  2552. if (nl80211_put_tid_config_support(rdev, msg))
  2553. goto nla_put_failure;
  2554. state->split_start++;
  2555. break;
  2556. case 16:
  2557. if (nl80211_put_sar_specs(rdev, msg))
  2558. goto nla_put_failure;
  2559. if (nl80211_put_mbssid_support(&rdev->wiphy, msg))
  2560. goto nla_put_failure;
  2561. if (nla_put_u16(msg, NL80211_ATTR_MAX_NUM_AKM_SUITES,
  2562. rdev->wiphy.max_num_akm_suites))
  2563. goto nla_put_failure;
  2564. if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)
  2565. nla_put_flag(msg, NL80211_ATTR_MLO_SUPPORT);
  2566. /* done */
  2567. state->split_start = 0;
  2568. break;
  2569. }
  2570. finish:
  2571. genlmsg_end(msg, hdr);
  2572. return 0;
  2573. nla_put_failure:
  2574. genlmsg_cancel(msg, hdr);
  2575. return -EMSGSIZE;
  2576. }
  2577. static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
  2578. struct netlink_callback *cb,
  2579. struct nl80211_dump_wiphy_state *state)
  2580. {
  2581. struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
  2582. int ret;
  2583. if (!tb)
  2584. return -ENOMEM;
  2585. ret = nlmsg_parse_deprecated(cb->nlh,
  2586. GENL_HDRLEN + nl80211_fam.hdrsize,
  2587. tb, nl80211_fam.maxattr,
  2588. nl80211_policy, NULL);
  2589. /* ignore parse errors for backward compatibility */
  2590. if (ret) {
  2591. ret = 0;
  2592. goto out;
  2593. }
  2594. state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
  2595. if (tb[NL80211_ATTR_WIPHY])
  2596. state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
  2597. if (tb[NL80211_ATTR_WDEV])
  2598. state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
  2599. if (tb[NL80211_ATTR_IFINDEX]) {
  2600. struct net_device *netdev;
  2601. struct cfg80211_registered_device *rdev;
  2602. int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
  2603. netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
  2604. if (!netdev) {
  2605. ret = -ENODEV;
  2606. goto out;
  2607. }
  2608. if (netdev->ieee80211_ptr) {
  2609. rdev = wiphy_to_rdev(
  2610. netdev->ieee80211_ptr->wiphy);
  2611. state->filter_wiphy = rdev->wiphy_idx;
  2612. }
  2613. }
  2614. ret = 0;
  2615. out:
  2616. kfree(tb);
  2617. return ret;
  2618. }
  2619. static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
  2620. {
  2621. int idx = 0, ret;
  2622. struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
  2623. struct cfg80211_registered_device *rdev;
  2624. rtnl_lock();
  2625. if (!state) {
  2626. state = kzalloc(sizeof(*state), GFP_KERNEL);
  2627. if (!state) {
  2628. rtnl_unlock();
  2629. return -ENOMEM;
  2630. }
  2631. state->filter_wiphy = -1;
  2632. ret = nl80211_dump_wiphy_parse(skb, cb, state);
  2633. if (ret) {
  2634. kfree(state);
  2635. rtnl_unlock();
  2636. return ret;
  2637. }
  2638. cb->args[0] = (long)state;
  2639. }
  2640. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  2641. if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
  2642. continue;
  2643. if (++idx <= state->start)
  2644. continue;
  2645. if (state->filter_wiphy != -1 &&
  2646. state->filter_wiphy != rdev->wiphy_idx)
  2647. continue;
  2648. /* attempt to fit multiple wiphy data chunks into the skb */
  2649. do {
  2650. ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
  2651. skb,
  2652. NETLINK_CB(cb->skb).portid,
  2653. cb->nlh->nlmsg_seq,
  2654. NLM_F_MULTI, state);
  2655. if (ret < 0) {
  2656. /*
  2657. * If sending the wiphy data didn't fit (ENOBUFS
  2658. * or EMSGSIZE returned), this SKB is still
  2659. * empty (so it's not too big because another
  2660. * wiphy dataset is already in the skb) and
  2661. * we've not tried to adjust the dump allocation
  2662. * yet ... then adjust the alloc size to be
  2663. * bigger, and return 1 but with the empty skb.
  2664. * This results in an empty message being RX'ed
  2665. * in userspace, but that is ignored.
  2666. *
  2667. * We can then retry with the larger buffer.
  2668. */
  2669. if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
  2670. !skb->len && !state->split &&
  2671. cb->min_dump_alloc < 4096) {
  2672. cb->min_dump_alloc = 4096;
  2673. state->split_start = 0;
  2674. rtnl_unlock();
  2675. return 1;
  2676. }
  2677. idx--;
  2678. break;
  2679. }
  2680. } while (state->split_start > 0);
  2681. break;
  2682. }
  2683. rtnl_unlock();
  2684. state->start = idx;
  2685. return skb->len;
  2686. }
  2687. static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
  2688. {
  2689. kfree((void *)cb->args[0]);
  2690. return 0;
  2691. }
  2692. static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
  2693. {
  2694. struct sk_buff *msg;
  2695. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2696. struct nl80211_dump_wiphy_state state = {};
  2697. msg = nlmsg_new(4096, GFP_KERNEL);
  2698. if (!msg)
  2699. return -ENOMEM;
  2700. if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
  2701. info->snd_portid, info->snd_seq, 0,
  2702. &state) < 0) {
  2703. nlmsg_free(msg);
  2704. return -ENOBUFS;
  2705. }
  2706. return genlmsg_reply(msg, info);
  2707. }
  2708. static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
  2709. [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
  2710. [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
  2711. [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
  2712. [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
  2713. [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
  2714. };
  2715. static int parse_txq_params(struct nlattr *tb[],
  2716. struct ieee80211_txq_params *txq_params)
  2717. {
  2718. u8 ac;
  2719. if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
  2720. !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
  2721. !tb[NL80211_TXQ_ATTR_AIFS])
  2722. return -EINVAL;
  2723. ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
  2724. txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
  2725. txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
  2726. txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
  2727. txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
  2728. if (ac >= NL80211_NUM_ACS)
  2729. return -EINVAL;
  2730. txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
  2731. return 0;
  2732. }
  2733. static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
  2734. {
  2735. /*
  2736. * You can only set the channel explicitly for some interfaces,
  2737. * most have their channel managed via their respective
  2738. * "establish a connection" command (connect, join, ...)
  2739. *
  2740. * For AP/GO and mesh mode, the channel can be set with the
  2741. * channel userspace API, but is only stored and passed to the
  2742. * low-level driver when the AP starts or the mesh is joined.
  2743. * This is for backward compatibility, userspace can also give
  2744. * the channel in the start-ap or join-mesh commands instead.
  2745. *
  2746. * Monitors are special as they are normally slaved to
  2747. * whatever else is going on, so they have their own special
  2748. * operation to set the monitor channel if possible.
  2749. */
  2750. return !wdev ||
  2751. wdev->iftype == NL80211_IFTYPE_AP ||
  2752. wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
  2753. wdev->iftype == NL80211_IFTYPE_MONITOR ||
  2754. wdev->iftype == NL80211_IFTYPE_P2P_GO;
  2755. }
  2756. static int nl80211_parse_punct_bitmap(struct cfg80211_registered_device *rdev,
  2757. struct genl_info *info,
  2758. const struct cfg80211_chan_def *chandef,
  2759. u16 *punct_bitmap)
  2760. {
  2761. if (!wiphy_ext_feature_isset(&rdev->wiphy, NL80211_EXT_FEATURE_PUNCT))
  2762. return -EINVAL;
  2763. *punct_bitmap = nla_get_u32(info->attrs[NL80211_ATTR_PUNCT_BITMAP]);
  2764. if (!cfg80211_valid_disable_subchannel_bitmap(punct_bitmap, chandef))
  2765. return -EINVAL;
  2766. return 0;
  2767. }
  2768. int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
  2769. struct genl_info *info,
  2770. struct cfg80211_chan_def *chandef)
  2771. {
  2772. struct netlink_ext_ack *extack = info->extack;
  2773. struct nlattr **attrs = info->attrs;
  2774. u32 control_freq;
  2775. if (!attrs[NL80211_ATTR_WIPHY_FREQ])
  2776. return -EINVAL;
  2777. control_freq = MHZ_TO_KHZ(
  2778. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  2779. if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
  2780. control_freq +=
  2781. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
  2782. memset(chandef, 0, sizeof(*chandef));
  2783. chandef->chan = ieee80211_get_channel_khz(&rdev->wiphy, control_freq);
  2784. chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
  2785. chandef->center_freq1 = KHZ_TO_MHZ(control_freq);
  2786. chandef->freq1_offset = control_freq % 1000;
  2787. chandef->center_freq2 = 0;
  2788. /* Primary channel not allowed */
  2789. if (!chandef->chan || chandef->chan->flags & IEEE80211_CHAN_DISABLED) {
  2790. NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ],
  2791. "Channel is disabled");
  2792. return -EINVAL;
  2793. }
  2794. if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
  2795. enum nl80211_channel_type chantype;
  2796. chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
  2797. switch (chantype) {
  2798. case NL80211_CHAN_NO_HT:
  2799. case NL80211_CHAN_HT20:
  2800. case NL80211_CHAN_HT40PLUS:
  2801. case NL80211_CHAN_HT40MINUS:
  2802. cfg80211_chandef_create(chandef, chandef->chan,
  2803. chantype);
  2804. /* user input for center_freq is incorrect */
  2805. if (attrs[NL80211_ATTR_CENTER_FREQ1] &&
  2806. chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) {
  2807. NL_SET_ERR_MSG_ATTR(extack,
  2808. attrs[NL80211_ATTR_CENTER_FREQ1],
  2809. "bad center frequency 1");
  2810. return -EINVAL;
  2811. }
  2812. /* center_freq2 must be zero */
  2813. if (attrs[NL80211_ATTR_CENTER_FREQ2] &&
  2814. nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) {
  2815. NL_SET_ERR_MSG_ATTR(extack,
  2816. attrs[NL80211_ATTR_CENTER_FREQ2],
  2817. "center frequency 2 can't be used");
  2818. return -EINVAL;
  2819. }
  2820. break;
  2821. default:
  2822. NL_SET_ERR_MSG_ATTR(extack,
  2823. attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
  2824. "invalid channel type");
  2825. return -EINVAL;
  2826. }
  2827. } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
  2828. chandef->width =
  2829. nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]);
  2830. if (chandef->chan->band == NL80211_BAND_S1GHZ) {
  2831. /* User input error for channel width doesn't match channel */
  2832. if (chandef->width != ieee80211_s1g_channel_width(chandef->chan)) {
  2833. NL_SET_ERR_MSG_ATTR(extack,
  2834. attrs[NL80211_ATTR_CHANNEL_WIDTH],
  2835. "bad channel width");
  2836. return -EINVAL;
  2837. }
  2838. }
  2839. if (attrs[NL80211_ATTR_CENTER_FREQ1]) {
  2840. chandef->center_freq1 =
  2841. nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]);
  2842. if (attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET])
  2843. chandef->freq1_offset = nla_get_u32(
  2844. attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET]);
  2845. else
  2846. chandef->freq1_offset = 0;
  2847. }
  2848. if (attrs[NL80211_ATTR_CENTER_FREQ2])
  2849. chandef->center_freq2 =
  2850. nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]);
  2851. }
  2852. if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
  2853. chandef->edmg.channels =
  2854. nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
  2855. if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
  2856. chandef->edmg.bw_config =
  2857. nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
  2858. } else {
  2859. chandef->edmg.bw_config = 0;
  2860. chandef->edmg.channels = 0;
  2861. }
  2862. if (!cfg80211_chandef_valid(chandef)) {
  2863. NL_SET_ERR_MSG(extack, "invalid channel definition");
  2864. return -EINVAL;
  2865. }
  2866. if (!cfg80211_chandef_usable(&rdev->wiphy, chandef,
  2867. IEEE80211_CHAN_DISABLED)) {
  2868. NL_SET_ERR_MSG(extack, "(extension) channel is disabled");
  2869. return -EINVAL;
  2870. }
  2871. if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
  2872. chandef->width == NL80211_CHAN_WIDTH_10) &&
  2873. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) {
  2874. NL_SET_ERR_MSG(extack, "5/10 MHz not supported");
  2875. return -EINVAL;
  2876. }
  2877. return 0;
  2878. }
  2879. static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
  2880. struct net_device *dev,
  2881. struct genl_info *info,
  2882. int _link_id)
  2883. {
  2884. struct cfg80211_chan_def chandef;
  2885. int result;
  2886. enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
  2887. struct wireless_dev *wdev = NULL;
  2888. int link_id = _link_id;
  2889. if (dev)
  2890. wdev = dev->ieee80211_ptr;
  2891. if (!nl80211_can_set_dev_channel(wdev))
  2892. return -EOPNOTSUPP;
  2893. if (wdev)
  2894. iftype = wdev->iftype;
  2895. if (link_id < 0) {
  2896. if (wdev && wdev->valid_links)
  2897. return -EINVAL;
  2898. link_id = 0;
  2899. }
  2900. result = nl80211_parse_chandef(rdev, info, &chandef);
  2901. if (result)
  2902. return result;
  2903. switch (iftype) {
  2904. case NL80211_IFTYPE_AP:
  2905. case NL80211_IFTYPE_P2P_GO:
  2906. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
  2907. iftype))
  2908. return -EINVAL;
  2909. if (wdev->links[link_id].ap.beacon_interval) {
  2910. struct ieee80211_channel *cur_chan;
  2911. if (!dev || !rdev->ops->set_ap_chanwidth ||
  2912. !(rdev->wiphy.features &
  2913. NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE))
  2914. return -EBUSY;
  2915. /* Only allow dynamic channel width changes */
  2916. cur_chan = wdev->links[link_id].ap.chandef.chan;
  2917. if (chandef.chan != cur_chan)
  2918. return -EBUSY;
  2919. result = rdev_set_ap_chanwidth(rdev, dev, link_id,
  2920. &chandef);
  2921. if (result)
  2922. return result;
  2923. wdev->links[link_id].ap.chandef = chandef;
  2924. } else {
  2925. wdev->u.ap.preset_chandef = chandef;
  2926. }
  2927. return 0;
  2928. case NL80211_IFTYPE_MESH_POINT:
  2929. return cfg80211_set_mesh_channel(rdev, wdev, &chandef);
  2930. case NL80211_IFTYPE_MONITOR:
  2931. return cfg80211_set_monitor_channel(rdev, &chandef);
  2932. default:
  2933. break;
  2934. }
  2935. return -EINVAL;
  2936. }
  2937. static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
  2938. {
  2939. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2940. int link_id = nl80211_link_id_or_invalid(info->attrs);
  2941. struct net_device *netdev = info->user_ptr[1];
  2942. int ret;
  2943. wdev_lock(netdev->ieee80211_ptr);
  2944. ret = __nl80211_set_channel(rdev, netdev, info, link_id);
  2945. wdev_unlock(netdev->ieee80211_ptr);
  2946. return ret;
  2947. }
  2948. static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
  2949. {
  2950. struct cfg80211_registered_device *rdev = NULL;
  2951. struct net_device *netdev = NULL;
  2952. struct wireless_dev *wdev;
  2953. int result = 0, rem_txq_params = 0;
  2954. struct nlattr *nl_txq_params;
  2955. u32 changed;
  2956. u8 retry_short = 0, retry_long = 0;
  2957. u32 frag_threshold = 0, rts_threshold = 0;
  2958. u8 coverage_class = 0;
  2959. u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0;
  2960. rtnl_lock();
  2961. /*
  2962. * Try to find the wiphy and netdev. Normally this
  2963. * function shouldn't need the netdev, but this is
  2964. * done for backward compatibility -- previously
  2965. * setting the channel was done per wiphy, but now
  2966. * it is per netdev. Previous userland like hostapd
  2967. * also passed a netdev to set_wiphy, so that it is
  2968. * possible to let that go to the right netdev!
  2969. */
  2970. if (info->attrs[NL80211_ATTR_IFINDEX]) {
  2971. int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
  2972. netdev = __dev_get_by_index(genl_info_net(info), ifindex);
  2973. if (netdev && netdev->ieee80211_ptr)
  2974. rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
  2975. else
  2976. netdev = NULL;
  2977. }
  2978. if (!netdev) {
  2979. rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
  2980. info->attrs);
  2981. if (IS_ERR(rdev)) {
  2982. rtnl_unlock();
  2983. return PTR_ERR(rdev);
  2984. }
  2985. wdev = NULL;
  2986. netdev = NULL;
  2987. result = 0;
  2988. } else
  2989. wdev = netdev->ieee80211_ptr;
  2990. wiphy_lock(&rdev->wiphy);
  2991. /*
  2992. * end workaround code, by now the rdev is available
  2993. * and locked, and wdev may or may not be NULL.
  2994. */
  2995. if (info->attrs[NL80211_ATTR_WIPHY_NAME])
  2996. result = cfg80211_dev_rename(
  2997. rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
  2998. rtnl_unlock();
  2999. if (result)
  3000. goto out;
  3001. if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
  3002. struct ieee80211_txq_params txq_params;
  3003. struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
  3004. if (!rdev->ops->set_txq_params) {
  3005. result = -EOPNOTSUPP;
  3006. goto out;
  3007. }
  3008. if (!netdev) {
  3009. result = -EINVAL;
  3010. goto out;
  3011. }
  3012. if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3013. netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  3014. result = -EINVAL;
  3015. goto out;
  3016. }
  3017. if (!netif_running(netdev)) {
  3018. result = -ENETDOWN;
  3019. goto out;
  3020. }
  3021. nla_for_each_nested(nl_txq_params,
  3022. info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
  3023. rem_txq_params) {
  3024. result = nla_parse_nested_deprecated(tb,
  3025. NL80211_TXQ_ATTR_MAX,
  3026. nl_txq_params,
  3027. txq_params_policy,
  3028. info->extack);
  3029. if (result)
  3030. goto out;
  3031. result = parse_txq_params(tb, &txq_params);
  3032. if (result)
  3033. goto out;
  3034. txq_params.link_id =
  3035. nl80211_link_id_or_invalid(info->attrs);
  3036. wdev_lock(netdev->ieee80211_ptr);
  3037. if (txq_params.link_id >= 0 &&
  3038. !(netdev->ieee80211_ptr->valid_links &
  3039. BIT(txq_params.link_id)))
  3040. result = -ENOLINK;
  3041. else if (txq_params.link_id >= 0 &&
  3042. !netdev->ieee80211_ptr->valid_links)
  3043. result = -EINVAL;
  3044. else
  3045. result = rdev_set_txq_params(rdev, netdev,
  3046. &txq_params);
  3047. wdev_unlock(netdev->ieee80211_ptr);
  3048. if (result)
  3049. goto out;
  3050. }
  3051. }
  3052. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  3053. int link_id = nl80211_link_id_or_invalid(info->attrs);
  3054. if (wdev) {
  3055. wdev_lock(wdev);
  3056. result = __nl80211_set_channel(
  3057. rdev,
  3058. nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
  3059. info, link_id);
  3060. wdev_unlock(wdev);
  3061. } else {
  3062. result = __nl80211_set_channel(rdev, netdev, info, link_id);
  3063. }
  3064. if (result)
  3065. goto out;
  3066. }
  3067. if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
  3068. struct wireless_dev *txp_wdev = wdev;
  3069. enum nl80211_tx_power_setting type;
  3070. int idx, mbm = 0;
  3071. if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
  3072. txp_wdev = NULL;
  3073. if (!rdev->ops->set_tx_power) {
  3074. result = -EOPNOTSUPP;
  3075. goto out;
  3076. }
  3077. idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
  3078. type = nla_get_u32(info->attrs[idx]);
  3079. if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
  3080. (type != NL80211_TX_POWER_AUTOMATIC)) {
  3081. result = -EINVAL;
  3082. goto out;
  3083. }
  3084. if (type != NL80211_TX_POWER_AUTOMATIC) {
  3085. idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
  3086. mbm = nla_get_u32(info->attrs[idx]);
  3087. }
  3088. result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
  3089. if (result)
  3090. goto out;
  3091. }
  3092. if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
  3093. info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
  3094. u32 tx_ant, rx_ant;
  3095. if ((!rdev->wiphy.available_antennas_tx &&
  3096. !rdev->wiphy.available_antennas_rx) ||
  3097. !rdev->ops->set_antenna) {
  3098. result = -EOPNOTSUPP;
  3099. goto out;
  3100. }
  3101. tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
  3102. rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
  3103. /* reject antenna configurations which don't match the
  3104. * available antenna masks, except for the "all" mask */
  3105. if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
  3106. (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) {
  3107. result = -EINVAL;
  3108. goto out;
  3109. }
  3110. tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
  3111. rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
  3112. result = rdev_set_antenna(rdev, tx_ant, rx_ant);
  3113. if (result)
  3114. goto out;
  3115. }
  3116. changed = 0;
  3117. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
  3118. retry_short = nla_get_u8(
  3119. info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
  3120. changed |= WIPHY_PARAM_RETRY_SHORT;
  3121. }
  3122. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
  3123. retry_long = nla_get_u8(
  3124. info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
  3125. changed |= WIPHY_PARAM_RETRY_LONG;
  3126. }
  3127. if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
  3128. frag_threshold = nla_get_u32(
  3129. info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
  3130. if (frag_threshold < 256) {
  3131. result = -EINVAL;
  3132. goto out;
  3133. }
  3134. if (frag_threshold != (u32) -1) {
  3135. /*
  3136. * Fragments (apart from the last one) are required to
  3137. * have even length. Make the fragmentation code
  3138. * simpler by stripping LSB should someone try to use
  3139. * odd threshold value.
  3140. */
  3141. frag_threshold &= ~0x1;
  3142. }
  3143. changed |= WIPHY_PARAM_FRAG_THRESHOLD;
  3144. }
  3145. if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
  3146. rts_threshold = nla_get_u32(
  3147. info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
  3148. changed |= WIPHY_PARAM_RTS_THRESHOLD;
  3149. }
  3150. if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
  3151. if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
  3152. result = -EINVAL;
  3153. goto out;
  3154. }
  3155. coverage_class = nla_get_u8(
  3156. info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
  3157. changed |= WIPHY_PARAM_COVERAGE_CLASS;
  3158. }
  3159. if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
  3160. if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) {
  3161. result = -EOPNOTSUPP;
  3162. goto out;
  3163. }
  3164. changed |= WIPHY_PARAM_DYN_ACK;
  3165. }
  3166. if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) {
  3167. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  3168. NL80211_EXT_FEATURE_TXQS)) {
  3169. result = -EOPNOTSUPP;
  3170. goto out;
  3171. }
  3172. txq_limit = nla_get_u32(
  3173. info->attrs[NL80211_ATTR_TXQ_LIMIT]);
  3174. changed |= WIPHY_PARAM_TXQ_LIMIT;
  3175. }
  3176. if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) {
  3177. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  3178. NL80211_EXT_FEATURE_TXQS)) {
  3179. result = -EOPNOTSUPP;
  3180. goto out;
  3181. }
  3182. txq_memory_limit = nla_get_u32(
  3183. info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]);
  3184. changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT;
  3185. }
  3186. if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) {
  3187. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  3188. NL80211_EXT_FEATURE_TXQS)) {
  3189. result = -EOPNOTSUPP;
  3190. goto out;
  3191. }
  3192. txq_quantum = nla_get_u32(
  3193. info->attrs[NL80211_ATTR_TXQ_QUANTUM]);
  3194. changed |= WIPHY_PARAM_TXQ_QUANTUM;
  3195. }
  3196. if (changed) {
  3197. u8 old_retry_short, old_retry_long;
  3198. u32 old_frag_threshold, old_rts_threshold;
  3199. u8 old_coverage_class;
  3200. u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum;
  3201. if (!rdev->ops->set_wiphy_params) {
  3202. result = -EOPNOTSUPP;
  3203. goto out;
  3204. }
  3205. old_retry_short = rdev->wiphy.retry_short;
  3206. old_retry_long = rdev->wiphy.retry_long;
  3207. old_frag_threshold = rdev->wiphy.frag_threshold;
  3208. old_rts_threshold = rdev->wiphy.rts_threshold;
  3209. old_coverage_class = rdev->wiphy.coverage_class;
  3210. old_txq_limit = rdev->wiphy.txq_limit;
  3211. old_txq_memory_limit = rdev->wiphy.txq_memory_limit;
  3212. old_txq_quantum = rdev->wiphy.txq_quantum;
  3213. if (changed & WIPHY_PARAM_RETRY_SHORT)
  3214. rdev->wiphy.retry_short = retry_short;
  3215. if (changed & WIPHY_PARAM_RETRY_LONG)
  3216. rdev->wiphy.retry_long = retry_long;
  3217. if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
  3218. rdev->wiphy.frag_threshold = frag_threshold;
  3219. if (changed & WIPHY_PARAM_RTS_THRESHOLD)
  3220. rdev->wiphy.rts_threshold = rts_threshold;
  3221. if (changed & WIPHY_PARAM_COVERAGE_CLASS)
  3222. rdev->wiphy.coverage_class = coverage_class;
  3223. if (changed & WIPHY_PARAM_TXQ_LIMIT)
  3224. rdev->wiphy.txq_limit = txq_limit;
  3225. if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT)
  3226. rdev->wiphy.txq_memory_limit = txq_memory_limit;
  3227. if (changed & WIPHY_PARAM_TXQ_QUANTUM)
  3228. rdev->wiphy.txq_quantum = txq_quantum;
  3229. result = rdev_set_wiphy_params(rdev, changed);
  3230. if (result) {
  3231. rdev->wiphy.retry_short = old_retry_short;
  3232. rdev->wiphy.retry_long = old_retry_long;
  3233. rdev->wiphy.frag_threshold = old_frag_threshold;
  3234. rdev->wiphy.rts_threshold = old_rts_threshold;
  3235. rdev->wiphy.coverage_class = old_coverage_class;
  3236. rdev->wiphy.txq_limit = old_txq_limit;
  3237. rdev->wiphy.txq_memory_limit = old_txq_memory_limit;
  3238. rdev->wiphy.txq_quantum = old_txq_quantum;
  3239. goto out;
  3240. }
  3241. }
  3242. result = 0;
  3243. out:
  3244. wiphy_unlock(&rdev->wiphy);
  3245. return result;
  3246. }
  3247. static int nl80211_send_chandef(struct sk_buff *msg,
  3248. const struct cfg80211_chan_def *chandef)
  3249. {
  3250. if (WARN_ON(!cfg80211_chandef_valid(chandef)))
  3251. return -EINVAL;
  3252. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
  3253. chandef->chan->center_freq))
  3254. return -ENOBUFS;
  3255. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET,
  3256. chandef->chan->freq_offset))
  3257. return -ENOBUFS;
  3258. switch (chandef->width) {
  3259. case NL80211_CHAN_WIDTH_20_NOHT:
  3260. case NL80211_CHAN_WIDTH_20:
  3261. case NL80211_CHAN_WIDTH_40:
  3262. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
  3263. cfg80211_get_chandef_type(chandef)))
  3264. return -ENOBUFS;
  3265. break;
  3266. default:
  3267. break;
  3268. }
  3269. if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
  3270. return -ENOBUFS;
  3271. if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
  3272. return -ENOBUFS;
  3273. if (chandef->center_freq2 &&
  3274. nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
  3275. return -ENOBUFS;
  3276. return 0;
  3277. }
  3278. static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
  3279. struct cfg80211_registered_device *rdev,
  3280. struct wireless_dev *wdev,
  3281. enum nl80211_commands cmd)
  3282. {
  3283. struct net_device *dev = wdev->netdev;
  3284. void *hdr;
  3285. WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
  3286. cmd != NL80211_CMD_DEL_INTERFACE &&
  3287. cmd != NL80211_CMD_SET_INTERFACE);
  3288. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  3289. if (!hdr)
  3290. return -1;
  3291. if (dev &&
  3292. (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  3293. nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
  3294. goto nla_put_failure;
  3295. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  3296. nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
  3297. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  3298. NL80211_ATTR_PAD) ||
  3299. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
  3300. nla_put_u32(msg, NL80211_ATTR_GENERATION,
  3301. rdev->devlist_generation ^
  3302. (cfg80211_rdev_list_generation << 2)) ||
  3303. nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr))
  3304. goto nla_put_failure;
  3305. if (rdev->ops->get_channel && !wdev->valid_links) {
  3306. struct cfg80211_chan_def chandef = {};
  3307. int ret;
  3308. ret = rdev_get_channel(rdev, wdev, 0, &chandef);
  3309. if (ret == 0 && nl80211_send_chandef(msg, &chandef))
  3310. goto nla_put_failure;
  3311. }
  3312. if (rdev->ops->get_tx_power) {
  3313. int dbm, ret;
  3314. ret = rdev_get_tx_power(rdev, wdev, &dbm);
  3315. if (ret == 0 &&
  3316. nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
  3317. DBM_TO_MBM(dbm)))
  3318. goto nla_put_failure;
  3319. }
  3320. wdev_lock(wdev);
  3321. switch (wdev->iftype) {
  3322. case NL80211_IFTYPE_AP:
  3323. case NL80211_IFTYPE_P2P_GO:
  3324. if (wdev->u.ap.ssid_len &&
  3325. nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len,
  3326. wdev->u.ap.ssid))
  3327. goto nla_put_failure_locked;
  3328. break;
  3329. case NL80211_IFTYPE_STATION:
  3330. case NL80211_IFTYPE_P2P_CLIENT:
  3331. if (wdev->u.client.ssid_len &&
  3332. nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len,
  3333. wdev->u.client.ssid))
  3334. goto nla_put_failure_locked;
  3335. break;
  3336. case NL80211_IFTYPE_ADHOC:
  3337. if (wdev->u.ibss.ssid_len &&
  3338. nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len,
  3339. wdev->u.ibss.ssid))
  3340. goto nla_put_failure_locked;
  3341. break;
  3342. default:
  3343. /* nothing */
  3344. break;
  3345. }
  3346. wdev_unlock(wdev);
  3347. if (rdev->ops->get_txq_stats) {
  3348. struct cfg80211_txq_stats txqstats = {};
  3349. int ret = rdev_get_txq_stats(rdev, wdev, &txqstats);
  3350. if (ret == 0 &&
  3351. !nl80211_put_txq_stats(msg, &txqstats,
  3352. NL80211_ATTR_TXQ_STATS))
  3353. goto nla_put_failure;
  3354. }
  3355. if (wdev->valid_links) {
  3356. unsigned int link_id;
  3357. struct nlattr *links = nla_nest_start(msg,
  3358. NL80211_ATTR_MLO_LINKS);
  3359. if (!links)
  3360. goto nla_put_failure;
  3361. for_each_valid_link(wdev, link_id) {
  3362. struct nlattr *link = nla_nest_start(msg, link_id + 1);
  3363. struct cfg80211_chan_def chandef = {};
  3364. int ret;
  3365. if (!link)
  3366. goto nla_put_failure;
  3367. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
  3368. goto nla_put_failure;
  3369. if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
  3370. wdev->links[link_id].addr))
  3371. goto nla_put_failure;
  3372. ret = rdev_get_channel(rdev, wdev, link_id, &chandef);
  3373. if (ret == 0 && nl80211_send_chandef(msg, &chandef))
  3374. goto nla_put_failure;
  3375. nla_nest_end(msg, link);
  3376. }
  3377. nla_nest_end(msg, links);
  3378. }
  3379. genlmsg_end(msg, hdr);
  3380. return 0;
  3381. nla_put_failure_locked:
  3382. wdev_unlock(wdev);
  3383. nla_put_failure:
  3384. genlmsg_cancel(msg, hdr);
  3385. return -EMSGSIZE;
  3386. }
  3387. static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
  3388. {
  3389. int wp_idx = 0;
  3390. int if_idx = 0;
  3391. int wp_start = cb->args[0];
  3392. int if_start = cb->args[1];
  3393. int filter_wiphy = -1;
  3394. struct cfg80211_registered_device *rdev;
  3395. struct wireless_dev *wdev;
  3396. int ret;
  3397. rtnl_lock();
  3398. if (!cb->args[2]) {
  3399. struct nl80211_dump_wiphy_state state = {
  3400. .filter_wiphy = -1,
  3401. };
  3402. ret = nl80211_dump_wiphy_parse(skb, cb, &state);
  3403. if (ret)
  3404. goto out_unlock;
  3405. filter_wiphy = state.filter_wiphy;
  3406. /*
  3407. * if filtering, set cb->args[2] to +1 since 0 is the default
  3408. * value needed to determine that parsing is necessary.
  3409. */
  3410. if (filter_wiphy >= 0)
  3411. cb->args[2] = filter_wiphy + 1;
  3412. else
  3413. cb->args[2] = -1;
  3414. } else if (cb->args[2] > 0) {
  3415. filter_wiphy = cb->args[2] - 1;
  3416. }
  3417. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  3418. if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
  3419. continue;
  3420. if (wp_idx < wp_start) {
  3421. wp_idx++;
  3422. continue;
  3423. }
  3424. if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
  3425. continue;
  3426. if_idx = 0;
  3427. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  3428. if (if_idx < if_start) {
  3429. if_idx++;
  3430. continue;
  3431. }
  3432. if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
  3433. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  3434. rdev, wdev,
  3435. NL80211_CMD_NEW_INTERFACE) < 0) {
  3436. goto out;
  3437. }
  3438. if_idx++;
  3439. }
  3440. wp_idx++;
  3441. }
  3442. out:
  3443. cb->args[0] = wp_idx;
  3444. cb->args[1] = if_idx;
  3445. ret = skb->len;
  3446. out_unlock:
  3447. rtnl_unlock();
  3448. return ret;
  3449. }
  3450. static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
  3451. {
  3452. struct sk_buff *msg;
  3453. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3454. struct wireless_dev *wdev = info->user_ptr[1];
  3455. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3456. if (!msg)
  3457. return -ENOMEM;
  3458. if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  3459. rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
  3460. nlmsg_free(msg);
  3461. return -ENOBUFS;
  3462. }
  3463. return genlmsg_reply(msg, info);
  3464. }
  3465. static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
  3466. [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
  3467. [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
  3468. [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
  3469. [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
  3470. [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
  3471. [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
  3472. };
  3473. static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
  3474. {
  3475. struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
  3476. int flag;
  3477. *mntrflags = 0;
  3478. if (!nla)
  3479. return -EINVAL;
  3480. if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL))
  3481. return -EINVAL;
  3482. for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
  3483. if (flags[flag])
  3484. *mntrflags |= (1<<flag);
  3485. *mntrflags |= MONITOR_FLAG_CHANGED;
  3486. return 0;
  3487. }
  3488. static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
  3489. enum nl80211_iftype type,
  3490. struct genl_info *info,
  3491. struct vif_params *params)
  3492. {
  3493. bool change = false;
  3494. int err;
  3495. if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
  3496. if (type != NL80211_IFTYPE_MONITOR)
  3497. return -EINVAL;
  3498. err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
  3499. &params->flags);
  3500. if (err)
  3501. return err;
  3502. change = true;
  3503. }
  3504. if (params->flags & MONITOR_FLAG_ACTIVE &&
  3505. !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
  3506. return -EOPNOTSUPP;
  3507. if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
  3508. const u8 *mumimo_groups;
  3509. u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
  3510. if (type != NL80211_IFTYPE_MONITOR)
  3511. return -EINVAL;
  3512. if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
  3513. return -EOPNOTSUPP;
  3514. mumimo_groups =
  3515. nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
  3516. /* bits 0 and 63 are reserved and must be zero */
  3517. if ((mumimo_groups[0] & BIT(0)) ||
  3518. (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
  3519. return -EINVAL;
  3520. params->vht_mumimo_groups = mumimo_groups;
  3521. change = true;
  3522. }
  3523. if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
  3524. u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
  3525. if (type != NL80211_IFTYPE_MONITOR)
  3526. return -EINVAL;
  3527. if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
  3528. return -EOPNOTSUPP;
  3529. params->vht_mumimo_follow_addr =
  3530. nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
  3531. change = true;
  3532. }
  3533. return change ? 1 : 0;
  3534. }
  3535. static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
  3536. struct net_device *netdev, u8 use_4addr,
  3537. enum nl80211_iftype iftype)
  3538. {
  3539. if (!use_4addr) {
  3540. if (netdev && netif_is_bridge_port(netdev))
  3541. return -EBUSY;
  3542. return 0;
  3543. }
  3544. switch (iftype) {
  3545. case NL80211_IFTYPE_AP_VLAN:
  3546. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
  3547. return 0;
  3548. break;
  3549. case NL80211_IFTYPE_STATION:
  3550. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
  3551. return 0;
  3552. break;
  3553. default:
  3554. break;
  3555. }
  3556. return -EOPNOTSUPP;
  3557. }
  3558. static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
  3559. {
  3560. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3561. struct vif_params params;
  3562. int err;
  3563. enum nl80211_iftype otype, ntype;
  3564. struct net_device *dev = info->user_ptr[1];
  3565. bool change = false;
  3566. memset(&params, 0, sizeof(params));
  3567. otype = ntype = dev->ieee80211_ptr->iftype;
  3568. if (info->attrs[NL80211_ATTR_IFTYPE]) {
  3569. ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  3570. if (otype != ntype)
  3571. change = true;
  3572. }
  3573. if (info->attrs[NL80211_ATTR_MESH_ID]) {
  3574. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3575. if (ntype != NL80211_IFTYPE_MESH_POINT)
  3576. return -EINVAL;
  3577. if (netif_running(dev))
  3578. return -EBUSY;
  3579. wdev_lock(wdev);
  3580. BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
  3581. IEEE80211_MAX_MESH_ID_LEN);
  3582. wdev->u.mesh.id_up_len =
  3583. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  3584. memcpy(wdev->u.mesh.id,
  3585. nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  3586. wdev->u.mesh.id_up_len);
  3587. wdev_unlock(wdev);
  3588. }
  3589. if (info->attrs[NL80211_ATTR_4ADDR]) {
  3590. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  3591. change = true;
  3592. err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
  3593. if (err)
  3594. return err;
  3595. } else {
  3596. params.use_4addr = -1;
  3597. }
  3598. err = nl80211_parse_mon_options(rdev, ntype, info, &params);
  3599. if (err < 0)
  3600. return err;
  3601. if (err > 0)
  3602. change = true;
  3603. if (change)
  3604. err = cfg80211_change_iface(rdev, dev, ntype, &params);
  3605. else
  3606. err = 0;
  3607. if (!err && params.use_4addr != -1)
  3608. dev->ieee80211_ptr->use_4addr = params.use_4addr;
  3609. if (change && !err) {
  3610. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3611. nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE);
  3612. }
  3613. return err;
  3614. }
  3615. static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
  3616. {
  3617. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3618. struct vif_params params;
  3619. struct wireless_dev *wdev;
  3620. struct sk_buff *msg;
  3621. int err;
  3622. enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
  3623. memset(&params, 0, sizeof(params));
  3624. if (!info->attrs[NL80211_ATTR_IFNAME])
  3625. return -EINVAL;
  3626. if (info->attrs[NL80211_ATTR_IFTYPE])
  3627. type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  3628. if (!rdev->ops->add_virtual_intf)
  3629. return -EOPNOTSUPP;
  3630. if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
  3631. rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
  3632. info->attrs[NL80211_ATTR_MAC]) {
  3633. nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
  3634. ETH_ALEN);
  3635. if (!is_valid_ether_addr(params.macaddr))
  3636. return -EADDRNOTAVAIL;
  3637. }
  3638. if (info->attrs[NL80211_ATTR_4ADDR]) {
  3639. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  3640. err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
  3641. if (err)
  3642. return err;
  3643. }
  3644. if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0))
  3645. return -EOPNOTSUPP;
  3646. err = nl80211_parse_mon_options(rdev, type, info, &params);
  3647. if (err < 0)
  3648. return err;
  3649. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3650. if (!msg)
  3651. return -ENOMEM;
  3652. wdev = rdev_add_virtual_intf(rdev,
  3653. nla_data(info->attrs[NL80211_ATTR_IFNAME]),
  3654. NET_NAME_USER, type, &params);
  3655. if (WARN_ON(!wdev)) {
  3656. nlmsg_free(msg);
  3657. return -EPROTO;
  3658. } else if (IS_ERR(wdev)) {
  3659. nlmsg_free(msg);
  3660. return PTR_ERR(wdev);
  3661. }
  3662. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  3663. wdev->owner_nlportid = info->snd_portid;
  3664. switch (type) {
  3665. case NL80211_IFTYPE_MESH_POINT:
  3666. if (!info->attrs[NL80211_ATTR_MESH_ID])
  3667. break;
  3668. wdev_lock(wdev);
  3669. BUILD_BUG_ON(IEEE80211_MAX_SSID_LEN !=
  3670. IEEE80211_MAX_MESH_ID_LEN);
  3671. wdev->u.mesh.id_up_len =
  3672. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  3673. memcpy(wdev->u.mesh.id,
  3674. nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  3675. wdev->u.mesh.id_up_len);
  3676. wdev_unlock(wdev);
  3677. break;
  3678. case NL80211_IFTYPE_NAN:
  3679. case NL80211_IFTYPE_P2P_DEVICE:
  3680. /*
  3681. * P2P Device and NAN do not have a netdev, so don't go
  3682. * through the netdev notifier and must be added here
  3683. */
  3684. cfg80211_init_wdev(wdev);
  3685. cfg80211_register_wdev(rdev, wdev);
  3686. break;
  3687. default:
  3688. break;
  3689. }
  3690. if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  3691. rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
  3692. nlmsg_free(msg);
  3693. return -ENOBUFS;
  3694. }
  3695. return genlmsg_reply(msg, info);
  3696. }
  3697. static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
  3698. {
  3699. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3700. int ret;
  3701. /* to avoid failing a new interface creation due to pending removal */
  3702. cfg80211_destroy_ifaces(rdev);
  3703. wiphy_lock(&rdev->wiphy);
  3704. ret = _nl80211_new_interface(skb, info);
  3705. wiphy_unlock(&rdev->wiphy);
  3706. return ret;
  3707. }
  3708. static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
  3709. {
  3710. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3711. struct wireless_dev *wdev = info->user_ptr[1];
  3712. if (!rdev->ops->del_virtual_intf)
  3713. return -EOPNOTSUPP;
  3714. /*
  3715. * We hold RTNL, so this is safe, without RTNL opencount cannot
  3716. * reach 0, and thus the rdev cannot be deleted.
  3717. *
  3718. * We need to do it for the dev_close(), since that will call
  3719. * the netdev notifiers, and we need to acquire the mutex there
  3720. * but don't know if we get there from here or from some other
  3721. * place (e.g. "ip link set ... down").
  3722. */
  3723. mutex_unlock(&rdev->wiphy.mtx);
  3724. /*
  3725. * If we remove a wireless device without a netdev then clear
  3726. * user_ptr[1] so that nl80211_post_doit won't dereference it
  3727. * to check if it needs to do dev_put(). Otherwise it crashes
  3728. * since the wdev has been freed, unlike with a netdev where
  3729. * we need the dev_put() for the netdev to really be freed.
  3730. */
  3731. if (!wdev->netdev)
  3732. info->user_ptr[1] = NULL;
  3733. else
  3734. dev_close(wdev->netdev);
  3735. mutex_lock(&rdev->wiphy.mtx);
  3736. return cfg80211_remove_virtual_intf(rdev, wdev);
  3737. }
  3738. static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
  3739. {
  3740. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3741. struct net_device *dev = info->user_ptr[1];
  3742. u16 noack_map;
  3743. if (!info->attrs[NL80211_ATTR_NOACK_MAP])
  3744. return -EINVAL;
  3745. if (!rdev->ops->set_noack_map)
  3746. return -EOPNOTSUPP;
  3747. noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
  3748. return rdev_set_noack_map(rdev, dev, noack_map);
  3749. }
  3750. static int nl80211_validate_key_link_id(struct genl_info *info,
  3751. struct wireless_dev *wdev,
  3752. int link_id, bool pairwise)
  3753. {
  3754. if (pairwise) {
  3755. if (link_id != -1) {
  3756. GENL_SET_ERR_MSG(info,
  3757. "link ID not allowed for pairwise key");
  3758. return -EINVAL;
  3759. }
  3760. return 0;
  3761. }
  3762. if (wdev->valid_links) {
  3763. if (link_id == -1) {
  3764. GENL_SET_ERR_MSG(info,
  3765. "link ID must for MLO group key");
  3766. return -EINVAL;
  3767. }
  3768. if (!(wdev->valid_links & BIT(link_id))) {
  3769. GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key");
  3770. return -EINVAL;
  3771. }
  3772. } else if (link_id != -1) {
  3773. GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key");
  3774. return -EINVAL;
  3775. }
  3776. return 0;
  3777. }
  3778. struct get_key_cookie {
  3779. struct sk_buff *msg;
  3780. int error;
  3781. int idx;
  3782. };
  3783. static void get_key_callback(void *c, struct key_params *params)
  3784. {
  3785. struct nlattr *key;
  3786. struct get_key_cookie *cookie = c;
  3787. if ((params->key &&
  3788. nla_put(cookie->msg, NL80211_ATTR_KEY_DATA,
  3789. params->key_len, params->key)) ||
  3790. (params->seq &&
  3791. nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
  3792. params->seq_len, params->seq)) ||
  3793. (params->cipher &&
  3794. nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
  3795. params->cipher)))
  3796. goto nla_put_failure;
  3797. key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY);
  3798. if (!key)
  3799. goto nla_put_failure;
  3800. if ((params->key &&
  3801. nla_put(cookie->msg, NL80211_KEY_DATA,
  3802. params->key_len, params->key)) ||
  3803. (params->seq &&
  3804. nla_put(cookie->msg, NL80211_KEY_SEQ,
  3805. params->seq_len, params->seq)) ||
  3806. (params->cipher &&
  3807. nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
  3808. params->cipher)))
  3809. goto nla_put_failure;
  3810. if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx))
  3811. goto nla_put_failure;
  3812. nla_nest_end(cookie->msg, key);
  3813. return;
  3814. nla_put_failure:
  3815. cookie->error = 1;
  3816. }
  3817. static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
  3818. {
  3819. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3820. int err;
  3821. struct net_device *dev = info->user_ptr[1];
  3822. u8 key_idx = 0;
  3823. const u8 *mac_addr = NULL;
  3824. bool pairwise;
  3825. struct get_key_cookie cookie = {
  3826. .error = 0,
  3827. };
  3828. void *hdr;
  3829. struct sk_buff *msg;
  3830. bool bigtk_support = false;
  3831. int link_id = nl80211_link_id_or_invalid(info->attrs);
  3832. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3833. if (wiphy_ext_feature_isset(&rdev->wiphy,
  3834. NL80211_EXT_FEATURE_BEACON_PROTECTION))
  3835. bigtk_support = true;
  3836. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  3837. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
  3838. wiphy_ext_feature_isset(&rdev->wiphy,
  3839. NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT))
  3840. bigtk_support = true;
  3841. if (info->attrs[NL80211_ATTR_KEY_IDX]) {
  3842. key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  3843. if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) {
  3844. GENL_SET_ERR_MSG(info, "BIGTK not supported");
  3845. return -EINVAL;
  3846. }
  3847. }
  3848. if (info->attrs[NL80211_ATTR_MAC])
  3849. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3850. pairwise = !!mac_addr;
  3851. if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
  3852. u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  3853. if (kt != NL80211_KEYTYPE_GROUP &&
  3854. kt != NL80211_KEYTYPE_PAIRWISE)
  3855. return -EINVAL;
  3856. pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
  3857. }
  3858. if (!rdev->ops->get_key)
  3859. return -EOPNOTSUPP;
  3860. if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  3861. return -ENOENT;
  3862. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3863. if (!msg)
  3864. return -ENOMEM;
  3865. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  3866. NL80211_CMD_NEW_KEY);
  3867. if (!hdr)
  3868. goto nla_put_failure;
  3869. cookie.msg = msg;
  3870. cookie.idx = key_idx;
  3871. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  3872. nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
  3873. goto nla_put_failure;
  3874. if (mac_addr &&
  3875. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
  3876. goto nla_put_failure;
  3877. err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise);
  3878. if (err)
  3879. goto free_msg;
  3880. err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr,
  3881. &cookie, get_key_callback);
  3882. if (err)
  3883. goto free_msg;
  3884. if (cookie.error)
  3885. goto nla_put_failure;
  3886. genlmsg_end(msg, hdr);
  3887. return genlmsg_reply(msg, info);
  3888. nla_put_failure:
  3889. err = -ENOBUFS;
  3890. free_msg:
  3891. nlmsg_free(msg);
  3892. return err;
  3893. }
  3894. static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
  3895. {
  3896. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3897. struct key_parse key;
  3898. int err;
  3899. struct net_device *dev = info->user_ptr[1];
  3900. int link_id = nl80211_link_id_or_invalid(info->attrs);
  3901. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3902. err = nl80211_parse_key(info, &key);
  3903. if (err)
  3904. return err;
  3905. if (key.idx < 0)
  3906. return -EINVAL;
  3907. /* Only support setting default key and
  3908. * Extended Key ID action NL80211_KEY_SET_TX.
  3909. */
  3910. if (!key.def && !key.defmgmt && !key.defbeacon &&
  3911. !(key.p.mode == NL80211_KEY_SET_TX))
  3912. return -EINVAL;
  3913. wdev_lock(wdev);
  3914. if (key.def) {
  3915. if (!rdev->ops->set_default_key) {
  3916. err = -EOPNOTSUPP;
  3917. goto out;
  3918. }
  3919. err = nl80211_key_allowed(wdev);
  3920. if (err)
  3921. goto out;
  3922. err = nl80211_validate_key_link_id(info, wdev, link_id, false);
  3923. if (err)
  3924. goto out;
  3925. err = rdev_set_default_key(rdev, dev, link_id, key.idx,
  3926. key.def_uni, key.def_multi);
  3927. if (err)
  3928. goto out;
  3929. #ifdef CONFIG_CFG80211_WEXT
  3930. wdev->wext.default_key = key.idx;
  3931. #endif
  3932. } else if (key.defmgmt) {
  3933. if (key.def_uni || !key.def_multi) {
  3934. err = -EINVAL;
  3935. goto out;
  3936. }
  3937. if (!rdev->ops->set_default_mgmt_key) {
  3938. err = -EOPNOTSUPP;
  3939. goto out;
  3940. }
  3941. err = nl80211_key_allowed(wdev);
  3942. if (err)
  3943. goto out;
  3944. err = nl80211_validate_key_link_id(info, wdev, link_id, false);
  3945. if (err)
  3946. goto out;
  3947. err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx);
  3948. if (err)
  3949. goto out;
  3950. #ifdef CONFIG_CFG80211_WEXT
  3951. wdev->wext.default_mgmt_key = key.idx;
  3952. #endif
  3953. } else if (key.defbeacon) {
  3954. if (key.def_uni || !key.def_multi) {
  3955. err = -EINVAL;
  3956. goto out;
  3957. }
  3958. if (!rdev->ops->set_default_beacon_key) {
  3959. err = -EOPNOTSUPP;
  3960. goto out;
  3961. }
  3962. err = nl80211_key_allowed(wdev);
  3963. if (err)
  3964. goto out;
  3965. err = nl80211_validate_key_link_id(info, wdev, link_id, false);
  3966. if (err)
  3967. goto out;
  3968. err = rdev_set_default_beacon_key(rdev, dev, link_id, key.idx);
  3969. if (err)
  3970. goto out;
  3971. } else if (key.p.mode == NL80211_KEY_SET_TX &&
  3972. wiphy_ext_feature_isset(&rdev->wiphy,
  3973. NL80211_EXT_FEATURE_EXT_KEY_ID)) {
  3974. u8 *mac_addr = NULL;
  3975. if (info->attrs[NL80211_ATTR_MAC])
  3976. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3977. if (!mac_addr || key.idx < 0 || key.idx > 1) {
  3978. err = -EINVAL;
  3979. goto out;
  3980. }
  3981. err = nl80211_validate_key_link_id(info, wdev, link_id, true);
  3982. if (err)
  3983. goto out;
  3984. err = rdev_add_key(rdev, dev, link_id, key.idx,
  3985. NL80211_KEYTYPE_PAIRWISE,
  3986. mac_addr, &key.p);
  3987. } else {
  3988. err = -EINVAL;
  3989. }
  3990. out:
  3991. wdev_unlock(wdev);
  3992. return err;
  3993. }
  3994. static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
  3995. {
  3996. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3997. int err;
  3998. struct net_device *dev = info->user_ptr[1];
  3999. struct key_parse key;
  4000. const u8 *mac_addr = NULL;
  4001. int link_id = nl80211_link_id_or_invalid(info->attrs);
  4002. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4003. err = nl80211_parse_key(info, &key);
  4004. if (err)
  4005. return err;
  4006. if (!key.p.key) {
  4007. GENL_SET_ERR_MSG(info, "no key");
  4008. return -EINVAL;
  4009. }
  4010. if (info->attrs[NL80211_ATTR_MAC])
  4011. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4012. if (key.type == -1) {
  4013. if (mac_addr)
  4014. key.type = NL80211_KEYTYPE_PAIRWISE;
  4015. else
  4016. key.type = NL80211_KEYTYPE_GROUP;
  4017. }
  4018. /* for now */
  4019. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  4020. key.type != NL80211_KEYTYPE_GROUP) {
  4021. GENL_SET_ERR_MSG(info, "key type not pairwise or group");
  4022. return -EINVAL;
  4023. }
  4024. if (key.type == NL80211_KEYTYPE_GROUP &&
  4025. info->attrs[NL80211_ATTR_VLAN_ID])
  4026. key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
  4027. if (!rdev->ops->add_key)
  4028. return -EOPNOTSUPP;
  4029. if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
  4030. key.type == NL80211_KEYTYPE_PAIRWISE,
  4031. mac_addr)) {
  4032. GENL_SET_ERR_MSG(info, "key setting validation failed");
  4033. return -EINVAL;
  4034. }
  4035. wdev_lock(wdev);
  4036. err = nl80211_key_allowed(wdev);
  4037. if (err)
  4038. GENL_SET_ERR_MSG(info, "key not allowed");
  4039. if (!err)
  4040. err = nl80211_validate_key_link_id(info, wdev, link_id,
  4041. key.type == NL80211_KEYTYPE_PAIRWISE);
  4042. if (!err) {
  4043. err = rdev_add_key(rdev, dev, link_id, key.idx,
  4044. key.type == NL80211_KEYTYPE_PAIRWISE,
  4045. mac_addr, &key.p);
  4046. if (err)
  4047. GENL_SET_ERR_MSG(info, "key addition failed");
  4048. }
  4049. wdev_unlock(wdev);
  4050. return err;
  4051. }
  4052. static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
  4053. {
  4054. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4055. int err;
  4056. struct net_device *dev = info->user_ptr[1];
  4057. u8 *mac_addr = NULL;
  4058. struct key_parse key;
  4059. int link_id = nl80211_link_id_or_invalid(info->attrs);
  4060. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4061. err = nl80211_parse_key(info, &key);
  4062. if (err)
  4063. return err;
  4064. if (info->attrs[NL80211_ATTR_MAC])
  4065. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4066. if (key.type == -1) {
  4067. if (mac_addr)
  4068. key.type = NL80211_KEYTYPE_PAIRWISE;
  4069. else
  4070. key.type = NL80211_KEYTYPE_GROUP;
  4071. }
  4072. /* for now */
  4073. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  4074. key.type != NL80211_KEYTYPE_GROUP)
  4075. return -EINVAL;
  4076. if (!cfg80211_valid_key_idx(rdev, key.idx,
  4077. key.type == NL80211_KEYTYPE_PAIRWISE))
  4078. return -EINVAL;
  4079. if (!rdev->ops->del_key)
  4080. return -EOPNOTSUPP;
  4081. wdev_lock(wdev);
  4082. err = nl80211_key_allowed(wdev);
  4083. if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
  4084. !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  4085. err = -ENOENT;
  4086. if (!err)
  4087. err = nl80211_validate_key_link_id(info, wdev, link_id,
  4088. key.type == NL80211_KEYTYPE_PAIRWISE);
  4089. if (!err)
  4090. err = rdev_del_key(rdev, dev, link_id, key.idx,
  4091. key.type == NL80211_KEYTYPE_PAIRWISE,
  4092. mac_addr);
  4093. #ifdef CONFIG_CFG80211_WEXT
  4094. if (!err) {
  4095. if (key.idx == wdev->wext.default_key)
  4096. wdev->wext.default_key = -1;
  4097. else if (key.idx == wdev->wext.default_mgmt_key)
  4098. wdev->wext.default_mgmt_key = -1;
  4099. }
  4100. #endif
  4101. wdev_unlock(wdev);
  4102. return err;
  4103. }
  4104. /* This function returns an error or the number of nested attributes */
  4105. static int validate_acl_mac_addrs(struct nlattr *nl_attr)
  4106. {
  4107. struct nlattr *attr;
  4108. int n_entries = 0, tmp;
  4109. nla_for_each_nested(attr, nl_attr, tmp) {
  4110. if (nla_len(attr) != ETH_ALEN)
  4111. return -EINVAL;
  4112. n_entries++;
  4113. }
  4114. return n_entries;
  4115. }
  4116. /*
  4117. * This function parses ACL information and allocates memory for ACL data.
  4118. * On successful return, the calling function is responsible to free the
  4119. * ACL buffer returned by this function.
  4120. */
  4121. static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
  4122. struct genl_info *info)
  4123. {
  4124. enum nl80211_acl_policy acl_policy;
  4125. struct nlattr *attr;
  4126. struct cfg80211_acl_data *acl;
  4127. int i = 0, n_entries, tmp;
  4128. if (!wiphy->max_acl_mac_addrs)
  4129. return ERR_PTR(-EOPNOTSUPP);
  4130. if (!info->attrs[NL80211_ATTR_ACL_POLICY])
  4131. return ERR_PTR(-EINVAL);
  4132. acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
  4133. if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
  4134. acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
  4135. return ERR_PTR(-EINVAL);
  4136. if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
  4137. return ERR_PTR(-EINVAL);
  4138. n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
  4139. if (n_entries < 0)
  4140. return ERR_PTR(n_entries);
  4141. if (n_entries > wiphy->max_acl_mac_addrs)
  4142. return ERR_PTR(-ENOTSUPP);
  4143. acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL);
  4144. if (!acl)
  4145. return ERR_PTR(-ENOMEM);
  4146. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
  4147. memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
  4148. i++;
  4149. }
  4150. acl->n_acl_entries = n_entries;
  4151. acl->acl_policy = acl_policy;
  4152. return acl;
  4153. }
  4154. static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
  4155. {
  4156. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4157. struct net_device *dev = info->user_ptr[1];
  4158. struct cfg80211_acl_data *acl;
  4159. int err;
  4160. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  4161. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  4162. return -EOPNOTSUPP;
  4163. if (!dev->ieee80211_ptr->links[0].ap.beacon_interval)
  4164. return -EINVAL;
  4165. acl = parse_acl_data(&rdev->wiphy, info);
  4166. if (IS_ERR(acl))
  4167. return PTR_ERR(acl);
  4168. err = rdev_set_mac_acl(rdev, dev, acl);
  4169. kfree(acl);
  4170. return err;
  4171. }
  4172. static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
  4173. u8 *rates, u8 rates_len)
  4174. {
  4175. u8 i;
  4176. u32 mask = 0;
  4177. for (i = 0; i < rates_len; i++) {
  4178. int rate = (rates[i] & 0x7f) * 5;
  4179. int ridx;
  4180. for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
  4181. struct ieee80211_rate *srate =
  4182. &sband->bitrates[ridx];
  4183. if (rate == srate->bitrate) {
  4184. mask |= 1 << ridx;
  4185. break;
  4186. }
  4187. }
  4188. if (ridx == sband->n_bitrates)
  4189. return 0; /* rate not found */
  4190. }
  4191. return mask;
  4192. }
  4193. static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
  4194. u8 *rates, u8 rates_len,
  4195. u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
  4196. {
  4197. u8 i;
  4198. memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
  4199. for (i = 0; i < rates_len; i++) {
  4200. int ridx, rbit;
  4201. ridx = rates[i] / 8;
  4202. rbit = BIT(rates[i] % 8);
  4203. /* check validity */
  4204. if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
  4205. return false;
  4206. /* check availability */
  4207. ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN);
  4208. if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
  4209. mcs[ridx] |= rbit;
  4210. else
  4211. return false;
  4212. }
  4213. return true;
  4214. }
  4215. static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
  4216. {
  4217. u16 mcs_mask = 0;
  4218. switch (vht_mcs_map) {
  4219. case IEEE80211_VHT_MCS_NOT_SUPPORTED:
  4220. break;
  4221. case IEEE80211_VHT_MCS_SUPPORT_0_7:
  4222. mcs_mask = 0x00FF;
  4223. break;
  4224. case IEEE80211_VHT_MCS_SUPPORT_0_8:
  4225. mcs_mask = 0x01FF;
  4226. break;
  4227. case IEEE80211_VHT_MCS_SUPPORT_0_9:
  4228. mcs_mask = 0x03FF;
  4229. break;
  4230. default:
  4231. break;
  4232. }
  4233. return mcs_mask;
  4234. }
  4235. static void vht_build_mcs_mask(u16 vht_mcs_map,
  4236. u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
  4237. {
  4238. u8 nss;
  4239. for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
  4240. vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
  4241. vht_mcs_map >>= 2;
  4242. }
  4243. }
  4244. static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
  4245. struct nl80211_txrate_vht *txrate,
  4246. u16 mcs[NL80211_VHT_NSS_MAX])
  4247. {
  4248. u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
  4249. u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
  4250. u8 i;
  4251. if (!sband->vht_cap.vht_supported)
  4252. return false;
  4253. memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
  4254. /* Build vht_mcs_mask from VHT capabilities */
  4255. vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
  4256. for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
  4257. if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
  4258. mcs[i] = txrate->mcs[i];
  4259. else
  4260. return false;
  4261. }
  4262. return true;
  4263. }
  4264. static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map)
  4265. {
  4266. switch (he_mcs_map) {
  4267. case IEEE80211_HE_MCS_NOT_SUPPORTED:
  4268. return 0;
  4269. case IEEE80211_HE_MCS_SUPPORT_0_7:
  4270. return 0x00FF;
  4271. case IEEE80211_HE_MCS_SUPPORT_0_9:
  4272. return 0x03FF;
  4273. case IEEE80211_HE_MCS_SUPPORT_0_11:
  4274. return 0xFFF;
  4275. default:
  4276. break;
  4277. }
  4278. return 0;
  4279. }
  4280. static void he_build_mcs_mask(u16 he_mcs_map,
  4281. u16 he_mcs_mask[NL80211_HE_NSS_MAX])
  4282. {
  4283. u8 nss;
  4284. for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) {
  4285. he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03);
  4286. he_mcs_map >>= 2;
  4287. }
  4288. }
  4289. static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id,
  4290. const struct ieee80211_sta_he_cap *he_cap)
  4291. {
  4292. struct net_device *dev = info->user_ptr[1];
  4293. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4294. struct cfg80211_chan_def *chandef;
  4295. __le16 tx_mcs;
  4296. chandef = wdev_chandef(wdev, link_id);
  4297. if (!chandef) {
  4298. /*
  4299. * This is probably broken, but we never maintained
  4300. * a chandef in these cases, so it always was.
  4301. */
  4302. return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80);
  4303. }
  4304. switch (chandef->width) {
  4305. case NL80211_CHAN_WIDTH_80P80:
  4306. tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80;
  4307. break;
  4308. case NL80211_CHAN_WIDTH_160:
  4309. tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160;
  4310. break;
  4311. default:
  4312. tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80;
  4313. break;
  4314. }
  4315. return le16_to_cpu(tx_mcs);
  4316. }
  4317. static bool he_set_mcs_mask(struct genl_info *info,
  4318. struct wireless_dev *wdev,
  4319. struct ieee80211_supported_band *sband,
  4320. struct nl80211_txrate_he *txrate,
  4321. u16 mcs[NL80211_HE_NSS_MAX],
  4322. unsigned int link_id)
  4323. {
  4324. const struct ieee80211_sta_he_cap *he_cap;
  4325. u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {};
  4326. u16 tx_mcs_map = 0;
  4327. u8 i;
  4328. he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype);
  4329. if (!he_cap)
  4330. return false;
  4331. memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX);
  4332. tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap);
  4333. /* Build he_mcs_mask from HE capabilities */
  4334. he_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
  4335. for (i = 0; i < NL80211_HE_NSS_MAX; i++) {
  4336. if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
  4337. mcs[i] = txrate->mcs[i];
  4338. else
  4339. return false;
  4340. }
  4341. return true;
  4342. }
  4343. static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
  4344. struct nlattr *attrs[],
  4345. enum nl80211_attrs attr,
  4346. struct cfg80211_bitrate_mask *mask,
  4347. struct net_device *dev,
  4348. bool default_all_enabled,
  4349. unsigned int link_id)
  4350. {
  4351. struct nlattr *tb[NL80211_TXRATE_MAX + 1];
  4352. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4353. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4354. int rem, i;
  4355. struct nlattr *tx_rates;
  4356. struct ieee80211_supported_band *sband;
  4357. u16 vht_tx_mcs_map, he_tx_mcs_map;
  4358. memset(mask, 0, sizeof(*mask));
  4359. /* Default to all rates enabled */
  4360. for (i = 0; i < NUM_NL80211_BANDS; i++) {
  4361. const struct ieee80211_sta_he_cap *he_cap;
  4362. if (!default_all_enabled)
  4363. break;
  4364. sband = rdev->wiphy.bands[i];
  4365. if (!sband)
  4366. continue;
  4367. mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
  4368. memcpy(mask->control[i].ht_mcs,
  4369. sband->ht_cap.mcs.rx_mask,
  4370. sizeof(mask->control[i].ht_mcs));
  4371. if (sband->vht_cap.vht_supported) {
  4372. vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
  4373. vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
  4374. }
  4375. he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype);
  4376. if (!he_cap)
  4377. continue;
  4378. he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap);
  4379. he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs);
  4380. mask->control[i].he_gi = 0xFF;
  4381. mask->control[i].he_ltf = 0xFF;
  4382. }
  4383. /* if no rates are given set it back to the defaults */
  4384. if (!attrs[attr])
  4385. goto out;
  4386. /* The nested attribute uses enum nl80211_band as the index. This maps
  4387. * directly to the enum nl80211_band values used in cfg80211.
  4388. */
  4389. BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
  4390. nla_for_each_nested(tx_rates, attrs[attr], rem) {
  4391. enum nl80211_band band = nla_type(tx_rates);
  4392. int err;
  4393. if (band < 0 || band >= NUM_NL80211_BANDS)
  4394. return -EINVAL;
  4395. sband = rdev->wiphy.bands[band];
  4396. if (sband == NULL)
  4397. return -EINVAL;
  4398. err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX,
  4399. tx_rates,
  4400. nl80211_txattr_policy,
  4401. info->extack);
  4402. if (err)
  4403. return err;
  4404. if (tb[NL80211_TXRATE_LEGACY]) {
  4405. mask->control[band].legacy = rateset_to_mask(
  4406. sband,
  4407. nla_data(tb[NL80211_TXRATE_LEGACY]),
  4408. nla_len(tb[NL80211_TXRATE_LEGACY]));
  4409. if ((mask->control[band].legacy == 0) &&
  4410. nla_len(tb[NL80211_TXRATE_LEGACY]))
  4411. return -EINVAL;
  4412. }
  4413. if (tb[NL80211_TXRATE_HT]) {
  4414. if (!ht_rateset_to_mask(
  4415. sband,
  4416. nla_data(tb[NL80211_TXRATE_HT]),
  4417. nla_len(tb[NL80211_TXRATE_HT]),
  4418. mask->control[band].ht_mcs))
  4419. return -EINVAL;
  4420. }
  4421. if (tb[NL80211_TXRATE_VHT]) {
  4422. if (!vht_set_mcs_mask(
  4423. sband,
  4424. nla_data(tb[NL80211_TXRATE_VHT]),
  4425. mask->control[band].vht_mcs))
  4426. return -EINVAL;
  4427. }
  4428. if (tb[NL80211_TXRATE_GI]) {
  4429. mask->control[band].gi =
  4430. nla_get_u8(tb[NL80211_TXRATE_GI]);
  4431. if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
  4432. return -EINVAL;
  4433. }
  4434. if (tb[NL80211_TXRATE_HE] &&
  4435. !he_set_mcs_mask(info, wdev, sband,
  4436. nla_data(tb[NL80211_TXRATE_HE]),
  4437. mask->control[band].he_mcs,
  4438. link_id))
  4439. return -EINVAL;
  4440. if (tb[NL80211_TXRATE_HE_GI])
  4441. mask->control[band].he_gi =
  4442. nla_get_u8(tb[NL80211_TXRATE_HE_GI]);
  4443. if (tb[NL80211_TXRATE_HE_LTF])
  4444. mask->control[band].he_ltf =
  4445. nla_get_u8(tb[NL80211_TXRATE_HE_LTF]);
  4446. if (mask->control[band].legacy == 0) {
  4447. /* don't allow empty legacy rates if HT, VHT or HE
  4448. * are not even supported.
  4449. */
  4450. if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
  4451. rdev->wiphy.bands[band]->vht_cap.vht_supported ||
  4452. ieee80211_get_he_iftype_cap(sband, wdev->iftype)))
  4453. return -EINVAL;
  4454. for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
  4455. if (mask->control[band].ht_mcs[i])
  4456. goto out;
  4457. for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
  4458. if (mask->control[band].vht_mcs[i])
  4459. goto out;
  4460. for (i = 0; i < NL80211_HE_NSS_MAX; i++)
  4461. if (mask->control[band].he_mcs[i])
  4462. goto out;
  4463. /* legacy and mcs rates may not be both empty */
  4464. return -EINVAL;
  4465. }
  4466. }
  4467. out:
  4468. return 0;
  4469. }
  4470. static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
  4471. enum nl80211_band band,
  4472. struct cfg80211_bitrate_mask *beacon_rate)
  4473. {
  4474. u32 count_ht, count_vht, count_he, i;
  4475. u32 rate = beacon_rate->control[band].legacy;
  4476. /* Allow only one rate */
  4477. if (hweight32(rate) > 1)
  4478. return -EINVAL;
  4479. count_ht = 0;
  4480. for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
  4481. if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
  4482. return -EINVAL;
  4483. } else if (beacon_rate->control[band].ht_mcs[i]) {
  4484. count_ht++;
  4485. if (count_ht > 1)
  4486. return -EINVAL;
  4487. }
  4488. if (count_ht && rate)
  4489. return -EINVAL;
  4490. }
  4491. count_vht = 0;
  4492. for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
  4493. if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
  4494. return -EINVAL;
  4495. } else if (beacon_rate->control[band].vht_mcs[i]) {
  4496. count_vht++;
  4497. if (count_vht > 1)
  4498. return -EINVAL;
  4499. }
  4500. if (count_vht && rate)
  4501. return -EINVAL;
  4502. }
  4503. count_he = 0;
  4504. for (i = 0; i < NL80211_HE_NSS_MAX; i++) {
  4505. if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) {
  4506. return -EINVAL;
  4507. } else if (beacon_rate->control[band].he_mcs[i]) {
  4508. count_he++;
  4509. if (count_he > 1)
  4510. return -EINVAL;
  4511. }
  4512. if (count_he && rate)
  4513. return -EINVAL;
  4514. }
  4515. if ((count_ht && count_vht && count_he) ||
  4516. (!rate && !count_ht && !count_vht && !count_he))
  4517. return -EINVAL;
  4518. if (rate &&
  4519. !wiphy_ext_feature_isset(&rdev->wiphy,
  4520. NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
  4521. return -EINVAL;
  4522. if (count_ht &&
  4523. !wiphy_ext_feature_isset(&rdev->wiphy,
  4524. NL80211_EXT_FEATURE_BEACON_RATE_HT))
  4525. return -EINVAL;
  4526. if (count_vht &&
  4527. !wiphy_ext_feature_isset(&rdev->wiphy,
  4528. NL80211_EXT_FEATURE_BEACON_RATE_VHT))
  4529. return -EINVAL;
  4530. if (count_he &&
  4531. !wiphy_ext_feature_isset(&rdev->wiphy,
  4532. NL80211_EXT_FEATURE_BEACON_RATE_HE))
  4533. return -EINVAL;
  4534. return 0;
  4535. }
  4536. static int nl80211_parse_mbssid_config(struct wiphy *wiphy,
  4537. struct net_device *dev,
  4538. struct nlattr *attrs,
  4539. struct cfg80211_mbssid_config *config,
  4540. u8 num_elems)
  4541. {
  4542. struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1];
  4543. if (!wiphy->mbssid_max_interfaces)
  4544. return -EOPNOTSUPP;
  4545. if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL,
  4546. NULL) ||
  4547. !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX])
  4548. return -EINVAL;
  4549. config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]);
  4550. if (config->ema) {
  4551. if (!wiphy->ema_max_profile_periodicity)
  4552. return -EOPNOTSUPP;
  4553. if (num_elems > wiphy->ema_max_profile_periodicity)
  4554. return -EINVAL;
  4555. }
  4556. config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]);
  4557. if (config->index >= wiphy->mbssid_max_interfaces ||
  4558. (!config->index && !num_elems))
  4559. return -EINVAL;
  4560. if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) {
  4561. u32 tx_ifindex =
  4562. nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]);
  4563. if ((!config->index && tx_ifindex != dev->ifindex) ||
  4564. (config->index && tx_ifindex == dev->ifindex))
  4565. return -EINVAL;
  4566. if (tx_ifindex != dev->ifindex) {
  4567. struct net_device *tx_netdev =
  4568. dev_get_by_index(wiphy_net(wiphy), tx_ifindex);
  4569. if (!tx_netdev || !tx_netdev->ieee80211_ptr ||
  4570. tx_netdev->ieee80211_ptr->wiphy != wiphy ||
  4571. tx_netdev->ieee80211_ptr->iftype !=
  4572. NL80211_IFTYPE_AP) {
  4573. dev_put(tx_netdev);
  4574. return -EINVAL;
  4575. }
  4576. config->tx_wdev = tx_netdev->ieee80211_ptr;
  4577. } else {
  4578. config->tx_wdev = dev->ieee80211_ptr;
  4579. }
  4580. } else if (!config->index) {
  4581. config->tx_wdev = dev->ieee80211_ptr;
  4582. } else {
  4583. return -EINVAL;
  4584. }
  4585. return 0;
  4586. }
  4587. static struct cfg80211_mbssid_elems *
  4588. nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs)
  4589. {
  4590. struct nlattr *nl_elems;
  4591. struct cfg80211_mbssid_elems *elems;
  4592. int rem_elems;
  4593. u8 i = 0, num_elems = 0;
  4594. if (!wiphy->mbssid_max_interfaces)
  4595. return ERR_PTR(-EINVAL);
  4596. nla_for_each_nested(nl_elems, attrs, rem_elems) {
  4597. if (num_elems >= 255)
  4598. return ERR_PTR(-EINVAL);
  4599. num_elems++;
  4600. }
  4601. elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL);
  4602. if (!elems)
  4603. return ERR_PTR(-ENOMEM);
  4604. nla_for_each_nested(nl_elems, attrs, rem_elems) {
  4605. elems->elem[i].data = nla_data(nl_elems);
  4606. elems->elem[i].len = nla_len(nl_elems);
  4607. i++;
  4608. }
  4609. elems->cnt = num_elems;
  4610. return elems;
  4611. }
  4612. static int nl80211_parse_he_bss_color(struct nlattr *attrs,
  4613. struct cfg80211_he_bss_color *he_bss_color)
  4614. {
  4615. struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1];
  4616. int err;
  4617. err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs,
  4618. he_bss_color_policy, NULL);
  4619. if (err)
  4620. return err;
  4621. if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR])
  4622. return -EINVAL;
  4623. he_bss_color->color =
  4624. nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]);
  4625. he_bss_color->enabled =
  4626. !nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]);
  4627. he_bss_color->partial =
  4628. nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]);
  4629. return 0;
  4630. }
  4631. static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev,
  4632. struct nlattr *attrs[],
  4633. struct cfg80211_beacon_data *bcn)
  4634. {
  4635. bool haveinfo = false;
  4636. int err;
  4637. memset(bcn, 0, sizeof(*bcn));
  4638. bcn->link_id = nl80211_link_id(attrs);
  4639. if (attrs[NL80211_ATTR_BEACON_HEAD]) {
  4640. bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
  4641. bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
  4642. if (!bcn->head_len)
  4643. return -EINVAL;
  4644. haveinfo = true;
  4645. }
  4646. if (attrs[NL80211_ATTR_BEACON_TAIL]) {
  4647. bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
  4648. bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
  4649. haveinfo = true;
  4650. }
  4651. if (!haveinfo)
  4652. return -EINVAL;
  4653. if (attrs[NL80211_ATTR_IE]) {
  4654. bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
  4655. bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
  4656. }
  4657. if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
  4658. bcn->proberesp_ies =
  4659. nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
  4660. bcn->proberesp_ies_len =
  4661. nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
  4662. }
  4663. if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
  4664. bcn->assocresp_ies =
  4665. nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
  4666. bcn->assocresp_ies_len =
  4667. nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
  4668. }
  4669. if (attrs[NL80211_ATTR_PROBE_RESP]) {
  4670. bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
  4671. bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
  4672. }
  4673. if (attrs[NL80211_ATTR_FTM_RESPONDER]) {
  4674. struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1];
  4675. err = nla_parse_nested_deprecated(tb,
  4676. NL80211_FTM_RESP_ATTR_MAX,
  4677. attrs[NL80211_ATTR_FTM_RESPONDER],
  4678. NULL, NULL);
  4679. if (err)
  4680. return err;
  4681. if (tb[NL80211_FTM_RESP_ATTR_ENABLED] &&
  4682. wiphy_ext_feature_isset(&rdev->wiphy,
  4683. NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER))
  4684. bcn->ftm_responder = 1;
  4685. else
  4686. return -EOPNOTSUPP;
  4687. if (tb[NL80211_FTM_RESP_ATTR_LCI]) {
  4688. bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]);
  4689. bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]);
  4690. }
  4691. if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) {
  4692. bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
  4693. bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
  4694. }
  4695. } else {
  4696. bcn->ftm_responder = -1;
  4697. }
  4698. if (attrs[NL80211_ATTR_HE_BSS_COLOR]) {
  4699. err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR],
  4700. &bcn->he_bss_color);
  4701. if (err)
  4702. return err;
  4703. bcn->he_bss_color_valid = true;
  4704. }
  4705. if (attrs[NL80211_ATTR_MBSSID_ELEMS]) {
  4706. struct cfg80211_mbssid_elems *mbssid =
  4707. nl80211_parse_mbssid_elems(&rdev->wiphy,
  4708. attrs[NL80211_ATTR_MBSSID_ELEMS]);
  4709. if (IS_ERR(mbssid))
  4710. return PTR_ERR(mbssid);
  4711. bcn->mbssid_ies = mbssid;
  4712. }
  4713. return 0;
  4714. }
  4715. static int nl80211_parse_he_obss_pd(struct nlattr *attrs,
  4716. struct ieee80211_he_obss_pd *he_obss_pd)
  4717. {
  4718. struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1];
  4719. int err;
  4720. err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs,
  4721. he_obss_pd_policy, NULL);
  4722. if (err)
  4723. return err;
  4724. if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL])
  4725. return -EINVAL;
  4726. he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]);
  4727. if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET])
  4728. he_obss_pd->min_offset =
  4729. nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]);
  4730. if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET])
  4731. he_obss_pd->max_offset =
  4732. nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]);
  4733. if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET])
  4734. he_obss_pd->non_srg_max_offset =
  4735. nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]);
  4736. if (he_obss_pd->min_offset > he_obss_pd->max_offset)
  4737. return -EINVAL;
  4738. if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP])
  4739. memcpy(he_obss_pd->bss_color_bitmap,
  4740. nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]),
  4741. sizeof(he_obss_pd->bss_color_bitmap));
  4742. if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP])
  4743. memcpy(he_obss_pd->partial_bssid_bitmap,
  4744. nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]),
  4745. sizeof(he_obss_pd->partial_bssid_bitmap));
  4746. he_obss_pd->enable = true;
  4747. return 0;
  4748. }
  4749. static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev,
  4750. struct nlattr *attrs,
  4751. struct cfg80211_ap_settings *params)
  4752. {
  4753. struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1];
  4754. int ret;
  4755. struct cfg80211_fils_discovery *fd = &params->fils_discovery;
  4756. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  4757. NL80211_EXT_FEATURE_FILS_DISCOVERY))
  4758. return -EINVAL;
  4759. ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs,
  4760. NULL, NULL);
  4761. if (ret)
  4762. return ret;
  4763. if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] ||
  4764. !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] ||
  4765. !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL])
  4766. return -EINVAL;
  4767. fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]);
  4768. fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]);
  4769. fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]);
  4770. fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]);
  4771. return 0;
  4772. }
  4773. static int
  4774. nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev,
  4775. struct nlattr *attrs,
  4776. struct cfg80211_ap_settings *params)
  4777. {
  4778. struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1];
  4779. int ret;
  4780. struct cfg80211_unsol_bcast_probe_resp *presp =
  4781. &params->unsol_bcast_probe_resp;
  4782. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  4783. NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP))
  4784. return -EINVAL;
  4785. ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX,
  4786. attrs, NULL, NULL);
  4787. if (ret)
  4788. return ret;
  4789. if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] ||
  4790. !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL])
  4791. return -EINVAL;
  4792. presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]);
  4793. presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]);
  4794. presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]);
  4795. return 0;
  4796. }
  4797. static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
  4798. const struct element *rates)
  4799. {
  4800. int i;
  4801. if (!rates)
  4802. return;
  4803. for (i = 0; i < rates->datalen; i++) {
  4804. if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
  4805. params->ht_required = true;
  4806. if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
  4807. params->vht_required = true;
  4808. if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY)
  4809. params->he_required = true;
  4810. if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E)
  4811. params->sae_h2e_required = true;
  4812. }
  4813. }
  4814. /*
  4815. * Since the nl80211 API didn't include, from the beginning, attributes about
  4816. * HT/VHT requirements/capabilities, we parse them out of the IEs for the
  4817. * benefit of drivers that rebuild IEs in the firmware.
  4818. */
  4819. static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
  4820. {
  4821. const struct cfg80211_beacon_data *bcn = &params->beacon;
  4822. size_t ies_len = bcn->tail_len;
  4823. const u8 *ies = bcn->tail;
  4824. const struct element *rates;
  4825. const struct element *cap;
  4826. rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len);
  4827. nl80211_check_ap_rate_selectors(params, rates);
  4828. rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
  4829. nl80211_check_ap_rate_selectors(params, rates);
  4830. cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len);
  4831. if (cap && cap->datalen >= sizeof(*params->ht_cap))
  4832. params->ht_cap = (void *)cap->data;
  4833. cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
  4834. if (cap && cap->datalen >= sizeof(*params->vht_cap))
  4835. params->vht_cap = (void *)cap->data;
  4836. cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len);
  4837. if (cap && cap->datalen >= sizeof(*params->he_cap) + 1)
  4838. params->he_cap = (void *)(cap->data + 1);
  4839. cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len);
  4840. if (cap && cap->datalen >= sizeof(*params->he_oper) + 1)
  4841. params->he_oper = (void *)(cap->data + 1);
  4842. cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len);
  4843. if (cap) {
  4844. if (!cap->datalen)
  4845. return -EINVAL;
  4846. params->eht_cap = (void *)(cap->data + 1);
  4847. if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap,
  4848. (const u8 *)params->eht_cap,
  4849. cap->datalen - 1, true))
  4850. return -EINVAL;
  4851. }
  4852. cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len);
  4853. if (cap) {
  4854. if (!cap->datalen)
  4855. return -EINVAL;
  4856. params->eht_oper = (void *)(cap->data + 1);
  4857. if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper,
  4858. cap->datalen - 1))
  4859. return -EINVAL;
  4860. }
  4861. return 0;
  4862. }
  4863. static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
  4864. struct cfg80211_ap_settings *params)
  4865. {
  4866. struct wireless_dev *wdev;
  4867. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  4868. if (wdev->iftype != NL80211_IFTYPE_AP &&
  4869. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  4870. continue;
  4871. if (!wdev->u.ap.preset_chandef.chan)
  4872. continue;
  4873. params->chandef = wdev->u.ap.preset_chandef;
  4874. return true;
  4875. }
  4876. return false;
  4877. }
  4878. static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
  4879. enum nl80211_auth_type auth_type,
  4880. enum nl80211_commands cmd)
  4881. {
  4882. if (auth_type > NL80211_AUTHTYPE_MAX)
  4883. return false;
  4884. switch (cmd) {
  4885. case NL80211_CMD_AUTHENTICATE:
  4886. if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
  4887. auth_type == NL80211_AUTHTYPE_SAE)
  4888. return false;
  4889. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  4890. NL80211_EXT_FEATURE_FILS_STA) &&
  4891. (auth_type == NL80211_AUTHTYPE_FILS_SK ||
  4892. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  4893. auth_type == NL80211_AUTHTYPE_FILS_PK))
  4894. return false;
  4895. return true;
  4896. case NL80211_CMD_CONNECT:
  4897. if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
  4898. !wiphy_ext_feature_isset(&rdev->wiphy,
  4899. NL80211_EXT_FEATURE_SAE_OFFLOAD) &&
  4900. auth_type == NL80211_AUTHTYPE_SAE)
  4901. return false;
  4902. /* FILS with SK PFS or PK not supported yet */
  4903. if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  4904. auth_type == NL80211_AUTHTYPE_FILS_PK)
  4905. return false;
  4906. if (!wiphy_ext_feature_isset(
  4907. &rdev->wiphy,
  4908. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
  4909. auth_type == NL80211_AUTHTYPE_FILS_SK)
  4910. return false;
  4911. return true;
  4912. case NL80211_CMD_START_AP:
  4913. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  4914. NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) &&
  4915. auth_type == NL80211_AUTHTYPE_SAE)
  4916. return false;
  4917. /* FILS not supported yet */
  4918. if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
  4919. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  4920. auth_type == NL80211_AUTHTYPE_FILS_PK)
  4921. return false;
  4922. return true;
  4923. default:
  4924. return false;
  4925. }
  4926. }
  4927. static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
  4928. {
  4929. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4930. unsigned int link_id = nl80211_link_id(info->attrs);
  4931. struct net_device *dev = info->user_ptr[1];
  4932. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4933. struct cfg80211_ap_settings *params;
  4934. int err;
  4935. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  4936. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  4937. return -EOPNOTSUPP;
  4938. if (!rdev->ops->start_ap)
  4939. return -EOPNOTSUPP;
  4940. if (wdev->links[link_id].ap.beacon_interval)
  4941. return -EALREADY;
  4942. /* these are required for START_AP */
  4943. if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
  4944. !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
  4945. !info->attrs[NL80211_ATTR_BEACON_HEAD])
  4946. return -EINVAL;
  4947. params = kzalloc(sizeof(*params), GFP_KERNEL);
  4948. if (!params)
  4949. return -ENOMEM;
  4950. err = nl80211_parse_beacon(rdev, info->attrs, &params->beacon);
  4951. if (err)
  4952. goto out;
  4953. params->beacon_interval =
  4954. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  4955. params->dtim_period =
  4956. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  4957. err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
  4958. params->beacon_interval);
  4959. if (err)
  4960. goto out;
  4961. /*
  4962. * In theory, some of these attributes should be required here
  4963. * but since they were not used when the command was originally
  4964. * added, keep them optional for old user space programs to let
  4965. * them continue to work with drivers that do not need the
  4966. * additional information -- drivers must check!
  4967. */
  4968. if (info->attrs[NL80211_ATTR_SSID]) {
  4969. params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  4970. params->ssid_len =
  4971. nla_len(info->attrs[NL80211_ATTR_SSID]);
  4972. if (params->ssid_len == 0) {
  4973. err = -EINVAL;
  4974. goto out;
  4975. }
  4976. if (wdev->u.ap.ssid_len &&
  4977. (wdev->u.ap.ssid_len != params->ssid_len ||
  4978. memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) {
  4979. /* require identical SSID for MLO */
  4980. err = -EINVAL;
  4981. goto out;
  4982. }
  4983. } else if (wdev->valid_links) {
  4984. /* require SSID for MLO */
  4985. err = -EINVAL;
  4986. goto out;
  4987. }
  4988. if (info->attrs[NL80211_ATTR_HIDDEN_SSID])
  4989. params->hidden_ssid = nla_get_u32(
  4990. info->attrs[NL80211_ATTR_HIDDEN_SSID]);
  4991. params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  4992. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  4993. params->auth_type = nla_get_u32(
  4994. info->attrs[NL80211_ATTR_AUTH_TYPE]);
  4995. if (!nl80211_valid_auth_type(rdev, params->auth_type,
  4996. NL80211_CMD_START_AP)) {
  4997. err = -EINVAL;
  4998. goto out;
  4999. }
  5000. } else
  5001. params->auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  5002. err = nl80211_crypto_settings(rdev, info, &params->crypto,
  5003. NL80211_MAX_NR_CIPHER_SUITES);
  5004. if (err)
  5005. goto out;
  5006. if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
  5007. if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) {
  5008. err = -EOPNOTSUPP;
  5009. goto out;
  5010. }
  5011. params->inactivity_timeout = nla_get_u16(
  5012. info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
  5013. }
  5014. if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
  5015. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  5016. err = -EINVAL;
  5017. goto out;
  5018. }
  5019. params->p2p_ctwindow =
  5020. nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
  5021. if (params->p2p_ctwindow != 0 &&
  5022. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) {
  5023. err = -EINVAL;
  5024. goto out;
  5025. }
  5026. }
  5027. if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
  5028. u8 tmp;
  5029. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  5030. err = -EINVAL;
  5031. goto out;
  5032. }
  5033. tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
  5034. params->p2p_opp_ps = tmp;
  5035. if (params->p2p_opp_ps != 0 &&
  5036. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) {
  5037. err = -EINVAL;
  5038. goto out;
  5039. }
  5040. }
  5041. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  5042. err = nl80211_parse_chandef(rdev, info, &params->chandef);
  5043. if (err)
  5044. goto out;
  5045. } else if (wdev->valid_links) {
  5046. /* with MLD need to specify the channel configuration */
  5047. err = -EINVAL;
  5048. goto out;
  5049. } else if (wdev->u.ap.preset_chandef.chan) {
  5050. params->chandef = wdev->u.ap.preset_chandef;
  5051. } else if (!nl80211_get_ap_channel(rdev, params)) {
  5052. err = -EINVAL;
  5053. goto out;
  5054. }
  5055. if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) {
  5056. err = nl80211_parse_punct_bitmap(rdev, info,
  5057. &params->chandef,
  5058. &params->punct_bitmap);
  5059. if (err)
  5060. goto out;
  5061. }
  5062. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params->chandef,
  5063. wdev->iftype)) {
  5064. err = -EINVAL;
  5065. goto out;
  5066. }
  5067. wdev_lock(wdev);
  5068. if (info->attrs[NL80211_ATTR_TX_RATES]) {
  5069. err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
  5070. NL80211_ATTR_TX_RATES,
  5071. &params->beacon_rate,
  5072. dev, false, link_id);
  5073. if (err)
  5074. goto out_unlock;
  5075. err = validate_beacon_tx_rate(rdev, params->chandef.chan->band,
  5076. &params->beacon_rate);
  5077. if (err)
  5078. goto out_unlock;
  5079. }
  5080. if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
  5081. params->smps_mode =
  5082. nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
  5083. switch (params->smps_mode) {
  5084. case NL80211_SMPS_OFF:
  5085. break;
  5086. case NL80211_SMPS_STATIC:
  5087. if (!(rdev->wiphy.features &
  5088. NL80211_FEATURE_STATIC_SMPS)) {
  5089. err = -EINVAL;
  5090. goto out_unlock;
  5091. }
  5092. break;
  5093. case NL80211_SMPS_DYNAMIC:
  5094. if (!(rdev->wiphy.features &
  5095. NL80211_FEATURE_DYNAMIC_SMPS)) {
  5096. err = -EINVAL;
  5097. goto out_unlock;
  5098. }
  5099. break;
  5100. default:
  5101. err = -EINVAL;
  5102. goto out_unlock;
  5103. }
  5104. } else {
  5105. params->smps_mode = NL80211_SMPS_OFF;
  5106. }
  5107. params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
  5108. if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
  5109. err = -EOPNOTSUPP;
  5110. goto out_unlock;
  5111. }
  5112. if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
  5113. params->acl = parse_acl_data(&rdev->wiphy, info);
  5114. if (IS_ERR(params->acl)) {
  5115. err = PTR_ERR(params->acl);
  5116. params->acl = NULL;
  5117. goto out_unlock;
  5118. }
  5119. }
  5120. params->twt_responder =
  5121. nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]);
  5122. if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) {
  5123. err = nl80211_parse_he_obss_pd(
  5124. info->attrs[NL80211_ATTR_HE_OBSS_PD],
  5125. &params->he_obss_pd);
  5126. if (err)
  5127. goto out_unlock;
  5128. }
  5129. if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) {
  5130. err = nl80211_parse_fils_discovery(rdev,
  5131. info->attrs[NL80211_ATTR_FILS_DISCOVERY],
  5132. params);
  5133. if (err)
  5134. goto out_unlock;
  5135. }
  5136. if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) {
  5137. err = nl80211_parse_unsol_bcast_probe_resp(
  5138. rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP],
  5139. params);
  5140. if (err)
  5141. goto out_unlock;
  5142. }
  5143. if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) {
  5144. err = nl80211_parse_mbssid_config(&rdev->wiphy, dev,
  5145. info->attrs[NL80211_ATTR_MBSSID_CONFIG],
  5146. &params->mbssid_config,
  5147. params->beacon.mbssid_ies ?
  5148. params->beacon.mbssid_ies->cnt :
  5149. 0);
  5150. if (err)
  5151. goto out_unlock;
  5152. }
  5153. err = nl80211_calculate_ap_params(params);
  5154. if (err)
  5155. goto out_unlock;
  5156. if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS])
  5157. params->flags = nla_get_u32(
  5158. info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]);
  5159. else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])
  5160. params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT;
  5161. if (wdev->conn_owner_nlportid &&
  5162. info->attrs[NL80211_ATTR_SOCKET_OWNER] &&
  5163. wdev->conn_owner_nlportid != info->snd_portid) {
  5164. err = -EINVAL;
  5165. goto out_unlock;
  5166. }
  5167. /* FIXME: validate MLO/link-id against driver capabilities */
  5168. err = rdev_start_ap(rdev, dev, params);
  5169. if (!err) {
  5170. wdev->links[link_id].ap.beacon_interval = params->beacon_interval;
  5171. wdev->links[link_id].ap.chandef = params->chandef;
  5172. wdev->u.ap.ssid_len = params->ssid_len;
  5173. memcpy(wdev->u.ap.ssid, params->ssid,
  5174. params->ssid_len);
  5175. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  5176. wdev->conn_owner_nlportid = info->snd_portid;
  5177. }
  5178. out_unlock:
  5179. wdev_unlock(wdev);
  5180. out:
  5181. kfree(params->acl);
  5182. kfree(params->beacon.mbssid_ies);
  5183. if (params->mbssid_config.tx_wdev &&
  5184. params->mbssid_config.tx_wdev->netdev &&
  5185. params->mbssid_config.tx_wdev->netdev != dev)
  5186. dev_put(params->mbssid_config.tx_wdev->netdev);
  5187. kfree(params);
  5188. return err;
  5189. }
  5190. static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
  5191. {
  5192. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5193. unsigned int link_id = nl80211_link_id(info->attrs);
  5194. struct net_device *dev = info->user_ptr[1];
  5195. struct wireless_dev *wdev = dev->ieee80211_ptr;
  5196. struct cfg80211_beacon_data params;
  5197. int err;
  5198. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  5199. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  5200. return -EOPNOTSUPP;
  5201. if (!rdev->ops->change_beacon)
  5202. return -EOPNOTSUPP;
  5203. if (!wdev->links[link_id].ap.beacon_interval)
  5204. return -EINVAL;
  5205. err = nl80211_parse_beacon(rdev, info->attrs, &params);
  5206. if (err)
  5207. goto out;
  5208. wdev_lock(wdev);
  5209. err = rdev_change_beacon(rdev, dev, &params);
  5210. wdev_unlock(wdev);
  5211. out:
  5212. kfree(params.mbssid_ies);
  5213. return err;
  5214. }
  5215. static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
  5216. {
  5217. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5218. unsigned int link_id = nl80211_link_id(info->attrs);
  5219. struct net_device *dev = info->user_ptr[1];
  5220. return cfg80211_stop_ap(rdev, dev, link_id, false);
  5221. }
  5222. static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
  5223. [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
  5224. [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
  5225. [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
  5226. [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
  5227. [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
  5228. [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
  5229. };
  5230. static int parse_station_flags(struct genl_info *info,
  5231. enum nl80211_iftype iftype,
  5232. struct station_parameters *params)
  5233. {
  5234. struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
  5235. struct nlattr *nla;
  5236. int flag;
  5237. /*
  5238. * Try parsing the new attribute first so userspace
  5239. * can specify both for older kernels.
  5240. */
  5241. nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
  5242. if (nla) {
  5243. struct nl80211_sta_flag_update *sta_flags;
  5244. sta_flags = nla_data(nla);
  5245. params->sta_flags_mask = sta_flags->mask;
  5246. params->sta_flags_set = sta_flags->set;
  5247. params->sta_flags_set &= params->sta_flags_mask;
  5248. if ((params->sta_flags_mask |
  5249. params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
  5250. return -EINVAL;
  5251. return 0;
  5252. }
  5253. /* if present, parse the old attribute */
  5254. nla = info->attrs[NL80211_ATTR_STA_FLAGS];
  5255. if (!nla)
  5256. return 0;
  5257. if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack))
  5258. return -EINVAL;
  5259. /*
  5260. * Only allow certain flags for interface types so that
  5261. * other attributes are silently ignored. Remember that
  5262. * this is backward compatibility code with old userspace
  5263. * and shouldn't be hit in other cases anyway.
  5264. */
  5265. switch (iftype) {
  5266. case NL80211_IFTYPE_AP:
  5267. case NL80211_IFTYPE_AP_VLAN:
  5268. case NL80211_IFTYPE_P2P_GO:
  5269. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
  5270. BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
  5271. BIT(NL80211_STA_FLAG_WME) |
  5272. BIT(NL80211_STA_FLAG_MFP);
  5273. break;
  5274. case NL80211_IFTYPE_P2P_CLIENT:
  5275. case NL80211_IFTYPE_STATION:
  5276. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
  5277. BIT(NL80211_STA_FLAG_TDLS_PEER);
  5278. break;
  5279. case NL80211_IFTYPE_MESH_POINT:
  5280. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  5281. BIT(NL80211_STA_FLAG_MFP) |
  5282. BIT(NL80211_STA_FLAG_AUTHORIZED);
  5283. break;
  5284. default:
  5285. return -EINVAL;
  5286. }
  5287. for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
  5288. if (flags[flag]) {
  5289. params->sta_flags_set |= (1<<flag);
  5290. /* no longer support new API additions in old API */
  5291. if (flag > NL80211_STA_FLAG_MAX_OLD_API)
  5292. return -EINVAL;
  5293. }
  5294. }
  5295. return 0;
  5296. }
  5297. bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr)
  5298. {
  5299. struct nlattr *rate;
  5300. u32 bitrate;
  5301. u16 bitrate_compat;
  5302. enum nl80211_rate_info rate_flg;
  5303. rate = nla_nest_start_noflag(msg, attr);
  5304. if (!rate)
  5305. return false;
  5306. /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
  5307. bitrate = cfg80211_calculate_bitrate(info);
  5308. /* report 16-bit bitrate only if we can */
  5309. bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
  5310. if (bitrate > 0 &&
  5311. nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
  5312. return false;
  5313. if (bitrate_compat > 0 &&
  5314. nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
  5315. return false;
  5316. switch (info->bw) {
  5317. case RATE_INFO_BW_5:
  5318. rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
  5319. break;
  5320. case RATE_INFO_BW_10:
  5321. rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
  5322. break;
  5323. default:
  5324. WARN_ON(1);
  5325. fallthrough;
  5326. case RATE_INFO_BW_20:
  5327. rate_flg = 0;
  5328. break;
  5329. case RATE_INFO_BW_40:
  5330. rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
  5331. break;
  5332. case RATE_INFO_BW_80:
  5333. rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
  5334. break;
  5335. case RATE_INFO_BW_160:
  5336. rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
  5337. break;
  5338. case RATE_INFO_BW_HE_RU:
  5339. rate_flg = 0;
  5340. WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS));
  5341. break;
  5342. case RATE_INFO_BW_320:
  5343. rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH;
  5344. break;
  5345. case RATE_INFO_BW_EHT_RU:
  5346. rate_flg = 0;
  5347. WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS));
  5348. break;
  5349. }
  5350. if (rate_flg && nla_put_flag(msg, rate_flg))
  5351. return false;
  5352. if (info->flags & RATE_INFO_FLAGS_MCS) {
  5353. if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
  5354. return false;
  5355. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  5356. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  5357. return false;
  5358. } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
  5359. if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
  5360. return false;
  5361. if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
  5362. return false;
  5363. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  5364. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  5365. return false;
  5366. } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) {
  5367. if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs))
  5368. return false;
  5369. if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss))
  5370. return false;
  5371. if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi))
  5372. return false;
  5373. if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm))
  5374. return false;
  5375. if (info->bw == RATE_INFO_BW_HE_RU &&
  5376. nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC,
  5377. info->he_ru_alloc))
  5378. return false;
  5379. } else if (info->flags & RATE_INFO_FLAGS_EHT_MCS) {
  5380. if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs))
  5381. return false;
  5382. if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss))
  5383. return false;
  5384. if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi))
  5385. return false;
  5386. if (info->bw == RATE_INFO_BW_EHT_RU &&
  5387. nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC,
  5388. info->eht_ru_alloc))
  5389. return false;
  5390. }
  5391. nla_nest_end(msg, rate);
  5392. return true;
  5393. }
  5394. static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
  5395. int id)
  5396. {
  5397. void *attr;
  5398. int i = 0;
  5399. if (!mask)
  5400. return true;
  5401. attr = nla_nest_start_noflag(msg, id);
  5402. if (!attr)
  5403. return false;
  5404. for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
  5405. if (!(mask & BIT(i)))
  5406. continue;
  5407. if (nla_put_u8(msg, i, signal[i]))
  5408. return false;
  5409. }
  5410. nla_nest_end(msg, attr);
  5411. return true;
  5412. }
  5413. static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
  5414. u32 seq, int flags,
  5415. struct cfg80211_registered_device *rdev,
  5416. struct net_device *dev,
  5417. const u8 *mac_addr, struct station_info *sinfo)
  5418. {
  5419. void *hdr;
  5420. struct nlattr *sinfoattr, *bss_param;
  5421. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  5422. if (!hdr) {
  5423. cfg80211_sinfo_release_content(sinfo);
  5424. return -1;
  5425. }
  5426. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  5427. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
  5428. nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
  5429. goto nla_put_failure;
  5430. sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO);
  5431. if (!sinfoattr)
  5432. goto nla_put_failure;
  5433. #define PUT_SINFO(attr, memb, type) do { \
  5434. BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \
  5435. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \
  5436. nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \
  5437. sinfo->memb)) \
  5438. goto nla_put_failure; \
  5439. } while (0)
  5440. #define PUT_SINFO_U64(attr, memb) do { \
  5441. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \
  5442. nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \
  5443. sinfo->memb, NL80211_STA_INFO_PAD)) \
  5444. goto nla_put_failure; \
  5445. } while (0)
  5446. PUT_SINFO(CONNECTED_TIME, connected_time, u32);
  5447. PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
  5448. PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at);
  5449. if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) |
  5450. BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) &&
  5451. nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
  5452. (u32)sinfo->rx_bytes))
  5453. goto nla_put_failure;
  5454. if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) |
  5455. BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) &&
  5456. nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
  5457. (u32)sinfo->tx_bytes))
  5458. goto nla_put_failure;
  5459. PUT_SINFO_U64(RX_BYTES64, rx_bytes);
  5460. PUT_SINFO_U64(TX_BYTES64, tx_bytes);
  5461. PUT_SINFO(LLID, llid, u16);
  5462. PUT_SINFO(PLID, plid, u16);
  5463. PUT_SINFO(PLINK_STATE, plink_state, u8);
  5464. PUT_SINFO_U64(RX_DURATION, rx_duration);
  5465. PUT_SINFO_U64(TX_DURATION, tx_duration);
  5466. if (wiphy_ext_feature_isset(&rdev->wiphy,
  5467. NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
  5468. PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16);
  5469. switch (rdev->wiphy.signal_type) {
  5470. case CFG80211_SIGNAL_TYPE_MBM:
  5471. PUT_SINFO(SIGNAL, signal, u8);
  5472. PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
  5473. break;
  5474. default:
  5475. break;
  5476. }
  5477. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) {
  5478. if (!nl80211_put_signal(msg, sinfo->chains,
  5479. sinfo->chain_signal,
  5480. NL80211_STA_INFO_CHAIN_SIGNAL))
  5481. goto nla_put_failure;
  5482. }
  5483. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
  5484. if (!nl80211_put_signal(msg, sinfo->chains,
  5485. sinfo->chain_signal_avg,
  5486. NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
  5487. goto nla_put_failure;
  5488. }
  5489. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) {
  5490. if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
  5491. NL80211_STA_INFO_TX_BITRATE))
  5492. goto nla_put_failure;
  5493. }
  5494. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) {
  5495. if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
  5496. NL80211_STA_INFO_RX_BITRATE))
  5497. goto nla_put_failure;
  5498. }
  5499. PUT_SINFO(RX_PACKETS, rx_packets, u32);
  5500. PUT_SINFO(TX_PACKETS, tx_packets, u32);
  5501. PUT_SINFO(TX_RETRIES, tx_retries, u32);
  5502. PUT_SINFO(TX_FAILED, tx_failed, u32);
  5503. PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
  5504. PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32);
  5505. PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
  5506. PUT_SINFO(LOCAL_PM, local_pm, u32);
  5507. PUT_SINFO(PEER_PM, peer_pm, u32);
  5508. PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
  5509. PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8);
  5510. PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8);
  5511. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) {
  5512. bss_param = nla_nest_start_noflag(msg,
  5513. NL80211_STA_INFO_BSS_PARAM);
  5514. if (!bss_param)
  5515. goto nla_put_failure;
  5516. if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
  5517. nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
  5518. ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
  5519. nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
  5520. ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
  5521. nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
  5522. nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
  5523. sinfo->bss_param.dtim_period) ||
  5524. nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
  5525. sinfo->bss_param.beacon_interval))
  5526. goto nla_put_failure;
  5527. nla_nest_end(msg, bss_param);
  5528. }
  5529. if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) &&
  5530. nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
  5531. sizeof(struct nl80211_sta_flag_update),
  5532. &sinfo->sta_flags))
  5533. goto nla_put_failure;
  5534. PUT_SINFO_U64(T_OFFSET, t_offset);
  5535. PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
  5536. PUT_SINFO_U64(BEACON_RX, rx_beacon);
  5537. PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
  5538. PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32);
  5539. PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32);
  5540. if (wiphy_ext_feature_isset(&rdev->wiphy,
  5541. NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) {
  5542. PUT_SINFO(ACK_SIGNAL, ack_signal, u8);
  5543. PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8);
  5544. }
  5545. #undef PUT_SINFO
  5546. #undef PUT_SINFO_U64
  5547. if (sinfo->pertid) {
  5548. struct nlattr *tidsattr;
  5549. int tid;
  5550. tidsattr = nla_nest_start_noflag(msg,
  5551. NL80211_STA_INFO_TID_STATS);
  5552. if (!tidsattr)
  5553. goto nla_put_failure;
  5554. for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
  5555. struct cfg80211_tid_stats *tidstats;
  5556. struct nlattr *tidattr;
  5557. tidstats = &sinfo->pertid[tid];
  5558. if (!tidstats->filled)
  5559. continue;
  5560. tidattr = nla_nest_start_noflag(msg, tid + 1);
  5561. if (!tidattr)
  5562. goto nla_put_failure;
  5563. #define PUT_TIDVAL_U64(attr, memb) do { \
  5564. if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \
  5565. nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \
  5566. tidstats->memb, NL80211_TID_STATS_PAD)) \
  5567. goto nla_put_failure; \
  5568. } while (0)
  5569. PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
  5570. PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
  5571. PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
  5572. PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
  5573. #undef PUT_TIDVAL_U64
  5574. if ((tidstats->filled &
  5575. BIT(NL80211_TID_STATS_TXQ_STATS)) &&
  5576. !nl80211_put_txq_stats(msg, &tidstats->txq_stats,
  5577. NL80211_TID_STATS_TXQ_STATS))
  5578. goto nla_put_failure;
  5579. nla_nest_end(msg, tidattr);
  5580. }
  5581. nla_nest_end(msg, tidsattr);
  5582. }
  5583. nla_nest_end(msg, sinfoattr);
  5584. if (sinfo->assoc_req_ies_len &&
  5585. nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
  5586. sinfo->assoc_req_ies))
  5587. goto nla_put_failure;
  5588. if (sinfo->assoc_resp_ies_len &&
  5589. nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len,
  5590. sinfo->assoc_resp_ies))
  5591. goto nla_put_failure;
  5592. if (sinfo->mlo_params_valid) {
  5593. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID,
  5594. sinfo->assoc_link_id))
  5595. goto nla_put_failure;
  5596. if (!is_zero_ether_addr(sinfo->mld_addr) &&
  5597. nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN,
  5598. sinfo->mld_addr))
  5599. goto nla_put_failure;
  5600. }
  5601. cfg80211_sinfo_release_content(sinfo);
  5602. genlmsg_end(msg, hdr);
  5603. return 0;
  5604. nla_put_failure:
  5605. cfg80211_sinfo_release_content(sinfo);
  5606. genlmsg_cancel(msg, hdr);
  5607. return -EMSGSIZE;
  5608. }
  5609. static int nl80211_dump_station(struct sk_buff *skb,
  5610. struct netlink_callback *cb)
  5611. {
  5612. struct station_info sinfo;
  5613. struct cfg80211_registered_device *rdev;
  5614. struct wireless_dev *wdev;
  5615. u8 mac_addr[ETH_ALEN];
  5616. int sta_idx = cb->args[2];
  5617. int err;
  5618. err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
  5619. if (err)
  5620. return err;
  5621. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  5622. __acquire(&rdev->wiphy.mtx);
  5623. if (!wdev->netdev) {
  5624. err = -EINVAL;
  5625. goto out_err;
  5626. }
  5627. if (!rdev->ops->dump_station) {
  5628. err = -EOPNOTSUPP;
  5629. goto out_err;
  5630. }
  5631. while (1) {
  5632. memset(&sinfo, 0, sizeof(sinfo));
  5633. err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
  5634. mac_addr, &sinfo);
  5635. if (err == -ENOENT)
  5636. break;
  5637. if (err)
  5638. goto out_err;
  5639. if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
  5640. NETLINK_CB(cb->skb).portid,
  5641. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  5642. rdev, wdev->netdev, mac_addr,
  5643. &sinfo) < 0)
  5644. goto out;
  5645. sta_idx++;
  5646. }
  5647. out:
  5648. cb->args[2] = sta_idx;
  5649. err = skb->len;
  5650. out_err:
  5651. wiphy_unlock(&rdev->wiphy);
  5652. return err;
  5653. }
  5654. static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
  5655. {
  5656. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5657. struct net_device *dev = info->user_ptr[1];
  5658. struct station_info sinfo;
  5659. struct sk_buff *msg;
  5660. u8 *mac_addr = NULL;
  5661. int err;
  5662. memset(&sinfo, 0, sizeof(sinfo));
  5663. if (!info->attrs[NL80211_ATTR_MAC])
  5664. return -EINVAL;
  5665. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5666. if (!rdev->ops->get_station)
  5667. return -EOPNOTSUPP;
  5668. err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
  5669. if (err)
  5670. return err;
  5671. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  5672. if (!msg) {
  5673. cfg80211_sinfo_release_content(&sinfo);
  5674. return -ENOMEM;
  5675. }
  5676. if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
  5677. info->snd_portid, info->snd_seq, 0,
  5678. rdev, dev, mac_addr, &sinfo) < 0) {
  5679. nlmsg_free(msg);
  5680. return -ENOBUFS;
  5681. }
  5682. return genlmsg_reply(msg, info);
  5683. }
  5684. int cfg80211_check_station_change(struct wiphy *wiphy,
  5685. struct station_parameters *params,
  5686. enum cfg80211_station_type statype)
  5687. {
  5688. if (params->listen_interval != -1 &&
  5689. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  5690. return -EINVAL;
  5691. if (params->support_p2p_ps != -1 &&
  5692. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  5693. return -EINVAL;
  5694. if (params->aid &&
  5695. !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
  5696. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  5697. return -EINVAL;
  5698. /* When you run into this, adjust the code below for the new flag */
  5699. BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
  5700. switch (statype) {
  5701. case CFG80211_STA_MESH_PEER_KERNEL:
  5702. case CFG80211_STA_MESH_PEER_USER:
  5703. /*
  5704. * No ignoring the TDLS flag here -- the userspace mesh
  5705. * code doesn't have the bug of including TDLS in the
  5706. * mask everywhere.
  5707. */
  5708. if (params->sta_flags_mask &
  5709. ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  5710. BIT(NL80211_STA_FLAG_MFP) |
  5711. BIT(NL80211_STA_FLAG_AUTHORIZED)))
  5712. return -EINVAL;
  5713. break;
  5714. case CFG80211_STA_TDLS_PEER_SETUP:
  5715. case CFG80211_STA_TDLS_PEER_ACTIVE:
  5716. if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
  5717. return -EINVAL;
  5718. /* ignore since it can't change */
  5719. params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  5720. break;
  5721. default:
  5722. /* disallow mesh-specific things */
  5723. if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
  5724. return -EINVAL;
  5725. if (params->local_pm)
  5726. return -EINVAL;
  5727. if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
  5728. return -EINVAL;
  5729. }
  5730. if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
  5731. statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
  5732. /* TDLS can't be set, ... */
  5733. if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
  5734. return -EINVAL;
  5735. /*
  5736. * ... but don't bother the driver with it. This works around
  5737. * a hostapd/wpa_supplicant issue -- it always includes the
  5738. * TLDS_PEER flag in the mask even for AP mode.
  5739. */
  5740. params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  5741. }
  5742. if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
  5743. statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
  5744. /* reject other things that can't change */
  5745. if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
  5746. return -EINVAL;
  5747. if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
  5748. return -EINVAL;
  5749. if (params->link_sta_params.supported_rates)
  5750. return -EINVAL;
  5751. if (params->ext_capab || params->link_sta_params.ht_capa ||
  5752. params->link_sta_params.vht_capa ||
  5753. params->link_sta_params.he_capa ||
  5754. params->link_sta_params.eht_capa)
  5755. return -EINVAL;
  5756. }
  5757. if (statype != CFG80211_STA_AP_CLIENT &&
  5758. statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
  5759. if (params->vlan)
  5760. return -EINVAL;
  5761. }
  5762. switch (statype) {
  5763. case CFG80211_STA_AP_MLME_CLIENT:
  5764. /* Use this only for authorizing/unauthorizing a station */
  5765. if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
  5766. return -EOPNOTSUPP;
  5767. break;
  5768. case CFG80211_STA_AP_CLIENT:
  5769. case CFG80211_STA_AP_CLIENT_UNASSOC:
  5770. /* accept only the listed bits */
  5771. if (params->sta_flags_mask &
  5772. ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
  5773. BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  5774. BIT(NL80211_STA_FLAG_ASSOCIATED) |
  5775. BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
  5776. BIT(NL80211_STA_FLAG_WME) |
  5777. BIT(NL80211_STA_FLAG_MFP)))
  5778. return -EINVAL;
  5779. /* but authenticated/associated only if driver handles it */
  5780. if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
  5781. params->sta_flags_mask &
  5782. (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  5783. BIT(NL80211_STA_FLAG_ASSOCIATED)))
  5784. return -EINVAL;
  5785. break;
  5786. case CFG80211_STA_IBSS:
  5787. case CFG80211_STA_AP_STA:
  5788. /* reject any changes other than AUTHORIZED */
  5789. if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
  5790. return -EINVAL;
  5791. break;
  5792. case CFG80211_STA_TDLS_PEER_SETUP:
  5793. /* reject any changes other than AUTHORIZED or WME */
  5794. if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
  5795. BIT(NL80211_STA_FLAG_WME)))
  5796. return -EINVAL;
  5797. /* force (at least) rates when authorizing */
  5798. if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
  5799. !params->link_sta_params.supported_rates)
  5800. return -EINVAL;
  5801. break;
  5802. case CFG80211_STA_TDLS_PEER_ACTIVE:
  5803. /* reject any changes */
  5804. return -EINVAL;
  5805. case CFG80211_STA_MESH_PEER_KERNEL:
  5806. if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
  5807. return -EINVAL;
  5808. break;
  5809. case CFG80211_STA_MESH_PEER_USER:
  5810. if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
  5811. params->plink_action != NL80211_PLINK_ACTION_BLOCK)
  5812. return -EINVAL;
  5813. break;
  5814. }
  5815. /*
  5816. * Older kernel versions ignored this attribute entirely, so don't
  5817. * reject attempts to update it but mark it as unused instead so the
  5818. * driver won't look at the data.
  5819. */
  5820. if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
  5821. statype != CFG80211_STA_TDLS_PEER_SETUP)
  5822. params->link_sta_params.opmode_notif_used = false;
  5823. return 0;
  5824. }
  5825. EXPORT_SYMBOL(cfg80211_check_station_change);
  5826. /*
  5827. * Get vlan interface making sure it is running and on the right wiphy.
  5828. */
  5829. static struct net_device *get_vlan(struct genl_info *info,
  5830. struct cfg80211_registered_device *rdev)
  5831. {
  5832. struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
  5833. struct net_device *v;
  5834. int ret;
  5835. if (!vlanattr)
  5836. return NULL;
  5837. v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
  5838. if (!v)
  5839. return ERR_PTR(-ENODEV);
  5840. if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
  5841. ret = -EINVAL;
  5842. goto error;
  5843. }
  5844. if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  5845. v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  5846. v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  5847. ret = -EINVAL;
  5848. goto error;
  5849. }
  5850. if (!netif_running(v)) {
  5851. ret = -ENETDOWN;
  5852. goto error;
  5853. }
  5854. return v;
  5855. error:
  5856. dev_put(v);
  5857. return ERR_PTR(ret);
  5858. }
  5859. static int nl80211_parse_sta_wme(struct genl_info *info,
  5860. struct station_parameters *params)
  5861. {
  5862. struct nlattr *tb[NL80211_STA_WME_MAX + 1];
  5863. struct nlattr *nla;
  5864. int err;
  5865. /* parse WME attributes if present */
  5866. if (!info->attrs[NL80211_ATTR_STA_WME])
  5867. return 0;
  5868. nla = info->attrs[NL80211_ATTR_STA_WME];
  5869. err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla,
  5870. nl80211_sta_wme_policy,
  5871. info->extack);
  5872. if (err)
  5873. return err;
  5874. if (tb[NL80211_STA_WME_UAPSD_QUEUES])
  5875. params->uapsd_queues = nla_get_u8(
  5876. tb[NL80211_STA_WME_UAPSD_QUEUES]);
  5877. if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
  5878. return -EINVAL;
  5879. if (tb[NL80211_STA_WME_MAX_SP])
  5880. params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
  5881. if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
  5882. return -EINVAL;
  5883. params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
  5884. return 0;
  5885. }
  5886. static int nl80211_parse_sta_channel_info(struct genl_info *info,
  5887. struct station_parameters *params)
  5888. {
  5889. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
  5890. params->supported_channels =
  5891. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
  5892. params->supported_channels_len =
  5893. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
  5894. /*
  5895. * Need to include at least one (first channel, number of
  5896. * channels) tuple for each subband (checked in policy),
  5897. * and must have proper tuples for the rest of the data as well.
  5898. */
  5899. if (params->supported_channels_len % 2)
  5900. return -EINVAL;
  5901. }
  5902. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
  5903. params->supported_oper_classes =
  5904. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
  5905. params->supported_oper_classes_len =
  5906. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
  5907. }
  5908. return 0;
  5909. }
  5910. static int nl80211_set_station_tdls(struct genl_info *info,
  5911. struct station_parameters *params)
  5912. {
  5913. int err;
  5914. /* Dummy STA entry gets updated once the peer capabilities are known */
  5915. if (info->attrs[NL80211_ATTR_PEER_AID])
  5916. params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
  5917. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  5918. params->link_sta_params.ht_capa =
  5919. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  5920. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  5921. params->link_sta_params.vht_capa =
  5922. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  5923. if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
  5924. params->link_sta_params.he_capa =
  5925. nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  5926. params->link_sta_params.he_capa_len =
  5927. nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  5928. if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
  5929. params->link_sta_params.eht_capa =
  5930. nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  5931. params->link_sta_params.eht_capa_len =
  5932. nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  5933. if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa,
  5934. (const u8 *)params->link_sta_params.eht_capa,
  5935. params->link_sta_params.eht_capa_len,
  5936. false))
  5937. return -EINVAL;
  5938. }
  5939. }
  5940. err = nl80211_parse_sta_channel_info(info, params);
  5941. if (err)
  5942. return err;
  5943. return nl80211_parse_sta_wme(info, params);
  5944. }
  5945. static int nl80211_parse_sta_txpower_setting(struct genl_info *info,
  5946. struct sta_txpwr *txpwr,
  5947. bool *txpwr_set)
  5948. {
  5949. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5950. int idx;
  5951. if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) {
  5952. if (!rdev->ops->set_tx_power ||
  5953. !wiphy_ext_feature_isset(&rdev->wiphy,
  5954. NL80211_EXT_FEATURE_STA_TX_PWR))
  5955. return -EOPNOTSUPP;
  5956. idx = NL80211_ATTR_STA_TX_POWER_SETTING;
  5957. txpwr->type = nla_get_u8(info->attrs[idx]);
  5958. if (txpwr->type == NL80211_TX_POWER_LIMITED) {
  5959. idx = NL80211_ATTR_STA_TX_POWER;
  5960. if (info->attrs[idx])
  5961. txpwr->power = nla_get_s16(info->attrs[idx]);
  5962. else
  5963. return -EINVAL;
  5964. }
  5965. *txpwr_set = true;
  5966. } else {
  5967. *txpwr_set = false;
  5968. }
  5969. return 0;
  5970. }
  5971. static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
  5972. {
  5973. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5974. struct net_device *dev = info->user_ptr[1];
  5975. struct station_parameters params;
  5976. u8 *mac_addr;
  5977. int err;
  5978. memset(&params, 0, sizeof(params));
  5979. if (!rdev->ops->change_station)
  5980. return -EOPNOTSUPP;
  5981. /*
  5982. * AID and listen_interval properties can be set only for unassociated
  5983. * station. Include these parameters here and will check them in
  5984. * cfg80211_check_station_change().
  5985. */
  5986. if (info->attrs[NL80211_ATTR_STA_AID])
  5987. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
  5988. if (info->attrs[NL80211_ATTR_VLAN_ID])
  5989. params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
  5990. if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  5991. params.listen_interval =
  5992. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  5993. else
  5994. params.listen_interval = -1;
  5995. if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS])
  5996. params.support_p2p_ps =
  5997. nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
  5998. else
  5999. params.support_p2p_ps = -1;
  6000. if (!info->attrs[NL80211_ATTR_MAC])
  6001. return -EINVAL;
  6002. params.link_sta_params.link_id =
  6003. nl80211_link_id_or_invalid(info->attrs);
  6004. if (info->attrs[NL80211_ATTR_MLD_ADDR]) {
  6005. /* If MLD_ADDR attribute is set then this is an MLD station
  6006. * and the MLD_ADDR attribute holds the MLD address and the
  6007. * MAC attribute holds for the LINK address.
  6008. * In that case, the link_id is also expected to be valid.
  6009. */
  6010. if (params.link_sta_params.link_id < 0)
  6011. return -EINVAL;
  6012. mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  6013. params.link_sta_params.mld_mac = mac_addr;
  6014. params.link_sta_params.link_mac =
  6015. nla_data(info->attrs[NL80211_ATTR_MAC]);
  6016. if (!is_valid_ether_addr(params.link_sta_params.link_mac))
  6017. return -EINVAL;
  6018. } else {
  6019. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6020. }
  6021. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
  6022. params.link_sta_params.supported_rates =
  6023. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  6024. params.link_sta_params.supported_rates_len =
  6025. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  6026. }
  6027. if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
  6028. params.capability =
  6029. nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
  6030. params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
  6031. }
  6032. if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
  6033. params.ext_capab =
  6034. nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  6035. params.ext_capab_len =
  6036. nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  6037. }
  6038. if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
  6039. return -EINVAL;
  6040. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
  6041. params.plink_action =
  6042. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  6043. if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
  6044. params.plink_state =
  6045. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
  6046. if (info->attrs[NL80211_ATTR_MESH_PEER_AID])
  6047. params.peer_aid = nla_get_u16(
  6048. info->attrs[NL80211_ATTR_MESH_PEER_AID]);
  6049. params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
  6050. }
  6051. if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE])
  6052. params.local_pm = nla_get_u32(
  6053. info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
  6054. if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
  6055. params.link_sta_params.opmode_notif_used = true;
  6056. params.link_sta_params.opmode_notif =
  6057. nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
  6058. }
  6059. if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
  6060. params.link_sta_params.he_6ghz_capa =
  6061. nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
  6062. if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
  6063. params.airtime_weight =
  6064. nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
  6065. if (params.airtime_weight &&
  6066. !wiphy_ext_feature_isset(&rdev->wiphy,
  6067. NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
  6068. return -EOPNOTSUPP;
  6069. err = nl80211_parse_sta_txpower_setting(info,
  6070. &params.link_sta_params.txpwr,
  6071. &params.link_sta_params.txpwr_set);
  6072. if (err)
  6073. return err;
  6074. /* Include parameters for TDLS peer (will check later) */
  6075. err = nl80211_set_station_tdls(info, &params);
  6076. if (err)
  6077. return err;
  6078. params.vlan = get_vlan(info, rdev);
  6079. if (IS_ERR(params.vlan))
  6080. return PTR_ERR(params.vlan);
  6081. switch (dev->ieee80211_ptr->iftype) {
  6082. case NL80211_IFTYPE_AP:
  6083. case NL80211_IFTYPE_AP_VLAN:
  6084. case NL80211_IFTYPE_P2P_GO:
  6085. case NL80211_IFTYPE_P2P_CLIENT:
  6086. case NL80211_IFTYPE_STATION:
  6087. case NL80211_IFTYPE_ADHOC:
  6088. case NL80211_IFTYPE_MESH_POINT:
  6089. break;
  6090. default:
  6091. err = -EOPNOTSUPP;
  6092. goto out_put_vlan;
  6093. }
  6094. /* driver will call cfg80211_check_station_change() */
  6095. wdev_lock(dev->ieee80211_ptr);
  6096. err = rdev_change_station(rdev, dev, mac_addr, &params);
  6097. wdev_unlock(dev->ieee80211_ptr);
  6098. out_put_vlan:
  6099. dev_put(params.vlan);
  6100. return err;
  6101. }
  6102. static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
  6103. {
  6104. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6105. int err;
  6106. struct net_device *dev = info->user_ptr[1];
  6107. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6108. struct station_parameters params;
  6109. u8 *mac_addr = NULL;
  6110. u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  6111. BIT(NL80211_STA_FLAG_ASSOCIATED);
  6112. memset(&params, 0, sizeof(params));
  6113. if (!rdev->ops->add_station)
  6114. return -EOPNOTSUPP;
  6115. if (!info->attrs[NL80211_ATTR_MAC])
  6116. return -EINVAL;
  6117. if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  6118. return -EINVAL;
  6119. if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
  6120. return -EINVAL;
  6121. if (!info->attrs[NL80211_ATTR_STA_AID] &&
  6122. !info->attrs[NL80211_ATTR_PEER_AID])
  6123. return -EINVAL;
  6124. params.link_sta_params.link_id =
  6125. nl80211_link_id_or_invalid(info->attrs);
  6126. if (info->attrs[NL80211_ATTR_MLD_ADDR]) {
  6127. mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  6128. params.link_sta_params.mld_mac = mac_addr;
  6129. params.link_sta_params.link_mac =
  6130. nla_data(info->attrs[NL80211_ATTR_MAC]);
  6131. if (!is_valid_ether_addr(params.link_sta_params.link_mac))
  6132. return -EINVAL;
  6133. } else {
  6134. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6135. }
  6136. params.link_sta_params.supported_rates =
  6137. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  6138. params.link_sta_params.supported_rates_len =
  6139. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  6140. params.listen_interval =
  6141. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  6142. if (info->attrs[NL80211_ATTR_VLAN_ID])
  6143. params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
  6144. if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
  6145. params.support_p2p_ps =
  6146. nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
  6147. } else {
  6148. /*
  6149. * if not specified, assume it's supported for P2P GO interface,
  6150. * and is NOT supported for AP interface
  6151. */
  6152. params.support_p2p_ps =
  6153. dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
  6154. }
  6155. if (info->attrs[NL80211_ATTR_PEER_AID])
  6156. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
  6157. else
  6158. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
  6159. if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
  6160. params.capability =
  6161. nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
  6162. params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
  6163. }
  6164. if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
  6165. params.ext_capab =
  6166. nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  6167. params.ext_capab_len =
  6168. nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  6169. }
  6170. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  6171. params.link_sta_params.ht_capa =
  6172. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  6173. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  6174. params.link_sta_params.vht_capa =
  6175. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  6176. if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
  6177. params.link_sta_params.he_capa =
  6178. nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  6179. params.link_sta_params.he_capa_len =
  6180. nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  6181. if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
  6182. params.link_sta_params.eht_capa =
  6183. nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  6184. params.link_sta_params.eht_capa_len =
  6185. nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  6186. if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa,
  6187. (const u8 *)params.link_sta_params.eht_capa,
  6188. params.link_sta_params.eht_capa_len,
  6189. false))
  6190. return -EINVAL;
  6191. }
  6192. }
  6193. if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
  6194. params.link_sta_params.he_6ghz_capa =
  6195. nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
  6196. if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
  6197. params.link_sta_params.opmode_notif_used = true;
  6198. params.link_sta_params.opmode_notif =
  6199. nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
  6200. }
  6201. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
  6202. params.plink_action =
  6203. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  6204. if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
  6205. params.airtime_weight =
  6206. nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
  6207. if (params.airtime_weight &&
  6208. !wiphy_ext_feature_isset(&rdev->wiphy,
  6209. NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
  6210. return -EOPNOTSUPP;
  6211. err = nl80211_parse_sta_txpower_setting(info,
  6212. &params.link_sta_params.txpwr,
  6213. &params.link_sta_params.txpwr_set);
  6214. if (err)
  6215. return err;
  6216. err = nl80211_parse_sta_channel_info(info, &params);
  6217. if (err)
  6218. return err;
  6219. err = nl80211_parse_sta_wme(info, &params);
  6220. if (err)
  6221. return err;
  6222. if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
  6223. return -EINVAL;
  6224. /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
  6225. * as userspace might just pass through the capabilities from the IEs
  6226. * directly, rather than enforcing this restriction and returning an
  6227. * error in this case.
  6228. */
  6229. if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
  6230. params.link_sta_params.ht_capa = NULL;
  6231. params.link_sta_params.vht_capa = NULL;
  6232. /* HE and EHT require WME */
  6233. if (params.link_sta_params.he_capa_len ||
  6234. params.link_sta_params.he_6ghz_capa ||
  6235. params.link_sta_params.eht_capa_len)
  6236. return -EINVAL;
  6237. }
  6238. /* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */
  6239. if (params.link_sta_params.he_6ghz_capa &&
  6240. (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa))
  6241. return -EINVAL;
  6242. /* When you run into this, adjust the code below for the new flag */
  6243. BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 7);
  6244. switch (dev->ieee80211_ptr->iftype) {
  6245. case NL80211_IFTYPE_AP:
  6246. case NL80211_IFTYPE_AP_VLAN:
  6247. case NL80211_IFTYPE_P2P_GO:
  6248. /* ignore WME attributes if iface/sta is not capable */
  6249. if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
  6250. !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
  6251. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  6252. /* TDLS peers cannot be added */
  6253. if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
  6254. info->attrs[NL80211_ATTR_PEER_AID])
  6255. return -EINVAL;
  6256. /* but don't bother the driver with it */
  6257. params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  6258. /* allow authenticated/associated only if driver handles it */
  6259. if (!(rdev->wiphy.features &
  6260. NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
  6261. params.sta_flags_mask & auth_assoc)
  6262. return -EINVAL;
  6263. /* Older userspace, or userspace wanting to be compatible with
  6264. * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
  6265. * and assoc flags in the mask, but assumes the station will be
  6266. * added as associated anyway since this was the required driver
  6267. * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
  6268. * introduced.
  6269. * In order to not bother drivers with this quirk in the API
  6270. * set the flags in both the mask and set for new stations in
  6271. * this case.
  6272. */
  6273. if (!(params.sta_flags_mask & auth_assoc)) {
  6274. params.sta_flags_mask |= auth_assoc;
  6275. params.sta_flags_set |= auth_assoc;
  6276. }
  6277. /* must be last in here for error handling */
  6278. params.vlan = get_vlan(info, rdev);
  6279. if (IS_ERR(params.vlan))
  6280. return PTR_ERR(params.vlan);
  6281. break;
  6282. case NL80211_IFTYPE_MESH_POINT:
  6283. /* ignore uAPSD data */
  6284. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  6285. /* associated is disallowed */
  6286. if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
  6287. return -EINVAL;
  6288. /* TDLS peers cannot be added */
  6289. if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
  6290. info->attrs[NL80211_ATTR_PEER_AID])
  6291. return -EINVAL;
  6292. break;
  6293. case NL80211_IFTYPE_STATION:
  6294. case NL80211_IFTYPE_P2P_CLIENT:
  6295. /* ignore uAPSD data */
  6296. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  6297. /* these are disallowed */
  6298. if (params.sta_flags_mask &
  6299. (BIT(NL80211_STA_FLAG_ASSOCIATED) |
  6300. BIT(NL80211_STA_FLAG_AUTHENTICATED)))
  6301. return -EINVAL;
  6302. /* Only TDLS peers can be added */
  6303. if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
  6304. return -EINVAL;
  6305. /* Can only add if TDLS ... */
  6306. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
  6307. return -EOPNOTSUPP;
  6308. /* ... with external setup is supported */
  6309. if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
  6310. return -EOPNOTSUPP;
  6311. /*
  6312. * Older wpa_supplicant versions always mark the TDLS peer
  6313. * as authorized, but it shouldn't yet be.
  6314. */
  6315. params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
  6316. break;
  6317. default:
  6318. return -EOPNOTSUPP;
  6319. }
  6320. /* be aware of params.vlan when changing code here */
  6321. wdev_lock(dev->ieee80211_ptr);
  6322. if (wdev->valid_links) {
  6323. if (params.link_sta_params.link_id < 0) {
  6324. err = -EINVAL;
  6325. goto out;
  6326. }
  6327. if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) {
  6328. err = -ENOLINK;
  6329. goto out;
  6330. }
  6331. } else {
  6332. if (params.link_sta_params.link_id >= 0) {
  6333. err = -EINVAL;
  6334. goto out;
  6335. }
  6336. }
  6337. err = rdev_add_station(rdev, dev, mac_addr, &params);
  6338. out:
  6339. wdev_unlock(dev->ieee80211_ptr);
  6340. dev_put(params.vlan);
  6341. return err;
  6342. }
  6343. static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
  6344. {
  6345. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6346. struct net_device *dev = info->user_ptr[1];
  6347. struct station_del_parameters params;
  6348. int ret;
  6349. memset(&params, 0, sizeof(params));
  6350. if (info->attrs[NL80211_ATTR_MAC])
  6351. params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6352. switch (dev->ieee80211_ptr->iftype) {
  6353. case NL80211_IFTYPE_AP:
  6354. case NL80211_IFTYPE_AP_VLAN:
  6355. case NL80211_IFTYPE_MESH_POINT:
  6356. case NL80211_IFTYPE_P2P_GO:
  6357. /* always accept these */
  6358. break;
  6359. case NL80211_IFTYPE_ADHOC:
  6360. /* conditionally accept */
  6361. if (wiphy_ext_feature_isset(&rdev->wiphy,
  6362. NL80211_EXT_FEATURE_DEL_IBSS_STA))
  6363. break;
  6364. return -EINVAL;
  6365. default:
  6366. return -EINVAL;
  6367. }
  6368. if (!rdev->ops->del_station)
  6369. return -EOPNOTSUPP;
  6370. if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
  6371. params.subtype =
  6372. nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
  6373. if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
  6374. params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
  6375. return -EINVAL;
  6376. } else {
  6377. /* Default to Deauthentication frame */
  6378. params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
  6379. }
  6380. if (info->attrs[NL80211_ATTR_REASON_CODE]) {
  6381. params.reason_code =
  6382. nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  6383. if (params.reason_code == 0)
  6384. return -EINVAL; /* 0 is reserved */
  6385. } else {
  6386. /* Default to reason code 2 */
  6387. params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
  6388. }
  6389. wdev_lock(dev->ieee80211_ptr);
  6390. ret = rdev_del_station(rdev, dev, &params);
  6391. wdev_unlock(dev->ieee80211_ptr);
  6392. return ret;
  6393. }
  6394. static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
  6395. int flags, struct net_device *dev,
  6396. u8 *dst, u8 *next_hop,
  6397. struct mpath_info *pinfo)
  6398. {
  6399. void *hdr;
  6400. struct nlattr *pinfoattr;
  6401. hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
  6402. if (!hdr)
  6403. return -1;
  6404. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  6405. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
  6406. nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
  6407. nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
  6408. goto nla_put_failure;
  6409. pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO);
  6410. if (!pinfoattr)
  6411. goto nla_put_failure;
  6412. if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
  6413. nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
  6414. pinfo->frame_qlen))
  6415. goto nla_put_failure;
  6416. if (((pinfo->filled & MPATH_INFO_SN) &&
  6417. nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
  6418. ((pinfo->filled & MPATH_INFO_METRIC) &&
  6419. nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
  6420. pinfo->metric)) ||
  6421. ((pinfo->filled & MPATH_INFO_EXPTIME) &&
  6422. nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
  6423. pinfo->exptime)) ||
  6424. ((pinfo->filled & MPATH_INFO_FLAGS) &&
  6425. nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
  6426. pinfo->flags)) ||
  6427. ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
  6428. nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
  6429. pinfo->discovery_timeout)) ||
  6430. ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
  6431. nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
  6432. pinfo->discovery_retries)) ||
  6433. ((pinfo->filled & MPATH_INFO_HOP_COUNT) &&
  6434. nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT,
  6435. pinfo->hop_count)) ||
  6436. ((pinfo->filled & MPATH_INFO_PATH_CHANGE) &&
  6437. nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE,
  6438. pinfo->path_change_count)))
  6439. goto nla_put_failure;
  6440. nla_nest_end(msg, pinfoattr);
  6441. genlmsg_end(msg, hdr);
  6442. return 0;
  6443. nla_put_failure:
  6444. genlmsg_cancel(msg, hdr);
  6445. return -EMSGSIZE;
  6446. }
  6447. static int nl80211_dump_mpath(struct sk_buff *skb,
  6448. struct netlink_callback *cb)
  6449. {
  6450. struct mpath_info pinfo;
  6451. struct cfg80211_registered_device *rdev;
  6452. struct wireless_dev *wdev;
  6453. u8 dst[ETH_ALEN];
  6454. u8 next_hop[ETH_ALEN];
  6455. int path_idx = cb->args[2];
  6456. int err;
  6457. err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
  6458. if (err)
  6459. return err;
  6460. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  6461. __acquire(&rdev->wiphy.mtx);
  6462. if (!rdev->ops->dump_mpath) {
  6463. err = -EOPNOTSUPP;
  6464. goto out_err;
  6465. }
  6466. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
  6467. err = -EOPNOTSUPP;
  6468. goto out_err;
  6469. }
  6470. while (1) {
  6471. err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
  6472. next_hop, &pinfo);
  6473. if (err == -ENOENT)
  6474. break;
  6475. if (err)
  6476. goto out_err;
  6477. if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
  6478. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  6479. wdev->netdev, dst, next_hop,
  6480. &pinfo) < 0)
  6481. goto out;
  6482. path_idx++;
  6483. }
  6484. out:
  6485. cb->args[2] = path_idx;
  6486. err = skb->len;
  6487. out_err:
  6488. wiphy_unlock(&rdev->wiphy);
  6489. return err;
  6490. }
  6491. static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
  6492. {
  6493. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6494. int err;
  6495. struct net_device *dev = info->user_ptr[1];
  6496. struct mpath_info pinfo;
  6497. struct sk_buff *msg;
  6498. u8 *dst = NULL;
  6499. u8 next_hop[ETH_ALEN];
  6500. memset(&pinfo, 0, sizeof(pinfo));
  6501. if (!info->attrs[NL80211_ATTR_MAC])
  6502. return -EINVAL;
  6503. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6504. if (!rdev->ops->get_mpath)
  6505. return -EOPNOTSUPP;
  6506. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6507. return -EOPNOTSUPP;
  6508. err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
  6509. if (err)
  6510. return err;
  6511. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6512. if (!msg)
  6513. return -ENOMEM;
  6514. if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
  6515. dev, dst, next_hop, &pinfo) < 0) {
  6516. nlmsg_free(msg);
  6517. return -ENOBUFS;
  6518. }
  6519. return genlmsg_reply(msg, info);
  6520. }
  6521. static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
  6522. {
  6523. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6524. struct net_device *dev = info->user_ptr[1];
  6525. u8 *dst = NULL;
  6526. u8 *next_hop = NULL;
  6527. if (!info->attrs[NL80211_ATTR_MAC])
  6528. return -EINVAL;
  6529. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  6530. return -EINVAL;
  6531. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6532. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  6533. if (!rdev->ops->change_mpath)
  6534. return -EOPNOTSUPP;
  6535. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6536. return -EOPNOTSUPP;
  6537. return rdev_change_mpath(rdev, dev, dst, next_hop);
  6538. }
  6539. static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
  6540. {
  6541. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6542. struct net_device *dev = info->user_ptr[1];
  6543. u8 *dst = NULL;
  6544. u8 *next_hop = NULL;
  6545. if (!info->attrs[NL80211_ATTR_MAC])
  6546. return -EINVAL;
  6547. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  6548. return -EINVAL;
  6549. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6550. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  6551. if (!rdev->ops->add_mpath)
  6552. return -EOPNOTSUPP;
  6553. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6554. return -EOPNOTSUPP;
  6555. return rdev_add_mpath(rdev, dev, dst, next_hop);
  6556. }
  6557. static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
  6558. {
  6559. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6560. struct net_device *dev = info->user_ptr[1];
  6561. u8 *dst = NULL;
  6562. if (info->attrs[NL80211_ATTR_MAC])
  6563. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6564. if (!rdev->ops->del_mpath)
  6565. return -EOPNOTSUPP;
  6566. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6567. return -EOPNOTSUPP;
  6568. return rdev_del_mpath(rdev, dev, dst);
  6569. }
  6570. static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
  6571. {
  6572. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6573. int err;
  6574. struct net_device *dev = info->user_ptr[1];
  6575. struct mpath_info pinfo;
  6576. struct sk_buff *msg;
  6577. u8 *dst = NULL;
  6578. u8 mpp[ETH_ALEN];
  6579. memset(&pinfo, 0, sizeof(pinfo));
  6580. if (!info->attrs[NL80211_ATTR_MAC])
  6581. return -EINVAL;
  6582. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6583. if (!rdev->ops->get_mpp)
  6584. return -EOPNOTSUPP;
  6585. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6586. return -EOPNOTSUPP;
  6587. err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
  6588. if (err)
  6589. return err;
  6590. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6591. if (!msg)
  6592. return -ENOMEM;
  6593. if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
  6594. dev, dst, mpp, &pinfo) < 0) {
  6595. nlmsg_free(msg);
  6596. return -ENOBUFS;
  6597. }
  6598. return genlmsg_reply(msg, info);
  6599. }
  6600. static int nl80211_dump_mpp(struct sk_buff *skb,
  6601. struct netlink_callback *cb)
  6602. {
  6603. struct mpath_info pinfo;
  6604. struct cfg80211_registered_device *rdev;
  6605. struct wireless_dev *wdev;
  6606. u8 dst[ETH_ALEN];
  6607. u8 mpp[ETH_ALEN];
  6608. int path_idx = cb->args[2];
  6609. int err;
  6610. err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
  6611. if (err)
  6612. return err;
  6613. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  6614. __acquire(&rdev->wiphy.mtx);
  6615. if (!rdev->ops->dump_mpp) {
  6616. err = -EOPNOTSUPP;
  6617. goto out_err;
  6618. }
  6619. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
  6620. err = -EOPNOTSUPP;
  6621. goto out_err;
  6622. }
  6623. while (1) {
  6624. err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
  6625. mpp, &pinfo);
  6626. if (err == -ENOENT)
  6627. break;
  6628. if (err)
  6629. goto out_err;
  6630. if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
  6631. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  6632. wdev->netdev, dst, mpp,
  6633. &pinfo) < 0)
  6634. goto out;
  6635. path_idx++;
  6636. }
  6637. out:
  6638. cb->args[2] = path_idx;
  6639. err = skb->len;
  6640. out_err:
  6641. wiphy_unlock(&rdev->wiphy);
  6642. return err;
  6643. }
  6644. static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
  6645. {
  6646. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6647. struct net_device *dev = info->user_ptr[1];
  6648. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6649. struct bss_parameters params;
  6650. int err;
  6651. memset(&params, 0, sizeof(params));
  6652. params.link_id = nl80211_link_id_or_invalid(info->attrs);
  6653. /* default to not changing parameters */
  6654. params.use_cts_prot = -1;
  6655. params.use_short_preamble = -1;
  6656. params.use_short_slot_time = -1;
  6657. params.ap_isolate = -1;
  6658. params.ht_opmode = -1;
  6659. params.p2p_ctwindow = -1;
  6660. params.p2p_opp_ps = -1;
  6661. if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
  6662. params.use_cts_prot =
  6663. nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
  6664. if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
  6665. params.use_short_preamble =
  6666. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
  6667. if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
  6668. params.use_short_slot_time =
  6669. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
  6670. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  6671. params.basic_rates =
  6672. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  6673. params.basic_rates_len =
  6674. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  6675. }
  6676. if (info->attrs[NL80211_ATTR_AP_ISOLATE])
  6677. params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
  6678. if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
  6679. params.ht_opmode =
  6680. nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
  6681. if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
  6682. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  6683. return -EINVAL;
  6684. params.p2p_ctwindow =
  6685. nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
  6686. if (params.p2p_ctwindow != 0 &&
  6687. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
  6688. return -EINVAL;
  6689. }
  6690. if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
  6691. u8 tmp;
  6692. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  6693. return -EINVAL;
  6694. tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
  6695. params.p2p_opp_ps = tmp;
  6696. if (params.p2p_opp_ps &&
  6697. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
  6698. return -EINVAL;
  6699. }
  6700. if (!rdev->ops->change_bss)
  6701. return -EOPNOTSUPP;
  6702. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  6703. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  6704. return -EOPNOTSUPP;
  6705. wdev_lock(wdev);
  6706. err = rdev_change_bss(rdev, dev, &params);
  6707. wdev_unlock(wdev);
  6708. return err;
  6709. }
  6710. static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
  6711. {
  6712. char *data = NULL;
  6713. bool is_indoor;
  6714. enum nl80211_user_reg_hint_type user_reg_hint_type;
  6715. u32 owner_nlportid;
  6716. /*
  6717. * You should only get this when cfg80211 hasn't yet initialized
  6718. * completely when built-in to the kernel right between the time
  6719. * window between nl80211_init() and regulatory_init(), if that is
  6720. * even possible.
  6721. */
  6722. if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
  6723. return -EINPROGRESS;
  6724. if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
  6725. user_reg_hint_type =
  6726. nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
  6727. else
  6728. user_reg_hint_type = NL80211_USER_REG_HINT_USER;
  6729. switch (user_reg_hint_type) {
  6730. case NL80211_USER_REG_HINT_USER:
  6731. case NL80211_USER_REG_HINT_CELL_BASE:
  6732. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  6733. return -EINVAL;
  6734. data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  6735. return regulatory_hint_user(data, user_reg_hint_type);
  6736. case NL80211_USER_REG_HINT_INDOOR:
  6737. if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  6738. owner_nlportid = info->snd_portid;
  6739. is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
  6740. } else {
  6741. owner_nlportid = 0;
  6742. is_indoor = true;
  6743. }
  6744. return regulatory_hint_indoor(is_indoor, owner_nlportid);
  6745. default:
  6746. return -EINVAL;
  6747. }
  6748. }
  6749. static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
  6750. {
  6751. return reg_reload_regdb();
  6752. }
  6753. static int nl80211_get_mesh_config(struct sk_buff *skb,
  6754. struct genl_info *info)
  6755. {
  6756. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6757. struct net_device *dev = info->user_ptr[1];
  6758. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6759. struct mesh_config cur_params;
  6760. int err = 0;
  6761. void *hdr;
  6762. struct nlattr *pinfoattr;
  6763. struct sk_buff *msg;
  6764. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  6765. return -EOPNOTSUPP;
  6766. if (!rdev->ops->get_mesh_config)
  6767. return -EOPNOTSUPP;
  6768. wdev_lock(wdev);
  6769. /* If not connected, get default parameters */
  6770. if (!wdev->u.mesh.id_len)
  6771. memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
  6772. else
  6773. err = rdev_get_mesh_config(rdev, dev, &cur_params);
  6774. wdev_unlock(wdev);
  6775. if (err)
  6776. return err;
  6777. /* Draw up a netlink message to send back */
  6778. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6779. if (!msg)
  6780. return -ENOMEM;
  6781. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  6782. NL80211_CMD_GET_MESH_CONFIG);
  6783. if (!hdr)
  6784. goto out;
  6785. pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG);
  6786. if (!pinfoattr)
  6787. goto nla_put_failure;
  6788. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  6789. nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
  6790. cur_params.dot11MeshRetryTimeout) ||
  6791. nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
  6792. cur_params.dot11MeshConfirmTimeout) ||
  6793. nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
  6794. cur_params.dot11MeshHoldingTimeout) ||
  6795. nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
  6796. cur_params.dot11MeshMaxPeerLinks) ||
  6797. nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
  6798. cur_params.dot11MeshMaxRetries) ||
  6799. nla_put_u8(msg, NL80211_MESHCONF_TTL,
  6800. cur_params.dot11MeshTTL) ||
  6801. nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
  6802. cur_params.element_ttl) ||
  6803. nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  6804. cur_params.auto_open_plinks) ||
  6805. nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
  6806. cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
  6807. nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  6808. cur_params.dot11MeshHWMPmaxPREQretries) ||
  6809. nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
  6810. cur_params.path_refresh_time) ||
  6811. nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  6812. cur_params.min_discovery_timeout) ||
  6813. nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  6814. cur_params.dot11MeshHWMPactivePathTimeout) ||
  6815. nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  6816. cur_params.dot11MeshHWMPpreqMinInterval) ||
  6817. nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
  6818. cur_params.dot11MeshHWMPperrMinInterval) ||
  6819. nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  6820. cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
  6821. nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
  6822. cur_params.dot11MeshHWMPRootMode) ||
  6823. nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
  6824. cur_params.dot11MeshHWMPRannInterval) ||
  6825. nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
  6826. cur_params.dot11MeshGateAnnouncementProtocol) ||
  6827. nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
  6828. cur_params.dot11MeshForwarding) ||
  6829. nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
  6830. cur_params.rssi_threshold) ||
  6831. nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
  6832. cur_params.ht_opmode) ||
  6833. nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
  6834. cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
  6835. nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
  6836. cur_params.dot11MeshHWMProotInterval) ||
  6837. nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
  6838. cur_params.dot11MeshHWMPconfirmationInterval) ||
  6839. nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
  6840. cur_params.power_mode) ||
  6841. nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
  6842. cur_params.dot11MeshAwakeWindowDuration) ||
  6843. nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
  6844. cur_params.plink_timeout) ||
  6845. nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE,
  6846. cur_params.dot11MeshConnectedToMeshGate) ||
  6847. nla_put_u8(msg, NL80211_MESHCONF_NOLEARN,
  6848. cur_params.dot11MeshNolearn) ||
  6849. nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS,
  6850. cur_params.dot11MeshConnectedToAuthServer))
  6851. goto nla_put_failure;
  6852. nla_nest_end(msg, pinfoattr);
  6853. genlmsg_end(msg, hdr);
  6854. return genlmsg_reply(msg, info);
  6855. nla_put_failure:
  6856. out:
  6857. nlmsg_free(msg);
  6858. return -ENOBUFS;
  6859. }
  6860. static const struct nla_policy
  6861. nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
  6862. [NL80211_MESHCONF_RETRY_TIMEOUT] =
  6863. NLA_POLICY_RANGE(NLA_U16, 1, 255),
  6864. [NL80211_MESHCONF_CONFIRM_TIMEOUT] =
  6865. NLA_POLICY_RANGE(NLA_U16, 1, 255),
  6866. [NL80211_MESHCONF_HOLDING_TIMEOUT] =
  6867. NLA_POLICY_RANGE(NLA_U16, 1, 255),
  6868. [NL80211_MESHCONF_MAX_PEER_LINKS] =
  6869. NLA_POLICY_RANGE(NLA_U16, 0, 255),
  6870. [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16),
  6871. [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
  6872. [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
  6873. [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1),
  6874. [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] =
  6875. NLA_POLICY_RANGE(NLA_U32, 1, 255),
  6876. [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
  6877. [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
  6878. [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1),
  6879. [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
  6880. [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] =
  6881. NLA_POLICY_MIN(NLA_U16, 1),
  6882. [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] =
  6883. NLA_POLICY_MIN(NLA_U16, 1),
  6884. [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] =
  6885. NLA_POLICY_MIN(NLA_U16, 1),
  6886. [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4),
  6887. [NL80211_MESHCONF_HWMP_RANN_INTERVAL] =
  6888. NLA_POLICY_MIN(NLA_U16, 1),
  6889. [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1),
  6890. [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1),
  6891. [NL80211_MESHCONF_RSSI_THRESHOLD] =
  6892. NLA_POLICY_RANGE(NLA_S32, -255, 0),
  6893. [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
  6894. [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
  6895. [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] =
  6896. NLA_POLICY_MIN(NLA_U16, 1),
  6897. [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] =
  6898. NLA_POLICY_MIN(NLA_U16, 1),
  6899. [NL80211_MESHCONF_POWER_MODE] =
  6900. NLA_POLICY_RANGE(NLA_U32,
  6901. NL80211_MESH_POWER_ACTIVE,
  6902. NL80211_MESH_POWER_MAX),
  6903. [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
  6904. [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
  6905. [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
  6906. [NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
  6907. [NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
  6908. };
  6909. static const struct nla_policy
  6910. nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
  6911. [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
  6912. [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
  6913. [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
  6914. [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
  6915. [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
  6916. [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
  6917. [NL80211_MESH_SETUP_IE] =
  6918. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
  6919. IEEE80211_MAX_DATA_LEN),
  6920. [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
  6921. };
  6922. static int nl80211_parse_mesh_config(struct genl_info *info,
  6923. struct mesh_config *cfg,
  6924. u32 *mask_out)
  6925. {
  6926. struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
  6927. u32 mask = 0;
  6928. u16 ht_opmode;
  6929. #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \
  6930. do { \
  6931. if (tb[attr]) { \
  6932. cfg->param = fn(tb[attr]); \
  6933. mask |= BIT((attr) - 1); \
  6934. } \
  6935. } while (0)
  6936. if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
  6937. return -EINVAL;
  6938. if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack))
  6939. return -EINVAL;
  6940. /* This makes sure that there aren't more than 32 mesh config
  6941. * parameters (otherwise our bitfield scheme would not work.) */
  6942. BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
  6943. /* Fill in the params struct */
  6944. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask,
  6945. NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
  6946. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask,
  6947. NL80211_MESHCONF_CONFIRM_TIMEOUT,
  6948. nla_get_u16);
  6949. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask,
  6950. NL80211_MESHCONF_HOLDING_TIMEOUT,
  6951. nla_get_u16);
  6952. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask,
  6953. NL80211_MESHCONF_MAX_PEER_LINKS,
  6954. nla_get_u16);
  6955. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask,
  6956. NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
  6957. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask,
  6958. NL80211_MESHCONF_TTL, nla_get_u8);
  6959. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask,
  6960. NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8);
  6961. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask,
  6962. NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  6963. nla_get_u8);
  6964. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
  6965. mask,
  6966. NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
  6967. nla_get_u32);
  6968. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask,
  6969. NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  6970. nla_get_u8);
  6971. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask,
  6972. NL80211_MESHCONF_PATH_REFRESH_TIME,
  6973. nla_get_u32);
  6974. if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) &&
  6975. (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535))
  6976. return -EINVAL;
  6977. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask,
  6978. NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  6979. nla_get_u16);
  6980. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
  6981. mask,
  6982. NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  6983. nla_get_u32);
  6984. if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) &&
  6985. (cfg->dot11MeshHWMPactivePathTimeout < 1 ||
  6986. cfg->dot11MeshHWMPactivePathTimeout > 65535))
  6987. return -EINVAL;
  6988. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask,
  6989. NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  6990. nla_get_u16);
  6991. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask,
  6992. NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
  6993. nla_get_u16);
  6994. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  6995. dot11MeshHWMPnetDiameterTraversalTime, mask,
  6996. NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  6997. nla_get_u16);
  6998. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask,
  6999. NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8);
  7000. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask,
  7001. NL80211_MESHCONF_HWMP_RANN_INTERVAL,
  7002. nla_get_u16);
  7003. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol,
  7004. mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
  7005. nla_get_u8);
  7006. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask,
  7007. NL80211_MESHCONF_FORWARDING, nla_get_u8);
  7008. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask,
  7009. NL80211_MESHCONF_RSSI_THRESHOLD,
  7010. nla_get_s32);
  7011. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask,
  7012. NL80211_MESHCONF_CONNECTED_TO_GATE,
  7013. nla_get_u8);
  7014. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask,
  7015. NL80211_MESHCONF_CONNECTED_TO_AS,
  7016. nla_get_u8);
  7017. /*
  7018. * Check HT operation mode based on
  7019. * IEEE 802.11-2016 9.4.2.57 HT Operation element.
  7020. */
  7021. if (tb[NL80211_MESHCONF_HT_OPMODE]) {
  7022. ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
  7023. if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
  7024. IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
  7025. IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
  7026. return -EINVAL;
  7027. /* NON_HT_STA bit is reserved, but some programs set it */
  7028. ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT;
  7029. cfg->ht_opmode = ht_opmode;
  7030. mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
  7031. }
  7032. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  7033. dot11MeshHWMPactivePathToRootTimeout, mask,
  7034. NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
  7035. nla_get_u32);
  7036. if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) &&
  7037. (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 ||
  7038. cfg->dot11MeshHWMPactivePathToRootTimeout > 65535))
  7039. return -EINVAL;
  7040. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask,
  7041. NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
  7042. nla_get_u16);
  7043. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval,
  7044. mask,
  7045. NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
  7046. nla_get_u16);
  7047. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask,
  7048. NL80211_MESHCONF_POWER_MODE, nla_get_u32);
  7049. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask,
  7050. NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16);
  7051. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask,
  7052. NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32);
  7053. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask,
  7054. NL80211_MESHCONF_NOLEARN, nla_get_u8);
  7055. if (mask_out)
  7056. *mask_out = mask;
  7057. return 0;
  7058. #undef FILL_IN_MESH_PARAM_IF_SET
  7059. }
  7060. static int nl80211_parse_mesh_setup(struct genl_info *info,
  7061. struct mesh_setup *setup)
  7062. {
  7063. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7064. struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
  7065. if (!info->attrs[NL80211_ATTR_MESH_SETUP])
  7066. return -EINVAL;
  7067. if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack))
  7068. return -EINVAL;
  7069. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
  7070. setup->sync_method =
  7071. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
  7072. IEEE80211_SYNC_METHOD_VENDOR :
  7073. IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
  7074. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
  7075. setup->path_sel_proto =
  7076. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
  7077. IEEE80211_PATH_PROTOCOL_VENDOR :
  7078. IEEE80211_PATH_PROTOCOL_HWMP;
  7079. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
  7080. setup->path_metric =
  7081. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
  7082. IEEE80211_PATH_METRIC_VENDOR :
  7083. IEEE80211_PATH_METRIC_AIRTIME;
  7084. if (tb[NL80211_MESH_SETUP_IE]) {
  7085. struct nlattr *ieattr =
  7086. tb[NL80211_MESH_SETUP_IE];
  7087. setup->ie = nla_data(ieattr);
  7088. setup->ie_len = nla_len(ieattr);
  7089. }
  7090. if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
  7091. !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
  7092. return -EINVAL;
  7093. setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
  7094. setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
  7095. setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
  7096. if (setup->is_secure)
  7097. setup->user_mpm = true;
  7098. if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
  7099. if (!setup->user_mpm)
  7100. return -EINVAL;
  7101. setup->auth_id =
  7102. nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
  7103. }
  7104. return 0;
  7105. }
  7106. static int nl80211_update_mesh_config(struct sk_buff *skb,
  7107. struct genl_info *info)
  7108. {
  7109. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7110. struct net_device *dev = info->user_ptr[1];
  7111. struct wireless_dev *wdev = dev->ieee80211_ptr;
  7112. struct mesh_config cfg = {};
  7113. u32 mask;
  7114. int err;
  7115. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  7116. return -EOPNOTSUPP;
  7117. if (!rdev->ops->update_mesh_config)
  7118. return -EOPNOTSUPP;
  7119. err = nl80211_parse_mesh_config(info, &cfg, &mask);
  7120. if (err)
  7121. return err;
  7122. wdev_lock(wdev);
  7123. if (!wdev->u.mesh.id_len)
  7124. err = -ENOLINK;
  7125. if (!err)
  7126. err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
  7127. wdev_unlock(wdev);
  7128. return err;
  7129. }
  7130. static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
  7131. struct sk_buff *msg)
  7132. {
  7133. struct nlattr *nl_reg_rules;
  7134. unsigned int i;
  7135. if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
  7136. (regdom->dfs_region &&
  7137. nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
  7138. goto nla_put_failure;
  7139. nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES);
  7140. if (!nl_reg_rules)
  7141. goto nla_put_failure;
  7142. for (i = 0; i < regdom->n_reg_rules; i++) {
  7143. struct nlattr *nl_reg_rule;
  7144. const struct ieee80211_reg_rule *reg_rule;
  7145. const struct ieee80211_freq_range *freq_range;
  7146. const struct ieee80211_power_rule *power_rule;
  7147. unsigned int max_bandwidth_khz;
  7148. reg_rule = &regdom->reg_rules[i];
  7149. freq_range = &reg_rule->freq_range;
  7150. power_rule = &reg_rule->power_rule;
  7151. nl_reg_rule = nla_nest_start_noflag(msg, i);
  7152. if (!nl_reg_rule)
  7153. goto nla_put_failure;
  7154. max_bandwidth_khz = freq_range->max_bandwidth_khz;
  7155. if (!max_bandwidth_khz)
  7156. max_bandwidth_khz = reg_get_max_bandwidth(regdom,
  7157. reg_rule);
  7158. if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
  7159. reg_rule->flags) ||
  7160. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
  7161. freq_range->start_freq_khz) ||
  7162. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
  7163. freq_range->end_freq_khz) ||
  7164. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
  7165. max_bandwidth_khz) ||
  7166. nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
  7167. power_rule->max_antenna_gain) ||
  7168. nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
  7169. power_rule->max_eirp) ||
  7170. nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
  7171. reg_rule->dfs_cac_ms))
  7172. goto nla_put_failure;
  7173. nla_nest_end(msg, nl_reg_rule);
  7174. }
  7175. nla_nest_end(msg, nl_reg_rules);
  7176. return 0;
  7177. nla_put_failure:
  7178. return -EMSGSIZE;
  7179. }
  7180. static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
  7181. {
  7182. const struct ieee80211_regdomain *regdom = NULL;
  7183. struct cfg80211_registered_device *rdev;
  7184. struct wiphy *wiphy = NULL;
  7185. struct sk_buff *msg;
  7186. int err = -EMSGSIZE;
  7187. void *hdr;
  7188. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7189. if (!msg)
  7190. return -ENOBUFS;
  7191. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  7192. NL80211_CMD_GET_REG);
  7193. if (!hdr)
  7194. goto put_failure;
  7195. rtnl_lock();
  7196. if (info->attrs[NL80211_ATTR_WIPHY]) {
  7197. bool self_managed;
  7198. rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
  7199. if (IS_ERR(rdev)) {
  7200. err = PTR_ERR(rdev);
  7201. goto nla_put_failure;
  7202. }
  7203. wiphy = &rdev->wiphy;
  7204. self_managed = wiphy->regulatory_flags &
  7205. REGULATORY_WIPHY_SELF_MANAGED;
  7206. rcu_read_lock();
  7207. regdom = get_wiphy_regdom(wiphy);
  7208. /* a self-managed-reg device must have a private regdom */
  7209. if (WARN_ON(!regdom && self_managed)) {
  7210. err = -EINVAL;
  7211. goto nla_put_failure_rcu;
  7212. }
  7213. if (regdom &&
  7214. nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  7215. goto nla_put_failure_rcu;
  7216. } else {
  7217. rcu_read_lock();
  7218. }
  7219. if (!wiphy && reg_last_request_cell_base() &&
  7220. nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
  7221. NL80211_USER_REG_HINT_CELL_BASE))
  7222. goto nla_put_failure_rcu;
  7223. if (!regdom)
  7224. regdom = rcu_dereference(cfg80211_regdomain);
  7225. if (nl80211_put_regdom(regdom, msg))
  7226. goto nla_put_failure_rcu;
  7227. rcu_read_unlock();
  7228. genlmsg_end(msg, hdr);
  7229. rtnl_unlock();
  7230. return genlmsg_reply(msg, info);
  7231. nla_put_failure_rcu:
  7232. rcu_read_unlock();
  7233. nla_put_failure:
  7234. rtnl_unlock();
  7235. put_failure:
  7236. nlmsg_free(msg);
  7237. return err;
  7238. }
  7239. static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
  7240. u32 seq, int flags, struct wiphy *wiphy,
  7241. const struct ieee80211_regdomain *regdom)
  7242. {
  7243. void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
  7244. NL80211_CMD_GET_REG);
  7245. if (!hdr)
  7246. return -1;
  7247. genl_dump_check_consistent(cb, hdr);
  7248. if (nl80211_put_regdom(regdom, msg))
  7249. goto nla_put_failure;
  7250. if (!wiphy && reg_last_request_cell_base() &&
  7251. nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
  7252. NL80211_USER_REG_HINT_CELL_BASE))
  7253. goto nla_put_failure;
  7254. if (wiphy &&
  7255. nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  7256. goto nla_put_failure;
  7257. if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  7258. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  7259. goto nla_put_failure;
  7260. genlmsg_end(msg, hdr);
  7261. return 0;
  7262. nla_put_failure:
  7263. genlmsg_cancel(msg, hdr);
  7264. return -EMSGSIZE;
  7265. }
  7266. static int nl80211_get_reg_dump(struct sk_buff *skb,
  7267. struct netlink_callback *cb)
  7268. {
  7269. const struct ieee80211_regdomain *regdom = NULL;
  7270. struct cfg80211_registered_device *rdev;
  7271. int err, reg_idx, start = cb->args[2];
  7272. rcu_read_lock();
  7273. if (cfg80211_regdomain && start == 0) {
  7274. err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
  7275. NLM_F_MULTI, NULL,
  7276. rcu_dereference(cfg80211_regdomain));
  7277. if (err < 0)
  7278. goto out_err;
  7279. }
  7280. /* the global regdom is idx 0 */
  7281. reg_idx = 1;
  7282. list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
  7283. regdom = get_wiphy_regdom(&rdev->wiphy);
  7284. if (!regdom)
  7285. continue;
  7286. if (++reg_idx <= start)
  7287. continue;
  7288. err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
  7289. NLM_F_MULTI, &rdev->wiphy, regdom);
  7290. if (err < 0) {
  7291. reg_idx--;
  7292. break;
  7293. }
  7294. }
  7295. cb->args[2] = reg_idx;
  7296. err = skb->len;
  7297. out_err:
  7298. rcu_read_unlock();
  7299. return err;
  7300. }
  7301. #ifdef CONFIG_CFG80211_CRDA_SUPPORT
  7302. static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
  7303. [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
  7304. [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
  7305. [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
  7306. [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
  7307. [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
  7308. [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
  7309. [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
  7310. };
  7311. static int parse_reg_rule(struct nlattr *tb[],
  7312. struct ieee80211_reg_rule *reg_rule)
  7313. {
  7314. struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
  7315. struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
  7316. if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
  7317. return -EINVAL;
  7318. if (!tb[NL80211_ATTR_FREQ_RANGE_START])
  7319. return -EINVAL;
  7320. if (!tb[NL80211_ATTR_FREQ_RANGE_END])
  7321. return -EINVAL;
  7322. if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
  7323. return -EINVAL;
  7324. if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
  7325. return -EINVAL;
  7326. reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
  7327. freq_range->start_freq_khz =
  7328. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
  7329. freq_range->end_freq_khz =
  7330. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
  7331. freq_range->max_bandwidth_khz =
  7332. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
  7333. power_rule->max_eirp =
  7334. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
  7335. if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
  7336. power_rule->max_antenna_gain =
  7337. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
  7338. if (tb[NL80211_ATTR_DFS_CAC_TIME])
  7339. reg_rule->dfs_cac_ms =
  7340. nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
  7341. return 0;
  7342. }
  7343. static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
  7344. {
  7345. struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
  7346. struct nlattr *nl_reg_rule;
  7347. char *alpha2;
  7348. int rem_reg_rules, r;
  7349. u32 num_rules = 0, rule_idx = 0;
  7350. enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
  7351. struct ieee80211_regdomain *rd;
  7352. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  7353. return -EINVAL;
  7354. if (!info->attrs[NL80211_ATTR_REG_RULES])
  7355. return -EINVAL;
  7356. alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  7357. if (info->attrs[NL80211_ATTR_DFS_REGION])
  7358. dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
  7359. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  7360. rem_reg_rules) {
  7361. num_rules++;
  7362. if (num_rules > NL80211_MAX_SUPP_REG_RULES)
  7363. return -EINVAL;
  7364. }
  7365. rtnl_lock();
  7366. if (!reg_is_valid_request(alpha2)) {
  7367. r = -EINVAL;
  7368. goto out;
  7369. }
  7370. rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL);
  7371. if (!rd) {
  7372. r = -ENOMEM;
  7373. goto out;
  7374. }
  7375. rd->n_reg_rules = num_rules;
  7376. rd->alpha2[0] = alpha2[0];
  7377. rd->alpha2[1] = alpha2[1];
  7378. /*
  7379. * Disable DFS master mode if the DFS region was
  7380. * not supported or known on this kernel.
  7381. */
  7382. if (reg_supported_dfs_region(dfs_region))
  7383. rd->dfs_region = dfs_region;
  7384. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  7385. rem_reg_rules) {
  7386. r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX,
  7387. nl_reg_rule, reg_rule_policy,
  7388. info->extack);
  7389. if (r)
  7390. goto bad_reg;
  7391. r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
  7392. if (r)
  7393. goto bad_reg;
  7394. rule_idx++;
  7395. if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
  7396. r = -EINVAL;
  7397. goto bad_reg;
  7398. }
  7399. }
  7400. r = set_regdom(rd, REGD_SOURCE_CRDA);
  7401. /* set_regdom takes ownership of rd */
  7402. rd = NULL;
  7403. bad_reg:
  7404. kfree(rd);
  7405. out:
  7406. rtnl_unlock();
  7407. return r;
  7408. }
  7409. #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
  7410. static int validate_scan_freqs(struct nlattr *freqs)
  7411. {
  7412. struct nlattr *attr1, *attr2;
  7413. int n_channels = 0, tmp1, tmp2;
  7414. nla_for_each_nested(attr1, freqs, tmp1)
  7415. if (nla_len(attr1) != sizeof(u32))
  7416. return 0;
  7417. nla_for_each_nested(attr1, freqs, tmp1) {
  7418. n_channels++;
  7419. /*
  7420. * Some hardware has a limited channel list for
  7421. * scanning, and it is pretty much nonsensical
  7422. * to scan for a channel twice, so disallow that
  7423. * and don't require drivers to check that the
  7424. * channel list they get isn't longer than what
  7425. * they can scan, as long as they can scan all
  7426. * the channels they registered at once.
  7427. */
  7428. nla_for_each_nested(attr2, freqs, tmp2)
  7429. if (attr1 != attr2 &&
  7430. nla_get_u32(attr1) == nla_get_u32(attr2))
  7431. return 0;
  7432. }
  7433. return n_channels;
  7434. }
  7435. static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
  7436. {
  7437. return b < NUM_NL80211_BANDS && wiphy->bands[b];
  7438. }
  7439. static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
  7440. struct cfg80211_bss_selection *bss_select)
  7441. {
  7442. struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
  7443. struct nlattr *nest;
  7444. int err;
  7445. bool found = false;
  7446. int i;
  7447. /* only process one nested attribute */
  7448. nest = nla_data(nla);
  7449. if (!nla_ok(nest, nla_len(nest)))
  7450. return -EINVAL;
  7451. err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX,
  7452. nest, nl80211_bss_select_policy,
  7453. NULL);
  7454. if (err)
  7455. return err;
  7456. /* only one attribute may be given */
  7457. for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
  7458. if (attr[i]) {
  7459. if (found)
  7460. return -EINVAL;
  7461. found = true;
  7462. }
  7463. }
  7464. bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
  7465. if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
  7466. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
  7467. if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
  7468. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
  7469. bss_select->param.band_pref =
  7470. nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
  7471. if (!is_band_valid(wiphy, bss_select->param.band_pref))
  7472. return -EINVAL;
  7473. }
  7474. if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
  7475. struct nl80211_bss_select_rssi_adjust *adj_param;
  7476. adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
  7477. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
  7478. bss_select->param.adjust.band = adj_param->band;
  7479. bss_select->param.adjust.delta = adj_param->delta;
  7480. if (!is_band_valid(wiphy, bss_select->param.adjust.band))
  7481. return -EINVAL;
  7482. }
  7483. /* user-space did not provide behaviour attribute */
  7484. if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
  7485. return -EINVAL;
  7486. if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
  7487. return -EINVAL;
  7488. return 0;
  7489. }
  7490. int nl80211_parse_random_mac(struct nlattr **attrs,
  7491. u8 *mac_addr, u8 *mac_addr_mask)
  7492. {
  7493. int i;
  7494. if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
  7495. eth_zero_addr(mac_addr);
  7496. eth_zero_addr(mac_addr_mask);
  7497. mac_addr[0] = 0x2;
  7498. mac_addr_mask[0] = 0x3;
  7499. return 0;
  7500. }
  7501. /* need both or none */
  7502. if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
  7503. return -EINVAL;
  7504. memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
  7505. memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
  7506. /* don't allow or configure an mcast address */
  7507. if (!is_multicast_ether_addr(mac_addr_mask) ||
  7508. is_multicast_ether_addr(mac_addr))
  7509. return -EINVAL;
  7510. /*
  7511. * allow users to pass a MAC address that has bits set outside
  7512. * of the mask, but don't bother drivers with having to deal
  7513. * with such bits
  7514. */
  7515. for (i = 0; i < ETH_ALEN; i++)
  7516. mac_addr[i] &= mac_addr_mask[i];
  7517. return 0;
  7518. }
  7519. static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev,
  7520. struct ieee80211_channel *chan)
  7521. {
  7522. unsigned int link_id;
  7523. bool all_ok = true;
  7524. ASSERT_WDEV_LOCK(wdev);
  7525. if (!cfg80211_beaconing_iface_active(wdev))
  7526. return true;
  7527. /*
  7528. * FIXME: check if we have a free HW resource/link for chan
  7529. *
  7530. * This, as well as the FIXME below, requires knowing the link
  7531. * capabilities of the hardware.
  7532. */
  7533. /* we cannot leave radar channels */
  7534. for_each_valid_link(wdev, link_id) {
  7535. struct cfg80211_chan_def *chandef;
  7536. chandef = wdev_chandef(wdev, link_id);
  7537. if (!chandef || !chandef->chan)
  7538. continue;
  7539. /*
  7540. * FIXME: don't require all_ok, but rather check only the
  7541. * correct HW resource/link onto which 'chan' falls,
  7542. * as only that link leaves the channel for doing
  7543. * the off-channel operation.
  7544. */
  7545. if (chandef->chan->flags & IEEE80211_CHAN_RADAR)
  7546. all_ok = false;
  7547. }
  7548. if (all_ok)
  7549. return true;
  7550. return regulatory_pre_cac_allowed(wdev->wiphy);
  7551. }
  7552. static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag,
  7553. enum nl80211_ext_feature_index feat)
  7554. {
  7555. if (!(flags & flag))
  7556. return true;
  7557. if (wiphy_ext_feature_isset(wiphy, feat))
  7558. return true;
  7559. return false;
  7560. }
  7561. static int
  7562. nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
  7563. void *request, struct nlattr **attrs,
  7564. bool is_sched_scan)
  7565. {
  7566. u8 *mac_addr, *mac_addr_mask;
  7567. u32 *flags;
  7568. enum nl80211_feature_flags randomness_flag;
  7569. if (!attrs[NL80211_ATTR_SCAN_FLAGS])
  7570. return 0;
  7571. if (is_sched_scan) {
  7572. struct cfg80211_sched_scan_request *req = request;
  7573. randomness_flag = wdev ?
  7574. NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
  7575. NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
  7576. flags = &req->flags;
  7577. mac_addr = req->mac_addr;
  7578. mac_addr_mask = req->mac_addr_mask;
  7579. } else {
  7580. struct cfg80211_scan_request *req = request;
  7581. randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
  7582. flags = &req->flags;
  7583. mac_addr = req->mac_addr;
  7584. mac_addr_mask = req->mac_addr_mask;
  7585. }
  7586. *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
  7587. if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
  7588. !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
  7589. !nl80211_check_scan_feat(wiphy, *flags,
  7590. NL80211_SCAN_FLAG_LOW_SPAN,
  7591. NL80211_EXT_FEATURE_LOW_SPAN_SCAN) ||
  7592. !nl80211_check_scan_feat(wiphy, *flags,
  7593. NL80211_SCAN_FLAG_LOW_POWER,
  7594. NL80211_EXT_FEATURE_LOW_POWER_SCAN) ||
  7595. !nl80211_check_scan_feat(wiphy, *flags,
  7596. NL80211_SCAN_FLAG_HIGH_ACCURACY,
  7597. NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) ||
  7598. !nl80211_check_scan_feat(wiphy, *flags,
  7599. NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME,
  7600. NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) ||
  7601. !nl80211_check_scan_feat(wiphy, *flags,
  7602. NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP,
  7603. NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) ||
  7604. !nl80211_check_scan_feat(wiphy, *flags,
  7605. NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION,
  7606. NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) ||
  7607. !nl80211_check_scan_feat(wiphy, *flags,
  7608. NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE,
  7609. NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) ||
  7610. !nl80211_check_scan_feat(wiphy, *flags,
  7611. NL80211_SCAN_FLAG_RANDOM_SN,
  7612. NL80211_EXT_FEATURE_SCAN_RANDOM_SN) ||
  7613. !nl80211_check_scan_feat(wiphy, *flags,
  7614. NL80211_SCAN_FLAG_MIN_PREQ_CONTENT,
  7615. NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT))
  7616. return -EOPNOTSUPP;
  7617. if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
  7618. int err;
  7619. if (!(wiphy->features & randomness_flag) ||
  7620. (wdev && wdev->connected))
  7621. return -EOPNOTSUPP;
  7622. err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
  7623. if (err)
  7624. return err;
  7625. }
  7626. return 0;
  7627. }
  7628. static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
  7629. {
  7630. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7631. struct wireless_dev *wdev = info->user_ptr[1];
  7632. struct cfg80211_scan_request *request;
  7633. struct nlattr *scan_freqs = NULL;
  7634. bool scan_freqs_khz = false;
  7635. struct nlattr *attr;
  7636. struct wiphy *wiphy;
  7637. int err, tmp, n_ssids = 0, n_channels, i;
  7638. size_t ie_len;
  7639. wiphy = &rdev->wiphy;
  7640. if (wdev->iftype == NL80211_IFTYPE_NAN)
  7641. return -EOPNOTSUPP;
  7642. if (!rdev->ops->scan)
  7643. return -EOPNOTSUPP;
  7644. if (rdev->scan_req || rdev->scan_msg)
  7645. return -EBUSY;
  7646. if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) {
  7647. if (!wiphy_ext_feature_isset(wiphy,
  7648. NL80211_EXT_FEATURE_SCAN_FREQ_KHZ))
  7649. return -EOPNOTSUPP;
  7650. scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ];
  7651. scan_freqs_khz = true;
  7652. } else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES])
  7653. scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES];
  7654. if (scan_freqs) {
  7655. n_channels = validate_scan_freqs(scan_freqs);
  7656. if (!n_channels)
  7657. return -EINVAL;
  7658. } else {
  7659. n_channels = ieee80211_get_num_supported_channels(wiphy);
  7660. }
  7661. if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
  7662. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
  7663. n_ssids++;
  7664. if (n_ssids > wiphy->max_scan_ssids)
  7665. return -EINVAL;
  7666. if (info->attrs[NL80211_ATTR_IE])
  7667. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7668. else
  7669. ie_len = 0;
  7670. if (ie_len > wiphy->max_scan_ie_len)
  7671. return -EINVAL;
  7672. request = kzalloc(sizeof(*request)
  7673. + sizeof(*request->ssids) * n_ssids
  7674. + sizeof(*request->channels) * n_channels
  7675. + ie_len, GFP_KERNEL);
  7676. if (!request)
  7677. return -ENOMEM;
  7678. if (n_ssids)
  7679. request->ssids = (void *)&request->channels[n_channels];
  7680. request->n_ssids = n_ssids;
  7681. if (ie_len) {
  7682. if (n_ssids)
  7683. request->ie = (void *)(request->ssids + n_ssids);
  7684. else
  7685. request->ie = (void *)(request->channels + n_channels);
  7686. }
  7687. i = 0;
  7688. if (scan_freqs) {
  7689. /* user specified, bail out if channel not found */
  7690. nla_for_each_nested(attr, scan_freqs, tmp) {
  7691. struct ieee80211_channel *chan;
  7692. int freq = nla_get_u32(attr);
  7693. if (!scan_freqs_khz)
  7694. freq = MHZ_TO_KHZ(freq);
  7695. chan = ieee80211_get_channel_khz(wiphy, freq);
  7696. if (!chan) {
  7697. err = -EINVAL;
  7698. goto out_free;
  7699. }
  7700. /* ignore disabled channels */
  7701. if (chan->flags & IEEE80211_CHAN_DISABLED)
  7702. continue;
  7703. request->channels[i] = chan;
  7704. i++;
  7705. }
  7706. } else {
  7707. enum nl80211_band band;
  7708. /* all channels */
  7709. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  7710. int j;
  7711. if (!wiphy->bands[band])
  7712. continue;
  7713. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  7714. struct ieee80211_channel *chan;
  7715. chan = &wiphy->bands[band]->channels[j];
  7716. if (chan->flags & IEEE80211_CHAN_DISABLED)
  7717. continue;
  7718. request->channels[i] = chan;
  7719. i++;
  7720. }
  7721. }
  7722. }
  7723. if (!i) {
  7724. err = -EINVAL;
  7725. goto out_free;
  7726. }
  7727. request->n_channels = i;
  7728. wdev_lock(wdev);
  7729. for (i = 0; i < request->n_channels; i++) {
  7730. struct ieee80211_channel *chan = request->channels[i];
  7731. /* if we can go off-channel to the target channel we're good */
  7732. if (cfg80211_off_channel_oper_allowed(wdev, chan))
  7733. continue;
  7734. if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) {
  7735. wdev_unlock(wdev);
  7736. err = -EBUSY;
  7737. goto out_free;
  7738. }
  7739. }
  7740. wdev_unlock(wdev);
  7741. i = 0;
  7742. if (n_ssids) {
  7743. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
  7744. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  7745. err = -EINVAL;
  7746. goto out_free;
  7747. }
  7748. request->ssids[i].ssid_len = nla_len(attr);
  7749. memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
  7750. i++;
  7751. }
  7752. }
  7753. if (info->attrs[NL80211_ATTR_IE]) {
  7754. request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7755. memcpy((void *)request->ie,
  7756. nla_data(info->attrs[NL80211_ATTR_IE]),
  7757. request->ie_len);
  7758. }
  7759. for (i = 0; i < NUM_NL80211_BANDS; i++)
  7760. if (wiphy->bands[i])
  7761. request->rates[i] =
  7762. (1 << wiphy->bands[i]->n_bitrates) - 1;
  7763. if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
  7764. nla_for_each_nested(attr,
  7765. info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
  7766. tmp) {
  7767. enum nl80211_band band = nla_type(attr);
  7768. if (band < 0 || band >= NUM_NL80211_BANDS) {
  7769. err = -EINVAL;
  7770. goto out_free;
  7771. }
  7772. if (!wiphy->bands[band])
  7773. continue;
  7774. err = ieee80211_get_ratemask(wiphy->bands[band],
  7775. nla_data(attr),
  7776. nla_len(attr),
  7777. &request->rates[band]);
  7778. if (err)
  7779. goto out_free;
  7780. }
  7781. }
  7782. if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
  7783. request->duration =
  7784. nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
  7785. request->duration_mandatory =
  7786. nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
  7787. }
  7788. err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
  7789. false);
  7790. if (err)
  7791. goto out_free;
  7792. request->no_cck =
  7793. nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
  7794. /* Initial implementation used NL80211_ATTR_MAC to set the specific
  7795. * BSSID to scan for. This was problematic because that same attribute
  7796. * was already used for another purpose (local random MAC address). The
  7797. * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
  7798. * compatibility with older userspace components, also use the
  7799. * NL80211_ATTR_MAC value here if it can be determined to be used for
  7800. * the specific BSSID use case instead of the random MAC address
  7801. * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
  7802. */
  7803. if (info->attrs[NL80211_ATTR_BSSID])
  7804. memcpy(request->bssid,
  7805. nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
  7806. else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
  7807. info->attrs[NL80211_ATTR_MAC])
  7808. memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
  7809. ETH_ALEN);
  7810. else
  7811. eth_broadcast_addr(request->bssid);
  7812. request->wdev = wdev;
  7813. request->wiphy = &rdev->wiphy;
  7814. request->scan_start = jiffies;
  7815. rdev->scan_req = request;
  7816. err = cfg80211_scan(rdev);
  7817. if (err)
  7818. goto out_free;
  7819. nl80211_send_scan_start(rdev, wdev);
  7820. dev_hold(wdev->netdev);
  7821. return 0;
  7822. out_free:
  7823. rdev->scan_req = NULL;
  7824. kfree(request);
  7825. return err;
  7826. }
  7827. static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
  7828. {
  7829. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7830. struct wireless_dev *wdev = info->user_ptr[1];
  7831. if (!rdev->ops->abort_scan)
  7832. return -EOPNOTSUPP;
  7833. if (rdev->scan_msg)
  7834. return 0;
  7835. if (!rdev->scan_req)
  7836. return -ENOENT;
  7837. rdev_abort_scan(rdev, wdev);
  7838. return 0;
  7839. }
  7840. static int
  7841. nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
  7842. struct cfg80211_sched_scan_request *request,
  7843. struct nlattr **attrs)
  7844. {
  7845. int tmp, err, i = 0;
  7846. struct nlattr *attr;
  7847. if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
  7848. u32 interval;
  7849. /*
  7850. * If scan plans are not specified,
  7851. * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
  7852. * case one scan plan will be set with the specified scan
  7853. * interval and infinite number of iterations.
  7854. */
  7855. interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
  7856. if (!interval)
  7857. return -EINVAL;
  7858. request->scan_plans[0].interval =
  7859. DIV_ROUND_UP(interval, MSEC_PER_SEC);
  7860. if (!request->scan_plans[0].interval)
  7861. return -EINVAL;
  7862. if (request->scan_plans[0].interval >
  7863. wiphy->max_sched_scan_plan_interval)
  7864. request->scan_plans[0].interval =
  7865. wiphy->max_sched_scan_plan_interval;
  7866. return 0;
  7867. }
  7868. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
  7869. struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
  7870. if (WARN_ON(i >= n_plans))
  7871. return -EINVAL;
  7872. err = nla_parse_nested_deprecated(plan,
  7873. NL80211_SCHED_SCAN_PLAN_MAX,
  7874. attr, nl80211_plan_policy,
  7875. NULL);
  7876. if (err)
  7877. return err;
  7878. if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
  7879. return -EINVAL;
  7880. request->scan_plans[i].interval =
  7881. nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
  7882. if (!request->scan_plans[i].interval ||
  7883. request->scan_plans[i].interval >
  7884. wiphy->max_sched_scan_plan_interval)
  7885. return -EINVAL;
  7886. if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
  7887. request->scan_plans[i].iterations =
  7888. nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
  7889. if (!request->scan_plans[i].iterations ||
  7890. (request->scan_plans[i].iterations >
  7891. wiphy->max_sched_scan_plan_iterations))
  7892. return -EINVAL;
  7893. } else if (i < n_plans - 1) {
  7894. /*
  7895. * All scan plans but the last one must specify
  7896. * a finite number of iterations
  7897. */
  7898. return -EINVAL;
  7899. }
  7900. i++;
  7901. }
  7902. /*
  7903. * The last scan plan must not specify the number of
  7904. * iterations, it is supposed to run infinitely
  7905. */
  7906. if (request->scan_plans[n_plans - 1].iterations)
  7907. return -EINVAL;
  7908. return 0;
  7909. }
  7910. static int
  7911. nl80211_parse_sched_scan_per_band_rssi(struct wiphy *wiphy,
  7912. struct cfg80211_match_set *match_sets,
  7913. struct nlattr *tb_band_rssi,
  7914. s32 rssi_thold)
  7915. {
  7916. struct nlattr *attr;
  7917. int i, tmp, ret = 0;
  7918. if (!wiphy_ext_feature_isset(wiphy,
  7919. NL80211_EXT_FEATURE_SCHED_SCAN_BAND_SPECIFIC_RSSI_THOLD)) {
  7920. if (tb_band_rssi)
  7921. ret = -EOPNOTSUPP;
  7922. else
  7923. for (i = 0; i < NUM_NL80211_BANDS; i++)
  7924. match_sets->per_band_rssi_thold[i] =
  7925. NL80211_SCAN_RSSI_THOLD_OFF;
  7926. return ret;
  7927. }
  7928. for (i = 0; i < NUM_NL80211_BANDS; i++)
  7929. match_sets->per_band_rssi_thold[i] = rssi_thold;
  7930. nla_for_each_nested(attr, tb_band_rssi, tmp) {
  7931. enum nl80211_band band = nla_type(attr);
  7932. if (band < 0 || band >= NUM_NL80211_BANDS)
  7933. return -EINVAL;
  7934. match_sets->per_band_rssi_thold[band] = nla_get_s32(attr);
  7935. }
  7936. return 0;
  7937. }
  7938. static struct cfg80211_sched_scan_request *
  7939. nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
  7940. struct nlattr **attrs, int max_match_sets)
  7941. {
  7942. struct cfg80211_sched_scan_request *request;
  7943. struct nlattr *attr;
  7944. int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
  7945. enum nl80211_band band;
  7946. size_t ie_len;
  7947. struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
  7948. s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
  7949. if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  7950. n_channels = validate_scan_freqs(
  7951. attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
  7952. if (!n_channels)
  7953. return ERR_PTR(-EINVAL);
  7954. } else {
  7955. n_channels = ieee80211_get_num_supported_channels(wiphy);
  7956. }
  7957. if (attrs[NL80211_ATTR_SCAN_SSIDS])
  7958. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
  7959. tmp)
  7960. n_ssids++;
  7961. if (n_ssids > wiphy->max_sched_scan_ssids)
  7962. return ERR_PTR(-EINVAL);
  7963. /*
  7964. * First, count the number of 'real' matchsets. Due to an issue with
  7965. * the old implementation, matchsets containing only the RSSI attribute
  7966. * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
  7967. * RSSI for all matchsets, rather than their own matchset for reporting
  7968. * all APs with a strong RSSI. This is needed to be compatible with
  7969. * older userspace that treated a matchset with only the RSSI as the
  7970. * global RSSI for all other matchsets - if there are other matchsets.
  7971. */
  7972. if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
  7973. nla_for_each_nested(attr,
  7974. attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
  7975. tmp) {
  7976. struct nlattr *rssi;
  7977. err = nla_parse_nested_deprecated(tb,
  7978. NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
  7979. attr,
  7980. nl80211_match_policy,
  7981. NULL);
  7982. if (err)
  7983. return ERR_PTR(err);
  7984. /* SSID and BSSID are mutually exclusive */
  7985. if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
  7986. tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
  7987. return ERR_PTR(-EINVAL);
  7988. /* add other standalone attributes here */
  7989. if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
  7990. tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
  7991. n_match_sets++;
  7992. continue;
  7993. }
  7994. rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
  7995. if (rssi)
  7996. default_match_rssi = nla_get_s32(rssi);
  7997. }
  7998. }
  7999. /* However, if there's no other matchset, add the RSSI one */
  8000. if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
  8001. n_match_sets = 1;
  8002. if (n_match_sets > max_match_sets)
  8003. return ERR_PTR(-EINVAL);
  8004. if (attrs[NL80211_ATTR_IE])
  8005. ie_len = nla_len(attrs[NL80211_ATTR_IE]);
  8006. else
  8007. ie_len = 0;
  8008. if (ie_len > wiphy->max_sched_scan_ie_len)
  8009. return ERR_PTR(-EINVAL);
  8010. if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
  8011. /*
  8012. * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
  8013. * each scan plan already specifies its own interval
  8014. */
  8015. if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
  8016. return ERR_PTR(-EINVAL);
  8017. nla_for_each_nested(attr,
  8018. attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
  8019. n_plans++;
  8020. } else {
  8021. /*
  8022. * The scan interval attribute is kept for backward
  8023. * compatibility. If no scan plans are specified and sched scan
  8024. * interval is specified, one scan plan will be set with this
  8025. * scan interval and infinite number of iterations.
  8026. */
  8027. if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
  8028. return ERR_PTR(-EINVAL);
  8029. n_plans = 1;
  8030. }
  8031. if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
  8032. return ERR_PTR(-EINVAL);
  8033. if (!wiphy_ext_feature_isset(
  8034. wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
  8035. (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
  8036. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
  8037. return ERR_PTR(-EINVAL);
  8038. request = kzalloc(sizeof(*request)
  8039. + sizeof(*request->ssids) * n_ssids
  8040. + sizeof(*request->match_sets) * n_match_sets
  8041. + sizeof(*request->scan_plans) * n_plans
  8042. + sizeof(*request->channels) * n_channels
  8043. + ie_len, GFP_KERNEL);
  8044. if (!request)
  8045. return ERR_PTR(-ENOMEM);
  8046. if (n_ssids)
  8047. request->ssids = (void *)&request->channels[n_channels];
  8048. request->n_ssids = n_ssids;
  8049. if (ie_len) {
  8050. if (n_ssids)
  8051. request->ie = (void *)(request->ssids + n_ssids);
  8052. else
  8053. request->ie = (void *)(request->channels + n_channels);
  8054. }
  8055. if (n_match_sets) {
  8056. if (request->ie)
  8057. request->match_sets = (void *)(request->ie + ie_len);
  8058. else if (n_ssids)
  8059. request->match_sets =
  8060. (void *)(request->ssids + n_ssids);
  8061. else
  8062. request->match_sets =
  8063. (void *)(request->channels + n_channels);
  8064. }
  8065. request->n_match_sets = n_match_sets;
  8066. if (n_match_sets)
  8067. request->scan_plans = (void *)(request->match_sets +
  8068. n_match_sets);
  8069. else if (request->ie)
  8070. request->scan_plans = (void *)(request->ie + ie_len);
  8071. else if (n_ssids)
  8072. request->scan_plans = (void *)(request->ssids + n_ssids);
  8073. else
  8074. request->scan_plans = (void *)(request->channels + n_channels);
  8075. request->n_scan_plans = n_plans;
  8076. i = 0;
  8077. if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  8078. /* user specified, bail out if channel not found */
  8079. nla_for_each_nested(attr,
  8080. attrs[NL80211_ATTR_SCAN_FREQUENCIES],
  8081. tmp) {
  8082. struct ieee80211_channel *chan;
  8083. chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
  8084. if (!chan) {
  8085. err = -EINVAL;
  8086. goto out_free;
  8087. }
  8088. /* ignore disabled channels */
  8089. if (chan->flags & IEEE80211_CHAN_DISABLED)
  8090. continue;
  8091. request->channels[i] = chan;
  8092. i++;
  8093. }
  8094. } else {
  8095. /* all channels */
  8096. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  8097. int j;
  8098. if (!wiphy->bands[band])
  8099. continue;
  8100. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  8101. struct ieee80211_channel *chan;
  8102. chan = &wiphy->bands[band]->channels[j];
  8103. if (chan->flags & IEEE80211_CHAN_DISABLED)
  8104. continue;
  8105. request->channels[i] = chan;
  8106. i++;
  8107. }
  8108. }
  8109. }
  8110. if (!i) {
  8111. err = -EINVAL;
  8112. goto out_free;
  8113. }
  8114. request->n_channels = i;
  8115. i = 0;
  8116. if (n_ssids) {
  8117. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
  8118. tmp) {
  8119. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  8120. err = -EINVAL;
  8121. goto out_free;
  8122. }
  8123. request->ssids[i].ssid_len = nla_len(attr);
  8124. memcpy(request->ssids[i].ssid, nla_data(attr),
  8125. nla_len(attr));
  8126. i++;
  8127. }
  8128. }
  8129. i = 0;
  8130. if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
  8131. nla_for_each_nested(attr,
  8132. attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
  8133. tmp) {
  8134. struct nlattr *ssid, *bssid, *rssi;
  8135. err = nla_parse_nested_deprecated(tb,
  8136. NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
  8137. attr,
  8138. nl80211_match_policy,
  8139. NULL);
  8140. if (err)
  8141. goto out_free;
  8142. ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
  8143. bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
  8144. if (!ssid && !bssid) {
  8145. i++;
  8146. continue;
  8147. }
  8148. if (WARN_ON(i >= n_match_sets)) {
  8149. /* this indicates a programming error,
  8150. * the loop above should have verified
  8151. * things properly
  8152. */
  8153. err = -EINVAL;
  8154. goto out_free;
  8155. }
  8156. if (ssid) {
  8157. memcpy(request->match_sets[i].ssid.ssid,
  8158. nla_data(ssid), nla_len(ssid));
  8159. request->match_sets[i].ssid.ssid_len =
  8160. nla_len(ssid);
  8161. }
  8162. if (bssid)
  8163. memcpy(request->match_sets[i].bssid,
  8164. nla_data(bssid), ETH_ALEN);
  8165. /* special attribute - old implementation w/a */
  8166. request->match_sets[i].rssi_thold = default_match_rssi;
  8167. rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
  8168. if (rssi)
  8169. request->match_sets[i].rssi_thold =
  8170. nla_get_s32(rssi);
  8171. /* Parse per band RSSI attribute */
  8172. err = nl80211_parse_sched_scan_per_band_rssi(wiphy,
  8173. &request->match_sets[i],
  8174. tb[NL80211_SCHED_SCAN_MATCH_PER_BAND_RSSI],
  8175. request->match_sets[i].rssi_thold);
  8176. if (err)
  8177. goto out_free;
  8178. i++;
  8179. }
  8180. /* there was no other matchset, so the RSSI one is alone */
  8181. if (i == 0 && n_match_sets)
  8182. request->match_sets[0].rssi_thold = default_match_rssi;
  8183. request->min_rssi_thold = INT_MAX;
  8184. for (i = 0; i < n_match_sets; i++)
  8185. request->min_rssi_thold =
  8186. min(request->match_sets[i].rssi_thold,
  8187. request->min_rssi_thold);
  8188. } else {
  8189. request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
  8190. }
  8191. if (ie_len) {
  8192. request->ie_len = ie_len;
  8193. memcpy((void *)request->ie,
  8194. nla_data(attrs[NL80211_ATTR_IE]),
  8195. request->ie_len);
  8196. }
  8197. err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
  8198. if (err)
  8199. goto out_free;
  8200. if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
  8201. request->delay =
  8202. nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
  8203. if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
  8204. request->relative_rssi = nla_get_s8(
  8205. attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
  8206. request->relative_rssi_set = true;
  8207. }
  8208. if (request->relative_rssi_set &&
  8209. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
  8210. struct nl80211_bss_select_rssi_adjust *rssi_adjust;
  8211. rssi_adjust = nla_data(
  8212. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
  8213. request->rssi_adjust.band = rssi_adjust->band;
  8214. request->rssi_adjust.delta = rssi_adjust->delta;
  8215. if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
  8216. err = -EINVAL;
  8217. goto out_free;
  8218. }
  8219. }
  8220. err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
  8221. if (err)
  8222. goto out_free;
  8223. request->scan_start = jiffies;
  8224. return request;
  8225. out_free:
  8226. kfree(request);
  8227. return ERR_PTR(err);
  8228. }
  8229. static int nl80211_start_sched_scan(struct sk_buff *skb,
  8230. struct genl_info *info)
  8231. {
  8232. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8233. struct net_device *dev = info->user_ptr[1];
  8234. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8235. struct cfg80211_sched_scan_request *sched_scan_req;
  8236. bool want_multi;
  8237. int err;
  8238. if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
  8239. return -EOPNOTSUPP;
  8240. want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
  8241. err = cfg80211_sched_scan_req_possible(rdev, want_multi);
  8242. if (err)
  8243. return err;
  8244. sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
  8245. info->attrs,
  8246. rdev->wiphy.max_match_sets);
  8247. err = PTR_ERR_OR_ZERO(sched_scan_req);
  8248. if (err)
  8249. goto out_err;
  8250. /* leave request id zero for legacy request
  8251. * or if driver does not support multi-scheduled scan
  8252. */
  8253. if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1)
  8254. sched_scan_req->reqid = cfg80211_assign_cookie(rdev);
  8255. err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
  8256. if (err)
  8257. goto out_free;
  8258. sched_scan_req->dev = dev;
  8259. sched_scan_req->wiphy = &rdev->wiphy;
  8260. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  8261. sched_scan_req->owner_nlportid = info->snd_portid;
  8262. cfg80211_add_sched_scan_req(rdev, sched_scan_req);
  8263. nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
  8264. return 0;
  8265. out_free:
  8266. kfree(sched_scan_req);
  8267. out_err:
  8268. return err;
  8269. }
  8270. static int nl80211_stop_sched_scan(struct sk_buff *skb,
  8271. struct genl_info *info)
  8272. {
  8273. struct cfg80211_sched_scan_request *req;
  8274. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8275. u64 cookie;
  8276. if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
  8277. return -EOPNOTSUPP;
  8278. if (info->attrs[NL80211_ATTR_COOKIE]) {
  8279. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  8280. return __cfg80211_stop_sched_scan(rdev, cookie, false);
  8281. }
  8282. req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
  8283. struct cfg80211_sched_scan_request,
  8284. list);
  8285. if (!req || req->reqid ||
  8286. (req->owner_nlportid &&
  8287. req->owner_nlportid != info->snd_portid))
  8288. return -ENOENT;
  8289. return cfg80211_stop_sched_scan_req(rdev, req, false);
  8290. }
  8291. static int nl80211_start_radar_detection(struct sk_buff *skb,
  8292. struct genl_info *info)
  8293. {
  8294. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8295. struct net_device *dev = info->user_ptr[1];
  8296. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8297. struct wiphy *wiphy = wdev->wiphy;
  8298. struct cfg80211_chan_def chandef;
  8299. enum nl80211_dfs_regions dfs_region;
  8300. unsigned int cac_time_ms;
  8301. int err = -EINVAL;
  8302. flush_delayed_work(&rdev->dfs_update_channels_wk);
  8303. wiphy_lock(wiphy);
  8304. dfs_region = reg_get_dfs_region(wiphy);
  8305. if (dfs_region == NL80211_DFS_UNSET)
  8306. goto unlock;
  8307. err = nl80211_parse_chandef(rdev, info, &chandef);
  8308. if (err)
  8309. goto unlock;
  8310. err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
  8311. if (err < 0)
  8312. goto unlock;
  8313. if (err == 0) {
  8314. err = -EINVAL;
  8315. goto unlock;
  8316. }
  8317. if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) {
  8318. err = -EINVAL;
  8319. goto unlock;
  8320. }
  8321. if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND])) {
  8322. err = cfg80211_start_background_radar_detection(rdev, wdev,
  8323. &chandef);
  8324. goto unlock;
  8325. }
  8326. if (netif_carrier_ok(dev)) {
  8327. err = -EBUSY;
  8328. goto unlock;
  8329. }
  8330. if (wdev->cac_started) {
  8331. err = -EBUSY;
  8332. goto unlock;
  8333. }
  8334. /* CAC start is offloaded to HW and can't be started manually */
  8335. if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) {
  8336. err = -EOPNOTSUPP;
  8337. goto unlock;
  8338. }
  8339. if (!rdev->ops->start_radar_detection) {
  8340. err = -EOPNOTSUPP;
  8341. goto unlock;
  8342. }
  8343. cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
  8344. if (WARN_ON(!cac_time_ms))
  8345. cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
  8346. err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms);
  8347. if (!err) {
  8348. wdev->links[0].ap.chandef = chandef;
  8349. wdev->cac_started = true;
  8350. wdev->cac_start_time = jiffies;
  8351. wdev->cac_time_ms = cac_time_ms;
  8352. }
  8353. unlock:
  8354. wiphy_unlock(wiphy);
  8355. return err;
  8356. }
  8357. static int nl80211_notify_radar_detection(struct sk_buff *skb,
  8358. struct genl_info *info)
  8359. {
  8360. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8361. struct net_device *dev = info->user_ptr[1];
  8362. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8363. struct wiphy *wiphy = wdev->wiphy;
  8364. struct cfg80211_chan_def chandef;
  8365. enum nl80211_dfs_regions dfs_region;
  8366. int err;
  8367. dfs_region = reg_get_dfs_region(wiphy);
  8368. if (dfs_region == NL80211_DFS_UNSET) {
  8369. GENL_SET_ERR_MSG(info,
  8370. "DFS Region is not set. Unexpected Radar indication");
  8371. return -EINVAL;
  8372. }
  8373. err = nl80211_parse_chandef(rdev, info, &chandef);
  8374. if (err) {
  8375. GENL_SET_ERR_MSG(info, "Unable to extract chandef info");
  8376. return err;
  8377. }
  8378. err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
  8379. if (err < 0) {
  8380. GENL_SET_ERR_MSG(info, "chandef is invalid");
  8381. return err;
  8382. }
  8383. if (err == 0) {
  8384. GENL_SET_ERR_MSG(info,
  8385. "Unexpected Radar indication for chandef/iftype");
  8386. return -EINVAL;
  8387. }
  8388. /* Do not process this notification if radar is already detected
  8389. * by kernel on this channel, and return success.
  8390. */
  8391. if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE)
  8392. return 0;
  8393. cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE);
  8394. cfg80211_sched_dfs_chan_update(rdev);
  8395. rdev->radar_chandef = chandef;
  8396. /* Propagate this notification to other radios as well */
  8397. queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk);
  8398. return 0;
  8399. }
  8400. static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
  8401. {
  8402. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8403. unsigned int link_id = nl80211_link_id(info->attrs);
  8404. struct net_device *dev = info->user_ptr[1];
  8405. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8406. struct cfg80211_csa_settings params;
  8407. struct nlattr **csa_attrs = NULL;
  8408. int err;
  8409. bool need_new_beacon = false;
  8410. bool need_handle_dfs_flag = true;
  8411. int len, i;
  8412. u32 cs_count;
  8413. if (!rdev->ops->channel_switch ||
  8414. !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
  8415. return -EOPNOTSUPP;
  8416. switch (dev->ieee80211_ptr->iftype) {
  8417. case NL80211_IFTYPE_AP:
  8418. case NL80211_IFTYPE_P2P_GO:
  8419. need_new_beacon = true;
  8420. /* For all modes except AP the handle_dfs flag needs to be
  8421. * supplied to tell the kernel that userspace will handle radar
  8422. * events when they happen. Otherwise a switch to a channel
  8423. * requiring DFS will be rejected.
  8424. */
  8425. need_handle_dfs_flag = false;
  8426. /* useless if AP is not running */
  8427. if (!wdev->links[link_id].ap.beacon_interval)
  8428. return -ENOTCONN;
  8429. break;
  8430. case NL80211_IFTYPE_ADHOC:
  8431. if (!wdev->u.ibss.ssid_len)
  8432. return -ENOTCONN;
  8433. break;
  8434. case NL80211_IFTYPE_MESH_POINT:
  8435. if (!wdev->u.mesh.id_len)
  8436. return -ENOTCONN;
  8437. break;
  8438. default:
  8439. return -EOPNOTSUPP;
  8440. }
  8441. memset(&params, 0, sizeof(params));
  8442. params.beacon_csa.ftm_responder = -1;
  8443. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  8444. !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
  8445. return -EINVAL;
  8446. /* only important for AP, IBSS and mesh create IEs internally */
  8447. if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
  8448. return -EINVAL;
  8449. /* Even though the attribute is u32, the specification says
  8450. * u8, so let's make sure we don't overflow.
  8451. */
  8452. cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
  8453. if (cs_count > 255)
  8454. return -EINVAL;
  8455. params.count = cs_count;
  8456. if (!need_new_beacon)
  8457. goto skip_beacons;
  8458. err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_after);
  8459. if (err)
  8460. goto free;
  8461. csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs),
  8462. GFP_KERNEL);
  8463. if (!csa_attrs) {
  8464. err = -ENOMEM;
  8465. goto free;
  8466. }
  8467. err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX,
  8468. info->attrs[NL80211_ATTR_CSA_IES],
  8469. nl80211_policy, info->extack);
  8470. if (err)
  8471. goto free;
  8472. err = nl80211_parse_beacon(rdev, csa_attrs, &params.beacon_csa);
  8473. if (err)
  8474. goto free;
  8475. if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) {
  8476. err = -EINVAL;
  8477. goto free;
  8478. }
  8479. len = nla_len(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]);
  8480. if (!len || (len % sizeof(u16))) {
  8481. err = -EINVAL;
  8482. goto free;
  8483. }
  8484. params.n_counter_offsets_beacon = len / sizeof(u16);
  8485. if (rdev->wiphy.max_num_csa_counters &&
  8486. (params.n_counter_offsets_beacon >
  8487. rdev->wiphy.max_num_csa_counters)) {
  8488. err = -EINVAL;
  8489. goto free;
  8490. }
  8491. params.counter_offsets_beacon =
  8492. nla_data(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]);
  8493. /* sanity checks - counters should fit and be the same */
  8494. for (i = 0; i < params.n_counter_offsets_beacon; i++) {
  8495. u16 offset = params.counter_offsets_beacon[i];
  8496. if (offset >= params.beacon_csa.tail_len) {
  8497. err = -EINVAL;
  8498. goto free;
  8499. }
  8500. if (params.beacon_csa.tail[offset] != params.count) {
  8501. err = -EINVAL;
  8502. goto free;
  8503. }
  8504. }
  8505. if (csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]) {
  8506. len = nla_len(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]);
  8507. if (!len || (len % sizeof(u16))) {
  8508. err = -EINVAL;
  8509. goto free;
  8510. }
  8511. params.n_counter_offsets_presp = len / sizeof(u16);
  8512. if (rdev->wiphy.max_num_csa_counters &&
  8513. (params.n_counter_offsets_presp >
  8514. rdev->wiphy.max_num_csa_counters)) {
  8515. err = -EINVAL;
  8516. goto free;
  8517. }
  8518. params.counter_offsets_presp =
  8519. nla_data(csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP]);
  8520. /* sanity checks - counters should fit and be the same */
  8521. for (i = 0; i < params.n_counter_offsets_presp; i++) {
  8522. u16 offset = params.counter_offsets_presp[i];
  8523. if (offset >= params.beacon_csa.probe_resp_len) {
  8524. err = -EINVAL;
  8525. goto free;
  8526. }
  8527. if (params.beacon_csa.probe_resp[offset] !=
  8528. params.count) {
  8529. err = -EINVAL;
  8530. goto free;
  8531. }
  8532. }
  8533. }
  8534. skip_beacons:
  8535. err = nl80211_parse_chandef(rdev, info, &params.chandef);
  8536. if (err)
  8537. goto free;
  8538. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
  8539. wdev->iftype)) {
  8540. err = -EINVAL;
  8541. goto free;
  8542. }
  8543. err = cfg80211_chandef_dfs_required(wdev->wiphy,
  8544. &params.chandef,
  8545. wdev->iftype);
  8546. if (err < 0)
  8547. goto free;
  8548. if (err > 0) {
  8549. params.radar_required = true;
  8550. if (need_handle_dfs_flag &&
  8551. !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
  8552. err = -EINVAL;
  8553. goto free;
  8554. }
  8555. }
  8556. if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
  8557. params.block_tx = true;
  8558. if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) {
  8559. err = nl80211_parse_punct_bitmap(rdev, info,
  8560. &params.chandef,
  8561. &params.punct_bitmap);
  8562. if (err)
  8563. goto free;
  8564. }
  8565. wdev_lock(wdev);
  8566. err = rdev_channel_switch(rdev, dev, &params);
  8567. wdev_unlock(wdev);
  8568. free:
  8569. kfree(params.beacon_after.mbssid_ies);
  8570. kfree(params.beacon_csa.mbssid_ies);
  8571. kfree(csa_attrs);
  8572. return err;
  8573. }
  8574. static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
  8575. u32 seq, int flags,
  8576. struct cfg80211_registered_device *rdev,
  8577. struct wireless_dev *wdev,
  8578. struct cfg80211_internal_bss *intbss)
  8579. {
  8580. struct cfg80211_bss *res = &intbss->pub;
  8581. const struct cfg80211_bss_ies *ies;
  8582. unsigned int link_id;
  8583. void *hdr;
  8584. struct nlattr *bss;
  8585. ASSERT_WDEV_LOCK(wdev);
  8586. hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
  8587. NL80211_CMD_NEW_SCAN_RESULTS);
  8588. if (!hdr)
  8589. return -1;
  8590. genl_dump_check_consistent(cb, hdr);
  8591. if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
  8592. goto nla_put_failure;
  8593. if (wdev->netdev &&
  8594. nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
  8595. goto nla_put_failure;
  8596. if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  8597. NL80211_ATTR_PAD))
  8598. goto nla_put_failure;
  8599. bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS);
  8600. if (!bss)
  8601. goto nla_put_failure;
  8602. if ((!is_zero_ether_addr(res->bssid) &&
  8603. nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
  8604. goto nla_put_failure;
  8605. rcu_read_lock();
  8606. /* indicate whether we have probe response data or not */
  8607. if (rcu_access_pointer(res->proberesp_ies) &&
  8608. nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
  8609. goto fail_unlock_rcu;
  8610. /* this pointer prefers to be pointed to probe response data
  8611. * but is always valid
  8612. */
  8613. ies = rcu_dereference(res->ies);
  8614. if (ies) {
  8615. if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
  8616. NL80211_BSS_PAD))
  8617. goto fail_unlock_rcu;
  8618. if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
  8619. ies->len, ies->data))
  8620. goto fail_unlock_rcu;
  8621. }
  8622. /* and this pointer is always (unless driver didn't know) beacon data */
  8623. ies = rcu_dereference(res->beacon_ies);
  8624. if (ies && ies->from_beacon) {
  8625. if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
  8626. NL80211_BSS_PAD))
  8627. goto fail_unlock_rcu;
  8628. if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
  8629. ies->len, ies->data))
  8630. goto fail_unlock_rcu;
  8631. }
  8632. rcu_read_unlock();
  8633. if (res->beacon_interval &&
  8634. nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
  8635. goto nla_put_failure;
  8636. if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
  8637. nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
  8638. nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET,
  8639. res->channel->freq_offset) ||
  8640. nla_put_u32(msg, NL80211_BSS_CHAN_WIDTH, res->scan_width) ||
  8641. nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
  8642. jiffies_to_msecs(jiffies - intbss->ts)))
  8643. goto nla_put_failure;
  8644. if (intbss->parent_tsf &&
  8645. (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
  8646. intbss->parent_tsf, NL80211_BSS_PAD) ||
  8647. nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
  8648. intbss->parent_bssid)))
  8649. goto nla_put_failure;
  8650. if (intbss->ts_boottime &&
  8651. nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
  8652. intbss->ts_boottime, NL80211_BSS_PAD))
  8653. goto nla_put_failure;
  8654. if (!nl80211_put_signal(msg, intbss->pub.chains,
  8655. intbss->pub.chain_signal,
  8656. NL80211_BSS_CHAIN_SIGNAL))
  8657. goto nla_put_failure;
  8658. switch (rdev->wiphy.signal_type) {
  8659. case CFG80211_SIGNAL_TYPE_MBM:
  8660. if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM, res->signal))
  8661. goto nla_put_failure;
  8662. break;
  8663. case CFG80211_SIGNAL_TYPE_UNSPEC:
  8664. if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC, res->signal))
  8665. goto nla_put_failure;
  8666. break;
  8667. default:
  8668. break;
  8669. }
  8670. switch (wdev->iftype) {
  8671. case NL80211_IFTYPE_P2P_CLIENT:
  8672. case NL80211_IFTYPE_STATION:
  8673. for_each_valid_link(wdev, link_id) {
  8674. if (intbss == wdev->links[link_id].client.current_bss &&
  8675. (nla_put_u32(msg, NL80211_BSS_STATUS,
  8676. NL80211_BSS_STATUS_ASSOCIATED) ||
  8677. (wdev->valid_links &&
  8678. (nla_put_u8(msg, NL80211_BSS_MLO_LINK_ID,
  8679. link_id) ||
  8680. nla_put(msg, NL80211_BSS_MLD_ADDR, ETH_ALEN,
  8681. wdev->u.client.connected_addr)))))
  8682. goto nla_put_failure;
  8683. }
  8684. break;
  8685. case NL80211_IFTYPE_ADHOC:
  8686. if (intbss == wdev->u.ibss.current_bss &&
  8687. nla_put_u32(msg, NL80211_BSS_STATUS,
  8688. NL80211_BSS_STATUS_IBSS_JOINED))
  8689. goto nla_put_failure;
  8690. break;
  8691. default:
  8692. break;
  8693. }
  8694. nla_nest_end(msg, bss);
  8695. genlmsg_end(msg, hdr);
  8696. return 0;
  8697. fail_unlock_rcu:
  8698. rcu_read_unlock();
  8699. nla_put_failure:
  8700. genlmsg_cancel(msg, hdr);
  8701. return -EMSGSIZE;
  8702. }
  8703. static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
  8704. {
  8705. struct cfg80211_registered_device *rdev;
  8706. struct cfg80211_internal_bss *scan;
  8707. struct wireless_dev *wdev;
  8708. int start = cb->args[2], idx = 0;
  8709. int err;
  8710. err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
  8711. if (err)
  8712. return err;
  8713. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  8714. __acquire(&rdev->wiphy.mtx);
  8715. wdev_lock(wdev);
  8716. spin_lock_bh(&rdev->bss_lock);
  8717. /*
  8718. * dump_scan will be called multiple times to break up the scan results
  8719. * into multiple messages. It is unlikely that any more bss-es will be
  8720. * expired after the first call, so only call only call this on the
  8721. * first dump_scan invocation.
  8722. */
  8723. if (start == 0)
  8724. cfg80211_bss_expire(rdev);
  8725. cb->seq = rdev->bss_generation;
  8726. list_for_each_entry(scan, &rdev->bss_list, list) {
  8727. if (++idx <= start)
  8728. continue;
  8729. if (nl80211_send_bss(skb, cb,
  8730. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  8731. rdev, wdev, scan) < 0) {
  8732. idx--;
  8733. break;
  8734. }
  8735. }
  8736. spin_unlock_bh(&rdev->bss_lock);
  8737. wdev_unlock(wdev);
  8738. cb->args[2] = idx;
  8739. wiphy_unlock(&rdev->wiphy);
  8740. return skb->len;
  8741. }
  8742. static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
  8743. int flags, struct net_device *dev,
  8744. bool allow_radio_stats,
  8745. struct survey_info *survey)
  8746. {
  8747. void *hdr;
  8748. struct nlattr *infoattr;
  8749. /* skip radio stats if userspace didn't request them */
  8750. if (!survey->channel && !allow_radio_stats)
  8751. return 0;
  8752. hdr = nl80211hdr_put(msg, portid, seq, flags,
  8753. NL80211_CMD_NEW_SURVEY_RESULTS);
  8754. if (!hdr)
  8755. return -ENOMEM;
  8756. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  8757. goto nla_put_failure;
  8758. infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO);
  8759. if (!infoattr)
  8760. goto nla_put_failure;
  8761. if (survey->channel &&
  8762. nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
  8763. survey->channel->center_freq))
  8764. goto nla_put_failure;
  8765. if (survey->channel && survey->channel->freq_offset &&
  8766. nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET,
  8767. survey->channel->freq_offset))
  8768. goto nla_put_failure;
  8769. if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
  8770. nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
  8771. goto nla_put_failure;
  8772. if ((survey->filled & SURVEY_INFO_IN_USE) &&
  8773. nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
  8774. goto nla_put_failure;
  8775. if ((survey->filled & SURVEY_INFO_TIME) &&
  8776. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
  8777. survey->time, NL80211_SURVEY_INFO_PAD))
  8778. goto nla_put_failure;
  8779. if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
  8780. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
  8781. survey->time_busy, NL80211_SURVEY_INFO_PAD))
  8782. goto nla_put_failure;
  8783. if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
  8784. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
  8785. survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
  8786. goto nla_put_failure;
  8787. if ((survey->filled & SURVEY_INFO_TIME_RX) &&
  8788. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
  8789. survey->time_rx, NL80211_SURVEY_INFO_PAD))
  8790. goto nla_put_failure;
  8791. if ((survey->filled & SURVEY_INFO_TIME_TX) &&
  8792. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
  8793. survey->time_tx, NL80211_SURVEY_INFO_PAD))
  8794. goto nla_put_failure;
  8795. if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
  8796. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
  8797. survey->time_scan, NL80211_SURVEY_INFO_PAD))
  8798. goto nla_put_failure;
  8799. if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) &&
  8800. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX,
  8801. survey->time_bss_rx, NL80211_SURVEY_INFO_PAD))
  8802. goto nla_put_failure;
  8803. nla_nest_end(msg, infoattr);
  8804. genlmsg_end(msg, hdr);
  8805. return 0;
  8806. nla_put_failure:
  8807. genlmsg_cancel(msg, hdr);
  8808. return -EMSGSIZE;
  8809. }
  8810. static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
  8811. {
  8812. struct nlattr **attrbuf;
  8813. struct survey_info survey;
  8814. struct cfg80211_registered_device *rdev;
  8815. struct wireless_dev *wdev;
  8816. int survey_idx = cb->args[2];
  8817. int res;
  8818. bool radio_stats;
  8819. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
  8820. if (!attrbuf)
  8821. return -ENOMEM;
  8822. res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf);
  8823. if (res) {
  8824. kfree(attrbuf);
  8825. return res;
  8826. }
  8827. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  8828. __acquire(&rdev->wiphy.mtx);
  8829. /* prepare_wdev_dump parsed the attributes */
  8830. radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
  8831. if (!wdev->netdev) {
  8832. res = -EINVAL;
  8833. goto out_err;
  8834. }
  8835. if (!rdev->ops->dump_survey) {
  8836. res = -EOPNOTSUPP;
  8837. goto out_err;
  8838. }
  8839. while (1) {
  8840. wdev_lock(wdev);
  8841. res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
  8842. wdev_unlock(wdev);
  8843. if (res == -ENOENT)
  8844. break;
  8845. if (res)
  8846. goto out_err;
  8847. /* don't send disabled channels, but do send non-channel data */
  8848. if (survey.channel &&
  8849. survey.channel->flags & IEEE80211_CHAN_DISABLED) {
  8850. survey_idx++;
  8851. continue;
  8852. }
  8853. if (nl80211_send_survey(skb,
  8854. NETLINK_CB(cb->skb).portid,
  8855. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  8856. wdev->netdev, radio_stats, &survey) < 0)
  8857. goto out;
  8858. survey_idx++;
  8859. }
  8860. out:
  8861. cb->args[2] = survey_idx;
  8862. res = skb->len;
  8863. out_err:
  8864. kfree(attrbuf);
  8865. wiphy_unlock(&rdev->wiphy);
  8866. return res;
  8867. }
  8868. static bool nl80211_valid_wpa_versions(u32 wpa_versions)
  8869. {
  8870. return !(wpa_versions & ~(NL80211_WPA_VERSION_1 |
  8871. NL80211_WPA_VERSION_2 |
  8872. NL80211_WPA_VERSION_3));
  8873. }
  8874. static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
  8875. {
  8876. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8877. struct net_device *dev = info->user_ptr[1];
  8878. struct ieee80211_channel *chan;
  8879. const u8 *bssid, *ssid;
  8880. int err, ssid_len;
  8881. enum nl80211_auth_type auth_type;
  8882. struct key_parse key;
  8883. bool local_state_change;
  8884. struct cfg80211_auth_request req = {};
  8885. u32 freq;
  8886. if (!info->attrs[NL80211_ATTR_MAC])
  8887. return -EINVAL;
  8888. if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
  8889. return -EINVAL;
  8890. if (!info->attrs[NL80211_ATTR_SSID])
  8891. return -EINVAL;
  8892. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  8893. return -EINVAL;
  8894. err = nl80211_parse_key(info, &key);
  8895. if (err)
  8896. return err;
  8897. if (key.idx >= 0) {
  8898. if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
  8899. return -EINVAL;
  8900. if (!key.p.key || !key.p.key_len)
  8901. return -EINVAL;
  8902. if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
  8903. key.p.key_len != WLAN_KEY_LEN_WEP40) &&
  8904. (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
  8905. key.p.key_len != WLAN_KEY_LEN_WEP104))
  8906. return -EINVAL;
  8907. if (key.idx > 3)
  8908. return -EINVAL;
  8909. } else {
  8910. key.p.key_len = 0;
  8911. key.p.key = NULL;
  8912. }
  8913. if (key.idx >= 0) {
  8914. int i;
  8915. bool ok = false;
  8916. for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
  8917. if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
  8918. ok = true;
  8919. break;
  8920. }
  8921. }
  8922. if (!ok)
  8923. return -EINVAL;
  8924. }
  8925. if (!rdev->ops->auth)
  8926. return -EOPNOTSUPP;
  8927. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  8928. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  8929. return -EOPNOTSUPP;
  8930. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  8931. freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  8932. if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
  8933. freq +=
  8934. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
  8935. chan = nl80211_get_valid_chan(&rdev->wiphy, freq);
  8936. if (!chan)
  8937. return -EINVAL;
  8938. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  8939. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  8940. if (info->attrs[NL80211_ATTR_IE]) {
  8941. req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  8942. req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  8943. }
  8944. auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  8945. if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
  8946. return -EINVAL;
  8947. if ((auth_type == NL80211_AUTHTYPE_SAE ||
  8948. auth_type == NL80211_AUTHTYPE_FILS_SK ||
  8949. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  8950. auth_type == NL80211_AUTHTYPE_FILS_PK) &&
  8951. !info->attrs[NL80211_ATTR_AUTH_DATA])
  8952. return -EINVAL;
  8953. if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
  8954. if (auth_type != NL80211_AUTHTYPE_SAE &&
  8955. auth_type != NL80211_AUTHTYPE_FILS_SK &&
  8956. auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
  8957. auth_type != NL80211_AUTHTYPE_FILS_PK)
  8958. return -EINVAL;
  8959. req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
  8960. req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
  8961. }
  8962. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  8963. /*
  8964. * Since we no longer track auth state, ignore
  8965. * requests to only change local state.
  8966. */
  8967. if (local_state_change)
  8968. return 0;
  8969. req.auth_type = auth_type;
  8970. req.key = key.p.key;
  8971. req.key_len = key.p.key_len;
  8972. req.key_idx = key.idx;
  8973. req.link_id = nl80211_link_id_or_invalid(info->attrs);
  8974. if (req.link_id >= 0) {
  8975. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO))
  8976. return -EINVAL;
  8977. if (!info->attrs[NL80211_ATTR_MLD_ADDR])
  8978. return -EINVAL;
  8979. req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  8980. if (!is_valid_ether_addr(req.ap_mld_addr))
  8981. return -EINVAL;
  8982. }
  8983. req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
  8984. IEEE80211_BSS_TYPE_ESS,
  8985. IEEE80211_PRIVACY_ANY);
  8986. if (!req.bss)
  8987. return -ENOENT;
  8988. wdev_lock(dev->ieee80211_ptr);
  8989. err = cfg80211_mlme_auth(rdev, dev, &req);
  8990. wdev_unlock(dev->ieee80211_ptr);
  8991. cfg80211_put_bss(&rdev->wiphy, req.bss);
  8992. return err;
  8993. }
  8994. static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev,
  8995. struct genl_info *info)
  8996. {
  8997. if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  8998. GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set");
  8999. return -EINVAL;
  9000. }
  9001. if (!rdev->ops->tx_control_port ||
  9002. !wiphy_ext_feature_isset(&rdev->wiphy,
  9003. NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
  9004. return -EOPNOTSUPP;
  9005. return 0;
  9006. }
  9007. static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  9008. struct genl_info *info,
  9009. struct cfg80211_crypto_settings *settings,
  9010. int cipher_limit)
  9011. {
  9012. memset(settings, 0, sizeof(*settings));
  9013. settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
  9014. if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
  9015. u16 proto;
  9016. proto = nla_get_u16(
  9017. info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
  9018. settings->control_port_ethertype = cpu_to_be16(proto);
  9019. if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  9020. proto != ETH_P_PAE)
  9021. return -EINVAL;
  9022. if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
  9023. settings->control_port_no_encrypt = true;
  9024. } else
  9025. settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
  9026. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  9027. int r = validate_pae_over_nl80211(rdev, info);
  9028. if (r < 0)
  9029. return r;
  9030. settings->control_port_over_nl80211 = true;
  9031. if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH])
  9032. settings->control_port_no_preauth = true;
  9033. }
  9034. if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
  9035. void *data;
  9036. int len, i;
  9037. data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  9038. len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  9039. settings->n_ciphers_pairwise = len / sizeof(u32);
  9040. if (len % sizeof(u32))
  9041. return -EINVAL;
  9042. if (settings->n_ciphers_pairwise > cipher_limit)
  9043. return -EINVAL;
  9044. memcpy(settings->ciphers_pairwise, data, len);
  9045. for (i = 0; i < settings->n_ciphers_pairwise; i++)
  9046. if (!cfg80211_supported_cipher_suite(
  9047. &rdev->wiphy,
  9048. settings->ciphers_pairwise[i]))
  9049. return -EINVAL;
  9050. }
  9051. if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
  9052. settings->cipher_group =
  9053. nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
  9054. if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
  9055. settings->cipher_group))
  9056. return -EINVAL;
  9057. }
  9058. if (info->attrs[NL80211_ATTR_WPA_VERSIONS]) {
  9059. settings->wpa_versions =
  9060. nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
  9061. if (!nl80211_valid_wpa_versions(settings->wpa_versions))
  9062. return -EINVAL;
  9063. }
  9064. if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
  9065. void *data;
  9066. int len;
  9067. data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
  9068. len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
  9069. settings->n_akm_suites = len / sizeof(u32);
  9070. if (len % sizeof(u32))
  9071. return -EINVAL;
  9072. if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites)
  9073. return -EINVAL;
  9074. memcpy(settings->akm_suites, data, len);
  9075. }
  9076. if (info->attrs[NL80211_ATTR_PMK]) {
  9077. if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
  9078. return -EINVAL;
  9079. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  9080. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) &&
  9081. !wiphy_ext_feature_isset(&rdev->wiphy,
  9082. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK))
  9083. return -EINVAL;
  9084. settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  9085. }
  9086. if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) {
  9087. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  9088. NL80211_EXT_FEATURE_SAE_OFFLOAD) &&
  9089. !wiphy_ext_feature_isset(&rdev->wiphy,
  9090. NL80211_EXT_FEATURE_SAE_OFFLOAD_AP))
  9091. return -EINVAL;
  9092. settings->sae_pwd =
  9093. nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
  9094. settings->sae_pwd_len =
  9095. nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
  9096. }
  9097. if (info->attrs[NL80211_ATTR_SAE_PWE])
  9098. settings->sae_pwe =
  9099. nla_get_u8(info->attrs[NL80211_ATTR_SAE_PWE]);
  9100. else
  9101. settings->sae_pwe = NL80211_SAE_PWE_UNSPECIFIED;
  9102. return 0;
  9103. }
  9104. static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev,
  9105. const u8 *ssid, int ssid_len,
  9106. struct nlattr **attrs)
  9107. {
  9108. struct ieee80211_channel *chan;
  9109. struct cfg80211_bss *bss;
  9110. const u8 *bssid;
  9111. u32 freq;
  9112. if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ])
  9113. return ERR_PTR(-EINVAL);
  9114. bssid = nla_data(attrs[NL80211_ATTR_MAC]);
  9115. freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ]));
  9116. if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
  9117. freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
  9118. chan = nl80211_get_valid_chan(&rdev->wiphy, freq);
  9119. if (!chan)
  9120. return ERR_PTR(-EINVAL);
  9121. bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid,
  9122. ssid, ssid_len,
  9123. IEEE80211_BSS_TYPE_ESS,
  9124. IEEE80211_PRIVACY_ANY);
  9125. if (!bss)
  9126. return ERR_PTR(-ENOENT);
  9127. return bss;
  9128. }
  9129. static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
  9130. {
  9131. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9132. struct net_device *dev = info->user_ptr[1];
  9133. struct cfg80211_assoc_request req = {};
  9134. struct nlattr **attrs = NULL;
  9135. const u8 *ap_addr, *ssid;
  9136. unsigned int link_id;
  9137. int err, ssid_len;
  9138. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  9139. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  9140. return -EPERM;
  9141. if (!info->attrs[NL80211_ATTR_SSID])
  9142. return -EINVAL;
  9143. if (!rdev->ops->assoc)
  9144. return -EOPNOTSUPP;
  9145. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  9146. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  9147. return -EOPNOTSUPP;
  9148. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  9149. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  9150. if (info->attrs[NL80211_ATTR_IE]) {
  9151. req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9152. req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9153. if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE,
  9154. req.ie, req.ie_len)) {
  9155. GENL_SET_ERR_MSG(info,
  9156. "non-inheritance makes no sense");
  9157. return -EINVAL;
  9158. }
  9159. }
  9160. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  9161. enum nl80211_mfp mfp =
  9162. nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  9163. if (mfp == NL80211_MFP_REQUIRED)
  9164. req.use_mfp = true;
  9165. else if (mfp != NL80211_MFP_NO)
  9166. return -EINVAL;
  9167. }
  9168. if (info->attrs[NL80211_ATTR_PREV_BSSID])
  9169. req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
  9170. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
  9171. req.flags |= ASSOC_REQ_DISABLE_HT;
  9172. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9173. memcpy(&req.ht_capa_mask,
  9174. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  9175. sizeof(req.ht_capa_mask));
  9176. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  9177. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9178. return -EINVAL;
  9179. memcpy(&req.ht_capa,
  9180. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  9181. sizeof(req.ht_capa));
  9182. }
  9183. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
  9184. req.flags |= ASSOC_REQ_DISABLE_VHT;
  9185. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE]))
  9186. req.flags |= ASSOC_REQ_DISABLE_HE;
  9187. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT]))
  9188. req.flags |= ASSOC_REQ_DISABLE_EHT;
  9189. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  9190. memcpy(&req.vht_capa_mask,
  9191. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
  9192. sizeof(req.vht_capa_mask));
  9193. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
  9194. if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  9195. return -EINVAL;
  9196. memcpy(&req.vht_capa,
  9197. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
  9198. sizeof(req.vht_capa));
  9199. }
  9200. if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
  9201. if (!((rdev->wiphy.features &
  9202. NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
  9203. (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
  9204. !wiphy_ext_feature_isset(&rdev->wiphy,
  9205. NL80211_EXT_FEATURE_RRM))
  9206. return -EINVAL;
  9207. req.flags |= ASSOC_REQ_USE_RRM;
  9208. }
  9209. if (info->attrs[NL80211_ATTR_FILS_KEK]) {
  9210. req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
  9211. req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
  9212. if (!info->attrs[NL80211_ATTR_FILS_NONCES])
  9213. return -EINVAL;
  9214. req.fils_nonces =
  9215. nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
  9216. }
  9217. if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) {
  9218. if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY])
  9219. return -EINVAL;
  9220. memcpy(&req.s1g_capa_mask,
  9221. nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]),
  9222. sizeof(req.s1g_capa_mask));
  9223. }
  9224. if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) {
  9225. if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK])
  9226. return -EINVAL;
  9227. memcpy(&req.s1g_capa,
  9228. nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]),
  9229. sizeof(req.s1g_capa));
  9230. }
  9231. req.link_id = nl80211_link_id_or_invalid(info->attrs);
  9232. if (info->attrs[NL80211_ATTR_MLO_LINKS]) {
  9233. unsigned int attrsize = NUM_NL80211_ATTR * sizeof(*attrs);
  9234. struct nlattr *link;
  9235. int rem = 0;
  9236. if (req.link_id < 0)
  9237. return -EINVAL;
  9238. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO))
  9239. return -EINVAL;
  9240. if (info->attrs[NL80211_ATTR_MAC] ||
  9241. info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  9242. !info->attrs[NL80211_ATTR_MLD_ADDR])
  9243. return -EINVAL;
  9244. req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  9245. ap_addr = req.ap_mld_addr;
  9246. attrs = kzalloc(attrsize, GFP_KERNEL);
  9247. if (!attrs)
  9248. return -ENOMEM;
  9249. nla_for_each_nested(link,
  9250. info->attrs[NL80211_ATTR_MLO_LINKS],
  9251. rem) {
  9252. memset(attrs, 0, attrsize);
  9253. nla_parse_nested(attrs, NL80211_ATTR_MAX,
  9254. link, NULL, NULL);
  9255. if (!attrs[NL80211_ATTR_MLO_LINK_ID]) {
  9256. err = -EINVAL;
  9257. goto free;
  9258. }
  9259. link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]);
  9260. /* cannot use the same link ID again */
  9261. if (req.links[link_id].bss) {
  9262. err = -EINVAL;
  9263. goto free;
  9264. }
  9265. req.links[link_id].bss =
  9266. nl80211_assoc_bss(rdev, ssid, ssid_len, attrs);
  9267. if (IS_ERR(req.links[link_id].bss)) {
  9268. err = PTR_ERR(req.links[link_id].bss);
  9269. req.links[link_id].bss = NULL;
  9270. goto free;
  9271. }
  9272. if (attrs[NL80211_ATTR_IE]) {
  9273. req.links[link_id].elems =
  9274. nla_data(attrs[NL80211_ATTR_IE]);
  9275. req.links[link_id].elems_len =
  9276. nla_len(attrs[NL80211_ATTR_IE]);
  9277. if (cfg80211_find_elem(WLAN_EID_FRAGMENT,
  9278. req.links[link_id].elems,
  9279. req.links[link_id].elems_len)) {
  9280. GENL_SET_ERR_MSG(info,
  9281. "cannot deal with fragmentation");
  9282. err = -EINVAL;
  9283. goto free;
  9284. }
  9285. if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE,
  9286. req.links[link_id].elems,
  9287. req.links[link_id].elems_len)) {
  9288. GENL_SET_ERR_MSG(info,
  9289. "cannot deal with non-inheritance");
  9290. err = -EINVAL;
  9291. goto free;
  9292. }
  9293. }
  9294. }
  9295. if (!req.links[req.link_id].bss) {
  9296. err = -EINVAL;
  9297. goto free;
  9298. }
  9299. if (req.links[req.link_id].elems_len) {
  9300. GENL_SET_ERR_MSG(info,
  9301. "cannot have per-link elems on assoc link");
  9302. err = -EINVAL;
  9303. goto free;
  9304. }
  9305. kfree(attrs);
  9306. attrs = NULL;
  9307. } else {
  9308. if (req.link_id >= 0)
  9309. return -EINVAL;
  9310. req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs);
  9311. if (IS_ERR(req.bss))
  9312. return PTR_ERR(req.bss);
  9313. ap_addr = req.bss->bssid;
  9314. }
  9315. err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
  9316. if (!err) {
  9317. wdev_lock(dev->ieee80211_ptr);
  9318. err = cfg80211_mlme_assoc(rdev, dev, &req);
  9319. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  9320. dev->ieee80211_ptr->conn_owner_nlportid =
  9321. info->snd_portid;
  9322. memcpy(dev->ieee80211_ptr->disconnect_bssid,
  9323. ap_addr, ETH_ALEN);
  9324. }
  9325. wdev_unlock(dev->ieee80211_ptr);
  9326. }
  9327. free:
  9328. for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++)
  9329. cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss);
  9330. cfg80211_put_bss(&rdev->wiphy, req.bss);
  9331. kfree(attrs);
  9332. return err;
  9333. }
  9334. static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
  9335. {
  9336. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9337. struct net_device *dev = info->user_ptr[1];
  9338. const u8 *ie = NULL, *bssid;
  9339. int ie_len = 0, err;
  9340. u16 reason_code;
  9341. bool local_state_change;
  9342. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  9343. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  9344. return -EPERM;
  9345. if (!info->attrs[NL80211_ATTR_MAC])
  9346. return -EINVAL;
  9347. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  9348. return -EINVAL;
  9349. if (!rdev->ops->deauth)
  9350. return -EOPNOTSUPP;
  9351. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  9352. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  9353. return -EOPNOTSUPP;
  9354. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9355. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  9356. if (reason_code == 0) {
  9357. /* Reason Code 0 is reserved */
  9358. return -EINVAL;
  9359. }
  9360. if (info->attrs[NL80211_ATTR_IE]) {
  9361. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9362. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9363. }
  9364. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  9365. wdev_lock(dev->ieee80211_ptr);
  9366. err = cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
  9367. local_state_change);
  9368. wdev_unlock(dev->ieee80211_ptr);
  9369. return err;
  9370. }
  9371. static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
  9372. {
  9373. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9374. struct net_device *dev = info->user_ptr[1];
  9375. const u8 *ie = NULL, *bssid;
  9376. int ie_len = 0, err;
  9377. u16 reason_code;
  9378. bool local_state_change;
  9379. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  9380. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  9381. return -EPERM;
  9382. if (!info->attrs[NL80211_ATTR_MAC])
  9383. return -EINVAL;
  9384. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  9385. return -EINVAL;
  9386. if (!rdev->ops->disassoc)
  9387. return -EOPNOTSUPP;
  9388. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  9389. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  9390. return -EOPNOTSUPP;
  9391. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9392. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  9393. if (reason_code == 0) {
  9394. /* Reason Code 0 is reserved */
  9395. return -EINVAL;
  9396. }
  9397. if (info->attrs[NL80211_ATTR_IE]) {
  9398. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9399. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9400. }
  9401. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  9402. wdev_lock(dev->ieee80211_ptr);
  9403. err = cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
  9404. local_state_change);
  9405. wdev_unlock(dev->ieee80211_ptr);
  9406. return err;
  9407. }
  9408. static bool
  9409. nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
  9410. int mcast_rate[NUM_NL80211_BANDS],
  9411. int rateval)
  9412. {
  9413. struct wiphy *wiphy = &rdev->wiphy;
  9414. bool found = false;
  9415. int band, i;
  9416. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  9417. struct ieee80211_supported_band *sband;
  9418. sband = wiphy->bands[band];
  9419. if (!sband)
  9420. continue;
  9421. for (i = 0; i < sband->n_bitrates; i++) {
  9422. if (sband->bitrates[i].bitrate == rateval) {
  9423. mcast_rate[band] = i + 1;
  9424. found = true;
  9425. break;
  9426. }
  9427. }
  9428. }
  9429. return found;
  9430. }
  9431. static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
  9432. {
  9433. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9434. struct net_device *dev = info->user_ptr[1];
  9435. struct cfg80211_ibss_params ibss;
  9436. struct wiphy *wiphy;
  9437. struct cfg80211_cached_keys *connkeys = NULL;
  9438. int err;
  9439. memset(&ibss, 0, sizeof(ibss));
  9440. if (!info->attrs[NL80211_ATTR_SSID] ||
  9441. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  9442. return -EINVAL;
  9443. ibss.beacon_interval = 100;
  9444. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
  9445. ibss.beacon_interval =
  9446. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  9447. err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
  9448. ibss.beacon_interval);
  9449. if (err)
  9450. return err;
  9451. if (!rdev->ops->join_ibss)
  9452. return -EOPNOTSUPP;
  9453. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  9454. return -EOPNOTSUPP;
  9455. wiphy = &rdev->wiphy;
  9456. if (info->attrs[NL80211_ATTR_MAC]) {
  9457. ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9458. if (!is_valid_ether_addr(ibss.bssid))
  9459. return -EINVAL;
  9460. }
  9461. ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  9462. ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  9463. if (info->attrs[NL80211_ATTR_IE]) {
  9464. ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9465. ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9466. }
  9467. err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
  9468. if (err)
  9469. return err;
  9470. if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
  9471. NL80211_IFTYPE_ADHOC))
  9472. return -EINVAL;
  9473. switch (ibss.chandef.width) {
  9474. case NL80211_CHAN_WIDTH_5:
  9475. case NL80211_CHAN_WIDTH_10:
  9476. case NL80211_CHAN_WIDTH_20_NOHT:
  9477. break;
  9478. case NL80211_CHAN_WIDTH_20:
  9479. case NL80211_CHAN_WIDTH_40:
  9480. if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
  9481. return -EINVAL;
  9482. break;
  9483. case NL80211_CHAN_WIDTH_80:
  9484. case NL80211_CHAN_WIDTH_80P80:
  9485. case NL80211_CHAN_WIDTH_160:
  9486. if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
  9487. return -EINVAL;
  9488. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  9489. NL80211_EXT_FEATURE_VHT_IBSS))
  9490. return -EINVAL;
  9491. break;
  9492. case NL80211_CHAN_WIDTH_320:
  9493. return -EINVAL;
  9494. default:
  9495. return -EINVAL;
  9496. }
  9497. ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
  9498. ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  9499. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  9500. u8 *rates =
  9501. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  9502. int n_rates =
  9503. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  9504. struct ieee80211_supported_band *sband =
  9505. wiphy->bands[ibss.chandef.chan->band];
  9506. err = ieee80211_get_ratemask(sband, rates, n_rates,
  9507. &ibss.basic_rates);
  9508. if (err)
  9509. return err;
  9510. }
  9511. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9512. memcpy(&ibss.ht_capa_mask,
  9513. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  9514. sizeof(ibss.ht_capa_mask));
  9515. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  9516. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9517. return -EINVAL;
  9518. memcpy(&ibss.ht_capa,
  9519. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  9520. sizeof(ibss.ht_capa));
  9521. }
  9522. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  9523. !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
  9524. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  9525. return -EINVAL;
  9526. if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  9527. bool no_ht = false;
  9528. connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
  9529. if (IS_ERR(connkeys))
  9530. return PTR_ERR(connkeys);
  9531. if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
  9532. no_ht) {
  9533. kfree_sensitive(connkeys);
  9534. return -EINVAL;
  9535. }
  9536. }
  9537. ibss.control_port =
  9538. nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
  9539. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  9540. int r = validate_pae_over_nl80211(rdev, info);
  9541. if (r < 0) {
  9542. kfree_sensitive(connkeys);
  9543. return r;
  9544. }
  9545. ibss.control_port_over_nl80211 = true;
  9546. }
  9547. ibss.userspace_handles_dfs =
  9548. nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
  9549. wdev_lock(dev->ieee80211_ptr);
  9550. err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
  9551. if (err)
  9552. kfree_sensitive(connkeys);
  9553. else if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  9554. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  9555. wdev_unlock(dev->ieee80211_ptr);
  9556. return err;
  9557. }
  9558. static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
  9559. {
  9560. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9561. struct net_device *dev = info->user_ptr[1];
  9562. if (!rdev->ops->leave_ibss)
  9563. return -EOPNOTSUPP;
  9564. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  9565. return -EOPNOTSUPP;
  9566. return cfg80211_leave_ibss(rdev, dev, false);
  9567. }
  9568. static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
  9569. {
  9570. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9571. struct net_device *dev = info->user_ptr[1];
  9572. int mcast_rate[NUM_NL80211_BANDS];
  9573. u32 nla_rate;
  9574. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
  9575. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  9576. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
  9577. return -EOPNOTSUPP;
  9578. if (!rdev->ops->set_mcast_rate)
  9579. return -EOPNOTSUPP;
  9580. memset(mcast_rate, 0, sizeof(mcast_rate));
  9581. if (!info->attrs[NL80211_ATTR_MCAST_RATE])
  9582. return -EINVAL;
  9583. nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
  9584. if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
  9585. return -EINVAL;
  9586. return rdev_set_mcast_rate(rdev, dev, mcast_rate);
  9587. }
  9588. static struct sk_buff *
  9589. __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
  9590. struct wireless_dev *wdev, int approxlen,
  9591. u32 portid, u32 seq, enum nl80211_commands cmd,
  9592. enum nl80211_attrs attr,
  9593. const struct nl80211_vendor_cmd_info *info,
  9594. gfp_t gfp)
  9595. {
  9596. struct sk_buff *skb;
  9597. void *hdr;
  9598. struct nlattr *data;
  9599. skb = nlmsg_new(approxlen + 100, gfp);
  9600. if (!skb)
  9601. return NULL;
  9602. hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
  9603. if (!hdr) {
  9604. kfree_skb(skb);
  9605. return NULL;
  9606. }
  9607. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  9608. goto nla_put_failure;
  9609. if (info) {
  9610. if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
  9611. info->vendor_id))
  9612. goto nla_put_failure;
  9613. if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
  9614. info->subcmd))
  9615. goto nla_put_failure;
  9616. }
  9617. if (wdev) {
  9618. if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
  9619. wdev_id(wdev), NL80211_ATTR_PAD))
  9620. goto nla_put_failure;
  9621. if (wdev->netdev &&
  9622. nla_put_u32(skb, NL80211_ATTR_IFINDEX,
  9623. wdev->netdev->ifindex))
  9624. goto nla_put_failure;
  9625. }
  9626. data = nla_nest_start_noflag(skb, attr);
  9627. if (!data)
  9628. goto nla_put_failure;
  9629. ((void **)skb->cb)[0] = rdev;
  9630. ((void **)skb->cb)[1] = hdr;
  9631. ((void **)skb->cb)[2] = data;
  9632. return skb;
  9633. nla_put_failure:
  9634. kfree_skb(skb);
  9635. return NULL;
  9636. }
  9637. struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
  9638. struct wireless_dev *wdev,
  9639. enum nl80211_commands cmd,
  9640. enum nl80211_attrs attr,
  9641. unsigned int portid,
  9642. int vendor_event_idx,
  9643. int approxlen, gfp_t gfp)
  9644. {
  9645. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  9646. const struct nl80211_vendor_cmd_info *info;
  9647. switch (cmd) {
  9648. case NL80211_CMD_TESTMODE:
  9649. if (WARN_ON(vendor_event_idx != -1))
  9650. return NULL;
  9651. info = NULL;
  9652. break;
  9653. case NL80211_CMD_VENDOR:
  9654. if (WARN_ON(vendor_event_idx < 0 ||
  9655. vendor_event_idx >= wiphy->n_vendor_events))
  9656. return NULL;
  9657. info = &wiphy->vendor_events[vendor_event_idx];
  9658. break;
  9659. default:
  9660. WARN_ON(1);
  9661. return NULL;
  9662. }
  9663. return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0,
  9664. cmd, attr, info, gfp);
  9665. }
  9666. EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
  9667. void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
  9668. {
  9669. struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
  9670. void *hdr = ((void **)skb->cb)[1];
  9671. struct nlmsghdr *nlhdr = nlmsg_hdr(skb);
  9672. struct nlattr *data = ((void **)skb->cb)[2];
  9673. enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
  9674. /* clear CB data for netlink core to own from now on */
  9675. memset(skb->cb, 0, sizeof(skb->cb));
  9676. nla_nest_end(skb, data);
  9677. genlmsg_end(skb, hdr);
  9678. if (nlhdr->nlmsg_pid) {
  9679. genlmsg_unicast(wiphy_net(&rdev->wiphy), skb,
  9680. nlhdr->nlmsg_pid);
  9681. } else {
  9682. if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
  9683. mcgrp = NL80211_MCGRP_VENDOR;
  9684. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  9685. skb, 0, mcgrp, gfp);
  9686. }
  9687. }
  9688. EXPORT_SYMBOL(__cfg80211_send_event_skb);
  9689. #ifdef CONFIG_NL80211_TESTMODE
  9690. static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
  9691. {
  9692. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9693. struct wireless_dev *wdev;
  9694. int err;
  9695. lockdep_assert_held(&rdev->wiphy.mtx);
  9696. wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info),
  9697. info->attrs);
  9698. if (!rdev->ops->testmode_cmd)
  9699. return -EOPNOTSUPP;
  9700. if (IS_ERR(wdev)) {
  9701. err = PTR_ERR(wdev);
  9702. if (err != -EINVAL)
  9703. return err;
  9704. wdev = NULL;
  9705. } else if (wdev->wiphy != &rdev->wiphy) {
  9706. return -EINVAL;
  9707. }
  9708. if (!info->attrs[NL80211_ATTR_TESTDATA])
  9709. return -EINVAL;
  9710. rdev->cur_cmd_info = info;
  9711. err = rdev_testmode_cmd(rdev, wdev,
  9712. nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
  9713. nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
  9714. rdev->cur_cmd_info = NULL;
  9715. return err;
  9716. }
  9717. static int nl80211_testmode_dump(struct sk_buff *skb,
  9718. struct netlink_callback *cb)
  9719. {
  9720. struct cfg80211_registered_device *rdev;
  9721. struct nlattr **attrbuf = NULL;
  9722. int err;
  9723. long phy_idx;
  9724. void *data = NULL;
  9725. int data_len = 0;
  9726. rtnl_lock();
  9727. if (cb->args[0]) {
  9728. /*
  9729. * 0 is a valid index, but not valid for args[0],
  9730. * so we need to offset by 1.
  9731. */
  9732. phy_idx = cb->args[0] - 1;
  9733. rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
  9734. if (!rdev) {
  9735. err = -ENOENT;
  9736. goto out_err;
  9737. }
  9738. } else {
  9739. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
  9740. GFP_KERNEL);
  9741. if (!attrbuf) {
  9742. err = -ENOMEM;
  9743. goto out_err;
  9744. }
  9745. err = nlmsg_parse_deprecated(cb->nlh,
  9746. GENL_HDRLEN + nl80211_fam.hdrsize,
  9747. attrbuf, nl80211_fam.maxattr,
  9748. nl80211_policy, NULL);
  9749. if (err)
  9750. goto out_err;
  9751. rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
  9752. if (IS_ERR(rdev)) {
  9753. err = PTR_ERR(rdev);
  9754. goto out_err;
  9755. }
  9756. phy_idx = rdev->wiphy_idx;
  9757. if (attrbuf[NL80211_ATTR_TESTDATA])
  9758. cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
  9759. }
  9760. if (cb->args[1]) {
  9761. data = nla_data((void *)cb->args[1]);
  9762. data_len = nla_len((void *)cb->args[1]);
  9763. }
  9764. if (!rdev->ops->testmode_dump) {
  9765. err = -EOPNOTSUPP;
  9766. goto out_err;
  9767. }
  9768. while (1) {
  9769. void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
  9770. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  9771. NL80211_CMD_TESTMODE);
  9772. struct nlattr *tmdata;
  9773. if (!hdr)
  9774. break;
  9775. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
  9776. genlmsg_cancel(skb, hdr);
  9777. break;
  9778. }
  9779. tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA);
  9780. if (!tmdata) {
  9781. genlmsg_cancel(skb, hdr);
  9782. break;
  9783. }
  9784. err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
  9785. nla_nest_end(skb, tmdata);
  9786. if (err == -ENOBUFS || err == -ENOENT) {
  9787. genlmsg_cancel(skb, hdr);
  9788. break;
  9789. } else if (err) {
  9790. genlmsg_cancel(skb, hdr);
  9791. goto out_err;
  9792. }
  9793. genlmsg_end(skb, hdr);
  9794. }
  9795. err = skb->len;
  9796. /* see above */
  9797. cb->args[0] = phy_idx + 1;
  9798. out_err:
  9799. kfree(attrbuf);
  9800. rtnl_unlock();
  9801. return err;
  9802. }
  9803. #endif
  9804. static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
  9805. {
  9806. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9807. struct net_device *dev = info->user_ptr[1];
  9808. struct cfg80211_connect_params connect;
  9809. struct wiphy *wiphy;
  9810. struct cfg80211_cached_keys *connkeys = NULL;
  9811. u32 freq = 0;
  9812. int err;
  9813. memset(&connect, 0, sizeof(connect));
  9814. if (!info->attrs[NL80211_ATTR_SSID] ||
  9815. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  9816. return -EINVAL;
  9817. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  9818. connect.auth_type =
  9819. nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  9820. if (!nl80211_valid_auth_type(rdev, connect.auth_type,
  9821. NL80211_CMD_CONNECT))
  9822. return -EINVAL;
  9823. } else
  9824. connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  9825. connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
  9826. if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
  9827. !wiphy_ext_feature_isset(&rdev->wiphy,
  9828. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  9829. return -EINVAL;
  9830. connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
  9831. err = nl80211_crypto_settings(rdev, info, &connect.crypto,
  9832. NL80211_MAX_NR_CIPHER_SUITES);
  9833. if (err)
  9834. return err;
  9835. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  9836. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  9837. return -EOPNOTSUPP;
  9838. wiphy = &rdev->wiphy;
  9839. connect.bg_scan_period = -1;
  9840. if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
  9841. (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
  9842. connect.bg_scan_period =
  9843. nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
  9844. }
  9845. if (info->attrs[NL80211_ATTR_MAC])
  9846. connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9847. else if (info->attrs[NL80211_ATTR_MAC_HINT])
  9848. connect.bssid_hint =
  9849. nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
  9850. connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  9851. connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  9852. if (info->attrs[NL80211_ATTR_IE]) {
  9853. connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9854. connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9855. }
  9856. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  9857. connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  9858. if (connect.mfp == NL80211_MFP_OPTIONAL &&
  9859. !wiphy_ext_feature_isset(&rdev->wiphy,
  9860. NL80211_EXT_FEATURE_MFP_OPTIONAL))
  9861. return -EOPNOTSUPP;
  9862. } else {
  9863. connect.mfp = NL80211_MFP_NO;
  9864. }
  9865. if (info->attrs[NL80211_ATTR_PREV_BSSID])
  9866. connect.prev_bssid =
  9867. nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
  9868. if (info->attrs[NL80211_ATTR_WIPHY_FREQ])
  9869. freq = MHZ_TO_KHZ(nla_get_u32(
  9870. info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  9871. if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
  9872. freq +=
  9873. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
  9874. if (freq) {
  9875. connect.channel = nl80211_get_valid_chan(wiphy, freq);
  9876. if (!connect.channel)
  9877. return -EINVAL;
  9878. } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
  9879. freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
  9880. freq = MHZ_TO_KHZ(freq);
  9881. connect.channel_hint = nl80211_get_valid_chan(wiphy, freq);
  9882. if (!connect.channel_hint)
  9883. return -EINVAL;
  9884. }
  9885. if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
  9886. connect.edmg.channels =
  9887. nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
  9888. if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
  9889. connect.edmg.bw_config =
  9890. nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
  9891. }
  9892. if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  9893. connkeys = nl80211_parse_connkeys(rdev, info, NULL);
  9894. if (IS_ERR(connkeys))
  9895. return PTR_ERR(connkeys);
  9896. }
  9897. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
  9898. connect.flags |= ASSOC_REQ_DISABLE_HT;
  9899. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9900. memcpy(&connect.ht_capa_mask,
  9901. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  9902. sizeof(connect.ht_capa_mask));
  9903. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  9904. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
  9905. kfree_sensitive(connkeys);
  9906. return -EINVAL;
  9907. }
  9908. memcpy(&connect.ht_capa,
  9909. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  9910. sizeof(connect.ht_capa));
  9911. }
  9912. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
  9913. connect.flags |= ASSOC_REQ_DISABLE_VHT;
  9914. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE]))
  9915. connect.flags |= ASSOC_REQ_DISABLE_HE;
  9916. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT]))
  9917. connect.flags |= ASSOC_REQ_DISABLE_EHT;
  9918. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  9919. memcpy(&connect.vht_capa_mask,
  9920. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
  9921. sizeof(connect.vht_capa_mask));
  9922. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
  9923. if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
  9924. kfree_sensitive(connkeys);
  9925. return -EINVAL;
  9926. }
  9927. memcpy(&connect.vht_capa,
  9928. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
  9929. sizeof(connect.vht_capa));
  9930. }
  9931. if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
  9932. if (!((rdev->wiphy.features &
  9933. NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
  9934. (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
  9935. !wiphy_ext_feature_isset(&rdev->wiphy,
  9936. NL80211_EXT_FEATURE_RRM)) {
  9937. kfree_sensitive(connkeys);
  9938. return -EINVAL;
  9939. }
  9940. connect.flags |= ASSOC_REQ_USE_RRM;
  9941. }
  9942. connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
  9943. if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
  9944. kfree_sensitive(connkeys);
  9945. return -EOPNOTSUPP;
  9946. }
  9947. if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
  9948. /* bss selection makes no sense if bssid is set */
  9949. if (connect.bssid) {
  9950. kfree_sensitive(connkeys);
  9951. return -EINVAL;
  9952. }
  9953. err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
  9954. wiphy, &connect.bss_select);
  9955. if (err) {
  9956. kfree_sensitive(connkeys);
  9957. return err;
  9958. }
  9959. }
  9960. if (wiphy_ext_feature_isset(&rdev->wiphy,
  9961. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
  9962. info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
  9963. info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
  9964. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
  9965. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  9966. connect.fils_erp_username =
  9967. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  9968. connect.fils_erp_username_len =
  9969. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  9970. connect.fils_erp_realm =
  9971. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  9972. connect.fils_erp_realm_len =
  9973. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  9974. connect.fils_erp_next_seq_num =
  9975. nla_get_u16(
  9976. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
  9977. connect.fils_erp_rrk =
  9978. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  9979. connect.fils_erp_rrk_len =
  9980. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  9981. } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
  9982. info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
  9983. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
  9984. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  9985. kfree_sensitive(connkeys);
  9986. return -EINVAL;
  9987. }
  9988. if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
  9989. if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  9990. kfree_sensitive(connkeys);
  9991. GENL_SET_ERR_MSG(info,
  9992. "external auth requires connection ownership");
  9993. return -EINVAL;
  9994. }
  9995. connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
  9996. }
  9997. if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT]))
  9998. connect.flags |= CONNECT_REQ_MLO_SUPPORT;
  9999. wdev_lock(dev->ieee80211_ptr);
  10000. err = cfg80211_connect(rdev, dev, &connect, connkeys,
  10001. connect.prev_bssid);
  10002. if (err)
  10003. kfree_sensitive(connkeys);
  10004. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  10005. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  10006. if (connect.bssid)
  10007. memcpy(dev->ieee80211_ptr->disconnect_bssid,
  10008. connect.bssid, ETH_ALEN);
  10009. else
  10010. eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid);
  10011. }
  10012. wdev_unlock(dev->ieee80211_ptr);
  10013. return err;
  10014. }
  10015. static int nl80211_update_connect_params(struct sk_buff *skb,
  10016. struct genl_info *info)
  10017. {
  10018. struct cfg80211_connect_params connect = {};
  10019. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10020. struct net_device *dev = info->user_ptr[1];
  10021. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10022. bool fils_sk_offload;
  10023. u32 auth_type;
  10024. u32 changed = 0;
  10025. int ret;
  10026. if (!rdev->ops->update_connect_params)
  10027. return -EOPNOTSUPP;
  10028. if (info->attrs[NL80211_ATTR_IE]) {
  10029. connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  10030. connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  10031. changed |= UPDATE_ASSOC_IES;
  10032. }
  10033. fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy,
  10034. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD);
  10035. /*
  10036. * when driver supports fils-sk offload all attributes must be
  10037. * provided. So the else covers "fils-sk-not-all" and
  10038. * "no-fils-sk-any".
  10039. */
  10040. if (fils_sk_offload &&
  10041. info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
  10042. info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
  10043. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
  10044. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  10045. connect.fils_erp_username =
  10046. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  10047. connect.fils_erp_username_len =
  10048. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  10049. connect.fils_erp_realm =
  10050. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  10051. connect.fils_erp_realm_len =
  10052. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  10053. connect.fils_erp_next_seq_num =
  10054. nla_get_u16(
  10055. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
  10056. connect.fils_erp_rrk =
  10057. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  10058. connect.fils_erp_rrk_len =
  10059. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  10060. changed |= UPDATE_FILS_ERP_INFO;
  10061. } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
  10062. info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
  10063. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
  10064. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  10065. return -EINVAL;
  10066. }
  10067. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  10068. auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  10069. if (!nl80211_valid_auth_type(rdev, auth_type,
  10070. NL80211_CMD_CONNECT))
  10071. return -EINVAL;
  10072. if (auth_type == NL80211_AUTHTYPE_FILS_SK &&
  10073. fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO))
  10074. return -EINVAL;
  10075. connect.auth_type = auth_type;
  10076. changed |= UPDATE_AUTH_TYPE;
  10077. }
  10078. wdev_lock(dev->ieee80211_ptr);
  10079. if (!wdev->connected)
  10080. ret = -ENOLINK;
  10081. else
  10082. ret = rdev_update_connect_params(rdev, dev, &connect, changed);
  10083. wdev_unlock(dev->ieee80211_ptr);
  10084. return ret;
  10085. }
  10086. static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
  10087. {
  10088. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10089. struct net_device *dev = info->user_ptr[1];
  10090. u16 reason;
  10091. int ret;
  10092. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  10093. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  10094. return -EPERM;
  10095. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  10096. reason = WLAN_REASON_DEAUTH_LEAVING;
  10097. else
  10098. reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  10099. if (reason == 0)
  10100. return -EINVAL;
  10101. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10102. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10103. return -EOPNOTSUPP;
  10104. wdev_lock(dev->ieee80211_ptr);
  10105. ret = cfg80211_disconnect(rdev, dev, reason, true);
  10106. wdev_unlock(dev->ieee80211_ptr);
  10107. return ret;
  10108. }
  10109. static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
  10110. {
  10111. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10112. struct net *net;
  10113. int err;
  10114. if (info->attrs[NL80211_ATTR_PID]) {
  10115. u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
  10116. net = get_net_ns_by_pid(pid);
  10117. } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
  10118. u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
  10119. net = get_net_ns_by_fd(fd);
  10120. } else {
  10121. return -EINVAL;
  10122. }
  10123. if (IS_ERR(net))
  10124. return PTR_ERR(net);
  10125. err = 0;
  10126. /* check if anything to do */
  10127. if (!net_eq(wiphy_net(&rdev->wiphy), net))
  10128. err = cfg80211_switch_netns(rdev, net);
  10129. put_net(net);
  10130. return err;
  10131. }
  10132. static int nl80211_set_pmksa(struct sk_buff *skb, struct genl_info *info)
  10133. {
  10134. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10135. struct net_device *dev = info->user_ptr[1];
  10136. struct cfg80211_pmksa pmksa;
  10137. bool ap_pmksa_caching_support = false;
  10138. memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
  10139. ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy,
  10140. NL80211_EXT_FEATURE_AP_PMKSA_CACHING);
  10141. if (!info->attrs[NL80211_ATTR_PMKID])
  10142. return -EINVAL;
  10143. pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  10144. if (info->attrs[NL80211_ATTR_MAC]) {
  10145. pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10146. } else if (info->attrs[NL80211_ATTR_SSID] &&
  10147. info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
  10148. info->attrs[NL80211_ATTR_PMK]) {
  10149. pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  10150. pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  10151. pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
  10152. } else {
  10153. return -EINVAL;
  10154. }
  10155. if (info->attrs[NL80211_ATTR_PMK]) {
  10156. pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  10157. pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
  10158. }
  10159. if (info->attrs[NL80211_ATTR_PMK_LIFETIME])
  10160. pmksa.pmk_lifetime =
  10161. nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]);
  10162. if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD])
  10163. pmksa.pmk_reauth_threshold =
  10164. nla_get_u8(info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]);
  10165. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10166. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
  10167. !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP ||
  10168. dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) &&
  10169. ap_pmksa_caching_support))
  10170. return -EOPNOTSUPP;
  10171. if (!rdev->ops->set_pmksa)
  10172. return -EOPNOTSUPP;
  10173. return rdev_set_pmksa(rdev, dev, &pmksa);
  10174. }
  10175. static int nl80211_del_pmksa(struct sk_buff *skb, struct genl_info *info)
  10176. {
  10177. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10178. struct net_device *dev = info->user_ptr[1];
  10179. struct cfg80211_pmksa pmksa;
  10180. bool sae_offload_support = false;
  10181. bool owe_offload_support = false;
  10182. bool ap_pmksa_caching_support = false;
  10183. memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
  10184. sae_offload_support = wiphy_ext_feature_isset(&rdev->wiphy,
  10185. NL80211_EXT_FEATURE_SAE_OFFLOAD);
  10186. owe_offload_support = wiphy_ext_feature_isset(&rdev->wiphy,
  10187. NL80211_EXT_FEATURE_OWE_OFFLOAD);
  10188. ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy,
  10189. NL80211_EXT_FEATURE_AP_PMKSA_CACHING);
  10190. if (info->attrs[NL80211_ATTR_PMKID])
  10191. pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  10192. if (info->attrs[NL80211_ATTR_MAC]) {
  10193. pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10194. } else if (info->attrs[NL80211_ATTR_SSID]) {
  10195. /* SSID based pmksa flush suppported only for FILS,
  10196. * OWE/SAE OFFLOAD cases
  10197. */
  10198. if (info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
  10199. info->attrs[NL80211_ATTR_PMK]) {
  10200. pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
  10201. } else if (!sae_offload_support && !owe_offload_support) {
  10202. return -EINVAL;
  10203. }
  10204. pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  10205. pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  10206. } else {
  10207. return -EINVAL;
  10208. }
  10209. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10210. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
  10211. !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP ||
  10212. dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) &&
  10213. ap_pmksa_caching_support))
  10214. return -EOPNOTSUPP;
  10215. if (!rdev->ops->del_pmksa)
  10216. return -EOPNOTSUPP;
  10217. return rdev_del_pmksa(rdev, dev, &pmksa);
  10218. }
  10219. static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
  10220. {
  10221. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10222. struct net_device *dev = info->user_ptr[1];
  10223. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10224. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10225. return -EOPNOTSUPP;
  10226. if (!rdev->ops->flush_pmksa)
  10227. return -EOPNOTSUPP;
  10228. return rdev_flush_pmksa(rdev, dev);
  10229. }
  10230. static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
  10231. {
  10232. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10233. struct net_device *dev = info->user_ptr[1];
  10234. u8 action_code, dialog_token;
  10235. u32 peer_capability = 0;
  10236. u16 status_code;
  10237. u8 *peer;
  10238. bool initiator;
  10239. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
  10240. !rdev->ops->tdls_mgmt)
  10241. return -EOPNOTSUPP;
  10242. if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
  10243. !info->attrs[NL80211_ATTR_STATUS_CODE] ||
  10244. !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
  10245. !info->attrs[NL80211_ATTR_IE] ||
  10246. !info->attrs[NL80211_ATTR_MAC])
  10247. return -EINVAL;
  10248. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10249. action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
  10250. status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  10251. dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
  10252. initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
  10253. if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
  10254. peer_capability =
  10255. nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
  10256. return rdev_tdls_mgmt(rdev, dev, peer, action_code,
  10257. dialog_token, status_code, peer_capability,
  10258. initiator,
  10259. nla_data(info->attrs[NL80211_ATTR_IE]),
  10260. nla_len(info->attrs[NL80211_ATTR_IE]));
  10261. }
  10262. static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
  10263. {
  10264. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10265. struct net_device *dev = info->user_ptr[1];
  10266. enum nl80211_tdls_operation operation;
  10267. u8 *peer;
  10268. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
  10269. !rdev->ops->tdls_oper)
  10270. return -EOPNOTSUPP;
  10271. if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
  10272. !info->attrs[NL80211_ATTR_MAC])
  10273. return -EINVAL;
  10274. operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
  10275. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10276. return rdev_tdls_oper(rdev, dev, peer, operation);
  10277. }
  10278. static int nl80211_remain_on_channel(struct sk_buff *skb,
  10279. struct genl_info *info)
  10280. {
  10281. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10282. unsigned int link_id = nl80211_link_id(info->attrs);
  10283. struct wireless_dev *wdev = info->user_ptr[1];
  10284. struct cfg80211_chan_def chandef;
  10285. struct sk_buff *msg;
  10286. void *hdr;
  10287. u64 cookie;
  10288. u32 duration;
  10289. int err;
  10290. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  10291. !info->attrs[NL80211_ATTR_DURATION])
  10292. return -EINVAL;
  10293. duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  10294. if (!rdev->ops->remain_on_channel ||
  10295. !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
  10296. return -EOPNOTSUPP;
  10297. /*
  10298. * We should be on that channel for at least a minimum amount of
  10299. * time (10ms) but no longer than the driver supports.
  10300. */
  10301. if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
  10302. duration > rdev->wiphy.max_remain_on_channel_duration)
  10303. return -EINVAL;
  10304. err = nl80211_parse_chandef(rdev, info, &chandef);
  10305. if (err)
  10306. return err;
  10307. wdev_lock(wdev);
  10308. if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) {
  10309. const struct cfg80211_chan_def *oper_chandef, *compat_chandef;
  10310. oper_chandef = wdev_chandef(wdev, link_id);
  10311. if (WARN_ON(!oper_chandef)) {
  10312. /* cannot happen since we must beacon to get here */
  10313. WARN_ON(1);
  10314. wdev_unlock(wdev);
  10315. return -EBUSY;
  10316. }
  10317. /* note: returns first one if identical chandefs */
  10318. compat_chandef = cfg80211_chandef_compatible(&chandef,
  10319. oper_chandef);
  10320. if (compat_chandef != &chandef) {
  10321. wdev_unlock(wdev);
  10322. return -EBUSY;
  10323. }
  10324. }
  10325. wdev_unlock(wdev);
  10326. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  10327. if (!msg)
  10328. return -ENOMEM;
  10329. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  10330. NL80211_CMD_REMAIN_ON_CHANNEL);
  10331. if (!hdr) {
  10332. err = -ENOBUFS;
  10333. goto free_msg;
  10334. }
  10335. err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
  10336. duration, &cookie);
  10337. if (err)
  10338. goto free_msg;
  10339. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  10340. NL80211_ATTR_PAD))
  10341. goto nla_put_failure;
  10342. genlmsg_end(msg, hdr);
  10343. return genlmsg_reply(msg, info);
  10344. nla_put_failure:
  10345. err = -ENOBUFS;
  10346. free_msg:
  10347. nlmsg_free(msg);
  10348. return err;
  10349. }
  10350. static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
  10351. struct genl_info *info)
  10352. {
  10353. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10354. struct wireless_dev *wdev = info->user_ptr[1];
  10355. u64 cookie;
  10356. if (!info->attrs[NL80211_ATTR_COOKIE])
  10357. return -EINVAL;
  10358. if (!rdev->ops->cancel_remain_on_channel)
  10359. return -EOPNOTSUPP;
  10360. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  10361. return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
  10362. }
  10363. static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
  10364. struct genl_info *info)
  10365. {
  10366. struct cfg80211_bitrate_mask mask;
  10367. unsigned int link_id = nl80211_link_id(info->attrs);
  10368. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10369. struct net_device *dev = info->user_ptr[1];
  10370. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10371. int err;
  10372. if (!rdev->ops->set_bitrate_mask)
  10373. return -EOPNOTSUPP;
  10374. wdev_lock(wdev);
  10375. err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
  10376. NL80211_ATTR_TX_RATES, &mask,
  10377. dev, true, link_id);
  10378. if (err)
  10379. goto out;
  10380. err = rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask);
  10381. out:
  10382. wdev_unlock(wdev);
  10383. return err;
  10384. }
  10385. static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
  10386. {
  10387. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10388. struct wireless_dev *wdev = info->user_ptr[1];
  10389. u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
  10390. if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
  10391. return -EINVAL;
  10392. if (info->attrs[NL80211_ATTR_FRAME_TYPE])
  10393. frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
  10394. switch (wdev->iftype) {
  10395. case NL80211_IFTYPE_STATION:
  10396. case NL80211_IFTYPE_ADHOC:
  10397. case NL80211_IFTYPE_P2P_CLIENT:
  10398. case NL80211_IFTYPE_AP:
  10399. case NL80211_IFTYPE_AP_VLAN:
  10400. case NL80211_IFTYPE_MESH_POINT:
  10401. case NL80211_IFTYPE_P2P_GO:
  10402. case NL80211_IFTYPE_P2P_DEVICE:
  10403. break;
  10404. case NL80211_IFTYPE_NAN:
  10405. if (!wiphy_ext_feature_isset(wdev->wiphy,
  10406. NL80211_EXT_FEATURE_SECURE_NAN))
  10407. return -EOPNOTSUPP;
  10408. break;
  10409. default:
  10410. return -EOPNOTSUPP;
  10411. }
  10412. /* not much point in registering if we can't reply */
  10413. if (!rdev->ops->mgmt_tx)
  10414. return -EOPNOTSUPP;
  10415. if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] &&
  10416. !wiphy_ext_feature_isset(&rdev->wiphy,
  10417. NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) {
  10418. GENL_SET_ERR_MSG(info,
  10419. "multicast RX registrations are not supported");
  10420. return -EOPNOTSUPP;
  10421. }
  10422. return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
  10423. nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
  10424. nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]),
  10425. info->attrs[NL80211_ATTR_RECEIVE_MULTICAST],
  10426. info->extack);
  10427. }
  10428. static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
  10429. {
  10430. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10431. struct wireless_dev *wdev = info->user_ptr[1];
  10432. struct cfg80211_chan_def chandef;
  10433. int err;
  10434. void *hdr = NULL;
  10435. u64 cookie;
  10436. struct sk_buff *msg = NULL;
  10437. struct cfg80211_mgmt_tx_params params = {
  10438. .dont_wait_for_ack =
  10439. info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
  10440. };
  10441. if (!info->attrs[NL80211_ATTR_FRAME])
  10442. return -EINVAL;
  10443. if (!rdev->ops->mgmt_tx)
  10444. return -EOPNOTSUPP;
  10445. switch (wdev->iftype) {
  10446. case NL80211_IFTYPE_P2P_DEVICE:
  10447. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  10448. return -EINVAL;
  10449. break;
  10450. case NL80211_IFTYPE_STATION:
  10451. case NL80211_IFTYPE_ADHOC:
  10452. case NL80211_IFTYPE_P2P_CLIENT:
  10453. case NL80211_IFTYPE_AP:
  10454. case NL80211_IFTYPE_AP_VLAN:
  10455. case NL80211_IFTYPE_MESH_POINT:
  10456. case NL80211_IFTYPE_P2P_GO:
  10457. break;
  10458. case NL80211_IFTYPE_NAN:
  10459. if (!wiphy_ext_feature_isset(wdev->wiphy,
  10460. NL80211_EXT_FEATURE_SECURE_NAN))
  10461. return -EOPNOTSUPP;
  10462. break;
  10463. default:
  10464. return -EOPNOTSUPP;
  10465. }
  10466. if (info->attrs[NL80211_ATTR_DURATION]) {
  10467. if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
  10468. return -EINVAL;
  10469. params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  10470. /*
  10471. * We should wait on the channel for at least a minimum amount
  10472. * of time (10ms) but no longer than the driver supports.
  10473. */
  10474. if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
  10475. params.wait > rdev->wiphy.max_remain_on_channel_duration)
  10476. return -EINVAL;
  10477. }
  10478. params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
  10479. if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
  10480. return -EINVAL;
  10481. params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
  10482. /* get the channel if any has been specified, otherwise pass NULL to
  10483. * the driver. The latter will use the current one
  10484. */
  10485. chandef.chan = NULL;
  10486. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  10487. err = nl80211_parse_chandef(rdev, info, &chandef);
  10488. if (err)
  10489. return err;
  10490. }
  10491. if (!chandef.chan && params.offchan)
  10492. return -EINVAL;
  10493. wdev_lock(wdev);
  10494. if (params.offchan &&
  10495. !cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) {
  10496. wdev_unlock(wdev);
  10497. return -EBUSY;
  10498. }
  10499. params.link_id = nl80211_link_id_or_invalid(info->attrs);
  10500. /*
  10501. * This now races due to the unlock, but we cannot check
  10502. * the valid links for the _station_ anyway, so that's up
  10503. * to the driver.
  10504. */
  10505. if (params.link_id >= 0 &&
  10506. !(wdev->valid_links & BIT(params.link_id))) {
  10507. wdev_unlock(wdev);
  10508. return -EINVAL;
  10509. }
  10510. wdev_unlock(wdev);
  10511. params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
  10512. params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
  10513. if (info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]) {
  10514. int len = nla_len(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
  10515. int i;
  10516. if (len % sizeof(u16))
  10517. return -EINVAL;
  10518. params.n_csa_offsets = len / sizeof(u16);
  10519. params.csa_offsets =
  10520. nla_data(info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX]);
  10521. /* check that all the offsets fit the frame */
  10522. for (i = 0; i < params.n_csa_offsets; i++) {
  10523. if (params.csa_offsets[i] >= params.len)
  10524. return -EINVAL;
  10525. }
  10526. }
  10527. if (!params.dont_wait_for_ack) {
  10528. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  10529. if (!msg)
  10530. return -ENOMEM;
  10531. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  10532. NL80211_CMD_FRAME);
  10533. if (!hdr) {
  10534. err = -ENOBUFS;
  10535. goto free_msg;
  10536. }
  10537. }
  10538. params.chan = chandef.chan;
  10539. err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
  10540. if (err)
  10541. goto free_msg;
  10542. if (msg) {
  10543. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  10544. NL80211_ATTR_PAD))
  10545. goto nla_put_failure;
  10546. genlmsg_end(msg, hdr);
  10547. return genlmsg_reply(msg, info);
  10548. }
  10549. return 0;
  10550. nla_put_failure:
  10551. err = -ENOBUFS;
  10552. free_msg:
  10553. nlmsg_free(msg);
  10554. return err;
  10555. }
  10556. static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
  10557. {
  10558. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10559. struct wireless_dev *wdev = info->user_ptr[1];
  10560. u64 cookie;
  10561. if (!info->attrs[NL80211_ATTR_COOKIE])
  10562. return -EINVAL;
  10563. if (!rdev->ops->mgmt_tx_cancel_wait)
  10564. return -EOPNOTSUPP;
  10565. switch (wdev->iftype) {
  10566. case NL80211_IFTYPE_STATION:
  10567. case NL80211_IFTYPE_ADHOC:
  10568. case NL80211_IFTYPE_P2P_CLIENT:
  10569. case NL80211_IFTYPE_AP:
  10570. case NL80211_IFTYPE_AP_VLAN:
  10571. case NL80211_IFTYPE_P2P_GO:
  10572. case NL80211_IFTYPE_P2P_DEVICE:
  10573. break;
  10574. case NL80211_IFTYPE_NAN:
  10575. if (!wiphy_ext_feature_isset(wdev->wiphy,
  10576. NL80211_EXT_FEATURE_SECURE_NAN))
  10577. return -EOPNOTSUPP;
  10578. break;
  10579. default:
  10580. return -EOPNOTSUPP;
  10581. }
  10582. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  10583. return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
  10584. }
  10585. static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
  10586. {
  10587. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10588. struct wireless_dev *wdev;
  10589. struct net_device *dev = info->user_ptr[1];
  10590. u8 ps_state;
  10591. bool state;
  10592. int err;
  10593. if (!info->attrs[NL80211_ATTR_PS_STATE])
  10594. return -EINVAL;
  10595. ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
  10596. wdev = dev->ieee80211_ptr;
  10597. if (!rdev->ops->set_power_mgmt)
  10598. return -EOPNOTSUPP;
  10599. state = (ps_state == NL80211_PS_ENABLED) ? true : false;
  10600. if (state == wdev->ps)
  10601. return 0;
  10602. err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
  10603. if (!err)
  10604. wdev->ps = state;
  10605. return err;
  10606. }
  10607. static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
  10608. {
  10609. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10610. enum nl80211_ps_state ps_state;
  10611. struct wireless_dev *wdev;
  10612. struct net_device *dev = info->user_ptr[1];
  10613. struct sk_buff *msg;
  10614. void *hdr;
  10615. int err;
  10616. wdev = dev->ieee80211_ptr;
  10617. if (!rdev->ops->set_power_mgmt)
  10618. return -EOPNOTSUPP;
  10619. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  10620. if (!msg)
  10621. return -ENOMEM;
  10622. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  10623. NL80211_CMD_GET_POWER_SAVE);
  10624. if (!hdr) {
  10625. err = -ENOBUFS;
  10626. goto free_msg;
  10627. }
  10628. if (wdev->ps)
  10629. ps_state = NL80211_PS_ENABLED;
  10630. else
  10631. ps_state = NL80211_PS_DISABLED;
  10632. if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
  10633. goto nla_put_failure;
  10634. genlmsg_end(msg, hdr);
  10635. return genlmsg_reply(msg, info);
  10636. nla_put_failure:
  10637. err = -ENOBUFS;
  10638. free_msg:
  10639. nlmsg_free(msg);
  10640. return err;
  10641. }
  10642. static const struct nla_policy
  10643. nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
  10644. [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
  10645. [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
  10646. [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
  10647. [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
  10648. [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
  10649. [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
  10650. [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
  10651. };
  10652. static int nl80211_set_cqm_txe(struct genl_info *info,
  10653. u32 rate, u32 pkts, u32 intvl)
  10654. {
  10655. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10656. struct net_device *dev = info->user_ptr[1];
  10657. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10658. if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
  10659. return -EINVAL;
  10660. if (!rdev->ops->set_cqm_txe_config)
  10661. return -EOPNOTSUPP;
  10662. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  10663. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10664. return -EOPNOTSUPP;
  10665. return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
  10666. }
  10667. static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
  10668. struct net_device *dev)
  10669. {
  10670. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10671. s32 last, low, high;
  10672. u32 hyst;
  10673. int i, n, low_index;
  10674. int err;
  10675. /* RSSI reporting disabled? */
  10676. if (!wdev->cqm_config)
  10677. return rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
  10678. /*
  10679. * Obtain current RSSI value if possible, if not and no RSSI threshold
  10680. * event has been received yet, we should receive an event after a
  10681. * connection is established and enough beacons received to calculate
  10682. * the average.
  10683. */
  10684. if (!wdev->cqm_config->last_rssi_event_value &&
  10685. wdev->links[0].client.current_bss &&
  10686. rdev->ops->get_station) {
  10687. struct station_info sinfo = {};
  10688. u8 *mac_addr;
  10689. mac_addr = wdev->links[0].client.current_bss->pub.bssid;
  10690. err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
  10691. if (err)
  10692. return err;
  10693. cfg80211_sinfo_release_content(&sinfo);
  10694. if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
  10695. wdev->cqm_config->last_rssi_event_value =
  10696. (s8) sinfo.rx_beacon_signal_avg;
  10697. }
  10698. last = wdev->cqm_config->last_rssi_event_value;
  10699. hyst = wdev->cqm_config->rssi_hyst;
  10700. n = wdev->cqm_config->n_rssi_thresholds;
  10701. for (i = 0; i < n; i++) {
  10702. i = array_index_nospec(i, n);
  10703. if (last < wdev->cqm_config->rssi_thresholds[i])
  10704. break;
  10705. }
  10706. low_index = i - 1;
  10707. if (low_index >= 0) {
  10708. low_index = array_index_nospec(low_index, n);
  10709. low = wdev->cqm_config->rssi_thresholds[low_index] - hyst;
  10710. } else {
  10711. low = S32_MIN;
  10712. }
  10713. if (i < n) {
  10714. i = array_index_nospec(i, n);
  10715. high = wdev->cqm_config->rssi_thresholds[i] + hyst - 1;
  10716. } else {
  10717. high = S32_MAX;
  10718. }
  10719. return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
  10720. }
  10721. static int nl80211_set_cqm_rssi(struct genl_info *info,
  10722. const s32 *thresholds, int n_thresholds,
  10723. u32 hysteresis)
  10724. {
  10725. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10726. struct net_device *dev = info->user_ptr[1];
  10727. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10728. int i, err;
  10729. s32 prev = S32_MIN;
  10730. /* Check all values negative and sorted */
  10731. for (i = 0; i < n_thresholds; i++) {
  10732. if (thresholds[i] > 0 || thresholds[i] <= prev)
  10733. return -EINVAL;
  10734. prev = thresholds[i];
  10735. }
  10736. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  10737. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10738. return -EOPNOTSUPP;
  10739. wdev_lock(wdev);
  10740. cfg80211_cqm_config_free(wdev);
  10741. wdev_unlock(wdev);
  10742. if (n_thresholds <= 1 && rdev->ops->set_cqm_rssi_config) {
  10743. if (n_thresholds == 0 || thresholds[0] == 0) /* Disabling */
  10744. return rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
  10745. return rdev_set_cqm_rssi_config(rdev, dev,
  10746. thresholds[0], hysteresis);
  10747. }
  10748. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  10749. NL80211_EXT_FEATURE_CQM_RSSI_LIST))
  10750. return -EOPNOTSUPP;
  10751. if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
  10752. n_thresholds = 0;
  10753. wdev_lock(wdev);
  10754. if (n_thresholds) {
  10755. struct cfg80211_cqm_config *cqm_config;
  10756. cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds,
  10757. n_thresholds),
  10758. GFP_KERNEL);
  10759. if (!cqm_config) {
  10760. err = -ENOMEM;
  10761. goto unlock;
  10762. }
  10763. cqm_config->rssi_hyst = hysteresis;
  10764. cqm_config->n_rssi_thresholds = n_thresholds;
  10765. memcpy(cqm_config->rssi_thresholds, thresholds,
  10766. flex_array_size(cqm_config, rssi_thresholds,
  10767. n_thresholds));
  10768. wdev->cqm_config = cqm_config;
  10769. }
  10770. err = cfg80211_cqm_rssi_update(rdev, dev);
  10771. unlock:
  10772. wdev_unlock(wdev);
  10773. return err;
  10774. }
  10775. static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
  10776. {
  10777. struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
  10778. struct nlattr *cqm;
  10779. int err;
  10780. cqm = info->attrs[NL80211_ATTR_CQM];
  10781. if (!cqm)
  10782. return -EINVAL;
  10783. err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm,
  10784. nl80211_attr_cqm_policy,
  10785. info->extack);
  10786. if (err)
  10787. return err;
  10788. if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
  10789. attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
  10790. const s32 *thresholds =
  10791. nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
  10792. int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
  10793. u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
  10794. if (len % 4)
  10795. return -EINVAL;
  10796. return nl80211_set_cqm_rssi(info, thresholds, len / 4,
  10797. hysteresis);
  10798. }
  10799. if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
  10800. attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
  10801. attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
  10802. u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
  10803. u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
  10804. u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
  10805. return nl80211_set_cqm_txe(info, rate, pkts, intvl);
  10806. }
  10807. return -EINVAL;
  10808. }
  10809. static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
  10810. {
  10811. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10812. struct net_device *dev = info->user_ptr[1];
  10813. struct ocb_setup setup = {};
  10814. int err;
  10815. err = nl80211_parse_chandef(rdev, info, &setup.chandef);
  10816. if (err)
  10817. return err;
  10818. return cfg80211_join_ocb(rdev, dev, &setup);
  10819. }
  10820. static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
  10821. {
  10822. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10823. struct net_device *dev = info->user_ptr[1];
  10824. return cfg80211_leave_ocb(rdev, dev);
  10825. }
  10826. static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
  10827. {
  10828. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10829. struct net_device *dev = info->user_ptr[1];
  10830. struct mesh_config cfg;
  10831. struct mesh_setup setup;
  10832. int err;
  10833. /* start with default */
  10834. memcpy(&cfg, &default_mesh_config, sizeof(cfg));
  10835. memcpy(&setup, &default_mesh_setup, sizeof(setup));
  10836. if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
  10837. /* and parse parameters if given */
  10838. err = nl80211_parse_mesh_config(info, &cfg, NULL);
  10839. if (err)
  10840. return err;
  10841. }
  10842. if (!info->attrs[NL80211_ATTR_MESH_ID] ||
  10843. !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
  10844. return -EINVAL;
  10845. setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
  10846. setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  10847. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  10848. !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
  10849. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  10850. return -EINVAL;
  10851. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
  10852. setup.beacon_interval =
  10853. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  10854. err = cfg80211_validate_beacon_int(rdev,
  10855. NL80211_IFTYPE_MESH_POINT,
  10856. setup.beacon_interval);
  10857. if (err)
  10858. return err;
  10859. }
  10860. if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
  10861. setup.dtim_period =
  10862. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  10863. if (setup.dtim_period < 1 || setup.dtim_period > 100)
  10864. return -EINVAL;
  10865. }
  10866. if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
  10867. /* parse additional setup parameters if given */
  10868. err = nl80211_parse_mesh_setup(info, &setup);
  10869. if (err)
  10870. return err;
  10871. }
  10872. if (setup.user_mpm)
  10873. cfg.auto_open_plinks = false;
  10874. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  10875. err = nl80211_parse_chandef(rdev, info, &setup.chandef);
  10876. if (err)
  10877. return err;
  10878. } else {
  10879. /* __cfg80211_join_mesh() will sort it out */
  10880. setup.chandef.chan = NULL;
  10881. }
  10882. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  10883. u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  10884. int n_rates =
  10885. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  10886. struct ieee80211_supported_band *sband;
  10887. if (!setup.chandef.chan)
  10888. return -EINVAL;
  10889. sband = rdev->wiphy.bands[setup.chandef.chan->band];
  10890. err = ieee80211_get_ratemask(sband, rates, n_rates,
  10891. &setup.basic_rates);
  10892. if (err)
  10893. return err;
  10894. }
  10895. if (info->attrs[NL80211_ATTR_TX_RATES]) {
  10896. err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
  10897. NL80211_ATTR_TX_RATES,
  10898. &setup.beacon_rate,
  10899. dev, false, 0);
  10900. if (err)
  10901. return err;
  10902. if (!setup.chandef.chan)
  10903. return -EINVAL;
  10904. err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
  10905. &setup.beacon_rate);
  10906. if (err)
  10907. return err;
  10908. }
  10909. setup.userspace_handles_dfs =
  10910. nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
  10911. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  10912. int r = validate_pae_over_nl80211(rdev, info);
  10913. if (r < 0)
  10914. return r;
  10915. setup.control_port_over_nl80211 = true;
  10916. }
  10917. wdev_lock(dev->ieee80211_ptr);
  10918. err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg);
  10919. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER])
  10920. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  10921. wdev_unlock(dev->ieee80211_ptr);
  10922. return err;
  10923. }
  10924. static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
  10925. {
  10926. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10927. struct net_device *dev = info->user_ptr[1];
  10928. return cfg80211_leave_mesh(rdev, dev);
  10929. }
  10930. #ifdef CONFIG_PM
  10931. static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
  10932. struct cfg80211_registered_device *rdev)
  10933. {
  10934. struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
  10935. struct nlattr *nl_pats, *nl_pat;
  10936. int i, pat_len;
  10937. if (!wowlan->n_patterns)
  10938. return 0;
  10939. nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
  10940. if (!nl_pats)
  10941. return -ENOBUFS;
  10942. for (i = 0; i < wowlan->n_patterns; i++) {
  10943. nl_pat = nla_nest_start_noflag(msg, i + 1);
  10944. if (!nl_pat)
  10945. return -ENOBUFS;
  10946. pat_len = wowlan->patterns[i].pattern_len;
  10947. if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
  10948. wowlan->patterns[i].mask) ||
  10949. nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
  10950. wowlan->patterns[i].pattern) ||
  10951. nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
  10952. wowlan->patterns[i].pkt_offset))
  10953. return -ENOBUFS;
  10954. nla_nest_end(msg, nl_pat);
  10955. }
  10956. nla_nest_end(msg, nl_pats);
  10957. return 0;
  10958. }
  10959. static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
  10960. struct cfg80211_wowlan_tcp *tcp)
  10961. {
  10962. struct nlattr *nl_tcp;
  10963. if (!tcp)
  10964. return 0;
  10965. nl_tcp = nla_nest_start_noflag(msg,
  10966. NL80211_WOWLAN_TRIG_TCP_CONNECTION);
  10967. if (!nl_tcp)
  10968. return -ENOBUFS;
  10969. if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
  10970. nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
  10971. nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
  10972. nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
  10973. nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
  10974. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  10975. tcp->payload_len, tcp->payload) ||
  10976. nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
  10977. tcp->data_interval) ||
  10978. nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
  10979. tcp->wake_len, tcp->wake_data) ||
  10980. nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
  10981. DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
  10982. return -ENOBUFS;
  10983. if (tcp->payload_seq.len &&
  10984. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
  10985. sizeof(tcp->payload_seq), &tcp->payload_seq))
  10986. return -ENOBUFS;
  10987. if (tcp->payload_tok.len &&
  10988. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
  10989. sizeof(tcp->payload_tok) + tcp->tokens_size,
  10990. &tcp->payload_tok))
  10991. return -ENOBUFS;
  10992. nla_nest_end(msg, nl_tcp);
  10993. return 0;
  10994. }
  10995. static int nl80211_send_wowlan_nd(struct sk_buff *msg,
  10996. struct cfg80211_sched_scan_request *req)
  10997. {
  10998. struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
  10999. int i;
  11000. if (!req)
  11001. return 0;
  11002. nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
  11003. if (!nd)
  11004. return -ENOBUFS;
  11005. if (req->n_scan_plans == 1 &&
  11006. nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
  11007. req->scan_plans[0].interval * 1000))
  11008. return -ENOBUFS;
  11009. if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
  11010. return -ENOBUFS;
  11011. if (req->relative_rssi_set) {
  11012. struct nl80211_bss_select_rssi_adjust rssi_adjust;
  11013. if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
  11014. req->relative_rssi))
  11015. return -ENOBUFS;
  11016. rssi_adjust.band = req->rssi_adjust.band;
  11017. rssi_adjust.delta = req->rssi_adjust.delta;
  11018. if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
  11019. sizeof(rssi_adjust), &rssi_adjust))
  11020. return -ENOBUFS;
  11021. }
  11022. freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
  11023. if (!freqs)
  11024. return -ENOBUFS;
  11025. for (i = 0; i < req->n_channels; i++) {
  11026. if (nla_put_u32(msg, i, req->channels[i]->center_freq))
  11027. return -ENOBUFS;
  11028. }
  11029. nla_nest_end(msg, freqs);
  11030. if (req->n_match_sets) {
  11031. matches = nla_nest_start_noflag(msg,
  11032. NL80211_ATTR_SCHED_SCAN_MATCH);
  11033. if (!matches)
  11034. return -ENOBUFS;
  11035. for (i = 0; i < req->n_match_sets; i++) {
  11036. match = nla_nest_start_noflag(msg, i);
  11037. if (!match)
  11038. return -ENOBUFS;
  11039. if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
  11040. req->match_sets[i].ssid.ssid_len,
  11041. req->match_sets[i].ssid.ssid))
  11042. return -ENOBUFS;
  11043. nla_nest_end(msg, match);
  11044. }
  11045. nla_nest_end(msg, matches);
  11046. }
  11047. scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
  11048. if (!scan_plans)
  11049. return -ENOBUFS;
  11050. for (i = 0; i < req->n_scan_plans; i++) {
  11051. scan_plan = nla_nest_start_noflag(msg, i + 1);
  11052. if (!scan_plan)
  11053. return -ENOBUFS;
  11054. if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
  11055. req->scan_plans[i].interval) ||
  11056. (req->scan_plans[i].iterations &&
  11057. nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
  11058. req->scan_plans[i].iterations)))
  11059. return -ENOBUFS;
  11060. nla_nest_end(msg, scan_plan);
  11061. }
  11062. nla_nest_end(msg, scan_plans);
  11063. nla_nest_end(msg, nd);
  11064. return 0;
  11065. }
  11066. static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
  11067. {
  11068. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11069. struct sk_buff *msg;
  11070. void *hdr;
  11071. u32 size = NLMSG_DEFAULT_SIZE;
  11072. if (!rdev->wiphy.wowlan)
  11073. return -EOPNOTSUPP;
  11074. if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
  11075. /* adjust size to have room for all the data */
  11076. size += rdev->wiphy.wowlan_config->tcp->tokens_size +
  11077. rdev->wiphy.wowlan_config->tcp->payload_len +
  11078. rdev->wiphy.wowlan_config->tcp->wake_len +
  11079. rdev->wiphy.wowlan_config->tcp->wake_len / 8;
  11080. }
  11081. msg = nlmsg_new(size, GFP_KERNEL);
  11082. if (!msg)
  11083. return -ENOMEM;
  11084. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  11085. NL80211_CMD_GET_WOWLAN);
  11086. if (!hdr)
  11087. goto nla_put_failure;
  11088. if (rdev->wiphy.wowlan_config) {
  11089. struct nlattr *nl_wowlan;
  11090. nl_wowlan = nla_nest_start_noflag(msg,
  11091. NL80211_ATTR_WOWLAN_TRIGGERS);
  11092. if (!nl_wowlan)
  11093. goto nla_put_failure;
  11094. if ((rdev->wiphy.wowlan_config->any &&
  11095. nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
  11096. (rdev->wiphy.wowlan_config->disconnect &&
  11097. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
  11098. (rdev->wiphy.wowlan_config->magic_pkt &&
  11099. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
  11100. (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
  11101. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
  11102. (rdev->wiphy.wowlan_config->eap_identity_req &&
  11103. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
  11104. (rdev->wiphy.wowlan_config->four_way_handshake &&
  11105. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
  11106. (rdev->wiphy.wowlan_config->rfkill_release &&
  11107. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
  11108. goto nla_put_failure;
  11109. if (nl80211_send_wowlan_patterns(msg, rdev))
  11110. goto nla_put_failure;
  11111. if (nl80211_send_wowlan_tcp(msg,
  11112. rdev->wiphy.wowlan_config->tcp))
  11113. goto nla_put_failure;
  11114. if (nl80211_send_wowlan_nd(
  11115. msg,
  11116. rdev->wiphy.wowlan_config->nd_config))
  11117. goto nla_put_failure;
  11118. nla_nest_end(msg, nl_wowlan);
  11119. }
  11120. genlmsg_end(msg, hdr);
  11121. return genlmsg_reply(msg, info);
  11122. nla_put_failure:
  11123. nlmsg_free(msg);
  11124. return -ENOBUFS;
  11125. }
  11126. static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
  11127. struct nlattr *attr,
  11128. struct cfg80211_wowlan *trig)
  11129. {
  11130. struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
  11131. struct cfg80211_wowlan_tcp *cfg;
  11132. struct nl80211_wowlan_tcp_data_token *tok = NULL;
  11133. struct nl80211_wowlan_tcp_data_seq *seq = NULL;
  11134. u32 size;
  11135. u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
  11136. int err, port;
  11137. if (!rdev->wiphy.wowlan->tcp)
  11138. return -EINVAL;
  11139. err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr,
  11140. nl80211_wowlan_tcp_policy, NULL);
  11141. if (err)
  11142. return err;
  11143. if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
  11144. !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
  11145. !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
  11146. !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
  11147. !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
  11148. !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
  11149. !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
  11150. !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
  11151. return -EINVAL;
  11152. data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
  11153. if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
  11154. return -EINVAL;
  11155. if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
  11156. rdev->wiphy.wowlan->tcp->data_interval_max ||
  11157. nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
  11158. return -EINVAL;
  11159. wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
  11160. if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
  11161. return -EINVAL;
  11162. wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
  11163. if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
  11164. return -EINVAL;
  11165. if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
  11166. u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
  11167. tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
  11168. tokens_size = tokln - sizeof(*tok);
  11169. if (!tok->len || tokens_size % tok->len)
  11170. return -EINVAL;
  11171. if (!rdev->wiphy.wowlan->tcp->tok)
  11172. return -EINVAL;
  11173. if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
  11174. return -EINVAL;
  11175. if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
  11176. return -EINVAL;
  11177. if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
  11178. return -EINVAL;
  11179. if (tok->offset + tok->len > data_size)
  11180. return -EINVAL;
  11181. }
  11182. if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
  11183. seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
  11184. if (!rdev->wiphy.wowlan->tcp->seq)
  11185. return -EINVAL;
  11186. if (seq->len == 0 || seq->len > 4)
  11187. return -EINVAL;
  11188. if (seq->len + seq->offset > data_size)
  11189. return -EINVAL;
  11190. }
  11191. size = sizeof(*cfg);
  11192. size += data_size;
  11193. size += wake_size + wake_mask_size;
  11194. size += tokens_size;
  11195. cfg = kzalloc(size, GFP_KERNEL);
  11196. if (!cfg)
  11197. return -ENOMEM;
  11198. cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
  11199. cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
  11200. memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
  11201. ETH_ALEN);
  11202. if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
  11203. port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
  11204. else
  11205. port = 0;
  11206. #ifdef CONFIG_INET
  11207. /* allocate a socket and port for it and use it */
  11208. err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
  11209. IPPROTO_TCP, &cfg->sock, 1);
  11210. if (err) {
  11211. kfree(cfg);
  11212. return err;
  11213. }
  11214. if (inet_csk_get_port(cfg->sock->sk, port)) {
  11215. sock_release(cfg->sock);
  11216. kfree(cfg);
  11217. return -EADDRINUSE;
  11218. }
  11219. cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
  11220. #else
  11221. if (!port) {
  11222. kfree(cfg);
  11223. return -EINVAL;
  11224. }
  11225. cfg->src_port = port;
  11226. #endif
  11227. cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
  11228. cfg->payload_len = data_size;
  11229. cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
  11230. memcpy((void *)cfg->payload,
  11231. nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
  11232. data_size);
  11233. if (seq)
  11234. cfg->payload_seq = *seq;
  11235. cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
  11236. cfg->wake_len = wake_size;
  11237. cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
  11238. memcpy((void *)cfg->wake_data,
  11239. nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
  11240. wake_size);
  11241. cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
  11242. data_size + wake_size;
  11243. memcpy((void *)cfg->wake_mask,
  11244. nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
  11245. wake_mask_size);
  11246. if (tok) {
  11247. cfg->tokens_size = tokens_size;
  11248. cfg->payload_tok = *tok;
  11249. memcpy(cfg->payload_tok.token_stream, tok->token_stream,
  11250. tokens_size);
  11251. }
  11252. trig->tcp = cfg;
  11253. return 0;
  11254. }
  11255. static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
  11256. const struct wiphy_wowlan_support *wowlan,
  11257. struct nlattr *attr,
  11258. struct cfg80211_wowlan *trig)
  11259. {
  11260. struct nlattr **tb;
  11261. int err;
  11262. tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
  11263. if (!tb)
  11264. return -ENOMEM;
  11265. if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
  11266. err = -EOPNOTSUPP;
  11267. goto out;
  11268. }
  11269. err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr,
  11270. nl80211_policy, NULL);
  11271. if (err)
  11272. goto out;
  11273. trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
  11274. wowlan->max_nd_match_sets);
  11275. err = PTR_ERR_OR_ZERO(trig->nd_config);
  11276. if (err)
  11277. trig->nd_config = NULL;
  11278. out:
  11279. kfree(tb);
  11280. return err;
  11281. }
  11282. static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
  11283. {
  11284. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11285. struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
  11286. struct cfg80211_wowlan new_triggers = {};
  11287. struct cfg80211_wowlan *ntrig;
  11288. const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
  11289. int err, i;
  11290. bool prev_enabled = rdev->wiphy.wowlan_config;
  11291. bool regular = false;
  11292. if (!wowlan)
  11293. return -EOPNOTSUPP;
  11294. if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
  11295. cfg80211_rdev_free_wowlan(rdev);
  11296. rdev->wiphy.wowlan_config = NULL;
  11297. goto set_wakeup;
  11298. }
  11299. err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG,
  11300. info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
  11301. nl80211_wowlan_policy, info->extack);
  11302. if (err)
  11303. return err;
  11304. if (tb[NL80211_WOWLAN_TRIG_ANY]) {
  11305. if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
  11306. return -EINVAL;
  11307. new_triggers.any = true;
  11308. }
  11309. if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
  11310. if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
  11311. return -EINVAL;
  11312. new_triggers.disconnect = true;
  11313. regular = true;
  11314. }
  11315. if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
  11316. if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
  11317. return -EINVAL;
  11318. new_triggers.magic_pkt = true;
  11319. regular = true;
  11320. }
  11321. if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
  11322. return -EINVAL;
  11323. if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
  11324. if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
  11325. return -EINVAL;
  11326. new_triggers.gtk_rekey_failure = true;
  11327. regular = true;
  11328. }
  11329. if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
  11330. if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
  11331. return -EINVAL;
  11332. new_triggers.eap_identity_req = true;
  11333. regular = true;
  11334. }
  11335. if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
  11336. if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
  11337. return -EINVAL;
  11338. new_triggers.four_way_handshake = true;
  11339. regular = true;
  11340. }
  11341. if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
  11342. if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
  11343. return -EINVAL;
  11344. new_triggers.rfkill_release = true;
  11345. regular = true;
  11346. }
  11347. if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
  11348. struct nlattr *pat;
  11349. int n_patterns = 0;
  11350. int rem, pat_len, mask_len, pkt_offset;
  11351. struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
  11352. regular = true;
  11353. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  11354. rem)
  11355. n_patterns++;
  11356. if (n_patterns > wowlan->n_patterns)
  11357. return -EINVAL;
  11358. new_triggers.patterns = kcalloc(n_patterns,
  11359. sizeof(new_triggers.patterns[0]),
  11360. GFP_KERNEL);
  11361. if (!new_triggers.patterns)
  11362. return -ENOMEM;
  11363. new_triggers.n_patterns = n_patterns;
  11364. i = 0;
  11365. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  11366. rem) {
  11367. u8 *mask_pat;
  11368. err = nla_parse_nested_deprecated(pat_tb,
  11369. MAX_NL80211_PKTPAT,
  11370. pat,
  11371. nl80211_packet_pattern_policy,
  11372. info->extack);
  11373. if (err)
  11374. goto error;
  11375. err = -EINVAL;
  11376. if (!pat_tb[NL80211_PKTPAT_MASK] ||
  11377. !pat_tb[NL80211_PKTPAT_PATTERN])
  11378. goto error;
  11379. pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
  11380. mask_len = DIV_ROUND_UP(pat_len, 8);
  11381. if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
  11382. goto error;
  11383. if (pat_len > wowlan->pattern_max_len ||
  11384. pat_len < wowlan->pattern_min_len)
  11385. goto error;
  11386. if (!pat_tb[NL80211_PKTPAT_OFFSET])
  11387. pkt_offset = 0;
  11388. else
  11389. pkt_offset = nla_get_u32(
  11390. pat_tb[NL80211_PKTPAT_OFFSET]);
  11391. if (pkt_offset > wowlan->max_pkt_offset)
  11392. goto error;
  11393. new_triggers.patterns[i].pkt_offset = pkt_offset;
  11394. mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
  11395. if (!mask_pat) {
  11396. err = -ENOMEM;
  11397. goto error;
  11398. }
  11399. new_triggers.patterns[i].mask = mask_pat;
  11400. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
  11401. mask_len);
  11402. mask_pat += mask_len;
  11403. new_triggers.patterns[i].pattern = mask_pat;
  11404. new_triggers.patterns[i].pattern_len = pat_len;
  11405. memcpy(mask_pat,
  11406. nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
  11407. pat_len);
  11408. i++;
  11409. }
  11410. }
  11411. if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
  11412. regular = true;
  11413. err = nl80211_parse_wowlan_tcp(
  11414. rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
  11415. &new_triggers);
  11416. if (err)
  11417. goto error;
  11418. }
  11419. if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
  11420. regular = true;
  11421. err = nl80211_parse_wowlan_nd(
  11422. rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
  11423. &new_triggers);
  11424. if (err)
  11425. goto error;
  11426. }
  11427. /* The 'any' trigger means the device continues operating more or less
  11428. * as in its normal operation mode and wakes up the host on most of the
  11429. * normal interrupts (like packet RX, ...)
  11430. * It therefore makes little sense to combine with the more constrained
  11431. * wakeup trigger modes.
  11432. */
  11433. if (new_triggers.any && regular) {
  11434. err = -EINVAL;
  11435. goto error;
  11436. }
  11437. ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
  11438. if (!ntrig) {
  11439. err = -ENOMEM;
  11440. goto error;
  11441. }
  11442. cfg80211_rdev_free_wowlan(rdev);
  11443. rdev->wiphy.wowlan_config = ntrig;
  11444. set_wakeup:
  11445. if (rdev->ops->set_wakeup &&
  11446. prev_enabled != !!rdev->wiphy.wowlan_config)
  11447. rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
  11448. return 0;
  11449. error:
  11450. for (i = 0; i < new_triggers.n_patterns; i++)
  11451. kfree(new_triggers.patterns[i].mask);
  11452. kfree(new_triggers.patterns);
  11453. if (new_triggers.tcp && new_triggers.tcp->sock)
  11454. sock_release(new_triggers.tcp->sock);
  11455. kfree(new_triggers.tcp);
  11456. kfree(new_triggers.nd_config);
  11457. return err;
  11458. }
  11459. #endif
  11460. static int nl80211_send_coalesce_rules(struct sk_buff *msg,
  11461. struct cfg80211_registered_device *rdev)
  11462. {
  11463. struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
  11464. int i, j, pat_len;
  11465. struct cfg80211_coalesce_rules *rule;
  11466. if (!rdev->coalesce->n_rules)
  11467. return 0;
  11468. nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE);
  11469. if (!nl_rules)
  11470. return -ENOBUFS;
  11471. for (i = 0; i < rdev->coalesce->n_rules; i++) {
  11472. nl_rule = nla_nest_start_noflag(msg, i + 1);
  11473. if (!nl_rule)
  11474. return -ENOBUFS;
  11475. rule = &rdev->coalesce->rules[i];
  11476. if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
  11477. rule->delay))
  11478. return -ENOBUFS;
  11479. if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
  11480. rule->condition))
  11481. return -ENOBUFS;
  11482. nl_pats = nla_nest_start_noflag(msg,
  11483. NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
  11484. if (!nl_pats)
  11485. return -ENOBUFS;
  11486. for (j = 0; j < rule->n_patterns; j++) {
  11487. nl_pat = nla_nest_start_noflag(msg, j + 1);
  11488. if (!nl_pat)
  11489. return -ENOBUFS;
  11490. pat_len = rule->patterns[j].pattern_len;
  11491. if (nla_put(msg, NL80211_PKTPAT_MASK,
  11492. DIV_ROUND_UP(pat_len, 8),
  11493. rule->patterns[j].mask) ||
  11494. nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
  11495. rule->patterns[j].pattern) ||
  11496. nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
  11497. rule->patterns[j].pkt_offset))
  11498. return -ENOBUFS;
  11499. nla_nest_end(msg, nl_pat);
  11500. }
  11501. nla_nest_end(msg, nl_pats);
  11502. nla_nest_end(msg, nl_rule);
  11503. }
  11504. nla_nest_end(msg, nl_rules);
  11505. return 0;
  11506. }
  11507. static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
  11508. {
  11509. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11510. struct sk_buff *msg;
  11511. void *hdr;
  11512. if (!rdev->wiphy.coalesce)
  11513. return -EOPNOTSUPP;
  11514. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11515. if (!msg)
  11516. return -ENOMEM;
  11517. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  11518. NL80211_CMD_GET_COALESCE);
  11519. if (!hdr)
  11520. goto nla_put_failure;
  11521. if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
  11522. goto nla_put_failure;
  11523. genlmsg_end(msg, hdr);
  11524. return genlmsg_reply(msg, info);
  11525. nla_put_failure:
  11526. nlmsg_free(msg);
  11527. return -ENOBUFS;
  11528. }
  11529. void cfg80211_rdev_free_coalesce(struct cfg80211_registered_device *rdev)
  11530. {
  11531. struct cfg80211_coalesce *coalesce = rdev->coalesce;
  11532. int i, j;
  11533. struct cfg80211_coalesce_rules *rule;
  11534. if (!coalesce)
  11535. return;
  11536. for (i = 0; i < coalesce->n_rules; i++) {
  11537. rule = &coalesce->rules[i];
  11538. for (j = 0; j < rule->n_patterns; j++)
  11539. kfree(rule->patterns[j].mask);
  11540. kfree(rule->patterns);
  11541. }
  11542. kfree(coalesce->rules);
  11543. kfree(coalesce);
  11544. rdev->coalesce = NULL;
  11545. }
  11546. static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
  11547. struct nlattr *rule,
  11548. struct cfg80211_coalesce_rules *new_rule)
  11549. {
  11550. int err, i;
  11551. const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
  11552. struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
  11553. int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
  11554. struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
  11555. err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX,
  11556. rule, nl80211_coalesce_policy, NULL);
  11557. if (err)
  11558. return err;
  11559. if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
  11560. new_rule->delay =
  11561. nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
  11562. if (new_rule->delay > coalesce->max_delay)
  11563. return -EINVAL;
  11564. if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
  11565. new_rule->condition =
  11566. nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
  11567. if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
  11568. return -EINVAL;
  11569. nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
  11570. rem)
  11571. n_patterns++;
  11572. if (n_patterns > coalesce->n_patterns)
  11573. return -EINVAL;
  11574. new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
  11575. GFP_KERNEL);
  11576. if (!new_rule->patterns)
  11577. return -ENOMEM;
  11578. new_rule->n_patterns = n_patterns;
  11579. i = 0;
  11580. nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
  11581. rem) {
  11582. u8 *mask_pat;
  11583. err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT,
  11584. pat,
  11585. nl80211_packet_pattern_policy,
  11586. NULL);
  11587. if (err)
  11588. return err;
  11589. if (!pat_tb[NL80211_PKTPAT_MASK] ||
  11590. !pat_tb[NL80211_PKTPAT_PATTERN])
  11591. return -EINVAL;
  11592. pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
  11593. mask_len = DIV_ROUND_UP(pat_len, 8);
  11594. if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
  11595. return -EINVAL;
  11596. if (pat_len > coalesce->pattern_max_len ||
  11597. pat_len < coalesce->pattern_min_len)
  11598. return -EINVAL;
  11599. if (!pat_tb[NL80211_PKTPAT_OFFSET])
  11600. pkt_offset = 0;
  11601. else
  11602. pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
  11603. if (pkt_offset > coalesce->max_pkt_offset)
  11604. return -EINVAL;
  11605. new_rule->patterns[i].pkt_offset = pkt_offset;
  11606. mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
  11607. if (!mask_pat)
  11608. return -ENOMEM;
  11609. new_rule->patterns[i].mask = mask_pat;
  11610. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
  11611. mask_len);
  11612. mask_pat += mask_len;
  11613. new_rule->patterns[i].pattern = mask_pat;
  11614. new_rule->patterns[i].pattern_len = pat_len;
  11615. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
  11616. pat_len);
  11617. i++;
  11618. }
  11619. return 0;
  11620. }
  11621. static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
  11622. {
  11623. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11624. const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
  11625. struct cfg80211_coalesce new_coalesce = {};
  11626. struct cfg80211_coalesce *n_coalesce;
  11627. int err, rem_rule, n_rules = 0, i, j;
  11628. struct nlattr *rule;
  11629. struct cfg80211_coalesce_rules *tmp_rule;
  11630. if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
  11631. return -EOPNOTSUPP;
  11632. if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
  11633. cfg80211_rdev_free_coalesce(rdev);
  11634. rdev_set_coalesce(rdev, NULL);
  11635. return 0;
  11636. }
  11637. nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
  11638. rem_rule)
  11639. n_rules++;
  11640. if (n_rules > coalesce->n_rules)
  11641. return -EINVAL;
  11642. new_coalesce.rules = kcalloc(n_rules, sizeof(new_coalesce.rules[0]),
  11643. GFP_KERNEL);
  11644. if (!new_coalesce.rules)
  11645. return -ENOMEM;
  11646. new_coalesce.n_rules = n_rules;
  11647. i = 0;
  11648. nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
  11649. rem_rule) {
  11650. err = nl80211_parse_coalesce_rule(rdev, rule,
  11651. &new_coalesce.rules[i]);
  11652. if (err)
  11653. goto error;
  11654. i++;
  11655. }
  11656. err = rdev_set_coalesce(rdev, &new_coalesce);
  11657. if (err)
  11658. goto error;
  11659. n_coalesce = kmemdup(&new_coalesce, sizeof(new_coalesce), GFP_KERNEL);
  11660. if (!n_coalesce) {
  11661. err = -ENOMEM;
  11662. goto error;
  11663. }
  11664. cfg80211_rdev_free_coalesce(rdev);
  11665. rdev->coalesce = n_coalesce;
  11666. return 0;
  11667. error:
  11668. for (i = 0; i < new_coalesce.n_rules; i++) {
  11669. tmp_rule = &new_coalesce.rules[i];
  11670. for (j = 0; j < tmp_rule->n_patterns; j++)
  11671. kfree(tmp_rule->patterns[j].mask);
  11672. kfree(tmp_rule->patterns);
  11673. }
  11674. kfree(new_coalesce.rules);
  11675. return err;
  11676. }
  11677. static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
  11678. {
  11679. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11680. struct net_device *dev = info->user_ptr[1];
  11681. struct wireless_dev *wdev = dev->ieee80211_ptr;
  11682. struct nlattr *tb[NUM_NL80211_REKEY_DATA];
  11683. struct cfg80211_gtk_rekey_data rekey_data = {};
  11684. int err;
  11685. if (!info->attrs[NL80211_ATTR_REKEY_DATA])
  11686. return -EINVAL;
  11687. err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA,
  11688. info->attrs[NL80211_ATTR_REKEY_DATA],
  11689. nl80211_rekey_policy, info->extack);
  11690. if (err)
  11691. return err;
  11692. if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
  11693. !tb[NL80211_REKEY_DATA_KCK])
  11694. return -EINVAL;
  11695. if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN &&
  11696. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK &&
  11697. nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN))
  11698. return -ERANGE;
  11699. if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN &&
  11700. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK &&
  11701. nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) &&
  11702. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 &&
  11703. nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32))
  11704. return -ERANGE;
  11705. rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
  11706. rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
  11707. rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
  11708. rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]);
  11709. rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]);
  11710. if (tb[NL80211_REKEY_DATA_AKM])
  11711. rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]);
  11712. wdev_lock(wdev);
  11713. if (!wdev->connected) {
  11714. err = -ENOTCONN;
  11715. goto out;
  11716. }
  11717. if (!rdev->ops->set_rekey_data) {
  11718. err = -EOPNOTSUPP;
  11719. goto out;
  11720. }
  11721. err = rdev_set_rekey_data(rdev, dev, &rekey_data);
  11722. out:
  11723. wdev_unlock(wdev);
  11724. return err;
  11725. }
  11726. static int nl80211_register_unexpected_frame(struct sk_buff *skb,
  11727. struct genl_info *info)
  11728. {
  11729. struct net_device *dev = info->user_ptr[1];
  11730. struct wireless_dev *wdev = dev->ieee80211_ptr;
  11731. if (wdev->iftype != NL80211_IFTYPE_AP &&
  11732. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  11733. return -EINVAL;
  11734. if (wdev->ap_unexpected_nlportid)
  11735. return -EBUSY;
  11736. wdev->ap_unexpected_nlportid = info->snd_portid;
  11737. return 0;
  11738. }
  11739. static int nl80211_probe_client(struct sk_buff *skb,
  11740. struct genl_info *info)
  11741. {
  11742. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11743. struct net_device *dev = info->user_ptr[1];
  11744. struct wireless_dev *wdev = dev->ieee80211_ptr;
  11745. struct sk_buff *msg;
  11746. void *hdr;
  11747. const u8 *addr;
  11748. u64 cookie;
  11749. int err;
  11750. if (wdev->iftype != NL80211_IFTYPE_AP &&
  11751. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  11752. return -EOPNOTSUPP;
  11753. if (!info->attrs[NL80211_ATTR_MAC])
  11754. return -EINVAL;
  11755. if (!rdev->ops->probe_client)
  11756. return -EOPNOTSUPP;
  11757. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11758. if (!msg)
  11759. return -ENOMEM;
  11760. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  11761. NL80211_CMD_PROBE_CLIENT);
  11762. if (!hdr) {
  11763. err = -ENOBUFS;
  11764. goto free_msg;
  11765. }
  11766. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  11767. err = rdev_probe_client(rdev, dev, addr, &cookie);
  11768. if (err)
  11769. goto free_msg;
  11770. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  11771. NL80211_ATTR_PAD))
  11772. goto nla_put_failure;
  11773. genlmsg_end(msg, hdr);
  11774. return genlmsg_reply(msg, info);
  11775. nla_put_failure:
  11776. err = -ENOBUFS;
  11777. free_msg:
  11778. nlmsg_free(msg);
  11779. return err;
  11780. }
  11781. static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
  11782. {
  11783. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11784. struct cfg80211_beacon_registration *reg, *nreg;
  11785. int rv;
  11786. if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
  11787. return -EOPNOTSUPP;
  11788. nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
  11789. if (!nreg)
  11790. return -ENOMEM;
  11791. /* First, check if already registered. */
  11792. spin_lock_bh(&rdev->beacon_registrations_lock);
  11793. list_for_each_entry(reg, &rdev->beacon_registrations, list) {
  11794. if (reg->nlportid == info->snd_portid) {
  11795. rv = -EALREADY;
  11796. goto out_err;
  11797. }
  11798. }
  11799. /* Add it to the list */
  11800. nreg->nlportid = info->snd_portid;
  11801. list_add(&nreg->list, &rdev->beacon_registrations);
  11802. spin_unlock_bh(&rdev->beacon_registrations_lock);
  11803. return 0;
  11804. out_err:
  11805. spin_unlock_bh(&rdev->beacon_registrations_lock);
  11806. kfree(nreg);
  11807. return rv;
  11808. }
  11809. static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
  11810. {
  11811. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11812. struct wireless_dev *wdev = info->user_ptr[1];
  11813. int err;
  11814. if (!rdev->ops->start_p2p_device)
  11815. return -EOPNOTSUPP;
  11816. if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
  11817. return -EOPNOTSUPP;
  11818. if (wdev_running(wdev))
  11819. return 0;
  11820. if (rfkill_blocked(rdev->wiphy.rfkill))
  11821. return -ERFKILL;
  11822. err = rdev_start_p2p_device(rdev, wdev);
  11823. if (err)
  11824. return err;
  11825. wdev->is_running = true;
  11826. rdev->opencount++;
  11827. return 0;
  11828. }
  11829. static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
  11830. {
  11831. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11832. struct wireless_dev *wdev = info->user_ptr[1];
  11833. if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
  11834. return -EOPNOTSUPP;
  11835. if (!rdev->ops->stop_p2p_device)
  11836. return -EOPNOTSUPP;
  11837. cfg80211_stop_p2p_device(rdev, wdev);
  11838. return 0;
  11839. }
  11840. static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
  11841. {
  11842. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11843. struct wireless_dev *wdev = info->user_ptr[1];
  11844. struct cfg80211_nan_conf conf = {};
  11845. int err;
  11846. if (wdev->iftype != NL80211_IFTYPE_NAN)
  11847. return -EOPNOTSUPP;
  11848. if (wdev_running(wdev))
  11849. return -EEXIST;
  11850. if (rfkill_blocked(rdev->wiphy.rfkill))
  11851. return -ERFKILL;
  11852. if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
  11853. return -EINVAL;
  11854. conf.master_pref =
  11855. nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
  11856. if (info->attrs[NL80211_ATTR_BANDS]) {
  11857. u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
  11858. if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
  11859. return -EOPNOTSUPP;
  11860. if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
  11861. return -EINVAL;
  11862. conf.bands = bands;
  11863. }
  11864. err = rdev_start_nan(rdev, wdev, &conf);
  11865. if (err)
  11866. return err;
  11867. wdev->is_running = true;
  11868. rdev->opencount++;
  11869. return 0;
  11870. }
  11871. static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
  11872. {
  11873. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11874. struct wireless_dev *wdev = info->user_ptr[1];
  11875. if (wdev->iftype != NL80211_IFTYPE_NAN)
  11876. return -EOPNOTSUPP;
  11877. cfg80211_stop_nan(rdev, wdev);
  11878. return 0;
  11879. }
  11880. static int validate_nan_filter(struct nlattr *filter_attr)
  11881. {
  11882. struct nlattr *attr;
  11883. int len = 0, n_entries = 0, rem;
  11884. nla_for_each_nested(attr, filter_attr, rem) {
  11885. len += nla_len(attr);
  11886. n_entries++;
  11887. }
  11888. if (len >= U8_MAX)
  11889. return -EINVAL;
  11890. return n_entries;
  11891. }
  11892. static int handle_nan_filter(struct nlattr *attr_filter,
  11893. struct cfg80211_nan_func *func,
  11894. bool tx)
  11895. {
  11896. struct nlattr *attr;
  11897. int n_entries, rem, i;
  11898. struct cfg80211_nan_func_filter *filter;
  11899. n_entries = validate_nan_filter(attr_filter);
  11900. if (n_entries < 0)
  11901. return n_entries;
  11902. BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
  11903. filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
  11904. if (!filter)
  11905. return -ENOMEM;
  11906. i = 0;
  11907. nla_for_each_nested(attr, attr_filter, rem) {
  11908. filter[i].filter = nla_memdup(attr, GFP_KERNEL);
  11909. if (!filter[i].filter)
  11910. goto err;
  11911. filter[i].len = nla_len(attr);
  11912. i++;
  11913. }
  11914. if (tx) {
  11915. func->num_tx_filters = n_entries;
  11916. func->tx_filters = filter;
  11917. } else {
  11918. func->num_rx_filters = n_entries;
  11919. func->rx_filters = filter;
  11920. }
  11921. return 0;
  11922. err:
  11923. i = 0;
  11924. nla_for_each_nested(attr, attr_filter, rem) {
  11925. kfree(filter[i].filter);
  11926. i++;
  11927. }
  11928. kfree(filter);
  11929. return -ENOMEM;
  11930. }
  11931. static int nl80211_nan_add_func(struct sk_buff *skb,
  11932. struct genl_info *info)
  11933. {
  11934. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11935. struct wireless_dev *wdev = info->user_ptr[1];
  11936. struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
  11937. struct cfg80211_nan_func *func;
  11938. struct sk_buff *msg = NULL;
  11939. void *hdr = NULL;
  11940. int err = 0;
  11941. if (wdev->iftype != NL80211_IFTYPE_NAN)
  11942. return -EOPNOTSUPP;
  11943. if (!wdev_running(wdev))
  11944. return -ENOTCONN;
  11945. if (!info->attrs[NL80211_ATTR_NAN_FUNC])
  11946. return -EINVAL;
  11947. err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX,
  11948. info->attrs[NL80211_ATTR_NAN_FUNC],
  11949. nl80211_nan_func_policy,
  11950. info->extack);
  11951. if (err)
  11952. return err;
  11953. func = kzalloc(sizeof(*func), GFP_KERNEL);
  11954. if (!func)
  11955. return -ENOMEM;
  11956. func->cookie = cfg80211_assign_cookie(rdev);
  11957. if (!tb[NL80211_NAN_FUNC_TYPE]) {
  11958. err = -EINVAL;
  11959. goto out;
  11960. }
  11961. func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
  11962. if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
  11963. err = -EINVAL;
  11964. goto out;
  11965. }
  11966. memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
  11967. sizeof(func->service_id));
  11968. func->close_range =
  11969. nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
  11970. if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
  11971. func->serv_spec_info_len =
  11972. nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
  11973. func->serv_spec_info =
  11974. kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
  11975. func->serv_spec_info_len,
  11976. GFP_KERNEL);
  11977. if (!func->serv_spec_info) {
  11978. err = -ENOMEM;
  11979. goto out;
  11980. }
  11981. }
  11982. if (tb[NL80211_NAN_FUNC_TTL])
  11983. func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
  11984. switch (func->type) {
  11985. case NL80211_NAN_FUNC_PUBLISH:
  11986. if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
  11987. err = -EINVAL;
  11988. goto out;
  11989. }
  11990. func->publish_type =
  11991. nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
  11992. func->publish_bcast =
  11993. nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
  11994. if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
  11995. func->publish_bcast) {
  11996. err = -EINVAL;
  11997. goto out;
  11998. }
  11999. break;
  12000. case NL80211_NAN_FUNC_SUBSCRIBE:
  12001. func->subscribe_active =
  12002. nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
  12003. break;
  12004. case NL80211_NAN_FUNC_FOLLOW_UP:
  12005. if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
  12006. !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
  12007. !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
  12008. err = -EINVAL;
  12009. goto out;
  12010. }
  12011. func->followup_id =
  12012. nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
  12013. func->followup_reqid =
  12014. nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
  12015. memcpy(func->followup_dest.addr,
  12016. nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
  12017. sizeof(func->followup_dest.addr));
  12018. if (func->ttl) {
  12019. err = -EINVAL;
  12020. goto out;
  12021. }
  12022. break;
  12023. default:
  12024. err = -EINVAL;
  12025. goto out;
  12026. }
  12027. if (tb[NL80211_NAN_FUNC_SRF]) {
  12028. struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
  12029. err = nla_parse_nested_deprecated(srf_tb,
  12030. NL80211_NAN_SRF_ATTR_MAX,
  12031. tb[NL80211_NAN_FUNC_SRF],
  12032. nl80211_nan_srf_policy,
  12033. info->extack);
  12034. if (err)
  12035. goto out;
  12036. func->srf_include =
  12037. nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
  12038. if (srf_tb[NL80211_NAN_SRF_BF]) {
  12039. if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
  12040. !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
  12041. err = -EINVAL;
  12042. goto out;
  12043. }
  12044. func->srf_bf_len =
  12045. nla_len(srf_tb[NL80211_NAN_SRF_BF]);
  12046. func->srf_bf =
  12047. kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
  12048. func->srf_bf_len, GFP_KERNEL);
  12049. if (!func->srf_bf) {
  12050. err = -ENOMEM;
  12051. goto out;
  12052. }
  12053. func->srf_bf_idx =
  12054. nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
  12055. } else {
  12056. struct nlattr *attr, *mac_attr =
  12057. srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
  12058. int n_entries, rem, i = 0;
  12059. if (!mac_attr) {
  12060. err = -EINVAL;
  12061. goto out;
  12062. }
  12063. n_entries = validate_acl_mac_addrs(mac_attr);
  12064. if (n_entries <= 0) {
  12065. err = -EINVAL;
  12066. goto out;
  12067. }
  12068. func->srf_num_macs = n_entries;
  12069. func->srf_macs =
  12070. kcalloc(n_entries, sizeof(*func->srf_macs),
  12071. GFP_KERNEL);
  12072. if (!func->srf_macs) {
  12073. err = -ENOMEM;
  12074. goto out;
  12075. }
  12076. nla_for_each_nested(attr, mac_attr, rem)
  12077. memcpy(func->srf_macs[i++].addr, nla_data(attr),
  12078. sizeof(*func->srf_macs));
  12079. }
  12080. }
  12081. if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
  12082. err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
  12083. func, true);
  12084. if (err)
  12085. goto out;
  12086. }
  12087. if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
  12088. err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
  12089. func, false);
  12090. if (err)
  12091. goto out;
  12092. }
  12093. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  12094. if (!msg) {
  12095. err = -ENOMEM;
  12096. goto out;
  12097. }
  12098. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  12099. NL80211_CMD_ADD_NAN_FUNCTION);
  12100. /* This can't really happen - we just allocated 4KB */
  12101. if (WARN_ON(!hdr)) {
  12102. err = -ENOMEM;
  12103. goto out;
  12104. }
  12105. err = rdev_add_nan_func(rdev, wdev, func);
  12106. out:
  12107. if (err < 0) {
  12108. cfg80211_free_nan_func(func);
  12109. nlmsg_free(msg);
  12110. return err;
  12111. }
  12112. /* propagate the instance id and cookie to userspace */
  12113. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
  12114. NL80211_ATTR_PAD))
  12115. goto nla_put_failure;
  12116. func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
  12117. if (!func_attr)
  12118. goto nla_put_failure;
  12119. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
  12120. func->instance_id))
  12121. goto nla_put_failure;
  12122. nla_nest_end(msg, func_attr);
  12123. genlmsg_end(msg, hdr);
  12124. return genlmsg_reply(msg, info);
  12125. nla_put_failure:
  12126. nlmsg_free(msg);
  12127. return -ENOBUFS;
  12128. }
  12129. static int nl80211_nan_del_func(struct sk_buff *skb,
  12130. struct genl_info *info)
  12131. {
  12132. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12133. struct wireless_dev *wdev = info->user_ptr[1];
  12134. u64 cookie;
  12135. if (wdev->iftype != NL80211_IFTYPE_NAN)
  12136. return -EOPNOTSUPP;
  12137. if (!wdev_running(wdev))
  12138. return -ENOTCONN;
  12139. if (!info->attrs[NL80211_ATTR_COOKIE])
  12140. return -EINVAL;
  12141. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  12142. rdev_del_nan_func(rdev, wdev, cookie);
  12143. return 0;
  12144. }
  12145. static int nl80211_nan_change_config(struct sk_buff *skb,
  12146. struct genl_info *info)
  12147. {
  12148. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12149. struct wireless_dev *wdev = info->user_ptr[1];
  12150. struct cfg80211_nan_conf conf = {};
  12151. u32 changed = 0;
  12152. if (wdev->iftype != NL80211_IFTYPE_NAN)
  12153. return -EOPNOTSUPP;
  12154. if (!wdev_running(wdev))
  12155. return -ENOTCONN;
  12156. if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
  12157. conf.master_pref =
  12158. nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
  12159. if (conf.master_pref <= 1 || conf.master_pref == 255)
  12160. return -EINVAL;
  12161. changed |= CFG80211_NAN_CONF_CHANGED_PREF;
  12162. }
  12163. if (info->attrs[NL80211_ATTR_BANDS]) {
  12164. u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
  12165. if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
  12166. return -EOPNOTSUPP;
  12167. if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
  12168. return -EINVAL;
  12169. conf.bands = bands;
  12170. changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
  12171. }
  12172. if (!changed)
  12173. return -EINVAL;
  12174. return rdev_nan_change_conf(rdev, wdev, &conf, changed);
  12175. }
  12176. void cfg80211_nan_match(struct wireless_dev *wdev,
  12177. struct cfg80211_nan_match_params *match, gfp_t gfp)
  12178. {
  12179. struct wiphy *wiphy = wdev->wiphy;
  12180. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12181. struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
  12182. struct sk_buff *msg;
  12183. void *hdr;
  12184. if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
  12185. return;
  12186. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12187. if (!msg)
  12188. return;
  12189. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
  12190. if (!hdr) {
  12191. nlmsg_free(msg);
  12192. return;
  12193. }
  12194. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12195. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  12196. wdev->netdev->ifindex)) ||
  12197. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12198. NL80211_ATTR_PAD))
  12199. goto nla_put_failure;
  12200. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
  12201. NL80211_ATTR_PAD) ||
  12202. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
  12203. goto nla_put_failure;
  12204. match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH);
  12205. if (!match_attr)
  12206. goto nla_put_failure;
  12207. local_func_attr = nla_nest_start_noflag(msg,
  12208. NL80211_NAN_MATCH_FUNC_LOCAL);
  12209. if (!local_func_attr)
  12210. goto nla_put_failure;
  12211. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
  12212. goto nla_put_failure;
  12213. nla_nest_end(msg, local_func_attr);
  12214. peer_func_attr = nla_nest_start_noflag(msg,
  12215. NL80211_NAN_MATCH_FUNC_PEER);
  12216. if (!peer_func_attr)
  12217. goto nla_put_failure;
  12218. if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
  12219. nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
  12220. goto nla_put_failure;
  12221. if (match->info && match->info_len &&
  12222. nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
  12223. match->info))
  12224. goto nla_put_failure;
  12225. nla_nest_end(msg, peer_func_attr);
  12226. nla_nest_end(msg, match_attr);
  12227. genlmsg_end(msg, hdr);
  12228. if (!wdev->owner_nlportid)
  12229. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  12230. msg, 0, NL80211_MCGRP_NAN, gfp);
  12231. else
  12232. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  12233. wdev->owner_nlportid);
  12234. return;
  12235. nla_put_failure:
  12236. nlmsg_free(msg);
  12237. }
  12238. EXPORT_SYMBOL(cfg80211_nan_match);
  12239. void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
  12240. u8 inst_id,
  12241. enum nl80211_nan_func_term_reason reason,
  12242. u64 cookie, gfp_t gfp)
  12243. {
  12244. struct wiphy *wiphy = wdev->wiphy;
  12245. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12246. struct sk_buff *msg;
  12247. struct nlattr *func_attr;
  12248. void *hdr;
  12249. if (WARN_ON(!inst_id))
  12250. return;
  12251. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12252. if (!msg)
  12253. return;
  12254. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
  12255. if (!hdr) {
  12256. nlmsg_free(msg);
  12257. return;
  12258. }
  12259. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12260. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  12261. wdev->netdev->ifindex)) ||
  12262. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12263. NL80211_ATTR_PAD))
  12264. goto nla_put_failure;
  12265. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  12266. NL80211_ATTR_PAD))
  12267. goto nla_put_failure;
  12268. func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
  12269. if (!func_attr)
  12270. goto nla_put_failure;
  12271. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
  12272. nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
  12273. goto nla_put_failure;
  12274. nla_nest_end(msg, func_attr);
  12275. genlmsg_end(msg, hdr);
  12276. if (!wdev->owner_nlportid)
  12277. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  12278. msg, 0, NL80211_MCGRP_NAN, gfp);
  12279. else
  12280. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  12281. wdev->owner_nlportid);
  12282. return;
  12283. nla_put_failure:
  12284. nlmsg_free(msg);
  12285. }
  12286. EXPORT_SYMBOL(cfg80211_nan_func_terminated);
  12287. static int nl80211_get_protocol_features(struct sk_buff *skb,
  12288. struct genl_info *info)
  12289. {
  12290. void *hdr;
  12291. struct sk_buff *msg;
  12292. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  12293. if (!msg)
  12294. return -ENOMEM;
  12295. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  12296. NL80211_CMD_GET_PROTOCOL_FEATURES);
  12297. if (!hdr)
  12298. goto nla_put_failure;
  12299. if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
  12300. NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
  12301. goto nla_put_failure;
  12302. genlmsg_end(msg, hdr);
  12303. return genlmsg_reply(msg, info);
  12304. nla_put_failure:
  12305. kfree_skb(msg);
  12306. return -ENOBUFS;
  12307. }
  12308. static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
  12309. {
  12310. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12311. struct cfg80211_update_ft_ies_params ft_params;
  12312. struct net_device *dev = info->user_ptr[1];
  12313. if (!rdev->ops->update_ft_ies)
  12314. return -EOPNOTSUPP;
  12315. if (!info->attrs[NL80211_ATTR_MDID] ||
  12316. !info->attrs[NL80211_ATTR_IE])
  12317. return -EINVAL;
  12318. memset(&ft_params, 0, sizeof(ft_params));
  12319. ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
  12320. ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  12321. ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  12322. return rdev_update_ft_ies(rdev, dev, &ft_params);
  12323. }
  12324. static int nl80211_crit_protocol_start(struct sk_buff *skb,
  12325. struct genl_info *info)
  12326. {
  12327. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12328. struct wireless_dev *wdev = info->user_ptr[1];
  12329. enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
  12330. u16 duration;
  12331. int ret;
  12332. if (!rdev->ops->crit_proto_start)
  12333. return -EOPNOTSUPP;
  12334. if (WARN_ON(!rdev->ops->crit_proto_stop))
  12335. return -EINVAL;
  12336. if (rdev->crit_proto_nlportid)
  12337. return -EBUSY;
  12338. /* determine protocol if provided */
  12339. if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
  12340. proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
  12341. if (proto >= NUM_NL80211_CRIT_PROTO)
  12342. return -EINVAL;
  12343. /* timeout must be provided */
  12344. if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
  12345. return -EINVAL;
  12346. duration =
  12347. nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
  12348. ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
  12349. if (!ret)
  12350. rdev->crit_proto_nlportid = info->snd_portid;
  12351. return ret;
  12352. }
  12353. static int nl80211_crit_protocol_stop(struct sk_buff *skb,
  12354. struct genl_info *info)
  12355. {
  12356. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12357. struct wireless_dev *wdev = info->user_ptr[1];
  12358. if (!rdev->ops->crit_proto_stop)
  12359. return -EOPNOTSUPP;
  12360. if (rdev->crit_proto_nlportid) {
  12361. rdev->crit_proto_nlportid = 0;
  12362. rdev_crit_proto_stop(rdev, wdev);
  12363. }
  12364. return 0;
  12365. }
  12366. static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd,
  12367. struct nlattr *attr,
  12368. struct netlink_ext_ack *extack)
  12369. {
  12370. if (vcmd->policy == VENDOR_CMD_RAW_DATA) {
  12371. if (attr->nla_type & NLA_F_NESTED) {
  12372. NL_SET_ERR_MSG_ATTR(extack, attr,
  12373. "unexpected nested data");
  12374. return -EINVAL;
  12375. }
  12376. return 0;
  12377. }
  12378. if (!(attr->nla_type & NLA_F_NESTED)) {
  12379. NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data");
  12380. return -EINVAL;
  12381. }
  12382. return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack);
  12383. }
  12384. static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
  12385. {
  12386. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12387. struct wireless_dev *wdev =
  12388. __cfg80211_wdev_from_attrs(rdev, genl_info_net(info),
  12389. info->attrs);
  12390. int i, err;
  12391. u32 vid, subcmd;
  12392. if (!rdev->wiphy.vendor_commands)
  12393. return -EOPNOTSUPP;
  12394. if (IS_ERR(wdev)) {
  12395. err = PTR_ERR(wdev);
  12396. if (err != -EINVAL)
  12397. return err;
  12398. wdev = NULL;
  12399. } else if (wdev->wiphy != &rdev->wiphy) {
  12400. return -EINVAL;
  12401. }
  12402. if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
  12403. !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
  12404. return -EINVAL;
  12405. vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
  12406. subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
  12407. for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
  12408. const struct wiphy_vendor_command *vcmd;
  12409. void *data = NULL;
  12410. int len = 0;
  12411. vcmd = &rdev->wiphy.vendor_commands[i];
  12412. if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
  12413. continue;
  12414. if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
  12415. WIPHY_VENDOR_CMD_NEED_NETDEV)) {
  12416. if (!wdev)
  12417. return -EINVAL;
  12418. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
  12419. !wdev->netdev)
  12420. return -EINVAL;
  12421. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
  12422. if (!wdev_running(wdev))
  12423. return -ENETDOWN;
  12424. }
  12425. } else {
  12426. wdev = NULL;
  12427. }
  12428. if (!vcmd->doit)
  12429. return -EOPNOTSUPP;
  12430. if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
  12431. data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
  12432. len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
  12433. err = nl80211_vendor_check_policy(vcmd,
  12434. info->attrs[NL80211_ATTR_VENDOR_DATA],
  12435. info->extack);
  12436. if (err)
  12437. return err;
  12438. }
  12439. rdev->cur_cmd_info = info;
  12440. err = vcmd->doit(&rdev->wiphy, wdev, data, len);
  12441. rdev->cur_cmd_info = NULL;
  12442. return err;
  12443. }
  12444. return -EOPNOTSUPP;
  12445. }
  12446. static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
  12447. struct netlink_callback *cb,
  12448. struct cfg80211_registered_device **rdev,
  12449. struct wireless_dev **wdev)
  12450. {
  12451. struct nlattr **attrbuf;
  12452. u32 vid, subcmd;
  12453. unsigned int i;
  12454. int vcmd_idx = -1;
  12455. int err;
  12456. void *data = NULL;
  12457. unsigned int data_len = 0;
  12458. if (cb->args[0]) {
  12459. /* subtract the 1 again here */
  12460. struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
  12461. struct wireless_dev *tmp;
  12462. if (!wiphy)
  12463. return -ENODEV;
  12464. *rdev = wiphy_to_rdev(wiphy);
  12465. *wdev = NULL;
  12466. if (cb->args[1]) {
  12467. list_for_each_entry(tmp, &wiphy->wdev_list, list) {
  12468. if (tmp->identifier == cb->args[1] - 1) {
  12469. *wdev = tmp;
  12470. break;
  12471. }
  12472. }
  12473. }
  12474. /* keep rtnl locked in successful case */
  12475. return 0;
  12476. }
  12477. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
  12478. if (!attrbuf)
  12479. return -ENOMEM;
  12480. err = nlmsg_parse_deprecated(cb->nlh,
  12481. GENL_HDRLEN + nl80211_fam.hdrsize,
  12482. attrbuf, nl80211_fam.maxattr,
  12483. nl80211_policy, NULL);
  12484. if (err)
  12485. goto out;
  12486. if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
  12487. !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) {
  12488. err = -EINVAL;
  12489. goto out;
  12490. }
  12491. *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf);
  12492. if (IS_ERR(*wdev))
  12493. *wdev = NULL;
  12494. *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
  12495. if (IS_ERR(*rdev)) {
  12496. err = PTR_ERR(*rdev);
  12497. goto out;
  12498. }
  12499. vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
  12500. subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
  12501. for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
  12502. const struct wiphy_vendor_command *vcmd;
  12503. vcmd = &(*rdev)->wiphy.vendor_commands[i];
  12504. if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
  12505. continue;
  12506. if (!vcmd->dumpit) {
  12507. err = -EOPNOTSUPP;
  12508. goto out;
  12509. }
  12510. vcmd_idx = i;
  12511. break;
  12512. }
  12513. if (vcmd_idx < 0) {
  12514. err = -EOPNOTSUPP;
  12515. goto out;
  12516. }
  12517. if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
  12518. data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
  12519. data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
  12520. err = nl80211_vendor_check_policy(
  12521. &(*rdev)->wiphy.vendor_commands[vcmd_idx],
  12522. attrbuf[NL80211_ATTR_VENDOR_DATA],
  12523. cb->extack);
  12524. if (err)
  12525. goto out;
  12526. }
  12527. /* 0 is the first index - add 1 to parse only once */
  12528. cb->args[0] = (*rdev)->wiphy_idx + 1;
  12529. /* add 1 to know if it was NULL */
  12530. cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
  12531. cb->args[2] = vcmd_idx;
  12532. cb->args[3] = (unsigned long)data;
  12533. cb->args[4] = data_len;
  12534. /* keep rtnl locked in successful case */
  12535. err = 0;
  12536. out:
  12537. kfree(attrbuf);
  12538. return err;
  12539. }
  12540. static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
  12541. struct netlink_callback *cb)
  12542. {
  12543. struct cfg80211_registered_device *rdev;
  12544. struct wireless_dev *wdev;
  12545. unsigned int vcmd_idx;
  12546. const struct wiphy_vendor_command *vcmd;
  12547. void *data;
  12548. int data_len;
  12549. int err;
  12550. struct nlattr *vendor_data;
  12551. rtnl_lock();
  12552. err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
  12553. if (err)
  12554. goto out;
  12555. vcmd_idx = cb->args[2];
  12556. data = (void *)cb->args[3];
  12557. data_len = cb->args[4];
  12558. vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
  12559. if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
  12560. WIPHY_VENDOR_CMD_NEED_NETDEV)) {
  12561. if (!wdev) {
  12562. err = -EINVAL;
  12563. goto out;
  12564. }
  12565. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
  12566. !wdev->netdev) {
  12567. err = -EINVAL;
  12568. goto out;
  12569. }
  12570. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
  12571. if (!wdev_running(wdev)) {
  12572. err = -ENETDOWN;
  12573. goto out;
  12574. }
  12575. }
  12576. }
  12577. while (1) {
  12578. void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
  12579. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  12580. NL80211_CMD_VENDOR);
  12581. if (!hdr)
  12582. break;
  12583. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12584. (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
  12585. wdev_id(wdev),
  12586. NL80211_ATTR_PAD))) {
  12587. genlmsg_cancel(skb, hdr);
  12588. break;
  12589. }
  12590. vendor_data = nla_nest_start_noflag(skb,
  12591. NL80211_ATTR_VENDOR_DATA);
  12592. if (!vendor_data) {
  12593. genlmsg_cancel(skb, hdr);
  12594. break;
  12595. }
  12596. err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
  12597. (unsigned long *)&cb->args[5]);
  12598. nla_nest_end(skb, vendor_data);
  12599. if (err == -ENOBUFS || err == -ENOENT) {
  12600. genlmsg_cancel(skb, hdr);
  12601. break;
  12602. } else if (err <= 0) {
  12603. genlmsg_cancel(skb, hdr);
  12604. goto out;
  12605. }
  12606. genlmsg_end(skb, hdr);
  12607. }
  12608. err = skb->len;
  12609. out:
  12610. rtnl_unlock();
  12611. return err;
  12612. }
  12613. struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
  12614. enum nl80211_commands cmd,
  12615. enum nl80211_attrs attr,
  12616. int approxlen)
  12617. {
  12618. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12619. if (WARN_ON(!rdev->cur_cmd_info))
  12620. return NULL;
  12621. return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
  12622. rdev->cur_cmd_info->snd_portid,
  12623. rdev->cur_cmd_info->snd_seq,
  12624. cmd, attr, NULL, GFP_KERNEL);
  12625. }
  12626. EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
  12627. int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
  12628. {
  12629. struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
  12630. void *hdr = ((void **)skb->cb)[1];
  12631. struct nlattr *data = ((void **)skb->cb)[2];
  12632. /* clear CB data for netlink core to own from now on */
  12633. memset(skb->cb, 0, sizeof(skb->cb));
  12634. if (WARN_ON(!rdev->cur_cmd_info)) {
  12635. kfree_skb(skb);
  12636. return -EINVAL;
  12637. }
  12638. nla_nest_end(skb, data);
  12639. genlmsg_end(skb, hdr);
  12640. return genlmsg_reply(skb, rdev->cur_cmd_info);
  12641. }
  12642. EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
  12643. unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy)
  12644. {
  12645. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12646. if (WARN_ON(!rdev->cur_cmd_info))
  12647. return 0;
  12648. return rdev->cur_cmd_info->snd_portid;
  12649. }
  12650. EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender);
  12651. static int nl80211_set_qos_map(struct sk_buff *skb,
  12652. struct genl_info *info)
  12653. {
  12654. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12655. struct cfg80211_qos_map *qos_map = NULL;
  12656. struct net_device *dev = info->user_ptr[1];
  12657. u8 *pos, len, num_des, des_len, des;
  12658. int ret;
  12659. if (!rdev->ops->set_qos_map)
  12660. return -EOPNOTSUPP;
  12661. if (info->attrs[NL80211_ATTR_QOS_MAP]) {
  12662. pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
  12663. len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
  12664. if (len % 2)
  12665. return -EINVAL;
  12666. qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
  12667. if (!qos_map)
  12668. return -ENOMEM;
  12669. num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
  12670. if (num_des) {
  12671. des_len = num_des *
  12672. sizeof(struct cfg80211_dscp_exception);
  12673. memcpy(qos_map->dscp_exception, pos, des_len);
  12674. qos_map->num_des = num_des;
  12675. for (des = 0; des < num_des; des++) {
  12676. if (qos_map->dscp_exception[des].up > 7) {
  12677. kfree(qos_map);
  12678. return -EINVAL;
  12679. }
  12680. }
  12681. pos += des_len;
  12682. }
  12683. memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
  12684. }
  12685. wdev_lock(dev->ieee80211_ptr);
  12686. ret = nl80211_key_allowed(dev->ieee80211_ptr);
  12687. if (!ret)
  12688. ret = rdev_set_qos_map(rdev, dev, qos_map);
  12689. wdev_unlock(dev->ieee80211_ptr);
  12690. kfree(qos_map);
  12691. return ret;
  12692. }
  12693. static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
  12694. {
  12695. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12696. struct net_device *dev = info->user_ptr[1];
  12697. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12698. const u8 *peer;
  12699. u8 tsid, up;
  12700. u16 admitted_time = 0;
  12701. int err;
  12702. if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
  12703. return -EOPNOTSUPP;
  12704. if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
  12705. !info->attrs[NL80211_ATTR_USER_PRIO])
  12706. return -EINVAL;
  12707. tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
  12708. up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
  12709. /* WMM uses TIDs 0-7 even for TSPEC */
  12710. if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
  12711. /* TODO: handle 802.11 TSPEC/admission control
  12712. * need more attributes for that (e.g. BA session requirement);
  12713. * change the WMM adminssion test above to allow both then
  12714. */
  12715. return -EINVAL;
  12716. }
  12717. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12718. if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
  12719. admitted_time =
  12720. nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
  12721. if (!admitted_time)
  12722. return -EINVAL;
  12723. }
  12724. wdev_lock(wdev);
  12725. switch (wdev->iftype) {
  12726. case NL80211_IFTYPE_STATION:
  12727. case NL80211_IFTYPE_P2P_CLIENT:
  12728. if (wdev->connected)
  12729. break;
  12730. err = -ENOTCONN;
  12731. goto out;
  12732. default:
  12733. err = -EOPNOTSUPP;
  12734. goto out;
  12735. }
  12736. err = rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
  12737. out:
  12738. wdev_unlock(wdev);
  12739. return err;
  12740. }
  12741. static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
  12742. {
  12743. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12744. struct net_device *dev = info->user_ptr[1];
  12745. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12746. const u8 *peer;
  12747. u8 tsid;
  12748. int err;
  12749. if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
  12750. return -EINVAL;
  12751. tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
  12752. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12753. wdev_lock(wdev);
  12754. err = rdev_del_tx_ts(rdev, dev, tsid, peer);
  12755. wdev_unlock(wdev);
  12756. return err;
  12757. }
  12758. static int nl80211_tdls_channel_switch(struct sk_buff *skb,
  12759. struct genl_info *info)
  12760. {
  12761. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12762. struct net_device *dev = info->user_ptr[1];
  12763. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12764. struct cfg80211_chan_def chandef = {};
  12765. const u8 *addr;
  12766. u8 oper_class;
  12767. int err;
  12768. if (!rdev->ops->tdls_channel_switch ||
  12769. !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
  12770. return -EOPNOTSUPP;
  12771. switch (dev->ieee80211_ptr->iftype) {
  12772. case NL80211_IFTYPE_STATION:
  12773. case NL80211_IFTYPE_P2P_CLIENT:
  12774. break;
  12775. default:
  12776. return -EOPNOTSUPP;
  12777. }
  12778. if (!info->attrs[NL80211_ATTR_MAC] ||
  12779. !info->attrs[NL80211_ATTR_OPER_CLASS])
  12780. return -EINVAL;
  12781. err = nl80211_parse_chandef(rdev, info, &chandef);
  12782. if (err)
  12783. return err;
  12784. /*
  12785. * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
  12786. * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
  12787. * specification is not defined for them.
  12788. */
  12789. if (chandef.chan->band == NL80211_BAND_2GHZ &&
  12790. chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
  12791. chandef.width != NL80211_CHAN_WIDTH_20)
  12792. return -EINVAL;
  12793. /* we will be active on the TDLS link */
  12794. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
  12795. wdev->iftype))
  12796. return -EINVAL;
  12797. /* don't allow switching to DFS channels */
  12798. if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
  12799. return -EINVAL;
  12800. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12801. oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
  12802. wdev_lock(wdev);
  12803. err = rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
  12804. wdev_unlock(wdev);
  12805. return err;
  12806. }
  12807. static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
  12808. struct genl_info *info)
  12809. {
  12810. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12811. struct net_device *dev = info->user_ptr[1];
  12812. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12813. const u8 *addr;
  12814. if (!rdev->ops->tdls_channel_switch ||
  12815. !rdev->ops->tdls_cancel_channel_switch ||
  12816. !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
  12817. return -EOPNOTSUPP;
  12818. switch (dev->ieee80211_ptr->iftype) {
  12819. case NL80211_IFTYPE_STATION:
  12820. case NL80211_IFTYPE_P2P_CLIENT:
  12821. break;
  12822. default:
  12823. return -EOPNOTSUPP;
  12824. }
  12825. if (!info->attrs[NL80211_ATTR_MAC])
  12826. return -EINVAL;
  12827. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12828. wdev_lock(wdev);
  12829. rdev_tdls_cancel_channel_switch(rdev, dev, addr);
  12830. wdev_unlock(wdev);
  12831. return 0;
  12832. }
  12833. static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
  12834. struct genl_info *info)
  12835. {
  12836. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12837. struct net_device *dev = info->user_ptr[1];
  12838. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12839. const struct nlattr *nla;
  12840. bool enabled;
  12841. if (!rdev->ops->set_multicast_to_unicast)
  12842. return -EOPNOTSUPP;
  12843. if (wdev->iftype != NL80211_IFTYPE_AP &&
  12844. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  12845. return -EOPNOTSUPP;
  12846. nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
  12847. enabled = nla_get_flag(nla);
  12848. return rdev_set_multicast_to_unicast(rdev, dev, enabled);
  12849. }
  12850. static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
  12851. {
  12852. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12853. struct net_device *dev = info->user_ptr[1];
  12854. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12855. struct cfg80211_pmk_conf pmk_conf = {};
  12856. int ret;
  12857. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  12858. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  12859. return -EOPNOTSUPP;
  12860. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  12861. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  12862. return -EOPNOTSUPP;
  12863. if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
  12864. return -EINVAL;
  12865. wdev_lock(wdev);
  12866. if (!wdev->connected) {
  12867. ret = -ENOTCONN;
  12868. goto out;
  12869. }
  12870. pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12871. if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN)) {
  12872. ret = -EINVAL;
  12873. goto out;
  12874. }
  12875. pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  12876. pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
  12877. if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
  12878. pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192) {
  12879. ret = -EINVAL;
  12880. goto out;
  12881. }
  12882. if (info->attrs[NL80211_ATTR_PMKR0_NAME])
  12883. pmk_conf.pmk_r0_name =
  12884. nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
  12885. ret = rdev_set_pmk(rdev, dev, &pmk_conf);
  12886. out:
  12887. wdev_unlock(wdev);
  12888. return ret;
  12889. }
  12890. static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
  12891. {
  12892. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12893. struct net_device *dev = info->user_ptr[1];
  12894. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12895. const u8 *aa;
  12896. int ret;
  12897. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  12898. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  12899. return -EOPNOTSUPP;
  12900. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  12901. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  12902. return -EOPNOTSUPP;
  12903. if (!info->attrs[NL80211_ATTR_MAC])
  12904. return -EINVAL;
  12905. wdev_lock(wdev);
  12906. aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12907. ret = rdev_del_pmk(rdev, dev, aa);
  12908. wdev_unlock(wdev);
  12909. return ret;
  12910. }
  12911. static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
  12912. {
  12913. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12914. struct net_device *dev = info->user_ptr[1];
  12915. struct cfg80211_external_auth_params params;
  12916. if (!rdev->ops->external_auth)
  12917. return -EOPNOTSUPP;
  12918. if (!info->attrs[NL80211_ATTR_SSID] &&
  12919. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  12920. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  12921. return -EINVAL;
  12922. if (!info->attrs[NL80211_ATTR_BSSID])
  12923. return -EINVAL;
  12924. if (!info->attrs[NL80211_ATTR_STATUS_CODE])
  12925. return -EINVAL;
  12926. memset(&params, 0, sizeof(params));
  12927. if (info->attrs[NL80211_ATTR_SSID]) {
  12928. params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  12929. if (params.ssid.ssid_len == 0)
  12930. return -EINVAL;
  12931. memcpy(params.ssid.ssid,
  12932. nla_data(info->attrs[NL80211_ATTR_SSID]),
  12933. params.ssid.ssid_len);
  12934. }
  12935. memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
  12936. ETH_ALEN);
  12937. params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  12938. if (info->attrs[NL80211_ATTR_PMKID])
  12939. params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  12940. return rdev_external_auth(rdev, dev, &params);
  12941. }
  12942. static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info)
  12943. {
  12944. bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK];
  12945. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12946. struct net_device *dev = info->user_ptr[1];
  12947. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12948. const u8 *buf;
  12949. size_t len;
  12950. u8 *dest;
  12951. u16 proto;
  12952. bool noencrypt;
  12953. u64 cookie = 0;
  12954. int link_id;
  12955. int err;
  12956. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  12957. NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
  12958. return -EOPNOTSUPP;
  12959. if (!rdev->ops->tx_control_port)
  12960. return -EOPNOTSUPP;
  12961. if (!info->attrs[NL80211_ATTR_FRAME] ||
  12962. !info->attrs[NL80211_ATTR_MAC] ||
  12963. !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
  12964. GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing");
  12965. return -EINVAL;
  12966. }
  12967. wdev_lock(wdev);
  12968. switch (wdev->iftype) {
  12969. case NL80211_IFTYPE_AP:
  12970. case NL80211_IFTYPE_P2P_GO:
  12971. case NL80211_IFTYPE_MESH_POINT:
  12972. break;
  12973. case NL80211_IFTYPE_ADHOC:
  12974. if (wdev->u.ibss.current_bss)
  12975. break;
  12976. err = -ENOTCONN;
  12977. goto out;
  12978. case NL80211_IFTYPE_STATION:
  12979. case NL80211_IFTYPE_P2P_CLIENT:
  12980. if (wdev->connected)
  12981. break;
  12982. err = -ENOTCONN;
  12983. goto out;
  12984. default:
  12985. err = -EOPNOTSUPP;
  12986. goto out;
  12987. }
  12988. wdev_unlock(wdev);
  12989. buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
  12990. len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
  12991. dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12992. proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
  12993. noencrypt =
  12994. nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]);
  12995. link_id = nl80211_link_id_or_invalid(info->attrs);
  12996. err = rdev_tx_control_port(rdev, dev, buf, len,
  12997. dest, cpu_to_be16(proto), noencrypt, link_id,
  12998. dont_wait_for_ack ? NULL : &cookie);
  12999. if (!err && !dont_wait_for_ack)
  13000. nl_set_extack_cookie_u64(info->extack, cookie);
  13001. return err;
  13002. out:
  13003. wdev_unlock(wdev);
  13004. return err;
  13005. }
  13006. static int nl80211_get_ftm_responder_stats(struct sk_buff *skb,
  13007. struct genl_info *info)
  13008. {
  13009. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13010. struct net_device *dev = info->user_ptr[1];
  13011. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13012. struct cfg80211_ftm_responder_stats ftm_stats = {};
  13013. unsigned int link_id = nl80211_link_id(info->attrs);
  13014. struct sk_buff *msg;
  13015. void *hdr;
  13016. struct nlattr *ftm_stats_attr;
  13017. int err;
  13018. if (wdev->iftype != NL80211_IFTYPE_AP ||
  13019. !wdev->links[link_id].ap.beacon_interval)
  13020. return -EOPNOTSUPP;
  13021. err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats);
  13022. if (err)
  13023. return err;
  13024. if (!ftm_stats.filled)
  13025. return -ENODATA;
  13026. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  13027. if (!msg)
  13028. return -ENOMEM;
  13029. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  13030. NL80211_CMD_GET_FTM_RESPONDER_STATS);
  13031. if (!hdr)
  13032. goto nla_put_failure;
  13033. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  13034. goto nla_put_failure;
  13035. ftm_stats_attr = nla_nest_start_noflag(msg,
  13036. NL80211_ATTR_FTM_RESPONDER_STATS);
  13037. if (!ftm_stats_attr)
  13038. goto nla_put_failure;
  13039. #define SET_FTM(field, name, type) \
  13040. do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
  13041. nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \
  13042. ftm_stats.field)) \
  13043. goto nla_put_failure; } while (0)
  13044. #define SET_FTM_U64(field, name) \
  13045. do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
  13046. nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \
  13047. ftm_stats.field, NL80211_FTM_STATS_PAD)) \
  13048. goto nla_put_failure; } while (0)
  13049. SET_FTM(success_num, SUCCESS_NUM, u32);
  13050. SET_FTM(partial_num, PARTIAL_NUM, u32);
  13051. SET_FTM(failed_num, FAILED_NUM, u32);
  13052. SET_FTM(asap_num, ASAP_NUM, u32);
  13053. SET_FTM(non_asap_num, NON_ASAP_NUM, u32);
  13054. SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC);
  13055. SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32);
  13056. SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32);
  13057. SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32);
  13058. #undef SET_FTM
  13059. nla_nest_end(msg, ftm_stats_attr);
  13060. genlmsg_end(msg, hdr);
  13061. return genlmsg_reply(msg, info);
  13062. nla_put_failure:
  13063. nlmsg_free(msg);
  13064. return -ENOBUFS;
  13065. }
  13066. static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info)
  13067. {
  13068. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13069. struct cfg80211_update_owe_info owe_info;
  13070. struct net_device *dev = info->user_ptr[1];
  13071. if (!rdev->ops->update_owe_info)
  13072. return -EOPNOTSUPP;
  13073. if (!info->attrs[NL80211_ATTR_STATUS_CODE] ||
  13074. !info->attrs[NL80211_ATTR_MAC])
  13075. return -EINVAL;
  13076. memset(&owe_info, 0, sizeof(owe_info));
  13077. owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  13078. nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN);
  13079. if (info->attrs[NL80211_ATTR_IE]) {
  13080. owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  13081. owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  13082. }
  13083. return rdev_update_owe_info(rdev, dev, &owe_info);
  13084. }
  13085. static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info)
  13086. {
  13087. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13088. struct net_device *dev = info->user_ptr[1];
  13089. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13090. struct station_info sinfo = {};
  13091. const u8 *buf;
  13092. size_t len;
  13093. u8 *dest;
  13094. int err;
  13095. if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station)
  13096. return -EOPNOTSUPP;
  13097. if (!info->attrs[NL80211_ATTR_MAC] ||
  13098. !info->attrs[NL80211_ATTR_FRAME]) {
  13099. GENL_SET_ERR_MSG(info, "Frame or MAC missing");
  13100. return -EINVAL;
  13101. }
  13102. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  13103. return -EOPNOTSUPP;
  13104. dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13105. buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
  13106. len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
  13107. if (len < sizeof(struct ethhdr))
  13108. return -EINVAL;
  13109. if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) ||
  13110. !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr))
  13111. return -EINVAL;
  13112. err = rdev_get_station(rdev, dev, dest, &sinfo);
  13113. if (err)
  13114. return err;
  13115. cfg80211_sinfo_release_content(&sinfo);
  13116. return rdev_probe_mesh_link(rdev, dev, dest, buf, len);
  13117. }
  13118. static int parse_tid_conf(struct cfg80211_registered_device *rdev,
  13119. struct nlattr *attrs[], struct net_device *dev,
  13120. struct cfg80211_tid_cfg *tid_conf,
  13121. struct genl_info *info, const u8 *peer,
  13122. unsigned int link_id)
  13123. {
  13124. struct netlink_ext_ack *extack = info->extack;
  13125. u64 mask;
  13126. int err;
  13127. if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS])
  13128. return -EINVAL;
  13129. tid_conf->config_override =
  13130. nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]);
  13131. tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]);
  13132. if (tid_conf->config_override) {
  13133. if (rdev->ops->reset_tid_config) {
  13134. err = rdev_reset_tid_config(rdev, dev, peer,
  13135. tid_conf->tids);
  13136. if (err)
  13137. return err;
  13138. } else {
  13139. return -EINVAL;
  13140. }
  13141. }
  13142. if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) {
  13143. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK);
  13144. tid_conf->noack =
  13145. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]);
  13146. }
  13147. if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) {
  13148. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT);
  13149. tid_conf->retry_short =
  13150. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]);
  13151. if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count)
  13152. return -EINVAL;
  13153. }
  13154. if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) {
  13155. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG);
  13156. tid_conf->retry_long =
  13157. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]);
  13158. if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count)
  13159. return -EINVAL;
  13160. }
  13161. if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) {
  13162. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL);
  13163. tid_conf->ampdu =
  13164. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]);
  13165. }
  13166. if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) {
  13167. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL);
  13168. tid_conf->rtscts =
  13169. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]);
  13170. }
  13171. if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) {
  13172. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL);
  13173. tid_conf->amsdu =
  13174. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]);
  13175. }
  13176. if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) {
  13177. u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr;
  13178. tid_conf->txrate_type = nla_get_u8(attrs[idx]);
  13179. if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) {
  13180. attr = NL80211_TID_CONFIG_ATTR_TX_RATE;
  13181. err = nl80211_parse_tx_bitrate_mask(info, attrs, attr,
  13182. &tid_conf->txrate_mask, dev,
  13183. true, link_id);
  13184. if (err)
  13185. return err;
  13186. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE);
  13187. }
  13188. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE);
  13189. }
  13190. if (peer)
  13191. mask = rdev->wiphy.tid_config_support.peer;
  13192. else
  13193. mask = rdev->wiphy.tid_config_support.vif;
  13194. if (tid_conf->mask & ~mask) {
  13195. NL_SET_ERR_MSG(extack, "unsupported TID configuration");
  13196. return -ENOTSUPP;
  13197. }
  13198. return 0;
  13199. }
  13200. static int nl80211_set_tid_config(struct sk_buff *skb,
  13201. struct genl_info *info)
  13202. {
  13203. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13204. struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1];
  13205. unsigned int link_id = nl80211_link_id(info->attrs);
  13206. struct net_device *dev = info->user_ptr[1];
  13207. struct cfg80211_tid_config *tid_config;
  13208. struct nlattr *tid;
  13209. int conf_idx = 0, rem_conf;
  13210. int ret = -EINVAL;
  13211. u32 num_conf = 0;
  13212. if (!info->attrs[NL80211_ATTR_TID_CONFIG])
  13213. return -EINVAL;
  13214. if (!rdev->ops->set_tid_config)
  13215. return -EOPNOTSUPP;
  13216. nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG],
  13217. rem_conf)
  13218. num_conf++;
  13219. tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf),
  13220. GFP_KERNEL);
  13221. if (!tid_config)
  13222. return -ENOMEM;
  13223. tid_config->n_tid_conf = num_conf;
  13224. if (info->attrs[NL80211_ATTR_MAC])
  13225. tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13226. wdev_lock(dev->ieee80211_ptr);
  13227. nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG],
  13228. rem_conf) {
  13229. ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX,
  13230. tid, NULL, NULL);
  13231. if (ret)
  13232. goto bad_tid_conf;
  13233. ret = parse_tid_conf(rdev, attrs, dev,
  13234. &tid_config->tid_conf[conf_idx],
  13235. info, tid_config->peer, link_id);
  13236. if (ret)
  13237. goto bad_tid_conf;
  13238. conf_idx++;
  13239. }
  13240. ret = rdev_set_tid_config(rdev, dev, tid_config);
  13241. bad_tid_conf:
  13242. kfree(tid_config);
  13243. wdev_unlock(dev->ieee80211_ptr);
  13244. return ret;
  13245. }
  13246. static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info)
  13247. {
  13248. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13249. struct cfg80211_color_change_settings params = {};
  13250. struct net_device *dev = info->user_ptr[1];
  13251. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13252. struct nlattr **tb;
  13253. u16 offset;
  13254. int err;
  13255. if (!rdev->ops->color_change)
  13256. return -EOPNOTSUPP;
  13257. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  13258. NL80211_EXT_FEATURE_BSS_COLOR))
  13259. return -EOPNOTSUPP;
  13260. if (wdev->iftype != NL80211_IFTYPE_AP)
  13261. return -EOPNOTSUPP;
  13262. if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] ||
  13263. !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] ||
  13264. !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS])
  13265. return -EINVAL;
  13266. params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]);
  13267. params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]);
  13268. err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_next);
  13269. if (err)
  13270. return err;
  13271. tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL);
  13272. if (!tb)
  13273. return -ENOMEM;
  13274. err = nla_parse_nested(tb, NL80211_ATTR_MAX,
  13275. info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS],
  13276. nl80211_policy, info->extack);
  13277. if (err)
  13278. goto out;
  13279. err = nl80211_parse_beacon(rdev, tb, &params.beacon_color_change);
  13280. if (err)
  13281. goto out;
  13282. if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) {
  13283. err = -EINVAL;
  13284. goto out;
  13285. }
  13286. if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) {
  13287. err = -EINVAL;
  13288. goto out;
  13289. }
  13290. offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]);
  13291. if (offset >= params.beacon_color_change.tail_len) {
  13292. err = -EINVAL;
  13293. goto out;
  13294. }
  13295. if (params.beacon_color_change.tail[offset] != params.count) {
  13296. err = -EINVAL;
  13297. goto out;
  13298. }
  13299. params.counter_offset_beacon = offset;
  13300. if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) {
  13301. if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) !=
  13302. sizeof(u16)) {
  13303. err = -EINVAL;
  13304. goto out;
  13305. }
  13306. offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]);
  13307. if (offset >= params.beacon_color_change.probe_resp_len) {
  13308. err = -EINVAL;
  13309. goto out;
  13310. }
  13311. if (params.beacon_color_change.probe_resp[offset] !=
  13312. params.count) {
  13313. err = -EINVAL;
  13314. goto out;
  13315. }
  13316. params.counter_offset_presp = offset;
  13317. }
  13318. wdev_lock(wdev);
  13319. err = rdev_color_change(rdev, dev, &params);
  13320. wdev_unlock(wdev);
  13321. out:
  13322. kfree(params.beacon_next.mbssid_ies);
  13323. kfree(params.beacon_color_change.mbssid_ies);
  13324. kfree(tb);
  13325. return err;
  13326. }
  13327. static int nl80211_set_fils_aad(struct sk_buff *skb,
  13328. struct genl_info *info)
  13329. {
  13330. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13331. struct net_device *dev = info->user_ptr[1];
  13332. struct cfg80211_fils_aad fils_aad = {};
  13333. u8 *nonces;
  13334. if (!info->attrs[NL80211_ATTR_MAC] ||
  13335. !info->attrs[NL80211_ATTR_FILS_KEK] ||
  13336. !info->attrs[NL80211_ATTR_FILS_NONCES])
  13337. return -EINVAL;
  13338. fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13339. fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
  13340. fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
  13341. nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
  13342. fils_aad.snonce = nonces;
  13343. fils_aad.anonce = nonces + FILS_NONCE_LEN;
  13344. return rdev_set_fils_aad(rdev, dev, &fils_aad);
  13345. }
  13346. static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info)
  13347. {
  13348. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13349. unsigned int link_id = nl80211_link_id(info->attrs);
  13350. struct net_device *dev = info->user_ptr[1];
  13351. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13352. int ret;
  13353. if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO))
  13354. return -EINVAL;
  13355. switch (wdev->iftype) {
  13356. case NL80211_IFTYPE_AP:
  13357. break;
  13358. default:
  13359. return -EINVAL;
  13360. }
  13361. if (!info->attrs[NL80211_ATTR_MAC] ||
  13362. !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC])))
  13363. return -EINVAL;
  13364. wdev_lock(wdev);
  13365. wdev->valid_links |= BIT(link_id);
  13366. ether_addr_copy(wdev->links[link_id].addr,
  13367. nla_data(info->attrs[NL80211_ATTR_MAC]));
  13368. ret = rdev_add_intf_link(rdev, wdev, link_id);
  13369. if (ret) {
  13370. wdev->valid_links &= ~BIT(link_id);
  13371. eth_zero_addr(wdev->links[link_id].addr);
  13372. }
  13373. wdev_unlock(wdev);
  13374. return ret;
  13375. }
  13376. static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info)
  13377. {
  13378. unsigned int link_id = nl80211_link_id(info->attrs);
  13379. struct net_device *dev = info->user_ptr[1];
  13380. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13381. /* cannot remove if there's no link */
  13382. if (!info->attrs[NL80211_ATTR_MLO_LINK_ID])
  13383. return -EINVAL;
  13384. switch (wdev->iftype) {
  13385. case NL80211_IFTYPE_AP:
  13386. break;
  13387. default:
  13388. return -EINVAL;
  13389. }
  13390. wdev_lock(wdev);
  13391. cfg80211_remove_link(wdev, link_id);
  13392. wdev_unlock(wdev);
  13393. return 0;
  13394. }
  13395. static int
  13396. nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info,
  13397. bool add)
  13398. {
  13399. struct link_station_parameters params = {};
  13400. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13401. struct net_device *dev = info->user_ptr[1];
  13402. int err;
  13403. if ((add && !rdev->ops->add_link_station) ||
  13404. (!add && !rdev->ops->mod_link_station))
  13405. return -EOPNOTSUPP;
  13406. if (add && !info->attrs[NL80211_ATTR_MAC])
  13407. return -EINVAL;
  13408. if (!info->attrs[NL80211_ATTR_MLD_ADDR])
  13409. return -EINVAL;
  13410. if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
  13411. return -EINVAL;
  13412. params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  13413. if (info->attrs[NL80211_ATTR_MAC]) {
  13414. params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13415. if (!is_valid_ether_addr(params.link_mac))
  13416. return -EINVAL;
  13417. }
  13418. if (!info->attrs[NL80211_ATTR_MLO_LINK_ID])
  13419. return -EINVAL;
  13420. params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]);
  13421. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
  13422. params.supported_rates =
  13423. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  13424. params.supported_rates_len =
  13425. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  13426. }
  13427. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  13428. params.ht_capa =
  13429. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  13430. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  13431. params.vht_capa =
  13432. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  13433. if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
  13434. params.he_capa =
  13435. nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  13436. params.he_capa_len =
  13437. nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  13438. if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
  13439. params.eht_capa =
  13440. nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  13441. params.eht_capa_len =
  13442. nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  13443. if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa,
  13444. (const u8 *)params.eht_capa,
  13445. params.eht_capa_len,
  13446. false))
  13447. return -EINVAL;
  13448. }
  13449. }
  13450. if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
  13451. params.he_6ghz_capa =
  13452. nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
  13453. if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
  13454. params.opmode_notif_used = true;
  13455. params.opmode_notif =
  13456. nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
  13457. }
  13458. err = nl80211_parse_sta_txpower_setting(info, &params.txpwr,
  13459. &params.txpwr_set);
  13460. if (err)
  13461. return err;
  13462. wdev_lock(dev->ieee80211_ptr);
  13463. if (add)
  13464. err = rdev_add_link_station(rdev, dev, &params);
  13465. else
  13466. err = rdev_mod_link_station(rdev, dev, &params);
  13467. wdev_unlock(dev->ieee80211_ptr);
  13468. return err;
  13469. }
  13470. static int
  13471. nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info)
  13472. {
  13473. return nl80211_add_mod_link_station(skb, info, true);
  13474. }
  13475. static int
  13476. nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info)
  13477. {
  13478. return nl80211_add_mod_link_station(skb, info, false);
  13479. }
  13480. static int
  13481. nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info)
  13482. {
  13483. struct link_station_del_parameters params = {};
  13484. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13485. struct net_device *dev = info->user_ptr[1];
  13486. int ret;
  13487. if (!rdev->ops->del_link_station)
  13488. return -EOPNOTSUPP;
  13489. if (!info->attrs[NL80211_ATTR_MLD_ADDR] ||
  13490. !info->attrs[NL80211_ATTR_MLO_LINK_ID])
  13491. return -EINVAL;
  13492. params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  13493. params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]);
  13494. wdev_lock(dev->ieee80211_ptr);
  13495. ret = rdev_del_link_station(rdev, dev, &params);
  13496. wdev_unlock(dev->ieee80211_ptr);
  13497. return ret;
  13498. }
  13499. #define NL80211_FLAG_NEED_WIPHY 0x01
  13500. #define NL80211_FLAG_NEED_NETDEV 0x02
  13501. #define NL80211_FLAG_NEED_RTNL 0x04
  13502. #define NL80211_FLAG_CHECK_NETDEV_UP 0x08
  13503. #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
  13504. NL80211_FLAG_CHECK_NETDEV_UP)
  13505. #define NL80211_FLAG_NEED_WDEV 0x10
  13506. /* If a netdev is associated, it must be UP, P2P must be started */
  13507. #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
  13508. NL80211_FLAG_CHECK_NETDEV_UP)
  13509. #define NL80211_FLAG_CLEAR_SKB 0x20
  13510. #define NL80211_FLAG_NO_WIPHY_MTX 0x40
  13511. #define NL80211_FLAG_MLO_VALID_LINK_ID 0x80
  13512. #define NL80211_FLAG_MLO_UNSUPPORTED 0x100
  13513. #define INTERNAL_FLAG_SELECTORS(__sel) \
  13514. SELECTOR(__sel, NONE, 0) /* must be first */ \
  13515. SELECTOR(__sel, WIPHY, \
  13516. NL80211_FLAG_NEED_WIPHY) \
  13517. SELECTOR(__sel, WDEV, \
  13518. NL80211_FLAG_NEED_WDEV) \
  13519. SELECTOR(__sel, NETDEV, \
  13520. NL80211_FLAG_NEED_NETDEV) \
  13521. SELECTOR(__sel, NETDEV_LINK, \
  13522. NL80211_FLAG_NEED_NETDEV | \
  13523. NL80211_FLAG_MLO_VALID_LINK_ID) \
  13524. SELECTOR(__sel, NETDEV_NO_MLO, \
  13525. NL80211_FLAG_NEED_NETDEV | \
  13526. NL80211_FLAG_MLO_UNSUPPORTED) \
  13527. SELECTOR(__sel, WIPHY_RTNL, \
  13528. NL80211_FLAG_NEED_WIPHY | \
  13529. NL80211_FLAG_NEED_RTNL) \
  13530. SELECTOR(__sel, WIPHY_RTNL_NOMTX, \
  13531. NL80211_FLAG_NEED_WIPHY | \
  13532. NL80211_FLAG_NEED_RTNL | \
  13533. NL80211_FLAG_NO_WIPHY_MTX) \
  13534. SELECTOR(__sel, WDEV_RTNL, \
  13535. NL80211_FLAG_NEED_WDEV | \
  13536. NL80211_FLAG_NEED_RTNL) \
  13537. SELECTOR(__sel, NETDEV_RTNL, \
  13538. NL80211_FLAG_NEED_NETDEV | \
  13539. NL80211_FLAG_NEED_RTNL) \
  13540. SELECTOR(__sel, NETDEV_UP, \
  13541. NL80211_FLAG_NEED_NETDEV_UP) \
  13542. SELECTOR(__sel, NETDEV_UP_LINK, \
  13543. NL80211_FLAG_NEED_NETDEV_UP | \
  13544. NL80211_FLAG_MLO_VALID_LINK_ID) \
  13545. SELECTOR(__sel, NETDEV_UP_NO_MLO, \
  13546. NL80211_FLAG_NEED_NETDEV_UP | \
  13547. NL80211_FLAG_MLO_UNSUPPORTED) \
  13548. SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR, \
  13549. NL80211_FLAG_NEED_NETDEV_UP | \
  13550. NL80211_FLAG_CLEAR_SKB | \
  13551. NL80211_FLAG_MLO_UNSUPPORTED) \
  13552. SELECTOR(__sel, NETDEV_UP_NOTMX, \
  13553. NL80211_FLAG_NEED_NETDEV_UP | \
  13554. NL80211_FLAG_NO_WIPHY_MTX) \
  13555. SELECTOR(__sel, NETDEV_UP_NOTMX_NOMLO, \
  13556. NL80211_FLAG_NEED_NETDEV_UP | \
  13557. NL80211_FLAG_NO_WIPHY_MTX | \
  13558. NL80211_FLAG_MLO_UNSUPPORTED) \
  13559. SELECTOR(__sel, NETDEV_UP_CLEAR, \
  13560. NL80211_FLAG_NEED_NETDEV_UP | \
  13561. NL80211_FLAG_CLEAR_SKB) \
  13562. SELECTOR(__sel, WDEV_UP, \
  13563. NL80211_FLAG_NEED_WDEV_UP) \
  13564. SELECTOR(__sel, WDEV_UP_LINK, \
  13565. NL80211_FLAG_NEED_WDEV_UP | \
  13566. NL80211_FLAG_MLO_VALID_LINK_ID) \
  13567. SELECTOR(__sel, WDEV_UP_RTNL, \
  13568. NL80211_FLAG_NEED_WDEV_UP | \
  13569. NL80211_FLAG_NEED_RTNL) \
  13570. SELECTOR(__sel, WIPHY_CLEAR, \
  13571. NL80211_FLAG_NEED_WIPHY | \
  13572. NL80211_FLAG_CLEAR_SKB)
  13573. enum nl80211_internal_flags_selector {
  13574. #define SELECTOR(_, name, value) NL80211_IFL_SEL_##name,
  13575. INTERNAL_FLAG_SELECTORS(_)
  13576. #undef SELECTOR
  13577. };
  13578. static u32 nl80211_internal_flags[] = {
  13579. #define SELECTOR(_, name, value) [NL80211_IFL_SEL_##name] = value,
  13580. INTERNAL_FLAG_SELECTORS(_)
  13581. #undef SELECTOR
  13582. };
  13583. static int nl80211_pre_doit(const struct genl_ops *ops, struct sk_buff *skb,
  13584. struct genl_info *info)
  13585. {
  13586. struct cfg80211_registered_device *rdev = NULL;
  13587. struct wireless_dev *wdev = NULL;
  13588. struct net_device *dev = NULL;
  13589. u32 internal_flags;
  13590. int err;
  13591. if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags)))
  13592. return -EINVAL;
  13593. internal_flags = nl80211_internal_flags[ops->internal_flags];
  13594. rtnl_lock();
  13595. if (internal_flags & NL80211_FLAG_NEED_WIPHY) {
  13596. rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
  13597. if (IS_ERR(rdev)) {
  13598. err = PTR_ERR(rdev);
  13599. goto out_unlock;
  13600. }
  13601. info->user_ptr[0] = rdev;
  13602. } else if (internal_flags & NL80211_FLAG_NEED_NETDEV ||
  13603. internal_flags & NL80211_FLAG_NEED_WDEV) {
  13604. wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info),
  13605. info->attrs);
  13606. if (IS_ERR(wdev)) {
  13607. err = PTR_ERR(wdev);
  13608. goto out_unlock;
  13609. }
  13610. dev = wdev->netdev;
  13611. dev_hold(dev);
  13612. rdev = wiphy_to_rdev(wdev->wiphy);
  13613. if (internal_flags & NL80211_FLAG_NEED_NETDEV) {
  13614. if (!dev) {
  13615. err = -EINVAL;
  13616. goto out_unlock;
  13617. }
  13618. info->user_ptr[1] = dev;
  13619. } else {
  13620. info->user_ptr[1] = wdev;
  13621. }
  13622. if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
  13623. !wdev_running(wdev)) {
  13624. err = -ENETDOWN;
  13625. goto out_unlock;
  13626. }
  13627. info->user_ptr[0] = rdev;
  13628. }
  13629. if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) {
  13630. struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID];
  13631. if (!wdev) {
  13632. err = -EINVAL;
  13633. goto out_unlock;
  13634. }
  13635. /* MLO -> require valid link ID */
  13636. if (wdev->valid_links &&
  13637. (!link_id ||
  13638. !(wdev->valid_links & BIT(nla_get_u8(link_id))))) {
  13639. err = -EINVAL;
  13640. goto out_unlock;
  13641. }
  13642. /* non-MLO -> no link ID attribute accepted */
  13643. if (!wdev->valid_links && link_id) {
  13644. err = -EINVAL;
  13645. goto out_unlock;
  13646. }
  13647. }
  13648. if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) {
  13649. if (info->attrs[NL80211_ATTR_MLO_LINK_ID] ||
  13650. (wdev && wdev->valid_links)) {
  13651. err = -EINVAL;
  13652. goto out_unlock;
  13653. }
  13654. }
  13655. if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) {
  13656. wiphy_lock(&rdev->wiphy);
  13657. /* we keep the mutex locked until post_doit */
  13658. __release(&rdev->wiphy.mtx);
  13659. }
  13660. if (!(internal_flags & NL80211_FLAG_NEED_RTNL))
  13661. rtnl_unlock();
  13662. return 0;
  13663. out_unlock:
  13664. rtnl_unlock();
  13665. dev_put(dev);
  13666. return err;
  13667. }
  13668. static void nl80211_post_doit(const struct genl_ops *ops, struct sk_buff *skb,
  13669. struct genl_info *info)
  13670. {
  13671. u32 internal_flags = nl80211_internal_flags[ops->internal_flags];
  13672. if (info->user_ptr[1]) {
  13673. if (internal_flags & NL80211_FLAG_NEED_WDEV) {
  13674. struct wireless_dev *wdev = info->user_ptr[1];
  13675. dev_put(wdev->netdev);
  13676. } else {
  13677. dev_put(info->user_ptr[1]);
  13678. }
  13679. }
  13680. if (info->user_ptr[0] &&
  13681. !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) {
  13682. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13683. /* we kept the mutex locked since pre_doit */
  13684. __acquire(&rdev->wiphy.mtx);
  13685. wiphy_unlock(&rdev->wiphy);
  13686. }
  13687. if (internal_flags & NL80211_FLAG_NEED_RTNL)
  13688. rtnl_unlock();
  13689. /* If needed, clear the netlink message payload from the SKB
  13690. * as it might contain key data that shouldn't stick around on
  13691. * the heap after the SKB is freed. The netlink message header
  13692. * is still needed for further processing, so leave it intact.
  13693. */
  13694. if (internal_flags & NL80211_FLAG_CLEAR_SKB) {
  13695. struct nlmsghdr *nlh = nlmsg_hdr(skb);
  13696. memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
  13697. }
  13698. }
  13699. static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev,
  13700. struct cfg80211_sar_specs *sar_specs,
  13701. struct nlattr *spec[], int index)
  13702. {
  13703. u32 range_index, i;
  13704. if (!sar_specs || !spec)
  13705. return -EINVAL;
  13706. if (!spec[NL80211_SAR_ATTR_SPECS_POWER] ||
  13707. !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX])
  13708. return -EINVAL;
  13709. range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]);
  13710. /* check if range_index exceeds num_freq_ranges */
  13711. if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges)
  13712. return -EINVAL;
  13713. /* check if range_index duplicates */
  13714. for (i = 0; i < index; i++) {
  13715. if (sar_specs->sub_specs[i].freq_range_index == range_index)
  13716. return -EINVAL;
  13717. }
  13718. sar_specs->sub_specs[index].power =
  13719. nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]);
  13720. sar_specs->sub_specs[index].freq_range_index = range_index;
  13721. return 0;
  13722. }
  13723. static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info)
  13724. {
  13725. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13726. struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1];
  13727. struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1];
  13728. struct cfg80211_sar_specs *sar_spec;
  13729. enum nl80211_sar_type type;
  13730. struct nlattr *spec_list;
  13731. u32 specs;
  13732. int rem, err;
  13733. if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs)
  13734. return -EOPNOTSUPP;
  13735. if (!info->attrs[NL80211_ATTR_SAR_SPEC])
  13736. return -EINVAL;
  13737. nla_parse_nested(tb, NL80211_SAR_ATTR_MAX,
  13738. info->attrs[NL80211_ATTR_SAR_SPEC],
  13739. NULL, NULL);
  13740. if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS])
  13741. return -EINVAL;
  13742. type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]);
  13743. if (type != rdev->wiphy.sar_capa->type)
  13744. return -EINVAL;
  13745. specs = 0;
  13746. nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem)
  13747. specs++;
  13748. if (specs > rdev->wiphy.sar_capa->num_freq_ranges)
  13749. return -EINVAL;
  13750. sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL);
  13751. if (!sar_spec)
  13752. return -ENOMEM;
  13753. sar_spec->type = type;
  13754. specs = 0;
  13755. nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) {
  13756. nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX,
  13757. spec_list, NULL, NULL);
  13758. switch (type) {
  13759. case NL80211_SAR_TYPE_POWER:
  13760. if (nl80211_set_sar_sub_specs(rdev, sar_spec,
  13761. spec, specs)) {
  13762. err = -EINVAL;
  13763. goto error;
  13764. }
  13765. break;
  13766. default:
  13767. err = -EINVAL;
  13768. goto error;
  13769. }
  13770. specs++;
  13771. }
  13772. sar_spec->num_sub_specs = specs;
  13773. rdev->cur_cmd_info = info;
  13774. err = rdev_set_sar_specs(rdev, sar_spec);
  13775. rdev->cur_cmd_info = NULL;
  13776. error:
  13777. kfree(sar_spec);
  13778. return err;
  13779. }
  13780. #define SELECTOR(__sel, name, value) \
  13781. ((__sel) == (value)) ? NL80211_IFL_SEL_##name :
  13782. int __missing_selector(void);
  13783. #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector()
  13784. static const struct genl_ops nl80211_ops[] = {
  13785. {
  13786. .cmd = NL80211_CMD_GET_WIPHY,
  13787. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13788. .doit = nl80211_get_wiphy,
  13789. .dumpit = nl80211_dump_wiphy,
  13790. .done = nl80211_dump_wiphy_done,
  13791. /* can be retrieved by unprivileged users */
  13792. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  13793. },
  13794. };
  13795. static const struct genl_small_ops nl80211_small_ops[] = {
  13796. {
  13797. .cmd = NL80211_CMD_SET_WIPHY,
  13798. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13799. .doit = nl80211_set_wiphy,
  13800. .flags = GENL_UNS_ADMIN_PERM,
  13801. },
  13802. {
  13803. .cmd = NL80211_CMD_GET_INTERFACE,
  13804. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13805. .doit = nl80211_get_interface,
  13806. .dumpit = nl80211_dump_interface,
  13807. /* can be retrieved by unprivileged users */
  13808. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV),
  13809. },
  13810. {
  13811. .cmd = NL80211_CMD_SET_INTERFACE,
  13812. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13813. .doit = nl80211_set_interface,
  13814. .flags = GENL_UNS_ADMIN_PERM,
  13815. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  13816. NL80211_FLAG_NEED_RTNL),
  13817. },
  13818. {
  13819. .cmd = NL80211_CMD_NEW_INTERFACE,
  13820. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13821. .doit = nl80211_new_interface,
  13822. .flags = GENL_UNS_ADMIN_PERM,
  13823. .internal_flags =
  13824. IFLAGS(NL80211_FLAG_NEED_WIPHY |
  13825. NL80211_FLAG_NEED_RTNL |
  13826. /* we take the wiphy mutex later ourselves */
  13827. NL80211_FLAG_NO_WIPHY_MTX),
  13828. },
  13829. {
  13830. .cmd = NL80211_CMD_DEL_INTERFACE,
  13831. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13832. .doit = nl80211_del_interface,
  13833. .flags = GENL_UNS_ADMIN_PERM,
  13834. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
  13835. NL80211_FLAG_NEED_RTNL),
  13836. },
  13837. {
  13838. .cmd = NL80211_CMD_GET_KEY,
  13839. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13840. .doit = nl80211_get_key,
  13841. .flags = GENL_UNS_ADMIN_PERM,
  13842. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13843. },
  13844. {
  13845. .cmd = NL80211_CMD_SET_KEY,
  13846. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13847. .doit = nl80211_set_key,
  13848. .flags = GENL_UNS_ADMIN_PERM,
  13849. /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */
  13850. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  13851. NL80211_FLAG_CLEAR_SKB),
  13852. },
  13853. {
  13854. .cmd = NL80211_CMD_NEW_KEY,
  13855. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13856. .doit = nl80211_new_key,
  13857. .flags = GENL_UNS_ADMIN_PERM,
  13858. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  13859. NL80211_FLAG_CLEAR_SKB),
  13860. },
  13861. {
  13862. .cmd = NL80211_CMD_DEL_KEY,
  13863. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13864. .doit = nl80211_del_key,
  13865. .flags = GENL_UNS_ADMIN_PERM,
  13866. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13867. },
  13868. {
  13869. .cmd = NL80211_CMD_SET_BEACON,
  13870. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13871. .flags = GENL_UNS_ADMIN_PERM,
  13872. .doit = nl80211_set_beacon,
  13873. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  13874. NL80211_FLAG_MLO_VALID_LINK_ID),
  13875. },
  13876. {
  13877. .cmd = NL80211_CMD_START_AP,
  13878. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13879. .flags = GENL_UNS_ADMIN_PERM,
  13880. .doit = nl80211_start_ap,
  13881. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  13882. NL80211_FLAG_MLO_VALID_LINK_ID),
  13883. },
  13884. {
  13885. .cmd = NL80211_CMD_STOP_AP,
  13886. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13887. .flags = GENL_UNS_ADMIN_PERM,
  13888. .doit = nl80211_stop_ap,
  13889. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  13890. NL80211_FLAG_MLO_VALID_LINK_ID),
  13891. },
  13892. {
  13893. .cmd = NL80211_CMD_GET_STATION,
  13894. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13895. .doit = nl80211_get_station,
  13896. .dumpit = nl80211_dump_station,
  13897. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  13898. },
  13899. {
  13900. .cmd = NL80211_CMD_SET_STATION,
  13901. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13902. .doit = nl80211_set_station,
  13903. .flags = GENL_UNS_ADMIN_PERM,
  13904. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13905. },
  13906. {
  13907. .cmd = NL80211_CMD_NEW_STATION,
  13908. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13909. .doit = nl80211_new_station,
  13910. .flags = GENL_UNS_ADMIN_PERM,
  13911. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13912. },
  13913. {
  13914. .cmd = NL80211_CMD_DEL_STATION,
  13915. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13916. .doit = nl80211_del_station,
  13917. .flags = GENL_UNS_ADMIN_PERM,
  13918. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13919. },
  13920. {
  13921. .cmd = NL80211_CMD_GET_MPATH,
  13922. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13923. .doit = nl80211_get_mpath,
  13924. .dumpit = nl80211_dump_mpath,
  13925. .flags = GENL_UNS_ADMIN_PERM,
  13926. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13927. },
  13928. {
  13929. .cmd = NL80211_CMD_GET_MPP,
  13930. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13931. .doit = nl80211_get_mpp,
  13932. .dumpit = nl80211_dump_mpp,
  13933. .flags = GENL_UNS_ADMIN_PERM,
  13934. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13935. },
  13936. {
  13937. .cmd = NL80211_CMD_SET_MPATH,
  13938. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13939. .doit = nl80211_set_mpath,
  13940. .flags = GENL_UNS_ADMIN_PERM,
  13941. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13942. },
  13943. {
  13944. .cmd = NL80211_CMD_NEW_MPATH,
  13945. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13946. .doit = nl80211_new_mpath,
  13947. .flags = GENL_UNS_ADMIN_PERM,
  13948. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13949. },
  13950. {
  13951. .cmd = NL80211_CMD_DEL_MPATH,
  13952. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13953. .doit = nl80211_del_mpath,
  13954. .flags = GENL_UNS_ADMIN_PERM,
  13955. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13956. },
  13957. {
  13958. .cmd = NL80211_CMD_SET_BSS,
  13959. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13960. .doit = nl80211_set_bss,
  13961. .flags = GENL_UNS_ADMIN_PERM,
  13962. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  13963. NL80211_FLAG_MLO_VALID_LINK_ID),
  13964. },
  13965. {
  13966. .cmd = NL80211_CMD_GET_REG,
  13967. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13968. .doit = nl80211_get_reg_do,
  13969. .dumpit = nl80211_get_reg_dump,
  13970. /* can be retrieved by unprivileged users */
  13971. },
  13972. #ifdef CONFIG_CFG80211_CRDA_SUPPORT
  13973. {
  13974. .cmd = NL80211_CMD_SET_REG,
  13975. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13976. .doit = nl80211_set_reg,
  13977. .flags = GENL_ADMIN_PERM,
  13978. },
  13979. #endif
  13980. {
  13981. .cmd = NL80211_CMD_REQ_SET_REG,
  13982. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13983. .doit = nl80211_req_set_reg,
  13984. .flags = GENL_ADMIN_PERM,
  13985. },
  13986. {
  13987. .cmd = NL80211_CMD_RELOAD_REGDB,
  13988. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13989. .doit = nl80211_reload_regdb,
  13990. .flags = GENL_ADMIN_PERM,
  13991. },
  13992. {
  13993. .cmd = NL80211_CMD_GET_MESH_CONFIG,
  13994. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  13995. .doit = nl80211_get_mesh_config,
  13996. /* can be retrieved by unprivileged users */
  13997. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  13998. },
  13999. {
  14000. .cmd = NL80211_CMD_SET_MESH_CONFIG,
  14001. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14002. .doit = nl80211_update_mesh_config,
  14003. .flags = GENL_UNS_ADMIN_PERM,
  14004. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14005. },
  14006. {
  14007. .cmd = NL80211_CMD_TRIGGER_SCAN,
  14008. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14009. .doit = nl80211_trigger_scan,
  14010. .flags = GENL_UNS_ADMIN_PERM,
  14011. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14012. },
  14013. {
  14014. .cmd = NL80211_CMD_ABORT_SCAN,
  14015. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14016. .doit = nl80211_abort_scan,
  14017. .flags = GENL_UNS_ADMIN_PERM,
  14018. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14019. },
  14020. {
  14021. .cmd = NL80211_CMD_GET_SCAN,
  14022. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14023. .dumpit = nl80211_dump_scan,
  14024. },
  14025. {
  14026. .cmd = NL80211_CMD_START_SCHED_SCAN,
  14027. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14028. .doit = nl80211_start_sched_scan,
  14029. .flags = GENL_UNS_ADMIN_PERM,
  14030. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14031. },
  14032. {
  14033. .cmd = NL80211_CMD_STOP_SCHED_SCAN,
  14034. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14035. .doit = nl80211_stop_sched_scan,
  14036. .flags = GENL_UNS_ADMIN_PERM,
  14037. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14038. },
  14039. {
  14040. .cmd = NL80211_CMD_AUTHENTICATE,
  14041. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14042. .doit = nl80211_authenticate,
  14043. .flags = GENL_UNS_ADMIN_PERM,
  14044. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14045. NL80211_FLAG_CLEAR_SKB),
  14046. },
  14047. {
  14048. .cmd = NL80211_CMD_ASSOCIATE,
  14049. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14050. .doit = nl80211_associate,
  14051. .flags = GENL_UNS_ADMIN_PERM,
  14052. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14053. NL80211_FLAG_CLEAR_SKB),
  14054. },
  14055. {
  14056. .cmd = NL80211_CMD_DEAUTHENTICATE,
  14057. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14058. .doit = nl80211_deauthenticate,
  14059. .flags = GENL_UNS_ADMIN_PERM,
  14060. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14061. },
  14062. {
  14063. .cmd = NL80211_CMD_DISASSOCIATE,
  14064. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14065. .doit = nl80211_disassociate,
  14066. .flags = GENL_UNS_ADMIN_PERM,
  14067. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14068. },
  14069. {
  14070. .cmd = NL80211_CMD_JOIN_IBSS,
  14071. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14072. .doit = nl80211_join_ibss,
  14073. .flags = GENL_UNS_ADMIN_PERM,
  14074. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14075. },
  14076. {
  14077. .cmd = NL80211_CMD_LEAVE_IBSS,
  14078. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14079. .doit = nl80211_leave_ibss,
  14080. .flags = GENL_UNS_ADMIN_PERM,
  14081. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14082. },
  14083. #ifdef CONFIG_NL80211_TESTMODE
  14084. {
  14085. .cmd = NL80211_CMD_TESTMODE,
  14086. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14087. .doit = nl80211_testmode_do,
  14088. .dumpit = nl80211_testmode_dump,
  14089. .flags = GENL_UNS_ADMIN_PERM,
  14090. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14091. },
  14092. #endif
  14093. {
  14094. .cmd = NL80211_CMD_CONNECT,
  14095. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14096. .doit = nl80211_connect,
  14097. .flags = GENL_UNS_ADMIN_PERM,
  14098. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14099. NL80211_FLAG_CLEAR_SKB),
  14100. },
  14101. {
  14102. .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
  14103. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14104. .doit = nl80211_update_connect_params,
  14105. .flags = GENL_ADMIN_PERM,
  14106. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14107. NL80211_FLAG_CLEAR_SKB),
  14108. },
  14109. {
  14110. .cmd = NL80211_CMD_DISCONNECT,
  14111. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14112. .doit = nl80211_disconnect,
  14113. .flags = GENL_UNS_ADMIN_PERM,
  14114. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14115. },
  14116. {
  14117. .cmd = NL80211_CMD_SET_WIPHY_NETNS,
  14118. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14119. .doit = nl80211_wiphy_netns,
  14120. .flags = GENL_UNS_ADMIN_PERM,
  14121. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
  14122. NL80211_FLAG_NEED_RTNL |
  14123. NL80211_FLAG_NO_WIPHY_MTX),
  14124. },
  14125. {
  14126. .cmd = NL80211_CMD_GET_SURVEY,
  14127. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14128. .dumpit = nl80211_dump_survey,
  14129. },
  14130. {
  14131. .cmd = NL80211_CMD_SET_PMKSA,
  14132. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14133. .doit = nl80211_set_pmksa,
  14134. .flags = GENL_UNS_ADMIN_PERM,
  14135. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14136. NL80211_FLAG_CLEAR_SKB),
  14137. },
  14138. {
  14139. .cmd = NL80211_CMD_DEL_PMKSA,
  14140. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14141. .doit = nl80211_del_pmksa,
  14142. .flags = GENL_UNS_ADMIN_PERM,
  14143. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14144. },
  14145. {
  14146. .cmd = NL80211_CMD_FLUSH_PMKSA,
  14147. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14148. .doit = nl80211_flush_pmksa,
  14149. .flags = GENL_UNS_ADMIN_PERM,
  14150. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14151. },
  14152. {
  14153. .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
  14154. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14155. .doit = nl80211_remain_on_channel,
  14156. .flags = GENL_UNS_ADMIN_PERM,
  14157. /* FIXME: requiring a link ID here is probably not good */
  14158. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
  14159. NL80211_FLAG_MLO_VALID_LINK_ID),
  14160. },
  14161. {
  14162. .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  14163. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14164. .doit = nl80211_cancel_remain_on_channel,
  14165. .flags = GENL_UNS_ADMIN_PERM,
  14166. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14167. },
  14168. {
  14169. .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
  14170. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14171. .doit = nl80211_set_tx_bitrate_mask,
  14172. .flags = GENL_UNS_ADMIN_PERM,
  14173. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14174. NL80211_FLAG_MLO_VALID_LINK_ID),
  14175. },
  14176. {
  14177. .cmd = NL80211_CMD_REGISTER_FRAME,
  14178. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14179. .doit = nl80211_register_mgmt,
  14180. .flags = GENL_UNS_ADMIN_PERM,
  14181. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV),
  14182. },
  14183. {
  14184. .cmd = NL80211_CMD_FRAME,
  14185. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14186. .doit = nl80211_tx_mgmt,
  14187. .flags = GENL_UNS_ADMIN_PERM,
  14188. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14189. },
  14190. {
  14191. .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
  14192. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14193. .doit = nl80211_tx_mgmt_cancel_wait,
  14194. .flags = GENL_UNS_ADMIN_PERM,
  14195. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14196. },
  14197. {
  14198. .cmd = NL80211_CMD_SET_POWER_SAVE,
  14199. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14200. .doit = nl80211_set_power_save,
  14201. .flags = GENL_UNS_ADMIN_PERM,
  14202. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14203. },
  14204. {
  14205. .cmd = NL80211_CMD_GET_POWER_SAVE,
  14206. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14207. .doit = nl80211_get_power_save,
  14208. /* can be retrieved by unprivileged users */
  14209. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14210. },
  14211. {
  14212. .cmd = NL80211_CMD_SET_CQM,
  14213. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14214. .doit = nl80211_set_cqm,
  14215. .flags = GENL_UNS_ADMIN_PERM,
  14216. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14217. },
  14218. {
  14219. .cmd = NL80211_CMD_SET_CHANNEL,
  14220. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14221. .doit = nl80211_set_channel,
  14222. .flags = GENL_UNS_ADMIN_PERM,
  14223. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14224. NL80211_FLAG_MLO_VALID_LINK_ID),
  14225. },
  14226. {
  14227. .cmd = NL80211_CMD_JOIN_MESH,
  14228. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14229. .doit = nl80211_join_mesh,
  14230. .flags = GENL_UNS_ADMIN_PERM,
  14231. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14232. },
  14233. {
  14234. .cmd = NL80211_CMD_LEAVE_MESH,
  14235. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14236. .doit = nl80211_leave_mesh,
  14237. .flags = GENL_UNS_ADMIN_PERM,
  14238. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14239. },
  14240. {
  14241. .cmd = NL80211_CMD_JOIN_OCB,
  14242. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14243. .doit = nl80211_join_ocb,
  14244. .flags = GENL_UNS_ADMIN_PERM,
  14245. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14246. },
  14247. {
  14248. .cmd = NL80211_CMD_LEAVE_OCB,
  14249. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14250. .doit = nl80211_leave_ocb,
  14251. .flags = GENL_UNS_ADMIN_PERM,
  14252. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14253. },
  14254. #ifdef CONFIG_PM
  14255. {
  14256. .cmd = NL80211_CMD_GET_WOWLAN,
  14257. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14258. .doit = nl80211_get_wowlan,
  14259. /* can be retrieved by unprivileged users */
  14260. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14261. },
  14262. {
  14263. .cmd = NL80211_CMD_SET_WOWLAN,
  14264. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14265. .doit = nl80211_set_wowlan,
  14266. .flags = GENL_UNS_ADMIN_PERM,
  14267. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14268. },
  14269. #endif
  14270. {
  14271. .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
  14272. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14273. .doit = nl80211_set_rekey_data,
  14274. .flags = GENL_UNS_ADMIN_PERM,
  14275. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14276. NL80211_FLAG_CLEAR_SKB),
  14277. },
  14278. {
  14279. .cmd = NL80211_CMD_TDLS_MGMT,
  14280. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14281. .doit = nl80211_tdls_mgmt,
  14282. .flags = GENL_UNS_ADMIN_PERM,
  14283. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14284. },
  14285. {
  14286. .cmd = NL80211_CMD_TDLS_OPER,
  14287. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14288. .doit = nl80211_tdls_oper,
  14289. .flags = GENL_UNS_ADMIN_PERM,
  14290. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14291. },
  14292. {
  14293. .cmd = NL80211_CMD_UNEXPECTED_FRAME,
  14294. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14295. .doit = nl80211_register_unexpected_frame,
  14296. .flags = GENL_UNS_ADMIN_PERM,
  14297. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14298. },
  14299. {
  14300. .cmd = NL80211_CMD_PROBE_CLIENT,
  14301. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14302. .doit = nl80211_probe_client,
  14303. .flags = GENL_UNS_ADMIN_PERM,
  14304. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14305. },
  14306. {
  14307. .cmd = NL80211_CMD_REGISTER_BEACONS,
  14308. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14309. .doit = nl80211_register_beacons,
  14310. .flags = GENL_UNS_ADMIN_PERM,
  14311. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14312. },
  14313. {
  14314. .cmd = NL80211_CMD_SET_NOACK_MAP,
  14315. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14316. .doit = nl80211_set_noack_map,
  14317. .flags = GENL_UNS_ADMIN_PERM,
  14318. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14319. },
  14320. {
  14321. .cmd = NL80211_CMD_START_P2P_DEVICE,
  14322. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14323. .doit = nl80211_start_p2p_device,
  14324. .flags = GENL_UNS_ADMIN_PERM,
  14325. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
  14326. NL80211_FLAG_NEED_RTNL),
  14327. },
  14328. {
  14329. .cmd = NL80211_CMD_STOP_P2P_DEVICE,
  14330. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14331. .doit = nl80211_stop_p2p_device,
  14332. .flags = GENL_UNS_ADMIN_PERM,
  14333. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
  14334. NL80211_FLAG_NEED_RTNL),
  14335. },
  14336. {
  14337. .cmd = NL80211_CMD_START_NAN,
  14338. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14339. .doit = nl80211_start_nan,
  14340. .flags = GENL_ADMIN_PERM,
  14341. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
  14342. NL80211_FLAG_NEED_RTNL),
  14343. },
  14344. {
  14345. .cmd = NL80211_CMD_STOP_NAN,
  14346. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14347. .doit = nl80211_stop_nan,
  14348. .flags = GENL_ADMIN_PERM,
  14349. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
  14350. NL80211_FLAG_NEED_RTNL),
  14351. },
  14352. {
  14353. .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
  14354. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14355. .doit = nl80211_nan_add_func,
  14356. .flags = GENL_ADMIN_PERM,
  14357. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14358. },
  14359. {
  14360. .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
  14361. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14362. .doit = nl80211_nan_del_func,
  14363. .flags = GENL_ADMIN_PERM,
  14364. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14365. },
  14366. {
  14367. .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
  14368. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14369. .doit = nl80211_nan_change_config,
  14370. .flags = GENL_ADMIN_PERM,
  14371. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14372. },
  14373. {
  14374. .cmd = NL80211_CMD_SET_MCAST_RATE,
  14375. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14376. .doit = nl80211_set_mcast_rate,
  14377. .flags = GENL_UNS_ADMIN_PERM,
  14378. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14379. },
  14380. {
  14381. .cmd = NL80211_CMD_SET_MAC_ACL,
  14382. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14383. .doit = nl80211_set_mac_acl,
  14384. .flags = GENL_UNS_ADMIN_PERM,
  14385. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14386. NL80211_FLAG_MLO_UNSUPPORTED),
  14387. },
  14388. {
  14389. .cmd = NL80211_CMD_RADAR_DETECT,
  14390. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14391. .doit = nl80211_start_radar_detection,
  14392. .flags = GENL_UNS_ADMIN_PERM,
  14393. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14394. NL80211_FLAG_NO_WIPHY_MTX |
  14395. NL80211_FLAG_MLO_UNSUPPORTED),
  14396. },
  14397. {
  14398. .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
  14399. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14400. .doit = nl80211_get_protocol_features,
  14401. },
  14402. {
  14403. .cmd = NL80211_CMD_UPDATE_FT_IES,
  14404. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14405. .doit = nl80211_update_ft_ies,
  14406. .flags = GENL_UNS_ADMIN_PERM,
  14407. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14408. },
  14409. {
  14410. .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
  14411. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14412. .doit = nl80211_crit_protocol_start,
  14413. .flags = GENL_UNS_ADMIN_PERM,
  14414. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14415. },
  14416. {
  14417. .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
  14418. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14419. .doit = nl80211_crit_protocol_stop,
  14420. .flags = GENL_UNS_ADMIN_PERM,
  14421. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14422. },
  14423. {
  14424. .cmd = NL80211_CMD_GET_COALESCE,
  14425. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14426. .doit = nl80211_get_coalesce,
  14427. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14428. },
  14429. {
  14430. .cmd = NL80211_CMD_SET_COALESCE,
  14431. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14432. .doit = nl80211_set_coalesce,
  14433. .flags = GENL_UNS_ADMIN_PERM,
  14434. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14435. },
  14436. {
  14437. .cmd = NL80211_CMD_CHANNEL_SWITCH,
  14438. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14439. .doit = nl80211_channel_switch,
  14440. .flags = GENL_UNS_ADMIN_PERM,
  14441. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14442. NL80211_FLAG_MLO_VALID_LINK_ID),
  14443. },
  14444. {
  14445. .cmd = NL80211_CMD_VENDOR,
  14446. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14447. .doit = nl80211_vendor_cmd,
  14448. .dumpit = nl80211_vendor_cmd_dump,
  14449. .flags = GENL_UNS_ADMIN_PERM,
  14450. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
  14451. NL80211_FLAG_CLEAR_SKB),
  14452. },
  14453. {
  14454. .cmd = NL80211_CMD_SET_QOS_MAP,
  14455. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14456. .doit = nl80211_set_qos_map,
  14457. .flags = GENL_UNS_ADMIN_PERM,
  14458. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14459. },
  14460. {
  14461. .cmd = NL80211_CMD_ADD_TX_TS,
  14462. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14463. .doit = nl80211_add_tx_ts,
  14464. .flags = GENL_UNS_ADMIN_PERM,
  14465. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14466. NL80211_FLAG_MLO_UNSUPPORTED),
  14467. },
  14468. {
  14469. .cmd = NL80211_CMD_DEL_TX_TS,
  14470. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14471. .doit = nl80211_del_tx_ts,
  14472. .flags = GENL_UNS_ADMIN_PERM,
  14473. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14474. },
  14475. {
  14476. .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
  14477. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14478. .doit = nl80211_tdls_channel_switch,
  14479. .flags = GENL_UNS_ADMIN_PERM,
  14480. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14481. },
  14482. {
  14483. .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
  14484. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14485. .doit = nl80211_tdls_cancel_channel_switch,
  14486. .flags = GENL_UNS_ADMIN_PERM,
  14487. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14488. },
  14489. {
  14490. .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
  14491. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14492. .doit = nl80211_set_multicast_to_unicast,
  14493. .flags = GENL_UNS_ADMIN_PERM,
  14494. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14495. },
  14496. {
  14497. .cmd = NL80211_CMD_SET_PMK,
  14498. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14499. .doit = nl80211_set_pmk,
  14500. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14501. NL80211_FLAG_CLEAR_SKB),
  14502. },
  14503. {
  14504. .cmd = NL80211_CMD_DEL_PMK,
  14505. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14506. .doit = nl80211_del_pmk,
  14507. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14508. },
  14509. {
  14510. .cmd = NL80211_CMD_EXTERNAL_AUTH,
  14511. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14512. .doit = nl80211_external_auth,
  14513. .flags = GENL_ADMIN_PERM,
  14514. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14515. },
  14516. {
  14517. .cmd = NL80211_CMD_CONTROL_PORT_FRAME,
  14518. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14519. .doit = nl80211_tx_control_port,
  14520. .flags = GENL_UNS_ADMIN_PERM,
  14521. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14522. },
  14523. {
  14524. .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS,
  14525. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14526. .doit = nl80211_get_ftm_responder_stats,
  14527. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14528. NL80211_FLAG_MLO_VALID_LINK_ID),
  14529. },
  14530. {
  14531. .cmd = NL80211_CMD_PEER_MEASUREMENT_START,
  14532. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14533. .doit = nl80211_pmsr_start,
  14534. .flags = GENL_UNS_ADMIN_PERM,
  14535. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14536. },
  14537. {
  14538. .cmd = NL80211_CMD_NOTIFY_RADAR,
  14539. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14540. .doit = nl80211_notify_radar_detection,
  14541. .flags = GENL_UNS_ADMIN_PERM,
  14542. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14543. },
  14544. {
  14545. .cmd = NL80211_CMD_UPDATE_OWE_INFO,
  14546. .doit = nl80211_update_owe_info,
  14547. .flags = GENL_ADMIN_PERM,
  14548. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14549. },
  14550. {
  14551. .cmd = NL80211_CMD_PROBE_MESH_LINK,
  14552. .doit = nl80211_probe_mesh_link,
  14553. .flags = GENL_UNS_ADMIN_PERM,
  14554. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14555. },
  14556. {
  14557. .cmd = NL80211_CMD_SET_TID_CONFIG,
  14558. .doit = nl80211_set_tid_config,
  14559. .flags = GENL_UNS_ADMIN_PERM,
  14560. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14561. NL80211_FLAG_MLO_VALID_LINK_ID),
  14562. },
  14563. {
  14564. .cmd = NL80211_CMD_SET_SAR_SPECS,
  14565. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14566. .doit = nl80211_set_sar_specs,
  14567. .flags = GENL_UNS_ADMIN_PERM,
  14568. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
  14569. NL80211_FLAG_NEED_RTNL),
  14570. },
  14571. {
  14572. .cmd = NL80211_CMD_COLOR_CHANGE_REQUEST,
  14573. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14574. .doit = nl80211_color_change,
  14575. .flags = GENL_UNS_ADMIN_PERM,
  14576. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14577. },
  14578. {
  14579. .cmd = NL80211_CMD_SET_FILS_AAD,
  14580. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14581. .doit = nl80211_set_fils_aad,
  14582. .flags = GENL_UNS_ADMIN_PERM,
  14583. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14584. },
  14585. {
  14586. .cmd = NL80211_CMD_ADD_LINK,
  14587. .doit = nl80211_add_link,
  14588. .flags = GENL_UNS_ADMIN_PERM,
  14589. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14590. },
  14591. {
  14592. .cmd = NL80211_CMD_REMOVE_LINK,
  14593. .doit = nl80211_remove_link,
  14594. .flags = GENL_UNS_ADMIN_PERM,
  14595. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14596. NL80211_FLAG_MLO_VALID_LINK_ID),
  14597. },
  14598. {
  14599. .cmd = NL80211_CMD_ADD_LINK_STA,
  14600. .doit = nl80211_add_link_station,
  14601. .flags = GENL_UNS_ADMIN_PERM,
  14602. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14603. NL80211_FLAG_MLO_VALID_LINK_ID),
  14604. },
  14605. {
  14606. .cmd = NL80211_CMD_MODIFY_LINK_STA,
  14607. .doit = nl80211_modify_link_station,
  14608. .flags = GENL_UNS_ADMIN_PERM,
  14609. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14610. NL80211_FLAG_MLO_VALID_LINK_ID),
  14611. },
  14612. {
  14613. .cmd = NL80211_CMD_REMOVE_LINK_STA,
  14614. .doit = nl80211_remove_link_station,
  14615. .flags = GENL_UNS_ADMIN_PERM,
  14616. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14617. NL80211_FLAG_MLO_VALID_LINK_ID),
  14618. },
  14619. };
  14620. static struct genl_family nl80211_fam __ro_after_init = {
  14621. .name = NL80211_GENL_NAME, /* have users key off the name instead */
  14622. .hdrsize = 0, /* no private header */
  14623. .version = 1, /* no particular meaning now */
  14624. .maxattr = NL80211_ATTR_MAX,
  14625. .policy = nl80211_policy,
  14626. .netnsok = true,
  14627. .pre_doit = nl80211_pre_doit,
  14628. .post_doit = nl80211_post_doit,
  14629. .module = THIS_MODULE,
  14630. .ops = nl80211_ops,
  14631. .n_ops = ARRAY_SIZE(nl80211_ops),
  14632. .small_ops = nl80211_small_ops,
  14633. .n_small_ops = ARRAY_SIZE(nl80211_small_ops),
  14634. .resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1,
  14635. .mcgrps = nl80211_mcgrps,
  14636. .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
  14637. .parallel_ops = true,
  14638. };
  14639. /* notification functions */
  14640. void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
  14641. enum nl80211_commands cmd)
  14642. {
  14643. struct sk_buff *msg;
  14644. struct nl80211_dump_wiphy_state state = {};
  14645. WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
  14646. cmd != NL80211_CMD_DEL_WIPHY);
  14647. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  14648. if (!msg)
  14649. return;
  14650. if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
  14651. nlmsg_free(msg);
  14652. return;
  14653. }
  14654. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  14655. NL80211_MCGRP_CONFIG, GFP_KERNEL);
  14656. }
  14657. void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
  14658. struct wireless_dev *wdev,
  14659. enum nl80211_commands cmd)
  14660. {
  14661. struct sk_buff *msg;
  14662. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  14663. if (!msg)
  14664. return;
  14665. if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) {
  14666. nlmsg_free(msg);
  14667. return;
  14668. }
  14669. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  14670. NL80211_MCGRP_CONFIG, GFP_KERNEL);
  14671. }
  14672. static int nl80211_add_scan_req(struct sk_buff *msg,
  14673. struct cfg80211_registered_device *rdev)
  14674. {
  14675. struct cfg80211_scan_request *req = rdev->scan_req;
  14676. struct nlattr *nest;
  14677. int i;
  14678. struct cfg80211_scan_info *info;
  14679. if (WARN_ON(!req))
  14680. return 0;
  14681. nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS);
  14682. if (!nest)
  14683. goto nla_put_failure;
  14684. for (i = 0; i < req->n_ssids; i++) {
  14685. if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
  14686. goto nla_put_failure;
  14687. }
  14688. nla_nest_end(msg, nest);
  14689. if (req->flags & NL80211_SCAN_FLAG_FREQ_KHZ) {
  14690. nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ);
  14691. if (!nest)
  14692. goto nla_put_failure;
  14693. for (i = 0; i < req->n_channels; i++) {
  14694. if (nla_put_u32(msg, i,
  14695. ieee80211_channel_to_khz(req->channels[i])))
  14696. goto nla_put_failure;
  14697. }
  14698. nla_nest_end(msg, nest);
  14699. } else {
  14700. nest = nla_nest_start_noflag(msg,
  14701. NL80211_ATTR_SCAN_FREQUENCIES);
  14702. if (!nest)
  14703. goto nla_put_failure;
  14704. for (i = 0; i < req->n_channels; i++) {
  14705. if (nla_put_u32(msg, i, req->channels[i]->center_freq))
  14706. goto nla_put_failure;
  14707. }
  14708. nla_nest_end(msg, nest);
  14709. }
  14710. if (req->ie &&
  14711. nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
  14712. goto nla_put_failure;
  14713. if (req->flags &&
  14714. nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
  14715. goto nla_put_failure;
  14716. info = rdev->int_scan_req ? &rdev->int_scan_req->info :
  14717. &rdev->scan_req->info;
  14718. if (info->scan_start_tsf &&
  14719. (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
  14720. info->scan_start_tsf, NL80211_BSS_PAD) ||
  14721. nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
  14722. info->tsf_bssid)))
  14723. goto nla_put_failure;
  14724. return 0;
  14725. nla_put_failure:
  14726. return -ENOBUFS;
  14727. }
  14728. static int nl80211_prep_scan_msg(struct sk_buff *msg,
  14729. struct cfg80211_registered_device *rdev,
  14730. struct wireless_dev *wdev,
  14731. u32 portid, u32 seq, int flags,
  14732. u32 cmd)
  14733. {
  14734. void *hdr;
  14735. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  14736. if (!hdr)
  14737. return -1;
  14738. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  14739. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  14740. wdev->netdev->ifindex)) ||
  14741. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  14742. NL80211_ATTR_PAD))
  14743. goto nla_put_failure;
  14744. /* ignore errors and send incomplete event anyway */
  14745. nl80211_add_scan_req(msg, rdev);
  14746. genlmsg_end(msg, hdr);
  14747. return 0;
  14748. nla_put_failure:
  14749. genlmsg_cancel(msg, hdr);
  14750. return -EMSGSIZE;
  14751. }
  14752. static int
  14753. nl80211_prep_sched_scan_msg(struct sk_buff *msg,
  14754. struct cfg80211_sched_scan_request *req, u32 cmd)
  14755. {
  14756. void *hdr;
  14757. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  14758. if (!hdr)
  14759. return -1;
  14760. if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
  14761. wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
  14762. nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
  14763. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
  14764. NL80211_ATTR_PAD))
  14765. goto nla_put_failure;
  14766. genlmsg_end(msg, hdr);
  14767. return 0;
  14768. nla_put_failure:
  14769. genlmsg_cancel(msg, hdr);
  14770. return -EMSGSIZE;
  14771. }
  14772. void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
  14773. struct wireless_dev *wdev)
  14774. {
  14775. struct sk_buff *msg;
  14776. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  14777. if (!msg)
  14778. return;
  14779. if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
  14780. NL80211_CMD_TRIGGER_SCAN) < 0) {
  14781. nlmsg_free(msg);
  14782. return;
  14783. }
  14784. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  14785. NL80211_MCGRP_SCAN, GFP_KERNEL);
  14786. }
  14787. struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
  14788. struct wireless_dev *wdev, bool aborted)
  14789. {
  14790. struct sk_buff *msg;
  14791. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  14792. if (!msg)
  14793. return NULL;
  14794. if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
  14795. aborted ? NL80211_CMD_SCAN_ABORTED :
  14796. NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
  14797. nlmsg_free(msg);
  14798. return NULL;
  14799. }
  14800. return msg;
  14801. }
  14802. /* send message created by nl80211_build_scan_msg() */
  14803. void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
  14804. struct sk_buff *msg)
  14805. {
  14806. if (!msg)
  14807. return;
  14808. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  14809. NL80211_MCGRP_SCAN, GFP_KERNEL);
  14810. }
  14811. void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
  14812. {
  14813. struct sk_buff *msg;
  14814. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  14815. if (!msg)
  14816. return;
  14817. if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
  14818. nlmsg_free(msg);
  14819. return;
  14820. }
  14821. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
  14822. NL80211_MCGRP_SCAN, GFP_KERNEL);
  14823. }
  14824. static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
  14825. struct regulatory_request *request)
  14826. {
  14827. /* Userspace can always count this one always being set */
  14828. if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
  14829. goto nla_put_failure;
  14830. if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
  14831. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  14832. NL80211_REGDOM_TYPE_WORLD))
  14833. goto nla_put_failure;
  14834. } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
  14835. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  14836. NL80211_REGDOM_TYPE_CUSTOM_WORLD))
  14837. goto nla_put_failure;
  14838. } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
  14839. request->intersect) {
  14840. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  14841. NL80211_REGDOM_TYPE_INTERSECTION))
  14842. goto nla_put_failure;
  14843. } else {
  14844. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  14845. NL80211_REGDOM_TYPE_COUNTRY) ||
  14846. nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
  14847. request->alpha2))
  14848. goto nla_put_failure;
  14849. }
  14850. if (request->wiphy_idx != WIPHY_IDX_INVALID) {
  14851. struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
  14852. if (wiphy &&
  14853. nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
  14854. goto nla_put_failure;
  14855. if (wiphy &&
  14856. wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  14857. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  14858. goto nla_put_failure;
  14859. }
  14860. return true;
  14861. nla_put_failure:
  14862. return false;
  14863. }
  14864. /*
  14865. * This can happen on global regulatory changes or device specific settings
  14866. * based on custom regulatory domains.
  14867. */
  14868. void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
  14869. struct regulatory_request *request)
  14870. {
  14871. struct sk_buff *msg;
  14872. void *hdr;
  14873. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  14874. if (!msg)
  14875. return;
  14876. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
  14877. if (!hdr)
  14878. goto nla_put_failure;
  14879. if (!nl80211_reg_change_event_fill(msg, request))
  14880. goto nla_put_failure;
  14881. genlmsg_end(msg, hdr);
  14882. rcu_read_lock();
  14883. genlmsg_multicast_allns(&nl80211_fam, msg, 0,
  14884. NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
  14885. rcu_read_unlock();
  14886. return;
  14887. nla_put_failure:
  14888. nlmsg_free(msg);
  14889. }
  14890. static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
  14891. struct net_device *netdev,
  14892. const u8 *buf, size_t len,
  14893. enum nl80211_commands cmd, gfp_t gfp,
  14894. int uapsd_queues, const u8 *req_ies,
  14895. size_t req_ies_len, bool reconnect)
  14896. {
  14897. struct sk_buff *msg;
  14898. void *hdr;
  14899. msg = nlmsg_new(100 + len + req_ies_len, gfp);
  14900. if (!msg)
  14901. return;
  14902. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  14903. if (!hdr) {
  14904. nlmsg_free(msg);
  14905. return;
  14906. }
  14907. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  14908. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  14909. nla_put(msg, NL80211_ATTR_FRAME, len, buf) ||
  14910. (req_ies &&
  14911. nla_put(msg, NL80211_ATTR_REQ_IE, req_ies_len, req_ies)))
  14912. goto nla_put_failure;
  14913. if (reconnect && nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED))
  14914. goto nla_put_failure;
  14915. if (uapsd_queues >= 0) {
  14916. struct nlattr *nla_wmm =
  14917. nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME);
  14918. if (!nla_wmm)
  14919. goto nla_put_failure;
  14920. if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
  14921. uapsd_queues))
  14922. goto nla_put_failure;
  14923. nla_nest_end(msg, nla_wmm);
  14924. }
  14925. genlmsg_end(msg, hdr);
  14926. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  14927. NL80211_MCGRP_MLME, gfp);
  14928. return;
  14929. nla_put_failure:
  14930. nlmsg_free(msg);
  14931. }
  14932. void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
  14933. struct net_device *netdev, const u8 *buf,
  14934. size_t len, gfp_t gfp)
  14935. {
  14936. nl80211_send_mlme_event(rdev, netdev, buf, len,
  14937. NL80211_CMD_AUTHENTICATE, gfp, -1, NULL, 0,
  14938. false);
  14939. }
  14940. void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
  14941. struct net_device *netdev,
  14942. struct cfg80211_rx_assoc_resp *data)
  14943. {
  14944. nl80211_send_mlme_event(rdev, netdev, data->buf, data->len,
  14945. NL80211_CMD_ASSOCIATE, GFP_KERNEL,
  14946. data->uapsd_queues,
  14947. data->req_ies, data->req_ies_len, false);
  14948. }
  14949. void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
  14950. struct net_device *netdev, const u8 *buf,
  14951. size_t len, bool reconnect, gfp_t gfp)
  14952. {
  14953. nl80211_send_mlme_event(rdev, netdev, buf, len,
  14954. NL80211_CMD_DEAUTHENTICATE, gfp, -1, NULL, 0,
  14955. reconnect);
  14956. }
  14957. void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
  14958. struct net_device *netdev, const u8 *buf,
  14959. size_t len, bool reconnect, gfp_t gfp)
  14960. {
  14961. nl80211_send_mlme_event(rdev, netdev, buf, len,
  14962. NL80211_CMD_DISASSOCIATE, gfp, -1, NULL, 0,
  14963. reconnect);
  14964. }
  14965. void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
  14966. size_t len)
  14967. {
  14968. struct wireless_dev *wdev = dev->ieee80211_ptr;
  14969. struct wiphy *wiphy = wdev->wiphy;
  14970. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  14971. const struct ieee80211_mgmt *mgmt = (void *)buf;
  14972. u32 cmd;
  14973. if (WARN_ON(len < 2))
  14974. return;
  14975. if (ieee80211_is_deauth(mgmt->frame_control)) {
  14976. cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
  14977. } else if (ieee80211_is_disassoc(mgmt->frame_control)) {
  14978. cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
  14979. } else if (ieee80211_is_beacon(mgmt->frame_control)) {
  14980. if (wdev->unprot_beacon_reported &&
  14981. elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000)
  14982. return;
  14983. cmd = NL80211_CMD_UNPROT_BEACON;
  14984. wdev->unprot_beacon_reported = jiffies;
  14985. } else {
  14986. return;
  14987. }
  14988. trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
  14989. nl80211_send_mlme_event(rdev, dev, buf, len, cmd, GFP_ATOMIC, -1,
  14990. NULL, 0, false);
  14991. }
  14992. EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
  14993. static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
  14994. struct net_device *netdev, int cmd,
  14995. const u8 *addr, gfp_t gfp)
  14996. {
  14997. struct sk_buff *msg;
  14998. void *hdr;
  14999. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15000. if (!msg)
  15001. return;
  15002. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  15003. if (!hdr) {
  15004. nlmsg_free(msg);
  15005. return;
  15006. }
  15007. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15008. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15009. nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
  15010. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
  15011. goto nla_put_failure;
  15012. genlmsg_end(msg, hdr);
  15013. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15014. NL80211_MCGRP_MLME, gfp);
  15015. return;
  15016. nla_put_failure:
  15017. nlmsg_free(msg);
  15018. }
  15019. void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
  15020. struct net_device *netdev, const u8 *addr,
  15021. gfp_t gfp)
  15022. {
  15023. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
  15024. addr, gfp);
  15025. }
  15026. void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
  15027. struct net_device *netdev, const u8 *addr,
  15028. gfp_t gfp)
  15029. {
  15030. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
  15031. addr, gfp);
  15032. }
  15033. void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
  15034. struct net_device *netdev,
  15035. struct cfg80211_connect_resp_params *cr,
  15036. gfp_t gfp)
  15037. {
  15038. struct sk_buff *msg;
  15039. void *hdr;
  15040. unsigned int link;
  15041. size_t link_info_size = 0;
  15042. const u8 *connected_addr = cr->valid_links ?
  15043. cr->ap_mld_addr : cr->links[0].bssid;
  15044. if (cr->valid_links) {
  15045. for_each_valid_link(cr, link) {
  15046. /* Nested attribute header */
  15047. link_info_size += NLA_HDRLEN;
  15048. /* Link ID */
  15049. link_info_size += nla_total_size(sizeof(u8));
  15050. link_info_size += cr->links[link].addr ?
  15051. nla_total_size(ETH_ALEN) : 0;
  15052. link_info_size += (cr->links[link].bssid ||
  15053. cr->links[link].bss) ?
  15054. nla_total_size(ETH_ALEN) : 0;
  15055. link_info_size += nla_total_size(sizeof(u16));
  15056. }
  15057. }
  15058. msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
  15059. cr->fils.kek_len + cr->fils.pmk_len +
  15060. (cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size,
  15061. gfp);
  15062. if (!msg)
  15063. return;
  15064. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
  15065. if (!hdr) {
  15066. nlmsg_free(msg);
  15067. return;
  15068. }
  15069. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15070. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15071. (connected_addr &&
  15072. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) ||
  15073. nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
  15074. cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
  15075. cr->status) ||
  15076. (cr->status < 0 &&
  15077. (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
  15078. nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
  15079. cr->timeout_reason))) ||
  15080. (cr->req_ie &&
  15081. nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
  15082. (cr->resp_ie &&
  15083. nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
  15084. cr->resp_ie)) ||
  15085. (cr->fils.update_erp_next_seq_num &&
  15086. nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
  15087. cr->fils.erp_next_seq_num)) ||
  15088. (cr->status == WLAN_STATUS_SUCCESS &&
  15089. ((cr->fils.kek &&
  15090. nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len,
  15091. cr->fils.kek)) ||
  15092. (cr->fils.pmk &&
  15093. nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) ||
  15094. (cr->fils.pmkid &&
  15095. nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid)))))
  15096. goto nla_put_failure;
  15097. if (cr->valid_links) {
  15098. int i = 1;
  15099. struct nlattr *nested;
  15100. nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS);
  15101. if (!nested)
  15102. goto nla_put_failure;
  15103. for_each_valid_link(cr, link) {
  15104. struct nlattr *nested_mlo_links;
  15105. const u8 *bssid = cr->links[link].bss ?
  15106. cr->links[link].bss->bssid :
  15107. cr->links[link].bssid;
  15108. nested_mlo_links = nla_nest_start(msg, i);
  15109. if (!nested_mlo_links)
  15110. goto nla_put_failure;
  15111. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) ||
  15112. (bssid &&
  15113. nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) ||
  15114. (cr->links[link].addr &&
  15115. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
  15116. cr->links[link].addr)) ||
  15117. nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
  15118. cr->links[link].status))
  15119. goto nla_put_failure;
  15120. nla_nest_end(msg, nested_mlo_links);
  15121. i++;
  15122. }
  15123. nla_nest_end(msg, nested);
  15124. }
  15125. genlmsg_end(msg, hdr);
  15126. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15127. NL80211_MCGRP_MLME, gfp);
  15128. return;
  15129. nla_put_failure:
  15130. nlmsg_free(msg);
  15131. }
  15132. void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
  15133. struct net_device *netdev,
  15134. struct cfg80211_roam_info *info, gfp_t gfp)
  15135. {
  15136. struct sk_buff *msg;
  15137. void *hdr;
  15138. size_t link_info_size = 0;
  15139. unsigned int link;
  15140. const u8 *connected_addr = info->ap_mld_addr ?
  15141. info->ap_mld_addr :
  15142. (info->links[0].bss ?
  15143. info->links[0].bss->bssid :
  15144. info->links[0].bssid);
  15145. if (info->valid_links) {
  15146. for_each_valid_link(info, link) {
  15147. /* Nested attribute header */
  15148. link_info_size += NLA_HDRLEN;
  15149. /* Link ID */
  15150. link_info_size += nla_total_size(sizeof(u8));
  15151. link_info_size += info->links[link].addr ?
  15152. nla_total_size(ETH_ALEN) : 0;
  15153. link_info_size += (info->links[link].bssid ||
  15154. info->links[link].bss) ?
  15155. nla_total_size(ETH_ALEN) : 0;
  15156. }
  15157. }
  15158. msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len +
  15159. info->fils.kek_len + info->fils.pmk_len +
  15160. (info->fils.pmkid ? WLAN_PMKID_LEN : 0) +
  15161. link_info_size, gfp);
  15162. if (!msg)
  15163. return;
  15164. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
  15165. if (!hdr) {
  15166. nlmsg_free(msg);
  15167. return;
  15168. }
  15169. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15170. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15171. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) ||
  15172. (info->req_ie &&
  15173. nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
  15174. info->req_ie)) ||
  15175. (info->resp_ie &&
  15176. nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
  15177. info->resp_ie)) ||
  15178. (info->fils.update_erp_next_seq_num &&
  15179. nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
  15180. info->fils.erp_next_seq_num)) ||
  15181. (info->fils.kek &&
  15182. nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len,
  15183. info->fils.kek)) ||
  15184. (info->fils.pmk &&
  15185. nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) ||
  15186. (info->fils.pmkid &&
  15187. nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid)))
  15188. goto nla_put_failure;
  15189. if (info->valid_links) {
  15190. int i = 1;
  15191. struct nlattr *nested;
  15192. nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS);
  15193. if (!nested)
  15194. goto nla_put_failure;
  15195. for_each_valid_link(info, link) {
  15196. struct nlattr *nested_mlo_links;
  15197. const u8 *bssid = info->links[link].bss ?
  15198. info->links[link].bss->bssid :
  15199. info->links[link].bssid;
  15200. nested_mlo_links = nla_nest_start(msg, i);
  15201. if (!nested_mlo_links)
  15202. goto nla_put_failure;
  15203. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) ||
  15204. (bssid &&
  15205. nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) ||
  15206. (info->links[link].addr &&
  15207. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
  15208. info->links[link].addr)))
  15209. goto nla_put_failure;
  15210. nla_nest_end(msg, nested_mlo_links);
  15211. i++;
  15212. }
  15213. nla_nest_end(msg, nested);
  15214. }
  15215. genlmsg_end(msg, hdr);
  15216. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15217. NL80211_MCGRP_MLME, gfp);
  15218. return;
  15219. nla_put_failure:
  15220. nlmsg_free(msg);
  15221. }
  15222. void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
  15223. struct net_device *netdev, const u8 *peer_addr,
  15224. const u8 *td_bitmap, u8 td_bitmap_len)
  15225. {
  15226. struct sk_buff *msg;
  15227. void *hdr;
  15228. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15229. if (!msg)
  15230. return;
  15231. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
  15232. if (!hdr) {
  15233. nlmsg_free(msg);
  15234. return;
  15235. }
  15236. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15237. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15238. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer_addr))
  15239. goto nla_put_failure;
  15240. if ((td_bitmap_len > 0) && td_bitmap)
  15241. if (nla_put(msg, NL80211_ATTR_TD_BITMAP,
  15242. td_bitmap_len, td_bitmap))
  15243. goto nla_put_failure;
  15244. genlmsg_end(msg, hdr);
  15245. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15246. NL80211_MCGRP_MLME, GFP_KERNEL);
  15247. return;
  15248. nla_put_failure:
  15249. nlmsg_free(msg);
  15250. }
  15251. void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
  15252. struct net_device *netdev, u16 reason,
  15253. const u8 *ie, size_t ie_len, bool from_ap)
  15254. {
  15255. struct sk_buff *msg;
  15256. void *hdr;
  15257. msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
  15258. if (!msg)
  15259. return;
  15260. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
  15261. if (!hdr) {
  15262. nlmsg_free(msg);
  15263. return;
  15264. }
  15265. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15266. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15267. (reason &&
  15268. nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
  15269. (from_ap &&
  15270. nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
  15271. (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
  15272. goto nla_put_failure;
  15273. genlmsg_end(msg, hdr);
  15274. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15275. NL80211_MCGRP_MLME, GFP_KERNEL);
  15276. return;
  15277. nla_put_failure:
  15278. nlmsg_free(msg);
  15279. }
  15280. void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
  15281. struct net_device *netdev, const u8 *bssid,
  15282. gfp_t gfp)
  15283. {
  15284. struct sk_buff *msg;
  15285. void *hdr;
  15286. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15287. if (!msg)
  15288. return;
  15289. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
  15290. if (!hdr) {
  15291. nlmsg_free(msg);
  15292. return;
  15293. }
  15294. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15295. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15296. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  15297. goto nla_put_failure;
  15298. genlmsg_end(msg, hdr);
  15299. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15300. NL80211_MCGRP_MLME, gfp);
  15301. return;
  15302. nla_put_failure:
  15303. nlmsg_free(msg);
  15304. }
  15305. void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
  15306. const u8 *ie, u8 ie_len,
  15307. int sig_dbm, gfp_t gfp)
  15308. {
  15309. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15310. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  15311. struct sk_buff *msg;
  15312. void *hdr;
  15313. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
  15314. return;
  15315. trace_cfg80211_notify_new_peer_candidate(dev, addr);
  15316. msg = nlmsg_new(100 + ie_len, gfp);
  15317. if (!msg)
  15318. return;
  15319. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
  15320. if (!hdr) {
  15321. nlmsg_free(msg);
  15322. return;
  15323. }
  15324. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15325. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  15326. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  15327. (ie_len && ie &&
  15328. nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) ||
  15329. (sig_dbm &&
  15330. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)))
  15331. goto nla_put_failure;
  15332. genlmsg_end(msg, hdr);
  15333. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15334. NL80211_MCGRP_MLME, gfp);
  15335. return;
  15336. nla_put_failure:
  15337. nlmsg_free(msg);
  15338. }
  15339. EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
  15340. void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
  15341. struct net_device *netdev, const u8 *addr,
  15342. enum nl80211_key_type key_type, int key_id,
  15343. const u8 *tsc, gfp_t gfp)
  15344. {
  15345. struct sk_buff *msg;
  15346. void *hdr;
  15347. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15348. if (!msg)
  15349. return;
  15350. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
  15351. if (!hdr) {
  15352. nlmsg_free(msg);
  15353. return;
  15354. }
  15355. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15356. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15357. (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
  15358. nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
  15359. (key_id != -1 &&
  15360. nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
  15361. (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
  15362. goto nla_put_failure;
  15363. genlmsg_end(msg, hdr);
  15364. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15365. NL80211_MCGRP_MLME, gfp);
  15366. return;
  15367. nla_put_failure:
  15368. nlmsg_free(msg);
  15369. }
  15370. void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
  15371. struct ieee80211_channel *channel_before,
  15372. struct ieee80211_channel *channel_after)
  15373. {
  15374. struct sk_buff *msg;
  15375. void *hdr;
  15376. struct nlattr *nl_freq;
  15377. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
  15378. if (!msg)
  15379. return;
  15380. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
  15381. if (!hdr) {
  15382. nlmsg_free(msg);
  15383. return;
  15384. }
  15385. /*
  15386. * Since we are applying the beacon hint to a wiphy we know its
  15387. * wiphy_idx is valid
  15388. */
  15389. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  15390. goto nla_put_failure;
  15391. /* Before */
  15392. nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE);
  15393. if (!nl_freq)
  15394. goto nla_put_failure;
  15395. if (nl80211_msg_put_channel(msg, wiphy, channel_before, false))
  15396. goto nla_put_failure;
  15397. nla_nest_end(msg, nl_freq);
  15398. /* After */
  15399. nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER);
  15400. if (!nl_freq)
  15401. goto nla_put_failure;
  15402. if (nl80211_msg_put_channel(msg, wiphy, channel_after, false))
  15403. goto nla_put_failure;
  15404. nla_nest_end(msg, nl_freq);
  15405. genlmsg_end(msg, hdr);
  15406. rcu_read_lock();
  15407. genlmsg_multicast_allns(&nl80211_fam, msg, 0,
  15408. NL80211_MCGRP_REGULATORY, GFP_ATOMIC);
  15409. rcu_read_unlock();
  15410. return;
  15411. nla_put_failure:
  15412. nlmsg_free(msg);
  15413. }
  15414. static void nl80211_send_remain_on_chan_event(
  15415. int cmd, struct cfg80211_registered_device *rdev,
  15416. struct wireless_dev *wdev, u64 cookie,
  15417. struct ieee80211_channel *chan,
  15418. unsigned int duration, gfp_t gfp)
  15419. {
  15420. struct sk_buff *msg;
  15421. void *hdr;
  15422. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15423. if (!msg)
  15424. return;
  15425. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  15426. if (!hdr) {
  15427. nlmsg_free(msg);
  15428. return;
  15429. }
  15430. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15431. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  15432. wdev->netdev->ifindex)) ||
  15433. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  15434. NL80211_ATTR_PAD) ||
  15435. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
  15436. nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
  15437. NL80211_CHAN_NO_HT) ||
  15438. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  15439. NL80211_ATTR_PAD))
  15440. goto nla_put_failure;
  15441. if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
  15442. nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
  15443. goto nla_put_failure;
  15444. genlmsg_end(msg, hdr);
  15445. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15446. NL80211_MCGRP_MLME, gfp);
  15447. return;
  15448. nla_put_failure:
  15449. nlmsg_free(msg);
  15450. }
  15451. void cfg80211_assoc_comeback(struct net_device *netdev,
  15452. const u8 *ap_addr, u32 timeout)
  15453. {
  15454. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  15455. struct wiphy *wiphy = wdev->wiphy;
  15456. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15457. struct sk_buff *msg;
  15458. void *hdr;
  15459. trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout);
  15460. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15461. if (!msg)
  15462. return;
  15463. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK);
  15464. if (!hdr) {
  15465. nlmsg_free(msg);
  15466. return;
  15467. }
  15468. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15469. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15470. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) ||
  15471. nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout))
  15472. goto nla_put_failure;
  15473. genlmsg_end(msg, hdr);
  15474. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15475. NL80211_MCGRP_MLME, GFP_KERNEL);
  15476. return;
  15477. nla_put_failure:
  15478. nlmsg_free(msg);
  15479. }
  15480. EXPORT_SYMBOL(cfg80211_assoc_comeback);
  15481. void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
  15482. struct ieee80211_channel *chan,
  15483. unsigned int duration, gfp_t gfp)
  15484. {
  15485. struct wiphy *wiphy = wdev->wiphy;
  15486. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15487. trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
  15488. nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
  15489. rdev, wdev, cookie, chan,
  15490. duration, gfp);
  15491. }
  15492. EXPORT_SYMBOL(cfg80211_ready_on_channel);
  15493. void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
  15494. struct ieee80211_channel *chan,
  15495. gfp_t gfp)
  15496. {
  15497. struct wiphy *wiphy = wdev->wiphy;
  15498. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15499. trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
  15500. nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  15501. rdev, wdev, cookie, chan, 0, gfp);
  15502. }
  15503. EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
  15504. void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie,
  15505. struct ieee80211_channel *chan,
  15506. gfp_t gfp)
  15507. {
  15508. struct wiphy *wiphy = wdev->wiphy;
  15509. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15510. trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan);
  15511. nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL,
  15512. rdev, wdev, cookie, chan, 0, gfp);
  15513. }
  15514. EXPORT_SYMBOL(cfg80211_tx_mgmt_expired);
  15515. void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
  15516. struct station_info *sinfo, gfp_t gfp)
  15517. {
  15518. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  15519. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15520. struct sk_buff *msg;
  15521. trace_cfg80211_new_sta(dev, mac_addr, sinfo);
  15522. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15523. if (!msg)
  15524. return;
  15525. if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
  15526. rdev, dev, mac_addr, sinfo) < 0) {
  15527. nlmsg_free(msg);
  15528. return;
  15529. }
  15530. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15531. NL80211_MCGRP_MLME, gfp);
  15532. }
  15533. EXPORT_SYMBOL(cfg80211_new_sta);
  15534. void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
  15535. struct station_info *sinfo, gfp_t gfp)
  15536. {
  15537. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  15538. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15539. struct sk_buff *msg;
  15540. struct station_info empty_sinfo = {};
  15541. if (!sinfo)
  15542. sinfo = &empty_sinfo;
  15543. trace_cfg80211_del_sta(dev, mac_addr);
  15544. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15545. if (!msg) {
  15546. cfg80211_sinfo_release_content(sinfo);
  15547. return;
  15548. }
  15549. if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
  15550. rdev, dev, mac_addr, sinfo) < 0) {
  15551. nlmsg_free(msg);
  15552. return;
  15553. }
  15554. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15555. NL80211_MCGRP_MLME, gfp);
  15556. }
  15557. EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
  15558. void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
  15559. enum nl80211_connect_failed_reason reason,
  15560. gfp_t gfp)
  15561. {
  15562. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  15563. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15564. struct sk_buff *msg;
  15565. void *hdr;
  15566. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  15567. if (!msg)
  15568. return;
  15569. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
  15570. if (!hdr) {
  15571. nlmsg_free(msg);
  15572. return;
  15573. }
  15574. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  15575. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
  15576. nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
  15577. goto nla_put_failure;
  15578. genlmsg_end(msg, hdr);
  15579. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15580. NL80211_MCGRP_MLME, gfp);
  15581. return;
  15582. nla_put_failure:
  15583. nlmsg_free(msg);
  15584. }
  15585. EXPORT_SYMBOL(cfg80211_conn_failed);
  15586. static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
  15587. const u8 *addr, gfp_t gfp)
  15588. {
  15589. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15590. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  15591. struct sk_buff *msg;
  15592. void *hdr;
  15593. u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
  15594. if (!nlportid)
  15595. return false;
  15596. msg = nlmsg_new(100, gfp);
  15597. if (!msg)
  15598. return true;
  15599. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  15600. if (!hdr) {
  15601. nlmsg_free(msg);
  15602. return true;
  15603. }
  15604. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15605. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  15606. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
  15607. goto nla_put_failure;
  15608. genlmsg_end(msg, hdr);
  15609. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  15610. return true;
  15611. nla_put_failure:
  15612. nlmsg_free(msg);
  15613. return true;
  15614. }
  15615. bool cfg80211_rx_spurious_frame(struct net_device *dev,
  15616. const u8 *addr, gfp_t gfp)
  15617. {
  15618. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15619. bool ret;
  15620. trace_cfg80211_rx_spurious_frame(dev, addr);
  15621. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  15622. wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
  15623. trace_cfg80211_return_bool(false);
  15624. return false;
  15625. }
  15626. ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
  15627. addr, gfp);
  15628. trace_cfg80211_return_bool(ret);
  15629. return ret;
  15630. }
  15631. EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
  15632. bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
  15633. const u8 *addr, gfp_t gfp)
  15634. {
  15635. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15636. bool ret;
  15637. trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
  15638. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  15639. wdev->iftype != NL80211_IFTYPE_P2P_GO &&
  15640. wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
  15641. trace_cfg80211_return_bool(false);
  15642. return false;
  15643. }
  15644. ret = __nl80211_unexpected_frame(dev,
  15645. NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
  15646. addr, gfp);
  15647. trace_cfg80211_return_bool(ret);
  15648. return ret;
  15649. }
  15650. EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
  15651. int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
  15652. struct wireless_dev *wdev, u32 nlportid,
  15653. struct cfg80211_rx_info *info, gfp_t gfp)
  15654. {
  15655. struct net_device *netdev = wdev->netdev;
  15656. struct sk_buff *msg;
  15657. void *hdr;
  15658. msg = nlmsg_new(100 + info->len, gfp);
  15659. if (!msg)
  15660. return -ENOMEM;
  15661. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  15662. if (!hdr) {
  15663. nlmsg_free(msg);
  15664. return -ENOMEM;
  15665. }
  15666. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15667. (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  15668. netdev->ifindex)) ||
  15669. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  15670. NL80211_ATTR_PAD) ||
  15671. (info->have_link_id &&
  15672. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) ||
  15673. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) ||
  15674. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) ||
  15675. (info->sig_dbm &&
  15676. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) ||
  15677. nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) ||
  15678. (info->flags &&
  15679. nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) ||
  15680. (info->rx_tstamp && nla_put_u64_64bit(msg,
  15681. NL80211_ATTR_RX_HW_TIMESTAMP,
  15682. info->rx_tstamp,
  15683. NL80211_ATTR_PAD)) ||
  15684. (info->ack_tstamp && nla_put_u64_64bit(msg,
  15685. NL80211_ATTR_TX_HW_TIMESTAMP,
  15686. info->ack_tstamp,
  15687. NL80211_ATTR_PAD)))
  15688. goto nla_put_failure;
  15689. genlmsg_end(msg, hdr);
  15690. return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  15691. nla_put_failure:
  15692. nlmsg_free(msg);
  15693. return -ENOBUFS;
  15694. }
  15695. static void nl80211_frame_tx_status(struct wireless_dev *wdev,
  15696. struct cfg80211_tx_status *status,
  15697. gfp_t gfp, enum nl80211_commands command)
  15698. {
  15699. struct wiphy *wiphy = wdev->wiphy;
  15700. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15701. struct net_device *netdev = wdev->netdev;
  15702. struct sk_buff *msg;
  15703. void *hdr;
  15704. if (command == NL80211_CMD_FRAME_TX_STATUS)
  15705. trace_cfg80211_mgmt_tx_status(wdev, status->cookie,
  15706. status->ack);
  15707. else
  15708. trace_cfg80211_control_port_tx_status(wdev, status->cookie,
  15709. status->ack);
  15710. msg = nlmsg_new(100 + status->len, gfp);
  15711. if (!msg)
  15712. return;
  15713. hdr = nl80211hdr_put(msg, 0, 0, 0, command);
  15714. if (!hdr) {
  15715. nlmsg_free(msg);
  15716. return;
  15717. }
  15718. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15719. (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  15720. netdev->ifindex)) ||
  15721. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  15722. NL80211_ATTR_PAD) ||
  15723. nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) ||
  15724. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie,
  15725. NL80211_ATTR_PAD) ||
  15726. (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
  15727. (status->tx_tstamp &&
  15728. nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP,
  15729. status->tx_tstamp, NL80211_ATTR_PAD)) ||
  15730. (status->ack_tstamp &&
  15731. nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP,
  15732. status->ack_tstamp, NL80211_ATTR_PAD)))
  15733. goto nla_put_failure;
  15734. genlmsg_end(msg, hdr);
  15735. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15736. NL80211_MCGRP_MLME, gfp);
  15737. return;
  15738. nla_put_failure:
  15739. nlmsg_free(msg);
  15740. }
  15741. void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie,
  15742. const u8 *buf, size_t len, bool ack,
  15743. gfp_t gfp)
  15744. {
  15745. struct cfg80211_tx_status status = {
  15746. .cookie = cookie,
  15747. .buf = buf,
  15748. .len = len,
  15749. .ack = ack
  15750. };
  15751. nl80211_frame_tx_status(wdev, &status, gfp,
  15752. NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS);
  15753. }
  15754. EXPORT_SYMBOL(cfg80211_control_port_tx_status);
  15755. void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev,
  15756. struct cfg80211_tx_status *status, gfp_t gfp)
  15757. {
  15758. nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS);
  15759. }
  15760. EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext);
  15761. static int __nl80211_rx_control_port(struct net_device *dev,
  15762. struct sk_buff *skb,
  15763. bool unencrypted,
  15764. int link_id,
  15765. gfp_t gfp)
  15766. {
  15767. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15768. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  15769. struct ethhdr *ehdr = eth_hdr(skb);
  15770. const u8 *addr = ehdr->h_source;
  15771. u16 proto = be16_to_cpu(skb->protocol);
  15772. struct sk_buff *msg;
  15773. void *hdr;
  15774. struct nlattr *frame;
  15775. u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid);
  15776. if (!nlportid)
  15777. return -ENOENT;
  15778. msg = nlmsg_new(100 + skb->len, gfp);
  15779. if (!msg)
  15780. return -ENOMEM;
  15781. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME);
  15782. if (!hdr) {
  15783. nlmsg_free(msg);
  15784. return -ENOBUFS;
  15785. }
  15786. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15787. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  15788. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  15789. NL80211_ATTR_PAD) ||
  15790. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  15791. nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) ||
  15792. (link_id >= 0 &&
  15793. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) ||
  15794. (unencrypted && nla_put_flag(msg,
  15795. NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT)))
  15796. goto nla_put_failure;
  15797. frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len);
  15798. if (!frame)
  15799. goto nla_put_failure;
  15800. skb_copy_bits(skb, 0, nla_data(frame), skb->len);
  15801. genlmsg_end(msg, hdr);
  15802. return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  15803. nla_put_failure:
  15804. nlmsg_free(msg);
  15805. return -ENOBUFS;
  15806. }
  15807. bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb,
  15808. bool unencrypted, int link_id)
  15809. {
  15810. int ret;
  15811. trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id);
  15812. ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id,
  15813. GFP_ATOMIC);
  15814. trace_cfg80211_return_bool(ret == 0);
  15815. return ret == 0;
  15816. }
  15817. EXPORT_SYMBOL(cfg80211_rx_control_port);
  15818. static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
  15819. const char *mac, gfp_t gfp)
  15820. {
  15821. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15822. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  15823. struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15824. void **cb;
  15825. if (!msg)
  15826. return NULL;
  15827. cb = (void **)msg->cb;
  15828. cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
  15829. if (!cb[0]) {
  15830. nlmsg_free(msg);
  15831. return NULL;
  15832. }
  15833. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15834. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  15835. goto nla_put_failure;
  15836. if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
  15837. goto nla_put_failure;
  15838. cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM);
  15839. if (!cb[1])
  15840. goto nla_put_failure;
  15841. cb[2] = rdev;
  15842. return msg;
  15843. nla_put_failure:
  15844. nlmsg_free(msg);
  15845. return NULL;
  15846. }
  15847. static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
  15848. {
  15849. void **cb = (void **)msg->cb;
  15850. struct cfg80211_registered_device *rdev = cb[2];
  15851. nla_nest_end(msg, cb[1]);
  15852. genlmsg_end(msg, cb[0]);
  15853. memset(msg->cb, 0, sizeof(msg->cb));
  15854. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15855. NL80211_MCGRP_MLME, gfp);
  15856. }
  15857. void cfg80211_cqm_rssi_notify(struct net_device *dev,
  15858. enum nl80211_cqm_rssi_threshold_event rssi_event,
  15859. s32 rssi_level, gfp_t gfp)
  15860. {
  15861. struct sk_buff *msg;
  15862. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15863. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  15864. trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
  15865. if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
  15866. rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
  15867. return;
  15868. if (wdev->cqm_config) {
  15869. wdev->cqm_config->last_rssi_event_value = rssi_level;
  15870. cfg80211_cqm_rssi_update(rdev, dev);
  15871. if (rssi_level == 0)
  15872. rssi_level = wdev->cqm_config->last_rssi_event_value;
  15873. }
  15874. msg = cfg80211_prepare_cqm(dev, NULL, gfp);
  15875. if (!msg)
  15876. return;
  15877. if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
  15878. rssi_event))
  15879. goto nla_put_failure;
  15880. if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
  15881. rssi_level))
  15882. goto nla_put_failure;
  15883. cfg80211_send_cqm(msg, gfp);
  15884. return;
  15885. nla_put_failure:
  15886. nlmsg_free(msg);
  15887. }
  15888. EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
  15889. void cfg80211_cqm_txe_notify(struct net_device *dev,
  15890. const u8 *peer, u32 num_packets,
  15891. u32 rate, u32 intvl, gfp_t gfp)
  15892. {
  15893. struct sk_buff *msg;
  15894. msg = cfg80211_prepare_cqm(dev, peer, gfp);
  15895. if (!msg)
  15896. return;
  15897. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
  15898. goto nla_put_failure;
  15899. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
  15900. goto nla_put_failure;
  15901. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
  15902. goto nla_put_failure;
  15903. cfg80211_send_cqm(msg, gfp);
  15904. return;
  15905. nla_put_failure:
  15906. nlmsg_free(msg);
  15907. }
  15908. EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
  15909. void cfg80211_cqm_pktloss_notify(struct net_device *dev,
  15910. const u8 *peer, u32 num_packets, gfp_t gfp)
  15911. {
  15912. struct sk_buff *msg;
  15913. trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
  15914. msg = cfg80211_prepare_cqm(dev, peer, gfp);
  15915. if (!msg)
  15916. return;
  15917. if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
  15918. goto nla_put_failure;
  15919. cfg80211_send_cqm(msg, gfp);
  15920. return;
  15921. nla_put_failure:
  15922. nlmsg_free(msg);
  15923. }
  15924. EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
  15925. void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
  15926. {
  15927. struct sk_buff *msg;
  15928. msg = cfg80211_prepare_cqm(dev, NULL, gfp);
  15929. if (!msg)
  15930. return;
  15931. if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
  15932. goto nla_put_failure;
  15933. cfg80211_send_cqm(msg, gfp);
  15934. return;
  15935. nla_put_failure:
  15936. nlmsg_free(msg);
  15937. }
  15938. EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
  15939. static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
  15940. struct net_device *netdev, const u8 *bssid,
  15941. const u8 *replay_ctr, gfp_t gfp)
  15942. {
  15943. struct sk_buff *msg;
  15944. struct nlattr *rekey_attr;
  15945. void *hdr;
  15946. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15947. if (!msg)
  15948. return;
  15949. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
  15950. if (!hdr) {
  15951. nlmsg_free(msg);
  15952. return;
  15953. }
  15954. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15955. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15956. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  15957. goto nla_put_failure;
  15958. rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA);
  15959. if (!rekey_attr)
  15960. goto nla_put_failure;
  15961. if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
  15962. NL80211_REPLAY_CTR_LEN, replay_ctr))
  15963. goto nla_put_failure;
  15964. nla_nest_end(msg, rekey_attr);
  15965. genlmsg_end(msg, hdr);
  15966. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15967. NL80211_MCGRP_MLME, gfp);
  15968. return;
  15969. nla_put_failure:
  15970. nlmsg_free(msg);
  15971. }
  15972. void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
  15973. const u8 *replay_ctr, gfp_t gfp)
  15974. {
  15975. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15976. struct wiphy *wiphy = wdev->wiphy;
  15977. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15978. trace_cfg80211_gtk_rekey_notify(dev, bssid);
  15979. nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
  15980. }
  15981. EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
  15982. static void
  15983. nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
  15984. struct net_device *netdev, int index,
  15985. const u8 *bssid, bool preauth, gfp_t gfp)
  15986. {
  15987. struct sk_buff *msg;
  15988. struct nlattr *attr;
  15989. void *hdr;
  15990. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15991. if (!msg)
  15992. return;
  15993. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
  15994. if (!hdr) {
  15995. nlmsg_free(msg);
  15996. return;
  15997. }
  15998. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15999. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  16000. goto nla_put_failure;
  16001. attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE);
  16002. if (!attr)
  16003. goto nla_put_failure;
  16004. if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
  16005. nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
  16006. (preauth &&
  16007. nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
  16008. goto nla_put_failure;
  16009. nla_nest_end(msg, attr);
  16010. genlmsg_end(msg, hdr);
  16011. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16012. NL80211_MCGRP_MLME, gfp);
  16013. return;
  16014. nla_put_failure:
  16015. nlmsg_free(msg);
  16016. }
  16017. void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
  16018. const u8 *bssid, bool preauth, gfp_t gfp)
  16019. {
  16020. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16021. struct wiphy *wiphy = wdev->wiphy;
  16022. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16023. trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
  16024. nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
  16025. }
  16026. EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
  16027. static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
  16028. struct net_device *netdev,
  16029. unsigned int link_id,
  16030. struct cfg80211_chan_def *chandef,
  16031. gfp_t gfp,
  16032. enum nl80211_commands notif,
  16033. u8 count, bool quiet, u16 punct_bitmap)
  16034. {
  16035. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  16036. struct sk_buff *msg;
  16037. void *hdr;
  16038. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16039. if (!msg)
  16040. return;
  16041. hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
  16042. if (!hdr) {
  16043. nlmsg_free(msg);
  16044. return;
  16045. }
  16046. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  16047. goto nla_put_failure;
  16048. if (wdev->valid_links &&
  16049. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
  16050. goto nla_put_failure;
  16051. if (nl80211_send_chandef(msg, chandef))
  16052. goto nla_put_failure;
  16053. if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) {
  16054. if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count))
  16055. goto nla_put_failure;
  16056. if (quiet &&
  16057. nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX))
  16058. goto nla_put_failure;
  16059. }
  16060. if (nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, punct_bitmap))
  16061. goto nla_put_failure;
  16062. genlmsg_end(msg, hdr);
  16063. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16064. NL80211_MCGRP_MLME, gfp);
  16065. return;
  16066. nla_put_failure:
  16067. nlmsg_free(msg);
  16068. }
  16069. void cfg80211_ch_switch_notify(struct net_device *dev,
  16070. struct cfg80211_chan_def *chandef,
  16071. unsigned int link_id, u16 punct_bitmap)
  16072. {
  16073. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16074. struct wiphy *wiphy = wdev->wiphy;
  16075. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16076. ASSERT_WDEV_LOCK(wdev);
  16077. WARN_INVALID_LINK_ID(wdev, link_id);
  16078. trace_cfg80211_ch_switch_notify(dev, chandef, link_id, punct_bitmap);
  16079. switch (wdev->iftype) {
  16080. case NL80211_IFTYPE_STATION:
  16081. case NL80211_IFTYPE_P2P_CLIENT:
  16082. if (!WARN_ON(!wdev->links[link_id].client.current_bss))
  16083. cfg80211_update_assoc_bss_entry(wdev, link_id,
  16084. chandef->chan);
  16085. break;
  16086. case NL80211_IFTYPE_MESH_POINT:
  16087. wdev->u.mesh.chandef = *chandef;
  16088. wdev->u.mesh.preset_chandef = *chandef;
  16089. break;
  16090. case NL80211_IFTYPE_AP:
  16091. case NL80211_IFTYPE_P2P_GO:
  16092. wdev->links[link_id].ap.chandef = *chandef;
  16093. break;
  16094. case NL80211_IFTYPE_ADHOC:
  16095. wdev->u.ibss.chandef = *chandef;
  16096. break;
  16097. default:
  16098. WARN_ON(1);
  16099. break;
  16100. }
  16101. cfg80211_sched_dfs_chan_update(rdev);
  16102. nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL,
  16103. NL80211_CMD_CH_SWITCH_NOTIFY, 0, false,
  16104. punct_bitmap);
  16105. }
  16106. EXPORT_SYMBOL(cfg80211_ch_switch_notify);
  16107. void cfg80211_ch_switch_started_notify(struct net_device *dev,
  16108. struct cfg80211_chan_def *chandef,
  16109. unsigned int link_id, u8 count,
  16110. bool quiet, u16 punct_bitmap)
  16111. {
  16112. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16113. struct wiphy *wiphy = wdev->wiphy;
  16114. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16115. ASSERT_WDEV_LOCK(wdev);
  16116. WARN_INVALID_LINK_ID(wdev, link_id);
  16117. trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id,
  16118. punct_bitmap);
  16119. nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL,
  16120. NL80211_CMD_CH_SWITCH_STARTED_NOTIFY,
  16121. count, quiet, punct_bitmap);
  16122. }
  16123. EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
  16124. int cfg80211_bss_color_notify(struct net_device *dev, gfp_t gfp,
  16125. enum nl80211_commands cmd, u8 count,
  16126. u64 color_bitmap)
  16127. {
  16128. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16129. struct wiphy *wiphy = wdev->wiphy;
  16130. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16131. struct sk_buff *msg;
  16132. void *hdr;
  16133. ASSERT_WDEV_LOCK(wdev);
  16134. trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap);
  16135. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16136. if (!msg)
  16137. return -ENOMEM;
  16138. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  16139. if (!hdr)
  16140. goto nla_put_failure;
  16141. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  16142. goto nla_put_failure;
  16143. if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED &&
  16144. nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count))
  16145. goto nla_put_failure;
  16146. if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION &&
  16147. nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP,
  16148. color_bitmap, NL80211_ATTR_PAD))
  16149. goto nla_put_failure;
  16150. genlmsg_end(msg, hdr);
  16151. return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  16152. msg, 0, NL80211_MCGRP_MLME, gfp);
  16153. nla_put_failure:
  16154. nlmsg_free(msg);
  16155. return -EINVAL;
  16156. }
  16157. EXPORT_SYMBOL(cfg80211_bss_color_notify);
  16158. void
  16159. nl80211_radar_notify(struct cfg80211_registered_device *rdev,
  16160. const struct cfg80211_chan_def *chandef,
  16161. enum nl80211_radar_event event,
  16162. struct net_device *netdev, gfp_t gfp)
  16163. {
  16164. struct sk_buff *msg;
  16165. void *hdr;
  16166. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16167. if (!msg)
  16168. return;
  16169. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
  16170. if (!hdr) {
  16171. nlmsg_free(msg);
  16172. return;
  16173. }
  16174. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  16175. goto nla_put_failure;
  16176. /* NOP and radar events don't need a netdev parameter */
  16177. if (netdev) {
  16178. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  16179. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  16180. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16181. NL80211_ATTR_PAD))
  16182. goto nla_put_failure;
  16183. }
  16184. if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
  16185. goto nla_put_failure;
  16186. if (nl80211_send_chandef(msg, chandef))
  16187. goto nla_put_failure;
  16188. genlmsg_end(msg, hdr);
  16189. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16190. NL80211_MCGRP_MLME, gfp);
  16191. return;
  16192. nla_put_failure:
  16193. nlmsg_free(msg);
  16194. }
  16195. void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac,
  16196. struct sta_opmode_info *sta_opmode,
  16197. gfp_t gfp)
  16198. {
  16199. struct sk_buff *msg;
  16200. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16201. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16202. void *hdr;
  16203. if (WARN_ON(!mac))
  16204. return;
  16205. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16206. if (!msg)
  16207. return;
  16208. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED);
  16209. if (!hdr) {
  16210. nlmsg_free(msg);
  16211. return;
  16212. }
  16213. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  16214. goto nla_put_failure;
  16215. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  16216. goto nla_put_failure;
  16217. if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
  16218. goto nla_put_failure;
  16219. if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) &&
  16220. nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode))
  16221. goto nla_put_failure;
  16222. if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) &&
  16223. nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw))
  16224. goto nla_put_failure;
  16225. if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) &&
  16226. nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss))
  16227. goto nla_put_failure;
  16228. genlmsg_end(msg, hdr);
  16229. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16230. NL80211_MCGRP_MLME, gfp);
  16231. return;
  16232. nla_put_failure:
  16233. nlmsg_free(msg);
  16234. }
  16235. EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify);
  16236. void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
  16237. u64 cookie, bool acked, s32 ack_signal,
  16238. bool is_valid_ack_signal, gfp_t gfp)
  16239. {
  16240. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16241. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16242. struct sk_buff *msg;
  16243. void *hdr;
  16244. trace_cfg80211_probe_status(dev, addr, cookie, acked);
  16245. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16246. if (!msg)
  16247. return;
  16248. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
  16249. if (!hdr) {
  16250. nlmsg_free(msg);
  16251. return;
  16252. }
  16253. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16254. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  16255. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  16256. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  16257. NL80211_ATTR_PAD) ||
  16258. (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
  16259. (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL,
  16260. ack_signal)))
  16261. goto nla_put_failure;
  16262. genlmsg_end(msg, hdr);
  16263. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16264. NL80211_MCGRP_MLME, gfp);
  16265. return;
  16266. nla_put_failure:
  16267. nlmsg_free(msg);
  16268. }
  16269. EXPORT_SYMBOL(cfg80211_probe_status);
  16270. void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame,
  16271. size_t len, int freq, int sig_dbm)
  16272. {
  16273. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16274. struct sk_buff *msg;
  16275. void *hdr;
  16276. struct cfg80211_beacon_registration *reg;
  16277. trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
  16278. spin_lock_bh(&rdev->beacon_registrations_lock);
  16279. list_for_each_entry(reg, &rdev->beacon_registrations, list) {
  16280. msg = nlmsg_new(len + 100, GFP_ATOMIC);
  16281. if (!msg) {
  16282. spin_unlock_bh(&rdev->beacon_registrations_lock);
  16283. return;
  16284. }
  16285. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  16286. if (!hdr)
  16287. goto nla_put_failure;
  16288. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16289. (freq &&
  16290. (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
  16291. KHZ_TO_MHZ(freq)) ||
  16292. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET,
  16293. freq % 1000))) ||
  16294. (sig_dbm &&
  16295. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
  16296. nla_put(msg, NL80211_ATTR_FRAME, len, frame))
  16297. goto nla_put_failure;
  16298. genlmsg_end(msg, hdr);
  16299. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
  16300. }
  16301. spin_unlock_bh(&rdev->beacon_registrations_lock);
  16302. return;
  16303. nla_put_failure:
  16304. spin_unlock_bh(&rdev->beacon_registrations_lock);
  16305. nlmsg_free(msg);
  16306. }
  16307. EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz);
  16308. #ifdef CONFIG_PM
  16309. static int cfg80211_net_detect_results(struct sk_buff *msg,
  16310. struct cfg80211_wowlan_wakeup *wakeup)
  16311. {
  16312. struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
  16313. struct nlattr *nl_results, *nl_match, *nl_freqs;
  16314. int i, j;
  16315. nl_results = nla_nest_start_noflag(msg,
  16316. NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
  16317. if (!nl_results)
  16318. return -EMSGSIZE;
  16319. for (i = 0; i < nd->n_matches; i++) {
  16320. struct cfg80211_wowlan_nd_match *match = nd->matches[i];
  16321. nl_match = nla_nest_start_noflag(msg, i);
  16322. if (!nl_match)
  16323. break;
  16324. /* The SSID attribute is optional in nl80211, but for
  16325. * simplicity reasons it's always present in the
  16326. * cfg80211 structure. If a driver can't pass the
  16327. * SSID, that needs to be changed. A zero length SSID
  16328. * is still a valid SSID (wildcard), so it cannot be
  16329. * used for this purpose.
  16330. */
  16331. if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
  16332. match->ssid.ssid)) {
  16333. nla_nest_cancel(msg, nl_match);
  16334. goto out;
  16335. }
  16336. if (match->n_channels) {
  16337. nl_freqs = nla_nest_start_noflag(msg,
  16338. NL80211_ATTR_SCAN_FREQUENCIES);
  16339. if (!nl_freqs) {
  16340. nla_nest_cancel(msg, nl_match);
  16341. goto out;
  16342. }
  16343. for (j = 0; j < match->n_channels; j++) {
  16344. if (nla_put_u32(msg, j, match->channels[j])) {
  16345. nla_nest_cancel(msg, nl_freqs);
  16346. nla_nest_cancel(msg, nl_match);
  16347. goto out;
  16348. }
  16349. }
  16350. nla_nest_end(msg, nl_freqs);
  16351. }
  16352. nla_nest_end(msg, nl_match);
  16353. }
  16354. out:
  16355. nla_nest_end(msg, nl_results);
  16356. return 0;
  16357. }
  16358. void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
  16359. struct cfg80211_wowlan_wakeup *wakeup,
  16360. gfp_t gfp)
  16361. {
  16362. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16363. struct sk_buff *msg;
  16364. void *hdr;
  16365. int size = 200;
  16366. trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
  16367. if (wakeup)
  16368. size += wakeup->packet_present_len;
  16369. msg = nlmsg_new(size, gfp);
  16370. if (!msg)
  16371. return;
  16372. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
  16373. if (!hdr)
  16374. goto free_msg;
  16375. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16376. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16377. NL80211_ATTR_PAD))
  16378. goto free_msg;
  16379. if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  16380. wdev->netdev->ifindex))
  16381. goto free_msg;
  16382. if (wakeup) {
  16383. struct nlattr *reasons;
  16384. reasons = nla_nest_start_noflag(msg,
  16385. NL80211_ATTR_WOWLAN_TRIGGERS);
  16386. if (!reasons)
  16387. goto free_msg;
  16388. if (wakeup->disconnect &&
  16389. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
  16390. goto free_msg;
  16391. if (wakeup->magic_pkt &&
  16392. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
  16393. goto free_msg;
  16394. if (wakeup->gtk_rekey_failure &&
  16395. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
  16396. goto free_msg;
  16397. if (wakeup->eap_identity_req &&
  16398. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
  16399. goto free_msg;
  16400. if (wakeup->four_way_handshake &&
  16401. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
  16402. goto free_msg;
  16403. if (wakeup->rfkill_release &&
  16404. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
  16405. goto free_msg;
  16406. if (wakeup->pattern_idx >= 0 &&
  16407. nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  16408. wakeup->pattern_idx))
  16409. goto free_msg;
  16410. if (wakeup->tcp_match &&
  16411. nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
  16412. goto free_msg;
  16413. if (wakeup->tcp_connlost &&
  16414. nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
  16415. goto free_msg;
  16416. if (wakeup->tcp_nomoretokens &&
  16417. nla_put_flag(msg,
  16418. NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
  16419. goto free_msg;
  16420. if (wakeup->packet) {
  16421. u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
  16422. u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
  16423. if (!wakeup->packet_80211) {
  16424. pkt_attr =
  16425. NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
  16426. len_attr =
  16427. NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
  16428. }
  16429. if (wakeup->packet_len &&
  16430. nla_put_u32(msg, len_attr, wakeup->packet_len))
  16431. goto free_msg;
  16432. if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
  16433. wakeup->packet))
  16434. goto free_msg;
  16435. }
  16436. if (wakeup->net_detect &&
  16437. cfg80211_net_detect_results(msg, wakeup))
  16438. goto free_msg;
  16439. nla_nest_end(msg, reasons);
  16440. }
  16441. genlmsg_end(msg, hdr);
  16442. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16443. NL80211_MCGRP_MLME, gfp);
  16444. return;
  16445. free_msg:
  16446. nlmsg_free(msg);
  16447. }
  16448. EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
  16449. #endif
  16450. void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
  16451. enum nl80211_tdls_operation oper,
  16452. u16 reason_code, gfp_t gfp)
  16453. {
  16454. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16455. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16456. struct sk_buff *msg;
  16457. void *hdr;
  16458. trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
  16459. reason_code);
  16460. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16461. if (!msg)
  16462. return;
  16463. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
  16464. if (!hdr) {
  16465. nlmsg_free(msg);
  16466. return;
  16467. }
  16468. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16469. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  16470. nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
  16471. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
  16472. (reason_code > 0 &&
  16473. nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
  16474. goto nla_put_failure;
  16475. genlmsg_end(msg, hdr);
  16476. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16477. NL80211_MCGRP_MLME, gfp);
  16478. return;
  16479. nla_put_failure:
  16480. nlmsg_free(msg);
  16481. }
  16482. EXPORT_SYMBOL(cfg80211_tdls_oper_request);
  16483. static int nl80211_netlink_notify(struct notifier_block * nb,
  16484. unsigned long state,
  16485. void *_notify)
  16486. {
  16487. struct netlink_notify *notify = _notify;
  16488. struct cfg80211_registered_device *rdev;
  16489. struct wireless_dev *wdev;
  16490. struct cfg80211_beacon_registration *reg, *tmp;
  16491. if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
  16492. return NOTIFY_DONE;
  16493. rcu_read_lock();
  16494. list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
  16495. struct cfg80211_sched_scan_request *sched_scan_req;
  16496. list_for_each_entry_rcu(sched_scan_req,
  16497. &rdev->sched_scan_req_list,
  16498. list) {
  16499. if (sched_scan_req->owner_nlportid == notify->portid) {
  16500. sched_scan_req->nl_owner_dead = true;
  16501. schedule_work(&rdev->sched_scan_stop_wk);
  16502. }
  16503. }
  16504. list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
  16505. cfg80211_mlme_unregister_socket(wdev, notify->portid);
  16506. if (wdev->owner_nlportid == notify->portid) {
  16507. wdev->nl_owner_dead = true;
  16508. schedule_work(&rdev->destroy_work);
  16509. } else if (wdev->conn_owner_nlportid == notify->portid) {
  16510. schedule_work(&wdev->disconnect_wk);
  16511. }
  16512. cfg80211_release_pmsr(wdev, notify->portid);
  16513. }
  16514. spin_lock_bh(&rdev->beacon_registrations_lock);
  16515. list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
  16516. list) {
  16517. if (reg->nlportid == notify->portid) {
  16518. list_del(&reg->list);
  16519. kfree(reg);
  16520. break;
  16521. }
  16522. }
  16523. spin_unlock_bh(&rdev->beacon_registrations_lock);
  16524. }
  16525. rcu_read_unlock();
  16526. /*
  16527. * It is possible that the user space process that is controlling the
  16528. * indoor setting disappeared, so notify the regulatory core.
  16529. */
  16530. regulatory_netlink_notify(notify->portid);
  16531. return NOTIFY_OK;
  16532. }
  16533. static struct notifier_block nl80211_netlink_notifier = {
  16534. .notifier_call = nl80211_netlink_notify,
  16535. };
  16536. void cfg80211_ft_event(struct net_device *netdev,
  16537. struct cfg80211_ft_event_params *ft_event)
  16538. {
  16539. struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
  16540. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16541. struct sk_buff *msg;
  16542. void *hdr;
  16543. trace_cfg80211_ft_event(wiphy, netdev, ft_event);
  16544. if (!ft_event->target_ap)
  16545. return;
  16546. msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len,
  16547. GFP_KERNEL);
  16548. if (!msg)
  16549. return;
  16550. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
  16551. if (!hdr)
  16552. goto out;
  16553. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16554. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  16555. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
  16556. goto out;
  16557. if (ft_event->ies &&
  16558. nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
  16559. goto out;
  16560. if (ft_event->ric_ies &&
  16561. nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
  16562. ft_event->ric_ies))
  16563. goto out;
  16564. genlmsg_end(msg, hdr);
  16565. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16566. NL80211_MCGRP_MLME, GFP_KERNEL);
  16567. return;
  16568. out:
  16569. nlmsg_free(msg);
  16570. }
  16571. EXPORT_SYMBOL(cfg80211_ft_event);
  16572. void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
  16573. {
  16574. struct cfg80211_registered_device *rdev;
  16575. struct sk_buff *msg;
  16576. void *hdr;
  16577. u32 nlportid;
  16578. rdev = wiphy_to_rdev(wdev->wiphy);
  16579. if (!rdev->crit_proto_nlportid)
  16580. return;
  16581. nlportid = rdev->crit_proto_nlportid;
  16582. rdev->crit_proto_nlportid = 0;
  16583. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16584. if (!msg)
  16585. return;
  16586. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
  16587. if (!hdr)
  16588. goto nla_put_failure;
  16589. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16590. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16591. NL80211_ATTR_PAD))
  16592. goto nla_put_failure;
  16593. genlmsg_end(msg, hdr);
  16594. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  16595. return;
  16596. nla_put_failure:
  16597. nlmsg_free(msg);
  16598. }
  16599. EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
  16600. void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id)
  16601. {
  16602. struct wiphy *wiphy = wdev->wiphy;
  16603. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16604. struct sk_buff *msg;
  16605. void *hdr;
  16606. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  16607. if (!msg)
  16608. return;
  16609. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
  16610. if (!hdr)
  16611. goto out;
  16612. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16613. nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
  16614. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16615. NL80211_ATTR_PAD) ||
  16616. (wdev->valid_links &&
  16617. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)))
  16618. goto out;
  16619. genlmsg_end(msg, hdr);
  16620. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
  16621. NL80211_MCGRP_MLME, GFP_KERNEL);
  16622. return;
  16623. out:
  16624. nlmsg_free(msg);
  16625. }
  16626. int cfg80211_external_auth_request(struct net_device *dev,
  16627. struct cfg80211_external_auth_params *params,
  16628. gfp_t gfp)
  16629. {
  16630. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16631. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16632. struct sk_buff *msg;
  16633. void *hdr;
  16634. if (!wdev->conn_owner_nlportid)
  16635. return -EINVAL;
  16636. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16637. if (!msg)
  16638. return -ENOMEM;
  16639. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
  16640. if (!hdr)
  16641. goto nla_put_failure;
  16642. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16643. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  16644. nla_put_u32(msg, NL80211_ATTR_AKM_SUITES, params->key_mgmt_suite) ||
  16645. nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
  16646. params->action) ||
  16647. nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
  16648. nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
  16649. params->ssid.ssid) ||
  16650. (!is_zero_ether_addr(params->mld_addr) &&
  16651. nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr)))
  16652. goto nla_put_failure;
  16653. genlmsg_end(msg, hdr);
  16654. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  16655. wdev->conn_owner_nlportid);
  16656. return 0;
  16657. nla_put_failure:
  16658. nlmsg_free(msg);
  16659. return -ENOBUFS;
  16660. }
  16661. EXPORT_SYMBOL(cfg80211_external_auth_request);
  16662. void cfg80211_update_owe_info_event(struct net_device *netdev,
  16663. struct cfg80211_update_owe_info *owe_info,
  16664. gfp_t gfp)
  16665. {
  16666. struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
  16667. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16668. struct sk_buff *msg;
  16669. void *hdr;
  16670. trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info);
  16671. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16672. if (!msg)
  16673. return;
  16674. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO);
  16675. if (!hdr)
  16676. goto nla_put_failure;
  16677. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16678. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  16679. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer))
  16680. goto nla_put_failure;
  16681. if (!owe_info->ie_len ||
  16682. nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie))
  16683. goto nla_put_failure;
  16684. if (owe_info->assoc_link_id != -1) {
  16685. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID,
  16686. owe_info->assoc_link_id))
  16687. goto nla_put_failure;
  16688. if (!is_zero_ether_addr(owe_info->peer_mld_addr) &&
  16689. nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN,
  16690. owe_info->peer_mld_addr))
  16691. goto nla_put_failure;
  16692. }
  16693. genlmsg_end(msg, hdr);
  16694. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16695. NL80211_MCGRP_MLME, gfp);
  16696. return;
  16697. nla_put_failure:
  16698. genlmsg_cancel(msg, hdr);
  16699. nlmsg_free(msg);
  16700. }
  16701. EXPORT_SYMBOL(cfg80211_update_owe_info_event);
  16702. /* initialisation/exit functions */
  16703. int __init nl80211_init(void)
  16704. {
  16705. int err;
  16706. err = genl_register_family(&nl80211_fam);
  16707. if (err)
  16708. return err;
  16709. err = netlink_register_notifier(&nl80211_netlink_notifier);
  16710. if (err)
  16711. goto err_out;
  16712. return 0;
  16713. err_out:
  16714. genl_unregister_family(&nl80211_fam);
  16715. return err;
  16716. }
  16717. void nl80211_exit(void)
  16718. {
  16719. netlink_unregister_notifier(&nl80211_netlink_notifier);
  16720. genl_unregister_family(&nl80211_fam);
  16721. }