nl80211.c 555 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367636863696370637163726373637463756376637763786379638063816382638363846385638663876388638963906391639263936394639563966397639863996400640164026403640464056406640764086409641064116412641364146415641664176418641964206421642264236424642564266427642864296430643164326433643464356436643764386439644064416442644364446445644664476448644964506451645264536454645564566457645864596460646164626463646464656466646764686469647064716472647364746475647664776478647964806481648264836484648564866487648864896490649164926493649464956496649764986499650065016502650365046505650665076508650965106511651265136514651565166517651865196520652165226523652465256526652765286529653065316532653365346535653665376538653965406541654265436544654565466547654865496550655165526553655465556556655765586559656065616562656365646565656665676568656965706571657265736574657565766577657865796580658165826583658465856586658765886589659065916592659365946595659665976598659966006601660266036604660566066607660866096610661166126613661466156616661766186619662066216622662366246625662666276628662966306631663266336634663566366637663866396640664166426643664466456646664766486649665066516652665366546655665666576658665966606661666266636664666566666667666866696670667166726673667466756676667766786679668066816682668366846685668666876688668966906691669266936694669566966697669866996700670167026703670467056706670767086709671067116712671367146715671667176718671967206721672267236724672567266727672867296730673167326733673467356736673767386739674067416742674367446745674667476748674967506751675267536754675567566757675867596760676167626763676467656766676767686769677067716772677367746775677667776778677967806781678267836784678567866787678867896790679167926793679467956796679767986799680068016802680368046805680668076808680968106811681268136814681568166817681868196820682168226823682468256826682768286829683068316832683368346835683668376838683968406841684268436844684568466847684868496850685168526853685468556856685768586859686068616862686368646865686668676868686968706871687268736874687568766877687868796880688168826883688468856886688768886889689068916892689368946895689668976898689969006901690269036904690569066907690869096910691169126913691469156916691769186919692069216922692369246925692669276928692969306931693269336934693569366937693869396940694169426943694469456946694769486949695069516952695369546955695669576958695969606961696269636964696569666967696869696970697169726973697469756976697769786979698069816982698369846985698669876988698969906991699269936994699569966997699869997000700170027003700470057006700770087009701070117012701370147015701670177018701970207021702270237024702570267027702870297030703170327033703470357036703770387039704070417042704370447045704670477048704970507051705270537054705570567057705870597060706170627063706470657066706770687069707070717072707370747075707670777078707970807081708270837084708570867087708870897090709170927093709470957096709770987099710071017102710371047105710671077108710971107111711271137114711571167117711871197120712171227123712471257126712771287129713071317132713371347135713671377138713971407141714271437144714571467147714871497150715171527153715471557156715771587159716071617162716371647165716671677168716971707171717271737174717571767177717871797180718171827183718471857186718771887189719071917192719371947195719671977198719972007201720272037204720572067207720872097210721172127213721472157216721772187219722072217222722372247225722672277228722972307231723272337234723572367237723872397240724172427243724472457246724772487249725072517252725372547255725672577258725972607261726272637264726572667267726872697270727172727273727472757276727772787279728072817282728372847285728672877288728972907291729272937294729572967297729872997300730173027303730473057306730773087309731073117312731373147315731673177318731973207321732273237324732573267327732873297330733173327333733473357336733773387339734073417342734373447345734673477348734973507351735273537354735573567357735873597360736173627363736473657366736773687369737073717372737373747375737673777378737973807381738273837384738573867387738873897390739173927393739473957396739773987399740074017402740374047405740674077408740974107411741274137414741574167417741874197420742174227423742474257426742774287429743074317432743374347435743674377438743974407441744274437444744574467447744874497450745174527453745474557456745774587459746074617462746374647465746674677468746974707471747274737474747574767477747874797480748174827483748474857486748774887489749074917492749374947495749674977498749975007501750275037504750575067507750875097510751175127513751475157516751775187519752075217522752375247525752675277528752975307531753275337534753575367537753875397540754175427543754475457546754775487549755075517552755375547555755675577558755975607561756275637564756575667567756875697570757175727573757475757576757775787579758075817582758375847585758675877588758975907591759275937594759575967597759875997600760176027603760476057606760776087609761076117612761376147615761676177618761976207621762276237624762576267627762876297630763176327633763476357636763776387639764076417642764376447645764676477648764976507651765276537654765576567657765876597660766176627663766476657666766776687669767076717672767376747675767676777678767976807681768276837684768576867687768876897690769176927693769476957696769776987699770077017702770377047705770677077708770977107711771277137714771577167717771877197720772177227723772477257726772777287729773077317732773377347735773677377738773977407741774277437744774577467747774877497750775177527753775477557756775777587759776077617762776377647765776677677768776977707771777277737774777577767777777877797780778177827783778477857786778777887789779077917792779377947795779677977798779978007801780278037804780578067807780878097810781178127813781478157816781778187819782078217822782378247825782678277828782978307831783278337834783578367837783878397840784178427843784478457846784778487849785078517852785378547855785678577858785978607861786278637864786578667867786878697870787178727873787478757876787778787879788078817882788378847885788678877888788978907891789278937894789578967897789878997900790179027903790479057906790779087909791079117912791379147915791679177918791979207921792279237924792579267927792879297930793179327933793479357936793779387939794079417942794379447945794679477948794979507951795279537954795579567957795879597960796179627963796479657966796779687969797079717972797379747975797679777978797979807981798279837984798579867987798879897990799179927993799479957996799779987999800080018002800380048005800680078008800980108011801280138014801580168017801880198020802180228023802480258026802780288029803080318032803380348035803680378038803980408041804280438044804580468047804880498050805180528053805480558056805780588059806080618062806380648065806680678068806980708071807280738074807580768077807880798080808180828083808480858086808780888089809080918092809380948095809680978098809981008101810281038104810581068107810881098110811181128113811481158116811781188119812081218122812381248125812681278128812981308131813281338134813581368137813881398140814181428143814481458146814781488149815081518152815381548155815681578158815981608161816281638164816581668167816881698170817181728173817481758176817781788179818081818182818381848185818681878188818981908191819281938194819581968197819881998200820182028203820482058206820782088209821082118212821382148215821682178218821982208221822282238224822582268227822882298230823182328233823482358236823782388239824082418242824382448245824682478248824982508251825282538254825582568257825882598260826182628263826482658266826782688269827082718272827382748275827682778278827982808281828282838284828582868287828882898290829182928293829482958296829782988299830083018302830383048305830683078308830983108311831283138314831583168317831883198320832183228323832483258326832783288329833083318332833383348335833683378338833983408341834283438344834583468347834883498350835183528353835483558356835783588359836083618362836383648365836683678368836983708371837283738374837583768377837883798380838183828383838483858386838783888389839083918392839383948395839683978398839984008401840284038404840584068407840884098410841184128413841484158416841784188419842084218422842384248425842684278428842984308431843284338434843584368437843884398440844184428443844484458446844784488449845084518452845384548455845684578458845984608461846284638464846584668467846884698470847184728473847484758476847784788479848084818482848384848485848684878488848984908491849284938494849584968497849884998500850185028503850485058506850785088509851085118512851385148515851685178518851985208521852285238524852585268527852885298530853185328533853485358536853785388539854085418542854385448545854685478548854985508551855285538554855585568557855885598560856185628563856485658566856785688569857085718572857385748575857685778578857985808581858285838584858585868587858885898590859185928593859485958596859785988599860086018602860386048605860686078608860986108611861286138614861586168617861886198620862186228623862486258626862786288629863086318632863386348635863686378638863986408641864286438644864586468647864886498650865186528653865486558656865786588659866086618662866386648665866686678668866986708671867286738674867586768677867886798680868186828683868486858686868786888689869086918692869386948695869686978698869987008701870287038704870587068707870887098710871187128713871487158716871787188719872087218722872387248725872687278728872987308731873287338734873587368737873887398740874187428743874487458746874787488749875087518752875387548755875687578758875987608761876287638764876587668767876887698770877187728773877487758776877787788779878087818782878387848785878687878788878987908791879287938794879587968797879887998800880188028803880488058806880788088809881088118812881388148815881688178818881988208821882288238824882588268827882888298830883188328833883488358836883788388839884088418842884388448845884688478848884988508851885288538854885588568857885888598860886188628863886488658866886788688869887088718872887388748875887688778878887988808881888288838884888588868887888888898890889188928893889488958896889788988899890089018902890389048905890689078908890989108911891289138914891589168917891889198920892189228923892489258926892789288929893089318932893389348935893689378938893989408941894289438944894589468947894889498950895189528953895489558956895789588959896089618962896389648965896689678968896989708971897289738974897589768977897889798980898189828983898489858986898789888989899089918992899389948995899689978998899990009001900290039004900590069007900890099010901190129013901490159016901790189019902090219022902390249025902690279028902990309031903290339034903590369037903890399040904190429043904490459046904790489049905090519052905390549055905690579058905990609061906290639064906590669067906890699070907190729073907490759076907790789079908090819082908390849085908690879088908990909091909290939094909590969097909890999100910191029103910491059106910791089109911091119112911391149115911691179118911991209121912291239124912591269127912891299130913191329133913491359136913791389139914091419142914391449145914691479148914991509151915291539154915591569157915891599160916191629163916491659166916791689169917091719172917391749175917691779178917991809181918291839184918591869187918891899190919191929193919491959196919791989199920092019202920392049205920692079208920992109211921292139214921592169217921892199220922192229223922492259226922792289229923092319232923392349235923692379238923992409241924292439244924592469247924892499250925192529253925492559256925792589259926092619262926392649265926692679268926992709271927292739274927592769277927892799280928192829283928492859286928792889289929092919292929392949295929692979298929993009301930293039304930593069307930893099310931193129313931493159316931793189319932093219322932393249325932693279328932993309331933293339334933593369337933893399340934193429343934493459346934793489349935093519352935393549355935693579358935993609361936293639364936593669367936893699370937193729373937493759376937793789379938093819382938393849385938693879388938993909391939293939394939593969397939893999400940194029403940494059406940794089409941094119412941394149415941694179418941994209421942294239424942594269427942894299430943194329433943494359436943794389439944094419442944394449445944694479448944994509451945294539454945594569457945894599460946194629463946494659466946794689469947094719472947394749475947694779478947994809481948294839484948594869487948894899490949194929493949494959496949794989499950095019502950395049505950695079508950995109511951295139514951595169517951895199520952195229523952495259526952795289529953095319532953395349535953695379538953995409541954295439544954595469547954895499550955195529553955495559556955795589559956095619562956395649565956695679568956995709571957295739574957595769577957895799580958195829583958495859586958795889589959095919592959395949595959695979598959996009601960296039604960596069607960896099610961196129613961496159616961796189619962096219622962396249625962696279628962996309631963296339634963596369637963896399640964196429643964496459646964796489649965096519652965396549655965696579658965996609661966296639664966596669667966896699670967196729673967496759676967796789679968096819682968396849685968696879688968996909691969296939694969596969697969896999700970197029703970497059706970797089709971097119712971397149715971697179718971997209721972297239724972597269727972897299730973197329733973497359736973797389739974097419742974397449745974697479748974997509751975297539754975597569757975897599760976197629763976497659766976797689769977097719772977397749775977697779778977997809781978297839784978597869787978897899790979197929793979497959796979797989799980098019802980398049805980698079808980998109811981298139814981598169817981898199820982198229823982498259826982798289829983098319832983398349835983698379838983998409841984298439844984598469847984898499850985198529853985498559856985798589859986098619862986398649865986698679868986998709871987298739874987598769877987898799880988198829883988498859886988798889889989098919892989398949895989698979898989999009901990299039904990599069907990899099910991199129913991499159916991799189919992099219922992399249925992699279928992999309931993299339934993599369937993899399940994199429943994499459946994799489949995099519952995399549955995699579958995999609961996299639964996599669967996899699970997199729973997499759976997799789979998099819982998399849985998699879988998999909991999299939994999599969997999899991000010001100021000310004100051000610007100081000910010100111001210013100141001510016100171001810019100201002110022100231002410025100261002710028100291003010031100321003310034100351003610037100381003910040100411004210043100441004510046100471004810049100501005110052100531005410055100561005710058100591006010061100621006310064100651006610067100681006910070100711007210073100741007510076100771007810079100801008110082100831008410085100861008710088100891009010091100921009310094100951009610097100981009910100101011010210103101041010510106101071010810109101101011110112101131011410115101161011710118101191012010121101221012310124101251012610127101281012910130101311013210133101341013510136101371013810139101401014110142101431014410145101461014710148101491015010151101521015310154101551015610157101581015910160101611016210163101641016510166101671016810169101701017110172101731017410175101761017710178101791018010181101821018310184101851018610187101881018910190101911019210193101941019510196101971019810199102001020110202102031020410205102061020710208102091021010211102121021310214102151021610217102181021910220102211022210223102241022510226102271022810229102301023110232102331023410235102361023710238102391024010241102421024310244102451024610247102481024910250102511025210253102541025510256102571025810259102601026110262102631026410265102661026710268102691027010271102721027310274102751027610277102781027910280102811028210283102841028510286102871028810289102901029110292102931029410295102961029710298102991030010301103021030310304103051030610307103081030910310103111031210313103141031510316103171031810319103201032110322103231032410325103261032710328103291033010331103321033310334103351033610337103381033910340103411034210343103441034510346103471034810349103501035110352103531035410355103561035710358103591036010361103621036310364103651036610367103681036910370103711037210373103741037510376103771037810379103801038110382103831038410385103861038710388103891039010391103921039310394103951039610397103981039910400104011040210403104041040510406104071040810409104101041110412104131041410415104161041710418104191042010421104221042310424104251042610427104281042910430104311043210433104341043510436104371043810439104401044110442104431044410445104461044710448104491045010451104521045310454104551045610457104581045910460104611046210463104641046510466104671046810469104701047110472104731047410475104761047710478104791048010481104821048310484104851048610487104881048910490104911049210493104941049510496104971049810499105001050110502105031050410505105061050710508105091051010511105121051310514105151051610517105181051910520105211052210523105241052510526105271052810529105301053110532105331053410535105361053710538105391054010541105421054310544105451054610547105481054910550105511055210553105541055510556105571055810559105601056110562105631056410565105661056710568105691057010571105721057310574105751057610577105781057910580105811058210583105841058510586105871058810589105901059110592105931059410595105961059710598105991060010601106021060310604106051060610607106081060910610106111061210613106141061510616106171061810619106201062110622106231062410625106261062710628106291063010631106321063310634106351063610637106381063910640106411064210643106441064510646106471064810649106501065110652106531065410655106561065710658106591066010661106621066310664106651066610667106681066910670106711067210673106741067510676106771067810679106801068110682106831068410685106861068710688106891069010691106921069310694106951069610697106981069910700107011070210703107041070510706107071070810709107101071110712107131071410715107161071710718107191072010721107221072310724107251072610727107281072910730107311073210733107341073510736107371073810739107401074110742107431074410745107461074710748107491075010751107521075310754107551075610757107581075910760107611076210763107641076510766107671076810769107701077110772107731077410775107761077710778107791078010781107821078310784107851078610787107881078910790107911079210793107941079510796107971079810799108001080110802108031080410805108061080710808108091081010811108121081310814108151081610817108181081910820108211082210823108241082510826108271082810829108301083110832108331083410835108361083710838108391084010841108421084310844108451084610847108481084910850108511085210853108541085510856108571085810859108601086110862108631086410865108661086710868108691087010871108721087310874108751087610877108781087910880108811088210883108841088510886108871088810889108901089110892108931089410895108961089710898108991090010901109021090310904109051090610907109081090910910109111091210913109141091510916109171091810919109201092110922109231092410925109261092710928109291093010931109321093310934109351093610937109381093910940109411094210943109441094510946109471094810949109501095110952109531095410955109561095710958109591096010961109621096310964109651096610967109681096910970109711097210973109741097510976109771097810979109801098110982109831098410985109861098710988109891099010991109921099310994109951099610997109981099911000110011100211003110041100511006110071100811009110101101111012110131101411015110161101711018110191102011021110221102311024110251102611027110281102911030110311103211033110341103511036110371103811039110401104111042110431104411045110461104711048110491105011051110521105311054110551105611057110581105911060110611106211063110641106511066110671106811069110701107111072110731107411075110761107711078110791108011081110821108311084110851108611087110881108911090110911109211093110941109511096110971109811099111001110111102111031110411105111061110711108111091111011111111121111311114111151111611117111181111911120111211112211123111241112511126111271112811129111301113111132111331113411135111361113711138111391114011141111421114311144111451114611147111481114911150111511115211153111541115511156111571115811159111601116111162111631116411165111661116711168111691117011171111721117311174111751117611177111781117911180111811118211183111841118511186111871118811189111901119111192111931119411195111961119711198111991120011201112021120311204112051120611207112081120911210112111121211213112141121511216112171121811219112201122111222112231122411225112261122711228112291123011231112321123311234112351123611237112381123911240112411124211243112441124511246112471124811249112501125111252112531125411255112561125711258112591126011261112621126311264112651126611267112681126911270112711127211273112741127511276112771127811279112801128111282112831128411285112861128711288112891129011291112921129311294112951129611297112981129911300113011130211303113041130511306113071130811309113101131111312113131131411315113161131711318113191132011321113221132311324113251132611327113281132911330113311133211333113341133511336113371133811339113401134111342113431134411345113461134711348113491135011351113521135311354113551135611357113581135911360113611136211363113641136511366113671136811369113701137111372113731137411375113761137711378113791138011381113821138311384113851138611387113881138911390113911139211393113941139511396113971139811399114001140111402114031140411405114061140711408114091141011411114121141311414114151141611417114181141911420114211142211423114241142511426114271142811429114301143111432114331143411435114361143711438114391144011441114421144311444114451144611447114481144911450114511145211453114541145511456114571145811459114601146111462114631146411465114661146711468114691147011471114721147311474114751147611477114781147911480114811148211483114841148511486114871148811489114901149111492114931149411495114961149711498114991150011501115021150311504115051150611507115081150911510115111151211513115141151511516115171151811519115201152111522115231152411525115261152711528115291153011531115321153311534115351153611537115381153911540115411154211543115441154511546115471154811549115501155111552115531155411555115561155711558115591156011561115621156311564115651156611567115681156911570115711157211573115741157511576115771157811579115801158111582115831158411585115861158711588115891159011591115921159311594115951159611597115981159911600116011160211603116041160511606116071160811609116101161111612116131161411615116161161711618116191162011621116221162311624116251162611627116281162911630116311163211633116341163511636116371163811639116401164111642116431164411645116461164711648116491165011651116521165311654116551165611657116581165911660116611166211663116641166511666116671166811669116701167111672116731167411675116761167711678116791168011681116821168311684116851168611687116881168911690116911169211693116941169511696116971169811699117001170111702117031170411705117061170711708117091171011711117121171311714117151171611717117181171911720117211172211723117241172511726117271172811729117301173111732117331173411735117361173711738117391174011741117421174311744117451174611747117481174911750117511175211753117541175511756117571175811759117601176111762117631176411765117661176711768117691177011771117721177311774117751177611777117781177911780117811178211783117841178511786117871178811789117901179111792117931179411795117961179711798117991180011801118021180311804118051180611807118081180911810118111181211813118141181511816118171181811819118201182111822118231182411825118261182711828118291183011831118321183311834118351183611837118381183911840118411184211843118441184511846118471184811849118501185111852118531185411855118561185711858118591186011861118621186311864118651186611867118681186911870118711187211873118741187511876118771187811879118801188111882118831188411885118861188711888118891189011891118921189311894118951189611897118981189911900119011190211903119041190511906119071190811909119101191111912119131191411915119161191711918119191192011921119221192311924119251192611927119281192911930119311193211933119341193511936119371193811939119401194111942119431194411945119461194711948119491195011951119521195311954119551195611957119581195911960119611196211963119641196511966119671196811969119701197111972119731197411975119761197711978119791198011981119821198311984119851198611987119881198911990119911199211993119941199511996119971199811999120001200112002120031200412005120061200712008120091201012011120121201312014120151201612017120181201912020120211202212023120241202512026120271202812029120301203112032120331203412035120361203712038120391204012041120421204312044120451204612047120481204912050120511205212053120541205512056120571205812059120601206112062120631206412065120661206712068120691207012071120721207312074120751207612077120781207912080120811208212083120841208512086120871208812089120901209112092120931209412095120961209712098120991210012101121021210312104121051210612107121081210912110121111211212113121141211512116121171211812119121201212112122121231212412125121261212712128121291213012131121321213312134121351213612137121381213912140121411214212143121441214512146121471214812149121501215112152121531215412155121561215712158121591216012161121621216312164121651216612167121681216912170121711217212173121741217512176121771217812179121801218112182121831218412185121861218712188121891219012191121921219312194121951219612197121981219912200122011220212203122041220512206122071220812209122101221112212122131221412215122161221712218122191222012221122221222312224122251222612227122281222912230122311223212233122341223512236122371223812239122401224112242122431224412245122461224712248122491225012251122521225312254122551225612257122581225912260122611226212263122641226512266122671226812269122701227112272122731227412275122761227712278122791228012281122821228312284122851228612287122881228912290122911229212293122941229512296122971229812299123001230112302123031230412305123061230712308123091231012311123121231312314123151231612317123181231912320123211232212323123241232512326123271232812329123301233112332123331233412335123361233712338123391234012341123421234312344123451234612347123481234912350123511235212353123541235512356123571235812359123601236112362123631236412365123661236712368123691237012371123721237312374123751237612377123781237912380123811238212383123841238512386123871238812389123901239112392123931239412395123961239712398123991240012401124021240312404124051240612407124081240912410124111241212413124141241512416124171241812419124201242112422124231242412425124261242712428124291243012431124321243312434124351243612437124381243912440124411244212443124441244512446124471244812449124501245112452124531245412455124561245712458124591246012461124621246312464124651246612467124681246912470124711247212473124741247512476124771247812479124801248112482124831248412485124861248712488124891249012491124921249312494124951249612497124981249912500125011250212503125041250512506125071250812509125101251112512125131251412515125161251712518125191252012521125221252312524125251252612527125281252912530125311253212533125341253512536125371253812539125401254112542125431254412545125461254712548125491255012551125521255312554125551255612557125581255912560125611256212563125641256512566125671256812569125701257112572125731257412575125761257712578125791258012581125821258312584125851258612587125881258912590125911259212593125941259512596125971259812599126001260112602126031260412605126061260712608126091261012611126121261312614126151261612617126181261912620126211262212623126241262512626126271262812629126301263112632126331263412635126361263712638126391264012641126421264312644126451264612647126481264912650126511265212653126541265512656126571265812659126601266112662126631266412665126661266712668126691267012671126721267312674126751267612677126781267912680126811268212683126841268512686126871268812689126901269112692126931269412695126961269712698126991270012701127021270312704127051270612707127081270912710127111271212713127141271512716127171271812719127201272112722127231272412725127261272712728127291273012731127321273312734127351273612737127381273912740127411274212743127441274512746127471274812749127501275112752127531275412755127561275712758127591276012761127621276312764127651276612767127681276912770127711277212773127741277512776127771277812779127801278112782127831278412785127861278712788127891279012791127921279312794127951279612797127981279912800128011280212803128041280512806128071280812809128101281112812128131281412815128161281712818128191282012821128221282312824128251282612827128281282912830128311283212833128341283512836128371283812839128401284112842128431284412845128461284712848128491285012851128521285312854128551285612857128581285912860128611286212863128641286512866128671286812869128701287112872128731287412875128761287712878128791288012881128821288312884128851288612887128881288912890128911289212893128941289512896128971289812899129001290112902129031290412905129061290712908129091291012911129121291312914129151291612917129181291912920129211292212923129241292512926129271292812929129301293112932129331293412935129361293712938129391294012941129421294312944129451294612947129481294912950129511295212953129541295512956129571295812959129601296112962129631296412965129661296712968129691297012971129721297312974129751297612977129781297912980129811298212983129841298512986129871298812989129901299112992129931299412995129961299712998129991300013001130021300313004130051300613007130081300913010130111301213013130141301513016130171301813019130201302113022130231302413025130261302713028130291303013031130321303313034130351303613037130381303913040130411304213043130441304513046130471304813049130501305113052130531305413055130561305713058130591306013061130621306313064130651306613067130681306913070130711307213073130741307513076130771307813079130801308113082130831308413085130861308713088130891309013091130921309313094130951309613097130981309913100131011310213103131041310513106131071310813109131101311113112131131311413115131161311713118131191312013121131221312313124131251312613127131281312913130131311313213133131341313513136131371313813139131401314113142131431314413145131461314713148131491315013151131521315313154131551315613157131581315913160131611316213163131641316513166131671316813169131701317113172131731317413175131761317713178131791318013181131821318313184131851318613187131881318913190131911319213193131941319513196131971319813199132001320113202132031320413205132061320713208132091321013211132121321313214132151321613217132181321913220132211322213223132241322513226132271322813229132301323113232132331323413235132361323713238132391324013241132421324313244132451324613247132481324913250132511325213253132541325513256132571325813259132601326113262132631326413265132661326713268132691327013271132721327313274132751327613277132781327913280132811328213283132841328513286132871328813289132901329113292132931329413295132961329713298132991330013301133021330313304133051330613307133081330913310133111331213313133141331513316133171331813319133201332113322133231332413325133261332713328133291333013331133321333313334133351333613337133381333913340133411334213343133441334513346133471334813349133501335113352133531335413355133561335713358133591336013361133621336313364133651336613367133681336913370133711337213373133741337513376133771337813379133801338113382133831338413385133861338713388133891339013391133921339313394133951339613397133981339913400134011340213403134041340513406134071340813409134101341113412134131341413415134161341713418134191342013421134221342313424134251342613427134281342913430134311343213433134341343513436134371343813439134401344113442134431344413445134461344713448134491345013451134521345313454134551345613457134581345913460134611346213463134641346513466134671346813469134701347113472134731347413475134761347713478134791348013481134821348313484134851348613487134881348913490134911349213493134941349513496134971349813499135001350113502135031350413505135061350713508135091351013511135121351313514135151351613517135181351913520135211352213523135241352513526135271352813529135301353113532135331353413535135361353713538135391354013541135421354313544135451354613547135481354913550135511355213553135541355513556135571355813559135601356113562135631356413565135661356713568135691357013571135721357313574135751357613577135781357913580135811358213583135841358513586135871358813589135901359113592135931359413595135961359713598135991360013601136021360313604136051360613607136081360913610136111361213613136141361513616136171361813619136201362113622136231362413625136261362713628136291363013631136321363313634136351363613637136381363913640136411364213643136441364513646136471364813649136501365113652136531365413655136561365713658136591366013661136621366313664136651366613667136681366913670136711367213673136741367513676136771367813679136801368113682136831368413685136861368713688136891369013691136921369313694136951369613697136981369913700137011370213703137041370513706137071370813709137101371113712137131371413715137161371713718137191372013721137221372313724137251372613727137281372913730137311373213733137341373513736137371373813739137401374113742137431374413745137461374713748137491375013751137521375313754137551375613757137581375913760137611376213763137641376513766137671376813769137701377113772137731377413775137761377713778137791378013781137821378313784137851378613787137881378913790137911379213793137941379513796137971379813799138001380113802138031380413805138061380713808138091381013811138121381313814138151381613817138181381913820138211382213823138241382513826138271382813829138301383113832138331383413835138361383713838138391384013841138421384313844138451384613847138481384913850138511385213853138541385513856138571385813859138601386113862138631386413865138661386713868138691387013871138721387313874138751387613877138781387913880138811388213883138841388513886138871388813889138901389113892138931389413895138961389713898138991390013901139021390313904139051390613907139081390913910139111391213913139141391513916139171391813919139201392113922139231392413925139261392713928139291393013931139321393313934139351393613937139381393913940139411394213943139441394513946139471394813949139501395113952139531395413955139561395713958139591396013961139621396313964139651396613967139681396913970139711397213973139741397513976139771397813979139801398113982139831398413985139861398713988139891399013991139921399313994139951399613997139981399914000140011400214003140041400514006140071400814009140101401114012140131401414015140161401714018140191402014021140221402314024140251402614027140281402914030140311403214033140341403514036140371403814039140401404114042140431404414045140461404714048140491405014051140521405314054140551405614057140581405914060140611406214063140641406514066140671406814069140701407114072140731407414075140761407714078140791408014081140821408314084140851408614087140881408914090140911409214093140941409514096140971409814099141001410114102141031410414105141061410714108141091411014111141121411314114141151411614117141181411914120141211412214123141241412514126141271412814129141301413114132141331413414135141361413714138141391414014141141421414314144141451414614147141481414914150141511415214153141541415514156141571415814159141601416114162141631416414165141661416714168141691417014171141721417314174141751417614177141781417914180141811418214183141841418514186141871418814189141901419114192141931419414195141961419714198141991420014201142021420314204142051420614207142081420914210142111421214213142141421514216142171421814219142201422114222142231422414225142261422714228142291423014231142321423314234142351423614237142381423914240142411424214243142441424514246142471424814249142501425114252142531425414255142561425714258142591426014261142621426314264142651426614267142681426914270142711427214273142741427514276142771427814279142801428114282142831428414285142861428714288142891429014291142921429314294142951429614297142981429914300143011430214303143041430514306143071430814309143101431114312143131431414315143161431714318143191432014321143221432314324143251432614327143281432914330143311433214333143341433514336143371433814339143401434114342143431434414345143461434714348143491435014351143521435314354143551435614357143581435914360143611436214363143641436514366143671436814369143701437114372143731437414375143761437714378143791438014381143821438314384143851438614387143881438914390143911439214393143941439514396143971439814399144001440114402144031440414405144061440714408144091441014411144121441314414144151441614417144181441914420144211442214423144241442514426144271442814429144301443114432144331443414435144361443714438144391444014441144421444314444144451444614447144481444914450144511445214453144541445514456144571445814459144601446114462144631446414465144661446714468144691447014471144721447314474144751447614477144781447914480144811448214483144841448514486144871448814489144901449114492144931449414495144961449714498144991450014501145021450314504145051450614507145081450914510145111451214513145141451514516145171451814519145201452114522145231452414525145261452714528145291453014531145321453314534145351453614537145381453914540145411454214543145441454514546145471454814549145501455114552145531455414555145561455714558145591456014561145621456314564145651456614567145681456914570145711457214573145741457514576145771457814579145801458114582145831458414585145861458714588145891459014591145921459314594145951459614597145981459914600146011460214603146041460514606146071460814609146101461114612146131461414615146161461714618146191462014621146221462314624146251462614627146281462914630146311463214633146341463514636146371463814639146401464114642146431464414645146461464714648146491465014651146521465314654146551465614657146581465914660146611466214663146641466514666146671466814669146701467114672146731467414675146761467714678146791468014681146821468314684146851468614687146881468914690146911469214693146941469514696146971469814699147001470114702147031470414705147061470714708147091471014711147121471314714147151471614717147181471914720147211472214723147241472514726147271472814729147301473114732147331473414735147361473714738147391474014741147421474314744147451474614747147481474914750147511475214753147541475514756147571475814759147601476114762147631476414765147661476714768147691477014771147721477314774147751477614777147781477914780147811478214783147841478514786147871478814789147901479114792147931479414795147961479714798147991480014801148021480314804148051480614807148081480914810148111481214813148141481514816148171481814819148201482114822148231482414825148261482714828148291483014831148321483314834148351483614837148381483914840148411484214843148441484514846148471484814849148501485114852148531485414855148561485714858148591486014861148621486314864148651486614867148681486914870148711487214873148741487514876148771487814879148801488114882148831488414885148861488714888148891489014891148921489314894148951489614897148981489914900149011490214903149041490514906149071490814909149101491114912149131491414915149161491714918149191492014921149221492314924149251492614927149281492914930149311493214933149341493514936149371493814939149401494114942149431494414945149461494714948149491495014951149521495314954149551495614957149581495914960149611496214963149641496514966149671496814969149701497114972149731497414975149761497714978149791498014981149821498314984149851498614987149881498914990149911499214993149941499514996149971499814999150001500115002150031500415005150061500715008150091501015011150121501315014150151501615017150181501915020150211502215023150241502515026150271502815029150301503115032150331503415035150361503715038150391504015041150421504315044150451504615047150481504915050150511505215053150541505515056150571505815059150601506115062150631506415065150661506715068150691507015071150721507315074150751507615077150781507915080150811508215083150841508515086150871508815089150901509115092150931509415095150961509715098150991510015101151021510315104151051510615107151081510915110151111511215113151141511515116151171511815119151201512115122151231512415125151261512715128151291513015131151321513315134151351513615137151381513915140151411514215143151441514515146151471514815149151501515115152151531515415155151561515715158151591516015161151621516315164151651516615167151681516915170151711517215173151741517515176151771517815179151801518115182151831518415185151861518715188151891519015191151921519315194151951519615197151981519915200152011520215203152041520515206152071520815209152101521115212152131521415215152161521715218152191522015221152221522315224152251522615227152281522915230152311523215233152341523515236152371523815239152401524115242152431524415245152461524715248152491525015251152521525315254152551525615257152581525915260152611526215263152641526515266152671526815269152701527115272152731527415275152761527715278152791528015281152821528315284152851528615287152881528915290152911529215293152941529515296152971529815299153001530115302153031530415305153061530715308153091531015311153121531315314153151531615317153181531915320153211532215323153241532515326153271532815329153301533115332153331533415335153361533715338153391534015341153421534315344153451534615347153481534915350153511535215353153541535515356153571535815359153601536115362153631536415365153661536715368153691537015371153721537315374153751537615377153781537915380153811538215383153841538515386153871538815389153901539115392153931539415395153961539715398153991540015401154021540315404154051540615407154081540915410154111541215413154141541515416154171541815419154201542115422154231542415425154261542715428154291543015431154321543315434154351543615437154381543915440154411544215443154441544515446154471544815449154501545115452154531545415455154561545715458154591546015461154621546315464154651546615467154681546915470154711547215473154741547515476154771547815479154801548115482154831548415485154861548715488154891549015491154921549315494154951549615497154981549915500155011550215503155041550515506155071550815509155101551115512155131551415515155161551715518155191552015521155221552315524155251552615527155281552915530155311553215533155341553515536155371553815539155401554115542155431554415545155461554715548155491555015551155521555315554155551555615557155581555915560155611556215563155641556515566155671556815569155701557115572155731557415575155761557715578155791558015581155821558315584155851558615587155881558915590155911559215593155941559515596155971559815599156001560115602156031560415605156061560715608156091561015611156121561315614156151561615617156181561915620156211562215623156241562515626156271562815629156301563115632156331563415635156361563715638156391564015641156421564315644156451564615647156481564915650156511565215653156541565515656156571565815659156601566115662156631566415665156661566715668156691567015671156721567315674156751567615677156781567915680156811568215683156841568515686156871568815689156901569115692156931569415695156961569715698156991570015701157021570315704157051570615707157081570915710157111571215713157141571515716157171571815719157201572115722157231572415725157261572715728157291573015731157321573315734157351573615737157381573915740157411574215743157441574515746157471574815749157501575115752157531575415755157561575715758157591576015761157621576315764157651576615767157681576915770157711577215773157741577515776157771577815779157801578115782157831578415785157861578715788157891579015791157921579315794157951579615797157981579915800158011580215803158041580515806158071580815809158101581115812158131581415815158161581715818158191582015821158221582315824158251582615827158281582915830158311583215833158341583515836158371583815839158401584115842158431584415845158461584715848158491585015851158521585315854158551585615857158581585915860158611586215863158641586515866158671586815869158701587115872158731587415875158761587715878158791588015881158821588315884158851588615887158881588915890158911589215893158941589515896158971589815899159001590115902159031590415905159061590715908159091591015911159121591315914159151591615917159181591915920159211592215923159241592515926159271592815929159301593115932159331593415935159361593715938159391594015941159421594315944159451594615947159481594915950159511595215953159541595515956159571595815959159601596115962159631596415965159661596715968159691597015971159721597315974159751597615977159781597915980159811598215983159841598515986159871598815989159901599115992159931599415995159961599715998159991600016001160021600316004160051600616007160081600916010160111601216013160141601516016160171601816019160201602116022160231602416025160261602716028160291603016031160321603316034160351603616037160381603916040160411604216043160441604516046160471604816049160501605116052160531605416055160561605716058160591606016061160621606316064160651606616067160681606916070160711607216073160741607516076160771607816079160801608116082160831608416085160861608716088160891609016091160921609316094160951609616097160981609916100161011610216103161041610516106161071610816109161101611116112161131611416115161161611716118161191612016121161221612316124161251612616127161281612916130161311613216133161341613516136161371613816139161401614116142161431614416145161461614716148161491615016151161521615316154161551615616157161581615916160161611616216163161641616516166161671616816169161701617116172161731617416175161761617716178161791618016181161821618316184161851618616187161881618916190161911619216193161941619516196161971619816199162001620116202162031620416205162061620716208162091621016211162121621316214162151621616217162181621916220162211622216223162241622516226162271622816229162301623116232162331623416235162361623716238162391624016241162421624316244162451624616247162481624916250162511625216253162541625516256162571625816259162601626116262162631626416265162661626716268162691627016271162721627316274162751627616277162781627916280162811628216283162841628516286162871628816289162901629116292162931629416295162961629716298162991630016301163021630316304163051630616307163081630916310163111631216313163141631516316163171631816319163201632116322163231632416325163261632716328163291633016331163321633316334163351633616337163381633916340163411634216343163441634516346163471634816349163501635116352163531635416355163561635716358163591636016361163621636316364163651636616367163681636916370163711637216373163741637516376163771637816379163801638116382163831638416385163861638716388163891639016391163921639316394163951639616397163981639916400164011640216403164041640516406164071640816409164101641116412164131641416415164161641716418164191642016421164221642316424164251642616427164281642916430164311643216433164341643516436164371643816439164401644116442164431644416445164461644716448164491645016451164521645316454164551645616457164581645916460164611646216463164641646516466164671646816469164701647116472164731647416475164761647716478164791648016481164821648316484164851648616487164881648916490164911649216493164941649516496164971649816499165001650116502165031650416505165061650716508165091651016511165121651316514165151651616517165181651916520165211652216523165241652516526165271652816529165301653116532165331653416535165361653716538165391654016541165421654316544165451654616547165481654916550165511655216553165541655516556165571655816559165601656116562165631656416565165661656716568165691657016571165721657316574165751657616577165781657916580165811658216583165841658516586165871658816589165901659116592165931659416595165961659716598165991660016601166021660316604166051660616607166081660916610166111661216613166141661516616166171661816619166201662116622166231662416625166261662716628166291663016631166321663316634166351663616637166381663916640166411664216643166441664516646166471664816649166501665116652166531665416655166561665716658166591666016661166621666316664166651666616667166681666916670166711667216673166741667516676166771667816679166801668116682166831668416685166861668716688166891669016691166921669316694166951669616697166981669916700167011670216703167041670516706167071670816709167101671116712167131671416715167161671716718167191672016721167221672316724167251672616727167281672916730167311673216733167341673516736167371673816739167401674116742167431674416745167461674716748167491675016751167521675316754167551675616757167581675916760167611676216763167641676516766167671676816769167701677116772167731677416775167761677716778167791678016781167821678316784167851678616787167881678916790167911679216793167941679516796167971679816799168001680116802168031680416805168061680716808168091681016811168121681316814168151681616817168181681916820168211682216823168241682516826168271682816829168301683116832168331683416835168361683716838168391684016841168421684316844168451684616847168481684916850168511685216853168541685516856168571685816859168601686116862168631686416865168661686716868168691687016871168721687316874168751687616877168781687916880168811688216883168841688516886168871688816889168901689116892168931689416895168961689716898168991690016901169021690316904169051690616907169081690916910169111691216913169141691516916169171691816919169201692116922169231692416925169261692716928169291693016931169321693316934169351693616937169381693916940169411694216943169441694516946169471694816949169501695116952169531695416955169561695716958169591696016961169621696316964169651696616967169681696916970169711697216973169741697516976169771697816979169801698116982169831698416985169861698716988169891699016991169921699316994169951699616997169981699917000170011700217003170041700517006170071700817009170101701117012170131701417015170161701717018170191702017021170221702317024170251702617027170281702917030170311703217033170341703517036170371703817039170401704117042170431704417045170461704717048170491705017051170521705317054170551705617057170581705917060170611706217063170641706517066170671706817069170701707117072170731707417075170761707717078170791708017081170821708317084170851708617087170881708917090170911709217093170941709517096170971709817099171001710117102171031710417105171061710717108171091711017111171121711317114171151711617117171181711917120171211712217123171241712517126171271712817129171301713117132171331713417135171361713717138171391714017141171421714317144171451714617147171481714917150171511715217153171541715517156171571715817159171601716117162171631716417165171661716717168171691717017171171721717317174171751717617177171781717917180171811718217183171841718517186171871718817189171901719117192171931719417195171961719717198171991720017201172021720317204172051720617207172081720917210172111721217213172141721517216172171721817219172201722117222172231722417225172261722717228172291723017231172321723317234172351723617237172381723917240172411724217243172441724517246172471724817249172501725117252172531725417255172561725717258172591726017261172621726317264172651726617267172681726917270172711727217273172741727517276172771727817279172801728117282172831728417285172861728717288172891729017291172921729317294172951729617297172981729917300173011730217303173041730517306173071730817309173101731117312173131731417315173161731717318173191732017321173221732317324173251732617327173281732917330173311733217333173341733517336173371733817339173401734117342173431734417345173461734717348173491735017351173521735317354173551735617357173581735917360173611736217363173641736517366173671736817369173701737117372173731737417375173761737717378173791738017381173821738317384173851738617387173881738917390173911739217393173941739517396173971739817399174001740117402174031740417405174061740717408174091741017411174121741317414174151741617417174181741917420174211742217423174241742517426174271742817429174301743117432174331743417435174361743717438174391744017441174421744317444174451744617447174481744917450174511745217453174541745517456174571745817459174601746117462174631746417465174661746717468174691747017471174721747317474174751747617477174781747917480174811748217483174841748517486174871748817489174901749117492174931749417495174961749717498174991750017501175021750317504175051750617507175081750917510175111751217513175141751517516175171751817519175201752117522175231752417525175261752717528175291753017531175321753317534175351753617537175381753917540175411754217543175441754517546175471754817549175501755117552175531755417555175561755717558175591756017561175621756317564175651756617567175681756917570175711757217573175741757517576175771757817579175801758117582175831758417585175861758717588175891759017591175921759317594175951759617597175981759917600176011760217603176041760517606176071760817609176101761117612176131761417615176161761717618176191762017621176221762317624176251762617627176281762917630176311763217633176341763517636176371763817639176401764117642176431764417645176461764717648176491765017651176521765317654176551765617657176581765917660176611766217663176641766517666176671766817669176701767117672176731767417675176761767717678176791768017681176821768317684176851768617687176881768917690176911769217693176941769517696176971769817699177001770117702177031770417705177061770717708177091771017711177121771317714177151771617717177181771917720177211772217723177241772517726177271772817729177301773117732177331773417735177361773717738177391774017741177421774317744177451774617747177481774917750177511775217753177541775517756177571775817759177601776117762177631776417765177661776717768177691777017771177721777317774177751777617777177781777917780177811778217783177841778517786177871778817789177901779117792177931779417795177961779717798177991780017801178021780317804178051780617807178081780917810178111781217813178141781517816178171781817819178201782117822178231782417825178261782717828178291783017831178321783317834178351783617837178381783917840178411784217843178441784517846178471784817849178501785117852178531785417855178561785717858178591786017861178621786317864178651786617867178681786917870178711787217873178741787517876178771787817879178801788117882178831788417885178861788717888178891789017891178921789317894178951789617897178981789917900179011790217903179041790517906179071790817909179101791117912179131791417915179161791717918179191792017921179221792317924179251792617927179281792917930179311793217933179341793517936179371793817939179401794117942179431794417945179461794717948179491795017951179521795317954179551795617957179581795917960179611796217963179641796517966179671796817969179701797117972179731797417975179761797717978179791798017981179821798317984179851798617987179881798917990179911799217993179941799517996179971799817999180001800118002180031800418005180061800718008180091801018011180121801318014180151801618017180181801918020180211802218023180241802518026180271802818029180301803118032180331803418035180361803718038180391804018041180421804318044180451804618047180481804918050180511805218053180541805518056180571805818059180601806118062180631806418065180661806718068180691807018071180721807318074180751807618077180781807918080180811808218083180841808518086180871808818089180901809118092180931809418095180961809718098180991810018101181021810318104181051810618107181081810918110181111811218113181141811518116181171811818119181201812118122181231812418125181261812718128181291813018131181321813318134181351813618137181381813918140181411814218143181441814518146181471814818149181501815118152181531815418155181561815718158181591816018161181621816318164181651816618167181681816918170181711817218173181741817518176181771817818179181801818118182181831818418185181861818718188181891819018191181921819318194181951819618197181981819918200182011820218203182041820518206182071820818209182101821118212182131821418215182161821718218182191822018221182221822318224182251822618227182281822918230182311823218233182341823518236182371823818239182401824118242182431824418245182461824718248182491825018251182521825318254182551825618257182581825918260182611826218263182641826518266182671826818269182701827118272182731827418275182761827718278182791828018281182821828318284182851828618287182881828918290182911829218293182941829518296182971829818299183001830118302183031830418305183061830718308183091831018311183121831318314183151831618317183181831918320183211832218323183241832518326183271832818329183301833118332183331833418335183361833718338183391834018341183421834318344183451834618347183481834918350183511835218353183541835518356183571835818359183601836118362183631836418365183661836718368183691837018371183721837318374183751837618377183781837918380183811838218383183841838518386183871838818389183901839118392183931839418395183961839718398183991840018401184021840318404184051840618407184081840918410184111841218413184141841518416184171841818419184201842118422184231842418425184261842718428184291843018431184321843318434184351843618437184381843918440184411844218443184441844518446184471844818449184501845118452184531845418455184561845718458184591846018461184621846318464184651846618467184681846918470184711847218473184741847518476184771847818479184801848118482184831848418485184861848718488184891849018491184921849318494184951849618497184981849918500185011850218503185041850518506185071850818509185101851118512185131851418515185161851718518185191852018521185221852318524185251852618527185281852918530185311853218533185341853518536185371853818539185401854118542185431854418545185461854718548185491855018551185521855318554185551855618557185581855918560185611856218563185641856518566185671856818569185701857118572185731857418575185761857718578185791858018581185821858318584185851858618587185881858918590185911859218593185941859518596185971859818599186001860118602186031860418605186061860718608186091861018611186121861318614186151861618617186181861918620186211862218623186241862518626186271862818629186301863118632186331863418635186361863718638186391864018641186421864318644186451864618647186481864918650186511865218653186541865518656186571865818659186601866118662186631866418665186661866718668186691867018671186721867318674186751867618677186781867918680186811868218683186841868518686186871868818689186901869118692186931869418695186961869718698186991870018701187021870318704187051870618707187081870918710187111871218713187141871518716187171871818719187201872118722187231872418725187261872718728187291873018731187321873318734187351873618737187381873918740187411874218743187441874518746187471874818749187501875118752187531875418755187561875718758187591876018761187621876318764187651876618767187681876918770187711877218773187741877518776187771877818779187801878118782187831878418785187861878718788187891879018791187921879318794187951879618797187981879918800188011880218803188041880518806188071880818809188101881118812188131881418815188161881718818188191882018821188221882318824188251882618827188281882918830188311883218833188341883518836188371883818839188401884118842188431884418845188461884718848188491885018851188521885318854188551885618857188581885918860188611886218863188641886518866188671886818869188701887118872188731887418875188761887718878188791888018881188821888318884188851888618887188881888918890188911889218893188941889518896188971889818899189001890118902189031890418905189061890718908189091891018911189121891318914189151891618917189181891918920189211892218923189241892518926189271892818929189301893118932189331893418935189361893718938189391894018941189421894318944189451894618947189481894918950189511895218953189541895518956189571895818959189601896118962189631896418965189661896718968189691897018971189721897318974189751897618977189781897918980189811898218983189841898518986189871898818989189901899118992189931899418995189961899718998189991900019001190021900319004190051900619007190081900919010190111901219013190141901519016190171901819019190201902119022190231902419025190261902719028190291903019031190321903319034190351903619037190381903919040190411904219043190441904519046190471904819049190501905119052190531905419055190561905719058190591906019061190621906319064190651906619067190681906919070190711907219073190741907519076190771907819079190801908119082190831908419085190861908719088190891909019091190921909319094190951909619097190981909919100191011910219103191041910519106191071910819109191101911119112191131911419115191161911719118191191912019121191221912319124191251912619127191281912919130191311913219133191341913519136191371913819139191401914119142191431914419145191461914719148191491915019151191521915319154191551915619157191581915919160191611916219163191641916519166191671916819169191701917119172191731917419175191761917719178191791918019181191821918319184191851918619187191881918919190191911919219193191941919519196191971919819199192001920119202192031920419205192061920719208192091921019211192121921319214192151921619217192181921919220192211922219223192241922519226192271922819229192301923119232192331923419235192361923719238192391924019241192421924319244192451924619247192481924919250192511925219253192541925519256192571925819259192601926119262192631926419265192661926719268192691927019271192721927319274192751927619277192781927919280192811928219283192841928519286192871928819289192901929119292192931929419295192961929719298192991930019301193021930319304193051930619307193081930919310193111931219313193141931519316193171931819319193201932119322193231932419325193261932719328193291933019331193321933319334193351933619337193381933919340193411934219343193441934519346193471934819349193501935119352193531935419355193561935719358193591936019361193621936319364193651936619367193681936919370193711937219373193741937519376193771937819379193801938119382193831938419385193861938719388193891939019391193921939319394193951939619397193981939919400194011940219403194041940519406194071940819409194101941119412194131941419415194161941719418194191942019421194221942319424194251942619427194281942919430194311943219433194341943519436194371943819439194401944119442194431944419445194461944719448194491945019451194521945319454194551945619457194581945919460194611946219463194641946519466194671946819469194701947119472194731947419475194761947719478194791948019481194821948319484194851948619487194881948919490194911949219493194941949519496194971949819499195001950119502195031950419505195061950719508195091951019511195121951319514195151951619517195181951919520195211952219523195241952519526195271952819529195301953119532195331953419535195361953719538195391954019541195421954319544195451954619547195481954919550195511955219553195541955519556195571955819559195601956119562195631956419565195661956719568195691957019571195721957319574195751957619577195781957919580195811958219583195841958519586195871958819589195901959119592195931959419595195961959719598195991960019601196021960319604196051960619607196081960919610196111961219613196141961519616196171961819619196201962119622196231962419625196261962719628196291963019631196321963319634196351963619637196381963919640196411964219643196441964519646196471964819649196501965119652196531965419655196561965719658196591966019661196621966319664196651966619667196681966919670196711967219673196741967519676196771967819679196801968119682196831968419685196861968719688196891969019691196921969319694196951969619697196981969919700197011970219703197041970519706197071970819709197101971119712197131971419715197161971719718197191972019721197221972319724197251972619727197281972919730197311973219733197341973519736197371973819739197401974119742197431974419745197461974719748197491975019751197521975319754197551975619757197581975919760197611976219763197641976519766197671976819769197701977119772197731977419775197761977719778197791978019781197821978319784197851978619787197881978919790197911979219793197941979519796197971979819799198001980119802198031980419805198061980719808198091981019811198121981319814198151981619817198181981919820198211982219823198241982519826198271982819829198301983119832198331983419835198361983719838198391984019841198421984319844198451984619847198481984919850198511985219853198541985519856198571985819859198601986119862198631986419865198661986719868198691987019871198721987319874198751987619877198781987919880198811988219883198841988519886198871988819889198901989119892198931989419895198961989719898198991990019901199021990319904199051990619907199081990919910199111991219913199141991519916199171991819919199201992119922199231992419925199261992719928199291993019931199321993319934199351993619937199381993919940199411994219943199441994519946199471994819949199501995119952199531995419955199561995719958199591996019961199621996319964199651996619967199681996919970199711997219973199741997519976199771997819979199801998119982199831998419985199861998719988199891999019991199921999319994199951999619997199981999920000200012000220003200042000520006200072000820009200102001120012200132001420015200162001720018200192002020021200222002320024200252002620027200282002920030200312003220033200342003520036200372003820039200402004120042200432004420045200462004720048200492005020051200522005320054200552005620057200582005920060200612006220063200642006520066200672006820069200702007120072200732007420075200762007720078200792008020081200822008320084200852008620087200882008920090200912009220093200942009520096200972009820099201002010120102201032010420105201062010720108201092011020111201122011320114201152011620117201182011920120201212012220123201242012520126201272012820129201302013120132201332013420135201362013720138201392014020141201422014320144201452014620147201482014920150201512015220153201542015520156201572015820159201602016120162201632016420165201662016720168201692017020171201722017320174201752017620177201782017920180201812018220183201842018520186201872018820189201902019120192201932019420195201962019720198201992020020201202022020320204202052020620207202082020920210202112021220213202142021520216202172021820219202202022120222202232022420225202262022720228202292023020231202322023320234202352023620237202382023920240202412024220243202442024520246202472024820249202502025120252202532025420255202562025720258202592026020261202622026320264202652026620267202682026920270202712027220273202742027520276202772027820279202802028120282202832028420285202862028720288202892029020291202922029320294202952029620297202982029920300203012030220303203042030520306203072030820309203102031120312203132031420315203162031720318203192032020321203222032320324203252032620327203282032920330203312033220333203342033520336203372033820339203402034120342203432034420345203462034720348203492035020351203522035320354203552035620357203582035920360203612036220363203642036520366203672036820369203702037120372203732037420375203762037720378203792038020381203822038320384203852038620387203882038920390203912039220393203942039520396203972039820399204002040120402204032040420405204062040720408204092041020411204122041320414204152041620417204182041920420204212042220423204242042520426204272042820429204302043120432204332043420435
  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 <johannes@sipsolutions.net>
  6. * Copyright 2013-2014 Intel Mobile Communications GmbH
  7. * Copyright 2015-2017 Intel Deutschland GmbH
  8. * Copyright (C) 2018-2024 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. for_each_rdev(rdev) {
  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. const struct ieee80211_ext *ext;
  196. unsigned int fixedlen, hdrlen;
  197. bool s1g_bcn;
  198. if (len < offsetofend(typeof(*mgmt), frame_control))
  199. goto err;
  200. s1g_bcn = ieee80211_is_s1g_beacon(mgmt->frame_control);
  201. if (s1g_bcn) {
  202. ext = (struct ieee80211_ext *)mgmt;
  203. fixedlen =
  204. offsetof(struct ieee80211_ext, u.s1g_beacon.variable) +
  205. ieee80211_s1g_optional_len(ext->frame_control);
  206. hdrlen = offsetof(struct ieee80211_ext, u.s1g_beacon);
  207. } else {
  208. fixedlen = offsetof(struct ieee80211_mgmt,
  209. u.beacon.variable);
  210. hdrlen = offsetof(struct ieee80211_mgmt, u.beacon);
  211. }
  212. if (len < fixedlen)
  213. goto err;
  214. if (ieee80211_hdrlen(mgmt->frame_control) != hdrlen)
  215. goto err;
  216. data += fixedlen;
  217. len -= fixedlen;
  218. for_each_element(elem, data, len) {
  219. /* nothing */
  220. }
  221. if (for_each_element_completed(elem, data, len))
  222. return 0;
  223. err:
  224. NL_SET_ERR_MSG_ATTR(extack, attr, "malformed beacon head");
  225. return -EINVAL;
  226. }
  227. static int validate_ie_attr(const struct nlattr *attr,
  228. struct netlink_ext_ack *extack)
  229. {
  230. const u8 *data = nla_data(attr);
  231. unsigned int len = nla_len(attr);
  232. const struct element *elem;
  233. for_each_element(elem, data, len) {
  234. /* nothing */
  235. }
  236. if (for_each_element_completed(elem, data, len))
  237. return 0;
  238. NL_SET_ERR_MSG_ATTR(extack, attr, "malformed information elements");
  239. return -EINVAL;
  240. }
  241. static int validate_he_capa(const struct nlattr *attr,
  242. struct netlink_ext_ack *extack)
  243. {
  244. if (!ieee80211_he_capa_size_ok(nla_data(attr), nla_len(attr)))
  245. return -EINVAL;
  246. return 0;
  247. }
  248. /* policy for the attributes */
  249. static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR];
  250. static const struct nla_policy
  251. nl80211_ftm_responder_policy[NL80211_FTM_RESP_ATTR_MAX + 1] = {
  252. [NL80211_FTM_RESP_ATTR_ENABLED] = { .type = NLA_FLAG, },
  253. [NL80211_FTM_RESP_ATTR_LCI] = { .type = NLA_BINARY,
  254. .len = U8_MAX },
  255. [NL80211_FTM_RESP_ATTR_CIVICLOC] = { .type = NLA_BINARY,
  256. .len = U8_MAX },
  257. };
  258. static const struct nla_policy
  259. nl80211_pmsr_ftm_req_attr_policy[NL80211_PMSR_FTM_REQ_ATTR_MAX + 1] = {
  260. [NL80211_PMSR_FTM_REQ_ATTR_ASAP] = { .type = NLA_FLAG },
  261. [NL80211_PMSR_FTM_REQ_ATTR_PREAMBLE] = { .type = NLA_U32 },
  262. [NL80211_PMSR_FTM_REQ_ATTR_NUM_BURSTS_EXP] =
  263. NLA_POLICY_MAX(NLA_U8, 15),
  264. [NL80211_PMSR_FTM_REQ_ATTR_BURST_PERIOD] = { .type = NLA_U16 },
  265. [NL80211_PMSR_FTM_REQ_ATTR_BURST_DURATION] =
  266. NLA_POLICY_MAX(NLA_U8, 15),
  267. [NL80211_PMSR_FTM_REQ_ATTR_FTMS_PER_BURST] = { .type = NLA_U8 },
  268. [NL80211_PMSR_FTM_REQ_ATTR_NUM_FTMR_RETRIES] = { .type = NLA_U8 },
  269. [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_LCI] = { .type = NLA_FLAG },
  270. [NL80211_PMSR_FTM_REQ_ATTR_REQUEST_CIVICLOC] = { .type = NLA_FLAG },
  271. [NL80211_PMSR_FTM_REQ_ATTR_TRIGGER_BASED] = { .type = NLA_FLAG },
  272. [NL80211_PMSR_FTM_REQ_ATTR_NON_TRIGGER_BASED] = { .type = NLA_FLAG },
  273. [NL80211_PMSR_FTM_REQ_ATTR_LMR_FEEDBACK] = { .type = NLA_FLAG },
  274. [NL80211_PMSR_FTM_REQ_ATTR_BSS_COLOR] = { .type = NLA_U8 },
  275. };
  276. static const struct nla_policy
  277. nl80211_pmsr_req_data_policy[NL80211_PMSR_TYPE_MAX + 1] = {
  278. [NL80211_PMSR_TYPE_FTM] =
  279. NLA_POLICY_NESTED(nl80211_pmsr_ftm_req_attr_policy),
  280. };
  281. static const struct nla_policy
  282. nl80211_pmsr_req_attr_policy[NL80211_PMSR_REQ_ATTR_MAX + 1] = {
  283. [NL80211_PMSR_REQ_ATTR_DATA] =
  284. NLA_POLICY_NESTED(nl80211_pmsr_req_data_policy),
  285. [NL80211_PMSR_REQ_ATTR_GET_AP_TSF] = { .type = NLA_FLAG },
  286. };
  287. static const struct nla_policy
  288. nl80211_pmsr_peer_attr_policy[NL80211_PMSR_PEER_ATTR_MAX + 1] = {
  289. [NL80211_PMSR_PEER_ATTR_ADDR] = NLA_POLICY_ETH_ADDR,
  290. [NL80211_PMSR_PEER_ATTR_CHAN] = NLA_POLICY_NESTED(nl80211_policy),
  291. [NL80211_PMSR_PEER_ATTR_REQ] =
  292. NLA_POLICY_NESTED(nl80211_pmsr_req_attr_policy),
  293. [NL80211_PMSR_PEER_ATTR_RESP] = { .type = NLA_REJECT },
  294. };
  295. static const struct nla_policy
  296. nl80211_pmsr_attr_policy[NL80211_PMSR_ATTR_MAX + 1] = {
  297. [NL80211_PMSR_ATTR_MAX_PEERS] = { .type = NLA_REJECT },
  298. [NL80211_PMSR_ATTR_REPORT_AP_TSF] = { .type = NLA_REJECT },
  299. [NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR] = { .type = NLA_REJECT },
  300. [NL80211_PMSR_ATTR_TYPE_CAPA] = { .type = NLA_REJECT },
  301. [NL80211_PMSR_ATTR_PEERS] =
  302. NLA_POLICY_NESTED_ARRAY(nl80211_pmsr_peer_attr_policy),
  303. };
  304. static const struct nla_policy
  305. he_obss_pd_policy[NL80211_HE_OBSS_PD_ATTR_MAX + 1] = {
  306. [NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET] =
  307. NLA_POLICY_RANGE(NLA_U8, 1, 20),
  308. [NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET] =
  309. NLA_POLICY_RANGE(NLA_U8, 1, 20),
  310. [NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET] =
  311. NLA_POLICY_RANGE(NLA_U8, 1, 20),
  312. [NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP] =
  313. NLA_POLICY_EXACT_LEN(8),
  314. [NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP] =
  315. NLA_POLICY_EXACT_LEN(8),
  316. [NL80211_HE_OBSS_PD_ATTR_SR_CTRL] = { .type = NLA_U8 },
  317. };
  318. static const struct nla_policy
  319. he_bss_color_policy[NL80211_HE_BSS_COLOR_ATTR_MAX + 1] = {
  320. [NL80211_HE_BSS_COLOR_ATTR_COLOR] = NLA_POLICY_RANGE(NLA_U8, 1, 63),
  321. [NL80211_HE_BSS_COLOR_ATTR_DISABLED] = { .type = NLA_FLAG },
  322. [NL80211_HE_BSS_COLOR_ATTR_PARTIAL] = { .type = NLA_FLAG },
  323. };
  324. static const struct nla_policy nl80211_txattr_policy[NL80211_TXRATE_MAX + 1] = {
  325. [NL80211_TXRATE_LEGACY] = { .type = NLA_BINARY,
  326. .len = NL80211_MAX_SUPP_RATES },
  327. [NL80211_TXRATE_HT] = { .type = NLA_BINARY,
  328. .len = NL80211_MAX_SUPP_HT_RATES },
  329. [NL80211_TXRATE_VHT] = NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_txrate_vht)),
  330. [NL80211_TXRATE_GI] = { .type = NLA_U8 },
  331. [NL80211_TXRATE_HE] = NLA_POLICY_EXACT_LEN(sizeof(struct nl80211_txrate_he)),
  332. [NL80211_TXRATE_HE_GI] = NLA_POLICY_RANGE(NLA_U8,
  333. NL80211_RATE_INFO_HE_GI_0_8,
  334. NL80211_RATE_INFO_HE_GI_3_2),
  335. [NL80211_TXRATE_HE_LTF] = NLA_POLICY_RANGE(NLA_U8,
  336. NL80211_RATE_INFO_HE_1XLTF,
  337. NL80211_RATE_INFO_HE_4XLTF),
  338. };
  339. static const struct nla_policy
  340. nl80211_tid_config_attr_policy[NL80211_TID_CONFIG_ATTR_MAX + 1] = {
  341. [NL80211_TID_CONFIG_ATTR_VIF_SUPP] = { .type = NLA_U64 },
  342. [NL80211_TID_CONFIG_ATTR_PEER_SUPP] = { .type = NLA_U64 },
  343. [NL80211_TID_CONFIG_ATTR_OVERRIDE] = { .type = NLA_FLAG },
  344. [NL80211_TID_CONFIG_ATTR_TIDS] = NLA_POLICY_RANGE(NLA_U16, 1, 0xff),
  345. [NL80211_TID_CONFIG_ATTR_NOACK] =
  346. NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
  347. [NL80211_TID_CONFIG_ATTR_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
  348. [NL80211_TID_CONFIG_ATTR_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
  349. [NL80211_TID_CONFIG_ATTR_AMPDU_CTRL] =
  350. NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
  351. [NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL] =
  352. NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
  353. [NL80211_TID_CONFIG_ATTR_AMSDU_CTRL] =
  354. NLA_POLICY_MAX(NLA_U8, NL80211_TID_CONFIG_DISABLE),
  355. [NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE] =
  356. NLA_POLICY_MAX(NLA_U8, NL80211_TX_RATE_FIXED),
  357. [NL80211_TID_CONFIG_ATTR_TX_RATE] =
  358. NLA_POLICY_NESTED(nl80211_txattr_policy),
  359. };
  360. static const struct nla_policy
  361. nl80211_fils_discovery_policy[NL80211_FILS_DISCOVERY_ATTR_MAX + 1] = {
  362. [NL80211_FILS_DISCOVERY_ATTR_INT_MIN] = NLA_POLICY_MAX(NLA_U32, 10000),
  363. [NL80211_FILS_DISCOVERY_ATTR_INT_MAX] = NLA_POLICY_MAX(NLA_U32, 10000),
  364. [NL80211_FILS_DISCOVERY_ATTR_TMPL] =
  365. NLA_POLICY_RANGE(NLA_BINARY,
  366. NL80211_FILS_DISCOVERY_TMPL_MIN_LEN,
  367. IEEE80211_MAX_DATA_LEN),
  368. };
  369. static const struct nla_policy
  370. nl80211_unsol_bcast_probe_resp_policy[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1] = {
  371. [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] = NLA_POLICY_MAX(NLA_U32, 20),
  372. [NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL] = { .type = NLA_BINARY,
  373. .len = IEEE80211_MAX_DATA_LEN }
  374. };
  375. static const struct nla_policy
  376. sar_specs_policy[NL80211_SAR_ATTR_SPECS_MAX + 1] = {
  377. [NL80211_SAR_ATTR_SPECS_POWER] = { .type = NLA_S32 },
  378. [NL80211_SAR_ATTR_SPECS_RANGE_INDEX] = {.type = NLA_U32 },
  379. };
  380. static const struct nla_policy
  381. sar_policy[NL80211_SAR_ATTR_MAX + 1] = {
  382. [NL80211_SAR_ATTR_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_SAR_TYPE),
  383. [NL80211_SAR_ATTR_SPECS] = NLA_POLICY_NESTED_ARRAY(sar_specs_policy),
  384. };
  385. static const struct nla_policy
  386. nl80211_mbssid_config_policy[NL80211_MBSSID_CONFIG_ATTR_MAX + 1] = {
  387. [NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES] = NLA_POLICY_MIN(NLA_U8, 2),
  388. [NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY] =
  389. NLA_POLICY_MIN(NLA_U8, 1),
  390. [NL80211_MBSSID_CONFIG_ATTR_INDEX] = { .type = NLA_U8 },
  391. [NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX] = { .type = NLA_U32 },
  392. [NL80211_MBSSID_CONFIG_ATTR_EMA] = { .type = NLA_FLAG },
  393. };
  394. static const struct nla_policy
  395. nl80211_sta_wme_policy[NL80211_STA_WME_MAX + 1] = {
  396. [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
  397. [NL80211_STA_WME_MAX_SP] = { .type = NLA_U8 },
  398. };
  399. static const struct netlink_range_validation nl80211_punct_bitmap_range = {
  400. .min = 0,
  401. .max = 0xffff,
  402. };
  403. static const struct netlink_range_validation q_range = {
  404. .max = INT_MAX,
  405. };
  406. static const struct nla_policy nl80211_policy[NUM_NL80211_ATTR] = {
  407. [0] = { .strict_start_type = NL80211_ATTR_HE_OBSS_PD },
  408. [NL80211_ATTR_WIPHY] = { .type = NLA_U32 },
  409. [NL80211_ATTR_WIPHY_NAME] = { .type = NLA_NUL_STRING,
  410. .len = 20-1 },
  411. [NL80211_ATTR_WIPHY_TXQ_PARAMS] = { .type = NLA_NESTED },
  412. [NL80211_ATTR_WIPHY_FREQ] = { .type = NLA_U32 },
  413. [NL80211_ATTR_WIPHY_CHANNEL_TYPE] = { .type = NLA_U32 },
  414. [NL80211_ATTR_WIPHY_EDMG_CHANNELS] = NLA_POLICY_RANGE(NLA_U8,
  415. NL80211_EDMG_CHANNELS_MIN,
  416. NL80211_EDMG_CHANNELS_MAX),
  417. [NL80211_ATTR_WIPHY_EDMG_BW_CONFIG] = NLA_POLICY_RANGE(NLA_U8,
  418. NL80211_EDMG_BW_CONFIG_MIN,
  419. NL80211_EDMG_BW_CONFIG_MAX),
  420. [NL80211_ATTR_CHANNEL_WIDTH] = { .type = NLA_U32 },
  421. [NL80211_ATTR_CENTER_FREQ1] = { .type = NLA_U32 },
  422. [NL80211_ATTR_CENTER_FREQ1_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999),
  423. [NL80211_ATTR_CENTER_FREQ2] = { .type = NLA_U32 },
  424. [NL80211_ATTR_WIPHY_RETRY_SHORT] = NLA_POLICY_MIN(NLA_U8, 1),
  425. [NL80211_ATTR_WIPHY_RETRY_LONG] = NLA_POLICY_MIN(NLA_U8, 1),
  426. [NL80211_ATTR_WIPHY_FRAG_THRESHOLD] = { .type = NLA_U32 },
  427. [NL80211_ATTR_WIPHY_RTS_THRESHOLD] = { .type = NLA_U32 },
  428. [NL80211_ATTR_WIPHY_COVERAGE_CLASS] = { .type = NLA_U8 },
  429. [NL80211_ATTR_WIPHY_DYN_ACK] = { .type = NLA_FLAG },
  430. [NL80211_ATTR_IFTYPE] = NLA_POLICY_MAX(NLA_U32, NL80211_IFTYPE_MAX),
  431. [NL80211_ATTR_IFINDEX] = { .type = NLA_U32 },
  432. [NL80211_ATTR_IFNAME] = { .type = NLA_NUL_STRING, .len = IFNAMSIZ-1 },
  433. [NL80211_ATTR_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  434. [NL80211_ATTR_PREV_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  435. [NL80211_ATTR_KEY] = { .type = NLA_NESTED, },
  436. [NL80211_ATTR_KEY_DATA] = { .type = NLA_BINARY,
  437. .len = WLAN_MAX_KEY_LEN },
  438. [NL80211_ATTR_KEY_IDX] = NLA_POLICY_MAX(NLA_U8, 7),
  439. [NL80211_ATTR_KEY_CIPHER] = { .type = NLA_U32 },
  440. [NL80211_ATTR_KEY_DEFAULT] = { .type = NLA_FLAG },
  441. [NL80211_ATTR_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
  442. [NL80211_ATTR_KEY_TYPE] =
  443. NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES),
  444. [NL80211_ATTR_BEACON_INTERVAL] = { .type = NLA_U32 },
  445. [NL80211_ATTR_DTIM_PERIOD] = { .type = NLA_U32 },
  446. [NL80211_ATTR_BEACON_HEAD] =
  447. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_beacon_head,
  448. IEEE80211_MAX_DATA_LEN),
  449. [NL80211_ATTR_BEACON_TAIL] =
  450. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
  451. IEEE80211_MAX_DATA_LEN),
  452. [NL80211_ATTR_STA_AID] =
  453. NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
  454. [NL80211_ATTR_STA_FLAGS] = { .type = NLA_NESTED },
  455. [NL80211_ATTR_STA_LISTEN_INTERVAL] = { .type = NLA_U16 },
  456. [NL80211_ATTR_STA_SUPPORTED_RATES] = { .type = NLA_BINARY,
  457. .len = NL80211_MAX_SUPP_RATES },
  458. [NL80211_ATTR_STA_PLINK_ACTION] =
  459. NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_ACTIONS - 1),
  460. [NL80211_ATTR_STA_TX_POWER_SETTING] =
  461. NLA_POLICY_RANGE(NLA_U8,
  462. NL80211_TX_POWER_AUTOMATIC,
  463. NL80211_TX_POWER_FIXED),
  464. [NL80211_ATTR_STA_TX_POWER] = { .type = NLA_S16 },
  465. [NL80211_ATTR_STA_VLAN] = { .type = NLA_U32 },
  466. [NL80211_ATTR_MNTR_FLAGS] = { /* NLA_NESTED can't be empty */ },
  467. [NL80211_ATTR_MESH_ID] = { .type = NLA_BINARY,
  468. .len = IEEE80211_MAX_MESH_ID_LEN },
  469. [NL80211_ATTR_MPATH_NEXT_HOP] = NLA_POLICY_ETH_ADDR_COMPAT,
  470. /* allow 3 for NUL-termination, we used to declare this NLA_STRING */
  471. [NL80211_ATTR_REG_ALPHA2] = NLA_POLICY_RANGE(NLA_BINARY, 2, 3),
  472. [NL80211_ATTR_REG_RULES] = { .type = NLA_NESTED },
  473. [NL80211_ATTR_BSS_CTS_PROT] = { .type = NLA_U8 },
  474. [NL80211_ATTR_BSS_SHORT_PREAMBLE] = { .type = NLA_U8 },
  475. [NL80211_ATTR_BSS_SHORT_SLOT_TIME] = { .type = NLA_U8 },
  476. [NL80211_ATTR_BSS_BASIC_RATES] = { .type = NLA_BINARY,
  477. .len = NL80211_MAX_SUPP_RATES },
  478. [NL80211_ATTR_BSS_HT_OPMODE] = { .type = NLA_U16 },
  479. [NL80211_ATTR_MESH_CONFIG] = { .type = NLA_NESTED },
  480. [NL80211_ATTR_SUPPORT_MESH_AUTH] = { .type = NLA_FLAG },
  481. [NL80211_ATTR_HT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_HT_CAPABILITY_LEN),
  482. [NL80211_ATTR_MGMT_SUBTYPE] = { .type = NLA_U8 },
  483. [NL80211_ATTR_IE] = NLA_POLICY_VALIDATE_FN(NLA_BINARY,
  484. validate_ie_attr,
  485. IEEE80211_MAX_DATA_LEN),
  486. [NL80211_ATTR_SCAN_FREQUENCIES] = { .type = NLA_NESTED },
  487. [NL80211_ATTR_SCAN_SSIDS] = { .type = NLA_NESTED },
  488. [NL80211_ATTR_SSID] = { .type = NLA_BINARY,
  489. .len = IEEE80211_MAX_SSID_LEN },
  490. [NL80211_ATTR_AUTH_TYPE] = { .type = NLA_U32 },
  491. [NL80211_ATTR_REASON_CODE] = { .type = NLA_U16 },
  492. [NL80211_ATTR_FREQ_FIXED] = { .type = NLA_FLAG },
  493. [NL80211_ATTR_TIMED_OUT] = { .type = NLA_FLAG },
  494. [NL80211_ATTR_USE_MFP] = NLA_POLICY_RANGE(NLA_U32,
  495. NL80211_MFP_NO,
  496. NL80211_MFP_OPTIONAL),
  497. [NL80211_ATTR_STA_FLAGS2] =
  498. NLA_POLICY_EXACT_LEN_WARN(sizeof(struct nl80211_sta_flag_update)),
  499. [NL80211_ATTR_CONTROL_PORT] = { .type = NLA_FLAG },
  500. [NL80211_ATTR_CONTROL_PORT_ETHERTYPE] = { .type = NLA_U16 },
  501. [NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT] = { .type = NLA_FLAG },
  502. [NL80211_ATTR_CONTROL_PORT_OVER_NL80211] = { .type = NLA_FLAG },
  503. [NL80211_ATTR_PRIVACY] = { .type = NLA_FLAG },
  504. [NL80211_ATTR_STATUS_CODE] = { .type = NLA_U16 },
  505. [NL80211_ATTR_CIPHER_SUITE_GROUP] = { .type = NLA_U32 },
  506. [NL80211_ATTR_WPA_VERSIONS] =
  507. NLA_POLICY_RANGE(NLA_U32, 0,
  508. NL80211_WPA_VERSION_1 |
  509. NL80211_WPA_VERSION_2 |
  510. NL80211_WPA_VERSION_3),
  511. [NL80211_ATTR_PID] = { .type = NLA_U32 },
  512. [NL80211_ATTR_4ADDR] = { .type = NLA_U8 },
  513. [NL80211_ATTR_PMKID] = NLA_POLICY_EXACT_LEN_WARN(WLAN_PMKID_LEN),
  514. [NL80211_ATTR_DURATION] = { .type = NLA_U32 },
  515. [NL80211_ATTR_COOKIE] = { .type = NLA_U64 },
  516. [NL80211_ATTR_TX_RATES] = { .type = NLA_NESTED },
  517. [NL80211_ATTR_FRAME] = { .type = NLA_BINARY,
  518. .len = IEEE80211_MAX_DATA_LEN },
  519. [NL80211_ATTR_FRAME_MATCH] = { .type = NLA_BINARY, },
  520. [NL80211_ATTR_PS_STATE] = NLA_POLICY_RANGE(NLA_U32,
  521. NL80211_PS_DISABLED,
  522. NL80211_PS_ENABLED),
  523. [NL80211_ATTR_CQM] = { .type = NLA_NESTED, },
  524. [NL80211_ATTR_LOCAL_STATE_CHANGE] = { .type = NLA_FLAG },
  525. [NL80211_ATTR_AP_ISOLATE] = { .type = NLA_U8 },
  526. [NL80211_ATTR_WIPHY_TX_POWER_SETTING] = { .type = NLA_U32 },
  527. [NL80211_ATTR_WIPHY_TX_POWER_LEVEL] = { .type = NLA_U32 },
  528. [NL80211_ATTR_FRAME_TYPE] = { .type = NLA_U16 },
  529. [NL80211_ATTR_WIPHY_ANTENNA_TX] = { .type = NLA_U32 },
  530. [NL80211_ATTR_WIPHY_ANTENNA_RX] = { .type = NLA_U32 },
  531. [NL80211_ATTR_MCAST_RATE] = { .type = NLA_U32 },
  532. [NL80211_ATTR_OFFCHANNEL_TX_OK] = { .type = NLA_FLAG },
  533. [NL80211_ATTR_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  534. [NL80211_ATTR_WOWLAN_TRIGGERS] = { .type = NLA_NESTED },
  535. [NL80211_ATTR_STA_PLINK_STATE] =
  536. NLA_POLICY_MAX(NLA_U8, NUM_NL80211_PLINK_STATES - 1),
  537. [NL80211_ATTR_MEASUREMENT_DURATION] = { .type = NLA_U16 },
  538. [NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY] = { .type = NLA_FLAG },
  539. [NL80211_ATTR_MESH_PEER_AID] =
  540. NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
  541. [NL80211_ATTR_SCHED_SCAN_INTERVAL] = { .type = NLA_U32 },
  542. [NL80211_ATTR_REKEY_DATA] = { .type = NLA_NESTED },
  543. [NL80211_ATTR_SCAN_SUPP_RATES] = { .type = NLA_NESTED },
  544. [NL80211_ATTR_HIDDEN_SSID] =
  545. NLA_POLICY_RANGE(NLA_U32,
  546. NL80211_HIDDEN_SSID_NOT_IN_USE,
  547. NL80211_HIDDEN_SSID_ZERO_CONTENTS),
  548. [NL80211_ATTR_IE_PROBE_RESP] =
  549. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
  550. IEEE80211_MAX_DATA_LEN),
  551. [NL80211_ATTR_IE_ASSOC_RESP] =
  552. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
  553. IEEE80211_MAX_DATA_LEN),
  554. [NL80211_ATTR_ROAM_SUPPORT] = { .type = NLA_FLAG },
  555. [NL80211_ATTR_STA_WME] = NLA_POLICY_NESTED(nl80211_sta_wme_policy),
  556. [NL80211_ATTR_SCHED_SCAN_MATCH] = { .type = NLA_NESTED },
  557. [NL80211_ATTR_TX_NO_CCK_RATE] = { .type = NLA_FLAG },
  558. [NL80211_ATTR_TDLS_ACTION] = { .type = NLA_U8 },
  559. [NL80211_ATTR_TDLS_DIALOG_TOKEN] = { .type = NLA_U8 },
  560. [NL80211_ATTR_TDLS_OPERATION] = { .type = NLA_U8 },
  561. [NL80211_ATTR_TDLS_SUPPORT] = { .type = NLA_FLAG },
  562. [NL80211_ATTR_TDLS_EXTERNAL_SETUP] = { .type = NLA_FLAG },
  563. [NL80211_ATTR_TDLS_INITIATOR] = { .type = NLA_FLAG },
  564. [NL80211_ATTR_DONT_WAIT_FOR_ACK] = { .type = NLA_FLAG },
  565. [NL80211_ATTR_PROBE_RESP] = { .type = NLA_BINARY,
  566. .len = IEEE80211_MAX_DATA_LEN },
  567. [NL80211_ATTR_DFS_REGION] = { .type = NLA_U8 },
  568. [NL80211_ATTR_DISABLE_HT] = { .type = NLA_FLAG },
  569. [NL80211_ATTR_HT_CAPABILITY_MASK] = {
  570. .len = NL80211_HT_CAPABILITY_LEN
  571. },
  572. [NL80211_ATTR_NOACK_MAP] = { .type = NLA_U16 },
  573. [NL80211_ATTR_INACTIVITY_TIMEOUT] = { .type = NLA_U16 },
  574. [NL80211_ATTR_BG_SCAN_PERIOD] = { .type = NLA_U16 },
  575. [NL80211_ATTR_WDEV] = { .type = NLA_U64 },
  576. [NL80211_ATTR_USER_REG_HINT_TYPE] = { .type = NLA_U32 },
  577. /* need to include at least Auth Transaction and Status Code */
  578. [NL80211_ATTR_AUTH_DATA] = NLA_POLICY_MIN_LEN(4),
  579. [NL80211_ATTR_VHT_CAPABILITY] = NLA_POLICY_EXACT_LEN_WARN(NL80211_VHT_CAPABILITY_LEN),
  580. [NL80211_ATTR_SCAN_FLAGS] = { .type = NLA_U32 },
  581. [NL80211_ATTR_P2P_CTWINDOW] = NLA_POLICY_MAX(NLA_U8, 127),
  582. [NL80211_ATTR_P2P_OPPPS] = NLA_POLICY_MAX(NLA_U8, 1),
  583. [NL80211_ATTR_LOCAL_MESH_POWER_MODE] =
  584. NLA_POLICY_RANGE(NLA_U32,
  585. NL80211_MESH_POWER_UNKNOWN + 1,
  586. NL80211_MESH_POWER_MAX),
  587. [NL80211_ATTR_ACL_POLICY] = {. type = NLA_U32 },
  588. [NL80211_ATTR_MAC_ADDRS] = { .type = NLA_NESTED },
  589. [NL80211_ATTR_STA_CAPABILITY] = { .type = NLA_U16 },
  590. [NL80211_ATTR_STA_EXT_CAPABILITY] = { .type = NLA_BINARY, },
  591. [NL80211_ATTR_SPLIT_WIPHY_DUMP] = { .type = NLA_FLAG, },
  592. [NL80211_ATTR_DISABLE_VHT] = { .type = NLA_FLAG },
  593. [NL80211_ATTR_VHT_CAPABILITY_MASK] = {
  594. .len = NL80211_VHT_CAPABILITY_LEN,
  595. },
  596. [NL80211_ATTR_MDID] = { .type = NLA_U16 },
  597. [NL80211_ATTR_IE_RIC] = { .type = NLA_BINARY,
  598. .len = IEEE80211_MAX_DATA_LEN },
  599. [NL80211_ATTR_CRIT_PROT_ID] = { .type = NLA_U16 },
  600. [NL80211_ATTR_MAX_CRIT_PROT_DURATION] =
  601. NLA_POLICY_MAX(NLA_U16, NL80211_CRIT_PROTO_MAX_DURATION),
  602. [NL80211_ATTR_PEER_AID] =
  603. NLA_POLICY_RANGE(NLA_U16, 1, IEEE80211_MAX_AID),
  604. [NL80211_ATTR_CH_SWITCH_COUNT] = { .type = NLA_U32 },
  605. [NL80211_ATTR_CH_SWITCH_BLOCK_TX] = { .type = NLA_FLAG },
  606. [NL80211_ATTR_CSA_IES] = { .type = NLA_NESTED },
  607. [NL80211_ATTR_CNTDWN_OFFS_BEACON] = { .type = NLA_BINARY },
  608. [NL80211_ATTR_CNTDWN_OFFS_PRESP] = { .type = NLA_BINARY },
  609. [NL80211_ATTR_STA_SUPPORTED_CHANNELS] = NLA_POLICY_MIN_LEN(2),
  610. /*
  611. * The value of the Length field of the Supported Operating
  612. * Classes element is between 2 and 253.
  613. */
  614. [NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES] =
  615. NLA_POLICY_RANGE(NLA_BINARY, 2, 253),
  616. [NL80211_ATTR_HANDLE_DFS] = { .type = NLA_FLAG },
  617. [NL80211_ATTR_OPMODE_NOTIF] = { .type = NLA_U8 },
  618. [NL80211_ATTR_VENDOR_ID] = { .type = NLA_U32 },
  619. [NL80211_ATTR_VENDOR_SUBCMD] = { .type = NLA_U32 },
  620. [NL80211_ATTR_VENDOR_DATA] = { .type = NLA_BINARY },
  621. [NL80211_ATTR_QOS_MAP] = NLA_POLICY_RANGE(NLA_BINARY,
  622. IEEE80211_QOS_MAP_LEN_MIN,
  623. IEEE80211_QOS_MAP_LEN_MAX),
  624. [NL80211_ATTR_MAC_HINT] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  625. [NL80211_ATTR_WIPHY_FREQ_HINT] = { .type = NLA_U32 },
  626. [NL80211_ATTR_TDLS_PEER_CAPABILITY] = { .type = NLA_U32 },
  627. [NL80211_ATTR_SOCKET_OWNER] = { .type = NLA_FLAG },
  628. [NL80211_ATTR_CSA_C_OFFSETS_TX] = { .type = NLA_BINARY },
  629. [NL80211_ATTR_USE_RRM] = { .type = NLA_FLAG },
  630. [NL80211_ATTR_TSID] = NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_TIDS - 1),
  631. [NL80211_ATTR_USER_PRIO] =
  632. NLA_POLICY_MAX(NLA_U8, IEEE80211_NUM_UPS - 1),
  633. [NL80211_ATTR_ADMITTED_TIME] = { .type = NLA_U16 },
  634. [NL80211_ATTR_SMPS_MODE] = { .type = NLA_U8 },
  635. [NL80211_ATTR_OPER_CLASS] = { .type = NLA_U8 },
  636. [NL80211_ATTR_MAC_MASK] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  637. [NL80211_ATTR_WIPHY_SELF_MANAGED_REG] = { .type = NLA_FLAG },
  638. [NL80211_ATTR_NETNS_FD] = { .type = NLA_U32 },
  639. [NL80211_ATTR_SCHED_SCAN_DELAY] = { .type = NLA_U32 },
  640. [NL80211_ATTR_REG_INDOOR] = { .type = NLA_FLAG },
  641. [NL80211_ATTR_PBSS] = { .type = NLA_FLAG },
  642. [NL80211_ATTR_BSS_SELECT] = { .type = NLA_NESTED },
  643. [NL80211_ATTR_STA_SUPPORT_P2P_PS] =
  644. NLA_POLICY_MAX(NLA_U8, NUM_NL80211_P2P_PS_STATUS - 1),
  645. [NL80211_ATTR_MU_MIMO_GROUP_DATA] = {
  646. .len = VHT_MUMIMO_GROUPS_DATA_LEN
  647. },
  648. [NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  649. [NL80211_ATTR_NAN_MASTER_PREF] = NLA_POLICY_MIN(NLA_U8, 1),
  650. [NL80211_ATTR_BANDS] = { .type = NLA_U32 },
  651. [NL80211_ATTR_NAN_FUNC] = { .type = NLA_NESTED },
  652. [NL80211_ATTR_FILS_KEK] = { .type = NLA_BINARY,
  653. .len = FILS_MAX_KEK_LEN },
  654. [NL80211_ATTR_FILS_NONCES] = NLA_POLICY_EXACT_LEN_WARN(2 * FILS_NONCE_LEN),
  655. [NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED] = { .type = NLA_FLAG, },
  656. [NL80211_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  657. [NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] = { .type = NLA_S8 },
  658. [NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST] = {
  659. .len = sizeof(struct nl80211_bss_select_rssi_adjust)
  660. },
  661. [NL80211_ATTR_TIMEOUT_REASON] = { .type = NLA_U32 },
  662. [NL80211_ATTR_FILS_ERP_USERNAME] = { .type = NLA_BINARY,
  663. .len = FILS_ERP_MAX_USERNAME_LEN },
  664. [NL80211_ATTR_FILS_ERP_REALM] = { .type = NLA_BINARY,
  665. .len = FILS_ERP_MAX_REALM_LEN },
  666. [NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] = { .type = NLA_U16 },
  667. [NL80211_ATTR_FILS_ERP_RRK] = { .type = NLA_BINARY,
  668. .len = FILS_ERP_MAX_RRK_LEN },
  669. [NL80211_ATTR_FILS_CACHE_ID] = NLA_POLICY_EXACT_LEN_WARN(2),
  670. [NL80211_ATTR_PMK] = { .type = NLA_BINARY, .len = PMK_MAX_LEN },
  671. [NL80211_ATTR_PMKR0_NAME] = NLA_POLICY_EXACT_LEN(WLAN_PMK_NAME_LEN),
  672. [NL80211_ATTR_SCHED_SCAN_MULTI] = { .type = NLA_FLAG },
  673. [NL80211_ATTR_EXTERNAL_AUTH_SUPPORT] = { .type = NLA_FLAG },
  674. [NL80211_ATTR_TXQ_LIMIT] = { .type = NLA_U32 },
  675. [NL80211_ATTR_TXQ_MEMORY_LIMIT] = { .type = NLA_U32 },
  676. [NL80211_ATTR_TXQ_QUANTUM] = NLA_POLICY_FULL_RANGE(NLA_U32, &q_range),
  677. [NL80211_ATTR_HE_CAPABILITY] =
  678. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_he_capa,
  679. NL80211_HE_MAX_CAPABILITY_LEN),
  680. [NL80211_ATTR_FTM_RESPONDER] =
  681. NLA_POLICY_NESTED(nl80211_ftm_responder_policy),
  682. [NL80211_ATTR_TIMEOUT] = NLA_POLICY_MIN(NLA_U32, 1),
  683. [NL80211_ATTR_PEER_MEASUREMENTS] =
  684. NLA_POLICY_NESTED(nl80211_pmsr_attr_policy),
  685. [NL80211_ATTR_AIRTIME_WEIGHT] = NLA_POLICY_MIN(NLA_U16, 1),
  686. [NL80211_ATTR_SAE_PASSWORD] = { .type = NLA_BINARY,
  687. .len = SAE_PASSWORD_MAX_LEN },
  688. [NL80211_ATTR_TWT_RESPONDER] = { .type = NLA_FLAG },
  689. [NL80211_ATTR_HE_OBSS_PD] = NLA_POLICY_NESTED(he_obss_pd_policy),
  690. [NL80211_ATTR_VLAN_ID] = NLA_POLICY_RANGE(NLA_U16, 1, VLAN_N_VID - 2),
  691. [NL80211_ATTR_HE_BSS_COLOR] = NLA_POLICY_NESTED(he_bss_color_policy),
  692. [NL80211_ATTR_TID_CONFIG] =
  693. NLA_POLICY_NESTED_ARRAY(nl80211_tid_config_attr_policy),
  694. [NL80211_ATTR_CONTROL_PORT_NO_PREAUTH] = { .type = NLA_FLAG },
  695. [NL80211_ATTR_PMK_LIFETIME] = NLA_POLICY_MIN(NLA_U32, 1),
  696. [NL80211_ATTR_PMK_REAUTH_THRESHOLD] = NLA_POLICY_RANGE(NLA_U8, 1, 100),
  697. [NL80211_ATTR_RECEIVE_MULTICAST] = { .type = NLA_FLAG },
  698. [NL80211_ATTR_WIPHY_FREQ_OFFSET] = NLA_POLICY_RANGE(NLA_U32, 0, 999),
  699. [NL80211_ATTR_SCAN_FREQ_KHZ] = { .type = NLA_NESTED },
  700. [NL80211_ATTR_HE_6GHZ_CAPABILITY] =
  701. NLA_POLICY_EXACT_LEN(sizeof(struct ieee80211_he_6ghz_capa)),
  702. [NL80211_ATTR_FILS_DISCOVERY] =
  703. NLA_POLICY_NESTED(nl80211_fils_discovery_policy),
  704. [NL80211_ATTR_UNSOL_BCAST_PROBE_RESP] =
  705. NLA_POLICY_NESTED(nl80211_unsol_bcast_probe_resp_policy),
  706. [NL80211_ATTR_S1G_CAPABILITY] =
  707. NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN),
  708. [NL80211_ATTR_S1G_CAPABILITY_MASK] =
  709. NLA_POLICY_EXACT_LEN(IEEE80211_S1G_CAPABILITY_LEN),
  710. [NL80211_ATTR_SAE_PWE] =
  711. NLA_POLICY_RANGE(NLA_U8, NL80211_SAE_PWE_HUNT_AND_PECK,
  712. NL80211_SAE_PWE_BOTH),
  713. [NL80211_ATTR_RECONNECT_REQUESTED] = { .type = NLA_REJECT },
  714. [NL80211_ATTR_SAR_SPEC] = NLA_POLICY_NESTED(sar_policy),
  715. [NL80211_ATTR_DISABLE_HE] = { .type = NLA_FLAG },
  716. [NL80211_ATTR_OBSS_COLOR_BITMAP] = { .type = NLA_U64 },
  717. [NL80211_ATTR_COLOR_CHANGE_COUNT] = { .type = NLA_U8 },
  718. [NL80211_ATTR_COLOR_CHANGE_COLOR] = { .type = NLA_U8 },
  719. [NL80211_ATTR_COLOR_CHANGE_ELEMS] = NLA_POLICY_NESTED(nl80211_policy),
  720. [NL80211_ATTR_MBSSID_CONFIG] =
  721. NLA_POLICY_NESTED(nl80211_mbssid_config_policy),
  722. [NL80211_ATTR_MBSSID_ELEMS] = { .type = NLA_NESTED },
  723. [NL80211_ATTR_RADAR_BACKGROUND] = { .type = NLA_FLAG },
  724. [NL80211_ATTR_AP_SETTINGS_FLAGS] = { .type = NLA_U32 },
  725. [NL80211_ATTR_EHT_CAPABILITY] =
  726. NLA_POLICY_RANGE(NLA_BINARY,
  727. NL80211_EHT_MIN_CAPABILITY_LEN,
  728. NL80211_EHT_MAX_CAPABILITY_LEN),
  729. [NL80211_ATTR_DISABLE_EHT] = { .type = NLA_FLAG },
  730. [NL80211_ATTR_MLO_LINKS] =
  731. NLA_POLICY_NESTED_ARRAY(nl80211_policy),
  732. [NL80211_ATTR_MLO_LINK_ID] =
  733. NLA_POLICY_RANGE(NLA_U8, 0, IEEE80211_MLD_MAX_NUM_LINKS - 1),
  734. [NL80211_ATTR_MLD_ADDR] = NLA_POLICY_EXACT_LEN(ETH_ALEN),
  735. [NL80211_ATTR_MLO_SUPPORT] = { .type = NLA_FLAG },
  736. [NL80211_ATTR_MAX_NUM_AKM_SUITES] = { .type = NLA_REJECT },
  737. [NL80211_ATTR_PUNCT_BITMAP] =
  738. NLA_POLICY_FULL_RANGE(NLA_U32, &nl80211_punct_bitmap_range),
  739. [NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS] = { .type = NLA_U16 },
  740. [NL80211_ATTR_HW_TIMESTAMP_ENABLED] = { .type = NLA_FLAG },
  741. [NL80211_ATTR_EMA_RNR_ELEMS] = { .type = NLA_NESTED },
  742. [NL80211_ATTR_MLO_LINK_DISABLED] = { .type = NLA_FLAG },
  743. [NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA] = { .type = NLA_FLAG },
  744. [NL80211_ATTR_MLO_TTLM_DLINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8),
  745. [NL80211_ATTR_MLO_TTLM_ULINK] = NLA_POLICY_EXACT_LEN(sizeof(u16) * 8),
  746. [NL80211_ATTR_ASSOC_SPP_AMSDU] = { .type = NLA_FLAG },
  747. };
  748. /* policy for the key attributes */
  749. static const struct nla_policy nl80211_key_policy[NL80211_KEY_MAX + 1] = {
  750. [NL80211_KEY_DATA] = { .type = NLA_BINARY, .len = WLAN_MAX_KEY_LEN },
  751. [NL80211_KEY_IDX] = { .type = NLA_U8 },
  752. [NL80211_KEY_CIPHER] = { .type = NLA_U32 },
  753. [NL80211_KEY_SEQ] = { .type = NLA_BINARY, .len = 16 },
  754. [NL80211_KEY_DEFAULT] = { .type = NLA_FLAG },
  755. [NL80211_KEY_DEFAULT_MGMT] = { .type = NLA_FLAG },
  756. [NL80211_KEY_TYPE] = NLA_POLICY_MAX(NLA_U32, NUM_NL80211_KEYTYPES - 1),
  757. [NL80211_KEY_DEFAULT_TYPES] = { .type = NLA_NESTED },
  758. [NL80211_KEY_MODE] = NLA_POLICY_RANGE(NLA_U8, 0, NL80211_KEY_SET_TX),
  759. };
  760. /* policy for the key default flags */
  761. static const struct nla_policy
  762. nl80211_key_default_policy[NUM_NL80211_KEY_DEFAULT_TYPES] = {
  763. [NL80211_KEY_DEFAULT_TYPE_UNICAST] = { .type = NLA_FLAG },
  764. [NL80211_KEY_DEFAULT_TYPE_MULTICAST] = { .type = NLA_FLAG },
  765. };
  766. #ifdef CONFIG_PM
  767. /* policy for WoWLAN attributes */
  768. static const struct nla_policy
  769. nl80211_wowlan_policy[NUM_NL80211_WOWLAN_TRIG] = {
  770. [NL80211_WOWLAN_TRIG_ANY] = { .type = NLA_FLAG },
  771. [NL80211_WOWLAN_TRIG_DISCONNECT] = { .type = NLA_FLAG },
  772. [NL80211_WOWLAN_TRIG_MAGIC_PKT] = { .type = NLA_FLAG },
  773. [NL80211_WOWLAN_TRIG_PKT_PATTERN] = { .type = NLA_NESTED },
  774. [NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE] = { .type = NLA_FLAG },
  775. [NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST] = { .type = NLA_FLAG },
  776. [NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE] = { .type = NLA_FLAG },
  777. [NL80211_WOWLAN_TRIG_RFKILL_RELEASE] = { .type = NLA_FLAG },
  778. [NL80211_WOWLAN_TRIG_TCP_CONNECTION] = { .type = NLA_NESTED },
  779. [NL80211_WOWLAN_TRIG_NET_DETECT] = { .type = NLA_NESTED },
  780. };
  781. static const struct nla_policy
  782. nl80211_wowlan_tcp_policy[NUM_NL80211_WOWLAN_TCP] = {
  783. [NL80211_WOWLAN_TCP_SRC_IPV4] = { .type = NLA_U32 },
  784. [NL80211_WOWLAN_TCP_DST_IPV4] = { .type = NLA_U32 },
  785. [NL80211_WOWLAN_TCP_DST_MAC] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  786. [NL80211_WOWLAN_TCP_SRC_PORT] = { .type = NLA_U16 },
  787. [NL80211_WOWLAN_TCP_DST_PORT] = { .type = NLA_U16 },
  788. [NL80211_WOWLAN_TCP_DATA_PAYLOAD] = NLA_POLICY_MIN_LEN(1),
  789. [NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ] = {
  790. .len = sizeof(struct nl80211_wowlan_tcp_data_seq)
  791. },
  792. [NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN] = {
  793. .len = sizeof(struct nl80211_wowlan_tcp_data_token)
  794. },
  795. [NL80211_WOWLAN_TCP_DATA_INTERVAL] = { .type = NLA_U32 },
  796. [NL80211_WOWLAN_TCP_WAKE_PAYLOAD] = NLA_POLICY_MIN_LEN(1),
  797. [NL80211_WOWLAN_TCP_WAKE_MASK] = NLA_POLICY_MIN_LEN(1),
  798. };
  799. #endif /* CONFIG_PM */
  800. /* policy for coalesce rule attributes */
  801. static const struct nla_policy
  802. nl80211_coalesce_policy[NUM_NL80211_ATTR_COALESCE_RULE] = {
  803. [NL80211_ATTR_COALESCE_RULE_DELAY] = { .type = NLA_U32 },
  804. [NL80211_ATTR_COALESCE_RULE_CONDITION] =
  805. NLA_POLICY_RANGE(NLA_U32,
  806. NL80211_COALESCE_CONDITION_MATCH,
  807. NL80211_COALESCE_CONDITION_NO_MATCH),
  808. [NL80211_ATTR_COALESCE_RULE_PKT_PATTERN] = { .type = NLA_NESTED },
  809. };
  810. /* policy for GTK rekey offload attributes */
  811. static const struct nla_policy
  812. nl80211_rekey_policy[NUM_NL80211_REKEY_DATA] = {
  813. [NL80211_REKEY_DATA_KEK] = {
  814. .type = NLA_BINARY,
  815. .len = NL80211_KEK_EXT_LEN
  816. },
  817. [NL80211_REKEY_DATA_KCK] = {
  818. .type = NLA_BINARY,
  819. .len = NL80211_KCK_EXT_LEN_32
  820. },
  821. [NL80211_REKEY_DATA_REPLAY_CTR] = NLA_POLICY_EXACT_LEN(NL80211_REPLAY_CTR_LEN),
  822. [NL80211_REKEY_DATA_AKM] = { .type = NLA_U32 },
  823. };
  824. static const struct nla_policy
  825. nl80211_match_policy[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1] = {
  826. [NL80211_SCHED_SCAN_MATCH_ATTR_SSID] = { .type = NLA_BINARY,
  827. .len = IEEE80211_MAX_SSID_LEN },
  828. [NL80211_SCHED_SCAN_MATCH_ATTR_BSSID] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  829. [NL80211_SCHED_SCAN_MATCH_ATTR_RSSI] = { .type = NLA_U32 },
  830. };
  831. static const struct nla_policy
  832. nl80211_plan_policy[NL80211_SCHED_SCAN_PLAN_MAX + 1] = {
  833. [NL80211_SCHED_SCAN_PLAN_INTERVAL] = { .type = NLA_U32 },
  834. [NL80211_SCHED_SCAN_PLAN_ITERATIONS] = { .type = NLA_U32 },
  835. };
  836. static const struct nla_policy
  837. nl80211_bss_select_policy[NL80211_BSS_SELECT_ATTR_MAX + 1] = {
  838. [NL80211_BSS_SELECT_ATTR_RSSI] = { .type = NLA_FLAG },
  839. [NL80211_BSS_SELECT_ATTR_BAND_PREF] = { .type = NLA_U32 },
  840. [NL80211_BSS_SELECT_ATTR_RSSI_ADJUST] = {
  841. .len = sizeof(struct nl80211_bss_select_rssi_adjust)
  842. },
  843. };
  844. /* policy for NAN function attributes */
  845. static const struct nla_policy
  846. nl80211_nan_func_policy[NL80211_NAN_FUNC_ATTR_MAX + 1] = {
  847. [NL80211_NAN_FUNC_TYPE] =
  848. NLA_POLICY_MAX(NLA_U8, NL80211_NAN_FUNC_MAX_TYPE),
  849. [NL80211_NAN_FUNC_SERVICE_ID] = {
  850. .len = NL80211_NAN_FUNC_SERVICE_ID_LEN },
  851. [NL80211_NAN_FUNC_PUBLISH_TYPE] = { .type = NLA_U8 },
  852. [NL80211_NAN_FUNC_PUBLISH_BCAST] = { .type = NLA_FLAG },
  853. [NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE] = { .type = NLA_FLAG },
  854. [NL80211_NAN_FUNC_FOLLOW_UP_ID] = { .type = NLA_U8 },
  855. [NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] = { .type = NLA_U8 },
  856. [NL80211_NAN_FUNC_FOLLOW_UP_DEST] = NLA_POLICY_EXACT_LEN_WARN(ETH_ALEN),
  857. [NL80211_NAN_FUNC_CLOSE_RANGE] = { .type = NLA_FLAG },
  858. [NL80211_NAN_FUNC_TTL] = { .type = NLA_U32 },
  859. [NL80211_NAN_FUNC_SERVICE_INFO] = { .type = NLA_BINARY,
  860. .len = NL80211_NAN_FUNC_SERVICE_SPEC_INFO_MAX_LEN },
  861. [NL80211_NAN_FUNC_SRF] = { .type = NLA_NESTED },
  862. [NL80211_NAN_FUNC_RX_MATCH_FILTER] = { .type = NLA_NESTED },
  863. [NL80211_NAN_FUNC_TX_MATCH_FILTER] = { .type = NLA_NESTED },
  864. [NL80211_NAN_FUNC_INSTANCE_ID] = { .type = NLA_U8 },
  865. [NL80211_NAN_FUNC_TERM_REASON] = { .type = NLA_U8 },
  866. };
  867. /* policy for Service Response Filter attributes */
  868. static const struct nla_policy
  869. nl80211_nan_srf_policy[NL80211_NAN_SRF_ATTR_MAX + 1] = {
  870. [NL80211_NAN_SRF_INCLUDE] = { .type = NLA_FLAG },
  871. [NL80211_NAN_SRF_BF] = { .type = NLA_BINARY,
  872. .len = NL80211_NAN_FUNC_SRF_MAX_LEN },
  873. [NL80211_NAN_SRF_BF_IDX] = { .type = NLA_U8 },
  874. [NL80211_NAN_SRF_MAC_ADDRS] = { .type = NLA_NESTED },
  875. };
  876. /* policy for packet pattern attributes */
  877. static const struct nla_policy
  878. nl80211_packet_pattern_policy[MAX_NL80211_PKTPAT + 1] = {
  879. [NL80211_PKTPAT_MASK] = { .type = NLA_BINARY, },
  880. [NL80211_PKTPAT_PATTERN] = { .type = NLA_BINARY, },
  881. [NL80211_PKTPAT_OFFSET] = { .type = NLA_U32 },
  882. };
  883. static int nl80211_prepare_wdev_dump(struct netlink_callback *cb,
  884. struct cfg80211_registered_device **rdev,
  885. struct wireless_dev **wdev,
  886. struct nlattr **attrbuf)
  887. {
  888. int err;
  889. if (!cb->args[0]) {
  890. struct nlattr **attrbuf_free = NULL;
  891. if (!attrbuf) {
  892. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
  893. GFP_KERNEL);
  894. if (!attrbuf)
  895. return -ENOMEM;
  896. attrbuf_free = attrbuf;
  897. }
  898. err = nlmsg_parse_deprecated(cb->nlh,
  899. GENL_HDRLEN + nl80211_fam.hdrsize,
  900. attrbuf, nl80211_fam.maxattr,
  901. nl80211_policy, NULL);
  902. if (err) {
  903. kfree(attrbuf_free);
  904. return err;
  905. }
  906. rtnl_lock();
  907. *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(cb->skb->sk),
  908. attrbuf);
  909. kfree(attrbuf_free);
  910. if (IS_ERR(*wdev)) {
  911. rtnl_unlock();
  912. return PTR_ERR(*wdev);
  913. }
  914. *rdev = wiphy_to_rdev((*wdev)->wiphy);
  915. mutex_lock(&(*rdev)->wiphy.mtx);
  916. rtnl_unlock();
  917. /* 0 is the first index - add 1 to parse only once */
  918. cb->args[0] = (*rdev)->wiphy_idx + 1;
  919. cb->args[1] = (*wdev)->identifier;
  920. } else {
  921. /* subtract the 1 again here */
  922. struct wiphy *wiphy;
  923. struct wireless_dev *tmp;
  924. rtnl_lock();
  925. wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
  926. if (!wiphy) {
  927. rtnl_unlock();
  928. return -ENODEV;
  929. }
  930. *rdev = wiphy_to_rdev(wiphy);
  931. *wdev = NULL;
  932. list_for_each_entry(tmp, &(*rdev)->wiphy.wdev_list, list) {
  933. if (tmp->identifier == cb->args[1]) {
  934. *wdev = tmp;
  935. break;
  936. }
  937. }
  938. if (!*wdev) {
  939. rtnl_unlock();
  940. return -ENODEV;
  941. }
  942. mutex_lock(&(*rdev)->wiphy.mtx);
  943. rtnl_unlock();
  944. }
  945. return 0;
  946. }
  947. /* message building helper */
  948. void *nl80211hdr_put(struct sk_buff *skb, u32 portid, u32 seq,
  949. int flags, u8 cmd)
  950. {
  951. /* since there is no private header just add the generic one */
  952. return genlmsg_put(skb, portid, seq, &nl80211_fam, flags, cmd);
  953. }
  954. static int nl80211_msg_put_wmm_rules(struct sk_buff *msg,
  955. const struct ieee80211_reg_rule *rule)
  956. {
  957. int j;
  958. struct nlattr *nl_wmm_rules =
  959. nla_nest_start_noflag(msg, NL80211_FREQUENCY_ATTR_WMM);
  960. if (!nl_wmm_rules)
  961. goto nla_put_failure;
  962. for (j = 0; j < IEEE80211_NUM_ACS; j++) {
  963. struct nlattr *nl_wmm_rule = nla_nest_start_noflag(msg, j);
  964. if (!nl_wmm_rule)
  965. goto nla_put_failure;
  966. if (nla_put_u16(msg, NL80211_WMMR_CW_MIN,
  967. rule->wmm_rule.client[j].cw_min) ||
  968. nla_put_u16(msg, NL80211_WMMR_CW_MAX,
  969. rule->wmm_rule.client[j].cw_max) ||
  970. nla_put_u8(msg, NL80211_WMMR_AIFSN,
  971. rule->wmm_rule.client[j].aifsn) ||
  972. nla_put_u16(msg, NL80211_WMMR_TXOP,
  973. rule->wmm_rule.client[j].cot))
  974. goto nla_put_failure;
  975. nla_nest_end(msg, nl_wmm_rule);
  976. }
  977. nla_nest_end(msg, nl_wmm_rules);
  978. return 0;
  979. nla_put_failure:
  980. return -ENOBUFS;
  981. }
  982. static int nl80211_msg_put_channel(struct sk_buff *msg, struct wiphy *wiphy,
  983. struct ieee80211_channel *chan,
  984. bool large)
  985. {
  986. /* Some channels must be completely excluded from the
  987. * list to protect old user-space tools from breaking
  988. */
  989. if (!large && chan->flags &
  990. (IEEE80211_CHAN_NO_10MHZ | IEEE80211_CHAN_NO_20MHZ))
  991. return 0;
  992. if (!large && chan->freq_offset)
  993. return 0;
  994. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_FREQ,
  995. chan->center_freq))
  996. goto nla_put_failure;
  997. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_OFFSET, chan->freq_offset))
  998. goto nla_put_failure;
  999. if ((chan->flags & IEEE80211_CHAN_PSD) &&
  1000. nla_put_s8(msg, NL80211_FREQUENCY_ATTR_PSD, chan->psd))
  1001. goto nla_put_failure;
  1002. if ((chan->flags & IEEE80211_CHAN_DISABLED) &&
  1003. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DISABLED))
  1004. goto nla_put_failure;
  1005. if (chan->flags & IEEE80211_CHAN_NO_IR) {
  1006. if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_IR))
  1007. goto nla_put_failure;
  1008. if (nla_put_flag(msg, __NL80211_FREQUENCY_ATTR_NO_IBSS))
  1009. goto nla_put_failure;
  1010. }
  1011. if (chan->flags & IEEE80211_CHAN_RADAR) {
  1012. if (nla_put_flag(msg, NL80211_FREQUENCY_ATTR_RADAR))
  1013. goto nla_put_failure;
  1014. if (large) {
  1015. u32 time;
  1016. time = elapsed_jiffies_msecs(chan->dfs_state_entered);
  1017. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_STATE,
  1018. chan->dfs_state))
  1019. goto nla_put_failure;
  1020. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_DFS_TIME,
  1021. time))
  1022. goto nla_put_failure;
  1023. if (nla_put_u32(msg,
  1024. NL80211_FREQUENCY_ATTR_DFS_CAC_TIME,
  1025. chan->dfs_cac_ms))
  1026. goto nla_put_failure;
  1027. }
  1028. }
  1029. if (large) {
  1030. if ((chan->flags & IEEE80211_CHAN_NO_HT40MINUS) &&
  1031. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_MINUS))
  1032. goto nla_put_failure;
  1033. if ((chan->flags & IEEE80211_CHAN_NO_HT40PLUS) &&
  1034. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HT40_PLUS))
  1035. goto nla_put_failure;
  1036. if ((chan->flags & IEEE80211_CHAN_NO_80MHZ) &&
  1037. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_80MHZ))
  1038. goto nla_put_failure;
  1039. if ((chan->flags & IEEE80211_CHAN_NO_160MHZ) &&
  1040. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_160MHZ))
  1041. goto nla_put_failure;
  1042. if ((chan->flags & IEEE80211_CHAN_INDOOR_ONLY) &&
  1043. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_INDOOR_ONLY))
  1044. goto nla_put_failure;
  1045. if ((chan->flags & IEEE80211_CHAN_IR_CONCURRENT) &&
  1046. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_IR_CONCURRENT))
  1047. goto nla_put_failure;
  1048. if ((chan->flags & IEEE80211_CHAN_NO_20MHZ) &&
  1049. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_20MHZ))
  1050. goto nla_put_failure;
  1051. if ((chan->flags & IEEE80211_CHAN_NO_10MHZ) &&
  1052. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_10MHZ))
  1053. goto nla_put_failure;
  1054. if ((chan->flags & IEEE80211_CHAN_NO_HE) &&
  1055. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_HE))
  1056. goto nla_put_failure;
  1057. if ((chan->flags & IEEE80211_CHAN_1MHZ) &&
  1058. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_1MHZ))
  1059. goto nla_put_failure;
  1060. if ((chan->flags & IEEE80211_CHAN_2MHZ) &&
  1061. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_2MHZ))
  1062. goto nla_put_failure;
  1063. if ((chan->flags & IEEE80211_CHAN_4MHZ) &&
  1064. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_4MHZ))
  1065. goto nla_put_failure;
  1066. if ((chan->flags & IEEE80211_CHAN_8MHZ) &&
  1067. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_8MHZ))
  1068. goto nla_put_failure;
  1069. if ((chan->flags & IEEE80211_CHAN_16MHZ) &&
  1070. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_16MHZ))
  1071. goto nla_put_failure;
  1072. if ((chan->flags & IEEE80211_CHAN_NO_320MHZ) &&
  1073. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_320MHZ))
  1074. goto nla_put_failure;
  1075. if ((chan->flags & IEEE80211_CHAN_NO_EHT) &&
  1076. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_EHT))
  1077. goto nla_put_failure;
  1078. if ((chan->flags & IEEE80211_CHAN_DFS_CONCURRENT) &&
  1079. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_DFS_CONCURRENT))
  1080. goto nla_put_failure;
  1081. if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_VLP_CLIENT) &&
  1082. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_VLP_CLIENT))
  1083. goto nla_put_failure;
  1084. if ((chan->flags & IEEE80211_CHAN_NO_6GHZ_AFC_CLIENT) &&
  1085. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_NO_6GHZ_AFC_CLIENT))
  1086. goto nla_put_failure;
  1087. if ((chan->flags & IEEE80211_CHAN_CAN_MONITOR) &&
  1088. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_CAN_MONITOR))
  1089. goto nla_put_failure;
  1090. if ((chan->flags & IEEE80211_CHAN_ALLOW_6GHZ_VLP_AP) &&
  1091. nla_put_flag(msg, NL80211_FREQUENCY_ATTR_ALLOW_6GHZ_VLP_AP))
  1092. goto nla_put_failure;
  1093. if ((chan->flags & IEEE80211_CHAN_ALLOW_20MHZ_ACTIVITY) &&
  1094. nla_put_flag(msg,
  1095. NL80211_FREQUENCY_ATTR_ALLOW_20MHZ_ACTIVITY))
  1096. goto nla_put_failure;
  1097. }
  1098. if (nla_put_u32(msg, NL80211_FREQUENCY_ATTR_MAX_TX_POWER,
  1099. DBM_TO_MBM(chan->max_power)))
  1100. goto nla_put_failure;
  1101. if (large) {
  1102. const struct ieee80211_reg_rule *rule =
  1103. freq_reg_info(wiphy, MHZ_TO_KHZ(chan->center_freq));
  1104. if (!IS_ERR_OR_NULL(rule) && rule->has_wmm) {
  1105. if (nl80211_msg_put_wmm_rules(msg, rule))
  1106. goto nla_put_failure;
  1107. }
  1108. }
  1109. return 0;
  1110. nla_put_failure:
  1111. return -ENOBUFS;
  1112. }
  1113. static bool nl80211_put_txq_stats(struct sk_buff *msg,
  1114. struct cfg80211_txq_stats *txqstats,
  1115. int attrtype)
  1116. {
  1117. struct nlattr *txqattr;
  1118. #define PUT_TXQVAL_U32(attr, memb) do { \
  1119. if (txqstats->filled & BIT(NL80211_TXQ_STATS_ ## attr) && \
  1120. nla_put_u32(msg, NL80211_TXQ_STATS_ ## attr, txqstats->memb)) \
  1121. return false; \
  1122. } while (0)
  1123. txqattr = nla_nest_start_noflag(msg, attrtype);
  1124. if (!txqattr)
  1125. return false;
  1126. PUT_TXQVAL_U32(BACKLOG_BYTES, backlog_bytes);
  1127. PUT_TXQVAL_U32(BACKLOG_PACKETS, backlog_packets);
  1128. PUT_TXQVAL_U32(FLOWS, flows);
  1129. PUT_TXQVAL_U32(DROPS, drops);
  1130. PUT_TXQVAL_U32(ECN_MARKS, ecn_marks);
  1131. PUT_TXQVAL_U32(OVERLIMIT, overlimit);
  1132. PUT_TXQVAL_U32(OVERMEMORY, overmemory);
  1133. PUT_TXQVAL_U32(COLLISIONS, collisions);
  1134. PUT_TXQVAL_U32(TX_BYTES, tx_bytes);
  1135. PUT_TXQVAL_U32(TX_PACKETS, tx_packets);
  1136. PUT_TXQVAL_U32(MAX_FLOWS, max_flows);
  1137. nla_nest_end(msg, txqattr);
  1138. #undef PUT_TXQVAL_U32
  1139. return true;
  1140. }
  1141. /* netlink command implementations */
  1142. /**
  1143. * nl80211_link_id - return link ID
  1144. * @attrs: attributes to look at
  1145. *
  1146. * Returns: the link ID or 0 if not given
  1147. *
  1148. * Note this function doesn't do any validation of the link
  1149. * ID validity wrt. links that were actually added, so it must
  1150. * be called only from ops with %NL80211_FLAG_MLO_VALID_LINK_ID
  1151. * or if additional validation is done.
  1152. */
  1153. static unsigned int nl80211_link_id(struct nlattr **attrs)
  1154. {
  1155. struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID];
  1156. if (!linkid)
  1157. return 0;
  1158. return nla_get_u8(linkid);
  1159. }
  1160. static int nl80211_link_id_or_invalid(struct nlattr **attrs)
  1161. {
  1162. struct nlattr *linkid = attrs[NL80211_ATTR_MLO_LINK_ID];
  1163. if (!linkid)
  1164. return -1;
  1165. return nla_get_u8(linkid);
  1166. }
  1167. struct key_parse {
  1168. struct key_params p;
  1169. int idx;
  1170. int type;
  1171. bool def, defmgmt, defbeacon;
  1172. bool def_uni, def_multi;
  1173. };
  1174. static int nl80211_parse_key_new(struct genl_info *info, struct nlattr *key,
  1175. struct key_parse *k)
  1176. {
  1177. struct nlattr *tb[NL80211_KEY_MAX + 1];
  1178. int err = nla_parse_nested_deprecated(tb, NL80211_KEY_MAX, key,
  1179. nl80211_key_policy,
  1180. info->extack);
  1181. if (err)
  1182. return err;
  1183. k->def = !!tb[NL80211_KEY_DEFAULT];
  1184. k->defmgmt = !!tb[NL80211_KEY_DEFAULT_MGMT];
  1185. k->defbeacon = !!tb[NL80211_KEY_DEFAULT_BEACON];
  1186. if (k->def) {
  1187. k->def_uni = true;
  1188. k->def_multi = true;
  1189. }
  1190. if (k->defmgmt || k->defbeacon)
  1191. k->def_multi = true;
  1192. if (tb[NL80211_KEY_IDX])
  1193. k->idx = nla_get_u8(tb[NL80211_KEY_IDX]);
  1194. if (tb[NL80211_KEY_DATA]) {
  1195. k->p.key = nla_data(tb[NL80211_KEY_DATA]);
  1196. k->p.key_len = nla_len(tb[NL80211_KEY_DATA]);
  1197. }
  1198. if (tb[NL80211_KEY_SEQ]) {
  1199. k->p.seq = nla_data(tb[NL80211_KEY_SEQ]);
  1200. k->p.seq_len = nla_len(tb[NL80211_KEY_SEQ]);
  1201. }
  1202. if (tb[NL80211_KEY_CIPHER])
  1203. k->p.cipher = nla_get_u32(tb[NL80211_KEY_CIPHER]);
  1204. if (tb[NL80211_KEY_TYPE])
  1205. k->type = nla_get_u32(tb[NL80211_KEY_TYPE]);
  1206. if (tb[NL80211_KEY_DEFAULT_TYPES]) {
  1207. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  1208. err = nla_parse_nested_deprecated(kdt,
  1209. NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  1210. tb[NL80211_KEY_DEFAULT_TYPES],
  1211. nl80211_key_default_policy,
  1212. info->extack);
  1213. if (err)
  1214. return err;
  1215. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  1216. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  1217. }
  1218. if (tb[NL80211_KEY_MODE])
  1219. k->p.mode = nla_get_u8(tb[NL80211_KEY_MODE]);
  1220. return 0;
  1221. }
  1222. static int nl80211_parse_key_old(struct genl_info *info, struct key_parse *k)
  1223. {
  1224. if (info->attrs[NL80211_ATTR_KEY_DATA]) {
  1225. k->p.key = nla_data(info->attrs[NL80211_ATTR_KEY_DATA]);
  1226. k->p.key_len = nla_len(info->attrs[NL80211_ATTR_KEY_DATA]);
  1227. }
  1228. if (info->attrs[NL80211_ATTR_KEY_SEQ]) {
  1229. k->p.seq = nla_data(info->attrs[NL80211_ATTR_KEY_SEQ]);
  1230. k->p.seq_len = nla_len(info->attrs[NL80211_ATTR_KEY_SEQ]);
  1231. }
  1232. if (info->attrs[NL80211_ATTR_KEY_IDX])
  1233. k->idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  1234. if (info->attrs[NL80211_ATTR_KEY_CIPHER])
  1235. k->p.cipher = nla_get_u32(info->attrs[NL80211_ATTR_KEY_CIPHER]);
  1236. k->def = !!info->attrs[NL80211_ATTR_KEY_DEFAULT];
  1237. k->defmgmt = !!info->attrs[NL80211_ATTR_KEY_DEFAULT_MGMT];
  1238. if (k->def) {
  1239. k->def_uni = true;
  1240. k->def_multi = true;
  1241. }
  1242. if (k->defmgmt)
  1243. k->def_multi = true;
  1244. if (info->attrs[NL80211_ATTR_KEY_TYPE])
  1245. k->type = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  1246. if (info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES]) {
  1247. struct nlattr *kdt[NUM_NL80211_KEY_DEFAULT_TYPES];
  1248. int err = nla_parse_nested_deprecated(kdt,
  1249. NUM_NL80211_KEY_DEFAULT_TYPES - 1,
  1250. info->attrs[NL80211_ATTR_KEY_DEFAULT_TYPES],
  1251. nl80211_key_default_policy,
  1252. info->extack);
  1253. if (err)
  1254. return err;
  1255. k->def_uni = kdt[NL80211_KEY_DEFAULT_TYPE_UNICAST];
  1256. k->def_multi = kdt[NL80211_KEY_DEFAULT_TYPE_MULTICAST];
  1257. }
  1258. return 0;
  1259. }
  1260. static int nl80211_parse_key(struct genl_info *info, struct key_parse *k)
  1261. {
  1262. int err;
  1263. memset(k, 0, sizeof(*k));
  1264. k->idx = -1;
  1265. k->type = -1;
  1266. if (info->attrs[NL80211_ATTR_KEY])
  1267. err = nl80211_parse_key_new(info, info->attrs[NL80211_ATTR_KEY], k);
  1268. else
  1269. err = nl80211_parse_key_old(info, k);
  1270. if (err)
  1271. return err;
  1272. if ((k->def ? 1 : 0) + (k->defmgmt ? 1 : 0) +
  1273. (k->defbeacon ? 1 : 0) > 1) {
  1274. GENL_SET_ERR_MSG(info,
  1275. "key with multiple default flags is invalid");
  1276. return -EINVAL;
  1277. }
  1278. if (k->defmgmt || k->defbeacon) {
  1279. if (k->def_uni || !k->def_multi) {
  1280. GENL_SET_ERR_MSG(info,
  1281. "defmgmt/defbeacon key must be mcast");
  1282. return -EINVAL;
  1283. }
  1284. }
  1285. if (k->idx != -1) {
  1286. if (k->defmgmt) {
  1287. if (k->idx < 4 || k->idx > 5) {
  1288. GENL_SET_ERR_MSG(info,
  1289. "defmgmt key idx not 4 or 5");
  1290. return -EINVAL;
  1291. }
  1292. } else if (k->defbeacon) {
  1293. if (k->idx < 6 || k->idx > 7) {
  1294. GENL_SET_ERR_MSG(info,
  1295. "defbeacon key idx not 6 or 7");
  1296. return -EINVAL;
  1297. }
  1298. } else if (k->def) {
  1299. if (k->idx < 0 || k->idx > 3) {
  1300. GENL_SET_ERR_MSG(info, "def key idx not 0-3");
  1301. return -EINVAL;
  1302. }
  1303. } else {
  1304. if (k->idx < 0 || k->idx > 7) {
  1305. GENL_SET_ERR_MSG(info, "key idx not 0-7");
  1306. return -EINVAL;
  1307. }
  1308. }
  1309. }
  1310. return 0;
  1311. }
  1312. static struct cfg80211_cached_keys *
  1313. nl80211_parse_connkeys(struct cfg80211_registered_device *rdev,
  1314. struct genl_info *info, bool *no_ht)
  1315. {
  1316. struct nlattr *keys = info->attrs[NL80211_ATTR_KEYS];
  1317. struct key_parse parse;
  1318. struct nlattr *key;
  1319. struct cfg80211_cached_keys *result;
  1320. int rem, err, def = 0;
  1321. bool have_key = false;
  1322. nla_for_each_nested(key, keys, rem) {
  1323. have_key = true;
  1324. break;
  1325. }
  1326. if (!have_key)
  1327. return NULL;
  1328. result = kzalloc(sizeof(*result), GFP_KERNEL);
  1329. if (!result)
  1330. return ERR_PTR(-ENOMEM);
  1331. result->def = -1;
  1332. nla_for_each_nested(key, keys, rem) {
  1333. memset(&parse, 0, sizeof(parse));
  1334. parse.idx = -1;
  1335. err = nl80211_parse_key_new(info, key, &parse);
  1336. if (err)
  1337. goto error;
  1338. err = -EINVAL;
  1339. if (!parse.p.key)
  1340. goto error;
  1341. if (parse.idx < 0 || parse.idx > 3) {
  1342. GENL_SET_ERR_MSG(info, "key index out of range [0-3]");
  1343. goto error;
  1344. }
  1345. if (parse.def) {
  1346. if (def) {
  1347. GENL_SET_ERR_MSG(info,
  1348. "only one key can be default");
  1349. goto error;
  1350. }
  1351. def = 1;
  1352. result->def = parse.idx;
  1353. if (!parse.def_uni || !parse.def_multi)
  1354. goto error;
  1355. } else if (parse.defmgmt)
  1356. goto error;
  1357. err = cfg80211_validate_key_settings(rdev, &parse.p,
  1358. parse.idx, false, NULL);
  1359. if (err)
  1360. goto error;
  1361. if (parse.p.cipher != WLAN_CIPHER_SUITE_WEP40 &&
  1362. parse.p.cipher != WLAN_CIPHER_SUITE_WEP104) {
  1363. GENL_SET_ERR_MSG(info, "connect key must be WEP");
  1364. err = -EINVAL;
  1365. goto error;
  1366. }
  1367. result->params[parse.idx].cipher = parse.p.cipher;
  1368. result->params[parse.idx].key_len = parse.p.key_len;
  1369. result->params[parse.idx].key = result->data[parse.idx];
  1370. memcpy(result->data[parse.idx], parse.p.key, parse.p.key_len);
  1371. /* must be WEP key if we got here */
  1372. if (no_ht)
  1373. *no_ht = true;
  1374. }
  1375. if (result->def < 0) {
  1376. err = -EINVAL;
  1377. GENL_SET_ERR_MSG(info, "need a default/TX key");
  1378. goto error;
  1379. }
  1380. return result;
  1381. error:
  1382. kfree(result);
  1383. return ERR_PTR(err);
  1384. }
  1385. static int nl80211_key_allowed(struct wireless_dev *wdev)
  1386. {
  1387. lockdep_assert_wiphy(wdev->wiphy);
  1388. switch (wdev->iftype) {
  1389. case NL80211_IFTYPE_AP:
  1390. case NL80211_IFTYPE_AP_VLAN:
  1391. case NL80211_IFTYPE_P2P_GO:
  1392. case NL80211_IFTYPE_MESH_POINT:
  1393. break;
  1394. case NL80211_IFTYPE_ADHOC:
  1395. if (wdev->u.ibss.current_bss)
  1396. return 0;
  1397. return -ENOLINK;
  1398. case NL80211_IFTYPE_STATION:
  1399. case NL80211_IFTYPE_P2P_CLIENT:
  1400. if (wdev->connected)
  1401. return 0;
  1402. return -ENOLINK;
  1403. case NL80211_IFTYPE_NAN:
  1404. if (wiphy_ext_feature_isset(wdev->wiphy,
  1405. NL80211_EXT_FEATURE_SECURE_NAN))
  1406. return 0;
  1407. return -EINVAL;
  1408. case NL80211_IFTYPE_UNSPECIFIED:
  1409. case NL80211_IFTYPE_OCB:
  1410. case NL80211_IFTYPE_MONITOR:
  1411. case NL80211_IFTYPE_P2P_DEVICE:
  1412. case NL80211_IFTYPE_WDS:
  1413. case NUM_NL80211_IFTYPES:
  1414. return -EINVAL;
  1415. }
  1416. return 0;
  1417. }
  1418. static struct ieee80211_channel *nl80211_get_valid_chan(struct wiphy *wiphy,
  1419. u32 freq)
  1420. {
  1421. struct ieee80211_channel *chan;
  1422. chan = ieee80211_get_channel_khz(wiphy, freq);
  1423. if (!chan || chan->flags & IEEE80211_CHAN_DISABLED)
  1424. return NULL;
  1425. return chan;
  1426. }
  1427. static int nl80211_put_iftypes(struct sk_buff *msg, u32 attr, u16 ifmodes)
  1428. {
  1429. struct nlattr *nl_modes = nla_nest_start_noflag(msg, attr);
  1430. int i;
  1431. if (!nl_modes)
  1432. goto nla_put_failure;
  1433. i = 0;
  1434. while (ifmodes) {
  1435. if ((ifmodes & 1) && nla_put_flag(msg, i))
  1436. goto nla_put_failure;
  1437. ifmodes >>= 1;
  1438. i++;
  1439. }
  1440. nla_nest_end(msg, nl_modes);
  1441. return 0;
  1442. nla_put_failure:
  1443. return -ENOBUFS;
  1444. }
  1445. static int nl80211_put_ifcomb_data(struct sk_buff *msg, bool large, int idx,
  1446. const struct ieee80211_iface_combination *c,
  1447. u16 nested)
  1448. {
  1449. struct nlattr *nl_combi, *nl_limits;
  1450. int i;
  1451. nl_combi = nla_nest_start_noflag(msg, idx | nested);
  1452. if (!nl_combi)
  1453. goto nla_put_failure;
  1454. nl_limits = nla_nest_start_noflag(msg, NL80211_IFACE_COMB_LIMITS |
  1455. nested);
  1456. if (!nl_limits)
  1457. goto nla_put_failure;
  1458. for (i = 0; i < c->n_limits; i++) {
  1459. struct nlattr *nl_limit;
  1460. nl_limit = nla_nest_start_noflag(msg, i + 1);
  1461. if (!nl_limit)
  1462. goto nla_put_failure;
  1463. if (nla_put_u32(msg, NL80211_IFACE_LIMIT_MAX, c->limits[i].max))
  1464. goto nla_put_failure;
  1465. if (nl80211_put_iftypes(msg, NL80211_IFACE_LIMIT_TYPES,
  1466. c->limits[i].types))
  1467. goto nla_put_failure;
  1468. nla_nest_end(msg, nl_limit);
  1469. }
  1470. nla_nest_end(msg, nl_limits);
  1471. if (c->beacon_int_infra_match &&
  1472. nla_put_flag(msg, NL80211_IFACE_COMB_STA_AP_BI_MATCH))
  1473. goto nla_put_failure;
  1474. if (nla_put_u32(msg, NL80211_IFACE_COMB_NUM_CHANNELS,
  1475. c->num_different_channels) ||
  1476. nla_put_u32(msg, NL80211_IFACE_COMB_MAXNUM,
  1477. c->max_interfaces))
  1478. goto nla_put_failure;
  1479. if (large &&
  1480. (nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_WIDTHS,
  1481. c->radar_detect_widths) ||
  1482. nla_put_u32(msg, NL80211_IFACE_COMB_RADAR_DETECT_REGIONS,
  1483. c->radar_detect_regions)))
  1484. goto nla_put_failure;
  1485. if (c->beacon_int_min_gcd &&
  1486. nla_put_u32(msg, NL80211_IFACE_COMB_BI_MIN_GCD,
  1487. c->beacon_int_min_gcd))
  1488. goto nla_put_failure;
  1489. nla_nest_end(msg, nl_combi);
  1490. return 0;
  1491. nla_put_failure:
  1492. return -ENOBUFS;
  1493. }
  1494. static int nl80211_put_iface_combinations(struct wiphy *wiphy,
  1495. struct sk_buff *msg,
  1496. int attr, int radio,
  1497. bool large, u16 nested)
  1498. {
  1499. const struct ieee80211_iface_combination *c;
  1500. struct nlattr *nl_combis;
  1501. int i, n;
  1502. nl_combis = nla_nest_start_noflag(msg, attr | nested);
  1503. if (!nl_combis)
  1504. goto nla_put_failure;
  1505. if (radio >= 0) {
  1506. c = wiphy->radio[0].iface_combinations;
  1507. n = wiphy->radio[0].n_iface_combinations;
  1508. } else {
  1509. c = wiphy->iface_combinations;
  1510. n = wiphy->n_iface_combinations;
  1511. }
  1512. for (i = 0; i < n; i++)
  1513. if (nl80211_put_ifcomb_data(msg, large, i + 1, &c[i], nested))
  1514. goto nla_put_failure;
  1515. nla_nest_end(msg, nl_combis);
  1516. return 0;
  1517. nla_put_failure:
  1518. return -ENOBUFS;
  1519. }
  1520. #ifdef CONFIG_PM
  1521. static int nl80211_send_wowlan_tcp_caps(struct cfg80211_registered_device *rdev,
  1522. struct sk_buff *msg)
  1523. {
  1524. const struct wiphy_wowlan_tcp_support *tcp = rdev->wiphy.wowlan->tcp;
  1525. struct nlattr *nl_tcp;
  1526. if (!tcp)
  1527. return 0;
  1528. nl_tcp = nla_nest_start_noflag(msg,
  1529. NL80211_WOWLAN_TRIG_TCP_CONNECTION);
  1530. if (!nl_tcp)
  1531. return -ENOBUFS;
  1532. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  1533. tcp->data_payload_max))
  1534. return -ENOBUFS;
  1535. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  1536. tcp->data_payload_max))
  1537. return -ENOBUFS;
  1538. if (tcp->seq && nla_put_flag(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ))
  1539. return -ENOBUFS;
  1540. if (tcp->tok && nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
  1541. sizeof(*tcp->tok), tcp->tok))
  1542. return -ENOBUFS;
  1543. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
  1544. tcp->data_interval_max))
  1545. return -ENOBUFS;
  1546. if (nla_put_u32(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
  1547. tcp->wake_payload_max))
  1548. return -ENOBUFS;
  1549. nla_nest_end(msg, nl_tcp);
  1550. return 0;
  1551. }
  1552. static int nl80211_send_wowlan(struct sk_buff *msg,
  1553. struct cfg80211_registered_device *rdev,
  1554. bool large)
  1555. {
  1556. struct nlattr *nl_wowlan;
  1557. if (!rdev->wiphy.wowlan)
  1558. return 0;
  1559. nl_wowlan = nla_nest_start_noflag(msg,
  1560. NL80211_ATTR_WOWLAN_TRIGGERS_SUPPORTED);
  1561. if (!nl_wowlan)
  1562. return -ENOBUFS;
  1563. if (((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_ANY) &&
  1564. nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
  1565. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_DISCONNECT) &&
  1566. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
  1567. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT) &&
  1568. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
  1569. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY) &&
  1570. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED)) ||
  1571. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
  1572. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
  1573. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ) &&
  1574. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
  1575. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE) &&
  1576. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
  1577. ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE) &&
  1578. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
  1579. return -ENOBUFS;
  1580. if (rdev->wiphy.wowlan->n_patterns) {
  1581. struct nl80211_pattern_support pat = {
  1582. .max_patterns = rdev->wiphy.wowlan->n_patterns,
  1583. .min_pattern_len = rdev->wiphy.wowlan->pattern_min_len,
  1584. .max_pattern_len = rdev->wiphy.wowlan->pattern_max_len,
  1585. .max_pkt_offset = rdev->wiphy.wowlan->max_pkt_offset,
  1586. };
  1587. if (nla_put(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  1588. sizeof(pat), &pat))
  1589. return -ENOBUFS;
  1590. }
  1591. if ((rdev->wiphy.wowlan->flags & WIPHY_WOWLAN_NET_DETECT) &&
  1592. nla_put_u32(msg, NL80211_WOWLAN_TRIG_NET_DETECT,
  1593. rdev->wiphy.wowlan->max_nd_match_sets))
  1594. return -ENOBUFS;
  1595. if (large && nl80211_send_wowlan_tcp_caps(rdev, msg))
  1596. return -ENOBUFS;
  1597. nla_nest_end(msg, nl_wowlan);
  1598. return 0;
  1599. }
  1600. #endif
  1601. static int nl80211_send_coalesce(struct sk_buff *msg,
  1602. struct cfg80211_registered_device *rdev)
  1603. {
  1604. struct nl80211_coalesce_rule_support rule;
  1605. if (!rdev->wiphy.coalesce)
  1606. return 0;
  1607. rule.max_rules = rdev->wiphy.coalesce->n_rules;
  1608. rule.max_delay = rdev->wiphy.coalesce->max_delay;
  1609. rule.pat.max_patterns = rdev->wiphy.coalesce->n_patterns;
  1610. rule.pat.min_pattern_len = rdev->wiphy.coalesce->pattern_min_len;
  1611. rule.pat.max_pattern_len = rdev->wiphy.coalesce->pattern_max_len;
  1612. rule.pat.max_pkt_offset = rdev->wiphy.coalesce->max_pkt_offset;
  1613. if (nla_put(msg, NL80211_ATTR_COALESCE_RULE, sizeof(rule), &rule))
  1614. return -ENOBUFS;
  1615. return 0;
  1616. }
  1617. static int
  1618. nl80211_send_iftype_data(struct sk_buff *msg,
  1619. const struct ieee80211_supported_band *sband,
  1620. const struct ieee80211_sband_iftype_data *iftdata)
  1621. {
  1622. const struct ieee80211_sta_he_cap *he_cap = &iftdata->he_cap;
  1623. const struct ieee80211_sta_eht_cap *eht_cap = &iftdata->eht_cap;
  1624. if (nl80211_put_iftypes(msg, NL80211_BAND_IFTYPE_ATTR_IFTYPES,
  1625. iftdata->types_mask))
  1626. return -ENOBUFS;
  1627. if (he_cap->has_he) {
  1628. if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MAC,
  1629. sizeof(he_cap->he_cap_elem.mac_cap_info),
  1630. he_cap->he_cap_elem.mac_cap_info) ||
  1631. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PHY,
  1632. sizeof(he_cap->he_cap_elem.phy_cap_info),
  1633. he_cap->he_cap_elem.phy_cap_info) ||
  1634. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_MCS_SET,
  1635. sizeof(he_cap->he_mcs_nss_supp),
  1636. &he_cap->he_mcs_nss_supp) ||
  1637. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_CAP_PPE,
  1638. sizeof(he_cap->ppe_thres), he_cap->ppe_thres))
  1639. return -ENOBUFS;
  1640. }
  1641. if (eht_cap->has_eht && he_cap->has_he) {
  1642. u8 mcs_nss_size, ppe_thresh_size;
  1643. u16 ppe_thres_hdr;
  1644. bool is_ap;
  1645. is_ap = iftdata->types_mask & BIT(NL80211_IFTYPE_AP) ||
  1646. iftdata->types_mask & BIT(NL80211_IFTYPE_P2P_GO);
  1647. mcs_nss_size =
  1648. ieee80211_eht_mcs_nss_size(&he_cap->he_cap_elem,
  1649. &eht_cap->eht_cap_elem,
  1650. is_ap);
  1651. ppe_thres_hdr = get_unaligned_le16(&eht_cap->eht_ppe_thres[0]);
  1652. ppe_thresh_size =
  1653. ieee80211_eht_ppe_size(ppe_thres_hdr,
  1654. eht_cap->eht_cap_elem.phy_cap_info);
  1655. if (nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MAC,
  1656. sizeof(eht_cap->eht_cap_elem.mac_cap_info),
  1657. eht_cap->eht_cap_elem.mac_cap_info) ||
  1658. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PHY,
  1659. sizeof(eht_cap->eht_cap_elem.phy_cap_info),
  1660. eht_cap->eht_cap_elem.phy_cap_info) ||
  1661. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_MCS_SET,
  1662. mcs_nss_size, &eht_cap->eht_mcs_nss_supp) ||
  1663. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_EHT_CAP_PPE,
  1664. ppe_thresh_size, eht_cap->eht_ppe_thres))
  1665. return -ENOBUFS;
  1666. }
  1667. if (sband->band == NL80211_BAND_6GHZ &&
  1668. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_HE_6GHZ_CAPA,
  1669. sizeof(iftdata->he_6ghz_capa),
  1670. &iftdata->he_6ghz_capa))
  1671. return -ENOBUFS;
  1672. if (iftdata->vendor_elems.data && iftdata->vendor_elems.len &&
  1673. nla_put(msg, NL80211_BAND_IFTYPE_ATTR_VENDOR_ELEMS,
  1674. iftdata->vendor_elems.len, iftdata->vendor_elems.data))
  1675. return -ENOBUFS;
  1676. return 0;
  1677. }
  1678. static int nl80211_send_band_rateinfo(struct sk_buff *msg,
  1679. struct ieee80211_supported_band *sband,
  1680. bool large)
  1681. {
  1682. struct nlattr *nl_rates, *nl_rate;
  1683. struct ieee80211_rate *rate;
  1684. int i;
  1685. /* add HT info */
  1686. if (sband->ht_cap.ht_supported &&
  1687. (nla_put(msg, NL80211_BAND_ATTR_HT_MCS_SET,
  1688. sizeof(sband->ht_cap.mcs),
  1689. &sband->ht_cap.mcs) ||
  1690. nla_put_u16(msg, NL80211_BAND_ATTR_HT_CAPA,
  1691. sband->ht_cap.cap) ||
  1692. nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_FACTOR,
  1693. sband->ht_cap.ampdu_factor) ||
  1694. nla_put_u8(msg, NL80211_BAND_ATTR_HT_AMPDU_DENSITY,
  1695. sband->ht_cap.ampdu_density)))
  1696. return -ENOBUFS;
  1697. /* add VHT info */
  1698. if (sband->vht_cap.vht_supported &&
  1699. (nla_put(msg, NL80211_BAND_ATTR_VHT_MCS_SET,
  1700. sizeof(sband->vht_cap.vht_mcs),
  1701. &sband->vht_cap.vht_mcs) ||
  1702. nla_put_u32(msg, NL80211_BAND_ATTR_VHT_CAPA,
  1703. sband->vht_cap.cap)))
  1704. return -ENOBUFS;
  1705. if (large && sband->n_iftype_data) {
  1706. struct nlattr *nl_iftype_data =
  1707. nla_nest_start_noflag(msg,
  1708. NL80211_BAND_ATTR_IFTYPE_DATA);
  1709. const struct ieee80211_sband_iftype_data *iftd;
  1710. int err;
  1711. if (!nl_iftype_data)
  1712. return -ENOBUFS;
  1713. for_each_sband_iftype_data(sband, i, iftd) {
  1714. struct nlattr *iftdata;
  1715. iftdata = nla_nest_start_noflag(msg, i + 1);
  1716. if (!iftdata)
  1717. return -ENOBUFS;
  1718. err = nl80211_send_iftype_data(msg, sband, iftd);
  1719. if (err)
  1720. return err;
  1721. nla_nest_end(msg, iftdata);
  1722. }
  1723. nla_nest_end(msg, nl_iftype_data);
  1724. }
  1725. /* add EDMG info */
  1726. if (large && sband->edmg_cap.channels &&
  1727. (nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_CHANNELS,
  1728. sband->edmg_cap.channels) ||
  1729. nla_put_u8(msg, NL80211_BAND_ATTR_EDMG_BW_CONFIG,
  1730. sband->edmg_cap.bw_config)))
  1731. return -ENOBUFS;
  1732. /* add bitrates */
  1733. nl_rates = nla_nest_start_noflag(msg, NL80211_BAND_ATTR_RATES);
  1734. if (!nl_rates)
  1735. return -ENOBUFS;
  1736. for (i = 0; i < sband->n_bitrates; i++) {
  1737. nl_rate = nla_nest_start_noflag(msg, i);
  1738. if (!nl_rate)
  1739. return -ENOBUFS;
  1740. rate = &sband->bitrates[i];
  1741. if (nla_put_u32(msg, NL80211_BITRATE_ATTR_RATE,
  1742. rate->bitrate))
  1743. return -ENOBUFS;
  1744. if ((rate->flags & IEEE80211_RATE_SHORT_PREAMBLE) &&
  1745. nla_put_flag(msg,
  1746. NL80211_BITRATE_ATTR_2GHZ_SHORTPREAMBLE))
  1747. return -ENOBUFS;
  1748. nla_nest_end(msg, nl_rate);
  1749. }
  1750. nla_nest_end(msg, nl_rates);
  1751. /* S1G capabilities */
  1752. if (sband->band == NL80211_BAND_S1GHZ && sband->s1g_cap.s1g &&
  1753. (nla_put(msg, NL80211_BAND_ATTR_S1G_CAPA,
  1754. sizeof(sband->s1g_cap.cap),
  1755. sband->s1g_cap.cap) ||
  1756. nla_put(msg, NL80211_BAND_ATTR_S1G_MCS_NSS_SET,
  1757. sizeof(sband->s1g_cap.nss_mcs),
  1758. sband->s1g_cap.nss_mcs)))
  1759. return -ENOBUFS;
  1760. return 0;
  1761. }
  1762. static int
  1763. nl80211_send_mgmt_stypes(struct sk_buff *msg,
  1764. const struct ieee80211_txrx_stypes *mgmt_stypes)
  1765. {
  1766. u16 stypes;
  1767. struct nlattr *nl_ftypes, *nl_ifs;
  1768. enum nl80211_iftype ift;
  1769. int i;
  1770. if (!mgmt_stypes)
  1771. return 0;
  1772. nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_TX_FRAME_TYPES);
  1773. if (!nl_ifs)
  1774. return -ENOBUFS;
  1775. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  1776. nl_ftypes = nla_nest_start_noflag(msg, ift);
  1777. if (!nl_ftypes)
  1778. return -ENOBUFS;
  1779. i = 0;
  1780. stypes = mgmt_stypes[ift].tx;
  1781. while (stypes) {
  1782. if ((stypes & 1) &&
  1783. nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
  1784. (i << 4) | IEEE80211_FTYPE_MGMT))
  1785. return -ENOBUFS;
  1786. stypes >>= 1;
  1787. i++;
  1788. }
  1789. nla_nest_end(msg, nl_ftypes);
  1790. }
  1791. nla_nest_end(msg, nl_ifs);
  1792. nl_ifs = nla_nest_start_noflag(msg, NL80211_ATTR_RX_FRAME_TYPES);
  1793. if (!nl_ifs)
  1794. return -ENOBUFS;
  1795. for (ift = 0; ift < NUM_NL80211_IFTYPES; ift++) {
  1796. nl_ftypes = nla_nest_start_noflag(msg, ift);
  1797. if (!nl_ftypes)
  1798. return -ENOBUFS;
  1799. i = 0;
  1800. stypes = mgmt_stypes[ift].rx;
  1801. while (stypes) {
  1802. if ((stypes & 1) &&
  1803. nla_put_u16(msg, NL80211_ATTR_FRAME_TYPE,
  1804. (i << 4) | IEEE80211_FTYPE_MGMT))
  1805. return -ENOBUFS;
  1806. stypes >>= 1;
  1807. i++;
  1808. }
  1809. nla_nest_end(msg, nl_ftypes);
  1810. }
  1811. nla_nest_end(msg, nl_ifs);
  1812. return 0;
  1813. }
  1814. #define CMD(op, n) \
  1815. do { \
  1816. if (rdev->ops->op) { \
  1817. i++; \
  1818. if (nla_put_u32(msg, i, NL80211_CMD_ ## n)) \
  1819. goto nla_put_failure; \
  1820. } \
  1821. } while (0)
  1822. static int nl80211_add_commands_unsplit(struct cfg80211_registered_device *rdev,
  1823. struct sk_buff *msg)
  1824. {
  1825. int i = 0;
  1826. /*
  1827. * do *NOT* add anything into this function, new things need to be
  1828. * advertised only to new versions of userspace that can deal with
  1829. * the split (and they can't possibly care about new features...
  1830. */
  1831. CMD(add_virtual_intf, NEW_INTERFACE);
  1832. CMD(change_virtual_intf, SET_INTERFACE);
  1833. CMD(add_key, NEW_KEY);
  1834. CMD(start_ap, START_AP);
  1835. CMD(add_station, NEW_STATION);
  1836. CMD(add_mpath, NEW_MPATH);
  1837. CMD(update_mesh_config, SET_MESH_CONFIG);
  1838. CMD(change_bss, SET_BSS);
  1839. CMD(auth, AUTHENTICATE);
  1840. CMD(assoc, ASSOCIATE);
  1841. CMD(deauth, DEAUTHENTICATE);
  1842. CMD(disassoc, DISASSOCIATE);
  1843. CMD(join_ibss, JOIN_IBSS);
  1844. CMD(join_mesh, JOIN_MESH);
  1845. CMD(set_pmksa, SET_PMKSA);
  1846. CMD(del_pmksa, DEL_PMKSA);
  1847. CMD(flush_pmksa, FLUSH_PMKSA);
  1848. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL)
  1849. CMD(remain_on_channel, REMAIN_ON_CHANNEL);
  1850. CMD(set_bitrate_mask, SET_TX_BITRATE_MASK);
  1851. CMD(mgmt_tx, FRAME);
  1852. CMD(mgmt_tx_cancel_wait, FRAME_WAIT_CANCEL);
  1853. if (rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK) {
  1854. i++;
  1855. if (nla_put_u32(msg, i, NL80211_CMD_SET_WIPHY_NETNS))
  1856. goto nla_put_failure;
  1857. }
  1858. if (rdev->ops->set_monitor_channel || rdev->ops->start_ap ||
  1859. rdev->ops->join_mesh) {
  1860. i++;
  1861. if (nla_put_u32(msg, i, NL80211_CMD_SET_CHANNEL))
  1862. goto nla_put_failure;
  1863. }
  1864. if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) {
  1865. CMD(tdls_mgmt, TDLS_MGMT);
  1866. CMD(tdls_oper, TDLS_OPER);
  1867. }
  1868. if (rdev->wiphy.max_sched_scan_reqs)
  1869. CMD(sched_scan_start, START_SCHED_SCAN);
  1870. CMD(probe_client, PROBE_CLIENT);
  1871. CMD(set_noack_map, SET_NOACK_MAP);
  1872. if (rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS) {
  1873. i++;
  1874. if (nla_put_u32(msg, i, NL80211_CMD_REGISTER_BEACONS))
  1875. goto nla_put_failure;
  1876. }
  1877. CMD(start_p2p_device, START_P2P_DEVICE);
  1878. CMD(set_mcast_rate, SET_MCAST_RATE);
  1879. #ifdef CONFIG_NL80211_TESTMODE
  1880. CMD(testmode_cmd, TESTMODE);
  1881. #endif
  1882. if (rdev->ops->connect || rdev->ops->auth) {
  1883. i++;
  1884. if (nla_put_u32(msg, i, NL80211_CMD_CONNECT))
  1885. goto nla_put_failure;
  1886. }
  1887. if (rdev->ops->disconnect || rdev->ops->deauth) {
  1888. i++;
  1889. if (nla_put_u32(msg, i, NL80211_CMD_DISCONNECT))
  1890. goto nla_put_failure;
  1891. }
  1892. return i;
  1893. nla_put_failure:
  1894. return -ENOBUFS;
  1895. }
  1896. static int
  1897. nl80211_send_pmsr_ftm_capa(const struct cfg80211_pmsr_capabilities *cap,
  1898. struct sk_buff *msg)
  1899. {
  1900. struct nlattr *ftm;
  1901. if (!cap->ftm.supported)
  1902. return 0;
  1903. ftm = nla_nest_start_noflag(msg, NL80211_PMSR_TYPE_FTM);
  1904. if (!ftm)
  1905. return -ENOBUFS;
  1906. if (cap->ftm.asap && nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_ASAP))
  1907. return -ENOBUFS;
  1908. if (cap->ftm.non_asap &&
  1909. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_ASAP))
  1910. return -ENOBUFS;
  1911. if (cap->ftm.request_lci &&
  1912. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_LCI))
  1913. return -ENOBUFS;
  1914. if (cap->ftm.request_civicloc &&
  1915. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_REQ_CIVICLOC))
  1916. return -ENOBUFS;
  1917. if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_PREAMBLES,
  1918. cap->ftm.preambles))
  1919. return -ENOBUFS;
  1920. if (nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_BANDWIDTHS,
  1921. cap->ftm.bandwidths))
  1922. return -ENOBUFS;
  1923. if (cap->ftm.max_bursts_exponent >= 0 &&
  1924. nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_BURSTS_EXPONENT,
  1925. cap->ftm.max_bursts_exponent))
  1926. return -ENOBUFS;
  1927. if (cap->ftm.max_ftms_per_burst &&
  1928. nla_put_u32(msg, NL80211_PMSR_FTM_CAPA_ATTR_MAX_FTMS_PER_BURST,
  1929. cap->ftm.max_ftms_per_burst))
  1930. return -ENOBUFS;
  1931. if (cap->ftm.trigger_based &&
  1932. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_TRIGGER_BASED))
  1933. return -ENOBUFS;
  1934. if (cap->ftm.non_trigger_based &&
  1935. nla_put_flag(msg, NL80211_PMSR_FTM_CAPA_ATTR_NON_TRIGGER_BASED))
  1936. return -ENOBUFS;
  1937. nla_nest_end(msg, ftm);
  1938. return 0;
  1939. }
  1940. static int nl80211_send_pmsr_capa(struct cfg80211_registered_device *rdev,
  1941. struct sk_buff *msg)
  1942. {
  1943. const struct cfg80211_pmsr_capabilities *cap = rdev->wiphy.pmsr_capa;
  1944. struct nlattr *pmsr, *caps;
  1945. if (!cap)
  1946. return 0;
  1947. /*
  1948. * we don't need to clean up anything here since the caller
  1949. * will genlmsg_cancel() if we fail
  1950. */
  1951. pmsr = nla_nest_start_noflag(msg, NL80211_ATTR_PEER_MEASUREMENTS);
  1952. if (!pmsr)
  1953. return -ENOBUFS;
  1954. if (nla_put_u32(msg, NL80211_PMSR_ATTR_MAX_PEERS, cap->max_peers))
  1955. return -ENOBUFS;
  1956. if (cap->report_ap_tsf &&
  1957. nla_put_flag(msg, NL80211_PMSR_ATTR_REPORT_AP_TSF))
  1958. return -ENOBUFS;
  1959. if (cap->randomize_mac_addr &&
  1960. nla_put_flag(msg, NL80211_PMSR_ATTR_RANDOMIZE_MAC_ADDR))
  1961. return -ENOBUFS;
  1962. caps = nla_nest_start_noflag(msg, NL80211_PMSR_ATTR_TYPE_CAPA);
  1963. if (!caps)
  1964. return -ENOBUFS;
  1965. if (nl80211_send_pmsr_ftm_capa(cap, msg))
  1966. return -ENOBUFS;
  1967. nla_nest_end(msg, caps);
  1968. nla_nest_end(msg, pmsr);
  1969. return 0;
  1970. }
  1971. static int
  1972. nl80211_put_iftype_akm_suites(struct cfg80211_registered_device *rdev,
  1973. struct sk_buff *msg)
  1974. {
  1975. int i;
  1976. struct nlattr *nested, *nested_akms;
  1977. const struct wiphy_iftype_akm_suites *iftype_akms;
  1978. if (!rdev->wiphy.num_iftype_akm_suites ||
  1979. !rdev->wiphy.iftype_akm_suites)
  1980. return 0;
  1981. nested = nla_nest_start(msg, NL80211_ATTR_IFTYPE_AKM_SUITES);
  1982. if (!nested)
  1983. return -ENOBUFS;
  1984. for (i = 0; i < rdev->wiphy.num_iftype_akm_suites; i++) {
  1985. nested_akms = nla_nest_start(msg, i + 1);
  1986. if (!nested_akms)
  1987. return -ENOBUFS;
  1988. iftype_akms = &rdev->wiphy.iftype_akm_suites[i];
  1989. if (nl80211_put_iftypes(msg, NL80211_IFTYPE_AKM_ATTR_IFTYPES,
  1990. iftype_akms->iftypes_mask))
  1991. return -ENOBUFS;
  1992. if (nla_put(msg, NL80211_IFTYPE_AKM_ATTR_SUITES,
  1993. sizeof(u32) * iftype_akms->n_akm_suites,
  1994. iftype_akms->akm_suites)) {
  1995. return -ENOBUFS;
  1996. }
  1997. nla_nest_end(msg, nested_akms);
  1998. }
  1999. nla_nest_end(msg, nested);
  2000. return 0;
  2001. }
  2002. static int
  2003. nl80211_put_tid_config_support(struct cfg80211_registered_device *rdev,
  2004. struct sk_buff *msg)
  2005. {
  2006. struct nlattr *supp;
  2007. if (!rdev->wiphy.tid_config_support.vif &&
  2008. !rdev->wiphy.tid_config_support.peer)
  2009. return 0;
  2010. supp = nla_nest_start(msg, NL80211_ATTR_TID_CONFIG);
  2011. if (!supp)
  2012. return -ENOSPC;
  2013. if (rdev->wiphy.tid_config_support.vif &&
  2014. nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_VIF_SUPP,
  2015. rdev->wiphy.tid_config_support.vif,
  2016. NL80211_TID_CONFIG_ATTR_PAD))
  2017. goto fail;
  2018. if (rdev->wiphy.tid_config_support.peer &&
  2019. nla_put_u64_64bit(msg, NL80211_TID_CONFIG_ATTR_PEER_SUPP,
  2020. rdev->wiphy.tid_config_support.peer,
  2021. NL80211_TID_CONFIG_ATTR_PAD))
  2022. goto fail;
  2023. /* for now we just use the same value ... makes more sense */
  2024. if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_SHORT,
  2025. rdev->wiphy.tid_config_support.max_retry))
  2026. goto fail;
  2027. if (nla_put_u8(msg, NL80211_TID_CONFIG_ATTR_RETRY_LONG,
  2028. rdev->wiphy.tid_config_support.max_retry))
  2029. goto fail;
  2030. nla_nest_end(msg, supp);
  2031. return 0;
  2032. fail:
  2033. nla_nest_cancel(msg, supp);
  2034. return -ENOBUFS;
  2035. }
  2036. static int
  2037. nl80211_put_sar_specs(struct cfg80211_registered_device *rdev,
  2038. struct sk_buff *msg)
  2039. {
  2040. struct nlattr *sar_capa, *specs, *sub_freq_range;
  2041. u8 num_freq_ranges;
  2042. int i;
  2043. if (!rdev->wiphy.sar_capa)
  2044. return 0;
  2045. num_freq_ranges = rdev->wiphy.sar_capa->num_freq_ranges;
  2046. sar_capa = nla_nest_start(msg, NL80211_ATTR_SAR_SPEC);
  2047. if (!sar_capa)
  2048. return -ENOSPC;
  2049. if (nla_put_u32(msg, NL80211_SAR_ATTR_TYPE, rdev->wiphy.sar_capa->type))
  2050. goto fail;
  2051. specs = nla_nest_start(msg, NL80211_SAR_ATTR_SPECS);
  2052. if (!specs)
  2053. goto fail;
  2054. /* report supported freq_ranges */
  2055. for (i = 0; i < num_freq_ranges; i++) {
  2056. sub_freq_range = nla_nest_start(msg, i + 1);
  2057. if (!sub_freq_range)
  2058. goto fail;
  2059. if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_START_FREQ,
  2060. rdev->wiphy.sar_capa->freq_ranges[i].start_freq))
  2061. goto fail;
  2062. if (nla_put_u32(msg, NL80211_SAR_ATTR_SPECS_END_FREQ,
  2063. rdev->wiphy.sar_capa->freq_ranges[i].end_freq))
  2064. goto fail;
  2065. nla_nest_end(msg, sub_freq_range);
  2066. }
  2067. nla_nest_end(msg, specs);
  2068. nla_nest_end(msg, sar_capa);
  2069. return 0;
  2070. fail:
  2071. nla_nest_cancel(msg, sar_capa);
  2072. return -ENOBUFS;
  2073. }
  2074. static int nl80211_put_mbssid_support(struct wiphy *wiphy, struct sk_buff *msg)
  2075. {
  2076. struct nlattr *config;
  2077. if (!wiphy->mbssid_max_interfaces)
  2078. return 0;
  2079. config = nla_nest_start(msg, NL80211_ATTR_MBSSID_CONFIG);
  2080. if (!config)
  2081. return -ENOBUFS;
  2082. if (nla_put_u8(msg, NL80211_MBSSID_CONFIG_ATTR_MAX_INTERFACES,
  2083. wiphy->mbssid_max_interfaces))
  2084. goto fail;
  2085. if (wiphy->ema_max_profile_periodicity &&
  2086. nla_put_u8(msg,
  2087. NL80211_MBSSID_CONFIG_ATTR_MAX_EMA_PROFILE_PERIODICITY,
  2088. wiphy->ema_max_profile_periodicity))
  2089. goto fail;
  2090. nla_nest_end(msg, config);
  2091. return 0;
  2092. fail:
  2093. nla_nest_cancel(msg, config);
  2094. return -ENOBUFS;
  2095. }
  2096. static int nl80211_put_radio(struct wiphy *wiphy, struct sk_buff *msg, int idx)
  2097. {
  2098. const struct wiphy_radio *r = &wiphy->radio[idx];
  2099. struct nlattr *radio, *freq;
  2100. int i;
  2101. radio = nla_nest_start(msg, idx);
  2102. if (!radio)
  2103. return -ENOBUFS;
  2104. if (nla_put_u32(msg, NL80211_WIPHY_RADIO_ATTR_INDEX, idx))
  2105. goto nla_put_failure;
  2106. for (i = 0; i < r->n_freq_range; i++) {
  2107. const struct wiphy_radio_freq_range *range = &r->freq_range[i];
  2108. freq = nla_nest_start(msg, NL80211_WIPHY_RADIO_ATTR_FREQ_RANGE);
  2109. if (!freq)
  2110. goto nla_put_failure;
  2111. if (nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_START,
  2112. range->start_freq) ||
  2113. nla_put_u32(msg, NL80211_WIPHY_RADIO_FREQ_ATTR_END,
  2114. range->end_freq))
  2115. goto nla_put_failure;
  2116. nla_nest_end(msg, freq);
  2117. }
  2118. for (i = 0; i < r->n_iface_combinations; i++)
  2119. if (nl80211_put_ifcomb_data(msg, true,
  2120. NL80211_WIPHY_RADIO_ATTR_INTERFACE_COMBINATION,
  2121. &r->iface_combinations[i],
  2122. NLA_F_NESTED))
  2123. goto nla_put_failure;
  2124. nla_nest_end(msg, radio);
  2125. return 0;
  2126. nla_put_failure:
  2127. return -ENOBUFS;
  2128. }
  2129. static int nl80211_put_radios(struct wiphy *wiphy, struct sk_buff *msg)
  2130. {
  2131. struct nlattr *radios;
  2132. int i;
  2133. if (!wiphy->n_radio)
  2134. return 0;
  2135. radios = nla_nest_start(msg, NL80211_ATTR_WIPHY_RADIOS);
  2136. if (!radios)
  2137. return -ENOBUFS;
  2138. for (i = 0; i < wiphy->n_radio; i++)
  2139. if (nl80211_put_radio(wiphy, msg, i))
  2140. goto fail;
  2141. nla_nest_end(msg, radios);
  2142. if (nl80211_put_iface_combinations(wiphy, msg,
  2143. NL80211_ATTR_WIPHY_INTERFACE_COMBINATIONS,
  2144. -1, true, NLA_F_NESTED))
  2145. return -ENOBUFS;
  2146. return 0;
  2147. fail:
  2148. nla_nest_cancel(msg, radios);
  2149. return -ENOBUFS;
  2150. }
  2151. struct nl80211_dump_wiphy_state {
  2152. s64 filter_wiphy;
  2153. long start;
  2154. long split_start, band_start, chan_start, capa_start;
  2155. bool split;
  2156. };
  2157. static int nl80211_send_wiphy(struct cfg80211_registered_device *rdev,
  2158. enum nl80211_commands cmd,
  2159. struct sk_buff *msg, u32 portid, u32 seq,
  2160. int flags, struct nl80211_dump_wiphy_state *state)
  2161. {
  2162. void *hdr;
  2163. struct nlattr *nl_bands, *nl_band;
  2164. struct nlattr *nl_freqs, *nl_freq;
  2165. struct nlattr *nl_cmds;
  2166. enum nl80211_band band;
  2167. struct ieee80211_channel *chan;
  2168. int i;
  2169. const struct ieee80211_txrx_stypes *mgmt_stypes =
  2170. rdev->wiphy.mgmt_stypes;
  2171. u32 features;
  2172. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  2173. if (!hdr)
  2174. return -ENOBUFS;
  2175. if (WARN_ON(!state))
  2176. return -EINVAL;
  2177. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  2178. nla_put_string(msg, NL80211_ATTR_WIPHY_NAME,
  2179. wiphy_name(&rdev->wiphy)) ||
  2180. nla_put_u32(msg, NL80211_ATTR_GENERATION,
  2181. cfg80211_rdev_list_generation))
  2182. goto nla_put_failure;
  2183. if (cmd != NL80211_CMD_NEW_WIPHY)
  2184. goto finish;
  2185. switch (state->split_start) {
  2186. case 0:
  2187. if (nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_SHORT,
  2188. rdev->wiphy.retry_short) ||
  2189. nla_put_u8(msg, NL80211_ATTR_WIPHY_RETRY_LONG,
  2190. rdev->wiphy.retry_long) ||
  2191. nla_put_u32(msg, NL80211_ATTR_WIPHY_FRAG_THRESHOLD,
  2192. rdev->wiphy.frag_threshold) ||
  2193. nla_put_u32(msg, NL80211_ATTR_WIPHY_RTS_THRESHOLD,
  2194. rdev->wiphy.rts_threshold) ||
  2195. nla_put_u8(msg, NL80211_ATTR_WIPHY_COVERAGE_CLASS,
  2196. rdev->wiphy.coverage_class) ||
  2197. nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCAN_SSIDS,
  2198. rdev->wiphy.max_scan_ssids) ||
  2199. nla_put_u8(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_SSIDS,
  2200. rdev->wiphy.max_sched_scan_ssids) ||
  2201. nla_put_u16(msg, NL80211_ATTR_MAX_SCAN_IE_LEN,
  2202. rdev->wiphy.max_scan_ie_len) ||
  2203. nla_put_u16(msg, NL80211_ATTR_MAX_SCHED_SCAN_IE_LEN,
  2204. rdev->wiphy.max_sched_scan_ie_len) ||
  2205. nla_put_u8(msg, NL80211_ATTR_MAX_MATCH_SETS,
  2206. rdev->wiphy.max_match_sets))
  2207. goto nla_put_failure;
  2208. if ((rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN) &&
  2209. nla_put_flag(msg, NL80211_ATTR_SUPPORT_IBSS_RSN))
  2210. goto nla_put_failure;
  2211. if ((rdev->wiphy.flags & WIPHY_FLAG_MESH_AUTH) &&
  2212. nla_put_flag(msg, NL80211_ATTR_SUPPORT_MESH_AUTH))
  2213. goto nla_put_failure;
  2214. if ((rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) &&
  2215. nla_put_flag(msg, NL80211_ATTR_SUPPORT_AP_UAPSD))
  2216. goto nla_put_failure;
  2217. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
  2218. nla_put_flag(msg, NL80211_ATTR_ROAM_SUPPORT))
  2219. goto nla_put_failure;
  2220. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) &&
  2221. nla_put_flag(msg, NL80211_ATTR_TDLS_SUPPORT))
  2222. goto nla_put_failure;
  2223. if ((rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP) &&
  2224. nla_put_flag(msg, NL80211_ATTR_TDLS_EXTERNAL_SETUP))
  2225. goto nla_put_failure;
  2226. state->split_start++;
  2227. if (state->split)
  2228. break;
  2229. fallthrough;
  2230. case 1:
  2231. if (nla_put(msg, NL80211_ATTR_CIPHER_SUITES,
  2232. sizeof(u32) * rdev->wiphy.n_cipher_suites,
  2233. rdev->wiphy.cipher_suites))
  2234. goto nla_put_failure;
  2235. if (nla_put_u8(msg, NL80211_ATTR_MAX_NUM_PMKIDS,
  2236. rdev->wiphy.max_num_pmkids))
  2237. goto nla_put_failure;
  2238. if ((rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  2239. nla_put_flag(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE))
  2240. goto nla_put_failure;
  2241. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_TX,
  2242. rdev->wiphy.available_antennas_tx) ||
  2243. nla_put_u32(msg, NL80211_ATTR_WIPHY_ANTENNA_AVAIL_RX,
  2244. rdev->wiphy.available_antennas_rx))
  2245. goto nla_put_failure;
  2246. if ((rdev->wiphy.flags & WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD) &&
  2247. nla_put_u32(msg, NL80211_ATTR_PROBE_RESP_OFFLOAD,
  2248. rdev->wiphy.probe_resp_offload))
  2249. goto nla_put_failure;
  2250. if ((rdev->wiphy.available_antennas_tx ||
  2251. rdev->wiphy.available_antennas_rx) &&
  2252. rdev->ops->get_antenna) {
  2253. u32 tx_ant = 0, rx_ant = 0;
  2254. int res;
  2255. res = rdev_get_antenna(rdev, &tx_ant, &rx_ant);
  2256. if (!res) {
  2257. if (nla_put_u32(msg,
  2258. NL80211_ATTR_WIPHY_ANTENNA_TX,
  2259. tx_ant) ||
  2260. nla_put_u32(msg,
  2261. NL80211_ATTR_WIPHY_ANTENNA_RX,
  2262. rx_ant))
  2263. goto nla_put_failure;
  2264. }
  2265. }
  2266. state->split_start++;
  2267. if (state->split)
  2268. break;
  2269. fallthrough;
  2270. case 2:
  2271. if (nl80211_put_iftypes(msg, NL80211_ATTR_SUPPORTED_IFTYPES,
  2272. rdev->wiphy.interface_modes))
  2273. goto nla_put_failure;
  2274. state->split_start++;
  2275. if (state->split)
  2276. break;
  2277. fallthrough;
  2278. case 3:
  2279. nl_bands = nla_nest_start_noflag(msg,
  2280. NL80211_ATTR_WIPHY_BANDS);
  2281. if (!nl_bands)
  2282. goto nla_put_failure;
  2283. for (band = state->band_start;
  2284. band < (state->split ?
  2285. NUM_NL80211_BANDS :
  2286. NL80211_BAND_60GHZ + 1);
  2287. band++) {
  2288. struct ieee80211_supported_band *sband;
  2289. /* omit higher bands for ancient software */
  2290. if (band > NL80211_BAND_5GHZ && !state->split)
  2291. break;
  2292. sband = rdev->wiphy.bands[band];
  2293. if (!sband)
  2294. continue;
  2295. nl_band = nla_nest_start_noflag(msg, band);
  2296. if (!nl_band)
  2297. goto nla_put_failure;
  2298. switch (state->chan_start) {
  2299. case 0:
  2300. if (nl80211_send_band_rateinfo(msg, sband,
  2301. state->split))
  2302. goto nla_put_failure;
  2303. state->chan_start++;
  2304. if (state->split)
  2305. break;
  2306. fallthrough;
  2307. default:
  2308. /* add frequencies */
  2309. nl_freqs = nla_nest_start_noflag(msg,
  2310. NL80211_BAND_ATTR_FREQS);
  2311. if (!nl_freqs)
  2312. goto nla_put_failure;
  2313. for (i = state->chan_start - 1;
  2314. i < sband->n_channels;
  2315. i++) {
  2316. nl_freq = nla_nest_start_noflag(msg,
  2317. i);
  2318. if (!nl_freq)
  2319. goto nla_put_failure;
  2320. chan = &sband->channels[i];
  2321. if (nl80211_msg_put_channel(
  2322. msg, &rdev->wiphy, chan,
  2323. state->split))
  2324. goto nla_put_failure;
  2325. nla_nest_end(msg, nl_freq);
  2326. if (state->split)
  2327. break;
  2328. }
  2329. if (i < sband->n_channels)
  2330. state->chan_start = i + 2;
  2331. else
  2332. state->chan_start = 0;
  2333. nla_nest_end(msg, nl_freqs);
  2334. }
  2335. nla_nest_end(msg, nl_band);
  2336. if (state->split) {
  2337. /* start again here */
  2338. if (state->chan_start)
  2339. band--;
  2340. break;
  2341. }
  2342. }
  2343. nla_nest_end(msg, nl_bands);
  2344. if (band < NUM_NL80211_BANDS)
  2345. state->band_start = band + 1;
  2346. else
  2347. state->band_start = 0;
  2348. /* if bands & channels are done, continue outside */
  2349. if (state->band_start == 0 && state->chan_start == 0)
  2350. state->split_start++;
  2351. if (state->split)
  2352. break;
  2353. fallthrough;
  2354. case 4:
  2355. nl_cmds = nla_nest_start_noflag(msg,
  2356. NL80211_ATTR_SUPPORTED_COMMANDS);
  2357. if (!nl_cmds)
  2358. goto nla_put_failure;
  2359. i = nl80211_add_commands_unsplit(rdev, msg);
  2360. if (i < 0)
  2361. goto nla_put_failure;
  2362. if (state->split) {
  2363. CMD(crit_proto_start, CRIT_PROTOCOL_START);
  2364. CMD(crit_proto_stop, CRIT_PROTOCOL_STOP);
  2365. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)
  2366. CMD(channel_switch, CHANNEL_SWITCH);
  2367. CMD(set_qos_map, SET_QOS_MAP);
  2368. if (rdev->wiphy.features &
  2369. NL80211_FEATURE_SUPPORTS_WMM_ADMISSION)
  2370. CMD(add_tx_ts, ADD_TX_TS);
  2371. CMD(set_multicast_to_unicast, SET_MULTICAST_TO_UNICAST);
  2372. CMD(update_connect_params, UPDATE_CONNECT_PARAMS);
  2373. CMD(update_ft_ies, UPDATE_FT_IES);
  2374. if (rdev->wiphy.sar_capa)
  2375. CMD(set_sar_specs, SET_SAR_SPECS);
  2376. }
  2377. #undef CMD
  2378. nla_nest_end(msg, nl_cmds);
  2379. state->split_start++;
  2380. if (state->split)
  2381. break;
  2382. fallthrough;
  2383. case 5:
  2384. if (rdev->ops->remain_on_channel &&
  2385. (rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL) &&
  2386. nla_put_u32(msg,
  2387. NL80211_ATTR_MAX_REMAIN_ON_CHANNEL_DURATION,
  2388. rdev->wiphy.max_remain_on_channel_duration))
  2389. goto nla_put_failure;
  2390. if ((rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX) &&
  2391. nla_put_flag(msg, NL80211_ATTR_OFFCHANNEL_TX_OK))
  2392. goto nla_put_failure;
  2393. state->split_start++;
  2394. if (state->split)
  2395. break;
  2396. fallthrough;
  2397. case 6:
  2398. #ifdef CONFIG_PM
  2399. if (nl80211_send_wowlan(msg, rdev, state->split))
  2400. goto nla_put_failure;
  2401. state->split_start++;
  2402. if (state->split)
  2403. break;
  2404. #else
  2405. state->split_start++;
  2406. #endif
  2407. fallthrough;
  2408. case 7:
  2409. if (nl80211_put_iftypes(msg, NL80211_ATTR_SOFTWARE_IFTYPES,
  2410. rdev->wiphy.software_iftypes))
  2411. goto nla_put_failure;
  2412. if (nl80211_put_iface_combinations(&rdev->wiphy, msg,
  2413. NL80211_ATTR_INTERFACE_COMBINATIONS,
  2414. rdev->wiphy.n_radio ? 0 : -1,
  2415. state->split, 0))
  2416. goto nla_put_failure;
  2417. state->split_start++;
  2418. if (state->split)
  2419. break;
  2420. fallthrough;
  2421. case 8:
  2422. if ((rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME) &&
  2423. nla_put_u32(msg, NL80211_ATTR_DEVICE_AP_SME,
  2424. rdev->wiphy.ap_sme_capa))
  2425. goto nla_put_failure;
  2426. features = rdev->wiphy.features;
  2427. /*
  2428. * We can only add the per-channel limit information if the
  2429. * dump is split, otherwise it makes it too big. Therefore
  2430. * only advertise it in that case.
  2431. */
  2432. if (state->split)
  2433. features |= NL80211_FEATURE_ADVERTISE_CHAN_LIMITS;
  2434. if (nla_put_u32(msg, NL80211_ATTR_FEATURE_FLAGS, features))
  2435. goto nla_put_failure;
  2436. if (rdev->wiphy.ht_capa_mod_mask &&
  2437. nla_put(msg, NL80211_ATTR_HT_CAPABILITY_MASK,
  2438. sizeof(*rdev->wiphy.ht_capa_mod_mask),
  2439. rdev->wiphy.ht_capa_mod_mask))
  2440. goto nla_put_failure;
  2441. if (rdev->wiphy.flags & WIPHY_FLAG_HAVE_AP_SME &&
  2442. rdev->wiphy.max_acl_mac_addrs &&
  2443. nla_put_u32(msg, NL80211_ATTR_MAC_ACL_MAX,
  2444. rdev->wiphy.max_acl_mac_addrs))
  2445. goto nla_put_failure;
  2446. /*
  2447. * Any information below this point is only available to
  2448. * applications that can deal with it being split. This
  2449. * helps ensure that newly added capabilities don't break
  2450. * older tools by overrunning their buffers.
  2451. *
  2452. * We still increment split_start so that in the split
  2453. * case we'll continue with more data in the next round,
  2454. * but break unconditionally so unsplit data stops here.
  2455. */
  2456. if (state->split)
  2457. state->split_start++;
  2458. else
  2459. state->split_start = 0;
  2460. break;
  2461. case 9:
  2462. if (nl80211_send_mgmt_stypes(msg, mgmt_stypes))
  2463. goto nla_put_failure;
  2464. if (nla_put_u32(msg, NL80211_ATTR_MAX_NUM_SCHED_SCAN_PLANS,
  2465. rdev->wiphy.max_sched_scan_plans) ||
  2466. nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_INTERVAL,
  2467. rdev->wiphy.max_sched_scan_plan_interval) ||
  2468. nla_put_u32(msg, NL80211_ATTR_MAX_SCAN_PLAN_ITERATIONS,
  2469. rdev->wiphy.max_sched_scan_plan_iterations))
  2470. goto nla_put_failure;
  2471. if (rdev->wiphy.extended_capabilities &&
  2472. (nla_put(msg, NL80211_ATTR_EXT_CAPA,
  2473. rdev->wiphy.extended_capabilities_len,
  2474. rdev->wiphy.extended_capabilities) ||
  2475. nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
  2476. rdev->wiphy.extended_capabilities_len,
  2477. rdev->wiphy.extended_capabilities_mask)))
  2478. goto nla_put_failure;
  2479. if (rdev->wiphy.vht_capa_mod_mask &&
  2480. nla_put(msg, NL80211_ATTR_VHT_CAPABILITY_MASK,
  2481. sizeof(*rdev->wiphy.vht_capa_mod_mask),
  2482. rdev->wiphy.vht_capa_mod_mask))
  2483. goto nla_put_failure;
  2484. if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
  2485. rdev->wiphy.perm_addr))
  2486. goto nla_put_failure;
  2487. if (!is_zero_ether_addr(rdev->wiphy.addr_mask) &&
  2488. nla_put(msg, NL80211_ATTR_MAC_MASK, ETH_ALEN,
  2489. rdev->wiphy.addr_mask))
  2490. goto nla_put_failure;
  2491. if (rdev->wiphy.n_addresses > 1) {
  2492. void *attr;
  2493. attr = nla_nest_start(msg, NL80211_ATTR_MAC_ADDRS);
  2494. if (!attr)
  2495. goto nla_put_failure;
  2496. for (i = 0; i < rdev->wiphy.n_addresses; i++)
  2497. if (nla_put(msg, i + 1, ETH_ALEN,
  2498. rdev->wiphy.addresses[i].addr))
  2499. goto nla_put_failure;
  2500. nla_nest_end(msg, attr);
  2501. }
  2502. state->split_start++;
  2503. break;
  2504. case 10:
  2505. if (nl80211_send_coalesce(msg, rdev))
  2506. goto nla_put_failure;
  2507. if ((rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ) &&
  2508. (nla_put_flag(msg, NL80211_ATTR_SUPPORT_5_MHZ) ||
  2509. nla_put_flag(msg, NL80211_ATTR_SUPPORT_10_MHZ)))
  2510. goto nla_put_failure;
  2511. if (rdev->wiphy.max_ap_assoc_sta &&
  2512. nla_put_u32(msg, NL80211_ATTR_MAX_AP_ASSOC_STA,
  2513. rdev->wiphy.max_ap_assoc_sta))
  2514. goto nla_put_failure;
  2515. state->split_start++;
  2516. break;
  2517. case 11:
  2518. if (rdev->wiphy.n_vendor_commands) {
  2519. const struct nl80211_vendor_cmd_info *info;
  2520. struct nlattr *nested;
  2521. nested = nla_nest_start_noflag(msg,
  2522. NL80211_ATTR_VENDOR_DATA);
  2523. if (!nested)
  2524. goto nla_put_failure;
  2525. for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
  2526. info = &rdev->wiphy.vendor_commands[i].info;
  2527. if (nla_put(msg, i + 1, sizeof(*info), info))
  2528. goto nla_put_failure;
  2529. }
  2530. nla_nest_end(msg, nested);
  2531. }
  2532. if (rdev->wiphy.n_vendor_events) {
  2533. const struct nl80211_vendor_cmd_info *info;
  2534. struct nlattr *nested;
  2535. nested = nla_nest_start_noflag(msg,
  2536. NL80211_ATTR_VENDOR_EVENTS);
  2537. if (!nested)
  2538. goto nla_put_failure;
  2539. for (i = 0; i < rdev->wiphy.n_vendor_events; i++) {
  2540. info = &rdev->wiphy.vendor_events[i];
  2541. if (nla_put(msg, i + 1, sizeof(*info), info))
  2542. goto nla_put_failure;
  2543. }
  2544. nla_nest_end(msg, nested);
  2545. }
  2546. state->split_start++;
  2547. break;
  2548. case 12:
  2549. if (rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH &&
  2550. nla_put_u8(msg, NL80211_ATTR_MAX_CSA_COUNTERS,
  2551. rdev->wiphy.max_num_csa_counters))
  2552. goto nla_put_failure;
  2553. if (rdev->wiphy.regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  2554. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  2555. goto nla_put_failure;
  2556. if (rdev->wiphy.max_sched_scan_reqs &&
  2557. nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_MAX_REQS,
  2558. rdev->wiphy.max_sched_scan_reqs))
  2559. goto nla_put_failure;
  2560. if (nla_put(msg, NL80211_ATTR_EXT_FEATURES,
  2561. sizeof(rdev->wiphy.ext_features),
  2562. rdev->wiphy.ext_features))
  2563. goto nla_put_failure;
  2564. if (rdev->wiphy.bss_select_support) {
  2565. struct nlattr *nested;
  2566. u32 bss_select_support = rdev->wiphy.bss_select_support;
  2567. nested = nla_nest_start_noflag(msg,
  2568. NL80211_ATTR_BSS_SELECT);
  2569. if (!nested)
  2570. goto nla_put_failure;
  2571. i = 0;
  2572. while (bss_select_support) {
  2573. if ((bss_select_support & 1) &&
  2574. nla_put_flag(msg, i))
  2575. goto nla_put_failure;
  2576. i++;
  2577. bss_select_support >>= 1;
  2578. }
  2579. nla_nest_end(msg, nested);
  2580. }
  2581. state->split_start++;
  2582. break;
  2583. case 13:
  2584. if (rdev->wiphy.num_iftype_ext_capab &&
  2585. rdev->wiphy.iftype_ext_capab) {
  2586. struct nlattr *nested_ext_capab, *nested;
  2587. nested = nla_nest_start_noflag(msg,
  2588. NL80211_ATTR_IFTYPE_EXT_CAPA);
  2589. if (!nested)
  2590. goto nla_put_failure;
  2591. for (i = state->capa_start;
  2592. i < rdev->wiphy.num_iftype_ext_capab; i++) {
  2593. const struct wiphy_iftype_ext_capab *capab;
  2594. capab = &rdev->wiphy.iftype_ext_capab[i];
  2595. nested_ext_capab = nla_nest_start_noflag(msg,
  2596. i);
  2597. if (!nested_ext_capab ||
  2598. nla_put_u32(msg, NL80211_ATTR_IFTYPE,
  2599. capab->iftype) ||
  2600. nla_put(msg, NL80211_ATTR_EXT_CAPA,
  2601. capab->extended_capabilities_len,
  2602. capab->extended_capabilities) ||
  2603. nla_put(msg, NL80211_ATTR_EXT_CAPA_MASK,
  2604. capab->extended_capabilities_len,
  2605. capab->extended_capabilities_mask))
  2606. goto nla_put_failure;
  2607. if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO &&
  2608. (nla_put_u16(msg,
  2609. NL80211_ATTR_EML_CAPABILITY,
  2610. capab->eml_capabilities) ||
  2611. nla_put_u16(msg,
  2612. NL80211_ATTR_MLD_CAPA_AND_OPS,
  2613. capab->mld_capa_and_ops)))
  2614. goto nla_put_failure;
  2615. nla_nest_end(msg, nested_ext_capab);
  2616. if (state->split)
  2617. break;
  2618. }
  2619. nla_nest_end(msg, nested);
  2620. if (i < rdev->wiphy.num_iftype_ext_capab) {
  2621. state->capa_start = i + 1;
  2622. break;
  2623. }
  2624. }
  2625. if (nla_put_u32(msg, NL80211_ATTR_BANDS,
  2626. rdev->wiphy.nan_supported_bands))
  2627. goto nla_put_failure;
  2628. if (wiphy_ext_feature_isset(&rdev->wiphy,
  2629. NL80211_EXT_FEATURE_TXQS)) {
  2630. struct cfg80211_txq_stats txqstats = {};
  2631. int res;
  2632. res = rdev_get_txq_stats(rdev, NULL, &txqstats);
  2633. if (!res &&
  2634. !nl80211_put_txq_stats(msg, &txqstats,
  2635. NL80211_ATTR_TXQ_STATS))
  2636. goto nla_put_failure;
  2637. if (nla_put_u32(msg, NL80211_ATTR_TXQ_LIMIT,
  2638. rdev->wiphy.txq_limit))
  2639. goto nla_put_failure;
  2640. if (nla_put_u32(msg, NL80211_ATTR_TXQ_MEMORY_LIMIT,
  2641. rdev->wiphy.txq_memory_limit))
  2642. goto nla_put_failure;
  2643. if (nla_put_u32(msg, NL80211_ATTR_TXQ_QUANTUM,
  2644. rdev->wiphy.txq_quantum))
  2645. goto nla_put_failure;
  2646. }
  2647. state->split_start++;
  2648. break;
  2649. case 14:
  2650. if (nl80211_send_pmsr_capa(rdev, msg))
  2651. goto nla_put_failure;
  2652. state->split_start++;
  2653. break;
  2654. case 15:
  2655. if (rdev->wiphy.akm_suites &&
  2656. nla_put(msg, NL80211_ATTR_AKM_SUITES,
  2657. sizeof(u32) * rdev->wiphy.n_akm_suites,
  2658. rdev->wiphy.akm_suites))
  2659. goto nla_put_failure;
  2660. if (nl80211_put_iftype_akm_suites(rdev, msg))
  2661. goto nla_put_failure;
  2662. if (nl80211_put_tid_config_support(rdev, msg))
  2663. goto nla_put_failure;
  2664. state->split_start++;
  2665. break;
  2666. case 16:
  2667. if (nl80211_put_sar_specs(rdev, msg))
  2668. goto nla_put_failure;
  2669. if (nl80211_put_mbssid_support(&rdev->wiphy, msg))
  2670. goto nla_put_failure;
  2671. if (nla_put_u16(msg, NL80211_ATTR_MAX_NUM_AKM_SUITES,
  2672. rdev->wiphy.max_num_akm_suites))
  2673. goto nla_put_failure;
  2674. if (rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO)
  2675. nla_put_flag(msg, NL80211_ATTR_MLO_SUPPORT);
  2676. if (rdev->wiphy.hw_timestamp_max_peers &&
  2677. nla_put_u16(msg, NL80211_ATTR_MAX_HW_TIMESTAMP_PEERS,
  2678. rdev->wiphy.hw_timestamp_max_peers))
  2679. goto nla_put_failure;
  2680. state->split_start++;
  2681. break;
  2682. case 17:
  2683. if (nl80211_put_radios(&rdev->wiphy, msg))
  2684. goto nla_put_failure;
  2685. /* done */
  2686. state->split_start = 0;
  2687. break;
  2688. }
  2689. finish:
  2690. genlmsg_end(msg, hdr);
  2691. return 0;
  2692. nla_put_failure:
  2693. genlmsg_cancel(msg, hdr);
  2694. return -EMSGSIZE;
  2695. }
  2696. static int nl80211_dump_wiphy_parse(struct sk_buff *skb,
  2697. struct netlink_callback *cb,
  2698. struct nl80211_dump_wiphy_state *state)
  2699. {
  2700. struct nlattr **tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
  2701. int ret;
  2702. if (!tb)
  2703. return -ENOMEM;
  2704. ret = nlmsg_parse_deprecated(cb->nlh,
  2705. GENL_HDRLEN + nl80211_fam.hdrsize,
  2706. tb, nl80211_fam.maxattr,
  2707. nl80211_policy, NULL);
  2708. /* ignore parse errors for backward compatibility */
  2709. if (ret) {
  2710. ret = 0;
  2711. goto out;
  2712. }
  2713. state->split = tb[NL80211_ATTR_SPLIT_WIPHY_DUMP];
  2714. if (tb[NL80211_ATTR_WIPHY])
  2715. state->filter_wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
  2716. if (tb[NL80211_ATTR_WDEV])
  2717. state->filter_wiphy = nla_get_u64(tb[NL80211_ATTR_WDEV]) >> 32;
  2718. if (tb[NL80211_ATTR_IFINDEX]) {
  2719. struct net_device *netdev;
  2720. struct cfg80211_registered_device *rdev;
  2721. int ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
  2722. netdev = __dev_get_by_index(sock_net(skb->sk), ifidx);
  2723. if (!netdev) {
  2724. ret = -ENODEV;
  2725. goto out;
  2726. }
  2727. if (netdev->ieee80211_ptr) {
  2728. rdev = wiphy_to_rdev(
  2729. netdev->ieee80211_ptr->wiphy);
  2730. state->filter_wiphy = rdev->wiphy_idx;
  2731. }
  2732. }
  2733. ret = 0;
  2734. out:
  2735. kfree(tb);
  2736. return ret;
  2737. }
  2738. static int nl80211_dump_wiphy(struct sk_buff *skb, struct netlink_callback *cb)
  2739. {
  2740. int idx = 0, ret;
  2741. struct nl80211_dump_wiphy_state *state = (void *)cb->args[0];
  2742. struct cfg80211_registered_device *rdev;
  2743. rtnl_lock();
  2744. if (!state) {
  2745. state = kzalloc(sizeof(*state), GFP_KERNEL);
  2746. if (!state) {
  2747. rtnl_unlock();
  2748. return -ENOMEM;
  2749. }
  2750. state->filter_wiphy = -1;
  2751. ret = nl80211_dump_wiphy_parse(skb, cb, state);
  2752. if (ret) {
  2753. kfree(state);
  2754. rtnl_unlock();
  2755. return ret;
  2756. }
  2757. cb->args[0] = (long)state;
  2758. }
  2759. for_each_rdev(rdev) {
  2760. if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
  2761. continue;
  2762. if (++idx <= state->start)
  2763. continue;
  2764. if (state->filter_wiphy != -1 &&
  2765. state->filter_wiphy != rdev->wiphy_idx)
  2766. continue;
  2767. wiphy_lock(&rdev->wiphy);
  2768. /* attempt to fit multiple wiphy data chunks into the skb */
  2769. do {
  2770. ret = nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY,
  2771. skb,
  2772. NETLINK_CB(cb->skb).portid,
  2773. cb->nlh->nlmsg_seq,
  2774. NLM_F_MULTI, state);
  2775. if (ret < 0) {
  2776. /*
  2777. * If sending the wiphy data didn't fit (ENOBUFS
  2778. * or EMSGSIZE returned), this SKB is still
  2779. * empty (so it's not too big because another
  2780. * wiphy dataset is already in the skb) and
  2781. * we've not tried to adjust the dump allocation
  2782. * yet ... then adjust the alloc size to be
  2783. * bigger, and return 1 but with the empty skb.
  2784. * This results in an empty message being RX'ed
  2785. * in userspace, but that is ignored.
  2786. *
  2787. * We can then retry with the larger buffer.
  2788. */
  2789. if ((ret == -ENOBUFS || ret == -EMSGSIZE) &&
  2790. !skb->len && !state->split &&
  2791. cb->min_dump_alloc < 4096) {
  2792. cb->min_dump_alloc = 4096;
  2793. state->split_start = 0;
  2794. wiphy_unlock(&rdev->wiphy);
  2795. rtnl_unlock();
  2796. return 1;
  2797. }
  2798. idx--;
  2799. break;
  2800. }
  2801. } while (state->split_start > 0);
  2802. wiphy_unlock(&rdev->wiphy);
  2803. break;
  2804. }
  2805. rtnl_unlock();
  2806. state->start = idx;
  2807. return skb->len;
  2808. }
  2809. static int nl80211_dump_wiphy_done(struct netlink_callback *cb)
  2810. {
  2811. kfree((void *)cb->args[0]);
  2812. return 0;
  2813. }
  2814. static int nl80211_get_wiphy(struct sk_buff *skb, struct genl_info *info)
  2815. {
  2816. struct sk_buff *msg;
  2817. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  2818. struct nl80211_dump_wiphy_state state = {};
  2819. msg = nlmsg_new(4096, GFP_KERNEL);
  2820. if (!msg)
  2821. return -ENOMEM;
  2822. if (nl80211_send_wiphy(rdev, NL80211_CMD_NEW_WIPHY, msg,
  2823. info->snd_portid, info->snd_seq, 0,
  2824. &state) < 0) {
  2825. nlmsg_free(msg);
  2826. return -ENOBUFS;
  2827. }
  2828. return genlmsg_reply(msg, info);
  2829. }
  2830. static const struct nla_policy txq_params_policy[NL80211_TXQ_ATTR_MAX + 1] = {
  2831. [NL80211_TXQ_ATTR_QUEUE] = { .type = NLA_U8 },
  2832. [NL80211_TXQ_ATTR_TXOP] = { .type = NLA_U16 },
  2833. [NL80211_TXQ_ATTR_CWMIN] = { .type = NLA_U16 },
  2834. [NL80211_TXQ_ATTR_CWMAX] = { .type = NLA_U16 },
  2835. [NL80211_TXQ_ATTR_AIFS] = { .type = NLA_U8 },
  2836. };
  2837. static int parse_txq_params(struct nlattr *tb[],
  2838. struct ieee80211_txq_params *txq_params)
  2839. {
  2840. u8 ac;
  2841. if (!tb[NL80211_TXQ_ATTR_AC] || !tb[NL80211_TXQ_ATTR_TXOP] ||
  2842. !tb[NL80211_TXQ_ATTR_CWMIN] || !tb[NL80211_TXQ_ATTR_CWMAX] ||
  2843. !tb[NL80211_TXQ_ATTR_AIFS])
  2844. return -EINVAL;
  2845. ac = nla_get_u8(tb[NL80211_TXQ_ATTR_AC]);
  2846. txq_params->txop = nla_get_u16(tb[NL80211_TXQ_ATTR_TXOP]);
  2847. txq_params->cwmin = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMIN]);
  2848. txq_params->cwmax = nla_get_u16(tb[NL80211_TXQ_ATTR_CWMAX]);
  2849. txq_params->aifs = nla_get_u8(tb[NL80211_TXQ_ATTR_AIFS]);
  2850. if (ac >= NL80211_NUM_ACS)
  2851. return -EINVAL;
  2852. txq_params->ac = array_index_nospec(ac, NL80211_NUM_ACS);
  2853. return 0;
  2854. }
  2855. static bool nl80211_can_set_dev_channel(struct wireless_dev *wdev)
  2856. {
  2857. /*
  2858. * You can only set the channel explicitly for some interfaces,
  2859. * most have their channel managed via their respective
  2860. * "establish a connection" command (connect, join, ...)
  2861. *
  2862. * For AP/GO and mesh mode, the channel can be set with the
  2863. * channel userspace API, but is only stored and passed to the
  2864. * low-level driver when the AP starts or the mesh is joined.
  2865. * This is for backward compatibility, userspace can also give
  2866. * the channel in the start-ap or join-mesh commands instead.
  2867. *
  2868. * Monitors are special as they are normally slaved to
  2869. * whatever else is going on, so they have their own special
  2870. * operation to set the monitor channel if possible.
  2871. */
  2872. return !wdev ||
  2873. wdev->iftype == NL80211_IFTYPE_AP ||
  2874. wdev->iftype == NL80211_IFTYPE_MESH_POINT ||
  2875. wdev->iftype == NL80211_IFTYPE_MONITOR ||
  2876. wdev->iftype == NL80211_IFTYPE_P2P_GO;
  2877. }
  2878. static int _nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
  2879. struct genl_info *info, bool monitor,
  2880. struct cfg80211_chan_def *chandef)
  2881. {
  2882. struct netlink_ext_ack *extack = info->extack;
  2883. struct nlattr **attrs = info->attrs;
  2884. u32 control_freq;
  2885. if (!attrs[NL80211_ATTR_WIPHY_FREQ]) {
  2886. NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ],
  2887. "Frequency is missing");
  2888. return -EINVAL;
  2889. }
  2890. control_freq = MHZ_TO_KHZ(
  2891. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  2892. if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
  2893. control_freq +=
  2894. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
  2895. memset(chandef, 0, sizeof(*chandef));
  2896. chandef->chan = ieee80211_get_channel_khz(&rdev->wiphy, control_freq);
  2897. chandef->width = NL80211_CHAN_WIDTH_20_NOHT;
  2898. chandef->center_freq1 = KHZ_TO_MHZ(control_freq);
  2899. chandef->freq1_offset = control_freq % 1000;
  2900. chandef->center_freq2 = 0;
  2901. if (!chandef->chan) {
  2902. NL_SET_ERR_MSG_ATTR(extack, attrs[NL80211_ATTR_WIPHY_FREQ],
  2903. "Unknown channel");
  2904. return -EINVAL;
  2905. }
  2906. if (attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
  2907. enum nl80211_channel_type chantype;
  2908. chantype = nla_get_u32(attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
  2909. switch (chantype) {
  2910. case NL80211_CHAN_NO_HT:
  2911. case NL80211_CHAN_HT20:
  2912. case NL80211_CHAN_HT40PLUS:
  2913. case NL80211_CHAN_HT40MINUS:
  2914. cfg80211_chandef_create(chandef, chandef->chan,
  2915. chantype);
  2916. /* user input for center_freq is incorrect */
  2917. if (attrs[NL80211_ATTR_CENTER_FREQ1] &&
  2918. chandef->center_freq1 != nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1])) {
  2919. NL_SET_ERR_MSG_ATTR(extack,
  2920. attrs[NL80211_ATTR_CENTER_FREQ1],
  2921. "bad center frequency 1");
  2922. return -EINVAL;
  2923. }
  2924. /* center_freq2 must be zero */
  2925. if (attrs[NL80211_ATTR_CENTER_FREQ2] &&
  2926. nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2])) {
  2927. NL_SET_ERR_MSG_ATTR(extack,
  2928. attrs[NL80211_ATTR_CENTER_FREQ2],
  2929. "center frequency 2 can't be used");
  2930. return -EINVAL;
  2931. }
  2932. break;
  2933. default:
  2934. NL_SET_ERR_MSG_ATTR(extack,
  2935. attrs[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
  2936. "invalid channel type");
  2937. return -EINVAL;
  2938. }
  2939. } else if (attrs[NL80211_ATTR_CHANNEL_WIDTH]) {
  2940. chandef->width =
  2941. nla_get_u32(attrs[NL80211_ATTR_CHANNEL_WIDTH]);
  2942. if (chandef->chan->band == NL80211_BAND_S1GHZ) {
  2943. /* User input error for channel width doesn't match channel */
  2944. if (chandef->width != ieee80211_s1g_channel_width(chandef->chan)) {
  2945. NL_SET_ERR_MSG_ATTR(extack,
  2946. attrs[NL80211_ATTR_CHANNEL_WIDTH],
  2947. "bad channel width");
  2948. return -EINVAL;
  2949. }
  2950. }
  2951. if (attrs[NL80211_ATTR_CENTER_FREQ1]) {
  2952. chandef->center_freq1 =
  2953. nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ1]);
  2954. if (attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET])
  2955. chandef->freq1_offset = nla_get_u32(
  2956. attrs[NL80211_ATTR_CENTER_FREQ1_OFFSET]);
  2957. else
  2958. chandef->freq1_offset = 0;
  2959. }
  2960. if (attrs[NL80211_ATTR_CENTER_FREQ2])
  2961. chandef->center_freq2 =
  2962. nla_get_u32(attrs[NL80211_ATTR_CENTER_FREQ2]);
  2963. }
  2964. if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
  2965. chandef->edmg.channels =
  2966. nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
  2967. if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
  2968. chandef->edmg.bw_config =
  2969. nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
  2970. } else {
  2971. chandef->edmg.bw_config = 0;
  2972. chandef->edmg.channels = 0;
  2973. }
  2974. if (info->attrs[NL80211_ATTR_PUNCT_BITMAP]) {
  2975. chandef->punctured =
  2976. nla_get_u32(info->attrs[NL80211_ATTR_PUNCT_BITMAP]);
  2977. if (chandef->punctured &&
  2978. !wiphy_ext_feature_isset(&rdev->wiphy,
  2979. NL80211_EXT_FEATURE_PUNCT)) {
  2980. NL_SET_ERR_MSG(extack,
  2981. "driver doesn't support puncturing");
  2982. return -EINVAL;
  2983. }
  2984. }
  2985. if (!cfg80211_chandef_valid(chandef)) {
  2986. NL_SET_ERR_MSG(extack, "invalid channel definition");
  2987. return -EINVAL;
  2988. }
  2989. if (!_cfg80211_chandef_usable(&rdev->wiphy, chandef,
  2990. IEEE80211_CHAN_DISABLED,
  2991. monitor ? IEEE80211_CHAN_CAN_MONITOR : 0)) {
  2992. NL_SET_ERR_MSG(extack, "(extension) channel is disabled");
  2993. return -EINVAL;
  2994. }
  2995. if ((chandef->width == NL80211_CHAN_WIDTH_5 ||
  2996. chandef->width == NL80211_CHAN_WIDTH_10) &&
  2997. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_5_10_MHZ)) {
  2998. NL_SET_ERR_MSG(extack, "5/10 MHz not supported");
  2999. return -EINVAL;
  3000. }
  3001. return 0;
  3002. }
  3003. int nl80211_parse_chandef(struct cfg80211_registered_device *rdev,
  3004. struct genl_info *info,
  3005. struct cfg80211_chan_def *chandef)
  3006. {
  3007. return _nl80211_parse_chandef(rdev, info, false, chandef);
  3008. }
  3009. static int __nl80211_set_channel(struct cfg80211_registered_device *rdev,
  3010. struct net_device *dev,
  3011. struct genl_info *info,
  3012. int _link_id)
  3013. {
  3014. struct cfg80211_chan_def chandef;
  3015. int result;
  3016. enum nl80211_iftype iftype = NL80211_IFTYPE_MONITOR;
  3017. struct wireless_dev *wdev = NULL;
  3018. int link_id = _link_id;
  3019. if (dev)
  3020. wdev = dev->ieee80211_ptr;
  3021. if (!nl80211_can_set_dev_channel(wdev))
  3022. return -EOPNOTSUPP;
  3023. if (wdev)
  3024. iftype = wdev->iftype;
  3025. if (link_id < 0) {
  3026. if (wdev && wdev->valid_links)
  3027. return -EINVAL;
  3028. link_id = 0;
  3029. }
  3030. result = _nl80211_parse_chandef(rdev, info,
  3031. iftype == NL80211_IFTYPE_MONITOR,
  3032. &chandef);
  3033. if (result)
  3034. return result;
  3035. switch (iftype) {
  3036. case NL80211_IFTYPE_AP:
  3037. case NL80211_IFTYPE_P2P_GO:
  3038. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
  3039. iftype))
  3040. return -EINVAL;
  3041. if (wdev->links[link_id].ap.beacon_interval) {
  3042. struct ieee80211_channel *cur_chan;
  3043. if (!dev || !rdev->ops->set_ap_chanwidth ||
  3044. !(rdev->wiphy.features &
  3045. NL80211_FEATURE_AP_MODE_CHAN_WIDTH_CHANGE))
  3046. return -EBUSY;
  3047. /* Only allow dynamic channel width changes */
  3048. cur_chan = wdev->links[link_id].ap.chandef.chan;
  3049. if (chandef.chan != cur_chan)
  3050. return -EBUSY;
  3051. /* only allow this for regular channel widths */
  3052. switch (wdev->links[link_id].ap.chandef.width) {
  3053. case NL80211_CHAN_WIDTH_20_NOHT:
  3054. case NL80211_CHAN_WIDTH_20:
  3055. case NL80211_CHAN_WIDTH_40:
  3056. case NL80211_CHAN_WIDTH_80:
  3057. case NL80211_CHAN_WIDTH_80P80:
  3058. case NL80211_CHAN_WIDTH_160:
  3059. case NL80211_CHAN_WIDTH_320:
  3060. break;
  3061. default:
  3062. return -EINVAL;
  3063. }
  3064. switch (chandef.width) {
  3065. case NL80211_CHAN_WIDTH_20_NOHT:
  3066. case NL80211_CHAN_WIDTH_20:
  3067. case NL80211_CHAN_WIDTH_40:
  3068. case NL80211_CHAN_WIDTH_80:
  3069. case NL80211_CHAN_WIDTH_80P80:
  3070. case NL80211_CHAN_WIDTH_160:
  3071. case NL80211_CHAN_WIDTH_320:
  3072. break;
  3073. default:
  3074. return -EINVAL;
  3075. }
  3076. result = rdev_set_ap_chanwidth(rdev, dev, link_id,
  3077. &chandef);
  3078. if (result)
  3079. return result;
  3080. wdev->links[link_id].ap.chandef = chandef;
  3081. } else {
  3082. wdev->u.ap.preset_chandef = chandef;
  3083. }
  3084. return 0;
  3085. case NL80211_IFTYPE_MESH_POINT:
  3086. return cfg80211_set_mesh_channel(rdev, wdev, &chandef);
  3087. case NL80211_IFTYPE_MONITOR:
  3088. return cfg80211_set_monitor_channel(rdev, &chandef);
  3089. default:
  3090. break;
  3091. }
  3092. return -EINVAL;
  3093. }
  3094. static int nl80211_set_channel(struct sk_buff *skb, struct genl_info *info)
  3095. {
  3096. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3097. int link_id = nl80211_link_id_or_invalid(info->attrs);
  3098. struct net_device *netdev = info->user_ptr[1];
  3099. return __nl80211_set_channel(rdev, netdev, info, link_id);
  3100. }
  3101. static int nl80211_set_wiphy(struct sk_buff *skb, struct genl_info *info)
  3102. {
  3103. struct cfg80211_registered_device *rdev = NULL;
  3104. struct net_device *netdev = NULL;
  3105. struct wireless_dev *wdev;
  3106. int result = 0, rem_txq_params = 0;
  3107. struct nlattr *nl_txq_params;
  3108. u32 changed;
  3109. u8 retry_short = 0, retry_long = 0;
  3110. u32 frag_threshold = 0, rts_threshold = 0;
  3111. u8 coverage_class = 0;
  3112. u32 txq_limit = 0, txq_memory_limit = 0, txq_quantum = 0;
  3113. rtnl_lock();
  3114. /*
  3115. * Try to find the wiphy and netdev. Normally this
  3116. * function shouldn't need the netdev, but this is
  3117. * done for backward compatibility -- previously
  3118. * setting the channel was done per wiphy, but now
  3119. * it is per netdev. Previous userland like hostapd
  3120. * also passed a netdev to set_wiphy, so that it is
  3121. * possible to let that go to the right netdev!
  3122. */
  3123. if (info->attrs[NL80211_ATTR_IFINDEX]) {
  3124. int ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
  3125. netdev = __dev_get_by_index(genl_info_net(info), ifindex);
  3126. if (netdev && netdev->ieee80211_ptr)
  3127. rdev = wiphy_to_rdev(netdev->ieee80211_ptr->wiphy);
  3128. else
  3129. netdev = NULL;
  3130. }
  3131. if (!netdev) {
  3132. rdev = __cfg80211_rdev_from_attrs(genl_info_net(info),
  3133. info->attrs);
  3134. if (IS_ERR(rdev)) {
  3135. rtnl_unlock();
  3136. return PTR_ERR(rdev);
  3137. }
  3138. wdev = NULL;
  3139. netdev = NULL;
  3140. result = 0;
  3141. } else
  3142. wdev = netdev->ieee80211_ptr;
  3143. wiphy_lock(&rdev->wiphy);
  3144. /*
  3145. * end workaround code, by now the rdev is available
  3146. * and locked, and wdev may or may not be NULL.
  3147. */
  3148. if (info->attrs[NL80211_ATTR_WIPHY_NAME])
  3149. result = cfg80211_dev_rename(
  3150. rdev, nla_data(info->attrs[NL80211_ATTR_WIPHY_NAME]));
  3151. rtnl_unlock();
  3152. if (result)
  3153. goto out;
  3154. if (info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS]) {
  3155. struct ieee80211_txq_params txq_params;
  3156. struct nlattr *tb[NL80211_TXQ_ATTR_MAX + 1];
  3157. if (!rdev->ops->set_txq_params) {
  3158. result = -EOPNOTSUPP;
  3159. goto out;
  3160. }
  3161. if (!netdev) {
  3162. result = -EINVAL;
  3163. goto out;
  3164. }
  3165. if (netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  3166. netdev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  3167. result = -EINVAL;
  3168. goto out;
  3169. }
  3170. if (!netif_running(netdev)) {
  3171. result = -ENETDOWN;
  3172. goto out;
  3173. }
  3174. nla_for_each_nested(nl_txq_params,
  3175. info->attrs[NL80211_ATTR_WIPHY_TXQ_PARAMS],
  3176. rem_txq_params) {
  3177. result = nla_parse_nested_deprecated(tb,
  3178. NL80211_TXQ_ATTR_MAX,
  3179. nl_txq_params,
  3180. txq_params_policy,
  3181. info->extack);
  3182. if (result)
  3183. goto out;
  3184. result = parse_txq_params(tb, &txq_params);
  3185. if (result)
  3186. goto out;
  3187. txq_params.link_id =
  3188. nl80211_link_id_or_invalid(info->attrs);
  3189. if (txq_params.link_id >= 0 &&
  3190. !(netdev->ieee80211_ptr->valid_links &
  3191. BIT(txq_params.link_id)))
  3192. result = -ENOLINK;
  3193. else if (txq_params.link_id >= 0 &&
  3194. !netdev->ieee80211_ptr->valid_links)
  3195. result = -EINVAL;
  3196. else
  3197. result = rdev_set_txq_params(rdev, netdev,
  3198. &txq_params);
  3199. if (result)
  3200. goto out;
  3201. }
  3202. }
  3203. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  3204. int link_id = nl80211_link_id_or_invalid(info->attrs);
  3205. if (wdev) {
  3206. result = __nl80211_set_channel(
  3207. rdev,
  3208. nl80211_can_set_dev_channel(wdev) ? netdev : NULL,
  3209. info, link_id);
  3210. } else {
  3211. result = __nl80211_set_channel(rdev, netdev, info, link_id);
  3212. }
  3213. if (result)
  3214. goto out;
  3215. }
  3216. if (info->attrs[NL80211_ATTR_WIPHY_TX_POWER_SETTING]) {
  3217. struct wireless_dev *txp_wdev = wdev;
  3218. enum nl80211_tx_power_setting type;
  3219. int idx, mbm = 0;
  3220. if (!(rdev->wiphy.features & NL80211_FEATURE_VIF_TXPOWER))
  3221. txp_wdev = NULL;
  3222. if (!rdev->ops->set_tx_power) {
  3223. result = -EOPNOTSUPP;
  3224. goto out;
  3225. }
  3226. idx = NL80211_ATTR_WIPHY_TX_POWER_SETTING;
  3227. type = nla_get_u32(info->attrs[idx]);
  3228. if (!info->attrs[NL80211_ATTR_WIPHY_TX_POWER_LEVEL] &&
  3229. (type != NL80211_TX_POWER_AUTOMATIC)) {
  3230. result = -EINVAL;
  3231. goto out;
  3232. }
  3233. if (type != NL80211_TX_POWER_AUTOMATIC) {
  3234. idx = NL80211_ATTR_WIPHY_TX_POWER_LEVEL;
  3235. mbm = nla_get_u32(info->attrs[idx]);
  3236. }
  3237. result = rdev_set_tx_power(rdev, txp_wdev, type, mbm);
  3238. if (result)
  3239. goto out;
  3240. }
  3241. if (info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX] &&
  3242. info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]) {
  3243. u32 tx_ant, rx_ant;
  3244. if ((!rdev->wiphy.available_antennas_tx &&
  3245. !rdev->wiphy.available_antennas_rx) ||
  3246. !rdev->ops->set_antenna) {
  3247. result = -EOPNOTSUPP;
  3248. goto out;
  3249. }
  3250. tx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_TX]);
  3251. rx_ant = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_ANTENNA_RX]);
  3252. /* reject antenna configurations which don't match the
  3253. * available antenna masks, except for the "all" mask */
  3254. if ((~tx_ant && (tx_ant & ~rdev->wiphy.available_antennas_tx)) ||
  3255. (~rx_ant && (rx_ant & ~rdev->wiphy.available_antennas_rx))) {
  3256. result = -EINVAL;
  3257. goto out;
  3258. }
  3259. tx_ant = tx_ant & rdev->wiphy.available_antennas_tx;
  3260. rx_ant = rx_ant & rdev->wiphy.available_antennas_rx;
  3261. result = rdev_set_antenna(rdev, tx_ant, rx_ant);
  3262. if (result)
  3263. goto out;
  3264. }
  3265. changed = 0;
  3266. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]) {
  3267. retry_short = nla_get_u8(
  3268. info->attrs[NL80211_ATTR_WIPHY_RETRY_SHORT]);
  3269. changed |= WIPHY_PARAM_RETRY_SHORT;
  3270. }
  3271. if (info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]) {
  3272. retry_long = nla_get_u8(
  3273. info->attrs[NL80211_ATTR_WIPHY_RETRY_LONG]);
  3274. changed |= WIPHY_PARAM_RETRY_LONG;
  3275. }
  3276. if (info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]) {
  3277. frag_threshold = nla_get_u32(
  3278. info->attrs[NL80211_ATTR_WIPHY_FRAG_THRESHOLD]);
  3279. if (frag_threshold < 256) {
  3280. result = -EINVAL;
  3281. goto out;
  3282. }
  3283. if (frag_threshold != (u32) -1) {
  3284. /*
  3285. * Fragments (apart from the last one) are required to
  3286. * have even length. Make the fragmentation code
  3287. * simpler by stripping LSB should someone try to use
  3288. * odd threshold value.
  3289. */
  3290. frag_threshold &= ~0x1;
  3291. }
  3292. changed |= WIPHY_PARAM_FRAG_THRESHOLD;
  3293. }
  3294. if (info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]) {
  3295. rts_threshold = nla_get_u32(
  3296. info->attrs[NL80211_ATTR_WIPHY_RTS_THRESHOLD]);
  3297. changed |= WIPHY_PARAM_RTS_THRESHOLD;
  3298. }
  3299. if (info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]) {
  3300. if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
  3301. result = -EINVAL;
  3302. goto out;
  3303. }
  3304. coverage_class = nla_get_u8(
  3305. info->attrs[NL80211_ATTR_WIPHY_COVERAGE_CLASS]);
  3306. changed |= WIPHY_PARAM_COVERAGE_CLASS;
  3307. }
  3308. if (info->attrs[NL80211_ATTR_WIPHY_DYN_ACK]) {
  3309. if (!(rdev->wiphy.features & NL80211_FEATURE_ACKTO_ESTIMATION)) {
  3310. result = -EOPNOTSUPP;
  3311. goto out;
  3312. }
  3313. changed |= WIPHY_PARAM_DYN_ACK;
  3314. }
  3315. if (info->attrs[NL80211_ATTR_TXQ_LIMIT]) {
  3316. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  3317. NL80211_EXT_FEATURE_TXQS)) {
  3318. result = -EOPNOTSUPP;
  3319. goto out;
  3320. }
  3321. txq_limit = nla_get_u32(
  3322. info->attrs[NL80211_ATTR_TXQ_LIMIT]);
  3323. changed |= WIPHY_PARAM_TXQ_LIMIT;
  3324. }
  3325. if (info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]) {
  3326. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  3327. NL80211_EXT_FEATURE_TXQS)) {
  3328. result = -EOPNOTSUPP;
  3329. goto out;
  3330. }
  3331. txq_memory_limit = nla_get_u32(
  3332. info->attrs[NL80211_ATTR_TXQ_MEMORY_LIMIT]);
  3333. changed |= WIPHY_PARAM_TXQ_MEMORY_LIMIT;
  3334. }
  3335. if (info->attrs[NL80211_ATTR_TXQ_QUANTUM]) {
  3336. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  3337. NL80211_EXT_FEATURE_TXQS)) {
  3338. result = -EOPNOTSUPP;
  3339. goto out;
  3340. }
  3341. txq_quantum = nla_get_u32(
  3342. info->attrs[NL80211_ATTR_TXQ_QUANTUM]);
  3343. changed |= WIPHY_PARAM_TXQ_QUANTUM;
  3344. }
  3345. if (changed) {
  3346. u8 old_retry_short, old_retry_long;
  3347. u32 old_frag_threshold, old_rts_threshold;
  3348. u8 old_coverage_class;
  3349. u32 old_txq_limit, old_txq_memory_limit, old_txq_quantum;
  3350. if (!rdev->ops->set_wiphy_params) {
  3351. result = -EOPNOTSUPP;
  3352. goto out;
  3353. }
  3354. old_retry_short = rdev->wiphy.retry_short;
  3355. old_retry_long = rdev->wiphy.retry_long;
  3356. old_frag_threshold = rdev->wiphy.frag_threshold;
  3357. old_rts_threshold = rdev->wiphy.rts_threshold;
  3358. old_coverage_class = rdev->wiphy.coverage_class;
  3359. old_txq_limit = rdev->wiphy.txq_limit;
  3360. old_txq_memory_limit = rdev->wiphy.txq_memory_limit;
  3361. old_txq_quantum = rdev->wiphy.txq_quantum;
  3362. if (changed & WIPHY_PARAM_RETRY_SHORT)
  3363. rdev->wiphy.retry_short = retry_short;
  3364. if (changed & WIPHY_PARAM_RETRY_LONG)
  3365. rdev->wiphy.retry_long = retry_long;
  3366. if (changed & WIPHY_PARAM_FRAG_THRESHOLD)
  3367. rdev->wiphy.frag_threshold = frag_threshold;
  3368. if (changed & WIPHY_PARAM_RTS_THRESHOLD)
  3369. rdev->wiphy.rts_threshold = rts_threshold;
  3370. if (changed & WIPHY_PARAM_COVERAGE_CLASS)
  3371. rdev->wiphy.coverage_class = coverage_class;
  3372. if (changed & WIPHY_PARAM_TXQ_LIMIT)
  3373. rdev->wiphy.txq_limit = txq_limit;
  3374. if (changed & WIPHY_PARAM_TXQ_MEMORY_LIMIT)
  3375. rdev->wiphy.txq_memory_limit = txq_memory_limit;
  3376. if (changed & WIPHY_PARAM_TXQ_QUANTUM)
  3377. rdev->wiphy.txq_quantum = txq_quantum;
  3378. result = rdev_set_wiphy_params(rdev, changed);
  3379. if (result) {
  3380. rdev->wiphy.retry_short = old_retry_short;
  3381. rdev->wiphy.retry_long = old_retry_long;
  3382. rdev->wiphy.frag_threshold = old_frag_threshold;
  3383. rdev->wiphy.rts_threshold = old_rts_threshold;
  3384. rdev->wiphy.coverage_class = old_coverage_class;
  3385. rdev->wiphy.txq_limit = old_txq_limit;
  3386. rdev->wiphy.txq_memory_limit = old_txq_memory_limit;
  3387. rdev->wiphy.txq_quantum = old_txq_quantum;
  3388. goto out;
  3389. }
  3390. }
  3391. result = 0;
  3392. out:
  3393. wiphy_unlock(&rdev->wiphy);
  3394. return result;
  3395. }
  3396. int nl80211_send_chandef(struct sk_buff *msg, const struct cfg80211_chan_def *chandef)
  3397. {
  3398. if (WARN_ON(!cfg80211_chandef_valid(chandef)))
  3399. return -EINVAL;
  3400. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
  3401. chandef->chan->center_freq))
  3402. return -ENOBUFS;
  3403. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET,
  3404. chandef->chan->freq_offset))
  3405. return -ENOBUFS;
  3406. switch (chandef->width) {
  3407. case NL80211_CHAN_WIDTH_20_NOHT:
  3408. case NL80211_CHAN_WIDTH_20:
  3409. case NL80211_CHAN_WIDTH_40:
  3410. if (nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
  3411. cfg80211_get_chandef_type(chandef)))
  3412. return -ENOBUFS;
  3413. break;
  3414. default:
  3415. break;
  3416. }
  3417. if (nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, chandef->width))
  3418. return -ENOBUFS;
  3419. if (nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ1, chandef->center_freq1))
  3420. return -ENOBUFS;
  3421. if (chandef->center_freq2 &&
  3422. nla_put_u32(msg, NL80211_ATTR_CENTER_FREQ2, chandef->center_freq2))
  3423. return -ENOBUFS;
  3424. if (chandef->punctured &&
  3425. nla_put_u32(msg, NL80211_ATTR_PUNCT_BITMAP, chandef->punctured))
  3426. return -ENOBUFS;
  3427. return 0;
  3428. }
  3429. EXPORT_SYMBOL(nl80211_send_chandef);
  3430. static int nl80211_send_iface(struct sk_buff *msg, u32 portid, u32 seq, int flags,
  3431. struct cfg80211_registered_device *rdev,
  3432. struct wireless_dev *wdev,
  3433. enum nl80211_commands cmd)
  3434. {
  3435. struct net_device *dev = wdev->netdev;
  3436. void *hdr;
  3437. lockdep_assert_wiphy(&rdev->wiphy);
  3438. WARN_ON(cmd != NL80211_CMD_NEW_INTERFACE &&
  3439. cmd != NL80211_CMD_DEL_INTERFACE &&
  3440. cmd != NL80211_CMD_SET_INTERFACE);
  3441. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  3442. if (!hdr)
  3443. return -1;
  3444. if (dev &&
  3445. (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  3446. nla_put_string(msg, NL80211_ATTR_IFNAME, dev->name)))
  3447. goto nla_put_failure;
  3448. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  3449. nla_put_u32(msg, NL80211_ATTR_IFTYPE, wdev->iftype) ||
  3450. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  3451. NL80211_ATTR_PAD) ||
  3452. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, wdev_address(wdev)) ||
  3453. nla_put_u32(msg, NL80211_ATTR_GENERATION,
  3454. rdev->devlist_generation ^
  3455. (cfg80211_rdev_list_generation << 2)) ||
  3456. nla_put_u8(msg, NL80211_ATTR_4ADDR, wdev->use_4addr))
  3457. goto nla_put_failure;
  3458. if (rdev->ops->get_channel && !wdev->valid_links) {
  3459. struct cfg80211_chan_def chandef = {};
  3460. int ret;
  3461. ret = rdev_get_channel(rdev, wdev, 0, &chandef);
  3462. if (ret == 0 && nl80211_send_chandef(msg, &chandef))
  3463. goto nla_put_failure;
  3464. }
  3465. if (rdev->ops->get_tx_power) {
  3466. int dbm, ret;
  3467. ret = rdev_get_tx_power(rdev, wdev, &dbm);
  3468. if (ret == 0 &&
  3469. nla_put_u32(msg, NL80211_ATTR_WIPHY_TX_POWER_LEVEL,
  3470. DBM_TO_MBM(dbm)))
  3471. goto nla_put_failure;
  3472. }
  3473. switch (wdev->iftype) {
  3474. case NL80211_IFTYPE_AP:
  3475. case NL80211_IFTYPE_P2P_GO:
  3476. if (wdev->u.ap.ssid_len &&
  3477. nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len,
  3478. wdev->u.ap.ssid))
  3479. goto nla_put_failure;
  3480. break;
  3481. case NL80211_IFTYPE_STATION:
  3482. case NL80211_IFTYPE_P2P_CLIENT:
  3483. if (wdev->u.client.ssid_len &&
  3484. nla_put(msg, NL80211_ATTR_SSID, wdev->u.client.ssid_len,
  3485. wdev->u.client.ssid))
  3486. goto nla_put_failure;
  3487. break;
  3488. case NL80211_IFTYPE_ADHOC:
  3489. if (wdev->u.ibss.ssid_len &&
  3490. nla_put(msg, NL80211_ATTR_SSID, wdev->u.ibss.ssid_len,
  3491. wdev->u.ibss.ssid))
  3492. goto nla_put_failure;
  3493. break;
  3494. default:
  3495. /* nothing */
  3496. break;
  3497. }
  3498. if (rdev->ops->get_txq_stats) {
  3499. struct cfg80211_txq_stats txqstats = {};
  3500. int ret = rdev_get_txq_stats(rdev, wdev, &txqstats);
  3501. if (ret == 0 &&
  3502. !nl80211_put_txq_stats(msg, &txqstats,
  3503. NL80211_ATTR_TXQ_STATS))
  3504. goto nla_put_failure;
  3505. }
  3506. if (wdev->valid_links) {
  3507. unsigned int link_id;
  3508. struct nlattr *links = nla_nest_start(msg,
  3509. NL80211_ATTR_MLO_LINKS);
  3510. if (!links)
  3511. goto nla_put_failure;
  3512. for_each_valid_link(wdev, link_id) {
  3513. struct nlattr *link = nla_nest_start(msg, link_id + 1);
  3514. struct cfg80211_chan_def chandef = {};
  3515. int ret;
  3516. if (!link)
  3517. goto nla_put_failure;
  3518. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
  3519. goto nla_put_failure;
  3520. if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
  3521. wdev->links[link_id].addr))
  3522. goto nla_put_failure;
  3523. ret = rdev_get_channel(rdev, wdev, link_id, &chandef);
  3524. if (ret == 0 && nl80211_send_chandef(msg, &chandef))
  3525. goto nla_put_failure;
  3526. nla_nest_end(msg, link);
  3527. }
  3528. nla_nest_end(msg, links);
  3529. }
  3530. genlmsg_end(msg, hdr);
  3531. return 0;
  3532. nla_put_failure:
  3533. genlmsg_cancel(msg, hdr);
  3534. return -EMSGSIZE;
  3535. }
  3536. static int nl80211_dump_interface(struct sk_buff *skb, struct netlink_callback *cb)
  3537. {
  3538. int wp_idx = 0;
  3539. int if_idx = 0;
  3540. int wp_start = cb->args[0];
  3541. int if_start = cb->args[1];
  3542. int filter_wiphy = -1;
  3543. struct cfg80211_registered_device *rdev;
  3544. struct wireless_dev *wdev;
  3545. int ret;
  3546. rtnl_lock();
  3547. if (!cb->args[2]) {
  3548. struct nl80211_dump_wiphy_state state = {
  3549. .filter_wiphy = -1,
  3550. };
  3551. ret = nl80211_dump_wiphy_parse(skb, cb, &state);
  3552. if (ret)
  3553. goto out_unlock;
  3554. filter_wiphy = state.filter_wiphy;
  3555. /*
  3556. * if filtering, set cb->args[2] to +1 since 0 is the default
  3557. * value needed to determine that parsing is necessary.
  3558. */
  3559. if (filter_wiphy >= 0)
  3560. cb->args[2] = filter_wiphy + 1;
  3561. else
  3562. cb->args[2] = -1;
  3563. } else if (cb->args[2] > 0) {
  3564. filter_wiphy = cb->args[2] - 1;
  3565. }
  3566. for_each_rdev(rdev) {
  3567. if (!net_eq(wiphy_net(&rdev->wiphy), sock_net(skb->sk)))
  3568. continue;
  3569. if (wp_idx < wp_start) {
  3570. wp_idx++;
  3571. continue;
  3572. }
  3573. if (filter_wiphy >= 0 && filter_wiphy != rdev->wiphy_idx)
  3574. continue;
  3575. if_idx = 0;
  3576. wiphy_lock(&rdev->wiphy);
  3577. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  3578. if (if_idx < if_start) {
  3579. if_idx++;
  3580. continue;
  3581. }
  3582. if (nl80211_send_iface(skb, NETLINK_CB(cb->skb).portid,
  3583. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  3584. rdev, wdev,
  3585. NL80211_CMD_NEW_INTERFACE) < 0) {
  3586. wiphy_unlock(&rdev->wiphy);
  3587. goto out;
  3588. }
  3589. if_idx++;
  3590. }
  3591. wiphy_unlock(&rdev->wiphy);
  3592. if_start = 0;
  3593. wp_idx++;
  3594. }
  3595. out:
  3596. cb->args[0] = wp_idx;
  3597. cb->args[1] = if_idx;
  3598. ret = skb->len;
  3599. out_unlock:
  3600. rtnl_unlock();
  3601. return ret;
  3602. }
  3603. static int nl80211_get_interface(struct sk_buff *skb, struct genl_info *info)
  3604. {
  3605. struct sk_buff *msg;
  3606. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3607. struct wireless_dev *wdev = info->user_ptr[1];
  3608. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3609. if (!msg)
  3610. return -ENOMEM;
  3611. if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  3612. rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
  3613. nlmsg_free(msg);
  3614. return -ENOBUFS;
  3615. }
  3616. return genlmsg_reply(msg, info);
  3617. }
  3618. static const struct nla_policy mntr_flags_policy[NL80211_MNTR_FLAG_MAX + 1] = {
  3619. [NL80211_MNTR_FLAG_FCSFAIL] = { .type = NLA_FLAG },
  3620. [NL80211_MNTR_FLAG_PLCPFAIL] = { .type = NLA_FLAG },
  3621. [NL80211_MNTR_FLAG_CONTROL] = { .type = NLA_FLAG },
  3622. [NL80211_MNTR_FLAG_OTHER_BSS] = { .type = NLA_FLAG },
  3623. [NL80211_MNTR_FLAG_COOK_FRAMES] = { .type = NLA_FLAG },
  3624. [NL80211_MNTR_FLAG_ACTIVE] = { .type = NLA_FLAG },
  3625. };
  3626. static int parse_monitor_flags(struct nlattr *nla, u32 *mntrflags)
  3627. {
  3628. struct nlattr *flags[NL80211_MNTR_FLAG_MAX + 1];
  3629. int flag;
  3630. *mntrflags = 0;
  3631. if (!nla)
  3632. return -EINVAL;
  3633. if (nla_parse_nested_deprecated(flags, NL80211_MNTR_FLAG_MAX, nla, mntr_flags_policy, NULL))
  3634. return -EINVAL;
  3635. for (flag = 1; flag <= NL80211_MNTR_FLAG_MAX; flag++)
  3636. if (flags[flag])
  3637. *mntrflags |= (1<<flag);
  3638. /* cooked monitor mode is incompatible with other modes */
  3639. if (*mntrflags & MONITOR_FLAG_COOK_FRAMES &&
  3640. *mntrflags != MONITOR_FLAG_COOK_FRAMES)
  3641. return -EOPNOTSUPP;
  3642. *mntrflags |= MONITOR_FLAG_CHANGED;
  3643. return 0;
  3644. }
  3645. static int nl80211_parse_mon_options(struct cfg80211_registered_device *rdev,
  3646. enum nl80211_iftype type,
  3647. struct genl_info *info,
  3648. struct vif_params *params)
  3649. {
  3650. bool change = false;
  3651. int err;
  3652. if (info->attrs[NL80211_ATTR_MNTR_FLAGS]) {
  3653. if (type != NL80211_IFTYPE_MONITOR)
  3654. return -EINVAL;
  3655. err = parse_monitor_flags(info->attrs[NL80211_ATTR_MNTR_FLAGS],
  3656. &params->flags);
  3657. if (err)
  3658. return err;
  3659. change = true;
  3660. }
  3661. if (params->flags & MONITOR_FLAG_ACTIVE &&
  3662. !(rdev->wiphy.features & NL80211_FEATURE_ACTIVE_MONITOR))
  3663. return -EOPNOTSUPP;
  3664. if (info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]) {
  3665. const u8 *mumimo_groups;
  3666. u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
  3667. if (type != NL80211_IFTYPE_MONITOR)
  3668. return -EINVAL;
  3669. if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
  3670. return -EOPNOTSUPP;
  3671. mumimo_groups =
  3672. nla_data(info->attrs[NL80211_ATTR_MU_MIMO_GROUP_DATA]);
  3673. /* bits 0 and 63 are reserved and must be zero */
  3674. if ((mumimo_groups[0] & BIT(0)) ||
  3675. (mumimo_groups[VHT_MUMIMO_GROUPS_DATA_LEN - 1] & BIT(7)))
  3676. return -EINVAL;
  3677. params->vht_mumimo_groups = mumimo_groups;
  3678. change = true;
  3679. }
  3680. if (info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]) {
  3681. u32 cap_flag = NL80211_EXT_FEATURE_MU_MIMO_AIR_SNIFFER;
  3682. if (type != NL80211_IFTYPE_MONITOR)
  3683. return -EINVAL;
  3684. if (!wiphy_ext_feature_isset(&rdev->wiphy, cap_flag))
  3685. return -EOPNOTSUPP;
  3686. params->vht_mumimo_follow_addr =
  3687. nla_data(info->attrs[NL80211_ATTR_MU_MIMO_FOLLOW_MAC_ADDR]);
  3688. change = true;
  3689. }
  3690. return change ? 1 : 0;
  3691. }
  3692. static int nl80211_valid_4addr(struct cfg80211_registered_device *rdev,
  3693. struct net_device *netdev, u8 use_4addr,
  3694. enum nl80211_iftype iftype)
  3695. {
  3696. if (!use_4addr) {
  3697. if (netdev && netif_is_bridge_port(netdev))
  3698. return -EBUSY;
  3699. return 0;
  3700. }
  3701. switch (iftype) {
  3702. case NL80211_IFTYPE_AP_VLAN:
  3703. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_AP)
  3704. return 0;
  3705. break;
  3706. case NL80211_IFTYPE_STATION:
  3707. if (rdev->wiphy.flags & WIPHY_FLAG_4ADDR_STATION)
  3708. return 0;
  3709. break;
  3710. default:
  3711. break;
  3712. }
  3713. return -EOPNOTSUPP;
  3714. }
  3715. static int nl80211_set_interface(struct sk_buff *skb, struct genl_info *info)
  3716. {
  3717. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3718. struct vif_params params;
  3719. int err;
  3720. enum nl80211_iftype otype, ntype;
  3721. struct net_device *dev = info->user_ptr[1];
  3722. bool change = false;
  3723. memset(&params, 0, sizeof(params));
  3724. otype = ntype = dev->ieee80211_ptr->iftype;
  3725. if (info->attrs[NL80211_ATTR_IFTYPE]) {
  3726. ntype = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  3727. if (otype != ntype)
  3728. change = true;
  3729. }
  3730. if (info->attrs[NL80211_ATTR_MESH_ID]) {
  3731. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3732. if (ntype != NL80211_IFTYPE_MESH_POINT)
  3733. return -EINVAL;
  3734. if (otype != NL80211_IFTYPE_MESH_POINT)
  3735. return -EINVAL;
  3736. if (netif_running(dev))
  3737. return -EBUSY;
  3738. wdev->u.mesh.id_up_len =
  3739. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  3740. memcpy(wdev->u.mesh.id,
  3741. nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  3742. wdev->u.mesh.id_up_len);
  3743. }
  3744. if (info->attrs[NL80211_ATTR_4ADDR]) {
  3745. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  3746. change = true;
  3747. err = nl80211_valid_4addr(rdev, dev, params.use_4addr, ntype);
  3748. if (err)
  3749. return err;
  3750. } else {
  3751. params.use_4addr = -1;
  3752. }
  3753. err = nl80211_parse_mon_options(rdev, ntype, info, &params);
  3754. if (err < 0)
  3755. return err;
  3756. if (err > 0)
  3757. change = true;
  3758. if (change)
  3759. err = cfg80211_change_iface(rdev, dev, ntype, &params);
  3760. else
  3761. err = 0;
  3762. if (!err && params.use_4addr != -1)
  3763. dev->ieee80211_ptr->use_4addr = params.use_4addr;
  3764. if (change && !err) {
  3765. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3766. nl80211_notify_iface(rdev, wdev, NL80211_CMD_SET_INTERFACE);
  3767. }
  3768. return err;
  3769. }
  3770. static int _nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
  3771. {
  3772. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3773. struct vif_params params;
  3774. struct wireless_dev *wdev;
  3775. struct sk_buff *msg;
  3776. int err;
  3777. enum nl80211_iftype type = NL80211_IFTYPE_UNSPECIFIED;
  3778. memset(&params, 0, sizeof(params));
  3779. if (!info->attrs[NL80211_ATTR_IFNAME])
  3780. return -EINVAL;
  3781. if (info->attrs[NL80211_ATTR_IFTYPE])
  3782. type = nla_get_u32(info->attrs[NL80211_ATTR_IFTYPE]);
  3783. if (!rdev->ops->add_virtual_intf)
  3784. return -EOPNOTSUPP;
  3785. if ((type == NL80211_IFTYPE_P2P_DEVICE || type == NL80211_IFTYPE_NAN ||
  3786. rdev->wiphy.features & NL80211_FEATURE_MAC_ON_CREATE) &&
  3787. info->attrs[NL80211_ATTR_MAC]) {
  3788. nla_memcpy(params.macaddr, info->attrs[NL80211_ATTR_MAC],
  3789. ETH_ALEN);
  3790. if (!is_valid_ether_addr(params.macaddr))
  3791. return -EADDRNOTAVAIL;
  3792. }
  3793. if (info->attrs[NL80211_ATTR_4ADDR]) {
  3794. params.use_4addr = !!nla_get_u8(info->attrs[NL80211_ATTR_4ADDR]);
  3795. err = nl80211_valid_4addr(rdev, NULL, params.use_4addr, type);
  3796. if (err)
  3797. return err;
  3798. }
  3799. if (!cfg80211_iftype_allowed(&rdev->wiphy, type, params.use_4addr, 0))
  3800. return -EOPNOTSUPP;
  3801. err = nl80211_parse_mon_options(rdev, type, info, &params);
  3802. if (err < 0)
  3803. return err;
  3804. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  3805. if (!msg)
  3806. return -ENOMEM;
  3807. wdev = rdev_add_virtual_intf(rdev,
  3808. nla_data(info->attrs[NL80211_ATTR_IFNAME]),
  3809. NET_NAME_USER, type, &params);
  3810. if (WARN_ON(!wdev)) {
  3811. nlmsg_free(msg);
  3812. return -EPROTO;
  3813. } else if (IS_ERR(wdev)) {
  3814. nlmsg_free(msg);
  3815. return PTR_ERR(wdev);
  3816. }
  3817. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  3818. wdev->owner_nlportid = info->snd_portid;
  3819. switch (type) {
  3820. case NL80211_IFTYPE_MESH_POINT:
  3821. if (!info->attrs[NL80211_ATTR_MESH_ID])
  3822. break;
  3823. wdev->u.mesh.id_up_len =
  3824. nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  3825. memcpy(wdev->u.mesh.id,
  3826. nla_data(info->attrs[NL80211_ATTR_MESH_ID]),
  3827. wdev->u.mesh.id_up_len);
  3828. break;
  3829. case NL80211_IFTYPE_NAN:
  3830. case NL80211_IFTYPE_P2P_DEVICE:
  3831. /*
  3832. * P2P Device and NAN do not have a netdev, so don't go
  3833. * through the netdev notifier and must be added here
  3834. */
  3835. cfg80211_init_wdev(wdev);
  3836. cfg80211_register_wdev(rdev, wdev);
  3837. break;
  3838. default:
  3839. break;
  3840. }
  3841. if (nl80211_send_iface(msg, info->snd_portid, info->snd_seq, 0,
  3842. rdev, wdev, NL80211_CMD_NEW_INTERFACE) < 0) {
  3843. nlmsg_free(msg);
  3844. return -ENOBUFS;
  3845. }
  3846. return genlmsg_reply(msg, info);
  3847. }
  3848. static int nl80211_new_interface(struct sk_buff *skb, struct genl_info *info)
  3849. {
  3850. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3851. int ret;
  3852. /* to avoid failing a new interface creation due to pending removal */
  3853. cfg80211_destroy_ifaces(rdev);
  3854. wiphy_lock(&rdev->wiphy);
  3855. ret = _nl80211_new_interface(skb, info);
  3856. wiphy_unlock(&rdev->wiphy);
  3857. return ret;
  3858. }
  3859. static int nl80211_del_interface(struct sk_buff *skb, struct genl_info *info)
  3860. {
  3861. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3862. struct wireless_dev *wdev = info->user_ptr[1];
  3863. if (!rdev->ops->del_virtual_intf)
  3864. return -EOPNOTSUPP;
  3865. /*
  3866. * We hold RTNL, so this is safe, without RTNL opencount cannot
  3867. * reach 0, and thus the rdev cannot be deleted.
  3868. *
  3869. * We need to do it for the dev_close(), since that will call
  3870. * the netdev notifiers, and we need to acquire the mutex there
  3871. * but don't know if we get there from here or from some other
  3872. * place (e.g. "ip link set ... down").
  3873. */
  3874. mutex_unlock(&rdev->wiphy.mtx);
  3875. /*
  3876. * If we remove a wireless device without a netdev then clear
  3877. * user_ptr[1] so that nl80211_post_doit won't dereference it
  3878. * to check if it needs to do dev_put(). Otherwise it crashes
  3879. * since the wdev has been freed, unlike with a netdev where
  3880. * we need the dev_put() for the netdev to really be freed.
  3881. */
  3882. if (!wdev->netdev)
  3883. info->user_ptr[1] = NULL;
  3884. else
  3885. dev_close(wdev->netdev);
  3886. mutex_lock(&rdev->wiphy.mtx);
  3887. return cfg80211_remove_virtual_intf(rdev, wdev);
  3888. }
  3889. static int nl80211_set_noack_map(struct sk_buff *skb, struct genl_info *info)
  3890. {
  3891. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3892. struct net_device *dev = info->user_ptr[1];
  3893. u16 noack_map;
  3894. if (!info->attrs[NL80211_ATTR_NOACK_MAP])
  3895. return -EINVAL;
  3896. if (!rdev->ops->set_noack_map)
  3897. return -EOPNOTSUPP;
  3898. noack_map = nla_get_u16(info->attrs[NL80211_ATTR_NOACK_MAP]);
  3899. return rdev_set_noack_map(rdev, dev, noack_map);
  3900. }
  3901. static int nl80211_validate_key_link_id(struct genl_info *info,
  3902. struct wireless_dev *wdev,
  3903. int link_id, bool pairwise)
  3904. {
  3905. if (pairwise) {
  3906. if (link_id != -1) {
  3907. GENL_SET_ERR_MSG(info,
  3908. "link ID not allowed for pairwise key");
  3909. return -EINVAL;
  3910. }
  3911. return 0;
  3912. }
  3913. if (wdev->valid_links) {
  3914. if (link_id == -1) {
  3915. GENL_SET_ERR_MSG(info,
  3916. "link ID must for MLO group key");
  3917. return -EINVAL;
  3918. }
  3919. if (!(wdev->valid_links & BIT(link_id))) {
  3920. GENL_SET_ERR_MSG(info, "invalid link ID for MLO group key");
  3921. return -EINVAL;
  3922. }
  3923. } else if (link_id != -1) {
  3924. GENL_SET_ERR_MSG(info, "link ID not allowed for non-MLO group key");
  3925. return -EINVAL;
  3926. }
  3927. return 0;
  3928. }
  3929. struct get_key_cookie {
  3930. struct sk_buff *msg;
  3931. int error;
  3932. int idx;
  3933. };
  3934. static void get_key_callback(void *c, struct key_params *params)
  3935. {
  3936. struct nlattr *key;
  3937. struct get_key_cookie *cookie = c;
  3938. if ((params->seq &&
  3939. nla_put(cookie->msg, NL80211_ATTR_KEY_SEQ,
  3940. params->seq_len, params->seq)) ||
  3941. (params->cipher &&
  3942. nla_put_u32(cookie->msg, NL80211_ATTR_KEY_CIPHER,
  3943. params->cipher)))
  3944. goto nla_put_failure;
  3945. key = nla_nest_start_noflag(cookie->msg, NL80211_ATTR_KEY);
  3946. if (!key)
  3947. goto nla_put_failure;
  3948. if ((params->seq &&
  3949. nla_put(cookie->msg, NL80211_KEY_SEQ,
  3950. params->seq_len, params->seq)) ||
  3951. (params->cipher &&
  3952. nla_put_u32(cookie->msg, NL80211_KEY_CIPHER,
  3953. params->cipher)))
  3954. goto nla_put_failure;
  3955. if (nla_put_u8(cookie->msg, NL80211_KEY_IDX, cookie->idx))
  3956. goto nla_put_failure;
  3957. nla_nest_end(cookie->msg, key);
  3958. return;
  3959. nla_put_failure:
  3960. cookie->error = 1;
  3961. }
  3962. static int nl80211_get_key(struct sk_buff *skb, struct genl_info *info)
  3963. {
  3964. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  3965. int err;
  3966. struct net_device *dev = info->user_ptr[1];
  3967. u8 key_idx = 0;
  3968. const u8 *mac_addr = NULL;
  3969. bool pairwise;
  3970. struct get_key_cookie cookie = {
  3971. .error = 0,
  3972. };
  3973. void *hdr;
  3974. struct sk_buff *msg;
  3975. bool bigtk_support = false;
  3976. int link_id = nl80211_link_id_or_invalid(info->attrs);
  3977. struct wireless_dev *wdev = dev->ieee80211_ptr;
  3978. if (wiphy_ext_feature_isset(&rdev->wiphy,
  3979. NL80211_EXT_FEATURE_BEACON_PROTECTION))
  3980. bigtk_support = true;
  3981. if ((wdev->iftype == NL80211_IFTYPE_STATION ||
  3982. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
  3983. wiphy_ext_feature_isset(&rdev->wiphy,
  3984. NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT))
  3985. bigtk_support = true;
  3986. if (info->attrs[NL80211_ATTR_KEY_IDX]) {
  3987. key_idx = nla_get_u8(info->attrs[NL80211_ATTR_KEY_IDX]);
  3988. if (key_idx >= 6 && key_idx <= 7 && !bigtk_support) {
  3989. GENL_SET_ERR_MSG(info, "BIGTK not supported");
  3990. return -EINVAL;
  3991. }
  3992. }
  3993. if (info->attrs[NL80211_ATTR_MAC])
  3994. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  3995. pairwise = !!mac_addr;
  3996. if (info->attrs[NL80211_ATTR_KEY_TYPE]) {
  3997. u32 kt = nla_get_u32(info->attrs[NL80211_ATTR_KEY_TYPE]);
  3998. if (kt != NL80211_KEYTYPE_GROUP &&
  3999. kt != NL80211_KEYTYPE_PAIRWISE)
  4000. return -EINVAL;
  4001. pairwise = kt == NL80211_KEYTYPE_PAIRWISE;
  4002. }
  4003. if (!rdev->ops->get_key)
  4004. return -EOPNOTSUPP;
  4005. if (!pairwise && mac_addr && !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  4006. return -ENOENT;
  4007. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  4008. if (!msg)
  4009. return -ENOMEM;
  4010. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  4011. NL80211_CMD_NEW_KEY);
  4012. if (!hdr)
  4013. goto nla_put_failure;
  4014. cookie.msg = msg;
  4015. cookie.idx = key_idx;
  4016. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  4017. nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_idx))
  4018. goto nla_put_failure;
  4019. if (mac_addr &&
  4020. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr))
  4021. goto nla_put_failure;
  4022. err = nl80211_validate_key_link_id(info, wdev, link_id, pairwise);
  4023. if (err)
  4024. goto free_msg;
  4025. err = rdev_get_key(rdev, dev, link_id, key_idx, pairwise, mac_addr,
  4026. &cookie, get_key_callback);
  4027. if (err)
  4028. goto free_msg;
  4029. if (cookie.error)
  4030. goto nla_put_failure;
  4031. genlmsg_end(msg, hdr);
  4032. return genlmsg_reply(msg, info);
  4033. nla_put_failure:
  4034. err = -ENOBUFS;
  4035. free_msg:
  4036. nlmsg_free(msg);
  4037. return err;
  4038. }
  4039. static int nl80211_set_key(struct sk_buff *skb, struct genl_info *info)
  4040. {
  4041. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4042. struct key_parse key;
  4043. int err;
  4044. struct net_device *dev = info->user_ptr[1];
  4045. int link_id = nl80211_link_id_or_invalid(info->attrs);
  4046. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4047. err = nl80211_parse_key(info, &key);
  4048. if (err)
  4049. return err;
  4050. if (key.idx < 0)
  4051. return -EINVAL;
  4052. /* Only support setting default key and
  4053. * Extended Key ID action NL80211_KEY_SET_TX.
  4054. */
  4055. if (!key.def && !key.defmgmt && !key.defbeacon &&
  4056. !(key.p.mode == NL80211_KEY_SET_TX))
  4057. return -EINVAL;
  4058. if (key.def) {
  4059. if (!rdev->ops->set_default_key)
  4060. return -EOPNOTSUPP;
  4061. err = nl80211_key_allowed(wdev);
  4062. if (err)
  4063. return err;
  4064. err = nl80211_validate_key_link_id(info, wdev, link_id, false);
  4065. if (err)
  4066. return err;
  4067. err = rdev_set_default_key(rdev, dev, link_id, key.idx,
  4068. key.def_uni, key.def_multi);
  4069. if (err)
  4070. return err;
  4071. #ifdef CONFIG_CFG80211_WEXT
  4072. wdev->wext.default_key = key.idx;
  4073. #endif
  4074. return 0;
  4075. } else if (key.defmgmt) {
  4076. if (key.def_uni || !key.def_multi)
  4077. return -EINVAL;
  4078. if (!rdev->ops->set_default_mgmt_key)
  4079. return -EOPNOTSUPP;
  4080. err = nl80211_key_allowed(wdev);
  4081. if (err)
  4082. return err;
  4083. err = nl80211_validate_key_link_id(info, wdev, link_id, false);
  4084. if (err)
  4085. return err;
  4086. err = rdev_set_default_mgmt_key(rdev, dev, link_id, key.idx);
  4087. if (err)
  4088. return err;
  4089. #ifdef CONFIG_CFG80211_WEXT
  4090. wdev->wext.default_mgmt_key = key.idx;
  4091. #endif
  4092. return 0;
  4093. } else if (key.defbeacon) {
  4094. if (key.def_uni || !key.def_multi)
  4095. return -EINVAL;
  4096. if (!rdev->ops->set_default_beacon_key)
  4097. return -EOPNOTSUPP;
  4098. err = nl80211_key_allowed(wdev);
  4099. if (err)
  4100. return err;
  4101. err = nl80211_validate_key_link_id(info, wdev, link_id, false);
  4102. if (err)
  4103. return err;
  4104. return rdev_set_default_beacon_key(rdev, dev, link_id, key.idx);
  4105. } else if (key.p.mode == NL80211_KEY_SET_TX &&
  4106. wiphy_ext_feature_isset(&rdev->wiphy,
  4107. NL80211_EXT_FEATURE_EXT_KEY_ID)) {
  4108. u8 *mac_addr = NULL;
  4109. if (info->attrs[NL80211_ATTR_MAC])
  4110. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4111. if (!mac_addr || key.idx < 0 || key.idx > 1)
  4112. return -EINVAL;
  4113. err = nl80211_validate_key_link_id(info, wdev, link_id, true);
  4114. if (err)
  4115. return err;
  4116. return rdev_add_key(rdev, dev, link_id, key.idx,
  4117. NL80211_KEYTYPE_PAIRWISE,
  4118. mac_addr, &key.p);
  4119. }
  4120. return -EINVAL;
  4121. }
  4122. static int nl80211_new_key(struct sk_buff *skb, struct genl_info *info)
  4123. {
  4124. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4125. int err;
  4126. struct net_device *dev = info->user_ptr[1];
  4127. struct key_parse key;
  4128. const u8 *mac_addr = NULL;
  4129. int link_id = nl80211_link_id_or_invalid(info->attrs);
  4130. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4131. err = nl80211_parse_key(info, &key);
  4132. if (err)
  4133. return err;
  4134. if (!key.p.key) {
  4135. GENL_SET_ERR_MSG(info, "no key");
  4136. return -EINVAL;
  4137. }
  4138. if (info->attrs[NL80211_ATTR_MAC])
  4139. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4140. if (key.type == -1) {
  4141. if (mac_addr)
  4142. key.type = NL80211_KEYTYPE_PAIRWISE;
  4143. else
  4144. key.type = NL80211_KEYTYPE_GROUP;
  4145. }
  4146. /* for now */
  4147. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  4148. key.type != NL80211_KEYTYPE_GROUP) {
  4149. GENL_SET_ERR_MSG(info, "key type not pairwise or group");
  4150. return -EINVAL;
  4151. }
  4152. if (key.type == NL80211_KEYTYPE_GROUP &&
  4153. info->attrs[NL80211_ATTR_VLAN_ID])
  4154. key.p.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
  4155. if (!rdev->ops->add_key)
  4156. return -EOPNOTSUPP;
  4157. if (cfg80211_validate_key_settings(rdev, &key.p, key.idx,
  4158. key.type == NL80211_KEYTYPE_PAIRWISE,
  4159. mac_addr)) {
  4160. GENL_SET_ERR_MSG(info, "key setting validation failed");
  4161. return -EINVAL;
  4162. }
  4163. err = nl80211_key_allowed(wdev);
  4164. if (err)
  4165. GENL_SET_ERR_MSG(info, "key not allowed");
  4166. if (!err)
  4167. err = nl80211_validate_key_link_id(info, wdev, link_id,
  4168. key.type == NL80211_KEYTYPE_PAIRWISE);
  4169. if (!err) {
  4170. err = rdev_add_key(rdev, dev, link_id, key.idx,
  4171. key.type == NL80211_KEYTYPE_PAIRWISE,
  4172. mac_addr, &key.p);
  4173. if (err)
  4174. GENL_SET_ERR_MSG(info, "key addition failed");
  4175. }
  4176. return err;
  4177. }
  4178. static int nl80211_del_key(struct sk_buff *skb, struct genl_info *info)
  4179. {
  4180. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4181. int err;
  4182. struct net_device *dev = info->user_ptr[1];
  4183. u8 *mac_addr = NULL;
  4184. struct key_parse key;
  4185. int link_id = nl80211_link_id_or_invalid(info->attrs);
  4186. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4187. err = nl80211_parse_key(info, &key);
  4188. if (err)
  4189. return err;
  4190. if (info->attrs[NL80211_ATTR_MAC])
  4191. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  4192. if (key.type == -1) {
  4193. if (mac_addr)
  4194. key.type = NL80211_KEYTYPE_PAIRWISE;
  4195. else
  4196. key.type = NL80211_KEYTYPE_GROUP;
  4197. }
  4198. /* for now */
  4199. if (key.type != NL80211_KEYTYPE_PAIRWISE &&
  4200. key.type != NL80211_KEYTYPE_GROUP)
  4201. return -EINVAL;
  4202. if (!cfg80211_valid_key_idx(rdev, key.idx,
  4203. key.type == NL80211_KEYTYPE_PAIRWISE))
  4204. return -EINVAL;
  4205. if (!rdev->ops->del_key)
  4206. return -EOPNOTSUPP;
  4207. err = nl80211_key_allowed(wdev);
  4208. if (key.type == NL80211_KEYTYPE_GROUP && mac_addr &&
  4209. !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
  4210. err = -ENOENT;
  4211. if (!err)
  4212. err = nl80211_validate_key_link_id(info, wdev, link_id,
  4213. key.type == NL80211_KEYTYPE_PAIRWISE);
  4214. if (!err)
  4215. err = rdev_del_key(rdev, dev, link_id, key.idx,
  4216. key.type == NL80211_KEYTYPE_PAIRWISE,
  4217. mac_addr);
  4218. #ifdef CONFIG_CFG80211_WEXT
  4219. if (!err) {
  4220. if (key.idx == wdev->wext.default_key)
  4221. wdev->wext.default_key = -1;
  4222. else if (key.idx == wdev->wext.default_mgmt_key)
  4223. wdev->wext.default_mgmt_key = -1;
  4224. }
  4225. #endif
  4226. return err;
  4227. }
  4228. /* This function returns an error or the number of nested attributes */
  4229. static int validate_acl_mac_addrs(struct nlattr *nl_attr)
  4230. {
  4231. struct nlattr *attr;
  4232. int n_entries = 0, tmp;
  4233. nla_for_each_nested(attr, nl_attr, tmp) {
  4234. if (nla_len(attr) != ETH_ALEN)
  4235. return -EINVAL;
  4236. n_entries++;
  4237. }
  4238. return n_entries;
  4239. }
  4240. /*
  4241. * This function parses ACL information and allocates memory for ACL data.
  4242. * On successful return, the calling function is responsible to free the
  4243. * ACL buffer returned by this function.
  4244. */
  4245. static struct cfg80211_acl_data *parse_acl_data(struct wiphy *wiphy,
  4246. struct genl_info *info)
  4247. {
  4248. enum nl80211_acl_policy acl_policy;
  4249. struct nlattr *attr;
  4250. struct cfg80211_acl_data *acl;
  4251. int i = 0, n_entries, tmp;
  4252. if (!wiphy->max_acl_mac_addrs)
  4253. return ERR_PTR(-EOPNOTSUPP);
  4254. if (!info->attrs[NL80211_ATTR_ACL_POLICY])
  4255. return ERR_PTR(-EINVAL);
  4256. acl_policy = nla_get_u32(info->attrs[NL80211_ATTR_ACL_POLICY]);
  4257. if (acl_policy != NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED &&
  4258. acl_policy != NL80211_ACL_POLICY_DENY_UNLESS_LISTED)
  4259. return ERR_PTR(-EINVAL);
  4260. if (!info->attrs[NL80211_ATTR_MAC_ADDRS])
  4261. return ERR_PTR(-EINVAL);
  4262. n_entries = validate_acl_mac_addrs(info->attrs[NL80211_ATTR_MAC_ADDRS]);
  4263. if (n_entries < 0)
  4264. return ERR_PTR(n_entries);
  4265. if (n_entries > wiphy->max_acl_mac_addrs)
  4266. return ERR_PTR(-EOPNOTSUPP);
  4267. acl = kzalloc(struct_size(acl, mac_addrs, n_entries), GFP_KERNEL);
  4268. if (!acl)
  4269. return ERR_PTR(-ENOMEM);
  4270. acl->n_acl_entries = n_entries;
  4271. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_MAC_ADDRS], tmp) {
  4272. memcpy(acl->mac_addrs[i].addr, nla_data(attr), ETH_ALEN);
  4273. i++;
  4274. }
  4275. acl->acl_policy = acl_policy;
  4276. return acl;
  4277. }
  4278. static int nl80211_set_mac_acl(struct sk_buff *skb, struct genl_info *info)
  4279. {
  4280. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4281. struct net_device *dev = info->user_ptr[1];
  4282. struct cfg80211_acl_data *acl;
  4283. int err;
  4284. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  4285. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  4286. return -EOPNOTSUPP;
  4287. if (!dev->ieee80211_ptr->links[0].ap.beacon_interval)
  4288. return -EINVAL;
  4289. acl = parse_acl_data(&rdev->wiphy, info);
  4290. if (IS_ERR(acl))
  4291. return PTR_ERR(acl);
  4292. err = rdev_set_mac_acl(rdev, dev, acl);
  4293. kfree(acl);
  4294. return err;
  4295. }
  4296. static u32 rateset_to_mask(struct ieee80211_supported_band *sband,
  4297. u8 *rates, u8 rates_len)
  4298. {
  4299. u8 i;
  4300. u32 mask = 0;
  4301. for (i = 0; i < rates_len; i++) {
  4302. int rate = (rates[i] & 0x7f) * 5;
  4303. int ridx;
  4304. for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
  4305. struct ieee80211_rate *srate =
  4306. &sband->bitrates[ridx];
  4307. if (rate == srate->bitrate) {
  4308. mask |= 1 << ridx;
  4309. break;
  4310. }
  4311. }
  4312. if (ridx == sband->n_bitrates)
  4313. return 0; /* rate not found */
  4314. }
  4315. return mask;
  4316. }
  4317. static bool ht_rateset_to_mask(struct ieee80211_supported_band *sband,
  4318. u8 *rates, u8 rates_len,
  4319. u8 mcs[IEEE80211_HT_MCS_MASK_LEN])
  4320. {
  4321. u8 i;
  4322. memset(mcs, 0, IEEE80211_HT_MCS_MASK_LEN);
  4323. for (i = 0; i < rates_len; i++) {
  4324. int ridx, rbit;
  4325. ridx = rates[i] / 8;
  4326. rbit = BIT(rates[i] % 8);
  4327. /* check validity */
  4328. if ((ridx < 0) || (ridx >= IEEE80211_HT_MCS_MASK_LEN))
  4329. return false;
  4330. /* check availability */
  4331. ridx = array_index_nospec(ridx, IEEE80211_HT_MCS_MASK_LEN);
  4332. if (sband->ht_cap.mcs.rx_mask[ridx] & rbit)
  4333. mcs[ridx] |= rbit;
  4334. else
  4335. return false;
  4336. }
  4337. return true;
  4338. }
  4339. static u16 vht_mcs_map_to_mcs_mask(u8 vht_mcs_map)
  4340. {
  4341. u16 mcs_mask = 0;
  4342. switch (vht_mcs_map) {
  4343. case IEEE80211_VHT_MCS_NOT_SUPPORTED:
  4344. break;
  4345. case IEEE80211_VHT_MCS_SUPPORT_0_7:
  4346. mcs_mask = 0x00FF;
  4347. break;
  4348. case IEEE80211_VHT_MCS_SUPPORT_0_8:
  4349. mcs_mask = 0x01FF;
  4350. break;
  4351. case IEEE80211_VHT_MCS_SUPPORT_0_9:
  4352. mcs_mask = 0x03FF;
  4353. break;
  4354. default:
  4355. break;
  4356. }
  4357. return mcs_mask;
  4358. }
  4359. static void vht_build_mcs_mask(u16 vht_mcs_map,
  4360. u16 vht_mcs_mask[NL80211_VHT_NSS_MAX])
  4361. {
  4362. u8 nss;
  4363. for (nss = 0; nss < NL80211_VHT_NSS_MAX; nss++) {
  4364. vht_mcs_mask[nss] = vht_mcs_map_to_mcs_mask(vht_mcs_map & 0x03);
  4365. vht_mcs_map >>= 2;
  4366. }
  4367. }
  4368. static bool vht_set_mcs_mask(struct ieee80211_supported_band *sband,
  4369. struct nl80211_txrate_vht *txrate,
  4370. u16 mcs[NL80211_VHT_NSS_MAX])
  4371. {
  4372. u16 tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
  4373. u16 tx_mcs_mask[NL80211_VHT_NSS_MAX] = {};
  4374. u8 i;
  4375. if (!sband->vht_cap.vht_supported)
  4376. return false;
  4377. memset(mcs, 0, sizeof(u16) * NL80211_VHT_NSS_MAX);
  4378. /* Build vht_mcs_mask from VHT capabilities */
  4379. vht_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
  4380. for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
  4381. if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
  4382. mcs[i] = txrate->mcs[i];
  4383. else
  4384. return false;
  4385. }
  4386. return true;
  4387. }
  4388. static u16 he_mcs_map_to_mcs_mask(u8 he_mcs_map)
  4389. {
  4390. switch (he_mcs_map) {
  4391. case IEEE80211_HE_MCS_NOT_SUPPORTED:
  4392. return 0;
  4393. case IEEE80211_HE_MCS_SUPPORT_0_7:
  4394. return 0x00FF;
  4395. case IEEE80211_HE_MCS_SUPPORT_0_9:
  4396. return 0x03FF;
  4397. case IEEE80211_HE_MCS_SUPPORT_0_11:
  4398. return 0xFFF;
  4399. default:
  4400. break;
  4401. }
  4402. return 0;
  4403. }
  4404. static void he_build_mcs_mask(u16 he_mcs_map,
  4405. u16 he_mcs_mask[NL80211_HE_NSS_MAX])
  4406. {
  4407. u8 nss;
  4408. for (nss = 0; nss < NL80211_HE_NSS_MAX; nss++) {
  4409. he_mcs_mask[nss] = he_mcs_map_to_mcs_mask(he_mcs_map & 0x03);
  4410. he_mcs_map >>= 2;
  4411. }
  4412. }
  4413. static u16 he_get_txmcsmap(struct genl_info *info, unsigned int link_id,
  4414. const struct ieee80211_sta_he_cap *he_cap)
  4415. {
  4416. struct net_device *dev = info->user_ptr[1];
  4417. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4418. struct cfg80211_chan_def *chandef;
  4419. __le16 tx_mcs;
  4420. chandef = wdev_chandef(wdev, link_id);
  4421. if (!chandef) {
  4422. /*
  4423. * This is probably broken, but we never maintained
  4424. * a chandef in these cases, so it always was.
  4425. */
  4426. return le16_to_cpu(he_cap->he_mcs_nss_supp.tx_mcs_80);
  4427. }
  4428. switch (chandef->width) {
  4429. case NL80211_CHAN_WIDTH_80P80:
  4430. tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80p80;
  4431. break;
  4432. case NL80211_CHAN_WIDTH_160:
  4433. tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_160;
  4434. break;
  4435. default:
  4436. tx_mcs = he_cap->he_mcs_nss_supp.tx_mcs_80;
  4437. break;
  4438. }
  4439. return le16_to_cpu(tx_mcs);
  4440. }
  4441. static bool he_set_mcs_mask(struct genl_info *info,
  4442. struct wireless_dev *wdev,
  4443. struct ieee80211_supported_band *sband,
  4444. struct nl80211_txrate_he *txrate,
  4445. u16 mcs[NL80211_HE_NSS_MAX],
  4446. unsigned int link_id)
  4447. {
  4448. const struct ieee80211_sta_he_cap *he_cap;
  4449. u16 tx_mcs_mask[NL80211_HE_NSS_MAX] = {};
  4450. u16 tx_mcs_map = 0;
  4451. u8 i;
  4452. he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype);
  4453. if (!he_cap)
  4454. return false;
  4455. memset(mcs, 0, sizeof(u16) * NL80211_HE_NSS_MAX);
  4456. tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap);
  4457. /* Build he_mcs_mask from HE capabilities */
  4458. he_build_mcs_mask(tx_mcs_map, tx_mcs_mask);
  4459. for (i = 0; i < NL80211_HE_NSS_MAX; i++) {
  4460. if ((tx_mcs_mask[i] & txrate->mcs[i]) == txrate->mcs[i])
  4461. mcs[i] = txrate->mcs[i];
  4462. else
  4463. return false;
  4464. }
  4465. return true;
  4466. }
  4467. static int nl80211_parse_tx_bitrate_mask(struct genl_info *info,
  4468. struct nlattr *attrs[],
  4469. enum nl80211_attrs attr,
  4470. struct cfg80211_bitrate_mask *mask,
  4471. struct net_device *dev,
  4472. bool default_all_enabled,
  4473. unsigned int link_id)
  4474. {
  4475. struct nlattr *tb[NL80211_TXRATE_MAX + 1];
  4476. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  4477. struct wireless_dev *wdev = dev->ieee80211_ptr;
  4478. int rem, i;
  4479. struct nlattr *tx_rates;
  4480. struct ieee80211_supported_band *sband;
  4481. u16 vht_tx_mcs_map, he_tx_mcs_map;
  4482. memset(mask, 0, sizeof(*mask));
  4483. /* Default to all rates enabled */
  4484. for (i = 0; i < NUM_NL80211_BANDS; i++) {
  4485. const struct ieee80211_sta_he_cap *he_cap;
  4486. if (!default_all_enabled)
  4487. break;
  4488. sband = rdev->wiphy.bands[i];
  4489. if (!sband)
  4490. continue;
  4491. mask->control[i].legacy = (1 << sband->n_bitrates) - 1;
  4492. memcpy(mask->control[i].ht_mcs,
  4493. sband->ht_cap.mcs.rx_mask,
  4494. sizeof(mask->control[i].ht_mcs));
  4495. if (sband->vht_cap.vht_supported) {
  4496. vht_tx_mcs_map = le16_to_cpu(sband->vht_cap.vht_mcs.tx_mcs_map);
  4497. vht_build_mcs_mask(vht_tx_mcs_map, mask->control[i].vht_mcs);
  4498. }
  4499. he_cap = ieee80211_get_he_iftype_cap(sband, wdev->iftype);
  4500. if (!he_cap)
  4501. continue;
  4502. he_tx_mcs_map = he_get_txmcsmap(info, link_id, he_cap);
  4503. he_build_mcs_mask(he_tx_mcs_map, mask->control[i].he_mcs);
  4504. mask->control[i].he_gi = 0xFF;
  4505. mask->control[i].he_ltf = 0xFF;
  4506. }
  4507. /* if no rates are given set it back to the defaults */
  4508. if (!attrs[attr])
  4509. goto out;
  4510. /* The nested attribute uses enum nl80211_band as the index. This maps
  4511. * directly to the enum nl80211_band values used in cfg80211.
  4512. */
  4513. BUILD_BUG_ON(NL80211_MAX_SUPP_HT_RATES > IEEE80211_HT_MCS_MASK_LEN * 8);
  4514. nla_for_each_nested(tx_rates, attrs[attr], rem) {
  4515. enum nl80211_band band = nla_type(tx_rates);
  4516. int err;
  4517. if (band < 0 || band >= NUM_NL80211_BANDS)
  4518. return -EINVAL;
  4519. sband = rdev->wiphy.bands[band];
  4520. if (sband == NULL)
  4521. return -EINVAL;
  4522. err = nla_parse_nested_deprecated(tb, NL80211_TXRATE_MAX,
  4523. tx_rates,
  4524. nl80211_txattr_policy,
  4525. info->extack);
  4526. if (err)
  4527. return err;
  4528. if (tb[NL80211_TXRATE_LEGACY]) {
  4529. mask->control[band].legacy = rateset_to_mask(
  4530. sband,
  4531. nla_data(tb[NL80211_TXRATE_LEGACY]),
  4532. nla_len(tb[NL80211_TXRATE_LEGACY]));
  4533. if ((mask->control[band].legacy == 0) &&
  4534. nla_len(tb[NL80211_TXRATE_LEGACY]))
  4535. return -EINVAL;
  4536. }
  4537. if (tb[NL80211_TXRATE_HT]) {
  4538. if (!ht_rateset_to_mask(
  4539. sband,
  4540. nla_data(tb[NL80211_TXRATE_HT]),
  4541. nla_len(tb[NL80211_TXRATE_HT]),
  4542. mask->control[band].ht_mcs))
  4543. return -EINVAL;
  4544. }
  4545. if (tb[NL80211_TXRATE_VHT]) {
  4546. if (!vht_set_mcs_mask(
  4547. sband,
  4548. nla_data(tb[NL80211_TXRATE_VHT]),
  4549. mask->control[band].vht_mcs))
  4550. return -EINVAL;
  4551. }
  4552. if (tb[NL80211_TXRATE_GI]) {
  4553. mask->control[band].gi =
  4554. nla_get_u8(tb[NL80211_TXRATE_GI]);
  4555. if (mask->control[band].gi > NL80211_TXRATE_FORCE_LGI)
  4556. return -EINVAL;
  4557. }
  4558. if (tb[NL80211_TXRATE_HE] &&
  4559. !he_set_mcs_mask(info, wdev, sband,
  4560. nla_data(tb[NL80211_TXRATE_HE]),
  4561. mask->control[band].he_mcs,
  4562. link_id))
  4563. return -EINVAL;
  4564. if (tb[NL80211_TXRATE_HE_GI])
  4565. mask->control[band].he_gi =
  4566. nla_get_u8(tb[NL80211_TXRATE_HE_GI]);
  4567. if (tb[NL80211_TXRATE_HE_LTF])
  4568. mask->control[band].he_ltf =
  4569. nla_get_u8(tb[NL80211_TXRATE_HE_LTF]);
  4570. if (mask->control[band].legacy == 0) {
  4571. /* don't allow empty legacy rates if HT, VHT or HE
  4572. * are not even supported.
  4573. */
  4574. if (!(rdev->wiphy.bands[band]->ht_cap.ht_supported ||
  4575. rdev->wiphy.bands[band]->vht_cap.vht_supported ||
  4576. ieee80211_get_he_iftype_cap(sband, wdev->iftype)))
  4577. return -EINVAL;
  4578. for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++)
  4579. if (mask->control[band].ht_mcs[i])
  4580. goto out;
  4581. for (i = 0; i < NL80211_VHT_NSS_MAX; i++)
  4582. if (mask->control[band].vht_mcs[i])
  4583. goto out;
  4584. for (i = 0; i < NL80211_HE_NSS_MAX; i++)
  4585. if (mask->control[band].he_mcs[i])
  4586. goto out;
  4587. /* legacy and mcs rates may not be both empty */
  4588. return -EINVAL;
  4589. }
  4590. }
  4591. out:
  4592. return 0;
  4593. }
  4594. static int validate_beacon_tx_rate(struct cfg80211_registered_device *rdev,
  4595. enum nl80211_band band,
  4596. struct cfg80211_bitrate_mask *beacon_rate)
  4597. {
  4598. u32 count_ht, count_vht, count_he, i;
  4599. u32 rate = beacon_rate->control[band].legacy;
  4600. /* Allow only one rate */
  4601. if (hweight32(rate) > 1)
  4602. return -EINVAL;
  4603. count_ht = 0;
  4604. for (i = 0; i < IEEE80211_HT_MCS_MASK_LEN; i++) {
  4605. if (hweight8(beacon_rate->control[band].ht_mcs[i]) > 1) {
  4606. return -EINVAL;
  4607. } else if (beacon_rate->control[band].ht_mcs[i]) {
  4608. count_ht++;
  4609. if (count_ht > 1)
  4610. return -EINVAL;
  4611. }
  4612. if (count_ht && rate)
  4613. return -EINVAL;
  4614. }
  4615. count_vht = 0;
  4616. for (i = 0; i < NL80211_VHT_NSS_MAX; i++) {
  4617. if (hweight16(beacon_rate->control[band].vht_mcs[i]) > 1) {
  4618. return -EINVAL;
  4619. } else if (beacon_rate->control[band].vht_mcs[i]) {
  4620. count_vht++;
  4621. if (count_vht > 1)
  4622. return -EINVAL;
  4623. }
  4624. if (count_vht && rate)
  4625. return -EINVAL;
  4626. }
  4627. count_he = 0;
  4628. for (i = 0; i < NL80211_HE_NSS_MAX; i++) {
  4629. if (hweight16(beacon_rate->control[band].he_mcs[i]) > 1) {
  4630. return -EINVAL;
  4631. } else if (beacon_rate->control[band].he_mcs[i]) {
  4632. count_he++;
  4633. if (count_he > 1)
  4634. return -EINVAL;
  4635. }
  4636. if (count_he && rate)
  4637. return -EINVAL;
  4638. }
  4639. if ((count_ht && count_vht && count_he) ||
  4640. (!rate && !count_ht && !count_vht && !count_he))
  4641. return -EINVAL;
  4642. if (rate &&
  4643. !wiphy_ext_feature_isset(&rdev->wiphy,
  4644. NL80211_EXT_FEATURE_BEACON_RATE_LEGACY))
  4645. return -EINVAL;
  4646. if (count_ht &&
  4647. !wiphy_ext_feature_isset(&rdev->wiphy,
  4648. NL80211_EXT_FEATURE_BEACON_RATE_HT))
  4649. return -EINVAL;
  4650. if (count_vht &&
  4651. !wiphy_ext_feature_isset(&rdev->wiphy,
  4652. NL80211_EXT_FEATURE_BEACON_RATE_VHT))
  4653. return -EINVAL;
  4654. if (count_he &&
  4655. !wiphy_ext_feature_isset(&rdev->wiphy,
  4656. NL80211_EXT_FEATURE_BEACON_RATE_HE))
  4657. return -EINVAL;
  4658. return 0;
  4659. }
  4660. static int nl80211_parse_mbssid_config(struct wiphy *wiphy,
  4661. struct net_device *dev,
  4662. struct nlattr *attrs,
  4663. struct cfg80211_mbssid_config *config,
  4664. u8 num_elems)
  4665. {
  4666. struct nlattr *tb[NL80211_MBSSID_CONFIG_ATTR_MAX + 1];
  4667. if (!wiphy->mbssid_max_interfaces)
  4668. return -EOPNOTSUPP;
  4669. if (nla_parse_nested(tb, NL80211_MBSSID_CONFIG_ATTR_MAX, attrs, NULL,
  4670. NULL) ||
  4671. !tb[NL80211_MBSSID_CONFIG_ATTR_INDEX])
  4672. return -EINVAL;
  4673. config->ema = nla_get_flag(tb[NL80211_MBSSID_CONFIG_ATTR_EMA]);
  4674. if (config->ema) {
  4675. if (!wiphy->ema_max_profile_periodicity)
  4676. return -EOPNOTSUPP;
  4677. if (num_elems > wiphy->ema_max_profile_periodicity)
  4678. return -EINVAL;
  4679. }
  4680. config->index = nla_get_u8(tb[NL80211_MBSSID_CONFIG_ATTR_INDEX]);
  4681. if (config->index >= wiphy->mbssid_max_interfaces ||
  4682. (!config->index && !num_elems))
  4683. return -EINVAL;
  4684. if (tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]) {
  4685. u32 tx_ifindex =
  4686. nla_get_u32(tb[NL80211_MBSSID_CONFIG_ATTR_TX_IFINDEX]);
  4687. if ((!config->index && tx_ifindex != dev->ifindex) ||
  4688. (config->index && tx_ifindex == dev->ifindex))
  4689. return -EINVAL;
  4690. if (tx_ifindex != dev->ifindex) {
  4691. struct net_device *tx_netdev =
  4692. dev_get_by_index(wiphy_net(wiphy), tx_ifindex);
  4693. if (!tx_netdev || !tx_netdev->ieee80211_ptr ||
  4694. tx_netdev->ieee80211_ptr->wiphy != wiphy ||
  4695. tx_netdev->ieee80211_ptr->iftype !=
  4696. NL80211_IFTYPE_AP) {
  4697. dev_put(tx_netdev);
  4698. return -EINVAL;
  4699. }
  4700. config->tx_wdev = tx_netdev->ieee80211_ptr;
  4701. } else {
  4702. config->tx_wdev = dev->ieee80211_ptr;
  4703. }
  4704. } else if (!config->index) {
  4705. config->tx_wdev = dev->ieee80211_ptr;
  4706. } else {
  4707. return -EINVAL;
  4708. }
  4709. return 0;
  4710. }
  4711. static struct cfg80211_mbssid_elems *
  4712. nl80211_parse_mbssid_elems(struct wiphy *wiphy, struct nlattr *attrs)
  4713. {
  4714. struct nlattr *nl_elems;
  4715. struct cfg80211_mbssid_elems *elems;
  4716. int rem_elems;
  4717. u8 i = 0, num_elems = 0;
  4718. if (!wiphy->mbssid_max_interfaces)
  4719. return ERR_PTR(-EINVAL);
  4720. nla_for_each_nested(nl_elems, attrs, rem_elems) {
  4721. if (num_elems >= 255)
  4722. return ERR_PTR(-EINVAL);
  4723. num_elems++;
  4724. }
  4725. elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL);
  4726. if (!elems)
  4727. return ERR_PTR(-ENOMEM);
  4728. elems->cnt = num_elems;
  4729. nla_for_each_nested(nl_elems, attrs, rem_elems) {
  4730. elems->elem[i].data = nla_data(nl_elems);
  4731. elems->elem[i].len = nla_len(nl_elems);
  4732. i++;
  4733. }
  4734. return elems;
  4735. }
  4736. static struct cfg80211_rnr_elems *
  4737. nl80211_parse_rnr_elems(struct wiphy *wiphy, struct nlattr *attrs,
  4738. struct netlink_ext_ack *extack)
  4739. {
  4740. struct nlattr *nl_elems;
  4741. struct cfg80211_rnr_elems *elems;
  4742. int rem_elems;
  4743. u8 i = 0, num_elems = 0;
  4744. nla_for_each_nested(nl_elems, attrs, rem_elems) {
  4745. int ret;
  4746. ret = validate_ie_attr(nl_elems, extack);
  4747. if (ret)
  4748. return ERR_PTR(ret);
  4749. num_elems++;
  4750. }
  4751. elems = kzalloc(struct_size(elems, elem, num_elems), GFP_KERNEL);
  4752. if (!elems)
  4753. return ERR_PTR(-ENOMEM);
  4754. elems->cnt = num_elems;
  4755. nla_for_each_nested(nl_elems, attrs, rem_elems) {
  4756. elems->elem[i].data = nla_data(nl_elems);
  4757. elems->elem[i].len = nla_len(nl_elems);
  4758. i++;
  4759. }
  4760. return elems;
  4761. }
  4762. static int nl80211_parse_he_bss_color(struct nlattr *attrs,
  4763. struct cfg80211_he_bss_color *he_bss_color)
  4764. {
  4765. struct nlattr *tb[NL80211_HE_BSS_COLOR_ATTR_MAX + 1];
  4766. int err;
  4767. err = nla_parse_nested(tb, NL80211_HE_BSS_COLOR_ATTR_MAX, attrs,
  4768. he_bss_color_policy, NULL);
  4769. if (err)
  4770. return err;
  4771. if (!tb[NL80211_HE_BSS_COLOR_ATTR_COLOR])
  4772. return -EINVAL;
  4773. he_bss_color->color =
  4774. nla_get_u8(tb[NL80211_HE_BSS_COLOR_ATTR_COLOR]);
  4775. he_bss_color->enabled =
  4776. !nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_DISABLED]);
  4777. he_bss_color->partial =
  4778. nla_get_flag(tb[NL80211_HE_BSS_COLOR_ATTR_PARTIAL]);
  4779. return 0;
  4780. }
  4781. static int nl80211_parse_beacon(struct cfg80211_registered_device *rdev,
  4782. struct nlattr *attrs[],
  4783. struct cfg80211_beacon_data *bcn,
  4784. struct netlink_ext_ack *extack)
  4785. {
  4786. bool haveinfo = false;
  4787. int err;
  4788. memset(bcn, 0, sizeof(*bcn));
  4789. bcn->link_id = nl80211_link_id(attrs);
  4790. if (attrs[NL80211_ATTR_BEACON_HEAD]) {
  4791. bcn->head = nla_data(attrs[NL80211_ATTR_BEACON_HEAD]);
  4792. bcn->head_len = nla_len(attrs[NL80211_ATTR_BEACON_HEAD]);
  4793. if (!bcn->head_len)
  4794. return -EINVAL;
  4795. haveinfo = true;
  4796. }
  4797. if (attrs[NL80211_ATTR_BEACON_TAIL]) {
  4798. bcn->tail = nla_data(attrs[NL80211_ATTR_BEACON_TAIL]);
  4799. bcn->tail_len = nla_len(attrs[NL80211_ATTR_BEACON_TAIL]);
  4800. haveinfo = true;
  4801. }
  4802. if (!haveinfo)
  4803. return -EINVAL;
  4804. if (attrs[NL80211_ATTR_IE]) {
  4805. bcn->beacon_ies = nla_data(attrs[NL80211_ATTR_IE]);
  4806. bcn->beacon_ies_len = nla_len(attrs[NL80211_ATTR_IE]);
  4807. }
  4808. if (attrs[NL80211_ATTR_IE_PROBE_RESP]) {
  4809. bcn->proberesp_ies =
  4810. nla_data(attrs[NL80211_ATTR_IE_PROBE_RESP]);
  4811. bcn->proberesp_ies_len =
  4812. nla_len(attrs[NL80211_ATTR_IE_PROBE_RESP]);
  4813. }
  4814. if (attrs[NL80211_ATTR_IE_ASSOC_RESP]) {
  4815. bcn->assocresp_ies =
  4816. nla_data(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
  4817. bcn->assocresp_ies_len =
  4818. nla_len(attrs[NL80211_ATTR_IE_ASSOC_RESP]);
  4819. }
  4820. if (attrs[NL80211_ATTR_PROBE_RESP]) {
  4821. bcn->probe_resp = nla_data(attrs[NL80211_ATTR_PROBE_RESP]);
  4822. bcn->probe_resp_len = nla_len(attrs[NL80211_ATTR_PROBE_RESP]);
  4823. }
  4824. if (attrs[NL80211_ATTR_FTM_RESPONDER]) {
  4825. struct nlattr *tb[NL80211_FTM_RESP_ATTR_MAX + 1];
  4826. err = nla_parse_nested_deprecated(tb,
  4827. NL80211_FTM_RESP_ATTR_MAX,
  4828. attrs[NL80211_ATTR_FTM_RESPONDER],
  4829. NULL, NULL);
  4830. if (err)
  4831. return err;
  4832. if (tb[NL80211_FTM_RESP_ATTR_ENABLED] &&
  4833. wiphy_ext_feature_isset(&rdev->wiphy,
  4834. NL80211_EXT_FEATURE_ENABLE_FTM_RESPONDER))
  4835. bcn->ftm_responder = 1;
  4836. else
  4837. return -EOPNOTSUPP;
  4838. if (tb[NL80211_FTM_RESP_ATTR_LCI]) {
  4839. bcn->lci = nla_data(tb[NL80211_FTM_RESP_ATTR_LCI]);
  4840. bcn->lci_len = nla_len(tb[NL80211_FTM_RESP_ATTR_LCI]);
  4841. }
  4842. if (tb[NL80211_FTM_RESP_ATTR_CIVICLOC]) {
  4843. bcn->civicloc = nla_data(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
  4844. bcn->civicloc_len = nla_len(tb[NL80211_FTM_RESP_ATTR_CIVICLOC]);
  4845. }
  4846. } else {
  4847. bcn->ftm_responder = -1;
  4848. }
  4849. if (attrs[NL80211_ATTR_HE_BSS_COLOR]) {
  4850. err = nl80211_parse_he_bss_color(attrs[NL80211_ATTR_HE_BSS_COLOR],
  4851. &bcn->he_bss_color);
  4852. if (err)
  4853. return err;
  4854. bcn->he_bss_color_valid = true;
  4855. }
  4856. if (attrs[NL80211_ATTR_MBSSID_ELEMS]) {
  4857. struct cfg80211_mbssid_elems *mbssid =
  4858. nl80211_parse_mbssid_elems(&rdev->wiphy,
  4859. attrs[NL80211_ATTR_MBSSID_ELEMS]);
  4860. if (IS_ERR(mbssid))
  4861. return PTR_ERR(mbssid);
  4862. bcn->mbssid_ies = mbssid;
  4863. if (bcn->mbssid_ies && attrs[NL80211_ATTR_EMA_RNR_ELEMS]) {
  4864. struct cfg80211_rnr_elems *rnr =
  4865. nl80211_parse_rnr_elems(&rdev->wiphy,
  4866. attrs[NL80211_ATTR_EMA_RNR_ELEMS],
  4867. extack);
  4868. if (IS_ERR(rnr))
  4869. return PTR_ERR(rnr);
  4870. if (rnr && rnr->cnt < bcn->mbssid_ies->cnt)
  4871. return -EINVAL;
  4872. bcn->rnr_ies = rnr;
  4873. }
  4874. }
  4875. return 0;
  4876. }
  4877. static int nl80211_parse_he_obss_pd(struct nlattr *attrs,
  4878. struct ieee80211_he_obss_pd *he_obss_pd)
  4879. {
  4880. struct nlattr *tb[NL80211_HE_OBSS_PD_ATTR_MAX + 1];
  4881. int err;
  4882. err = nla_parse_nested(tb, NL80211_HE_OBSS_PD_ATTR_MAX, attrs,
  4883. he_obss_pd_policy, NULL);
  4884. if (err)
  4885. return err;
  4886. if (!tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL])
  4887. return -EINVAL;
  4888. he_obss_pd->sr_ctrl = nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_SR_CTRL]);
  4889. if (tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET])
  4890. he_obss_pd->min_offset =
  4891. nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MIN_OFFSET]);
  4892. if (tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET])
  4893. he_obss_pd->max_offset =
  4894. nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_MAX_OFFSET]);
  4895. if (tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET])
  4896. he_obss_pd->non_srg_max_offset =
  4897. nla_get_u8(tb[NL80211_HE_OBSS_PD_ATTR_NON_SRG_MAX_OFFSET]);
  4898. if (he_obss_pd->min_offset > he_obss_pd->max_offset)
  4899. return -EINVAL;
  4900. if (tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP])
  4901. memcpy(he_obss_pd->bss_color_bitmap,
  4902. nla_data(tb[NL80211_HE_OBSS_PD_ATTR_BSS_COLOR_BITMAP]),
  4903. sizeof(he_obss_pd->bss_color_bitmap));
  4904. if (tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP])
  4905. memcpy(he_obss_pd->partial_bssid_bitmap,
  4906. nla_data(tb[NL80211_HE_OBSS_PD_ATTR_PARTIAL_BSSID_BITMAP]),
  4907. sizeof(he_obss_pd->partial_bssid_bitmap));
  4908. he_obss_pd->enable = true;
  4909. return 0;
  4910. }
  4911. static int nl80211_parse_fils_discovery(struct cfg80211_registered_device *rdev,
  4912. struct nlattr *attrs,
  4913. struct cfg80211_fils_discovery *fd)
  4914. {
  4915. struct nlattr *tb[NL80211_FILS_DISCOVERY_ATTR_MAX + 1];
  4916. int ret;
  4917. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  4918. NL80211_EXT_FEATURE_FILS_DISCOVERY))
  4919. return -EINVAL;
  4920. ret = nla_parse_nested(tb, NL80211_FILS_DISCOVERY_ATTR_MAX, attrs,
  4921. NULL, NULL);
  4922. if (ret)
  4923. return ret;
  4924. if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] &&
  4925. !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] &&
  4926. !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]) {
  4927. fd->update = true;
  4928. return 0;
  4929. }
  4930. if (!tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN] ||
  4931. !tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX] ||
  4932. !tb[NL80211_FILS_DISCOVERY_ATTR_TMPL])
  4933. return -EINVAL;
  4934. fd->tmpl_len = nla_len(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]);
  4935. fd->tmpl = nla_data(tb[NL80211_FILS_DISCOVERY_ATTR_TMPL]);
  4936. fd->min_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MIN]);
  4937. fd->max_interval = nla_get_u32(tb[NL80211_FILS_DISCOVERY_ATTR_INT_MAX]);
  4938. fd->update = true;
  4939. return 0;
  4940. }
  4941. static int
  4942. nl80211_parse_unsol_bcast_probe_resp(struct cfg80211_registered_device *rdev,
  4943. struct nlattr *attrs,
  4944. struct cfg80211_unsol_bcast_probe_resp *presp)
  4945. {
  4946. struct nlattr *tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX + 1];
  4947. int ret;
  4948. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  4949. NL80211_EXT_FEATURE_UNSOL_BCAST_PROBE_RESP))
  4950. return -EINVAL;
  4951. ret = nla_parse_nested(tb, NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_MAX,
  4952. attrs, NULL, NULL);
  4953. if (ret)
  4954. return ret;
  4955. if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] &&
  4956. !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]) {
  4957. presp->update = true;
  4958. return 0;
  4959. }
  4960. if (!tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT] ||
  4961. !tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL])
  4962. return -EINVAL;
  4963. presp->tmpl = nla_data(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]);
  4964. presp->tmpl_len = nla_len(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_TMPL]);
  4965. presp->interval = nla_get_u32(tb[NL80211_UNSOL_BCAST_PROBE_RESP_ATTR_INT]);
  4966. presp->update = true;
  4967. return 0;
  4968. }
  4969. static void nl80211_check_ap_rate_selectors(struct cfg80211_ap_settings *params,
  4970. const struct element *rates)
  4971. {
  4972. int i;
  4973. if (!rates)
  4974. return;
  4975. for (i = 0; i < rates->datalen; i++) {
  4976. if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
  4977. params->ht_required = true;
  4978. if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_VHT_PHY)
  4979. params->vht_required = true;
  4980. if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_HE_PHY)
  4981. params->he_required = true;
  4982. if (rates->data[i] == BSS_MEMBERSHIP_SELECTOR_SAE_H2E)
  4983. params->sae_h2e_required = true;
  4984. }
  4985. }
  4986. /*
  4987. * Since the nl80211 API didn't include, from the beginning, attributes about
  4988. * HT/VHT requirements/capabilities, we parse them out of the IEs for the
  4989. * benefit of drivers that rebuild IEs in the firmware.
  4990. */
  4991. static int nl80211_calculate_ap_params(struct cfg80211_ap_settings *params)
  4992. {
  4993. const struct cfg80211_beacon_data *bcn = &params->beacon;
  4994. size_t ies_len = bcn->tail_len;
  4995. const u8 *ies = bcn->tail;
  4996. const struct element *rates;
  4997. const struct element *cap;
  4998. rates = cfg80211_find_elem(WLAN_EID_SUPP_RATES, ies, ies_len);
  4999. nl80211_check_ap_rate_selectors(params, rates);
  5000. rates = cfg80211_find_elem(WLAN_EID_EXT_SUPP_RATES, ies, ies_len);
  5001. nl80211_check_ap_rate_selectors(params, rates);
  5002. cap = cfg80211_find_elem(WLAN_EID_HT_CAPABILITY, ies, ies_len);
  5003. if (cap && cap->datalen >= sizeof(*params->ht_cap))
  5004. params->ht_cap = (void *)cap->data;
  5005. cap = cfg80211_find_elem(WLAN_EID_VHT_CAPABILITY, ies, ies_len);
  5006. if (cap && cap->datalen >= sizeof(*params->vht_cap))
  5007. params->vht_cap = (void *)cap->data;
  5008. cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_CAPABILITY, ies, ies_len);
  5009. if (cap && cap->datalen >= sizeof(*params->he_cap) + 1)
  5010. params->he_cap = (void *)(cap->data + 1);
  5011. cap = cfg80211_find_ext_elem(WLAN_EID_EXT_HE_OPERATION, ies, ies_len);
  5012. if (cap && cap->datalen >= sizeof(*params->he_oper) + 1)
  5013. params->he_oper = (void *)(cap->data + 1);
  5014. cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_CAPABILITY, ies, ies_len);
  5015. if (cap) {
  5016. if (!cap->datalen)
  5017. return -EINVAL;
  5018. params->eht_cap = (void *)(cap->data + 1);
  5019. if (!ieee80211_eht_capa_size_ok((const u8 *)params->he_cap,
  5020. (const u8 *)params->eht_cap,
  5021. cap->datalen - 1, true))
  5022. return -EINVAL;
  5023. }
  5024. cap = cfg80211_find_ext_elem(WLAN_EID_EXT_EHT_OPERATION, ies, ies_len);
  5025. if (cap) {
  5026. if (!cap->datalen)
  5027. return -EINVAL;
  5028. params->eht_oper = (void *)(cap->data + 1);
  5029. if (!ieee80211_eht_oper_size_ok((const u8 *)params->eht_oper,
  5030. cap->datalen - 1))
  5031. return -EINVAL;
  5032. }
  5033. return 0;
  5034. }
  5035. static bool nl80211_get_ap_channel(struct cfg80211_registered_device *rdev,
  5036. struct cfg80211_ap_settings *params)
  5037. {
  5038. struct wireless_dev *wdev;
  5039. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  5040. if (wdev->iftype != NL80211_IFTYPE_AP &&
  5041. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  5042. continue;
  5043. if (!wdev->u.ap.preset_chandef.chan)
  5044. continue;
  5045. params->chandef = wdev->u.ap.preset_chandef;
  5046. return true;
  5047. }
  5048. return false;
  5049. }
  5050. static bool nl80211_valid_auth_type(struct cfg80211_registered_device *rdev,
  5051. enum nl80211_auth_type auth_type,
  5052. enum nl80211_commands cmd)
  5053. {
  5054. if (auth_type > NL80211_AUTHTYPE_MAX)
  5055. return false;
  5056. switch (cmd) {
  5057. case NL80211_CMD_AUTHENTICATE:
  5058. if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
  5059. auth_type == NL80211_AUTHTYPE_SAE)
  5060. return false;
  5061. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  5062. NL80211_EXT_FEATURE_FILS_STA) &&
  5063. (auth_type == NL80211_AUTHTYPE_FILS_SK ||
  5064. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  5065. auth_type == NL80211_AUTHTYPE_FILS_PK))
  5066. return false;
  5067. return true;
  5068. case NL80211_CMD_CONNECT:
  5069. if (!(rdev->wiphy.features & NL80211_FEATURE_SAE) &&
  5070. !wiphy_ext_feature_isset(&rdev->wiphy,
  5071. NL80211_EXT_FEATURE_SAE_OFFLOAD) &&
  5072. auth_type == NL80211_AUTHTYPE_SAE)
  5073. return false;
  5074. /* FILS with SK PFS or PK not supported yet */
  5075. if (auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  5076. auth_type == NL80211_AUTHTYPE_FILS_PK)
  5077. return false;
  5078. if (!wiphy_ext_feature_isset(
  5079. &rdev->wiphy,
  5080. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
  5081. auth_type == NL80211_AUTHTYPE_FILS_SK)
  5082. return false;
  5083. return true;
  5084. case NL80211_CMD_START_AP:
  5085. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  5086. NL80211_EXT_FEATURE_SAE_OFFLOAD_AP) &&
  5087. auth_type == NL80211_AUTHTYPE_SAE)
  5088. return false;
  5089. /* FILS not supported yet */
  5090. if (auth_type == NL80211_AUTHTYPE_FILS_SK ||
  5091. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  5092. auth_type == NL80211_AUTHTYPE_FILS_PK)
  5093. return false;
  5094. return true;
  5095. default:
  5096. return false;
  5097. }
  5098. }
  5099. static void nl80211_send_ap_started(struct wireless_dev *wdev,
  5100. unsigned int link_id)
  5101. {
  5102. struct wiphy *wiphy = wdev->wiphy;
  5103. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  5104. struct sk_buff *msg;
  5105. void *hdr;
  5106. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  5107. if (!msg)
  5108. return;
  5109. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_START_AP);
  5110. if (!hdr)
  5111. goto out;
  5112. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  5113. nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
  5114. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  5115. NL80211_ATTR_PAD) ||
  5116. (wdev->u.ap.ssid_len &&
  5117. nla_put(msg, NL80211_ATTR_SSID, wdev->u.ap.ssid_len,
  5118. wdev->u.ap.ssid)) ||
  5119. (wdev->valid_links &&
  5120. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)))
  5121. goto out;
  5122. genlmsg_end(msg, hdr);
  5123. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
  5124. NL80211_MCGRP_MLME, GFP_KERNEL);
  5125. return;
  5126. out:
  5127. nlmsg_free(msg);
  5128. }
  5129. static int nl80211_validate_ap_phy_operation(struct cfg80211_ap_settings *params)
  5130. {
  5131. struct ieee80211_channel *channel = params->chandef.chan;
  5132. if ((params->he_cap || params->he_oper) &&
  5133. (channel->flags & IEEE80211_CHAN_NO_HE))
  5134. return -EOPNOTSUPP;
  5135. if ((params->eht_cap || params->eht_oper) &&
  5136. (channel->flags & IEEE80211_CHAN_NO_EHT))
  5137. return -EOPNOTSUPP;
  5138. return 0;
  5139. }
  5140. static int nl80211_start_ap(struct sk_buff *skb, struct genl_info *info)
  5141. {
  5142. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5143. struct cfg80211_beaconing_check_config beacon_check = {};
  5144. unsigned int link_id = nl80211_link_id(info->attrs);
  5145. struct net_device *dev = info->user_ptr[1];
  5146. struct wireless_dev *wdev = dev->ieee80211_ptr;
  5147. struct cfg80211_ap_settings *params;
  5148. int err;
  5149. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  5150. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  5151. return -EOPNOTSUPP;
  5152. if (!rdev->ops->start_ap)
  5153. return -EOPNOTSUPP;
  5154. if (wdev->links[link_id].cac_started)
  5155. return -EBUSY;
  5156. if (wdev->links[link_id].ap.beacon_interval)
  5157. return -EALREADY;
  5158. /* these are required for START_AP */
  5159. if (!info->attrs[NL80211_ATTR_BEACON_INTERVAL] ||
  5160. !info->attrs[NL80211_ATTR_DTIM_PERIOD] ||
  5161. !info->attrs[NL80211_ATTR_BEACON_HEAD])
  5162. return -EINVAL;
  5163. params = kzalloc(sizeof(*params), GFP_KERNEL);
  5164. if (!params)
  5165. return -ENOMEM;
  5166. err = nl80211_parse_beacon(rdev, info->attrs, &params->beacon,
  5167. info->extack);
  5168. if (err)
  5169. goto out;
  5170. params->beacon_interval =
  5171. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  5172. params->dtim_period =
  5173. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  5174. err = cfg80211_validate_beacon_int(rdev, dev->ieee80211_ptr->iftype,
  5175. params->beacon_interval);
  5176. if (err)
  5177. goto out;
  5178. /*
  5179. * In theory, some of these attributes should be required here
  5180. * but since they were not used when the command was originally
  5181. * added, keep them optional for old user space programs to let
  5182. * them continue to work with drivers that do not need the
  5183. * additional information -- drivers must check!
  5184. */
  5185. if (info->attrs[NL80211_ATTR_SSID]) {
  5186. params->ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  5187. params->ssid_len =
  5188. nla_len(info->attrs[NL80211_ATTR_SSID]);
  5189. if (params->ssid_len == 0) {
  5190. err = -EINVAL;
  5191. goto out;
  5192. }
  5193. if (wdev->u.ap.ssid_len &&
  5194. (wdev->u.ap.ssid_len != params->ssid_len ||
  5195. memcmp(wdev->u.ap.ssid, params->ssid, params->ssid_len))) {
  5196. /* require identical SSID for MLO */
  5197. err = -EINVAL;
  5198. goto out;
  5199. }
  5200. } else if (wdev->valid_links) {
  5201. /* require SSID for MLO */
  5202. err = -EINVAL;
  5203. goto out;
  5204. }
  5205. if (info->attrs[NL80211_ATTR_HIDDEN_SSID])
  5206. params->hidden_ssid = nla_get_u32(
  5207. info->attrs[NL80211_ATTR_HIDDEN_SSID]);
  5208. params->privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  5209. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  5210. params->auth_type = nla_get_u32(
  5211. info->attrs[NL80211_ATTR_AUTH_TYPE]);
  5212. if (!nl80211_valid_auth_type(rdev, params->auth_type,
  5213. NL80211_CMD_START_AP)) {
  5214. err = -EINVAL;
  5215. goto out;
  5216. }
  5217. } else
  5218. params->auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  5219. err = nl80211_crypto_settings(rdev, info, &params->crypto,
  5220. NL80211_MAX_NR_CIPHER_SUITES);
  5221. if (err)
  5222. goto out;
  5223. if (info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]) {
  5224. if (!(rdev->wiphy.features & NL80211_FEATURE_INACTIVITY_TIMER)) {
  5225. err = -EOPNOTSUPP;
  5226. goto out;
  5227. }
  5228. params->inactivity_timeout = nla_get_u16(
  5229. info->attrs[NL80211_ATTR_INACTIVITY_TIMEOUT]);
  5230. }
  5231. if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
  5232. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  5233. err = -EINVAL;
  5234. goto out;
  5235. }
  5236. params->p2p_ctwindow =
  5237. nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
  5238. if (params->p2p_ctwindow != 0 &&
  5239. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN)) {
  5240. err = -EINVAL;
  5241. goto out;
  5242. }
  5243. }
  5244. if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
  5245. u8 tmp;
  5246. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  5247. err = -EINVAL;
  5248. goto out;
  5249. }
  5250. tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
  5251. params->p2p_opp_ps = tmp;
  5252. if (params->p2p_opp_ps != 0 &&
  5253. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS)) {
  5254. err = -EINVAL;
  5255. goto out;
  5256. }
  5257. }
  5258. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  5259. err = nl80211_parse_chandef(rdev, info, &params->chandef);
  5260. if (err)
  5261. goto out;
  5262. } else if (wdev->valid_links) {
  5263. /* with MLD need to specify the channel configuration */
  5264. err = -EINVAL;
  5265. goto out;
  5266. } else if (wdev->u.ap.preset_chandef.chan) {
  5267. params->chandef = wdev->u.ap.preset_chandef;
  5268. } else if (!nl80211_get_ap_channel(rdev, params)) {
  5269. err = -EINVAL;
  5270. goto out;
  5271. }
  5272. beacon_check.iftype = wdev->iftype;
  5273. beacon_check.relax = true;
  5274. beacon_check.reg_power =
  5275. cfg80211_get_6ghz_power_type(params->beacon.tail,
  5276. params->beacon.tail_len);
  5277. if (!cfg80211_reg_check_beaconing(&rdev->wiphy, &params->chandef,
  5278. &beacon_check)) {
  5279. err = -EINVAL;
  5280. goto out;
  5281. }
  5282. if (info->attrs[NL80211_ATTR_TX_RATES]) {
  5283. err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
  5284. NL80211_ATTR_TX_RATES,
  5285. &params->beacon_rate,
  5286. dev, false, link_id);
  5287. if (err)
  5288. goto out;
  5289. err = validate_beacon_tx_rate(rdev, params->chandef.chan->band,
  5290. &params->beacon_rate);
  5291. if (err)
  5292. goto out;
  5293. }
  5294. if (info->attrs[NL80211_ATTR_SMPS_MODE]) {
  5295. params->smps_mode =
  5296. nla_get_u8(info->attrs[NL80211_ATTR_SMPS_MODE]);
  5297. switch (params->smps_mode) {
  5298. case NL80211_SMPS_OFF:
  5299. break;
  5300. case NL80211_SMPS_STATIC:
  5301. if (!(rdev->wiphy.features &
  5302. NL80211_FEATURE_STATIC_SMPS)) {
  5303. err = -EINVAL;
  5304. goto out;
  5305. }
  5306. break;
  5307. case NL80211_SMPS_DYNAMIC:
  5308. if (!(rdev->wiphy.features &
  5309. NL80211_FEATURE_DYNAMIC_SMPS)) {
  5310. err = -EINVAL;
  5311. goto out;
  5312. }
  5313. break;
  5314. default:
  5315. err = -EINVAL;
  5316. goto out;
  5317. }
  5318. } else {
  5319. params->smps_mode = NL80211_SMPS_OFF;
  5320. }
  5321. params->pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
  5322. if (params->pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
  5323. err = -EOPNOTSUPP;
  5324. goto out;
  5325. }
  5326. if (info->attrs[NL80211_ATTR_ACL_POLICY]) {
  5327. params->acl = parse_acl_data(&rdev->wiphy, info);
  5328. if (IS_ERR(params->acl)) {
  5329. err = PTR_ERR(params->acl);
  5330. params->acl = NULL;
  5331. goto out;
  5332. }
  5333. }
  5334. params->twt_responder =
  5335. nla_get_flag(info->attrs[NL80211_ATTR_TWT_RESPONDER]);
  5336. if (info->attrs[NL80211_ATTR_HE_OBSS_PD]) {
  5337. err = nl80211_parse_he_obss_pd(
  5338. info->attrs[NL80211_ATTR_HE_OBSS_PD],
  5339. &params->he_obss_pd);
  5340. if (err)
  5341. goto out;
  5342. }
  5343. if (info->attrs[NL80211_ATTR_FILS_DISCOVERY]) {
  5344. err = nl80211_parse_fils_discovery(rdev,
  5345. info->attrs[NL80211_ATTR_FILS_DISCOVERY],
  5346. &params->fils_discovery);
  5347. if (err)
  5348. goto out;
  5349. }
  5350. if (info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP]) {
  5351. err = nl80211_parse_unsol_bcast_probe_resp(
  5352. rdev, info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP],
  5353. &params->unsol_bcast_probe_resp);
  5354. if (err)
  5355. goto out;
  5356. }
  5357. if (info->attrs[NL80211_ATTR_MBSSID_CONFIG]) {
  5358. err = nl80211_parse_mbssid_config(&rdev->wiphy, dev,
  5359. info->attrs[NL80211_ATTR_MBSSID_CONFIG],
  5360. &params->mbssid_config,
  5361. params->beacon.mbssid_ies ?
  5362. params->beacon.mbssid_ies->cnt :
  5363. 0);
  5364. if (err)
  5365. goto out;
  5366. }
  5367. if (!params->mbssid_config.ema && params->beacon.rnr_ies) {
  5368. err = -EINVAL;
  5369. goto out;
  5370. }
  5371. err = nl80211_calculate_ap_params(params);
  5372. if (err)
  5373. goto out;
  5374. err = nl80211_validate_ap_phy_operation(params);
  5375. if (err)
  5376. goto out;
  5377. if (info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS])
  5378. params->flags = nla_get_u32(
  5379. info->attrs[NL80211_ATTR_AP_SETTINGS_FLAGS]);
  5380. else if (info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])
  5381. params->flags |= NL80211_AP_SETTINGS_EXTERNAL_AUTH_SUPPORT;
  5382. if (wdev->conn_owner_nlportid &&
  5383. info->attrs[NL80211_ATTR_SOCKET_OWNER] &&
  5384. wdev->conn_owner_nlportid != info->snd_portid) {
  5385. err = -EINVAL;
  5386. goto out;
  5387. }
  5388. /* FIXME: validate MLO/link-id against driver capabilities */
  5389. err = rdev_start_ap(rdev, dev, params);
  5390. if (!err) {
  5391. wdev->links[link_id].ap.beacon_interval = params->beacon_interval;
  5392. wdev->links[link_id].ap.chandef = params->chandef;
  5393. wdev->u.ap.ssid_len = params->ssid_len;
  5394. memcpy(wdev->u.ap.ssid, params->ssid,
  5395. params->ssid_len);
  5396. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  5397. wdev->conn_owner_nlportid = info->snd_portid;
  5398. nl80211_send_ap_started(wdev, link_id);
  5399. }
  5400. out:
  5401. kfree(params->acl);
  5402. kfree(params->beacon.mbssid_ies);
  5403. if (params->mbssid_config.tx_wdev &&
  5404. params->mbssid_config.tx_wdev->netdev &&
  5405. params->mbssid_config.tx_wdev->netdev != dev)
  5406. dev_put(params->mbssid_config.tx_wdev->netdev);
  5407. kfree(params->beacon.rnr_ies);
  5408. kfree(params);
  5409. return err;
  5410. }
  5411. static int nl80211_set_beacon(struct sk_buff *skb, struct genl_info *info)
  5412. {
  5413. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5414. struct cfg80211_beaconing_check_config beacon_check = {};
  5415. unsigned int link_id = nl80211_link_id(info->attrs);
  5416. struct net_device *dev = info->user_ptr[1];
  5417. struct wireless_dev *wdev = dev->ieee80211_ptr;
  5418. struct cfg80211_ap_update *params;
  5419. struct nlattr *attr;
  5420. int err;
  5421. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  5422. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  5423. return -EOPNOTSUPP;
  5424. if (!rdev->ops->change_beacon)
  5425. return -EOPNOTSUPP;
  5426. if (!wdev->links[link_id].ap.beacon_interval)
  5427. return -EINVAL;
  5428. params = kzalloc(sizeof(*params), GFP_KERNEL);
  5429. if (!params)
  5430. return -ENOMEM;
  5431. err = nl80211_parse_beacon(rdev, info->attrs, &params->beacon,
  5432. info->extack);
  5433. if (err)
  5434. goto out;
  5435. /* recheck beaconing is permitted with possibly changed power type */
  5436. beacon_check.iftype = wdev->iftype;
  5437. beacon_check.relax = true;
  5438. beacon_check.reg_power =
  5439. cfg80211_get_6ghz_power_type(params->beacon.tail,
  5440. params->beacon.tail_len);
  5441. if (!cfg80211_reg_check_beaconing(&rdev->wiphy,
  5442. &wdev->links[link_id].ap.chandef,
  5443. &beacon_check)) {
  5444. err = -EINVAL;
  5445. goto out;
  5446. }
  5447. attr = info->attrs[NL80211_ATTR_FILS_DISCOVERY];
  5448. if (attr) {
  5449. err = nl80211_parse_fils_discovery(rdev, attr,
  5450. &params->fils_discovery);
  5451. if (err)
  5452. goto out;
  5453. }
  5454. attr = info->attrs[NL80211_ATTR_UNSOL_BCAST_PROBE_RESP];
  5455. if (attr) {
  5456. err = nl80211_parse_unsol_bcast_probe_resp(rdev, attr,
  5457. &params->unsol_bcast_probe_resp);
  5458. if (err)
  5459. goto out;
  5460. }
  5461. err = rdev_change_beacon(rdev, dev, params);
  5462. out:
  5463. kfree(params->beacon.mbssid_ies);
  5464. kfree(params->beacon.rnr_ies);
  5465. kfree(params);
  5466. return err;
  5467. }
  5468. static int nl80211_stop_ap(struct sk_buff *skb, struct genl_info *info)
  5469. {
  5470. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5471. unsigned int link_id = nl80211_link_id(info->attrs);
  5472. struct net_device *dev = info->user_ptr[1];
  5473. return cfg80211_stop_ap(rdev, dev, link_id, false);
  5474. }
  5475. static const struct nla_policy sta_flags_policy[NL80211_STA_FLAG_MAX + 1] = {
  5476. [NL80211_STA_FLAG_AUTHORIZED] = { .type = NLA_FLAG },
  5477. [NL80211_STA_FLAG_SHORT_PREAMBLE] = { .type = NLA_FLAG },
  5478. [NL80211_STA_FLAG_WME] = { .type = NLA_FLAG },
  5479. [NL80211_STA_FLAG_MFP] = { .type = NLA_FLAG },
  5480. [NL80211_STA_FLAG_AUTHENTICATED] = { .type = NLA_FLAG },
  5481. [NL80211_STA_FLAG_TDLS_PEER] = { .type = NLA_FLAG },
  5482. };
  5483. static int parse_station_flags(struct genl_info *info,
  5484. enum nl80211_iftype iftype,
  5485. struct station_parameters *params)
  5486. {
  5487. struct nlattr *flags[NL80211_STA_FLAG_MAX + 1];
  5488. struct nlattr *nla;
  5489. int flag;
  5490. /*
  5491. * Try parsing the new attribute first so userspace
  5492. * can specify both for older kernels.
  5493. */
  5494. nla = info->attrs[NL80211_ATTR_STA_FLAGS2];
  5495. if (nla) {
  5496. struct nl80211_sta_flag_update *sta_flags;
  5497. sta_flags = nla_data(nla);
  5498. params->sta_flags_mask = sta_flags->mask;
  5499. params->sta_flags_set = sta_flags->set;
  5500. params->sta_flags_set &= params->sta_flags_mask;
  5501. if ((params->sta_flags_mask |
  5502. params->sta_flags_set) & BIT(__NL80211_STA_FLAG_INVALID))
  5503. return -EINVAL;
  5504. return 0;
  5505. }
  5506. /* if present, parse the old attribute */
  5507. nla = info->attrs[NL80211_ATTR_STA_FLAGS];
  5508. if (!nla)
  5509. return 0;
  5510. if (nla_parse_nested_deprecated(flags, NL80211_STA_FLAG_MAX, nla, sta_flags_policy, info->extack))
  5511. return -EINVAL;
  5512. /*
  5513. * Only allow certain flags for interface types so that
  5514. * other attributes are silently ignored. Remember that
  5515. * this is backward compatibility code with old userspace
  5516. * and shouldn't be hit in other cases anyway.
  5517. */
  5518. switch (iftype) {
  5519. case NL80211_IFTYPE_AP:
  5520. case NL80211_IFTYPE_AP_VLAN:
  5521. case NL80211_IFTYPE_P2P_GO:
  5522. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
  5523. BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
  5524. BIT(NL80211_STA_FLAG_WME) |
  5525. BIT(NL80211_STA_FLAG_MFP);
  5526. break;
  5527. case NL80211_IFTYPE_P2P_CLIENT:
  5528. case NL80211_IFTYPE_STATION:
  5529. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHORIZED) |
  5530. BIT(NL80211_STA_FLAG_TDLS_PEER);
  5531. break;
  5532. case NL80211_IFTYPE_MESH_POINT:
  5533. params->sta_flags_mask = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  5534. BIT(NL80211_STA_FLAG_MFP) |
  5535. BIT(NL80211_STA_FLAG_AUTHORIZED);
  5536. break;
  5537. default:
  5538. return -EINVAL;
  5539. }
  5540. for (flag = 1; flag <= NL80211_STA_FLAG_MAX; flag++) {
  5541. if (flags[flag]) {
  5542. params->sta_flags_set |= (1<<flag);
  5543. /* no longer support new API additions in old API */
  5544. if (flag > NL80211_STA_FLAG_MAX_OLD_API)
  5545. return -EINVAL;
  5546. }
  5547. }
  5548. return 0;
  5549. }
  5550. bool nl80211_put_sta_rate(struct sk_buff *msg, struct rate_info *info, int attr)
  5551. {
  5552. struct nlattr *rate;
  5553. u32 bitrate;
  5554. u16 bitrate_compat;
  5555. enum nl80211_rate_info rate_flg;
  5556. rate = nla_nest_start_noflag(msg, attr);
  5557. if (!rate)
  5558. return false;
  5559. /* cfg80211_calculate_bitrate will return 0 for mcs >= 32 */
  5560. bitrate = cfg80211_calculate_bitrate(info);
  5561. /* report 16-bit bitrate only if we can */
  5562. bitrate_compat = bitrate < (1UL << 16) ? bitrate : 0;
  5563. if (bitrate > 0 &&
  5564. nla_put_u32(msg, NL80211_RATE_INFO_BITRATE32, bitrate))
  5565. return false;
  5566. if (bitrate_compat > 0 &&
  5567. nla_put_u16(msg, NL80211_RATE_INFO_BITRATE, bitrate_compat))
  5568. return false;
  5569. switch (info->bw) {
  5570. case RATE_INFO_BW_1:
  5571. rate_flg = NL80211_RATE_INFO_1_MHZ_WIDTH;
  5572. break;
  5573. case RATE_INFO_BW_2:
  5574. rate_flg = NL80211_RATE_INFO_2_MHZ_WIDTH;
  5575. break;
  5576. case RATE_INFO_BW_4:
  5577. rate_flg = NL80211_RATE_INFO_4_MHZ_WIDTH;
  5578. break;
  5579. case RATE_INFO_BW_5:
  5580. rate_flg = NL80211_RATE_INFO_5_MHZ_WIDTH;
  5581. break;
  5582. case RATE_INFO_BW_8:
  5583. rate_flg = NL80211_RATE_INFO_8_MHZ_WIDTH;
  5584. break;
  5585. case RATE_INFO_BW_10:
  5586. rate_flg = NL80211_RATE_INFO_10_MHZ_WIDTH;
  5587. break;
  5588. case RATE_INFO_BW_16:
  5589. rate_flg = NL80211_RATE_INFO_16_MHZ_WIDTH;
  5590. break;
  5591. default:
  5592. WARN_ON(1);
  5593. fallthrough;
  5594. case RATE_INFO_BW_20:
  5595. rate_flg = 0;
  5596. break;
  5597. case RATE_INFO_BW_40:
  5598. rate_flg = NL80211_RATE_INFO_40_MHZ_WIDTH;
  5599. break;
  5600. case RATE_INFO_BW_80:
  5601. rate_flg = NL80211_RATE_INFO_80_MHZ_WIDTH;
  5602. break;
  5603. case RATE_INFO_BW_160:
  5604. rate_flg = NL80211_RATE_INFO_160_MHZ_WIDTH;
  5605. break;
  5606. case RATE_INFO_BW_HE_RU:
  5607. rate_flg = 0;
  5608. WARN_ON(!(info->flags & RATE_INFO_FLAGS_HE_MCS));
  5609. break;
  5610. case RATE_INFO_BW_320:
  5611. rate_flg = NL80211_RATE_INFO_320_MHZ_WIDTH;
  5612. break;
  5613. case RATE_INFO_BW_EHT_RU:
  5614. rate_flg = 0;
  5615. WARN_ON(!(info->flags & RATE_INFO_FLAGS_EHT_MCS));
  5616. break;
  5617. }
  5618. if (rate_flg && nla_put_flag(msg, rate_flg))
  5619. return false;
  5620. if (info->flags & RATE_INFO_FLAGS_MCS) {
  5621. if (nla_put_u8(msg, NL80211_RATE_INFO_MCS, info->mcs))
  5622. return false;
  5623. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  5624. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  5625. return false;
  5626. } else if (info->flags & RATE_INFO_FLAGS_VHT_MCS) {
  5627. if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_MCS, info->mcs))
  5628. return false;
  5629. if (nla_put_u8(msg, NL80211_RATE_INFO_VHT_NSS, info->nss))
  5630. return false;
  5631. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  5632. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  5633. return false;
  5634. } else if (info->flags & RATE_INFO_FLAGS_HE_MCS) {
  5635. if (nla_put_u8(msg, NL80211_RATE_INFO_HE_MCS, info->mcs))
  5636. return false;
  5637. if (nla_put_u8(msg, NL80211_RATE_INFO_HE_NSS, info->nss))
  5638. return false;
  5639. if (nla_put_u8(msg, NL80211_RATE_INFO_HE_GI, info->he_gi))
  5640. return false;
  5641. if (nla_put_u8(msg, NL80211_RATE_INFO_HE_DCM, info->he_dcm))
  5642. return false;
  5643. if (info->bw == RATE_INFO_BW_HE_RU &&
  5644. nla_put_u8(msg, NL80211_RATE_INFO_HE_RU_ALLOC,
  5645. info->he_ru_alloc))
  5646. return false;
  5647. } else if (info->flags & RATE_INFO_FLAGS_S1G_MCS) {
  5648. if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_MCS, info->mcs))
  5649. return false;
  5650. if (nla_put_u8(msg, NL80211_RATE_INFO_S1G_NSS, info->nss))
  5651. return false;
  5652. if (info->flags & RATE_INFO_FLAGS_SHORT_GI &&
  5653. nla_put_flag(msg, NL80211_RATE_INFO_SHORT_GI))
  5654. return false;
  5655. } else if (info->flags & RATE_INFO_FLAGS_EHT_MCS) {
  5656. if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_MCS, info->mcs))
  5657. return false;
  5658. if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_NSS, info->nss))
  5659. return false;
  5660. if (nla_put_u8(msg, NL80211_RATE_INFO_EHT_GI, info->eht_gi))
  5661. return false;
  5662. if (info->bw == RATE_INFO_BW_EHT_RU &&
  5663. nla_put_u8(msg, NL80211_RATE_INFO_EHT_RU_ALLOC,
  5664. info->eht_ru_alloc))
  5665. return false;
  5666. }
  5667. nla_nest_end(msg, rate);
  5668. return true;
  5669. }
  5670. static bool nl80211_put_signal(struct sk_buff *msg, u8 mask, s8 *signal,
  5671. int id)
  5672. {
  5673. void *attr;
  5674. int i = 0;
  5675. if (!mask)
  5676. return true;
  5677. attr = nla_nest_start_noflag(msg, id);
  5678. if (!attr)
  5679. return false;
  5680. for (i = 0; i < IEEE80211_MAX_CHAINS; i++) {
  5681. if (!(mask & BIT(i)))
  5682. continue;
  5683. if (nla_put_u8(msg, i, signal[i]))
  5684. return false;
  5685. }
  5686. nla_nest_end(msg, attr);
  5687. return true;
  5688. }
  5689. static int nl80211_send_station(struct sk_buff *msg, u32 cmd, u32 portid,
  5690. u32 seq, int flags,
  5691. struct cfg80211_registered_device *rdev,
  5692. struct net_device *dev,
  5693. const u8 *mac_addr, struct station_info *sinfo)
  5694. {
  5695. void *hdr;
  5696. struct nlattr *sinfoattr, *bss_param;
  5697. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  5698. if (!hdr) {
  5699. cfg80211_sinfo_release_content(sinfo);
  5700. return -1;
  5701. }
  5702. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  5703. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
  5704. nla_put_u32(msg, NL80211_ATTR_GENERATION, sinfo->generation))
  5705. goto nla_put_failure;
  5706. sinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_STA_INFO);
  5707. if (!sinfoattr)
  5708. goto nla_put_failure;
  5709. #define PUT_SINFO(attr, memb, type) do { \
  5710. BUILD_BUG_ON(sizeof(type) == sizeof(u64)); \
  5711. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \
  5712. nla_put_ ## type(msg, NL80211_STA_INFO_ ## attr, \
  5713. sinfo->memb)) \
  5714. goto nla_put_failure; \
  5715. } while (0)
  5716. #define PUT_SINFO_U64(attr, memb) do { \
  5717. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_ ## attr) && \
  5718. nla_put_u64_64bit(msg, NL80211_STA_INFO_ ## attr, \
  5719. sinfo->memb, NL80211_STA_INFO_PAD)) \
  5720. goto nla_put_failure; \
  5721. } while (0)
  5722. PUT_SINFO(CONNECTED_TIME, connected_time, u32);
  5723. PUT_SINFO(INACTIVE_TIME, inactive_time, u32);
  5724. PUT_SINFO_U64(ASSOC_AT_BOOTTIME, assoc_at);
  5725. if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_RX_BYTES) |
  5726. BIT_ULL(NL80211_STA_INFO_RX_BYTES64)) &&
  5727. nla_put_u32(msg, NL80211_STA_INFO_RX_BYTES,
  5728. (u32)sinfo->rx_bytes))
  5729. goto nla_put_failure;
  5730. if (sinfo->filled & (BIT_ULL(NL80211_STA_INFO_TX_BYTES) |
  5731. BIT_ULL(NL80211_STA_INFO_TX_BYTES64)) &&
  5732. nla_put_u32(msg, NL80211_STA_INFO_TX_BYTES,
  5733. (u32)sinfo->tx_bytes))
  5734. goto nla_put_failure;
  5735. PUT_SINFO_U64(RX_BYTES64, rx_bytes);
  5736. PUT_SINFO_U64(TX_BYTES64, tx_bytes);
  5737. PUT_SINFO(LLID, llid, u16);
  5738. PUT_SINFO(PLID, plid, u16);
  5739. PUT_SINFO(PLINK_STATE, plink_state, u8);
  5740. PUT_SINFO_U64(RX_DURATION, rx_duration);
  5741. PUT_SINFO_U64(TX_DURATION, tx_duration);
  5742. if (wiphy_ext_feature_isset(&rdev->wiphy,
  5743. NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
  5744. PUT_SINFO(AIRTIME_WEIGHT, airtime_weight, u16);
  5745. switch (rdev->wiphy.signal_type) {
  5746. case CFG80211_SIGNAL_TYPE_MBM:
  5747. PUT_SINFO(SIGNAL, signal, u8);
  5748. PUT_SINFO(SIGNAL_AVG, signal_avg, u8);
  5749. break;
  5750. default:
  5751. break;
  5752. }
  5753. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL)) {
  5754. if (!nl80211_put_signal(msg, sinfo->chains,
  5755. sinfo->chain_signal,
  5756. NL80211_STA_INFO_CHAIN_SIGNAL))
  5757. goto nla_put_failure;
  5758. }
  5759. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_CHAIN_SIGNAL_AVG)) {
  5760. if (!nl80211_put_signal(msg, sinfo->chains,
  5761. sinfo->chain_signal_avg,
  5762. NL80211_STA_INFO_CHAIN_SIGNAL_AVG))
  5763. goto nla_put_failure;
  5764. }
  5765. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_TX_BITRATE)) {
  5766. if (!nl80211_put_sta_rate(msg, &sinfo->txrate,
  5767. NL80211_STA_INFO_TX_BITRATE))
  5768. goto nla_put_failure;
  5769. }
  5770. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_RX_BITRATE)) {
  5771. if (!nl80211_put_sta_rate(msg, &sinfo->rxrate,
  5772. NL80211_STA_INFO_RX_BITRATE))
  5773. goto nla_put_failure;
  5774. }
  5775. PUT_SINFO(RX_PACKETS, rx_packets, u32);
  5776. PUT_SINFO(TX_PACKETS, tx_packets, u32);
  5777. PUT_SINFO(TX_RETRIES, tx_retries, u32);
  5778. PUT_SINFO(TX_FAILED, tx_failed, u32);
  5779. PUT_SINFO(EXPECTED_THROUGHPUT, expected_throughput, u32);
  5780. PUT_SINFO(AIRTIME_LINK_METRIC, airtime_link_metric, u32);
  5781. PUT_SINFO(BEACON_LOSS, beacon_loss_count, u32);
  5782. PUT_SINFO(LOCAL_PM, local_pm, u32);
  5783. PUT_SINFO(PEER_PM, peer_pm, u32);
  5784. PUT_SINFO(NONPEER_PM, nonpeer_pm, u32);
  5785. PUT_SINFO(CONNECTED_TO_GATE, connected_to_gate, u8);
  5786. PUT_SINFO(CONNECTED_TO_AS, connected_to_as, u8);
  5787. if (sinfo->filled & BIT_ULL(NL80211_STA_INFO_BSS_PARAM)) {
  5788. bss_param = nla_nest_start_noflag(msg,
  5789. NL80211_STA_INFO_BSS_PARAM);
  5790. if (!bss_param)
  5791. goto nla_put_failure;
  5792. if (((sinfo->bss_param.flags & BSS_PARAM_FLAGS_CTS_PROT) &&
  5793. nla_put_flag(msg, NL80211_STA_BSS_PARAM_CTS_PROT)) ||
  5794. ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_PREAMBLE) &&
  5795. nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_PREAMBLE)) ||
  5796. ((sinfo->bss_param.flags & BSS_PARAM_FLAGS_SHORT_SLOT_TIME) &&
  5797. nla_put_flag(msg, NL80211_STA_BSS_PARAM_SHORT_SLOT_TIME)) ||
  5798. nla_put_u8(msg, NL80211_STA_BSS_PARAM_DTIM_PERIOD,
  5799. sinfo->bss_param.dtim_period) ||
  5800. nla_put_u16(msg, NL80211_STA_BSS_PARAM_BEACON_INTERVAL,
  5801. sinfo->bss_param.beacon_interval))
  5802. goto nla_put_failure;
  5803. nla_nest_end(msg, bss_param);
  5804. }
  5805. if ((sinfo->filled & BIT_ULL(NL80211_STA_INFO_STA_FLAGS)) &&
  5806. nla_put(msg, NL80211_STA_INFO_STA_FLAGS,
  5807. sizeof(struct nl80211_sta_flag_update),
  5808. &sinfo->sta_flags))
  5809. goto nla_put_failure;
  5810. PUT_SINFO_U64(T_OFFSET, t_offset);
  5811. PUT_SINFO_U64(RX_DROP_MISC, rx_dropped_misc);
  5812. PUT_SINFO_U64(BEACON_RX, rx_beacon);
  5813. PUT_SINFO(BEACON_SIGNAL_AVG, rx_beacon_signal_avg, u8);
  5814. PUT_SINFO(RX_MPDUS, rx_mpdu_count, u32);
  5815. PUT_SINFO(FCS_ERROR_COUNT, fcs_err_count, u32);
  5816. if (wiphy_ext_feature_isset(&rdev->wiphy,
  5817. NL80211_EXT_FEATURE_ACK_SIGNAL_SUPPORT)) {
  5818. PUT_SINFO(ACK_SIGNAL, ack_signal, u8);
  5819. PUT_SINFO(ACK_SIGNAL_AVG, avg_ack_signal, s8);
  5820. }
  5821. #undef PUT_SINFO
  5822. #undef PUT_SINFO_U64
  5823. if (sinfo->pertid) {
  5824. struct nlattr *tidsattr;
  5825. int tid;
  5826. tidsattr = nla_nest_start_noflag(msg,
  5827. NL80211_STA_INFO_TID_STATS);
  5828. if (!tidsattr)
  5829. goto nla_put_failure;
  5830. for (tid = 0; tid < IEEE80211_NUM_TIDS + 1; tid++) {
  5831. struct cfg80211_tid_stats *tidstats;
  5832. struct nlattr *tidattr;
  5833. tidstats = &sinfo->pertid[tid];
  5834. if (!tidstats->filled)
  5835. continue;
  5836. tidattr = nla_nest_start_noflag(msg, tid + 1);
  5837. if (!tidattr)
  5838. goto nla_put_failure;
  5839. #define PUT_TIDVAL_U64(attr, memb) do { \
  5840. if (tidstats->filled & BIT(NL80211_TID_STATS_ ## attr) && \
  5841. nla_put_u64_64bit(msg, NL80211_TID_STATS_ ## attr, \
  5842. tidstats->memb, NL80211_TID_STATS_PAD)) \
  5843. goto nla_put_failure; \
  5844. } while (0)
  5845. PUT_TIDVAL_U64(RX_MSDU, rx_msdu);
  5846. PUT_TIDVAL_U64(TX_MSDU, tx_msdu);
  5847. PUT_TIDVAL_U64(TX_MSDU_RETRIES, tx_msdu_retries);
  5848. PUT_TIDVAL_U64(TX_MSDU_FAILED, tx_msdu_failed);
  5849. #undef PUT_TIDVAL_U64
  5850. if ((tidstats->filled &
  5851. BIT(NL80211_TID_STATS_TXQ_STATS)) &&
  5852. !nl80211_put_txq_stats(msg, &tidstats->txq_stats,
  5853. NL80211_TID_STATS_TXQ_STATS))
  5854. goto nla_put_failure;
  5855. nla_nest_end(msg, tidattr);
  5856. }
  5857. nla_nest_end(msg, tidsattr);
  5858. }
  5859. nla_nest_end(msg, sinfoattr);
  5860. if (sinfo->assoc_req_ies_len &&
  5861. nla_put(msg, NL80211_ATTR_IE, sinfo->assoc_req_ies_len,
  5862. sinfo->assoc_req_ies))
  5863. goto nla_put_failure;
  5864. if (sinfo->assoc_resp_ies_len &&
  5865. nla_put(msg, NL80211_ATTR_RESP_IE, sinfo->assoc_resp_ies_len,
  5866. sinfo->assoc_resp_ies))
  5867. goto nla_put_failure;
  5868. if (sinfo->mlo_params_valid) {
  5869. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID,
  5870. sinfo->assoc_link_id))
  5871. goto nla_put_failure;
  5872. if (!is_zero_ether_addr(sinfo->mld_addr) &&
  5873. nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN,
  5874. sinfo->mld_addr))
  5875. goto nla_put_failure;
  5876. }
  5877. cfg80211_sinfo_release_content(sinfo);
  5878. genlmsg_end(msg, hdr);
  5879. return 0;
  5880. nla_put_failure:
  5881. cfg80211_sinfo_release_content(sinfo);
  5882. genlmsg_cancel(msg, hdr);
  5883. return -EMSGSIZE;
  5884. }
  5885. static int nl80211_dump_station(struct sk_buff *skb,
  5886. struct netlink_callback *cb)
  5887. {
  5888. struct station_info sinfo;
  5889. struct cfg80211_registered_device *rdev;
  5890. struct wireless_dev *wdev;
  5891. u8 mac_addr[ETH_ALEN];
  5892. int sta_idx = cb->args[2];
  5893. int err;
  5894. err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
  5895. if (err)
  5896. return err;
  5897. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  5898. __acquire(&rdev->wiphy.mtx);
  5899. if (!wdev->netdev) {
  5900. err = -EINVAL;
  5901. goto out_err;
  5902. }
  5903. if (!rdev->ops->dump_station) {
  5904. err = -EOPNOTSUPP;
  5905. goto out_err;
  5906. }
  5907. while (1) {
  5908. memset(&sinfo, 0, sizeof(sinfo));
  5909. err = rdev_dump_station(rdev, wdev->netdev, sta_idx,
  5910. mac_addr, &sinfo);
  5911. if (err == -ENOENT)
  5912. break;
  5913. if (err)
  5914. goto out_err;
  5915. if (nl80211_send_station(skb, NL80211_CMD_NEW_STATION,
  5916. NETLINK_CB(cb->skb).portid,
  5917. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  5918. rdev, wdev->netdev, mac_addr,
  5919. &sinfo) < 0)
  5920. goto out;
  5921. sta_idx++;
  5922. }
  5923. out:
  5924. cb->args[2] = sta_idx;
  5925. err = skb->len;
  5926. out_err:
  5927. wiphy_unlock(&rdev->wiphy);
  5928. return err;
  5929. }
  5930. static int nl80211_get_station(struct sk_buff *skb, struct genl_info *info)
  5931. {
  5932. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  5933. struct net_device *dev = info->user_ptr[1];
  5934. struct station_info sinfo;
  5935. struct sk_buff *msg;
  5936. u8 *mac_addr = NULL;
  5937. int err;
  5938. memset(&sinfo, 0, sizeof(sinfo));
  5939. if (!info->attrs[NL80211_ATTR_MAC])
  5940. return -EINVAL;
  5941. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  5942. if (!rdev->ops->get_station)
  5943. return -EOPNOTSUPP;
  5944. err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
  5945. if (err)
  5946. return err;
  5947. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  5948. if (!msg) {
  5949. cfg80211_sinfo_release_content(&sinfo);
  5950. return -ENOMEM;
  5951. }
  5952. if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION,
  5953. info->snd_portid, info->snd_seq, 0,
  5954. rdev, dev, mac_addr, &sinfo) < 0) {
  5955. nlmsg_free(msg);
  5956. return -ENOBUFS;
  5957. }
  5958. return genlmsg_reply(msg, info);
  5959. }
  5960. int cfg80211_check_station_change(struct wiphy *wiphy,
  5961. struct station_parameters *params,
  5962. enum cfg80211_station_type statype)
  5963. {
  5964. if (params->listen_interval != -1 &&
  5965. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  5966. return -EINVAL;
  5967. if (params->support_p2p_ps != -1 &&
  5968. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  5969. return -EINVAL;
  5970. if (params->aid &&
  5971. !(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) &&
  5972. statype != CFG80211_STA_AP_CLIENT_UNASSOC)
  5973. return -EINVAL;
  5974. /* When you run into this, adjust the code below for the new flag */
  5975. BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8);
  5976. switch (statype) {
  5977. case CFG80211_STA_MESH_PEER_KERNEL:
  5978. case CFG80211_STA_MESH_PEER_USER:
  5979. /*
  5980. * No ignoring the TDLS flag here -- the userspace mesh
  5981. * code doesn't have the bug of including TDLS in the
  5982. * mask everywhere.
  5983. */
  5984. if (params->sta_flags_mask &
  5985. ~(BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  5986. BIT(NL80211_STA_FLAG_MFP) |
  5987. BIT(NL80211_STA_FLAG_AUTHORIZED)))
  5988. return -EINVAL;
  5989. break;
  5990. case CFG80211_STA_TDLS_PEER_SETUP:
  5991. case CFG80211_STA_TDLS_PEER_ACTIVE:
  5992. if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
  5993. return -EINVAL;
  5994. /* ignore since it can't change */
  5995. params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  5996. break;
  5997. default:
  5998. /* disallow mesh-specific things */
  5999. if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION)
  6000. return -EINVAL;
  6001. if (params->local_pm)
  6002. return -EINVAL;
  6003. if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
  6004. return -EINVAL;
  6005. }
  6006. if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
  6007. statype != CFG80211_STA_TDLS_PEER_ACTIVE) {
  6008. /* TDLS can't be set, ... */
  6009. if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
  6010. return -EINVAL;
  6011. /*
  6012. * ... but don't bother the driver with it. This works around
  6013. * a hostapd/wpa_supplicant issue -- it always includes the
  6014. * TLDS_PEER flag in the mask even for AP mode.
  6015. */
  6016. params->sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  6017. }
  6018. if (statype != CFG80211_STA_TDLS_PEER_SETUP &&
  6019. statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
  6020. /* reject other things that can't change */
  6021. if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD)
  6022. return -EINVAL;
  6023. if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY)
  6024. return -EINVAL;
  6025. if (params->link_sta_params.supported_rates)
  6026. return -EINVAL;
  6027. if (params->ext_capab || params->link_sta_params.ht_capa ||
  6028. params->link_sta_params.vht_capa ||
  6029. params->link_sta_params.he_capa ||
  6030. params->link_sta_params.eht_capa)
  6031. return -EINVAL;
  6032. if (params->sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU))
  6033. return -EINVAL;
  6034. }
  6035. if (statype != CFG80211_STA_AP_CLIENT &&
  6036. statype != CFG80211_STA_AP_CLIENT_UNASSOC) {
  6037. if (params->vlan)
  6038. return -EINVAL;
  6039. }
  6040. switch (statype) {
  6041. case CFG80211_STA_AP_MLME_CLIENT:
  6042. /* Use this only for authorizing/unauthorizing a station */
  6043. if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)))
  6044. return -EOPNOTSUPP;
  6045. break;
  6046. case CFG80211_STA_AP_CLIENT:
  6047. case CFG80211_STA_AP_CLIENT_UNASSOC:
  6048. /* accept only the listed bits */
  6049. if (params->sta_flags_mask &
  6050. ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
  6051. BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  6052. BIT(NL80211_STA_FLAG_ASSOCIATED) |
  6053. BIT(NL80211_STA_FLAG_SHORT_PREAMBLE) |
  6054. BIT(NL80211_STA_FLAG_WME) |
  6055. BIT(NL80211_STA_FLAG_MFP) |
  6056. BIT(NL80211_STA_FLAG_SPP_AMSDU)))
  6057. return -EINVAL;
  6058. /* but authenticated/associated only if driver handles it */
  6059. if (!(wiphy->features & NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
  6060. params->sta_flags_mask &
  6061. (BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  6062. BIT(NL80211_STA_FLAG_ASSOCIATED)))
  6063. return -EINVAL;
  6064. break;
  6065. case CFG80211_STA_IBSS:
  6066. case CFG80211_STA_AP_STA:
  6067. /* reject any changes other than AUTHORIZED */
  6068. if (params->sta_flags_mask & ~BIT(NL80211_STA_FLAG_AUTHORIZED))
  6069. return -EINVAL;
  6070. break;
  6071. case CFG80211_STA_TDLS_PEER_SETUP:
  6072. /* reject any changes other than AUTHORIZED or WME */
  6073. if (params->sta_flags_mask & ~(BIT(NL80211_STA_FLAG_AUTHORIZED) |
  6074. BIT(NL80211_STA_FLAG_WME)))
  6075. return -EINVAL;
  6076. /* force (at least) rates when authorizing */
  6077. if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED) &&
  6078. !params->link_sta_params.supported_rates)
  6079. return -EINVAL;
  6080. break;
  6081. case CFG80211_STA_TDLS_PEER_ACTIVE:
  6082. /* reject any changes */
  6083. return -EINVAL;
  6084. case CFG80211_STA_MESH_PEER_KERNEL:
  6085. if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE)
  6086. return -EINVAL;
  6087. break;
  6088. case CFG80211_STA_MESH_PEER_USER:
  6089. if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION &&
  6090. params->plink_action != NL80211_PLINK_ACTION_BLOCK)
  6091. return -EINVAL;
  6092. break;
  6093. }
  6094. /*
  6095. * Older kernel versions ignored this attribute entirely, so don't
  6096. * reject attempts to update it but mark it as unused instead so the
  6097. * driver won't look at the data.
  6098. */
  6099. if (statype != CFG80211_STA_AP_CLIENT_UNASSOC &&
  6100. statype != CFG80211_STA_TDLS_PEER_SETUP)
  6101. params->link_sta_params.opmode_notif_used = false;
  6102. return 0;
  6103. }
  6104. EXPORT_SYMBOL(cfg80211_check_station_change);
  6105. /*
  6106. * Get vlan interface making sure it is running and on the right wiphy.
  6107. */
  6108. static struct net_device *get_vlan(struct genl_info *info,
  6109. struct cfg80211_registered_device *rdev)
  6110. {
  6111. struct nlattr *vlanattr = info->attrs[NL80211_ATTR_STA_VLAN];
  6112. struct net_device *v;
  6113. int ret;
  6114. if (!vlanattr)
  6115. return NULL;
  6116. v = dev_get_by_index(genl_info_net(info), nla_get_u32(vlanattr));
  6117. if (!v)
  6118. return ERR_PTR(-ENODEV);
  6119. if (!v->ieee80211_ptr || v->ieee80211_ptr->wiphy != &rdev->wiphy) {
  6120. ret = -EINVAL;
  6121. goto error;
  6122. }
  6123. if (v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP_VLAN &&
  6124. v->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  6125. v->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO) {
  6126. ret = -EINVAL;
  6127. goto error;
  6128. }
  6129. if (!netif_running(v)) {
  6130. ret = -ENETDOWN;
  6131. goto error;
  6132. }
  6133. return v;
  6134. error:
  6135. dev_put(v);
  6136. return ERR_PTR(ret);
  6137. }
  6138. static int nl80211_parse_sta_wme(struct genl_info *info,
  6139. struct station_parameters *params)
  6140. {
  6141. struct nlattr *tb[NL80211_STA_WME_MAX + 1];
  6142. struct nlattr *nla;
  6143. int err;
  6144. /* parse WME attributes if present */
  6145. if (!info->attrs[NL80211_ATTR_STA_WME])
  6146. return 0;
  6147. nla = info->attrs[NL80211_ATTR_STA_WME];
  6148. err = nla_parse_nested_deprecated(tb, NL80211_STA_WME_MAX, nla,
  6149. nl80211_sta_wme_policy,
  6150. info->extack);
  6151. if (err)
  6152. return err;
  6153. if (tb[NL80211_STA_WME_UAPSD_QUEUES])
  6154. params->uapsd_queues = nla_get_u8(
  6155. tb[NL80211_STA_WME_UAPSD_QUEUES]);
  6156. if (params->uapsd_queues & ~IEEE80211_WMM_IE_STA_QOSINFO_AC_MASK)
  6157. return -EINVAL;
  6158. if (tb[NL80211_STA_WME_MAX_SP])
  6159. params->max_sp = nla_get_u8(tb[NL80211_STA_WME_MAX_SP]);
  6160. if (params->max_sp & ~IEEE80211_WMM_IE_STA_QOSINFO_SP_MASK)
  6161. return -EINVAL;
  6162. params->sta_modify_mask |= STATION_PARAM_APPLY_UAPSD;
  6163. return 0;
  6164. }
  6165. static int nl80211_parse_sta_channel_info(struct genl_info *info,
  6166. struct station_parameters *params)
  6167. {
  6168. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]) {
  6169. params->supported_channels =
  6170. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
  6171. params->supported_channels_len =
  6172. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_CHANNELS]);
  6173. /*
  6174. * Need to include at least one (first channel, number of
  6175. * channels) tuple for each subband (checked in policy),
  6176. * and must have proper tuples for the rest of the data as well.
  6177. */
  6178. if (params->supported_channels_len % 2)
  6179. return -EINVAL;
  6180. }
  6181. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]) {
  6182. params->supported_oper_classes =
  6183. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
  6184. params->supported_oper_classes_len =
  6185. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_OPER_CLASSES]);
  6186. }
  6187. return 0;
  6188. }
  6189. static int nl80211_set_station_tdls(struct genl_info *info,
  6190. struct station_parameters *params)
  6191. {
  6192. int err;
  6193. /* Dummy STA entry gets updated once the peer capabilities are known */
  6194. if (info->attrs[NL80211_ATTR_PEER_AID])
  6195. params->aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
  6196. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  6197. params->link_sta_params.ht_capa =
  6198. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  6199. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  6200. params->link_sta_params.vht_capa =
  6201. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  6202. if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
  6203. params->link_sta_params.he_capa =
  6204. nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  6205. params->link_sta_params.he_capa_len =
  6206. nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  6207. if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
  6208. params->link_sta_params.eht_capa =
  6209. nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  6210. params->link_sta_params.eht_capa_len =
  6211. nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  6212. if (!ieee80211_eht_capa_size_ok((const u8 *)params->link_sta_params.he_capa,
  6213. (const u8 *)params->link_sta_params.eht_capa,
  6214. params->link_sta_params.eht_capa_len,
  6215. false))
  6216. return -EINVAL;
  6217. }
  6218. }
  6219. err = nl80211_parse_sta_channel_info(info, params);
  6220. if (err)
  6221. return err;
  6222. return nl80211_parse_sta_wme(info, params);
  6223. }
  6224. static int nl80211_parse_sta_txpower_setting(struct genl_info *info,
  6225. struct sta_txpwr *txpwr,
  6226. bool *txpwr_set)
  6227. {
  6228. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6229. int idx;
  6230. if (info->attrs[NL80211_ATTR_STA_TX_POWER_SETTING]) {
  6231. if (!rdev->ops->set_tx_power ||
  6232. !wiphy_ext_feature_isset(&rdev->wiphy,
  6233. NL80211_EXT_FEATURE_STA_TX_PWR))
  6234. return -EOPNOTSUPP;
  6235. idx = NL80211_ATTR_STA_TX_POWER_SETTING;
  6236. txpwr->type = nla_get_u8(info->attrs[idx]);
  6237. if (txpwr->type == NL80211_TX_POWER_LIMITED) {
  6238. idx = NL80211_ATTR_STA_TX_POWER;
  6239. if (info->attrs[idx])
  6240. txpwr->power = nla_get_s16(info->attrs[idx]);
  6241. else
  6242. return -EINVAL;
  6243. }
  6244. *txpwr_set = true;
  6245. } else {
  6246. *txpwr_set = false;
  6247. }
  6248. return 0;
  6249. }
  6250. static int nl80211_set_station(struct sk_buff *skb, struct genl_info *info)
  6251. {
  6252. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6253. struct net_device *dev = info->user_ptr[1];
  6254. struct station_parameters params;
  6255. u8 *mac_addr;
  6256. int err;
  6257. memset(&params, 0, sizeof(params));
  6258. if (!rdev->ops->change_station)
  6259. return -EOPNOTSUPP;
  6260. /*
  6261. * AID and listen_interval properties can be set only for unassociated
  6262. * station. Include these parameters here and will check them in
  6263. * cfg80211_check_station_change().
  6264. */
  6265. if (info->attrs[NL80211_ATTR_STA_AID])
  6266. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
  6267. if (info->attrs[NL80211_ATTR_VLAN_ID])
  6268. params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
  6269. if (info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  6270. params.listen_interval =
  6271. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  6272. else
  6273. params.listen_interval = -1;
  6274. if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS])
  6275. params.support_p2p_ps =
  6276. nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
  6277. else
  6278. params.support_p2p_ps = -1;
  6279. if (!info->attrs[NL80211_ATTR_MAC])
  6280. return -EINVAL;
  6281. params.link_sta_params.link_id =
  6282. nl80211_link_id_or_invalid(info->attrs);
  6283. if (info->attrs[NL80211_ATTR_MLD_ADDR]) {
  6284. /* If MLD_ADDR attribute is set then this is an MLD station
  6285. * and the MLD_ADDR attribute holds the MLD address and the
  6286. * MAC attribute holds for the LINK address.
  6287. * In that case, the link_id is also expected to be valid.
  6288. */
  6289. if (params.link_sta_params.link_id < 0)
  6290. return -EINVAL;
  6291. mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  6292. params.link_sta_params.mld_mac = mac_addr;
  6293. params.link_sta_params.link_mac =
  6294. nla_data(info->attrs[NL80211_ATTR_MAC]);
  6295. if (!is_valid_ether_addr(params.link_sta_params.link_mac))
  6296. return -EINVAL;
  6297. } else {
  6298. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6299. }
  6300. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
  6301. params.link_sta_params.supported_rates =
  6302. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  6303. params.link_sta_params.supported_rates_len =
  6304. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  6305. }
  6306. if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
  6307. params.capability =
  6308. nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
  6309. params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
  6310. }
  6311. if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
  6312. params.ext_capab =
  6313. nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  6314. params.ext_capab_len =
  6315. nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  6316. }
  6317. if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
  6318. return -EINVAL;
  6319. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
  6320. params.plink_action =
  6321. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  6322. if (info->attrs[NL80211_ATTR_STA_PLINK_STATE]) {
  6323. params.plink_state =
  6324. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_STATE]);
  6325. if (info->attrs[NL80211_ATTR_MESH_PEER_AID])
  6326. params.peer_aid = nla_get_u16(
  6327. info->attrs[NL80211_ATTR_MESH_PEER_AID]);
  6328. params.sta_modify_mask |= STATION_PARAM_APPLY_PLINK_STATE;
  6329. }
  6330. if (info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE])
  6331. params.local_pm = nla_get_u32(
  6332. info->attrs[NL80211_ATTR_LOCAL_MESH_POWER_MODE]);
  6333. if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
  6334. params.link_sta_params.opmode_notif_used = true;
  6335. params.link_sta_params.opmode_notif =
  6336. nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
  6337. }
  6338. if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
  6339. params.link_sta_params.he_6ghz_capa =
  6340. nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
  6341. if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
  6342. params.airtime_weight =
  6343. nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
  6344. if (params.airtime_weight &&
  6345. !wiphy_ext_feature_isset(&rdev->wiphy,
  6346. NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
  6347. return -EOPNOTSUPP;
  6348. err = nl80211_parse_sta_txpower_setting(info,
  6349. &params.link_sta_params.txpwr,
  6350. &params.link_sta_params.txpwr_set);
  6351. if (err)
  6352. return err;
  6353. /* Include parameters for TDLS peer (will check later) */
  6354. err = nl80211_set_station_tdls(info, &params);
  6355. if (err)
  6356. return err;
  6357. params.vlan = get_vlan(info, rdev);
  6358. if (IS_ERR(params.vlan))
  6359. return PTR_ERR(params.vlan);
  6360. switch (dev->ieee80211_ptr->iftype) {
  6361. case NL80211_IFTYPE_AP:
  6362. case NL80211_IFTYPE_AP_VLAN:
  6363. case NL80211_IFTYPE_P2P_GO:
  6364. case NL80211_IFTYPE_P2P_CLIENT:
  6365. case NL80211_IFTYPE_STATION:
  6366. case NL80211_IFTYPE_ADHOC:
  6367. case NL80211_IFTYPE_MESH_POINT:
  6368. break;
  6369. default:
  6370. err = -EOPNOTSUPP;
  6371. goto out_put_vlan;
  6372. }
  6373. /* driver will call cfg80211_check_station_change() */
  6374. err = rdev_change_station(rdev, dev, mac_addr, &params);
  6375. out_put_vlan:
  6376. dev_put(params.vlan);
  6377. return err;
  6378. }
  6379. static int nl80211_new_station(struct sk_buff *skb, struct genl_info *info)
  6380. {
  6381. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6382. int err;
  6383. struct net_device *dev = info->user_ptr[1];
  6384. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6385. struct station_parameters params;
  6386. u8 *mac_addr = NULL;
  6387. u32 auth_assoc = BIT(NL80211_STA_FLAG_AUTHENTICATED) |
  6388. BIT(NL80211_STA_FLAG_ASSOCIATED);
  6389. memset(&params, 0, sizeof(params));
  6390. if (!rdev->ops->add_station)
  6391. return -EOPNOTSUPP;
  6392. if (!info->attrs[NL80211_ATTR_MAC])
  6393. return -EINVAL;
  6394. if (!info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL])
  6395. return -EINVAL;
  6396. if (!info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
  6397. return -EINVAL;
  6398. if (!info->attrs[NL80211_ATTR_STA_AID] &&
  6399. !info->attrs[NL80211_ATTR_PEER_AID])
  6400. return -EINVAL;
  6401. params.link_sta_params.link_id =
  6402. nl80211_link_id_or_invalid(info->attrs);
  6403. if (info->attrs[NL80211_ATTR_MLD_ADDR]) {
  6404. mac_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  6405. params.link_sta_params.mld_mac = mac_addr;
  6406. params.link_sta_params.link_mac =
  6407. nla_data(info->attrs[NL80211_ATTR_MAC]);
  6408. if (!is_valid_ether_addr(params.link_sta_params.link_mac))
  6409. return -EINVAL;
  6410. } else {
  6411. mac_addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6412. }
  6413. params.link_sta_params.supported_rates =
  6414. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  6415. params.link_sta_params.supported_rates_len =
  6416. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  6417. params.listen_interval =
  6418. nla_get_u16(info->attrs[NL80211_ATTR_STA_LISTEN_INTERVAL]);
  6419. if (info->attrs[NL80211_ATTR_VLAN_ID])
  6420. params.vlan_id = nla_get_u16(info->attrs[NL80211_ATTR_VLAN_ID]);
  6421. if (info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]) {
  6422. params.support_p2p_ps =
  6423. nla_get_u8(info->attrs[NL80211_ATTR_STA_SUPPORT_P2P_PS]);
  6424. } else {
  6425. /*
  6426. * if not specified, assume it's supported for P2P GO interface,
  6427. * and is NOT supported for AP interface
  6428. */
  6429. params.support_p2p_ps =
  6430. dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO;
  6431. }
  6432. if (info->attrs[NL80211_ATTR_PEER_AID])
  6433. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_PEER_AID]);
  6434. else
  6435. params.aid = nla_get_u16(info->attrs[NL80211_ATTR_STA_AID]);
  6436. if (info->attrs[NL80211_ATTR_STA_CAPABILITY]) {
  6437. params.capability =
  6438. nla_get_u16(info->attrs[NL80211_ATTR_STA_CAPABILITY]);
  6439. params.sta_modify_mask |= STATION_PARAM_APPLY_CAPABILITY;
  6440. }
  6441. if (info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]) {
  6442. params.ext_capab =
  6443. nla_data(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  6444. params.ext_capab_len =
  6445. nla_len(info->attrs[NL80211_ATTR_STA_EXT_CAPABILITY]);
  6446. }
  6447. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  6448. params.link_sta_params.ht_capa =
  6449. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  6450. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  6451. params.link_sta_params.vht_capa =
  6452. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  6453. if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
  6454. params.link_sta_params.he_capa =
  6455. nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  6456. params.link_sta_params.he_capa_len =
  6457. nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  6458. if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
  6459. params.link_sta_params.eht_capa =
  6460. nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  6461. params.link_sta_params.eht_capa_len =
  6462. nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  6463. if (!ieee80211_eht_capa_size_ok((const u8 *)params.link_sta_params.he_capa,
  6464. (const u8 *)params.link_sta_params.eht_capa,
  6465. params.link_sta_params.eht_capa_len,
  6466. false))
  6467. return -EINVAL;
  6468. }
  6469. }
  6470. if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
  6471. params.link_sta_params.he_6ghz_capa =
  6472. nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
  6473. if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
  6474. params.link_sta_params.opmode_notif_used = true;
  6475. params.link_sta_params.opmode_notif =
  6476. nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
  6477. }
  6478. if (info->attrs[NL80211_ATTR_STA_PLINK_ACTION])
  6479. params.plink_action =
  6480. nla_get_u8(info->attrs[NL80211_ATTR_STA_PLINK_ACTION]);
  6481. if (info->attrs[NL80211_ATTR_AIRTIME_WEIGHT])
  6482. params.airtime_weight =
  6483. nla_get_u16(info->attrs[NL80211_ATTR_AIRTIME_WEIGHT]);
  6484. if (params.airtime_weight &&
  6485. !wiphy_ext_feature_isset(&rdev->wiphy,
  6486. NL80211_EXT_FEATURE_AIRTIME_FAIRNESS))
  6487. return -EOPNOTSUPP;
  6488. err = nl80211_parse_sta_txpower_setting(info,
  6489. &params.link_sta_params.txpwr,
  6490. &params.link_sta_params.txpwr_set);
  6491. if (err)
  6492. return err;
  6493. err = nl80211_parse_sta_channel_info(info, &params);
  6494. if (err)
  6495. return err;
  6496. err = nl80211_parse_sta_wme(info, &params);
  6497. if (err)
  6498. return err;
  6499. if (parse_station_flags(info, dev->ieee80211_ptr->iftype, &params))
  6500. return -EINVAL;
  6501. /* HT/VHT requires QoS, but if we don't have that just ignore HT/VHT
  6502. * as userspace might just pass through the capabilities from the IEs
  6503. * directly, rather than enforcing this restriction and returning an
  6504. * error in this case.
  6505. */
  6506. if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME))) {
  6507. params.link_sta_params.ht_capa = NULL;
  6508. params.link_sta_params.vht_capa = NULL;
  6509. /* HE and EHT require WME */
  6510. if (params.link_sta_params.he_capa_len ||
  6511. params.link_sta_params.he_6ghz_capa ||
  6512. params.link_sta_params.eht_capa_len)
  6513. return -EINVAL;
  6514. }
  6515. /* Ensure that HT/VHT capabilities are not set for 6 GHz HE STA */
  6516. if (params.link_sta_params.he_6ghz_capa &&
  6517. (params.link_sta_params.ht_capa || params.link_sta_params.vht_capa))
  6518. return -EINVAL;
  6519. /* When you run into this, adjust the code below for the new flag */
  6520. BUILD_BUG_ON(NL80211_STA_FLAG_MAX != 8);
  6521. switch (dev->ieee80211_ptr->iftype) {
  6522. case NL80211_IFTYPE_AP:
  6523. case NL80211_IFTYPE_AP_VLAN:
  6524. case NL80211_IFTYPE_P2P_GO:
  6525. /* ignore WME attributes if iface/sta is not capable */
  6526. if (!(rdev->wiphy.flags & WIPHY_FLAG_AP_UAPSD) ||
  6527. !(params.sta_flags_set & BIT(NL80211_STA_FLAG_WME)))
  6528. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  6529. /* TDLS peers cannot be added */
  6530. if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
  6531. info->attrs[NL80211_ATTR_PEER_AID])
  6532. return -EINVAL;
  6533. /* but don't bother the driver with it */
  6534. params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_TDLS_PEER);
  6535. /* allow authenticated/associated only if driver handles it */
  6536. if (!(rdev->wiphy.features &
  6537. NL80211_FEATURE_FULL_AP_CLIENT_STATE) &&
  6538. params.sta_flags_mask & auth_assoc)
  6539. return -EINVAL;
  6540. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  6541. NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT) &&
  6542. params.sta_flags_mask & BIT(NL80211_STA_FLAG_SPP_AMSDU))
  6543. return -EINVAL;
  6544. /* Older userspace, or userspace wanting to be compatible with
  6545. * !NL80211_FEATURE_FULL_AP_CLIENT_STATE, will not set the auth
  6546. * and assoc flags in the mask, but assumes the station will be
  6547. * added as associated anyway since this was the required driver
  6548. * behaviour before NL80211_FEATURE_FULL_AP_CLIENT_STATE was
  6549. * introduced.
  6550. * In order to not bother drivers with this quirk in the API
  6551. * set the flags in both the mask and set for new stations in
  6552. * this case.
  6553. */
  6554. if (!(params.sta_flags_mask & auth_assoc)) {
  6555. params.sta_flags_mask |= auth_assoc;
  6556. params.sta_flags_set |= auth_assoc;
  6557. }
  6558. /* must be last in here for error handling */
  6559. params.vlan = get_vlan(info, rdev);
  6560. if (IS_ERR(params.vlan))
  6561. return PTR_ERR(params.vlan);
  6562. break;
  6563. case NL80211_IFTYPE_MESH_POINT:
  6564. /* ignore uAPSD data */
  6565. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  6566. /* associated is disallowed */
  6567. if (params.sta_flags_mask & BIT(NL80211_STA_FLAG_ASSOCIATED))
  6568. return -EINVAL;
  6569. /* TDLS peers cannot be added */
  6570. if ((params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) ||
  6571. info->attrs[NL80211_ATTR_PEER_AID])
  6572. return -EINVAL;
  6573. break;
  6574. case NL80211_IFTYPE_STATION:
  6575. case NL80211_IFTYPE_P2P_CLIENT:
  6576. /* ignore uAPSD data */
  6577. params.sta_modify_mask &= ~STATION_PARAM_APPLY_UAPSD;
  6578. /* these are disallowed */
  6579. if (params.sta_flags_mask &
  6580. (BIT(NL80211_STA_FLAG_ASSOCIATED) |
  6581. BIT(NL80211_STA_FLAG_AUTHENTICATED)))
  6582. return -EINVAL;
  6583. /* Only TDLS peers can be added */
  6584. if (!(params.sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)))
  6585. return -EINVAL;
  6586. /* Can only add if TDLS ... */
  6587. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS))
  6588. return -EOPNOTSUPP;
  6589. /* ... with external setup is supported */
  6590. if (!(rdev->wiphy.flags & WIPHY_FLAG_TDLS_EXTERNAL_SETUP))
  6591. return -EOPNOTSUPP;
  6592. /*
  6593. * Older wpa_supplicant versions always mark the TDLS peer
  6594. * as authorized, but it shouldn't yet be.
  6595. */
  6596. params.sta_flags_mask &= ~BIT(NL80211_STA_FLAG_AUTHORIZED);
  6597. break;
  6598. default:
  6599. return -EOPNOTSUPP;
  6600. }
  6601. /* be aware of params.vlan when changing code here */
  6602. if (wdev->valid_links) {
  6603. if (params.link_sta_params.link_id < 0) {
  6604. err = -EINVAL;
  6605. goto out;
  6606. }
  6607. if (!(wdev->valid_links & BIT(params.link_sta_params.link_id))) {
  6608. err = -ENOLINK;
  6609. goto out;
  6610. }
  6611. } else {
  6612. if (params.link_sta_params.link_id >= 0) {
  6613. err = -EINVAL;
  6614. goto out;
  6615. }
  6616. }
  6617. err = rdev_add_station(rdev, dev, mac_addr, &params);
  6618. out:
  6619. dev_put(params.vlan);
  6620. return err;
  6621. }
  6622. static int nl80211_del_station(struct sk_buff *skb, struct genl_info *info)
  6623. {
  6624. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6625. struct net_device *dev = info->user_ptr[1];
  6626. struct wireless_dev *wdev = dev->ieee80211_ptr;
  6627. struct station_del_parameters params;
  6628. int link_id = nl80211_link_id_or_invalid(info->attrs);
  6629. memset(&params, 0, sizeof(params));
  6630. if (info->attrs[NL80211_ATTR_MAC])
  6631. params.mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6632. switch (wdev->iftype) {
  6633. case NL80211_IFTYPE_AP:
  6634. case NL80211_IFTYPE_AP_VLAN:
  6635. case NL80211_IFTYPE_MESH_POINT:
  6636. case NL80211_IFTYPE_P2P_GO:
  6637. /* always accept these */
  6638. break;
  6639. case NL80211_IFTYPE_ADHOC:
  6640. /* conditionally accept */
  6641. if (wiphy_ext_feature_isset(&rdev->wiphy,
  6642. NL80211_EXT_FEATURE_DEL_IBSS_STA))
  6643. break;
  6644. return -EINVAL;
  6645. default:
  6646. return -EINVAL;
  6647. }
  6648. if (!rdev->ops->del_station)
  6649. return -EOPNOTSUPP;
  6650. if (info->attrs[NL80211_ATTR_MGMT_SUBTYPE]) {
  6651. params.subtype =
  6652. nla_get_u8(info->attrs[NL80211_ATTR_MGMT_SUBTYPE]);
  6653. if (params.subtype != IEEE80211_STYPE_DISASSOC >> 4 &&
  6654. params.subtype != IEEE80211_STYPE_DEAUTH >> 4)
  6655. return -EINVAL;
  6656. } else {
  6657. /* Default to Deauthentication frame */
  6658. params.subtype = IEEE80211_STYPE_DEAUTH >> 4;
  6659. }
  6660. if (info->attrs[NL80211_ATTR_REASON_CODE]) {
  6661. params.reason_code =
  6662. nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  6663. if (params.reason_code == 0)
  6664. return -EINVAL; /* 0 is reserved */
  6665. } else {
  6666. /* Default to reason code 2 */
  6667. params.reason_code = WLAN_REASON_PREV_AUTH_NOT_VALID;
  6668. }
  6669. /* Link ID not expected in case of non-ML operation */
  6670. if (!wdev->valid_links && link_id != -1)
  6671. return -EINVAL;
  6672. /* If given, a valid link ID should be passed during MLO */
  6673. if (wdev->valid_links && link_id >= 0 &&
  6674. !(wdev->valid_links & BIT(link_id)))
  6675. return -EINVAL;
  6676. params.link_id = link_id;
  6677. return rdev_del_station(rdev, dev, &params);
  6678. }
  6679. static int nl80211_send_mpath(struct sk_buff *msg, u32 portid, u32 seq,
  6680. int flags, struct net_device *dev,
  6681. u8 *dst, u8 *next_hop,
  6682. struct mpath_info *pinfo)
  6683. {
  6684. void *hdr;
  6685. struct nlattr *pinfoattr;
  6686. hdr = nl80211hdr_put(msg, portid, seq, flags, NL80211_CMD_NEW_MPATH);
  6687. if (!hdr)
  6688. return -1;
  6689. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  6690. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, dst) ||
  6691. nla_put(msg, NL80211_ATTR_MPATH_NEXT_HOP, ETH_ALEN, next_hop) ||
  6692. nla_put_u32(msg, NL80211_ATTR_GENERATION, pinfo->generation))
  6693. goto nla_put_failure;
  6694. pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MPATH_INFO);
  6695. if (!pinfoattr)
  6696. goto nla_put_failure;
  6697. if ((pinfo->filled & MPATH_INFO_FRAME_QLEN) &&
  6698. nla_put_u32(msg, NL80211_MPATH_INFO_FRAME_QLEN,
  6699. pinfo->frame_qlen))
  6700. goto nla_put_failure;
  6701. if (((pinfo->filled & MPATH_INFO_SN) &&
  6702. nla_put_u32(msg, NL80211_MPATH_INFO_SN, pinfo->sn)) ||
  6703. ((pinfo->filled & MPATH_INFO_METRIC) &&
  6704. nla_put_u32(msg, NL80211_MPATH_INFO_METRIC,
  6705. pinfo->metric)) ||
  6706. ((pinfo->filled & MPATH_INFO_EXPTIME) &&
  6707. nla_put_u32(msg, NL80211_MPATH_INFO_EXPTIME,
  6708. pinfo->exptime)) ||
  6709. ((pinfo->filled & MPATH_INFO_FLAGS) &&
  6710. nla_put_u8(msg, NL80211_MPATH_INFO_FLAGS,
  6711. pinfo->flags)) ||
  6712. ((pinfo->filled & MPATH_INFO_DISCOVERY_TIMEOUT) &&
  6713. nla_put_u32(msg, NL80211_MPATH_INFO_DISCOVERY_TIMEOUT,
  6714. pinfo->discovery_timeout)) ||
  6715. ((pinfo->filled & MPATH_INFO_DISCOVERY_RETRIES) &&
  6716. nla_put_u8(msg, NL80211_MPATH_INFO_DISCOVERY_RETRIES,
  6717. pinfo->discovery_retries)) ||
  6718. ((pinfo->filled & MPATH_INFO_HOP_COUNT) &&
  6719. nla_put_u8(msg, NL80211_MPATH_INFO_HOP_COUNT,
  6720. pinfo->hop_count)) ||
  6721. ((pinfo->filled & MPATH_INFO_PATH_CHANGE) &&
  6722. nla_put_u32(msg, NL80211_MPATH_INFO_PATH_CHANGE,
  6723. pinfo->path_change_count)))
  6724. goto nla_put_failure;
  6725. nla_nest_end(msg, pinfoattr);
  6726. genlmsg_end(msg, hdr);
  6727. return 0;
  6728. nla_put_failure:
  6729. genlmsg_cancel(msg, hdr);
  6730. return -EMSGSIZE;
  6731. }
  6732. static int nl80211_dump_mpath(struct sk_buff *skb,
  6733. struct netlink_callback *cb)
  6734. {
  6735. struct mpath_info pinfo;
  6736. struct cfg80211_registered_device *rdev;
  6737. struct wireless_dev *wdev;
  6738. u8 dst[ETH_ALEN];
  6739. u8 next_hop[ETH_ALEN];
  6740. int path_idx = cb->args[2];
  6741. int err;
  6742. err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
  6743. if (err)
  6744. return err;
  6745. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  6746. __acquire(&rdev->wiphy.mtx);
  6747. if (!rdev->ops->dump_mpath) {
  6748. err = -EOPNOTSUPP;
  6749. goto out_err;
  6750. }
  6751. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
  6752. err = -EOPNOTSUPP;
  6753. goto out_err;
  6754. }
  6755. while (1) {
  6756. err = rdev_dump_mpath(rdev, wdev->netdev, path_idx, dst,
  6757. next_hop, &pinfo);
  6758. if (err == -ENOENT)
  6759. break;
  6760. if (err)
  6761. goto out_err;
  6762. if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
  6763. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  6764. wdev->netdev, dst, next_hop,
  6765. &pinfo) < 0)
  6766. goto out;
  6767. path_idx++;
  6768. }
  6769. out:
  6770. cb->args[2] = path_idx;
  6771. err = skb->len;
  6772. out_err:
  6773. wiphy_unlock(&rdev->wiphy);
  6774. return err;
  6775. }
  6776. static int nl80211_get_mpath(struct sk_buff *skb, struct genl_info *info)
  6777. {
  6778. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6779. int err;
  6780. struct net_device *dev = info->user_ptr[1];
  6781. struct mpath_info pinfo;
  6782. struct sk_buff *msg;
  6783. u8 *dst = NULL;
  6784. u8 next_hop[ETH_ALEN];
  6785. memset(&pinfo, 0, sizeof(pinfo));
  6786. if (!info->attrs[NL80211_ATTR_MAC])
  6787. return -EINVAL;
  6788. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6789. if (!rdev->ops->get_mpath)
  6790. return -EOPNOTSUPP;
  6791. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6792. return -EOPNOTSUPP;
  6793. err = rdev_get_mpath(rdev, dev, dst, next_hop, &pinfo);
  6794. if (err)
  6795. return err;
  6796. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6797. if (!msg)
  6798. return -ENOMEM;
  6799. if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
  6800. dev, dst, next_hop, &pinfo) < 0) {
  6801. nlmsg_free(msg);
  6802. return -ENOBUFS;
  6803. }
  6804. return genlmsg_reply(msg, info);
  6805. }
  6806. static int nl80211_set_mpath(struct sk_buff *skb, struct genl_info *info)
  6807. {
  6808. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6809. struct net_device *dev = info->user_ptr[1];
  6810. u8 *dst = NULL;
  6811. u8 *next_hop = NULL;
  6812. if (!info->attrs[NL80211_ATTR_MAC])
  6813. return -EINVAL;
  6814. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  6815. return -EINVAL;
  6816. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6817. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  6818. if (!rdev->ops->change_mpath)
  6819. return -EOPNOTSUPP;
  6820. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6821. return -EOPNOTSUPP;
  6822. return rdev_change_mpath(rdev, dev, dst, next_hop);
  6823. }
  6824. static int nl80211_new_mpath(struct sk_buff *skb, struct genl_info *info)
  6825. {
  6826. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6827. struct net_device *dev = info->user_ptr[1];
  6828. u8 *dst = NULL;
  6829. u8 *next_hop = NULL;
  6830. if (!info->attrs[NL80211_ATTR_MAC])
  6831. return -EINVAL;
  6832. if (!info->attrs[NL80211_ATTR_MPATH_NEXT_HOP])
  6833. return -EINVAL;
  6834. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6835. next_hop = nla_data(info->attrs[NL80211_ATTR_MPATH_NEXT_HOP]);
  6836. if (!rdev->ops->add_mpath)
  6837. return -EOPNOTSUPP;
  6838. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6839. return -EOPNOTSUPP;
  6840. return rdev_add_mpath(rdev, dev, dst, next_hop);
  6841. }
  6842. static int nl80211_del_mpath(struct sk_buff *skb, struct genl_info *info)
  6843. {
  6844. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6845. struct net_device *dev = info->user_ptr[1];
  6846. u8 *dst = NULL;
  6847. if (info->attrs[NL80211_ATTR_MAC])
  6848. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6849. if (!rdev->ops->del_mpath)
  6850. return -EOPNOTSUPP;
  6851. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6852. return -EOPNOTSUPP;
  6853. return rdev_del_mpath(rdev, dev, dst);
  6854. }
  6855. static int nl80211_get_mpp(struct sk_buff *skb, struct genl_info *info)
  6856. {
  6857. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6858. int err;
  6859. struct net_device *dev = info->user_ptr[1];
  6860. struct mpath_info pinfo;
  6861. struct sk_buff *msg;
  6862. u8 *dst = NULL;
  6863. u8 mpp[ETH_ALEN];
  6864. memset(&pinfo, 0, sizeof(pinfo));
  6865. if (!info->attrs[NL80211_ATTR_MAC])
  6866. return -EINVAL;
  6867. dst = nla_data(info->attrs[NL80211_ATTR_MAC]);
  6868. if (!rdev->ops->get_mpp)
  6869. return -EOPNOTSUPP;
  6870. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT)
  6871. return -EOPNOTSUPP;
  6872. err = rdev_get_mpp(rdev, dev, dst, mpp, &pinfo);
  6873. if (err)
  6874. return err;
  6875. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  6876. if (!msg)
  6877. return -ENOMEM;
  6878. if (nl80211_send_mpath(msg, info->snd_portid, info->snd_seq, 0,
  6879. dev, dst, mpp, &pinfo) < 0) {
  6880. nlmsg_free(msg);
  6881. return -ENOBUFS;
  6882. }
  6883. return genlmsg_reply(msg, info);
  6884. }
  6885. static int nl80211_dump_mpp(struct sk_buff *skb,
  6886. struct netlink_callback *cb)
  6887. {
  6888. struct mpath_info pinfo;
  6889. struct cfg80211_registered_device *rdev;
  6890. struct wireless_dev *wdev;
  6891. u8 dst[ETH_ALEN];
  6892. u8 mpp[ETH_ALEN];
  6893. int path_idx = cb->args[2];
  6894. int err;
  6895. err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, NULL);
  6896. if (err)
  6897. return err;
  6898. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  6899. __acquire(&rdev->wiphy.mtx);
  6900. if (!rdev->ops->dump_mpp) {
  6901. err = -EOPNOTSUPP;
  6902. goto out_err;
  6903. }
  6904. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT) {
  6905. err = -EOPNOTSUPP;
  6906. goto out_err;
  6907. }
  6908. while (1) {
  6909. err = rdev_dump_mpp(rdev, wdev->netdev, path_idx, dst,
  6910. mpp, &pinfo);
  6911. if (err == -ENOENT)
  6912. break;
  6913. if (err)
  6914. goto out_err;
  6915. if (nl80211_send_mpath(skb, NETLINK_CB(cb->skb).portid,
  6916. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  6917. wdev->netdev, dst, mpp,
  6918. &pinfo) < 0)
  6919. goto out;
  6920. path_idx++;
  6921. }
  6922. out:
  6923. cb->args[2] = path_idx;
  6924. err = skb->len;
  6925. out_err:
  6926. wiphy_unlock(&rdev->wiphy);
  6927. return err;
  6928. }
  6929. static int nl80211_set_bss(struct sk_buff *skb, struct genl_info *info)
  6930. {
  6931. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  6932. struct net_device *dev = info->user_ptr[1];
  6933. struct bss_parameters params;
  6934. memset(&params, 0, sizeof(params));
  6935. params.link_id = nl80211_link_id_or_invalid(info->attrs);
  6936. /* default to not changing parameters */
  6937. params.use_cts_prot = -1;
  6938. params.use_short_preamble = -1;
  6939. params.use_short_slot_time = -1;
  6940. params.ap_isolate = -1;
  6941. params.ht_opmode = -1;
  6942. params.p2p_ctwindow = -1;
  6943. params.p2p_opp_ps = -1;
  6944. if (info->attrs[NL80211_ATTR_BSS_CTS_PROT])
  6945. params.use_cts_prot =
  6946. nla_get_u8(info->attrs[NL80211_ATTR_BSS_CTS_PROT]);
  6947. if (info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE])
  6948. params.use_short_preamble =
  6949. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_PREAMBLE]);
  6950. if (info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME])
  6951. params.use_short_slot_time =
  6952. nla_get_u8(info->attrs[NL80211_ATTR_BSS_SHORT_SLOT_TIME]);
  6953. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  6954. params.basic_rates =
  6955. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  6956. params.basic_rates_len =
  6957. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  6958. }
  6959. if (info->attrs[NL80211_ATTR_AP_ISOLATE])
  6960. params.ap_isolate = !!nla_get_u8(info->attrs[NL80211_ATTR_AP_ISOLATE]);
  6961. if (info->attrs[NL80211_ATTR_BSS_HT_OPMODE])
  6962. params.ht_opmode =
  6963. nla_get_u16(info->attrs[NL80211_ATTR_BSS_HT_OPMODE]);
  6964. if (info->attrs[NL80211_ATTR_P2P_CTWINDOW]) {
  6965. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  6966. return -EINVAL;
  6967. params.p2p_ctwindow =
  6968. nla_get_u8(info->attrs[NL80211_ATTR_P2P_CTWINDOW]);
  6969. if (params.p2p_ctwindow != 0 &&
  6970. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_CTWIN))
  6971. return -EINVAL;
  6972. }
  6973. if (info->attrs[NL80211_ATTR_P2P_OPPPS]) {
  6974. u8 tmp;
  6975. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  6976. return -EINVAL;
  6977. tmp = nla_get_u8(info->attrs[NL80211_ATTR_P2P_OPPPS]);
  6978. params.p2p_opp_ps = tmp;
  6979. if (params.p2p_opp_ps &&
  6980. !(rdev->wiphy.features & NL80211_FEATURE_P2P_GO_OPPPS))
  6981. return -EINVAL;
  6982. }
  6983. if (!rdev->ops->change_bss)
  6984. return -EOPNOTSUPP;
  6985. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  6986. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  6987. return -EOPNOTSUPP;
  6988. return rdev_change_bss(rdev, dev, &params);
  6989. }
  6990. static int nl80211_req_set_reg(struct sk_buff *skb, struct genl_info *info)
  6991. {
  6992. char *data = NULL;
  6993. bool is_indoor;
  6994. enum nl80211_user_reg_hint_type user_reg_hint_type;
  6995. u32 owner_nlportid;
  6996. /*
  6997. * You should only get this when cfg80211 hasn't yet initialized
  6998. * completely when built-in to the kernel right between the time
  6999. * window between nl80211_init() and regulatory_init(), if that is
  7000. * even possible.
  7001. */
  7002. if (unlikely(!rcu_access_pointer(cfg80211_regdomain)))
  7003. return -EINPROGRESS;
  7004. if (info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE])
  7005. user_reg_hint_type =
  7006. nla_get_u32(info->attrs[NL80211_ATTR_USER_REG_HINT_TYPE]);
  7007. else
  7008. user_reg_hint_type = NL80211_USER_REG_HINT_USER;
  7009. switch (user_reg_hint_type) {
  7010. case NL80211_USER_REG_HINT_USER:
  7011. case NL80211_USER_REG_HINT_CELL_BASE:
  7012. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  7013. return -EINVAL;
  7014. data = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  7015. return regulatory_hint_user(data, user_reg_hint_type);
  7016. case NL80211_USER_REG_HINT_INDOOR:
  7017. if (info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  7018. owner_nlportid = info->snd_portid;
  7019. is_indoor = !!info->attrs[NL80211_ATTR_REG_INDOOR];
  7020. } else {
  7021. owner_nlportid = 0;
  7022. is_indoor = true;
  7023. }
  7024. regulatory_hint_indoor(is_indoor, owner_nlportid);
  7025. return 0;
  7026. default:
  7027. return -EINVAL;
  7028. }
  7029. }
  7030. static int nl80211_reload_regdb(struct sk_buff *skb, struct genl_info *info)
  7031. {
  7032. return reg_reload_regdb();
  7033. }
  7034. static int nl80211_get_mesh_config(struct sk_buff *skb,
  7035. struct genl_info *info)
  7036. {
  7037. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7038. struct net_device *dev = info->user_ptr[1];
  7039. struct wireless_dev *wdev = dev->ieee80211_ptr;
  7040. struct mesh_config cur_params;
  7041. int err = 0;
  7042. void *hdr;
  7043. struct nlattr *pinfoattr;
  7044. struct sk_buff *msg;
  7045. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  7046. return -EOPNOTSUPP;
  7047. if (!rdev->ops->get_mesh_config)
  7048. return -EOPNOTSUPP;
  7049. /* If not connected, get default parameters */
  7050. if (!wdev->u.mesh.id_len)
  7051. memcpy(&cur_params, &default_mesh_config, sizeof(cur_params));
  7052. else
  7053. err = rdev_get_mesh_config(rdev, dev, &cur_params);
  7054. if (err)
  7055. return err;
  7056. /* Draw up a netlink message to send back */
  7057. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7058. if (!msg)
  7059. return -ENOMEM;
  7060. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  7061. NL80211_CMD_GET_MESH_CONFIG);
  7062. if (!hdr)
  7063. goto out;
  7064. pinfoattr = nla_nest_start_noflag(msg, NL80211_ATTR_MESH_CONFIG);
  7065. if (!pinfoattr)
  7066. goto nla_put_failure;
  7067. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  7068. nla_put_u16(msg, NL80211_MESHCONF_RETRY_TIMEOUT,
  7069. cur_params.dot11MeshRetryTimeout) ||
  7070. nla_put_u16(msg, NL80211_MESHCONF_CONFIRM_TIMEOUT,
  7071. cur_params.dot11MeshConfirmTimeout) ||
  7072. nla_put_u16(msg, NL80211_MESHCONF_HOLDING_TIMEOUT,
  7073. cur_params.dot11MeshHoldingTimeout) ||
  7074. nla_put_u16(msg, NL80211_MESHCONF_MAX_PEER_LINKS,
  7075. cur_params.dot11MeshMaxPeerLinks) ||
  7076. nla_put_u8(msg, NL80211_MESHCONF_MAX_RETRIES,
  7077. cur_params.dot11MeshMaxRetries) ||
  7078. nla_put_u8(msg, NL80211_MESHCONF_TTL,
  7079. cur_params.dot11MeshTTL) ||
  7080. nla_put_u8(msg, NL80211_MESHCONF_ELEMENT_TTL,
  7081. cur_params.element_ttl) ||
  7082. nla_put_u8(msg, NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  7083. cur_params.auto_open_plinks) ||
  7084. nla_put_u32(msg, NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
  7085. cur_params.dot11MeshNbrOffsetMaxNeighbor) ||
  7086. nla_put_u8(msg, NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  7087. cur_params.dot11MeshHWMPmaxPREQretries) ||
  7088. nla_put_u32(msg, NL80211_MESHCONF_PATH_REFRESH_TIME,
  7089. cur_params.path_refresh_time) ||
  7090. nla_put_u16(msg, NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  7091. cur_params.min_discovery_timeout) ||
  7092. nla_put_u32(msg, NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  7093. cur_params.dot11MeshHWMPactivePathTimeout) ||
  7094. nla_put_u16(msg, NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  7095. cur_params.dot11MeshHWMPpreqMinInterval) ||
  7096. nla_put_u16(msg, NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
  7097. cur_params.dot11MeshHWMPperrMinInterval) ||
  7098. nla_put_u16(msg, NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  7099. cur_params.dot11MeshHWMPnetDiameterTraversalTime) ||
  7100. nla_put_u8(msg, NL80211_MESHCONF_HWMP_ROOTMODE,
  7101. cur_params.dot11MeshHWMPRootMode) ||
  7102. nla_put_u16(msg, NL80211_MESHCONF_HWMP_RANN_INTERVAL,
  7103. cur_params.dot11MeshHWMPRannInterval) ||
  7104. nla_put_u8(msg, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
  7105. cur_params.dot11MeshGateAnnouncementProtocol) ||
  7106. nla_put_u8(msg, NL80211_MESHCONF_FORWARDING,
  7107. cur_params.dot11MeshForwarding) ||
  7108. nla_put_s32(msg, NL80211_MESHCONF_RSSI_THRESHOLD,
  7109. cur_params.rssi_threshold) ||
  7110. nla_put_u32(msg, NL80211_MESHCONF_HT_OPMODE,
  7111. cur_params.ht_opmode) ||
  7112. nla_put_u32(msg, NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
  7113. cur_params.dot11MeshHWMPactivePathToRootTimeout) ||
  7114. nla_put_u16(msg, NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
  7115. cur_params.dot11MeshHWMProotInterval) ||
  7116. nla_put_u16(msg, NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
  7117. cur_params.dot11MeshHWMPconfirmationInterval) ||
  7118. nla_put_u32(msg, NL80211_MESHCONF_POWER_MODE,
  7119. cur_params.power_mode) ||
  7120. nla_put_u16(msg, NL80211_MESHCONF_AWAKE_WINDOW,
  7121. cur_params.dot11MeshAwakeWindowDuration) ||
  7122. nla_put_u32(msg, NL80211_MESHCONF_PLINK_TIMEOUT,
  7123. cur_params.plink_timeout) ||
  7124. nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_GATE,
  7125. cur_params.dot11MeshConnectedToMeshGate) ||
  7126. nla_put_u8(msg, NL80211_MESHCONF_NOLEARN,
  7127. cur_params.dot11MeshNolearn) ||
  7128. nla_put_u8(msg, NL80211_MESHCONF_CONNECTED_TO_AS,
  7129. cur_params.dot11MeshConnectedToAuthServer))
  7130. goto nla_put_failure;
  7131. nla_nest_end(msg, pinfoattr);
  7132. genlmsg_end(msg, hdr);
  7133. return genlmsg_reply(msg, info);
  7134. nla_put_failure:
  7135. out:
  7136. nlmsg_free(msg);
  7137. return -ENOBUFS;
  7138. }
  7139. static const struct nla_policy
  7140. nl80211_meshconf_params_policy[NL80211_MESHCONF_ATTR_MAX+1] = {
  7141. [NL80211_MESHCONF_RETRY_TIMEOUT] =
  7142. NLA_POLICY_RANGE(NLA_U16, 1, 255),
  7143. [NL80211_MESHCONF_CONFIRM_TIMEOUT] =
  7144. NLA_POLICY_RANGE(NLA_U16, 1, 255),
  7145. [NL80211_MESHCONF_HOLDING_TIMEOUT] =
  7146. NLA_POLICY_RANGE(NLA_U16, 1, 255),
  7147. [NL80211_MESHCONF_MAX_PEER_LINKS] =
  7148. NLA_POLICY_RANGE(NLA_U16, 0, 255),
  7149. [NL80211_MESHCONF_MAX_RETRIES] = NLA_POLICY_MAX(NLA_U8, 16),
  7150. [NL80211_MESHCONF_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
  7151. [NL80211_MESHCONF_ELEMENT_TTL] = NLA_POLICY_MIN(NLA_U8, 1),
  7152. [NL80211_MESHCONF_AUTO_OPEN_PLINKS] = NLA_POLICY_MAX(NLA_U8, 1),
  7153. [NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR] =
  7154. NLA_POLICY_RANGE(NLA_U32, 1, 255),
  7155. [NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES] = { .type = NLA_U8 },
  7156. [NL80211_MESHCONF_PATH_REFRESH_TIME] = { .type = NLA_U32 },
  7157. [NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT] = NLA_POLICY_MIN(NLA_U16, 1),
  7158. [NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT] = { .type = NLA_U32 },
  7159. [NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL] =
  7160. NLA_POLICY_MIN(NLA_U16, 1),
  7161. [NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL] =
  7162. NLA_POLICY_MIN(NLA_U16, 1),
  7163. [NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME] =
  7164. NLA_POLICY_MIN(NLA_U16, 1),
  7165. [NL80211_MESHCONF_HWMP_ROOTMODE] = NLA_POLICY_MAX(NLA_U8, 4),
  7166. [NL80211_MESHCONF_HWMP_RANN_INTERVAL] =
  7167. NLA_POLICY_MIN(NLA_U16, 1),
  7168. [NL80211_MESHCONF_GATE_ANNOUNCEMENTS] = NLA_POLICY_MAX(NLA_U8, 1),
  7169. [NL80211_MESHCONF_FORWARDING] = NLA_POLICY_MAX(NLA_U8, 1),
  7170. [NL80211_MESHCONF_RSSI_THRESHOLD] =
  7171. NLA_POLICY_RANGE(NLA_S32, -255, 0),
  7172. [NL80211_MESHCONF_HT_OPMODE] = { .type = NLA_U16 },
  7173. [NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT] = { .type = NLA_U32 },
  7174. [NL80211_MESHCONF_HWMP_ROOT_INTERVAL] =
  7175. NLA_POLICY_MIN(NLA_U16, 1),
  7176. [NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL] =
  7177. NLA_POLICY_MIN(NLA_U16, 1),
  7178. [NL80211_MESHCONF_POWER_MODE] =
  7179. NLA_POLICY_RANGE(NLA_U32,
  7180. NL80211_MESH_POWER_ACTIVE,
  7181. NL80211_MESH_POWER_MAX),
  7182. [NL80211_MESHCONF_AWAKE_WINDOW] = { .type = NLA_U16 },
  7183. [NL80211_MESHCONF_PLINK_TIMEOUT] = { .type = NLA_U32 },
  7184. [NL80211_MESHCONF_CONNECTED_TO_GATE] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
  7185. [NL80211_MESHCONF_NOLEARN] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
  7186. [NL80211_MESHCONF_CONNECTED_TO_AS] = NLA_POLICY_RANGE(NLA_U8, 0, 1),
  7187. };
  7188. static const struct nla_policy
  7189. nl80211_mesh_setup_params_policy[NL80211_MESH_SETUP_ATTR_MAX+1] = {
  7190. [NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC] = { .type = NLA_U8 },
  7191. [NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL] = { .type = NLA_U8 },
  7192. [NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC] = { .type = NLA_U8 },
  7193. [NL80211_MESH_SETUP_USERSPACE_AUTH] = { .type = NLA_FLAG },
  7194. [NL80211_MESH_SETUP_AUTH_PROTOCOL] = { .type = NLA_U8 },
  7195. [NL80211_MESH_SETUP_USERSPACE_MPM] = { .type = NLA_FLAG },
  7196. [NL80211_MESH_SETUP_IE] =
  7197. NLA_POLICY_VALIDATE_FN(NLA_BINARY, validate_ie_attr,
  7198. IEEE80211_MAX_DATA_LEN),
  7199. [NL80211_MESH_SETUP_USERSPACE_AMPE] = { .type = NLA_FLAG },
  7200. };
  7201. static int nl80211_parse_mesh_config(struct genl_info *info,
  7202. struct mesh_config *cfg,
  7203. u32 *mask_out)
  7204. {
  7205. struct nlattr *tb[NL80211_MESHCONF_ATTR_MAX + 1];
  7206. u32 mask = 0;
  7207. u16 ht_opmode;
  7208. #define FILL_IN_MESH_PARAM_IF_SET(tb, cfg, param, mask, attr, fn) \
  7209. do { \
  7210. if (tb[attr]) { \
  7211. cfg->param = fn(tb[attr]); \
  7212. mask |= BIT((attr) - 1); \
  7213. } \
  7214. } while (0)
  7215. if (!info->attrs[NL80211_ATTR_MESH_CONFIG])
  7216. return -EINVAL;
  7217. if (nla_parse_nested_deprecated(tb, NL80211_MESHCONF_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_CONFIG], nl80211_meshconf_params_policy, info->extack))
  7218. return -EINVAL;
  7219. /* This makes sure that there aren't more than 32 mesh config
  7220. * parameters (otherwise our bitfield scheme would not work.) */
  7221. BUILD_BUG_ON(NL80211_MESHCONF_ATTR_MAX > 32);
  7222. /* Fill in the params struct */
  7223. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshRetryTimeout, mask,
  7224. NL80211_MESHCONF_RETRY_TIMEOUT, nla_get_u16);
  7225. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConfirmTimeout, mask,
  7226. NL80211_MESHCONF_CONFIRM_TIMEOUT,
  7227. nla_get_u16);
  7228. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHoldingTimeout, mask,
  7229. NL80211_MESHCONF_HOLDING_TIMEOUT,
  7230. nla_get_u16);
  7231. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxPeerLinks, mask,
  7232. NL80211_MESHCONF_MAX_PEER_LINKS,
  7233. nla_get_u16);
  7234. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshMaxRetries, mask,
  7235. NL80211_MESHCONF_MAX_RETRIES, nla_get_u8);
  7236. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshTTL, mask,
  7237. NL80211_MESHCONF_TTL, nla_get_u8);
  7238. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, element_ttl, mask,
  7239. NL80211_MESHCONF_ELEMENT_TTL, nla_get_u8);
  7240. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, auto_open_plinks, mask,
  7241. NL80211_MESHCONF_AUTO_OPEN_PLINKS,
  7242. nla_get_u8);
  7243. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNbrOffsetMaxNeighbor,
  7244. mask,
  7245. NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR,
  7246. nla_get_u32);
  7247. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPmaxPREQretries, mask,
  7248. NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES,
  7249. nla_get_u8);
  7250. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, path_refresh_time, mask,
  7251. NL80211_MESHCONF_PATH_REFRESH_TIME,
  7252. nla_get_u32);
  7253. if (mask & BIT(NL80211_MESHCONF_PATH_REFRESH_TIME) &&
  7254. (cfg->path_refresh_time < 1 || cfg->path_refresh_time > 65535))
  7255. return -EINVAL;
  7256. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, min_discovery_timeout, mask,
  7257. NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT,
  7258. nla_get_u16);
  7259. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPactivePathTimeout,
  7260. mask,
  7261. NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT,
  7262. nla_get_u32);
  7263. if (mask & BIT(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT) &&
  7264. (cfg->dot11MeshHWMPactivePathTimeout < 1 ||
  7265. cfg->dot11MeshHWMPactivePathTimeout > 65535))
  7266. return -EINVAL;
  7267. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPpreqMinInterval, mask,
  7268. NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL,
  7269. nla_get_u16);
  7270. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPperrMinInterval, mask,
  7271. NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL,
  7272. nla_get_u16);
  7273. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  7274. dot11MeshHWMPnetDiameterTraversalTime, mask,
  7275. NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
  7276. nla_get_u16);
  7277. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRootMode, mask,
  7278. NL80211_MESHCONF_HWMP_ROOTMODE, nla_get_u8);
  7279. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPRannInterval, mask,
  7280. NL80211_MESHCONF_HWMP_RANN_INTERVAL,
  7281. nla_get_u16);
  7282. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshGateAnnouncementProtocol,
  7283. mask, NL80211_MESHCONF_GATE_ANNOUNCEMENTS,
  7284. nla_get_u8);
  7285. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshForwarding, mask,
  7286. NL80211_MESHCONF_FORWARDING, nla_get_u8);
  7287. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, rssi_threshold, mask,
  7288. NL80211_MESHCONF_RSSI_THRESHOLD,
  7289. nla_get_s32);
  7290. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToMeshGate, mask,
  7291. NL80211_MESHCONF_CONNECTED_TO_GATE,
  7292. nla_get_u8);
  7293. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshConnectedToAuthServer, mask,
  7294. NL80211_MESHCONF_CONNECTED_TO_AS,
  7295. nla_get_u8);
  7296. /*
  7297. * Check HT operation mode based on
  7298. * IEEE 802.11-2016 9.4.2.57 HT Operation element.
  7299. */
  7300. if (tb[NL80211_MESHCONF_HT_OPMODE]) {
  7301. ht_opmode = nla_get_u16(tb[NL80211_MESHCONF_HT_OPMODE]);
  7302. if (ht_opmode & ~(IEEE80211_HT_OP_MODE_PROTECTION |
  7303. IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT |
  7304. IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT))
  7305. return -EINVAL;
  7306. /* NON_HT_STA bit is reserved, but some programs set it */
  7307. ht_opmode &= ~IEEE80211_HT_OP_MODE_NON_HT_STA_PRSNT;
  7308. cfg->ht_opmode = ht_opmode;
  7309. mask |= (1 << (NL80211_MESHCONF_HT_OPMODE - 1));
  7310. }
  7311. FILL_IN_MESH_PARAM_IF_SET(tb, cfg,
  7312. dot11MeshHWMPactivePathToRootTimeout, mask,
  7313. NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT,
  7314. nla_get_u32);
  7315. if (mask & BIT(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT) &&
  7316. (cfg->dot11MeshHWMPactivePathToRootTimeout < 1 ||
  7317. cfg->dot11MeshHWMPactivePathToRootTimeout > 65535))
  7318. return -EINVAL;
  7319. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMProotInterval, mask,
  7320. NL80211_MESHCONF_HWMP_ROOT_INTERVAL,
  7321. nla_get_u16);
  7322. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshHWMPconfirmationInterval,
  7323. mask,
  7324. NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL,
  7325. nla_get_u16);
  7326. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, power_mode, mask,
  7327. NL80211_MESHCONF_POWER_MODE, nla_get_u32);
  7328. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshAwakeWindowDuration, mask,
  7329. NL80211_MESHCONF_AWAKE_WINDOW, nla_get_u16);
  7330. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, plink_timeout, mask,
  7331. NL80211_MESHCONF_PLINK_TIMEOUT, nla_get_u32);
  7332. FILL_IN_MESH_PARAM_IF_SET(tb, cfg, dot11MeshNolearn, mask,
  7333. NL80211_MESHCONF_NOLEARN, nla_get_u8);
  7334. if (mask_out)
  7335. *mask_out = mask;
  7336. return 0;
  7337. #undef FILL_IN_MESH_PARAM_IF_SET
  7338. }
  7339. static int nl80211_parse_mesh_setup(struct genl_info *info,
  7340. struct mesh_setup *setup)
  7341. {
  7342. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7343. struct nlattr *tb[NL80211_MESH_SETUP_ATTR_MAX + 1];
  7344. if (!info->attrs[NL80211_ATTR_MESH_SETUP])
  7345. return -EINVAL;
  7346. if (nla_parse_nested_deprecated(tb, NL80211_MESH_SETUP_ATTR_MAX, info->attrs[NL80211_ATTR_MESH_SETUP], nl80211_mesh_setup_params_policy, info->extack))
  7347. return -EINVAL;
  7348. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])
  7349. setup->sync_method =
  7350. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_SYNC])) ?
  7351. IEEE80211_SYNC_METHOD_VENDOR :
  7352. IEEE80211_SYNC_METHOD_NEIGHBOR_OFFSET;
  7353. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])
  7354. setup->path_sel_proto =
  7355. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_PATH_SEL])) ?
  7356. IEEE80211_PATH_PROTOCOL_VENDOR :
  7357. IEEE80211_PATH_PROTOCOL_HWMP;
  7358. if (tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])
  7359. setup->path_metric =
  7360. (nla_get_u8(tb[NL80211_MESH_SETUP_ENABLE_VENDOR_METRIC])) ?
  7361. IEEE80211_PATH_METRIC_VENDOR :
  7362. IEEE80211_PATH_METRIC_AIRTIME;
  7363. if (tb[NL80211_MESH_SETUP_IE]) {
  7364. struct nlattr *ieattr =
  7365. tb[NL80211_MESH_SETUP_IE];
  7366. setup->ie = nla_data(ieattr);
  7367. setup->ie_len = nla_len(ieattr);
  7368. }
  7369. if (tb[NL80211_MESH_SETUP_USERSPACE_MPM] &&
  7370. !(rdev->wiphy.features & NL80211_FEATURE_USERSPACE_MPM))
  7371. return -EINVAL;
  7372. setup->user_mpm = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_MPM]);
  7373. setup->is_authenticated = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AUTH]);
  7374. setup->is_secure = nla_get_flag(tb[NL80211_MESH_SETUP_USERSPACE_AMPE]);
  7375. if (setup->is_secure)
  7376. setup->user_mpm = true;
  7377. if (tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]) {
  7378. if (!setup->user_mpm)
  7379. return -EINVAL;
  7380. setup->auth_id =
  7381. nla_get_u8(tb[NL80211_MESH_SETUP_AUTH_PROTOCOL]);
  7382. }
  7383. return 0;
  7384. }
  7385. static int nl80211_update_mesh_config(struct sk_buff *skb,
  7386. struct genl_info *info)
  7387. {
  7388. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7389. struct net_device *dev = info->user_ptr[1];
  7390. struct wireless_dev *wdev = dev->ieee80211_ptr;
  7391. struct mesh_config cfg = {};
  7392. u32 mask;
  7393. int err;
  7394. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  7395. return -EOPNOTSUPP;
  7396. if (!rdev->ops->update_mesh_config)
  7397. return -EOPNOTSUPP;
  7398. err = nl80211_parse_mesh_config(info, &cfg, &mask);
  7399. if (err)
  7400. return err;
  7401. if (!wdev->u.mesh.id_len)
  7402. err = -ENOLINK;
  7403. if (!err)
  7404. err = rdev_update_mesh_config(rdev, dev, mask, &cfg);
  7405. return err;
  7406. }
  7407. static int nl80211_put_regdom(const struct ieee80211_regdomain *regdom,
  7408. struct sk_buff *msg)
  7409. {
  7410. struct nlattr *nl_reg_rules;
  7411. unsigned int i;
  7412. if (nla_put_string(msg, NL80211_ATTR_REG_ALPHA2, regdom->alpha2) ||
  7413. (regdom->dfs_region &&
  7414. nla_put_u8(msg, NL80211_ATTR_DFS_REGION, regdom->dfs_region)))
  7415. goto nla_put_failure;
  7416. nl_reg_rules = nla_nest_start_noflag(msg, NL80211_ATTR_REG_RULES);
  7417. if (!nl_reg_rules)
  7418. goto nla_put_failure;
  7419. for (i = 0; i < regdom->n_reg_rules; i++) {
  7420. struct nlattr *nl_reg_rule;
  7421. const struct ieee80211_reg_rule *reg_rule;
  7422. const struct ieee80211_freq_range *freq_range;
  7423. const struct ieee80211_power_rule *power_rule;
  7424. unsigned int max_bandwidth_khz;
  7425. reg_rule = &regdom->reg_rules[i];
  7426. freq_range = &reg_rule->freq_range;
  7427. power_rule = &reg_rule->power_rule;
  7428. nl_reg_rule = nla_nest_start_noflag(msg, i);
  7429. if (!nl_reg_rule)
  7430. goto nla_put_failure;
  7431. max_bandwidth_khz = freq_range->max_bandwidth_khz;
  7432. if (!max_bandwidth_khz)
  7433. max_bandwidth_khz = reg_get_max_bandwidth(regdom,
  7434. reg_rule);
  7435. if (nla_put_u32(msg, NL80211_ATTR_REG_RULE_FLAGS,
  7436. reg_rule->flags) ||
  7437. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_START,
  7438. freq_range->start_freq_khz) ||
  7439. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_END,
  7440. freq_range->end_freq_khz) ||
  7441. nla_put_u32(msg, NL80211_ATTR_FREQ_RANGE_MAX_BW,
  7442. max_bandwidth_khz) ||
  7443. nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN,
  7444. power_rule->max_antenna_gain) ||
  7445. nla_put_u32(msg, NL80211_ATTR_POWER_RULE_MAX_EIRP,
  7446. power_rule->max_eirp) ||
  7447. nla_put_u32(msg, NL80211_ATTR_DFS_CAC_TIME,
  7448. reg_rule->dfs_cac_ms))
  7449. goto nla_put_failure;
  7450. if ((reg_rule->flags & NL80211_RRF_PSD) &&
  7451. nla_put_s8(msg, NL80211_ATTR_POWER_RULE_PSD,
  7452. reg_rule->psd))
  7453. goto nla_put_failure;
  7454. nla_nest_end(msg, nl_reg_rule);
  7455. }
  7456. nla_nest_end(msg, nl_reg_rules);
  7457. return 0;
  7458. nla_put_failure:
  7459. return -EMSGSIZE;
  7460. }
  7461. static int nl80211_get_reg_do(struct sk_buff *skb, struct genl_info *info)
  7462. {
  7463. const struct ieee80211_regdomain *regdom = NULL;
  7464. struct cfg80211_registered_device *rdev;
  7465. struct wiphy *wiphy = NULL;
  7466. struct sk_buff *msg;
  7467. int err = -EMSGSIZE;
  7468. void *hdr;
  7469. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  7470. if (!msg)
  7471. return -ENOBUFS;
  7472. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  7473. NL80211_CMD_GET_REG);
  7474. if (!hdr)
  7475. goto put_failure;
  7476. rtnl_lock();
  7477. if (info->attrs[NL80211_ATTR_WIPHY]) {
  7478. bool self_managed;
  7479. rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
  7480. if (IS_ERR(rdev)) {
  7481. err = PTR_ERR(rdev);
  7482. goto nla_put_failure;
  7483. }
  7484. wiphy = &rdev->wiphy;
  7485. self_managed = wiphy->regulatory_flags &
  7486. REGULATORY_WIPHY_SELF_MANAGED;
  7487. rcu_read_lock();
  7488. regdom = get_wiphy_regdom(wiphy);
  7489. /* a self-managed-reg device must have a private regdom */
  7490. if (WARN_ON(!regdom && self_managed)) {
  7491. err = -EINVAL;
  7492. goto nla_put_failure_rcu;
  7493. }
  7494. if (regdom &&
  7495. nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  7496. goto nla_put_failure_rcu;
  7497. } else {
  7498. rcu_read_lock();
  7499. }
  7500. if (!wiphy && reg_last_request_cell_base() &&
  7501. nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
  7502. NL80211_USER_REG_HINT_CELL_BASE))
  7503. goto nla_put_failure_rcu;
  7504. if (!regdom)
  7505. regdom = rcu_dereference(cfg80211_regdomain);
  7506. if (nl80211_put_regdom(regdom, msg))
  7507. goto nla_put_failure_rcu;
  7508. rcu_read_unlock();
  7509. genlmsg_end(msg, hdr);
  7510. rtnl_unlock();
  7511. return genlmsg_reply(msg, info);
  7512. nla_put_failure_rcu:
  7513. rcu_read_unlock();
  7514. nla_put_failure:
  7515. rtnl_unlock();
  7516. put_failure:
  7517. nlmsg_free(msg);
  7518. return err;
  7519. }
  7520. static int nl80211_send_regdom(struct sk_buff *msg, struct netlink_callback *cb,
  7521. u32 seq, int flags, struct wiphy *wiphy,
  7522. const struct ieee80211_regdomain *regdom)
  7523. {
  7524. void *hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
  7525. NL80211_CMD_GET_REG);
  7526. if (!hdr)
  7527. return -1;
  7528. genl_dump_check_consistent(cb, hdr);
  7529. if (nl80211_put_regdom(regdom, msg))
  7530. goto nla_put_failure;
  7531. if (!wiphy && reg_last_request_cell_base() &&
  7532. nla_put_u32(msg, NL80211_ATTR_USER_REG_HINT_TYPE,
  7533. NL80211_USER_REG_HINT_CELL_BASE))
  7534. goto nla_put_failure;
  7535. if (wiphy &&
  7536. nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  7537. goto nla_put_failure;
  7538. if (wiphy && wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  7539. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  7540. goto nla_put_failure;
  7541. genlmsg_end(msg, hdr);
  7542. return 0;
  7543. nla_put_failure:
  7544. genlmsg_cancel(msg, hdr);
  7545. return -EMSGSIZE;
  7546. }
  7547. static int nl80211_get_reg_dump(struct sk_buff *skb,
  7548. struct netlink_callback *cb)
  7549. {
  7550. const struct ieee80211_regdomain *regdom = NULL;
  7551. struct cfg80211_registered_device *rdev;
  7552. int err, reg_idx, start = cb->args[2];
  7553. rcu_read_lock();
  7554. if (cfg80211_regdomain && start == 0) {
  7555. err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
  7556. NLM_F_MULTI, NULL,
  7557. rcu_dereference(cfg80211_regdomain));
  7558. if (err < 0)
  7559. goto out_err;
  7560. }
  7561. /* the global regdom is idx 0 */
  7562. reg_idx = 1;
  7563. list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
  7564. regdom = get_wiphy_regdom(&rdev->wiphy);
  7565. if (!regdom)
  7566. continue;
  7567. if (++reg_idx <= start)
  7568. continue;
  7569. err = nl80211_send_regdom(skb, cb, cb->nlh->nlmsg_seq,
  7570. NLM_F_MULTI, &rdev->wiphy, regdom);
  7571. if (err < 0) {
  7572. reg_idx--;
  7573. break;
  7574. }
  7575. }
  7576. cb->args[2] = reg_idx;
  7577. err = skb->len;
  7578. out_err:
  7579. rcu_read_unlock();
  7580. return err;
  7581. }
  7582. #ifdef CONFIG_CFG80211_CRDA_SUPPORT
  7583. static const struct nla_policy reg_rule_policy[NL80211_REG_RULE_ATTR_MAX + 1] = {
  7584. [NL80211_ATTR_REG_RULE_FLAGS] = { .type = NLA_U32 },
  7585. [NL80211_ATTR_FREQ_RANGE_START] = { .type = NLA_U32 },
  7586. [NL80211_ATTR_FREQ_RANGE_END] = { .type = NLA_U32 },
  7587. [NL80211_ATTR_FREQ_RANGE_MAX_BW] = { .type = NLA_U32 },
  7588. [NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN] = { .type = NLA_U32 },
  7589. [NL80211_ATTR_POWER_RULE_MAX_EIRP] = { .type = NLA_U32 },
  7590. [NL80211_ATTR_DFS_CAC_TIME] = { .type = NLA_U32 },
  7591. };
  7592. static int parse_reg_rule(struct nlattr *tb[],
  7593. struct ieee80211_reg_rule *reg_rule)
  7594. {
  7595. struct ieee80211_freq_range *freq_range = &reg_rule->freq_range;
  7596. struct ieee80211_power_rule *power_rule = &reg_rule->power_rule;
  7597. if (!tb[NL80211_ATTR_REG_RULE_FLAGS])
  7598. return -EINVAL;
  7599. if (!tb[NL80211_ATTR_FREQ_RANGE_START])
  7600. return -EINVAL;
  7601. if (!tb[NL80211_ATTR_FREQ_RANGE_END])
  7602. return -EINVAL;
  7603. if (!tb[NL80211_ATTR_FREQ_RANGE_MAX_BW])
  7604. return -EINVAL;
  7605. if (!tb[NL80211_ATTR_POWER_RULE_MAX_EIRP])
  7606. return -EINVAL;
  7607. reg_rule->flags = nla_get_u32(tb[NL80211_ATTR_REG_RULE_FLAGS]);
  7608. freq_range->start_freq_khz =
  7609. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_START]);
  7610. freq_range->end_freq_khz =
  7611. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_END]);
  7612. freq_range->max_bandwidth_khz =
  7613. nla_get_u32(tb[NL80211_ATTR_FREQ_RANGE_MAX_BW]);
  7614. power_rule->max_eirp =
  7615. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_EIRP]);
  7616. if (tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN])
  7617. power_rule->max_antenna_gain =
  7618. nla_get_u32(tb[NL80211_ATTR_POWER_RULE_MAX_ANT_GAIN]);
  7619. if (tb[NL80211_ATTR_DFS_CAC_TIME])
  7620. reg_rule->dfs_cac_ms =
  7621. nla_get_u32(tb[NL80211_ATTR_DFS_CAC_TIME]);
  7622. return 0;
  7623. }
  7624. static int nl80211_set_reg(struct sk_buff *skb, struct genl_info *info)
  7625. {
  7626. struct nlattr *tb[NL80211_REG_RULE_ATTR_MAX + 1];
  7627. struct nlattr *nl_reg_rule;
  7628. char *alpha2;
  7629. int rem_reg_rules, r;
  7630. u32 num_rules = 0, rule_idx = 0;
  7631. enum nl80211_dfs_regions dfs_region = NL80211_DFS_UNSET;
  7632. struct ieee80211_regdomain *rd;
  7633. if (!info->attrs[NL80211_ATTR_REG_ALPHA2])
  7634. return -EINVAL;
  7635. if (!info->attrs[NL80211_ATTR_REG_RULES])
  7636. return -EINVAL;
  7637. alpha2 = nla_data(info->attrs[NL80211_ATTR_REG_ALPHA2]);
  7638. if (info->attrs[NL80211_ATTR_DFS_REGION])
  7639. dfs_region = nla_get_u8(info->attrs[NL80211_ATTR_DFS_REGION]);
  7640. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  7641. rem_reg_rules) {
  7642. num_rules++;
  7643. if (num_rules > NL80211_MAX_SUPP_REG_RULES)
  7644. return -EINVAL;
  7645. }
  7646. rtnl_lock();
  7647. if (!reg_is_valid_request(alpha2)) {
  7648. r = -EINVAL;
  7649. goto out;
  7650. }
  7651. rd = kzalloc(struct_size(rd, reg_rules, num_rules), GFP_KERNEL);
  7652. if (!rd) {
  7653. r = -ENOMEM;
  7654. goto out;
  7655. }
  7656. rd->n_reg_rules = num_rules;
  7657. rd->alpha2[0] = alpha2[0];
  7658. rd->alpha2[1] = alpha2[1];
  7659. /*
  7660. * Disable DFS master mode if the DFS region was
  7661. * not supported or known on this kernel.
  7662. */
  7663. if (reg_supported_dfs_region(dfs_region))
  7664. rd->dfs_region = dfs_region;
  7665. nla_for_each_nested(nl_reg_rule, info->attrs[NL80211_ATTR_REG_RULES],
  7666. rem_reg_rules) {
  7667. r = nla_parse_nested_deprecated(tb, NL80211_REG_RULE_ATTR_MAX,
  7668. nl_reg_rule, reg_rule_policy,
  7669. info->extack);
  7670. if (r)
  7671. goto bad_reg;
  7672. r = parse_reg_rule(tb, &rd->reg_rules[rule_idx]);
  7673. if (r)
  7674. goto bad_reg;
  7675. rule_idx++;
  7676. if (rule_idx > NL80211_MAX_SUPP_REG_RULES) {
  7677. r = -EINVAL;
  7678. goto bad_reg;
  7679. }
  7680. }
  7681. r = set_regdom(rd, REGD_SOURCE_CRDA);
  7682. /* set_regdom takes ownership of rd */
  7683. rd = NULL;
  7684. bad_reg:
  7685. kfree(rd);
  7686. out:
  7687. rtnl_unlock();
  7688. return r;
  7689. }
  7690. #endif /* CONFIG_CFG80211_CRDA_SUPPORT */
  7691. static int validate_scan_freqs(struct nlattr *freqs)
  7692. {
  7693. struct nlattr *attr1, *attr2;
  7694. int n_channels = 0, tmp1, tmp2;
  7695. nla_for_each_nested(attr1, freqs, tmp1)
  7696. if (nla_len(attr1) != sizeof(u32))
  7697. return 0;
  7698. nla_for_each_nested(attr1, freqs, tmp1) {
  7699. n_channels++;
  7700. /*
  7701. * Some hardware has a limited channel list for
  7702. * scanning, and it is pretty much nonsensical
  7703. * to scan for a channel twice, so disallow that
  7704. * and don't require drivers to check that the
  7705. * channel list they get isn't longer than what
  7706. * they can scan, as long as they can scan all
  7707. * the channels they registered at once.
  7708. */
  7709. nla_for_each_nested(attr2, freqs, tmp2)
  7710. if (attr1 != attr2 &&
  7711. nla_get_u32(attr1) == nla_get_u32(attr2))
  7712. return 0;
  7713. }
  7714. return n_channels;
  7715. }
  7716. static bool is_band_valid(struct wiphy *wiphy, enum nl80211_band b)
  7717. {
  7718. return b < NUM_NL80211_BANDS && wiphy->bands[b];
  7719. }
  7720. static int parse_bss_select(struct nlattr *nla, struct wiphy *wiphy,
  7721. struct cfg80211_bss_selection *bss_select)
  7722. {
  7723. struct nlattr *attr[NL80211_BSS_SELECT_ATTR_MAX + 1];
  7724. struct nlattr *nest;
  7725. int err;
  7726. bool found = false;
  7727. int i;
  7728. /* only process one nested attribute */
  7729. nest = nla_data(nla);
  7730. if (!nla_ok(nest, nla_len(nest)))
  7731. return -EINVAL;
  7732. err = nla_parse_nested_deprecated(attr, NL80211_BSS_SELECT_ATTR_MAX,
  7733. nest, nl80211_bss_select_policy,
  7734. NULL);
  7735. if (err)
  7736. return err;
  7737. /* only one attribute may be given */
  7738. for (i = 0; i <= NL80211_BSS_SELECT_ATTR_MAX; i++) {
  7739. if (attr[i]) {
  7740. if (found)
  7741. return -EINVAL;
  7742. found = true;
  7743. }
  7744. }
  7745. bss_select->behaviour = __NL80211_BSS_SELECT_ATTR_INVALID;
  7746. if (attr[NL80211_BSS_SELECT_ATTR_RSSI])
  7747. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI;
  7748. if (attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]) {
  7749. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_BAND_PREF;
  7750. bss_select->param.band_pref =
  7751. nla_get_u32(attr[NL80211_BSS_SELECT_ATTR_BAND_PREF]);
  7752. if (!is_band_valid(wiphy, bss_select->param.band_pref))
  7753. return -EINVAL;
  7754. }
  7755. if (attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]) {
  7756. struct nl80211_bss_select_rssi_adjust *adj_param;
  7757. adj_param = nla_data(attr[NL80211_BSS_SELECT_ATTR_RSSI_ADJUST]);
  7758. bss_select->behaviour = NL80211_BSS_SELECT_ATTR_RSSI_ADJUST;
  7759. bss_select->param.adjust.band = adj_param->band;
  7760. bss_select->param.adjust.delta = adj_param->delta;
  7761. if (!is_band_valid(wiphy, bss_select->param.adjust.band))
  7762. return -EINVAL;
  7763. }
  7764. /* user-space did not provide behaviour attribute */
  7765. if (bss_select->behaviour == __NL80211_BSS_SELECT_ATTR_INVALID)
  7766. return -EINVAL;
  7767. if (!(wiphy->bss_select_support & BIT(bss_select->behaviour)))
  7768. return -EINVAL;
  7769. return 0;
  7770. }
  7771. int nl80211_parse_random_mac(struct nlattr **attrs,
  7772. u8 *mac_addr, u8 *mac_addr_mask)
  7773. {
  7774. int i;
  7775. if (!attrs[NL80211_ATTR_MAC] && !attrs[NL80211_ATTR_MAC_MASK]) {
  7776. eth_zero_addr(mac_addr);
  7777. eth_zero_addr(mac_addr_mask);
  7778. mac_addr[0] = 0x2;
  7779. mac_addr_mask[0] = 0x3;
  7780. return 0;
  7781. }
  7782. /* need both or none */
  7783. if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_MAC_MASK])
  7784. return -EINVAL;
  7785. memcpy(mac_addr, nla_data(attrs[NL80211_ATTR_MAC]), ETH_ALEN);
  7786. memcpy(mac_addr_mask, nla_data(attrs[NL80211_ATTR_MAC_MASK]), ETH_ALEN);
  7787. /* don't allow or configure an mcast address */
  7788. if (!is_multicast_ether_addr(mac_addr_mask) ||
  7789. is_multicast_ether_addr(mac_addr))
  7790. return -EINVAL;
  7791. /*
  7792. * allow users to pass a MAC address that has bits set outside
  7793. * of the mask, but don't bother drivers with having to deal
  7794. * with such bits
  7795. */
  7796. for (i = 0; i < ETH_ALEN; i++)
  7797. mac_addr[i] &= mac_addr_mask[i];
  7798. return 0;
  7799. }
  7800. static bool cfg80211_off_channel_oper_allowed(struct wireless_dev *wdev,
  7801. struct ieee80211_channel *chan)
  7802. {
  7803. unsigned int link_id;
  7804. bool all_ok = true;
  7805. lockdep_assert_wiphy(wdev->wiphy);
  7806. if (!cfg80211_beaconing_iface_active(wdev))
  7807. return true;
  7808. /*
  7809. * FIXME: check if we have a free HW resource/link for chan
  7810. *
  7811. * This, as well as the FIXME below, requires knowing the link
  7812. * capabilities of the hardware.
  7813. */
  7814. /* we cannot leave radar channels */
  7815. for_each_valid_link(wdev, link_id) {
  7816. struct cfg80211_chan_def *chandef;
  7817. chandef = wdev_chandef(wdev, link_id);
  7818. if (!chandef || !chandef->chan)
  7819. continue;
  7820. /*
  7821. * FIXME: don't require all_ok, but rather check only the
  7822. * correct HW resource/link onto which 'chan' falls,
  7823. * as only that link leaves the channel for doing
  7824. * the off-channel operation.
  7825. */
  7826. if (chandef->chan->flags & IEEE80211_CHAN_RADAR)
  7827. all_ok = false;
  7828. }
  7829. if (all_ok)
  7830. return true;
  7831. return regulatory_pre_cac_allowed(wdev->wiphy);
  7832. }
  7833. static bool nl80211_check_scan_feat(struct wiphy *wiphy, u32 flags, u32 flag,
  7834. enum nl80211_ext_feature_index feat)
  7835. {
  7836. if (!(flags & flag))
  7837. return true;
  7838. if (wiphy_ext_feature_isset(wiphy, feat))
  7839. return true;
  7840. return false;
  7841. }
  7842. static int
  7843. nl80211_check_scan_flags(struct wiphy *wiphy, struct wireless_dev *wdev,
  7844. void *request, struct nlattr **attrs,
  7845. bool is_sched_scan)
  7846. {
  7847. u8 *mac_addr, *mac_addr_mask;
  7848. u32 *flags;
  7849. enum nl80211_feature_flags randomness_flag;
  7850. if (!attrs[NL80211_ATTR_SCAN_FLAGS])
  7851. return 0;
  7852. if (is_sched_scan) {
  7853. struct cfg80211_sched_scan_request *req = request;
  7854. randomness_flag = wdev ?
  7855. NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR :
  7856. NL80211_FEATURE_ND_RANDOM_MAC_ADDR;
  7857. flags = &req->flags;
  7858. mac_addr = req->mac_addr;
  7859. mac_addr_mask = req->mac_addr_mask;
  7860. } else {
  7861. struct cfg80211_scan_request *req = request;
  7862. randomness_flag = NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
  7863. flags = &req->flags;
  7864. mac_addr = req->mac_addr;
  7865. mac_addr_mask = req->mac_addr_mask;
  7866. }
  7867. *flags = nla_get_u32(attrs[NL80211_ATTR_SCAN_FLAGS]);
  7868. if (((*flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
  7869. !(wiphy->features & NL80211_FEATURE_LOW_PRIORITY_SCAN)) ||
  7870. !nl80211_check_scan_feat(wiphy, *flags,
  7871. NL80211_SCAN_FLAG_LOW_SPAN,
  7872. NL80211_EXT_FEATURE_LOW_SPAN_SCAN) ||
  7873. !nl80211_check_scan_feat(wiphy, *flags,
  7874. NL80211_SCAN_FLAG_LOW_POWER,
  7875. NL80211_EXT_FEATURE_LOW_POWER_SCAN) ||
  7876. !nl80211_check_scan_feat(wiphy, *flags,
  7877. NL80211_SCAN_FLAG_HIGH_ACCURACY,
  7878. NL80211_EXT_FEATURE_HIGH_ACCURACY_SCAN) ||
  7879. !nl80211_check_scan_feat(wiphy, *flags,
  7880. NL80211_SCAN_FLAG_FILS_MAX_CHANNEL_TIME,
  7881. NL80211_EXT_FEATURE_FILS_MAX_CHANNEL_TIME) ||
  7882. !nl80211_check_scan_feat(wiphy, *flags,
  7883. NL80211_SCAN_FLAG_ACCEPT_BCAST_PROBE_RESP,
  7884. NL80211_EXT_FEATURE_ACCEPT_BCAST_PROBE_RESP) ||
  7885. !nl80211_check_scan_feat(wiphy, *flags,
  7886. NL80211_SCAN_FLAG_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION,
  7887. NL80211_EXT_FEATURE_OCE_PROBE_REQ_DEFERRAL_SUPPRESSION) ||
  7888. !nl80211_check_scan_feat(wiphy, *flags,
  7889. NL80211_SCAN_FLAG_OCE_PROBE_REQ_HIGH_TX_RATE,
  7890. NL80211_EXT_FEATURE_OCE_PROBE_REQ_HIGH_TX_RATE) ||
  7891. !nl80211_check_scan_feat(wiphy, *flags,
  7892. NL80211_SCAN_FLAG_RANDOM_SN,
  7893. NL80211_EXT_FEATURE_SCAN_RANDOM_SN) ||
  7894. !nl80211_check_scan_feat(wiphy, *flags,
  7895. NL80211_SCAN_FLAG_MIN_PREQ_CONTENT,
  7896. NL80211_EXT_FEATURE_SCAN_MIN_PREQ_CONTENT))
  7897. return -EOPNOTSUPP;
  7898. if (*flags & NL80211_SCAN_FLAG_RANDOM_ADDR) {
  7899. int err;
  7900. if (!(wiphy->features & randomness_flag) ||
  7901. (wdev && wdev->connected))
  7902. return -EOPNOTSUPP;
  7903. err = nl80211_parse_random_mac(attrs, mac_addr, mac_addr_mask);
  7904. if (err)
  7905. return err;
  7906. }
  7907. return 0;
  7908. }
  7909. static int nl80211_trigger_scan(struct sk_buff *skb, struct genl_info *info)
  7910. {
  7911. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  7912. struct wireless_dev *wdev = info->user_ptr[1];
  7913. struct cfg80211_scan_request *request;
  7914. struct nlattr *scan_freqs = NULL;
  7915. bool scan_freqs_khz = false;
  7916. struct nlattr *attr;
  7917. struct wiphy *wiphy;
  7918. int err, tmp, n_ssids = 0, n_channels, i;
  7919. size_t ie_len, size;
  7920. size_t ssids_offset, ie_offset;
  7921. wiphy = &rdev->wiphy;
  7922. if (wdev->iftype == NL80211_IFTYPE_NAN)
  7923. return -EOPNOTSUPP;
  7924. if (!rdev->ops->scan)
  7925. return -EOPNOTSUPP;
  7926. if (rdev->scan_req || rdev->scan_msg)
  7927. return -EBUSY;
  7928. if (info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ]) {
  7929. if (!wiphy_ext_feature_isset(wiphy,
  7930. NL80211_EXT_FEATURE_SCAN_FREQ_KHZ))
  7931. return -EOPNOTSUPP;
  7932. scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQ_KHZ];
  7933. scan_freqs_khz = true;
  7934. } else if (info->attrs[NL80211_ATTR_SCAN_FREQUENCIES])
  7935. scan_freqs = info->attrs[NL80211_ATTR_SCAN_FREQUENCIES];
  7936. if (scan_freqs) {
  7937. n_channels = validate_scan_freqs(scan_freqs);
  7938. if (!n_channels)
  7939. return -EINVAL;
  7940. } else {
  7941. n_channels = ieee80211_get_num_supported_channels(wiphy);
  7942. }
  7943. if (info->attrs[NL80211_ATTR_SCAN_SSIDS])
  7944. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp)
  7945. n_ssids++;
  7946. if (n_ssids > wiphy->max_scan_ssids)
  7947. return -EINVAL;
  7948. if (info->attrs[NL80211_ATTR_IE])
  7949. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  7950. else
  7951. ie_len = 0;
  7952. if (ie_len > wiphy->max_scan_ie_len)
  7953. return -EINVAL;
  7954. size = struct_size(request, channels, n_channels);
  7955. ssids_offset = size;
  7956. size = size_add(size, array_size(sizeof(*request->ssids), n_ssids));
  7957. ie_offset = size;
  7958. size = size_add(size, ie_len);
  7959. request = kzalloc(size, GFP_KERNEL);
  7960. if (!request)
  7961. return -ENOMEM;
  7962. request->n_channels = n_channels;
  7963. if (n_ssids)
  7964. request->ssids = (void *)request + ssids_offset;
  7965. request->n_ssids = n_ssids;
  7966. if (ie_len)
  7967. request->ie = (void *)request + ie_offset;
  7968. i = 0;
  7969. if (scan_freqs) {
  7970. /* user specified, bail out if channel not found */
  7971. nla_for_each_nested(attr, scan_freqs, tmp) {
  7972. struct ieee80211_channel *chan;
  7973. int freq = nla_get_u32(attr);
  7974. if (!scan_freqs_khz)
  7975. freq = MHZ_TO_KHZ(freq);
  7976. chan = ieee80211_get_channel_khz(wiphy, freq);
  7977. if (!chan) {
  7978. err = -EINVAL;
  7979. goto out_free;
  7980. }
  7981. /* ignore disabled channels */
  7982. if (chan->flags & IEEE80211_CHAN_DISABLED)
  7983. continue;
  7984. request->channels[i] = chan;
  7985. i++;
  7986. }
  7987. } else {
  7988. enum nl80211_band band;
  7989. /* all channels */
  7990. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  7991. int j;
  7992. if (!wiphy->bands[band])
  7993. continue;
  7994. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  7995. struct ieee80211_channel *chan;
  7996. chan = &wiphy->bands[band]->channels[j];
  7997. if (chan->flags & IEEE80211_CHAN_DISABLED)
  7998. continue;
  7999. request->channels[i] = chan;
  8000. i++;
  8001. }
  8002. }
  8003. }
  8004. if (!i) {
  8005. err = -EINVAL;
  8006. goto out_free;
  8007. }
  8008. request->n_channels = i;
  8009. for (i = 0; i < request->n_channels; i++) {
  8010. struct ieee80211_channel *chan = request->channels[i];
  8011. /* if we can go off-channel to the target channel we're good */
  8012. if (cfg80211_off_channel_oper_allowed(wdev, chan))
  8013. continue;
  8014. if (!cfg80211_wdev_on_sub_chan(wdev, chan, true)) {
  8015. err = -EBUSY;
  8016. goto out_free;
  8017. }
  8018. }
  8019. i = 0;
  8020. if (n_ssids) {
  8021. nla_for_each_nested(attr, info->attrs[NL80211_ATTR_SCAN_SSIDS], tmp) {
  8022. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  8023. err = -EINVAL;
  8024. goto out_free;
  8025. }
  8026. request->ssids[i].ssid_len = nla_len(attr);
  8027. memcpy(request->ssids[i].ssid, nla_data(attr), nla_len(attr));
  8028. i++;
  8029. }
  8030. }
  8031. if (info->attrs[NL80211_ATTR_IE]) {
  8032. request->ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  8033. memcpy((void *)request->ie,
  8034. nla_data(info->attrs[NL80211_ATTR_IE]),
  8035. request->ie_len);
  8036. }
  8037. for (i = 0; i < NUM_NL80211_BANDS; i++)
  8038. if (wiphy->bands[i])
  8039. request->rates[i] =
  8040. (1 << wiphy->bands[i]->n_bitrates) - 1;
  8041. if (info->attrs[NL80211_ATTR_SCAN_SUPP_RATES]) {
  8042. nla_for_each_nested(attr,
  8043. info->attrs[NL80211_ATTR_SCAN_SUPP_RATES],
  8044. tmp) {
  8045. enum nl80211_band band = nla_type(attr);
  8046. if (band < 0 || band >= NUM_NL80211_BANDS) {
  8047. err = -EINVAL;
  8048. goto out_free;
  8049. }
  8050. if (!wiphy->bands[band])
  8051. continue;
  8052. err = ieee80211_get_ratemask(wiphy->bands[band],
  8053. nla_data(attr),
  8054. nla_len(attr),
  8055. &request->rates[band]);
  8056. if (err)
  8057. goto out_free;
  8058. }
  8059. }
  8060. if (info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]) {
  8061. request->duration =
  8062. nla_get_u16(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION]);
  8063. request->duration_mandatory =
  8064. nla_get_flag(info->attrs[NL80211_ATTR_MEASUREMENT_DURATION_MANDATORY]);
  8065. }
  8066. err = nl80211_check_scan_flags(wiphy, wdev, request, info->attrs,
  8067. false);
  8068. if (err)
  8069. goto out_free;
  8070. request->no_cck =
  8071. nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
  8072. /* Initial implementation used NL80211_ATTR_MAC to set the specific
  8073. * BSSID to scan for. This was problematic because that same attribute
  8074. * was already used for another purpose (local random MAC address). The
  8075. * NL80211_ATTR_BSSID attribute was added to fix this. For backwards
  8076. * compatibility with older userspace components, also use the
  8077. * NL80211_ATTR_MAC value here if it can be determined to be used for
  8078. * the specific BSSID use case instead of the random MAC address
  8079. * (NL80211_ATTR_SCAN_FLAGS is used to enable random MAC address use).
  8080. */
  8081. if (info->attrs[NL80211_ATTR_BSSID])
  8082. memcpy(request->bssid,
  8083. nla_data(info->attrs[NL80211_ATTR_BSSID]), ETH_ALEN);
  8084. else if (!(request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) &&
  8085. info->attrs[NL80211_ATTR_MAC])
  8086. memcpy(request->bssid, nla_data(info->attrs[NL80211_ATTR_MAC]),
  8087. ETH_ALEN);
  8088. else
  8089. eth_broadcast_addr(request->bssid);
  8090. request->tsf_report_link_id = nl80211_link_id_or_invalid(info->attrs);
  8091. request->wdev = wdev;
  8092. request->wiphy = &rdev->wiphy;
  8093. request->scan_start = jiffies;
  8094. rdev->scan_req = request;
  8095. err = cfg80211_scan(rdev);
  8096. if (err)
  8097. goto out_free;
  8098. nl80211_send_scan_start(rdev, wdev);
  8099. dev_hold(wdev->netdev);
  8100. return 0;
  8101. out_free:
  8102. rdev->scan_req = NULL;
  8103. kfree(request);
  8104. return err;
  8105. }
  8106. static int nl80211_abort_scan(struct sk_buff *skb, struct genl_info *info)
  8107. {
  8108. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8109. struct wireless_dev *wdev = info->user_ptr[1];
  8110. if (!rdev->ops->abort_scan)
  8111. return -EOPNOTSUPP;
  8112. if (rdev->scan_msg)
  8113. return 0;
  8114. if (!rdev->scan_req)
  8115. return -ENOENT;
  8116. rdev_abort_scan(rdev, wdev);
  8117. return 0;
  8118. }
  8119. static int
  8120. nl80211_parse_sched_scan_plans(struct wiphy *wiphy, int n_plans,
  8121. struct cfg80211_sched_scan_request *request,
  8122. struct nlattr **attrs)
  8123. {
  8124. int tmp, err, i = 0;
  8125. struct nlattr *attr;
  8126. if (!attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
  8127. u32 interval;
  8128. /*
  8129. * If scan plans are not specified,
  8130. * %NL80211_ATTR_SCHED_SCAN_INTERVAL will be specified. In this
  8131. * case one scan plan will be set with the specified scan
  8132. * interval and infinite number of iterations.
  8133. */
  8134. interval = nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL]);
  8135. if (!interval)
  8136. return -EINVAL;
  8137. request->scan_plans[0].interval =
  8138. DIV_ROUND_UP(interval, MSEC_PER_SEC);
  8139. if (!request->scan_plans[0].interval)
  8140. return -EINVAL;
  8141. if (request->scan_plans[0].interval >
  8142. wiphy->max_sched_scan_plan_interval)
  8143. request->scan_plans[0].interval =
  8144. wiphy->max_sched_scan_plan_interval;
  8145. return 0;
  8146. }
  8147. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp) {
  8148. struct nlattr *plan[NL80211_SCHED_SCAN_PLAN_MAX + 1];
  8149. if (WARN_ON(i >= n_plans))
  8150. return -EINVAL;
  8151. err = nla_parse_nested_deprecated(plan,
  8152. NL80211_SCHED_SCAN_PLAN_MAX,
  8153. attr, nl80211_plan_policy,
  8154. NULL);
  8155. if (err)
  8156. return err;
  8157. if (!plan[NL80211_SCHED_SCAN_PLAN_INTERVAL])
  8158. return -EINVAL;
  8159. request->scan_plans[i].interval =
  8160. nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_INTERVAL]);
  8161. if (!request->scan_plans[i].interval ||
  8162. request->scan_plans[i].interval >
  8163. wiphy->max_sched_scan_plan_interval)
  8164. return -EINVAL;
  8165. if (plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]) {
  8166. request->scan_plans[i].iterations =
  8167. nla_get_u32(plan[NL80211_SCHED_SCAN_PLAN_ITERATIONS]);
  8168. if (!request->scan_plans[i].iterations ||
  8169. (request->scan_plans[i].iterations >
  8170. wiphy->max_sched_scan_plan_iterations))
  8171. return -EINVAL;
  8172. } else if (i < n_plans - 1) {
  8173. /*
  8174. * All scan plans but the last one must specify
  8175. * a finite number of iterations
  8176. */
  8177. return -EINVAL;
  8178. }
  8179. i++;
  8180. }
  8181. /*
  8182. * The last scan plan must not specify the number of
  8183. * iterations, it is supposed to run infinitely
  8184. */
  8185. if (request->scan_plans[n_plans - 1].iterations)
  8186. return -EINVAL;
  8187. return 0;
  8188. }
  8189. static struct cfg80211_sched_scan_request *
  8190. nl80211_parse_sched_scan(struct wiphy *wiphy, struct wireless_dev *wdev,
  8191. struct nlattr **attrs, int max_match_sets)
  8192. {
  8193. struct cfg80211_sched_scan_request *request;
  8194. struct nlattr *attr;
  8195. int err, tmp, n_ssids = 0, n_match_sets = 0, n_channels, i, n_plans = 0;
  8196. enum nl80211_band band;
  8197. size_t ie_len, size;
  8198. struct nlattr *tb[NL80211_SCHED_SCAN_MATCH_ATTR_MAX + 1];
  8199. s32 default_match_rssi = NL80211_SCAN_RSSI_THOLD_OFF;
  8200. if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  8201. n_channels = validate_scan_freqs(
  8202. attrs[NL80211_ATTR_SCAN_FREQUENCIES]);
  8203. if (!n_channels)
  8204. return ERR_PTR(-EINVAL);
  8205. } else {
  8206. n_channels = ieee80211_get_num_supported_channels(wiphy);
  8207. }
  8208. if (attrs[NL80211_ATTR_SCAN_SSIDS])
  8209. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
  8210. tmp)
  8211. n_ssids++;
  8212. if (n_ssids > wiphy->max_sched_scan_ssids)
  8213. return ERR_PTR(-EINVAL);
  8214. /*
  8215. * First, count the number of 'real' matchsets. Due to an issue with
  8216. * the old implementation, matchsets containing only the RSSI attribute
  8217. * (NL80211_SCHED_SCAN_MATCH_ATTR_RSSI) are considered as the 'default'
  8218. * RSSI for all matchsets, rather than their own matchset for reporting
  8219. * all APs with a strong RSSI. This is needed to be compatible with
  8220. * older userspace that treated a matchset with only the RSSI as the
  8221. * global RSSI for all other matchsets - if there are other matchsets.
  8222. */
  8223. if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
  8224. nla_for_each_nested(attr,
  8225. attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
  8226. tmp) {
  8227. struct nlattr *rssi;
  8228. err = nla_parse_nested_deprecated(tb,
  8229. NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
  8230. attr,
  8231. nl80211_match_policy,
  8232. NULL);
  8233. if (err)
  8234. return ERR_PTR(err);
  8235. /* SSID and BSSID are mutually exclusive */
  8236. if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] &&
  8237. tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID])
  8238. return ERR_PTR(-EINVAL);
  8239. /* add other standalone attributes here */
  8240. if (tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID] ||
  8241. tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID]) {
  8242. n_match_sets++;
  8243. continue;
  8244. }
  8245. rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
  8246. if (rssi)
  8247. default_match_rssi = nla_get_s32(rssi);
  8248. }
  8249. }
  8250. /* However, if there's no other matchset, add the RSSI one */
  8251. if (!n_match_sets && default_match_rssi != NL80211_SCAN_RSSI_THOLD_OFF)
  8252. n_match_sets = 1;
  8253. if (n_match_sets > max_match_sets)
  8254. return ERR_PTR(-EINVAL);
  8255. if (attrs[NL80211_ATTR_IE])
  8256. ie_len = nla_len(attrs[NL80211_ATTR_IE]);
  8257. else
  8258. ie_len = 0;
  8259. if (ie_len > wiphy->max_sched_scan_ie_len)
  8260. return ERR_PTR(-EINVAL);
  8261. if (attrs[NL80211_ATTR_SCHED_SCAN_PLANS]) {
  8262. /*
  8263. * NL80211_ATTR_SCHED_SCAN_INTERVAL must not be specified since
  8264. * each scan plan already specifies its own interval
  8265. */
  8266. if (attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
  8267. return ERR_PTR(-EINVAL);
  8268. nla_for_each_nested(attr,
  8269. attrs[NL80211_ATTR_SCHED_SCAN_PLANS], tmp)
  8270. n_plans++;
  8271. } else {
  8272. /*
  8273. * The scan interval attribute is kept for backward
  8274. * compatibility. If no scan plans are specified and sched scan
  8275. * interval is specified, one scan plan will be set with this
  8276. * scan interval and infinite number of iterations.
  8277. */
  8278. if (!attrs[NL80211_ATTR_SCHED_SCAN_INTERVAL])
  8279. return ERR_PTR(-EINVAL);
  8280. n_plans = 1;
  8281. }
  8282. if (!n_plans || n_plans > wiphy->max_sched_scan_plans)
  8283. return ERR_PTR(-EINVAL);
  8284. if (!wiphy_ext_feature_isset(
  8285. wiphy, NL80211_EXT_FEATURE_SCHED_SCAN_RELATIVE_RSSI) &&
  8286. (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI] ||
  8287. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]))
  8288. return ERR_PTR(-EINVAL);
  8289. size = struct_size(request, channels, n_channels);
  8290. size = size_add(size, array_size(sizeof(*request->ssids), n_ssids));
  8291. size = size_add(size, array_size(sizeof(*request->match_sets),
  8292. n_match_sets));
  8293. size = size_add(size, array_size(sizeof(*request->scan_plans),
  8294. n_plans));
  8295. size = size_add(size, ie_len);
  8296. request = kzalloc(size, GFP_KERNEL);
  8297. if (!request)
  8298. return ERR_PTR(-ENOMEM);
  8299. request->n_channels = n_channels;
  8300. if (n_ssids)
  8301. request->ssids = (void *)request +
  8302. struct_size(request, channels, n_channels);
  8303. request->n_ssids = n_ssids;
  8304. if (ie_len) {
  8305. if (n_ssids)
  8306. request->ie = (void *)(request->ssids + n_ssids);
  8307. else
  8308. request->ie = (void *)(request->channels + n_channels);
  8309. }
  8310. if (n_match_sets) {
  8311. if (request->ie)
  8312. request->match_sets = (void *)(request->ie + ie_len);
  8313. else if (n_ssids)
  8314. request->match_sets =
  8315. (void *)(request->ssids + n_ssids);
  8316. else
  8317. request->match_sets =
  8318. (void *)(request->channels + n_channels);
  8319. }
  8320. request->n_match_sets = n_match_sets;
  8321. if (n_match_sets)
  8322. request->scan_plans = (void *)(request->match_sets +
  8323. n_match_sets);
  8324. else if (request->ie)
  8325. request->scan_plans = (void *)(request->ie + ie_len);
  8326. else if (n_ssids)
  8327. request->scan_plans = (void *)(request->ssids + n_ssids);
  8328. else
  8329. request->scan_plans = (void *)(request->channels + n_channels);
  8330. request->n_scan_plans = n_plans;
  8331. i = 0;
  8332. if (attrs[NL80211_ATTR_SCAN_FREQUENCIES]) {
  8333. /* user specified, bail out if channel not found */
  8334. nla_for_each_nested(attr,
  8335. attrs[NL80211_ATTR_SCAN_FREQUENCIES],
  8336. tmp) {
  8337. struct ieee80211_channel *chan;
  8338. chan = ieee80211_get_channel(wiphy, nla_get_u32(attr));
  8339. if (!chan) {
  8340. err = -EINVAL;
  8341. goto out_free;
  8342. }
  8343. /* ignore disabled channels */
  8344. if (chan->flags & IEEE80211_CHAN_DISABLED)
  8345. continue;
  8346. request->channels[i] = chan;
  8347. i++;
  8348. }
  8349. } else {
  8350. /* all channels */
  8351. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  8352. int j;
  8353. if (!wiphy->bands[band])
  8354. continue;
  8355. for (j = 0; j < wiphy->bands[band]->n_channels; j++) {
  8356. struct ieee80211_channel *chan;
  8357. chan = &wiphy->bands[band]->channels[j];
  8358. if (chan->flags & IEEE80211_CHAN_DISABLED)
  8359. continue;
  8360. request->channels[i] = chan;
  8361. i++;
  8362. }
  8363. }
  8364. }
  8365. if (!i) {
  8366. err = -EINVAL;
  8367. goto out_free;
  8368. }
  8369. request->n_channels = i;
  8370. i = 0;
  8371. if (n_ssids) {
  8372. nla_for_each_nested(attr, attrs[NL80211_ATTR_SCAN_SSIDS],
  8373. tmp) {
  8374. if (nla_len(attr) > IEEE80211_MAX_SSID_LEN) {
  8375. err = -EINVAL;
  8376. goto out_free;
  8377. }
  8378. request->ssids[i].ssid_len = nla_len(attr);
  8379. memcpy(request->ssids[i].ssid, nla_data(attr),
  8380. nla_len(attr));
  8381. i++;
  8382. }
  8383. }
  8384. i = 0;
  8385. if (attrs[NL80211_ATTR_SCHED_SCAN_MATCH]) {
  8386. nla_for_each_nested(attr,
  8387. attrs[NL80211_ATTR_SCHED_SCAN_MATCH],
  8388. tmp) {
  8389. struct nlattr *ssid, *bssid, *rssi;
  8390. err = nla_parse_nested_deprecated(tb,
  8391. NL80211_SCHED_SCAN_MATCH_ATTR_MAX,
  8392. attr,
  8393. nl80211_match_policy,
  8394. NULL);
  8395. if (err)
  8396. goto out_free;
  8397. ssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_SSID];
  8398. bssid = tb[NL80211_SCHED_SCAN_MATCH_ATTR_BSSID];
  8399. if (!ssid && !bssid) {
  8400. i++;
  8401. continue;
  8402. }
  8403. if (WARN_ON(i >= n_match_sets)) {
  8404. /* this indicates a programming error,
  8405. * the loop above should have verified
  8406. * things properly
  8407. */
  8408. err = -EINVAL;
  8409. goto out_free;
  8410. }
  8411. if (ssid) {
  8412. memcpy(request->match_sets[i].ssid.ssid,
  8413. nla_data(ssid), nla_len(ssid));
  8414. request->match_sets[i].ssid.ssid_len =
  8415. nla_len(ssid);
  8416. }
  8417. if (bssid)
  8418. memcpy(request->match_sets[i].bssid,
  8419. nla_data(bssid), ETH_ALEN);
  8420. /* special attribute - old implementation w/a */
  8421. request->match_sets[i].rssi_thold = default_match_rssi;
  8422. rssi = tb[NL80211_SCHED_SCAN_MATCH_ATTR_RSSI];
  8423. if (rssi)
  8424. request->match_sets[i].rssi_thold =
  8425. nla_get_s32(rssi);
  8426. i++;
  8427. }
  8428. /* there was no other matchset, so the RSSI one is alone */
  8429. if (i == 0 && n_match_sets)
  8430. request->match_sets[0].rssi_thold = default_match_rssi;
  8431. request->min_rssi_thold = INT_MAX;
  8432. for (i = 0; i < n_match_sets; i++)
  8433. request->min_rssi_thold =
  8434. min(request->match_sets[i].rssi_thold,
  8435. request->min_rssi_thold);
  8436. } else {
  8437. request->min_rssi_thold = NL80211_SCAN_RSSI_THOLD_OFF;
  8438. }
  8439. if (ie_len) {
  8440. request->ie_len = ie_len;
  8441. memcpy((void *)request->ie,
  8442. nla_data(attrs[NL80211_ATTR_IE]),
  8443. request->ie_len);
  8444. }
  8445. err = nl80211_check_scan_flags(wiphy, wdev, request, attrs, true);
  8446. if (err)
  8447. goto out_free;
  8448. if (attrs[NL80211_ATTR_SCHED_SCAN_DELAY])
  8449. request->delay =
  8450. nla_get_u32(attrs[NL80211_ATTR_SCHED_SCAN_DELAY]);
  8451. if (attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]) {
  8452. request->relative_rssi = nla_get_s8(
  8453. attrs[NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI]);
  8454. request->relative_rssi_set = true;
  8455. }
  8456. if (request->relative_rssi_set &&
  8457. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]) {
  8458. struct nl80211_bss_select_rssi_adjust *rssi_adjust;
  8459. rssi_adjust = nla_data(
  8460. attrs[NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST]);
  8461. request->rssi_adjust.band = rssi_adjust->band;
  8462. request->rssi_adjust.delta = rssi_adjust->delta;
  8463. if (!is_band_valid(wiphy, request->rssi_adjust.band)) {
  8464. err = -EINVAL;
  8465. goto out_free;
  8466. }
  8467. }
  8468. err = nl80211_parse_sched_scan_plans(wiphy, n_plans, request, attrs);
  8469. if (err)
  8470. goto out_free;
  8471. request->scan_start = jiffies;
  8472. return request;
  8473. out_free:
  8474. kfree(request);
  8475. return ERR_PTR(err);
  8476. }
  8477. static int nl80211_start_sched_scan(struct sk_buff *skb,
  8478. struct genl_info *info)
  8479. {
  8480. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8481. struct net_device *dev = info->user_ptr[1];
  8482. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8483. struct cfg80211_sched_scan_request *sched_scan_req;
  8484. bool want_multi;
  8485. int err;
  8486. if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_start)
  8487. return -EOPNOTSUPP;
  8488. want_multi = info->attrs[NL80211_ATTR_SCHED_SCAN_MULTI];
  8489. err = cfg80211_sched_scan_req_possible(rdev, want_multi);
  8490. if (err)
  8491. return err;
  8492. sched_scan_req = nl80211_parse_sched_scan(&rdev->wiphy, wdev,
  8493. info->attrs,
  8494. rdev->wiphy.max_match_sets);
  8495. err = PTR_ERR_OR_ZERO(sched_scan_req);
  8496. if (err)
  8497. goto out_err;
  8498. /* leave request id zero for legacy request
  8499. * or if driver does not support multi-scheduled scan
  8500. */
  8501. if (want_multi && rdev->wiphy.max_sched_scan_reqs > 1)
  8502. sched_scan_req->reqid = cfg80211_assign_cookie(rdev);
  8503. err = rdev_sched_scan_start(rdev, dev, sched_scan_req);
  8504. if (err)
  8505. goto out_free;
  8506. sched_scan_req->dev = dev;
  8507. sched_scan_req->wiphy = &rdev->wiphy;
  8508. if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  8509. sched_scan_req->owner_nlportid = info->snd_portid;
  8510. cfg80211_add_sched_scan_req(rdev, sched_scan_req);
  8511. nl80211_send_sched_scan(sched_scan_req, NL80211_CMD_START_SCHED_SCAN);
  8512. return 0;
  8513. out_free:
  8514. kfree(sched_scan_req);
  8515. out_err:
  8516. return err;
  8517. }
  8518. static int nl80211_stop_sched_scan(struct sk_buff *skb,
  8519. struct genl_info *info)
  8520. {
  8521. struct cfg80211_sched_scan_request *req;
  8522. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8523. u64 cookie;
  8524. if (!rdev->wiphy.max_sched_scan_reqs || !rdev->ops->sched_scan_stop)
  8525. return -EOPNOTSUPP;
  8526. if (info->attrs[NL80211_ATTR_COOKIE]) {
  8527. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  8528. return __cfg80211_stop_sched_scan(rdev, cookie, false);
  8529. }
  8530. req = list_first_or_null_rcu(&rdev->sched_scan_req_list,
  8531. struct cfg80211_sched_scan_request,
  8532. list);
  8533. if (!req || req->reqid ||
  8534. (req->owner_nlportid &&
  8535. req->owner_nlportid != info->snd_portid))
  8536. return -ENOENT;
  8537. return cfg80211_stop_sched_scan_req(rdev, req, false);
  8538. }
  8539. static int nl80211_start_radar_detection(struct sk_buff *skb,
  8540. struct genl_info *info)
  8541. {
  8542. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8543. struct net_device *dev = info->user_ptr[1];
  8544. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8545. int link_id = nl80211_link_id(info->attrs);
  8546. struct wiphy *wiphy = wdev->wiphy;
  8547. struct cfg80211_chan_def chandef;
  8548. enum nl80211_dfs_regions dfs_region;
  8549. unsigned int cac_time_ms;
  8550. int err = -EINVAL;
  8551. flush_delayed_work(&rdev->dfs_update_channels_wk);
  8552. switch (wdev->iftype) {
  8553. case NL80211_IFTYPE_AP:
  8554. case NL80211_IFTYPE_P2P_GO:
  8555. case NL80211_IFTYPE_MESH_POINT:
  8556. case NL80211_IFTYPE_ADHOC:
  8557. break;
  8558. default:
  8559. /* caution - see cfg80211_beaconing_iface_active() below */
  8560. return -EINVAL;
  8561. }
  8562. wiphy_lock(wiphy);
  8563. dfs_region = reg_get_dfs_region(wiphy);
  8564. if (dfs_region == NL80211_DFS_UNSET)
  8565. goto unlock;
  8566. err = nl80211_parse_chandef(rdev, info, &chandef);
  8567. if (err)
  8568. goto unlock;
  8569. err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
  8570. if (err < 0)
  8571. goto unlock;
  8572. if (err == 0) {
  8573. err = -EINVAL;
  8574. goto unlock;
  8575. }
  8576. if (!cfg80211_chandef_dfs_usable(wiphy, &chandef)) {
  8577. err = -EINVAL;
  8578. goto unlock;
  8579. }
  8580. if (nla_get_flag(info->attrs[NL80211_ATTR_RADAR_BACKGROUND])) {
  8581. err = cfg80211_start_background_radar_detection(rdev, wdev,
  8582. &chandef);
  8583. goto unlock;
  8584. }
  8585. if (cfg80211_beaconing_iface_active(wdev)) {
  8586. /* During MLO other link(s) can beacon, only the current link
  8587. * can not already beacon
  8588. */
  8589. if (wdev->valid_links &&
  8590. !wdev->links[link_id].ap.beacon_interval) {
  8591. /* nothing */
  8592. } else {
  8593. err = -EBUSY;
  8594. goto unlock;
  8595. }
  8596. }
  8597. if (wdev->links[link_id].cac_started) {
  8598. err = -EBUSY;
  8599. goto unlock;
  8600. }
  8601. /* CAC start is offloaded to HW and can't be started manually */
  8602. if (wiphy_ext_feature_isset(wiphy, NL80211_EXT_FEATURE_DFS_OFFLOAD)) {
  8603. err = -EOPNOTSUPP;
  8604. goto unlock;
  8605. }
  8606. if (!rdev->ops->start_radar_detection) {
  8607. err = -EOPNOTSUPP;
  8608. goto unlock;
  8609. }
  8610. cac_time_ms = cfg80211_chandef_dfs_cac_time(&rdev->wiphy, &chandef);
  8611. if (WARN_ON(!cac_time_ms))
  8612. cac_time_ms = IEEE80211_DFS_MIN_CAC_TIME_MS;
  8613. err = rdev_start_radar_detection(rdev, dev, &chandef, cac_time_ms,
  8614. link_id);
  8615. if (!err) {
  8616. switch (wdev->iftype) {
  8617. case NL80211_IFTYPE_AP:
  8618. case NL80211_IFTYPE_P2P_GO:
  8619. wdev->links[0].ap.chandef = chandef;
  8620. break;
  8621. case NL80211_IFTYPE_ADHOC:
  8622. wdev->u.ibss.chandef = chandef;
  8623. break;
  8624. case NL80211_IFTYPE_MESH_POINT:
  8625. wdev->u.mesh.chandef = chandef;
  8626. break;
  8627. default:
  8628. break;
  8629. }
  8630. wdev->links[link_id].cac_started = true;
  8631. wdev->links[link_id].cac_start_time = jiffies;
  8632. wdev->links[link_id].cac_time_ms = cac_time_ms;
  8633. }
  8634. unlock:
  8635. wiphy_unlock(wiphy);
  8636. return err;
  8637. }
  8638. static int nl80211_notify_radar_detection(struct sk_buff *skb,
  8639. struct genl_info *info)
  8640. {
  8641. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8642. struct net_device *dev = info->user_ptr[1];
  8643. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8644. struct wiphy *wiphy = wdev->wiphy;
  8645. struct cfg80211_chan_def chandef;
  8646. enum nl80211_dfs_regions dfs_region;
  8647. int err;
  8648. dfs_region = reg_get_dfs_region(wiphy);
  8649. if (dfs_region == NL80211_DFS_UNSET) {
  8650. GENL_SET_ERR_MSG(info,
  8651. "DFS Region is not set. Unexpected Radar indication");
  8652. return -EINVAL;
  8653. }
  8654. err = nl80211_parse_chandef(rdev, info, &chandef);
  8655. if (err) {
  8656. GENL_SET_ERR_MSG(info, "Unable to extract chandef info");
  8657. return err;
  8658. }
  8659. err = cfg80211_chandef_dfs_required(wiphy, &chandef, wdev->iftype);
  8660. if (err < 0) {
  8661. GENL_SET_ERR_MSG(info, "chandef is invalid");
  8662. return err;
  8663. }
  8664. if (err == 0) {
  8665. GENL_SET_ERR_MSG(info,
  8666. "Unexpected Radar indication for chandef/iftype");
  8667. return -EINVAL;
  8668. }
  8669. /* Do not process this notification if radar is already detected
  8670. * by kernel on this channel, and return success.
  8671. */
  8672. if (chandef.chan->dfs_state == NL80211_DFS_UNAVAILABLE)
  8673. return 0;
  8674. cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_UNAVAILABLE);
  8675. cfg80211_sched_dfs_chan_update(rdev);
  8676. rdev->radar_chandef = chandef;
  8677. /* Propagate this notification to other radios as well */
  8678. queue_work(cfg80211_wq, &rdev->propagate_radar_detect_wk);
  8679. return 0;
  8680. }
  8681. static int nl80211_parse_counter_offsets(struct cfg80211_registered_device *rdev,
  8682. const u8 *data, size_t datalen,
  8683. int first_count, struct nlattr *attr,
  8684. const u16 **offsets, unsigned int *n_offsets)
  8685. {
  8686. int i;
  8687. *n_offsets = 0;
  8688. if (!attr)
  8689. return 0;
  8690. if (!nla_len(attr) || (nla_len(attr) % sizeof(u16)))
  8691. return -EINVAL;
  8692. *n_offsets = nla_len(attr) / sizeof(u16);
  8693. if (rdev->wiphy.max_num_csa_counters &&
  8694. (*n_offsets > rdev->wiphy.max_num_csa_counters))
  8695. return -EINVAL;
  8696. *offsets = nla_data(attr);
  8697. /* sanity checks - counters should fit and be the same */
  8698. for (i = 0; i < *n_offsets; i++) {
  8699. u16 offset = (*offsets)[i];
  8700. if (offset >= datalen)
  8701. return -EINVAL;
  8702. if (first_count != -1 && data[offset] != first_count)
  8703. return -EINVAL;
  8704. }
  8705. return 0;
  8706. }
  8707. static int nl80211_channel_switch(struct sk_buff *skb, struct genl_info *info)
  8708. {
  8709. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  8710. unsigned int link_id = nl80211_link_id(info->attrs);
  8711. struct net_device *dev = info->user_ptr[1];
  8712. struct wireless_dev *wdev = dev->ieee80211_ptr;
  8713. struct cfg80211_csa_settings params;
  8714. struct nlattr **csa_attrs = NULL;
  8715. int err;
  8716. bool need_new_beacon = false;
  8717. bool need_handle_dfs_flag = true;
  8718. u32 cs_count;
  8719. if (!rdev->ops->channel_switch ||
  8720. !(rdev->wiphy.flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH))
  8721. return -EOPNOTSUPP;
  8722. switch (dev->ieee80211_ptr->iftype) {
  8723. case NL80211_IFTYPE_AP:
  8724. case NL80211_IFTYPE_P2P_GO:
  8725. need_new_beacon = true;
  8726. /* For all modes except AP the handle_dfs flag needs to be
  8727. * supplied to tell the kernel that userspace will handle radar
  8728. * events when they happen. Otherwise a switch to a channel
  8729. * requiring DFS will be rejected.
  8730. */
  8731. need_handle_dfs_flag = false;
  8732. /* useless if AP is not running */
  8733. if (!wdev->links[link_id].ap.beacon_interval)
  8734. return -ENOTCONN;
  8735. break;
  8736. case NL80211_IFTYPE_ADHOC:
  8737. if (!wdev->u.ibss.ssid_len)
  8738. return -ENOTCONN;
  8739. break;
  8740. case NL80211_IFTYPE_MESH_POINT:
  8741. if (!wdev->u.mesh.id_len)
  8742. return -ENOTCONN;
  8743. break;
  8744. default:
  8745. return -EOPNOTSUPP;
  8746. }
  8747. memset(&params, 0, sizeof(params));
  8748. params.beacon_csa.ftm_responder = -1;
  8749. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  8750. !info->attrs[NL80211_ATTR_CH_SWITCH_COUNT])
  8751. return -EINVAL;
  8752. /* only important for AP, IBSS and mesh create IEs internally */
  8753. if (need_new_beacon && !info->attrs[NL80211_ATTR_CSA_IES])
  8754. return -EINVAL;
  8755. /* Even though the attribute is u32, the specification says
  8756. * u8, so let's make sure we don't overflow.
  8757. */
  8758. cs_count = nla_get_u32(info->attrs[NL80211_ATTR_CH_SWITCH_COUNT]);
  8759. if (cs_count > 255)
  8760. return -EINVAL;
  8761. params.count = cs_count;
  8762. if (!need_new_beacon)
  8763. goto skip_beacons;
  8764. err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_after,
  8765. info->extack);
  8766. if (err)
  8767. goto free;
  8768. csa_attrs = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*csa_attrs),
  8769. GFP_KERNEL);
  8770. if (!csa_attrs) {
  8771. err = -ENOMEM;
  8772. goto free;
  8773. }
  8774. err = nla_parse_nested_deprecated(csa_attrs, NL80211_ATTR_MAX,
  8775. info->attrs[NL80211_ATTR_CSA_IES],
  8776. nl80211_policy, info->extack);
  8777. if (err)
  8778. goto free;
  8779. err = nl80211_parse_beacon(rdev, csa_attrs, &params.beacon_csa,
  8780. info->extack);
  8781. if (err)
  8782. goto free;
  8783. if (!csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON]) {
  8784. err = -EINVAL;
  8785. goto free;
  8786. }
  8787. err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.tail,
  8788. params.beacon_csa.tail_len,
  8789. params.count,
  8790. csa_attrs[NL80211_ATTR_CNTDWN_OFFS_BEACON],
  8791. &params.counter_offsets_beacon,
  8792. &params.n_counter_offsets_beacon);
  8793. if (err)
  8794. goto free;
  8795. err = nl80211_parse_counter_offsets(rdev, params.beacon_csa.probe_resp,
  8796. params.beacon_csa.probe_resp_len,
  8797. params.count,
  8798. csa_attrs[NL80211_ATTR_CNTDWN_OFFS_PRESP],
  8799. &params.counter_offsets_presp,
  8800. &params.n_counter_offsets_presp);
  8801. if (err)
  8802. goto free;
  8803. skip_beacons:
  8804. err = nl80211_parse_chandef(rdev, info, &params.chandef);
  8805. if (err)
  8806. goto free;
  8807. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &params.chandef,
  8808. wdev->iftype)) {
  8809. err = -EINVAL;
  8810. goto free;
  8811. }
  8812. err = cfg80211_chandef_dfs_required(wdev->wiphy,
  8813. &params.chandef,
  8814. wdev->iftype);
  8815. if (err < 0)
  8816. goto free;
  8817. if (err > 0) {
  8818. params.radar_required = true;
  8819. if (need_handle_dfs_flag &&
  8820. !nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS])) {
  8821. err = -EINVAL;
  8822. goto free;
  8823. }
  8824. }
  8825. if (info->attrs[NL80211_ATTR_CH_SWITCH_BLOCK_TX])
  8826. params.block_tx = true;
  8827. params.link_id = link_id;
  8828. err = rdev_channel_switch(rdev, dev, &params);
  8829. free:
  8830. kfree(params.beacon_after.mbssid_ies);
  8831. kfree(params.beacon_csa.mbssid_ies);
  8832. kfree(params.beacon_after.rnr_ies);
  8833. kfree(params.beacon_csa.rnr_ies);
  8834. kfree(csa_attrs);
  8835. return err;
  8836. }
  8837. static int nl80211_send_bss(struct sk_buff *msg, struct netlink_callback *cb,
  8838. u32 seq, int flags,
  8839. struct cfg80211_registered_device *rdev,
  8840. struct wireless_dev *wdev,
  8841. struct cfg80211_internal_bss *intbss)
  8842. {
  8843. struct cfg80211_bss *res = &intbss->pub;
  8844. const struct cfg80211_bss_ies *ies;
  8845. unsigned int link_id;
  8846. void *hdr;
  8847. struct nlattr *bss;
  8848. lockdep_assert_wiphy(wdev->wiphy);
  8849. hdr = nl80211hdr_put(msg, NETLINK_CB(cb->skb).portid, seq, flags,
  8850. NL80211_CMD_NEW_SCAN_RESULTS);
  8851. if (!hdr)
  8852. return -1;
  8853. genl_dump_check_consistent(cb, hdr);
  8854. if (nla_put_u32(msg, NL80211_ATTR_GENERATION, rdev->bss_generation))
  8855. goto nla_put_failure;
  8856. if (wdev->netdev &&
  8857. nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex))
  8858. goto nla_put_failure;
  8859. if (nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  8860. NL80211_ATTR_PAD))
  8861. goto nla_put_failure;
  8862. bss = nla_nest_start_noflag(msg, NL80211_ATTR_BSS);
  8863. if (!bss)
  8864. goto nla_put_failure;
  8865. if ((!is_zero_ether_addr(res->bssid) &&
  8866. nla_put(msg, NL80211_BSS_BSSID, ETH_ALEN, res->bssid)))
  8867. goto nla_put_failure;
  8868. rcu_read_lock();
  8869. /* indicate whether we have probe response data or not */
  8870. if (rcu_access_pointer(res->proberesp_ies) &&
  8871. nla_put_flag(msg, NL80211_BSS_PRESP_DATA))
  8872. goto fail_unlock_rcu;
  8873. /* this pointer prefers to be pointed to probe response data
  8874. * but is always valid
  8875. */
  8876. ies = rcu_dereference(res->ies);
  8877. if (ies) {
  8878. if (nla_put_u64_64bit(msg, NL80211_BSS_TSF, ies->tsf,
  8879. NL80211_BSS_PAD))
  8880. goto fail_unlock_rcu;
  8881. if (ies->len && nla_put(msg, NL80211_BSS_INFORMATION_ELEMENTS,
  8882. ies->len, ies->data))
  8883. goto fail_unlock_rcu;
  8884. }
  8885. /* and this pointer is always (unless driver didn't know) beacon data */
  8886. ies = rcu_dereference(res->beacon_ies);
  8887. if (ies && ies->from_beacon) {
  8888. if (nla_put_u64_64bit(msg, NL80211_BSS_BEACON_TSF, ies->tsf,
  8889. NL80211_BSS_PAD))
  8890. goto fail_unlock_rcu;
  8891. if (ies->len && nla_put(msg, NL80211_BSS_BEACON_IES,
  8892. ies->len, ies->data))
  8893. goto fail_unlock_rcu;
  8894. }
  8895. rcu_read_unlock();
  8896. if (res->beacon_interval &&
  8897. nla_put_u16(msg, NL80211_BSS_BEACON_INTERVAL, res->beacon_interval))
  8898. goto nla_put_failure;
  8899. if (nla_put_u16(msg, NL80211_BSS_CAPABILITY, res->capability) ||
  8900. nla_put_u32(msg, NL80211_BSS_FREQUENCY, res->channel->center_freq) ||
  8901. nla_put_u32(msg, NL80211_BSS_FREQUENCY_OFFSET,
  8902. res->channel->freq_offset) ||
  8903. nla_put_u32(msg, NL80211_BSS_SEEN_MS_AGO,
  8904. jiffies_to_msecs(jiffies - intbss->ts)))
  8905. goto nla_put_failure;
  8906. if (intbss->parent_tsf &&
  8907. (nla_put_u64_64bit(msg, NL80211_BSS_PARENT_TSF,
  8908. intbss->parent_tsf, NL80211_BSS_PAD) ||
  8909. nla_put(msg, NL80211_BSS_PARENT_BSSID, ETH_ALEN,
  8910. intbss->parent_bssid)))
  8911. goto nla_put_failure;
  8912. if (intbss->ts_boottime &&
  8913. nla_put_u64_64bit(msg, NL80211_BSS_LAST_SEEN_BOOTTIME,
  8914. intbss->ts_boottime, NL80211_BSS_PAD))
  8915. goto nla_put_failure;
  8916. if (!nl80211_put_signal(msg, intbss->pub.chains,
  8917. intbss->pub.chain_signal,
  8918. NL80211_BSS_CHAIN_SIGNAL))
  8919. goto nla_put_failure;
  8920. if (intbss->bss_source != BSS_SOURCE_STA_PROFILE) {
  8921. switch (rdev->wiphy.signal_type) {
  8922. case CFG80211_SIGNAL_TYPE_MBM:
  8923. if (nla_put_u32(msg, NL80211_BSS_SIGNAL_MBM,
  8924. res->signal))
  8925. goto nla_put_failure;
  8926. break;
  8927. case CFG80211_SIGNAL_TYPE_UNSPEC:
  8928. if (nla_put_u8(msg, NL80211_BSS_SIGNAL_UNSPEC,
  8929. res->signal))
  8930. goto nla_put_failure;
  8931. break;
  8932. default:
  8933. break;
  8934. }
  8935. }
  8936. switch (wdev->iftype) {
  8937. case NL80211_IFTYPE_P2P_CLIENT:
  8938. case NL80211_IFTYPE_STATION:
  8939. for_each_valid_link(wdev, link_id) {
  8940. if (intbss == wdev->links[link_id].client.current_bss &&
  8941. (nla_put_u32(msg, NL80211_BSS_STATUS,
  8942. NL80211_BSS_STATUS_ASSOCIATED) ||
  8943. (wdev->valid_links &&
  8944. (nla_put_u8(msg, NL80211_BSS_MLO_LINK_ID,
  8945. link_id) ||
  8946. nla_put(msg, NL80211_BSS_MLD_ADDR, ETH_ALEN,
  8947. wdev->u.client.connected_addr)))))
  8948. goto nla_put_failure;
  8949. }
  8950. break;
  8951. case NL80211_IFTYPE_ADHOC:
  8952. if (intbss == wdev->u.ibss.current_bss &&
  8953. nla_put_u32(msg, NL80211_BSS_STATUS,
  8954. NL80211_BSS_STATUS_IBSS_JOINED))
  8955. goto nla_put_failure;
  8956. break;
  8957. default:
  8958. break;
  8959. }
  8960. if (nla_put_u32(msg, NL80211_BSS_USE_FOR, res->use_for))
  8961. goto nla_put_failure;
  8962. if (res->cannot_use_reasons &&
  8963. nla_put_u64_64bit(msg, NL80211_BSS_CANNOT_USE_REASONS,
  8964. res->cannot_use_reasons,
  8965. NL80211_BSS_PAD))
  8966. goto nla_put_failure;
  8967. nla_nest_end(msg, bss);
  8968. genlmsg_end(msg, hdr);
  8969. return 0;
  8970. fail_unlock_rcu:
  8971. rcu_read_unlock();
  8972. nla_put_failure:
  8973. genlmsg_cancel(msg, hdr);
  8974. return -EMSGSIZE;
  8975. }
  8976. static int nl80211_dump_scan(struct sk_buff *skb, struct netlink_callback *cb)
  8977. {
  8978. struct cfg80211_registered_device *rdev;
  8979. struct cfg80211_internal_bss *scan;
  8980. struct wireless_dev *wdev;
  8981. struct nlattr **attrbuf;
  8982. int start = cb->args[2], idx = 0;
  8983. bool dump_include_use_data;
  8984. int err;
  8985. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
  8986. if (!attrbuf)
  8987. return -ENOMEM;
  8988. err = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf);
  8989. if (err) {
  8990. kfree(attrbuf);
  8991. return err;
  8992. }
  8993. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  8994. __acquire(&rdev->wiphy.mtx);
  8995. dump_include_use_data =
  8996. attrbuf[NL80211_ATTR_BSS_DUMP_INCLUDE_USE_DATA];
  8997. kfree(attrbuf);
  8998. spin_lock_bh(&rdev->bss_lock);
  8999. /*
  9000. * dump_scan will be called multiple times to break up the scan results
  9001. * into multiple messages. It is unlikely that any more bss-es will be
  9002. * expired after the first call, so only call only call this on the
  9003. * first dump_scan invocation.
  9004. */
  9005. if (start == 0)
  9006. cfg80211_bss_expire(rdev);
  9007. cb->seq = rdev->bss_generation;
  9008. list_for_each_entry(scan, &rdev->bss_list, list) {
  9009. if (++idx <= start)
  9010. continue;
  9011. if (!dump_include_use_data &&
  9012. !(scan->pub.use_for & NL80211_BSS_USE_FOR_NORMAL))
  9013. continue;
  9014. if (nl80211_send_bss(skb, cb,
  9015. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  9016. rdev, wdev, scan) < 0) {
  9017. idx--;
  9018. break;
  9019. }
  9020. }
  9021. spin_unlock_bh(&rdev->bss_lock);
  9022. cb->args[2] = idx;
  9023. wiphy_unlock(&rdev->wiphy);
  9024. return skb->len;
  9025. }
  9026. static int nl80211_send_survey(struct sk_buff *msg, u32 portid, u32 seq,
  9027. int flags, struct net_device *dev,
  9028. bool allow_radio_stats,
  9029. struct survey_info *survey)
  9030. {
  9031. void *hdr;
  9032. struct nlattr *infoattr;
  9033. /* skip radio stats if userspace didn't request them */
  9034. if (!survey->channel && !allow_radio_stats)
  9035. return 0;
  9036. hdr = nl80211hdr_put(msg, portid, seq, flags,
  9037. NL80211_CMD_NEW_SURVEY_RESULTS);
  9038. if (!hdr)
  9039. return -ENOMEM;
  9040. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  9041. goto nla_put_failure;
  9042. infoattr = nla_nest_start_noflag(msg, NL80211_ATTR_SURVEY_INFO);
  9043. if (!infoattr)
  9044. goto nla_put_failure;
  9045. if (survey->channel &&
  9046. nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY,
  9047. survey->channel->center_freq))
  9048. goto nla_put_failure;
  9049. if (survey->channel && survey->channel->freq_offset &&
  9050. nla_put_u32(msg, NL80211_SURVEY_INFO_FREQUENCY_OFFSET,
  9051. survey->channel->freq_offset))
  9052. goto nla_put_failure;
  9053. if ((survey->filled & SURVEY_INFO_NOISE_DBM) &&
  9054. nla_put_u8(msg, NL80211_SURVEY_INFO_NOISE, survey->noise))
  9055. goto nla_put_failure;
  9056. if ((survey->filled & SURVEY_INFO_IN_USE) &&
  9057. nla_put_flag(msg, NL80211_SURVEY_INFO_IN_USE))
  9058. goto nla_put_failure;
  9059. if ((survey->filled & SURVEY_INFO_TIME) &&
  9060. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME,
  9061. survey->time, NL80211_SURVEY_INFO_PAD))
  9062. goto nla_put_failure;
  9063. if ((survey->filled & SURVEY_INFO_TIME_BUSY) &&
  9064. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BUSY,
  9065. survey->time_busy, NL80211_SURVEY_INFO_PAD))
  9066. goto nla_put_failure;
  9067. if ((survey->filled & SURVEY_INFO_TIME_EXT_BUSY) &&
  9068. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_EXT_BUSY,
  9069. survey->time_ext_busy, NL80211_SURVEY_INFO_PAD))
  9070. goto nla_put_failure;
  9071. if ((survey->filled & SURVEY_INFO_TIME_RX) &&
  9072. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_RX,
  9073. survey->time_rx, NL80211_SURVEY_INFO_PAD))
  9074. goto nla_put_failure;
  9075. if ((survey->filled & SURVEY_INFO_TIME_TX) &&
  9076. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_TX,
  9077. survey->time_tx, NL80211_SURVEY_INFO_PAD))
  9078. goto nla_put_failure;
  9079. if ((survey->filled & SURVEY_INFO_TIME_SCAN) &&
  9080. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_SCAN,
  9081. survey->time_scan, NL80211_SURVEY_INFO_PAD))
  9082. goto nla_put_failure;
  9083. if ((survey->filled & SURVEY_INFO_TIME_BSS_RX) &&
  9084. nla_put_u64_64bit(msg, NL80211_SURVEY_INFO_TIME_BSS_RX,
  9085. survey->time_bss_rx, NL80211_SURVEY_INFO_PAD))
  9086. goto nla_put_failure;
  9087. nla_nest_end(msg, infoattr);
  9088. genlmsg_end(msg, hdr);
  9089. return 0;
  9090. nla_put_failure:
  9091. genlmsg_cancel(msg, hdr);
  9092. return -EMSGSIZE;
  9093. }
  9094. static int nl80211_dump_survey(struct sk_buff *skb, struct netlink_callback *cb)
  9095. {
  9096. struct nlattr **attrbuf;
  9097. struct survey_info survey;
  9098. struct cfg80211_registered_device *rdev;
  9099. struct wireless_dev *wdev;
  9100. int survey_idx = cb->args[2];
  9101. int res;
  9102. bool radio_stats;
  9103. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
  9104. if (!attrbuf)
  9105. return -ENOMEM;
  9106. res = nl80211_prepare_wdev_dump(cb, &rdev, &wdev, attrbuf);
  9107. if (res) {
  9108. kfree(attrbuf);
  9109. return res;
  9110. }
  9111. /* nl80211_prepare_wdev_dump acquired it in the successful case */
  9112. __acquire(&rdev->wiphy.mtx);
  9113. /* prepare_wdev_dump parsed the attributes */
  9114. radio_stats = attrbuf[NL80211_ATTR_SURVEY_RADIO_STATS];
  9115. if (!wdev->netdev) {
  9116. res = -EINVAL;
  9117. goto out_err;
  9118. }
  9119. if (!rdev->ops->dump_survey) {
  9120. res = -EOPNOTSUPP;
  9121. goto out_err;
  9122. }
  9123. while (1) {
  9124. res = rdev_dump_survey(rdev, wdev->netdev, survey_idx, &survey);
  9125. if (res == -ENOENT)
  9126. break;
  9127. if (res)
  9128. goto out_err;
  9129. /* don't send disabled channels, but do send non-channel data */
  9130. if (survey.channel &&
  9131. survey.channel->flags & IEEE80211_CHAN_DISABLED) {
  9132. survey_idx++;
  9133. continue;
  9134. }
  9135. if (nl80211_send_survey(skb,
  9136. NETLINK_CB(cb->skb).portid,
  9137. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  9138. wdev->netdev, radio_stats, &survey) < 0)
  9139. goto out;
  9140. survey_idx++;
  9141. }
  9142. out:
  9143. cb->args[2] = survey_idx;
  9144. res = skb->len;
  9145. out_err:
  9146. kfree(attrbuf);
  9147. wiphy_unlock(&rdev->wiphy);
  9148. return res;
  9149. }
  9150. static int nl80211_authenticate(struct sk_buff *skb, struct genl_info *info)
  9151. {
  9152. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9153. struct net_device *dev = info->user_ptr[1];
  9154. struct ieee80211_channel *chan;
  9155. const u8 *bssid, *ssid;
  9156. int err, ssid_len;
  9157. enum nl80211_auth_type auth_type;
  9158. struct key_parse key;
  9159. bool local_state_change;
  9160. struct cfg80211_auth_request req = {};
  9161. u32 freq;
  9162. if (!info->attrs[NL80211_ATTR_MAC])
  9163. return -EINVAL;
  9164. if (!info->attrs[NL80211_ATTR_AUTH_TYPE])
  9165. return -EINVAL;
  9166. if (!info->attrs[NL80211_ATTR_SSID])
  9167. return -EINVAL;
  9168. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  9169. return -EINVAL;
  9170. err = nl80211_parse_key(info, &key);
  9171. if (err)
  9172. return err;
  9173. if (key.idx >= 0) {
  9174. if (key.type != -1 && key.type != NL80211_KEYTYPE_GROUP)
  9175. return -EINVAL;
  9176. if (!key.p.key || !key.p.key_len)
  9177. return -EINVAL;
  9178. if ((key.p.cipher != WLAN_CIPHER_SUITE_WEP40 ||
  9179. key.p.key_len != WLAN_KEY_LEN_WEP40) &&
  9180. (key.p.cipher != WLAN_CIPHER_SUITE_WEP104 ||
  9181. key.p.key_len != WLAN_KEY_LEN_WEP104))
  9182. return -EINVAL;
  9183. if (key.idx > 3)
  9184. return -EINVAL;
  9185. } else {
  9186. key.p.key_len = 0;
  9187. key.p.key = NULL;
  9188. }
  9189. if (key.idx >= 0) {
  9190. int i;
  9191. bool ok = false;
  9192. for (i = 0; i < rdev->wiphy.n_cipher_suites; i++) {
  9193. if (key.p.cipher == rdev->wiphy.cipher_suites[i]) {
  9194. ok = true;
  9195. break;
  9196. }
  9197. }
  9198. if (!ok)
  9199. return -EINVAL;
  9200. }
  9201. if (!rdev->ops->auth)
  9202. return -EOPNOTSUPP;
  9203. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  9204. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  9205. return -EOPNOTSUPP;
  9206. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9207. freq = MHZ_TO_KHZ(nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  9208. if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
  9209. freq +=
  9210. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
  9211. chan = nl80211_get_valid_chan(&rdev->wiphy, freq);
  9212. if (!chan)
  9213. return -EINVAL;
  9214. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  9215. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  9216. if (info->attrs[NL80211_ATTR_IE]) {
  9217. req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9218. req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9219. }
  9220. auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  9221. if (!nl80211_valid_auth_type(rdev, auth_type, NL80211_CMD_AUTHENTICATE))
  9222. return -EINVAL;
  9223. if ((auth_type == NL80211_AUTHTYPE_SAE ||
  9224. auth_type == NL80211_AUTHTYPE_FILS_SK ||
  9225. auth_type == NL80211_AUTHTYPE_FILS_SK_PFS ||
  9226. auth_type == NL80211_AUTHTYPE_FILS_PK) &&
  9227. !info->attrs[NL80211_ATTR_AUTH_DATA])
  9228. return -EINVAL;
  9229. if (info->attrs[NL80211_ATTR_AUTH_DATA]) {
  9230. if (auth_type != NL80211_AUTHTYPE_SAE &&
  9231. auth_type != NL80211_AUTHTYPE_FILS_SK &&
  9232. auth_type != NL80211_AUTHTYPE_FILS_SK_PFS &&
  9233. auth_type != NL80211_AUTHTYPE_FILS_PK)
  9234. return -EINVAL;
  9235. req.auth_data = nla_data(info->attrs[NL80211_ATTR_AUTH_DATA]);
  9236. req.auth_data_len = nla_len(info->attrs[NL80211_ATTR_AUTH_DATA]);
  9237. }
  9238. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  9239. /*
  9240. * Since we no longer track auth state, ignore
  9241. * requests to only change local state.
  9242. */
  9243. if (local_state_change)
  9244. return 0;
  9245. req.auth_type = auth_type;
  9246. req.key = key.p.key;
  9247. req.key_len = key.p.key_len;
  9248. req.key_idx = key.idx;
  9249. req.link_id = nl80211_link_id_or_invalid(info->attrs);
  9250. if (req.link_id >= 0) {
  9251. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO))
  9252. return -EINVAL;
  9253. if (!info->attrs[NL80211_ATTR_MLD_ADDR])
  9254. return -EINVAL;
  9255. req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  9256. if (!is_valid_ether_addr(req.ap_mld_addr))
  9257. return -EINVAL;
  9258. }
  9259. req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
  9260. IEEE80211_BSS_TYPE_ESS,
  9261. IEEE80211_PRIVACY_ANY);
  9262. if (!req.bss)
  9263. return -ENOENT;
  9264. err = cfg80211_mlme_auth(rdev, dev, &req);
  9265. cfg80211_put_bss(&rdev->wiphy, req.bss);
  9266. return err;
  9267. }
  9268. static int validate_pae_over_nl80211(struct cfg80211_registered_device *rdev,
  9269. struct genl_info *info)
  9270. {
  9271. if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  9272. GENL_SET_ERR_MSG(info, "SOCKET_OWNER not set");
  9273. return -EINVAL;
  9274. }
  9275. if (!rdev->ops->tx_control_port ||
  9276. !wiphy_ext_feature_isset(&rdev->wiphy,
  9277. NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
  9278. return -EOPNOTSUPP;
  9279. return 0;
  9280. }
  9281. static int nl80211_crypto_settings(struct cfg80211_registered_device *rdev,
  9282. struct genl_info *info,
  9283. struct cfg80211_crypto_settings *settings,
  9284. int cipher_limit)
  9285. {
  9286. memset(settings, 0, sizeof(*settings));
  9287. settings->control_port = info->attrs[NL80211_ATTR_CONTROL_PORT];
  9288. if (info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
  9289. u16 proto;
  9290. proto = nla_get_u16(
  9291. info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
  9292. settings->control_port_ethertype = cpu_to_be16(proto);
  9293. if (!(rdev->wiphy.flags & WIPHY_FLAG_CONTROL_PORT_PROTOCOL) &&
  9294. proto != ETH_P_PAE)
  9295. return -EINVAL;
  9296. if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT])
  9297. settings->control_port_no_encrypt = true;
  9298. } else
  9299. settings->control_port_ethertype = cpu_to_be16(ETH_P_PAE);
  9300. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  9301. int r = validate_pae_over_nl80211(rdev, info);
  9302. if (r < 0)
  9303. return r;
  9304. settings->control_port_over_nl80211 = true;
  9305. if (info->attrs[NL80211_ATTR_CONTROL_PORT_NO_PREAUTH])
  9306. settings->control_port_no_preauth = true;
  9307. }
  9308. if (info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]) {
  9309. void *data;
  9310. int len, i;
  9311. data = nla_data(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  9312. len = nla_len(info->attrs[NL80211_ATTR_CIPHER_SUITES_PAIRWISE]);
  9313. settings->n_ciphers_pairwise = len / sizeof(u32);
  9314. if (len % sizeof(u32))
  9315. return -EINVAL;
  9316. if (settings->n_ciphers_pairwise > cipher_limit)
  9317. return -EINVAL;
  9318. memcpy(settings->ciphers_pairwise, data, len);
  9319. for (i = 0; i < settings->n_ciphers_pairwise; i++)
  9320. if (!cfg80211_supported_cipher_suite(
  9321. &rdev->wiphy,
  9322. settings->ciphers_pairwise[i]))
  9323. return -EINVAL;
  9324. }
  9325. if (info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]) {
  9326. settings->cipher_group =
  9327. nla_get_u32(info->attrs[NL80211_ATTR_CIPHER_SUITE_GROUP]);
  9328. if (!cfg80211_supported_cipher_suite(&rdev->wiphy,
  9329. settings->cipher_group))
  9330. return -EINVAL;
  9331. }
  9332. if (info->attrs[NL80211_ATTR_WPA_VERSIONS])
  9333. settings->wpa_versions =
  9334. nla_get_u32(info->attrs[NL80211_ATTR_WPA_VERSIONS]);
  9335. if (info->attrs[NL80211_ATTR_AKM_SUITES]) {
  9336. void *data;
  9337. int len;
  9338. data = nla_data(info->attrs[NL80211_ATTR_AKM_SUITES]);
  9339. len = nla_len(info->attrs[NL80211_ATTR_AKM_SUITES]);
  9340. settings->n_akm_suites = len / sizeof(u32);
  9341. if (len % sizeof(u32))
  9342. return -EINVAL;
  9343. if (settings->n_akm_suites > rdev->wiphy.max_num_akm_suites)
  9344. return -EINVAL;
  9345. memcpy(settings->akm_suites, data, len);
  9346. }
  9347. if (info->attrs[NL80211_ATTR_PMK]) {
  9348. if (nla_len(info->attrs[NL80211_ATTR_PMK]) != WLAN_PMK_LEN)
  9349. return -EINVAL;
  9350. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  9351. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_PSK) &&
  9352. !wiphy_ext_feature_isset(&rdev->wiphy,
  9353. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_AP_PSK))
  9354. return -EINVAL;
  9355. settings->psk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  9356. }
  9357. if (info->attrs[NL80211_ATTR_SAE_PASSWORD]) {
  9358. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  9359. NL80211_EXT_FEATURE_SAE_OFFLOAD) &&
  9360. !wiphy_ext_feature_isset(&rdev->wiphy,
  9361. NL80211_EXT_FEATURE_SAE_OFFLOAD_AP))
  9362. return -EINVAL;
  9363. settings->sae_pwd =
  9364. nla_data(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
  9365. settings->sae_pwd_len =
  9366. nla_len(info->attrs[NL80211_ATTR_SAE_PASSWORD]);
  9367. }
  9368. if (info->attrs[NL80211_ATTR_SAE_PWE])
  9369. settings->sae_pwe =
  9370. nla_get_u8(info->attrs[NL80211_ATTR_SAE_PWE]);
  9371. else
  9372. settings->sae_pwe = NL80211_SAE_PWE_UNSPECIFIED;
  9373. return 0;
  9374. }
  9375. static struct cfg80211_bss *nl80211_assoc_bss(struct cfg80211_registered_device *rdev,
  9376. const u8 *ssid, int ssid_len,
  9377. struct nlattr **attrs,
  9378. int assoc_link_id, int link_id)
  9379. {
  9380. struct ieee80211_channel *chan;
  9381. struct cfg80211_bss *bss;
  9382. const u8 *bssid;
  9383. u32 freq, use_for = 0;
  9384. if (!attrs[NL80211_ATTR_MAC] || !attrs[NL80211_ATTR_WIPHY_FREQ])
  9385. return ERR_PTR(-EINVAL);
  9386. bssid = nla_data(attrs[NL80211_ATTR_MAC]);
  9387. freq = MHZ_TO_KHZ(nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ]));
  9388. if (attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
  9389. freq += nla_get_u32(attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
  9390. chan = nl80211_get_valid_chan(&rdev->wiphy, freq);
  9391. if (!chan)
  9392. return ERR_PTR(-EINVAL);
  9393. if (assoc_link_id >= 0)
  9394. use_for = NL80211_BSS_USE_FOR_MLD_LINK;
  9395. if (assoc_link_id == link_id)
  9396. use_for |= NL80211_BSS_USE_FOR_NORMAL;
  9397. bss = __cfg80211_get_bss(&rdev->wiphy, chan, bssid,
  9398. ssid, ssid_len,
  9399. IEEE80211_BSS_TYPE_ESS,
  9400. IEEE80211_PRIVACY_ANY,
  9401. use_for);
  9402. if (!bss)
  9403. return ERR_PTR(-ENOENT);
  9404. return bss;
  9405. }
  9406. static int nl80211_associate(struct sk_buff *skb, struct genl_info *info)
  9407. {
  9408. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9409. struct net_device *dev = info->user_ptr[1];
  9410. struct cfg80211_assoc_request req = {};
  9411. struct nlattr **attrs = NULL;
  9412. const u8 *ap_addr, *ssid;
  9413. unsigned int link_id;
  9414. int err, ssid_len;
  9415. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  9416. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  9417. return -EPERM;
  9418. if (!info->attrs[NL80211_ATTR_SSID])
  9419. return -EINVAL;
  9420. if (!rdev->ops->assoc)
  9421. return -EOPNOTSUPP;
  9422. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  9423. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  9424. return -EOPNOTSUPP;
  9425. ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  9426. ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  9427. if (info->attrs[NL80211_ATTR_IE]) {
  9428. req.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9429. req.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9430. if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE,
  9431. req.ie, req.ie_len)) {
  9432. NL_SET_ERR_MSG_ATTR(info->extack,
  9433. info->attrs[NL80211_ATTR_IE],
  9434. "non-inheritance makes no sense");
  9435. return -EINVAL;
  9436. }
  9437. }
  9438. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  9439. enum nl80211_mfp mfp =
  9440. nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  9441. if (mfp == NL80211_MFP_REQUIRED)
  9442. req.use_mfp = true;
  9443. else if (mfp != NL80211_MFP_NO)
  9444. return -EINVAL;
  9445. }
  9446. if (info->attrs[NL80211_ATTR_PREV_BSSID])
  9447. req.prev_bssid = nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
  9448. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
  9449. req.flags |= ASSOC_REQ_DISABLE_HT;
  9450. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9451. memcpy(&req.ht_capa_mask,
  9452. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  9453. sizeof(req.ht_capa_mask));
  9454. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  9455. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9456. return -EINVAL;
  9457. memcpy(&req.ht_capa,
  9458. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  9459. sizeof(req.ht_capa));
  9460. }
  9461. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
  9462. req.flags |= ASSOC_REQ_DISABLE_VHT;
  9463. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE]))
  9464. req.flags |= ASSOC_REQ_DISABLE_HE;
  9465. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT]))
  9466. req.flags |= ASSOC_REQ_DISABLE_EHT;
  9467. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  9468. memcpy(&req.vht_capa_mask,
  9469. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
  9470. sizeof(req.vht_capa_mask));
  9471. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
  9472. if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  9473. return -EINVAL;
  9474. memcpy(&req.vht_capa,
  9475. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
  9476. sizeof(req.vht_capa));
  9477. }
  9478. if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
  9479. if (!((rdev->wiphy.features &
  9480. NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
  9481. (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
  9482. !wiphy_ext_feature_isset(&rdev->wiphy,
  9483. NL80211_EXT_FEATURE_RRM))
  9484. return -EINVAL;
  9485. req.flags |= ASSOC_REQ_USE_RRM;
  9486. }
  9487. if (info->attrs[NL80211_ATTR_FILS_KEK]) {
  9488. req.fils_kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
  9489. req.fils_kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
  9490. if (!info->attrs[NL80211_ATTR_FILS_NONCES])
  9491. return -EINVAL;
  9492. req.fils_nonces =
  9493. nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
  9494. }
  9495. if (info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]) {
  9496. if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY])
  9497. return -EINVAL;
  9498. memcpy(&req.s1g_capa_mask,
  9499. nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK]),
  9500. sizeof(req.s1g_capa_mask));
  9501. }
  9502. if (info->attrs[NL80211_ATTR_S1G_CAPABILITY]) {
  9503. if (!info->attrs[NL80211_ATTR_S1G_CAPABILITY_MASK])
  9504. return -EINVAL;
  9505. memcpy(&req.s1g_capa,
  9506. nla_data(info->attrs[NL80211_ATTR_S1G_CAPABILITY]),
  9507. sizeof(req.s1g_capa));
  9508. }
  9509. if (nla_get_flag(info->attrs[NL80211_ATTR_ASSOC_SPP_AMSDU])) {
  9510. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  9511. NL80211_EXT_FEATURE_SPP_AMSDU_SUPPORT)) {
  9512. GENL_SET_ERR_MSG(info, "SPP A-MSDUs not supported");
  9513. return -EINVAL;
  9514. }
  9515. req.flags |= ASSOC_REQ_SPP_AMSDU;
  9516. }
  9517. req.link_id = nl80211_link_id_or_invalid(info->attrs);
  9518. if (info->attrs[NL80211_ATTR_MLO_LINKS]) {
  9519. unsigned int attrsize = NUM_NL80211_ATTR * sizeof(*attrs);
  9520. struct nlattr *link;
  9521. int rem = 0;
  9522. if (req.link_id < 0)
  9523. return -EINVAL;
  9524. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_MLO))
  9525. return -EINVAL;
  9526. if (info->attrs[NL80211_ATTR_MAC] ||
  9527. info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  9528. !info->attrs[NL80211_ATTR_MLD_ADDR])
  9529. return -EINVAL;
  9530. req.ap_mld_addr = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  9531. ap_addr = req.ap_mld_addr;
  9532. attrs = kzalloc(attrsize, GFP_KERNEL);
  9533. if (!attrs)
  9534. return -ENOMEM;
  9535. nla_for_each_nested(link,
  9536. info->attrs[NL80211_ATTR_MLO_LINKS],
  9537. rem) {
  9538. memset(attrs, 0, attrsize);
  9539. nla_parse_nested(attrs, NL80211_ATTR_MAX,
  9540. link, NULL, NULL);
  9541. if (!attrs[NL80211_ATTR_MLO_LINK_ID]) {
  9542. err = -EINVAL;
  9543. NL_SET_BAD_ATTR(info->extack, link);
  9544. goto free;
  9545. }
  9546. link_id = nla_get_u8(attrs[NL80211_ATTR_MLO_LINK_ID]);
  9547. /* cannot use the same link ID again */
  9548. if (req.links[link_id].bss) {
  9549. err = -EINVAL;
  9550. NL_SET_BAD_ATTR(info->extack, link);
  9551. goto free;
  9552. }
  9553. req.links[link_id].bss =
  9554. nl80211_assoc_bss(rdev, ssid, ssid_len, attrs,
  9555. req.link_id, link_id);
  9556. if (IS_ERR(req.links[link_id].bss)) {
  9557. err = PTR_ERR(req.links[link_id].bss);
  9558. req.links[link_id].bss = NULL;
  9559. NL_SET_ERR_MSG_ATTR(info->extack,
  9560. link, "Error fetching BSS for link");
  9561. goto free;
  9562. }
  9563. if (attrs[NL80211_ATTR_IE]) {
  9564. req.links[link_id].elems =
  9565. nla_data(attrs[NL80211_ATTR_IE]);
  9566. req.links[link_id].elems_len =
  9567. nla_len(attrs[NL80211_ATTR_IE]);
  9568. if (cfg80211_find_elem(WLAN_EID_FRAGMENT,
  9569. req.links[link_id].elems,
  9570. req.links[link_id].elems_len)) {
  9571. NL_SET_ERR_MSG_ATTR(info->extack,
  9572. attrs[NL80211_ATTR_IE],
  9573. "cannot deal with fragmentation");
  9574. err = -EINVAL;
  9575. goto free;
  9576. }
  9577. if (cfg80211_find_ext_elem(WLAN_EID_EXT_NON_INHERITANCE,
  9578. req.links[link_id].elems,
  9579. req.links[link_id].elems_len)) {
  9580. NL_SET_ERR_MSG_ATTR(info->extack,
  9581. attrs[NL80211_ATTR_IE],
  9582. "cannot deal with non-inheritance");
  9583. err = -EINVAL;
  9584. goto free;
  9585. }
  9586. }
  9587. req.links[link_id].disabled =
  9588. nla_get_flag(attrs[NL80211_ATTR_MLO_LINK_DISABLED]);
  9589. }
  9590. if (!req.links[req.link_id].bss) {
  9591. err = -EINVAL;
  9592. goto free;
  9593. }
  9594. if (req.links[req.link_id].elems_len) {
  9595. GENL_SET_ERR_MSG(info,
  9596. "cannot have per-link elems on assoc link");
  9597. err = -EINVAL;
  9598. goto free;
  9599. }
  9600. if (req.links[req.link_id].disabled) {
  9601. GENL_SET_ERR_MSG(info,
  9602. "cannot have assoc link disabled");
  9603. err = -EINVAL;
  9604. goto free;
  9605. }
  9606. kfree(attrs);
  9607. attrs = NULL;
  9608. } else {
  9609. if (req.link_id >= 0)
  9610. return -EINVAL;
  9611. req.bss = nl80211_assoc_bss(rdev, ssid, ssid_len, info->attrs,
  9612. -1, -1);
  9613. if (IS_ERR(req.bss))
  9614. return PTR_ERR(req.bss);
  9615. ap_addr = req.bss->bssid;
  9616. }
  9617. err = nl80211_crypto_settings(rdev, info, &req.crypto, 1);
  9618. if (!err) {
  9619. struct nlattr *link;
  9620. int rem = 0;
  9621. err = cfg80211_mlme_assoc(rdev, dev, &req,
  9622. info->extack);
  9623. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  9624. dev->ieee80211_ptr->conn_owner_nlportid =
  9625. info->snd_portid;
  9626. memcpy(dev->ieee80211_ptr->disconnect_bssid,
  9627. ap_addr, ETH_ALEN);
  9628. }
  9629. /* Report error from first problematic link */
  9630. if (info->attrs[NL80211_ATTR_MLO_LINKS]) {
  9631. nla_for_each_nested(link,
  9632. info->attrs[NL80211_ATTR_MLO_LINKS],
  9633. rem) {
  9634. struct nlattr *link_id_attr =
  9635. nla_find_nested(link, NL80211_ATTR_MLO_LINK_ID);
  9636. if (!link_id_attr)
  9637. continue;
  9638. link_id = nla_get_u8(link_id_attr);
  9639. if (link_id == req.link_id)
  9640. continue;
  9641. if (!req.links[link_id].error ||
  9642. WARN_ON(req.links[link_id].error > 0))
  9643. continue;
  9644. WARN_ON(err >= 0);
  9645. NL_SET_BAD_ATTR(info->extack, link);
  9646. err = req.links[link_id].error;
  9647. break;
  9648. }
  9649. }
  9650. }
  9651. free:
  9652. for (link_id = 0; link_id < ARRAY_SIZE(req.links); link_id++)
  9653. cfg80211_put_bss(&rdev->wiphy, req.links[link_id].bss);
  9654. cfg80211_put_bss(&rdev->wiphy, req.bss);
  9655. kfree(attrs);
  9656. return err;
  9657. }
  9658. static int nl80211_deauthenticate(struct sk_buff *skb, struct genl_info *info)
  9659. {
  9660. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9661. struct net_device *dev = info->user_ptr[1];
  9662. const u8 *ie = NULL, *bssid;
  9663. int ie_len = 0;
  9664. u16 reason_code;
  9665. bool local_state_change;
  9666. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  9667. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  9668. return -EPERM;
  9669. if (!info->attrs[NL80211_ATTR_MAC])
  9670. return -EINVAL;
  9671. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  9672. return -EINVAL;
  9673. if (!rdev->ops->deauth)
  9674. return -EOPNOTSUPP;
  9675. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  9676. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  9677. return -EOPNOTSUPP;
  9678. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9679. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  9680. if (reason_code == 0) {
  9681. /* Reason Code 0 is reserved */
  9682. return -EINVAL;
  9683. }
  9684. if (info->attrs[NL80211_ATTR_IE]) {
  9685. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9686. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9687. }
  9688. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  9689. return cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason_code,
  9690. local_state_change);
  9691. }
  9692. static int nl80211_disassociate(struct sk_buff *skb, struct genl_info *info)
  9693. {
  9694. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9695. struct net_device *dev = info->user_ptr[1];
  9696. const u8 *ie = NULL, *bssid;
  9697. int ie_len = 0;
  9698. u16 reason_code;
  9699. bool local_state_change;
  9700. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  9701. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  9702. return -EPERM;
  9703. if (!info->attrs[NL80211_ATTR_MAC])
  9704. return -EINVAL;
  9705. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  9706. return -EINVAL;
  9707. if (!rdev->ops->disassoc)
  9708. return -EOPNOTSUPP;
  9709. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  9710. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  9711. return -EOPNOTSUPP;
  9712. bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9713. reason_code = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  9714. if (reason_code == 0) {
  9715. /* Reason Code 0 is reserved */
  9716. return -EINVAL;
  9717. }
  9718. if (info->attrs[NL80211_ATTR_IE]) {
  9719. ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9720. ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9721. }
  9722. local_state_change = !!info->attrs[NL80211_ATTR_LOCAL_STATE_CHANGE];
  9723. return cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason_code,
  9724. local_state_change);
  9725. }
  9726. static bool
  9727. nl80211_parse_mcast_rate(struct cfg80211_registered_device *rdev,
  9728. int mcast_rate[NUM_NL80211_BANDS],
  9729. int rateval)
  9730. {
  9731. struct wiphy *wiphy = &rdev->wiphy;
  9732. bool found = false;
  9733. int band, i;
  9734. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  9735. struct ieee80211_supported_band *sband;
  9736. sband = wiphy->bands[band];
  9737. if (!sband)
  9738. continue;
  9739. for (i = 0; i < sband->n_bitrates; i++) {
  9740. if (sband->bitrates[i].bitrate == rateval) {
  9741. mcast_rate[band] = i + 1;
  9742. found = true;
  9743. break;
  9744. }
  9745. }
  9746. }
  9747. return found;
  9748. }
  9749. static int nl80211_join_ibss(struct sk_buff *skb, struct genl_info *info)
  9750. {
  9751. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9752. struct net_device *dev = info->user_ptr[1];
  9753. struct cfg80211_ibss_params ibss;
  9754. struct wiphy *wiphy;
  9755. struct cfg80211_cached_keys *connkeys = NULL;
  9756. int err;
  9757. memset(&ibss, 0, sizeof(ibss));
  9758. if (!info->attrs[NL80211_ATTR_SSID] ||
  9759. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  9760. return -EINVAL;
  9761. ibss.beacon_interval = 100;
  9762. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL])
  9763. ibss.beacon_interval =
  9764. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  9765. err = cfg80211_validate_beacon_int(rdev, NL80211_IFTYPE_ADHOC,
  9766. ibss.beacon_interval);
  9767. if (err)
  9768. return err;
  9769. if (!rdev->ops->join_ibss)
  9770. return -EOPNOTSUPP;
  9771. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  9772. return -EOPNOTSUPP;
  9773. wiphy = &rdev->wiphy;
  9774. if (info->attrs[NL80211_ATTR_MAC]) {
  9775. ibss.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  9776. if (!is_valid_ether_addr(ibss.bssid))
  9777. return -EINVAL;
  9778. }
  9779. ibss.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  9780. ibss.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  9781. if (info->attrs[NL80211_ATTR_IE]) {
  9782. ibss.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  9783. ibss.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  9784. }
  9785. err = nl80211_parse_chandef(rdev, info, &ibss.chandef);
  9786. if (err)
  9787. return err;
  9788. if (!cfg80211_reg_can_beacon(&rdev->wiphy, &ibss.chandef,
  9789. NL80211_IFTYPE_ADHOC))
  9790. return -EINVAL;
  9791. switch (ibss.chandef.width) {
  9792. case NL80211_CHAN_WIDTH_5:
  9793. case NL80211_CHAN_WIDTH_10:
  9794. case NL80211_CHAN_WIDTH_20_NOHT:
  9795. break;
  9796. case NL80211_CHAN_WIDTH_20:
  9797. case NL80211_CHAN_WIDTH_40:
  9798. if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
  9799. return -EINVAL;
  9800. break;
  9801. case NL80211_CHAN_WIDTH_80:
  9802. case NL80211_CHAN_WIDTH_80P80:
  9803. case NL80211_CHAN_WIDTH_160:
  9804. if (!(rdev->wiphy.features & NL80211_FEATURE_HT_IBSS))
  9805. return -EINVAL;
  9806. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  9807. NL80211_EXT_FEATURE_VHT_IBSS))
  9808. return -EINVAL;
  9809. break;
  9810. case NL80211_CHAN_WIDTH_320:
  9811. return -EINVAL;
  9812. default:
  9813. return -EINVAL;
  9814. }
  9815. ibss.channel_fixed = !!info->attrs[NL80211_ATTR_FREQ_FIXED];
  9816. ibss.privacy = !!info->attrs[NL80211_ATTR_PRIVACY];
  9817. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  9818. u8 *rates =
  9819. nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  9820. int n_rates =
  9821. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  9822. struct ieee80211_supported_band *sband =
  9823. wiphy->bands[ibss.chandef.chan->band];
  9824. err = ieee80211_get_ratemask(sband, rates, n_rates,
  9825. &ibss.basic_rates);
  9826. if (err)
  9827. return err;
  9828. }
  9829. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9830. memcpy(&ibss.ht_capa_mask,
  9831. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  9832. sizeof(ibss.ht_capa_mask));
  9833. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  9834. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  9835. return -EINVAL;
  9836. memcpy(&ibss.ht_capa,
  9837. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  9838. sizeof(ibss.ht_capa));
  9839. }
  9840. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  9841. !nl80211_parse_mcast_rate(rdev, ibss.mcast_rate,
  9842. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  9843. return -EINVAL;
  9844. if (ibss.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  9845. bool no_ht = false;
  9846. connkeys = nl80211_parse_connkeys(rdev, info, &no_ht);
  9847. if (IS_ERR(connkeys))
  9848. return PTR_ERR(connkeys);
  9849. if ((ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT) &&
  9850. no_ht) {
  9851. kfree_sensitive(connkeys);
  9852. return -EINVAL;
  9853. }
  9854. }
  9855. ibss.control_port =
  9856. nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT]);
  9857. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  9858. int r = validate_pae_over_nl80211(rdev, info);
  9859. if (r < 0) {
  9860. kfree_sensitive(connkeys);
  9861. return r;
  9862. }
  9863. ibss.control_port_over_nl80211 = true;
  9864. }
  9865. ibss.userspace_handles_dfs =
  9866. nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
  9867. err = __cfg80211_join_ibss(rdev, dev, &ibss, connkeys);
  9868. if (err)
  9869. kfree_sensitive(connkeys);
  9870. else if (info->attrs[NL80211_ATTR_SOCKET_OWNER])
  9871. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  9872. return err;
  9873. }
  9874. static int nl80211_leave_ibss(struct sk_buff *skb, struct genl_info *info)
  9875. {
  9876. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9877. struct net_device *dev = info->user_ptr[1];
  9878. if (!rdev->ops->leave_ibss)
  9879. return -EOPNOTSUPP;
  9880. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC)
  9881. return -EOPNOTSUPP;
  9882. return cfg80211_leave_ibss(rdev, dev, false);
  9883. }
  9884. static int nl80211_set_mcast_rate(struct sk_buff *skb, struct genl_info *info)
  9885. {
  9886. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  9887. struct net_device *dev = info->user_ptr[1];
  9888. int mcast_rate[NUM_NL80211_BANDS];
  9889. u32 nla_rate;
  9890. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_ADHOC &&
  9891. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_MESH_POINT &&
  9892. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_OCB)
  9893. return -EOPNOTSUPP;
  9894. if (!rdev->ops->set_mcast_rate)
  9895. return -EOPNOTSUPP;
  9896. memset(mcast_rate, 0, sizeof(mcast_rate));
  9897. if (!info->attrs[NL80211_ATTR_MCAST_RATE])
  9898. return -EINVAL;
  9899. nla_rate = nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE]);
  9900. if (!nl80211_parse_mcast_rate(rdev, mcast_rate, nla_rate))
  9901. return -EINVAL;
  9902. return rdev_set_mcast_rate(rdev, dev, mcast_rate);
  9903. }
  9904. static struct sk_buff *
  9905. __cfg80211_alloc_vendor_skb(struct cfg80211_registered_device *rdev,
  9906. struct wireless_dev *wdev, int approxlen,
  9907. u32 portid, u32 seq, enum nl80211_commands cmd,
  9908. enum nl80211_attrs attr,
  9909. const struct nl80211_vendor_cmd_info *info,
  9910. gfp_t gfp)
  9911. {
  9912. struct sk_buff *skb;
  9913. void *hdr;
  9914. struct nlattr *data;
  9915. skb = nlmsg_new(approxlen + 100, gfp);
  9916. if (!skb)
  9917. return NULL;
  9918. hdr = nl80211hdr_put(skb, portid, seq, 0, cmd);
  9919. if (!hdr) {
  9920. kfree_skb(skb);
  9921. return NULL;
  9922. }
  9923. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  9924. goto nla_put_failure;
  9925. if (info) {
  9926. if (nla_put_u32(skb, NL80211_ATTR_VENDOR_ID,
  9927. info->vendor_id))
  9928. goto nla_put_failure;
  9929. if (nla_put_u32(skb, NL80211_ATTR_VENDOR_SUBCMD,
  9930. info->subcmd))
  9931. goto nla_put_failure;
  9932. }
  9933. if (wdev) {
  9934. if (nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
  9935. wdev_id(wdev), NL80211_ATTR_PAD))
  9936. goto nla_put_failure;
  9937. if (wdev->netdev &&
  9938. nla_put_u32(skb, NL80211_ATTR_IFINDEX,
  9939. wdev->netdev->ifindex))
  9940. goto nla_put_failure;
  9941. }
  9942. data = nla_nest_start_noflag(skb, attr);
  9943. if (!data)
  9944. goto nla_put_failure;
  9945. ((void **)skb->cb)[0] = rdev;
  9946. ((void **)skb->cb)[1] = hdr;
  9947. ((void **)skb->cb)[2] = data;
  9948. return skb;
  9949. nla_put_failure:
  9950. kfree_skb(skb);
  9951. return NULL;
  9952. }
  9953. struct sk_buff *__cfg80211_alloc_event_skb(struct wiphy *wiphy,
  9954. struct wireless_dev *wdev,
  9955. enum nl80211_commands cmd,
  9956. enum nl80211_attrs attr,
  9957. unsigned int portid,
  9958. int vendor_event_idx,
  9959. int approxlen, gfp_t gfp)
  9960. {
  9961. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  9962. const struct nl80211_vendor_cmd_info *info;
  9963. switch (cmd) {
  9964. case NL80211_CMD_TESTMODE:
  9965. if (WARN_ON(vendor_event_idx != -1))
  9966. return NULL;
  9967. info = NULL;
  9968. break;
  9969. case NL80211_CMD_VENDOR:
  9970. if (WARN_ON(vendor_event_idx < 0 ||
  9971. vendor_event_idx >= wiphy->n_vendor_events))
  9972. return NULL;
  9973. info = &wiphy->vendor_events[vendor_event_idx];
  9974. break;
  9975. default:
  9976. WARN_ON(1);
  9977. return NULL;
  9978. }
  9979. return __cfg80211_alloc_vendor_skb(rdev, wdev, approxlen, portid, 0,
  9980. cmd, attr, info, gfp);
  9981. }
  9982. EXPORT_SYMBOL(__cfg80211_alloc_event_skb);
  9983. void __cfg80211_send_event_skb(struct sk_buff *skb, gfp_t gfp)
  9984. {
  9985. struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
  9986. void *hdr = ((void **)skb->cb)[1];
  9987. struct nlmsghdr *nlhdr = nlmsg_hdr(skb);
  9988. struct nlattr *data = ((void **)skb->cb)[2];
  9989. enum nl80211_multicast_groups mcgrp = NL80211_MCGRP_TESTMODE;
  9990. /* clear CB data for netlink core to own from now on */
  9991. memset(skb->cb, 0, sizeof(skb->cb));
  9992. nla_nest_end(skb, data);
  9993. genlmsg_end(skb, hdr);
  9994. if (nlhdr->nlmsg_pid) {
  9995. genlmsg_unicast(wiphy_net(&rdev->wiphy), skb,
  9996. nlhdr->nlmsg_pid);
  9997. } else {
  9998. if (data->nla_type == NL80211_ATTR_VENDOR_DATA)
  9999. mcgrp = NL80211_MCGRP_VENDOR;
  10000. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  10001. skb, 0, mcgrp, gfp);
  10002. }
  10003. }
  10004. EXPORT_SYMBOL(__cfg80211_send_event_skb);
  10005. #ifdef CONFIG_NL80211_TESTMODE
  10006. static int nl80211_testmode_do(struct sk_buff *skb, struct genl_info *info)
  10007. {
  10008. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10009. struct wireless_dev *wdev;
  10010. int err;
  10011. lockdep_assert_held(&rdev->wiphy.mtx);
  10012. wdev = __cfg80211_wdev_from_attrs(rdev, genl_info_net(info),
  10013. info->attrs);
  10014. if (!rdev->ops->testmode_cmd)
  10015. return -EOPNOTSUPP;
  10016. if (IS_ERR(wdev)) {
  10017. err = PTR_ERR(wdev);
  10018. if (err != -EINVAL)
  10019. return err;
  10020. wdev = NULL;
  10021. } else if (wdev->wiphy != &rdev->wiphy) {
  10022. return -EINVAL;
  10023. }
  10024. if (!info->attrs[NL80211_ATTR_TESTDATA])
  10025. return -EINVAL;
  10026. rdev->cur_cmd_info = info;
  10027. err = rdev_testmode_cmd(rdev, wdev,
  10028. nla_data(info->attrs[NL80211_ATTR_TESTDATA]),
  10029. nla_len(info->attrs[NL80211_ATTR_TESTDATA]));
  10030. rdev->cur_cmd_info = NULL;
  10031. return err;
  10032. }
  10033. static int nl80211_testmode_dump(struct sk_buff *skb,
  10034. struct netlink_callback *cb)
  10035. {
  10036. struct cfg80211_registered_device *rdev;
  10037. struct nlattr **attrbuf = NULL;
  10038. int err;
  10039. long phy_idx;
  10040. void *data = NULL;
  10041. int data_len = 0;
  10042. rtnl_lock();
  10043. if (cb->args[0]) {
  10044. /*
  10045. * 0 is a valid index, but not valid for args[0],
  10046. * so we need to offset by 1.
  10047. */
  10048. phy_idx = cb->args[0] - 1;
  10049. rdev = cfg80211_rdev_by_wiphy_idx(phy_idx);
  10050. if (!rdev) {
  10051. err = -ENOENT;
  10052. goto out_err;
  10053. }
  10054. } else {
  10055. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf),
  10056. GFP_KERNEL);
  10057. if (!attrbuf) {
  10058. err = -ENOMEM;
  10059. goto out_err;
  10060. }
  10061. err = nlmsg_parse_deprecated(cb->nlh,
  10062. GENL_HDRLEN + nl80211_fam.hdrsize,
  10063. attrbuf, nl80211_fam.maxattr,
  10064. nl80211_policy, NULL);
  10065. if (err)
  10066. goto out_err;
  10067. rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
  10068. if (IS_ERR(rdev)) {
  10069. err = PTR_ERR(rdev);
  10070. goto out_err;
  10071. }
  10072. phy_idx = rdev->wiphy_idx;
  10073. if (attrbuf[NL80211_ATTR_TESTDATA])
  10074. cb->args[1] = (long)attrbuf[NL80211_ATTR_TESTDATA];
  10075. }
  10076. if (cb->args[1]) {
  10077. data = nla_data((void *)cb->args[1]);
  10078. data_len = nla_len((void *)cb->args[1]);
  10079. }
  10080. if (!rdev->ops->testmode_dump) {
  10081. err = -EOPNOTSUPP;
  10082. goto out_err;
  10083. }
  10084. while (1) {
  10085. void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
  10086. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  10087. NL80211_CMD_TESTMODE);
  10088. struct nlattr *tmdata;
  10089. if (!hdr)
  10090. break;
  10091. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, phy_idx)) {
  10092. genlmsg_cancel(skb, hdr);
  10093. break;
  10094. }
  10095. tmdata = nla_nest_start_noflag(skb, NL80211_ATTR_TESTDATA);
  10096. if (!tmdata) {
  10097. genlmsg_cancel(skb, hdr);
  10098. break;
  10099. }
  10100. err = rdev_testmode_dump(rdev, skb, cb, data, data_len);
  10101. nla_nest_end(skb, tmdata);
  10102. if (err == -ENOBUFS || err == -ENOENT) {
  10103. genlmsg_cancel(skb, hdr);
  10104. break;
  10105. } else if (err) {
  10106. genlmsg_cancel(skb, hdr);
  10107. goto out_err;
  10108. }
  10109. genlmsg_end(skb, hdr);
  10110. }
  10111. err = skb->len;
  10112. /* see above */
  10113. cb->args[0] = phy_idx + 1;
  10114. out_err:
  10115. kfree(attrbuf);
  10116. rtnl_unlock();
  10117. return err;
  10118. }
  10119. #endif
  10120. static int nl80211_connect(struct sk_buff *skb, struct genl_info *info)
  10121. {
  10122. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10123. struct net_device *dev = info->user_ptr[1];
  10124. struct cfg80211_connect_params connect;
  10125. struct wiphy *wiphy;
  10126. struct cfg80211_cached_keys *connkeys = NULL;
  10127. u32 freq = 0;
  10128. int err;
  10129. memset(&connect, 0, sizeof(connect));
  10130. if (!info->attrs[NL80211_ATTR_SSID] ||
  10131. !nla_len(info->attrs[NL80211_ATTR_SSID]))
  10132. return -EINVAL;
  10133. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  10134. connect.auth_type =
  10135. nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  10136. if (!nl80211_valid_auth_type(rdev, connect.auth_type,
  10137. NL80211_CMD_CONNECT))
  10138. return -EINVAL;
  10139. } else
  10140. connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  10141. connect.privacy = info->attrs[NL80211_ATTR_PRIVACY];
  10142. if (info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS] &&
  10143. !wiphy_ext_feature_isset(&rdev->wiphy,
  10144. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  10145. return -EINVAL;
  10146. connect.want_1x = info->attrs[NL80211_ATTR_WANT_1X_4WAY_HS];
  10147. err = nl80211_crypto_settings(rdev, info, &connect.crypto,
  10148. NL80211_MAX_NR_CIPHER_SUITES);
  10149. if (err)
  10150. return err;
  10151. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10152. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10153. return -EOPNOTSUPP;
  10154. wiphy = &rdev->wiphy;
  10155. connect.bg_scan_period = -1;
  10156. if (info->attrs[NL80211_ATTR_BG_SCAN_PERIOD] &&
  10157. (wiphy->flags & WIPHY_FLAG_SUPPORTS_FW_ROAM)) {
  10158. connect.bg_scan_period =
  10159. nla_get_u16(info->attrs[NL80211_ATTR_BG_SCAN_PERIOD]);
  10160. }
  10161. if (info->attrs[NL80211_ATTR_MAC])
  10162. connect.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10163. else if (info->attrs[NL80211_ATTR_MAC_HINT])
  10164. connect.bssid_hint =
  10165. nla_data(info->attrs[NL80211_ATTR_MAC_HINT]);
  10166. connect.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  10167. connect.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  10168. if (info->attrs[NL80211_ATTR_IE]) {
  10169. connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  10170. connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  10171. }
  10172. if (info->attrs[NL80211_ATTR_USE_MFP]) {
  10173. connect.mfp = nla_get_u32(info->attrs[NL80211_ATTR_USE_MFP]);
  10174. if (connect.mfp == NL80211_MFP_OPTIONAL &&
  10175. !wiphy_ext_feature_isset(&rdev->wiphy,
  10176. NL80211_EXT_FEATURE_MFP_OPTIONAL))
  10177. return -EOPNOTSUPP;
  10178. } else {
  10179. connect.mfp = NL80211_MFP_NO;
  10180. }
  10181. if (info->attrs[NL80211_ATTR_PREV_BSSID])
  10182. connect.prev_bssid =
  10183. nla_data(info->attrs[NL80211_ATTR_PREV_BSSID]);
  10184. if (info->attrs[NL80211_ATTR_WIPHY_FREQ])
  10185. freq = MHZ_TO_KHZ(nla_get_u32(
  10186. info->attrs[NL80211_ATTR_WIPHY_FREQ]));
  10187. if (info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET])
  10188. freq +=
  10189. nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_OFFSET]);
  10190. if (freq) {
  10191. connect.channel = nl80211_get_valid_chan(wiphy, freq);
  10192. if (!connect.channel)
  10193. return -EINVAL;
  10194. } else if (info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]) {
  10195. freq = nla_get_u32(info->attrs[NL80211_ATTR_WIPHY_FREQ_HINT]);
  10196. freq = MHZ_TO_KHZ(freq);
  10197. connect.channel_hint = nl80211_get_valid_chan(wiphy, freq);
  10198. if (!connect.channel_hint)
  10199. return -EINVAL;
  10200. }
  10201. if (info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]) {
  10202. connect.edmg.channels =
  10203. nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_CHANNELS]);
  10204. if (info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG])
  10205. connect.edmg.bw_config =
  10206. nla_get_u8(info->attrs[NL80211_ATTR_WIPHY_EDMG_BW_CONFIG]);
  10207. }
  10208. if (connect.privacy && info->attrs[NL80211_ATTR_KEYS]) {
  10209. connkeys = nl80211_parse_connkeys(rdev, info, NULL);
  10210. if (IS_ERR(connkeys))
  10211. return PTR_ERR(connkeys);
  10212. }
  10213. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HT]))
  10214. connect.flags |= ASSOC_REQ_DISABLE_HT;
  10215. if (info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK])
  10216. memcpy(&connect.ht_capa_mask,
  10217. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]),
  10218. sizeof(connect.ht_capa_mask));
  10219. if (info->attrs[NL80211_ATTR_HT_CAPABILITY]) {
  10220. if (!info->attrs[NL80211_ATTR_HT_CAPABILITY_MASK]) {
  10221. kfree_sensitive(connkeys);
  10222. return -EINVAL;
  10223. }
  10224. memcpy(&connect.ht_capa,
  10225. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]),
  10226. sizeof(connect.ht_capa));
  10227. }
  10228. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_VHT]))
  10229. connect.flags |= ASSOC_REQ_DISABLE_VHT;
  10230. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_HE]))
  10231. connect.flags |= ASSOC_REQ_DISABLE_HE;
  10232. if (nla_get_flag(info->attrs[NL80211_ATTR_DISABLE_EHT]))
  10233. connect.flags |= ASSOC_REQ_DISABLE_EHT;
  10234. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK])
  10235. memcpy(&connect.vht_capa_mask,
  10236. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]),
  10237. sizeof(connect.vht_capa_mask));
  10238. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY]) {
  10239. if (!info->attrs[NL80211_ATTR_VHT_CAPABILITY_MASK]) {
  10240. kfree_sensitive(connkeys);
  10241. return -EINVAL;
  10242. }
  10243. memcpy(&connect.vht_capa,
  10244. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]),
  10245. sizeof(connect.vht_capa));
  10246. }
  10247. if (nla_get_flag(info->attrs[NL80211_ATTR_USE_RRM])) {
  10248. if (!((rdev->wiphy.features &
  10249. NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES) &&
  10250. (rdev->wiphy.features & NL80211_FEATURE_QUIET)) &&
  10251. !wiphy_ext_feature_isset(&rdev->wiphy,
  10252. NL80211_EXT_FEATURE_RRM)) {
  10253. kfree_sensitive(connkeys);
  10254. return -EINVAL;
  10255. }
  10256. connect.flags |= ASSOC_REQ_USE_RRM;
  10257. }
  10258. connect.pbss = nla_get_flag(info->attrs[NL80211_ATTR_PBSS]);
  10259. if (connect.pbss && !rdev->wiphy.bands[NL80211_BAND_60GHZ]) {
  10260. kfree_sensitive(connkeys);
  10261. return -EOPNOTSUPP;
  10262. }
  10263. if (info->attrs[NL80211_ATTR_BSS_SELECT]) {
  10264. /* bss selection makes no sense if bssid is set */
  10265. if (connect.bssid) {
  10266. kfree_sensitive(connkeys);
  10267. return -EINVAL;
  10268. }
  10269. err = parse_bss_select(info->attrs[NL80211_ATTR_BSS_SELECT],
  10270. wiphy, &connect.bss_select);
  10271. if (err) {
  10272. kfree_sensitive(connkeys);
  10273. return err;
  10274. }
  10275. }
  10276. if (wiphy_ext_feature_isset(&rdev->wiphy,
  10277. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD) &&
  10278. info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
  10279. info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
  10280. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
  10281. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  10282. connect.fils_erp_username =
  10283. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  10284. connect.fils_erp_username_len =
  10285. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  10286. connect.fils_erp_realm =
  10287. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  10288. connect.fils_erp_realm_len =
  10289. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  10290. connect.fils_erp_next_seq_num =
  10291. nla_get_u16(
  10292. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
  10293. connect.fils_erp_rrk =
  10294. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  10295. connect.fils_erp_rrk_len =
  10296. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  10297. } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
  10298. info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
  10299. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
  10300. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  10301. kfree_sensitive(connkeys);
  10302. return -EINVAL;
  10303. }
  10304. if (nla_get_flag(info->attrs[NL80211_ATTR_EXTERNAL_AUTH_SUPPORT])) {
  10305. if (!info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  10306. kfree_sensitive(connkeys);
  10307. GENL_SET_ERR_MSG(info,
  10308. "external auth requires connection ownership");
  10309. return -EINVAL;
  10310. }
  10311. connect.flags |= CONNECT_REQ_EXTERNAL_AUTH_SUPPORT;
  10312. }
  10313. if (nla_get_flag(info->attrs[NL80211_ATTR_MLO_SUPPORT]))
  10314. connect.flags |= CONNECT_REQ_MLO_SUPPORT;
  10315. err = cfg80211_connect(rdev, dev, &connect, connkeys,
  10316. connect.prev_bssid);
  10317. if (err)
  10318. kfree_sensitive(connkeys);
  10319. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER]) {
  10320. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  10321. if (connect.bssid)
  10322. memcpy(dev->ieee80211_ptr->disconnect_bssid,
  10323. connect.bssid, ETH_ALEN);
  10324. else
  10325. eth_zero_addr(dev->ieee80211_ptr->disconnect_bssid);
  10326. }
  10327. return err;
  10328. }
  10329. static int nl80211_update_connect_params(struct sk_buff *skb,
  10330. struct genl_info *info)
  10331. {
  10332. struct cfg80211_connect_params connect = {};
  10333. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10334. struct net_device *dev = info->user_ptr[1];
  10335. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10336. bool fils_sk_offload;
  10337. u32 auth_type;
  10338. u32 changed = 0;
  10339. if (!rdev->ops->update_connect_params)
  10340. return -EOPNOTSUPP;
  10341. if (info->attrs[NL80211_ATTR_IE]) {
  10342. connect.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  10343. connect.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  10344. changed |= UPDATE_ASSOC_IES;
  10345. }
  10346. fils_sk_offload = wiphy_ext_feature_isset(&rdev->wiphy,
  10347. NL80211_EXT_FEATURE_FILS_SK_OFFLOAD);
  10348. /*
  10349. * when driver supports fils-sk offload all attributes must be
  10350. * provided. So the else covers "fils-sk-not-all" and
  10351. * "no-fils-sk-any".
  10352. */
  10353. if (fils_sk_offload &&
  10354. info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] &&
  10355. info->attrs[NL80211_ATTR_FILS_ERP_REALM] &&
  10356. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] &&
  10357. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  10358. connect.fils_erp_username =
  10359. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  10360. connect.fils_erp_username_len =
  10361. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_USERNAME]);
  10362. connect.fils_erp_realm =
  10363. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  10364. connect.fils_erp_realm_len =
  10365. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_REALM]);
  10366. connect.fils_erp_next_seq_num =
  10367. nla_get_u16(
  10368. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM]);
  10369. connect.fils_erp_rrk =
  10370. nla_data(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  10371. connect.fils_erp_rrk_len =
  10372. nla_len(info->attrs[NL80211_ATTR_FILS_ERP_RRK]);
  10373. changed |= UPDATE_FILS_ERP_INFO;
  10374. } else if (info->attrs[NL80211_ATTR_FILS_ERP_USERNAME] ||
  10375. info->attrs[NL80211_ATTR_FILS_ERP_REALM] ||
  10376. info->attrs[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM] ||
  10377. info->attrs[NL80211_ATTR_FILS_ERP_RRK]) {
  10378. return -EINVAL;
  10379. }
  10380. if (info->attrs[NL80211_ATTR_AUTH_TYPE]) {
  10381. auth_type = nla_get_u32(info->attrs[NL80211_ATTR_AUTH_TYPE]);
  10382. if (!nl80211_valid_auth_type(rdev, auth_type,
  10383. NL80211_CMD_CONNECT))
  10384. return -EINVAL;
  10385. if (auth_type == NL80211_AUTHTYPE_FILS_SK &&
  10386. fils_sk_offload && !(changed & UPDATE_FILS_ERP_INFO))
  10387. return -EINVAL;
  10388. connect.auth_type = auth_type;
  10389. changed |= UPDATE_AUTH_TYPE;
  10390. }
  10391. if (!wdev->connected)
  10392. return -ENOLINK;
  10393. return rdev_update_connect_params(rdev, dev, &connect, changed);
  10394. }
  10395. static int nl80211_disconnect(struct sk_buff *skb, struct genl_info *info)
  10396. {
  10397. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10398. struct net_device *dev = info->user_ptr[1];
  10399. u16 reason;
  10400. if (dev->ieee80211_ptr->conn_owner_nlportid &&
  10401. dev->ieee80211_ptr->conn_owner_nlportid != info->snd_portid)
  10402. return -EPERM;
  10403. if (!info->attrs[NL80211_ATTR_REASON_CODE])
  10404. reason = WLAN_REASON_DEAUTH_LEAVING;
  10405. else
  10406. reason = nla_get_u16(info->attrs[NL80211_ATTR_REASON_CODE]);
  10407. if (reason == 0)
  10408. return -EINVAL;
  10409. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10410. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10411. return -EOPNOTSUPP;
  10412. return cfg80211_disconnect(rdev, dev, reason, true);
  10413. }
  10414. static int nl80211_wiphy_netns(struct sk_buff *skb, struct genl_info *info)
  10415. {
  10416. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10417. struct net *net;
  10418. int err;
  10419. if (info->attrs[NL80211_ATTR_PID]) {
  10420. u32 pid = nla_get_u32(info->attrs[NL80211_ATTR_PID]);
  10421. net = get_net_ns_by_pid(pid);
  10422. } else if (info->attrs[NL80211_ATTR_NETNS_FD]) {
  10423. u32 fd = nla_get_u32(info->attrs[NL80211_ATTR_NETNS_FD]);
  10424. net = get_net_ns_by_fd(fd);
  10425. } else {
  10426. return -EINVAL;
  10427. }
  10428. if (IS_ERR(net))
  10429. return PTR_ERR(net);
  10430. err = 0;
  10431. /* check if anything to do */
  10432. if (!net_eq(wiphy_net(&rdev->wiphy), net))
  10433. err = cfg80211_switch_netns(rdev, net);
  10434. put_net(net);
  10435. return err;
  10436. }
  10437. static int nl80211_set_pmksa(struct sk_buff *skb, struct genl_info *info)
  10438. {
  10439. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10440. struct net_device *dev = info->user_ptr[1];
  10441. struct cfg80211_pmksa pmksa;
  10442. bool ap_pmksa_caching_support = false;
  10443. memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
  10444. ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy,
  10445. NL80211_EXT_FEATURE_AP_PMKSA_CACHING);
  10446. if (!info->attrs[NL80211_ATTR_PMKID])
  10447. return -EINVAL;
  10448. pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  10449. if (info->attrs[NL80211_ATTR_MAC]) {
  10450. pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10451. } else if (info->attrs[NL80211_ATTR_SSID] &&
  10452. info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
  10453. info->attrs[NL80211_ATTR_PMK]) {
  10454. pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  10455. pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  10456. pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
  10457. } else {
  10458. return -EINVAL;
  10459. }
  10460. if (info->attrs[NL80211_ATTR_PMK]) {
  10461. pmksa.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  10462. pmksa.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
  10463. }
  10464. if (info->attrs[NL80211_ATTR_PMK_LIFETIME])
  10465. pmksa.pmk_lifetime =
  10466. nla_get_u32(info->attrs[NL80211_ATTR_PMK_LIFETIME]);
  10467. if (info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD])
  10468. pmksa.pmk_reauth_threshold =
  10469. nla_get_u8(info->attrs[NL80211_ATTR_PMK_REAUTH_THRESHOLD]);
  10470. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10471. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
  10472. !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP ||
  10473. dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) &&
  10474. ap_pmksa_caching_support))
  10475. return -EOPNOTSUPP;
  10476. if (!rdev->ops->set_pmksa)
  10477. return -EOPNOTSUPP;
  10478. return rdev_set_pmksa(rdev, dev, &pmksa);
  10479. }
  10480. static int nl80211_del_pmksa(struct sk_buff *skb, struct genl_info *info)
  10481. {
  10482. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10483. struct net_device *dev = info->user_ptr[1];
  10484. struct cfg80211_pmksa pmksa;
  10485. bool sae_offload_support = false;
  10486. bool owe_offload_support = false;
  10487. bool ap_pmksa_caching_support = false;
  10488. memset(&pmksa, 0, sizeof(struct cfg80211_pmksa));
  10489. sae_offload_support = wiphy_ext_feature_isset(&rdev->wiphy,
  10490. NL80211_EXT_FEATURE_SAE_OFFLOAD);
  10491. owe_offload_support = wiphy_ext_feature_isset(&rdev->wiphy,
  10492. NL80211_EXT_FEATURE_OWE_OFFLOAD);
  10493. ap_pmksa_caching_support = wiphy_ext_feature_isset(&rdev->wiphy,
  10494. NL80211_EXT_FEATURE_AP_PMKSA_CACHING);
  10495. if (info->attrs[NL80211_ATTR_PMKID])
  10496. pmksa.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  10497. if (info->attrs[NL80211_ATTR_MAC]) {
  10498. pmksa.bssid = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10499. } else if (info->attrs[NL80211_ATTR_SSID]) {
  10500. /* SSID based pmksa flush suppported only for FILS,
  10501. * OWE/SAE OFFLOAD cases
  10502. */
  10503. if (info->attrs[NL80211_ATTR_FILS_CACHE_ID] &&
  10504. info->attrs[NL80211_ATTR_PMK]) {
  10505. pmksa.cache_id = nla_data(info->attrs[NL80211_ATTR_FILS_CACHE_ID]);
  10506. } else if (!sae_offload_support && !owe_offload_support) {
  10507. return -EINVAL;
  10508. }
  10509. pmksa.ssid = nla_data(info->attrs[NL80211_ATTR_SSID]);
  10510. pmksa.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  10511. } else {
  10512. return -EINVAL;
  10513. }
  10514. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10515. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT &&
  10516. !((dev->ieee80211_ptr->iftype == NL80211_IFTYPE_AP ||
  10517. dev->ieee80211_ptr->iftype == NL80211_IFTYPE_P2P_GO) &&
  10518. ap_pmksa_caching_support))
  10519. return -EOPNOTSUPP;
  10520. if (!rdev->ops->del_pmksa)
  10521. return -EOPNOTSUPP;
  10522. return rdev_del_pmksa(rdev, dev, &pmksa);
  10523. }
  10524. static int nl80211_flush_pmksa(struct sk_buff *skb, struct genl_info *info)
  10525. {
  10526. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10527. struct net_device *dev = info->user_ptr[1];
  10528. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION &&
  10529. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10530. return -EOPNOTSUPP;
  10531. if (!rdev->ops->flush_pmksa)
  10532. return -EOPNOTSUPP;
  10533. return rdev_flush_pmksa(rdev, dev);
  10534. }
  10535. static int nl80211_tdls_mgmt(struct sk_buff *skb, struct genl_info *info)
  10536. {
  10537. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10538. struct net_device *dev = info->user_ptr[1];
  10539. u8 action_code, dialog_token;
  10540. u32 peer_capability = 0;
  10541. u16 status_code;
  10542. u8 *peer;
  10543. int link_id;
  10544. bool initiator;
  10545. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
  10546. !rdev->ops->tdls_mgmt)
  10547. return -EOPNOTSUPP;
  10548. if (!info->attrs[NL80211_ATTR_TDLS_ACTION] ||
  10549. !info->attrs[NL80211_ATTR_STATUS_CODE] ||
  10550. !info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN] ||
  10551. !info->attrs[NL80211_ATTR_IE] ||
  10552. !info->attrs[NL80211_ATTR_MAC])
  10553. return -EINVAL;
  10554. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10555. action_code = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_ACTION]);
  10556. status_code = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  10557. dialog_token = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_DIALOG_TOKEN]);
  10558. initiator = nla_get_flag(info->attrs[NL80211_ATTR_TDLS_INITIATOR]);
  10559. if (info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY])
  10560. peer_capability =
  10561. nla_get_u32(info->attrs[NL80211_ATTR_TDLS_PEER_CAPABILITY]);
  10562. link_id = nl80211_link_id_or_invalid(info->attrs);
  10563. return rdev_tdls_mgmt(rdev, dev, peer, link_id, action_code,
  10564. dialog_token, status_code, peer_capability,
  10565. initiator,
  10566. nla_data(info->attrs[NL80211_ATTR_IE]),
  10567. nla_len(info->attrs[NL80211_ATTR_IE]));
  10568. }
  10569. static int nl80211_tdls_oper(struct sk_buff *skb, struct genl_info *info)
  10570. {
  10571. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10572. struct net_device *dev = info->user_ptr[1];
  10573. enum nl80211_tdls_operation operation;
  10574. u8 *peer;
  10575. if (!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_TDLS) ||
  10576. !rdev->ops->tdls_oper)
  10577. return -EOPNOTSUPP;
  10578. if (!info->attrs[NL80211_ATTR_TDLS_OPERATION] ||
  10579. !info->attrs[NL80211_ATTR_MAC])
  10580. return -EINVAL;
  10581. operation = nla_get_u8(info->attrs[NL80211_ATTR_TDLS_OPERATION]);
  10582. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  10583. return rdev_tdls_oper(rdev, dev, peer, operation);
  10584. }
  10585. static int nl80211_remain_on_channel(struct sk_buff *skb,
  10586. struct genl_info *info)
  10587. {
  10588. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10589. unsigned int link_id = nl80211_link_id(info->attrs);
  10590. struct wireless_dev *wdev = info->user_ptr[1];
  10591. struct cfg80211_chan_def chandef;
  10592. struct sk_buff *msg;
  10593. void *hdr;
  10594. u64 cookie;
  10595. u32 duration;
  10596. int err;
  10597. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ] ||
  10598. !info->attrs[NL80211_ATTR_DURATION])
  10599. return -EINVAL;
  10600. duration = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  10601. if (!rdev->ops->remain_on_channel ||
  10602. !(rdev->wiphy.flags & WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL))
  10603. return -EOPNOTSUPP;
  10604. /*
  10605. * We should be on that channel for at least a minimum amount of
  10606. * time (10ms) but no longer than the driver supports.
  10607. */
  10608. if (duration < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
  10609. duration > rdev->wiphy.max_remain_on_channel_duration)
  10610. return -EINVAL;
  10611. err = nl80211_parse_chandef(rdev, info, &chandef);
  10612. if (err)
  10613. return err;
  10614. if (!cfg80211_off_channel_oper_allowed(wdev, chandef.chan)) {
  10615. const struct cfg80211_chan_def *oper_chandef, *compat_chandef;
  10616. oper_chandef = wdev_chandef(wdev, link_id);
  10617. if (WARN_ON(!oper_chandef)) {
  10618. /* cannot happen since we must beacon to get here */
  10619. WARN_ON(1);
  10620. return -EBUSY;
  10621. }
  10622. /* note: returns first one if identical chandefs */
  10623. compat_chandef = cfg80211_chandef_compatible(&chandef,
  10624. oper_chandef);
  10625. if (compat_chandef != &chandef)
  10626. return -EBUSY;
  10627. }
  10628. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  10629. if (!msg)
  10630. return -ENOMEM;
  10631. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  10632. NL80211_CMD_REMAIN_ON_CHANNEL);
  10633. if (!hdr) {
  10634. err = -ENOBUFS;
  10635. goto free_msg;
  10636. }
  10637. err = rdev_remain_on_channel(rdev, wdev, chandef.chan,
  10638. duration, &cookie);
  10639. if (err)
  10640. goto free_msg;
  10641. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  10642. NL80211_ATTR_PAD))
  10643. goto nla_put_failure;
  10644. genlmsg_end(msg, hdr);
  10645. return genlmsg_reply(msg, info);
  10646. nla_put_failure:
  10647. err = -ENOBUFS;
  10648. free_msg:
  10649. nlmsg_free(msg);
  10650. return err;
  10651. }
  10652. static int nl80211_cancel_remain_on_channel(struct sk_buff *skb,
  10653. struct genl_info *info)
  10654. {
  10655. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10656. struct wireless_dev *wdev = info->user_ptr[1];
  10657. u64 cookie;
  10658. if (!info->attrs[NL80211_ATTR_COOKIE])
  10659. return -EINVAL;
  10660. if (!rdev->ops->cancel_remain_on_channel)
  10661. return -EOPNOTSUPP;
  10662. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  10663. return rdev_cancel_remain_on_channel(rdev, wdev, cookie);
  10664. }
  10665. static int nl80211_set_tx_bitrate_mask(struct sk_buff *skb,
  10666. struct genl_info *info)
  10667. {
  10668. struct cfg80211_bitrate_mask mask;
  10669. unsigned int link_id = nl80211_link_id(info->attrs);
  10670. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10671. struct net_device *dev = info->user_ptr[1];
  10672. int err;
  10673. if (!rdev->ops->set_bitrate_mask)
  10674. return -EOPNOTSUPP;
  10675. err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
  10676. NL80211_ATTR_TX_RATES, &mask,
  10677. dev, true, link_id);
  10678. if (err)
  10679. return err;
  10680. return rdev_set_bitrate_mask(rdev, dev, link_id, NULL, &mask);
  10681. }
  10682. static int nl80211_register_mgmt(struct sk_buff *skb, struct genl_info *info)
  10683. {
  10684. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10685. struct wireless_dev *wdev = info->user_ptr[1];
  10686. u16 frame_type = IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_ACTION;
  10687. if (!info->attrs[NL80211_ATTR_FRAME_MATCH])
  10688. return -EINVAL;
  10689. if (info->attrs[NL80211_ATTR_FRAME_TYPE])
  10690. frame_type = nla_get_u16(info->attrs[NL80211_ATTR_FRAME_TYPE]);
  10691. switch (wdev->iftype) {
  10692. case NL80211_IFTYPE_STATION:
  10693. case NL80211_IFTYPE_ADHOC:
  10694. case NL80211_IFTYPE_P2P_CLIENT:
  10695. case NL80211_IFTYPE_AP:
  10696. case NL80211_IFTYPE_AP_VLAN:
  10697. case NL80211_IFTYPE_MESH_POINT:
  10698. case NL80211_IFTYPE_P2P_GO:
  10699. case NL80211_IFTYPE_P2P_DEVICE:
  10700. break;
  10701. case NL80211_IFTYPE_NAN:
  10702. if (!wiphy_ext_feature_isset(wdev->wiphy,
  10703. NL80211_EXT_FEATURE_SECURE_NAN))
  10704. return -EOPNOTSUPP;
  10705. break;
  10706. default:
  10707. return -EOPNOTSUPP;
  10708. }
  10709. /* not much point in registering if we can't reply */
  10710. if (!rdev->ops->mgmt_tx)
  10711. return -EOPNOTSUPP;
  10712. if (info->attrs[NL80211_ATTR_RECEIVE_MULTICAST] &&
  10713. !wiphy_ext_feature_isset(&rdev->wiphy,
  10714. NL80211_EXT_FEATURE_MULTICAST_REGISTRATIONS)) {
  10715. GENL_SET_ERR_MSG(info,
  10716. "multicast RX registrations are not supported");
  10717. return -EOPNOTSUPP;
  10718. }
  10719. return cfg80211_mlme_register_mgmt(wdev, info->snd_portid, frame_type,
  10720. nla_data(info->attrs[NL80211_ATTR_FRAME_MATCH]),
  10721. nla_len(info->attrs[NL80211_ATTR_FRAME_MATCH]),
  10722. info->attrs[NL80211_ATTR_RECEIVE_MULTICAST],
  10723. info->extack);
  10724. }
  10725. static int nl80211_tx_mgmt(struct sk_buff *skb, struct genl_info *info)
  10726. {
  10727. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10728. struct wireless_dev *wdev = info->user_ptr[1];
  10729. struct cfg80211_chan_def chandef;
  10730. int err;
  10731. void *hdr = NULL;
  10732. u64 cookie;
  10733. struct sk_buff *msg = NULL;
  10734. struct cfg80211_mgmt_tx_params params = {
  10735. .dont_wait_for_ack =
  10736. info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK],
  10737. };
  10738. if (!info->attrs[NL80211_ATTR_FRAME])
  10739. return -EINVAL;
  10740. if (!rdev->ops->mgmt_tx)
  10741. return -EOPNOTSUPP;
  10742. switch (wdev->iftype) {
  10743. case NL80211_IFTYPE_P2P_DEVICE:
  10744. if (!info->attrs[NL80211_ATTR_WIPHY_FREQ])
  10745. return -EINVAL;
  10746. break;
  10747. case NL80211_IFTYPE_STATION:
  10748. case NL80211_IFTYPE_ADHOC:
  10749. case NL80211_IFTYPE_P2P_CLIENT:
  10750. case NL80211_IFTYPE_AP:
  10751. case NL80211_IFTYPE_AP_VLAN:
  10752. case NL80211_IFTYPE_MESH_POINT:
  10753. case NL80211_IFTYPE_P2P_GO:
  10754. break;
  10755. case NL80211_IFTYPE_NAN:
  10756. if (!wiphy_ext_feature_isset(wdev->wiphy,
  10757. NL80211_EXT_FEATURE_SECURE_NAN))
  10758. return -EOPNOTSUPP;
  10759. break;
  10760. default:
  10761. return -EOPNOTSUPP;
  10762. }
  10763. if (info->attrs[NL80211_ATTR_DURATION]) {
  10764. if (!(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
  10765. return -EINVAL;
  10766. params.wait = nla_get_u32(info->attrs[NL80211_ATTR_DURATION]);
  10767. /*
  10768. * We should wait on the channel for at least a minimum amount
  10769. * of time (10ms) but no longer than the driver supports.
  10770. */
  10771. if (params.wait < NL80211_MIN_REMAIN_ON_CHANNEL_TIME ||
  10772. params.wait > rdev->wiphy.max_remain_on_channel_duration)
  10773. return -EINVAL;
  10774. }
  10775. params.offchan = info->attrs[NL80211_ATTR_OFFCHANNEL_TX_OK];
  10776. if (params.offchan && !(rdev->wiphy.flags & WIPHY_FLAG_OFFCHAN_TX))
  10777. return -EINVAL;
  10778. params.no_cck = nla_get_flag(info->attrs[NL80211_ATTR_TX_NO_CCK_RATE]);
  10779. /* get the channel if any has been specified, otherwise pass NULL to
  10780. * the driver. The latter will use the current one
  10781. */
  10782. chandef.chan = NULL;
  10783. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  10784. err = nl80211_parse_chandef(rdev, info, &chandef);
  10785. if (err)
  10786. return err;
  10787. }
  10788. if (!chandef.chan && params.offchan)
  10789. return -EINVAL;
  10790. if (params.offchan &&
  10791. !cfg80211_off_channel_oper_allowed(wdev, chandef.chan))
  10792. return -EBUSY;
  10793. params.link_id = nl80211_link_id_or_invalid(info->attrs);
  10794. /*
  10795. * This now races due to the unlock, but we cannot check
  10796. * the valid links for the _station_ anyway, so that's up
  10797. * to the driver.
  10798. */
  10799. if (params.link_id >= 0 &&
  10800. !(wdev->valid_links & BIT(params.link_id)))
  10801. return -EINVAL;
  10802. params.buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
  10803. params.len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
  10804. err = nl80211_parse_counter_offsets(rdev, NULL, params.len, -1,
  10805. info->attrs[NL80211_ATTR_CSA_C_OFFSETS_TX],
  10806. &params.csa_offsets,
  10807. &params.n_csa_offsets);
  10808. if (err)
  10809. return err;
  10810. if (!params.dont_wait_for_ack) {
  10811. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  10812. if (!msg)
  10813. return -ENOMEM;
  10814. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  10815. NL80211_CMD_FRAME);
  10816. if (!hdr) {
  10817. err = -ENOBUFS;
  10818. goto free_msg;
  10819. }
  10820. }
  10821. params.chan = chandef.chan;
  10822. err = cfg80211_mlme_mgmt_tx(rdev, wdev, &params, &cookie);
  10823. if (err)
  10824. goto free_msg;
  10825. if (msg) {
  10826. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  10827. NL80211_ATTR_PAD))
  10828. goto nla_put_failure;
  10829. genlmsg_end(msg, hdr);
  10830. return genlmsg_reply(msg, info);
  10831. }
  10832. return 0;
  10833. nla_put_failure:
  10834. err = -ENOBUFS;
  10835. free_msg:
  10836. nlmsg_free(msg);
  10837. return err;
  10838. }
  10839. static int nl80211_tx_mgmt_cancel_wait(struct sk_buff *skb, struct genl_info *info)
  10840. {
  10841. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10842. struct wireless_dev *wdev = info->user_ptr[1];
  10843. u64 cookie;
  10844. if (!info->attrs[NL80211_ATTR_COOKIE])
  10845. return -EINVAL;
  10846. if (!rdev->ops->mgmt_tx_cancel_wait)
  10847. return -EOPNOTSUPP;
  10848. switch (wdev->iftype) {
  10849. case NL80211_IFTYPE_STATION:
  10850. case NL80211_IFTYPE_ADHOC:
  10851. case NL80211_IFTYPE_P2P_CLIENT:
  10852. case NL80211_IFTYPE_AP:
  10853. case NL80211_IFTYPE_AP_VLAN:
  10854. case NL80211_IFTYPE_P2P_GO:
  10855. case NL80211_IFTYPE_P2P_DEVICE:
  10856. break;
  10857. case NL80211_IFTYPE_NAN:
  10858. if (!wiphy_ext_feature_isset(wdev->wiphy,
  10859. NL80211_EXT_FEATURE_SECURE_NAN))
  10860. return -EOPNOTSUPP;
  10861. break;
  10862. default:
  10863. return -EOPNOTSUPP;
  10864. }
  10865. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  10866. return rdev_mgmt_tx_cancel_wait(rdev, wdev, cookie);
  10867. }
  10868. static int nl80211_set_power_save(struct sk_buff *skb, struct genl_info *info)
  10869. {
  10870. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10871. struct wireless_dev *wdev;
  10872. struct net_device *dev = info->user_ptr[1];
  10873. u8 ps_state;
  10874. bool state;
  10875. int err;
  10876. if (!info->attrs[NL80211_ATTR_PS_STATE])
  10877. return -EINVAL;
  10878. ps_state = nla_get_u32(info->attrs[NL80211_ATTR_PS_STATE]);
  10879. wdev = dev->ieee80211_ptr;
  10880. if (!rdev->ops->set_power_mgmt)
  10881. return -EOPNOTSUPP;
  10882. state = (ps_state == NL80211_PS_ENABLED) ? true : false;
  10883. if (state == wdev->ps)
  10884. return 0;
  10885. err = rdev_set_power_mgmt(rdev, dev, state, wdev->ps_timeout);
  10886. if (!err)
  10887. wdev->ps = state;
  10888. return err;
  10889. }
  10890. static int nl80211_get_power_save(struct sk_buff *skb, struct genl_info *info)
  10891. {
  10892. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10893. enum nl80211_ps_state ps_state;
  10894. struct wireless_dev *wdev;
  10895. struct net_device *dev = info->user_ptr[1];
  10896. struct sk_buff *msg;
  10897. void *hdr;
  10898. int err;
  10899. wdev = dev->ieee80211_ptr;
  10900. if (!rdev->ops->set_power_mgmt)
  10901. return -EOPNOTSUPP;
  10902. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  10903. if (!msg)
  10904. return -ENOMEM;
  10905. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  10906. NL80211_CMD_GET_POWER_SAVE);
  10907. if (!hdr) {
  10908. err = -ENOBUFS;
  10909. goto free_msg;
  10910. }
  10911. if (wdev->ps)
  10912. ps_state = NL80211_PS_ENABLED;
  10913. else
  10914. ps_state = NL80211_PS_DISABLED;
  10915. if (nla_put_u32(msg, NL80211_ATTR_PS_STATE, ps_state))
  10916. goto nla_put_failure;
  10917. genlmsg_end(msg, hdr);
  10918. return genlmsg_reply(msg, info);
  10919. nla_put_failure:
  10920. err = -ENOBUFS;
  10921. free_msg:
  10922. nlmsg_free(msg);
  10923. return err;
  10924. }
  10925. static const struct nla_policy
  10926. nl80211_attr_cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
  10927. [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_BINARY },
  10928. [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U32 },
  10929. [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
  10930. [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
  10931. [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
  10932. [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
  10933. [NL80211_ATTR_CQM_RSSI_LEVEL] = { .type = NLA_S32 },
  10934. };
  10935. static int nl80211_set_cqm_txe(struct genl_info *info,
  10936. u32 rate, u32 pkts, u32 intvl)
  10937. {
  10938. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  10939. struct net_device *dev = info->user_ptr[1];
  10940. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10941. if (rate > 100 || intvl > NL80211_CQM_TXE_MAX_INTVL)
  10942. return -EINVAL;
  10943. if (!rdev->ops->set_cqm_txe_config)
  10944. return -EOPNOTSUPP;
  10945. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  10946. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  10947. return -EOPNOTSUPP;
  10948. return rdev_set_cqm_txe_config(rdev, dev, rate, pkts, intvl);
  10949. }
  10950. static int cfg80211_cqm_rssi_update(struct cfg80211_registered_device *rdev,
  10951. struct net_device *dev,
  10952. struct cfg80211_cqm_config *cqm_config)
  10953. {
  10954. struct wireless_dev *wdev = dev->ieee80211_ptr;
  10955. s32 last, low, high;
  10956. u32 hyst;
  10957. int i, n, low_index;
  10958. int err;
  10959. /*
  10960. * Obtain current RSSI value if possible, if not and no RSSI threshold
  10961. * event has been received yet, we should receive an event after a
  10962. * connection is established and enough beacons received to calculate
  10963. * the average.
  10964. */
  10965. if (!cqm_config->last_rssi_event_value &&
  10966. wdev->links[0].client.current_bss &&
  10967. rdev->ops->get_station) {
  10968. struct station_info sinfo = {};
  10969. u8 *mac_addr;
  10970. mac_addr = wdev->links[0].client.current_bss->pub.bssid;
  10971. err = rdev_get_station(rdev, dev, mac_addr, &sinfo);
  10972. if (err)
  10973. return err;
  10974. cfg80211_sinfo_release_content(&sinfo);
  10975. if (sinfo.filled & BIT_ULL(NL80211_STA_INFO_BEACON_SIGNAL_AVG))
  10976. cqm_config->last_rssi_event_value =
  10977. (s8) sinfo.rx_beacon_signal_avg;
  10978. }
  10979. last = cqm_config->last_rssi_event_value;
  10980. hyst = cqm_config->rssi_hyst;
  10981. n = cqm_config->n_rssi_thresholds;
  10982. for (i = 0; i < n; i++) {
  10983. i = array_index_nospec(i, n);
  10984. if (last < cqm_config->rssi_thresholds[i])
  10985. break;
  10986. }
  10987. low_index = i - 1;
  10988. if (low_index >= 0) {
  10989. low_index = array_index_nospec(low_index, n);
  10990. low = cqm_config->rssi_thresholds[low_index] - hyst;
  10991. } else {
  10992. low = S32_MIN;
  10993. }
  10994. if (i < n) {
  10995. i = array_index_nospec(i, n);
  10996. high = cqm_config->rssi_thresholds[i] + hyst - 1;
  10997. } else {
  10998. high = S32_MAX;
  10999. }
  11000. return rdev_set_cqm_rssi_range_config(rdev, dev, low, high);
  11001. }
  11002. static int nl80211_set_cqm_rssi(struct genl_info *info,
  11003. const s32 *thresholds, int n_thresholds,
  11004. u32 hysteresis)
  11005. {
  11006. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11007. struct cfg80211_cqm_config *cqm_config = NULL, *old;
  11008. struct net_device *dev = info->user_ptr[1];
  11009. struct wireless_dev *wdev = dev->ieee80211_ptr;
  11010. s32 prev = S32_MIN;
  11011. int i, err;
  11012. /* Check all values negative and sorted */
  11013. for (i = 0; i < n_thresholds; i++) {
  11014. if (thresholds[i] > 0 || thresholds[i] <= prev)
  11015. return -EINVAL;
  11016. prev = thresholds[i];
  11017. }
  11018. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  11019. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  11020. return -EOPNOTSUPP;
  11021. if (n_thresholds == 1 && thresholds[0] == 0) /* Disabling */
  11022. n_thresholds = 0;
  11023. old = wiphy_dereference(wdev->wiphy, wdev->cqm_config);
  11024. /* if already disabled just succeed */
  11025. if (!n_thresholds && !old)
  11026. return 0;
  11027. if (n_thresholds > 1) {
  11028. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  11029. NL80211_EXT_FEATURE_CQM_RSSI_LIST) ||
  11030. !rdev->ops->set_cqm_rssi_range_config)
  11031. return -EOPNOTSUPP;
  11032. } else {
  11033. if (!rdev->ops->set_cqm_rssi_config)
  11034. return -EOPNOTSUPP;
  11035. }
  11036. if (n_thresholds) {
  11037. cqm_config = kzalloc(struct_size(cqm_config, rssi_thresholds,
  11038. n_thresholds),
  11039. GFP_KERNEL);
  11040. if (!cqm_config)
  11041. return -ENOMEM;
  11042. cqm_config->rssi_hyst = hysteresis;
  11043. cqm_config->n_rssi_thresholds = n_thresholds;
  11044. memcpy(cqm_config->rssi_thresholds, thresholds,
  11045. flex_array_size(cqm_config, rssi_thresholds,
  11046. n_thresholds));
  11047. cqm_config->use_range_api = n_thresholds > 1 ||
  11048. !rdev->ops->set_cqm_rssi_config;
  11049. rcu_assign_pointer(wdev->cqm_config, cqm_config);
  11050. if (cqm_config->use_range_api)
  11051. err = cfg80211_cqm_rssi_update(rdev, dev, cqm_config);
  11052. else
  11053. err = rdev_set_cqm_rssi_config(rdev, dev,
  11054. thresholds[0],
  11055. hysteresis);
  11056. } else {
  11057. RCU_INIT_POINTER(wdev->cqm_config, NULL);
  11058. /* if enabled as range also disable via range */
  11059. if (old->use_range_api)
  11060. err = rdev_set_cqm_rssi_range_config(rdev, dev, 0, 0);
  11061. else
  11062. err = rdev_set_cqm_rssi_config(rdev, dev, 0, 0);
  11063. }
  11064. if (err) {
  11065. rcu_assign_pointer(wdev->cqm_config, old);
  11066. kfree_rcu(cqm_config, rcu_head);
  11067. } else {
  11068. kfree_rcu(old, rcu_head);
  11069. }
  11070. return err;
  11071. }
  11072. static int nl80211_set_cqm(struct sk_buff *skb, struct genl_info *info)
  11073. {
  11074. struct nlattr *attrs[NL80211_ATTR_CQM_MAX + 1];
  11075. struct nlattr *cqm;
  11076. int err;
  11077. cqm = info->attrs[NL80211_ATTR_CQM];
  11078. if (!cqm)
  11079. return -EINVAL;
  11080. err = nla_parse_nested_deprecated(attrs, NL80211_ATTR_CQM_MAX, cqm,
  11081. nl80211_attr_cqm_policy,
  11082. info->extack);
  11083. if (err)
  11084. return err;
  11085. if (attrs[NL80211_ATTR_CQM_RSSI_THOLD] &&
  11086. attrs[NL80211_ATTR_CQM_RSSI_HYST]) {
  11087. const s32 *thresholds =
  11088. nla_data(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
  11089. int len = nla_len(attrs[NL80211_ATTR_CQM_RSSI_THOLD]);
  11090. u32 hysteresis = nla_get_u32(attrs[NL80211_ATTR_CQM_RSSI_HYST]);
  11091. if (len % 4)
  11092. return -EINVAL;
  11093. return nl80211_set_cqm_rssi(info, thresholds, len / 4,
  11094. hysteresis);
  11095. }
  11096. if (attrs[NL80211_ATTR_CQM_TXE_RATE] &&
  11097. attrs[NL80211_ATTR_CQM_TXE_PKTS] &&
  11098. attrs[NL80211_ATTR_CQM_TXE_INTVL]) {
  11099. u32 rate = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_RATE]);
  11100. u32 pkts = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_PKTS]);
  11101. u32 intvl = nla_get_u32(attrs[NL80211_ATTR_CQM_TXE_INTVL]);
  11102. return nl80211_set_cqm_txe(info, rate, pkts, intvl);
  11103. }
  11104. return -EINVAL;
  11105. }
  11106. static int nl80211_join_ocb(struct sk_buff *skb, struct genl_info *info)
  11107. {
  11108. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11109. struct net_device *dev = info->user_ptr[1];
  11110. struct ocb_setup setup = {};
  11111. int err;
  11112. err = nl80211_parse_chandef(rdev, info, &setup.chandef);
  11113. if (err)
  11114. return err;
  11115. return cfg80211_join_ocb(rdev, dev, &setup);
  11116. }
  11117. static int nl80211_leave_ocb(struct sk_buff *skb, struct genl_info *info)
  11118. {
  11119. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11120. struct net_device *dev = info->user_ptr[1];
  11121. return cfg80211_leave_ocb(rdev, dev);
  11122. }
  11123. static int nl80211_join_mesh(struct sk_buff *skb, struct genl_info *info)
  11124. {
  11125. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11126. struct net_device *dev = info->user_ptr[1];
  11127. struct mesh_config cfg;
  11128. struct mesh_setup setup;
  11129. int err;
  11130. /* start with default */
  11131. memcpy(&cfg, &default_mesh_config, sizeof(cfg));
  11132. memcpy(&setup, &default_mesh_setup, sizeof(setup));
  11133. if (info->attrs[NL80211_ATTR_MESH_CONFIG]) {
  11134. /* and parse parameters if given */
  11135. err = nl80211_parse_mesh_config(info, &cfg, NULL);
  11136. if (err)
  11137. return err;
  11138. }
  11139. if (!info->attrs[NL80211_ATTR_MESH_ID] ||
  11140. !nla_len(info->attrs[NL80211_ATTR_MESH_ID]))
  11141. return -EINVAL;
  11142. setup.mesh_id = nla_data(info->attrs[NL80211_ATTR_MESH_ID]);
  11143. setup.mesh_id_len = nla_len(info->attrs[NL80211_ATTR_MESH_ID]);
  11144. if (info->attrs[NL80211_ATTR_MCAST_RATE] &&
  11145. !nl80211_parse_mcast_rate(rdev, setup.mcast_rate,
  11146. nla_get_u32(info->attrs[NL80211_ATTR_MCAST_RATE])))
  11147. return -EINVAL;
  11148. if (info->attrs[NL80211_ATTR_BEACON_INTERVAL]) {
  11149. setup.beacon_interval =
  11150. nla_get_u32(info->attrs[NL80211_ATTR_BEACON_INTERVAL]);
  11151. err = cfg80211_validate_beacon_int(rdev,
  11152. NL80211_IFTYPE_MESH_POINT,
  11153. setup.beacon_interval);
  11154. if (err)
  11155. return err;
  11156. }
  11157. if (info->attrs[NL80211_ATTR_DTIM_PERIOD]) {
  11158. setup.dtim_period =
  11159. nla_get_u32(info->attrs[NL80211_ATTR_DTIM_PERIOD]);
  11160. if (setup.dtim_period < 1 || setup.dtim_period > 100)
  11161. return -EINVAL;
  11162. }
  11163. if (info->attrs[NL80211_ATTR_MESH_SETUP]) {
  11164. /* parse additional setup parameters if given */
  11165. err = nl80211_parse_mesh_setup(info, &setup);
  11166. if (err)
  11167. return err;
  11168. }
  11169. if (setup.user_mpm)
  11170. cfg.auto_open_plinks = false;
  11171. if (info->attrs[NL80211_ATTR_WIPHY_FREQ]) {
  11172. err = nl80211_parse_chandef(rdev, info, &setup.chandef);
  11173. if (err)
  11174. return err;
  11175. } else {
  11176. /* __cfg80211_join_mesh() will sort it out */
  11177. setup.chandef.chan = NULL;
  11178. }
  11179. if (info->attrs[NL80211_ATTR_BSS_BASIC_RATES]) {
  11180. u8 *rates = nla_data(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  11181. int n_rates =
  11182. nla_len(info->attrs[NL80211_ATTR_BSS_BASIC_RATES]);
  11183. struct ieee80211_supported_band *sband;
  11184. if (!setup.chandef.chan)
  11185. return -EINVAL;
  11186. sband = rdev->wiphy.bands[setup.chandef.chan->band];
  11187. err = ieee80211_get_ratemask(sband, rates, n_rates,
  11188. &setup.basic_rates);
  11189. if (err)
  11190. return err;
  11191. }
  11192. if (info->attrs[NL80211_ATTR_TX_RATES]) {
  11193. err = nl80211_parse_tx_bitrate_mask(info, info->attrs,
  11194. NL80211_ATTR_TX_RATES,
  11195. &setup.beacon_rate,
  11196. dev, false, 0);
  11197. if (err)
  11198. return err;
  11199. if (!setup.chandef.chan)
  11200. return -EINVAL;
  11201. err = validate_beacon_tx_rate(rdev, setup.chandef.chan->band,
  11202. &setup.beacon_rate);
  11203. if (err)
  11204. return err;
  11205. }
  11206. setup.userspace_handles_dfs =
  11207. nla_get_flag(info->attrs[NL80211_ATTR_HANDLE_DFS]);
  11208. if (info->attrs[NL80211_ATTR_CONTROL_PORT_OVER_NL80211]) {
  11209. int r = validate_pae_over_nl80211(rdev, info);
  11210. if (r < 0)
  11211. return r;
  11212. setup.control_port_over_nl80211 = true;
  11213. }
  11214. err = __cfg80211_join_mesh(rdev, dev, &setup, &cfg);
  11215. if (!err && info->attrs[NL80211_ATTR_SOCKET_OWNER])
  11216. dev->ieee80211_ptr->conn_owner_nlportid = info->snd_portid;
  11217. return err;
  11218. }
  11219. static int nl80211_leave_mesh(struct sk_buff *skb, struct genl_info *info)
  11220. {
  11221. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11222. struct net_device *dev = info->user_ptr[1];
  11223. return cfg80211_leave_mesh(rdev, dev);
  11224. }
  11225. #ifdef CONFIG_PM
  11226. static int nl80211_send_wowlan_patterns(struct sk_buff *msg,
  11227. struct cfg80211_registered_device *rdev)
  11228. {
  11229. struct cfg80211_wowlan *wowlan = rdev->wiphy.wowlan_config;
  11230. struct nlattr *nl_pats, *nl_pat;
  11231. int i, pat_len;
  11232. if (!wowlan->n_patterns)
  11233. return 0;
  11234. nl_pats = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN);
  11235. if (!nl_pats)
  11236. return -ENOBUFS;
  11237. for (i = 0; i < wowlan->n_patterns; i++) {
  11238. nl_pat = nla_nest_start_noflag(msg, i + 1);
  11239. if (!nl_pat)
  11240. return -ENOBUFS;
  11241. pat_len = wowlan->patterns[i].pattern_len;
  11242. if (nla_put(msg, NL80211_PKTPAT_MASK, DIV_ROUND_UP(pat_len, 8),
  11243. wowlan->patterns[i].mask) ||
  11244. nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
  11245. wowlan->patterns[i].pattern) ||
  11246. nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
  11247. wowlan->patterns[i].pkt_offset))
  11248. return -ENOBUFS;
  11249. nla_nest_end(msg, nl_pat);
  11250. }
  11251. nla_nest_end(msg, nl_pats);
  11252. return 0;
  11253. }
  11254. static int nl80211_send_wowlan_tcp(struct sk_buff *msg,
  11255. struct cfg80211_wowlan_tcp *tcp)
  11256. {
  11257. struct nlattr *nl_tcp;
  11258. if (!tcp)
  11259. return 0;
  11260. nl_tcp = nla_nest_start_noflag(msg,
  11261. NL80211_WOWLAN_TRIG_TCP_CONNECTION);
  11262. if (!nl_tcp)
  11263. return -ENOBUFS;
  11264. if (nla_put_in_addr(msg, NL80211_WOWLAN_TCP_SRC_IPV4, tcp->src) ||
  11265. nla_put_in_addr(msg, NL80211_WOWLAN_TCP_DST_IPV4, tcp->dst) ||
  11266. nla_put(msg, NL80211_WOWLAN_TCP_DST_MAC, ETH_ALEN, tcp->dst_mac) ||
  11267. nla_put_u16(msg, NL80211_WOWLAN_TCP_SRC_PORT, tcp->src_port) ||
  11268. nla_put_u16(msg, NL80211_WOWLAN_TCP_DST_PORT, tcp->dst_port) ||
  11269. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD,
  11270. tcp->payload_len, tcp->payload) ||
  11271. nla_put_u32(msg, NL80211_WOWLAN_TCP_DATA_INTERVAL,
  11272. tcp->data_interval) ||
  11273. nla_put(msg, NL80211_WOWLAN_TCP_WAKE_PAYLOAD,
  11274. tcp->wake_len, tcp->wake_data) ||
  11275. nla_put(msg, NL80211_WOWLAN_TCP_WAKE_MASK,
  11276. DIV_ROUND_UP(tcp->wake_len, 8), tcp->wake_mask))
  11277. return -ENOBUFS;
  11278. if (tcp->payload_seq.len &&
  11279. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ,
  11280. sizeof(tcp->payload_seq), &tcp->payload_seq))
  11281. return -ENOBUFS;
  11282. if (tcp->payload_tok.len &&
  11283. nla_put(msg, NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN,
  11284. sizeof(tcp->payload_tok) + tcp->tokens_size,
  11285. &tcp->payload_tok))
  11286. return -ENOBUFS;
  11287. nla_nest_end(msg, nl_tcp);
  11288. return 0;
  11289. }
  11290. static int nl80211_send_wowlan_nd(struct sk_buff *msg,
  11291. struct cfg80211_sched_scan_request *req)
  11292. {
  11293. struct nlattr *nd, *freqs, *matches, *match, *scan_plans, *scan_plan;
  11294. int i;
  11295. if (!req)
  11296. return 0;
  11297. nd = nla_nest_start_noflag(msg, NL80211_WOWLAN_TRIG_NET_DETECT);
  11298. if (!nd)
  11299. return -ENOBUFS;
  11300. if (req->n_scan_plans == 1 &&
  11301. nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_INTERVAL,
  11302. req->scan_plans[0].interval * 1000))
  11303. return -ENOBUFS;
  11304. if (nla_put_u32(msg, NL80211_ATTR_SCHED_SCAN_DELAY, req->delay))
  11305. return -ENOBUFS;
  11306. if (req->relative_rssi_set) {
  11307. struct nl80211_bss_select_rssi_adjust rssi_adjust;
  11308. if (nla_put_s8(msg, NL80211_ATTR_SCHED_SCAN_RELATIVE_RSSI,
  11309. req->relative_rssi))
  11310. return -ENOBUFS;
  11311. rssi_adjust.band = req->rssi_adjust.band;
  11312. rssi_adjust.delta = req->rssi_adjust.delta;
  11313. if (nla_put(msg, NL80211_ATTR_SCHED_SCAN_RSSI_ADJUST,
  11314. sizeof(rssi_adjust), &rssi_adjust))
  11315. return -ENOBUFS;
  11316. }
  11317. freqs = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_FREQUENCIES);
  11318. if (!freqs)
  11319. return -ENOBUFS;
  11320. for (i = 0; i < req->n_channels; i++) {
  11321. if (nla_put_u32(msg, i, req->channels[i]->center_freq))
  11322. return -ENOBUFS;
  11323. }
  11324. nla_nest_end(msg, freqs);
  11325. if (req->n_match_sets) {
  11326. matches = nla_nest_start_noflag(msg,
  11327. NL80211_ATTR_SCHED_SCAN_MATCH);
  11328. if (!matches)
  11329. return -ENOBUFS;
  11330. for (i = 0; i < req->n_match_sets; i++) {
  11331. match = nla_nest_start_noflag(msg, i);
  11332. if (!match)
  11333. return -ENOBUFS;
  11334. if (nla_put(msg, NL80211_SCHED_SCAN_MATCH_ATTR_SSID,
  11335. req->match_sets[i].ssid.ssid_len,
  11336. req->match_sets[i].ssid.ssid))
  11337. return -ENOBUFS;
  11338. nla_nest_end(msg, match);
  11339. }
  11340. nla_nest_end(msg, matches);
  11341. }
  11342. scan_plans = nla_nest_start_noflag(msg, NL80211_ATTR_SCHED_SCAN_PLANS);
  11343. if (!scan_plans)
  11344. return -ENOBUFS;
  11345. for (i = 0; i < req->n_scan_plans; i++) {
  11346. scan_plan = nla_nest_start_noflag(msg, i + 1);
  11347. if (!scan_plan)
  11348. return -ENOBUFS;
  11349. if (nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_INTERVAL,
  11350. req->scan_plans[i].interval) ||
  11351. (req->scan_plans[i].iterations &&
  11352. nla_put_u32(msg, NL80211_SCHED_SCAN_PLAN_ITERATIONS,
  11353. req->scan_plans[i].iterations)))
  11354. return -ENOBUFS;
  11355. nla_nest_end(msg, scan_plan);
  11356. }
  11357. nla_nest_end(msg, scan_plans);
  11358. nla_nest_end(msg, nd);
  11359. return 0;
  11360. }
  11361. static int nl80211_get_wowlan(struct sk_buff *skb, struct genl_info *info)
  11362. {
  11363. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11364. struct sk_buff *msg;
  11365. void *hdr;
  11366. u32 size = NLMSG_DEFAULT_SIZE;
  11367. if (!rdev->wiphy.wowlan)
  11368. return -EOPNOTSUPP;
  11369. if (rdev->wiphy.wowlan_config && rdev->wiphy.wowlan_config->tcp) {
  11370. /* adjust size to have room for all the data */
  11371. size += rdev->wiphy.wowlan_config->tcp->tokens_size +
  11372. rdev->wiphy.wowlan_config->tcp->payload_len +
  11373. rdev->wiphy.wowlan_config->tcp->wake_len +
  11374. rdev->wiphy.wowlan_config->tcp->wake_len / 8;
  11375. }
  11376. msg = nlmsg_new(size, GFP_KERNEL);
  11377. if (!msg)
  11378. return -ENOMEM;
  11379. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  11380. NL80211_CMD_GET_WOWLAN);
  11381. if (!hdr)
  11382. goto nla_put_failure;
  11383. if (rdev->wiphy.wowlan_config) {
  11384. struct nlattr *nl_wowlan;
  11385. nl_wowlan = nla_nest_start_noflag(msg,
  11386. NL80211_ATTR_WOWLAN_TRIGGERS);
  11387. if (!nl_wowlan)
  11388. goto nla_put_failure;
  11389. if ((rdev->wiphy.wowlan_config->any &&
  11390. nla_put_flag(msg, NL80211_WOWLAN_TRIG_ANY)) ||
  11391. (rdev->wiphy.wowlan_config->disconnect &&
  11392. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT)) ||
  11393. (rdev->wiphy.wowlan_config->magic_pkt &&
  11394. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT)) ||
  11395. (rdev->wiphy.wowlan_config->gtk_rekey_failure &&
  11396. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE)) ||
  11397. (rdev->wiphy.wowlan_config->eap_identity_req &&
  11398. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST)) ||
  11399. (rdev->wiphy.wowlan_config->four_way_handshake &&
  11400. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE)) ||
  11401. (rdev->wiphy.wowlan_config->rfkill_release &&
  11402. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE)))
  11403. goto nla_put_failure;
  11404. if (nl80211_send_wowlan_patterns(msg, rdev))
  11405. goto nla_put_failure;
  11406. if (nl80211_send_wowlan_tcp(msg,
  11407. rdev->wiphy.wowlan_config->tcp))
  11408. goto nla_put_failure;
  11409. if (nl80211_send_wowlan_nd(
  11410. msg,
  11411. rdev->wiphy.wowlan_config->nd_config))
  11412. goto nla_put_failure;
  11413. nla_nest_end(msg, nl_wowlan);
  11414. }
  11415. genlmsg_end(msg, hdr);
  11416. return genlmsg_reply(msg, info);
  11417. nla_put_failure:
  11418. nlmsg_free(msg);
  11419. return -ENOBUFS;
  11420. }
  11421. static int nl80211_parse_wowlan_tcp(struct cfg80211_registered_device *rdev,
  11422. struct nlattr *attr,
  11423. struct cfg80211_wowlan *trig)
  11424. {
  11425. struct nlattr *tb[NUM_NL80211_WOWLAN_TCP];
  11426. struct cfg80211_wowlan_tcp *cfg;
  11427. struct nl80211_wowlan_tcp_data_token *tok = NULL;
  11428. struct nl80211_wowlan_tcp_data_seq *seq = NULL;
  11429. u32 size;
  11430. u32 data_size, wake_size, tokens_size = 0, wake_mask_size;
  11431. int err, port;
  11432. if (!rdev->wiphy.wowlan->tcp)
  11433. return -EINVAL;
  11434. err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TCP, attr,
  11435. nl80211_wowlan_tcp_policy, NULL);
  11436. if (err)
  11437. return err;
  11438. if (!tb[NL80211_WOWLAN_TCP_SRC_IPV4] ||
  11439. !tb[NL80211_WOWLAN_TCP_DST_IPV4] ||
  11440. !tb[NL80211_WOWLAN_TCP_DST_MAC] ||
  11441. !tb[NL80211_WOWLAN_TCP_DST_PORT] ||
  11442. !tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD] ||
  11443. !tb[NL80211_WOWLAN_TCP_DATA_INTERVAL] ||
  11444. !tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD] ||
  11445. !tb[NL80211_WOWLAN_TCP_WAKE_MASK])
  11446. return -EINVAL;
  11447. data_size = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]);
  11448. if (data_size > rdev->wiphy.wowlan->tcp->data_payload_max)
  11449. return -EINVAL;
  11450. if (nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) >
  11451. rdev->wiphy.wowlan->tcp->data_interval_max ||
  11452. nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]) == 0)
  11453. return -EINVAL;
  11454. wake_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]);
  11455. if (wake_size > rdev->wiphy.wowlan->tcp->wake_payload_max)
  11456. return -EINVAL;
  11457. wake_mask_size = nla_len(tb[NL80211_WOWLAN_TCP_WAKE_MASK]);
  11458. if (wake_mask_size != DIV_ROUND_UP(wake_size, 8))
  11459. return -EINVAL;
  11460. if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]) {
  11461. u32 tokln = nla_len(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
  11462. tok = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_TOKEN]);
  11463. tokens_size = tokln - sizeof(*tok);
  11464. if (!tok->len || tokens_size % tok->len)
  11465. return -EINVAL;
  11466. if (!rdev->wiphy.wowlan->tcp->tok)
  11467. return -EINVAL;
  11468. if (tok->len > rdev->wiphy.wowlan->tcp->tok->max_len)
  11469. return -EINVAL;
  11470. if (tok->len < rdev->wiphy.wowlan->tcp->tok->min_len)
  11471. return -EINVAL;
  11472. if (tokens_size > rdev->wiphy.wowlan->tcp->tok->bufsize)
  11473. return -EINVAL;
  11474. if (tok->offset + tok->len > data_size)
  11475. return -EINVAL;
  11476. }
  11477. if (tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]) {
  11478. seq = nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD_SEQ]);
  11479. if (!rdev->wiphy.wowlan->tcp->seq)
  11480. return -EINVAL;
  11481. if (seq->len == 0 || seq->len > 4)
  11482. return -EINVAL;
  11483. if (seq->len + seq->offset > data_size)
  11484. return -EINVAL;
  11485. }
  11486. size = sizeof(*cfg);
  11487. size += data_size;
  11488. size += wake_size + wake_mask_size;
  11489. size += tokens_size;
  11490. cfg = kzalloc(size, GFP_KERNEL);
  11491. if (!cfg)
  11492. return -ENOMEM;
  11493. cfg->src = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_SRC_IPV4]);
  11494. cfg->dst = nla_get_in_addr(tb[NL80211_WOWLAN_TCP_DST_IPV4]);
  11495. memcpy(cfg->dst_mac, nla_data(tb[NL80211_WOWLAN_TCP_DST_MAC]),
  11496. ETH_ALEN);
  11497. if (tb[NL80211_WOWLAN_TCP_SRC_PORT])
  11498. port = nla_get_u16(tb[NL80211_WOWLAN_TCP_SRC_PORT]);
  11499. else
  11500. port = 0;
  11501. #ifdef CONFIG_INET
  11502. /* allocate a socket and port for it and use it */
  11503. err = __sock_create(wiphy_net(&rdev->wiphy), PF_INET, SOCK_STREAM,
  11504. IPPROTO_TCP, &cfg->sock, 1);
  11505. if (err) {
  11506. kfree(cfg);
  11507. return err;
  11508. }
  11509. if (inet_csk_get_port(cfg->sock->sk, port)) {
  11510. sock_release(cfg->sock);
  11511. kfree(cfg);
  11512. return -EADDRINUSE;
  11513. }
  11514. cfg->src_port = inet_sk(cfg->sock->sk)->inet_num;
  11515. #else
  11516. if (!port) {
  11517. kfree(cfg);
  11518. return -EINVAL;
  11519. }
  11520. cfg->src_port = port;
  11521. #endif
  11522. cfg->dst_port = nla_get_u16(tb[NL80211_WOWLAN_TCP_DST_PORT]);
  11523. cfg->payload_len = data_size;
  11524. cfg->payload = (u8 *)cfg + sizeof(*cfg) + tokens_size;
  11525. memcpy((void *)cfg->payload,
  11526. nla_data(tb[NL80211_WOWLAN_TCP_DATA_PAYLOAD]),
  11527. data_size);
  11528. if (seq)
  11529. cfg->payload_seq = *seq;
  11530. cfg->data_interval = nla_get_u32(tb[NL80211_WOWLAN_TCP_DATA_INTERVAL]);
  11531. cfg->wake_len = wake_size;
  11532. cfg->wake_data = (u8 *)cfg + sizeof(*cfg) + tokens_size + data_size;
  11533. memcpy((void *)cfg->wake_data,
  11534. nla_data(tb[NL80211_WOWLAN_TCP_WAKE_PAYLOAD]),
  11535. wake_size);
  11536. cfg->wake_mask = (u8 *)cfg + sizeof(*cfg) + tokens_size +
  11537. data_size + wake_size;
  11538. memcpy((void *)cfg->wake_mask,
  11539. nla_data(tb[NL80211_WOWLAN_TCP_WAKE_MASK]),
  11540. wake_mask_size);
  11541. if (tok) {
  11542. cfg->tokens_size = tokens_size;
  11543. cfg->payload_tok = *tok;
  11544. memcpy(cfg->payload_tok.token_stream, tok->token_stream,
  11545. tokens_size);
  11546. }
  11547. trig->tcp = cfg;
  11548. return 0;
  11549. }
  11550. static int nl80211_parse_wowlan_nd(struct cfg80211_registered_device *rdev,
  11551. const struct wiphy_wowlan_support *wowlan,
  11552. struct nlattr *attr,
  11553. struct cfg80211_wowlan *trig)
  11554. {
  11555. struct nlattr **tb;
  11556. int err;
  11557. tb = kcalloc(NUM_NL80211_ATTR, sizeof(*tb), GFP_KERNEL);
  11558. if (!tb)
  11559. return -ENOMEM;
  11560. if (!(wowlan->flags & WIPHY_WOWLAN_NET_DETECT)) {
  11561. err = -EOPNOTSUPP;
  11562. goto out;
  11563. }
  11564. err = nla_parse_nested_deprecated(tb, NL80211_ATTR_MAX, attr,
  11565. nl80211_policy, NULL);
  11566. if (err)
  11567. goto out;
  11568. trig->nd_config = nl80211_parse_sched_scan(&rdev->wiphy, NULL, tb,
  11569. wowlan->max_nd_match_sets);
  11570. err = PTR_ERR_OR_ZERO(trig->nd_config);
  11571. if (err)
  11572. trig->nd_config = NULL;
  11573. out:
  11574. kfree(tb);
  11575. return err;
  11576. }
  11577. static int nl80211_set_wowlan(struct sk_buff *skb, struct genl_info *info)
  11578. {
  11579. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11580. struct nlattr *tb[NUM_NL80211_WOWLAN_TRIG];
  11581. struct cfg80211_wowlan new_triggers = {};
  11582. struct cfg80211_wowlan *ntrig;
  11583. const struct wiphy_wowlan_support *wowlan = rdev->wiphy.wowlan;
  11584. int err, i;
  11585. bool prev_enabled = rdev->wiphy.wowlan_config;
  11586. bool regular = false;
  11587. if (!wowlan)
  11588. return -EOPNOTSUPP;
  11589. if (!info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS]) {
  11590. cfg80211_rdev_free_wowlan(rdev);
  11591. rdev->wiphy.wowlan_config = NULL;
  11592. goto set_wakeup;
  11593. }
  11594. err = nla_parse_nested_deprecated(tb, MAX_NL80211_WOWLAN_TRIG,
  11595. info->attrs[NL80211_ATTR_WOWLAN_TRIGGERS],
  11596. nl80211_wowlan_policy, info->extack);
  11597. if (err)
  11598. return err;
  11599. if (tb[NL80211_WOWLAN_TRIG_ANY]) {
  11600. if (!(wowlan->flags & WIPHY_WOWLAN_ANY))
  11601. return -EINVAL;
  11602. new_triggers.any = true;
  11603. }
  11604. if (tb[NL80211_WOWLAN_TRIG_DISCONNECT]) {
  11605. if (!(wowlan->flags & WIPHY_WOWLAN_DISCONNECT))
  11606. return -EINVAL;
  11607. new_triggers.disconnect = true;
  11608. regular = true;
  11609. }
  11610. if (tb[NL80211_WOWLAN_TRIG_MAGIC_PKT]) {
  11611. if (!(wowlan->flags & WIPHY_WOWLAN_MAGIC_PKT))
  11612. return -EINVAL;
  11613. new_triggers.magic_pkt = true;
  11614. regular = true;
  11615. }
  11616. if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_SUPPORTED])
  11617. return -EINVAL;
  11618. if (tb[NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE]) {
  11619. if (!(wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE))
  11620. return -EINVAL;
  11621. new_triggers.gtk_rekey_failure = true;
  11622. regular = true;
  11623. }
  11624. if (tb[NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST]) {
  11625. if (!(wowlan->flags & WIPHY_WOWLAN_EAP_IDENTITY_REQ))
  11626. return -EINVAL;
  11627. new_triggers.eap_identity_req = true;
  11628. regular = true;
  11629. }
  11630. if (tb[NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE]) {
  11631. if (!(wowlan->flags & WIPHY_WOWLAN_4WAY_HANDSHAKE))
  11632. return -EINVAL;
  11633. new_triggers.four_way_handshake = true;
  11634. regular = true;
  11635. }
  11636. if (tb[NL80211_WOWLAN_TRIG_RFKILL_RELEASE]) {
  11637. if (!(wowlan->flags & WIPHY_WOWLAN_RFKILL_RELEASE))
  11638. return -EINVAL;
  11639. new_triggers.rfkill_release = true;
  11640. regular = true;
  11641. }
  11642. if (tb[NL80211_WOWLAN_TRIG_PKT_PATTERN]) {
  11643. struct nlattr *pat;
  11644. int n_patterns = 0;
  11645. int rem, pat_len, mask_len, pkt_offset;
  11646. struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
  11647. regular = true;
  11648. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  11649. rem)
  11650. n_patterns++;
  11651. if (n_patterns > wowlan->n_patterns)
  11652. return -EINVAL;
  11653. new_triggers.patterns = kcalloc(n_patterns,
  11654. sizeof(new_triggers.patterns[0]),
  11655. GFP_KERNEL);
  11656. if (!new_triggers.patterns)
  11657. return -ENOMEM;
  11658. new_triggers.n_patterns = n_patterns;
  11659. i = 0;
  11660. nla_for_each_nested(pat, tb[NL80211_WOWLAN_TRIG_PKT_PATTERN],
  11661. rem) {
  11662. u8 *mask_pat;
  11663. err = nla_parse_nested_deprecated(pat_tb,
  11664. MAX_NL80211_PKTPAT,
  11665. pat,
  11666. nl80211_packet_pattern_policy,
  11667. info->extack);
  11668. if (err)
  11669. goto error;
  11670. err = -EINVAL;
  11671. if (!pat_tb[NL80211_PKTPAT_MASK] ||
  11672. !pat_tb[NL80211_PKTPAT_PATTERN])
  11673. goto error;
  11674. pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
  11675. mask_len = DIV_ROUND_UP(pat_len, 8);
  11676. if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
  11677. goto error;
  11678. if (pat_len > wowlan->pattern_max_len ||
  11679. pat_len < wowlan->pattern_min_len)
  11680. goto error;
  11681. if (!pat_tb[NL80211_PKTPAT_OFFSET])
  11682. pkt_offset = 0;
  11683. else
  11684. pkt_offset = nla_get_u32(
  11685. pat_tb[NL80211_PKTPAT_OFFSET]);
  11686. if (pkt_offset > wowlan->max_pkt_offset)
  11687. goto error;
  11688. new_triggers.patterns[i].pkt_offset = pkt_offset;
  11689. mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
  11690. if (!mask_pat) {
  11691. err = -ENOMEM;
  11692. goto error;
  11693. }
  11694. new_triggers.patterns[i].mask = mask_pat;
  11695. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
  11696. mask_len);
  11697. mask_pat += mask_len;
  11698. new_triggers.patterns[i].pattern = mask_pat;
  11699. new_triggers.patterns[i].pattern_len = pat_len;
  11700. memcpy(mask_pat,
  11701. nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
  11702. pat_len);
  11703. i++;
  11704. }
  11705. }
  11706. if (tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION]) {
  11707. regular = true;
  11708. err = nl80211_parse_wowlan_tcp(
  11709. rdev, tb[NL80211_WOWLAN_TRIG_TCP_CONNECTION],
  11710. &new_triggers);
  11711. if (err)
  11712. goto error;
  11713. }
  11714. if (tb[NL80211_WOWLAN_TRIG_NET_DETECT]) {
  11715. regular = true;
  11716. err = nl80211_parse_wowlan_nd(
  11717. rdev, wowlan, tb[NL80211_WOWLAN_TRIG_NET_DETECT],
  11718. &new_triggers);
  11719. if (err)
  11720. goto error;
  11721. }
  11722. /* The 'any' trigger means the device continues operating more or less
  11723. * as in its normal operation mode and wakes up the host on most of the
  11724. * normal interrupts (like packet RX, ...)
  11725. * It therefore makes little sense to combine with the more constrained
  11726. * wakeup trigger modes.
  11727. */
  11728. if (new_triggers.any && regular) {
  11729. err = -EINVAL;
  11730. goto error;
  11731. }
  11732. ntrig = kmemdup(&new_triggers, sizeof(new_triggers), GFP_KERNEL);
  11733. if (!ntrig) {
  11734. err = -ENOMEM;
  11735. goto error;
  11736. }
  11737. cfg80211_rdev_free_wowlan(rdev);
  11738. rdev->wiphy.wowlan_config = ntrig;
  11739. set_wakeup:
  11740. if (rdev->ops->set_wakeup &&
  11741. prev_enabled != !!rdev->wiphy.wowlan_config)
  11742. rdev_set_wakeup(rdev, rdev->wiphy.wowlan_config);
  11743. return 0;
  11744. error:
  11745. for (i = 0; i < new_triggers.n_patterns; i++)
  11746. kfree(new_triggers.patterns[i].mask);
  11747. kfree(new_triggers.patterns);
  11748. if (new_triggers.tcp && new_triggers.tcp->sock)
  11749. sock_release(new_triggers.tcp->sock);
  11750. kfree(new_triggers.tcp);
  11751. kfree(new_triggers.nd_config);
  11752. return err;
  11753. }
  11754. #endif
  11755. static int nl80211_send_coalesce_rules(struct sk_buff *msg,
  11756. struct cfg80211_registered_device *rdev)
  11757. {
  11758. struct nlattr *nl_pats, *nl_pat, *nl_rule, *nl_rules;
  11759. int i, j, pat_len;
  11760. struct cfg80211_coalesce_rules *rule;
  11761. if (!rdev->coalesce->n_rules)
  11762. return 0;
  11763. nl_rules = nla_nest_start_noflag(msg, NL80211_ATTR_COALESCE_RULE);
  11764. if (!nl_rules)
  11765. return -ENOBUFS;
  11766. for (i = 0; i < rdev->coalesce->n_rules; i++) {
  11767. nl_rule = nla_nest_start_noflag(msg, i + 1);
  11768. if (!nl_rule)
  11769. return -ENOBUFS;
  11770. rule = &rdev->coalesce->rules[i];
  11771. if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_DELAY,
  11772. rule->delay))
  11773. return -ENOBUFS;
  11774. if (nla_put_u32(msg, NL80211_ATTR_COALESCE_RULE_CONDITION,
  11775. rule->condition))
  11776. return -ENOBUFS;
  11777. nl_pats = nla_nest_start_noflag(msg,
  11778. NL80211_ATTR_COALESCE_RULE_PKT_PATTERN);
  11779. if (!nl_pats)
  11780. return -ENOBUFS;
  11781. for (j = 0; j < rule->n_patterns; j++) {
  11782. nl_pat = nla_nest_start_noflag(msg, j + 1);
  11783. if (!nl_pat)
  11784. return -ENOBUFS;
  11785. pat_len = rule->patterns[j].pattern_len;
  11786. if (nla_put(msg, NL80211_PKTPAT_MASK,
  11787. DIV_ROUND_UP(pat_len, 8),
  11788. rule->patterns[j].mask) ||
  11789. nla_put(msg, NL80211_PKTPAT_PATTERN, pat_len,
  11790. rule->patterns[j].pattern) ||
  11791. nla_put_u32(msg, NL80211_PKTPAT_OFFSET,
  11792. rule->patterns[j].pkt_offset))
  11793. return -ENOBUFS;
  11794. nla_nest_end(msg, nl_pat);
  11795. }
  11796. nla_nest_end(msg, nl_pats);
  11797. nla_nest_end(msg, nl_rule);
  11798. }
  11799. nla_nest_end(msg, nl_rules);
  11800. return 0;
  11801. }
  11802. static int nl80211_get_coalesce(struct sk_buff *skb, struct genl_info *info)
  11803. {
  11804. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11805. struct sk_buff *msg;
  11806. void *hdr;
  11807. if (!rdev->wiphy.coalesce)
  11808. return -EOPNOTSUPP;
  11809. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  11810. if (!msg)
  11811. return -ENOMEM;
  11812. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  11813. NL80211_CMD_GET_COALESCE);
  11814. if (!hdr)
  11815. goto nla_put_failure;
  11816. if (rdev->coalesce && nl80211_send_coalesce_rules(msg, rdev))
  11817. goto nla_put_failure;
  11818. genlmsg_end(msg, hdr);
  11819. return genlmsg_reply(msg, info);
  11820. nla_put_failure:
  11821. nlmsg_free(msg);
  11822. return -ENOBUFS;
  11823. }
  11824. void cfg80211_free_coalesce(struct cfg80211_coalesce *coalesce)
  11825. {
  11826. int i, j;
  11827. struct cfg80211_coalesce_rules *rule;
  11828. if (!coalesce)
  11829. return;
  11830. for (i = 0; i < coalesce->n_rules; i++) {
  11831. rule = &coalesce->rules[i];
  11832. if (!rule)
  11833. continue;
  11834. for (j = 0; j < rule->n_patterns; j++)
  11835. kfree(rule->patterns[j].mask);
  11836. kfree(rule->patterns);
  11837. }
  11838. kfree(coalesce);
  11839. }
  11840. static int nl80211_parse_coalesce_rule(struct cfg80211_registered_device *rdev,
  11841. struct nlattr *rule,
  11842. struct cfg80211_coalesce_rules *new_rule)
  11843. {
  11844. int err, i;
  11845. const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
  11846. struct nlattr *tb[NUM_NL80211_ATTR_COALESCE_RULE], *pat;
  11847. int rem, pat_len, mask_len, pkt_offset, n_patterns = 0;
  11848. struct nlattr *pat_tb[NUM_NL80211_PKTPAT];
  11849. err = nla_parse_nested_deprecated(tb, NL80211_ATTR_COALESCE_RULE_MAX,
  11850. rule, nl80211_coalesce_policy, NULL);
  11851. if (err)
  11852. return err;
  11853. if (tb[NL80211_ATTR_COALESCE_RULE_DELAY])
  11854. new_rule->delay =
  11855. nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_DELAY]);
  11856. if (new_rule->delay > coalesce->max_delay)
  11857. return -EINVAL;
  11858. if (tb[NL80211_ATTR_COALESCE_RULE_CONDITION])
  11859. new_rule->condition =
  11860. nla_get_u32(tb[NL80211_ATTR_COALESCE_RULE_CONDITION]);
  11861. if (!tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN])
  11862. return -EINVAL;
  11863. nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
  11864. rem)
  11865. n_patterns++;
  11866. if (n_patterns > coalesce->n_patterns)
  11867. return -EINVAL;
  11868. new_rule->patterns = kcalloc(n_patterns, sizeof(new_rule->patterns[0]),
  11869. GFP_KERNEL);
  11870. if (!new_rule->patterns)
  11871. return -ENOMEM;
  11872. new_rule->n_patterns = n_patterns;
  11873. i = 0;
  11874. nla_for_each_nested(pat, tb[NL80211_ATTR_COALESCE_RULE_PKT_PATTERN],
  11875. rem) {
  11876. u8 *mask_pat;
  11877. err = nla_parse_nested_deprecated(pat_tb, MAX_NL80211_PKTPAT,
  11878. pat,
  11879. nl80211_packet_pattern_policy,
  11880. NULL);
  11881. if (err)
  11882. return err;
  11883. if (!pat_tb[NL80211_PKTPAT_MASK] ||
  11884. !pat_tb[NL80211_PKTPAT_PATTERN])
  11885. return -EINVAL;
  11886. pat_len = nla_len(pat_tb[NL80211_PKTPAT_PATTERN]);
  11887. mask_len = DIV_ROUND_UP(pat_len, 8);
  11888. if (nla_len(pat_tb[NL80211_PKTPAT_MASK]) != mask_len)
  11889. return -EINVAL;
  11890. if (pat_len > coalesce->pattern_max_len ||
  11891. pat_len < coalesce->pattern_min_len)
  11892. return -EINVAL;
  11893. if (!pat_tb[NL80211_PKTPAT_OFFSET])
  11894. pkt_offset = 0;
  11895. else
  11896. pkt_offset = nla_get_u32(pat_tb[NL80211_PKTPAT_OFFSET]);
  11897. if (pkt_offset > coalesce->max_pkt_offset)
  11898. return -EINVAL;
  11899. new_rule->patterns[i].pkt_offset = pkt_offset;
  11900. mask_pat = kmalloc(mask_len + pat_len, GFP_KERNEL);
  11901. if (!mask_pat)
  11902. return -ENOMEM;
  11903. new_rule->patterns[i].mask = mask_pat;
  11904. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_MASK]),
  11905. mask_len);
  11906. mask_pat += mask_len;
  11907. new_rule->patterns[i].pattern = mask_pat;
  11908. new_rule->patterns[i].pattern_len = pat_len;
  11909. memcpy(mask_pat, nla_data(pat_tb[NL80211_PKTPAT_PATTERN]),
  11910. pat_len);
  11911. i++;
  11912. }
  11913. return 0;
  11914. }
  11915. static int nl80211_set_coalesce(struct sk_buff *skb, struct genl_info *info)
  11916. {
  11917. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11918. const struct wiphy_coalesce_support *coalesce = rdev->wiphy.coalesce;
  11919. struct cfg80211_coalesce *new_coalesce;
  11920. int err, rem_rule, n_rules = 0, i;
  11921. struct nlattr *rule;
  11922. if (!rdev->wiphy.coalesce || !rdev->ops->set_coalesce)
  11923. return -EOPNOTSUPP;
  11924. if (!info->attrs[NL80211_ATTR_COALESCE_RULE]) {
  11925. cfg80211_free_coalesce(rdev->coalesce);
  11926. rdev->coalesce = NULL;
  11927. rdev_set_coalesce(rdev, NULL);
  11928. return 0;
  11929. }
  11930. nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
  11931. rem_rule)
  11932. n_rules++;
  11933. if (n_rules > coalesce->n_rules)
  11934. return -EINVAL;
  11935. new_coalesce = kzalloc(struct_size(new_coalesce, rules, n_rules),
  11936. GFP_KERNEL);
  11937. if (!new_coalesce)
  11938. return -ENOMEM;
  11939. new_coalesce->n_rules = n_rules;
  11940. i = 0;
  11941. nla_for_each_nested(rule, info->attrs[NL80211_ATTR_COALESCE_RULE],
  11942. rem_rule) {
  11943. err = nl80211_parse_coalesce_rule(rdev, rule,
  11944. &new_coalesce->rules[i]);
  11945. if (err)
  11946. goto error;
  11947. i++;
  11948. }
  11949. err = rdev_set_coalesce(rdev, new_coalesce);
  11950. if (err)
  11951. goto error;
  11952. cfg80211_free_coalesce(rdev->coalesce);
  11953. rdev->coalesce = new_coalesce;
  11954. return 0;
  11955. error:
  11956. cfg80211_free_coalesce(new_coalesce);
  11957. return err;
  11958. }
  11959. static int nl80211_set_rekey_data(struct sk_buff *skb, struct genl_info *info)
  11960. {
  11961. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  11962. struct net_device *dev = info->user_ptr[1];
  11963. struct wireless_dev *wdev = dev->ieee80211_ptr;
  11964. struct nlattr *tb[NUM_NL80211_REKEY_DATA];
  11965. struct cfg80211_gtk_rekey_data rekey_data = {};
  11966. int err;
  11967. if (!info->attrs[NL80211_ATTR_REKEY_DATA])
  11968. return -EINVAL;
  11969. err = nla_parse_nested_deprecated(tb, MAX_NL80211_REKEY_DATA,
  11970. info->attrs[NL80211_ATTR_REKEY_DATA],
  11971. nl80211_rekey_policy, info->extack);
  11972. if (err)
  11973. return err;
  11974. if (!tb[NL80211_REKEY_DATA_REPLAY_CTR] || !tb[NL80211_REKEY_DATA_KEK] ||
  11975. !tb[NL80211_REKEY_DATA_KCK])
  11976. return -EINVAL;
  11977. if (nla_len(tb[NL80211_REKEY_DATA_KEK]) != NL80211_KEK_LEN &&
  11978. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK &&
  11979. nla_len(tb[NL80211_REKEY_DATA_KEK]) == NL80211_KEK_EXT_LEN))
  11980. return -ERANGE;
  11981. if (nla_len(tb[NL80211_REKEY_DATA_KCK]) != NL80211_KCK_LEN &&
  11982. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KEK_KCK &&
  11983. nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN) &&
  11984. !(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_EXT_KCK_32 &&
  11985. nla_len(tb[NL80211_REKEY_DATA_KCK]) == NL80211_KCK_EXT_LEN_32))
  11986. return -ERANGE;
  11987. rekey_data.kek = nla_data(tb[NL80211_REKEY_DATA_KEK]);
  11988. rekey_data.kck = nla_data(tb[NL80211_REKEY_DATA_KCK]);
  11989. rekey_data.replay_ctr = nla_data(tb[NL80211_REKEY_DATA_REPLAY_CTR]);
  11990. rekey_data.kek_len = nla_len(tb[NL80211_REKEY_DATA_KEK]);
  11991. rekey_data.kck_len = nla_len(tb[NL80211_REKEY_DATA_KCK]);
  11992. if (tb[NL80211_REKEY_DATA_AKM])
  11993. rekey_data.akm = nla_get_u32(tb[NL80211_REKEY_DATA_AKM]);
  11994. if (!wdev->connected)
  11995. return -ENOTCONN;
  11996. if (!rdev->ops->set_rekey_data)
  11997. return -EOPNOTSUPP;
  11998. return rdev_set_rekey_data(rdev, dev, &rekey_data);
  11999. }
  12000. static int nl80211_register_unexpected_frame(struct sk_buff *skb,
  12001. struct genl_info *info)
  12002. {
  12003. struct net_device *dev = info->user_ptr[1];
  12004. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12005. if (wdev->iftype != NL80211_IFTYPE_AP &&
  12006. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  12007. return -EINVAL;
  12008. if (wdev->ap_unexpected_nlportid)
  12009. return -EBUSY;
  12010. wdev->ap_unexpected_nlportid = info->snd_portid;
  12011. return 0;
  12012. }
  12013. static int nl80211_probe_client(struct sk_buff *skb,
  12014. struct genl_info *info)
  12015. {
  12016. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12017. struct net_device *dev = info->user_ptr[1];
  12018. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12019. struct sk_buff *msg;
  12020. void *hdr;
  12021. const u8 *addr;
  12022. u64 cookie;
  12023. int err;
  12024. if (wdev->iftype != NL80211_IFTYPE_AP &&
  12025. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  12026. return -EOPNOTSUPP;
  12027. if (!info->attrs[NL80211_ATTR_MAC])
  12028. return -EINVAL;
  12029. if (!rdev->ops->probe_client)
  12030. return -EOPNOTSUPP;
  12031. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  12032. if (!msg)
  12033. return -ENOMEM;
  12034. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  12035. NL80211_CMD_PROBE_CLIENT);
  12036. if (!hdr) {
  12037. err = -ENOBUFS;
  12038. goto free_msg;
  12039. }
  12040. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12041. err = rdev_probe_client(rdev, dev, addr, &cookie);
  12042. if (err)
  12043. goto free_msg;
  12044. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  12045. NL80211_ATTR_PAD))
  12046. goto nla_put_failure;
  12047. genlmsg_end(msg, hdr);
  12048. return genlmsg_reply(msg, info);
  12049. nla_put_failure:
  12050. err = -ENOBUFS;
  12051. free_msg:
  12052. nlmsg_free(msg);
  12053. return err;
  12054. }
  12055. static int nl80211_register_beacons(struct sk_buff *skb, struct genl_info *info)
  12056. {
  12057. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12058. struct cfg80211_beacon_registration *reg, *nreg;
  12059. int rv;
  12060. if (!(rdev->wiphy.flags & WIPHY_FLAG_REPORTS_OBSS))
  12061. return -EOPNOTSUPP;
  12062. nreg = kzalloc(sizeof(*nreg), GFP_KERNEL);
  12063. if (!nreg)
  12064. return -ENOMEM;
  12065. /* First, check if already registered. */
  12066. spin_lock_bh(&rdev->beacon_registrations_lock);
  12067. list_for_each_entry(reg, &rdev->beacon_registrations, list) {
  12068. if (reg->nlportid == info->snd_portid) {
  12069. rv = -EALREADY;
  12070. goto out_err;
  12071. }
  12072. }
  12073. /* Add it to the list */
  12074. nreg->nlportid = info->snd_portid;
  12075. list_add(&nreg->list, &rdev->beacon_registrations);
  12076. spin_unlock_bh(&rdev->beacon_registrations_lock);
  12077. return 0;
  12078. out_err:
  12079. spin_unlock_bh(&rdev->beacon_registrations_lock);
  12080. kfree(nreg);
  12081. return rv;
  12082. }
  12083. static int nl80211_start_p2p_device(struct sk_buff *skb, struct genl_info *info)
  12084. {
  12085. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12086. struct wireless_dev *wdev = info->user_ptr[1];
  12087. int err;
  12088. if (!rdev->ops->start_p2p_device)
  12089. return -EOPNOTSUPP;
  12090. if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
  12091. return -EOPNOTSUPP;
  12092. if (wdev_running(wdev))
  12093. return 0;
  12094. if (rfkill_blocked(rdev->wiphy.rfkill))
  12095. return -ERFKILL;
  12096. err = rdev_start_p2p_device(rdev, wdev);
  12097. if (err)
  12098. return err;
  12099. wdev->is_running = true;
  12100. rdev->opencount++;
  12101. return 0;
  12102. }
  12103. static int nl80211_stop_p2p_device(struct sk_buff *skb, struct genl_info *info)
  12104. {
  12105. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12106. struct wireless_dev *wdev = info->user_ptr[1];
  12107. if (wdev->iftype != NL80211_IFTYPE_P2P_DEVICE)
  12108. return -EOPNOTSUPP;
  12109. if (!rdev->ops->stop_p2p_device)
  12110. return -EOPNOTSUPP;
  12111. cfg80211_stop_p2p_device(rdev, wdev);
  12112. return 0;
  12113. }
  12114. static int nl80211_start_nan(struct sk_buff *skb, struct genl_info *info)
  12115. {
  12116. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12117. struct wireless_dev *wdev = info->user_ptr[1];
  12118. struct cfg80211_nan_conf conf = {};
  12119. int err;
  12120. if (wdev->iftype != NL80211_IFTYPE_NAN)
  12121. return -EOPNOTSUPP;
  12122. if (wdev_running(wdev))
  12123. return -EEXIST;
  12124. if (rfkill_blocked(rdev->wiphy.rfkill))
  12125. return -ERFKILL;
  12126. if (!info->attrs[NL80211_ATTR_NAN_MASTER_PREF])
  12127. return -EINVAL;
  12128. conf.master_pref =
  12129. nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
  12130. if (info->attrs[NL80211_ATTR_BANDS]) {
  12131. u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
  12132. if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
  12133. return -EOPNOTSUPP;
  12134. if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
  12135. return -EINVAL;
  12136. conf.bands = bands;
  12137. }
  12138. err = rdev_start_nan(rdev, wdev, &conf);
  12139. if (err)
  12140. return err;
  12141. wdev->is_running = true;
  12142. rdev->opencount++;
  12143. return 0;
  12144. }
  12145. static int nl80211_stop_nan(struct sk_buff *skb, struct genl_info *info)
  12146. {
  12147. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12148. struct wireless_dev *wdev = info->user_ptr[1];
  12149. if (wdev->iftype != NL80211_IFTYPE_NAN)
  12150. return -EOPNOTSUPP;
  12151. cfg80211_stop_nan(rdev, wdev);
  12152. return 0;
  12153. }
  12154. static int validate_nan_filter(struct nlattr *filter_attr)
  12155. {
  12156. struct nlattr *attr;
  12157. int len = 0, n_entries = 0, rem;
  12158. nla_for_each_nested(attr, filter_attr, rem) {
  12159. len += nla_len(attr);
  12160. n_entries++;
  12161. }
  12162. if (len >= U8_MAX)
  12163. return -EINVAL;
  12164. return n_entries;
  12165. }
  12166. static int handle_nan_filter(struct nlattr *attr_filter,
  12167. struct cfg80211_nan_func *func,
  12168. bool tx)
  12169. {
  12170. struct nlattr *attr;
  12171. int n_entries, rem, i;
  12172. struct cfg80211_nan_func_filter *filter;
  12173. n_entries = validate_nan_filter(attr_filter);
  12174. if (n_entries < 0)
  12175. return n_entries;
  12176. BUILD_BUG_ON(sizeof(*func->rx_filters) != sizeof(*func->tx_filters));
  12177. filter = kcalloc(n_entries, sizeof(*func->rx_filters), GFP_KERNEL);
  12178. if (!filter)
  12179. return -ENOMEM;
  12180. i = 0;
  12181. nla_for_each_nested(attr, attr_filter, rem) {
  12182. filter[i].filter = nla_memdup(attr, GFP_KERNEL);
  12183. if (!filter[i].filter)
  12184. goto err;
  12185. filter[i].len = nla_len(attr);
  12186. i++;
  12187. }
  12188. if (tx) {
  12189. func->num_tx_filters = n_entries;
  12190. func->tx_filters = filter;
  12191. } else {
  12192. func->num_rx_filters = n_entries;
  12193. func->rx_filters = filter;
  12194. }
  12195. return 0;
  12196. err:
  12197. i = 0;
  12198. nla_for_each_nested(attr, attr_filter, rem) {
  12199. kfree(filter[i].filter);
  12200. i++;
  12201. }
  12202. kfree(filter);
  12203. return -ENOMEM;
  12204. }
  12205. static int nl80211_nan_add_func(struct sk_buff *skb,
  12206. struct genl_info *info)
  12207. {
  12208. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12209. struct wireless_dev *wdev = info->user_ptr[1];
  12210. struct nlattr *tb[NUM_NL80211_NAN_FUNC_ATTR], *func_attr;
  12211. struct cfg80211_nan_func *func;
  12212. struct sk_buff *msg = NULL;
  12213. void *hdr = NULL;
  12214. int err = 0;
  12215. if (wdev->iftype != NL80211_IFTYPE_NAN)
  12216. return -EOPNOTSUPP;
  12217. if (!wdev_running(wdev))
  12218. return -ENOTCONN;
  12219. if (!info->attrs[NL80211_ATTR_NAN_FUNC])
  12220. return -EINVAL;
  12221. err = nla_parse_nested_deprecated(tb, NL80211_NAN_FUNC_ATTR_MAX,
  12222. info->attrs[NL80211_ATTR_NAN_FUNC],
  12223. nl80211_nan_func_policy,
  12224. info->extack);
  12225. if (err)
  12226. return err;
  12227. func = kzalloc(sizeof(*func), GFP_KERNEL);
  12228. if (!func)
  12229. return -ENOMEM;
  12230. func->cookie = cfg80211_assign_cookie(rdev);
  12231. if (!tb[NL80211_NAN_FUNC_TYPE]) {
  12232. err = -EINVAL;
  12233. goto out;
  12234. }
  12235. func->type = nla_get_u8(tb[NL80211_NAN_FUNC_TYPE]);
  12236. if (!tb[NL80211_NAN_FUNC_SERVICE_ID]) {
  12237. err = -EINVAL;
  12238. goto out;
  12239. }
  12240. memcpy(func->service_id, nla_data(tb[NL80211_NAN_FUNC_SERVICE_ID]),
  12241. sizeof(func->service_id));
  12242. func->close_range =
  12243. nla_get_flag(tb[NL80211_NAN_FUNC_CLOSE_RANGE]);
  12244. if (tb[NL80211_NAN_FUNC_SERVICE_INFO]) {
  12245. func->serv_spec_info_len =
  12246. nla_len(tb[NL80211_NAN_FUNC_SERVICE_INFO]);
  12247. func->serv_spec_info =
  12248. kmemdup(nla_data(tb[NL80211_NAN_FUNC_SERVICE_INFO]),
  12249. func->serv_spec_info_len,
  12250. GFP_KERNEL);
  12251. if (!func->serv_spec_info) {
  12252. err = -ENOMEM;
  12253. goto out;
  12254. }
  12255. }
  12256. if (tb[NL80211_NAN_FUNC_TTL])
  12257. func->ttl = nla_get_u32(tb[NL80211_NAN_FUNC_TTL]);
  12258. switch (func->type) {
  12259. case NL80211_NAN_FUNC_PUBLISH:
  12260. if (!tb[NL80211_NAN_FUNC_PUBLISH_TYPE]) {
  12261. err = -EINVAL;
  12262. goto out;
  12263. }
  12264. func->publish_type =
  12265. nla_get_u8(tb[NL80211_NAN_FUNC_PUBLISH_TYPE]);
  12266. func->publish_bcast =
  12267. nla_get_flag(tb[NL80211_NAN_FUNC_PUBLISH_BCAST]);
  12268. if ((!(func->publish_type & NL80211_NAN_SOLICITED_PUBLISH)) &&
  12269. func->publish_bcast) {
  12270. err = -EINVAL;
  12271. goto out;
  12272. }
  12273. break;
  12274. case NL80211_NAN_FUNC_SUBSCRIBE:
  12275. func->subscribe_active =
  12276. nla_get_flag(tb[NL80211_NAN_FUNC_SUBSCRIBE_ACTIVE]);
  12277. break;
  12278. case NL80211_NAN_FUNC_FOLLOW_UP:
  12279. if (!tb[NL80211_NAN_FUNC_FOLLOW_UP_ID] ||
  12280. !tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID] ||
  12281. !tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]) {
  12282. err = -EINVAL;
  12283. goto out;
  12284. }
  12285. func->followup_id =
  12286. nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_ID]);
  12287. func->followup_reqid =
  12288. nla_get_u8(tb[NL80211_NAN_FUNC_FOLLOW_UP_REQ_ID]);
  12289. memcpy(func->followup_dest.addr,
  12290. nla_data(tb[NL80211_NAN_FUNC_FOLLOW_UP_DEST]),
  12291. sizeof(func->followup_dest.addr));
  12292. if (func->ttl) {
  12293. err = -EINVAL;
  12294. goto out;
  12295. }
  12296. break;
  12297. default:
  12298. err = -EINVAL;
  12299. goto out;
  12300. }
  12301. if (tb[NL80211_NAN_FUNC_SRF]) {
  12302. struct nlattr *srf_tb[NUM_NL80211_NAN_SRF_ATTR];
  12303. err = nla_parse_nested_deprecated(srf_tb,
  12304. NL80211_NAN_SRF_ATTR_MAX,
  12305. tb[NL80211_NAN_FUNC_SRF],
  12306. nl80211_nan_srf_policy,
  12307. info->extack);
  12308. if (err)
  12309. goto out;
  12310. func->srf_include =
  12311. nla_get_flag(srf_tb[NL80211_NAN_SRF_INCLUDE]);
  12312. if (srf_tb[NL80211_NAN_SRF_BF]) {
  12313. if (srf_tb[NL80211_NAN_SRF_MAC_ADDRS] ||
  12314. !srf_tb[NL80211_NAN_SRF_BF_IDX]) {
  12315. err = -EINVAL;
  12316. goto out;
  12317. }
  12318. func->srf_bf_len =
  12319. nla_len(srf_tb[NL80211_NAN_SRF_BF]);
  12320. func->srf_bf =
  12321. kmemdup(nla_data(srf_tb[NL80211_NAN_SRF_BF]),
  12322. func->srf_bf_len, GFP_KERNEL);
  12323. if (!func->srf_bf) {
  12324. err = -ENOMEM;
  12325. goto out;
  12326. }
  12327. func->srf_bf_idx =
  12328. nla_get_u8(srf_tb[NL80211_NAN_SRF_BF_IDX]);
  12329. } else {
  12330. struct nlattr *attr, *mac_attr =
  12331. srf_tb[NL80211_NAN_SRF_MAC_ADDRS];
  12332. int n_entries, rem, i = 0;
  12333. if (!mac_attr) {
  12334. err = -EINVAL;
  12335. goto out;
  12336. }
  12337. n_entries = validate_acl_mac_addrs(mac_attr);
  12338. if (n_entries <= 0) {
  12339. err = -EINVAL;
  12340. goto out;
  12341. }
  12342. func->srf_num_macs = n_entries;
  12343. func->srf_macs =
  12344. kcalloc(n_entries, sizeof(*func->srf_macs),
  12345. GFP_KERNEL);
  12346. if (!func->srf_macs) {
  12347. err = -ENOMEM;
  12348. goto out;
  12349. }
  12350. nla_for_each_nested(attr, mac_attr, rem)
  12351. memcpy(func->srf_macs[i++].addr, nla_data(attr),
  12352. sizeof(*func->srf_macs));
  12353. }
  12354. }
  12355. if (tb[NL80211_NAN_FUNC_TX_MATCH_FILTER]) {
  12356. err = handle_nan_filter(tb[NL80211_NAN_FUNC_TX_MATCH_FILTER],
  12357. func, true);
  12358. if (err)
  12359. goto out;
  12360. }
  12361. if (tb[NL80211_NAN_FUNC_RX_MATCH_FILTER]) {
  12362. err = handle_nan_filter(tb[NL80211_NAN_FUNC_RX_MATCH_FILTER],
  12363. func, false);
  12364. if (err)
  12365. goto out;
  12366. }
  12367. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  12368. if (!msg) {
  12369. err = -ENOMEM;
  12370. goto out;
  12371. }
  12372. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  12373. NL80211_CMD_ADD_NAN_FUNCTION);
  12374. /* This can't really happen - we just allocated 4KB */
  12375. if (WARN_ON(!hdr)) {
  12376. err = -ENOMEM;
  12377. goto out;
  12378. }
  12379. err = rdev_add_nan_func(rdev, wdev, func);
  12380. out:
  12381. if (err < 0) {
  12382. cfg80211_free_nan_func(func);
  12383. nlmsg_free(msg);
  12384. return err;
  12385. }
  12386. /* propagate the instance id and cookie to userspace */
  12387. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, func->cookie,
  12388. NL80211_ATTR_PAD))
  12389. goto nla_put_failure;
  12390. func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
  12391. if (!func_attr)
  12392. goto nla_put_failure;
  12393. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID,
  12394. func->instance_id))
  12395. goto nla_put_failure;
  12396. nla_nest_end(msg, func_attr);
  12397. genlmsg_end(msg, hdr);
  12398. return genlmsg_reply(msg, info);
  12399. nla_put_failure:
  12400. nlmsg_free(msg);
  12401. return -ENOBUFS;
  12402. }
  12403. static int nl80211_nan_del_func(struct sk_buff *skb,
  12404. struct genl_info *info)
  12405. {
  12406. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12407. struct wireless_dev *wdev = info->user_ptr[1];
  12408. u64 cookie;
  12409. if (wdev->iftype != NL80211_IFTYPE_NAN)
  12410. return -EOPNOTSUPP;
  12411. if (!wdev_running(wdev))
  12412. return -ENOTCONN;
  12413. if (!info->attrs[NL80211_ATTR_COOKIE])
  12414. return -EINVAL;
  12415. cookie = nla_get_u64(info->attrs[NL80211_ATTR_COOKIE]);
  12416. rdev_del_nan_func(rdev, wdev, cookie);
  12417. return 0;
  12418. }
  12419. static int nl80211_nan_change_config(struct sk_buff *skb,
  12420. struct genl_info *info)
  12421. {
  12422. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12423. struct wireless_dev *wdev = info->user_ptr[1];
  12424. struct cfg80211_nan_conf conf = {};
  12425. u32 changed = 0;
  12426. if (wdev->iftype != NL80211_IFTYPE_NAN)
  12427. return -EOPNOTSUPP;
  12428. if (!wdev_running(wdev))
  12429. return -ENOTCONN;
  12430. if (info->attrs[NL80211_ATTR_NAN_MASTER_PREF]) {
  12431. conf.master_pref =
  12432. nla_get_u8(info->attrs[NL80211_ATTR_NAN_MASTER_PREF]);
  12433. if (conf.master_pref <= 1 || conf.master_pref == 255)
  12434. return -EINVAL;
  12435. changed |= CFG80211_NAN_CONF_CHANGED_PREF;
  12436. }
  12437. if (info->attrs[NL80211_ATTR_BANDS]) {
  12438. u32 bands = nla_get_u32(info->attrs[NL80211_ATTR_BANDS]);
  12439. if (bands & ~(u32)wdev->wiphy->nan_supported_bands)
  12440. return -EOPNOTSUPP;
  12441. if (bands && !(bands & BIT(NL80211_BAND_2GHZ)))
  12442. return -EINVAL;
  12443. conf.bands = bands;
  12444. changed |= CFG80211_NAN_CONF_CHANGED_BANDS;
  12445. }
  12446. if (!changed)
  12447. return -EINVAL;
  12448. return rdev_nan_change_conf(rdev, wdev, &conf, changed);
  12449. }
  12450. void cfg80211_nan_match(struct wireless_dev *wdev,
  12451. struct cfg80211_nan_match_params *match, gfp_t gfp)
  12452. {
  12453. struct wiphy *wiphy = wdev->wiphy;
  12454. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12455. struct nlattr *match_attr, *local_func_attr, *peer_func_attr;
  12456. struct sk_buff *msg;
  12457. void *hdr;
  12458. if (WARN_ON(!match->inst_id || !match->peer_inst_id || !match->addr))
  12459. return;
  12460. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12461. if (!msg)
  12462. return;
  12463. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NAN_MATCH);
  12464. if (!hdr) {
  12465. nlmsg_free(msg);
  12466. return;
  12467. }
  12468. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12469. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  12470. wdev->netdev->ifindex)) ||
  12471. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12472. NL80211_ATTR_PAD))
  12473. goto nla_put_failure;
  12474. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, match->cookie,
  12475. NL80211_ATTR_PAD) ||
  12476. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, match->addr))
  12477. goto nla_put_failure;
  12478. match_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_MATCH);
  12479. if (!match_attr)
  12480. goto nla_put_failure;
  12481. local_func_attr = nla_nest_start_noflag(msg,
  12482. NL80211_NAN_MATCH_FUNC_LOCAL);
  12483. if (!local_func_attr)
  12484. goto nla_put_failure;
  12485. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->inst_id))
  12486. goto nla_put_failure;
  12487. nla_nest_end(msg, local_func_attr);
  12488. peer_func_attr = nla_nest_start_noflag(msg,
  12489. NL80211_NAN_MATCH_FUNC_PEER);
  12490. if (!peer_func_attr)
  12491. goto nla_put_failure;
  12492. if (nla_put_u8(msg, NL80211_NAN_FUNC_TYPE, match->type) ||
  12493. nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, match->peer_inst_id))
  12494. goto nla_put_failure;
  12495. if (match->info && match->info_len &&
  12496. nla_put(msg, NL80211_NAN_FUNC_SERVICE_INFO, match->info_len,
  12497. match->info))
  12498. goto nla_put_failure;
  12499. nla_nest_end(msg, peer_func_attr);
  12500. nla_nest_end(msg, match_attr);
  12501. genlmsg_end(msg, hdr);
  12502. if (!wdev->owner_nlportid)
  12503. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  12504. msg, 0, NL80211_MCGRP_NAN, gfp);
  12505. else
  12506. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  12507. wdev->owner_nlportid);
  12508. return;
  12509. nla_put_failure:
  12510. nlmsg_free(msg);
  12511. }
  12512. EXPORT_SYMBOL(cfg80211_nan_match);
  12513. void cfg80211_nan_func_terminated(struct wireless_dev *wdev,
  12514. u8 inst_id,
  12515. enum nl80211_nan_func_term_reason reason,
  12516. u64 cookie, gfp_t gfp)
  12517. {
  12518. struct wiphy *wiphy = wdev->wiphy;
  12519. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12520. struct sk_buff *msg;
  12521. struct nlattr *func_attr;
  12522. void *hdr;
  12523. if (WARN_ON(!inst_id))
  12524. return;
  12525. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  12526. if (!msg)
  12527. return;
  12528. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DEL_NAN_FUNCTION);
  12529. if (!hdr) {
  12530. nlmsg_free(msg);
  12531. return;
  12532. }
  12533. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12534. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  12535. wdev->netdev->ifindex)) ||
  12536. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  12537. NL80211_ATTR_PAD))
  12538. goto nla_put_failure;
  12539. if (nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  12540. NL80211_ATTR_PAD))
  12541. goto nla_put_failure;
  12542. func_attr = nla_nest_start_noflag(msg, NL80211_ATTR_NAN_FUNC);
  12543. if (!func_attr)
  12544. goto nla_put_failure;
  12545. if (nla_put_u8(msg, NL80211_NAN_FUNC_INSTANCE_ID, inst_id) ||
  12546. nla_put_u8(msg, NL80211_NAN_FUNC_TERM_REASON, reason))
  12547. goto nla_put_failure;
  12548. nla_nest_end(msg, func_attr);
  12549. genlmsg_end(msg, hdr);
  12550. if (!wdev->owner_nlportid)
  12551. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  12552. msg, 0, NL80211_MCGRP_NAN, gfp);
  12553. else
  12554. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  12555. wdev->owner_nlportid);
  12556. return;
  12557. nla_put_failure:
  12558. nlmsg_free(msg);
  12559. }
  12560. EXPORT_SYMBOL(cfg80211_nan_func_terminated);
  12561. static int nl80211_get_protocol_features(struct sk_buff *skb,
  12562. struct genl_info *info)
  12563. {
  12564. void *hdr;
  12565. struct sk_buff *msg;
  12566. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  12567. if (!msg)
  12568. return -ENOMEM;
  12569. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  12570. NL80211_CMD_GET_PROTOCOL_FEATURES);
  12571. if (!hdr)
  12572. goto nla_put_failure;
  12573. if (nla_put_u32(msg, NL80211_ATTR_PROTOCOL_FEATURES,
  12574. NL80211_PROTOCOL_FEATURE_SPLIT_WIPHY_DUMP))
  12575. goto nla_put_failure;
  12576. genlmsg_end(msg, hdr);
  12577. return genlmsg_reply(msg, info);
  12578. nla_put_failure:
  12579. kfree_skb(msg);
  12580. return -ENOBUFS;
  12581. }
  12582. static int nl80211_update_ft_ies(struct sk_buff *skb, struct genl_info *info)
  12583. {
  12584. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12585. struct cfg80211_update_ft_ies_params ft_params;
  12586. struct net_device *dev = info->user_ptr[1];
  12587. if (!rdev->ops->update_ft_ies)
  12588. return -EOPNOTSUPP;
  12589. if (!info->attrs[NL80211_ATTR_MDID] ||
  12590. !info->attrs[NL80211_ATTR_IE])
  12591. return -EINVAL;
  12592. memset(&ft_params, 0, sizeof(ft_params));
  12593. ft_params.md = nla_get_u16(info->attrs[NL80211_ATTR_MDID]);
  12594. ft_params.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  12595. ft_params.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  12596. return rdev_update_ft_ies(rdev, dev, &ft_params);
  12597. }
  12598. static int nl80211_crit_protocol_start(struct sk_buff *skb,
  12599. struct genl_info *info)
  12600. {
  12601. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12602. struct wireless_dev *wdev = info->user_ptr[1];
  12603. enum nl80211_crit_proto_id proto = NL80211_CRIT_PROTO_UNSPEC;
  12604. u16 duration;
  12605. int ret;
  12606. if (!rdev->ops->crit_proto_start)
  12607. return -EOPNOTSUPP;
  12608. if (WARN_ON(!rdev->ops->crit_proto_stop))
  12609. return -EINVAL;
  12610. if (rdev->crit_proto_nlportid)
  12611. return -EBUSY;
  12612. /* determine protocol if provided */
  12613. if (info->attrs[NL80211_ATTR_CRIT_PROT_ID])
  12614. proto = nla_get_u16(info->attrs[NL80211_ATTR_CRIT_PROT_ID]);
  12615. if (proto >= NUM_NL80211_CRIT_PROTO)
  12616. return -EINVAL;
  12617. /* timeout must be provided */
  12618. if (!info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION])
  12619. return -EINVAL;
  12620. duration =
  12621. nla_get_u16(info->attrs[NL80211_ATTR_MAX_CRIT_PROT_DURATION]);
  12622. ret = rdev_crit_proto_start(rdev, wdev, proto, duration);
  12623. if (!ret)
  12624. rdev->crit_proto_nlportid = info->snd_portid;
  12625. return ret;
  12626. }
  12627. static int nl80211_crit_protocol_stop(struct sk_buff *skb,
  12628. struct genl_info *info)
  12629. {
  12630. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12631. struct wireless_dev *wdev = info->user_ptr[1];
  12632. if (!rdev->ops->crit_proto_stop)
  12633. return -EOPNOTSUPP;
  12634. if (rdev->crit_proto_nlportid) {
  12635. rdev->crit_proto_nlportid = 0;
  12636. rdev_crit_proto_stop(rdev, wdev);
  12637. }
  12638. return 0;
  12639. }
  12640. static int nl80211_vendor_check_policy(const struct wiphy_vendor_command *vcmd,
  12641. struct nlattr *attr,
  12642. struct netlink_ext_ack *extack)
  12643. {
  12644. if (vcmd->policy == VENDOR_CMD_RAW_DATA) {
  12645. if (attr->nla_type & NLA_F_NESTED) {
  12646. NL_SET_ERR_MSG_ATTR(extack, attr,
  12647. "unexpected nested data");
  12648. return -EINVAL;
  12649. }
  12650. return 0;
  12651. }
  12652. if (!(attr->nla_type & NLA_F_NESTED)) {
  12653. NL_SET_ERR_MSG_ATTR(extack, attr, "expected nested data");
  12654. return -EINVAL;
  12655. }
  12656. return nla_validate_nested(attr, vcmd->maxattr, vcmd->policy, extack);
  12657. }
  12658. static int nl80211_vendor_cmd(struct sk_buff *skb, struct genl_info *info)
  12659. {
  12660. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12661. struct wireless_dev *wdev =
  12662. __cfg80211_wdev_from_attrs(rdev, genl_info_net(info),
  12663. info->attrs);
  12664. int i, err;
  12665. u32 vid, subcmd;
  12666. if (!rdev->wiphy.vendor_commands)
  12667. return -EOPNOTSUPP;
  12668. if (IS_ERR(wdev)) {
  12669. err = PTR_ERR(wdev);
  12670. if (err != -EINVAL)
  12671. return err;
  12672. wdev = NULL;
  12673. } else if (wdev->wiphy != &rdev->wiphy) {
  12674. return -EINVAL;
  12675. }
  12676. if (!info->attrs[NL80211_ATTR_VENDOR_ID] ||
  12677. !info->attrs[NL80211_ATTR_VENDOR_SUBCMD])
  12678. return -EINVAL;
  12679. vid = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_ID]);
  12680. subcmd = nla_get_u32(info->attrs[NL80211_ATTR_VENDOR_SUBCMD]);
  12681. for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
  12682. const struct wiphy_vendor_command *vcmd;
  12683. void *data = NULL;
  12684. int len = 0;
  12685. vcmd = &rdev->wiphy.vendor_commands[i];
  12686. if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
  12687. continue;
  12688. if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
  12689. WIPHY_VENDOR_CMD_NEED_NETDEV)) {
  12690. if (!wdev)
  12691. return -EINVAL;
  12692. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
  12693. !wdev->netdev)
  12694. return -EINVAL;
  12695. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
  12696. if (!wdev_running(wdev))
  12697. return -ENETDOWN;
  12698. }
  12699. } else {
  12700. wdev = NULL;
  12701. }
  12702. if (!vcmd->doit)
  12703. return -EOPNOTSUPP;
  12704. if (info->attrs[NL80211_ATTR_VENDOR_DATA]) {
  12705. data = nla_data(info->attrs[NL80211_ATTR_VENDOR_DATA]);
  12706. len = nla_len(info->attrs[NL80211_ATTR_VENDOR_DATA]);
  12707. err = nl80211_vendor_check_policy(vcmd,
  12708. info->attrs[NL80211_ATTR_VENDOR_DATA],
  12709. info->extack);
  12710. if (err)
  12711. return err;
  12712. }
  12713. rdev->cur_cmd_info = info;
  12714. err = vcmd->doit(&rdev->wiphy, wdev, data, len);
  12715. rdev->cur_cmd_info = NULL;
  12716. return err;
  12717. }
  12718. return -EOPNOTSUPP;
  12719. }
  12720. static int nl80211_prepare_vendor_dump(struct sk_buff *skb,
  12721. struct netlink_callback *cb,
  12722. struct cfg80211_registered_device **rdev,
  12723. struct wireless_dev **wdev)
  12724. {
  12725. struct nlattr **attrbuf;
  12726. u32 vid, subcmd;
  12727. unsigned int i;
  12728. int vcmd_idx = -1;
  12729. int err;
  12730. void *data = NULL;
  12731. unsigned int data_len = 0;
  12732. if (cb->args[0]) {
  12733. /* subtract the 1 again here */
  12734. struct wiphy *wiphy = wiphy_idx_to_wiphy(cb->args[0] - 1);
  12735. struct wireless_dev *tmp;
  12736. if (!wiphy)
  12737. return -ENODEV;
  12738. *rdev = wiphy_to_rdev(wiphy);
  12739. *wdev = NULL;
  12740. if (cb->args[1]) {
  12741. list_for_each_entry(tmp, &wiphy->wdev_list, list) {
  12742. if (tmp->identifier == cb->args[1] - 1) {
  12743. *wdev = tmp;
  12744. break;
  12745. }
  12746. }
  12747. }
  12748. /* keep rtnl locked in successful case */
  12749. return 0;
  12750. }
  12751. attrbuf = kcalloc(NUM_NL80211_ATTR, sizeof(*attrbuf), GFP_KERNEL);
  12752. if (!attrbuf)
  12753. return -ENOMEM;
  12754. err = nlmsg_parse_deprecated(cb->nlh,
  12755. GENL_HDRLEN + nl80211_fam.hdrsize,
  12756. attrbuf, nl80211_fam.maxattr,
  12757. nl80211_policy, NULL);
  12758. if (err)
  12759. goto out;
  12760. if (!attrbuf[NL80211_ATTR_VENDOR_ID] ||
  12761. !attrbuf[NL80211_ATTR_VENDOR_SUBCMD]) {
  12762. err = -EINVAL;
  12763. goto out;
  12764. }
  12765. *wdev = __cfg80211_wdev_from_attrs(NULL, sock_net(skb->sk), attrbuf);
  12766. if (IS_ERR(*wdev))
  12767. *wdev = NULL;
  12768. *rdev = __cfg80211_rdev_from_attrs(sock_net(skb->sk), attrbuf);
  12769. if (IS_ERR(*rdev)) {
  12770. err = PTR_ERR(*rdev);
  12771. goto out;
  12772. }
  12773. vid = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_ID]);
  12774. subcmd = nla_get_u32(attrbuf[NL80211_ATTR_VENDOR_SUBCMD]);
  12775. for (i = 0; i < (*rdev)->wiphy.n_vendor_commands; i++) {
  12776. const struct wiphy_vendor_command *vcmd;
  12777. vcmd = &(*rdev)->wiphy.vendor_commands[i];
  12778. if (vcmd->info.vendor_id != vid || vcmd->info.subcmd != subcmd)
  12779. continue;
  12780. if (!vcmd->dumpit) {
  12781. err = -EOPNOTSUPP;
  12782. goto out;
  12783. }
  12784. vcmd_idx = i;
  12785. break;
  12786. }
  12787. if (vcmd_idx < 0) {
  12788. err = -EOPNOTSUPP;
  12789. goto out;
  12790. }
  12791. if (attrbuf[NL80211_ATTR_VENDOR_DATA]) {
  12792. data = nla_data(attrbuf[NL80211_ATTR_VENDOR_DATA]);
  12793. data_len = nla_len(attrbuf[NL80211_ATTR_VENDOR_DATA]);
  12794. err = nl80211_vendor_check_policy(
  12795. &(*rdev)->wiphy.vendor_commands[vcmd_idx],
  12796. attrbuf[NL80211_ATTR_VENDOR_DATA],
  12797. cb->extack);
  12798. if (err)
  12799. goto out;
  12800. }
  12801. /* 0 is the first index - add 1 to parse only once */
  12802. cb->args[0] = (*rdev)->wiphy_idx + 1;
  12803. /* add 1 to know if it was NULL */
  12804. cb->args[1] = *wdev ? (*wdev)->identifier + 1 : 0;
  12805. cb->args[2] = vcmd_idx;
  12806. cb->args[3] = (unsigned long)data;
  12807. cb->args[4] = data_len;
  12808. /* keep rtnl locked in successful case */
  12809. err = 0;
  12810. out:
  12811. kfree(attrbuf);
  12812. return err;
  12813. }
  12814. static int nl80211_vendor_cmd_dump(struct sk_buff *skb,
  12815. struct netlink_callback *cb)
  12816. {
  12817. struct cfg80211_registered_device *rdev;
  12818. struct wireless_dev *wdev;
  12819. unsigned int vcmd_idx;
  12820. const struct wiphy_vendor_command *vcmd;
  12821. void *data;
  12822. int data_len;
  12823. int err;
  12824. struct nlattr *vendor_data;
  12825. rtnl_lock();
  12826. err = nl80211_prepare_vendor_dump(skb, cb, &rdev, &wdev);
  12827. if (err)
  12828. goto out;
  12829. vcmd_idx = cb->args[2];
  12830. data = (void *)cb->args[3];
  12831. data_len = cb->args[4];
  12832. vcmd = &rdev->wiphy.vendor_commands[vcmd_idx];
  12833. if (vcmd->flags & (WIPHY_VENDOR_CMD_NEED_WDEV |
  12834. WIPHY_VENDOR_CMD_NEED_NETDEV)) {
  12835. if (!wdev) {
  12836. err = -EINVAL;
  12837. goto out;
  12838. }
  12839. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_NETDEV &&
  12840. !wdev->netdev) {
  12841. err = -EINVAL;
  12842. goto out;
  12843. }
  12844. if (vcmd->flags & WIPHY_VENDOR_CMD_NEED_RUNNING) {
  12845. if (!wdev_running(wdev)) {
  12846. err = -ENETDOWN;
  12847. goto out;
  12848. }
  12849. }
  12850. }
  12851. while (1) {
  12852. void *hdr = nl80211hdr_put(skb, NETLINK_CB(cb->skb).portid,
  12853. cb->nlh->nlmsg_seq, NLM_F_MULTI,
  12854. NL80211_CMD_VENDOR);
  12855. if (!hdr)
  12856. break;
  12857. if (nla_put_u32(skb, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  12858. (wdev && nla_put_u64_64bit(skb, NL80211_ATTR_WDEV,
  12859. wdev_id(wdev),
  12860. NL80211_ATTR_PAD))) {
  12861. genlmsg_cancel(skb, hdr);
  12862. break;
  12863. }
  12864. vendor_data = nla_nest_start_noflag(skb,
  12865. NL80211_ATTR_VENDOR_DATA);
  12866. if (!vendor_data) {
  12867. genlmsg_cancel(skb, hdr);
  12868. break;
  12869. }
  12870. err = vcmd->dumpit(&rdev->wiphy, wdev, skb, data, data_len,
  12871. (unsigned long *)&cb->args[5]);
  12872. nla_nest_end(skb, vendor_data);
  12873. if (err == -ENOBUFS || err == -ENOENT) {
  12874. genlmsg_cancel(skb, hdr);
  12875. break;
  12876. } else if (err <= 0) {
  12877. genlmsg_cancel(skb, hdr);
  12878. goto out;
  12879. }
  12880. genlmsg_end(skb, hdr);
  12881. }
  12882. err = skb->len;
  12883. out:
  12884. rtnl_unlock();
  12885. return err;
  12886. }
  12887. struct sk_buff *__cfg80211_alloc_reply_skb(struct wiphy *wiphy,
  12888. enum nl80211_commands cmd,
  12889. enum nl80211_attrs attr,
  12890. int approxlen)
  12891. {
  12892. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12893. if (WARN_ON(!rdev->cur_cmd_info))
  12894. return NULL;
  12895. return __cfg80211_alloc_vendor_skb(rdev, NULL, approxlen,
  12896. rdev->cur_cmd_info->snd_portid,
  12897. rdev->cur_cmd_info->snd_seq,
  12898. cmd, attr, NULL, GFP_KERNEL);
  12899. }
  12900. EXPORT_SYMBOL(__cfg80211_alloc_reply_skb);
  12901. int cfg80211_vendor_cmd_reply(struct sk_buff *skb)
  12902. {
  12903. struct cfg80211_registered_device *rdev = ((void **)skb->cb)[0];
  12904. void *hdr = ((void **)skb->cb)[1];
  12905. struct nlattr *data = ((void **)skb->cb)[2];
  12906. /* clear CB data for netlink core to own from now on */
  12907. memset(skb->cb, 0, sizeof(skb->cb));
  12908. if (WARN_ON(!rdev->cur_cmd_info)) {
  12909. kfree_skb(skb);
  12910. return -EINVAL;
  12911. }
  12912. nla_nest_end(skb, data);
  12913. genlmsg_end(skb, hdr);
  12914. return genlmsg_reply(skb, rdev->cur_cmd_info);
  12915. }
  12916. EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_reply);
  12917. unsigned int cfg80211_vendor_cmd_get_sender(struct wiphy *wiphy)
  12918. {
  12919. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  12920. if (WARN_ON(!rdev->cur_cmd_info))
  12921. return 0;
  12922. return rdev->cur_cmd_info->snd_portid;
  12923. }
  12924. EXPORT_SYMBOL_GPL(cfg80211_vendor_cmd_get_sender);
  12925. static int nl80211_set_qos_map(struct sk_buff *skb,
  12926. struct genl_info *info)
  12927. {
  12928. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12929. struct cfg80211_qos_map *qos_map = NULL;
  12930. struct net_device *dev = info->user_ptr[1];
  12931. u8 *pos, len, num_des, des_len, des;
  12932. int ret;
  12933. if (!rdev->ops->set_qos_map)
  12934. return -EOPNOTSUPP;
  12935. if (info->attrs[NL80211_ATTR_QOS_MAP]) {
  12936. pos = nla_data(info->attrs[NL80211_ATTR_QOS_MAP]);
  12937. len = nla_len(info->attrs[NL80211_ATTR_QOS_MAP]);
  12938. if (len % 2)
  12939. return -EINVAL;
  12940. qos_map = kzalloc(sizeof(struct cfg80211_qos_map), GFP_KERNEL);
  12941. if (!qos_map)
  12942. return -ENOMEM;
  12943. num_des = (len - IEEE80211_QOS_MAP_LEN_MIN) >> 1;
  12944. if (num_des) {
  12945. des_len = num_des *
  12946. sizeof(struct cfg80211_dscp_exception);
  12947. memcpy(qos_map->dscp_exception, pos, des_len);
  12948. qos_map->num_des = num_des;
  12949. for (des = 0; des < num_des; des++) {
  12950. if (qos_map->dscp_exception[des].up > 7) {
  12951. kfree(qos_map);
  12952. return -EINVAL;
  12953. }
  12954. }
  12955. pos += des_len;
  12956. }
  12957. memcpy(qos_map->up, pos, IEEE80211_QOS_MAP_LEN_MIN);
  12958. }
  12959. ret = nl80211_key_allowed(dev->ieee80211_ptr);
  12960. if (!ret)
  12961. ret = rdev_set_qos_map(rdev, dev, qos_map);
  12962. kfree(qos_map);
  12963. return ret;
  12964. }
  12965. static int nl80211_add_tx_ts(struct sk_buff *skb, struct genl_info *info)
  12966. {
  12967. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  12968. struct net_device *dev = info->user_ptr[1];
  12969. struct wireless_dev *wdev = dev->ieee80211_ptr;
  12970. const u8 *peer;
  12971. u8 tsid, up;
  12972. u16 admitted_time = 0;
  12973. if (!(rdev->wiphy.features & NL80211_FEATURE_SUPPORTS_WMM_ADMISSION))
  12974. return -EOPNOTSUPP;
  12975. if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC] ||
  12976. !info->attrs[NL80211_ATTR_USER_PRIO])
  12977. return -EINVAL;
  12978. tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
  12979. up = nla_get_u8(info->attrs[NL80211_ATTR_USER_PRIO]);
  12980. /* WMM uses TIDs 0-7 even for TSPEC */
  12981. if (tsid >= IEEE80211_FIRST_TSPEC_TSID) {
  12982. /* TODO: handle 802.11 TSPEC/admission control
  12983. * need more attributes for that (e.g. BA session requirement);
  12984. * change the WMM adminssion test above to allow both then
  12985. */
  12986. return -EINVAL;
  12987. }
  12988. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  12989. if (info->attrs[NL80211_ATTR_ADMITTED_TIME]) {
  12990. admitted_time =
  12991. nla_get_u16(info->attrs[NL80211_ATTR_ADMITTED_TIME]);
  12992. if (!admitted_time)
  12993. return -EINVAL;
  12994. }
  12995. switch (wdev->iftype) {
  12996. case NL80211_IFTYPE_STATION:
  12997. case NL80211_IFTYPE_P2P_CLIENT:
  12998. if (wdev->connected)
  12999. break;
  13000. return -ENOTCONN;
  13001. default:
  13002. return -EOPNOTSUPP;
  13003. }
  13004. return rdev_add_tx_ts(rdev, dev, tsid, peer, up, admitted_time);
  13005. }
  13006. static int nl80211_del_tx_ts(struct sk_buff *skb, struct genl_info *info)
  13007. {
  13008. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13009. struct net_device *dev = info->user_ptr[1];
  13010. const u8 *peer;
  13011. u8 tsid;
  13012. if (!info->attrs[NL80211_ATTR_TSID] || !info->attrs[NL80211_ATTR_MAC])
  13013. return -EINVAL;
  13014. tsid = nla_get_u8(info->attrs[NL80211_ATTR_TSID]);
  13015. peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13016. return rdev_del_tx_ts(rdev, dev, tsid, peer);
  13017. }
  13018. static int nl80211_tdls_channel_switch(struct sk_buff *skb,
  13019. struct genl_info *info)
  13020. {
  13021. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13022. struct net_device *dev = info->user_ptr[1];
  13023. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13024. struct cfg80211_chan_def chandef = {};
  13025. const u8 *addr;
  13026. u8 oper_class;
  13027. int err;
  13028. if (!rdev->ops->tdls_channel_switch ||
  13029. !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
  13030. return -EOPNOTSUPP;
  13031. switch (dev->ieee80211_ptr->iftype) {
  13032. case NL80211_IFTYPE_STATION:
  13033. case NL80211_IFTYPE_P2P_CLIENT:
  13034. break;
  13035. default:
  13036. return -EOPNOTSUPP;
  13037. }
  13038. if (!info->attrs[NL80211_ATTR_MAC] ||
  13039. !info->attrs[NL80211_ATTR_OPER_CLASS])
  13040. return -EINVAL;
  13041. err = nl80211_parse_chandef(rdev, info, &chandef);
  13042. if (err)
  13043. return err;
  13044. /*
  13045. * Don't allow wide channels on the 2.4Ghz band, as per IEEE802.11-2012
  13046. * section 10.22.6.2.1. Disallow 5/10Mhz channels as well for now, the
  13047. * specification is not defined for them.
  13048. */
  13049. if (chandef.chan->band == NL80211_BAND_2GHZ &&
  13050. chandef.width != NL80211_CHAN_WIDTH_20_NOHT &&
  13051. chandef.width != NL80211_CHAN_WIDTH_20)
  13052. return -EINVAL;
  13053. /* we will be active on the TDLS link */
  13054. if (!cfg80211_reg_can_beacon_relax(&rdev->wiphy, &chandef,
  13055. wdev->iftype))
  13056. return -EINVAL;
  13057. /* don't allow switching to DFS channels */
  13058. if (cfg80211_chandef_dfs_required(wdev->wiphy, &chandef, wdev->iftype))
  13059. return -EINVAL;
  13060. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13061. oper_class = nla_get_u8(info->attrs[NL80211_ATTR_OPER_CLASS]);
  13062. return rdev_tdls_channel_switch(rdev, dev, addr, oper_class, &chandef);
  13063. }
  13064. static int nl80211_tdls_cancel_channel_switch(struct sk_buff *skb,
  13065. struct genl_info *info)
  13066. {
  13067. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13068. struct net_device *dev = info->user_ptr[1];
  13069. const u8 *addr;
  13070. if (!rdev->ops->tdls_channel_switch ||
  13071. !rdev->ops->tdls_cancel_channel_switch ||
  13072. !(rdev->wiphy.features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH))
  13073. return -EOPNOTSUPP;
  13074. switch (dev->ieee80211_ptr->iftype) {
  13075. case NL80211_IFTYPE_STATION:
  13076. case NL80211_IFTYPE_P2P_CLIENT:
  13077. break;
  13078. default:
  13079. return -EOPNOTSUPP;
  13080. }
  13081. if (!info->attrs[NL80211_ATTR_MAC])
  13082. return -EINVAL;
  13083. addr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13084. rdev_tdls_cancel_channel_switch(rdev, dev, addr);
  13085. return 0;
  13086. }
  13087. static int nl80211_set_multicast_to_unicast(struct sk_buff *skb,
  13088. struct genl_info *info)
  13089. {
  13090. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13091. struct net_device *dev = info->user_ptr[1];
  13092. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13093. const struct nlattr *nla;
  13094. bool enabled;
  13095. if (!rdev->ops->set_multicast_to_unicast)
  13096. return -EOPNOTSUPP;
  13097. if (wdev->iftype != NL80211_IFTYPE_AP &&
  13098. wdev->iftype != NL80211_IFTYPE_P2P_GO)
  13099. return -EOPNOTSUPP;
  13100. nla = info->attrs[NL80211_ATTR_MULTICAST_TO_UNICAST_ENABLED];
  13101. enabled = nla_get_flag(nla);
  13102. return rdev_set_multicast_to_unicast(rdev, dev, enabled);
  13103. }
  13104. static int nl80211_set_pmk(struct sk_buff *skb, struct genl_info *info)
  13105. {
  13106. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13107. struct net_device *dev = info->user_ptr[1];
  13108. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13109. struct cfg80211_pmk_conf pmk_conf = {};
  13110. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  13111. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  13112. return -EOPNOTSUPP;
  13113. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  13114. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  13115. return -EOPNOTSUPP;
  13116. if (!info->attrs[NL80211_ATTR_MAC] || !info->attrs[NL80211_ATTR_PMK])
  13117. return -EINVAL;
  13118. if (!wdev->connected)
  13119. return -ENOTCONN;
  13120. pmk_conf.aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13121. if (memcmp(pmk_conf.aa, wdev->u.client.connected_addr, ETH_ALEN))
  13122. return -EINVAL;
  13123. pmk_conf.pmk = nla_data(info->attrs[NL80211_ATTR_PMK]);
  13124. pmk_conf.pmk_len = nla_len(info->attrs[NL80211_ATTR_PMK]);
  13125. if (pmk_conf.pmk_len != WLAN_PMK_LEN &&
  13126. pmk_conf.pmk_len != WLAN_PMK_LEN_SUITE_B_192)
  13127. return -EINVAL;
  13128. if (info->attrs[NL80211_ATTR_PMKR0_NAME])
  13129. pmk_conf.pmk_r0_name =
  13130. nla_data(info->attrs[NL80211_ATTR_PMKR0_NAME]);
  13131. return rdev_set_pmk(rdev, dev, &pmk_conf);
  13132. }
  13133. static int nl80211_del_pmk(struct sk_buff *skb, struct genl_info *info)
  13134. {
  13135. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13136. struct net_device *dev = info->user_ptr[1];
  13137. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13138. const u8 *aa;
  13139. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  13140. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  13141. return -EOPNOTSUPP;
  13142. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  13143. NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X))
  13144. return -EOPNOTSUPP;
  13145. if (!info->attrs[NL80211_ATTR_MAC])
  13146. return -EINVAL;
  13147. aa = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13148. return rdev_del_pmk(rdev, dev, aa);
  13149. }
  13150. static int nl80211_external_auth(struct sk_buff *skb, struct genl_info *info)
  13151. {
  13152. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13153. struct net_device *dev = info->user_ptr[1];
  13154. struct cfg80211_external_auth_params params;
  13155. if (!rdev->ops->external_auth)
  13156. return -EOPNOTSUPP;
  13157. if (!info->attrs[NL80211_ATTR_SSID] &&
  13158. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_AP &&
  13159. dev->ieee80211_ptr->iftype != NL80211_IFTYPE_P2P_GO)
  13160. return -EINVAL;
  13161. if (!info->attrs[NL80211_ATTR_BSSID])
  13162. return -EINVAL;
  13163. if (!info->attrs[NL80211_ATTR_STATUS_CODE])
  13164. return -EINVAL;
  13165. memset(&params, 0, sizeof(params));
  13166. if (info->attrs[NL80211_ATTR_SSID]) {
  13167. params.ssid.ssid_len = nla_len(info->attrs[NL80211_ATTR_SSID]);
  13168. if (params.ssid.ssid_len == 0)
  13169. return -EINVAL;
  13170. memcpy(params.ssid.ssid,
  13171. nla_data(info->attrs[NL80211_ATTR_SSID]),
  13172. params.ssid.ssid_len);
  13173. }
  13174. memcpy(params.bssid, nla_data(info->attrs[NL80211_ATTR_BSSID]),
  13175. ETH_ALEN);
  13176. params.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  13177. if (info->attrs[NL80211_ATTR_PMKID])
  13178. params.pmkid = nla_data(info->attrs[NL80211_ATTR_PMKID]);
  13179. return rdev_external_auth(rdev, dev, &params);
  13180. }
  13181. static int nl80211_tx_control_port(struct sk_buff *skb, struct genl_info *info)
  13182. {
  13183. bool dont_wait_for_ack = info->attrs[NL80211_ATTR_DONT_WAIT_FOR_ACK];
  13184. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13185. struct net_device *dev = info->user_ptr[1];
  13186. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13187. const u8 *buf;
  13188. size_t len;
  13189. u8 *dest;
  13190. u16 proto;
  13191. bool noencrypt;
  13192. u64 cookie = 0;
  13193. int link_id;
  13194. int err;
  13195. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  13196. NL80211_EXT_FEATURE_CONTROL_PORT_OVER_NL80211))
  13197. return -EOPNOTSUPP;
  13198. if (!rdev->ops->tx_control_port)
  13199. return -EOPNOTSUPP;
  13200. if (!info->attrs[NL80211_ATTR_FRAME] ||
  13201. !info->attrs[NL80211_ATTR_MAC] ||
  13202. !info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]) {
  13203. GENL_SET_ERR_MSG(info, "Frame, MAC or ethertype missing");
  13204. return -EINVAL;
  13205. }
  13206. switch (wdev->iftype) {
  13207. case NL80211_IFTYPE_AP:
  13208. case NL80211_IFTYPE_P2P_GO:
  13209. case NL80211_IFTYPE_MESH_POINT:
  13210. break;
  13211. case NL80211_IFTYPE_ADHOC:
  13212. if (wdev->u.ibss.current_bss)
  13213. break;
  13214. return -ENOTCONN;
  13215. case NL80211_IFTYPE_STATION:
  13216. case NL80211_IFTYPE_P2P_CLIENT:
  13217. if (wdev->connected)
  13218. break;
  13219. return -ENOTCONN;
  13220. default:
  13221. return -EOPNOTSUPP;
  13222. }
  13223. buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
  13224. len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
  13225. dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13226. proto = nla_get_u16(info->attrs[NL80211_ATTR_CONTROL_PORT_ETHERTYPE]);
  13227. noencrypt =
  13228. nla_get_flag(info->attrs[NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT]);
  13229. link_id = nl80211_link_id_or_invalid(info->attrs);
  13230. err = rdev_tx_control_port(rdev, dev, buf, len,
  13231. dest, cpu_to_be16(proto), noencrypt, link_id,
  13232. dont_wait_for_ack ? NULL : &cookie);
  13233. if (!err && !dont_wait_for_ack)
  13234. nl_set_extack_cookie_u64(info->extack, cookie);
  13235. return err;
  13236. }
  13237. static int nl80211_get_ftm_responder_stats(struct sk_buff *skb,
  13238. struct genl_info *info)
  13239. {
  13240. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13241. struct net_device *dev = info->user_ptr[1];
  13242. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13243. struct cfg80211_ftm_responder_stats ftm_stats = {};
  13244. unsigned int link_id = nl80211_link_id(info->attrs);
  13245. struct sk_buff *msg;
  13246. void *hdr;
  13247. struct nlattr *ftm_stats_attr;
  13248. int err;
  13249. if (wdev->iftype != NL80211_IFTYPE_AP ||
  13250. !wdev->links[link_id].ap.beacon_interval)
  13251. return -EOPNOTSUPP;
  13252. err = rdev_get_ftm_responder_stats(rdev, dev, &ftm_stats);
  13253. if (err)
  13254. return err;
  13255. if (!ftm_stats.filled)
  13256. return -ENODATA;
  13257. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  13258. if (!msg)
  13259. return -ENOMEM;
  13260. hdr = nl80211hdr_put(msg, info->snd_portid, info->snd_seq, 0,
  13261. NL80211_CMD_GET_FTM_RESPONDER_STATS);
  13262. if (!hdr)
  13263. goto nla_put_failure;
  13264. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  13265. goto nla_put_failure;
  13266. ftm_stats_attr = nla_nest_start_noflag(msg,
  13267. NL80211_ATTR_FTM_RESPONDER_STATS);
  13268. if (!ftm_stats_attr)
  13269. goto nla_put_failure;
  13270. #define SET_FTM(field, name, type) \
  13271. do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
  13272. nla_put_ ## type(msg, NL80211_FTM_STATS_ ## name, \
  13273. ftm_stats.field)) \
  13274. goto nla_put_failure; } while (0)
  13275. #define SET_FTM_U64(field, name) \
  13276. do { if ((ftm_stats.filled & BIT(NL80211_FTM_STATS_ ## name)) && \
  13277. nla_put_u64_64bit(msg, NL80211_FTM_STATS_ ## name, \
  13278. ftm_stats.field, NL80211_FTM_STATS_PAD)) \
  13279. goto nla_put_failure; } while (0)
  13280. SET_FTM(success_num, SUCCESS_NUM, u32);
  13281. SET_FTM(partial_num, PARTIAL_NUM, u32);
  13282. SET_FTM(failed_num, FAILED_NUM, u32);
  13283. SET_FTM(asap_num, ASAP_NUM, u32);
  13284. SET_FTM(non_asap_num, NON_ASAP_NUM, u32);
  13285. SET_FTM_U64(total_duration_ms, TOTAL_DURATION_MSEC);
  13286. SET_FTM(unknown_triggers_num, UNKNOWN_TRIGGERS_NUM, u32);
  13287. SET_FTM(reschedule_requests_num, RESCHEDULE_REQUESTS_NUM, u32);
  13288. SET_FTM(out_of_window_triggers_num, OUT_OF_WINDOW_TRIGGERS_NUM, u32);
  13289. #undef SET_FTM
  13290. nla_nest_end(msg, ftm_stats_attr);
  13291. genlmsg_end(msg, hdr);
  13292. return genlmsg_reply(msg, info);
  13293. nla_put_failure:
  13294. nlmsg_free(msg);
  13295. return -ENOBUFS;
  13296. }
  13297. static int nl80211_update_owe_info(struct sk_buff *skb, struct genl_info *info)
  13298. {
  13299. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13300. struct cfg80211_update_owe_info owe_info;
  13301. struct net_device *dev = info->user_ptr[1];
  13302. if (!rdev->ops->update_owe_info)
  13303. return -EOPNOTSUPP;
  13304. if (!info->attrs[NL80211_ATTR_STATUS_CODE] ||
  13305. !info->attrs[NL80211_ATTR_MAC])
  13306. return -EINVAL;
  13307. memset(&owe_info, 0, sizeof(owe_info));
  13308. owe_info.status = nla_get_u16(info->attrs[NL80211_ATTR_STATUS_CODE]);
  13309. nla_memcpy(owe_info.peer, info->attrs[NL80211_ATTR_MAC], ETH_ALEN);
  13310. if (info->attrs[NL80211_ATTR_IE]) {
  13311. owe_info.ie = nla_data(info->attrs[NL80211_ATTR_IE]);
  13312. owe_info.ie_len = nla_len(info->attrs[NL80211_ATTR_IE]);
  13313. }
  13314. return rdev_update_owe_info(rdev, dev, &owe_info);
  13315. }
  13316. static int nl80211_probe_mesh_link(struct sk_buff *skb, struct genl_info *info)
  13317. {
  13318. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13319. struct net_device *dev = info->user_ptr[1];
  13320. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13321. struct station_info sinfo = {};
  13322. const u8 *buf;
  13323. size_t len;
  13324. u8 *dest;
  13325. int err;
  13326. if (!rdev->ops->probe_mesh_link || !rdev->ops->get_station)
  13327. return -EOPNOTSUPP;
  13328. if (!info->attrs[NL80211_ATTR_MAC] ||
  13329. !info->attrs[NL80211_ATTR_FRAME]) {
  13330. GENL_SET_ERR_MSG(info, "Frame or MAC missing");
  13331. return -EINVAL;
  13332. }
  13333. if (wdev->iftype != NL80211_IFTYPE_MESH_POINT)
  13334. return -EOPNOTSUPP;
  13335. dest = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13336. buf = nla_data(info->attrs[NL80211_ATTR_FRAME]);
  13337. len = nla_len(info->attrs[NL80211_ATTR_FRAME]);
  13338. if (len < sizeof(struct ethhdr))
  13339. return -EINVAL;
  13340. if (!ether_addr_equal(buf, dest) || is_multicast_ether_addr(buf) ||
  13341. !ether_addr_equal(buf + ETH_ALEN, dev->dev_addr))
  13342. return -EINVAL;
  13343. err = rdev_get_station(rdev, dev, dest, &sinfo);
  13344. if (err)
  13345. return err;
  13346. cfg80211_sinfo_release_content(&sinfo);
  13347. return rdev_probe_mesh_link(rdev, dev, dest, buf, len);
  13348. }
  13349. static int parse_tid_conf(struct cfg80211_registered_device *rdev,
  13350. struct nlattr *attrs[], struct net_device *dev,
  13351. struct cfg80211_tid_cfg *tid_conf,
  13352. struct genl_info *info, const u8 *peer,
  13353. unsigned int link_id)
  13354. {
  13355. struct netlink_ext_ack *extack = info->extack;
  13356. u64 mask;
  13357. int err;
  13358. if (!attrs[NL80211_TID_CONFIG_ATTR_TIDS])
  13359. return -EINVAL;
  13360. tid_conf->config_override =
  13361. nla_get_flag(attrs[NL80211_TID_CONFIG_ATTR_OVERRIDE]);
  13362. tid_conf->tids = nla_get_u16(attrs[NL80211_TID_CONFIG_ATTR_TIDS]);
  13363. if (tid_conf->config_override) {
  13364. if (rdev->ops->reset_tid_config) {
  13365. err = rdev_reset_tid_config(rdev, dev, peer,
  13366. tid_conf->tids);
  13367. if (err)
  13368. return err;
  13369. } else {
  13370. return -EINVAL;
  13371. }
  13372. }
  13373. if (attrs[NL80211_TID_CONFIG_ATTR_NOACK]) {
  13374. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_NOACK);
  13375. tid_conf->noack =
  13376. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_NOACK]);
  13377. }
  13378. if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]) {
  13379. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_SHORT);
  13380. tid_conf->retry_short =
  13381. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_SHORT]);
  13382. if (tid_conf->retry_short > rdev->wiphy.max_data_retry_count)
  13383. return -EINVAL;
  13384. }
  13385. if (attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]) {
  13386. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RETRY_LONG);
  13387. tid_conf->retry_long =
  13388. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RETRY_LONG]);
  13389. if (tid_conf->retry_long > rdev->wiphy.max_data_retry_count)
  13390. return -EINVAL;
  13391. }
  13392. if (attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]) {
  13393. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMPDU_CTRL);
  13394. tid_conf->ampdu =
  13395. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMPDU_CTRL]);
  13396. }
  13397. if (attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]) {
  13398. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL);
  13399. tid_conf->rtscts =
  13400. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_RTSCTS_CTRL]);
  13401. }
  13402. if (attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]) {
  13403. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_AMSDU_CTRL);
  13404. tid_conf->amsdu =
  13405. nla_get_u8(attrs[NL80211_TID_CONFIG_ATTR_AMSDU_CTRL]);
  13406. }
  13407. if (attrs[NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE]) {
  13408. u32 idx = NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE, attr;
  13409. tid_conf->txrate_type = nla_get_u8(attrs[idx]);
  13410. if (tid_conf->txrate_type != NL80211_TX_RATE_AUTOMATIC) {
  13411. attr = NL80211_TID_CONFIG_ATTR_TX_RATE;
  13412. err = nl80211_parse_tx_bitrate_mask(info, attrs, attr,
  13413. &tid_conf->txrate_mask, dev,
  13414. true, link_id);
  13415. if (err)
  13416. return err;
  13417. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE);
  13418. }
  13419. tid_conf->mask |= BIT(NL80211_TID_CONFIG_ATTR_TX_RATE_TYPE);
  13420. }
  13421. if (peer)
  13422. mask = rdev->wiphy.tid_config_support.peer;
  13423. else
  13424. mask = rdev->wiphy.tid_config_support.vif;
  13425. if (tid_conf->mask & ~mask) {
  13426. NL_SET_ERR_MSG(extack, "unsupported TID configuration");
  13427. return -EOPNOTSUPP;
  13428. }
  13429. return 0;
  13430. }
  13431. static int nl80211_set_tid_config(struct sk_buff *skb,
  13432. struct genl_info *info)
  13433. {
  13434. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13435. struct nlattr *attrs[NL80211_TID_CONFIG_ATTR_MAX + 1];
  13436. unsigned int link_id = nl80211_link_id(info->attrs);
  13437. struct net_device *dev = info->user_ptr[1];
  13438. struct cfg80211_tid_config *tid_config;
  13439. struct nlattr *tid;
  13440. int conf_idx = 0, rem_conf;
  13441. int ret = -EINVAL;
  13442. u32 num_conf = 0;
  13443. if (!info->attrs[NL80211_ATTR_TID_CONFIG])
  13444. return -EINVAL;
  13445. if (!rdev->ops->set_tid_config)
  13446. return -EOPNOTSUPP;
  13447. nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG],
  13448. rem_conf)
  13449. num_conf++;
  13450. tid_config = kzalloc(struct_size(tid_config, tid_conf, num_conf),
  13451. GFP_KERNEL);
  13452. if (!tid_config)
  13453. return -ENOMEM;
  13454. tid_config->n_tid_conf = num_conf;
  13455. if (info->attrs[NL80211_ATTR_MAC])
  13456. tid_config->peer = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13457. nla_for_each_nested(tid, info->attrs[NL80211_ATTR_TID_CONFIG],
  13458. rem_conf) {
  13459. ret = nla_parse_nested(attrs, NL80211_TID_CONFIG_ATTR_MAX,
  13460. tid, NULL, NULL);
  13461. if (ret)
  13462. goto bad_tid_conf;
  13463. ret = parse_tid_conf(rdev, attrs, dev,
  13464. &tid_config->tid_conf[conf_idx],
  13465. info, tid_config->peer, link_id);
  13466. if (ret)
  13467. goto bad_tid_conf;
  13468. conf_idx++;
  13469. }
  13470. ret = rdev_set_tid_config(rdev, dev, tid_config);
  13471. bad_tid_conf:
  13472. kfree(tid_config);
  13473. return ret;
  13474. }
  13475. static int nl80211_color_change(struct sk_buff *skb, struct genl_info *info)
  13476. {
  13477. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13478. struct cfg80211_color_change_settings params = {};
  13479. struct net_device *dev = info->user_ptr[1];
  13480. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13481. struct nlattr **tb;
  13482. u16 offset;
  13483. int err;
  13484. if (!rdev->ops->color_change)
  13485. return -EOPNOTSUPP;
  13486. if (!wiphy_ext_feature_isset(&rdev->wiphy,
  13487. NL80211_EXT_FEATURE_BSS_COLOR))
  13488. return -EOPNOTSUPP;
  13489. if (wdev->iftype != NL80211_IFTYPE_AP)
  13490. return -EOPNOTSUPP;
  13491. if (!info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT] ||
  13492. !info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR] ||
  13493. !info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS])
  13494. return -EINVAL;
  13495. params.count = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COUNT]);
  13496. params.color = nla_get_u8(info->attrs[NL80211_ATTR_COLOR_CHANGE_COLOR]);
  13497. err = nl80211_parse_beacon(rdev, info->attrs, &params.beacon_next,
  13498. info->extack);
  13499. if (err)
  13500. return err;
  13501. tb = kcalloc(NL80211_ATTR_MAX + 1, sizeof(*tb), GFP_KERNEL);
  13502. if (!tb)
  13503. return -ENOMEM;
  13504. err = nla_parse_nested(tb, NL80211_ATTR_MAX,
  13505. info->attrs[NL80211_ATTR_COLOR_CHANGE_ELEMS],
  13506. nl80211_policy, info->extack);
  13507. if (err)
  13508. goto out;
  13509. err = nl80211_parse_beacon(rdev, tb, &params.beacon_color_change,
  13510. info->extack);
  13511. if (err)
  13512. goto out;
  13513. if (!tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) {
  13514. err = -EINVAL;
  13515. goto out;
  13516. }
  13517. if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]) != sizeof(u16)) {
  13518. err = -EINVAL;
  13519. goto out;
  13520. }
  13521. offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_BEACON]);
  13522. if (offset >= params.beacon_color_change.tail_len) {
  13523. err = -EINVAL;
  13524. goto out;
  13525. }
  13526. if (params.beacon_color_change.tail[offset] != params.count) {
  13527. err = -EINVAL;
  13528. goto out;
  13529. }
  13530. params.counter_offset_beacon = offset;
  13531. if (tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) {
  13532. if (nla_len(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]) !=
  13533. sizeof(u16)) {
  13534. err = -EINVAL;
  13535. goto out;
  13536. }
  13537. offset = nla_get_u16(tb[NL80211_ATTR_CNTDWN_OFFS_PRESP]);
  13538. if (offset >= params.beacon_color_change.probe_resp_len) {
  13539. err = -EINVAL;
  13540. goto out;
  13541. }
  13542. if (params.beacon_color_change.probe_resp[offset] !=
  13543. params.count) {
  13544. err = -EINVAL;
  13545. goto out;
  13546. }
  13547. params.counter_offset_presp = offset;
  13548. }
  13549. params.link_id = nl80211_link_id(info->attrs);
  13550. err = rdev_color_change(rdev, dev, &params);
  13551. out:
  13552. kfree(params.beacon_next.mbssid_ies);
  13553. kfree(params.beacon_color_change.mbssid_ies);
  13554. kfree(params.beacon_next.rnr_ies);
  13555. kfree(params.beacon_color_change.rnr_ies);
  13556. kfree(tb);
  13557. return err;
  13558. }
  13559. static int nl80211_set_fils_aad(struct sk_buff *skb,
  13560. struct genl_info *info)
  13561. {
  13562. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13563. struct net_device *dev = info->user_ptr[1];
  13564. struct cfg80211_fils_aad fils_aad = {};
  13565. u8 *nonces;
  13566. if (!info->attrs[NL80211_ATTR_MAC] ||
  13567. !info->attrs[NL80211_ATTR_FILS_KEK] ||
  13568. !info->attrs[NL80211_ATTR_FILS_NONCES])
  13569. return -EINVAL;
  13570. fils_aad.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13571. fils_aad.kek_len = nla_len(info->attrs[NL80211_ATTR_FILS_KEK]);
  13572. fils_aad.kek = nla_data(info->attrs[NL80211_ATTR_FILS_KEK]);
  13573. nonces = nla_data(info->attrs[NL80211_ATTR_FILS_NONCES]);
  13574. fils_aad.snonce = nonces;
  13575. fils_aad.anonce = nonces + FILS_NONCE_LEN;
  13576. return rdev_set_fils_aad(rdev, dev, &fils_aad);
  13577. }
  13578. static int nl80211_add_link(struct sk_buff *skb, struct genl_info *info)
  13579. {
  13580. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13581. unsigned int link_id = nl80211_link_id(info->attrs);
  13582. struct net_device *dev = info->user_ptr[1];
  13583. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13584. int ret;
  13585. if (!(wdev->wiphy->flags & WIPHY_FLAG_SUPPORTS_MLO))
  13586. return -EINVAL;
  13587. switch (wdev->iftype) {
  13588. case NL80211_IFTYPE_AP:
  13589. break;
  13590. default:
  13591. return -EINVAL;
  13592. }
  13593. if (!info->attrs[NL80211_ATTR_MAC] ||
  13594. !is_valid_ether_addr(nla_data(info->attrs[NL80211_ATTR_MAC])))
  13595. return -EINVAL;
  13596. wdev->valid_links |= BIT(link_id);
  13597. ether_addr_copy(wdev->links[link_id].addr,
  13598. nla_data(info->attrs[NL80211_ATTR_MAC]));
  13599. ret = rdev_add_intf_link(rdev, wdev, link_id);
  13600. if (ret) {
  13601. wdev->valid_links &= ~BIT(link_id);
  13602. eth_zero_addr(wdev->links[link_id].addr);
  13603. }
  13604. return ret;
  13605. }
  13606. static int nl80211_remove_link(struct sk_buff *skb, struct genl_info *info)
  13607. {
  13608. unsigned int link_id = nl80211_link_id(info->attrs);
  13609. struct net_device *dev = info->user_ptr[1];
  13610. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13611. /* cannot remove if there's no link */
  13612. if (!info->attrs[NL80211_ATTR_MLO_LINK_ID])
  13613. return -EINVAL;
  13614. switch (wdev->iftype) {
  13615. case NL80211_IFTYPE_AP:
  13616. break;
  13617. default:
  13618. return -EINVAL;
  13619. }
  13620. cfg80211_remove_link(wdev, link_id);
  13621. return 0;
  13622. }
  13623. static int
  13624. nl80211_add_mod_link_station(struct sk_buff *skb, struct genl_info *info,
  13625. bool add)
  13626. {
  13627. struct link_station_parameters params = {};
  13628. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13629. struct net_device *dev = info->user_ptr[1];
  13630. int err;
  13631. if ((add && !rdev->ops->add_link_station) ||
  13632. (!add && !rdev->ops->mod_link_station))
  13633. return -EOPNOTSUPP;
  13634. if (add && !info->attrs[NL80211_ATTR_MAC])
  13635. return -EINVAL;
  13636. if (!info->attrs[NL80211_ATTR_MLD_ADDR])
  13637. return -EINVAL;
  13638. if (add && !info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES])
  13639. return -EINVAL;
  13640. params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  13641. if (info->attrs[NL80211_ATTR_MAC]) {
  13642. params.link_mac = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13643. if (!is_valid_ether_addr(params.link_mac))
  13644. return -EINVAL;
  13645. }
  13646. if (!info->attrs[NL80211_ATTR_MLO_LINK_ID])
  13647. return -EINVAL;
  13648. params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]);
  13649. if (info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]) {
  13650. params.supported_rates =
  13651. nla_data(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  13652. params.supported_rates_len =
  13653. nla_len(info->attrs[NL80211_ATTR_STA_SUPPORTED_RATES]);
  13654. }
  13655. if (info->attrs[NL80211_ATTR_HT_CAPABILITY])
  13656. params.ht_capa =
  13657. nla_data(info->attrs[NL80211_ATTR_HT_CAPABILITY]);
  13658. if (info->attrs[NL80211_ATTR_VHT_CAPABILITY])
  13659. params.vht_capa =
  13660. nla_data(info->attrs[NL80211_ATTR_VHT_CAPABILITY]);
  13661. if (info->attrs[NL80211_ATTR_HE_CAPABILITY]) {
  13662. params.he_capa =
  13663. nla_data(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  13664. params.he_capa_len =
  13665. nla_len(info->attrs[NL80211_ATTR_HE_CAPABILITY]);
  13666. if (info->attrs[NL80211_ATTR_EHT_CAPABILITY]) {
  13667. params.eht_capa =
  13668. nla_data(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  13669. params.eht_capa_len =
  13670. nla_len(info->attrs[NL80211_ATTR_EHT_CAPABILITY]);
  13671. if (!ieee80211_eht_capa_size_ok((const u8 *)params.he_capa,
  13672. (const u8 *)params.eht_capa,
  13673. params.eht_capa_len,
  13674. false))
  13675. return -EINVAL;
  13676. }
  13677. }
  13678. if (info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY])
  13679. params.he_6ghz_capa =
  13680. nla_data(info->attrs[NL80211_ATTR_HE_6GHZ_CAPABILITY]);
  13681. if (info->attrs[NL80211_ATTR_OPMODE_NOTIF]) {
  13682. params.opmode_notif_used = true;
  13683. params.opmode_notif =
  13684. nla_get_u8(info->attrs[NL80211_ATTR_OPMODE_NOTIF]);
  13685. }
  13686. err = nl80211_parse_sta_txpower_setting(info, &params.txpwr,
  13687. &params.txpwr_set);
  13688. if (err)
  13689. return err;
  13690. if (add)
  13691. return rdev_add_link_station(rdev, dev, &params);
  13692. return rdev_mod_link_station(rdev, dev, &params);
  13693. }
  13694. static int
  13695. nl80211_add_link_station(struct sk_buff *skb, struct genl_info *info)
  13696. {
  13697. return nl80211_add_mod_link_station(skb, info, true);
  13698. }
  13699. static int
  13700. nl80211_modify_link_station(struct sk_buff *skb, struct genl_info *info)
  13701. {
  13702. return nl80211_add_mod_link_station(skb, info, false);
  13703. }
  13704. static int
  13705. nl80211_remove_link_station(struct sk_buff *skb, struct genl_info *info)
  13706. {
  13707. struct link_station_del_parameters params = {};
  13708. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13709. struct net_device *dev = info->user_ptr[1];
  13710. if (!rdev->ops->del_link_station)
  13711. return -EOPNOTSUPP;
  13712. if (!info->attrs[NL80211_ATTR_MLD_ADDR] ||
  13713. !info->attrs[NL80211_ATTR_MLO_LINK_ID])
  13714. return -EINVAL;
  13715. params.mld_mac = nla_data(info->attrs[NL80211_ATTR_MLD_ADDR]);
  13716. params.link_id = nla_get_u8(info->attrs[NL80211_ATTR_MLO_LINK_ID]);
  13717. return rdev_del_link_station(rdev, dev, &params);
  13718. }
  13719. static int nl80211_set_hw_timestamp(struct sk_buff *skb,
  13720. struct genl_info *info)
  13721. {
  13722. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13723. struct net_device *dev = info->user_ptr[1];
  13724. struct cfg80211_set_hw_timestamp hwts = {};
  13725. if (!rdev->wiphy.hw_timestamp_max_peers)
  13726. return -EOPNOTSUPP;
  13727. if (!info->attrs[NL80211_ATTR_MAC] &&
  13728. rdev->wiphy.hw_timestamp_max_peers != CFG80211_HW_TIMESTAMP_ALL_PEERS)
  13729. return -EOPNOTSUPP;
  13730. if (info->attrs[NL80211_ATTR_MAC])
  13731. hwts.macaddr = nla_data(info->attrs[NL80211_ATTR_MAC]);
  13732. hwts.enable =
  13733. nla_get_flag(info->attrs[NL80211_ATTR_HW_TIMESTAMP_ENABLED]);
  13734. return rdev_set_hw_timestamp(rdev, dev, &hwts);
  13735. }
  13736. static int
  13737. nl80211_set_ttlm(struct sk_buff *skb, struct genl_info *info)
  13738. {
  13739. struct cfg80211_ttlm_params params = {};
  13740. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13741. struct net_device *dev = info->user_ptr[1];
  13742. struct wireless_dev *wdev = dev->ieee80211_ptr;
  13743. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  13744. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)
  13745. return -EOPNOTSUPP;
  13746. if (!wdev->connected)
  13747. return -ENOLINK;
  13748. if (!info->attrs[NL80211_ATTR_MLO_TTLM_DLINK] ||
  13749. !info->attrs[NL80211_ATTR_MLO_TTLM_ULINK])
  13750. return -EINVAL;
  13751. nla_memcpy(params.dlink,
  13752. info->attrs[NL80211_ATTR_MLO_TTLM_DLINK],
  13753. sizeof(params.dlink));
  13754. nla_memcpy(params.ulink,
  13755. info->attrs[NL80211_ATTR_MLO_TTLM_ULINK],
  13756. sizeof(params.ulink));
  13757. return rdev_set_ttlm(rdev, dev, &params);
  13758. }
  13759. #define NL80211_FLAG_NEED_WIPHY 0x01
  13760. #define NL80211_FLAG_NEED_NETDEV 0x02
  13761. #define NL80211_FLAG_NEED_RTNL 0x04
  13762. #define NL80211_FLAG_CHECK_NETDEV_UP 0x08
  13763. #define NL80211_FLAG_NEED_NETDEV_UP (NL80211_FLAG_NEED_NETDEV |\
  13764. NL80211_FLAG_CHECK_NETDEV_UP)
  13765. #define NL80211_FLAG_NEED_WDEV 0x10
  13766. /* If a netdev is associated, it must be UP, P2P must be started */
  13767. #define NL80211_FLAG_NEED_WDEV_UP (NL80211_FLAG_NEED_WDEV |\
  13768. NL80211_FLAG_CHECK_NETDEV_UP)
  13769. #define NL80211_FLAG_CLEAR_SKB 0x20
  13770. #define NL80211_FLAG_NO_WIPHY_MTX 0x40
  13771. #define NL80211_FLAG_MLO_VALID_LINK_ID 0x80
  13772. #define NL80211_FLAG_MLO_UNSUPPORTED 0x100
  13773. #define INTERNAL_FLAG_SELECTORS(__sel) \
  13774. SELECTOR(__sel, NONE, 0) /* must be first */ \
  13775. SELECTOR(__sel, WIPHY, \
  13776. NL80211_FLAG_NEED_WIPHY) \
  13777. SELECTOR(__sel, WDEV, \
  13778. NL80211_FLAG_NEED_WDEV) \
  13779. SELECTOR(__sel, NETDEV, \
  13780. NL80211_FLAG_NEED_NETDEV) \
  13781. SELECTOR(__sel, NETDEV_LINK, \
  13782. NL80211_FLAG_NEED_NETDEV | \
  13783. NL80211_FLAG_MLO_VALID_LINK_ID) \
  13784. SELECTOR(__sel, NETDEV_NO_MLO, \
  13785. NL80211_FLAG_NEED_NETDEV | \
  13786. NL80211_FLAG_MLO_UNSUPPORTED) \
  13787. SELECTOR(__sel, WIPHY_RTNL, \
  13788. NL80211_FLAG_NEED_WIPHY | \
  13789. NL80211_FLAG_NEED_RTNL) \
  13790. SELECTOR(__sel, WIPHY_RTNL_NOMTX, \
  13791. NL80211_FLAG_NEED_WIPHY | \
  13792. NL80211_FLAG_NEED_RTNL | \
  13793. NL80211_FLAG_NO_WIPHY_MTX) \
  13794. SELECTOR(__sel, WDEV_RTNL, \
  13795. NL80211_FLAG_NEED_WDEV | \
  13796. NL80211_FLAG_NEED_RTNL) \
  13797. SELECTOR(__sel, NETDEV_RTNL, \
  13798. NL80211_FLAG_NEED_NETDEV | \
  13799. NL80211_FLAG_NEED_RTNL) \
  13800. SELECTOR(__sel, NETDEV_UP, \
  13801. NL80211_FLAG_NEED_NETDEV_UP) \
  13802. SELECTOR(__sel, NETDEV_UP_LINK, \
  13803. NL80211_FLAG_NEED_NETDEV_UP | \
  13804. NL80211_FLAG_MLO_VALID_LINK_ID) \
  13805. SELECTOR(__sel, NETDEV_UP_NO_MLO, \
  13806. NL80211_FLAG_NEED_NETDEV_UP | \
  13807. NL80211_FLAG_MLO_UNSUPPORTED) \
  13808. SELECTOR(__sel, NETDEV_UP_NO_MLO_CLEAR, \
  13809. NL80211_FLAG_NEED_NETDEV_UP | \
  13810. NL80211_FLAG_CLEAR_SKB | \
  13811. NL80211_FLAG_MLO_UNSUPPORTED) \
  13812. SELECTOR(__sel, NETDEV_UP_NOTMX, \
  13813. NL80211_FLAG_NEED_NETDEV_UP | \
  13814. NL80211_FLAG_NO_WIPHY_MTX) \
  13815. SELECTOR(__sel, NETDEV_UP_NOTMX_MLO, \
  13816. NL80211_FLAG_NEED_NETDEV_UP | \
  13817. NL80211_FLAG_NO_WIPHY_MTX | \
  13818. NL80211_FLAG_MLO_VALID_LINK_ID) \
  13819. SELECTOR(__sel, NETDEV_UP_CLEAR, \
  13820. NL80211_FLAG_NEED_NETDEV_UP | \
  13821. NL80211_FLAG_CLEAR_SKB) \
  13822. SELECTOR(__sel, WDEV_UP, \
  13823. NL80211_FLAG_NEED_WDEV_UP) \
  13824. SELECTOR(__sel, WDEV_UP_LINK, \
  13825. NL80211_FLAG_NEED_WDEV_UP | \
  13826. NL80211_FLAG_MLO_VALID_LINK_ID) \
  13827. SELECTOR(__sel, WDEV_UP_RTNL, \
  13828. NL80211_FLAG_NEED_WDEV_UP | \
  13829. NL80211_FLAG_NEED_RTNL) \
  13830. SELECTOR(__sel, WIPHY_CLEAR, \
  13831. NL80211_FLAG_NEED_WIPHY | \
  13832. NL80211_FLAG_CLEAR_SKB)
  13833. enum nl80211_internal_flags_selector {
  13834. #define SELECTOR(_, name, value) NL80211_IFL_SEL_##name,
  13835. INTERNAL_FLAG_SELECTORS(_)
  13836. #undef SELECTOR
  13837. };
  13838. static u32 nl80211_internal_flags[] = {
  13839. #define SELECTOR(_, name, value) [NL80211_IFL_SEL_##name] = value,
  13840. INTERNAL_FLAG_SELECTORS(_)
  13841. #undef SELECTOR
  13842. };
  13843. static int nl80211_pre_doit(const struct genl_split_ops *ops,
  13844. struct sk_buff *skb,
  13845. struct genl_info *info)
  13846. {
  13847. struct cfg80211_registered_device *rdev = NULL;
  13848. struct wireless_dev *wdev = NULL;
  13849. struct net_device *dev = NULL;
  13850. u32 internal_flags;
  13851. int err;
  13852. if (WARN_ON(ops->internal_flags >= ARRAY_SIZE(nl80211_internal_flags)))
  13853. return -EINVAL;
  13854. internal_flags = nl80211_internal_flags[ops->internal_flags];
  13855. rtnl_lock();
  13856. if (internal_flags & NL80211_FLAG_NEED_WIPHY) {
  13857. rdev = cfg80211_get_dev_from_info(genl_info_net(info), info);
  13858. if (IS_ERR(rdev)) {
  13859. err = PTR_ERR(rdev);
  13860. goto out_unlock;
  13861. }
  13862. info->user_ptr[0] = rdev;
  13863. } else if (internal_flags & NL80211_FLAG_NEED_NETDEV ||
  13864. internal_flags & NL80211_FLAG_NEED_WDEV) {
  13865. wdev = __cfg80211_wdev_from_attrs(NULL, genl_info_net(info),
  13866. info->attrs);
  13867. if (IS_ERR(wdev)) {
  13868. err = PTR_ERR(wdev);
  13869. goto out_unlock;
  13870. }
  13871. dev = wdev->netdev;
  13872. dev_hold(dev);
  13873. rdev = wiphy_to_rdev(wdev->wiphy);
  13874. if (internal_flags & NL80211_FLAG_NEED_NETDEV) {
  13875. if (!dev) {
  13876. err = -EINVAL;
  13877. goto out_unlock;
  13878. }
  13879. info->user_ptr[1] = dev;
  13880. } else {
  13881. info->user_ptr[1] = wdev;
  13882. }
  13883. if (internal_flags & NL80211_FLAG_CHECK_NETDEV_UP &&
  13884. !wdev_running(wdev)) {
  13885. err = -ENETDOWN;
  13886. goto out_unlock;
  13887. }
  13888. info->user_ptr[0] = rdev;
  13889. }
  13890. if (internal_flags & NL80211_FLAG_MLO_VALID_LINK_ID) {
  13891. struct nlattr *link_id = info->attrs[NL80211_ATTR_MLO_LINK_ID];
  13892. if (!wdev) {
  13893. err = -EINVAL;
  13894. goto out_unlock;
  13895. }
  13896. /* MLO -> require valid link ID */
  13897. if (wdev->valid_links &&
  13898. (!link_id ||
  13899. !(wdev->valid_links & BIT(nla_get_u8(link_id))))) {
  13900. err = -EINVAL;
  13901. goto out_unlock;
  13902. }
  13903. /* non-MLO -> no link ID attribute accepted */
  13904. if (!wdev->valid_links && link_id) {
  13905. err = -EINVAL;
  13906. goto out_unlock;
  13907. }
  13908. }
  13909. if (internal_flags & NL80211_FLAG_MLO_UNSUPPORTED) {
  13910. if (info->attrs[NL80211_ATTR_MLO_LINK_ID] ||
  13911. (wdev && wdev->valid_links)) {
  13912. err = -EINVAL;
  13913. goto out_unlock;
  13914. }
  13915. }
  13916. if (rdev && !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) {
  13917. wiphy_lock(&rdev->wiphy);
  13918. /* we keep the mutex locked until post_doit */
  13919. __release(&rdev->wiphy.mtx);
  13920. }
  13921. if (!(internal_flags & NL80211_FLAG_NEED_RTNL))
  13922. rtnl_unlock();
  13923. return 0;
  13924. out_unlock:
  13925. rtnl_unlock();
  13926. dev_put(dev);
  13927. return err;
  13928. }
  13929. static void nl80211_post_doit(const struct genl_split_ops *ops,
  13930. struct sk_buff *skb,
  13931. struct genl_info *info)
  13932. {
  13933. u32 internal_flags = nl80211_internal_flags[ops->internal_flags];
  13934. if (info->user_ptr[1]) {
  13935. if (internal_flags & NL80211_FLAG_NEED_WDEV) {
  13936. struct wireless_dev *wdev = info->user_ptr[1];
  13937. dev_put(wdev->netdev);
  13938. } else {
  13939. dev_put(info->user_ptr[1]);
  13940. }
  13941. }
  13942. if (info->user_ptr[0] &&
  13943. !(internal_flags & NL80211_FLAG_NO_WIPHY_MTX)) {
  13944. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13945. /* we kept the mutex locked since pre_doit */
  13946. __acquire(&rdev->wiphy.mtx);
  13947. wiphy_unlock(&rdev->wiphy);
  13948. }
  13949. if (internal_flags & NL80211_FLAG_NEED_RTNL)
  13950. rtnl_unlock();
  13951. /* If needed, clear the netlink message payload from the SKB
  13952. * as it might contain key data that shouldn't stick around on
  13953. * the heap after the SKB is freed. The netlink message header
  13954. * is still needed for further processing, so leave it intact.
  13955. */
  13956. if (internal_flags & NL80211_FLAG_CLEAR_SKB) {
  13957. struct nlmsghdr *nlh = nlmsg_hdr(skb);
  13958. memset(nlmsg_data(nlh), 0, nlmsg_len(nlh));
  13959. }
  13960. }
  13961. static int nl80211_set_sar_sub_specs(struct cfg80211_registered_device *rdev,
  13962. struct cfg80211_sar_specs *sar_specs,
  13963. struct nlattr *spec[], int index)
  13964. {
  13965. u32 range_index, i;
  13966. if (!sar_specs || !spec)
  13967. return -EINVAL;
  13968. if (!spec[NL80211_SAR_ATTR_SPECS_POWER] ||
  13969. !spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX])
  13970. return -EINVAL;
  13971. range_index = nla_get_u32(spec[NL80211_SAR_ATTR_SPECS_RANGE_INDEX]);
  13972. /* check if range_index exceeds num_freq_ranges */
  13973. if (range_index >= rdev->wiphy.sar_capa->num_freq_ranges)
  13974. return -EINVAL;
  13975. /* check if range_index duplicates */
  13976. for (i = 0; i < index; i++) {
  13977. if (sar_specs->sub_specs[i].freq_range_index == range_index)
  13978. return -EINVAL;
  13979. }
  13980. sar_specs->sub_specs[index].power =
  13981. nla_get_s32(spec[NL80211_SAR_ATTR_SPECS_POWER]);
  13982. sar_specs->sub_specs[index].freq_range_index = range_index;
  13983. return 0;
  13984. }
  13985. static int nl80211_set_sar_specs(struct sk_buff *skb, struct genl_info *info)
  13986. {
  13987. struct cfg80211_registered_device *rdev = info->user_ptr[0];
  13988. struct nlattr *spec[NL80211_SAR_ATTR_SPECS_MAX + 1];
  13989. struct nlattr *tb[NL80211_SAR_ATTR_MAX + 1];
  13990. struct cfg80211_sar_specs *sar_spec;
  13991. enum nl80211_sar_type type;
  13992. struct nlattr *spec_list;
  13993. u32 specs;
  13994. int rem, err;
  13995. if (!rdev->wiphy.sar_capa || !rdev->ops->set_sar_specs)
  13996. return -EOPNOTSUPP;
  13997. if (!info->attrs[NL80211_ATTR_SAR_SPEC])
  13998. return -EINVAL;
  13999. nla_parse_nested(tb, NL80211_SAR_ATTR_MAX,
  14000. info->attrs[NL80211_ATTR_SAR_SPEC],
  14001. NULL, NULL);
  14002. if (!tb[NL80211_SAR_ATTR_TYPE] || !tb[NL80211_SAR_ATTR_SPECS])
  14003. return -EINVAL;
  14004. type = nla_get_u32(tb[NL80211_SAR_ATTR_TYPE]);
  14005. if (type != rdev->wiphy.sar_capa->type)
  14006. return -EINVAL;
  14007. specs = 0;
  14008. nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem)
  14009. specs++;
  14010. if (specs > rdev->wiphy.sar_capa->num_freq_ranges)
  14011. return -EINVAL;
  14012. sar_spec = kzalloc(struct_size(sar_spec, sub_specs, specs), GFP_KERNEL);
  14013. if (!sar_spec)
  14014. return -ENOMEM;
  14015. sar_spec->num_sub_specs = specs;
  14016. sar_spec->type = type;
  14017. specs = 0;
  14018. nla_for_each_nested(spec_list, tb[NL80211_SAR_ATTR_SPECS], rem) {
  14019. nla_parse_nested(spec, NL80211_SAR_ATTR_SPECS_MAX,
  14020. spec_list, NULL, NULL);
  14021. switch (type) {
  14022. case NL80211_SAR_TYPE_POWER:
  14023. if (nl80211_set_sar_sub_specs(rdev, sar_spec,
  14024. spec, specs)) {
  14025. err = -EINVAL;
  14026. goto error;
  14027. }
  14028. break;
  14029. default:
  14030. err = -EINVAL;
  14031. goto error;
  14032. }
  14033. specs++;
  14034. }
  14035. sar_spec->num_sub_specs = specs;
  14036. rdev->cur_cmd_info = info;
  14037. err = rdev_set_sar_specs(rdev, sar_spec);
  14038. rdev->cur_cmd_info = NULL;
  14039. error:
  14040. kfree(sar_spec);
  14041. return err;
  14042. }
  14043. #define SELECTOR(__sel, name, value) \
  14044. ((__sel) == (value)) ? NL80211_IFL_SEL_##name :
  14045. int __missing_selector(void);
  14046. #define IFLAGS(__val) INTERNAL_FLAG_SELECTORS(__val) __missing_selector()
  14047. static const struct genl_ops nl80211_ops[] = {
  14048. {
  14049. .cmd = NL80211_CMD_GET_WIPHY,
  14050. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14051. .doit = nl80211_get_wiphy,
  14052. .dumpit = nl80211_dump_wiphy,
  14053. .done = nl80211_dump_wiphy_done,
  14054. /* can be retrieved by unprivileged users */
  14055. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14056. },
  14057. };
  14058. static const struct genl_small_ops nl80211_small_ops[] = {
  14059. {
  14060. .cmd = NL80211_CMD_SET_WIPHY,
  14061. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14062. .doit = nl80211_set_wiphy,
  14063. .flags = GENL_UNS_ADMIN_PERM,
  14064. },
  14065. {
  14066. .cmd = NL80211_CMD_GET_INTERFACE,
  14067. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14068. .doit = nl80211_get_interface,
  14069. .dumpit = nl80211_dump_interface,
  14070. /* can be retrieved by unprivileged users */
  14071. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV),
  14072. },
  14073. {
  14074. .cmd = NL80211_CMD_SET_INTERFACE,
  14075. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14076. .doit = nl80211_set_interface,
  14077. .flags = GENL_UNS_ADMIN_PERM,
  14078. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14079. NL80211_FLAG_NEED_RTNL),
  14080. },
  14081. {
  14082. .cmd = NL80211_CMD_NEW_INTERFACE,
  14083. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14084. .doit = nl80211_new_interface,
  14085. .flags = GENL_UNS_ADMIN_PERM,
  14086. .internal_flags =
  14087. IFLAGS(NL80211_FLAG_NEED_WIPHY |
  14088. NL80211_FLAG_NEED_RTNL |
  14089. /* we take the wiphy mutex later ourselves */
  14090. NL80211_FLAG_NO_WIPHY_MTX),
  14091. },
  14092. {
  14093. .cmd = NL80211_CMD_DEL_INTERFACE,
  14094. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14095. .doit = nl80211_del_interface,
  14096. .flags = GENL_UNS_ADMIN_PERM,
  14097. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
  14098. NL80211_FLAG_NEED_RTNL),
  14099. },
  14100. {
  14101. .cmd = NL80211_CMD_GET_KEY,
  14102. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14103. .doit = nl80211_get_key,
  14104. .flags = GENL_UNS_ADMIN_PERM,
  14105. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14106. },
  14107. {
  14108. .cmd = NL80211_CMD_SET_KEY,
  14109. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14110. .doit = nl80211_set_key,
  14111. .flags = GENL_UNS_ADMIN_PERM,
  14112. /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on key */
  14113. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14114. NL80211_FLAG_CLEAR_SKB),
  14115. },
  14116. {
  14117. .cmd = NL80211_CMD_NEW_KEY,
  14118. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14119. .doit = nl80211_new_key,
  14120. .flags = GENL_UNS_ADMIN_PERM,
  14121. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14122. NL80211_FLAG_CLEAR_SKB),
  14123. },
  14124. {
  14125. .cmd = NL80211_CMD_DEL_KEY,
  14126. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14127. .doit = nl80211_del_key,
  14128. .flags = GENL_UNS_ADMIN_PERM,
  14129. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14130. },
  14131. {
  14132. .cmd = NL80211_CMD_SET_BEACON,
  14133. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14134. .flags = GENL_UNS_ADMIN_PERM,
  14135. .doit = nl80211_set_beacon,
  14136. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14137. NL80211_FLAG_MLO_VALID_LINK_ID),
  14138. },
  14139. {
  14140. .cmd = NL80211_CMD_START_AP,
  14141. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14142. .flags = GENL_UNS_ADMIN_PERM,
  14143. .doit = nl80211_start_ap,
  14144. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14145. NL80211_FLAG_MLO_VALID_LINK_ID),
  14146. },
  14147. {
  14148. .cmd = NL80211_CMD_STOP_AP,
  14149. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14150. .flags = GENL_UNS_ADMIN_PERM,
  14151. .doit = nl80211_stop_ap,
  14152. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14153. NL80211_FLAG_MLO_VALID_LINK_ID),
  14154. },
  14155. {
  14156. .cmd = NL80211_CMD_GET_STATION,
  14157. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14158. .doit = nl80211_get_station,
  14159. .dumpit = nl80211_dump_station,
  14160. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14161. },
  14162. {
  14163. .cmd = NL80211_CMD_SET_STATION,
  14164. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14165. .doit = nl80211_set_station,
  14166. .flags = GENL_UNS_ADMIN_PERM,
  14167. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14168. },
  14169. {
  14170. .cmd = NL80211_CMD_NEW_STATION,
  14171. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14172. .doit = nl80211_new_station,
  14173. .flags = GENL_UNS_ADMIN_PERM,
  14174. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14175. },
  14176. {
  14177. .cmd = NL80211_CMD_DEL_STATION,
  14178. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14179. .doit = nl80211_del_station,
  14180. .flags = GENL_UNS_ADMIN_PERM,
  14181. /* cannot use NL80211_FLAG_MLO_VALID_LINK_ID, depends on
  14182. * whether MAC address is passed or not. If MAC address is
  14183. * passed, then even during MLO, link ID is not required.
  14184. */
  14185. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14186. },
  14187. {
  14188. .cmd = NL80211_CMD_GET_MPATH,
  14189. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14190. .doit = nl80211_get_mpath,
  14191. .dumpit = nl80211_dump_mpath,
  14192. .flags = GENL_UNS_ADMIN_PERM,
  14193. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14194. },
  14195. {
  14196. .cmd = NL80211_CMD_GET_MPP,
  14197. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14198. .doit = nl80211_get_mpp,
  14199. .dumpit = nl80211_dump_mpp,
  14200. .flags = GENL_UNS_ADMIN_PERM,
  14201. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14202. },
  14203. {
  14204. .cmd = NL80211_CMD_SET_MPATH,
  14205. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14206. .doit = nl80211_set_mpath,
  14207. .flags = GENL_UNS_ADMIN_PERM,
  14208. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14209. },
  14210. {
  14211. .cmd = NL80211_CMD_NEW_MPATH,
  14212. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14213. .doit = nl80211_new_mpath,
  14214. .flags = GENL_UNS_ADMIN_PERM,
  14215. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14216. },
  14217. {
  14218. .cmd = NL80211_CMD_DEL_MPATH,
  14219. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14220. .doit = nl80211_del_mpath,
  14221. .flags = GENL_UNS_ADMIN_PERM,
  14222. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14223. },
  14224. {
  14225. .cmd = NL80211_CMD_SET_BSS,
  14226. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14227. .doit = nl80211_set_bss,
  14228. .flags = GENL_UNS_ADMIN_PERM,
  14229. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14230. NL80211_FLAG_MLO_VALID_LINK_ID),
  14231. },
  14232. {
  14233. .cmd = NL80211_CMD_GET_REG,
  14234. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14235. .doit = nl80211_get_reg_do,
  14236. .dumpit = nl80211_get_reg_dump,
  14237. /* can be retrieved by unprivileged users */
  14238. },
  14239. #ifdef CONFIG_CFG80211_CRDA_SUPPORT
  14240. {
  14241. .cmd = NL80211_CMD_SET_REG,
  14242. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14243. .doit = nl80211_set_reg,
  14244. .flags = GENL_ADMIN_PERM,
  14245. },
  14246. #endif
  14247. {
  14248. .cmd = NL80211_CMD_REQ_SET_REG,
  14249. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14250. .doit = nl80211_req_set_reg,
  14251. .flags = GENL_ADMIN_PERM,
  14252. },
  14253. {
  14254. .cmd = NL80211_CMD_RELOAD_REGDB,
  14255. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14256. .doit = nl80211_reload_regdb,
  14257. .flags = GENL_ADMIN_PERM,
  14258. },
  14259. {
  14260. .cmd = NL80211_CMD_GET_MESH_CONFIG,
  14261. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14262. .doit = nl80211_get_mesh_config,
  14263. /* can be retrieved by unprivileged users */
  14264. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14265. },
  14266. {
  14267. .cmd = NL80211_CMD_SET_MESH_CONFIG,
  14268. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14269. .doit = nl80211_update_mesh_config,
  14270. .flags = GENL_UNS_ADMIN_PERM,
  14271. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14272. },
  14273. {
  14274. .cmd = NL80211_CMD_TRIGGER_SCAN,
  14275. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14276. .doit = nl80211_trigger_scan,
  14277. .flags = GENL_UNS_ADMIN_PERM,
  14278. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14279. },
  14280. {
  14281. .cmd = NL80211_CMD_ABORT_SCAN,
  14282. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14283. .doit = nl80211_abort_scan,
  14284. .flags = GENL_UNS_ADMIN_PERM,
  14285. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14286. },
  14287. {
  14288. .cmd = NL80211_CMD_GET_SCAN,
  14289. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14290. .dumpit = nl80211_dump_scan,
  14291. },
  14292. {
  14293. .cmd = NL80211_CMD_START_SCHED_SCAN,
  14294. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14295. .doit = nl80211_start_sched_scan,
  14296. .flags = GENL_UNS_ADMIN_PERM,
  14297. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14298. },
  14299. {
  14300. .cmd = NL80211_CMD_STOP_SCHED_SCAN,
  14301. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14302. .doit = nl80211_stop_sched_scan,
  14303. .flags = GENL_UNS_ADMIN_PERM,
  14304. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14305. },
  14306. {
  14307. .cmd = NL80211_CMD_AUTHENTICATE,
  14308. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14309. .doit = nl80211_authenticate,
  14310. .flags = GENL_UNS_ADMIN_PERM,
  14311. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14312. NL80211_FLAG_CLEAR_SKB),
  14313. },
  14314. {
  14315. .cmd = NL80211_CMD_ASSOCIATE,
  14316. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14317. .doit = nl80211_associate,
  14318. .flags = GENL_UNS_ADMIN_PERM,
  14319. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14320. NL80211_FLAG_CLEAR_SKB),
  14321. },
  14322. {
  14323. .cmd = NL80211_CMD_DEAUTHENTICATE,
  14324. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14325. .doit = nl80211_deauthenticate,
  14326. .flags = GENL_UNS_ADMIN_PERM,
  14327. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14328. },
  14329. {
  14330. .cmd = NL80211_CMD_DISASSOCIATE,
  14331. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14332. .doit = nl80211_disassociate,
  14333. .flags = GENL_UNS_ADMIN_PERM,
  14334. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14335. },
  14336. {
  14337. .cmd = NL80211_CMD_JOIN_IBSS,
  14338. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14339. .doit = nl80211_join_ibss,
  14340. .flags = GENL_UNS_ADMIN_PERM,
  14341. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14342. },
  14343. {
  14344. .cmd = NL80211_CMD_LEAVE_IBSS,
  14345. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14346. .doit = nl80211_leave_ibss,
  14347. .flags = GENL_UNS_ADMIN_PERM,
  14348. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14349. },
  14350. #ifdef CONFIG_NL80211_TESTMODE
  14351. {
  14352. .cmd = NL80211_CMD_TESTMODE,
  14353. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14354. .doit = nl80211_testmode_do,
  14355. .dumpit = nl80211_testmode_dump,
  14356. .flags = GENL_UNS_ADMIN_PERM,
  14357. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14358. },
  14359. #endif
  14360. {
  14361. .cmd = NL80211_CMD_CONNECT,
  14362. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14363. .doit = nl80211_connect,
  14364. .flags = GENL_UNS_ADMIN_PERM,
  14365. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14366. NL80211_FLAG_CLEAR_SKB),
  14367. },
  14368. {
  14369. .cmd = NL80211_CMD_UPDATE_CONNECT_PARAMS,
  14370. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14371. .doit = nl80211_update_connect_params,
  14372. .flags = GENL_ADMIN_PERM,
  14373. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14374. NL80211_FLAG_CLEAR_SKB),
  14375. },
  14376. {
  14377. .cmd = NL80211_CMD_DISCONNECT,
  14378. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14379. .doit = nl80211_disconnect,
  14380. .flags = GENL_UNS_ADMIN_PERM,
  14381. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14382. },
  14383. {
  14384. .cmd = NL80211_CMD_SET_WIPHY_NETNS,
  14385. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14386. .doit = nl80211_wiphy_netns,
  14387. .flags = GENL_UNS_ADMIN_PERM,
  14388. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
  14389. NL80211_FLAG_NEED_RTNL |
  14390. NL80211_FLAG_NO_WIPHY_MTX),
  14391. },
  14392. {
  14393. .cmd = NL80211_CMD_GET_SURVEY,
  14394. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14395. .dumpit = nl80211_dump_survey,
  14396. },
  14397. {
  14398. .cmd = NL80211_CMD_SET_PMKSA,
  14399. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14400. .doit = nl80211_set_pmksa,
  14401. .flags = GENL_UNS_ADMIN_PERM,
  14402. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14403. NL80211_FLAG_CLEAR_SKB),
  14404. },
  14405. {
  14406. .cmd = NL80211_CMD_DEL_PMKSA,
  14407. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14408. .doit = nl80211_del_pmksa,
  14409. .flags = GENL_UNS_ADMIN_PERM,
  14410. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14411. },
  14412. {
  14413. .cmd = NL80211_CMD_FLUSH_PMKSA,
  14414. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14415. .doit = nl80211_flush_pmksa,
  14416. .flags = GENL_UNS_ADMIN_PERM,
  14417. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14418. },
  14419. {
  14420. .cmd = NL80211_CMD_REMAIN_ON_CHANNEL,
  14421. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14422. .doit = nl80211_remain_on_channel,
  14423. .flags = GENL_UNS_ADMIN_PERM,
  14424. /* FIXME: requiring a link ID here is probably not good */
  14425. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
  14426. NL80211_FLAG_MLO_VALID_LINK_ID),
  14427. },
  14428. {
  14429. .cmd = NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  14430. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14431. .doit = nl80211_cancel_remain_on_channel,
  14432. .flags = GENL_UNS_ADMIN_PERM,
  14433. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14434. },
  14435. {
  14436. .cmd = NL80211_CMD_SET_TX_BITRATE_MASK,
  14437. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14438. .doit = nl80211_set_tx_bitrate_mask,
  14439. .flags = GENL_UNS_ADMIN_PERM,
  14440. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14441. NL80211_FLAG_MLO_VALID_LINK_ID),
  14442. },
  14443. {
  14444. .cmd = NL80211_CMD_REGISTER_FRAME,
  14445. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14446. .doit = nl80211_register_mgmt,
  14447. .flags = GENL_UNS_ADMIN_PERM,
  14448. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV),
  14449. },
  14450. {
  14451. .cmd = NL80211_CMD_FRAME,
  14452. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14453. .doit = nl80211_tx_mgmt,
  14454. .flags = GENL_UNS_ADMIN_PERM,
  14455. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14456. },
  14457. {
  14458. .cmd = NL80211_CMD_FRAME_WAIT_CANCEL,
  14459. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14460. .doit = nl80211_tx_mgmt_cancel_wait,
  14461. .flags = GENL_UNS_ADMIN_PERM,
  14462. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14463. },
  14464. {
  14465. .cmd = NL80211_CMD_SET_POWER_SAVE,
  14466. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14467. .doit = nl80211_set_power_save,
  14468. .flags = GENL_UNS_ADMIN_PERM,
  14469. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14470. },
  14471. {
  14472. .cmd = NL80211_CMD_GET_POWER_SAVE,
  14473. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14474. .doit = nl80211_get_power_save,
  14475. /* can be retrieved by unprivileged users */
  14476. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14477. },
  14478. {
  14479. .cmd = NL80211_CMD_SET_CQM,
  14480. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14481. .doit = nl80211_set_cqm,
  14482. .flags = GENL_UNS_ADMIN_PERM,
  14483. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14484. },
  14485. {
  14486. .cmd = NL80211_CMD_SET_CHANNEL,
  14487. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14488. .doit = nl80211_set_channel,
  14489. .flags = GENL_UNS_ADMIN_PERM,
  14490. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14491. NL80211_FLAG_MLO_VALID_LINK_ID),
  14492. },
  14493. {
  14494. .cmd = NL80211_CMD_JOIN_MESH,
  14495. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14496. .doit = nl80211_join_mesh,
  14497. .flags = GENL_UNS_ADMIN_PERM,
  14498. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14499. },
  14500. {
  14501. .cmd = NL80211_CMD_LEAVE_MESH,
  14502. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14503. .doit = nl80211_leave_mesh,
  14504. .flags = GENL_UNS_ADMIN_PERM,
  14505. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14506. },
  14507. {
  14508. .cmd = NL80211_CMD_JOIN_OCB,
  14509. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14510. .doit = nl80211_join_ocb,
  14511. .flags = GENL_UNS_ADMIN_PERM,
  14512. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14513. },
  14514. {
  14515. .cmd = NL80211_CMD_LEAVE_OCB,
  14516. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14517. .doit = nl80211_leave_ocb,
  14518. .flags = GENL_UNS_ADMIN_PERM,
  14519. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14520. },
  14521. #ifdef CONFIG_PM
  14522. {
  14523. .cmd = NL80211_CMD_GET_WOWLAN,
  14524. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14525. .doit = nl80211_get_wowlan,
  14526. /* can be retrieved by unprivileged users */
  14527. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14528. },
  14529. {
  14530. .cmd = NL80211_CMD_SET_WOWLAN,
  14531. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14532. .doit = nl80211_set_wowlan,
  14533. .flags = GENL_UNS_ADMIN_PERM,
  14534. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14535. },
  14536. #endif
  14537. {
  14538. .cmd = NL80211_CMD_SET_REKEY_OFFLOAD,
  14539. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14540. .doit = nl80211_set_rekey_data,
  14541. .flags = GENL_UNS_ADMIN_PERM,
  14542. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14543. NL80211_FLAG_CLEAR_SKB),
  14544. },
  14545. {
  14546. .cmd = NL80211_CMD_TDLS_MGMT,
  14547. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14548. .doit = nl80211_tdls_mgmt,
  14549. .flags = GENL_UNS_ADMIN_PERM,
  14550. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14551. NL80211_FLAG_MLO_VALID_LINK_ID),
  14552. },
  14553. {
  14554. .cmd = NL80211_CMD_TDLS_OPER,
  14555. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14556. .doit = nl80211_tdls_oper,
  14557. .flags = GENL_UNS_ADMIN_PERM,
  14558. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14559. },
  14560. {
  14561. .cmd = NL80211_CMD_UNEXPECTED_FRAME,
  14562. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14563. .doit = nl80211_register_unexpected_frame,
  14564. .flags = GENL_UNS_ADMIN_PERM,
  14565. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14566. },
  14567. {
  14568. .cmd = NL80211_CMD_PROBE_CLIENT,
  14569. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14570. .doit = nl80211_probe_client,
  14571. .flags = GENL_UNS_ADMIN_PERM,
  14572. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14573. },
  14574. {
  14575. .cmd = NL80211_CMD_REGISTER_BEACONS,
  14576. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14577. .doit = nl80211_register_beacons,
  14578. .flags = GENL_UNS_ADMIN_PERM,
  14579. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14580. },
  14581. {
  14582. .cmd = NL80211_CMD_SET_NOACK_MAP,
  14583. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14584. .doit = nl80211_set_noack_map,
  14585. .flags = GENL_UNS_ADMIN_PERM,
  14586. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14587. },
  14588. {
  14589. .cmd = NL80211_CMD_START_P2P_DEVICE,
  14590. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14591. .doit = nl80211_start_p2p_device,
  14592. .flags = GENL_UNS_ADMIN_PERM,
  14593. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
  14594. NL80211_FLAG_NEED_RTNL),
  14595. },
  14596. {
  14597. .cmd = NL80211_CMD_STOP_P2P_DEVICE,
  14598. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14599. .doit = nl80211_stop_p2p_device,
  14600. .flags = GENL_UNS_ADMIN_PERM,
  14601. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
  14602. NL80211_FLAG_NEED_RTNL),
  14603. },
  14604. {
  14605. .cmd = NL80211_CMD_START_NAN,
  14606. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14607. .doit = nl80211_start_nan,
  14608. .flags = GENL_ADMIN_PERM,
  14609. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV |
  14610. NL80211_FLAG_NEED_RTNL),
  14611. },
  14612. {
  14613. .cmd = NL80211_CMD_STOP_NAN,
  14614. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14615. .doit = nl80211_stop_nan,
  14616. .flags = GENL_ADMIN_PERM,
  14617. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP |
  14618. NL80211_FLAG_NEED_RTNL),
  14619. },
  14620. {
  14621. .cmd = NL80211_CMD_ADD_NAN_FUNCTION,
  14622. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14623. .doit = nl80211_nan_add_func,
  14624. .flags = GENL_ADMIN_PERM,
  14625. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14626. },
  14627. {
  14628. .cmd = NL80211_CMD_DEL_NAN_FUNCTION,
  14629. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14630. .doit = nl80211_nan_del_func,
  14631. .flags = GENL_ADMIN_PERM,
  14632. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14633. },
  14634. {
  14635. .cmd = NL80211_CMD_CHANGE_NAN_CONFIG,
  14636. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14637. .doit = nl80211_nan_change_config,
  14638. .flags = GENL_ADMIN_PERM,
  14639. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14640. },
  14641. {
  14642. .cmd = NL80211_CMD_SET_MCAST_RATE,
  14643. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14644. .doit = nl80211_set_mcast_rate,
  14645. .flags = GENL_UNS_ADMIN_PERM,
  14646. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14647. },
  14648. {
  14649. .cmd = NL80211_CMD_SET_MAC_ACL,
  14650. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14651. .doit = nl80211_set_mac_acl,
  14652. .flags = GENL_UNS_ADMIN_PERM,
  14653. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14654. NL80211_FLAG_MLO_UNSUPPORTED),
  14655. },
  14656. {
  14657. .cmd = NL80211_CMD_RADAR_DETECT,
  14658. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14659. .doit = nl80211_start_radar_detection,
  14660. .flags = GENL_UNS_ADMIN_PERM,
  14661. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14662. NL80211_FLAG_NO_WIPHY_MTX |
  14663. NL80211_FLAG_MLO_VALID_LINK_ID),
  14664. },
  14665. {
  14666. .cmd = NL80211_CMD_GET_PROTOCOL_FEATURES,
  14667. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14668. .doit = nl80211_get_protocol_features,
  14669. },
  14670. {
  14671. .cmd = NL80211_CMD_UPDATE_FT_IES,
  14672. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14673. .doit = nl80211_update_ft_ies,
  14674. .flags = GENL_UNS_ADMIN_PERM,
  14675. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14676. },
  14677. {
  14678. .cmd = NL80211_CMD_CRIT_PROTOCOL_START,
  14679. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14680. .doit = nl80211_crit_protocol_start,
  14681. .flags = GENL_UNS_ADMIN_PERM,
  14682. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14683. },
  14684. {
  14685. .cmd = NL80211_CMD_CRIT_PROTOCOL_STOP,
  14686. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14687. .doit = nl80211_crit_protocol_stop,
  14688. .flags = GENL_UNS_ADMIN_PERM,
  14689. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14690. },
  14691. {
  14692. .cmd = NL80211_CMD_GET_COALESCE,
  14693. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14694. .doit = nl80211_get_coalesce,
  14695. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14696. },
  14697. {
  14698. .cmd = NL80211_CMD_SET_COALESCE,
  14699. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14700. .doit = nl80211_set_coalesce,
  14701. .flags = GENL_UNS_ADMIN_PERM,
  14702. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY),
  14703. },
  14704. {
  14705. .cmd = NL80211_CMD_CHANNEL_SWITCH,
  14706. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14707. .doit = nl80211_channel_switch,
  14708. .flags = GENL_UNS_ADMIN_PERM,
  14709. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14710. NL80211_FLAG_MLO_VALID_LINK_ID),
  14711. },
  14712. {
  14713. .cmd = NL80211_CMD_VENDOR,
  14714. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14715. .doit = nl80211_vendor_cmd,
  14716. .dumpit = nl80211_vendor_cmd_dump,
  14717. .flags = GENL_UNS_ADMIN_PERM,
  14718. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
  14719. NL80211_FLAG_CLEAR_SKB),
  14720. },
  14721. {
  14722. .cmd = NL80211_CMD_SET_QOS_MAP,
  14723. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14724. .doit = nl80211_set_qos_map,
  14725. .flags = GENL_UNS_ADMIN_PERM,
  14726. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14727. },
  14728. {
  14729. .cmd = NL80211_CMD_ADD_TX_TS,
  14730. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14731. .doit = nl80211_add_tx_ts,
  14732. .flags = GENL_UNS_ADMIN_PERM,
  14733. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14734. NL80211_FLAG_MLO_UNSUPPORTED),
  14735. },
  14736. {
  14737. .cmd = NL80211_CMD_DEL_TX_TS,
  14738. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14739. .doit = nl80211_del_tx_ts,
  14740. .flags = GENL_UNS_ADMIN_PERM,
  14741. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14742. },
  14743. {
  14744. .cmd = NL80211_CMD_TDLS_CHANNEL_SWITCH,
  14745. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14746. .doit = nl80211_tdls_channel_switch,
  14747. .flags = GENL_UNS_ADMIN_PERM,
  14748. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14749. },
  14750. {
  14751. .cmd = NL80211_CMD_TDLS_CANCEL_CHANNEL_SWITCH,
  14752. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14753. .doit = nl80211_tdls_cancel_channel_switch,
  14754. .flags = GENL_UNS_ADMIN_PERM,
  14755. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14756. },
  14757. {
  14758. .cmd = NL80211_CMD_SET_MULTICAST_TO_UNICAST,
  14759. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14760. .doit = nl80211_set_multicast_to_unicast,
  14761. .flags = GENL_UNS_ADMIN_PERM,
  14762. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV),
  14763. },
  14764. {
  14765. .cmd = NL80211_CMD_SET_PMK,
  14766. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14767. .doit = nl80211_set_pmk,
  14768. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14769. NL80211_FLAG_CLEAR_SKB),
  14770. },
  14771. {
  14772. .cmd = NL80211_CMD_DEL_PMK,
  14773. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14774. .doit = nl80211_del_pmk,
  14775. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14776. },
  14777. {
  14778. .cmd = NL80211_CMD_EXTERNAL_AUTH,
  14779. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14780. .doit = nl80211_external_auth,
  14781. .flags = GENL_ADMIN_PERM,
  14782. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14783. },
  14784. {
  14785. .cmd = NL80211_CMD_CONTROL_PORT_FRAME,
  14786. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14787. .doit = nl80211_tx_control_port,
  14788. .flags = GENL_UNS_ADMIN_PERM,
  14789. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14790. },
  14791. {
  14792. .cmd = NL80211_CMD_GET_FTM_RESPONDER_STATS,
  14793. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14794. .doit = nl80211_get_ftm_responder_stats,
  14795. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14796. NL80211_FLAG_MLO_VALID_LINK_ID),
  14797. },
  14798. {
  14799. .cmd = NL80211_CMD_PEER_MEASUREMENT_START,
  14800. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14801. .doit = nl80211_pmsr_start,
  14802. .flags = GENL_UNS_ADMIN_PERM,
  14803. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WDEV_UP),
  14804. },
  14805. {
  14806. .cmd = NL80211_CMD_NOTIFY_RADAR,
  14807. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14808. .doit = nl80211_notify_radar_detection,
  14809. .flags = GENL_UNS_ADMIN_PERM,
  14810. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14811. },
  14812. {
  14813. .cmd = NL80211_CMD_UPDATE_OWE_INFO,
  14814. .doit = nl80211_update_owe_info,
  14815. .flags = GENL_ADMIN_PERM,
  14816. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14817. },
  14818. {
  14819. .cmd = NL80211_CMD_PROBE_MESH_LINK,
  14820. .doit = nl80211_probe_mesh_link,
  14821. .flags = GENL_UNS_ADMIN_PERM,
  14822. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14823. },
  14824. {
  14825. .cmd = NL80211_CMD_SET_TID_CONFIG,
  14826. .doit = nl80211_set_tid_config,
  14827. .flags = GENL_UNS_ADMIN_PERM,
  14828. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV |
  14829. NL80211_FLAG_MLO_VALID_LINK_ID),
  14830. },
  14831. {
  14832. .cmd = NL80211_CMD_SET_SAR_SPECS,
  14833. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14834. .doit = nl80211_set_sar_specs,
  14835. .flags = GENL_UNS_ADMIN_PERM,
  14836. .internal_flags = IFLAGS(NL80211_FLAG_NEED_WIPHY |
  14837. NL80211_FLAG_NEED_RTNL),
  14838. },
  14839. {
  14840. .cmd = NL80211_CMD_COLOR_CHANGE_REQUEST,
  14841. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14842. .doit = nl80211_color_change,
  14843. .flags = GENL_UNS_ADMIN_PERM,
  14844. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14845. NL80211_FLAG_MLO_VALID_LINK_ID),
  14846. },
  14847. {
  14848. .cmd = NL80211_CMD_SET_FILS_AAD,
  14849. .validate = GENL_DONT_VALIDATE_STRICT | GENL_DONT_VALIDATE_DUMP,
  14850. .doit = nl80211_set_fils_aad,
  14851. .flags = GENL_UNS_ADMIN_PERM,
  14852. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14853. },
  14854. {
  14855. .cmd = NL80211_CMD_ADD_LINK,
  14856. .doit = nl80211_add_link,
  14857. .flags = GENL_UNS_ADMIN_PERM,
  14858. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14859. },
  14860. {
  14861. .cmd = NL80211_CMD_REMOVE_LINK,
  14862. .doit = nl80211_remove_link,
  14863. .flags = GENL_UNS_ADMIN_PERM,
  14864. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14865. NL80211_FLAG_MLO_VALID_LINK_ID),
  14866. },
  14867. {
  14868. .cmd = NL80211_CMD_ADD_LINK_STA,
  14869. .doit = nl80211_add_link_station,
  14870. .flags = GENL_UNS_ADMIN_PERM,
  14871. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14872. NL80211_FLAG_MLO_VALID_LINK_ID),
  14873. },
  14874. {
  14875. .cmd = NL80211_CMD_MODIFY_LINK_STA,
  14876. .doit = nl80211_modify_link_station,
  14877. .flags = GENL_UNS_ADMIN_PERM,
  14878. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14879. NL80211_FLAG_MLO_VALID_LINK_ID),
  14880. },
  14881. {
  14882. .cmd = NL80211_CMD_REMOVE_LINK_STA,
  14883. .doit = nl80211_remove_link_station,
  14884. .flags = GENL_UNS_ADMIN_PERM,
  14885. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP |
  14886. NL80211_FLAG_MLO_VALID_LINK_ID),
  14887. },
  14888. {
  14889. .cmd = NL80211_CMD_SET_HW_TIMESTAMP,
  14890. .doit = nl80211_set_hw_timestamp,
  14891. .flags = GENL_UNS_ADMIN_PERM,
  14892. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14893. },
  14894. {
  14895. .cmd = NL80211_CMD_SET_TID_TO_LINK_MAPPING,
  14896. .doit = nl80211_set_ttlm,
  14897. .flags = GENL_UNS_ADMIN_PERM,
  14898. .internal_flags = IFLAGS(NL80211_FLAG_NEED_NETDEV_UP),
  14899. },
  14900. };
  14901. static struct genl_family nl80211_fam __ro_after_init = {
  14902. .name = NL80211_GENL_NAME, /* have users key off the name instead */
  14903. .hdrsize = 0, /* no private header */
  14904. .version = 1, /* no particular meaning now */
  14905. .maxattr = NL80211_ATTR_MAX,
  14906. .policy = nl80211_policy,
  14907. .netnsok = true,
  14908. .pre_doit = nl80211_pre_doit,
  14909. .post_doit = nl80211_post_doit,
  14910. .module = THIS_MODULE,
  14911. .ops = nl80211_ops,
  14912. .n_ops = ARRAY_SIZE(nl80211_ops),
  14913. .small_ops = nl80211_small_ops,
  14914. .n_small_ops = ARRAY_SIZE(nl80211_small_ops),
  14915. .resv_start_op = NL80211_CMD_REMOVE_LINK_STA + 1,
  14916. .mcgrps = nl80211_mcgrps,
  14917. .n_mcgrps = ARRAY_SIZE(nl80211_mcgrps),
  14918. .parallel_ops = true,
  14919. };
  14920. /* notification functions */
  14921. void nl80211_notify_wiphy(struct cfg80211_registered_device *rdev,
  14922. enum nl80211_commands cmd)
  14923. {
  14924. struct sk_buff *msg;
  14925. struct nl80211_dump_wiphy_state state = {};
  14926. WARN_ON(cmd != NL80211_CMD_NEW_WIPHY &&
  14927. cmd != NL80211_CMD_DEL_WIPHY);
  14928. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  14929. if (!msg)
  14930. return;
  14931. if (nl80211_send_wiphy(rdev, cmd, msg, 0, 0, 0, &state) < 0) {
  14932. nlmsg_free(msg);
  14933. return;
  14934. }
  14935. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  14936. NL80211_MCGRP_CONFIG, GFP_KERNEL);
  14937. }
  14938. void nl80211_notify_iface(struct cfg80211_registered_device *rdev,
  14939. struct wireless_dev *wdev,
  14940. enum nl80211_commands cmd)
  14941. {
  14942. struct sk_buff *msg;
  14943. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  14944. if (!msg)
  14945. return;
  14946. if (nl80211_send_iface(msg, 0, 0, 0, rdev, wdev, cmd) < 0) {
  14947. nlmsg_free(msg);
  14948. return;
  14949. }
  14950. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  14951. NL80211_MCGRP_CONFIG, GFP_KERNEL);
  14952. }
  14953. static int nl80211_add_scan_req(struct sk_buff *msg,
  14954. struct cfg80211_registered_device *rdev)
  14955. {
  14956. struct cfg80211_scan_request *req = rdev->scan_req;
  14957. struct nlattr *nest;
  14958. int i;
  14959. struct cfg80211_scan_info *info;
  14960. if (WARN_ON(!req))
  14961. return 0;
  14962. nest = nla_nest_start_noflag(msg, NL80211_ATTR_SCAN_SSIDS);
  14963. if (!nest)
  14964. goto nla_put_failure;
  14965. for (i = 0; i < req->n_ssids; i++) {
  14966. if (nla_put(msg, i, req->ssids[i].ssid_len, req->ssids[i].ssid))
  14967. goto nla_put_failure;
  14968. }
  14969. nla_nest_end(msg, nest);
  14970. if (req->flags & NL80211_SCAN_FLAG_FREQ_KHZ) {
  14971. nest = nla_nest_start(msg, NL80211_ATTR_SCAN_FREQ_KHZ);
  14972. if (!nest)
  14973. goto nla_put_failure;
  14974. for (i = 0; i < req->n_channels; i++) {
  14975. if (nla_put_u32(msg, i,
  14976. ieee80211_channel_to_khz(req->channels[i])))
  14977. goto nla_put_failure;
  14978. }
  14979. nla_nest_end(msg, nest);
  14980. } else {
  14981. nest = nla_nest_start_noflag(msg,
  14982. NL80211_ATTR_SCAN_FREQUENCIES);
  14983. if (!nest)
  14984. goto nla_put_failure;
  14985. for (i = 0; i < req->n_channels; i++) {
  14986. if (nla_put_u32(msg, i, req->channels[i]->center_freq))
  14987. goto nla_put_failure;
  14988. }
  14989. nla_nest_end(msg, nest);
  14990. }
  14991. if (req->ie &&
  14992. nla_put(msg, NL80211_ATTR_IE, req->ie_len, req->ie))
  14993. goto nla_put_failure;
  14994. if (req->flags &&
  14995. nla_put_u32(msg, NL80211_ATTR_SCAN_FLAGS, req->flags))
  14996. goto nla_put_failure;
  14997. info = rdev->int_scan_req ? &rdev->int_scan_req->info :
  14998. &rdev->scan_req->info;
  14999. if (info->scan_start_tsf &&
  15000. (nla_put_u64_64bit(msg, NL80211_ATTR_SCAN_START_TIME_TSF,
  15001. info->scan_start_tsf, NL80211_BSS_PAD) ||
  15002. nla_put(msg, NL80211_ATTR_SCAN_START_TIME_TSF_BSSID, ETH_ALEN,
  15003. info->tsf_bssid)))
  15004. goto nla_put_failure;
  15005. return 0;
  15006. nla_put_failure:
  15007. return -ENOBUFS;
  15008. }
  15009. static int nl80211_prep_scan_msg(struct sk_buff *msg,
  15010. struct cfg80211_registered_device *rdev,
  15011. struct wireless_dev *wdev,
  15012. u32 portid, u32 seq, int flags,
  15013. u32 cmd)
  15014. {
  15015. void *hdr;
  15016. hdr = nl80211hdr_put(msg, portid, seq, flags, cmd);
  15017. if (!hdr)
  15018. return -1;
  15019. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15020. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  15021. wdev->netdev->ifindex)) ||
  15022. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  15023. NL80211_ATTR_PAD))
  15024. goto nla_put_failure;
  15025. /* ignore errors and send incomplete event anyway */
  15026. nl80211_add_scan_req(msg, rdev);
  15027. genlmsg_end(msg, hdr);
  15028. return 0;
  15029. nla_put_failure:
  15030. genlmsg_cancel(msg, hdr);
  15031. return -EMSGSIZE;
  15032. }
  15033. static int
  15034. nl80211_prep_sched_scan_msg(struct sk_buff *msg,
  15035. struct cfg80211_sched_scan_request *req, u32 cmd)
  15036. {
  15037. void *hdr;
  15038. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  15039. if (!hdr)
  15040. return -1;
  15041. if (nla_put_u32(msg, NL80211_ATTR_WIPHY,
  15042. wiphy_to_rdev(req->wiphy)->wiphy_idx) ||
  15043. nla_put_u32(msg, NL80211_ATTR_IFINDEX, req->dev->ifindex) ||
  15044. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, req->reqid,
  15045. NL80211_ATTR_PAD))
  15046. goto nla_put_failure;
  15047. genlmsg_end(msg, hdr);
  15048. return 0;
  15049. nla_put_failure:
  15050. genlmsg_cancel(msg, hdr);
  15051. return -EMSGSIZE;
  15052. }
  15053. void nl80211_send_scan_start(struct cfg80211_registered_device *rdev,
  15054. struct wireless_dev *wdev)
  15055. {
  15056. struct sk_buff *msg;
  15057. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15058. if (!msg)
  15059. return;
  15060. if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
  15061. NL80211_CMD_TRIGGER_SCAN) < 0) {
  15062. nlmsg_free(msg);
  15063. return;
  15064. }
  15065. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15066. NL80211_MCGRP_SCAN, GFP_KERNEL);
  15067. }
  15068. struct sk_buff *nl80211_build_scan_msg(struct cfg80211_registered_device *rdev,
  15069. struct wireless_dev *wdev, bool aborted)
  15070. {
  15071. struct sk_buff *msg;
  15072. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15073. if (!msg)
  15074. return NULL;
  15075. if (nl80211_prep_scan_msg(msg, rdev, wdev, 0, 0, 0,
  15076. aborted ? NL80211_CMD_SCAN_ABORTED :
  15077. NL80211_CMD_NEW_SCAN_RESULTS) < 0) {
  15078. nlmsg_free(msg);
  15079. return NULL;
  15080. }
  15081. return msg;
  15082. }
  15083. /* send message created by nl80211_build_scan_msg() */
  15084. void nl80211_send_scan_msg(struct cfg80211_registered_device *rdev,
  15085. struct sk_buff *msg)
  15086. {
  15087. if (!msg)
  15088. return;
  15089. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15090. NL80211_MCGRP_SCAN, GFP_KERNEL);
  15091. }
  15092. void nl80211_send_sched_scan(struct cfg80211_sched_scan_request *req, u32 cmd)
  15093. {
  15094. struct sk_buff *msg;
  15095. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15096. if (!msg)
  15097. return;
  15098. if (nl80211_prep_sched_scan_msg(msg, req, cmd) < 0) {
  15099. nlmsg_free(msg);
  15100. return;
  15101. }
  15102. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(req->wiphy), msg, 0,
  15103. NL80211_MCGRP_SCAN, GFP_KERNEL);
  15104. }
  15105. static bool nl80211_reg_change_event_fill(struct sk_buff *msg,
  15106. struct regulatory_request *request)
  15107. {
  15108. /* Userspace can always count this one always being set */
  15109. if (nla_put_u8(msg, NL80211_ATTR_REG_INITIATOR, request->initiator))
  15110. goto nla_put_failure;
  15111. if (request->alpha2[0] == '0' && request->alpha2[1] == '0') {
  15112. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  15113. NL80211_REGDOM_TYPE_WORLD))
  15114. goto nla_put_failure;
  15115. } else if (request->alpha2[0] == '9' && request->alpha2[1] == '9') {
  15116. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  15117. NL80211_REGDOM_TYPE_CUSTOM_WORLD))
  15118. goto nla_put_failure;
  15119. } else if ((request->alpha2[0] == '9' && request->alpha2[1] == '8') ||
  15120. request->intersect) {
  15121. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  15122. NL80211_REGDOM_TYPE_INTERSECTION))
  15123. goto nla_put_failure;
  15124. } else {
  15125. if (nla_put_u8(msg, NL80211_ATTR_REG_TYPE,
  15126. NL80211_REGDOM_TYPE_COUNTRY) ||
  15127. nla_put_string(msg, NL80211_ATTR_REG_ALPHA2,
  15128. request->alpha2))
  15129. goto nla_put_failure;
  15130. }
  15131. if (request->wiphy_idx != WIPHY_IDX_INVALID) {
  15132. struct wiphy *wiphy = wiphy_idx_to_wiphy(request->wiphy_idx);
  15133. if (wiphy &&
  15134. nla_put_u32(msg, NL80211_ATTR_WIPHY, request->wiphy_idx))
  15135. goto nla_put_failure;
  15136. if (wiphy &&
  15137. wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED &&
  15138. nla_put_flag(msg, NL80211_ATTR_WIPHY_SELF_MANAGED_REG))
  15139. goto nla_put_failure;
  15140. }
  15141. return true;
  15142. nla_put_failure:
  15143. return false;
  15144. }
  15145. /*
  15146. * This can happen on global regulatory changes or device specific settings
  15147. * based on custom regulatory domains.
  15148. */
  15149. void nl80211_common_reg_change_event(enum nl80211_commands cmd_id,
  15150. struct regulatory_request *request)
  15151. {
  15152. struct sk_buff *msg;
  15153. void *hdr;
  15154. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15155. if (!msg)
  15156. return;
  15157. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd_id);
  15158. if (!hdr)
  15159. goto nla_put_failure;
  15160. if (!nl80211_reg_change_event_fill(msg, request))
  15161. goto nla_put_failure;
  15162. genlmsg_end(msg, hdr);
  15163. genlmsg_multicast_allns(&nl80211_fam, msg, 0,
  15164. NL80211_MCGRP_REGULATORY);
  15165. return;
  15166. nla_put_failure:
  15167. nlmsg_free(msg);
  15168. }
  15169. struct nl80211_mlme_event {
  15170. enum nl80211_commands cmd;
  15171. const u8 *buf;
  15172. size_t buf_len;
  15173. int uapsd_queues;
  15174. const u8 *req_ies;
  15175. size_t req_ies_len;
  15176. bool reconnect;
  15177. };
  15178. static void nl80211_send_mlme_event(struct cfg80211_registered_device *rdev,
  15179. struct net_device *netdev,
  15180. const struct nl80211_mlme_event *event,
  15181. gfp_t gfp)
  15182. {
  15183. struct sk_buff *msg;
  15184. void *hdr;
  15185. msg = nlmsg_new(100 + event->buf_len + event->req_ies_len, gfp);
  15186. if (!msg)
  15187. return;
  15188. hdr = nl80211hdr_put(msg, 0, 0, 0, event->cmd);
  15189. if (!hdr) {
  15190. nlmsg_free(msg);
  15191. return;
  15192. }
  15193. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15194. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15195. nla_put(msg, NL80211_ATTR_FRAME, event->buf_len, event->buf) ||
  15196. (event->req_ies &&
  15197. nla_put(msg, NL80211_ATTR_REQ_IE, event->req_ies_len,
  15198. event->req_ies)))
  15199. goto nla_put_failure;
  15200. if (event->reconnect &&
  15201. nla_put_flag(msg, NL80211_ATTR_RECONNECT_REQUESTED))
  15202. goto nla_put_failure;
  15203. if (event->uapsd_queues >= 0) {
  15204. struct nlattr *nla_wmm =
  15205. nla_nest_start_noflag(msg, NL80211_ATTR_STA_WME);
  15206. if (!nla_wmm)
  15207. goto nla_put_failure;
  15208. if (nla_put_u8(msg, NL80211_STA_WME_UAPSD_QUEUES,
  15209. event->uapsd_queues))
  15210. goto nla_put_failure;
  15211. nla_nest_end(msg, nla_wmm);
  15212. }
  15213. genlmsg_end(msg, hdr);
  15214. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15215. NL80211_MCGRP_MLME, gfp);
  15216. return;
  15217. nla_put_failure:
  15218. nlmsg_free(msg);
  15219. }
  15220. void nl80211_send_rx_auth(struct cfg80211_registered_device *rdev,
  15221. struct net_device *netdev, const u8 *buf,
  15222. size_t len, gfp_t gfp)
  15223. {
  15224. struct nl80211_mlme_event event = {
  15225. .cmd = NL80211_CMD_AUTHENTICATE,
  15226. .buf = buf,
  15227. .buf_len = len,
  15228. .uapsd_queues = -1,
  15229. };
  15230. nl80211_send_mlme_event(rdev, netdev, &event, gfp);
  15231. }
  15232. void nl80211_send_rx_assoc(struct cfg80211_registered_device *rdev,
  15233. struct net_device *netdev,
  15234. const struct cfg80211_rx_assoc_resp_data *data)
  15235. {
  15236. struct nl80211_mlme_event event = {
  15237. .cmd = NL80211_CMD_ASSOCIATE,
  15238. .buf = data->buf,
  15239. .buf_len = data->len,
  15240. .uapsd_queues = data->uapsd_queues,
  15241. .req_ies = data->req_ies,
  15242. .req_ies_len = data->req_ies_len,
  15243. };
  15244. nl80211_send_mlme_event(rdev, netdev, &event, GFP_KERNEL);
  15245. }
  15246. void nl80211_send_deauth(struct cfg80211_registered_device *rdev,
  15247. struct net_device *netdev, const u8 *buf,
  15248. size_t len, bool reconnect, gfp_t gfp)
  15249. {
  15250. struct nl80211_mlme_event event = {
  15251. .cmd = NL80211_CMD_DEAUTHENTICATE,
  15252. .buf = buf,
  15253. .buf_len = len,
  15254. .reconnect = reconnect,
  15255. .uapsd_queues = -1,
  15256. };
  15257. nl80211_send_mlme_event(rdev, netdev, &event, gfp);
  15258. }
  15259. void nl80211_send_disassoc(struct cfg80211_registered_device *rdev,
  15260. struct net_device *netdev, const u8 *buf,
  15261. size_t len, bool reconnect, gfp_t gfp)
  15262. {
  15263. struct nl80211_mlme_event event = {
  15264. .cmd = NL80211_CMD_DISASSOCIATE,
  15265. .buf = buf,
  15266. .buf_len = len,
  15267. .reconnect = reconnect,
  15268. .uapsd_queues = -1,
  15269. };
  15270. nl80211_send_mlme_event(rdev, netdev, &event, gfp);
  15271. }
  15272. void cfg80211_rx_unprot_mlme_mgmt(struct net_device *dev, const u8 *buf,
  15273. size_t len)
  15274. {
  15275. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15276. struct wiphy *wiphy = wdev->wiphy;
  15277. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15278. const struct ieee80211_mgmt *mgmt = (void *)buf;
  15279. struct nl80211_mlme_event event = {
  15280. .buf = buf,
  15281. .buf_len = len,
  15282. .uapsd_queues = -1,
  15283. };
  15284. if (WARN_ON(len < 2))
  15285. return;
  15286. if (ieee80211_is_deauth(mgmt->frame_control)) {
  15287. event.cmd = NL80211_CMD_UNPROT_DEAUTHENTICATE;
  15288. } else if (ieee80211_is_disassoc(mgmt->frame_control)) {
  15289. event.cmd = NL80211_CMD_UNPROT_DISASSOCIATE;
  15290. } else if (ieee80211_is_beacon(mgmt->frame_control)) {
  15291. if (wdev->unprot_beacon_reported &&
  15292. elapsed_jiffies_msecs(wdev->unprot_beacon_reported) < 10000)
  15293. return;
  15294. event.cmd = NL80211_CMD_UNPROT_BEACON;
  15295. wdev->unprot_beacon_reported = jiffies;
  15296. } else {
  15297. return;
  15298. }
  15299. trace_cfg80211_rx_unprot_mlme_mgmt(dev, buf, len);
  15300. nl80211_send_mlme_event(rdev, dev, &event, GFP_ATOMIC);
  15301. }
  15302. EXPORT_SYMBOL(cfg80211_rx_unprot_mlme_mgmt);
  15303. static void nl80211_send_mlme_timeout(struct cfg80211_registered_device *rdev,
  15304. struct net_device *netdev, int cmd,
  15305. const u8 *addr, gfp_t gfp)
  15306. {
  15307. struct sk_buff *msg;
  15308. void *hdr;
  15309. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15310. if (!msg)
  15311. return;
  15312. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  15313. if (!hdr) {
  15314. nlmsg_free(msg);
  15315. return;
  15316. }
  15317. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15318. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15319. nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
  15320. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
  15321. goto nla_put_failure;
  15322. genlmsg_end(msg, hdr);
  15323. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15324. NL80211_MCGRP_MLME, gfp);
  15325. return;
  15326. nla_put_failure:
  15327. nlmsg_free(msg);
  15328. }
  15329. void nl80211_send_auth_timeout(struct cfg80211_registered_device *rdev,
  15330. struct net_device *netdev, const u8 *addr,
  15331. gfp_t gfp)
  15332. {
  15333. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_AUTHENTICATE,
  15334. addr, gfp);
  15335. }
  15336. void nl80211_send_assoc_timeout(struct cfg80211_registered_device *rdev,
  15337. struct net_device *netdev, const u8 *addr,
  15338. gfp_t gfp)
  15339. {
  15340. nl80211_send_mlme_timeout(rdev, netdev, NL80211_CMD_ASSOCIATE,
  15341. addr, gfp);
  15342. }
  15343. void nl80211_send_connect_result(struct cfg80211_registered_device *rdev,
  15344. struct net_device *netdev,
  15345. struct cfg80211_connect_resp_params *cr,
  15346. gfp_t gfp)
  15347. {
  15348. struct sk_buff *msg;
  15349. void *hdr;
  15350. unsigned int link;
  15351. size_t link_info_size = 0;
  15352. const u8 *connected_addr = cr->valid_links ?
  15353. cr->ap_mld_addr : cr->links[0].bssid;
  15354. if (cr->valid_links) {
  15355. for_each_valid_link(cr, link) {
  15356. /* Nested attribute header */
  15357. link_info_size += NLA_HDRLEN;
  15358. /* Link ID */
  15359. link_info_size += nla_total_size(sizeof(u8));
  15360. link_info_size += cr->links[link].addr ?
  15361. nla_total_size(ETH_ALEN) : 0;
  15362. link_info_size += (cr->links[link].bssid ||
  15363. cr->links[link].bss) ?
  15364. nla_total_size(ETH_ALEN) : 0;
  15365. link_info_size += nla_total_size(sizeof(u16));
  15366. }
  15367. }
  15368. msg = nlmsg_new(100 + cr->req_ie_len + cr->resp_ie_len +
  15369. cr->fils.kek_len + cr->fils.pmk_len +
  15370. (cr->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size,
  15371. gfp);
  15372. if (!msg)
  15373. return;
  15374. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONNECT);
  15375. if (!hdr) {
  15376. nlmsg_free(msg);
  15377. return;
  15378. }
  15379. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15380. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15381. (connected_addr &&
  15382. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr)) ||
  15383. nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
  15384. cr->status < 0 ? WLAN_STATUS_UNSPECIFIED_FAILURE :
  15385. cr->status) ||
  15386. (cr->status < 0 &&
  15387. (nla_put_flag(msg, NL80211_ATTR_TIMED_OUT) ||
  15388. nla_put_u32(msg, NL80211_ATTR_TIMEOUT_REASON,
  15389. cr->timeout_reason))) ||
  15390. (cr->req_ie &&
  15391. nla_put(msg, NL80211_ATTR_REQ_IE, cr->req_ie_len, cr->req_ie)) ||
  15392. (cr->resp_ie &&
  15393. nla_put(msg, NL80211_ATTR_RESP_IE, cr->resp_ie_len,
  15394. cr->resp_ie)) ||
  15395. (cr->fils.update_erp_next_seq_num &&
  15396. nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
  15397. cr->fils.erp_next_seq_num)) ||
  15398. (cr->status == WLAN_STATUS_SUCCESS &&
  15399. ((cr->fils.kek &&
  15400. nla_put(msg, NL80211_ATTR_FILS_KEK, cr->fils.kek_len,
  15401. cr->fils.kek)) ||
  15402. (cr->fils.pmk &&
  15403. nla_put(msg, NL80211_ATTR_PMK, cr->fils.pmk_len, cr->fils.pmk)) ||
  15404. (cr->fils.pmkid &&
  15405. nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, cr->fils.pmkid)))))
  15406. goto nla_put_failure;
  15407. if (cr->valid_links) {
  15408. int i = 1;
  15409. struct nlattr *nested;
  15410. nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS);
  15411. if (!nested)
  15412. goto nla_put_failure;
  15413. for_each_valid_link(cr, link) {
  15414. struct nlattr *nested_mlo_links;
  15415. const u8 *bssid = cr->links[link].bss ?
  15416. cr->links[link].bss->bssid :
  15417. cr->links[link].bssid;
  15418. nested_mlo_links = nla_nest_start(msg, i);
  15419. if (!nested_mlo_links)
  15420. goto nla_put_failure;
  15421. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) ||
  15422. (bssid &&
  15423. nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) ||
  15424. (cr->links[link].addr &&
  15425. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
  15426. cr->links[link].addr)) ||
  15427. nla_put_u16(msg, NL80211_ATTR_STATUS_CODE,
  15428. cr->links[link].status))
  15429. goto nla_put_failure;
  15430. nla_nest_end(msg, nested_mlo_links);
  15431. i++;
  15432. }
  15433. nla_nest_end(msg, nested);
  15434. }
  15435. genlmsg_end(msg, hdr);
  15436. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15437. NL80211_MCGRP_MLME, gfp);
  15438. return;
  15439. nla_put_failure:
  15440. nlmsg_free(msg);
  15441. }
  15442. void nl80211_send_roamed(struct cfg80211_registered_device *rdev,
  15443. struct net_device *netdev,
  15444. struct cfg80211_roam_info *info, gfp_t gfp)
  15445. {
  15446. struct sk_buff *msg;
  15447. void *hdr;
  15448. size_t link_info_size = 0;
  15449. unsigned int link;
  15450. const u8 *connected_addr = info->ap_mld_addr ?
  15451. info->ap_mld_addr :
  15452. (info->links[0].bss ?
  15453. info->links[0].bss->bssid :
  15454. info->links[0].bssid);
  15455. if (info->valid_links) {
  15456. for_each_valid_link(info, link) {
  15457. /* Nested attribute header */
  15458. link_info_size += NLA_HDRLEN;
  15459. /* Link ID */
  15460. link_info_size += nla_total_size(sizeof(u8));
  15461. link_info_size += info->links[link].addr ?
  15462. nla_total_size(ETH_ALEN) : 0;
  15463. link_info_size += (info->links[link].bssid ||
  15464. info->links[link].bss) ?
  15465. nla_total_size(ETH_ALEN) : 0;
  15466. }
  15467. }
  15468. msg = nlmsg_new(100 + info->req_ie_len + info->resp_ie_len +
  15469. info->fils.kek_len + info->fils.pmk_len +
  15470. (info->fils.pmkid ? WLAN_PMKID_LEN : 0) +
  15471. link_info_size, gfp);
  15472. if (!msg)
  15473. return;
  15474. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ROAM);
  15475. if (!hdr) {
  15476. nlmsg_free(msg);
  15477. return;
  15478. }
  15479. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15480. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15481. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, connected_addr) ||
  15482. (info->req_ie &&
  15483. nla_put(msg, NL80211_ATTR_REQ_IE, info->req_ie_len,
  15484. info->req_ie)) ||
  15485. (info->resp_ie &&
  15486. nla_put(msg, NL80211_ATTR_RESP_IE, info->resp_ie_len,
  15487. info->resp_ie)) ||
  15488. (info->fils.update_erp_next_seq_num &&
  15489. nla_put_u16(msg, NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM,
  15490. info->fils.erp_next_seq_num)) ||
  15491. (info->fils.kek &&
  15492. nla_put(msg, NL80211_ATTR_FILS_KEK, info->fils.kek_len,
  15493. info->fils.kek)) ||
  15494. (info->fils.pmk &&
  15495. nla_put(msg, NL80211_ATTR_PMK, info->fils.pmk_len, info->fils.pmk)) ||
  15496. (info->fils.pmkid &&
  15497. nla_put(msg, NL80211_ATTR_PMKID, WLAN_PMKID_LEN, info->fils.pmkid)))
  15498. goto nla_put_failure;
  15499. if (info->valid_links) {
  15500. int i = 1;
  15501. struct nlattr *nested;
  15502. nested = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS);
  15503. if (!nested)
  15504. goto nla_put_failure;
  15505. for_each_valid_link(info, link) {
  15506. struct nlattr *nested_mlo_links;
  15507. const u8 *bssid = info->links[link].bss ?
  15508. info->links[link].bss->bssid :
  15509. info->links[link].bssid;
  15510. nested_mlo_links = nla_nest_start(msg, i);
  15511. if (!nested_mlo_links)
  15512. goto nla_put_failure;
  15513. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link) ||
  15514. (bssid &&
  15515. nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, bssid)) ||
  15516. (info->links[link].addr &&
  15517. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN,
  15518. info->links[link].addr)))
  15519. goto nla_put_failure;
  15520. nla_nest_end(msg, nested_mlo_links);
  15521. i++;
  15522. }
  15523. nla_nest_end(msg, nested);
  15524. }
  15525. genlmsg_end(msg, hdr);
  15526. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15527. NL80211_MCGRP_MLME, gfp);
  15528. return;
  15529. nla_put_failure:
  15530. nlmsg_free(msg);
  15531. }
  15532. void nl80211_send_port_authorized(struct cfg80211_registered_device *rdev,
  15533. struct net_device *netdev, const u8 *peer_addr,
  15534. const u8 *td_bitmap, u8 td_bitmap_len)
  15535. {
  15536. struct sk_buff *msg;
  15537. void *hdr;
  15538. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15539. if (!msg)
  15540. return;
  15541. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PORT_AUTHORIZED);
  15542. if (!hdr) {
  15543. nlmsg_free(msg);
  15544. return;
  15545. }
  15546. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15547. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15548. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer_addr))
  15549. goto nla_put_failure;
  15550. if ((td_bitmap_len > 0) && td_bitmap)
  15551. if (nla_put(msg, NL80211_ATTR_TD_BITMAP,
  15552. td_bitmap_len, td_bitmap))
  15553. goto nla_put_failure;
  15554. genlmsg_end(msg, hdr);
  15555. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15556. NL80211_MCGRP_MLME, GFP_KERNEL);
  15557. return;
  15558. nla_put_failure:
  15559. nlmsg_free(msg);
  15560. }
  15561. void nl80211_send_disconnected(struct cfg80211_registered_device *rdev,
  15562. struct net_device *netdev, u16 reason,
  15563. const u8 *ie, size_t ie_len, bool from_ap)
  15564. {
  15565. struct sk_buff *msg;
  15566. void *hdr;
  15567. msg = nlmsg_new(100 + ie_len, GFP_KERNEL);
  15568. if (!msg)
  15569. return;
  15570. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_DISCONNECT);
  15571. if (!hdr) {
  15572. nlmsg_free(msg);
  15573. return;
  15574. }
  15575. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15576. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15577. (reason &&
  15578. nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason)) ||
  15579. (from_ap &&
  15580. nla_put_flag(msg, NL80211_ATTR_DISCONNECTED_BY_AP)) ||
  15581. (ie && nla_put(msg, NL80211_ATTR_IE, ie_len, ie)))
  15582. goto nla_put_failure;
  15583. genlmsg_end(msg, hdr);
  15584. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15585. NL80211_MCGRP_MLME, GFP_KERNEL);
  15586. return;
  15587. nla_put_failure:
  15588. nlmsg_free(msg);
  15589. }
  15590. void cfg80211_links_removed(struct net_device *dev, u16 link_mask)
  15591. {
  15592. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15593. struct wiphy *wiphy = wdev->wiphy;
  15594. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15595. struct sk_buff *msg;
  15596. struct nlattr *links;
  15597. void *hdr;
  15598. lockdep_assert_wiphy(wdev->wiphy);
  15599. trace_cfg80211_links_removed(dev, link_mask);
  15600. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
  15601. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT))
  15602. return;
  15603. if (WARN_ON(!wdev->valid_links || !link_mask ||
  15604. (wdev->valid_links & link_mask) != link_mask ||
  15605. wdev->valid_links == link_mask))
  15606. return;
  15607. cfg80211_wdev_release_link_bsses(wdev, link_mask);
  15608. wdev->valid_links &= ~link_mask;
  15609. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15610. if (!msg)
  15611. return;
  15612. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_LINKS_REMOVED);
  15613. if (!hdr) {
  15614. nlmsg_free(msg);
  15615. return;
  15616. }
  15617. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15618. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  15619. goto nla_put_failure;
  15620. links = nla_nest_start(msg, NL80211_ATTR_MLO_LINKS);
  15621. if (!links)
  15622. goto nla_put_failure;
  15623. while (link_mask) {
  15624. struct nlattr *link;
  15625. int link_id = __ffs(link_mask);
  15626. link = nla_nest_start(msg, link_id + 1);
  15627. if (!link)
  15628. goto nla_put_failure;
  15629. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
  15630. goto nla_put_failure;
  15631. nla_nest_end(msg, link);
  15632. link_mask &= ~(1 << link_id);
  15633. }
  15634. nla_nest_end(msg, links);
  15635. genlmsg_end(msg, hdr);
  15636. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15637. NL80211_MCGRP_MLME, GFP_KERNEL);
  15638. return;
  15639. nla_put_failure:
  15640. nlmsg_free(msg);
  15641. }
  15642. EXPORT_SYMBOL(cfg80211_links_removed);
  15643. void nl80211_send_ibss_bssid(struct cfg80211_registered_device *rdev,
  15644. struct net_device *netdev, const u8 *bssid,
  15645. gfp_t gfp)
  15646. {
  15647. struct sk_buff *msg;
  15648. void *hdr;
  15649. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15650. if (!msg)
  15651. return;
  15652. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_JOIN_IBSS);
  15653. if (!hdr) {
  15654. nlmsg_free(msg);
  15655. return;
  15656. }
  15657. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15658. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15659. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  15660. goto nla_put_failure;
  15661. genlmsg_end(msg, hdr);
  15662. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15663. NL80211_MCGRP_MLME, gfp);
  15664. return;
  15665. nla_put_failure:
  15666. nlmsg_free(msg);
  15667. }
  15668. void cfg80211_notify_new_peer_candidate(struct net_device *dev, const u8 *addr,
  15669. const u8 *ie, u8 ie_len,
  15670. int sig_dbm, gfp_t gfp)
  15671. {
  15672. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15673. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  15674. struct sk_buff *msg;
  15675. void *hdr;
  15676. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_MESH_POINT))
  15677. return;
  15678. trace_cfg80211_notify_new_peer_candidate(dev, addr);
  15679. msg = nlmsg_new(100 + ie_len, gfp);
  15680. if (!msg)
  15681. return;
  15682. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NEW_PEER_CANDIDATE);
  15683. if (!hdr) {
  15684. nlmsg_free(msg);
  15685. return;
  15686. }
  15687. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15688. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  15689. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  15690. (ie_len && ie &&
  15691. nla_put(msg, NL80211_ATTR_IE, ie_len, ie)) ||
  15692. (sig_dbm &&
  15693. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)))
  15694. goto nla_put_failure;
  15695. genlmsg_end(msg, hdr);
  15696. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15697. NL80211_MCGRP_MLME, gfp);
  15698. return;
  15699. nla_put_failure:
  15700. nlmsg_free(msg);
  15701. }
  15702. EXPORT_SYMBOL(cfg80211_notify_new_peer_candidate);
  15703. void nl80211_michael_mic_failure(struct cfg80211_registered_device *rdev,
  15704. struct net_device *netdev, const u8 *addr,
  15705. enum nl80211_key_type key_type, int key_id,
  15706. const u8 *tsc, gfp_t gfp)
  15707. {
  15708. struct sk_buff *msg;
  15709. void *hdr;
  15710. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15711. if (!msg)
  15712. return;
  15713. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_MICHAEL_MIC_FAILURE);
  15714. if (!hdr) {
  15715. nlmsg_free(msg);
  15716. return;
  15717. }
  15718. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15719. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15720. (addr && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr)) ||
  15721. nla_put_u32(msg, NL80211_ATTR_KEY_TYPE, key_type) ||
  15722. (key_id != -1 &&
  15723. nla_put_u8(msg, NL80211_ATTR_KEY_IDX, key_id)) ||
  15724. (tsc && nla_put(msg, NL80211_ATTR_KEY_SEQ, 6, tsc)))
  15725. goto nla_put_failure;
  15726. genlmsg_end(msg, hdr);
  15727. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15728. NL80211_MCGRP_MLME, gfp);
  15729. return;
  15730. nla_put_failure:
  15731. nlmsg_free(msg);
  15732. }
  15733. void nl80211_send_beacon_hint_event(struct wiphy *wiphy,
  15734. struct ieee80211_channel *channel_before,
  15735. struct ieee80211_channel *channel_after)
  15736. {
  15737. struct sk_buff *msg;
  15738. void *hdr;
  15739. struct nlattr *nl_freq;
  15740. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
  15741. if (!msg)
  15742. return;
  15743. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_REG_BEACON_HINT);
  15744. if (!hdr) {
  15745. nlmsg_free(msg);
  15746. return;
  15747. }
  15748. /*
  15749. * Since we are applying the beacon hint to a wiphy we know its
  15750. * wiphy_idx is valid
  15751. */
  15752. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, get_wiphy_idx(wiphy)))
  15753. goto nla_put_failure;
  15754. /* Before */
  15755. nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_BEFORE);
  15756. if (!nl_freq)
  15757. goto nla_put_failure;
  15758. if (nl80211_msg_put_channel(msg, wiphy, channel_before, false))
  15759. goto nla_put_failure;
  15760. nla_nest_end(msg, nl_freq);
  15761. /* After */
  15762. nl_freq = nla_nest_start_noflag(msg, NL80211_ATTR_FREQ_AFTER);
  15763. if (!nl_freq)
  15764. goto nla_put_failure;
  15765. if (nl80211_msg_put_channel(msg, wiphy, channel_after, false))
  15766. goto nla_put_failure;
  15767. nla_nest_end(msg, nl_freq);
  15768. genlmsg_end(msg, hdr);
  15769. genlmsg_multicast_allns(&nl80211_fam, msg, 0,
  15770. NL80211_MCGRP_REGULATORY);
  15771. return;
  15772. nla_put_failure:
  15773. nlmsg_free(msg);
  15774. }
  15775. static void nl80211_send_remain_on_chan_event(
  15776. int cmd, struct cfg80211_registered_device *rdev,
  15777. struct wireless_dev *wdev, u64 cookie,
  15778. struct ieee80211_channel *chan,
  15779. unsigned int duration, gfp_t gfp)
  15780. {
  15781. struct sk_buff *msg;
  15782. void *hdr;
  15783. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15784. if (!msg)
  15785. return;
  15786. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  15787. if (!hdr) {
  15788. nlmsg_free(msg);
  15789. return;
  15790. }
  15791. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15792. (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  15793. wdev->netdev->ifindex)) ||
  15794. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  15795. NL80211_ATTR_PAD) ||
  15796. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, chan->center_freq) ||
  15797. nla_put_u32(msg, NL80211_ATTR_WIPHY_CHANNEL_TYPE,
  15798. NL80211_CHAN_NO_HT) ||
  15799. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  15800. NL80211_ATTR_PAD))
  15801. goto nla_put_failure;
  15802. if (cmd == NL80211_CMD_REMAIN_ON_CHANNEL &&
  15803. nla_put_u32(msg, NL80211_ATTR_DURATION, duration))
  15804. goto nla_put_failure;
  15805. genlmsg_end(msg, hdr);
  15806. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15807. NL80211_MCGRP_MLME, gfp);
  15808. return;
  15809. nla_put_failure:
  15810. nlmsg_free(msg);
  15811. }
  15812. void cfg80211_assoc_comeback(struct net_device *netdev,
  15813. const u8 *ap_addr, u32 timeout)
  15814. {
  15815. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  15816. struct wiphy *wiphy = wdev->wiphy;
  15817. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15818. struct sk_buff *msg;
  15819. void *hdr;
  15820. trace_cfg80211_assoc_comeback(wdev, ap_addr, timeout);
  15821. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  15822. if (!msg)
  15823. return;
  15824. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_ASSOC_COMEBACK);
  15825. if (!hdr) {
  15826. nlmsg_free(msg);
  15827. return;
  15828. }
  15829. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15830. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  15831. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ap_addr) ||
  15832. nla_put_u32(msg, NL80211_ATTR_TIMEOUT, timeout))
  15833. goto nla_put_failure;
  15834. genlmsg_end(msg, hdr);
  15835. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15836. NL80211_MCGRP_MLME, GFP_KERNEL);
  15837. return;
  15838. nla_put_failure:
  15839. nlmsg_free(msg);
  15840. }
  15841. EXPORT_SYMBOL(cfg80211_assoc_comeback);
  15842. void cfg80211_ready_on_channel(struct wireless_dev *wdev, u64 cookie,
  15843. struct ieee80211_channel *chan,
  15844. unsigned int duration, gfp_t gfp)
  15845. {
  15846. struct wiphy *wiphy = wdev->wiphy;
  15847. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15848. trace_cfg80211_ready_on_channel(wdev, cookie, chan, duration);
  15849. nl80211_send_remain_on_chan_event(NL80211_CMD_REMAIN_ON_CHANNEL,
  15850. rdev, wdev, cookie, chan,
  15851. duration, gfp);
  15852. }
  15853. EXPORT_SYMBOL(cfg80211_ready_on_channel);
  15854. void cfg80211_remain_on_channel_expired(struct wireless_dev *wdev, u64 cookie,
  15855. struct ieee80211_channel *chan,
  15856. gfp_t gfp)
  15857. {
  15858. struct wiphy *wiphy = wdev->wiphy;
  15859. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15860. trace_cfg80211_ready_on_channel_expired(wdev, cookie, chan);
  15861. nl80211_send_remain_on_chan_event(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL,
  15862. rdev, wdev, cookie, chan, 0, gfp);
  15863. }
  15864. EXPORT_SYMBOL(cfg80211_remain_on_channel_expired);
  15865. void cfg80211_tx_mgmt_expired(struct wireless_dev *wdev, u64 cookie,
  15866. struct ieee80211_channel *chan,
  15867. gfp_t gfp)
  15868. {
  15869. struct wiphy *wiphy = wdev->wiphy;
  15870. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15871. trace_cfg80211_tx_mgmt_expired(wdev, cookie, chan);
  15872. nl80211_send_remain_on_chan_event(NL80211_CMD_FRAME_WAIT_CANCEL,
  15873. rdev, wdev, cookie, chan, 0, gfp);
  15874. }
  15875. EXPORT_SYMBOL(cfg80211_tx_mgmt_expired);
  15876. void cfg80211_new_sta(struct net_device *dev, const u8 *mac_addr,
  15877. struct station_info *sinfo, gfp_t gfp)
  15878. {
  15879. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  15880. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15881. struct sk_buff *msg;
  15882. trace_cfg80211_new_sta(dev, mac_addr, sinfo);
  15883. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15884. if (!msg)
  15885. return;
  15886. if (nl80211_send_station(msg, NL80211_CMD_NEW_STATION, 0, 0, 0,
  15887. rdev, dev, mac_addr, sinfo) < 0) {
  15888. nlmsg_free(msg);
  15889. return;
  15890. }
  15891. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15892. NL80211_MCGRP_MLME, gfp);
  15893. }
  15894. EXPORT_SYMBOL(cfg80211_new_sta);
  15895. void cfg80211_del_sta_sinfo(struct net_device *dev, const u8 *mac_addr,
  15896. struct station_info *sinfo, gfp_t gfp)
  15897. {
  15898. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  15899. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15900. struct sk_buff *msg;
  15901. struct station_info empty_sinfo = {};
  15902. if (!sinfo)
  15903. sinfo = &empty_sinfo;
  15904. trace_cfg80211_del_sta(dev, mac_addr);
  15905. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  15906. if (!msg) {
  15907. cfg80211_sinfo_release_content(sinfo);
  15908. return;
  15909. }
  15910. if (nl80211_send_station(msg, NL80211_CMD_DEL_STATION, 0, 0, 0,
  15911. rdev, dev, mac_addr, sinfo) < 0) {
  15912. nlmsg_free(msg);
  15913. return;
  15914. }
  15915. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15916. NL80211_MCGRP_MLME, gfp);
  15917. }
  15918. EXPORT_SYMBOL(cfg80211_del_sta_sinfo);
  15919. void cfg80211_conn_failed(struct net_device *dev, const u8 *mac_addr,
  15920. enum nl80211_connect_failed_reason reason,
  15921. gfp_t gfp)
  15922. {
  15923. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  15924. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  15925. struct sk_buff *msg;
  15926. void *hdr;
  15927. msg = nlmsg_new(NLMSG_GOODSIZE, gfp);
  15928. if (!msg)
  15929. return;
  15930. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONN_FAILED);
  15931. if (!hdr) {
  15932. nlmsg_free(msg);
  15933. return;
  15934. }
  15935. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  15936. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac_addr) ||
  15937. nla_put_u32(msg, NL80211_ATTR_CONN_FAILED_REASON, reason))
  15938. goto nla_put_failure;
  15939. genlmsg_end(msg, hdr);
  15940. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  15941. NL80211_MCGRP_MLME, gfp);
  15942. return;
  15943. nla_put_failure:
  15944. nlmsg_free(msg);
  15945. }
  15946. EXPORT_SYMBOL(cfg80211_conn_failed);
  15947. static bool __nl80211_unexpected_frame(struct net_device *dev, u8 cmd,
  15948. const u8 *addr, gfp_t gfp)
  15949. {
  15950. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15951. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  15952. struct sk_buff *msg;
  15953. void *hdr;
  15954. u32 nlportid = READ_ONCE(wdev->ap_unexpected_nlportid);
  15955. if (!nlportid)
  15956. return false;
  15957. msg = nlmsg_new(100, gfp);
  15958. if (!msg)
  15959. return true;
  15960. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  15961. if (!hdr) {
  15962. nlmsg_free(msg);
  15963. return true;
  15964. }
  15965. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  15966. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  15967. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr))
  15968. goto nla_put_failure;
  15969. genlmsg_end(msg, hdr);
  15970. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  15971. return true;
  15972. nla_put_failure:
  15973. nlmsg_free(msg);
  15974. return true;
  15975. }
  15976. bool cfg80211_rx_spurious_frame(struct net_device *dev,
  15977. const u8 *addr, gfp_t gfp)
  15978. {
  15979. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15980. bool ret;
  15981. trace_cfg80211_rx_spurious_frame(dev, addr);
  15982. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  15983. wdev->iftype != NL80211_IFTYPE_P2P_GO)) {
  15984. trace_cfg80211_return_bool(false);
  15985. return false;
  15986. }
  15987. ret = __nl80211_unexpected_frame(dev, NL80211_CMD_UNEXPECTED_FRAME,
  15988. addr, gfp);
  15989. trace_cfg80211_return_bool(ret);
  15990. return ret;
  15991. }
  15992. EXPORT_SYMBOL(cfg80211_rx_spurious_frame);
  15993. bool cfg80211_rx_unexpected_4addr_frame(struct net_device *dev,
  15994. const u8 *addr, gfp_t gfp)
  15995. {
  15996. struct wireless_dev *wdev = dev->ieee80211_ptr;
  15997. bool ret;
  15998. trace_cfg80211_rx_unexpected_4addr_frame(dev, addr);
  15999. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_AP &&
  16000. wdev->iftype != NL80211_IFTYPE_P2P_GO &&
  16001. wdev->iftype != NL80211_IFTYPE_AP_VLAN)) {
  16002. trace_cfg80211_return_bool(false);
  16003. return false;
  16004. }
  16005. ret = __nl80211_unexpected_frame(dev,
  16006. NL80211_CMD_UNEXPECTED_4ADDR_FRAME,
  16007. addr, gfp);
  16008. trace_cfg80211_return_bool(ret);
  16009. return ret;
  16010. }
  16011. EXPORT_SYMBOL(cfg80211_rx_unexpected_4addr_frame);
  16012. int nl80211_send_mgmt(struct cfg80211_registered_device *rdev,
  16013. struct wireless_dev *wdev, u32 nlportid,
  16014. struct cfg80211_rx_info *info, gfp_t gfp)
  16015. {
  16016. struct net_device *netdev = wdev->netdev;
  16017. struct sk_buff *msg;
  16018. void *hdr;
  16019. msg = nlmsg_new(100 + info->len, gfp);
  16020. if (!msg)
  16021. return -ENOMEM;
  16022. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  16023. if (!hdr) {
  16024. nlmsg_free(msg);
  16025. return -ENOMEM;
  16026. }
  16027. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16028. (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  16029. netdev->ifindex)) ||
  16030. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16031. NL80211_ATTR_PAD) ||
  16032. (info->have_link_id &&
  16033. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, info->link_id)) ||
  16034. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ, KHZ_TO_MHZ(info->freq)) ||
  16035. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET, info->freq % 1000) ||
  16036. (info->sig_dbm &&
  16037. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, info->sig_dbm)) ||
  16038. nla_put(msg, NL80211_ATTR_FRAME, info->len, info->buf) ||
  16039. (info->flags &&
  16040. nla_put_u32(msg, NL80211_ATTR_RXMGMT_FLAGS, info->flags)) ||
  16041. (info->rx_tstamp && nla_put_u64_64bit(msg,
  16042. NL80211_ATTR_RX_HW_TIMESTAMP,
  16043. info->rx_tstamp,
  16044. NL80211_ATTR_PAD)) ||
  16045. (info->ack_tstamp && nla_put_u64_64bit(msg,
  16046. NL80211_ATTR_TX_HW_TIMESTAMP,
  16047. info->ack_tstamp,
  16048. NL80211_ATTR_PAD)))
  16049. goto nla_put_failure;
  16050. genlmsg_end(msg, hdr);
  16051. return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  16052. nla_put_failure:
  16053. nlmsg_free(msg);
  16054. return -ENOBUFS;
  16055. }
  16056. static void nl80211_frame_tx_status(struct wireless_dev *wdev,
  16057. struct cfg80211_tx_status *status,
  16058. gfp_t gfp, enum nl80211_commands command)
  16059. {
  16060. struct wiphy *wiphy = wdev->wiphy;
  16061. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16062. struct net_device *netdev = wdev->netdev;
  16063. struct sk_buff *msg;
  16064. void *hdr;
  16065. if (command == NL80211_CMD_FRAME_TX_STATUS)
  16066. trace_cfg80211_mgmt_tx_status(wdev, status->cookie,
  16067. status->ack);
  16068. else
  16069. trace_cfg80211_control_port_tx_status(wdev, status->cookie,
  16070. status->ack);
  16071. msg = nlmsg_new(100 + status->len, gfp);
  16072. if (!msg)
  16073. return;
  16074. hdr = nl80211hdr_put(msg, 0, 0, 0, command);
  16075. if (!hdr) {
  16076. nlmsg_free(msg);
  16077. return;
  16078. }
  16079. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16080. (netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  16081. netdev->ifindex)) ||
  16082. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16083. NL80211_ATTR_PAD) ||
  16084. nla_put(msg, NL80211_ATTR_FRAME, status->len, status->buf) ||
  16085. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, status->cookie,
  16086. NL80211_ATTR_PAD) ||
  16087. (status->ack && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
  16088. (status->tx_tstamp &&
  16089. nla_put_u64_64bit(msg, NL80211_ATTR_TX_HW_TIMESTAMP,
  16090. status->tx_tstamp, NL80211_ATTR_PAD)) ||
  16091. (status->ack_tstamp &&
  16092. nla_put_u64_64bit(msg, NL80211_ATTR_RX_HW_TIMESTAMP,
  16093. status->ack_tstamp, NL80211_ATTR_PAD)))
  16094. goto nla_put_failure;
  16095. genlmsg_end(msg, hdr);
  16096. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16097. NL80211_MCGRP_MLME, gfp);
  16098. return;
  16099. nla_put_failure:
  16100. nlmsg_free(msg);
  16101. }
  16102. void cfg80211_control_port_tx_status(struct wireless_dev *wdev, u64 cookie,
  16103. const u8 *buf, size_t len, bool ack,
  16104. gfp_t gfp)
  16105. {
  16106. struct cfg80211_tx_status status = {
  16107. .cookie = cookie,
  16108. .buf = buf,
  16109. .len = len,
  16110. .ack = ack
  16111. };
  16112. nl80211_frame_tx_status(wdev, &status, gfp,
  16113. NL80211_CMD_CONTROL_PORT_FRAME_TX_STATUS);
  16114. }
  16115. EXPORT_SYMBOL(cfg80211_control_port_tx_status);
  16116. void cfg80211_mgmt_tx_status_ext(struct wireless_dev *wdev,
  16117. struct cfg80211_tx_status *status, gfp_t gfp)
  16118. {
  16119. nl80211_frame_tx_status(wdev, status, gfp, NL80211_CMD_FRAME_TX_STATUS);
  16120. }
  16121. EXPORT_SYMBOL(cfg80211_mgmt_tx_status_ext);
  16122. static int __nl80211_rx_control_port(struct net_device *dev,
  16123. struct sk_buff *skb,
  16124. bool unencrypted,
  16125. int link_id,
  16126. gfp_t gfp)
  16127. {
  16128. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16129. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16130. struct ethhdr *ehdr = eth_hdr(skb);
  16131. const u8 *addr = ehdr->h_source;
  16132. u16 proto = be16_to_cpu(skb->protocol);
  16133. struct sk_buff *msg;
  16134. void *hdr;
  16135. struct nlattr *frame;
  16136. u32 nlportid = READ_ONCE(wdev->conn_owner_nlportid);
  16137. if (!nlportid)
  16138. return -ENOENT;
  16139. msg = nlmsg_new(100 + skb->len, gfp);
  16140. if (!msg)
  16141. return -ENOMEM;
  16142. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CONTROL_PORT_FRAME);
  16143. if (!hdr) {
  16144. nlmsg_free(msg);
  16145. return -ENOBUFS;
  16146. }
  16147. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16148. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  16149. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16150. NL80211_ATTR_PAD) ||
  16151. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  16152. nla_put_u16(msg, NL80211_ATTR_CONTROL_PORT_ETHERTYPE, proto) ||
  16153. (link_id >= 0 &&
  16154. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)) ||
  16155. (unencrypted && nla_put_flag(msg,
  16156. NL80211_ATTR_CONTROL_PORT_NO_ENCRYPT)))
  16157. goto nla_put_failure;
  16158. frame = nla_reserve(msg, NL80211_ATTR_FRAME, skb->len);
  16159. if (!frame)
  16160. goto nla_put_failure;
  16161. skb_copy_bits(skb, 0, nla_data(frame), skb->len);
  16162. genlmsg_end(msg, hdr);
  16163. return genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  16164. nla_put_failure:
  16165. nlmsg_free(msg);
  16166. return -ENOBUFS;
  16167. }
  16168. bool cfg80211_rx_control_port(struct net_device *dev, struct sk_buff *skb,
  16169. bool unencrypted, int link_id)
  16170. {
  16171. int ret;
  16172. trace_cfg80211_rx_control_port(dev, skb, unencrypted, link_id);
  16173. ret = __nl80211_rx_control_port(dev, skb, unencrypted, link_id,
  16174. GFP_ATOMIC);
  16175. trace_cfg80211_return_bool(ret == 0);
  16176. return ret == 0;
  16177. }
  16178. EXPORT_SYMBOL(cfg80211_rx_control_port);
  16179. static struct sk_buff *cfg80211_prepare_cqm(struct net_device *dev,
  16180. const char *mac, gfp_t gfp)
  16181. {
  16182. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16183. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16184. struct sk_buff *msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16185. void **cb;
  16186. if (!msg)
  16187. return NULL;
  16188. cb = (void **)msg->cb;
  16189. cb[0] = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_NOTIFY_CQM);
  16190. if (!cb[0]) {
  16191. nlmsg_free(msg);
  16192. return NULL;
  16193. }
  16194. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16195. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  16196. goto nla_put_failure;
  16197. if (mac && nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
  16198. goto nla_put_failure;
  16199. cb[1] = nla_nest_start_noflag(msg, NL80211_ATTR_CQM);
  16200. if (!cb[1])
  16201. goto nla_put_failure;
  16202. cb[2] = rdev;
  16203. return msg;
  16204. nla_put_failure:
  16205. nlmsg_free(msg);
  16206. return NULL;
  16207. }
  16208. static void cfg80211_send_cqm(struct sk_buff *msg, gfp_t gfp)
  16209. {
  16210. void **cb = (void **)msg->cb;
  16211. struct cfg80211_registered_device *rdev = cb[2];
  16212. nla_nest_end(msg, cb[1]);
  16213. genlmsg_end(msg, cb[0]);
  16214. memset(msg->cb, 0, sizeof(msg->cb));
  16215. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16216. NL80211_MCGRP_MLME, gfp);
  16217. }
  16218. void cfg80211_cqm_rssi_notify(struct net_device *dev,
  16219. enum nl80211_cqm_rssi_threshold_event rssi_event,
  16220. s32 rssi_level, gfp_t gfp)
  16221. {
  16222. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16223. struct cfg80211_cqm_config *cqm_config;
  16224. trace_cfg80211_cqm_rssi_notify(dev, rssi_event, rssi_level);
  16225. if (WARN_ON(rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW &&
  16226. rssi_event != NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH))
  16227. return;
  16228. rcu_read_lock();
  16229. cqm_config = rcu_dereference(wdev->cqm_config);
  16230. if (cqm_config) {
  16231. cqm_config->last_rssi_event_value = rssi_level;
  16232. cqm_config->last_rssi_event_type = rssi_event;
  16233. wiphy_work_queue(wdev->wiphy, &wdev->cqm_rssi_work);
  16234. }
  16235. rcu_read_unlock();
  16236. }
  16237. EXPORT_SYMBOL(cfg80211_cqm_rssi_notify);
  16238. void cfg80211_cqm_rssi_notify_work(struct wiphy *wiphy, struct wiphy_work *work)
  16239. {
  16240. struct wireless_dev *wdev = container_of(work, struct wireless_dev,
  16241. cqm_rssi_work);
  16242. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16243. enum nl80211_cqm_rssi_threshold_event rssi_event;
  16244. struct cfg80211_cqm_config *cqm_config;
  16245. struct sk_buff *msg;
  16246. s32 rssi_level;
  16247. cqm_config = wiphy_dereference(wdev->wiphy, wdev->cqm_config);
  16248. if (!cqm_config)
  16249. return;
  16250. if (cqm_config->use_range_api)
  16251. cfg80211_cqm_rssi_update(rdev, wdev->netdev, cqm_config);
  16252. rssi_level = cqm_config->last_rssi_event_value;
  16253. rssi_event = cqm_config->last_rssi_event_type;
  16254. msg = cfg80211_prepare_cqm(wdev->netdev, NULL, GFP_KERNEL);
  16255. if (!msg)
  16256. return;
  16257. if (nla_put_u32(msg, NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT,
  16258. rssi_event))
  16259. goto nla_put_failure;
  16260. if (rssi_level && nla_put_s32(msg, NL80211_ATTR_CQM_RSSI_LEVEL,
  16261. rssi_level))
  16262. goto nla_put_failure;
  16263. cfg80211_send_cqm(msg, GFP_KERNEL);
  16264. return;
  16265. nla_put_failure:
  16266. nlmsg_free(msg);
  16267. }
  16268. void cfg80211_cqm_txe_notify(struct net_device *dev,
  16269. const u8 *peer, u32 num_packets,
  16270. u32 rate, u32 intvl, gfp_t gfp)
  16271. {
  16272. struct sk_buff *msg;
  16273. msg = cfg80211_prepare_cqm(dev, peer, gfp);
  16274. if (!msg)
  16275. return;
  16276. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_PKTS, num_packets))
  16277. goto nla_put_failure;
  16278. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_RATE, rate))
  16279. goto nla_put_failure;
  16280. if (nla_put_u32(msg, NL80211_ATTR_CQM_TXE_INTVL, intvl))
  16281. goto nla_put_failure;
  16282. cfg80211_send_cqm(msg, gfp);
  16283. return;
  16284. nla_put_failure:
  16285. nlmsg_free(msg);
  16286. }
  16287. EXPORT_SYMBOL(cfg80211_cqm_txe_notify);
  16288. void cfg80211_cqm_pktloss_notify(struct net_device *dev,
  16289. const u8 *peer, u32 num_packets, gfp_t gfp)
  16290. {
  16291. struct sk_buff *msg;
  16292. trace_cfg80211_cqm_pktloss_notify(dev, peer, num_packets);
  16293. msg = cfg80211_prepare_cqm(dev, peer, gfp);
  16294. if (!msg)
  16295. return;
  16296. if (nla_put_u32(msg, NL80211_ATTR_CQM_PKT_LOSS_EVENT, num_packets))
  16297. goto nla_put_failure;
  16298. cfg80211_send_cqm(msg, gfp);
  16299. return;
  16300. nla_put_failure:
  16301. nlmsg_free(msg);
  16302. }
  16303. EXPORT_SYMBOL(cfg80211_cqm_pktloss_notify);
  16304. void cfg80211_cqm_beacon_loss_notify(struct net_device *dev, gfp_t gfp)
  16305. {
  16306. struct sk_buff *msg;
  16307. msg = cfg80211_prepare_cqm(dev, NULL, gfp);
  16308. if (!msg)
  16309. return;
  16310. if (nla_put_flag(msg, NL80211_ATTR_CQM_BEACON_LOSS_EVENT))
  16311. goto nla_put_failure;
  16312. cfg80211_send_cqm(msg, gfp);
  16313. return;
  16314. nla_put_failure:
  16315. nlmsg_free(msg);
  16316. }
  16317. EXPORT_SYMBOL(cfg80211_cqm_beacon_loss_notify);
  16318. static void nl80211_gtk_rekey_notify(struct cfg80211_registered_device *rdev,
  16319. struct net_device *netdev, const u8 *bssid,
  16320. const u8 *replay_ctr, gfp_t gfp)
  16321. {
  16322. struct sk_buff *msg;
  16323. struct nlattr *rekey_attr;
  16324. void *hdr;
  16325. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16326. if (!msg)
  16327. return;
  16328. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_REKEY_OFFLOAD);
  16329. if (!hdr) {
  16330. nlmsg_free(msg);
  16331. return;
  16332. }
  16333. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16334. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  16335. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, bssid))
  16336. goto nla_put_failure;
  16337. rekey_attr = nla_nest_start_noflag(msg, NL80211_ATTR_REKEY_DATA);
  16338. if (!rekey_attr)
  16339. goto nla_put_failure;
  16340. if (nla_put(msg, NL80211_REKEY_DATA_REPLAY_CTR,
  16341. NL80211_REPLAY_CTR_LEN, replay_ctr))
  16342. goto nla_put_failure;
  16343. nla_nest_end(msg, rekey_attr);
  16344. genlmsg_end(msg, hdr);
  16345. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16346. NL80211_MCGRP_MLME, gfp);
  16347. return;
  16348. nla_put_failure:
  16349. nlmsg_free(msg);
  16350. }
  16351. void cfg80211_gtk_rekey_notify(struct net_device *dev, const u8 *bssid,
  16352. const u8 *replay_ctr, gfp_t gfp)
  16353. {
  16354. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16355. struct wiphy *wiphy = wdev->wiphy;
  16356. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16357. trace_cfg80211_gtk_rekey_notify(dev, bssid);
  16358. nl80211_gtk_rekey_notify(rdev, dev, bssid, replay_ctr, gfp);
  16359. }
  16360. EXPORT_SYMBOL(cfg80211_gtk_rekey_notify);
  16361. static void
  16362. nl80211_pmksa_candidate_notify(struct cfg80211_registered_device *rdev,
  16363. struct net_device *netdev, int index,
  16364. const u8 *bssid, bool preauth, gfp_t gfp)
  16365. {
  16366. struct sk_buff *msg;
  16367. struct nlattr *attr;
  16368. void *hdr;
  16369. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16370. if (!msg)
  16371. return;
  16372. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PMKSA_CANDIDATE);
  16373. if (!hdr) {
  16374. nlmsg_free(msg);
  16375. return;
  16376. }
  16377. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16378. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  16379. goto nla_put_failure;
  16380. attr = nla_nest_start_noflag(msg, NL80211_ATTR_PMKSA_CANDIDATE);
  16381. if (!attr)
  16382. goto nla_put_failure;
  16383. if (nla_put_u32(msg, NL80211_PMKSA_CANDIDATE_INDEX, index) ||
  16384. nla_put(msg, NL80211_PMKSA_CANDIDATE_BSSID, ETH_ALEN, bssid) ||
  16385. (preauth &&
  16386. nla_put_flag(msg, NL80211_PMKSA_CANDIDATE_PREAUTH)))
  16387. goto nla_put_failure;
  16388. nla_nest_end(msg, attr);
  16389. genlmsg_end(msg, hdr);
  16390. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16391. NL80211_MCGRP_MLME, gfp);
  16392. return;
  16393. nla_put_failure:
  16394. nlmsg_free(msg);
  16395. }
  16396. void cfg80211_pmksa_candidate_notify(struct net_device *dev, int index,
  16397. const u8 *bssid, bool preauth, gfp_t gfp)
  16398. {
  16399. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16400. struct wiphy *wiphy = wdev->wiphy;
  16401. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16402. trace_cfg80211_pmksa_candidate_notify(dev, index, bssid, preauth);
  16403. nl80211_pmksa_candidate_notify(rdev, dev, index, bssid, preauth, gfp);
  16404. }
  16405. EXPORT_SYMBOL(cfg80211_pmksa_candidate_notify);
  16406. static void nl80211_ch_switch_notify(struct cfg80211_registered_device *rdev,
  16407. struct net_device *netdev,
  16408. unsigned int link_id,
  16409. struct cfg80211_chan_def *chandef,
  16410. gfp_t gfp,
  16411. enum nl80211_commands notif,
  16412. u8 count, bool quiet)
  16413. {
  16414. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  16415. struct sk_buff *msg;
  16416. void *hdr;
  16417. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16418. if (!msg)
  16419. return;
  16420. hdr = nl80211hdr_put(msg, 0, 0, 0, notif);
  16421. if (!hdr) {
  16422. nlmsg_free(msg);
  16423. return;
  16424. }
  16425. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex))
  16426. goto nla_put_failure;
  16427. if (wdev->valid_links &&
  16428. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
  16429. goto nla_put_failure;
  16430. if (nl80211_send_chandef(msg, chandef))
  16431. goto nla_put_failure;
  16432. if (notif == NL80211_CMD_CH_SWITCH_STARTED_NOTIFY) {
  16433. if (nla_put_u32(msg, NL80211_ATTR_CH_SWITCH_COUNT, count))
  16434. goto nla_put_failure;
  16435. if (quiet &&
  16436. nla_put_flag(msg, NL80211_ATTR_CH_SWITCH_BLOCK_TX))
  16437. goto nla_put_failure;
  16438. }
  16439. genlmsg_end(msg, hdr);
  16440. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16441. NL80211_MCGRP_MLME, gfp);
  16442. return;
  16443. nla_put_failure:
  16444. nlmsg_free(msg);
  16445. }
  16446. void cfg80211_ch_switch_notify(struct net_device *dev,
  16447. struct cfg80211_chan_def *chandef,
  16448. unsigned int link_id)
  16449. {
  16450. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16451. struct wiphy *wiphy = wdev->wiphy;
  16452. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16453. lockdep_assert_wiphy(wdev->wiphy);
  16454. WARN_INVALID_LINK_ID(wdev, link_id);
  16455. trace_cfg80211_ch_switch_notify(dev, chandef, link_id);
  16456. switch (wdev->iftype) {
  16457. case NL80211_IFTYPE_STATION:
  16458. case NL80211_IFTYPE_P2P_CLIENT:
  16459. if (!WARN_ON(!wdev->links[link_id].client.current_bss))
  16460. cfg80211_update_assoc_bss_entry(wdev, link_id,
  16461. chandef->chan);
  16462. break;
  16463. case NL80211_IFTYPE_MESH_POINT:
  16464. wdev->u.mesh.chandef = *chandef;
  16465. wdev->u.mesh.preset_chandef = *chandef;
  16466. break;
  16467. case NL80211_IFTYPE_AP:
  16468. case NL80211_IFTYPE_P2P_GO:
  16469. wdev->links[link_id].ap.chandef = *chandef;
  16470. break;
  16471. case NL80211_IFTYPE_ADHOC:
  16472. wdev->u.ibss.chandef = *chandef;
  16473. break;
  16474. default:
  16475. WARN_ON(1);
  16476. break;
  16477. }
  16478. cfg80211_schedule_channels_check(wdev);
  16479. cfg80211_sched_dfs_chan_update(rdev);
  16480. nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL,
  16481. NL80211_CMD_CH_SWITCH_NOTIFY, 0, false);
  16482. }
  16483. EXPORT_SYMBOL(cfg80211_ch_switch_notify);
  16484. void cfg80211_ch_switch_started_notify(struct net_device *dev,
  16485. struct cfg80211_chan_def *chandef,
  16486. unsigned int link_id, u8 count,
  16487. bool quiet)
  16488. {
  16489. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16490. struct wiphy *wiphy = wdev->wiphy;
  16491. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16492. lockdep_assert_wiphy(wdev->wiphy);
  16493. WARN_INVALID_LINK_ID(wdev, link_id);
  16494. trace_cfg80211_ch_switch_started_notify(dev, chandef, link_id);
  16495. nl80211_ch_switch_notify(rdev, dev, link_id, chandef, GFP_KERNEL,
  16496. NL80211_CMD_CH_SWITCH_STARTED_NOTIFY,
  16497. count, quiet);
  16498. }
  16499. EXPORT_SYMBOL(cfg80211_ch_switch_started_notify);
  16500. int cfg80211_bss_color_notify(struct net_device *dev,
  16501. enum nl80211_commands cmd, u8 count,
  16502. u64 color_bitmap, u8 link_id)
  16503. {
  16504. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16505. struct wiphy *wiphy = wdev->wiphy;
  16506. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16507. struct sk_buff *msg;
  16508. void *hdr;
  16509. lockdep_assert_wiphy(wdev->wiphy);
  16510. trace_cfg80211_bss_color_notify(dev, cmd, count, color_bitmap);
  16511. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  16512. if (!msg)
  16513. return -ENOMEM;
  16514. hdr = nl80211hdr_put(msg, 0, 0, 0, cmd);
  16515. if (!hdr)
  16516. goto nla_put_failure;
  16517. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  16518. goto nla_put_failure;
  16519. if (wdev->valid_links &&
  16520. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id))
  16521. goto nla_put_failure;
  16522. if (cmd == NL80211_CMD_COLOR_CHANGE_STARTED &&
  16523. nla_put_u32(msg, NL80211_ATTR_COLOR_CHANGE_COUNT, count))
  16524. goto nla_put_failure;
  16525. if (cmd == NL80211_CMD_OBSS_COLOR_COLLISION &&
  16526. nla_put_u64_64bit(msg, NL80211_ATTR_OBSS_COLOR_BITMAP,
  16527. color_bitmap, NL80211_ATTR_PAD))
  16528. goto nla_put_failure;
  16529. genlmsg_end(msg, hdr);
  16530. return genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy),
  16531. msg, 0, NL80211_MCGRP_MLME, GFP_KERNEL);
  16532. nla_put_failure:
  16533. nlmsg_free(msg);
  16534. return -EINVAL;
  16535. }
  16536. EXPORT_SYMBOL(cfg80211_bss_color_notify);
  16537. void
  16538. nl80211_radar_notify(struct cfg80211_registered_device *rdev,
  16539. const struct cfg80211_chan_def *chandef,
  16540. enum nl80211_radar_event event,
  16541. struct net_device *netdev, gfp_t gfp)
  16542. {
  16543. struct sk_buff *msg;
  16544. void *hdr;
  16545. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16546. if (!msg)
  16547. return;
  16548. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_RADAR_DETECT);
  16549. if (!hdr) {
  16550. nlmsg_free(msg);
  16551. return;
  16552. }
  16553. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  16554. goto nla_put_failure;
  16555. /* NOP and radar events don't need a netdev parameter */
  16556. if (netdev) {
  16557. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  16558. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  16559. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16560. NL80211_ATTR_PAD))
  16561. goto nla_put_failure;
  16562. }
  16563. if (nla_put_u32(msg, NL80211_ATTR_RADAR_EVENT, event))
  16564. goto nla_put_failure;
  16565. if (nl80211_send_chandef(msg, chandef))
  16566. goto nla_put_failure;
  16567. genlmsg_end(msg, hdr);
  16568. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16569. NL80211_MCGRP_MLME, gfp);
  16570. return;
  16571. nla_put_failure:
  16572. nlmsg_free(msg);
  16573. }
  16574. void cfg80211_sta_opmode_change_notify(struct net_device *dev, const u8 *mac,
  16575. struct sta_opmode_info *sta_opmode,
  16576. gfp_t gfp)
  16577. {
  16578. struct sk_buff *msg;
  16579. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16580. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16581. void *hdr;
  16582. if (WARN_ON(!mac))
  16583. return;
  16584. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16585. if (!msg)
  16586. return;
  16587. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STA_OPMODE_CHANGED);
  16588. if (!hdr) {
  16589. nlmsg_free(msg);
  16590. return;
  16591. }
  16592. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx))
  16593. goto nla_put_failure;
  16594. if (nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex))
  16595. goto nla_put_failure;
  16596. if (nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, mac))
  16597. goto nla_put_failure;
  16598. if ((sta_opmode->changed & STA_OPMODE_SMPS_MODE_CHANGED) &&
  16599. nla_put_u8(msg, NL80211_ATTR_SMPS_MODE, sta_opmode->smps_mode))
  16600. goto nla_put_failure;
  16601. if ((sta_opmode->changed & STA_OPMODE_MAX_BW_CHANGED) &&
  16602. nla_put_u32(msg, NL80211_ATTR_CHANNEL_WIDTH, sta_opmode->bw))
  16603. goto nla_put_failure;
  16604. if ((sta_opmode->changed & STA_OPMODE_N_SS_CHANGED) &&
  16605. nla_put_u8(msg, NL80211_ATTR_NSS, sta_opmode->rx_nss))
  16606. goto nla_put_failure;
  16607. genlmsg_end(msg, hdr);
  16608. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16609. NL80211_MCGRP_MLME, gfp);
  16610. return;
  16611. nla_put_failure:
  16612. nlmsg_free(msg);
  16613. }
  16614. EXPORT_SYMBOL(cfg80211_sta_opmode_change_notify);
  16615. void cfg80211_probe_status(struct net_device *dev, const u8 *addr,
  16616. u64 cookie, bool acked, s32 ack_signal,
  16617. bool is_valid_ack_signal, gfp_t gfp)
  16618. {
  16619. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16620. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16621. struct sk_buff *msg;
  16622. void *hdr;
  16623. trace_cfg80211_probe_status(dev, addr, cookie, acked);
  16624. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16625. if (!msg)
  16626. return;
  16627. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_PROBE_CLIENT);
  16628. if (!hdr) {
  16629. nlmsg_free(msg);
  16630. return;
  16631. }
  16632. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16633. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  16634. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, addr) ||
  16635. nla_put_u64_64bit(msg, NL80211_ATTR_COOKIE, cookie,
  16636. NL80211_ATTR_PAD) ||
  16637. (acked && nla_put_flag(msg, NL80211_ATTR_ACK)) ||
  16638. (is_valid_ack_signal && nla_put_s32(msg, NL80211_ATTR_ACK_SIGNAL,
  16639. ack_signal)))
  16640. goto nla_put_failure;
  16641. genlmsg_end(msg, hdr);
  16642. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16643. NL80211_MCGRP_MLME, gfp);
  16644. return;
  16645. nla_put_failure:
  16646. nlmsg_free(msg);
  16647. }
  16648. EXPORT_SYMBOL(cfg80211_probe_status);
  16649. void cfg80211_report_obss_beacon_khz(struct wiphy *wiphy, const u8 *frame,
  16650. size_t len, int freq, int sig_dbm)
  16651. {
  16652. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16653. struct sk_buff *msg;
  16654. void *hdr;
  16655. struct cfg80211_beacon_registration *reg;
  16656. trace_cfg80211_report_obss_beacon(wiphy, frame, len, freq, sig_dbm);
  16657. spin_lock_bh(&rdev->beacon_registrations_lock);
  16658. list_for_each_entry(reg, &rdev->beacon_registrations, list) {
  16659. msg = nlmsg_new(len + 100, GFP_ATOMIC);
  16660. if (!msg) {
  16661. spin_unlock_bh(&rdev->beacon_registrations_lock);
  16662. return;
  16663. }
  16664. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FRAME);
  16665. if (!hdr)
  16666. goto nla_put_failure;
  16667. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16668. (freq &&
  16669. (nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ,
  16670. KHZ_TO_MHZ(freq)) ||
  16671. nla_put_u32(msg, NL80211_ATTR_WIPHY_FREQ_OFFSET,
  16672. freq % 1000))) ||
  16673. (sig_dbm &&
  16674. nla_put_u32(msg, NL80211_ATTR_RX_SIGNAL_DBM, sig_dbm)) ||
  16675. nla_put(msg, NL80211_ATTR_FRAME, len, frame))
  16676. goto nla_put_failure;
  16677. genlmsg_end(msg, hdr);
  16678. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, reg->nlportid);
  16679. }
  16680. spin_unlock_bh(&rdev->beacon_registrations_lock);
  16681. return;
  16682. nla_put_failure:
  16683. spin_unlock_bh(&rdev->beacon_registrations_lock);
  16684. nlmsg_free(msg);
  16685. }
  16686. EXPORT_SYMBOL(cfg80211_report_obss_beacon_khz);
  16687. #ifdef CONFIG_PM
  16688. static int cfg80211_net_detect_results(struct sk_buff *msg,
  16689. struct cfg80211_wowlan_wakeup *wakeup)
  16690. {
  16691. struct cfg80211_wowlan_nd_info *nd = wakeup->net_detect;
  16692. struct nlattr *nl_results, *nl_match, *nl_freqs;
  16693. int i, j;
  16694. nl_results = nla_nest_start_noflag(msg,
  16695. NL80211_WOWLAN_TRIG_NET_DETECT_RESULTS);
  16696. if (!nl_results)
  16697. return -EMSGSIZE;
  16698. for (i = 0; i < nd->n_matches; i++) {
  16699. struct cfg80211_wowlan_nd_match *match = nd->matches[i];
  16700. nl_match = nla_nest_start_noflag(msg, i);
  16701. if (!nl_match)
  16702. break;
  16703. /* The SSID attribute is optional in nl80211, but for
  16704. * simplicity reasons it's always present in the
  16705. * cfg80211 structure. If a driver can't pass the
  16706. * SSID, that needs to be changed. A zero length SSID
  16707. * is still a valid SSID (wildcard), so it cannot be
  16708. * used for this purpose.
  16709. */
  16710. if (nla_put(msg, NL80211_ATTR_SSID, match->ssid.ssid_len,
  16711. match->ssid.ssid)) {
  16712. nla_nest_cancel(msg, nl_match);
  16713. goto out;
  16714. }
  16715. if (match->n_channels) {
  16716. nl_freqs = nla_nest_start_noflag(msg,
  16717. NL80211_ATTR_SCAN_FREQUENCIES);
  16718. if (!nl_freqs) {
  16719. nla_nest_cancel(msg, nl_match);
  16720. goto out;
  16721. }
  16722. for (j = 0; j < match->n_channels; j++) {
  16723. if (nla_put_u32(msg, j, match->channels[j])) {
  16724. nla_nest_cancel(msg, nl_freqs);
  16725. nla_nest_cancel(msg, nl_match);
  16726. goto out;
  16727. }
  16728. }
  16729. nla_nest_end(msg, nl_freqs);
  16730. }
  16731. nla_nest_end(msg, nl_match);
  16732. }
  16733. out:
  16734. nla_nest_end(msg, nl_results);
  16735. return 0;
  16736. }
  16737. void cfg80211_report_wowlan_wakeup(struct wireless_dev *wdev,
  16738. struct cfg80211_wowlan_wakeup *wakeup,
  16739. gfp_t gfp)
  16740. {
  16741. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16742. struct sk_buff *msg;
  16743. void *hdr;
  16744. int size = 200;
  16745. trace_cfg80211_report_wowlan_wakeup(wdev->wiphy, wdev, wakeup);
  16746. if (wakeup)
  16747. size += wakeup->packet_present_len;
  16748. msg = nlmsg_new(size, gfp);
  16749. if (!msg)
  16750. return;
  16751. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_SET_WOWLAN);
  16752. if (!hdr)
  16753. goto free_msg;
  16754. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16755. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16756. NL80211_ATTR_PAD))
  16757. goto free_msg;
  16758. if (wdev->netdev && nla_put_u32(msg, NL80211_ATTR_IFINDEX,
  16759. wdev->netdev->ifindex))
  16760. goto free_msg;
  16761. if (wakeup) {
  16762. struct nlattr *reasons;
  16763. reasons = nla_nest_start_noflag(msg,
  16764. NL80211_ATTR_WOWLAN_TRIGGERS);
  16765. if (!reasons)
  16766. goto free_msg;
  16767. if (wakeup->disconnect &&
  16768. nla_put_flag(msg, NL80211_WOWLAN_TRIG_DISCONNECT))
  16769. goto free_msg;
  16770. if (wakeup->magic_pkt &&
  16771. nla_put_flag(msg, NL80211_WOWLAN_TRIG_MAGIC_PKT))
  16772. goto free_msg;
  16773. if (wakeup->gtk_rekey_failure &&
  16774. nla_put_flag(msg, NL80211_WOWLAN_TRIG_GTK_REKEY_FAILURE))
  16775. goto free_msg;
  16776. if (wakeup->eap_identity_req &&
  16777. nla_put_flag(msg, NL80211_WOWLAN_TRIG_EAP_IDENT_REQUEST))
  16778. goto free_msg;
  16779. if (wakeup->four_way_handshake &&
  16780. nla_put_flag(msg, NL80211_WOWLAN_TRIG_4WAY_HANDSHAKE))
  16781. goto free_msg;
  16782. if (wakeup->rfkill_release &&
  16783. nla_put_flag(msg, NL80211_WOWLAN_TRIG_RFKILL_RELEASE))
  16784. goto free_msg;
  16785. if (wakeup->pattern_idx >= 0 &&
  16786. nla_put_u32(msg, NL80211_WOWLAN_TRIG_PKT_PATTERN,
  16787. wakeup->pattern_idx))
  16788. goto free_msg;
  16789. if (wakeup->tcp_match &&
  16790. nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_MATCH))
  16791. goto free_msg;
  16792. if (wakeup->tcp_connlost &&
  16793. nla_put_flag(msg, NL80211_WOWLAN_TRIG_WAKEUP_TCP_CONNLOST))
  16794. goto free_msg;
  16795. if (wakeup->tcp_nomoretokens &&
  16796. nla_put_flag(msg,
  16797. NL80211_WOWLAN_TRIG_WAKEUP_TCP_NOMORETOKENS))
  16798. goto free_msg;
  16799. if (wakeup->unprot_deauth_disassoc &&
  16800. nla_put_flag(msg,
  16801. NL80211_WOWLAN_TRIG_UNPROTECTED_DEAUTH_DISASSOC))
  16802. goto free_msg;
  16803. if (wakeup->packet) {
  16804. u32 pkt_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211;
  16805. u32 len_attr = NL80211_WOWLAN_TRIG_WAKEUP_PKT_80211_LEN;
  16806. if (!wakeup->packet_80211) {
  16807. pkt_attr =
  16808. NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023;
  16809. len_attr =
  16810. NL80211_WOWLAN_TRIG_WAKEUP_PKT_8023_LEN;
  16811. }
  16812. if (wakeup->packet_len &&
  16813. nla_put_u32(msg, len_attr, wakeup->packet_len))
  16814. goto free_msg;
  16815. if (nla_put(msg, pkt_attr, wakeup->packet_present_len,
  16816. wakeup->packet))
  16817. goto free_msg;
  16818. }
  16819. if (wakeup->net_detect &&
  16820. cfg80211_net_detect_results(msg, wakeup))
  16821. goto free_msg;
  16822. nla_nest_end(msg, reasons);
  16823. }
  16824. genlmsg_end(msg, hdr);
  16825. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16826. NL80211_MCGRP_MLME, gfp);
  16827. return;
  16828. free_msg:
  16829. nlmsg_free(msg);
  16830. }
  16831. EXPORT_SYMBOL(cfg80211_report_wowlan_wakeup);
  16832. #endif
  16833. void cfg80211_tdls_oper_request(struct net_device *dev, const u8 *peer,
  16834. enum nl80211_tdls_operation oper,
  16835. u16 reason_code, gfp_t gfp)
  16836. {
  16837. struct wireless_dev *wdev = dev->ieee80211_ptr;
  16838. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  16839. struct sk_buff *msg;
  16840. void *hdr;
  16841. trace_cfg80211_tdls_oper_request(wdev->wiphy, dev, peer, oper,
  16842. reason_code);
  16843. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16844. if (!msg)
  16845. return;
  16846. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_TDLS_OPER);
  16847. if (!hdr) {
  16848. nlmsg_free(msg);
  16849. return;
  16850. }
  16851. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16852. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  16853. nla_put_u8(msg, NL80211_ATTR_TDLS_OPERATION, oper) ||
  16854. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, peer) ||
  16855. (reason_code > 0 &&
  16856. nla_put_u16(msg, NL80211_ATTR_REASON_CODE, reason_code)))
  16857. goto nla_put_failure;
  16858. genlmsg_end(msg, hdr);
  16859. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16860. NL80211_MCGRP_MLME, gfp);
  16861. return;
  16862. nla_put_failure:
  16863. nlmsg_free(msg);
  16864. }
  16865. EXPORT_SYMBOL(cfg80211_tdls_oper_request);
  16866. static int nl80211_netlink_notify(struct notifier_block * nb,
  16867. unsigned long state,
  16868. void *_notify)
  16869. {
  16870. struct netlink_notify *notify = _notify;
  16871. struct cfg80211_registered_device *rdev;
  16872. struct wireless_dev *wdev;
  16873. struct cfg80211_beacon_registration *reg, *tmp;
  16874. if (state != NETLINK_URELEASE || notify->protocol != NETLINK_GENERIC)
  16875. return NOTIFY_DONE;
  16876. rcu_read_lock();
  16877. list_for_each_entry_rcu(rdev, &cfg80211_rdev_list, list) {
  16878. struct cfg80211_sched_scan_request *sched_scan_req;
  16879. list_for_each_entry_rcu(sched_scan_req,
  16880. &rdev->sched_scan_req_list,
  16881. list) {
  16882. if (sched_scan_req->owner_nlportid == notify->portid) {
  16883. sched_scan_req->nl_owner_dead = true;
  16884. wiphy_work_queue(&rdev->wiphy,
  16885. &rdev->sched_scan_stop_wk);
  16886. }
  16887. }
  16888. list_for_each_entry_rcu(wdev, &rdev->wiphy.wdev_list, list) {
  16889. cfg80211_mlme_unregister_socket(wdev, notify->portid);
  16890. if (wdev->owner_nlportid == notify->portid) {
  16891. wdev->nl_owner_dead = true;
  16892. schedule_work(&rdev->destroy_work);
  16893. } else if (wdev->conn_owner_nlportid == notify->portid) {
  16894. schedule_work(&wdev->disconnect_wk);
  16895. }
  16896. cfg80211_release_pmsr(wdev, notify->portid);
  16897. }
  16898. spin_lock_bh(&rdev->beacon_registrations_lock);
  16899. list_for_each_entry_safe(reg, tmp, &rdev->beacon_registrations,
  16900. list) {
  16901. if (reg->nlportid == notify->portid) {
  16902. list_del(&reg->list);
  16903. kfree(reg);
  16904. break;
  16905. }
  16906. }
  16907. spin_unlock_bh(&rdev->beacon_registrations_lock);
  16908. }
  16909. rcu_read_unlock();
  16910. /*
  16911. * It is possible that the user space process that is controlling the
  16912. * indoor setting disappeared, so notify the regulatory core.
  16913. */
  16914. regulatory_netlink_notify(notify->portid);
  16915. return NOTIFY_OK;
  16916. }
  16917. static struct notifier_block nl80211_netlink_notifier = {
  16918. .notifier_call = nl80211_netlink_notify,
  16919. };
  16920. void cfg80211_ft_event(struct net_device *netdev,
  16921. struct cfg80211_ft_event_params *ft_event)
  16922. {
  16923. struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
  16924. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16925. struct sk_buff *msg;
  16926. void *hdr;
  16927. trace_cfg80211_ft_event(wiphy, netdev, ft_event);
  16928. if (!ft_event->target_ap)
  16929. return;
  16930. msg = nlmsg_new(100 + ft_event->ies_len + ft_event->ric_ies_len,
  16931. GFP_KERNEL);
  16932. if (!msg)
  16933. return;
  16934. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_FT_EVENT);
  16935. if (!hdr)
  16936. goto out;
  16937. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16938. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  16939. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, ft_event->target_ap))
  16940. goto out;
  16941. if (ft_event->ies &&
  16942. nla_put(msg, NL80211_ATTR_IE, ft_event->ies_len, ft_event->ies))
  16943. goto out;
  16944. if (ft_event->ric_ies &&
  16945. nla_put(msg, NL80211_ATTR_IE_RIC, ft_event->ric_ies_len,
  16946. ft_event->ric_ies))
  16947. goto out;
  16948. genlmsg_end(msg, hdr);
  16949. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  16950. NL80211_MCGRP_MLME, GFP_KERNEL);
  16951. return;
  16952. out:
  16953. nlmsg_free(msg);
  16954. }
  16955. EXPORT_SYMBOL(cfg80211_ft_event);
  16956. void cfg80211_crit_proto_stopped(struct wireless_dev *wdev, gfp_t gfp)
  16957. {
  16958. struct cfg80211_registered_device *rdev;
  16959. struct sk_buff *msg;
  16960. void *hdr;
  16961. u32 nlportid;
  16962. rdev = wiphy_to_rdev(wdev->wiphy);
  16963. if (!rdev->crit_proto_nlportid)
  16964. return;
  16965. nlportid = rdev->crit_proto_nlportid;
  16966. rdev->crit_proto_nlportid = 0;
  16967. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  16968. if (!msg)
  16969. return;
  16970. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_CRIT_PROTOCOL_STOP);
  16971. if (!hdr)
  16972. goto nla_put_failure;
  16973. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16974. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16975. NL80211_ATTR_PAD))
  16976. goto nla_put_failure;
  16977. genlmsg_end(msg, hdr);
  16978. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg, nlportid);
  16979. return;
  16980. nla_put_failure:
  16981. nlmsg_free(msg);
  16982. }
  16983. EXPORT_SYMBOL(cfg80211_crit_proto_stopped);
  16984. void nl80211_send_ap_stopped(struct wireless_dev *wdev, unsigned int link_id)
  16985. {
  16986. struct wiphy *wiphy = wdev->wiphy;
  16987. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  16988. struct sk_buff *msg;
  16989. void *hdr;
  16990. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
  16991. if (!msg)
  16992. return;
  16993. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_STOP_AP);
  16994. if (!hdr)
  16995. goto out;
  16996. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  16997. nla_put_u32(msg, NL80211_ATTR_IFINDEX, wdev->netdev->ifindex) ||
  16998. nla_put_u64_64bit(msg, NL80211_ATTR_WDEV, wdev_id(wdev),
  16999. NL80211_ATTR_PAD) ||
  17000. (wdev->valid_links &&
  17001. nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID, link_id)))
  17002. goto out;
  17003. genlmsg_end(msg, hdr);
  17004. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(wiphy), msg, 0,
  17005. NL80211_MCGRP_MLME, GFP_KERNEL);
  17006. return;
  17007. out:
  17008. nlmsg_free(msg);
  17009. }
  17010. int cfg80211_external_auth_request(struct net_device *dev,
  17011. struct cfg80211_external_auth_params *params,
  17012. gfp_t gfp)
  17013. {
  17014. struct wireless_dev *wdev = dev->ieee80211_ptr;
  17015. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  17016. struct sk_buff *msg;
  17017. void *hdr;
  17018. if (!wdev->conn_owner_nlportid)
  17019. return -EINVAL;
  17020. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  17021. if (!msg)
  17022. return -ENOMEM;
  17023. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_EXTERNAL_AUTH);
  17024. if (!hdr)
  17025. goto nla_put_failure;
  17026. /* Some historical mistakes in drivers <-> userspace interface (notably
  17027. * between drivers and wpa_supplicant) led to a big-endian conversion
  17028. * being needed on NL80211_ATTR_AKM_SUITES _only_ when its value is
  17029. * WLAN_AKM_SUITE_SAE. This is now fixed on userspace side, but for the
  17030. * benefit of older wpa_supplicant versions, send this particular value
  17031. * in big-endian. Note that newer wpa_supplicant will also detect this
  17032. * particular value in big endian still, so it all continues to work.
  17033. */
  17034. if (params->key_mgmt_suite == WLAN_AKM_SUITE_SAE) {
  17035. if (nla_put_be32(msg, NL80211_ATTR_AKM_SUITES,
  17036. cpu_to_be32(WLAN_AKM_SUITE_SAE)))
  17037. goto nla_put_failure;
  17038. } else {
  17039. if (nla_put_u32(msg, NL80211_ATTR_AKM_SUITES,
  17040. params->key_mgmt_suite))
  17041. goto nla_put_failure;
  17042. }
  17043. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  17044. nla_put_u32(msg, NL80211_ATTR_IFINDEX, dev->ifindex) ||
  17045. nla_put_u32(msg, NL80211_ATTR_EXTERNAL_AUTH_ACTION,
  17046. params->action) ||
  17047. nla_put(msg, NL80211_ATTR_BSSID, ETH_ALEN, params->bssid) ||
  17048. nla_put(msg, NL80211_ATTR_SSID, params->ssid.ssid_len,
  17049. params->ssid.ssid) ||
  17050. (!is_zero_ether_addr(params->mld_addr) &&
  17051. nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN, params->mld_addr)))
  17052. goto nla_put_failure;
  17053. genlmsg_end(msg, hdr);
  17054. genlmsg_unicast(wiphy_net(&rdev->wiphy), msg,
  17055. wdev->conn_owner_nlportid);
  17056. return 0;
  17057. nla_put_failure:
  17058. nlmsg_free(msg);
  17059. return -ENOBUFS;
  17060. }
  17061. EXPORT_SYMBOL(cfg80211_external_auth_request);
  17062. void cfg80211_update_owe_info_event(struct net_device *netdev,
  17063. struct cfg80211_update_owe_info *owe_info,
  17064. gfp_t gfp)
  17065. {
  17066. struct wiphy *wiphy = netdev->ieee80211_ptr->wiphy;
  17067. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  17068. struct sk_buff *msg;
  17069. void *hdr;
  17070. trace_cfg80211_update_owe_info_event(wiphy, netdev, owe_info);
  17071. msg = nlmsg_new(NLMSG_DEFAULT_SIZE, gfp);
  17072. if (!msg)
  17073. return;
  17074. hdr = nl80211hdr_put(msg, 0, 0, 0, NL80211_CMD_UPDATE_OWE_INFO);
  17075. if (!hdr)
  17076. goto nla_put_failure;
  17077. if (nla_put_u32(msg, NL80211_ATTR_WIPHY, rdev->wiphy_idx) ||
  17078. nla_put_u32(msg, NL80211_ATTR_IFINDEX, netdev->ifindex) ||
  17079. nla_put(msg, NL80211_ATTR_MAC, ETH_ALEN, owe_info->peer))
  17080. goto nla_put_failure;
  17081. if (!owe_info->ie_len ||
  17082. nla_put(msg, NL80211_ATTR_IE, owe_info->ie_len, owe_info->ie))
  17083. goto nla_put_failure;
  17084. if (owe_info->assoc_link_id != -1) {
  17085. if (nla_put_u8(msg, NL80211_ATTR_MLO_LINK_ID,
  17086. owe_info->assoc_link_id))
  17087. goto nla_put_failure;
  17088. if (!is_zero_ether_addr(owe_info->peer_mld_addr) &&
  17089. nla_put(msg, NL80211_ATTR_MLD_ADDR, ETH_ALEN,
  17090. owe_info->peer_mld_addr))
  17091. goto nla_put_failure;
  17092. }
  17093. genlmsg_end(msg, hdr);
  17094. genlmsg_multicast_netns(&nl80211_fam, wiphy_net(&rdev->wiphy), msg, 0,
  17095. NL80211_MCGRP_MLME, gfp);
  17096. return;
  17097. nla_put_failure:
  17098. genlmsg_cancel(msg, hdr);
  17099. nlmsg_free(msg);
  17100. }
  17101. EXPORT_SYMBOL(cfg80211_update_owe_info_event);
  17102. void cfg80211_schedule_channels_check(struct wireless_dev *wdev)
  17103. {
  17104. struct wiphy *wiphy = wdev->wiphy;
  17105. /* Schedule channels check if NO_IR or DFS relaxations are supported */
  17106. if (wdev->iftype == NL80211_IFTYPE_STATION &&
  17107. (wiphy_ext_feature_isset(wiphy,
  17108. NL80211_EXT_FEATURE_DFS_CONCURRENT) ||
  17109. (IS_ENABLED(CONFIG_CFG80211_REG_RELAX_NO_IR) &&
  17110. wiphy->regulatory_flags & REGULATORY_ENABLE_RELAX_NO_IR)))
  17111. reg_check_channels();
  17112. }
  17113. EXPORT_SYMBOL(cfg80211_schedule_channels_check);
  17114. /* initialisation/exit functions */
  17115. int __init nl80211_init(void)
  17116. {
  17117. int err;
  17118. err = genl_register_family(&nl80211_fam);
  17119. if (err)
  17120. return err;
  17121. err = netlink_register_notifier(&nl80211_netlink_notifier);
  17122. if (err)
  17123. goto err_out;
  17124. return 0;
  17125. err_out:
  17126. genl_unregister_family(&nl80211_fam);
  17127. return err;
  17128. }
  17129. void nl80211_exit(void)
  17130. {
  17131. netlink_unregister_notifier(&nl80211_netlink_notifier);
  17132. genl_unregister_family(&nl80211_fam);
  17133. }