1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * mac80211 configuration hooks for cfg80211
- *
- * Copyright 2006-2010 Johannes Berg <[email protected]>
- * Copyright 2013-2015 Intel Mobile Communications GmbH
- * Copyright (C) 2015-2017 Intel Deutschland GmbH
- * Copyright (C) 2018-2022 Intel Corporation
- */
- #include <linux/ieee80211.h>
- #include <linux/nl80211.h>
- #include <linux/rtnetlink.h>
- #include <linux/slab.h>
- #include <net/net_namespace.h>
- #include <linux/rcupdate.h>
- #include <linux/fips.h>
- #include <linux/if_ether.h>
- #include <net/cfg80211.h>
- #include "ieee80211_i.h"
- #include "driver-ops.h"
- #include "rate.h"
- #include "mesh.h"
- #include "wme.h"
- static struct ieee80211_link_data *
- ieee80211_link_or_deflink(struct ieee80211_sub_if_data *sdata, int link_id,
- bool require_valid)
- {
- struct ieee80211_link_data *link;
- if (link_id < 0) {
- /*
- * For keys, if sdata is not an MLD, we might not use
- * the return value at all (if it's not a pairwise key),
- * so in that case (require_valid==false) don't error.
- */
- if (require_valid && sdata->vif.valid_links)
- return ERR_PTR(-EINVAL);
- return &sdata->deflink;
- }
- link = sdata_dereference(sdata->link[link_id], sdata);
- if (!link)
- return ERR_PTR(-ENOLINK);
- return link;
- }
- static void ieee80211_set_mu_mimo_follow(struct ieee80211_sub_if_data *sdata,
- struct vif_params *params)
- {
- bool mu_mimo_groups = false;
- bool mu_mimo_follow = false;
- if (params->vht_mumimo_groups) {
- u64 membership;
- BUILD_BUG_ON(sizeof(membership) != WLAN_MEMBERSHIP_LEN);
- memcpy(sdata->vif.bss_conf.mu_group.membership,
- params->vht_mumimo_groups, WLAN_MEMBERSHIP_LEN);
- memcpy(sdata->vif.bss_conf.mu_group.position,
- params->vht_mumimo_groups + WLAN_MEMBERSHIP_LEN,
- WLAN_USER_POSITION_LEN);
- ieee80211_link_info_change_notify(sdata, &sdata->deflink,
- BSS_CHANGED_MU_GROUPS);
- /* don't care about endianness - just check for 0 */
- memcpy(&membership, params->vht_mumimo_groups,
- WLAN_MEMBERSHIP_LEN);
- mu_mimo_groups = membership != 0;
- }
- if (params->vht_mumimo_follow_addr) {
- mu_mimo_follow =
- is_valid_ether_addr(params->vht_mumimo_follow_addr);
- ether_addr_copy(sdata->u.mntr.mu_follow_addr,
- params->vht_mumimo_follow_addr);
- }
- sdata->vif.bss_conf.mu_mimo_owner = mu_mimo_groups || mu_mimo_follow;
- }
- static int ieee80211_set_mon_options(struct ieee80211_sub_if_data *sdata,
- struct vif_params *params)
- {
- struct ieee80211_local *local = sdata->local;
- struct ieee80211_sub_if_data *monitor_sdata;
- /* check flags first */
- if (params->flags && ieee80211_sdata_running(sdata)) {
- u32 mask = MONITOR_FLAG_COOK_FRAMES | MONITOR_FLAG_ACTIVE;
- /*
- * Prohibit MONITOR_FLAG_COOK_FRAMES and
- * MONITOR_FLAG_ACTIVE to be changed while the
- * interface is up.
- * Else we would need to add a lot of cruft
- * to update everything:
- * cooked_mntrs, monitor and all fif_* counters
- * reconfigure hardware
- */
- if ((params->flags & mask) != (sdata->u.mntr.flags & mask))
- return -EBUSY;
- }
- /* also validate MU-MIMO change */
- monitor_sdata = wiphy_dereference(local->hw.wiphy,
- local->monitor_sdata);
- if (!monitor_sdata &&
- (params->vht_mumimo_groups || params->vht_mumimo_follow_addr))
- return -EOPNOTSUPP;
- /* apply all changes now - no failures allowed */
- if (monitor_sdata)
- ieee80211_set_mu_mimo_follow(monitor_sdata, params);
- if (params->flags) {
- if (ieee80211_sdata_running(sdata)) {
- ieee80211_adjust_monitor_flags(sdata, -1);
- sdata->u.mntr.flags = params->flags;
- ieee80211_adjust_monitor_flags(sdata, 1);
- ieee80211_configure_filter(local);
- } else {
- /*
- * Because the interface is down, ieee80211_do_stop
- * and ieee80211_do_open take care of "everything"
- * mentioned in the comment above.
- */
- sdata->u.mntr.flags = params->flags;
- }
- }
- return 0;
- }
- static int ieee80211_set_ap_mbssid_options(struct ieee80211_sub_if_data *sdata,
- struct cfg80211_mbssid_config params,
- struct ieee80211_bss_conf *link_conf)
- {
- struct ieee80211_sub_if_data *tx_sdata;
- sdata->vif.mbssid_tx_vif = NULL;
- link_conf->bssid_index = 0;
- link_conf->nontransmitted = false;
- link_conf->ema_ap = false;
- link_conf->bssid_indicator = 0;
- if (sdata->vif.type != NL80211_IFTYPE_AP || !params.tx_wdev)
- return -EINVAL;
- tx_sdata = IEEE80211_WDEV_TO_SUB_IF(params.tx_wdev);
- if (!tx_sdata)
- return -EINVAL;
- if (tx_sdata == sdata) {
- sdata->vif.mbssid_tx_vif = &sdata->vif;
- } else {
- sdata->vif.mbssid_tx_vif = &tx_sdata->vif;
- link_conf->nontransmitted = true;
- link_conf->bssid_index = params.index;
- }
- if (params.ema)
- link_conf->ema_ap = true;
- return 0;
- }
- static struct wireless_dev *ieee80211_add_iface(struct wiphy *wiphy,
- const char *name,
- unsigned char name_assign_type,
- enum nl80211_iftype type,
- struct vif_params *params)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct wireless_dev *wdev;
- struct ieee80211_sub_if_data *sdata;
- int err;
- err = ieee80211_if_add(local, name, name_assign_type, &wdev, type, params);
- if (err)
- return ERR_PTR(err);
- sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- if (type == NL80211_IFTYPE_MONITOR) {
- err = ieee80211_set_mon_options(sdata, params);
- if (err) {
- ieee80211_if_remove(sdata);
- return NULL;
- }
- }
- return wdev;
- }
- static int ieee80211_del_iface(struct wiphy *wiphy, struct wireless_dev *wdev)
- {
- ieee80211_if_remove(IEEE80211_WDEV_TO_SUB_IF(wdev));
- return 0;
- }
- static int ieee80211_change_iface(struct wiphy *wiphy,
- struct net_device *dev,
- enum nl80211_iftype type,
- struct vif_params *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- struct sta_info *sta;
- int ret;
- ret = ieee80211_if_change_type(sdata, type);
- if (ret)
- return ret;
- if (type == NL80211_IFTYPE_AP_VLAN && params->use_4addr == 0) {
- RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);
- ieee80211_check_fast_rx_iface(sdata);
- } else if (type == NL80211_IFTYPE_STATION && params->use_4addr >= 0) {
- struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
- if (params->use_4addr == ifmgd->use_4addr)
- return 0;
- /* FIXME: no support for 4-addr MLO yet */
- if (sdata->vif.valid_links)
- return -EOPNOTSUPP;
- sdata->u.mgd.use_4addr = params->use_4addr;
- if (!ifmgd->associated)
- return 0;
- mutex_lock(&local->sta_mtx);
- sta = sta_info_get(sdata, sdata->deflink.u.mgd.bssid);
- if (sta)
- drv_sta_set_4addr(local, sdata, &sta->sta,
- params->use_4addr);
- mutex_unlock(&local->sta_mtx);
- if (params->use_4addr)
- ieee80211_send_4addr_nullfunc(local, sdata);
- }
- if (sdata->vif.type == NL80211_IFTYPE_MONITOR) {
- ret = ieee80211_set_mon_options(sdata, params);
- if (ret)
- return ret;
- }
- return 0;
- }
- static int ieee80211_start_p2p_device(struct wiphy *wiphy,
- struct wireless_dev *wdev)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- int ret;
- mutex_lock(&sdata->local->chanctx_mtx);
- ret = ieee80211_check_combinations(sdata, NULL, 0, 0);
- mutex_unlock(&sdata->local->chanctx_mtx);
- if (ret < 0)
- return ret;
- return ieee80211_do_open(wdev, true);
- }
- static void ieee80211_stop_p2p_device(struct wiphy *wiphy,
- struct wireless_dev *wdev)
- {
- ieee80211_sdata_stop(IEEE80211_WDEV_TO_SUB_IF(wdev));
- }
- static int ieee80211_start_nan(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- struct cfg80211_nan_conf *conf)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- int ret;
- mutex_lock(&sdata->local->chanctx_mtx);
- ret = ieee80211_check_combinations(sdata, NULL, 0, 0);
- mutex_unlock(&sdata->local->chanctx_mtx);
- if (ret < 0)
- return ret;
- ret = ieee80211_do_open(wdev, true);
- if (ret)
- return ret;
- ret = drv_start_nan(sdata->local, sdata, conf);
- if (ret)
- ieee80211_sdata_stop(sdata);
- sdata->u.nan.conf = *conf;
- return ret;
- }
- static void ieee80211_stop_nan(struct wiphy *wiphy,
- struct wireless_dev *wdev)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- drv_stop_nan(sdata->local, sdata);
- ieee80211_sdata_stop(sdata);
- }
- static int ieee80211_nan_change_conf(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- struct cfg80211_nan_conf *conf,
- u32 changes)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- struct cfg80211_nan_conf new_conf;
- int ret = 0;
- if (sdata->vif.type != NL80211_IFTYPE_NAN)
- return -EOPNOTSUPP;
- if (!ieee80211_sdata_running(sdata))
- return -ENETDOWN;
- new_conf = sdata->u.nan.conf;
- if (changes & CFG80211_NAN_CONF_CHANGED_PREF)
- new_conf.master_pref = conf->master_pref;
- if (changes & CFG80211_NAN_CONF_CHANGED_BANDS)
- new_conf.bands = conf->bands;
- ret = drv_nan_change_conf(sdata->local, sdata, &new_conf, changes);
- if (!ret)
- sdata->u.nan.conf = new_conf;
- return ret;
- }
- static int ieee80211_add_nan_func(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- struct cfg80211_nan_func *nan_func)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- int ret;
- if (sdata->vif.type != NL80211_IFTYPE_NAN)
- return -EOPNOTSUPP;
- if (!ieee80211_sdata_running(sdata))
- return -ENETDOWN;
- spin_lock_bh(&sdata->u.nan.func_lock);
- ret = idr_alloc(&sdata->u.nan.function_inst_ids,
- nan_func, 1, sdata->local->hw.max_nan_de_entries + 1,
- GFP_ATOMIC);
- spin_unlock_bh(&sdata->u.nan.func_lock);
- if (ret < 0)
- return ret;
- nan_func->instance_id = ret;
- WARN_ON(nan_func->instance_id == 0);
- ret = drv_add_nan_func(sdata->local, sdata, nan_func);
- if (ret) {
- spin_lock_bh(&sdata->u.nan.func_lock);
- idr_remove(&sdata->u.nan.function_inst_ids,
- nan_func->instance_id);
- spin_unlock_bh(&sdata->u.nan.func_lock);
- }
- return ret;
- }
- static struct cfg80211_nan_func *
- ieee80211_find_nan_func_by_cookie(struct ieee80211_sub_if_data *sdata,
- u64 cookie)
- {
- struct cfg80211_nan_func *func;
- int id;
- lockdep_assert_held(&sdata->u.nan.func_lock);
- idr_for_each_entry(&sdata->u.nan.function_inst_ids, func, id) {
- if (func->cookie == cookie)
- return func;
- }
- return NULL;
- }
- static void ieee80211_del_nan_func(struct wiphy *wiphy,
- struct wireless_dev *wdev, u64 cookie)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- struct cfg80211_nan_func *func;
- u8 instance_id = 0;
- if (sdata->vif.type != NL80211_IFTYPE_NAN ||
- !ieee80211_sdata_running(sdata))
- return;
- spin_lock_bh(&sdata->u.nan.func_lock);
- func = ieee80211_find_nan_func_by_cookie(sdata, cookie);
- if (func)
- instance_id = func->instance_id;
- spin_unlock_bh(&sdata->u.nan.func_lock);
- if (instance_id)
- drv_del_nan_func(sdata->local, sdata, instance_id);
- }
- static int ieee80211_set_noack_map(struct wiphy *wiphy,
- struct net_device *dev,
- u16 noack_map)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- sdata->noack_map = noack_map;
- ieee80211_check_fast_xmit_iface(sdata);
- return 0;
- }
- static int ieee80211_set_tx(struct ieee80211_sub_if_data *sdata,
- const u8 *mac_addr, u8 key_idx)
- {
- struct ieee80211_local *local = sdata->local;
- struct ieee80211_key *key;
- struct sta_info *sta;
- int ret = -EINVAL;
- if (!wiphy_ext_feature_isset(local->hw.wiphy,
- NL80211_EXT_FEATURE_EXT_KEY_ID))
- return -EINVAL;
- sta = sta_info_get_bss(sdata, mac_addr);
- if (!sta)
- return -EINVAL;
- if (sta->ptk_idx == key_idx)
- return 0;
- mutex_lock(&local->key_mtx);
- key = key_mtx_dereference(local, sta->ptk[key_idx]);
- if (key && key->conf.flags & IEEE80211_KEY_FLAG_NO_AUTO_TX)
- ret = ieee80211_set_tx_key(key);
- mutex_unlock(&local->key_mtx);
- return ret;
- }
- static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev,
- int link_id, u8 key_idx, bool pairwise,
- const u8 *mac_addr, struct key_params *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_link_data *link =
- ieee80211_link_or_deflink(sdata, link_id, false);
- struct ieee80211_local *local = sdata->local;
- struct sta_info *sta = NULL;
- struct ieee80211_key *key;
- int err;
- if (!ieee80211_sdata_running(sdata))
- return -ENETDOWN;
- if (IS_ERR(link))
- return PTR_ERR(link);
- if (pairwise && params->mode == NL80211_KEY_SET_TX)
- return ieee80211_set_tx(sdata, mac_addr, key_idx);
- /* reject WEP and TKIP keys if WEP failed to initialize */
- switch (params->cipher) {
- case WLAN_CIPHER_SUITE_WEP40:
- case WLAN_CIPHER_SUITE_TKIP:
- case WLAN_CIPHER_SUITE_WEP104:
- if (link_id >= 0)
- return -EINVAL;
- if (WARN_ON_ONCE(fips_enabled))
- return -EINVAL;
- break;
- default:
- break;
- }
- key = ieee80211_key_alloc(params->cipher, key_idx, params->key_len,
- params->key, params->seq_len, params->seq);
- if (IS_ERR(key))
- return PTR_ERR(key);
- key->conf.link_id = link_id;
- if (pairwise)
- key->conf.flags |= IEEE80211_KEY_FLAG_PAIRWISE;
- if (params->mode == NL80211_KEY_NO_TX)
- key->conf.flags |= IEEE80211_KEY_FLAG_NO_AUTO_TX;
- mutex_lock(&local->sta_mtx);
- if (mac_addr) {
- sta = sta_info_get_bss(sdata, mac_addr);
- /*
- * The ASSOC test makes sure the driver is ready to
- * receive the key. When wpa_supplicant has roamed
- * using FT, it attempts to set the key before
- * association has completed, this rejects that attempt
- * so it will set the key again after association.
- *
- * TODO: accept the key if we have a station entry and
- * add it to the device after the station.
- */
- if (!sta || !test_sta_flag(sta, WLAN_STA_ASSOC)) {
- ieee80211_key_free_unused(key);
- err = -ENOENT;
- goto out_unlock;
- }
- }
- switch (sdata->vif.type) {
- case NL80211_IFTYPE_STATION:
- if (sdata->u.mgd.mfp != IEEE80211_MFP_DISABLED)
- key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
- break;
- case NL80211_IFTYPE_AP:
- case NL80211_IFTYPE_AP_VLAN:
- /* Keys without a station are used for TX only */
- if (sta && test_sta_flag(sta, WLAN_STA_MFP))
- key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
- break;
- case NL80211_IFTYPE_ADHOC:
- /* no MFP (yet) */
- break;
- case NL80211_IFTYPE_MESH_POINT:
- #ifdef CONFIG_MAC80211_MESH
- if (sdata->u.mesh.security != IEEE80211_MESH_SEC_NONE)
- key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
- break;
- #endif
- case NL80211_IFTYPE_WDS:
- case NL80211_IFTYPE_MONITOR:
- case NL80211_IFTYPE_P2P_DEVICE:
- case NL80211_IFTYPE_NAN:
- case NL80211_IFTYPE_UNSPECIFIED:
- case NUM_NL80211_IFTYPES:
- case NL80211_IFTYPE_P2P_CLIENT:
- case NL80211_IFTYPE_P2P_GO:
- case NL80211_IFTYPE_OCB:
- /* shouldn't happen */
- WARN_ON_ONCE(1);
- break;
- }
- err = ieee80211_key_link(key, link, sta);
- /* KRACK protection, shouldn't happen but just silently accept key */
- if (err == -EALREADY)
- err = 0;
- out_unlock:
- mutex_unlock(&local->sta_mtx);
- return err;
- }
- static struct ieee80211_key *
- ieee80211_lookup_key(struct ieee80211_sub_if_data *sdata, int link_id,
- u8 key_idx, bool pairwise, const u8 *mac_addr)
- {
- struct ieee80211_local *local __maybe_unused = sdata->local;
- struct ieee80211_link_data *link = &sdata->deflink;
- struct ieee80211_key *key;
- if (link_id >= 0) {
- link = rcu_dereference_check(sdata->link[link_id],
- lockdep_is_held(&sdata->wdev.mtx));
- if (!link)
- return NULL;
- }
- if (mac_addr) {
- struct sta_info *sta;
- struct link_sta_info *link_sta;
- sta = sta_info_get_bss(sdata, mac_addr);
- if (!sta)
- return NULL;
- if (link_id >= 0) {
- link_sta = rcu_dereference_check(sta->link[link_id],
- lockdep_is_held(&local->sta_mtx));
- if (!link_sta)
- return NULL;
- } else {
- link_sta = &sta->deflink;
- }
- if (pairwise && key_idx < NUM_DEFAULT_KEYS)
- return rcu_dereference_check_key_mtx(local,
- sta->ptk[key_idx]);
- if (!pairwise &&
- key_idx < NUM_DEFAULT_KEYS +
- NUM_DEFAULT_MGMT_KEYS +
- NUM_DEFAULT_BEACON_KEYS)
- return rcu_dereference_check_key_mtx(local,
- link_sta->gtk[key_idx]);
- return NULL;
- }
- if (pairwise && key_idx < NUM_DEFAULT_KEYS)
- return rcu_dereference_check_key_mtx(local,
- sdata->keys[key_idx]);
- key = rcu_dereference_check_key_mtx(local, link->gtk[key_idx]);
- if (key)
- return key;
- /* or maybe it was a WEP key */
- if (key_idx < NUM_DEFAULT_KEYS)
- return rcu_dereference_check_key_mtx(local, sdata->keys[key_idx]);
- return NULL;
- }
- static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
- int link_id, u8 key_idx, bool pairwise,
- const u8 *mac_addr)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- struct ieee80211_key *key;
- int ret;
- mutex_lock(&local->sta_mtx);
- mutex_lock(&local->key_mtx);
- key = ieee80211_lookup_key(sdata, link_id, key_idx, pairwise, mac_addr);
- if (!key) {
- ret = -ENOENT;
- goto out_unlock;
- }
- ieee80211_key_free(key, sdata->vif.type == NL80211_IFTYPE_STATION);
- ret = 0;
- out_unlock:
- mutex_unlock(&local->key_mtx);
- mutex_unlock(&local->sta_mtx);
- return ret;
- }
- static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev,
- int link_id, u8 key_idx, bool pairwise,
- const u8 *mac_addr, void *cookie,
- void (*callback)(void *cookie,
- struct key_params *params))
- {
- struct ieee80211_sub_if_data *sdata;
- u8 seq[6] = {0};
- struct key_params params;
- struct ieee80211_key *key;
- u64 pn64;
- u32 iv32;
- u16 iv16;
- int err = -ENOENT;
- struct ieee80211_key_seq kseq = {};
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- rcu_read_lock();
- key = ieee80211_lookup_key(sdata, link_id, key_idx, pairwise, mac_addr);
- if (!key)
- goto out;
- memset(¶ms, 0, sizeof(params));
- params.cipher = key->conf.cipher;
- switch (key->conf.cipher) {
- case WLAN_CIPHER_SUITE_TKIP:
- pn64 = atomic64_read(&key->conf.tx_pn);
- iv32 = TKIP_PN_TO_IV32(pn64);
- iv16 = TKIP_PN_TO_IV16(pn64);
- if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE &&
- !(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) {
- drv_get_key_seq(sdata->local, key, &kseq);
- iv32 = kseq.tkip.iv32;
- iv16 = kseq.tkip.iv16;
- }
- seq[0] = iv16 & 0xff;
- seq[1] = (iv16 >> 8) & 0xff;
- seq[2] = iv32 & 0xff;
- seq[3] = (iv32 >> 8) & 0xff;
- seq[4] = (iv32 >> 16) & 0xff;
- seq[5] = (iv32 >> 24) & 0xff;
- params.seq = seq;
- params.seq_len = 6;
- break;
- case WLAN_CIPHER_SUITE_CCMP:
- case WLAN_CIPHER_SUITE_CCMP_256:
- case WLAN_CIPHER_SUITE_AES_CMAC:
- case WLAN_CIPHER_SUITE_BIP_CMAC_256:
- BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
- offsetof(typeof(kseq), aes_cmac));
- fallthrough;
- case WLAN_CIPHER_SUITE_BIP_GMAC_128:
- case WLAN_CIPHER_SUITE_BIP_GMAC_256:
- BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
- offsetof(typeof(kseq), aes_gmac));
- fallthrough;
- case WLAN_CIPHER_SUITE_GCMP:
- case WLAN_CIPHER_SUITE_GCMP_256:
- BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
- offsetof(typeof(kseq), gcmp));
- if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE &&
- !(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) {
- drv_get_key_seq(sdata->local, key, &kseq);
- memcpy(seq, kseq.ccmp.pn, 6);
- } else {
- pn64 = atomic64_read(&key->conf.tx_pn);
- seq[0] = pn64;
- seq[1] = pn64 >> 8;
- seq[2] = pn64 >> 16;
- seq[3] = pn64 >> 24;
- seq[4] = pn64 >> 32;
- seq[5] = pn64 >> 40;
- }
- params.seq = seq;
- params.seq_len = 6;
- break;
- default:
- if (!(key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE))
- break;
- if (WARN_ON(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV))
- break;
- drv_get_key_seq(sdata->local, key, &kseq);
- params.seq = kseq.hw.seq;
- params.seq_len = kseq.hw.seq_len;
- break;
- }
- params.key = key->conf.key;
- params.key_len = key->conf.keylen;
- callback(cookie, ¶ms);
- err = 0;
- out:
- rcu_read_unlock();
- return err;
- }
- static int ieee80211_config_default_key(struct wiphy *wiphy,
- struct net_device *dev,
- int link_id, u8 key_idx, bool uni,
- bool multi)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_link_data *link =
- ieee80211_link_or_deflink(sdata, link_id, false);
- if (IS_ERR(link))
- return PTR_ERR(link);
- ieee80211_set_default_key(link, key_idx, uni, multi);
- return 0;
- }
- static int ieee80211_config_default_mgmt_key(struct wiphy *wiphy,
- struct net_device *dev,
- int link_id, u8 key_idx)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_link_data *link =
- ieee80211_link_or_deflink(sdata, link_id, true);
- if (IS_ERR(link))
- return PTR_ERR(link);
- ieee80211_set_default_mgmt_key(link, key_idx);
- return 0;
- }
- static int ieee80211_config_default_beacon_key(struct wiphy *wiphy,
- struct net_device *dev,
- int link_id, u8 key_idx)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_link_data *link =
- ieee80211_link_or_deflink(sdata, link_id, true);
- if (IS_ERR(link))
- return PTR_ERR(link);
- ieee80211_set_default_beacon_key(link, key_idx);
- return 0;
- }
- void sta_set_rate_info_tx(struct sta_info *sta,
- const struct ieee80211_tx_rate *rate,
- struct rate_info *rinfo)
- {
- rinfo->flags = 0;
- if (rate->flags & IEEE80211_TX_RC_MCS) {
- rinfo->flags |= RATE_INFO_FLAGS_MCS;
- rinfo->mcs = rate->idx;
- } else if (rate->flags & IEEE80211_TX_RC_VHT_MCS) {
- rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS;
- rinfo->mcs = ieee80211_rate_get_vht_mcs(rate);
- rinfo->nss = ieee80211_rate_get_vht_nss(rate);
- } else {
- struct ieee80211_supported_band *sband;
- int shift = ieee80211_vif_get_shift(&sta->sdata->vif);
- u16 brate;
- sband = ieee80211_get_sband(sta->sdata);
- WARN_ON_ONCE(sband && !sband->bitrates);
- if (sband && sband->bitrates) {
- brate = sband->bitrates[rate->idx].bitrate;
- rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
- }
- }
- if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
- rinfo->bw = RATE_INFO_BW_40;
- else if (rate->flags & IEEE80211_TX_RC_80_MHZ_WIDTH)
- rinfo->bw = RATE_INFO_BW_80;
- else if (rate->flags & IEEE80211_TX_RC_160_MHZ_WIDTH)
- rinfo->bw = RATE_INFO_BW_160;
- else
- rinfo->bw = RATE_INFO_BW_20;
- if (rate->flags & IEEE80211_TX_RC_SHORT_GI)
- rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI;
- }
- static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
- int idx, u8 *mac, struct station_info *sinfo)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- struct sta_info *sta;
- int ret = -ENOENT;
- mutex_lock(&local->sta_mtx);
- sta = sta_info_get_by_idx(sdata, idx);
- if (sta) {
- ret = 0;
- memcpy(mac, sta->sta.addr, ETH_ALEN);
- sta_set_sinfo(sta, sinfo, true);
- }
- mutex_unlock(&local->sta_mtx);
- return ret;
- }
- static int ieee80211_dump_survey(struct wiphy *wiphy, struct net_device *dev,
- int idx, struct survey_info *survey)
- {
- struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
- return drv_get_survey(local, idx, survey);
- }
- static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev,
- const u8 *mac, struct station_info *sinfo)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- struct sta_info *sta;
- int ret = -ENOENT;
- mutex_lock(&local->sta_mtx);
- sta = sta_info_get_bss(sdata, mac);
- if (sta) {
- ret = 0;
- sta_set_sinfo(sta, sinfo, true);
- }
- mutex_unlock(&local->sta_mtx);
- return ret;
- }
- static int ieee80211_set_monitor_channel(struct wiphy *wiphy,
- struct cfg80211_chan_def *chandef)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata;
- int ret = 0;
- if (cfg80211_chandef_identical(&local->monitor_chandef, chandef))
- return 0;
- mutex_lock(&local->mtx);
- if (local->use_chanctx) {
- sdata = wiphy_dereference(local->hw.wiphy,
- local->monitor_sdata);
- if (sdata) {
- ieee80211_link_release_channel(&sdata->deflink);
- ret = ieee80211_link_use_channel(&sdata->deflink,
- chandef,
- IEEE80211_CHANCTX_EXCLUSIVE);
- }
- } else if (local->open_count == local->monitors) {
- local->_oper_chandef = *chandef;
- ieee80211_hw_config(local, 0);
- }
- if (ret == 0)
- local->monitor_chandef = *chandef;
- mutex_unlock(&local->mtx);
- return ret;
- }
- static int
- ieee80211_set_probe_resp(struct ieee80211_sub_if_data *sdata,
- const u8 *resp, size_t resp_len,
- const struct ieee80211_csa_settings *csa,
- const struct ieee80211_color_change_settings *cca,
- struct ieee80211_link_data *link)
- {
- struct probe_resp *new, *old;
- if (!resp || !resp_len)
- return 1;
- old = sdata_dereference(link->u.ap.probe_resp, sdata);
- new = kzalloc(sizeof(struct probe_resp) + resp_len, GFP_KERNEL);
- if (!new)
- return -ENOMEM;
- new->len = resp_len;
- memcpy(new->data, resp, resp_len);
- if (csa)
- memcpy(new->cntdwn_counter_offsets, csa->counter_offsets_presp,
- csa->n_counter_offsets_presp *
- sizeof(new->cntdwn_counter_offsets[0]));
- else if (cca)
- new->cntdwn_counter_offsets[0] = cca->counter_offset_presp;
- rcu_assign_pointer(link->u.ap.probe_resp, new);
- if (old)
- kfree_rcu(old, rcu_head);
- return 0;
- }
- static int ieee80211_set_fils_discovery(struct ieee80211_sub_if_data *sdata,
- struct cfg80211_fils_discovery *params,
- struct ieee80211_link_data *link,
- struct ieee80211_bss_conf *link_conf)
- {
- struct fils_discovery_data *new, *old = NULL;
- struct ieee80211_fils_discovery *fd;
- if (!params->tmpl || !params->tmpl_len)
- return -EINVAL;
- fd = &link_conf->fils_discovery;
- fd->min_interval = params->min_interval;
- fd->max_interval = params->max_interval;
- old = sdata_dereference(link->u.ap.fils_discovery, sdata);
- new = kzalloc(sizeof(*new) + params->tmpl_len, GFP_KERNEL);
- if (!new)
- return -ENOMEM;
- new->len = params->tmpl_len;
- memcpy(new->data, params->tmpl, params->tmpl_len);
- rcu_assign_pointer(link->u.ap.fils_discovery, new);
- if (old)
- kfree_rcu(old, rcu_head);
- return 0;
- }
- static int
- ieee80211_set_unsol_bcast_probe_resp(struct ieee80211_sub_if_data *sdata,
- struct cfg80211_unsol_bcast_probe_resp *params,
- struct ieee80211_link_data *link,
- struct ieee80211_bss_conf *link_conf)
- {
- struct unsol_bcast_probe_resp_data *new, *old = NULL;
- if (!params->tmpl || !params->tmpl_len)
- return -EINVAL;
- old = sdata_dereference(link->u.ap.unsol_bcast_probe_resp, sdata);
- new = kzalloc(sizeof(*new) + params->tmpl_len, GFP_KERNEL);
- if (!new)
- return -ENOMEM;
- new->len = params->tmpl_len;
- memcpy(new->data, params->tmpl, params->tmpl_len);
- rcu_assign_pointer(link->u.ap.unsol_bcast_probe_resp, new);
- if (old)
- kfree_rcu(old, rcu_head);
- link_conf->unsol_bcast_probe_resp_interval = params->interval;
- return 0;
- }
- static int ieee80211_set_ftm_responder_params(
- struct ieee80211_sub_if_data *sdata,
- const u8 *lci, size_t lci_len,
- const u8 *civicloc, size_t civicloc_len,
- struct ieee80211_bss_conf *link_conf)
- {
- struct ieee80211_ftm_responder_params *new, *old;
- u8 *pos;
- int len;
- if (!lci_len && !civicloc_len)
- return 0;
- old = link_conf->ftmr_params;
- len = lci_len + civicloc_len;
- new = kzalloc(sizeof(*new) + len, GFP_KERNEL);
- if (!new)
- return -ENOMEM;
- pos = (u8 *)(new + 1);
- if (lci_len) {
- new->lci_len = lci_len;
- new->lci = pos;
- memcpy(pos, lci, lci_len);
- pos += lci_len;
- }
- if (civicloc_len) {
- new->civicloc_len = civicloc_len;
- new->civicloc = pos;
- memcpy(pos, civicloc, civicloc_len);
- pos += civicloc_len;
- }
- link_conf->ftmr_params = new;
- kfree(old);
- return 0;
- }
- static int
- ieee80211_copy_mbssid_beacon(u8 *pos, struct cfg80211_mbssid_elems *dst,
- struct cfg80211_mbssid_elems *src)
- {
- int i, offset = 0;
- for (i = 0; i < src->cnt; i++) {
- memcpy(pos + offset, src->elem[i].data, src->elem[i].len);
- dst->elem[i].len = src->elem[i].len;
- dst->elem[i].data = pos + offset;
- offset += dst->elem[i].len;
- }
- dst->cnt = src->cnt;
- return offset;
- }
- static int ieee80211_assign_beacon(struct ieee80211_sub_if_data *sdata,
- struct ieee80211_link_data *link,
- struct cfg80211_beacon_data *params,
- const struct ieee80211_csa_settings *csa,
- const struct ieee80211_color_change_settings *cca)
- {
- struct cfg80211_mbssid_elems *mbssid = NULL;
- struct beacon_data *new, *old;
- int new_head_len, new_tail_len;
- int size, err;
- u32 changed = BSS_CHANGED_BEACON;
- struct ieee80211_bss_conf *link_conf = link->conf;
- old = sdata_dereference(link->u.ap.beacon, sdata);
- /* Need to have a beacon head if we don't have one yet */
- if (!params->head && !old)
- return -EINVAL;
- /* new or old head? */
- if (params->head)
- new_head_len = params->head_len;
- else
- new_head_len = old->head_len;
- /* new or old tail? */
- if (params->tail || !old)
- /* params->tail_len will be zero for !params->tail */
- new_tail_len = params->tail_len;
- else
- new_tail_len = old->tail_len;
- size = sizeof(*new) + new_head_len + new_tail_len;
- /* new or old multiple BSSID elements? */
- if (params->mbssid_ies) {
- mbssid = params->mbssid_ies;
- size += struct_size(new->mbssid_ies, elem, mbssid->cnt);
- size += ieee80211_get_mbssid_beacon_len(mbssid);
- } else if (old && old->mbssid_ies) {
- mbssid = old->mbssid_ies;
- size += struct_size(new->mbssid_ies, elem, mbssid->cnt);
- size += ieee80211_get_mbssid_beacon_len(mbssid);
- }
- new = kzalloc(size, GFP_KERNEL);
- if (!new)
- return -ENOMEM;
- /* start filling the new info now */
- /*
- * pointers go into the block we allocated,
- * memory is | beacon_data | head | tail | mbssid_ies
- */
- new->head = ((u8 *) new) + sizeof(*new);
- new->tail = new->head + new_head_len;
- new->head_len = new_head_len;
- new->tail_len = new_tail_len;
- /* copy in optional mbssid_ies */
- if (mbssid) {
- u8 *pos = new->tail + new->tail_len;
- new->mbssid_ies = (void *)pos;
- pos += struct_size(new->mbssid_ies, elem, mbssid->cnt);
- ieee80211_copy_mbssid_beacon(pos, new->mbssid_ies, mbssid);
- /* update bssid_indicator */
- link_conf->bssid_indicator =
- ilog2(__roundup_pow_of_two(mbssid->cnt + 1));
- }
- if (csa) {
- new->cntdwn_current_counter = csa->count;
- memcpy(new->cntdwn_counter_offsets, csa->counter_offsets_beacon,
- csa->n_counter_offsets_beacon *
- sizeof(new->cntdwn_counter_offsets[0]));
- } else if (cca) {
- new->cntdwn_current_counter = cca->count;
- new->cntdwn_counter_offsets[0] = cca->counter_offset_beacon;
- }
- /* copy in head */
- if (params->head)
- memcpy(new->head, params->head, new_head_len);
- else
- memcpy(new->head, old->head, new_head_len);
- /* copy in optional tail */
- if (params->tail)
- memcpy(new->tail, params->tail, new_tail_len);
- else
- if (old)
- memcpy(new->tail, old->tail, new_tail_len);
- err = ieee80211_set_probe_resp(sdata, params->probe_resp,
- params->probe_resp_len, csa, cca, link);
- if (err < 0) {
- kfree(new);
- return err;
- }
- if (err == 0)
- changed |= BSS_CHANGED_AP_PROBE_RESP;
- if (params->ftm_responder != -1) {
- link_conf->ftm_responder = params->ftm_responder;
- err = ieee80211_set_ftm_responder_params(sdata,
- params->lci,
- params->lci_len,
- params->civicloc,
- params->civicloc_len,
- link_conf);
- if (err < 0) {
- kfree(new);
- return err;
- }
- changed |= BSS_CHANGED_FTM_RESPONDER;
- }
- rcu_assign_pointer(link->u.ap.beacon, new);
- sdata->u.ap.active = true;
- if (old)
- kfree_rcu(old, rcu_head);
- return changed;
- }
- static int ieee80211_start_ap(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_ap_settings *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- struct beacon_data *old;
- struct ieee80211_sub_if_data *vlan;
- u32 changed = BSS_CHANGED_BEACON_INT |
- BSS_CHANGED_BEACON_ENABLED |
- BSS_CHANGED_BEACON |
- BSS_CHANGED_P2P_PS |
- BSS_CHANGED_TXPOWER |
- BSS_CHANGED_TWT;
- int i, err;
- int prev_beacon_int;
- unsigned int link_id = params->beacon.link_id;
- struct ieee80211_link_data *link;
- struct ieee80211_bss_conf *link_conf;
- link = sdata_dereference(sdata->link[link_id], sdata);
- if (!link)
- return -ENOLINK;
- link_conf = link->conf;
- old = sdata_dereference(link->u.ap.beacon, sdata);
- if (old)
- return -EALREADY;
- if (params->smps_mode != NL80211_SMPS_OFF)
- return -ENOTSUPP;
- link->smps_mode = IEEE80211_SMPS_OFF;
- link->needed_rx_chains = sdata->local->rx_chains;
- prev_beacon_int = link_conf->beacon_int;
- link_conf->beacon_int = params->beacon_interval;
- if (params->he_cap && params->he_oper) {
- link_conf->he_support = true;
- link_conf->htc_trig_based_pkt_ext =
- le32_get_bits(params->he_oper->he_oper_params,
- IEEE80211_HE_OPERATION_DFLT_PE_DURATION_MASK);
- link_conf->frame_time_rts_th =
- le32_get_bits(params->he_oper->he_oper_params,
- IEEE80211_HE_OPERATION_RTS_THRESHOLD_MASK);
- changed |= BSS_CHANGED_HE_OBSS_PD;
- if (params->beacon.he_bss_color.enabled)
- changed |= BSS_CHANGED_HE_BSS_COLOR;
- }
- if (sdata->vif.type == NL80211_IFTYPE_AP &&
- params->mbssid_config.tx_wdev) {
- err = ieee80211_set_ap_mbssid_options(sdata,
- params->mbssid_config,
- link_conf);
- if (err)
- return err;
- }
- mutex_lock(&local->mtx);
- err = ieee80211_link_use_channel(link, ¶ms->chandef,
- IEEE80211_CHANCTX_SHARED);
- if (!err)
- ieee80211_link_copy_chanctx_to_vlans(link, false);
- mutex_unlock(&local->mtx);
- if (err) {
- link_conf->beacon_int = prev_beacon_int;
- return err;
- }
- /*
- * Apply control port protocol, this allows us to
- * not encrypt dynamic WEP control frames.
- */
- sdata->control_port_protocol = params->crypto.control_port_ethertype;
- sdata->control_port_no_encrypt = params->crypto.control_port_no_encrypt;
- sdata->control_port_over_nl80211 =
- params->crypto.control_port_over_nl80211;
- sdata->control_port_no_preauth =
- params->crypto.control_port_no_preauth;
- list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list) {
- vlan->control_port_protocol =
- params->crypto.control_port_ethertype;
- vlan->control_port_no_encrypt =
- params->crypto.control_port_no_encrypt;
- vlan->control_port_over_nl80211 =
- params->crypto.control_port_over_nl80211;
- vlan->control_port_no_preauth =
- params->crypto.control_port_no_preauth;
- }
- link_conf->dtim_period = params->dtim_period;
- link_conf->enable_beacon = true;
- link_conf->allow_p2p_go_ps = sdata->vif.p2p;
- link_conf->twt_responder = params->twt_responder;
- link_conf->he_obss_pd = params->he_obss_pd;
- link_conf->he_bss_color = params->beacon.he_bss_color;
- sdata->vif.cfg.s1g = params->chandef.chan->band ==
- NL80211_BAND_S1GHZ;
- sdata->vif.cfg.ssid_len = params->ssid_len;
- if (params->ssid_len)
- memcpy(sdata->vif.cfg.ssid, params->ssid,
- params->ssid_len);
- link_conf->hidden_ssid =
- (params->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE);
- memset(&link_conf->p2p_noa_attr, 0,
- sizeof(link_conf->p2p_noa_attr));
- link_conf->p2p_noa_attr.oppps_ctwindow =
- params->p2p_ctwindow & IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
- if (params->p2p_opp_ps)
- link_conf->p2p_noa_attr.oppps_ctwindow |=
- IEEE80211_P2P_OPPPS_ENABLE_BIT;
- sdata->beacon_rate_set = false;
- if (wiphy_ext_feature_isset(local->hw.wiphy,
- NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) {
- for (i = 0; i < NUM_NL80211_BANDS; i++) {
- sdata->beacon_rateidx_mask[i] =
- params->beacon_rate.control[i].legacy;
- if (sdata->beacon_rateidx_mask[i])
- sdata->beacon_rate_set = true;
- }
- }
- if (ieee80211_hw_check(&local->hw, HAS_RATE_CONTROL))
- link_conf->beacon_tx_rate = params->beacon_rate;
- err = ieee80211_assign_beacon(sdata, link, ¶ms->beacon, NULL, NULL);
- if (err < 0)
- goto error;
- changed |= err;
- if (params->fils_discovery.max_interval) {
- err = ieee80211_set_fils_discovery(sdata,
- ¶ms->fils_discovery,
- link, link_conf);
- if (err < 0)
- goto error;
- changed |= BSS_CHANGED_FILS_DISCOVERY;
- }
- if (params->unsol_bcast_probe_resp.interval) {
- err = ieee80211_set_unsol_bcast_probe_resp(sdata,
- ¶ms->unsol_bcast_probe_resp,
- link, link_conf);
- if (err < 0)
- goto error;
- changed |= BSS_CHANGED_UNSOL_BCAST_PROBE_RESP;
- }
- err = drv_start_ap(sdata->local, sdata, link_conf);
- if (err) {
- old = sdata_dereference(link->u.ap.beacon, sdata);
- if (old)
- kfree_rcu(old, rcu_head);
- RCU_INIT_POINTER(link->u.ap.beacon, NULL);
- sdata->u.ap.active = false;
- goto error;
- }
- ieee80211_recalc_dtim(local, sdata);
- ieee80211_vif_cfg_change_notify(sdata, BSS_CHANGED_SSID);
- ieee80211_link_info_change_notify(sdata, link, changed);
- netif_carrier_on(dev);
- list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list)
- netif_carrier_on(vlan->dev);
- return 0;
- error:
- mutex_lock(&local->mtx);
- ieee80211_link_release_channel(link);
- mutex_unlock(&local->mtx);
- return err;
- }
- static int ieee80211_change_beacon(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_beacon_data *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_link_data *link;
- struct beacon_data *old;
- int err;
- struct ieee80211_bss_conf *link_conf;
- sdata_assert_lock(sdata);
- link = sdata_dereference(sdata->link[params->link_id], sdata);
- if (!link)
- return -ENOLINK;
- link_conf = link->conf;
- /* don't allow changing the beacon while a countdown is in place - offset
- * of channel switch counter may change
- */
- if (link_conf->csa_active || link_conf->color_change_active)
- return -EBUSY;
- old = sdata_dereference(link->u.ap.beacon, sdata);
- if (!old)
- return -ENOENT;
- err = ieee80211_assign_beacon(sdata, link, params, NULL, NULL);
- if (err < 0)
- return err;
- if (params->he_bss_color_valid &&
- params->he_bss_color.enabled != link_conf->he_bss_color.enabled) {
- link_conf->he_bss_color.enabled = params->he_bss_color.enabled;
- err |= BSS_CHANGED_HE_BSS_COLOR;
- }
- ieee80211_link_info_change_notify(sdata, link, err);
- return 0;
- }
- static void ieee80211_free_next_beacon(struct ieee80211_link_data *link)
- {
- if (!link->u.ap.next_beacon)
- return;
- kfree(link->u.ap.next_beacon->mbssid_ies);
- kfree(link->u.ap.next_beacon);
- link->u.ap.next_beacon = NULL;
- }
- static int ieee80211_stop_ap(struct wiphy *wiphy, struct net_device *dev,
- unsigned int link_id)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_sub_if_data *vlan;
- struct ieee80211_local *local = sdata->local;
- struct beacon_data *old_beacon;
- struct probe_resp *old_probe_resp;
- struct fils_discovery_data *old_fils_discovery;
- struct unsol_bcast_probe_resp_data *old_unsol_bcast_probe_resp;
- struct cfg80211_chan_def chandef;
- struct ieee80211_link_data *link =
- sdata_dereference(sdata->link[link_id], sdata);
- struct ieee80211_bss_conf *link_conf = link->conf;
- sdata_assert_lock(sdata);
- old_beacon = sdata_dereference(link->u.ap.beacon, sdata);
- if (!old_beacon)
- return -ENOENT;
- old_probe_resp = sdata_dereference(link->u.ap.probe_resp,
- sdata);
- old_fils_discovery = sdata_dereference(link->u.ap.fils_discovery,
- sdata);
- old_unsol_bcast_probe_resp =
- sdata_dereference(link->u.ap.unsol_bcast_probe_resp,
- sdata);
- /* abort any running channel switch or color change */
- mutex_lock(&local->mtx);
- link_conf->csa_active = false;
- link_conf->color_change_active = false;
- if (link->csa_block_tx) {
- ieee80211_wake_vif_queues(local, sdata,
- IEEE80211_QUEUE_STOP_REASON_CSA);
- link->csa_block_tx = false;
- }
- mutex_unlock(&local->mtx);
- ieee80211_free_next_beacon(link);
- /* turn off carrier for this interface and dependent VLANs */
- list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list)
- netif_carrier_off(vlan->dev);
- netif_carrier_off(dev);
- /* remove beacon and probe response */
- sdata->u.ap.active = false;
- RCU_INIT_POINTER(link->u.ap.beacon, NULL);
- RCU_INIT_POINTER(link->u.ap.probe_resp, NULL);
- RCU_INIT_POINTER(link->u.ap.fils_discovery, NULL);
- RCU_INIT_POINTER(link->u.ap.unsol_bcast_probe_resp, NULL);
- kfree_rcu(old_beacon, rcu_head);
- if (old_probe_resp)
- kfree_rcu(old_probe_resp, rcu_head);
- if (old_fils_discovery)
- kfree_rcu(old_fils_discovery, rcu_head);
- if (old_unsol_bcast_probe_resp)
- kfree_rcu(old_unsol_bcast_probe_resp, rcu_head);
- kfree(link_conf->ftmr_params);
- link_conf->ftmr_params = NULL;
- sdata->vif.mbssid_tx_vif = NULL;
- link_conf->bssid_index = 0;
- link_conf->nontransmitted = false;
- link_conf->ema_ap = false;
- link_conf->bssid_indicator = 0;
- __sta_info_flush(sdata, true);
- ieee80211_free_keys(sdata, true);
- link_conf->enable_beacon = false;
- sdata->beacon_rate_set = false;
- sdata->vif.cfg.ssid_len = 0;
- clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state);
- ieee80211_link_info_change_notify(sdata, link,
- BSS_CHANGED_BEACON_ENABLED);
- if (sdata->wdev.cac_started) {
- chandef = link_conf->chandef;
- cancel_delayed_work_sync(&link->dfs_cac_timer_work);
- cfg80211_cac_event(sdata->dev, &chandef,
- NL80211_RADAR_CAC_ABORTED,
- GFP_KERNEL);
- }
- drv_stop_ap(sdata->local, sdata, link_conf);
- /* free all potentially still buffered bcast frames */
- local->total_ps_buffered -= skb_queue_len(&sdata->u.ap.ps.bc_buf);
- ieee80211_purge_tx_queue(&local->hw, &sdata->u.ap.ps.bc_buf);
- mutex_lock(&local->mtx);
- ieee80211_link_copy_chanctx_to_vlans(link, true);
- ieee80211_link_release_channel(link);
- mutex_unlock(&local->mtx);
- return 0;
- }
- static int sta_apply_auth_flags(struct ieee80211_local *local,
- struct sta_info *sta,
- u32 mask, u32 set)
- {
- int ret;
- if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
- set & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
- !test_sta_flag(sta, WLAN_STA_AUTH)) {
- ret = sta_info_move_state(sta, IEEE80211_STA_AUTH);
- if (ret)
- return ret;
- }
- if (mask & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
- set & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
- !test_sta_flag(sta, WLAN_STA_ASSOC)) {
- /*
- * When peer becomes associated, init rate control as
- * well. Some drivers require rate control initialized
- * before drv_sta_state() is called.
- */
- if (!test_sta_flag(sta, WLAN_STA_RATE_CONTROL))
- rate_control_rate_init(sta);
- ret = sta_info_move_state(sta, IEEE80211_STA_ASSOC);
- if (ret)
- return ret;
- }
- if (mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
- if (set & BIT(NL80211_STA_FLAG_AUTHORIZED))
- ret = sta_info_move_state(sta, IEEE80211_STA_AUTHORIZED);
- else if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
- ret = sta_info_move_state(sta, IEEE80211_STA_ASSOC);
- else
- ret = 0;
- if (ret)
- return ret;
- }
- if (mask & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
- !(set & BIT(NL80211_STA_FLAG_ASSOCIATED)) &&
- test_sta_flag(sta, WLAN_STA_ASSOC)) {
- ret = sta_info_move_state(sta, IEEE80211_STA_AUTH);
- if (ret)
- return ret;
- }
- if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
- !(set & BIT(NL80211_STA_FLAG_AUTHENTICATED)) &&
- test_sta_flag(sta, WLAN_STA_AUTH)) {
- ret = sta_info_move_state(sta, IEEE80211_STA_NONE);
- if (ret)
- return ret;
- }
- return 0;
- }
- static void sta_apply_mesh_params(struct ieee80211_local *local,
- struct sta_info *sta,
- struct station_parameters *params)
- {
- #ifdef CONFIG_MAC80211_MESH
- struct ieee80211_sub_if_data *sdata = sta->sdata;
- u32 changed = 0;
- if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) {
- switch (params->plink_state) {
- case NL80211_PLINK_ESTAB:
- if (sta->mesh->plink_state != NL80211_PLINK_ESTAB)
- changed = mesh_plink_inc_estab_count(sdata);
- sta->mesh->plink_state = params->plink_state;
- sta->mesh->aid = params->peer_aid;
- ieee80211_mps_sta_status_update(sta);
- changed |= ieee80211_mps_set_sta_local_pm(sta,
- sdata->u.mesh.mshcfg.power_mode);
- ewma_mesh_tx_rate_avg_init(&sta->mesh->tx_rate_avg);
- /* init at low value */
- ewma_mesh_tx_rate_avg_add(&sta->mesh->tx_rate_avg, 10);
- break;
- case NL80211_PLINK_LISTEN:
- case NL80211_PLINK_BLOCKED:
- case NL80211_PLINK_OPN_SNT:
- case NL80211_PLINK_OPN_RCVD:
- case NL80211_PLINK_CNF_RCVD:
- case NL80211_PLINK_HOLDING:
- if (sta->mesh->plink_state == NL80211_PLINK_ESTAB)
- changed = mesh_plink_dec_estab_count(sdata);
- sta->mesh->plink_state = params->plink_state;
- ieee80211_mps_sta_status_update(sta);
- changed |= ieee80211_mps_set_sta_local_pm(sta,
- NL80211_MESH_POWER_UNKNOWN);
- break;
- default:
- /* nothing */
- break;
- }
- }
- switch (params->plink_action) {
- case NL80211_PLINK_ACTION_NO_ACTION:
- /* nothing */
- break;
- case NL80211_PLINK_ACTION_OPEN:
- changed |= mesh_plink_open(sta);
- break;
- case NL80211_PLINK_ACTION_BLOCK:
- changed |= mesh_plink_block(sta);
- break;
- }
- if (params->local_pm)
- changed |= ieee80211_mps_set_sta_local_pm(sta,
- params->local_pm);
- ieee80211_mbss_info_change_notify(sdata, changed);
- #endif
- }
- static int sta_link_apply_parameters(struct ieee80211_local *local,
- struct sta_info *sta, bool new_link,
- struct link_station_parameters *params)
- {
- int ret = 0;
- struct ieee80211_supported_band *sband;
- struct ieee80211_sub_if_data *sdata = sta->sdata;
- u32 link_id = params->link_id < 0 ? 0 : params->link_id;
- struct ieee80211_link_data *link =
- sdata_dereference(sdata->link[link_id], sdata);
- struct link_sta_info *link_sta =
- rcu_dereference_protected(sta->link[link_id],
- lockdep_is_held(&local->sta_mtx));
- /*
- * If there are no changes, then accept a link that doesn't exist,
- * unless it's a new link.
- */
- if (params->link_id < 0 && !new_link &&
- !params->link_mac && !params->txpwr_set &&
- !params->supported_rates_len &&
- !params->ht_capa && !params->vht_capa &&
- !params->he_capa && !params->eht_capa &&
- !params->opmode_notif_used)
- return 0;
- if (!link || !link_sta)
- return -EINVAL;
- sband = ieee80211_get_link_sband(link);
- if (!sband)
- return -EINVAL;
- if (params->link_mac) {
- if (new_link) {
- memcpy(link_sta->addr, params->link_mac, ETH_ALEN);
- memcpy(link_sta->pub->addr, params->link_mac, ETH_ALEN);
- } else if (!ether_addr_equal(link_sta->addr,
- params->link_mac)) {
- return -EINVAL;
- }
- } else if (new_link) {
- return -EINVAL;
- }
- if (params->txpwr_set) {
- link_sta->pub->txpwr.type = params->txpwr.type;
- if (params->txpwr.type == NL80211_TX_POWER_LIMITED)
- link_sta->pub->txpwr.power = params->txpwr.power;
- ret = drv_sta_set_txpwr(local, sdata, sta);
- if (ret)
- return ret;
- }
- if (params->supported_rates &&
- params->supported_rates_len) {
- ieee80211_parse_bitrates(link->conf->chandef.width,
- sband, params->supported_rates,
- params->supported_rates_len,
- &link_sta->pub->supp_rates[sband->band]);
- }
- if (params->ht_capa)
- ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
- params->ht_capa, link_sta);
- /* VHT can override some HT caps such as the A-MSDU max length */
- if (params->vht_capa)
- ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,
- params->vht_capa, NULL,
- link_sta);
- if (params->he_capa)
- ieee80211_he_cap_ie_to_sta_he_cap(sdata, sband,
- (void *)params->he_capa,
- params->he_capa_len,
- (void *)params->he_6ghz_capa,
- link_sta);
- if (params->eht_capa)
- ieee80211_eht_cap_ie_to_sta_eht_cap(sdata, sband,
- (u8 *)params->he_capa,
- params->he_capa_len,
- params->eht_capa,
- params->eht_capa_len,
- link_sta);
- if (params->opmode_notif_used) {
- /* returned value is only needed for rc update, but the
- * rc isn't initialized here yet, so ignore it
- */
- __ieee80211_vht_handle_opmode(sdata, link_sta,
- params->opmode_notif,
- sband->band);
- }
- return ret;
- }
- static int sta_apply_parameters(struct ieee80211_local *local,
- struct sta_info *sta,
- struct station_parameters *params)
- {
- struct ieee80211_sub_if_data *sdata = sta->sdata;
- u32 mask, set;
- int ret = 0;
- mask = params->sta_flags_mask;
- set = params->sta_flags_set;
- if (ieee80211_vif_is_mesh(&sdata->vif)) {
- /*
- * In mesh mode, ASSOCIATED isn't part of the nl80211
- * API but must follow AUTHENTICATED for driver state.
- */
- if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED))
- mask |= BIT(NL80211_STA_FLAG_ASSOCIATED);
- if (set & BIT(NL80211_STA_FLAG_AUTHENTICATED))
- set |= BIT(NL80211_STA_FLAG_ASSOCIATED);
- } else if (test_sta_flag(sta, WLAN_STA_TDLS_PEER)) {
- /*
- * TDLS -- everything follows authorized, but
- * only becoming authorized is possible, not
- * going back
- */
- if (set & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
- set |= BIT(NL80211_STA_FLAG_AUTHENTICATED) |
- BIT(NL80211_STA_FLAG_ASSOCIATED);
- mask |= BIT(NL80211_STA_FLAG_AUTHENTICATED) |
- BIT(NL80211_STA_FLAG_ASSOCIATED);
- }
- }
- if (mask & BIT(NL80211_STA_FLAG_WME) &&
- local->hw.queues >= IEEE80211_NUM_ACS)
- sta->sta.wme = set & BIT(NL80211_STA_FLAG_WME);
- /* auth flags will be set later for TDLS,
- * and for unassociated stations that move to associated */
- if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
- !((mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) &&
- (set & BIT(NL80211_STA_FLAG_ASSOCIATED)))) {
- ret = sta_apply_auth_flags(local, sta, mask, set);
- if (ret)
- return ret;
- }
- if (mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) {
- if (set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE))
- set_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE);
- else
- clear_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE);
- }
- if (mask & BIT(NL80211_STA_FLAG_MFP)) {
- sta->sta.mfp = !!(set & BIT(NL80211_STA_FLAG_MFP));
- if (set & BIT(NL80211_STA_FLAG_MFP))
- set_sta_flag(sta, WLAN_STA_MFP);
- else
- clear_sta_flag(sta, WLAN_STA_MFP);
- }
- if (mask & BIT(NL80211_STA_FLAG_TDLS_PEER)) {
- if (set & BIT(NL80211_STA_FLAG_TDLS_PEER))
- set_sta_flag(sta, WLAN_STA_TDLS_PEER);
- else
- clear_sta_flag(sta, WLAN_STA_TDLS_PEER);
- }
- /* mark TDLS channel switch support, if the AP allows it */
- if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
- !sdata->deflink.u.mgd.tdls_chan_switch_prohibited &&
- params->ext_capab_len >= 4 &&
- params->ext_capab[3] & WLAN_EXT_CAPA4_TDLS_CHAN_SWITCH)
- set_sta_flag(sta, WLAN_STA_TDLS_CHAN_SWITCH);
- if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
- !sdata->u.mgd.tdls_wider_bw_prohibited &&
- ieee80211_hw_check(&local->hw, TDLS_WIDER_BW) &&
- params->ext_capab_len >= 8 &&
- params->ext_capab[7] & WLAN_EXT_CAPA8_TDLS_WIDE_BW_ENABLED)
- set_sta_flag(sta, WLAN_STA_TDLS_WIDER_BW);
- if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) {
- sta->sta.uapsd_queues = params->uapsd_queues;
- sta->sta.max_sp = params->max_sp;
- }
- ieee80211_sta_set_max_amsdu_subframes(sta, params->ext_capab,
- params->ext_capab_len);
- /*
- * cfg80211 validates this (1-2007) and allows setting the AID
- * only when creating a new station entry
- */
- if (params->aid)
- sta->sta.aid = params->aid;
- /*
- * Some of the following updates would be racy if called on an
- * existing station, via ieee80211_change_station(). However,
- * all such changes are rejected by cfg80211 except for updates
- * changing the supported rates on an existing but not yet used
- * TDLS peer.
- */
- if (params->listen_interval >= 0)
- sta->listen_interval = params->listen_interval;
- ret = sta_link_apply_parameters(local, sta, false,
- ¶ms->link_sta_params);
- if (ret)
- return ret;
- if (params->support_p2p_ps >= 0)
- sta->sta.support_p2p_ps = params->support_p2p_ps;
- if (ieee80211_vif_is_mesh(&sdata->vif))
- sta_apply_mesh_params(local, sta, params);
- if (params->airtime_weight)
- sta->airtime_weight = params->airtime_weight;
- /* set the STA state after all sta info from usermode has been set */
- if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) ||
- set & BIT(NL80211_STA_FLAG_ASSOCIATED)) {
- ret = sta_apply_auth_flags(local, sta, mask, set);
- if (ret)
- return ret;
- }
- /* Mark the STA as MLO if MLD MAC address is available */
- if (params->link_sta_params.mld_mac)
- sta->sta.mlo = true;
- return 0;
- }
- static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
- const u8 *mac,
- struct station_parameters *params)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct sta_info *sta;
- struct ieee80211_sub_if_data *sdata;
- int err;
- if (params->vlan) {
- sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
- if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
- sdata->vif.type != NL80211_IFTYPE_AP)
- return -EINVAL;
- } else
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- if (ether_addr_equal(mac, sdata->vif.addr))
- return -EINVAL;
- if (!is_valid_ether_addr(mac))
- return -EINVAL;
- if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER) &&
- sdata->vif.type == NL80211_IFTYPE_STATION &&
- !sdata->u.mgd.associated)
- return -EINVAL;
- /*
- * If we have a link ID, it can be a non-MLO station on an AP MLD,
- * but we need to have a link_mac in that case as well, so use the
- * STA's MAC address in that case.
- */
- if (params->link_sta_params.link_id >= 0)
- sta = sta_info_alloc_with_link(sdata, mac,
- params->link_sta_params.link_id,
- params->link_sta_params.link_mac ?: mac,
- GFP_KERNEL);
- else
- sta = sta_info_alloc(sdata, mac, GFP_KERNEL);
- if (!sta)
- return -ENOMEM;
- if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
- sta->sta.tdls = true;
- /* Though the mutex is not needed here (since the station is not
- * visible yet), sta_apply_parameters (and inner functions) require
- * the mutex due to other paths.
- */
- mutex_lock(&local->sta_mtx);
- err = sta_apply_parameters(local, sta, params);
- mutex_unlock(&local->sta_mtx);
- if (err) {
- sta_info_free(local, sta);
- return err;
- }
- /*
- * for TDLS and for unassociated station, rate control should be
- * initialized only when rates are known and station is marked
- * authorized/associated
- */
- if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
- test_sta_flag(sta, WLAN_STA_ASSOC))
- rate_control_rate_init(sta);
- return sta_info_insert(sta);
- }
- static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
- struct station_del_parameters *params)
- {
- struct ieee80211_sub_if_data *sdata;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- if (params->mac)
- return sta_info_destroy_addr_bss(sdata, params->mac);
- sta_info_flush(sdata);
- return 0;
- }
- static int ieee80211_change_station(struct wiphy *wiphy,
- struct net_device *dev, const u8 *mac,
- struct station_parameters *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct sta_info *sta;
- struct ieee80211_sub_if_data *vlansdata;
- enum cfg80211_station_type statype;
- int err;
- mutex_lock(&local->sta_mtx);
- sta = sta_info_get_bss(sdata, mac);
- if (!sta) {
- err = -ENOENT;
- goto out_err;
- }
- switch (sdata->vif.type) {
- case NL80211_IFTYPE_MESH_POINT:
- if (sdata->u.mesh.user_mpm)
- statype = CFG80211_STA_MESH_PEER_USER;
- else
- statype = CFG80211_STA_MESH_PEER_KERNEL;
- break;
- case NL80211_IFTYPE_ADHOC:
- statype = CFG80211_STA_IBSS;
- break;
- case NL80211_IFTYPE_STATION:
- if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER)) {
- statype = CFG80211_STA_AP_STA;
- break;
- }
- if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
- statype = CFG80211_STA_TDLS_PEER_ACTIVE;
- else
- statype = CFG80211_STA_TDLS_PEER_SETUP;
- break;
- case NL80211_IFTYPE_AP:
- case NL80211_IFTYPE_AP_VLAN:
- if (test_sta_flag(sta, WLAN_STA_ASSOC))
- statype = CFG80211_STA_AP_CLIENT;
- else
- statype = CFG80211_STA_AP_CLIENT_UNASSOC;
- break;
- default:
- err = -EOPNOTSUPP;
- goto out_err;
- }
- err = cfg80211_check_station_change(wiphy, params, statype);
- if (err)
- goto out_err;
- if (params->vlan && params->vlan != sta->sdata->dev) {
- vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
- if (params->vlan->ieee80211_ptr->use_4addr) {
- if (vlansdata->u.vlan.sta) {
- err = -EBUSY;
- goto out_err;
- }
- rcu_assign_pointer(vlansdata->u.vlan.sta, sta);
- __ieee80211_check_fast_rx_iface(vlansdata);
- drv_sta_set_4addr(local, sta->sdata, &sta->sta, true);
- }
- if (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
- sta->sdata->u.vlan.sta) {
- ieee80211_clear_fast_rx(sta);
- RCU_INIT_POINTER(sta->sdata->u.vlan.sta, NULL);
- }
- if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
- ieee80211_vif_dec_num_mcast(sta->sdata);
- sta->sdata = vlansdata;
- ieee80211_check_fast_xmit(sta);
- if (test_sta_flag(sta, WLAN_STA_AUTHORIZED)) {
- ieee80211_vif_inc_num_mcast(sta->sdata);
- cfg80211_send_layer2_update(sta->sdata->dev,
- sta->sta.addr);
- }
- }
- /* we use sta_info_get_bss() so this might be different */
- if (sdata != sta->sdata) {
- mutex_lock_nested(&sta->sdata->wdev.mtx, 1);
- err = sta_apply_parameters(local, sta, params);
- mutex_unlock(&sta->sdata->wdev.mtx);
- } else {
- err = sta_apply_parameters(local, sta, params);
- }
- if (err)
- goto out_err;
- mutex_unlock(&local->sta_mtx);
- if (sdata->vif.type == NL80211_IFTYPE_STATION &&
- params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
- ieee80211_recalc_ps(local);
- ieee80211_recalc_ps_vif(sdata);
- }
- return 0;
- out_err:
- mutex_unlock(&local->sta_mtx);
- return err;
- }
- #ifdef CONFIG_MAC80211_MESH
- static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
- const u8 *dst, const u8 *next_hop)
- {
- struct ieee80211_sub_if_data *sdata;
- struct mesh_path *mpath;
- struct sta_info *sta;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- rcu_read_lock();
- sta = sta_info_get(sdata, next_hop);
- if (!sta) {
- rcu_read_unlock();
- return -ENOENT;
- }
- mpath = mesh_path_add(sdata, dst);
- if (IS_ERR(mpath)) {
- rcu_read_unlock();
- return PTR_ERR(mpath);
- }
- mesh_path_fix_nexthop(mpath, sta);
- rcu_read_unlock();
- return 0;
- }
- static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
- const u8 *dst)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- if (dst)
- return mesh_path_del(sdata, dst);
- mesh_path_flush_by_iface(sdata);
- return 0;
- }
- static int ieee80211_change_mpath(struct wiphy *wiphy, struct net_device *dev,
- const u8 *dst, const u8 *next_hop)
- {
- struct ieee80211_sub_if_data *sdata;
- struct mesh_path *mpath;
- struct sta_info *sta;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- rcu_read_lock();
- sta = sta_info_get(sdata, next_hop);
- if (!sta) {
- rcu_read_unlock();
- return -ENOENT;
- }
- mpath = mesh_path_lookup(sdata, dst);
- if (!mpath) {
- rcu_read_unlock();
- return -ENOENT;
- }
- mesh_path_fix_nexthop(mpath, sta);
- rcu_read_unlock();
- return 0;
- }
- static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
- struct mpath_info *pinfo)
- {
- struct sta_info *next_hop_sta = rcu_dereference(mpath->next_hop);
- if (next_hop_sta)
- memcpy(next_hop, next_hop_sta->sta.addr, ETH_ALEN);
- else
- eth_zero_addr(next_hop);
- memset(pinfo, 0, sizeof(*pinfo));
- pinfo->generation = mpath->sdata->u.mesh.mesh_paths_generation;
- pinfo->filled = MPATH_INFO_FRAME_QLEN |
- MPATH_INFO_SN |
- MPATH_INFO_METRIC |
- MPATH_INFO_EXPTIME |
- MPATH_INFO_DISCOVERY_TIMEOUT |
- MPATH_INFO_DISCOVERY_RETRIES |
- MPATH_INFO_FLAGS |
- MPATH_INFO_HOP_COUNT |
- MPATH_INFO_PATH_CHANGE;
- pinfo->frame_qlen = mpath->frame_queue.qlen;
- pinfo->sn = mpath->sn;
- pinfo->metric = mpath->metric;
- if (time_before(jiffies, mpath->exp_time))
- pinfo->exptime = jiffies_to_msecs(mpath->exp_time - jiffies);
- pinfo->discovery_timeout =
- jiffies_to_msecs(mpath->discovery_timeout);
- pinfo->discovery_retries = mpath->discovery_retries;
- if (mpath->flags & MESH_PATH_ACTIVE)
- pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE;
- if (mpath->flags & MESH_PATH_RESOLVING)
- pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
- if (mpath->flags & MESH_PATH_SN_VALID)
- pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID;
- if (mpath->flags & MESH_PATH_FIXED)
- pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
- if (mpath->flags & MESH_PATH_RESOLVED)
- pinfo->flags |= NL80211_MPATH_FLAG_RESOLVED;
- pinfo->hop_count = mpath->hop_count;
- pinfo->path_change_count = mpath->path_change_count;
- }
- static int ieee80211_get_mpath(struct wiphy *wiphy, struct net_device *dev,
- u8 *dst, u8 *next_hop, struct mpath_info *pinfo)
- {
- struct ieee80211_sub_if_data *sdata;
- struct mesh_path *mpath;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- rcu_read_lock();
- mpath = mesh_path_lookup(sdata, dst);
- if (!mpath) {
- rcu_read_unlock();
- return -ENOENT;
- }
- memcpy(dst, mpath->dst, ETH_ALEN);
- mpath_set_pinfo(mpath, next_hop, pinfo);
- rcu_read_unlock();
- return 0;
- }
- static int ieee80211_dump_mpath(struct wiphy *wiphy, struct net_device *dev,
- int idx, u8 *dst, u8 *next_hop,
- struct mpath_info *pinfo)
- {
- struct ieee80211_sub_if_data *sdata;
- struct mesh_path *mpath;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- rcu_read_lock();
- mpath = mesh_path_lookup_by_idx(sdata, idx);
- if (!mpath) {
- rcu_read_unlock();
- return -ENOENT;
- }
- memcpy(dst, mpath->dst, ETH_ALEN);
- mpath_set_pinfo(mpath, next_hop, pinfo);
- rcu_read_unlock();
- return 0;
- }
- static void mpp_set_pinfo(struct mesh_path *mpath, u8 *mpp,
- struct mpath_info *pinfo)
- {
- memset(pinfo, 0, sizeof(*pinfo));
- memcpy(mpp, mpath->mpp, ETH_ALEN);
- pinfo->generation = mpath->sdata->u.mesh.mpp_paths_generation;
- }
- static int ieee80211_get_mpp(struct wiphy *wiphy, struct net_device *dev,
- u8 *dst, u8 *mpp, struct mpath_info *pinfo)
- {
- struct ieee80211_sub_if_data *sdata;
- struct mesh_path *mpath;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- rcu_read_lock();
- mpath = mpp_path_lookup(sdata, dst);
- if (!mpath) {
- rcu_read_unlock();
- return -ENOENT;
- }
- memcpy(dst, mpath->dst, ETH_ALEN);
- mpp_set_pinfo(mpath, mpp, pinfo);
- rcu_read_unlock();
- return 0;
- }
- static int ieee80211_dump_mpp(struct wiphy *wiphy, struct net_device *dev,
- int idx, u8 *dst, u8 *mpp,
- struct mpath_info *pinfo)
- {
- struct ieee80211_sub_if_data *sdata;
- struct mesh_path *mpath;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- rcu_read_lock();
- mpath = mpp_path_lookup_by_idx(sdata, idx);
- if (!mpath) {
- rcu_read_unlock();
- return -ENOENT;
- }
- memcpy(dst, mpath->dst, ETH_ALEN);
- mpp_set_pinfo(mpath, mpp, pinfo);
- rcu_read_unlock();
- return 0;
- }
- static int ieee80211_get_mesh_config(struct wiphy *wiphy,
- struct net_device *dev,
- struct mesh_config *conf)
- {
- struct ieee80211_sub_if_data *sdata;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- memcpy(conf, &(sdata->u.mesh.mshcfg), sizeof(struct mesh_config));
- return 0;
- }
- static inline bool _chg_mesh_attr(enum nl80211_meshconf_params parm, u32 mask)
- {
- return (mask >> (parm-1)) & 0x1;
- }
- static int copy_mesh_setup(struct ieee80211_if_mesh *ifmsh,
- const struct mesh_setup *setup)
- {
- u8 *new_ie;
- struct ieee80211_sub_if_data *sdata = container_of(ifmsh,
- struct ieee80211_sub_if_data, u.mesh);
- int i;
- /* allocate information elements */
- new_ie = NULL;
- if (setup->ie_len) {
- new_ie = kmemdup(setup->ie, setup->ie_len,
- GFP_KERNEL);
- if (!new_ie)
- return -ENOMEM;
- }
- ifmsh->ie_len = setup->ie_len;
- ifmsh->ie = new_ie;
- /* now copy the rest of the setup parameters */
- ifmsh->mesh_id_len = setup->mesh_id_len;
- memcpy(ifmsh->mesh_id, setup->mesh_id, ifmsh->mesh_id_len);
- ifmsh->mesh_sp_id = setup->sync_method;
- ifmsh->mesh_pp_id = setup->path_sel_proto;
- ifmsh->mesh_pm_id = setup->path_metric;
- ifmsh->user_mpm = setup->user_mpm;
- ifmsh->mesh_auth_id = setup->auth_id;
- ifmsh->security = IEEE80211_MESH_SEC_NONE;
- ifmsh->userspace_handles_dfs = setup->userspace_handles_dfs;
- if (setup->is_authenticated)
- ifmsh->security |= IEEE80211_MESH_SEC_AUTHED;
- if (setup->is_secure)
- ifmsh->security |= IEEE80211_MESH_SEC_SECURED;
- /* mcast rate setting in Mesh Node */
- memcpy(sdata->vif.bss_conf.mcast_rate, setup->mcast_rate,
- sizeof(setup->mcast_rate));
- sdata->vif.bss_conf.basic_rates = setup->basic_rates;
- sdata->vif.bss_conf.beacon_int = setup->beacon_interval;
- sdata->vif.bss_conf.dtim_period = setup->dtim_period;
- sdata->beacon_rate_set = false;
- if (wiphy_ext_feature_isset(sdata->local->hw.wiphy,
- NL80211_EXT_FEATURE_BEACON_RATE_LEGACY)) {
- for (i = 0; i < NUM_NL80211_BANDS; i++) {
- sdata->beacon_rateidx_mask[i] =
- setup->beacon_rate.control[i].legacy;
- if (sdata->beacon_rateidx_mask[i])
- sdata->beacon_rate_set = true;
- }
- }
- return 0;
- }
- static int ieee80211_update_mesh_config(struct wiphy *wiphy,
- struct net_device *dev, u32 mask,
- const struct mesh_config *nconf)
- {
- struct mesh_config *conf;
- struct ieee80211_sub_if_data *sdata;
- struct ieee80211_if_mesh *ifmsh;
- sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- ifmsh = &sdata->u.mesh;
- /* Set the config options which we are interested in setting */
- conf = &(sdata->u.mesh.mshcfg);
- if (_chg_mesh_attr(NL80211_MESHCONF_RETRY_TIMEOUT, mask))
- conf->dot11MeshRetryTimeout = nconf->dot11MeshRetryTimeout;
- if (_chg_mesh_attr(NL80211_MESHCONF_CONFIRM_TIMEOUT, mask))
- conf->dot11MeshConfirmTimeout = nconf->dot11MeshConfirmTimeout;
- if (_chg_mesh_attr(NL80211_MESHCONF_HOLDING_TIMEOUT, mask))
- conf->dot11MeshHoldingTimeout = nconf->dot11MeshHoldingTimeout;
- if (_chg_mesh_attr(NL80211_MESHCONF_MAX_PEER_LINKS, mask))
- conf->dot11MeshMaxPeerLinks = nconf->dot11MeshMaxPeerLinks;
- if (_chg_mesh_attr(NL80211_MESHCONF_MAX_RETRIES, mask))
- conf->dot11MeshMaxRetries = nconf->dot11MeshMaxRetries;
- if (_chg_mesh_attr(NL80211_MESHCONF_TTL, mask))
- conf->dot11MeshTTL = nconf->dot11MeshTTL;
- if (_chg_mesh_attr(NL80211_MESHCONF_ELEMENT_TTL, mask))
- conf->element_ttl = nconf->element_ttl;
- if (_chg_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask)) {
- if (ifmsh->user_mpm)
- return -EBUSY;
- conf->auto_open_plinks = nconf->auto_open_plinks;
- }
- if (_chg_mesh_attr(NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, mask))
- conf->dot11MeshNbrOffsetMaxNeighbor =
- nconf->dot11MeshNbrOffsetMaxNeighbor;
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, mask))
- conf->dot11MeshHWMPmaxPREQretries =
- nconf->dot11MeshHWMPmaxPREQretries;
- if (_chg_mesh_attr(NL80211_MESHCONF_PATH_REFRESH_TIME, mask))
- conf->path_refresh_time = nconf->path_refresh_time;
- if (_chg_mesh_attr(NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, mask))
- conf->min_discovery_timeout = nconf->min_discovery_timeout;
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, mask))
- conf->dot11MeshHWMPactivePathTimeout =
- nconf->dot11MeshHWMPactivePathTimeout;
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, mask))
- conf->dot11MeshHWMPpreqMinInterval =
- nconf->dot11MeshHWMPpreqMinInterval;
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, mask))
- conf->dot11MeshHWMPperrMinInterval =
- nconf->dot11MeshHWMPperrMinInterval;
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
- mask))
- conf->dot11MeshHWMPnetDiameterTraversalTime =
- nconf->dot11MeshHWMPnetDiameterTraversalTime;
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) {
- conf->dot11MeshHWMPRootMode = nconf->dot11MeshHWMPRootMode;
- ieee80211_mesh_root_setup(ifmsh);
- }
- if (_chg_mesh_attr(NL80211_MESHCONF_GATE_ANNOUNCEMENTS, mask)) {
- /* our current gate announcement implementation rides on root
- * announcements, so require this ifmsh to also be a root node
- * */
- if (nconf->dot11MeshGateAnnouncementProtocol &&
- !(conf->dot11MeshHWMPRootMode > IEEE80211_ROOTMODE_ROOT)) {
- conf->dot11MeshHWMPRootMode = IEEE80211_PROACTIVE_RANN;
- ieee80211_mesh_root_setup(ifmsh);
- }
- conf->dot11MeshGateAnnouncementProtocol =
- nconf->dot11MeshGateAnnouncementProtocol;
- }
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_RANN_INTERVAL, mask))
- conf->dot11MeshHWMPRannInterval =
- nconf->dot11MeshHWMPRannInterval;
- if (_chg_mesh_attr(NL80211_MESHCONF_FORWARDING, mask))
- conf->dot11MeshForwarding = nconf->dot11MeshForwarding;
- if (_chg_mesh_attr(NL80211_MESHCONF_RSSI_THRESHOLD, mask)) {
- /* our RSSI threshold implementation is supported only for
- * devices that report signal in dBm.
- */
- if (!ieee80211_hw_check(&sdata->local->hw, SIGNAL_DBM))
- return -ENOTSUPP;
- conf->rssi_threshold = nconf->rssi_threshold;
- }
- if (_chg_mesh_attr(NL80211_MESHCONF_HT_OPMODE, mask)) {
- conf->ht_opmode = nconf->ht_opmode;
- sdata->vif.bss_conf.ht_operation_mode = nconf->ht_opmode;
- ieee80211_link_info_change_notify(sdata, &sdata->deflink,
- BSS_CHANGED_HT);
- }
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, mask))
- conf->dot11MeshHWMPactivePathToRootTimeout =
- nconf->dot11MeshHWMPactivePathToRootTimeout;
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOT_INTERVAL, mask))
- conf->dot11MeshHWMProotInterval =
- nconf->dot11MeshHWMProotInterval;
- if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, mask))
- conf->dot11MeshHWMPconfirmationInterval =
- nconf->dot11MeshHWMPconfirmationInterval;
- if (_chg_mesh_attr(NL80211_MESHCONF_POWER_MODE, mask)) {
- conf->power_mode = nconf->power_mode;
- ieee80211_mps_local_status_update(sdata);
- }
- if (_chg_mesh_attr(NL80211_MESHCONF_AWAKE_WINDOW, mask))
- conf->dot11MeshAwakeWindowDuration =
- nconf->dot11MeshAwakeWindowDuration;
- if (_chg_mesh_attr(NL80211_MESHCONF_PLINK_TIMEOUT, mask))
- conf->plink_timeout = nconf->plink_timeout;
- if (_chg_mesh_attr(NL80211_MESHCONF_CONNECTED_TO_GATE, mask))
- conf->dot11MeshConnectedToMeshGate =
- nconf->dot11MeshConnectedToMeshGate;
- if (_chg_mesh_attr(NL80211_MESHCONF_NOLEARN, mask))
- conf->dot11MeshNolearn = nconf->dot11MeshNolearn;
- if (_chg_mesh_attr(NL80211_MESHCONF_CONNECTED_TO_AS, mask))
- conf->dot11MeshConnectedToAuthServer =
- nconf->dot11MeshConnectedToAuthServer;
- ieee80211_mbss_info_change_notify(sdata, BSS_CHANGED_BEACON);
- return 0;
- }
- static int ieee80211_join_mesh(struct wiphy *wiphy, struct net_device *dev,
- const struct mesh_config *conf,
- const struct mesh_setup *setup)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh;
- int err;
- memcpy(&ifmsh->mshcfg, conf, sizeof(struct mesh_config));
- err = copy_mesh_setup(ifmsh, setup);
- if (err)
- return err;
- sdata->control_port_over_nl80211 = setup->control_port_over_nl80211;
- /* can mesh use other SMPS modes? */
- sdata->deflink.smps_mode = IEEE80211_SMPS_OFF;
- sdata->deflink.needed_rx_chains = sdata->local->rx_chains;
- mutex_lock(&sdata->local->mtx);
- err = ieee80211_link_use_channel(&sdata->deflink, &setup->chandef,
- IEEE80211_CHANCTX_SHARED);
- mutex_unlock(&sdata->local->mtx);
- if (err)
- return err;
- return ieee80211_start_mesh(sdata);
- }
- static int ieee80211_leave_mesh(struct wiphy *wiphy, struct net_device *dev)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- ieee80211_stop_mesh(sdata);
- mutex_lock(&sdata->local->mtx);
- ieee80211_link_release_channel(&sdata->deflink);
- kfree(sdata->u.mesh.ie);
- mutex_unlock(&sdata->local->mtx);
- return 0;
- }
- #endif
- static int ieee80211_change_bss(struct wiphy *wiphy,
- struct net_device *dev,
- struct bss_parameters *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_supported_band *sband;
- u32 changed = 0;
- if (!sdata_dereference(sdata->deflink.u.ap.beacon, sdata))
- return -ENOENT;
- sband = ieee80211_get_sband(sdata);
- if (!sband)
- return -EINVAL;
- if (params->use_cts_prot >= 0) {
- sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
- changed |= BSS_CHANGED_ERP_CTS_PROT;
- }
- if (params->use_short_preamble >= 0) {
- sdata->vif.bss_conf.use_short_preamble =
- params->use_short_preamble;
- changed |= BSS_CHANGED_ERP_PREAMBLE;
- }
- if (!sdata->vif.bss_conf.use_short_slot &&
- (sband->band == NL80211_BAND_5GHZ ||
- sband->band == NL80211_BAND_6GHZ)) {
- sdata->vif.bss_conf.use_short_slot = true;
- changed |= BSS_CHANGED_ERP_SLOT;
- }
- if (params->use_short_slot_time >= 0) {
- sdata->vif.bss_conf.use_short_slot =
- params->use_short_slot_time;
- changed |= BSS_CHANGED_ERP_SLOT;
- }
- if (params->basic_rates) {
- ieee80211_parse_bitrates(sdata->vif.bss_conf.chandef.width,
- wiphy->bands[sband->band],
- params->basic_rates,
- params->basic_rates_len,
- &sdata->vif.bss_conf.basic_rates);
- changed |= BSS_CHANGED_BASIC_RATES;
- ieee80211_check_rate_mask(&sdata->deflink);
- }
- if (params->ap_isolate >= 0) {
- if (params->ap_isolate)
- sdata->flags |= IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
- else
- sdata->flags &= ~IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
- ieee80211_check_fast_rx_iface(sdata);
- }
- if (params->ht_opmode >= 0) {
- sdata->vif.bss_conf.ht_operation_mode =
- (u16) params->ht_opmode;
- changed |= BSS_CHANGED_HT;
- }
- if (params->p2p_ctwindow >= 0) {
- sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow &=
- ~IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
- sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |=
- params->p2p_ctwindow & IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
- changed |= BSS_CHANGED_P2P_PS;
- }
- if (params->p2p_opp_ps > 0) {
- sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |=
- IEEE80211_P2P_OPPPS_ENABLE_BIT;
- changed |= BSS_CHANGED_P2P_PS;
- } else if (params->p2p_opp_ps == 0) {
- sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow &=
- ~IEEE80211_P2P_OPPPS_ENABLE_BIT;
- changed |= BSS_CHANGED_P2P_PS;
- }
- ieee80211_link_info_change_notify(sdata, &sdata->deflink, changed);
- return 0;
- }
- static int ieee80211_set_txq_params(struct wiphy *wiphy,
- struct net_device *dev,
- struct ieee80211_txq_params *params)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_link_data *link =
- ieee80211_link_or_deflink(sdata, params->link_id, true);
- struct ieee80211_tx_queue_params p;
- if (!local->ops->conf_tx)
- return -EOPNOTSUPP;
- if (local->hw.queues < IEEE80211_NUM_ACS)
- return -EOPNOTSUPP;
- if (IS_ERR(link))
- return PTR_ERR(link);
- memset(&p, 0, sizeof(p));
- p.aifs = params->aifs;
- p.cw_max = params->cwmax;
- p.cw_min = params->cwmin;
- p.txop = params->txop;
- /*
- * Setting tx queue params disables u-apsd because it's only
- * called in master mode.
- */
- p.uapsd = false;
- ieee80211_regulatory_limit_wmm_params(sdata, &p, params->ac);
- link->tx_conf[params->ac] = p;
- if (drv_conf_tx(local, link, params->ac, &p)) {
- wiphy_debug(local->hw.wiphy,
- "failed to set TX queue parameters for AC %d\n",
- params->ac);
- return -EINVAL;
- }
- ieee80211_link_info_change_notify(sdata, link,
- BSS_CHANGED_QOS);
- return 0;
- }
- #ifdef CONFIG_PM
- static int ieee80211_suspend(struct wiphy *wiphy,
- struct cfg80211_wowlan *wowlan)
- {
- return __ieee80211_suspend(wiphy_priv(wiphy), wowlan);
- }
- static int ieee80211_resume(struct wiphy *wiphy)
- {
- return __ieee80211_resume(wiphy_priv(wiphy));
- }
- #else
- #define ieee80211_suspend NULL
- #define ieee80211_resume NULL
- #endif
- static int ieee80211_scan(struct wiphy *wiphy,
- struct cfg80211_scan_request *req)
- {
- struct ieee80211_sub_if_data *sdata;
- sdata = IEEE80211_WDEV_TO_SUB_IF(req->wdev);
- switch (ieee80211_vif_type_p2p(&sdata->vif)) {
- case NL80211_IFTYPE_STATION:
- case NL80211_IFTYPE_ADHOC:
- case NL80211_IFTYPE_MESH_POINT:
- case NL80211_IFTYPE_P2P_CLIENT:
- case NL80211_IFTYPE_P2P_DEVICE:
- break;
- case NL80211_IFTYPE_P2P_GO:
- if (sdata->local->ops->hw_scan)
- break;
- /*
- * FIXME: implement NoA while scanning in software,
- * for now fall through to allow scanning only when
- * beaconing hasn't been configured yet
- */
- fallthrough;
- case NL80211_IFTYPE_AP:
- /*
- * If the scan has been forced (and the driver supports
- * forcing), don't care about being beaconing already.
- * This will create problems to the attached stations (e.g. all
- * the frames sent while scanning on other channel will be
- * lost)
- */
- if (sdata->deflink.u.ap.beacon &&
- (!(wiphy->features & NL80211_FEATURE_AP_SCAN) ||
- !(req->flags & NL80211_SCAN_FLAG_AP)))
- return -EOPNOTSUPP;
- break;
- case NL80211_IFTYPE_NAN:
- default:
- return -EOPNOTSUPP;
- }
- return ieee80211_request_scan(sdata, req);
- }
- static void ieee80211_abort_scan(struct wiphy *wiphy, struct wireless_dev *wdev)
- {
- ieee80211_scan_cancel(wiphy_priv(wiphy));
- }
- static int
- ieee80211_sched_scan_start(struct wiphy *wiphy,
- struct net_device *dev,
- struct cfg80211_sched_scan_request *req)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- if (!sdata->local->ops->sched_scan_start)
- return -EOPNOTSUPP;
- return ieee80211_request_sched_scan_start(sdata, req);
- }
- static int
- ieee80211_sched_scan_stop(struct wiphy *wiphy, struct net_device *dev,
- u64 reqid)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- if (!local->ops->sched_scan_stop)
- return -EOPNOTSUPP;
- return ieee80211_request_sched_scan_stop(local);
- }
- static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_auth_request *req)
- {
- return ieee80211_mgd_auth(IEEE80211_DEV_TO_SUB_IF(dev), req);
- }
- static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_assoc_request *req)
- {
- return ieee80211_mgd_assoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
- }
- static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_deauth_request *req)
- {
- return ieee80211_mgd_deauth(IEEE80211_DEV_TO_SUB_IF(dev), req);
- }
- static int ieee80211_disassoc(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_disassoc_request *req)
- {
- return ieee80211_mgd_disassoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
- }
- static int ieee80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_ibss_params *params)
- {
- return ieee80211_ibss_join(IEEE80211_DEV_TO_SUB_IF(dev), params);
- }
- static int ieee80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
- {
- return ieee80211_ibss_leave(IEEE80211_DEV_TO_SUB_IF(dev));
- }
- static int ieee80211_join_ocb(struct wiphy *wiphy, struct net_device *dev,
- struct ocb_setup *setup)
- {
- return ieee80211_ocb_join(IEEE80211_DEV_TO_SUB_IF(dev), setup);
- }
- static int ieee80211_leave_ocb(struct wiphy *wiphy, struct net_device *dev)
- {
- return ieee80211_ocb_leave(IEEE80211_DEV_TO_SUB_IF(dev));
- }
- static int ieee80211_set_mcast_rate(struct wiphy *wiphy, struct net_device *dev,
- int rate[NUM_NL80211_BANDS])
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- memcpy(sdata->vif.bss_conf.mcast_rate, rate,
- sizeof(int) * NUM_NL80211_BANDS);
- ieee80211_link_info_change_notify(sdata, &sdata->deflink,
- BSS_CHANGED_MCAST_RATE);
- return 0;
- }
- static int ieee80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- int err;
- if (changed & WIPHY_PARAM_FRAG_THRESHOLD) {
- ieee80211_check_fast_xmit_all(local);
- err = drv_set_frag_threshold(local, wiphy->frag_threshold);
- if (err) {
- ieee80211_check_fast_xmit_all(local);
- return err;
- }
- }
- if ((changed & WIPHY_PARAM_COVERAGE_CLASS) ||
- (changed & WIPHY_PARAM_DYN_ACK)) {
- s16 coverage_class;
- coverage_class = changed & WIPHY_PARAM_COVERAGE_CLASS ?
- wiphy->coverage_class : -1;
- err = drv_set_coverage_class(local, coverage_class);
- if (err)
- return err;
- }
- if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
- err = drv_set_rts_threshold(local, wiphy->rts_threshold);
- if (err)
- return err;
- }
- if (changed & WIPHY_PARAM_RETRY_SHORT) {
- if (wiphy->retry_short > IEEE80211_MAX_TX_RETRY)
- return -EINVAL;
- local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
- }
- if (changed & WIPHY_PARAM_RETRY_LONG) {
- if (wiphy->retry_long > IEEE80211_MAX_TX_RETRY)
- return -EINVAL;
- local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
- }
- if (changed &
- (WIPHY_PARAM_RETRY_SHORT | WIPHY_PARAM_RETRY_LONG))
- ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS);
- if (changed & (WIPHY_PARAM_TXQ_LIMIT |
- WIPHY_PARAM_TXQ_MEMORY_LIMIT |
- WIPHY_PARAM_TXQ_QUANTUM))
- ieee80211_txq_set_params(local);
- return 0;
- }
- static int ieee80211_set_tx_power(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- enum nl80211_tx_power_setting type, int mbm)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata;
- enum nl80211_tx_power_setting txp_type = type;
- bool update_txp_type = false;
- bool has_monitor = false;
- if (wdev) {
- sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- if (sdata->vif.type == NL80211_IFTYPE_MONITOR) {
- sdata = wiphy_dereference(local->hw.wiphy,
- local->monitor_sdata);
- if (!sdata)
- return -EOPNOTSUPP;
- }
- switch (type) {
- case NL80211_TX_POWER_AUTOMATIC:
- sdata->deflink.user_power_level =
- IEEE80211_UNSET_POWER_LEVEL;
- txp_type = NL80211_TX_POWER_LIMITED;
- break;
- case NL80211_TX_POWER_LIMITED:
- case NL80211_TX_POWER_FIXED:
- if (mbm < 0 || (mbm % 100))
- return -EOPNOTSUPP;
- sdata->deflink.user_power_level = MBM_TO_DBM(mbm);
- break;
- }
- if (txp_type != sdata->vif.bss_conf.txpower_type) {
- update_txp_type = true;
- sdata->vif.bss_conf.txpower_type = txp_type;
- }
- ieee80211_recalc_txpower(sdata, update_txp_type);
- return 0;
- }
- switch (type) {
- case NL80211_TX_POWER_AUTOMATIC:
- local->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
- txp_type = NL80211_TX_POWER_LIMITED;
- break;
- case NL80211_TX_POWER_LIMITED:
- case NL80211_TX_POWER_FIXED:
- if (mbm < 0 || (mbm % 100))
- return -EOPNOTSUPP;
- local->user_power_level = MBM_TO_DBM(mbm);
- break;
- }
- mutex_lock(&local->iflist_mtx);
- list_for_each_entry(sdata, &local->interfaces, list) {
- if (sdata->vif.type == NL80211_IFTYPE_MONITOR) {
- has_monitor = true;
- continue;
- }
- sdata->deflink.user_power_level = local->user_power_level;
- if (txp_type != sdata->vif.bss_conf.txpower_type)
- update_txp_type = true;
- sdata->vif.bss_conf.txpower_type = txp_type;
- }
- list_for_each_entry(sdata, &local->interfaces, list) {
- if (sdata->vif.type == NL80211_IFTYPE_MONITOR)
- continue;
- ieee80211_recalc_txpower(sdata, update_txp_type);
- }
- mutex_unlock(&local->iflist_mtx);
- if (has_monitor) {
- sdata = wiphy_dereference(local->hw.wiphy,
- local->monitor_sdata);
- if (sdata) {
- sdata->deflink.user_power_level = local->user_power_level;
- if (txp_type != sdata->vif.bss_conf.txpower_type)
- update_txp_type = true;
- sdata->vif.bss_conf.txpower_type = txp_type;
- ieee80211_recalc_txpower(sdata, update_txp_type);
- }
- }
- return 0;
- }
- static int ieee80211_get_tx_power(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- int *dbm)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- if (local->ops->get_txpower)
- return drv_get_txpower(local, sdata, dbm);
- if (!local->use_chanctx)
- *dbm = local->hw.conf.power_level;
- else
- *dbm = sdata->vif.bss_conf.txpower;
- /* INT_MIN indicates no power level was set yet */
- if (*dbm == INT_MIN)
- return -EINVAL;
- return 0;
- }
- static void ieee80211_rfkill_poll(struct wiphy *wiphy)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- drv_rfkill_poll(local);
- }
- #ifdef CONFIG_NL80211_TESTMODE
- static int ieee80211_testmode_cmd(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- void *data, int len)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_vif *vif = NULL;
- if (!local->ops->testmode_cmd)
- return -EOPNOTSUPP;
- if (wdev) {
- struct ieee80211_sub_if_data *sdata;
- sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- if (sdata->flags & IEEE80211_SDATA_IN_DRIVER)
- vif = &sdata->vif;
- }
- return local->ops->testmode_cmd(&local->hw, vif, data, len);
- }
- static int ieee80211_testmode_dump(struct wiphy *wiphy,
- struct sk_buff *skb,
- struct netlink_callback *cb,
- void *data, int len)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- if (!local->ops->testmode_dump)
- return -EOPNOTSUPP;
- return local->ops->testmode_dump(&local->hw, skb, cb, data, len);
- }
- #endif
- int __ieee80211_request_smps_mgd(struct ieee80211_sub_if_data *sdata,
- struct ieee80211_link_data *link,
- enum ieee80211_smps_mode smps_mode)
- {
- const u8 *ap;
- enum ieee80211_smps_mode old_req;
- int err;
- struct sta_info *sta;
- bool tdls_peer_found = false;
- lockdep_assert_held(&sdata->wdev.mtx);
- if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_STATION))
- return -EINVAL;
- old_req = link->u.mgd.req_smps;
- link->u.mgd.req_smps = smps_mode;
- if (old_req == smps_mode &&
- smps_mode != IEEE80211_SMPS_AUTOMATIC)
- return 0;
- /*
- * If not associated, or current association is not an HT
- * association, there's no need to do anything, just store
- * the new value until we associate.
- */
- if (!sdata->u.mgd.associated ||
- link->conf->chandef.width == NL80211_CHAN_WIDTH_20_NOHT)
- return 0;
- ap = link->u.mgd.bssid;
- rcu_read_lock();
- list_for_each_entry_rcu(sta, &sdata->local->sta_list, list) {
- if (!sta->sta.tdls || sta->sdata != sdata || !sta->uploaded ||
- !test_sta_flag(sta, WLAN_STA_AUTHORIZED))
- continue;
- tdls_peer_found = true;
- break;
- }
- rcu_read_unlock();
- if (smps_mode == IEEE80211_SMPS_AUTOMATIC) {
- if (tdls_peer_found || !sdata->u.mgd.powersave)
- smps_mode = IEEE80211_SMPS_OFF;
- else
- smps_mode = IEEE80211_SMPS_DYNAMIC;
- }
- /* send SM PS frame to AP */
- err = ieee80211_send_smps_action(sdata, smps_mode,
- ap, ap);
- if (err)
- link->u.mgd.req_smps = old_req;
- else if (smps_mode != IEEE80211_SMPS_OFF && tdls_peer_found)
- ieee80211_teardown_tdls_peers(sdata);
- return err;
- }
- static int ieee80211_set_power_mgmt(struct wiphy *wiphy, struct net_device *dev,
- bool enabled, int timeout)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
- unsigned int link_id;
- if (sdata->vif.type != NL80211_IFTYPE_STATION)
- return -EOPNOTSUPP;
- if (!ieee80211_hw_check(&local->hw, SUPPORTS_PS))
- return -EOPNOTSUPP;
- if (enabled == sdata->u.mgd.powersave &&
- timeout == local->dynamic_ps_forced_timeout)
- return 0;
- sdata->u.mgd.powersave = enabled;
- local->dynamic_ps_forced_timeout = timeout;
- /* no change, but if automatic follow powersave */
- sdata_lock(sdata);
- for (link_id = 0; link_id < ARRAY_SIZE(sdata->link); link_id++) {
- struct ieee80211_link_data *link;
- link = sdata_dereference(sdata->link[link_id], sdata);
- if (!link)
- continue;
- __ieee80211_request_smps_mgd(sdata, link,
- link->u.mgd.req_smps);
- }
- sdata_unlock(sdata);
- if (ieee80211_hw_check(&local->hw, SUPPORTS_DYNAMIC_PS))
- ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
- ieee80211_recalc_ps(local);
- ieee80211_recalc_ps_vif(sdata);
- ieee80211_check_fast_rx_iface(sdata);
- return 0;
- }
- static int ieee80211_set_cqm_rssi_config(struct wiphy *wiphy,
- struct net_device *dev,
- s32 rssi_thold, u32 rssi_hyst)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_vif *vif = &sdata->vif;
- struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
- if (rssi_thold == bss_conf->cqm_rssi_thold &&
- rssi_hyst == bss_conf->cqm_rssi_hyst)
- return 0;
- if (sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER &&
- !(sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI))
- return -EOPNOTSUPP;
- bss_conf->cqm_rssi_thold = rssi_thold;
- bss_conf->cqm_rssi_hyst = rssi_hyst;
- bss_conf->cqm_rssi_low = 0;
- bss_conf->cqm_rssi_high = 0;
- sdata->deflink.u.mgd.last_cqm_event_signal = 0;
- /* tell the driver upon association, unless already associated */
- if (sdata->u.mgd.associated &&
- sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)
- ieee80211_link_info_change_notify(sdata, &sdata->deflink,
- BSS_CHANGED_CQM);
- return 0;
- }
- static int ieee80211_set_cqm_rssi_range_config(struct wiphy *wiphy,
- struct net_device *dev,
- s32 rssi_low, s32 rssi_high)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_vif *vif = &sdata->vif;
- struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
- if (sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER)
- return -EOPNOTSUPP;
- bss_conf->cqm_rssi_low = rssi_low;
- bss_conf->cqm_rssi_high = rssi_high;
- bss_conf->cqm_rssi_thold = 0;
- bss_conf->cqm_rssi_hyst = 0;
- sdata->deflink.u.mgd.last_cqm_event_signal = 0;
- /* tell the driver upon association, unless already associated */
- if (sdata->u.mgd.associated &&
- sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)
- ieee80211_link_info_change_notify(sdata, &sdata->deflink,
- BSS_CHANGED_CQM);
- return 0;
- }
- static int ieee80211_set_bitrate_mask(struct wiphy *wiphy,
- struct net_device *dev,
- unsigned int link_id,
- const u8 *addr,
- const struct cfg80211_bitrate_mask *mask)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
- int i, ret;
- if (!ieee80211_sdata_running(sdata))
- return -ENETDOWN;
- /*
- * If active validate the setting and reject it if it doesn't leave
- * at least one basic rate usable, since we really have to be able
- * to send something, and if we're an AP we have to be able to do
- * so at a basic rate so that all clients can receive it.
- */
- if (rcu_access_pointer(sdata->vif.bss_conf.chanctx_conf) &&
- sdata->vif.bss_conf.chandef.chan) {
- u32 basic_rates = sdata->vif.bss_conf.basic_rates;
- enum nl80211_band band = sdata->vif.bss_conf.chandef.chan->band;
- if (!(mask->control[band].legacy & basic_rates))
- return -EINVAL;
- }
- if (ieee80211_hw_check(&local->hw, HAS_RATE_CONTROL)) {
- ret = drv_set_bitrate_mask(local, sdata, mask);
- if (ret)
- return ret;
- }
- for (i = 0; i < NUM_NL80211_BANDS; i++) {
- struct ieee80211_supported_band *sband = wiphy->bands[i];
- int j;
- sdata->rc_rateidx_mask[i] = mask->control[i].legacy;
- memcpy(sdata->rc_rateidx_mcs_mask[i], mask->control[i].ht_mcs,
- sizeof(mask->control[i].ht_mcs));
- memcpy(sdata->rc_rateidx_vht_mcs_mask[i],
- mask->control[i].vht_mcs,
- sizeof(mask->control[i].vht_mcs));
- sdata->rc_has_mcs_mask[i] = false;
- sdata->rc_has_vht_mcs_mask[i] = false;
- if (!sband)
- continue;
- for (j = 0; j < IEEE80211_HT_MCS_MASK_LEN; j++) {
- if (sdata->rc_rateidx_mcs_mask[i][j] != 0xff) {
- sdata->rc_has_mcs_mask[i] = true;
- break;
- }
- }
- for (j = 0; j < NL80211_VHT_NSS_MAX; j++) {
- if (sdata->rc_rateidx_vht_mcs_mask[i][j] != 0xffff) {
- sdata->rc_has_vht_mcs_mask[i] = true;
- break;
- }
- }
- }
- return 0;
- }
- static int ieee80211_start_radar_detection(struct wiphy *wiphy,
- struct net_device *dev,
- struct cfg80211_chan_def *chandef,
- u32 cac_time_ms)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- int err;
- mutex_lock(&local->mtx);
- if (!list_empty(&local->roc_list) || local->scanning) {
- err = -EBUSY;
- goto out_unlock;
- }
- /* whatever, but channel contexts should not complain about that one */
- sdata->deflink.smps_mode = IEEE80211_SMPS_OFF;
- sdata->deflink.needed_rx_chains = local->rx_chains;
- err = ieee80211_link_use_channel(&sdata->deflink, chandef,
- IEEE80211_CHANCTX_SHARED);
- if (err)
- goto out_unlock;
- ieee80211_queue_delayed_work(&sdata->local->hw,
- &sdata->deflink.dfs_cac_timer_work,
- msecs_to_jiffies(cac_time_ms));
- out_unlock:
- mutex_unlock(&local->mtx);
- return err;
- }
- static void ieee80211_end_cac(struct wiphy *wiphy,
- struct net_device *dev)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- mutex_lock(&local->mtx);
- list_for_each_entry(sdata, &local->interfaces, list) {
- /* it might be waiting for the local->mtx, but then
- * by the time it gets it, sdata->wdev.cac_started
- * will no longer be true
- */
- cancel_delayed_work(&sdata->deflink.dfs_cac_timer_work);
- if (sdata->wdev.cac_started) {
- ieee80211_link_release_channel(&sdata->deflink);
- sdata->wdev.cac_started = false;
- }
- }
- mutex_unlock(&local->mtx);
- }
- static struct cfg80211_beacon_data *
- cfg80211_beacon_dup(struct cfg80211_beacon_data *beacon)
- {
- struct cfg80211_beacon_data *new_beacon;
- u8 *pos;
- int len;
- len = beacon->head_len + beacon->tail_len + beacon->beacon_ies_len +
- beacon->proberesp_ies_len + beacon->assocresp_ies_len +
- beacon->probe_resp_len + beacon->lci_len + beacon->civicloc_len +
- ieee80211_get_mbssid_beacon_len(beacon->mbssid_ies);
- new_beacon = kzalloc(sizeof(*new_beacon) + len, GFP_KERNEL);
- if (!new_beacon)
- return NULL;
- if (beacon->mbssid_ies && beacon->mbssid_ies->cnt) {
- new_beacon->mbssid_ies =
- kzalloc(struct_size(new_beacon->mbssid_ies,
- elem, beacon->mbssid_ies->cnt),
- GFP_KERNEL);
- if (!new_beacon->mbssid_ies) {
- kfree(new_beacon);
- return NULL;
- }
- }
- pos = (u8 *)(new_beacon + 1);
- if (beacon->head_len) {
- new_beacon->head_len = beacon->head_len;
- new_beacon->head = pos;
- memcpy(pos, beacon->head, beacon->head_len);
- pos += beacon->head_len;
- }
- if (beacon->tail_len) {
- new_beacon->tail_len = beacon->tail_len;
- new_beacon->tail = pos;
- memcpy(pos, beacon->tail, beacon->tail_len);
- pos += beacon->tail_len;
- }
- if (beacon->beacon_ies_len) {
- new_beacon->beacon_ies_len = beacon->beacon_ies_len;
- new_beacon->beacon_ies = pos;
- memcpy(pos, beacon->beacon_ies, beacon->beacon_ies_len);
- pos += beacon->beacon_ies_len;
- }
- if (beacon->proberesp_ies_len) {
- new_beacon->proberesp_ies_len = beacon->proberesp_ies_len;
- new_beacon->proberesp_ies = pos;
- memcpy(pos, beacon->proberesp_ies, beacon->proberesp_ies_len);
- pos += beacon->proberesp_ies_len;
- }
- if (beacon->assocresp_ies_len) {
- new_beacon->assocresp_ies_len = beacon->assocresp_ies_len;
- new_beacon->assocresp_ies = pos;
- memcpy(pos, beacon->assocresp_ies, beacon->assocresp_ies_len);
- pos += beacon->assocresp_ies_len;
- }
- if (beacon->probe_resp_len) {
- new_beacon->probe_resp_len = beacon->probe_resp_len;
- new_beacon->probe_resp = pos;
- memcpy(pos, beacon->probe_resp, beacon->probe_resp_len);
- pos += beacon->probe_resp_len;
- }
- if (beacon->mbssid_ies && beacon->mbssid_ies->cnt)
- pos += ieee80211_copy_mbssid_beacon(pos,
- new_beacon->mbssid_ies,
- beacon->mbssid_ies);
- /* might copy -1, meaning no changes requested */
- new_beacon->ftm_responder = beacon->ftm_responder;
- if (beacon->lci) {
- new_beacon->lci_len = beacon->lci_len;
- new_beacon->lci = pos;
- memcpy(pos, beacon->lci, beacon->lci_len);
- pos += beacon->lci_len;
- }
- if (beacon->civicloc) {
- new_beacon->civicloc_len = beacon->civicloc_len;
- new_beacon->civicloc = pos;
- memcpy(pos, beacon->civicloc, beacon->civicloc_len);
- pos += beacon->civicloc_len;
- }
- return new_beacon;
- }
- void ieee80211_csa_finish(struct ieee80211_vif *vif)
- {
- struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
- struct ieee80211_local *local = sdata->local;
- rcu_read_lock();
- if (vif->mbssid_tx_vif == vif) {
- /* Trigger ieee80211_csa_finish() on the non-transmitting
- * interfaces when channel switch is received on
- * transmitting interface
- */
- struct ieee80211_sub_if_data *iter;
- list_for_each_entry_rcu(iter, &local->interfaces, list) {
- if (!ieee80211_sdata_running(iter))
- continue;
- if (iter == sdata || iter->vif.mbssid_tx_vif != vif)
- continue;
- ieee80211_queue_work(&iter->local->hw,
- &iter->deflink.csa_finalize_work);
- }
- }
- ieee80211_queue_work(&local->hw, &sdata->deflink.csa_finalize_work);
- rcu_read_unlock();
- }
- EXPORT_SYMBOL(ieee80211_csa_finish);
- void ieee80211_channel_switch_disconnect(struct ieee80211_vif *vif, bool block_tx)
- {
- struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
- struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
- struct ieee80211_local *local = sdata->local;
- sdata->deflink.csa_block_tx = block_tx;
- sdata_info(sdata, "channel switch failed, disconnecting\n");
- ieee80211_queue_work(&local->hw, &ifmgd->csa_connection_drop_work);
- }
- EXPORT_SYMBOL(ieee80211_channel_switch_disconnect);
- static int ieee80211_set_after_csa_beacon(struct ieee80211_sub_if_data *sdata,
- u32 *changed)
- {
- int err;
- switch (sdata->vif.type) {
- case NL80211_IFTYPE_AP:
- if (!sdata->deflink.u.ap.next_beacon)
- return -EINVAL;
- err = ieee80211_assign_beacon(sdata, &sdata->deflink,
- sdata->deflink.u.ap.next_beacon,
- NULL, NULL);
- ieee80211_free_next_beacon(&sdata->deflink);
- if (err < 0)
- return err;
- *changed |= err;
- break;
- case NL80211_IFTYPE_ADHOC:
- err = ieee80211_ibss_finish_csa(sdata);
- if (err < 0)
- return err;
- *changed |= err;
- break;
- #ifdef CONFIG_MAC80211_MESH
- case NL80211_IFTYPE_MESH_POINT:
- err = ieee80211_mesh_finish_csa(sdata);
- if (err < 0)
- return err;
- *changed |= err;
- break;
- #endif
- default:
- WARN_ON(1);
- return -EINVAL;
- }
- return 0;
- }
- static int __ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata)
- {
- struct ieee80211_local *local = sdata->local;
- u32 changed = 0;
- int err;
- sdata_assert_lock(sdata);
- lockdep_assert_held(&local->mtx);
- lockdep_assert_held(&local->chanctx_mtx);
- /*
- * using reservation isn't immediate as it may be deferred until later
- * with multi-vif. once reservation is complete it will re-schedule the
- * work with no reserved_chanctx so verify chandef to check if it
- * completed successfully
- */
- if (sdata->deflink.reserved_chanctx) {
- /*
- * with multi-vif csa driver may call ieee80211_csa_finish()
- * many times while waiting for other interfaces to use their
- * reservations
- */
- if (sdata->deflink.reserved_ready)
- return 0;
- return ieee80211_link_use_reserved_context(&sdata->deflink);
- }
- if (!cfg80211_chandef_identical(&sdata->vif.bss_conf.chandef,
- &sdata->deflink.csa_chandef))
- return -EINVAL;
- sdata->vif.bss_conf.csa_active = false;
- err = ieee80211_set_after_csa_beacon(sdata, &changed);
- if (err)
- return err;
- ieee80211_link_info_change_notify(sdata, &sdata->deflink, changed);
- if (sdata->deflink.csa_block_tx) {
- ieee80211_wake_vif_queues(local, sdata,
- IEEE80211_QUEUE_STOP_REASON_CSA);
- sdata->deflink.csa_block_tx = false;
- }
- err = drv_post_channel_switch(sdata);
- if (err)
- return err;
- cfg80211_ch_switch_notify(sdata->dev, &sdata->deflink.csa_chandef, 0,
- 0);
- return 0;
- }
- static void ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata)
- {
- if (__ieee80211_csa_finalize(sdata)) {
- sdata_info(sdata, "failed to finalize CSA, disconnecting\n");
- cfg80211_stop_iface(sdata->local->hw.wiphy, &sdata->wdev,
- GFP_KERNEL);
- }
- }
- void ieee80211_csa_finalize_work(struct work_struct *work)
- {
- struct ieee80211_sub_if_data *sdata =
- container_of(work, struct ieee80211_sub_if_data,
- deflink.csa_finalize_work);
- struct ieee80211_local *local = sdata->local;
- sdata_lock(sdata);
- mutex_lock(&local->mtx);
- mutex_lock(&local->chanctx_mtx);
- /* AP might have been stopped while waiting for the lock. */
- if (!sdata->vif.bss_conf.csa_active)
- goto unlock;
- if (!ieee80211_sdata_running(sdata))
- goto unlock;
- ieee80211_csa_finalize(sdata);
- unlock:
- mutex_unlock(&local->chanctx_mtx);
- mutex_unlock(&local->mtx);
- sdata_unlock(sdata);
- }
- static int ieee80211_set_csa_beacon(struct ieee80211_sub_if_data *sdata,
- struct cfg80211_csa_settings *params,
- u32 *changed)
- {
- struct ieee80211_csa_settings csa = {};
- int err;
- switch (sdata->vif.type) {
- case NL80211_IFTYPE_AP:
- sdata->deflink.u.ap.next_beacon =
- cfg80211_beacon_dup(¶ms->beacon_after);
- if (!sdata->deflink.u.ap.next_beacon)
- return -ENOMEM;
- /*
- * With a count of 0, we don't have to wait for any
- * TBTT before switching, so complete the CSA
- * immediately. In theory, with a count == 1 we
- * should delay the switch until just before the next
- * TBTT, but that would complicate things so we switch
- * immediately too. If we would delay the switch
- * until the next TBTT, we would have to set the probe
- * response here.
- *
- * TODO: A channel switch with count <= 1 without
- * sending a CSA action frame is kind of useless,
- * because the clients won't know we're changing
- * channels. The action frame must be implemented
- * either here or in the userspace.
- */
- if (params->count <= 1)
- break;
- if ((params->n_counter_offsets_beacon >
- IEEE80211_MAX_CNTDWN_COUNTERS_NUM) ||
- (params->n_counter_offsets_presp >
- IEEE80211_MAX_CNTDWN_COUNTERS_NUM)) {
- ieee80211_free_next_beacon(&sdata->deflink);
- return -EINVAL;
- }
- csa.counter_offsets_beacon = params->counter_offsets_beacon;
- csa.counter_offsets_presp = params->counter_offsets_presp;
- csa.n_counter_offsets_beacon = params->n_counter_offsets_beacon;
- csa.n_counter_offsets_presp = params->n_counter_offsets_presp;
- csa.count = params->count;
- err = ieee80211_assign_beacon(sdata, &sdata->deflink,
- ¶ms->beacon_csa, &csa,
- NULL);
- if (err < 0) {
- ieee80211_free_next_beacon(&sdata->deflink);
- return err;
- }
- *changed |= err;
- break;
- case NL80211_IFTYPE_ADHOC:
- if (!sdata->vif.cfg.ibss_joined)
- return -EINVAL;
- if (params->chandef.width != sdata->u.ibss.chandef.width)
- return -EINVAL;
- switch (params->chandef.width) {
- case NL80211_CHAN_WIDTH_40:
- if (cfg80211_get_chandef_type(¶ms->chandef) !=
- cfg80211_get_chandef_type(&sdata->u.ibss.chandef))
- return -EINVAL;
- break;
- case NL80211_CHAN_WIDTH_5:
- case NL80211_CHAN_WIDTH_10:
- case NL80211_CHAN_WIDTH_20_NOHT:
- case NL80211_CHAN_WIDTH_20:
- break;
- default:
- return -EINVAL;
- }
- /* changes into another band are not supported */
- if (sdata->u.ibss.chandef.chan->band !=
- params->chandef.chan->band)
- return -EINVAL;
- /* see comments in the NL80211_IFTYPE_AP block */
- if (params->count > 1) {
- err = ieee80211_ibss_csa_beacon(sdata, params);
- if (err < 0)
- return err;
- *changed |= err;
- }
- ieee80211_send_action_csa(sdata, params);
- break;
- #ifdef CONFIG_MAC80211_MESH
- case NL80211_IFTYPE_MESH_POINT: {
- struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh;
- /* changes into another band are not supported */
- if (sdata->vif.bss_conf.chandef.chan->band !=
- params->chandef.chan->band)
- return -EINVAL;
- if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_NONE) {
- ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_INIT;
- if (!ifmsh->pre_value)
- ifmsh->pre_value = 1;
- else
- ifmsh->pre_value++;
- }
- /* see comments in the NL80211_IFTYPE_AP block */
- if (params->count > 1) {
- err = ieee80211_mesh_csa_beacon(sdata, params);
- if (err < 0) {
- ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_NONE;
- return err;
- }
- *changed |= err;
- }
- if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_INIT)
- ieee80211_send_action_csa(sdata, params);
- break;
- }
- #endif
- default:
- return -EOPNOTSUPP;
- }
- return 0;
- }
- static void ieee80211_color_change_abort(struct ieee80211_sub_if_data *sdata)
- {
- sdata->vif.bss_conf.color_change_active = false;
- ieee80211_free_next_beacon(&sdata->deflink);
- cfg80211_color_change_aborted_notify(sdata->dev);
- }
- static int
- __ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_csa_settings *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- struct ieee80211_channel_switch ch_switch;
- struct ieee80211_chanctx_conf *conf;
- struct ieee80211_chanctx *chanctx;
- u32 changed = 0;
- int err;
- sdata_assert_lock(sdata);
- lockdep_assert_held(&local->mtx);
- if (!list_empty(&local->roc_list) || local->scanning)
- return -EBUSY;
- if (sdata->wdev.cac_started)
- return -EBUSY;
- if (cfg80211_chandef_identical(¶ms->chandef,
- &sdata->vif.bss_conf.chandef))
- return -EINVAL;
- /* don't allow another channel switch if one is already active. */
- if (sdata->vif.bss_conf.csa_active)
- return -EBUSY;
- mutex_lock(&local->chanctx_mtx);
- conf = rcu_dereference_protected(sdata->vif.bss_conf.chanctx_conf,
- lockdep_is_held(&local->chanctx_mtx));
- if (!conf) {
- err = -EBUSY;
- goto out;
- }
- if (params->chandef.chan->freq_offset) {
- /* this may work, but is untested */
- err = -EOPNOTSUPP;
- goto out;
- }
- chanctx = container_of(conf, struct ieee80211_chanctx, conf);
- ch_switch.timestamp = 0;
- ch_switch.device_timestamp = 0;
- ch_switch.block_tx = params->block_tx;
- ch_switch.chandef = params->chandef;
- ch_switch.count = params->count;
- err = drv_pre_channel_switch(sdata, &ch_switch);
- if (err)
- goto out;
- err = ieee80211_link_reserve_chanctx(&sdata->deflink, ¶ms->chandef,
- chanctx->mode,
- params->radar_required);
- if (err)
- goto out;
- /* if reservation is invalid then this will fail */
- err = ieee80211_check_combinations(sdata, NULL, chanctx->mode, 0);
- if (err) {
- ieee80211_link_unreserve_chanctx(&sdata->deflink);
- goto out;
- }
- /* if there is a color change in progress, abort it */
- if (sdata->vif.bss_conf.color_change_active)
- ieee80211_color_change_abort(sdata);
- err = ieee80211_set_csa_beacon(sdata, params, &changed);
- if (err) {
- ieee80211_link_unreserve_chanctx(&sdata->deflink);
- goto out;
- }
- sdata->deflink.csa_chandef = params->chandef;
- sdata->deflink.csa_block_tx = params->block_tx;
- sdata->vif.bss_conf.csa_active = true;
- if (sdata->deflink.csa_block_tx)
- ieee80211_stop_vif_queues(local, sdata,
- IEEE80211_QUEUE_STOP_REASON_CSA);
- cfg80211_ch_switch_started_notify(sdata->dev,
- &sdata->deflink.csa_chandef, 0,
- params->count, params->block_tx, 0);
- if (changed) {
- ieee80211_link_info_change_notify(sdata, &sdata->deflink,
- changed);
- drv_channel_switch_beacon(sdata, ¶ms->chandef);
- } else {
- /* if the beacon didn't change, we can finalize immediately */
- ieee80211_csa_finalize(sdata);
- }
- out:
- mutex_unlock(&local->chanctx_mtx);
- return err;
- }
- int ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_csa_settings *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- int err;
- mutex_lock(&local->mtx);
- err = __ieee80211_channel_switch(wiphy, dev, params);
- mutex_unlock(&local->mtx);
- return err;
- }
- u64 ieee80211_mgmt_tx_cookie(struct ieee80211_local *local)
- {
- lockdep_assert_held(&local->mtx);
- local->roc_cookie_counter++;
- /* wow, you wrapped 64 bits ... more likely a bug */
- if (WARN_ON(local->roc_cookie_counter == 0))
- local->roc_cookie_counter++;
- return local->roc_cookie_counter;
- }
- int ieee80211_attach_ack_skb(struct ieee80211_local *local, struct sk_buff *skb,
- u64 *cookie, gfp_t gfp)
- {
- unsigned long spin_flags;
- struct sk_buff *ack_skb;
- int id;
- ack_skb = skb_copy(skb, gfp);
- if (!ack_skb)
- return -ENOMEM;
- spin_lock_irqsave(&local->ack_status_lock, spin_flags);
- id = idr_alloc(&local->ack_status_frames, ack_skb,
- 1, 0x2000, GFP_ATOMIC);
- spin_unlock_irqrestore(&local->ack_status_lock, spin_flags);
- if (id < 0) {
- kfree_skb(ack_skb);
- return -ENOMEM;
- }
- IEEE80211_SKB_CB(skb)->ack_frame_id = id;
- *cookie = ieee80211_mgmt_tx_cookie(local);
- IEEE80211_SKB_CB(ack_skb)->ack.cookie = *cookie;
- return 0;
- }
- static void
- ieee80211_update_mgmt_frame_registrations(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- struct mgmt_frame_regs *upd)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- u32 preq_mask = BIT(IEEE80211_STYPE_PROBE_REQ >> 4);
- u32 action_mask = BIT(IEEE80211_STYPE_ACTION >> 4);
- bool global_change, intf_change;
- global_change =
- (local->probe_req_reg != !!(upd->global_stypes & preq_mask)) ||
- (local->rx_mcast_action_reg !=
- !!(upd->global_mcast_stypes & action_mask));
- local->probe_req_reg = upd->global_stypes & preq_mask;
- local->rx_mcast_action_reg = upd->global_mcast_stypes & action_mask;
- intf_change = (sdata->vif.probe_req_reg !=
- !!(upd->interface_stypes & preq_mask)) ||
- (sdata->vif.rx_mcast_action_reg !=
- !!(upd->interface_mcast_stypes & action_mask));
- sdata->vif.probe_req_reg = upd->interface_stypes & preq_mask;
- sdata->vif.rx_mcast_action_reg =
- upd->interface_mcast_stypes & action_mask;
- if (!local->open_count)
- return;
- if (intf_change && ieee80211_sdata_running(sdata))
- drv_config_iface_filter(local, sdata,
- sdata->vif.probe_req_reg ?
- FIF_PROBE_REQ : 0,
- FIF_PROBE_REQ);
- if (global_change)
- ieee80211_configure_filter(local);
- }
- static int ieee80211_set_antenna(struct wiphy *wiphy, u32 tx_ant, u32 rx_ant)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- if (local->started)
- return -EOPNOTSUPP;
- return drv_set_antenna(local, tx_ant, rx_ant);
- }
- static int ieee80211_get_antenna(struct wiphy *wiphy, u32 *tx_ant, u32 *rx_ant)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- return drv_get_antenna(local, tx_ant, rx_ant);
- }
- static int ieee80211_set_rekey_data(struct wiphy *wiphy,
- struct net_device *dev,
- struct cfg80211_gtk_rekey_data *data)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- if (!local->ops->set_rekey_data)
- return -EOPNOTSUPP;
- drv_set_rekey_data(local, sdata, data);
- return 0;
- }
- static int ieee80211_probe_client(struct wiphy *wiphy, struct net_device *dev,
- const u8 *peer, u64 *cookie)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- struct ieee80211_qos_hdr *nullfunc;
- struct sk_buff *skb;
- int size = sizeof(*nullfunc);
- __le16 fc;
- bool qos;
- struct ieee80211_tx_info *info;
- struct sta_info *sta;
- struct ieee80211_chanctx_conf *chanctx_conf;
- enum nl80211_band band;
- int ret;
- /* the lock is needed to assign the cookie later */
- mutex_lock(&local->mtx);
- rcu_read_lock();
- sta = sta_info_get_bss(sdata, peer);
- if (!sta) {
- ret = -ENOLINK;
- goto unlock;
- }
- qos = sta->sta.wme;
- chanctx_conf = rcu_dereference(sdata->vif.bss_conf.chanctx_conf);
- if (WARN_ON(!chanctx_conf)) {
- ret = -EINVAL;
- goto unlock;
- }
- band = chanctx_conf->def.chan->band;
- if (qos) {
- fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
- IEEE80211_STYPE_QOS_NULLFUNC |
- IEEE80211_FCTL_FROMDS);
- } else {
- size -= 2;
- fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
- IEEE80211_STYPE_NULLFUNC |
- IEEE80211_FCTL_FROMDS);
- }
- skb = dev_alloc_skb(local->hw.extra_tx_headroom + size);
- if (!skb) {
- ret = -ENOMEM;
- goto unlock;
- }
- skb->dev = dev;
- skb_reserve(skb, local->hw.extra_tx_headroom);
- nullfunc = skb_put(skb, size);
- nullfunc->frame_control = fc;
- nullfunc->duration_id = 0;
- memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN);
- memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN);
- memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN);
- nullfunc->seq_ctrl = 0;
- info = IEEE80211_SKB_CB(skb);
- info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS |
- IEEE80211_TX_INTFL_NL80211_FRAME_TX;
- info->band = band;
- skb_set_queue_mapping(skb, IEEE80211_AC_VO);
- skb->priority = 7;
- if (qos)
- nullfunc->qos_ctrl = cpu_to_le16(7);
- ret = ieee80211_attach_ack_skb(local, skb, cookie, GFP_ATOMIC);
- if (ret) {
- kfree_skb(skb);
- goto unlock;
- }
- local_bh_disable();
- ieee80211_xmit(sdata, sta, skb);
- local_bh_enable();
- ret = 0;
- unlock:
- rcu_read_unlock();
- mutex_unlock(&local->mtx);
- return ret;
- }
- static int ieee80211_cfg_get_channel(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- unsigned int link_id,
- struct cfg80211_chan_def *chandef)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_chanctx_conf *chanctx_conf;
- struct ieee80211_link_data *link;
- int ret = -ENODATA;
- rcu_read_lock();
- link = rcu_dereference(sdata->link[link_id]);
- if (!link) {
- ret = -ENOLINK;
- goto out;
- }
- chanctx_conf = rcu_dereference(link->conf->chanctx_conf);
- if (chanctx_conf) {
- *chandef = link->conf->chandef;
- ret = 0;
- } else if (local->open_count > 0 &&
- local->open_count == local->monitors &&
- sdata->vif.type == NL80211_IFTYPE_MONITOR) {
- if (local->use_chanctx)
- *chandef = local->monitor_chandef;
- else
- *chandef = local->_oper_chandef;
- ret = 0;
- }
- out:
- rcu_read_unlock();
- return ret;
- }
- #ifdef CONFIG_PM
- static void ieee80211_set_wakeup(struct wiphy *wiphy, bool enabled)
- {
- drv_set_wakeup(wiphy_priv(wiphy), enabled);
- }
- #endif
- static int ieee80211_set_qos_map(struct wiphy *wiphy,
- struct net_device *dev,
- struct cfg80211_qos_map *qos_map)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct mac80211_qos_map *new_qos_map, *old_qos_map;
- if (qos_map) {
- new_qos_map = kzalloc(sizeof(*new_qos_map), GFP_KERNEL);
- if (!new_qos_map)
- return -ENOMEM;
- memcpy(&new_qos_map->qos_map, qos_map, sizeof(*qos_map));
- } else {
- /* A NULL qos_map was passed to disable QoS mapping */
- new_qos_map = NULL;
- }
- old_qos_map = sdata_dereference(sdata->qos_map, sdata);
- rcu_assign_pointer(sdata->qos_map, new_qos_map);
- if (old_qos_map)
- kfree_rcu(old_qos_map, rcu_head);
- return 0;
- }
- static int ieee80211_set_ap_chanwidth(struct wiphy *wiphy,
- struct net_device *dev,
- unsigned int link_id,
- struct cfg80211_chan_def *chandef)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_link_data *link;
- int ret;
- u32 changed = 0;
- link = sdata_dereference(sdata->link[link_id], sdata);
- ret = ieee80211_link_change_bandwidth(link, chandef, &changed);
- if (ret == 0)
- ieee80211_link_info_change_notify(sdata, link, changed);
- return ret;
- }
- static int ieee80211_add_tx_ts(struct wiphy *wiphy, struct net_device *dev,
- u8 tsid, const u8 *peer, u8 up,
- u16 admitted_time)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
- int ac = ieee802_1d_to_ac[up];
- if (sdata->vif.type != NL80211_IFTYPE_STATION)
- return -EOPNOTSUPP;
- if (!(sdata->wmm_acm & BIT(up)))
- return -EINVAL;
- if (ifmgd->tx_tspec[ac].admitted_time)
- return -EBUSY;
- if (admitted_time) {
- ifmgd->tx_tspec[ac].admitted_time = 32 * admitted_time;
- ifmgd->tx_tspec[ac].tsid = tsid;
- ifmgd->tx_tspec[ac].up = up;
- }
- return 0;
- }
- static int ieee80211_del_tx_ts(struct wiphy *wiphy, struct net_device *dev,
- u8 tsid, const u8 *peer)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
- struct ieee80211_local *local = wiphy_priv(wiphy);
- int ac;
- for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
- struct ieee80211_sta_tx_tspec *tx_tspec = &ifmgd->tx_tspec[ac];
- /* skip unused entries */
- if (!tx_tspec->admitted_time)
- continue;
- if (tx_tspec->tsid != tsid)
- continue;
- /* due to this new packets will be reassigned to non-ACM ACs */
- tx_tspec->up = -1;
- /* Make sure that all packets have been sent to avoid to
- * restore the QoS params on packets that are still on the
- * queues.
- */
- synchronize_net();
- ieee80211_flush_queues(local, sdata, false);
- /* restore the normal QoS parameters
- * (unconditionally to avoid races)
- */
- tx_tspec->action = TX_TSPEC_ACTION_STOP_DOWNGRADE;
- tx_tspec->downgraded = false;
- ieee80211_sta_handle_tspec_ac_params(sdata);
- /* finally clear all the data */
- memset(tx_tspec, 0, sizeof(*tx_tspec));
- return 0;
- }
- return -ENOENT;
- }
- void ieee80211_nan_func_terminated(struct ieee80211_vif *vif,
- u8 inst_id,
- enum nl80211_nan_func_term_reason reason,
- gfp_t gfp)
- {
- struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
- struct cfg80211_nan_func *func;
- u64 cookie;
- if (WARN_ON(vif->type != NL80211_IFTYPE_NAN))
- return;
- spin_lock_bh(&sdata->u.nan.func_lock);
- func = idr_find(&sdata->u.nan.function_inst_ids, inst_id);
- if (WARN_ON(!func)) {
- spin_unlock_bh(&sdata->u.nan.func_lock);
- return;
- }
- cookie = func->cookie;
- idr_remove(&sdata->u.nan.function_inst_ids, inst_id);
- spin_unlock_bh(&sdata->u.nan.func_lock);
- cfg80211_free_nan_func(func);
- cfg80211_nan_func_terminated(ieee80211_vif_to_wdev(vif), inst_id,
- reason, cookie, gfp);
- }
- EXPORT_SYMBOL(ieee80211_nan_func_terminated);
- void ieee80211_nan_func_match(struct ieee80211_vif *vif,
- struct cfg80211_nan_match_params *match,
- gfp_t gfp)
- {
- struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
- struct cfg80211_nan_func *func;
- if (WARN_ON(vif->type != NL80211_IFTYPE_NAN))
- return;
- spin_lock_bh(&sdata->u.nan.func_lock);
- func = idr_find(&sdata->u.nan.function_inst_ids, match->inst_id);
- if (WARN_ON(!func)) {
- spin_unlock_bh(&sdata->u.nan.func_lock);
- return;
- }
- match->cookie = func->cookie;
- spin_unlock_bh(&sdata->u.nan.func_lock);
- cfg80211_nan_match(ieee80211_vif_to_wdev(vif), match, gfp);
- }
- EXPORT_SYMBOL(ieee80211_nan_func_match);
- static int ieee80211_set_multicast_to_unicast(struct wiphy *wiphy,
- struct net_device *dev,
- const bool enabled)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- sdata->u.ap.multicast_to_unicast = enabled;
- return 0;
- }
- void ieee80211_fill_txq_stats(struct cfg80211_txq_stats *txqstats,
- struct txq_info *txqi)
- {
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_BACKLOG_BYTES))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_BACKLOG_BYTES);
- txqstats->backlog_bytes = txqi->tin.backlog_bytes;
- }
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_BACKLOG_PACKETS))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_BACKLOG_PACKETS);
- txqstats->backlog_packets = txqi->tin.backlog_packets;
- }
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_FLOWS))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_FLOWS);
- txqstats->flows = txqi->tin.flows;
- }
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_DROPS))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_DROPS);
- txqstats->drops = txqi->cstats.drop_count;
- }
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_ECN_MARKS))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_ECN_MARKS);
- txqstats->ecn_marks = txqi->cstats.ecn_mark;
- }
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_OVERLIMIT))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_OVERLIMIT);
- txqstats->overlimit = txqi->tin.overlimit;
- }
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_COLLISIONS))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_COLLISIONS);
- txqstats->collisions = txqi->tin.collisions;
- }
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_TX_BYTES))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_TX_BYTES);
- txqstats->tx_bytes = txqi->tin.tx_bytes;
- }
- if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_TX_PACKETS))) {
- txqstats->filled |= BIT(NL80211_TXQ_STATS_TX_PACKETS);
- txqstats->tx_packets = txqi->tin.tx_packets;
- }
- }
- static int ieee80211_get_txq_stats(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- struct cfg80211_txq_stats *txqstats)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata;
- int ret = 0;
- if (!local->ops->wake_tx_queue)
- return 1;
- spin_lock_bh(&local->fq.lock);
- rcu_read_lock();
- if (wdev) {
- sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- if (!sdata->vif.txq) {
- ret = 1;
- goto out;
- }
- ieee80211_fill_txq_stats(txqstats, to_txq_info(sdata->vif.txq));
- } else {
- /* phy stats */
- txqstats->filled |= BIT(NL80211_TXQ_STATS_BACKLOG_PACKETS) |
- BIT(NL80211_TXQ_STATS_BACKLOG_BYTES) |
- BIT(NL80211_TXQ_STATS_OVERLIMIT) |
- BIT(NL80211_TXQ_STATS_OVERMEMORY) |
- BIT(NL80211_TXQ_STATS_COLLISIONS) |
- BIT(NL80211_TXQ_STATS_MAX_FLOWS);
- txqstats->backlog_packets = local->fq.backlog;
- txqstats->backlog_bytes = local->fq.memory_usage;
- txqstats->overlimit = local->fq.overlimit;
- txqstats->overmemory = local->fq.overmemory;
- txqstats->collisions = local->fq.collisions;
- txqstats->max_flows = local->fq.flows_cnt;
- }
- out:
- rcu_read_unlock();
- spin_unlock_bh(&local->fq.lock);
- return ret;
- }
- static int
- ieee80211_get_ftm_responder_stats(struct wiphy *wiphy,
- struct net_device *dev,
- struct cfg80211_ftm_responder_stats *ftm_stats)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- return drv_get_ftm_responder_stats(local, sdata, ftm_stats);
- }
- static int
- ieee80211_start_pmsr(struct wiphy *wiphy, struct wireless_dev *dev,
- struct cfg80211_pmsr_request *request)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(dev);
- return drv_start_pmsr(local, sdata, request);
- }
- static void
- ieee80211_abort_pmsr(struct wiphy *wiphy, struct wireless_dev *dev,
- struct cfg80211_pmsr_request *request)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(dev);
- return drv_abort_pmsr(local, sdata, request);
- }
- static int ieee80211_set_tid_config(struct wiphy *wiphy,
- struct net_device *dev,
- struct cfg80211_tid_config *tid_conf)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct sta_info *sta;
- int ret;
- if (!sdata->local->ops->set_tid_config)
- return -EOPNOTSUPP;
- if (!tid_conf->peer)
- return drv_set_tid_config(sdata->local, sdata, NULL, tid_conf);
- mutex_lock(&sdata->local->sta_mtx);
- sta = sta_info_get_bss(sdata, tid_conf->peer);
- if (!sta) {
- mutex_unlock(&sdata->local->sta_mtx);
- return -ENOENT;
- }
- ret = drv_set_tid_config(sdata->local, sdata, &sta->sta, tid_conf);
- mutex_unlock(&sdata->local->sta_mtx);
- return ret;
- }
- static int ieee80211_reset_tid_config(struct wiphy *wiphy,
- struct net_device *dev,
- const u8 *peer, u8 tids)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct sta_info *sta;
- int ret;
- if (!sdata->local->ops->reset_tid_config)
- return -EOPNOTSUPP;
- if (!peer)
- return drv_reset_tid_config(sdata->local, sdata, NULL, tids);
- mutex_lock(&sdata->local->sta_mtx);
- sta = sta_info_get_bss(sdata, peer);
- if (!sta) {
- mutex_unlock(&sdata->local->sta_mtx);
- return -ENOENT;
- }
- ret = drv_reset_tid_config(sdata->local, sdata, &sta->sta, tids);
- mutex_unlock(&sdata->local->sta_mtx);
- return ret;
- }
- static int ieee80211_set_sar_specs(struct wiphy *wiphy,
- struct cfg80211_sar_specs *sar)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- if (!local->ops->set_sar_specs)
- return -EOPNOTSUPP;
- return local->ops->set_sar_specs(&local->hw, sar);
- }
- static int
- ieee80211_set_after_color_change_beacon(struct ieee80211_sub_if_data *sdata,
- u32 *changed)
- {
- switch (sdata->vif.type) {
- case NL80211_IFTYPE_AP: {
- int ret;
- if (!sdata->deflink.u.ap.next_beacon)
- return -EINVAL;
- ret = ieee80211_assign_beacon(sdata, &sdata->deflink,
- sdata->deflink.u.ap.next_beacon,
- NULL, NULL);
- ieee80211_free_next_beacon(&sdata->deflink);
- if (ret < 0)
- return ret;
- *changed |= ret;
- break;
- }
- default:
- WARN_ON_ONCE(1);
- return -EINVAL;
- }
- return 0;
- }
- static int
- ieee80211_set_color_change_beacon(struct ieee80211_sub_if_data *sdata,
- struct cfg80211_color_change_settings *params,
- u32 *changed)
- {
- struct ieee80211_color_change_settings color_change = {};
- int err;
- switch (sdata->vif.type) {
- case NL80211_IFTYPE_AP:
- sdata->deflink.u.ap.next_beacon =
- cfg80211_beacon_dup(¶ms->beacon_next);
- if (!sdata->deflink.u.ap.next_beacon)
- return -ENOMEM;
- if (params->count <= 1)
- break;
- color_change.counter_offset_beacon =
- params->counter_offset_beacon;
- color_change.counter_offset_presp =
- params->counter_offset_presp;
- color_change.count = params->count;
- err = ieee80211_assign_beacon(sdata, &sdata->deflink,
- ¶ms->beacon_color_change,
- NULL, &color_change);
- if (err < 0) {
- ieee80211_free_next_beacon(&sdata->deflink);
- return err;
- }
- *changed |= err;
- break;
- default:
- return -EOPNOTSUPP;
- }
- return 0;
- }
- static void
- ieee80211_color_change_bss_config_notify(struct ieee80211_sub_if_data *sdata,
- u8 color, int enable, u32 changed)
- {
- sdata->vif.bss_conf.he_bss_color.color = color;
- sdata->vif.bss_conf.he_bss_color.enabled = enable;
- changed |= BSS_CHANGED_HE_BSS_COLOR;
- ieee80211_link_info_change_notify(sdata, &sdata->deflink, changed);
- if (!sdata->vif.bss_conf.nontransmitted && sdata->vif.mbssid_tx_vif) {
- struct ieee80211_sub_if_data *child;
- mutex_lock(&sdata->local->iflist_mtx);
- list_for_each_entry(child, &sdata->local->interfaces, list) {
- if (child != sdata && child->vif.mbssid_tx_vif == &sdata->vif) {
- child->vif.bss_conf.he_bss_color.color = color;
- child->vif.bss_conf.he_bss_color.enabled = enable;
- ieee80211_link_info_change_notify(child,
- &child->deflink,
- BSS_CHANGED_HE_BSS_COLOR);
- }
- }
- mutex_unlock(&sdata->local->iflist_mtx);
- }
- }
- static int ieee80211_color_change_finalize(struct ieee80211_sub_if_data *sdata)
- {
- struct ieee80211_local *local = sdata->local;
- u32 changed = 0;
- int err;
- sdata_assert_lock(sdata);
- lockdep_assert_held(&local->mtx);
- sdata->vif.bss_conf.color_change_active = false;
- err = ieee80211_set_after_color_change_beacon(sdata, &changed);
- if (err) {
- cfg80211_color_change_aborted_notify(sdata->dev);
- return err;
- }
- ieee80211_color_change_bss_config_notify(sdata,
- sdata->vif.bss_conf.color_change_color,
- 1, changed);
- cfg80211_color_change_notify(sdata->dev);
- return 0;
- }
- void ieee80211_color_change_finalize_work(struct work_struct *work)
- {
- struct ieee80211_sub_if_data *sdata =
- container_of(work, struct ieee80211_sub_if_data,
- deflink.color_change_finalize_work);
- struct ieee80211_local *local = sdata->local;
- sdata_lock(sdata);
- mutex_lock(&local->mtx);
- /* AP might have been stopped while waiting for the lock. */
- if (!sdata->vif.bss_conf.color_change_active)
- goto unlock;
- if (!ieee80211_sdata_running(sdata))
- goto unlock;
- ieee80211_color_change_finalize(sdata);
- unlock:
- mutex_unlock(&local->mtx);
- sdata_unlock(sdata);
- }
- void ieee80211_color_collision_detection_work(struct work_struct *work)
- {
- struct delayed_work *delayed_work = to_delayed_work(work);
- struct ieee80211_link_data *link =
- container_of(delayed_work, struct ieee80211_link_data,
- color_collision_detect_work);
- struct ieee80211_sub_if_data *sdata = link->sdata;
- sdata_lock(sdata);
- cfg80211_obss_color_collision_notify(sdata->dev, link->color_bitmap,
- GFP_KERNEL);
- sdata_unlock(sdata);
- }
- void ieee80211_color_change_finish(struct ieee80211_vif *vif)
- {
- struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
- ieee80211_queue_work(&sdata->local->hw,
- &sdata->deflink.color_change_finalize_work);
- }
- EXPORT_SYMBOL_GPL(ieee80211_color_change_finish);
- void
- ieeee80211_obss_color_collision_notify(struct ieee80211_vif *vif,
- u64 color_bitmap, gfp_t gfp)
- {
- struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
- struct ieee80211_link_data *link = &sdata->deflink;
- if (sdata->vif.bss_conf.color_change_active || sdata->vif.bss_conf.csa_active)
- return;
- if (delayed_work_pending(&link->color_collision_detect_work))
- return;
- link->color_bitmap = color_bitmap;
- /* queue the color collision detection event every 500 ms in order to
- * avoid sending too much netlink messages to userspace.
- */
- ieee80211_queue_delayed_work(&sdata->local->hw,
- &link->color_collision_detect_work,
- msecs_to_jiffies(500));
- }
- EXPORT_SYMBOL_GPL(ieeee80211_obss_color_collision_notify);
- static int
- ieee80211_color_change(struct wiphy *wiphy, struct net_device *dev,
- struct cfg80211_color_change_settings *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = sdata->local;
- u32 changed = 0;
- int err;
- sdata_assert_lock(sdata);
- if (sdata->vif.bss_conf.nontransmitted)
- return -EINVAL;
- mutex_lock(&local->mtx);
- /* don't allow another color change if one is already active or if csa
- * is active
- */
- if (sdata->vif.bss_conf.color_change_active || sdata->vif.bss_conf.csa_active) {
- err = -EBUSY;
- goto out;
- }
- err = ieee80211_set_color_change_beacon(sdata, params, &changed);
- if (err)
- goto out;
- sdata->vif.bss_conf.color_change_active = true;
- sdata->vif.bss_conf.color_change_color = params->color;
- cfg80211_color_change_started_notify(sdata->dev, params->count);
- if (changed)
- ieee80211_color_change_bss_config_notify(sdata, 0, 0, changed);
- else
- /* if the beacon didn't change, we can finalize immediately */
- ieee80211_color_change_finalize(sdata);
- out:
- mutex_unlock(&local->mtx);
- return err;
- }
- static int
- ieee80211_set_radar_background(struct wiphy *wiphy,
- struct cfg80211_chan_def *chandef)
- {
- struct ieee80211_local *local = wiphy_priv(wiphy);
- if (!local->ops->set_radar_background)
- return -EOPNOTSUPP;
- return local->ops->set_radar_background(&local->hw, chandef);
- }
- static int ieee80211_add_intf_link(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- unsigned int link_id)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- int res;
- if (wdev->use_4addr)
- return -EOPNOTSUPP;
- mutex_lock(&sdata->local->mtx);
- res = ieee80211_vif_set_links(sdata, wdev->valid_links);
- mutex_unlock(&sdata->local->mtx);
- return res;
- }
- static void ieee80211_del_intf_link(struct wiphy *wiphy,
- struct wireless_dev *wdev,
- unsigned int link_id)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
- mutex_lock(&sdata->local->mtx);
- ieee80211_vif_set_links(sdata, wdev->valid_links);
- mutex_unlock(&sdata->local->mtx);
- }
- static int sta_add_link_station(struct ieee80211_local *local,
- struct ieee80211_sub_if_data *sdata,
- struct link_station_parameters *params)
- {
- struct sta_info *sta;
- int ret;
- sta = sta_info_get_bss(sdata, params->mld_mac);
- if (!sta)
- return -ENOENT;
- if (!sta->sta.valid_links)
- return -EINVAL;
- if (sta->sta.valid_links & BIT(params->link_id))
- return -EALREADY;
- ret = ieee80211_sta_allocate_link(sta, params->link_id);
- if (ret)
- return ret;
- ret = sta_link_apply_parameters(local, sta, true, params);
- if (ret) {
- ieee80211_sta_free_link(sta, params->link_id);
- return ret;
- }
- /* ieee80211_sta_activate_link frees the link upon failure */
- return ieee80211_sta_activate_link(sta, params->link_id);
- }
- static int
- ieee80211_add_link_station(struct wiphy *wiphy, struct net_device *dev,
- struct link_station_parameters *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = wiphy_priv(wiphy);
- int ret;
- mutex_lock(&sdata->local->sta_mtx);
- ret = sta_add_link_station(local, sdata, params);
- mutex_unlock(&sdata->local->sta_mtx);
- return ret;
- }
- static int sta_mod_link_station(struct ieee80211_local *local,
- struct ieee80211_sub_if_data *sdata,
- struct link_station_parameters *params)
- {
- struct sta_info *sta;
- sta = sta_info_get_bss(sdata, params->mld_mac);
- if (!sta)
- return -ENOENT;
- if (!(sta->sta.valid_links & BIT(params->link_id)))
- return -EINVAL;
- return sta_link_apply_parameters(local, sta, false, params);
- }
- static int
- ieee80211_mod_link_station(struct wiphy *wiphy, struct net_device *dev,
- struct link_station_parameters *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- struct ieee80211_local *local = wiphy_priv(wiphy);
- int ret;
- mutex_lock(&sdata->local->sta_mtx);
- ret = sta_mod_link_station(local, sdata, params);
- mutex_unlock(&sdata->local->sta_mtx);
- return ret;
- }
- static int sta_del_link_station(struct ieee80211_sub_if_data *sdata,
- struct link_station_del_parameters *params)
- {
- struct sta_info *sta;
- sta = sta_info_get_bss(sdata, params->mld_mac);
- if (!sta)
- return -ENOENT;
- if (!(sta->sta.valid_links & BIT(params->link_id)))
- return -EINVAL;
- /* must not create a STA without links */
- if (sta->sta.valid_links == BIT(params->link_id))
- return -EINVAL;
- ieee80211_sta_remove_link(sta, params->link_id);
- return 0;
- }
- static int
- ieee80211_del_link_station(struct wiphy *wiphy, struct net_device *dev,
- struct link_station_del_parameters *params)
- {
- struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
- int ret;
- mutex_lock(&sdata->local->sta_mtx);
- ret = sta_del_link_station(sdata, params);
- mutex_unlock(&sdata->local->sta_mtx);
- return ret;
- }
- const struct cfg80211_ops mac80211_config_ops = {
- .add_virtual_intf = ieee80211_add_iface,
- .del_virtual_intf = ieee80211_del_iface,
- .change_virtual_intf = ieee80211_change_iface,
- .start_p2p_device = ieee80211_start_p2p_device,
- .stop_p2p_device = ieee80211_stop_p2p_device,
- .add_key = ieee80211_add_key,
- .del_key = ieee80211_del_key,
- .get_key = ieee80211_get_key,
- .set_default_key = ieee80211_config_default_key,
- .set_default_mgmt_key = ieee80211_config_default_mgmt_key,
- .set_default_beacon_key = ieee80211_config_default_beacon_key,
- .start_ap = ieee80211_start_ap,
- .change_beacon = ieee80211_change_beacon,
- .stop_ap = ieee80211_stop_ap,
- .add_station = ieee80211_add_station,
- .del_station = ieee80211_del_station,
- .change_station = ieee80211_change_station,
- .get_station = ieee80211_get_station,
- .dump_station = ieee80211_dump_station,
- .dump_survey = ieee80211_dump_survey,
- #ifdef CONFIG_MAC80211_MESH
- .add_mpath = ieee80211_add_mpath,
- .del_mpath = ieee80211_del_mpath,
- .change_mpath = ieee80211_change_mpath,
- .get_mpath = ieee80211_get_mpath,
- .dump_mpath = ieee80211_dump_mpath,
- .get_mpp = ieee80211_get_mpp,
- .dump_mpp = ieee80211_dump_mpp,
- .update_mesh_config = ieee80211_update_mesh_config,
- .get_mesh_config = ieee80211_get_mesh_config,
- .join_mesh = ieee80211_join_mesh,
- .leave_mesh = ieee80211_leave_mesh,
- #endif
- .join_ocb = ieee80211_join_ocb,
- .leave_ocb = ieee80211_leave_ocb,
- .change_bss = ieee80211_change_bss,
- .set_txq_params = ieee80211_set_txq_params,
- .set_monitor_channel = ieee80211_set_monitor_channel,
- .suspend = ieee80211_suspend,
- .resume = ieee80211_resume,
- .scan = ieee80211_scan,
- .abort_scan = ieee80211_abort_scan,
- .sched_scan_start = ieee80211_sched_scan_start,
- .sched_scan_stop = ieee80211_sched_scan_stop,
- .auth = ieee80211_auth,
- .assoc = ieee80211_assoc,
- .deauth = ieee80211_deauth,
- .disassoc = ieee80211_disassoc,
- .join_ibss = ieee80211_join_ibss,
- .leave_ibss = ieee80211_leave_ibss,
- .set_mcast_rate = ieee80211_set_mcast_rate,
- .set_wiphy_params = ieee80211_set_wiphy_params,
- .set_tx_power = ieee80211_set_tx_power,
- .get_tx_power = ieee80211_get_tx_power,
- .rfkill_poll = ieee80211_rfkill_poll,
- CFG80211_TESTMODE_CMD(ieee80211_testmode_cmd)
- CFG80211_TESTMODE_DUMP(ieee80211_testmode_dump)
- .set_power_mgmt = ieee80211_set_power_mgmt,
- .set_bitrate_mask = ieee80211_set_bitrate_mask,
- .remain_on_channel = ieee80211_remain_on_channel,
- .cancel_remain_on_channel = ieee80211_cancel_remain_on_channel,
- .mgmt_tx = ieee80211_mgmt_tx,
- .mgmt_tx_cancel_wait = ieee80211_mgmt_tx_cancel_wait,
- .set_cqm_rssi_config = ieee80211_set_cqm_rssi_config,
- .set_cqm_rssi_range_config = ieee80211_set_cqm_rssi_range_config,
- .update_mgmt_frame_registrations =
- ieee80211_update_mgmt_frame_registrations,
- .set_antenna = ieee80211_set_antenna,
- .get_antenna = ieee80211_get_antenna,
- .set_rekey_data = ieee80211_set_rekey_data,
- .tdls_oper = ieee80211_tdls_oper,
- .tdls_mgmt = ieee80211_tdls_mgmt,
- .tdls_channel_switch = ieee80211_tdls_channel_switch,
- .tdls_cancel_channel_switch = ieee80211_tdls_cancel_channel_switch,
- .probe_client = ieee80211_probe_client,
- .set_noack_map = ieee80211_set_noack_map,
- #ifdef CONFIG_PM
- .set_wakeup = ieee80211_set_wakeup,
- #endif
- .get_channel = ieee80211_cfg_get_channel,
- .start_radar_detection = ieee80211_start_radar_detection,
- .end_cac = ieee80211_end_cac,
- .channel_switch = ieee80211_channel_switch,
- .set_qos_map = ieee80211_set_qos_map,
- .set_ap_chanwidth = ieee80211_set_ap_chanwidth,
- .add_tx_ts = ieee80211_add_tx_ts,
- .del_tx_ts = ieee80211_del_tx_ts,
- .start_nan = ieee80211_start_nan,
- .stop_nan = ieee80211_stop_nan,
- .nan_change_conf = ieee80211_nan_change_conf,
- .add_nan_func = ieee80211_add_nan_func,
- .del_nan_func = ieee80211_del_nan_func,
- .set_multicast_to_unicast = ieee80211_set_multicast_to_unicast,
- .tx_control_port = ieee80211_tx_control_port,
- .get_txq_stats = ieee80211_get_txq_stats,
- .get_ftm_responder_stats = ieee80211_get_ftm_responder_stats,
- .start_pmsr = ieee80211_start_pmsr,
- .abort_pmsr = ieee80211_abort_pmsr,
- .probe_mesh_link = ieee80211_probe_mesh_link,
- .set_tid_config = ieee80211_set_tid_config,
- .reset_tid_config = ieee80211_reset_tid_config,
- .set_sar_specs = ieee80211_set_sar_specs,
- .color_change = ieee80211_color_change,
- .set_radar_background = ieee80211_set_radar_background,
- .add_intf_link = ieee80211_add_intf_link,
- .del_intf_link = ieee80211_del_intf_link,
- .add_link_station = ieee80211_add_link_station,
- .mod_link_station = ieee80211_mod_link_station,
- .del_link_station = ieee80211_del_link_station,
- };
|