wmi_unified_roam_tlv.c 204 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237423842394240424142424243424442454246424742484249425042514252425342544255425642574258425942604261426242634264426542664267426842694270427142724273427442754276427742784279428042814282428342844285428642874288428942904291429242934294429542964297429842994300430143024303430443054306430743084309431043114312431343144315431643174318431943204321432243234324432543264327432843294330433143324333433443354336433743384339434043414342434343444345434643474348434943504351435243534354435543564357435843594360436143624363436443654366436743684369437043714372437343744375437643774378437943804381438243834384438543864387438843894390439143924393439443954396439743984399440044014402440344044405440644074408440944104411441244134414441544164417441844194420442144224423442444254426442744284429443044314432443344344435443644374438443944404441444244434444444544464447444844494450445144524453445444554456445744584459446044614462446344644465446644674468446944704471447244734474447544764477447844794480448144824483448444854486448744884489449044914492449344944495449644974498449945004501450245034504450545064507450845094510451145124513451445154516451745184519452045214522452345244525452645274528452945304531453245334534453545364537453845394540454145424543454445454546454745484549455045514552455345544555455645574558455945604561456245634564456545664567456845694570457145724573457445754576457745784579458045814582458345844585458645874588458945904591459245934594459545964597459845994600460146024603460446054606460746084609461046114612461346144615461646174618461946204621462246234624462546264627462846294630463146324633463446354636463746384639464046414642464346444645464646474648464946504651465246534654465546564657465846594660466146624663466446654666466746684669467046714672467346744675467646774678467946804681468246834684468546864687468846894690469146924693469446954696469746984699470047014702470347044705470647074708470947104711471247134714471547164717471847194720472147224723472447254726472747284729473047314732473347344735473647374738473947404741474247434744474547464747474847494750475147524753475447554756475747584759476047614762476347644765476647674768476947704771477247734774477547764777477847794780478147824783478447854786478747884789479047914792479347944795479647974798479948004801480248034804480548064807480848094810481148124813481448154816481748184819482048214822482348244825482648274828482948304831483248334834483548364837483848394840484148424843484448454846484748484849485048514852485348544855485648574858485948604861486248634864486548664867486848694870487148724873487448754876487748784879488048814882488348844885488648874888488948904891489248934894489548964897489848994900490149024903490449054906490749084909491049114912491349144915491649174918491949204921492249234924492549264927492849294930493149324933493449354936493749384939494049414942494349444945494649474948494949504951495249534954495549564957495849594960496149624963496449654966496749684969497049714972497349744975497649774978497949804981498249834984498549864987498849894990499149924993499449954996499749984999500050015002500350045005500650075008500950105011501250135014501550165017501850195020502150225023502450255026502750285029503050315032503350345035503650375038503950405041504250435044504550465047504850495050505150525053505450555056505750585059506050615062506350645065506650675068506950705071507250735074507550765077507850795080508150825083508450855086508750885089509050915092509350945095509650975098509951005101510251035104510551065107510851095110511151125113511451155116511751185119512051215122512351245125512651275128512951305131513251335134513551365137513851395140514151425143514451455146514751485149515051515152515351545155515651575158515951605161516251635164516551665167516851695170517151725173517451755176517751785179518051815182518351845185518651875188518951905191519251935194519551965197519851995200520152025203520452055206520752085209521052115212521352145215521652175218521952205221522252235224522552265227522852295230523152325233523452355236523752385239524052415242524352445245524652475248524952505251525252535254525552565257525852595260526152625263526452655266526752685269527052715272527352745275527652775278527952805281528252835284528552865287528852895290529152925293529452955296529752985299530053015302530353045305530653075308530953105311531253135314531553165317531853195320532153225323532453255326532753285329533053315332533353345335533653375338533953405341534253435344534553465347534853495350535153525353535453555356535753585359536053615362536353645365536653675368536953705371537253735374537553765377537853795380538153825383538453855386538753885389539053915392539353945395539653975398539954005401540254035404540554065407540854095410541154125413541454155416541754185419542054215422542354245425542654275428542954305431543254335434543554365437543854395440544154425443544454455446544754485449545054515452545354545455545654575458545954605461546254635464546554665467546854695470547154725473547454755476547754785479548054815482548354845485548654875488548954905491549254935494549554965497549854995500550155025503550455055506550755085509551055115512551355145515551655175518551955205521552255235524552555265527552855295530553155325533553455355536553755385539554055415542554355445545554655475548554955505551555255535554555555565557555855595560556155625563556455655566556755685569557055715572557355745575557655775578557955805581558255835584558555865587558855895590559155925593559455955596559755985599560056015602560356045605560656075608560956105611561256135614561556165617561856195620562156225623562456255626562756285629563056315632563356345635563656375638563956405641564256435644564556465647564856495650565156525653565456555656565756585659566056615662566356645665566656675668566956705671567256735674567556765677567856795680568156825683568456855686568756885689569056915692569356945695569656975698569957005701570257035704570557065707570857095710571157125713571457155716571757185719572057215722572357245725572657275728572957305731573257335734573557365737573857395740574157425743574457455746574757485749575057515752575357545755575657575758575957605761576257635764576557665767576857695770577157725773577457755776577757785779578057815782578357845785578657875788578957905791579257935794579557965797579857995800580158025803580458055806580758085809581058115812581358145815581658175818581958205821582258235824582558265827582858295830583158325833583458355836583758385839584058415842584358445845584658475848584958505851585258535854585558565857585858595860586158625863586458655866586758685869587058715872587358745875587658775878587958805881588258835884588558865887588858895890589158925893589458955896589758985899590059015902590359045905590659075908590959105911591259135914591559165917591859195920592159225923592459255926592759285929593059315932593359345935593659375938593959405941594259435944594559465947594859495950595159525953595459555956595759585959596059615962596359645965596659675968596959705971597259735974597559765977597859795980598159825983598459855986598759885989599059915992599359945995599659975998599960006001600260036004600560066007600860096010601160126013601460156016601760186019602060216022602360246025602660276028602960306031603260336034603560366037603860396040604160426043604460456046604760486049605060516052605360546055605660576058605960606061606260636064606560666067606860696070607160726073607460756076607760786079608060816082608360846085608660876088608960906091609260936094609560966097609860996100610161026103610461056106610761086109611061116112611361146115611661176118611961206121612261236124612561266127612861296130613161326133613461356136613761386139614061416142614361446145614661476148614961506151615261536154615561566157615861596160616161626163616461656166616761686169617061716172617361746175617661776178617961806181618261836184618561866187618861896190619161926193619461956196619761986199620062016202620362046205620662076208620962106211621262136214621562166217621862196220622162226223622462256226622762286229623062316232623362346235623662376238623962406241624262436244624562466247624862496250625162526253625462556256625762586259626062616262626362646265626662676268626962706271627262736274627562766277627862796280628162826283628462856286628762886289629062916292629362946295629662976298629963006301630263036304630563066307630863096310631163126313631463156316631763186319632063216322632363246325632663276328632963306331633263336334633563366337633863396340634163426343634463456346634763486349635063516352635363546355635663576358635963606361636263636364636563666367
  1. /*
  2. * Copyright (c) 2013-2021, The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2021-2023 Qualcomm Innovation Center, Inc. All rights reserved.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for any
  6. * purpose with or without fee is hereby granted, provided that the above
  7. * copyright notice and this permission notice appear in all copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  10. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  11. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  12. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  13. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  14. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  15. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  16. */
  17. /**
  18. * DOC: Implement API's specific to roaming component.
  19. */
  20. #include <wmi_unified_priv.h>
  21. #include <wmi_unified_roam_api.h>
  22. #include <wmi_unified_roam_param.h>
  23. #include "wmi.h"
  24. #include "wlan_roam_debug.h"
  25. #include "ol_defines.h"
  26. #include "wlan_cm_roam_api.h"
  27. #include "wlan_mlme_api.h"
  28. #include "wlan_crypto_global_api.h"
  29. #define WMI_MAC_TO_PDEV_MAP(x) ((x) + (1))
  30. #define WMI_PDEV_TO_MAC_MAP(x) ((x) - (1))
  31. #ifdef FEATURE_LFR_SUBNET_DETECTION
  32. /**
  33. * send_set_gateway_params_cmd_tlv() - set gateway parameters
  34. * @wmi_handle: wmi handle
  35. * @req: gateway parameter update request structure
  36. *
  37. * This function reads the incoming @req and fill in the destination
  38. * WMI structure and sends down the gateway configs down to the firmware
  39. *
  40. * Return: QDF_STATUS
  41. */
  42. static QDF_STATUS send_set_gateway_params_cmd_tlv(wmi_unified_t wmi_handle,
  43. struct gateway_update_req_param *req)
  44. {
  45. wmi_roam_subnet_change_config_fixed_param *cmd;
  46. wmi_buf_t buf;
  47. QDF_STATUS ret;
  48. int len = sizeof(*cmd);
  49. buf = wmi_buf_alloc(wmi_handle, len);
  50. if (!buf)
  51. return QDF_STATUS_E_NOMEM;
  52. cmd = (wmi_roam_subnet_change_config_fixed_param *)wmi_buf_data(buf);
  53. WMITLV_SET_HDR(&cmd->tlv_header,
  54. WMITLV_TAG_STRUC_wmi_roam_subnet_change_config_fixed_param,
  55. WMITLV_GET_STRUCT_TLVLEN(
  56. wmi_roam_subnet_change_config_fixed_param));
  57. cmd->vdev_id = req->vdev_id;
  58. qdf_mem_copy(&cmd->inet_gw_ip_v4_addr, req->ipv4_addr,
  59. QDF_IPV4_ADDR_SIZE);
  60. qdf_mem_copy(&cmd->inet_gw_ip_v6_addr, req->ipv6_addr,
  61. QDF_IPV6_ADDR_SIZE);
  62. WMI_CHAR_ARRAY_TO_MAC_ADDR(req->gw_mac_addr.bytes,
  63. &cmd->inet_gw_mac_addr);
  64. cmd->max_retries = req->max_retries;
  65. cmd->timeout = req->timeout;
  66. cmd->num_skip_subnet_change_detection_bssid_list = 0;
  67. cmd->flag = 0;
  68. if (req->ipv4_addr_type)
  69. WMI_SET_ROAM_SUBNET_CHANGE_FLAG_IP4_ENABLED(cmd->flag);
  70. if (req->ipv6_addr_type)
  71. WMI_SET_ROAM_SUBNET_CHANGE_FLAG_IP6_ENABLED(cmd->flag);
  72. wmi_mtrace(WMI_ROAM_SUBNET_CHANGE_CONFIG_CMDID, cmd->vdev_id, 0);
  73. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  74. WMI_ROAM_SUBNET_CHANGE_CONFIG_CMDID);
  75. if (QDF_IS_STATUS_ERROR(ret)) {
  76. wmi_err("Failed to send gw config parameter to fw, ret: %d",
  77. ret);
  78. wmi_buf_free(buf);
  79. }
  80. return ret;
  81. }
  82. void wmi_lfr_subnet_detection_attach_tlv(struct wmi_unified *wmi_handle)
  83. {
  84. struct wmi_ops *ops = wmi_handle->ops;
  85. ops->send_set_gateway_params_cmd = send_set_gateway_params_cmd_tlv;
  86. }
  87. #endif /* FEATURE_LFR_SUBNET_DETECTION */
  88. #ifdef FEATURE_RSSI_MONITOR
  89. /**
  90. * send_set_rssi_monitoring_cmd_tlv() - set rssi monitoring
  91. * @wmi_handle: wmi handle
  92. * @req: rssi monitoring request structure
  93. *
  94. * This function reads the incoming @req and fill in the destination
  95. * WMI structure and send down the rssi monitoring configs down to the firmware
  96. *
  97. * Return: 0 on success; error number otherwise
  98. */
  99. static QDF_STATUS send_set_rssi_monitoring_cmd_tlv(wmi_unified_t wmi_handle,
  100. struct rssi_monitor_param *req)
  101. {
  102. wmi_rssi_breach_monitor_config_fixed_param *cmd;
  103. wmi_buf_t buf;
  104. QDF_STATUS ret;
  105. uint32_t len = sizeof(*cmd);
  106. buf = wmi_buf_alloc(wmi_handle, len);
  107. if (!buf)
  108. return QDF_STATUS_E_NOMEM;
  109. cmd = (wmi_rssi_breach_monitor_config_fixed_param *)wmi_buf_data(buf);
  110. WMITLV_SET_HDR(&cmd->tlv_header,
  111. WMITLV_TAG_STRUC_wmi_rssi_breach_monitor_config_fixed_param,
  112. WMITLV_GET_STRUCT_TLVLEN(
  113. wmi_rssi_breach_monitor_config_fixed_param));
  114. cmd->vdev_id = req->vdev_id;
  115. cmd->request_id = req->request_id;
  116. cmd->lo_rssi_reenable_hysteresis = 0;
  117. cmd->hi_rssi_reenable_histeresis = 0;
  118. cmd->min_report_interval = 0;
  119. cmd->max_num_report = 1;
  120. if (req->control) {
  121. /* enable one threshold for each min/max */
  122. cmd->enabled_bitmap = 0x09;
  123. cmd->low_rssi_breach_threshold[0] = req->min_rssi;
  124. cmd->hi_rssi_breach_threshold[0] = req->max_rssi;
  125. } else {
  126. cmd->enabled_bitmap = 0;
  127. cmd->low_rssi_breach_threshold[0] = 0;
  128. cmd->hi_rssi_breach_threshold[0] = 0;
  129. }
  130. wmi_mtrace(WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID, cmd->vdev_id, 0);
  131. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  132. WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID);
  133. if (QDF_IS_STATUS_ERROR(ret)) {
  134. wmi_err("Failed to send WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID");
  135. wmi_buf_free(buf);
  136. }
  137. wmi_debug("Sent WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID to FW");
  138. return ret;
  139. }
  140. void wmi_rssi_monitor_attach_tlv(struct wmi_unified *wmi_handle)
  141. {
  142. struct wmi_ops *ops = wmi_handle->ops;
  143. ops->send_set_rssi_monitoring_cmd = send_set_rssi_monitoring_cmd_tlv;
  144. }
  145. #endif /* FEATURE_RSSI_MONITOR */
  146. /**
  147. * send_roam_scan_offload_rssi_thresh_cmd_tlv() - set scan offload
  148. * rssi threshold
  149. * @wmi_handle: wmi handle
  150. * @roam_req: Roaming request buffer
  151. *
  152. * Send WMI_ROAM_SCAN_RSSI_THRESHOLD TLV to firmware
  153. *
  154. * Return: QDF status
  155. */
  156. static QDF_STATUS send_roam_scan_offload_rssi_thresh_cmd_tlv(
  157. wmi_unified_t wmi_handle,
  158. struct wlan_roam_offload_scan_rssi_params *roam_req)
  159. {
  160. wmi_buf_t buf = NULL;
  161. QDF_STATUS status;
  162. int len;
  163. uint8_t *buf_ptr;
  164. wmi_roam_scan_rssi_threshold_fixed_param *rssi_threshold_fp;
  165. wmi_roam_scan_extended_threshold_param *ext_thresholds = NULL;
  166. wmi_roam_earlystop_rssi_thres_param *early_stop_thresholds = NULL;
  167. wmi_roam_dense_thres_param *dense_thresholds = NULL;
  168. wmi_roam_bg_scan_roaming_param *bg_scan_params = NULL;
  169. wmi_roam_data_rssi_roaming_param *data_rssi_param = NULL;
  170. len = sizeof(wmi_roam_scan_rssi_threshold_fixed_param);
  171. len += WMI_TLV_HDR_SIZE; /* TLV for ext_thresholds*/
  172. len += sizeof(wmi_roam_scan_extended_threshold_param);
  173. len += WMI_TLV_HDR_SIZE;
  174. len += sizeof(wmi_roam_earlystop_rssi_thres_param);
  175. len += WMI_TLV_HDR_SIZE; /* TLV for dense thresholds*/
  176. len += sizeof(wmi_roam_dense_thres_param);
  177. len += WMI_TLV_HDR_SIZE; /* TLV for BG Scan*/
  178. len += sizeof(wmi_roam_bg_scan_roaming_param);
  179. len += WMI_TLV_HDR_SIZE; /* TLV for data RSSI*/
  180. len += sizeof(wmi_roam_data_rssi_roaming_param);
  181. buf = wmi_buf_alloc(wmi_handle, len);
  182. if (!buf)
  183. return QDF_STATUS_E_NOMEM;
  184. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  185. rssi_threshold_fp =
  186. (wmi_roam_scan_rssi_threshold_fixed_param *)buf_ptr;
  187. WMITLV_SET_HDR(
  188. &rssi_threshold_fp->tlv_header,
  189. WMITLV_TAG_STRUC_wmi_roam_scan_rssi_threshold_fixed_param,
  190. WMITLV_GET_STRUCT_TLVLEN
  191. (wmi_roam_scan_rssi_threshold_fixed_param));
  192. /* fill in threshold values */
  193. rssi_threshold_fp->vdev_id = roam_req->vdev_id;
  194. rssi_threshold_fp->roam_scan_rssi_thresh = roam_req->rssi_thresh;
  195. rssi_threshold_fp->roam_rssi_thresh_diff = roam_req->rssi_thresh_diff;
  196. rssi_threshold_fp->hirssi_scan_max_count =
  197. roam_req->hi_rssi_scan_max_count;
  198. rssi_threshold_fp->hirssi_scan_delta =
  199. roam_req->hi_rssi_scan_rssi_delta;
  200. rssi_threshold_fp->hirssi_upper_bound = roam_req->hi_rssi_scan_rssi_ub;
  201. rssi_threshold_fp->rssi_thresh_offset_5g =
  202. roam_req->rssi_thresh_offset_5g;
  203. buf_ptr += sizeof(wmi_roam_scan_rssi_threshold_fixed_param);
  204. WMITLV_SET_HDR(buf_ptr,
  205. WMITLV_TAG_ARRAY_STRUC,
  206. sizeof(wmi_roam_scan_extended_threshold_param));
  207. buf_ptr += WMI_TLV_HDR_SIZE;
  208. ext_thresholds = (wmi_roam_scan_extended_threshold_param *)buf_ptr;
  209. ext_thresholds->penalty_threshold_5g = roam_req->penalty_threshold_5g;
  210. if (roam_req->raise_rssi_thresh_5g >= WMI_NOISE_FLOOR_DBM_DEFAULT)
  211. ext_thresholds->boost_threshold_5g =
  212. roam_req->boost_threshold_5g;
  213. ext_thresholds->boost_algorithm_5g =
  214. WMI_ROAM_5G_BOOST_PENALIZE_ALGO_LINEAR;
  215. ext_thresholds->boost_factor_5g = roam_req->raise_factor_5g;
  216. ext_thresholds->penalty_algorithm_5g =
  217. WMI_ROAM_5G_BOOST_PENALIZE_ALGO_LINEAR;
  218. ext_thresholds->penalty_factor_5g = roam_req->drop_factor_5g;
  219. ext_thresholds->max_boost_5g = roam_req->max_raise_rssi_5g;
  220. ext_thresholds->max_penalty_5g = roam_req->max_drop_rssi_5g;
  221. ext_thresholds->good_rssi_threshold = roam_req->good_rssi_threshold;
  222. WMITLV_SET_HDR(&ext_thresholds->tlv_header,
  223. WMITLV_TAG_STRUC_wmi_roam_scan_extended_threshold_param,
  224. WMITLV_GET_STRUCT_TLVLEN
  225. (wmi_roam_scan_extended_threshold_param));
  226. buf_ptr += sizeof(wmi_roam_scan_extended_threshold_param);
  227. WMITLV_SET_HDR(buf_ptr,
  228. WMITLV_TAG_ARRAY_STRUC,
  229. sizeof(wmi_roam_earlystop_rssi_thres_param));
  230. buf_ptr += WMI_TLV_HDR_SIZE;
  231. early_stop_thresholds = (wmi_roam_earlystop_rssi_thres_param *)buf_ptr;
  232. early_stop_thresholds->roam_earlystop_thres_min =
  233. roam_req->roam_earlystop_thres_min;
  234. early_stop_thresholds->roam_earlystop_thres_max =
  235. roam_req->roam_earlystop_thres_max;
  236. WMITLV_SET_HDR(&early_stop_thresholds->tlv_header,
  237. WMITLV_TAG_STRUC_wmi_roam_earlystop_rssi_thres_param,
  238. WMITLV_GET_STRUCT_TLVLEN
  239. (wmi_roam_earlystop_rssi_thres_param));
  240. buf_ptr += sizeof(wmi_roam_earlystop_rssi_thres_param);
  241. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  242. sizeof(wmi_roam_dense_thres_param));
  243. buf_ptr += WMI_TLV_HDR_SIZE;
  244. dense_thresholds = (wmi_roam_dense_thres_param *)buf_ptr;
  245. dense_thresholds->roam_dense_rssi_thres_offset =
  246. roam_req->dense_rssi_thresh_offset;
  247. dense_thresholds->roam_dense_min_aps = roam_req->dense_min_aps_cnt;
  248. dense_thresholds->roam_dense_traffic_thres =
  249. roam_req->traffic_threshold;
  250. dense_thresholds->roam_dense_status = roam_req->initial_dense_status;
  251. WMITLV_SET_HDR(&dense_thresholds->tlv_header,
  252. WMITLV_TAG_STRUC_wmi_roam_dense_thres_param,
  253. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_dense_thres_param));
  254. buf_ptr += sizeof(wmi_roam_dense_thres_param);
  255. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  256. sizeof(wmi_roam_bg_scan_roaming_param));
  257. buf_ptr += WMI_TLV_HDR_SIZE;
  258. bg_scan_params = (wmi_roam_bg_scan_roaming_param *)buf_ptr;
  259. bg_scan_params->roam_bg_scan_bad_rssi_thresh =
  260. roam_req->bg_scan_bad_rssi_thresh;
  261. bg_scan_params->roam_bg_scan_client_bitmap =
  262. roam_req->bg_scan_client_bitmap;
  263. bg_scan_params->bad_rssi_thresh_offset_2g =
  264. roam_req->roam_bad_rssi_thresh_offset_2g;
  265. bg_scan_params->flags = 0;
  266. if (roam_req->roam_bad_rssi_thresh_offset_2g)
  267. bg_scan_params->flags |= WMI_ROAM_BG_SCAN_FLAGS_2G_TO_5G_ONLY;
  268. WMITLV_SET_HDR(&bg_scan_params->tlv_header,
  269. WMITLV_TAG_STRUC_wmi_roam_bg_scan_roaming_param,
  270. WMITLV_GET_STRUCT_TLVLEN
  271. (wmi_roam_bg_scan_roaming_param));
  272. buf_ptr += sizeof(wmi_roam_bg_scan_roaming_param);
  273. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  274. sizeof(wmi_roam_data_rssi_roaming_param));
  275. buf_ptr += WMI_TLV_HDR_SIZE;
  276. data_rssi_param = (wmi_roam_data_rssi_roaming_param *)buf_ptr;
  277. data_rssi_param->flags =
  278. roam_req->roam_data_rssi_threshold_triggers;
  279. data_rssi_param->roam_data_rssi_thres =
  280. roam_req->roam_data_rssi_threshold;
  281. data_rssi_param->rx_inactivity_ms =
  282. roam_req->rx_data_inactivity_time;
  283. WMITLV_SET_HDR(&data_rssi_param->tlv_header,
  284. WMITLV_TAG_STRUC_wmi_roam_data_rssi_roaming_param,
  285. WMITLV_GET_STRUCT_TLVLEN
  286. (wmi_roam_data_rssi_roaming_param));
  287. wmi_debug("vdev %d Data rssi threshold: %d, triggers: 0x%x, rx time: %d, rssi_thresh:%d",
  288. rssi_threshold_fp->vdev_id,
  289. data_rssi_param->roam_data_rssi_thres,
  290. data_rssi_param->flags,
  291. data_rssi_param->rx_inactivity_ms,
  292. rssi_threshold_fp->roam_scan_rssi_thresh);
  293. wmi_mtrace(WMI_ROAM_SCAN_RSSI_THRESHOLD, NO_SESSION, 0);
  294. status = wmi_unified_cmd_send(wmi_handle, buf,
  295. len, WMI_ROAM_SCAN_RSSI_THRESHOLD);
  296. if (QDF_IS_STATUS_ERROR(status)) {
  297. wmi_err("cmd WMI_ROAM_SCAN_RSSI_THRESHOLD returned Error %d",
  298. status);
  299. wmi_buf_free(buf);
  300. }
  301. return status;
  302. }
  303. /**
  304. * send_roam_scan_offload_scan_period_cmd_tlv() - set roam offload scan period
  305. * @wmi_handle: wmi handle
  306. * @param: roam scan parameters to be sent to firmware
  307. *
  308. * Send WMI_ROAM_SCAN_PERIOD parameters to fw.
  309. *
  310. * Return: QDF status
  311. */
  312. static QDF_STATUS
  313. send_roam_scan_offload_scan_period_cmd_tlv(
  314. wmi_unified_t wmi_handle,
  315. struct wlan_roam_scan_period_params *param)
  316. {
  317. QDF_STATUS status;
  318. wmi_buf_t buf = NULL;
  319. int len;
  320. uint8_t *buf_ptr;
  321. wmi_roam_scan_period_fixed_param *scan_period_fp;
  322. /* Send scan period values */
  323. len = sizeof(wmi_roam_scan_period_fixed_param);
  324. buf = wmi_buf_alloc(wmi_handle, len);
  325. if (!buf)
  326. return QDF_STATUS_E_NOMEM;
  327. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  328. scan_period_fp = (wmi_roam_scan_period_fixed_param *)buf_ptr;
  329. WMITLV_SET_HDR(&scan_period_fp->tlv_header,
  330. WMITLV_TAG_STRUC_wmi_roam_scan_period_fixed_param,
  331. WMITLV_GET_STRUCT_TLVLEN
  332. (wmi_roam_scan_period_fixed_param));
  333. /* fill in scan period values */
  334. scan_period_fp->vdev_id = param->vdev_id;
  335. scan_period_fp->roam_scan_period = param->scan_period;
  336. scan_period_fp->roam_scan_age = param->scan_age;
  337. scan_period_fp->inactivity_time_period =
  338. param->roam_scan_inactivity_time;
  339. scan_period_fp->roam_inactive_count =
  340. param->roam_inactive_data_packet_count;
  341. /* Firmware expects the full scan period in msec whereas host
  342. * provides the same in seconds.
  343. * Convert it to msec and send to firmware
  344. */
  345. scan_period_fp->roam_full_scan_period = param->full_scan_period * 1000;
  346. wmi_debug("roam_scan_period=%d, roam_scan_age=%d, full_scan_period= %u",
  347. scan_period_fp->roam_scan_period,
  348. scan_period_fp->roam_scan_age,
  349. scan_period_fp->roam_full_scan_period);
  350. wmi_debug("inactiviy time:%d inactive cnt:%d",
  351. scan_period_fp->inactivity_time_period,
  352. scan_period_fp->roam_inactive_count);
  353. wmi_mtrace(WMI_ROAM_SCAN_PERIOD, NO_SESSION, 0);
  354. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  355. WMI_ROAM_SCAN_PERIOD);
  356. if (QDF_IS_STATUS_ERROR(status)) {
  357. wmi_buf_free(buf);
  358. return status;
  359. }
  360. return QDF_STATUS_SUCCESS;
  361. }
  362. static QDF_STATUS send_roam_mawc_params_cmd_tlv(
  363. wmi_unified_t wmi_handle,
  364. struct wlan_roam_mawc_params *params)
  365. {
  366. wmi_buf_t buf = NULL;
  367. QDF_STATUS status;
  368. int len;
  369. uint8_t *buf_ptr;
  370. wmi_roam_configure_mawc_cmd_fixed_param *wmi_roam_mawc_params;
  371. len = sizeof(*wmi_roam_mawc_params);
  372. buf = wmi_buf_alloc(wmi_handle, len);
  373. if (!buf)
  374. return QDF_STATUS_E_NOMEM;
  375. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  376. wmi_roam_mawc_params =
  377. (wmi_roam_configure_mawc_cmd_fixed_param *)buf_ptr;
  378. WMITLV_SET_HDR(&wmi_roam_mawc_params->tlv_header,
  379. WMITLV_TAG_STRUC_wmi_roam_configure_mawc_cmd_fixed_param,
  380. WMITLV_GET_STRUCT_TLVLEN
  381. (wmi_roam_configure_mawc_cmd_fixed_param));
  382. wmi_roam_mawc_params->vdev_id = params->vdev_id;
  383. if (params->enable)
  384. wmi_roam_mawc_params->enable = 1;
  385. else
  386. wmi_roam_mawc_params->enable = 0;
  387. wmi_roam_mawc_params->traffic_load_threshold =
  388. params->traffic_load_threshold;
  389. wmi_roam_mawc_params->best_ap_rssi_threshold =
  390. params->best_ap_rssi_threshold;
  391. wmi_roam_mawc_params->rssi_stationary_high_adjust =
  392. params->rssi_stationary_high_adjust;
  393. wmi_roam_mawc_params->rssi_stationary_low_adjust =
  394. params->rssi_stationary_low_adjust;
  395. wmi_debug("MAWC roam en=%d, vdev=%d, tr=%d, ap=%d, high=%d, low=%d",
  396. wmi_roam_mawc_params->enable, wmi_roam_mawc_params->vdev_id,
  397. wmi_roam_mawc_params->traffic_load_threshold,
  398. wmi_roam_mawc_params->best_ap_rssi_threshold,
  399. wmi_roam_mawc_params->rssi_stationary_high_adjust,
  400. wmi_roam_mawc_params->rssi_stationary_low_adjust);
  401. wmi_mtrace(WMI_ROAM_CONFIGURE_MAWC_CMDID, NO_SESSION, 0);
  402. status = wmi_unified_cmd_send(wmi_handle, buf,
  403. len, WMI_ROAM_CONFIGURE_MAWC_CMDID);
  404. if (QDF_IS_STATUS_ERROR(status)) {
  405. wmi_err("WMI_ROAM_CONFIGURE_MAWC_CMDID failed, Error %d",
  406. status);
  407. wmi_buf_free(buf);
  408. return status;
  409. }
  410. return QDF_STATUS_SUCCESS;
  411. }
  412. /**
  413. * send_roam_scan_filter_cmd_tlv() - Filter to be applied while roaming
  414. * @wmi_handle: wmi handle
  415. * @roam_req: Request which contains the filters
  416. *
  417. * There are filters such as allowlist, denylist and preferred
  418. * list that need to be applied to the scan results to form the
  419. * probable candidates for roaming.
  420. *
  421. * Return: Return success upon successfully passing the
  422. * parameters to the firmware, otherwise failure.
  423. */
  424. static QDF_STATUS send_roam_scan_filter_cmd_tlv(wmi_unified_t wmi_handle,
  425. struct roam_scan_filter_params *roam_req)
  426. {
  427. wmi_buf_t buf = NULL;
  428. QDF_STATUS status;
  429. uint32_t i;
  430. uint32_t len, blist_len = 0;
  431. uint8_t *buf_ptr;
  432. wmi_roam_filter_fixed_param *roam_filter;
  433. uint8_t *bssid_src_ptr = NULL;
  434. wmi_mac_addr *bssid_dst_ptr = NULL;
  435. wmi_ssid *ssid_ptr = NULL;
  436. uint32_t *bssid_preferred_factor_ptr = NULL;
  437. wmi_roam_lca_disallow_config_tlv_param *blist_param;
  438. wmi_roam_rssi_rejection_oce_config_param *rssi_rej;
  439. len = sizeof(wmi_roam_filter_fixed_param);
  440. len += WMI_TLV_HDR_SIZE;
  441. if (roam_req->num_bssid_deny_list)
  442. len += roam_req->num_bssid_deny_list * sizeof(wmi_mac_addr);
  443. len += WMI_TLV_HDR_SIZE;
  444. if (roam_req->num_ssid_allow_list)
  445. len += roam_req->num_ssid_allow_list * sizeof(wmi_ssid);
  446. len += 2 * WMI_TLV_HDR_SIZE;
  447. if (roam_req->num_bssid_preferred_list) {
  448. len += (roam_req->num_bssid_preferred_list *
  449. sizeof(wmi_mac_addr));
  450. len += roam_req->num_bssid_preferred_list * sizeof(uint32_t);
  451. }
  452. len += WMI_TLV_HDR_SIZE;
  453. if (roam_req->lca_disallow_config_present) {
  454. len += sizeof(*blist_param);
  455. blist_len = sizeof(*blist_param);
  456. }
  457. len += WMI_TLV_HDR_SIZE;
  458. if (roam_req->num_rssi_rejection_ap)
  459. len += roam_req->num_rssi_rejection_ap * sizeof(*rssi_rej);
  460. buf = wmi_buf_alloc(wmi_handle, len);
  461. if (!buf)
  462. return QDF_STATUS_E_NOMEM;
  463. buf_ptr = (u_int8_t *)wmi_buf_data(buf);
  464. roam_filter = (wmi_roam_filter_fixed_param *)buf_ptr;
  465. WMITLV_SET_HDR(&roam_filter->tlv_header,
  466. WMITLV_TAG_STRUC_wmi_roam_filter_fixed_param,
  467. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_filter_fixed_param));
  468. /* fill in fixed values */
  469. roam_filter->vdev_id = roam_req->vdev_id;
  470. roam_filter->flags = 0;
  471. roam_filter->op_bitmap = roam_req->op_bitmap;
  472. roam_filter->num_bssid_black_list = roam_req->num_bssid_deny_list;
  473. roam_filter->num_ssid_white_list = roam_req->num_ssid_allow_list;
  474. roam_filter->num_bssid_preferred_list =
  475. roam_req->num_bssid_preferred_list;
  476. roam_filter->num_rssi_rejection_ap =
  477. roam_req->num_rssi_rejection_ap;
  478. roam_filter->delta_rssi = roam_req->delta_rssi;
  479. buf_ptr += sizeof(wmi_roam_filter_fixed_param);
  480. WMITLV_SET_HDR((buf_ptr),
  481. WMITLV_TAG_ARRAY_FIXED_STRUC,
  482. (roam_req->num_bssid_deny_list * sizeof(wmi_mac_addr)));
  483. bssid_src_ptr = (uint8_t *)&roam_req->bssid_avoid_list;
  484. bssid_dst_ptr = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE);
  485. for (i = 0; i < roam_req->num_bssid_deny_list; i++) {
  486. WMI_CHAR_ARRAY_TO_MAC_ADDR(bssid_src_ptr, bssid_dst_ptr);
  487. bssid_src_ptr += ATH_MAC_LEN;
  488. bssid_dst_ptr++;
  489. }
  490. buf_ptr += WMI_TLV_HDR_SIZE +
  491. (roam_req->num_bssid_deny_list * sizeof(wmi_mac_addr));
  492. WMITLV_SET_HDR((buf_ptr),
  493. WMITLV_TAG_ARRAY_FIXED_STRUC,
  494. (roam_req->num_ssid_allow_list * sizeof(wmi_ssid)));
  495. ssid_ptr = (wmi_ssid *)(buf_ptr + WMI_TLV_HDR_SIZE);
  496. for (i = 0; i < roam_req->num_ssid_allow_list; i++) {
  497. qdf_mem_copy(&ssid_ptr->ssid,
  498. &roam_req->ssid_allowed_list[i].ssid,
  499. roam_req->ssid_allowed_list[i].length);
  500. ssid_ptr->ssid_len = roam_req->ssid_allowed_list[i].length;
  501. ssid_ptr++;
  502. }
  503. buf_ptr += WMI_TLV_HDR_SIZE + (roam_req->num_ssid_allow_list *
  504. sizeof(wmi_ssid));
  505. WMITLV_SET_HDR((buf_ptr),
  506. WMITLV_TAG_ARRAY_FIXED_STRUC,
  507. (roam_req->num_bssid_preferred_list * sizeof(wmi_mac_addr)));
  508. bssid_src_ptr = (uint8_t *)&roam_req->bssid_favored;
  509. bssid_dst_ptr = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE);
  510. for (i = 0; i < roam_req->num_bssid_preferred_list; i++) {
  511. WMI_CHAR_ARRAY_TO_MAC_ADDR(bssid_src_ptr,
  512. (wmi_mac_addr *)bssid_dst_ptr);
  513. bssid_src_ptr += ATH_MAC_LEN;
  514. bssid_dst_ptr++;
  515. }
  516. buf_ptr += WMI_TLV_HDR_SIZE +
  517. (roam_req->num_bssid_preferred_list * sizeof(wmi_mac_addr));
  518. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  519. (roam_req->num_bssid_preferred_list * sizeof(uint32_t)));
  520. bssid_preferred_factor_ptr = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
  521. for (i = 0; i < roam_req->num_bssid_preferred_list; i++) {
  522. *bssid_preferred_factor_ptr =
  523. roam_req->bssid_favored_factor[i];
  524. bssid_preferred_factor_ptr++;
  525. }
  526. buf_ptr += WMI_TLV_HDR_SIZE +
  527. (roam_req->num_bssid_preferred_list * sizeof(uint32_t));
  528. WMITLV_SET_HDR(buf_ptr,
  529. WMITLV_TAG_ARRAY_STRUC, blist_len);
  530. buf_ptr += WMI_TLV_HDR_SIZE;
  531. if (roam_req->lca_disallow_config_present) {
  532. blist_param =
  533. (wmi_roam_lca_disallow_config_tlv_param *)buf_ptr;
  534. WMITLV_SET_HDR(&blist_param->tlv_header,
  535. WMITLV_TAG_STRUC_wmi_roam_lca_disallow_config_tlv_param,
  536. WMITLV_GET_STRUCT_TLVLEN(
  537. wmi_roam_lca_disallow_config_tlv_param));
  538. blist_param->disallow_duration = roam_req->disallow_duration;
  539. blist_param->rssi_channel_penalization =
  540. roam_req->rssi_channel_penalization;
  541. blist_param->num_disallowed_aps = roam_req->num_disallowed_aps;
  542. blist_param->disallow_lca_enable_source_bitmap =
  543. (WMI_ROAM_LCA_DISALLOW_SOURCE_PER |
  544. WMI_ROAM_LCA_DISALLOW_SOURCE_BACKGROUND);
  545. buf_ptr += (sizeof(wmi_roam_lca_disallow_config_tlv_param));
  546. }
  547. WMITLV_SET_HDR(buf_ptr,
  548. WMITLV_TAG_ARRAY_STRUC,
  549. (roam_req->num_rssi_rejection_ap * sizeof(*rssi_rej)));
  550. buf_ptr += WMI_TLV_HDR_SIZE;
  551. for (i = 0; i < roam_req->num_rssi_rejection_ap; i++) {
  552. rssi_rej =
  553. (wmi_roam_rssi_rejection_oce_config_param *)buf_ptr;
  554. WMITLV_SET_HDR(&rssi_rej->tlv_header,
  555. WMITLV_TAG_STRUC_wmi_roam_rssi_rejection_oce_config_param,
  556. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_rssi_rejection_oce_config_param));
  557. WMI_CHAR_ARRAY_TO_MAC_ADDR(
  558. roam_req->rssi_rejection_ap[i].bssid.bytes,
  559. &rssi_rej->bssid);
  560. rssi_rej->remaining_disallow_duration =
  561. roam_req->rssi_rejection_ap[i].reject_duration;
  562. rssi_rej->requested_rssi =
  563. (int32_t)roam_req->rssi_rejection_ap[i].expected_rssi;
  564. buf_ptr +=
  565. (sizeof(wmi_roam_rssi_rejection_oce_config_param));
  566. }
  567. wmi_mtrace(WMI_ROAM_FILTER_CMDID, NO_SESSION, 0);
  568. status = wmi_unified_cmd_send(wmi_handle, buf,
  569. len, WMI_ROAM_FILTER_CMDID);
  570. if (QDF_IS_STATUS_ERROR(status)) {
  571. wmi_err("cmd WMI_ROAM_FILTER_CMDID returned Error %d",
  572. status);
  573. wmi_buf_free(buf);
  574. }
  575. return status;
  576. }
  577. #ifdef FEATURE_WLAN_ESE
  578. /**
  579. * send_plm_stop_cmd_tlv() - plm stop request
  580. * @wmi_handle: wmi handle
  581. * @plm: plm request parameters
  582. *
  583. * This function request FW to stop PLM.
  584. *
  585. * Return: CDF status
  586. */
  587. static QDF_STATUS send_plm_stop_cmd_tlv(wmi_unified_t wmi_handle,
  588. const struct plm_req_params *plm)
  589. {
  590. wmi_vdev_plmreq_stop_cmd_fixed_param *cmd;
  591. int32_t len;
  592. wmi_buf_t buf;
  593. uint8_t *buf_ptr;
  594. int ret;
  595. len = sizeof(*cmd);
  596. buf = wmi_buf_alloc(wmi_handle, len);
  597. if (!buf)
  598. return QDF_STATUS_E_NOMEM;
  599. cmd = (wmi_vdev_plmreq_stop_cmd_fixed_param *)wmi_buf_data(buf);
  600. buf_ptr = (uint8_t *)cmd;
  601. WMITLV_SET_HDR(&cmd->tlv_header,
  602. WMITLV_TAG_STRUC_wmi_vdev_plmreq_stop_cmd_fixed_param,
  603. WMITLV_GET_STRUCT_TLVLEN
  604. (wmi_vdev_plmreq_stop_cmd_fixed_param));
  605. cmd->vdev_id = plm->vdev_id;
  606. cmd->meas_token = plm->meas_token;
  607. wmi_debug("vdev %d meas token %d", cmd->vdev_id, cmd->meas_token);
  608. wmi_mtrace(WMI_VDEV_PLMREQ_STOP_CMDID, cmd->vdev_id, 0);
  609. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  610. WMI_VDEV_PLMREQ_STOP_CMDID);
  611. if (ret) {
  612. wmi_err("Failed to send plm stop wmi cmd");
  613. wmi_buf_free(buf);
  614. return QDF_STATUS_E_FAILURE;
  615. }
  616. return QDF_STATUS_SUCCESS;
  617. }
  618. /**
  619. * send_plm_start_cmd_tlv() - plm start request
  620. * @wmi_handle: wmi handle
  621. * @plm: plm request parameters
  622. *
  623. * This function request FW to start PLM.
  624. *
  625. * Return: CDF status
  626. */
  627. static QDF_STATUS send_plm_start_cmd_tlv(wmi_unified_t wmi_handle,
  628. const struct plm_req_params *plm)
  629. {
  630. wmi_vdev_plmreq_start_cmd_fixed_param *cmd;
  631. uint32_t *channel_list;
  632. int32_t len;
  633. wmi_buf_t buf;
  634. uint8_t *buf_ptr;
  635. uint8_t count;
  636. int ret;
  637. /* TLV place holder for channel_list */
  638. len = sizeof(*cmd) + WMI_TLV_HDR_SIZE;
  639. len += sizeof(uint32_t) * plm->plm_num_ch;
  640. buf = wmi_buf_alloc(wmi_handle, len);
  641. if (!buf)
  642. return QDF_STATUS_E_NOMEM;
  643. cmd = (wmi_vdev_plmreq_start_cmd_fixed_param *)wmi_buf_data(buf);
  644. buf_ptr = (uint8_t *)cmd;
  645. WMITLV_SET_HDR(&cmd->tlv_header,
  646. WMITLV_TAG_STRUC_wmi_vdev_plmreq_start_cmd_fixed_param,
  647. WMITLV_GET_STRUCT_TLVLEN
  648. (wmi_vdev_plmreq_start_cmd_fixed_param));
  649. cmd->vdev_id = plm->vdev_id;
  650. cmd->meas_token = plm->meas_token;
  651. cmd->dialog_token = plm->diag_token;
  652. cmd->number_bursts = plm->num_bursts;
  653. cmd->burst_interval = WMI_SEC_TO_MSEC(plm->burst_int);
  654. cmd->off_duration = plm->meas_duration;
  655. cmd->burst_cycle = plm->burst_len;
  656. cmd->tx_power = plm->desired_tx_pwr;
  657. WMI_CHAR_ARRAY_TO_MAC_ADDR(plm->mac_addr.bytes, &cmd->dest_mac);
  658. cmd->num_chans = plm->plm_num_ch;
  659. buf_ptr += sizeof(wmi_vdev_plmreq_start_cmd_fixed_param);
  660. wmi_debug("vdev: %d measu token: %d dialog_token: %d number_bursts: %d burst_interval: %d off_duration: %d burst_cycle: %d tx_power: %d Number of channels: %d",
  661. cmd->vdev_id, cmd->meas_token, cmd->dialog_token,
  662. cmd->number_bursts, cmd->burst_interval, cmd->off_duration,
  663. cmd->burst_cycle, cmd->tx_power, cmd->num_chans);
  664. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  665. (cmd->num_chans * sizeof(uint32_t)));
  666. buf_ptr += WMI_TLV_HDR_SIZE;
  667. if (cmd->num_chans) {
  668. channel_list = (uint32_t *)buf_ptr;
  669. for (count = 0; count < cmd->num_chans; count++) {
  670. channel_list[count] = plm->plm_ch_freq_list[count];
  671. wmi_debug("Ch[%d]: %d MHz", count, channel_list[count]);
  672. }
  673. buf_ptr += cmd->num_chans * sizeof(uint32_t);
  674. }
  675. wmi_mtrace(WMI_VDEV_PLMREQ_START_CMDID, cmd->vdev_id, 0);
  676. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  677. WMI_VDEV_PLMREQ_START_CMDID);
  678. if (ret) {
  679. wmi_err("Failed to send plm start wmi cmd");
  680. wmi_buf_free(buf);
  681. return QDF_STATUS_E_FAILURE;
  682. }
  683. return QDF_STATUS_SUCCESS;
  684. }
  685. void wmi_ese_attach_tlv(wmi_unified_t wmi_handle)
  686. {
  687. struct wmi_ops *ops = wmi_handle->ops;
  688. ops->send_plm_stop_cmd = send_plm_stop_cmd_tlv;
  689. ops->send_plm_start_cmd = send_plm_start_cmd_tlv;
  690. }
  691. #endif /* FEATURE_WLAN_ESE */
  692. /**
  693. * convert_roam_trigger_reason() - Function to convert unified Roam trigger
  694. * enum to TLV specific WMI_ROAM_TRIGGER_REASON_ID
  695. * @trigger_reason: Roam trigger reason
  696. *
  697. * Return: WMI roam trigger reason
  698. */
  699. static uint32_t
  700. convert_roam_trigger_reason(enum roam_trigger_reason trigger_reason)
  701. {
  702. switch (trigger_reason) {
  703. case ROAM_TRIGGER_REASON_NONE:
  704. return WMI_ROAM_TRIGGER_REASON_NONE;
  705. case ROAM_TRIGGER_REASON_PER:
  706. return WMI_ROAM_TRIGGER_REASON_PER;
  707. case ROAM_TRIGGER_REASON_BMISS:
  708. return WMI_ROAM_TRIGGER_REASON_BMISS;
  709. case ROAM_TRIGGER_REASON_LOW_RSSI:
  710. return WMI_ROAM_TRIGGER_REASON_LOW_RSSI;
  711. case ROAM_TRIGGER_REASON_HIGH_RSSI:
  712. return WMI_ROAM_TRIGGER_REASON_HIGH_RSSI;
  713. case ROAM_TRIGGER_REASON_PERIODIC:
  714. return WMI_ROAM_TRIGGER_REASON_PERIODIC;
  715. case ROAM_TRIGGER_REASON_MAWC:
  716. return WMI_ROAM_TRIGGER_REASON_MAWC;
  717. case ROAM_TRIGGER_REASON_DENSE:
  718. return WMI_ROAM_TRIGGER_REASON_DENSE;
  719. case ROAM_TRIGGER_REASON_BACKGROUND:
  720. return WMI_ROAM_TRIGGER_REASON_BACKGROUND;
  721. case ROAM_TRIGGER_REASON_FORCED:
  722. return WMI_ROAM_TRIGGER_REASON_FORCED;
  723. case ROAM_TRIGGER_REASON_BTM:
  724. return WMI_ROAM_TRIGGER_REASON_BTM;
  725. case ROAM_TRIGGER_REASON_UNIT_TEST:
  726. return WMI_ROAM_TRIGGER_REASON_UNIT_TEST;
  727. case ROAM_TRIGGER_REASON_BSS_LOAD:
  728. return WMI_ROAM_TRIGGER_REASON_BSS_LOAD;
  729. case ROAM_TRIGGER_REASON_DEAUTH:
  730. return WMI_ROAM_TRIGGER_REASON_DEAUTH;
  731. case ROAM_TRIGGER_REASON_IDLE:
  732. return WMI_ROAM_TRIGGER_REASON_IDLE;
  733. case ROAM_TRIGGER_REASON_STA_KICKOUT:
  734. return WMI_ROAM_TRIGGER_REASON_STA_KICKOUT;
  735. case ROAM_TRIGGER_REASON_ESS_RSSI:
  736. return WMI_ROAM_TRIGGER_REASON_ESS_RSSI;
  737. case ROAM_TRIGGER_REASON_WTC_BTM:
  738. return WMI_ROAM_TRIGGER_REASON_WTC_BTM;
  739. case ROAM_TRIGGER_REASON_PMK_TIMEOUT:
  740. return WMI_ROAM_TRIGGER_REASON_PMK_TIMEOUT;
  741. case ROAM_TRIGGER_REASON_BTC:
  742. return WMI_ROAM_TRIGGER_REASON_BTC;
  743. case ROAM_TRIGGER_REASON_MAX:
  744. return WMI_ROAM_TRIGGER_REASON_MAX;
  745. default:
  746. return WMI_ROAM_TRIGGER_REASON_NONE;
  747. }
  748. }
  749. #if defined(WLAN_FEATURE_HOST_ROAM) || defined(WLAN_FEATURE_ROAM_OFFLOAD)
  750. static char *wmi_get_roam_event_reason_string(uint32_t reason)
  751. {
  752. switch (reason) {
  753. case WMI_ROAM_REASON_INVALID:
  754. return "Default";
  755. case WMI_ROAM_REASON_BETTER_AP:
  756. return "Better AP";
  757. case WMI_ROAM_REASON_BMISS:
  758. return "BMISS";
  759. case WMI_ROAM_REASON_LOW_RSSI:
  760. return "Low Rssi";
  761. case WMI_ROAM_REASON_SUITABLE_AP:
  762. return "Suitable AP";
  763. case WMI_ROAM_REASON_HO_FAILED:
  764. return "Hand-off Failed";
  765. case WMI_ROAM_REASON_INVOKE_ROAM_FAIL:
  766. return "Roam Invoke failed";
  767. case WMI_ROAM_REASON_RSO_STATUS:
  768. return "RSO status";
  769. case WMI_ROAM_REASON_BTM:
  770. return "BTM";
  771. case WMI_ROAM_REASON_DEAUTH:
  772. return "Deauth";
  773. default:
  774. return "Invalid";
  775. }
  776. return "Invalid";
  777. }
  778. static enum roam_reason
  779. wmi_convert_fw_reason_to_cm_reason(uint32_t reason)
  780. {
  781. switch (reason) {
  782. case WMI_ROAM_REASON_INVALID:
  783. return ROAM_REASON_INVALID;
  784. case WMI_ROAM_REASON_BETTER_AP:
  785. return ROAM_REASON_BETTER_AP;
  786. case WMI_ROAM_REASON_BMISS:
  787. return ROAM_REASON_BMISS;
  788. case WMI_ROAM_REASON_LOW_RSSI:
  789. return ROAM_REASON_LOW_RSSI;
  790. case WMI_ROAM_REASON_SUITABLE_AP:
  791. return ROAM_REASON_SUITABLE_AP;
  792. case WMI_ROAM_REASON_HO_FAILED:
  793. return ROAM_REASON_HO_FAILED;
  794. case WMI_ROAM_REASON_INVOKE_ROAM_FAIL:
  795. return ROAM_REASON_INVOKE_ROAM_FAIL;
  796. case WMI_ROAM_REASON_RSO_STATUS:
  797. return ROAM_REASON_RSO_STATUS;
  798. case WMI_ROAM_REASON_BTM:
  799. return ROAM_REASON_BTM;
  800. case WMI_ROAM_REASON_DEAUTH:
  801. return ROAM_REASON_DEAUTH;
  802. default:
  803. return ROAM_REASON_INVALID;
  804. }
  805. return ROAM_REASON_INVALID;
  806. }
  807. static enum cm_roam_notif
  808. wmi_convert_fw_notif_to_cm_notif(uint32_t fw_notif)
  809. {
  810. switch (fw_notif) {
  811. case WMI_ROAM_NOTIF_ROAM_START:
  812. return CM_ROAM_NOTIF_ROAM_START;
  813. case WMI_ROAM_NOTIF_ROAM_ABORT:
  814. return CM_ROAM_NOTIF_ROAM_ABORT;
  815. case WMI_ROAM_NOTIF_ROAM_REASSOC:
  816. return CM_ROAM_NOTIF_ROAM_REASSOC;
  817. case WMI_ROAM_NOTIF_SCAN_MODE_SUCCESS:
  818. return CM_ROAM_NOTIF_SCAN_MODE_SUCCESS;
  819. case WMI_ROAM_NOTIF_SCAN_MODE_FAIL:
  820. return CM_ROAM_NOTIF_SCAN_MODE_FAIL;
  821. case WMI_ROAM_NOTIF_DISCONNECT:
  822. return CM_ROAM_NOTIF_DISCONNECT;
  823. case WMI_ROAM_NOTIF_SUBNET_CHANGED:
  824. return CM_ROAM_NOTIF_SUBNET_CHANGED;
  825. case WMI_ROAM_NOTIF_SCAN_START:
  826. return CM_ROAM_NOTIF_SCAN_START;
  827. case WMI_ROAM_NOTIF_DEAUTH_RECV:
  828. return CM_ROAM_NOTIF_DEAUTH_RECV;
  829. case WMI_ROAM_NOTIF_DISASSOC_RECV:
  830. return CM_ROAM_NOTIF_DISASSOC_RECV;
  831. case WMI_ROAM_NOTIF_SCAN_MODE_SUCCESS_WITH_HO_FAIL:
  832. return CM_ROAM_NOTIF_HO_FAIL;
  833. case WMI_ROAM_NOTIF_SCAN_END:
  834. return CM_ROAM_NOTIF_SCAN_END;
  835. default:
  836. return CM_ROAM_NOTIF_INVALID;
  837. }
  838. return CM_ROAM_NOTIF_INVALID;
  839. }
  840. static void
  841. wmi_extract_pdev_hw_mode_trans_ind(
  842. wmi_pdev_hw_mode_transition_event_fixed_param *fixed_param,
  843. wmi_pdev_set_hw_mode_response_vdev_mac_entry *vdev_mac_entry,
  844. struct cm_hw_mode_trans_ind *hw_mode_trans_ind)
  845. {
  846. uint32_t i;
  847. if (fixed_param->num_vdev_mac_entries > MAX_VDEV_SUPPORTED) {
  848. wmi_err("Number of Vdev mac entries %d exceeded max vdev supported %d",
  849. fixed_param->num_vdev_mac_entries,
  850. MAX_VDEV_SUPPORTED);
  851. return;
  852. }
  853. hw_mode_trans_ind->old_hw_mode_index = fixed_param->old_hw_mode_index;
  854. hw_mode_trans_ind->new_hw_mode_index = fixed_param->new_hw_mode_index;
  855. hw_mode_trans_ind->num_vdev_mac_entries =
  856. fixed_param->num_vdev_mac_entries;
  857. wmi_debug("old_hw_mode_index:%d new_hw_mode_index:%d entries=%d",
  858. fixed_param->old_hw_mode_index,
  859. fixed_param->new_hw_mode_index,
  860. fixed_param->num_vdev_mac_entries);
  861. if (!vdev_mac_entry) {
  862. wmi_err("Invalid vdev_mac_entry");
  863. return;
  864. }
  865. /* Store the vdev-mac map in WMA and send to policy manager */
  866. for (i = 0; i < fixed_param->num_vdev_mac_entries; i++) {
  867. uint32_t vdev_id, mac_id, pdev_id;
  868. vdev_id = vdev_mac_entry[i].vdev_id;
  869. pdev_id = vdev_mac_entry[i].pdev_id;
  870. if (pdev_id == OL_TXRX_PDEV_ID) {
  871. wmi_err("soc level id received for mac id");
  872. return;
  873. }
  874. if (vdev_id >= WLAN_MAX_VDEVS) {
  875. wmi_err("vdev_id: %d is invalid, max_bssid: %d",
  876. vdev_id, WLAN_MAX_VDEVS);
  877. return;
  878. }
  879. mac_id = WMI_PDEV_TO_MAC_MAP(vdev_mac_entry[i].pdev_id);
  880. hw_mode_trans_ind->vdev_mac_map[i].vdev_id = vdev_id;
  881. hw_mode_trans_ind->vdev_mac_map[i].mac_id = mac_id;
  882. wmi_debug("vdev_id:%d mac_id:%d", vdev_id, mac_id);
  883. }
  884. }
  885. /**
  886. * extract_roam_event_tlv() - Extract the roam event
  887. * @wmi_handle: wmi handle
  888. * @evt_buf: Pointer to the event buffer
  889. * @len: Data length
  890. * @roam_event: Roam event data
  891. */
  892. static QDF_STATUS
  893. extract_roam_event_tlv(wmi_unified_t wmi_handle, void *evt_buf, uint32_t len,
  894. struct roam_offload_roam_event *roam_event)
  895. {
  896. QDF_STATUS status = QDF_STATUS_SUCCESS;
  897. wmi_roam_event_fixed_param *wmi_event = NULL;
  898. WMI_ROAM_EVENTID_param_tlvs *param_buf = NULL;
  899. struct cm_hw_mode_trans_ind *hw_mode_trans_ind;
  900. wmi_pdev_hw_mode_transition_event_fixed_param *hw_mode_trans_param;
  901. if (!evt_buf) {
  902. wmi_debug("Empty roam_sync_event param buf");
  903. status = QDF_STATUS_E_FAILURE;
  904. goto end;
  905. }
  906. param_buf = (WMI_ROAM_EVENTID_param_tlvs *)evt_buf;
  907. if (!param_buf) {
  908. wmi_debug("received null buf from target");
  909. status = QDF_STATUS_E_FAILURE;
  910. goto end;
  911. }
  912. wmi_event = param_buf->fixed_param;
  913. if (!wmi_event) {
  914. wmi_debug("received null event data from target");
  915. status = QDF_STATUS_E_FAILURE;
  916. goto end;
  917. }
  918. roam_event->vdev_id = wmi_event->vdev_id;
  919. if (roam_event->vdev_id >= WLAN_MAX_VDEVS) {
  920. wmi_err("Invalid vdev id from firmware: %u",
  921. roam_event->vdev_id);
  922. return -EINVAL;
  923. }
  924. hw_mode_trans_param = param_buf->hw_mode_transition_fixed_param;
  925. if (hw_mode_trans_param &&
  926. hw_mode_trans_param->num_vdev_mac_entries >
  927. param_buf->num_wmi_pdev_set_hw_mode_response_vdev_mac_mapping) {
  928. wmi_debug("invalid vdev mac entries %d %d",
  929. hw_mode_trans_param->num_vdev_mac_entries,
  930. param_buf->num_wmi_pdev_set_hw_mode_response_vdev_mac_mapping);
  931. return QDF_STATUS_E_FAILURE;
  932. }
  933. roam_event->reason =
  934. wmi_convert_fw_reason_to_cm_reason(wmi_event->reason);
  935. roam_event->rssi = wmi_event->rssi;
  936. roam_event->notif = wmi_convert_fw_notif_to_cm_notif(wmi_event->notif);
  937. roam_event->notif_params = wmi_event->notif_params;
  938. roam_event->notif_params1 = wmi_event->notif_params1;
  939. wlan_roam_debug_log(roam_event->vdev_id, DEBUG_ROAM_EVENT,
  940. DEBUG_INVALID_PEER_ID, NULL, NULL,
  941. roam_event->reason,
  942. (roam_event->reason == WMI_ROAM_REASON_INVALID) ?
  943. roam_event->notif : roam_event->rssi);
  944. DPTRACE(qdf_dp_trace_record_event(QDF_DP_TRACE_EVENT_RECORD,
  945. roam_event->vdev_id,
  946. QDF_TRACE_DEFAULT_PDEV_ID,
  947. QDF_PROTO_TYPE_EVENT,
  948. QDF_ROAM_EVENTID));
  949. wmi_debug("FW_ROAM_EVT: Reason:%s[%d], Notif %x for vdevid %x, rssi %d, params %d, params1 %d",
  950. wmi_get_roam_event_reason_string(roam_event->reason),
  951. roam_event->reason,
  952. roam_event->notif, roam_event->vdev_id, roam_event->rssi,
  953. roam_event->notif_params, roam_event->notif_params1);
  954. if (param_buf->hw_mode_transition_fixed_param) {
  955. hw_mode_trans_ind = qdf_mem_malloc(sizeof(*hw_mode_trans_ind));
  956. if (!hw_mode_trans_ind) {
  957. status = QDF_STATUS_E_NOMEM;
  958. goto end;
  959. }
  960. wmi_extract_pdev_hw_mode_trans_ind(
  961. param_buf->hw_mode_transition_fixed_param,
  962. param_buf->wmi_pdev_set_hw_mode_response_vdev_mac_mapping,
  963. hw_mode_trans_ind);
  964. roam_event->hw_mode_trans_ind = hw_mode_trans_ind;
  965. }
  966. if (wmi_event->notif_params1)
  967. roam_event->deauth_disassoc_frame =
  968. param_buf->deauth_disassoc_frame;
  969. end:
  970. return status;
  971. }
  972. #endif /* WLAN_FEATURE_HOST_ROAM || WLAN_FEATURE_ROAM_OFFLOAD */
  973. #ifdef WLAN_FEATURE_ROAM_OFFLOAD
  974. /* send_set_ric_req_cmd_tlv() - set ric request element
  975. * @wmi_handle: wmi handle
  976. * @msg: message
  977. * @is_add_ts: is addts required
  978. *
  979. * This function sets ric request element for 11r roaming.
  980. *
  981. * Return: CDF status
  982. */
  983. static QDF_STATUS send_set_ric_req_cmd_tlv(wmi_unified_t wmi_handle,
  984. void *msg, uint8_t is_add_ts)
  985. {
  986. wmi_ric_request_fixed_param *cmd;
  987. wmi_ric_tspec *tspec_param;
  988. wmi_buf_t buf;
  989. uint8_t *buf_ptr;
  990. struct mac_tspec_ie *tspec_ie = NULL;
  991. int32_t len = sizeof(wmi_ric_request_fixed_param) +
  992. WMI_TLV_HDR_SIZE + sizeof(wmi_ric_tspec);
  993. buf = wmi_buf_alloc(wmi_handle, len);
  994. if (!buf)
  995. return QDF_STATUS_E_NOMEM;
  996. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  997. cmd = (wmi_ric_request_fixed_param *)buf_ptr;
  998. WMITLV_SET_HDR(&cmd->tlv_header,
  999. WMITLV_TAG_STRUC_wmi_ric_request_fixed_param,
  1000. WMITLV_GET_STRUCT_TLVLEN(wmi_ric_request_fixed_param));
  1001. if (is_add_ts)
  1002. cmd->vdev_id = ((struct add_ts_param *)msg)->vdev_id;
  1003. else
  1004. cmd->vdev_id = ((struct del_ts_params *)msg)->sessionId;
  1005. cmd->num_ric_request = 1;
  1006. cmd->is_add_ric = is_add_ts;
  1007. buf_ptr += sizeof(wmi_ric_request_fixed_param);
  1008. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, sizeof(wmi_ric_tspec));
  1009. buf_ptr += WMI_TLV_HDR_SIZE;
  1010. tspec_param = (wmi_ric_tspec *)buf_ptr;
  1011. WMITLV_SET_HDR(&tspec_param->tlv_header,
  1012. WMITLV_TAG_STRUC_wmi_ric_tspec,
  1013. WMITLV_GET_STRUCT_TLVLEN(wmi_ric_tspec));
  1014. if (is_add_ts)
  1015. tspec_ie = &(((struct add_ts_param *)msg)->tspec);
  1016. else
  1017. tspec_ie = &(((struct del_ts_params *)msg)->delTsInfo.tspec);
  1018. if (tspec_ie) {
  1019. /* Fill the tsinfo in the format expected by firmware */
  1020. #ifndef ANI_LITTLE_BIT_ENDIAN
  1021. qdf_mem_copy(((uint8_t *)&tspec_param->ts_info) + 1,
  1022. ((uint8_t *)&tspec_ie->tsinfo) + 1, 2);
  1023. #else
  1024. qdf_mem_copy(((uint8_t *)&tspec_param->ts_info),
  1025. ((uint8_t *)&tspec_ie->tsinfo) + 1, 2);
  1026. #endif /* ANI_LITTLE_BIT_ENDIAN */
  1027. tspec_param->nominal_msdu_size = tspec_ie->nomMsduSz;
  1028. tspec_param->maximum_msdu_size = tspec_ie->maxMsduSz;
  1029. tspec_param->min_service_interval = tspec_ie->minSvcInterval;
  1030. tspec_param->max_service_interval = tspec_ie->maxSvcInterval;
  1031. tspec_param->inactivity_interval = tspec_ie->inactInterval;
  1032. tspec_param->suspension_interval = tspec_ie->suspendInterval;
  1033. tspec_param->svc_start_time = tspec_ie->svcStartTime;
  1034. tspec_param->min_data_rate = tspec_ie->minDataRate;
  1035. tspec_param->mean_data_rate = tspec_ie->meanDataRate;
  1036. tspec_param->peak_data_rate = tspec_ie->peakDataRate;
  1037. tspec_param->max_burst_size = tspec_ie->maxBurstSz;
  1038. tspec_param->delay_bound = tspec_ie->delayBound;
  1039. tspec_param->min_phy_rate = tspec_ie->minPhyRate;
  1040. tspec_param->surplus_bw_allowance = tspec_ie->surplusBw;
  1041. tspec_param->medium_time = 0;
  1042. }
  1043. wmi_debug("Set RIC Req is_add_ts: %d", is_add_ts);
  1044. wmi_mtrace(WMI_ROAM_SET_RIC_REQUEST_CMDID, cmd->vdev_id, 0);
  1045. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1046. WMI_ROAM_SET_RIC_REQUEST_CMDID)) {
  1047. wmi_err("Failed to send vdev Set RIC Req command");
  1048. if (is_add_ts)
  1049. ((struct add_ts_param *)msg)->status =
  1050. QDF_STATUS_E_FAILURE;
  1051. wmi_buf_free(buf);
  1052. return QDF_STATUS_E_FAILURE;
  1053. }
  1054. return QDF_STATUS_SUCCESS;
  1055. }
  1056. /**
  1057. * send_process_roam_synch_complete_cmd_tlv() - roam synch complete command to
  1058. * fw.
  1059. * @wmi_handle: wmi handle
  1060. * @vdev_id: vdev id
  1061. *
  1062. * This function sends roam synch complete event to fw.
  1063. *
  1064. * Return: QDF STATUS
  1065. */
  1066. static QDF_STATUS
  1067. send_process_roam_synch_complete_cmd_tlv(wmi_unified_t wmi_handle,
  1068. uint8_t vdev_id)
  1069. {
  1070. wmi_roam_synch_complete_fixed_param *cmd;
  1071. wmi_buf_t wmi_buf;
  1072. uint8_t *buf_ptr;
  1073. uint16_t len;
  1074. len = sizeof(wmi_roam_synch_complete_fixed_param);
  1075. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  1076. if (!wmi_buf)
  1077. return QDF_STATUS_E_NOMEM;
  1078. cmd = (wmi_roam_synch_complete_fixed_param *)wmi_buf_data(wmi_buf);
  1079. buf_ptr = (uint8_t *)cmd;
  1080. WMITLV_SET_HDR(&cmd->tlv_header,
  1081. WMITLV_TAG_STRUC_wmi_roam_synch_complete_fixed_param,
  1082. WMITLV_GET_STRUCT_TLVLEN
  1083. (wmi_roam_synch_complete_fixed_param));
  1084. cmd->vdev_id = vdev_id;
  1085. wmi_mtrace(WMI_ROAM_SYNCH_COMPLETE, cmd->vdev_id, 0);
  1086. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  1087. WMI_ROAM_SYNCH_COMPLETE)) {
  1088. wmi_err("Failed to send roam synch confirmation");
  1089. wmi_buf_free(wmi_buf);
  1090. return QDF_STATUS_E_FAILURE;
  1091. }
  1092. return QDF_STATUS_SUCCESS;
  1093. }
  1094. /**
  1095. * send_roam_invoke_cmd_tlv() - send roam invoke command to fw.
  1096. * @wmi_handle: wma handle
  1097. * @roaminvoke: roam invoke command
  1098. *
  1099. * Send roam invoke command to fw for fastreassoc.
  1100. *
  1101. * Return: CDF STATUS
  1102. */
  1103. static QDF_STATUS send_roam_invoke_cmd_tlv(wmi_unified_t wmi_handle,
  1104. struct roam_invoke_req *roaminvoke)
  1105. {
  1106. wmi_roam_invoke_cmd_fixed_param *cmd;
  1107. wmi_buf_t wmi_buf;
  1108. u_int8_t *buf_ptr;
  1109. u_int16_t len, args_tlv_len;
  1110. uint32_t *channel_list;
  1111. wmi_mac_addr *bssid_list;
  1112. wmi_tlv_buf_len_param *buf_len_tlv;
  1113. args_tlv_len = (4 * WMI_TLV_HDR_SIZE) + sizeof(uint32_t) +
  1114. sizeof(wmi_mac_addr) + sizeof(wmi_tlv_buf_len_param) +
  1115. roundup(roaminvoke->frame_len, sizeof(uint32_t));
  1116. len = sizeof(wmi_roam_invoke_cmd_fixed_param) + args_tlv_len;
  1117. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  1118. if (!wmi_buf)
  1119. return QDF_STATUS_E_NOMEM;
  1120. cmd = (wmi_roam_invoke_cmd_fixed_param *)wmi_buf_data(wmi_buf);
  1121. buf_ptr = (u_int8_t *)cmd;
  1122. WMITLV_SET_HDR(&cmd->tlv_header,
  1123. WMITLV_TAG_STRUC_wmi_roam_invoke_cmd_fixed_param,
  1124. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_invoke_cmd_fixed_param));
  1125. cmd->vdev_id = roaminvoke->vdev_id;
  1126. cmd->flags |= (1 << WMI_ROAM_INVOKE_FLAG_REPORT_FAILURE);
  1127. if (roaminvoke->is_same_bssid)
  1128. cmd->flags |= (1 << WMI_ROAM_INVOKE_FLAG_NO_NULL_FRAME_TO_AP);
  1129. if (roaminvoke->frame_len) {
  1130. cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_SKIP;
  1131. /* packing 1 beacon/probe_rsp frame with WMI cmd */
  1132. cmd->num_buf = 1;
  1133. } else {
  1134. cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_FIXED_CH;
  1135. cmd->num_buf = 0;
  1136. }
  1137. cmd->roam_ap_sel_mode = 0;
  1138. cmd->roam_delay = 0;
  1139. cmd->num_chan = 1;
  1140. cmd->num_bssid = 1;
  1141. if (roaminvoke->forced_roaming) {
  1142. cmd->num_chan = 0;
  1143. cmd->num_bssid = 0;
  1144. cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_CACHE_MAP;
  1145. cmd->flags |=
  1146. (1 << WMI_ROAM_INVOKE_FLAG_FULL_SCAN_IF_NO_CANDIDATE);
  1147. cmd->reason = ROAM_INVOKE_REASON_NUD_FAILURE;
  1148. } else if (qdf_is_macaddr_broadcast(&roaminvoke->target_bssid)) {
  1149. cmd->num_chan = 0;
  1150. cmd->num_bssid = 0;
  1151. cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_CACHE_MAP;
  1152. cmd->flags |=
  1153. (1 << WMI_ROAM_INVOKE_FLAG_FULL_SCAN_IF_NO_CANDIDATE) |
  1154. (1 << WMI_ROAM_INVOKE_FLAG_SELECT_CANDIDATE_CONSIDER_SCORE);
  1155. cmd->reason = ROAM_INVOKE_REASON_USER_SPACE;
  1156. } else {
  1157. cmd->reason = ROAM_INVOKE_REASON_USER_SPACE;
  1158. }
  1159. buf_ptr += sizeof(wmi_roam_invoke_cmd_fixed_param);
  1160. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  1161. (sizeof(u_int32_t)));
  1162. channel_list = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
  1163. *channel_list = roaminvoke->ch_freq;
  1164. buf_ptr += sizeof(uint32_t) + WMI_TLV_HDR_SIZE;
  1165. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC,
  1166. (sizeof(wmi_mac_addr)));
  1167. bssid_list = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE);
  1168. WMI_CHAR_ARRAY_TO_MAC_ADDR(roaminvoke->target_bssid.bytes, bssid_list);
  1169. /* move to next tlv i.e. bcn_prb_buf_list */
  1170. buf_ptr += WMI_TLV_HDR_SIZE + sizeof(wmi_mac_addr);
  1171. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC,
  1172. sizeof(wmi_tlv_buf_len_param));
  1173. buf_len_tlv = (wmi_tlv_buf_len_param *)(buf_ptr + WMI_TLV_HDR_SIZE);
  1174. WMITLV_SET_HDR(&buf_len_tlv->tlv_header,
  1175. WMITLV_TAG_STRUC_wmi_tlv_buf_len_param,
  1176. WMITLV_GET_STRUCT_TLVLEN(wmi_tlv_buf_len_param));
  1177. buf_len_tlv->buf_len = roaminvoke->frame_len;
  1178. /* move to next tlv i.e. bcn_prb_frm */
  1179. buf_ptr += WMI_TLV_HDR_SIZE + sizeof(wmi_tlv_buf_len_param);
  1180. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE,
  1181. roundup(roaminvoke->frame_len, sizeof(uint32_t)));
  1182. /* copy frame after the header */
  1183. qdf_mem_copy(buf_ptr + WMI_TLV_HDR_SIZE,
  1184. roaminvoke->frame_buf,
  1185. roaminvoke->frame_len);
  1186. wmi_debug("flag:%d, MODE:%d, ap:%d, dly:%d, n_ch:%d, n_bssid:%d, ch_freq:%d, is_same_bss:%d",
  1187. cmd->flags, cmd->roam_scan_mode,
  1188. cmd->roam_ap_sel_mode, cmd->roam_delay,
  1189. cmd->num_chan, cmd->num_bssid, roaminvoke->ch_freq,
  1190. roaminvoke->is_same_bssid);
  1191. wmi_mtrace(WMI_ROAM_INVOKE_CMDID, cmd->vdev_id, 0);
  1192. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  1193. WMI_ROAM_INVOKE_CMDID)) {
  1194. wmi_err("Failed to send roam invoke command");
  1195. wmi_buf_free(wmi_buf);
  1196. return QDF_STATUS_E_FAILURE;
  1197. }
  1198. return QDF_STATUS_SUCCESS;
  1199. }
  1200. /**
  1201. * convert_control_roam_trigger_reason_bitmap() - Convert roam trigger bitmap
  1202. *
  1203. * @trigger_reason_bitmap: Roam trigger reason bitmap received from upper layers
  1204. *
  1205. * Converts the controlled roam trigger reason bitmap of
  1206. * type @roam_control_trigger_reason to firmware trigger
  1207. * reason bitmap as defined in
  1208. * trigger_reason_bitmask @wmi_roam_enable_disable_trigger_reason_fixed_param
  1209. *
  1210. * Return: trigger_reason_bitmask as defined in
  1211. * wmi_roam_enable_disable_trigger_reason_fixed_param
  1212. */
  1213. static uint32_t
  1214. convert_control_roam_trigger_reason_bitmap(uint32_t trigger_reason_bitmap)
  1215. {
  1216. uint32_t fw_trigger_bitmap = 0, all_bitmap;
  1217. /* Enable the complete trigger bitmap when all bits are set in
  1218. * the control config bitmap
  1219. */
  1220. all_bitmap = BIT(ROAM_TRIGGER_REASON_MAX) - 1;
  1221. if (trigger_reason_bitmap == all_bitmap)
  1222. return BIT(WMI_ROAM_TRIGGER_EXT_REASON_MAX) - 1;
  1223. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_NONE))
  1224. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_NONE);
  1225. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_PER))
  1226. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_PER);
  1227. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BMISS))
  1228. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BMISS);
  1229. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_LOW_RSSI))
  1230. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_LOW_RSSI);
  1231. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_HIGH_RSSI))
  1232. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_HIGH_RSSI);
  1233. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_PERIODIC))
  1234. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_PERIODIC);
  1235. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_MAWC))
  1236. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_MAWC);
  1237. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_DENSE))
  1238. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_DENSE);
  1239. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BACKGROUND))
  1240. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BACKGROUND);
  1241. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_FORCED))
  1242. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_FORCED);
  1243. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BTM))
  1244. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BTM);
  1245. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_UNIT_TEST))
  1246. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_UNIT_TEST);
  1247. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BSS_LOAD))
  1248. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BSS_LOAD);
  1249. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_DEAUTH))
  1250. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_DEAUTH);
  1251. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_IDLE))
  1252. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_IDLE);
  1253. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_STA_KICKOUT))
  1254. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_STA_KICKOUT);
  1255. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_ESS_RSSI))
  1256. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_ESS_RSSI);
  1257. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_WTC_BTM))
  1258. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_WTC_BTM);
  1259. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_PMK_TIMEOUT))
  1260. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_PMK_TIMEOUT);
  1261. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BTC))
  1262. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BTC);
  1263. return fw_trigger_bitmap;
  1264. }
  1265. /**
  1266. * get_internal_mandatory_roam_triggers() - Internal triggers to be added
  1267. *
  1268. * Return: the bitmap of mandatory triggers to be sent to firmware but not given
  1269. * by user.
  1270. */
  1271. static uint32_t
  1272. get_internal_mandatory_roam_triggers(void)
  1273. {
  1274. return BIT(WMI_ROAM_TRIGGER_REASON_FORCED);
  1275. }
  1276. /**
  1277. * convert_roam_trigger_scan_mode() - Function to convert unified Roam trigger
  1278. * scan mode enum to TLV specific ROAM_TRIGGER_SCAN_MODE
  1279. * @scan_freq_scheme: scan freq scheme coming from userspace
  1280. *
  1281. * Return: ROAM_TRIGGER_SCAN_MODE
  1282. */
  1283. static WMI_ROAM_TRIGGER_SCAN_MODE
  1284. convert_roam_trigger_scan_mode(enum roam_scan_freq_scheme scan_freq_scheme)
  1285. {
  1286. switch (scan_freq_scheme) {
  1287. case ROAM_SCAN_FREQ_SCHEME_NO_SCAN:
  1288. return ROAM_TRIGGER_SCAN_MODE_NO_SCAN_DISCONNECTION;
  1289. case ROAM_SCAN_FREQ_SCHEME_PARTIAL_SCAN:
  1290. return ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  1291. case ROAM_SCAN_FREQ_SCHEME_FULL_SCAN:
  1292. return ROAM_TRIGGER_SCAN_MODE_FULL;
  1293. default:
  1294. return ROAM_TRIGGER_SCAN_MODE_NONE;
  1295. }
  1296. }
  1297. /**
  1298. * wmi_fill_default_roam_trigger_parameters() - Fill the default parameters
  1299. * for wmi_configure_roam_trigger_parameters tlv.
  1300. * @roam_trigger_params: pointer to wmi_configure_roam_trigger_parameters tlv
  1301. * to be filled.
  1302. * @roam_trigger: Roam trigger reason
  1303. *
  1304. * Return: None
  1305. */
  1306. static void wmi_fill_default_roam_trigger_parameters(
  1307. wmi_configure_roam_trigger_parameters *roam_trigger_params,
  1308. uint32_t roam_trigger)
  1309. {
  1310. WMITLV_SET_HDR(&roam_trigger_params->tlv_header,
  1311. WMITLV_TAG_STRUC_wmi_configure_roam_trigger_parameters,
  1312. WMITLV_GET_STRUCT_TLVLEN(wmi_configure_roam_trigger_parameters));
  1313. roam_trigger_params->trigger_reason = roam_trigger;
  1314. roam_trigger_params->enable = 1;
  1315. roam_trigger_params->scan_mode = ROAM_TRIGGER_SCAN_MODE_NONE;
  1316. roam_trigger_params->trigger_rssi_threshold =
  1317. ROAM_MAX_CFG_VALUE;
  1318. roam_trigger_params->cand_ap_min_rssi_threshold =
  1319. ROAM_MAX_CFG_VALUE;
  1320. roam_trigger_params->cand_ap_min_rssi_threshold_5g =
  1321. ROAM_MAX_CFG_VALUE;
  1322. roam_trigger_params->cand_ap_min_rssi_threshold_6g =
  1323. ROAM_MAX_CFG_VALUE;
  1324. roam_trigger_params->roam_score_delta_percentage =
  1325. ROAM_MAX_CFG_VALUE;
  1326. roam_trigger_params->reason_code = ROAM_MAX_CFG_VALUE;
  1327. }
  1328. static void wmi_fill_score_delta_params(
  1329. wmi_configure_roam_trigger_parameters *roam_trigger_params,
  1330. struct wlan_roam_triggers *triggers,
  1331. uint8_t trig_index)
  1332. {
  1333. enum roam_trigger_reason trig_reason;
  1334. if (trig_index >= NUM_OF_ROAM_TRIGGERS)
  1335. return;
  1336. trig_reason =
  1337. triggers->score_delta_param[trig_index].trigger_reason;
  1338. wmi_fill_default_roam_trigger_parameters(
  1339. roam_trigger_params,
  1340. convert_roam_trigger_reason(trig_reason));
  1341. roam_trigger_params->roam_score_delta_percentage =
  1342. triggers->score_delta_param[trig_index].roam_score_delta;
  1343. wmi_debug("RSO_CFG: Score delta per: %d converted trig_reason: %d",
  1344. roam_trigger_params->roam_score_delta_percentage,
  1345. convert_roam_trigger_reason(trig_reason));
  1346. }
  1347. static void wmi_fill_min_rssi_params(
  1348. wmi_configure_roam_trigger_parameters *roam_trigger_params,
  1349. struct wlan_roam_triggers *triggers,
  1350. uint8_t trig_index)
  1351. {
  1352. enum roam_trigger_reason trig_reason;
  1353. if (trig_index >= NUM_OF_ROAM_MIN_RSSI)
  1354. return;
  1355. trig_reason =
  1356. triggers->min_rssi_params[trig_index].trigger_reason;
  1357. wmi_fill_default_roam_trigger_parameters(
  1358. roam_trigger_params,
  1359. convert_roam_trigger_reason(trig_reason));
  1360. roam_trigger_params->cand_ap_min_rssi_threshold =
  1361. triggers->min_rssi_params[trig_index].min_rssi;
  1362. roam_trigger_params->cand_ap_min_rssi_threshold_5g =
  1363. triggers->min_rssi_params[trig_index].min_rssi;
  1364. roam_trigger_params->cand_ap_min_rssi_threshold_6g =
  1365. triggers->min_rssi_params[trig_index].min_rssi;
  1366. wmi_debug("RSO_CFG: Min rssi thresh: %d converted trig_reason: %d",
  1367. roam_trigger_params->cand_ap_min_rssi_threshold,
  1368. convert_roam_trigger_reason(trig_reason));
  1369. }
  1370. /**
  1371. * send_set_roam_trigger_cmd_tlv() - send set roam triggers to fw
  1372. * @wmi_handle: wmi handle
  1373. * @triggers: roam trigger bitmap to be enabled
  1374. *
  1375. * Send WMI_ROAM_ENABLE_DISABLE_TRIGGER_REASON_CMDID to fw.
  1376. *
  1377. * Return: QDF_STATUS
  1378. */
  1379. static QDF_STATUS send_set_roam_trigger_cmd_tlv(wmi_unified_t wmi_handle,
  1380. struct wlan_roam_triggers *triggers)
  1381. {
  1382. wmi_buf_t buf;
  1383. wmi_roam_enable_disable_trigger_reason_fixed_param *cmd;
  1384. uint32_t len = sizeof(*cmd);
  1385. int ret;
  1386. uint8_t *buf_ptr;
  1387. wmi_configure_roam_trigger_parameters
  1388. *roam_trigger_parameters;
  1389. uint32_t num_triggers_enabled = 0;
  1390. uint32_t roam_scan_scheme_bitmap = triggers->roam_scan_scheme_bitmap;
  1391. uint32_t total_tlv_len = 0;
  1392. if (BIT(ROAM_TRIGGER_REASON_PER) & roam_scan_scheme_bitmap)
  1393. num_triggers_enabled++;
  1394. if (BIT(ROAM_TRIGGER_REASON_BTC) & roam_scan_scheme_bitmap)
  1395. num_triggers_enabled++;
  1396. if (BIT(ROAM_TRIGGER_REASON_BMISS) & roam_scan_scheme_bitmap)
  1397. num_triggers_enabled++;
  1398. if (BIT(ROAM_TRIGGER_REASON_LOW_RSSI) & roam_scan_scheme_bitmap)
  1399. num_triggers_enabled++;
  1400. if (BIT(ROAM_TRIGGER_REASON_BTM) & roam_scan_scheme_bitmap)
  1401. num_triggers_enabled++;
  1402. if (BIT(ROAM_TRIGGER_REASON_BSS_LOAD) & roam_scan_scheme_bitmap)
  1403. num_triggers_enabled++;
  1404. if (wmi_service_enabled(wmi_handle,
  1405. wmi_service_configure_roam_trigger_param_support))
  1406. total_tlv_len += (NUM_OF_ROAM_TRIGGERS + NUM_OF_ROAM_MIN_RSSI) *
  1407. sizeof(wmi_configure_roam_trigger_parameters);
  1408. total_tlv_len += 2 * sizeof(wmi_configure_roam_trigger_parameters) +
  1409. num_triggers_enabled *
  1410. sizeof(wmi_configure_roam_trigger_parameters);
  1411. len += WMI_TLV_HDR_SIZE + total_tlv_len;
  1412. buf = wmi_buf_alloc(wmi_handle, len);
  1413. if (!buf) {
  1414. wmi_err("Failed to allocate wmi buffer");
  1415. return QDF_STATUS_E_NOMEM;
  1416. }
  1417. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  1418. cmd = (wmi_roam_enable_disable_trigger_reason_fixed_param *)
  1419. wmi_buf_data(buf);
  1420. WMITLV_SET_HDR(&cmd->tlv_header,
  1421. WMITLV_TAG_STRUC_wmi_roam_enable_disable_trigger_reason_fixed_param,
  1422. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_enable_disable_trigger_reason_fixed_param));
  1423. cmd->vdev_id = triggers->vdev_id;
  1424. cmd->trigger_reason_bitmask =
  1425. convert_control_roam_trigger_reason_bitmap(triggers->trigger_bitmap);
  1426. wmi_debug("RSO_CFG: Received trigger bitmap: 0x%x converted trigger_bitmap: 0x%x",
  1427. triggers->trigger_bitmap, cmd->trigger_reason_bitmask);
  1428. cmd->trigger_reason_bitmask |= get_internal_mandatory_roam_triggers();
  1429. wmi_debug("RSO_CFG: vdev id: %d final trigger_bitmap: 0x%x roam_scan_scheme:0x%x num_triggers_enabled:%d",
  1430. cmd->vdev_id, cmd->trigger_reason_bitmask,
  1431. roam_scan_scheme_bitmap, num_triggers_enabled);
  1432. buf_ptr += sizeof(wmi_roam_enable_disable_trigger_reason_fixed_param);
  1433. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, total_tlv_len);
  1434. buf_ptr += WMI_TLV_HDR_SIZE;
  1435. roam_trigger_parameters =
  1436. (wmi_configure_roam_trigger_parameters *)buf_ptr;
  1437. WMITLV_SET_HDR(&roam_trigger_parameters->tlv_header,
  1438. WMITLV_TAG_STRUC_wmi_configure_roam_trigger_parameters,
  1439. WMITLV_GET_STRUCT_TLVLEN(
  1440. wmi_configure_roam_trigger_parameters));
  1441. roam_trigger_parameters->trigger_reason =
  1442. WMI_ROAM_TRIGGER_REASON_WTC_BTM;
  1443. if (triggers->vendor_btm_param.user_roam_reason == 0)
  1444. roam_trigger_parameters->enable = 1;
  1445. roam_trigger_parameters->scan_mode = convert_roam_trigger_scan_mode(
  1446. triggers->vendor_btm_param.scan_freq_scheme);
  1447. roam_trigger_parameters->trigger_rssi_threshold =
  1448. triggers->vendor_btm_param.connected_rssi_threshold;
  1449. roam_trigger_parameters->cand_ap_min_rssi_threshold =
  1450. triggers->vendor_btm_param.candidate_rssi_threshold_2g;
  1451. roam_trigger_parameters->cand_ap_min_rssi_threshold_5g =
  1452. triggers->vendor_btm_param.candidate_rssi_threshold_5g;
  1453. roam_trigger_parameters->cand_ap_min_rssi_threshold_6g =
  1454. triggers->vendor_btm_param.candidate_rssi_threshold_6g;
  1455. roam_trigger_parameters->roam_score_delta_percentage =
  1456. triggers->roam_score_delta;
  1457. roam_trigger_parameters->reason_code =
  1458. triggers->vendor_btm_param.user_roam_reason;
  1459. roam_trigger_parameters++;
  1460. if (wmi_service_enabled(wmi_handle,
  1461. wmi_service_configure_roam_trigger_param_support)) {
  1462. wmi_fill_score_delta_params(roam_trigger_parameters,
  1463. triggers,
  1464. IDLE_ROAM_TRIGGER);
  1465. if (cmd->trigger_reason_bitmask &
  1466. BIT(WMI_ROAM_TRIGGER_REASON_IDLE))
  1467. roam_trigger_parameters->enable = 1;
  1468. else
  1469. roam_trigger_parameters->enable = 0;
  1470. roam_trigger_parameters++;
  1471. wmi_fill_score_delta_params(roam_trigger_parameters,
  1472. triggers,
  1473. BTM_ROAM_TRIGGER);
  1474. roam_trigger_parameters++;
  1475. wmi_fill_min_rssi_params(roam_trigger_parameters,
  1476. triggers,
  1477. DEAUTH_MIN_RSSI);
  1478. roam_trigger_parameters++;
  1479. wmi_fill_min_rssi_params(roam_trigger_parameters,
  1480. triggers,
  1481. BMISS_MIN_RSSI);
  1482. roam_trigger_parameters++;
  1483. wmi_fill_min_rssi_params(roam_trigger_parameters,
  1484. triggers,
  1485. MIN_RSSI_2G_TO_5G_ROAM);
  1486. roam_trigger_parameters++;
  1487. }
  1488. wmi_fill_default_roam_trigger_parameters(
  1489. roam_trigger_parameters,
  1490. WMI_ROAM_TRIGGER_REASON_PMK_TIMEOUT);
  1491. if (cmd->trigger_reason_bitmask &
  1492. BIT(WMI_ROAM_TRIGGER_REASON_PMK_TIMEOUT))
  1493. roam_trigger_parameters->enable = 1;
  1494. else
  1495. roam_trigger_parameters->enable = 0;
  1496. roam_trigger_parameters->roam_score_delta_percentage = 0;
  1497. roam_trigger_parameters++;
  1498. if (num_triggers_enabled == 0)
  1499. goto send;
  1500. if (BIT(ROAM_TRIGGER_REASON_PER) & roam_scan_scheme_bitmap) {
  1501. wmi_fill_default_roam_trigger_parameters(
  1502. roam_trigger_parameters,
  1503. WMI_ROAM_TRIGGER_REASON_PER);
  1504. roam_trigger_parameters->scan_mode =
  1505. ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  1506. roam_trigger_parameters++;
  1507. }
  1508. if (BIT(ROAM_TRIGGER_REASON_BTC) & roam_scan_scheme_bitmap) {
  1509. wmi_fill_default_roam_trigger_parameters(
  1510. roam_trigger_parameters,
  1511. WMI_ROAM_TRIGGER_REASON_BTC);
  1512. roam_trigger_parameters->scan_mode =
  1513. ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  1514. roam_trigger_parameters++;
  1515. }
  1516. if (BIT(ROAM_TRIGGER_REASON_BMISS) & roam_scan_scheme_bitmap) {
  1517. wmi_fill_default_roam_trigger_parameters(
  1518. roam_trigger_parameters,
  1519. WMI_ROAM_TRIGGER_REASON_BMISS);
  1520. roam_trigger_parameters->scan_mode =
  1521. ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  1522. roam_trigger_parameters++;
  1523. }
  1524. if (BIT(ROAM_TRIGGER_REASON_LOW_RSSI) & roam_scan_scheme_bitmap) {
  1525. wmi_fill_default_roam_trigger_parameters(
  1526. roam_trigger_parameters,
  1527. WMI_ROAM_TRIGGER_REASON_LOW_RSSI);
  1528. roam_trigger_parameters->scan_mode =
  1529. ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  1530. roam_trigger_parameters++;
  1531. }
  1532. if (BIT(ROAM_TRIGGER_REASON_BTM) & roam_scan_scheme_bitmap) {
  1533. wmi_fill_default_roam_trigger_parameters(
  1534. roam_trigger_parameters,
  1535. WMI_ROAM_TRIGGER_REASON_BTM);
  1536. roam_trigger_parameters->scan_mode =
  1537. ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  1538. roam_trigger_parameters++;
  1539. }
  1540. if (BIT(ROAM_TRIGGER_REASON_BSS_LOAD) & roam_scan_scheme_bitmap) {
  1541. wmi_fill_default_roam_trigger_parameters(
  1542. roam_trigger_parameters,
  1543. WMI_ROAM_TRIGGER_REASON_BSS_LOAD);
  1544. roam_trigger_parameters->scan_mode =
  1545. ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  1546. roam_trigger_parameters++;
  1547. }
  1548. send:
  1549. wmi_mtrace(WMI_ROAM_ENABLE_DISABLE_TRIGGER_REASON_CMDID,
  1550. triggers->vdev_id, 0);
  1551. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1552. WMI_ROAM_ENABLE_DISABLE_TRIGGER_REASON_CMDID);
  1553. if (QDF_IS_STATUS_ERROR(ret)) {
  1554. wmi_err("Failed to send set roam triggers command ret = %d",
  1555. ret);
  1556. wmi_buf_free(buf);
  1557. }
  1558. return ret;
  1559. }
  1560. /**
  1561. * send_vdev_set_pcl_cmd_tlv() - Send WMI_VDEV_SET_PCL_CMDID to FW
  1562. * @wmi_handle: wmi handle
  1563. * @params: Set VDEV PCL params
  1564. *
  1565. * WMI_VDEV_SET_PCL_CMDID provides the Preferred Channel List (PCL) to WLAN
  1566. * firmware. The roaming module is the consumer of this information
  1567. * in the WLAN firmware. The channel list will be used when a VDEV needs
  1568. * to migrate to a new channel without host driver involvement. An example of
  1569. * this behavior is Legacy Fast Roaming (LFR 3.0).
  1570. *
  1571. * WMI_VDEV_SET_PCL_CMDID will carry only the weight list and not the actual
  1572. * channel list. The weights corresponds to the channels sent in
  1573. * WMI_SCAN_CHAN_LIST_CMDID. The channels from PCL would be having a higher
  1574. * weightage compared to the non PCL channels.
  1575. *
  1576. * When roaming is enabled on STA 1, PDEV pcl will be sent. When STA2 is
  1577. * up, VDEV pcl will be sent on STA 1 after calculating pcl again applying
  1578. * the bandmask and VDEV pcl will be sent for STA2. When one of the STA
  1579. * is disconnected, PDEV pcl will be sent on the other STA again.
  1580. *
  1581. * Return: Success if the cmd is sent successfully to the firmware
  1582. */
  1583. static QDF_STATUS
  1584. send_vdev_set_pcl_cmd_tlv(wmi_unified_t wmi_handle,
  1585. struct set_pcl_cmd_params *params)
  1586. {
  1587. wmi_vdev_set_pcl_cmd_fixed_param *cmd;
  1588. wmi_buf_t buf;
  1589. uint8_t *buf_ptr;
  1590. uint32_t *ch_weight, i;
  1591. size_t len;
  1592. uint32_t chan_len;
  1593. chan_len = params->weights->saved_num_chan;
  1594. len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + (chan_len * sizeof(uint32_t));
  1595. buf = wmi_buf_alloc(wmi_handle, len);
  1596. if (!buf)
  1597. return QDF_STATUS_E_NOMEM;
  1598. cmd = (wmi_vdev_set_pcl_cmd_fixed_param *)wmi_buf_data(buf);
  1599. buf_ptr = (uint8_t *)cmd;
  1600. WMITLV_SET_HDR(&cmd->tlv_header,
  1601. WMITLV_TAG_STRUC_wmi_vdev_set_pcl_cmd_fixed_param,
  1602. WMITLV_GET_STRUCT_TLVLEN(wmi_vdev_set_pcl_cmd_fixed_param));
  1603. cmd->vdev_id = params->vdev_id;
  1604. buf_ptr += sizeof(wmi_vdev_set_pcl_cmd_fixed_param);
  1605. /* Channel weights uint32 Array TLV */
  1606. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  1607. (chan_len * sizeof(uint32_t)));
  1608. ch_weight = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
  1609. for (i = 0; i < chan_len; i++)
  1610. ch_weight[i] = params->weights->weighed_valid_list[i];
  1611. wmi_mtrace(WMI_VDEV_SET_PCL_CMDID, params->vdev_id, 0);
  1612. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1613. WMI_VDEV_SET_PCL_CMDID)) {
  1614. wmi_err("Failed to send WMI_VDEV_SET_PCL_CMDID");
  1615. wmi_buf_free(buf);
  1616. return QDF_STATUS_E_FAILURE;
  1617. }
  1618. return QDF_STATUS_SUCCESS;
  1619. }
  1620. /**
  1621. * extract_roam_btm_response_stats_tlv() - Extract the btm rsp stats
  1622. * from the WMI_ROAM_STATS_EVENTID
  1623. * @wmi_handle: wmi handle
  1624. * @evt_buf: Pointer to the event buffer
  1625. * @dst: Pointer to destination structure to fill data
  1626. * @idx: TLV id
  1627. */
  1628. static QDF_STATUS
  1629. extract_roam_btm_response_stats_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  1630. struct roam_btm_response_data *dst,
  1631. uint8_t idx)
  1632. {
  1633. WMI_ROAM_STATS_EVENTID_param_tlvs *param_buf;
  1634. wmi_roam_btm_response_info *src_data = NULL;
  1635. param_buf = (WMI_ROAM_STATS_EVENTID_param_tlvs *)evt_buf;
  1636. if (!param_buf || !param_buf->roam_btm_response_info ||
  1637. !param_buf->num_roam_btm_response_info ||
  1638. idx >= param_buf->num_roam_btm_response_info) {
  1639. wmi_debug("Empty btm response param buf");
  1640. return QDF_STATUS_SUCCESS;
  1641. }
  1642. src_data = &param_buf->roam_btm_response_info[idx];
  1643. if (!src_data->timestamp)
  1644. return QDF_STATUS_SUCCESS;
  1645. dst->present = true;
  1646. dst->btm_status = src_data->btm_status;
  1647. WMI_MAC_ADDR_TO_CHAR_ARRAY(&src_data->target_bssid,
  1648. dst->target_bssid.bytes);
  1649. dst->vsie_reason = src_data->vsie_reason;
  1650. dst->timestamp = src_data->timestamp;
  1651. dst->btm_resp_dialog_token = src_data->btm_resp_dialog_token;
  1652. dst->btm_delay = src_data->btm_resp_bss_termination_delay;
  1653. dst->band = WMI_ROAM_BTM_RESP_MLO_BAND_INFO_GET(src_data->info);
  1654. if (dst->band != WMI_MLO_BAND_NO_MLO)
  1655. dst->is_mlo = true;
  1656. return QDF_STATUS_SUCCESS;
  1657. }
  1658. /**
  1659. * extract_roam_initial_info_tlv() - Extract the roam initial info
  1660. * from the WMI_ROAM_STATS_EVENTID
  1661. * @wmi_handle: wmi handle
  1662. * @evt_buf: Pointer to the event buffer
  1663. * @dst: Pointer to destination structure to fill data
  1664. * @idx: TLV id
  1665. */
  1666. static QDF_STATUS
  1667. extract_roam_initial_info_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  1668. struct roam_initial_data *dst, uint8_t idx)
  1669. {
  1670. WMI_ROAM_STATS_EVENTID_param_tlvs *param_buf;
  1671. wmi_roam_initial_info *src_data = NULL;
  1672. param_buf = (WMI_ROAM_STATS_EVENTID_param_tlvs *)evt_buf;
  1673. if (!param_buf || !param_buf->roam_initial_info ||
  1674. !param_buf->num_roam_initial_info ||
  1675. idx >= param_buf->num_roam_initial_info) {
  1676. wmi_debug("Empty roam_initial_info param buf");
  1677. return QDF_STATUS_SUCCESS;
  1678. }
  1679. src_data = &param_buf->roam_initial_info[idx];
  1680. dst->present = true;
  1681. dst->roam_full_scan_count = src_data->roam_full_scan_count;
  1682. dst->rssi_th = src_data->rssi_th;
  1683. dst->cu_th = src_data->cu_th;
  1684. dst->fw_cancel_timer_bitmap = src_data->timer_canceled;
  1685. return QDF_STATUS_SUCCESS;
  1686. }
  1687. /**
  1688. * extract_roam_msg_info_tlv() - Extract the roam message info
  1689. * from the WMI_ROAM_STATS_EVENTID
  1690. * @wmi_handle: wmi handle
  1691. * @evt_buf: Pointer to the event buffer
  1692. * @dst: Pointer to destination structure to fill data
  1693. * @idx: TLV id
  1694. */
  1695. static QDF_STATUS
  1696. extract_roam_msg_info_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  1697. struct roam_msg_info *dst, uint8_t idx)
  1698. {
  1699. WMI_ROAM_STATS_EVENTID_param_tlvs *param_buf;
  1700. wmi_roam_msg_info *src_data = NULL;
  1701. param_buf = (WMI_ROAM_STATS_EVENTID_param_tlvs *)evt_buf;
  1702. if (!param_buf || !param_buf->roam_msg_info ||
  1703. !param_buf->num_roam_msg_info ||
  1704. idx >= param_buf->num_roam_msg_info)
  1705. return QDF_STATUS_SUCCESS;
  1706. src_data = &param_buf->roam_msg_info[idx];
  1707. dst->present = true;
  1708. dst->timestamp = src_data->timestamp;
  1709. dst->msg_id = src_data->msg_id;
  1710. dst->msg_param1 = src_data->msg_param1;
  1711. dst->msg_param2 = src_data->msg_param2;
  1712. return QDF_STATUS_SUCCESS;
  1713. }
  1714. static enum wlan_roam_frame_subtype
  1715. wmi_get_converted_roam_eapol_subtype(
  1716. WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_SUBTYPE eapol_subtype)
  1717. {
  1718. switch (eapol_subtype) {
  1719. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_SUBTYPE_M1:
  1720. return ROAM_FRAME_SUBTYPE_M1;
  1721. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_SUBTYPE_M2:
  1722. return ROAM_FRAME_SUBTYPE_M2;
  1723. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_SUBTYPE_M3:
  1724. return ROAM_FRAME_SUBTYPE_M3;
  1725. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_SUBTYPE_M4:
  1726. return ROAM_FRAME_SUBTYPE_M4;
  1727. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_SUBTYPE_GTK_M1:
  1728. return ROAM_FRAME_SUBTYPE_GTK_M1;
  1729. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_SUBTYPE_GTK_M2:
  1730. return ROAM_FRAME_SUBTYPE_GTK_M2;
  1731. default:
  1732. break;
  1733. }
  1734. return 0;
  1735. }
  1736. static enum qdf_dp_tx_rx_status
  1737. wmi_get_converted_tx_status(
  1738. WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_STATUS roam_tx_status)
  1739. {
  1740. switch (roam_tx_status) {
  1741. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_STATUS_ACK:
  1742. return QDF_TX_RX_STATUS_OK;
  1743. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_STATUS_NO_ACK:
  1744. return QDF_TX_RX_STATUS_NO_ACK;
  1745. case WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT_STATUS_TX_FAIL:
  1746. return QDF_TX_RX_STATUS_DROP;
  1747. default:
  1748. break;
  1749. }
  1750. return QDF_TX_RX_STATUS_INVALID;
  1751. }
  1752. #define WLAN_FC0_SUBTYPE_SHIFT 4
  1753. #define WLAN_FRAME_INFO_TYPE_OFFSET 0
  1754. #define WLAN_FRAME_INFO_SUBTYPE_OFFSET 2
  1755. #define WLAN_FRAME_INFO_RESP_OFFSET 6
  1756. #define WLAN_FRAME_INFO_AUTH_ALG_OFFSET 7
  1757. #define WLAN_FRAME_INFO_SEQ_NUM_OFFSET 16
  1758. /**
  1759. * extract_roam_frame_info_tlv() - Extract the frame exchanges during roaming
  1760. * info from the WMI_ROAM_STATS_EVENTID
  1761. * @wmi_handle: wmi handle
  1762. * @evt_buf: Pointer to the event buffer
  1763. * @dst: Pointer to destination structure to fill data
  1764. * @frame_idx: TLV id
  1765. * @num_frames: Number of Frame TLVs to be extracted
  1766. */
  1767. static QDF_STATUS
  1768. extract_roam_frame_info_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  1769. struct roam_frame_stats *dst, uint8_t frame_idx,
  1770. uint8_t num_frames)
  1771. {
  1772. WMI_ROAM_STATS_EVENTID_param_tlvs *param_buf;
  1773. wmi_roam_frame_info *src_data = NULL;
  1774. struct roam_frame_info *dst_buf;
  1775. uint8_t i, subtype;
  1776. param_buf = (WMI_ROAM_STATS_EVENTID_param_tlvs *)evt_buf;
  1777. if (!param_buf || !param_buf->roam_frame_info ||
  1778. !param_buf->num_roam_frame_info ||
  1779. (frame_idx + num_frames) > param_buf->num_roam_frame_info) {
  1780. wmi_err("Empty roam_frame_info param buf frame_idx:%d num_frames:%d",
  1781. frame_idx, num_frames);
  1782. return QDF_STATUS_SUCCESS;
  1783. }
  1784. src_data = &param_buf->roam_frame_info[frame_idx];
  1785. if (num_frames > WLAN_ROAM_MAX_FRAME_INFO)
  1786. num_frames = WLAN_ROAM_MAX_FRAME_INFO;
  1787. dst->num_frame = num_frames;
  1788. dst_buf = dst->frame_info;
  1789. for (i = 0; i < num_frames; i++) {
  1790. dst_buf->timestamp = src_data->timestamp;
  1791. WMI_MAC_ADDR_TO_CHAR_ARRAY(&src_data->bssid,
  1792. dst_buf->bssid.bytes);
  1793. dst_buf->type = WMI_GET_BITS(src_data->frame_info,
  1794. WLAN_FRAME_INFO_TYPE_OFFSET, 2);
  1795. subtype = WMI_GET_BITS(src_data->frame_info,
  1796. WLAN_FRAME_INFO_SUBTYPE_OFFSET, 4);
  1797. if (dst_buf->type == WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT) {
  1798. dst_buf->type = ROAM_FRAME_INFO_FRAME_TYPE_EXT;
  1799. dst_buf->subtype =
  1800. wmi_get_converted_roam_eapol_subtype(subtype);
  1801. } else {
  1802. dst_buf->subtype = subtype << WLAN_FC0_SUBTYPE_SHIFT;
  1803. }
  1804. dst_buf->is_rsp = WMI_GET_BITS(src_data->frame_info,
  1805. WLAN_FRAME_INFO_RESP_OFFSET, 1);
  1806. dst_buf->seq_num = WMI_GET_BITS(src_data->frame_info,
  1807. WLAN_FRAME_INFO_SEQ_NUM_OFFSET,
  1808. 16);
  1809. dst_buf->status_code = src_data->status_code;
  1810. if (dst_buf->type != WMI_ROAM_FRAME_INFO_FRAME_TYPE_EXT &&
  1811. dst_buf->subtype == MGMT_SUBTYPE_AUTH)
  1812. dst_buf->auth_algo =
  1813. WMI_GET_BITS(src_data->frame_info,
  1814. WLAN_FRAME_INFO_AUTH_ALG_OFFSET,
  1815. 4);
  1816. if (!dst_buf->is_rsp)
  1817. dst_buf->tx_status = wmi_get_converted_tx_status(
  1818. src_data->status_code);
  1819. dst_buf->retry_count = src_data->retry_count;
  1820. dst_buf->rssi = (-1) * src_data->rssi_dbm_abs;
  1821. dst_buf->assoc_id =
  1822. WMI_GET_ASSOC_ID(src_data->frame_info_ext);
  1823. dst_buf->band =
  1824. WMI_GET_MLO_BITMAP_BAND_INFO(src_data->frame_info_ext);
  1825. dst_buf++;
  1826. src_data++;
  1827. }
  1828. return QDF_STATUS_SUCCESS;
  1829. }
  1830. /**
  1831. * wmi_fill_data_synch_frame_event() - Fill the the roam sync data buffer using
  1832. * synch frame event data
  1833. * @rso_cfg: Source buffer
  1834. * @roam_sync_ind: Buffer to be filled
  1835. *
  1836. * Firmware sends all the required information required for roam
  1837. * synch propagation as TLV's and stored in param_buf. These
  1838. * parameters are parsed and filled into the roam synch indication
  1839. * buffer which will be used at different layers for propagation.
  1840. *
  1841. * Return: None
  1842. */
  1843. static void
  1844. wmi_fill_data_synch_frame_event(struct rso_config *rso_cfg,
  1845. struct roam_offload_synch_ind *roam_sync_ind)
  1846. {
  1847. uint8_t *bcn_probersp_ptr, *link_bcn_probersp_ptr;
  1848. uint8_t *reassoc_rsp_ptr;
  1849. uint8_t *reassoc_req_ptr;
  1850. /* Beacon/Probe Rsp data */
  1851. roam_sync_ind->beacon_probe_resp_offset =
  1852. sizeof(struct roam_offload_synch_ind);
  1853. bcn_probersp_ptr = (uint8_t *)roam_sync_ind +
  1854. roam_sync_ind->beacon_probe_resp_offset;
  1855. roam_sync_ind->beacon_probe_resp_length =
  1856. rso_cfg->roam_sync_frame_ind.bcn_probe_rsp_len;
  1857. qdf_mem_copy(bcn_probersp_ptr,
  1858. rso_cfg->roam_sync_frame_ind.bcn_probe_rsp,
  1859. roam_sync_ind->beacon_probe_resp_length);
  1860. qdf_mem_free(rso_cfg->roam_sync_frame_ind.bcn_probe_rsp);
  1861. rso_cfg->roam_sync_frame_ind.bcn_probe_rsp = NULL;
  1862. /* Link beacon/probe rsp data */
  1863. if (rso_cfg->roam_sync_frame_ind.link_bcn_probe_rsp) {
  1864. roam_sync_ind->link_beacon_probe_resp_offset =
  1865. sizeof(struct roam_offload_synch_ind) +
  1866. roam_sync_ind->beacon_probe_resp_length;
  1867. roam_sync_ind->link_beacon_probe_resp_length =
  1868. rso_cfg->roam_sync_frame_ind.link_bcn_probe_rsp_len;
  1869. roam_sync_ind->is_link_beacon =
  1870. rso_cfg->roam_sync_frame_ind.is_link_beacon;
  1871. link_bcn_probersp_ptr = (uint8_t *)roam_sync_ind +
  1872. roam_sync_ind->link_beacon_probe_resp_offset;
  1873. qdf_mem_copy(link_bcn_probersp_ptr,
  1874. rso_cfg->roam_sync_frame_ind.link_bcn_probe_rsp,
  1875. roam_sync_ind->link_beacon_probe_resp_length);
  1876. qdf_mem_free(rso_cfg->roam_sync_frame_ind.link_bcn_probe_rsp);
  1877. rso_cfg->roam_sync_frame_ind.link_bcn_probe_rsp = NULL;
  1878. }
  1879. /* ReAssoc Rsp data */
  1880. roam_sync_ind->reassoc_resp_offset =
  1881. sizeof(struct roam_offload_synch_ind) +
  1882. roam_sync_ind->beacon_probe_resp_length +
  1883. roam_sync_ind->link_beacon_probe_resp_length;
  1884. roam_sync_ind->reassoc_resp_length =
  1885. rso_cfg->roam_sync_frame_ind.reassoc_rsp_len;
  1886. reassoc_rsp_ptr = (uint8_t *)roam_sync_ind +
  1887. roam_sync_ind->reassoc_resp_offset;
  1888. qdf_mem_copy(reassoc_rsp_ptr,
  1889. rso_cfg->roam_sync_frame_ind.reassoc_rsp,
  1890. roam_sync_ind->reassoc_resp_length);
  1891. qdf_mem_free(rso_cfg->roam_sync_frame_ind.reassoc_rsp);
  1892. rso_cfg->roam_sync_frame_ind.reassoc_rsp = NULL;
  1893. /* ReAssoc Req data */
  1894. roam_sync_ind->reassoc_req_offset =
  1895. sizeof(struct roam_offload_synch_ind) +
  1896. roam_sync_ind->beacon_probe_resp_length +
  1897. roam_sync_ind->link_beacon_probe_resp_length +
  1898. roam_sync_ind->reassoc_resp_length;
  1899. roam_sync_ind->reassoc_req_length =
  1900. rso_cfg->roam_sync_frame_ind.reassoc_req_len;
  1901. reassoc_req_ptr = (uint8_t *)roam_sync_ind +
  1902. roam_sync_ind->reassoc_req_offset;
  1903. qdf_mem_copy(reassoc_req_ptr,
  1904. rso_cfg->roam_sync_frame_ind.reassoc_req,
  1905. roam_sync_ind->reassoc_req_length);
  1906. qdf_mem_free(rso_cfg->roam_sync_frame_ind.reassoc_req);
  1907. rso_cfg->roam_sync_frame_ind.reassoc_req = NULL;
  1908. }
  1909. /**
  1910. * wmi_fill_data_synch_event() - Fill the the roam sync data buffer
  1911. * using synch event data
  1912. * @roam_sync_ind: Buffer to be filled
  1913. * @param_buf: Source buffer
  1914. *
  1915. * Firmware sends all the required information required for roam
  1916. * synch propagation as TLV's and stored in param_buf. These
  1917. * parameters are parsed and filled into the roam synch indication
  1918. * buffer which will be used at different layers for propagation.
  1919. *
  1920. * Return: None
  1921. */
  1922. static void
  1923. wmi_fill_data_synch_event(struct roam_offload_synch_ind *roam_sync_ind,
  1924. WMI_ROAM_SYNCH_EVENTID_param_tlvs *param_buf)
  1925. {
  1926. uint8_t *bcn_probersp_ptr;
  1927. uint8_t *reassoc_rsp_ptr;
  1928. uint8_t *reassoc_req_ptr;
  1929. wmi_roam_synch_event_fixed_param *synch_event;
  1930. synch_event = param_buf->fixed_param;
  1931. /* Beacon/Probe Rsp data */
  1932. roam_sync_ind->beacon_probe_resp_offset =
  1933. sizeof(struct roam_offload_synch_ind);
  1934. bcn_probersp_ptr = (uint8_t *)roam_sync_ind +
  1935. roam_sync_ind->beacon_probe_resp_offset;
  1936. roam_sync_ind->beacon_probe_resp_length =
  1937. synch_event->bcn_probe_rsp_len;
  1938. qdf_mem_copy(bcn_probersp_ptr, param_buf->bcn_probe_rsp_frame,
  1939. roam_sync_ind->beacon_probe_resp_length);
  1940. /*
  1941. * Firmware doesn't support link beacon/Probe Rsp data in roam sync
  1942. * event. It's always sent in sync_frame event
  1943. */
  1944. /* ReAssoc Rsp data */
  1945. roam_sync_ind->reassoc_resp_offset =
  1946. sizeof(struct roam_offload_synch_ind) +
  1947. roam_sync_ind->beacon_probe_resp_length;
  1948. roam_sync_ind->reassoc_resp_length = synch_event->reassoc_rsp_len;
  1949. reassoc_rsp_ptr = (uint8_t *)roam_sync_ind +
  1950. roam_sync_ind->reassoc_resp_offset;
  1951. qdf_mem_copy(reassoc_rsp_ptr,
  1952. param_buf->reassoc_rsp_frame,
  1953. roam_sync_ind->reassoc_resp_length);
  1954. /* ReAssoc Req data */
  1955. roam_sync_ind->reassoc_req_offset =
  1956. sizeof(struct roam_offload_synch_ind) +
  1957. roam_sync_ind->beacon_probe_resp_length +
  1958. roam_sync_ind->reassoc_resp_length;
  1959. roam_sync_ind->reassoc_req_length = synch_event->reassoc_req_len;
  1960. reassoc_req_ptr = (uint8_t *)roam_sync_ind +
  1961. roam_sync_ind->reassoc_req_offset;
  1962. qdf_mem_copy(reassoc_req_ptr, param_buf->reassoc_req_frame,
  1963. roam_sync_ind->reassoc_req_length);
  1964. }
  1965. #ifdef WLAN_FEATURE_11BE_MLO
  1966. #define STANDBY_VDEV_ID (0xFFFFFFFF)
  1967. static QDF_STATUS
  1968. wmi_fill_roam_mlo_info(wmi_unified_t wmi_handle,
  1969. WMI_ROAM_SYNCH_EVENTID_param_tlvs *param_buf,
  1970. struct roam_offload_synch_ind *roam_sync_ind)
  1971. {
  1972. uint8_t i, mlo_max_allowed_links;
  1973. wmi_roam_ml_setup_links_param *setup_links;
  1974. wmi_roam_ml_key_material_param *ml_key_param;
  1975. struct ml_setup_link_param *link;
  1976. struct ml_key_material_param *key;
  1977. mlo_max_allowed_links =
  1978. wlan_mlme_get_sta_mlo_conn_max_num(wmi_handle->soc->wmi_psoc);
  1979. if (param_buf->num_setup_links_param) {
  1980. if (param_buf->num_setup_links_param > mlo_max_allowed_links ||
  1981. param_buf->num_setup_links_param > WLAN_MAX_ML_BSS_LINKS) {
  1982. wmi_err("Number of links %d exceeded max vdev supported %d",
  1983. param_buf->num_setup_links_param,
  1984. mlo_max_allowed_links);
  1985. return QDF_STATUS_E_INVAL;
  1986. }
  1987. roam_sync_ind->num_setup_links =
  1988. param_buf->num_setup_links_param;
  1989. setup_links = param_buf->setup_links_param;
  1990. for (i = 0; i < roam_sync_ind->num_setup_links; i++) {
  1991. link = &roam_sync_ind->ml_link[i];
  1992. link->link_id = setup_links->link_id;
  1993. /*
  1994. * setup_links->vdev_id == UINT32_MAX for standby link
  1995. */
  1996. link->vdev_id = WLAN_INVALID_VDEV_ID;
  1997. if (setup_links->vdev_id != STANDBY_VDEV_ID)
  1998. link->vdev_id = setup_links->vdev_id;
  1999. link->channel = setup_links->channel;
  2000. link->flags = setup_links->flags;
  2001. WMI_MAC_ADDR_TO_CHAR_ARRAY(&setup_links->link_addr,
  2002. link->link_addr.bytes);
  2003. WMI_MAC_ADDR_TO_CHAR_ARRAY(&setup_links->self_link_addr,
  2004. link->self_link_addr.bytes);
  2005. wmi_debug("link_id: %u vdev_id: %u flags: 0x%x addr:" QDF_MAC_ADDR_FMT "self_addr:" QDF_MAC_ADDR_FMT,
  2006. link->link_id, link->vdev_id,
  2007. link->flags,
  2008. QDF_MAC_ADDR_REF(link->link_addr.bytes),
  2009. QDF_MAC_ADDR_REF(link->self_link_addr.bytes));
  2010. wmi_debug("channel: %u mhz center_freq1: %u center_freq2: %u",
  2011. link->channel.mhz,
  2012. link->channel.band_center_freq1,
  2013. link->channel.band_center_freq2);
  2014. setup_links++;
  2015. }
  2016. }
  2017. if (!param_buf->num_ml_key_material)
  2018. return QDF_STATUS_SUCCESS;
  2019. if (param_buf->num_ml_key_material > WLAN_MAX_ML_BSS_LINKS)
  2020. param_buf->num_ml_key_material = WLAN_MAX_ML_BSS_LINKS;
  2021. roam_sync_ind->num_ml_key_material = param_buf->num_ml_key_material;
  2022. ml_key_param = param_buf->ml_key_material;
  2023. for (i = 0; i < roam_sync_ind->num_ml_key_material; i++) {
  2024. key = &roam_sync_ind->ml_key[i];
  2025. key->link_id = ml_key_param->link_id;
  2026. key->key_idx = ml_key_param->key_ix;
  2027. key->key_cipher = ml_key_param->key_cipher;
  2028. qdf_mem_copy(key->pn, ml_key_param->pn,
  2029. WMI_MAX_PN_LEN);
  2030. qdf_mem_copy(key->key_buff, ml_key_param->key_buff,
  2031. WMI_MAX_KEY_LEN);
  2032. wmi_debug("link_id: %u key_idx: %u key_cipher: %u",
  2033. key->link_id, key->key_idx, key->key_cipher);
  2034. ml_key_param++;
  2035. }
  2036. return QDF_STATUS_SUCCESS;
  2037. }
  2038. #else
  2039. static QDF_STATUS
  2040. wmi_fill_roam_mlo_info(wmi_unified_t wmi_handle,
  2041. WMI_ROAM_SYNCH_EVENTID_param_tlvs *param_buf,
  2042. struct roam_offload_synch_ind *roam_sync_ind)
  2043. {
  2044. return QDF_STATUS_SUCCESS;
  2045. }
  2046. #endif
  2047. static QDF_STATUS
  2048. wmi_fill_roam_sync_buffer(wmi_unified_t wmi_handle,
  2049. struct wlan_objmgr_vdev *vdev,
  2050. struct rso_config *rso_cfg,
  2051. struct roam_offload_synch_ind *roam_sync_ind,
  2052. WMI_ROAM_SYNCH_EVENTID_param_tlvs *param_buf)
  2053. {
  2054. wmi_roam_synch_event_fixed_param *synch_event;
  2055. void *soc = cds_get_context(QDF_MODULE_ID_SOC);
  2056. wmi_channel *chan = NULL;
  2057. wmi_key_material *key;
  2058. wmi_key_material_ext *key_ext;
  2059. wmi_roam_fils_synch_tlv_param *fils_info;
  2060. wmi_roam_pmk_cache_synch_tlv_param *pmk_cache_info;
  2061. QDF_STATUS status = QDF_STATUS_E_FAILURE;
  2062. uint8_t kck_len;
  2063. uint8_t kek_len;
  2064. synch_event = param_buf->fixed_param;
  2065. roam_sync_ind->roamed_vdev_id = synch_event->vdev_id;
  2066. roam_sync_ind->auth_status = synch_event->auth_status;
  2067. roam_sync_ind->roam_reason = synch_event->roam_reason;
  2068. roam_sync_ind->rssi = synch_event->rssi;
  2069. roam_sync_ind->is_beacon = synch_event->is_beacon;
  2070. WMI_MAC_ADDR_TO_CHAR_ARRAY(&synch_event->bssid,
  2071. roam_sync_ind->bssid.bytes);
  2072. wmi_debug("roamed_vdev_id %d auth_status %d roam_reason %d rssi %d is_beacon %d",
  2073. roam_sync_ind->roamed_vdev_id,
  2074. roam_sync_ind->auth_status,
  2075. roam_sync_ind->roam_reason,
  2076. roam_sync_ind->rssi,
  2077. roam_sync_ind->is_beacon);
  2078. cdp_update_roaming_peer_in_vdev(soc, synch_event->vdev_id,
  2079. roam_sync_ind->bssid.bytes,
  2080. synch_event->auth_status);
  2081. /*
  2082. * If lengths of bcn_probe_rsp, reassoc_req and reassoc_rsp are zero in
  2083. * synch_event driver would have received bcn_probe_rsp, reassoc_req
  2084. * and reassoc_rsp via the event WMI_ROAM_SYNCH_FRAME_EVENTID
  2085. */
  2086. if ((!synch_event->bcn_probe_rsp_len) &&
  2087. (!synch_event->reassoc_req_len) &&
  2088. (!synch_event->reassoc_rsp_len)) {
  2089. if (!rso_cfg->roam_sync_frame_ind.bcn_probe_rsp) {
  2090. wmi_err("LFR3: bcn_probe_rsp is NULL");
  2091. QDF_ASSERT(rso_cfg->roam_sync_frame_ind.bcn_probe_rsp);
  2092. wlan_cm_free_roam_synch_frame_ind(rso_cfg);
  2093. return status;
  2094. }
  2095. if (!rso_cfg->roam_sync_frame_ind.reassoc_rsp) {
  2096. wmi_err("LFR3: reassoc_rsp is NULL");
  2097. QDF_ASSERT(rso_cfg->roam_sync_frame_ind.reassoc_rsp);
  2098. wlan_cm_free_roam_synch_frame_ind(rso_cfg);
  2099. return status;
  2100. }
  2101. if (!rso_cfg->roam_sync_frame_ind.reassoc_req) {
  2102. wmi_err("LFR3: reassoc_req is NULL");
  2103. QDF_ASSERT(rso_cfg->roam_sync_frame_ind.reassoc_req);
  2104. wlan_cm_free_roam_synch_frame_ind(rso_cfg);
  2105. return status;
  2106. }
  2107. wmi_fill_data_synch_frame_event(rso_cfg, roam_sync_ind);
  2108. } else {
  2109. wmi_fill_data_synch_event(roam_sync_ind, param_buf);
  2110. }
  2111. chan = param_buf->chan;
  2112. if (chan) {
  2113. roam_sync_ind->chan_freq = chan->mhz;
  2114. roam_sync_ind->phy_mode =
  2115. wlan_cm_fw_to_host_phymode(WMI_GET_CHANNEL_MODE(chan));
  2116. roam_sync_ind->chan = *chan;
  2117. } else {
  2118. roam_sync_ind->phy_mode = WLAN_PHYMODE_AUTO;
  2119. }
  2120. key = param_buf->key;
  2121. key_ext = param_buf->key_ext;
  2122. if (key) {
  2123. roam_sync_ind->kck_len = KCK_KEY_LEN;
  2124. qdf_mem_copy(roam_sync_ind->kck, key->kck,
  2125. KCK_KEY_LEN);
  2126. roam_sync_ind->kek_len = KEK_KEY_LEN;
  2127. qdf_mem_copy(roam_sync_ind->kek, key->kek,
  2128. KEK_KEY_LEN);
  2129. qdf_mem_copy(roam_sync_ind->replay_ctr,
  2130. key->replay_counter, REPLAY_CTR_LEN);
  2131. } else if (key_ext) {
  2132. /*
  2133. * key_ext carries key materials whose size
  2134. * is greater than conventional 16bytes.
  2135. */
  2136. kck_len = key_ext->kck_len ?
  2137. key_ext->kck_len : KCK_192BIT_KEY_LEN;
  2138. kek_len = key_ext->kek_len ?
  2139. key_ext->kek_len : KEK_256BIT_KEY_LEN;
  2140. roam_sync_ind->kck_len = kck_len;
  2141. qdf_mem_copy(roam_sync_ind->kck,
  2142. key_ext->key_buffer, kck_len);
  2143. roam_sync_ind->kek_len = kek_len;
  2144. qdf_mem_copy(roam_sync_ind->kek,
  2145. (key_ext->key_buffer + kck_len),
  2146. kek_len);
  2147. qdf_mem_copy(roam_sync_ind->replay_ctr,
  2148. (key_ext->key_buffer + kek_len + kck_len),
  2149. REPLAY_CTR_LEN);
  2150. }
  2151. wmi_debug("ROAM_SYNC kek_len %d kck_len %d",
  2152. roam_sync_ind->kek_len,
  2153. roam_sync_ind->kck_len);
  2154. if (param_buf->hw_mode_transition_fixed_param) {
  2155. wmi_extract_pdev_hw_mode_trans_ind(
  2156. param_buf->hw_mode_transition_fixed_param,
  2157. param_buf->wmi_pdev_set_hw_mode_response_vdev_mac_mapping,
  2158. &roam_sync_ind->hw_mode_trans_ind);
  2159. roam_sync_ind->hw_mode_trans_present = true;
  2160. } else {
  2161. wmi_debug("hw_mode transition fixed param is NULL");
  2162. }
  2163. fils_info = param_buf->roam_fils_synch_info;
  2164. if (fils_info) {
  2165. if ((fils_info->kek_len > MAX_KEK_LENGTH) ||
  2166. (fils_info->pmk_len > MAX_PMK_LEN)) {
  2167. wmi_err("Invalid kek_len %d or pmk_len %d",
  2168. fils_info->kek_len,
  2169. fils_info->pmk_len);
  2170. wlan_cm_free_roam_synch_frame_ind(rso_cfg);
  2171. return status;
  2172. }
  2173. roam_sync_ind->kek_len = fils_info->kek_len;
  2174. qdf_mem_copy(roam_sync_ind->kek, fils_info->kek,
  2175. fils_info->kek_len);
  2176. roam_sync_ind->pmk_len = fils_info->pmk_len;
  2177. qdf_mem_copy(roam_sync_ind->pmk, fils_info->pmk,
  2178. fils_info->pmk_len);
  2179. qdf_mem_copy(roam_sync_ind->pmkid, fils_info->pmkid,
  2180. PMKID_LEN);
  2181. roam_sync_ind->update_erp_next_seq_num =
  2182. fils_info->update_erp_next_seq_num;
  2183. roam_sync_ind->next_erp_seq_num =
  2184. fils_info->next_erp_seq_num;
  2185. wmi_debug("Update ERP Seq Num %d, Next ERP Seq Num %d KEK len %d",
  2186. roam_sync_ind->update_erp_next_seq_num,
  2187. roam_sync_ind->next_erp_seq_num,
  2188. roam_sync_ind->kek_len);
  2189. }
  2190. pmk_cache_info = param_buf->roam_pmk_cache_synch_info;
  2191. if (pmk_cache_info && (pmk_cache_info->pmk_len)) {
  2192. if (pmk_cache_info->pmk_len > MAX_PMK_LEN) {
  2193. wmi_err("Invalid pmk_len %d",
  2194. pmk_cache_info->pmk_len);
  2195. wlan_cm_free_roam_synch_frame_ind(rso_cfg);
  2196. return status;
  2197. }
  2198. roam_sync_ind->pmk_len = pmk_cache_info->pmk_len;
  2199. qdf_mem_copy(roam_sync_ind->pmk,
  2200. pmk_cache_info->pmk, pmk_cache_info->pmk_len);
  2201. qdf_mem_copy(roam_sync_ind->pmkid,
  2202. pmk_cache_info->pmkid, PMKID_LEN);
  2203. }
  2204. status = wmi_fill_roam_mlo_info(wmi_handle, param_buf, roam_sync_ind);
  2205. if (QDF_IS_STATUS_ERROR(status)) {
  2206. wmi_err("Failed to fill roam mlo info");
  2207. return status;
  2208. }
  2209. wlan_cm_free_roam_synch_frame_ind(rso_cfg);
  2210. return QDF_STATUS_SUCCESS;
  2211. }
  2212. /**
  2213. * extract_roam_sync_event_tlv() - Extract the roam sync event
  2214. * from the wmi_roam_synch_event_id
  2215. * @wmi_handle: wmi handle
  2216. * @evt_buf: Pointer to the event buffer
  2217. * @len: Data length
  2218. * @roam_sync_ind: Ptr to roam offload sync struct
  2219. */
  2220. static QDF_STATUS
  2221. extract_roam_sync_event_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  2222. uint32_t len,
  2223. struct roam_offload_synch_ind **roam_sync_ind)
  2224. {
  2225. QDF_STATUS status = QDF_STATUS_SUCCESS;
  2226. wmi_roam_synch_event_fixed_param *synch_event = NULL;
  2227. WMI_ROAM_SYNCH_EVENTID_param_tlvs *param_buf = NULL;
  2228. struct roam_offload_synch_ind *roam_sync = NULL;
  2229. struct wlan_objmgr_vdev *vdev = NULL;
  2230. struct wlan_objmgr_psoc *psoc = NULL;
  2231. struct rso_config *rso_cfg;
  2232. uint32_t roam_synch_data_len;
  2233. uint32_t bcn_probe_rsp_len, link_bcn_probe_rsp_len;
  2234. uint32_t reassoc_rsp_len;
  2235. uint32_t reassoc_req_len;
  2236. wmi_pdev_hw_mode_transition_event_fixed_param *hw_mode_trans_param;
  2237. if (!evt_buf) {
  2238. wmi_debug("Empty roam_sync_event param buf");
  2239. return QDF_STATUS_E_FAILURE;
  2240. }
  2241. param_buf = (WMI_ROAM_SYNCH_EVENTID_param_tlvs *)evt_buf;
  2242. if (!param_buf) {
  2243. wmi_debug("received null buf from target");
  2244. return QDF_STATUS_E_FAILURE;
  2245. }
  2246. synch_event = param_buf->fixed_param;
  2247. if (!synch_event) {
  2248. wmi_debug("received null event data from target");
  2249. return QDF_STATUS_E_FAILURE;
  2250. }
  2251. hw_mode_trans_param = param_buf->hw_mode_transition_fixed_param;
  2252. if (hw_mode_trans_param &&
  2253. hw_mode_trans_param->num_vdev_mac_entries >
  2254. param_buf->num_wmi_pdev_set_hw_mode_response_vdev_mac_mapping) {
  2255. wmi_debug("invalid vdev mac entries %d %d in roam sync",
  2256. hw_mode_trans_param->num_vdev_mac_entries,
  2257. param_buf->num_wmi_pdev_set_hw_mode_response_vdev_mac_mapping);
  2258. return QDF_STATUS_E_FAILURE;
  2259. }
  2260. if (synch_event->vdev_id >= WLAN_MAX_VDEVS) {
  2261. wmi_err("received invalid vdev_id %d",
  2262. synch_event->vdev_id);
  2263. return QDF_STATUS_E_FAILURE;
  2264. }
  2265. if (synch_event->bcn_probe_rsp_len >
  2266. param_buf->num_bcn_probe_rsp_frame ||
  2267. synch_event->reassoc_req_len >
  2268. param_buf->num_reassoc_req_frame ||
  2269. synch_event->reassoc_rsp_len >
  2270. param_buf->num_reassoc_rsp_frame) {
  2271. wmi_debug("Invalid sync payload: LEN bcn:%d, req:%d, rsp:%d, vdev:%d",
  2272. synch_event->bcn_probe_rsp_len,
  2273. synch_event->reassoc_req_len,
  2274. synch_event->reassoc_rsp_len,
  2275. synch_event->vdev_id);
  2276. status = QDF_STATUS_E_FAILURE;
  2277. goto abort_roam;
  2278. }
  2279. psoc = wmi_handle->soc->wmi_psoc;
  2280. vdev = wlan_objmgr_get_vdev_by_id_from_psoc(psoc, synch_event->vdev_id,
  2281. WLAN_MLME_SB_ID);
  2282. if (!vdev) {
  2283. wmi_err("For vdev:%d object is NULL", synch_event->vdev_id);
  2284. status = QDF_STATUS_E_FAILURE;
  2285. goto abort_roam;
  2286. }
  2287. rso_cfg = wlan_cm_get_rso_config(vdev);
  2288. if (!rso_cfg) {
  2289. status = QDF_STATUS_E_FAILURE;
  2290. goto end;
  2291. }
  2292. /*
  2293. * All below length fields are unsigned and hence positive numbers.
  2294. * Maximum number during the addition would be (3 * MAX_LIMIT(UINT32) +
  2295. * few fixed fields).
  2296. */
  2297. wmi_debug("synch payload: LEN bcn:%d, req:%d, rsp:%d",
  2298. synch_event->bcn_probe_rsp_len,
  2299. synch_event->reassoc_req_len,
  2300. synch_event->reassoc_rsp_len);
  2301. /*
  2302. * If lengths of bcn_probe_rsp, reassoc_req and reassoc_rsp are zero in
  2303. * synch_event driver would have received bcn_probe_rsp, reassoc_req
  2304. * and reassoc_rsp via the event WMI_ROAM_SYNCH_FRAME_EVENTID
  2305. */
  2306. if ((!synch_event->bcn_probe_rsp_len) &&
  2307. (!synch_event->reassoc_req_len) &&
  2308. (!synch_event->reassoc_rsp_len)) {
  2309. bcn_probe_rsp_len =
  2310. rso_cfg->roam_sync_frame_ind.bcn_probe_rsp_len;
  2311. link_bcn_probe_rsp_len =
  2312. rso_cfg->roam_sync_frame_ind.link_bcn_probe_rsp_len;
  2313. reassoc_req_len = rso_cfg->roam_sync_frame_ind.reassoc_req_len;
  2314. reassoc_rsp_len = rso_cfg->roam_sync_frame_ind.reassoc_rsp_len;
  2315. roam_synch_data_len =
  2316. bcn_probe_rsp_len + link_bcn_probe_rsp_len +
  2317. reassoc_rsp_len + reassoc_req_len +
  2318. sizeof(struct roam_offload_synch_ind);
  2319. wmi_debug("Updated synch payload: LEN bcn:%d, link bcn: %d req:%d, rsp:%d",
  2320. bcn_probe_rsp_len,
  2321. link_bcn_probe_rsp_len,
  2322. reassoc_req_len,
  2323. reassoc_rsp_len);
  2324. } else {
  2325. bcn_probe_rsp_len = synch_event->bcn_probe_rsp_len;
  2326. reassoc_req_len = synch_event->reassoc_req_len;
  2327. reassoc_rsp_len = synch_event->reassoc_rsp_len;
  2328. if (synch_event->bcn_probe_rsp_len > WMI_SVC_MSG_MAX_SIZE) {
  2329. status = QDF_STATUS_E_FAILURE;
  2330. goto end;
  2331. }
  2332. if (synch_event->reassoc_rsp_len >
  2333. (WMI_SVC_MSG_MAX_SIZE - synch_event->bcn_probe_rsp_len)) {
  2334. status = QDF_STATUS_E_FAILURE;
  2335. goto end;
  2336. }
  2337. if (synch_event->reassoc_req_len >
  2338. WMI_SVC_MSG_MAX_SIZE - (synch_event->bcn_probe_rsp_len +
  2339. synch_event->reassoc_rsp_len)) {
  2340. status = QDF_STATUS_E_FAILURE;
  2341. goto end;
  2342. }
  2343. roam_synch_data_len = bcn_probe_rsp_len +
  2344. reassoc_rsp_len + reassoc_req_len;
  2345. /*
  2346. * Below is the check for the entire size of the message
  2347. * received from the firmware.
  2348. */
  2349. if (roam_synch_data_len > WMI_SVC_MSG_MAX_SIZE -
  2350. (sizeof(*synch_event) + sizeof(wmi_channel) +
  2351. sizeof(wmi_key_material) + sizeof(uint32_t))) {
  2352. status = QDF_STATUS_E_FAILURE;
  2353. goto end;
  2354. }
  2355. roam_synch_data_len += sizeof(struct roam_offload_synch_ind);
  2356. }
  2357. roam_sync = qdf_mem_malloc(roam_synch_data_len);
  2358. if (!roam_sync) {
  2359. QDF_ASSERT(roam_sync);
  2360. status = QDF_STATUS_E_NOMEM;
  2361. goto end;
  2362. }
  2363. *roam_sync_ind = roam_sync;
  2364. status = wmi_fill_roam_sync_buffer(wmi_handle, vdev, rso_cfg,
  2365. roam_sync, param_buf);
  2366. end:
  2367. wlan_objmgr_vdev_release_ref(vdev, WLAN_MLME_SB_ID);
  2368. abort_roam:
  2369. if (QDF_IS_STATUS_ERROR(status)) {
  2370. wmi_err("%d Failed to extract roam sync ind", status);
  2371. wlan_cm_roam_stop_req(psoc, synch_event->vdev_id,
  2372. REASON_ROAM_SYNCH_FAILED);
  2373. }
  2374. return status;
  2375. }
  2376. /**
  2377. * extract_roam_sync_frame_event_tlv() - Extract the roam sync frame event
  2378. * from the wmi_roam_synch_event_id
  2379. * @wmi_handle: wmi handle
  2380. * @event: Pointer to the event buffer
  2381. * @len: event buffer length
  2382. * @frame_ptr: wmi sync frame event ptr
  2383. */
  2384. static QDF_STATUS
  2385. extract_roam_sync_frame_event_tlv(wmi_unified_t wmi_handle, void *event,
  2386. uint32_t len,
  2387. struct roam_synch_frame_ind *frame_ptr)
  2388. {
  2389. WMI_ROAM_SYNCH_FRAME_EVENTID_param_tlvs *param_buf = NULL;
  2390. struct roam_synch_frame_ind *frame_ind;
  2391. wmi_roam_synch_frame_event_fixed_param *frame_evt;
  2392. if (!event) {
  2393. wmi_err("Event param null");
  2394. return QDF_STATUS_E_NULL_VALUE;
  2395. }
  2396. param_buf = (WMI_ROAM_SYNCH_FRAME_EVENTID_param_tlvs *)event;
  2397. if (!param_buf) {
  2398. wmi_err("received null buf from target");
  2399. return QDF_STATUS_E_NULL_VALUE;
  2400. }
  2401. frame_evt = param_buf->fixed_param;
  2402. if (!frame_evt) {
  2403. wmi_err("received null event data from target");
  2404. return QDF_STATUS_E_NULL_VALUE;
  2405. }
  2406. if (frame_evt->vdev_id >= WLAN_MAX_VDEVS) {
  2407. wmi_err("received invalid vdev_id %d", frame_evt->vdev_id);
  2408. return QDF_STATUS_E_FAILURE;
  2409. }
  2410. /*
  2411. * Firmware can send more than one roam synch frame event to host
  2412. * driver. So Bcn_prb_rsp_len/reassoc_req_len/reassoc_rsp_len can be 0
  2413. * in some of the events.
  2414. */
  2415. if (frame_evt->bcn_probe_rsp_len > param_buf->num_bcn_probe_rsp_frame ||
  2416. frame_evt->reassoc_req_len > param_buf->num_reassoc_req_frame ||
  2417. frame_evt->reassoc_rsp_len > param_buf->num_reassoc_rsp_frame ||
  2418. (frame_evt->bcn_probe_rsp_len &&
  2419. frame_evt->bcn_probe_rsp_len < sizeof(struct wlan_frame_hdr)) ||
  2420. (frame_evt->reassoc_req_len &&
  2421. frame_evt->reassoc_req_len < sizeof(struct wlan_frame_hdr)) ||
  2422. (frame_evt->reassoc_rsp_len &&
  2423. frame_evt->reassoc_rsp_len < sizeof(struct wlan_frame_hdr))) {
  2424. wmi_err("fixed/actual len err: bcn:%d/%d req:%d/%d rsp:%d/%d",
  2425. frame_evt->bcn_probe_rsp_len,
  2426. param_buf->num_bcn_probe_rsp_frame,
  2427. frame_evt->reassoc_req_len,
  2428. param_buf->num_reassoc_req_frame,
  2429. frame_evt->reassoc_rsp_len,
  2430. param_buf->num_reassoc_rsp_frame);
  2431. return QDF_STATUS_E_FAILURE;
  2432. }
  2433. frame_ind = frame_ptr;
  2434. frame_ind->vdev_id = frame_evt->vdev_id;
  2435. wmi_debug("synch frame payload: LEN %s bcn:%d, req:%d, rsp:%d",
  2436. frame_evt->reassoc_rsp_len ? "Assoc" : "Link",
  2437. frame_evt->bcn_probe_rsp_len,
  2438. frame_evt->reassoc_req_len,
  2439. frame_evt->reassoc_rsp_len);
  2440. if (frame_evt->bcn_probe_rsp_len &&
  2441. frame_evt->reassoc_rsp_len) {
  2442. frame_ind->bcn_probe_rsp_len = frame_evt->bcn_probe_rsp_len;
  2443. frame_ind->is_beacon = frame_evt->is_beacon;
  2444. frame_ind->bcn_probe_rsp =
  2445. qdf_mem_malloc(frame_ind->bcn_probe_rsp_len);
  2446. if (!frame_ind->bcn_probe_rsp) {
  2447. QDF_ASSERT(frame_ind->bcn_probe_rsp);
  2448. return QDF_STATUS_E_NOMEM;
  2449. }
  2450. qdf_mem_copy(frame_ind->bcn_probe_rsp,
  2451. param_buf->bcn_probe_rsp_frame,
  2452. frame_ind->bcn_probe_rsp_len);
  2453. } else if (frame_evt->bcn_probe_rsp_len) {
  2454. frame_ind->link_bcn_probe_rsp_len =
  2455. frame_evt->bcn_probe_rsp_len;
  2456. frame_ind->is_link_beacon = frame_evt->is_beacon;
  2457. if (frame_ind->link_bcn_probe_rsp)
  2458. qdf_mem_free(frame_ind->bcn_probe_rsp);
  2459. frame_ind->link_bcn_probe_rsp =
  2460. qdf_mem_malloc(frame_ind->link_bcn_probe_rsp_len);
  2461. if (!frame_ind->link_bcn_probe_rsp) {
  2462. QDF_ASSERT(frame_ind->link_bcn_probe_rsp);
  2463. return QDF_STATUS_E_NOMEM;
  2464. }
  2465. qdf_mem_copy(frame_ind->link_bcn_probe_rsp,
  2466. param_buf->bcn_probe_rsp_frame,
  2467. frame_ind->link_bcn_probe_rsp_len);
  2468. }
  2469. if (frame_evt->reassoc_req_len) {
  2470. frame_ind->reassoc_req_len = frame_evt->reassoc_req_len;
  2471. frame_ind->reassoc_req =
  2472. qdf_mem_malloc(frame_ind->reassoc_req_len);
  2473. if (!frame_ind->reassoc_req) {
  2474. QDF_ASSERT(frame_ind->reassoc_req);
  2475. return QDF_STATUS_E_NOMEM;
  2476. }
  2477. qdf_mem_copy(frame_ind->reassoc_req,
  2478. param_buf->reassoc_req_frame,
  2479. frame_ind->reassoc_req_len);
  2480. }
  2481. if (frame_evt->reassoc_rsp_len) {
  2482. frame_ind->reassoc_rsp_len = frame_evt->reassoc_rsp_len;
  2483. frame_ind->reassoc_rsp =
  2484. qdf_mem_malloc(frame_ind->reassoc_rsp_len);
  2485. if (!frame_ind->reassoc_rsp) {
  2486. QDF_ASSERT(frame_ind->reassoc_rsp);
  2487. return QDF_STATUS_E_NOMEM;
  2488. }
  2489. qdf_mem_copy(frame_ind->reassoc_rsp,
  2490. param_buf->reassoc_rsp_frame,
  2491. frame_ind->reassoc_rsp_len);
  2492. }
  2493. return QDF_STATUS_SUCCESS;
  2494. }
  2495. static enum dlm_reject_ap_reason wmi_get_reject_reason(uint32_t reason)
  2496. {
  2497. switch (reason) {
  2498. case WMI_BL_REASON_NUD_FAILURE:
  2499. return REASON_NUD_FAILURE;
  2500. case WMI_BL_REASON_STA_KICKOUT:
  2501. return REASON_STA_KICKOUT;
  2502. case WMI_BL_REASON_ROAM_HO_FAILURE:
  2503. return REASON_ROAM_HO_FAILURE;
  2504. case WMI_BL_REASON_ASSOC_REJECT_POOR_RSSI:
  2505. return REASON_ASSOC_REJECT_POOR_RSSI;
  2506. case WMI_BL_REASON_ASSOC_REJECT_OCE:
  2507. return REASON_ASSOC_REJECT_OCE;
  2508. case WMI_BL_REASON_USERSPACE_BL:
  2509. return REASON_USERSPACE_BL;
  2510. case WMI_BL_REASON_USERSPACE_AVOID_LIST:
  2511. return REASON_USERSPACE_AVOID_LIST;
  2512. case WMI_BL_REASON_BTM_DIASSOC_IMMINENT:
  2513. return REASON_BTM_DISASSOC_IMMINENT;
  2514. case WMI_BL_REASON_BTM_BSS_TERMINATION:
  2515. return REASON_BTM_BSS_TERMINATION;
  2516. case WMI_BL_REASON_BTM_MBO_RETRY:
  2517. return REASON_BTM_MBO_RETRY;
  2518. case WMI_BL_REASON_REASSOC_RSSI_REJECT:
  2519. return REASON_REASSOC_RSSI_REJECT;
  2520. case WMI_BL_REASON_REASSOC_NO_MORE_STAS:
  2521. return REASON_REASSOC_NO_MORE_STAS;
  2522. default:
  2523. return REASON_UNKNOWN;
  2524. }
  2525. }
  2526. static QDF_STATUS
  2527. extract_btm_denylist_event(wmi_unified_t wmi_handle,
  2528. uint8_t *event, uint32_t len,
  2529. struct roam_denylist_event **list)
  2530. {
  2531. WMI_ROAM_BLACKLIST_EVENTID_param_tlvs *param_buf;
  2532. wmi_roam_blacklist_event_fixed_param *resp_event;
  2533. wmi_roam_blacklist_with_timeout_tlv_param *src_list;
  2534. struct roam_denylist_timeout *roam_denylist;
  2535. struct roam_denylist_event *dst_list;
  2536. uint32_t num_entries, i;
  2537. param_buf = (WMI_ROAM_BLACKLIST_EVENTID_param_tlvs *)event;
  2538. if (!param_buf) {
  2539. wmi_err("Invalid event buffer");
  2540. return QDF_STATUS_E_INVAL;
  2541. }
  2542. resp_event = param_buf->fixed_param;
  2543. if (!resp_event) {
  2544. wmi_err("received null event data from target");
  2545. return QDF_STATUS_E_INVAL;
  2546. }
  2547. if (resp_event->vdev_id >= WLAN_MAX_VDEVS) {
  2548. wmi_err("received invalid vdev_id %d", resp_event->vdev_id);
  2549. return QDF_STATUS_E_INVAL;
  2550. }
  2551. num_entries = param_buf->num_blacklist_with_timeout;
  2552. if (num_entries == 0)
  2553. return QDF_STATUS_SUCCESS;
  2554. if (num_entries > MAX_RSSI_AVOID_BSSID_LIST) {
  2555. wmi_err("num blacklist entries:%d exceeds maximum value",
  2556. num_entries);
  2557. return QDF_STATUS_E_INVAL;
  2558. }
  2559. src_list = param_buf->blacklist_with_timeout;
  2560. if (len < (sizeof(*resp_event) + (num_entries * sizeof(*src_list)))) {
  2561. wmi_err("Invalid length:%d", len);
  2562. return QDF_STATUS_E_INVAL;
  2563. }
  2564. dst_list = qdf_mem_malloc(sizeof(struct roam_denylist_event) +
  2565. (sizeof(struct roam_denylist_timeout) *
  2566. num_entries));
  2567. if (!dst_list)
  2568. return QDF_STATUS_E_NOMEM;
  2569. dst_list->vdev_id = resp_event->vdev_id;
  2570. roam_denylist = &dst_list->roam_denylist[0];
  2571. for (i = 0; i < num_entries; i++) {
  2572. WMI_MAC_ADDR_TO_CHAR_ARRAY(&src_list->bssid,
  2573. roam_denylist->bssid.bytes);
  2574. roam_denylist->timeout = src_list->timeout;
  2575. roam_denylist->received_time = src_list->timestamp;
  2576. roam_denylist->original_timeout = src_list->original_timeout;
  2577. roam_denylist->reject_reason =
  2578. wmi_get_reject_reason(src_list->reason);
  2579. roam_denylist->source = src_list->source;
  2580. roam_denylist++;
  2581. src_list++;
  2582. }
  2583. dst_list->num_entries = num_entries;
  2584. *list = dst_list;
  2585. return QDF_STATUS_SUCCESS;
  2586. }
  2587. static QDF_STATUS
  2588. extract_vdev_disconnect_event_tlv(wmi_unified_t wmi_handle,
  2589. uint8_t *event, uint32_t data_len,
  2590. struct vdev_disconnect_event_data *data)
  2591. {
  2592. WMI_VDEV_DISCONNECT_EVENTID_param_tlvs *param_buf;
  2593. wmi_vdev_disconnect_event_fixed_param *roam_vdev_disc_ev;
  2594. param_buf = (WMI_VDEV_DISCONNECT_EVENTID_param_tlvs *)event;
  2595. roam_vdev_disc_ev = param_buf->fixed_param;
  2596. if (!roam_vdev_disc_ev) {
  2597. wmi_err("roam cap event is NULL");
  2598. return QDF_STATUS_E_INVAL;
  2599. }
  2600. if (roam_vdev_disc_ev->vdev_id >= WLAN_MAX_VDEVS) {
  2601. wmi_err("Invalid vdev id %d", roam_vdev_disc_ev->vdev_id);
  2602. return QDF_STATUS_E_INVAL;
  2603. }
  2604. data->vdev_id = roam_vdev_disc_ev->vdev_id;
  2605. data->reason = roam_vdev_disc_ev->reason;
  2606. wmi_debug("Received disconnect roam event on vdev_id : %d, reason:%d",
  2607. data->vdev_id, data->reason);
  2608. return QDF_STATUS_SUCCESS;
  2609. }
  2610. static QDF_STATUS
  2611. extract_roam_scan_chan_list_tlv(wmi_unified_t wmi_handle,
  2612. uint8_t *event, uint32_t data_len,
  2613. struct cm_roam_scan_ch_resp **list)
  2614. {
  2615. WMI_ROAM_SCAN_CHANNEL_LIST_EVENTID_param_tlvs *param_buf;
  2616. wmi_roam_scan_channel_list_event_fixed_param *fixed_param;
  2617. struct cm_roam_scan_ch_resp *data;
  2618. uint8_t i = 0, num_ch = 0;
  2619. param_buf = (WMI_ROAM_SCAN_CHANNEL_LIST_EVENTID_param_tlvs *)event;
  2620. if (!param_buf) {
  2621. wmi_err_rl("NULL event received from target");
  2622. return -EINVAL;
  2623. }
  2624. fixed_param = param_buf->fixed_param;
  2625. if (!fixed_param) {
  2626. wmi_err_rl(" NULL fixed param");
  2627. return -EINVAL;
  2628. }
  2629. if (fixed_param->vdev_id >= WLAN_MAX_VDEVS) {
  2630. wmi_err_rl("Invalid vdev_id %d", fixed_param->vdev_id);
  2631. return -EINVAL;
  2632. }
  2633. num_ch = (param_buf->num_channel_list < CM_CFG_VALID_CHANNEL_LIST_LEN) ?
  2634. param_buf->num_channel_list : CM_CFG_VALID_CHANNEL_LIST_LEN;
  2635. data = qdf_mem_malloc(sizeof(struct cm_roam_scan_ch_resp) +
  2636. num_ch * sizeof(param_buf->channel_list[0]));
  2637. if (!data)
  2638. return -EINVAL;
  2639. data->chan_list = (uint32_t *)(data + 1);
  2640. data->vdev_id = fixed_param->vdev_id;
  2641. data->command_resp = fixed_param->command_response;
  2642. data->num_channels = param_buf->num_channel_list;
  2643. for (i = 0; i < num_ch; i++)
  2644. data->chan_list[i] = param_buf->channel_list[i];
  2645. *list = data;
  2646. return QDF_STATUS_SUCCESS;
  2647. }
  2648. static QDF_STATUS
  2649. extract_roam_stats_with_single_tlv(wmi_unified_t wmi_handle, uint8_t *evt_buf,
  2650. struct roam_stats_event *stats_info)
  2651. {
  2652. QDF_STATUS status;
  2653. uint8_t vdev_id = stats_info->vdev_id;
  2654. uint8_t band;
  2655. status = wmi_unified_extract_roam_scan_stats(
  2656. wmi_handle, evt_buf, &stats_info->scan[0], 0, 0, 0);
  2657. if (QDF_IS_STATUS_ERROR(status))
  2658. wmi_debug("Roam scan stats extract failed vdev %d", vdev_id);
  2659. band = stats_info->scan[0].band;
  2660. status = wmi_unified_extract_roam_11kv_stats(
  2661. wmi_handle, evt_buf, &stats_info->data_11kv[0], 0, 0,
  2662. band);
  2663. if (QDF_IS_STATUS_ERROR(status))
  2664. wmi_debug("Roam 11kv stats extract failed vdev %d", vdev_id);
  2665. status = wmi_unified_extract_roam_trigger_stats(
  2666. wmi_handle, evt_buf, &stats_info->trigger[0], 0, 0);
  2667. if (QDF_IS_STATUS_ERROR(status))
  2668. wmi_debug("Extract roamtrigger stats failed vdev %d",
  2669. vdev_id);
  2670. status = wmi_unified_extract_roam_btm_response(
  2671. wmi_handle, evt_buf, &stats_info->btm_rsp[0], 0);
  2672. if (QDF_IS_STATUS_ERROR(status))
  2673. wmi_debug("Roam btm rsp stats extract fail vdev %d",
  2674. vdev_id);
  2675. return QDF_STATUS_SUCCESS;
  2676. }
  2677. /**
  2678. * extract_roam_stats_event_tlv() - Extract the roam stats event
  2679. * from the wmi_roam_stats_event_id
  2680. * @wmi_handle: wmi handle
  2681. * @evt_buf: Pointer to the event buffer
  2682. * @len: Data length
  2683. * @data: Double pointer to roam stats data
  2684. */
  2685. static QDF_STATUS
  2686. extract_roam_stats_event_tlv(wmi_unified_t wmi_handle, uint8_t *evt_buf,
  2687. uint32_t len,
  2688. struct roam_stats_event **data)
  2689. {
  2690. WMI_ROAM_STATS_EVENTID_param_tlvs *param_buf;
  2691. wmi_roam_stats_event_fixed_param *fixed_param;
  2692. struct roam_stats_event *stats_info;
  2693. struct roam_msg_info *roam_msg_info = NULL;
  2694. uint8_t vdev_id, i, num_btm = 0, num_frames = 0;
  2695. uint8_t num_tlv = 0, num_chan = 0, num_ap = 0, num_rpt = 0;
  2696. uint8_t num_trigger_reason = 0, band;
  2697. uint32_t rem_len;
  2698. QDF_STATUS status;
  2699. param_buf = (WMI_ROAM_STATS_EVENTID_param_tlvs *)evt_buf;
  2700. if (!param_buf) {
  2701. wmi_err_rl("NULL event received from target");
  2702. return QDF_STATUS_E_INVAL;
  2703. }
  2704. fixed_param = param_buf->fixed_param;
  2705. if (!fixed_param) {
  2706. wmi_err_rl(" NULL fixed param");
  2707. return QDF_STATUS_E_INVAL;
  2708. }
  2709. vdev_id = fixed_param->vdev_id;
  2710. if (vdev_id >= WLAN_MAX_VDEVS) {
  2711. wmi_err_rl("Invalid vdev_id %d", vdev_id);
  2712. return QDF_STATUS_E_INVAL;
  2713. }
  2714. num_tlv = fixed_param->roam_scan_trigger_count;
  2715. if (num_tlv > MAX_ROAM_SCAN_STATS_TLV) {
  2716. wmi_err_rl("Limiting roam triggers to 5");
  2717. num_tlv = MAX_ROAM_SCAN_STATS_TLV;
  2718. }
  2719. if (param_buf->roam_trigger_reason)
  2720. num_trigger_reason = num_tlv;
  2721. else
  2722. num_trigger_reason = 0;
  2723. rem_len = len - sizeof(*fixed_param);
  2724. if (rem_len < num_trigger_reason * sizeof(wmi_roam_trigger_reason)) {
  2725. wmi_err_rl("Invalid roam trigger data");
  2726. return QDF_STATUS_E_INVAL;
  2727. }
  2728. rem_len -= num_trigger_reason * sizeof(wmi_roam_trigger_reason);
  2729. if (rem_len < num_tlv * sizeof(wmi_roam_scan_info)) {
  2730. wmi_err_rl("Invalid roam scan data");
  2731. return QDF_STATUS_E_INVAL;
  2732. }
  2733. rem_len -= num_tlv * sizeof(wmi_roam_scan_info);
  2734. if (rem_len < num_tlv * sizeof(wmi_roam_result)) {
  2735. wmi_err_rl("Invalid roam result data");
  2736. return QDF_STATUS_E_INVAL;
  2737. }
  2738. rem_len -= num_tlv * sizeof(wmi_roam_result);
  2739. if (rem_len < (num_tlv * sizeof(wmi_roam_neighbor_report_info))) {
  2740. wmi_err_rl("Invalid roam neighbor report data");
  2741. return QDF_STATUS_E_INVAL;
  2742. }
  2743. rem_len -= num_tlv * sizeof(wmi_roam_neighbor_report_info);
  2744. if (rem_len < (param_buf->num_roam_scan_chan_info *
  2745. sizeof(wmi_roam_scan_channel_info))) {
  2746. wmi_err_rl("Invalid roam chan data num_tlv:%d",
  2747. param_buf->num_roam_scan_chan_info);
  2748. return QDF_STATUS_E_INVAL;
  2749. }
  2750. rem_len -= param_buf->num_roam_scan_chan_info *
  2751. sizeof(wmi_roam_scan_channel_info);
  2752. if (rem_len < (param_buf->num_roam_ap_info *
  2753. sizeof(wmi_roam_ap_info))) {
  2754. wmi_err_rl("Invalid roam ap data num_tlv:%d",
  2755. param_buf->num_roam_ap_info);
  2756. return QDF_STATUS_E_INVAL;
  2757. }
  2758. rem_len -= param_buf->num_roam_ap_info * sizeof(wmi_roam_ap_info);
  2759. if (rem_len < (param_buf->num_roam_neighbor_report_chan_info *
  2760. sizeof(wmi_roam_neighbor_report_channel_info))) {
  2761. wmi_err_rl("Invalid roam neigb rpt chan data num_tlv:%d",
  2762. param_buf->num_roam_neighbor_report_chan_info);
  2763. return QDF_STATUS_E_INVAL;
  2764. }
  2765. rem_len -= param_buf->num_roam_neighbor_report_chan_info *
  2766. sizeof(wmi_roam_neighbor_report_channel_info);
  2767. if (rem_len < param_buf->num_roam_btm_response_info *
  2768. sizeof(wmi_roam_btm_response_info)) {
  2769. wmi_err_rl("Invalid btm rsp data");
  2770. return QDF_STATUS_E_INVAL;
  2771. }
  2772. rem_len -= param_buf->num_roam_btm_response_info *
  2773. sizeof(wmi_roam_btm_response_info);
  2774. if (rem_len < param_buf->num_roam_initial_info *
  2775. sizeof(wmi_roam_initial_info)) {
  2776. wmi_err_rl("Invalid Initial roam info");
  2777. return QDF_STATUS_E_INVAL;
  2778. }
  2779. rem_len -= param_buf->num_roam_initial_info *
  2780. sizeof(wmi_roam_initial_info);
  2781. if (rem_len < param_buf->num_roam_msg_info *
  2782. sizeof(wmi_roam_msg_info)) {
  2783. wmi_err_rl("Invalid roam msg info");
  2784. return QDF_STATUS_E_INVAL;
  2785. }
  2786. rem_len -= param_buf->num_roam_msg_info * sizeof(wmi_roam_msg_info);
  2787. if (rem_len <
  2788. param_buf->num_roam_frame_info * sizeof(wmi_roam_frame_info)) {
  2789. wmi_err_rl("Invalid roam frame info");
  2790. return QDF_STATUS_E_INVAL;
  2791. }
  2792. stats_info = qdf_mem_malloc(sizeof(struct roam_stats_event));
  2793. if (!stats_info) {
  2794. status = QDF_STATUS_E_NOMEM;
  2795. goto err;
  2796. }
  2797. *data = stats_info;
  2798. qdf_mem_set(stats_info, sizeof(struct roam_stats_event), 0);
  2799. stats_info->vdev_id = vdev_id;
  2800. stats_info->num_roam_msg_info = param_buf->num_roam_msg_info;
  2801. stats_info->num_tlv = num_tlv;
  2802. if (!num_tlv)
  2803. extract_roam_stats_with_single_tlv(wmi_handle, evt_buf,
  2804. stats_info);
  2805. for (i = 0; i < num_tlv; i++) {
  2806. /*
  2807. * Roam Trigger id and that specific roam trigger related
  2808. * details.
  2809. */
  2810. status = wmi_unified_extract_roam_trigger_stats(wmi_handle,
  2811. evt_buf,
  2812. &stats_info->trigger[i], i,
  2813. num_btm);
  2814. if (QDF_IS_STATUS_ERROR(status)) {
  2815. wmi_debug_rl("Extract roam trigger stats failed vdev %d at %d iteration",
  2816. vdev_id, i);
  2817. status = QDF_STATUS_E_INVAL;
  2818. goto err;
  2819. }
  2820. if (stats_info->trigger[i].trigger_reason ==
  2821. WMI_ROAM_TRIGGER_REASON_BTM)
  2822. num_btm += stats_info->trigger[i].btm_trig_data.candidate_list_count;
  2823. /* Roam scan related details - Scan channel, scan type .. */
  2824. status = wmi_unified_extract_roam_scan_stats(wmi_handle,
  2825. evt_buf,
  2826. &stats_info->scan[i], i,
  2827. num_chan, num_ap);
  2828. if (QDF_IS_STATUS_ERROR(status)) {
  2829. wmi_debug_rl("Roam scan stats extract failed vdev %d at %d iteration",
  2830. vdev_id, i);
  2831. status = QDF_STATUS_E_INVAL;
  2832. goto err;
  2833. }
  2834. num_chan += stats_info->scan[i].num_chan;
  2835. num_ap += stats_info->scan[i].num_ap;
  2836. num_frames = stats_info->scan[i].frame_info_count;
  2837. /* Roam result - Success/Failure status, failure reason */
  2838. status = wmi_unified_extract_roam_result_stats(wmi_handle,
  2839. evt_buf,
  2840. &stats_info->result[i], i);
  2841. if (QDF_IS_STATUS_ERROR(status)) {
  2842. wmi_debug_rl("Roam result stats extract failed vdev %d at %d iteration",
  2843. vdev_id, i);
  2844. status = QDF_STATUS_E_INVAL;
  2845. goto err;
  2846. }
  2847. if (num_frames) {
  2848. status = wmi_unified_extract_roam_extract_frame_info(
  2849. wmi_handle, evt_buf,
  2850. &stats_info->frame_stats[i], i,
  2851. num_frames);
  2852. if (QDF_IS_STATUS_ERROR(status)) {
  2853. wmi_debug_rl("Roam frame stats extract failed vdev %d at %d iteration",
  2854. vdev_id, i);
  2855. status = QDF_STATUS_E_INVAL;
  2856. goto err;
  2857. }
  2858. }
  2859. band = stats_info->scan[i].band;
  2860. /* BTM req/resp or Neighbor report/response info */
  2861. status = wmi_unified_extract_roam_11kv_stats(
  2862. wmi_handle,
  2863. evt_buf,
  2864. &stats_info->data_11kv[i],
  2865. i, num_rpt, band);
  2866. if (QDF_IS_STATUS_ERROR(status))
  2867. wmi_debug_rl("Roam 11kv stats extract fail vdev %d iter %d",
  2868. vdev_id, i);
  2869. if (stats_info->data_11kv[i].present)
  2870. num_rpt += stats_info->data_11kv[i].num_freq;
  2871. /* BTM resp info */
  2872. status = wmi_unified_extract_roam_btm_response(wmi_handle,
  2873. evt_buf,
  2874. &stats_info->btm_rsp[i],
  2875. i);
  2876. if (QDF_IS_STATUS_ERROR(status)) {
  2877. wmi_debug_rl("Roam btm rsp stats extract fail vdev %d at %d iteration",
  2878. vdev_id, i);
  2879. status = QDF_STATUS_E_INVAL;
  2880. goto err;
  2881. }
  2882. /* Initial Roam info */
  2883. status = wmi_unified_extract_roam_initial_info(wmi_handle,
  2884. evt_buf,
  2885. &stats_info->roam_init_info[i], i);
  2886. if (QDF_IS_STATUS_ERROR(status)) {
  2887. wmi_debug_rl("Initial roam stats extract fail vdev %d at %d iteration",
  2888. vdev_id, i);
  2889. status = QDF_STATUS_E_INVAL;
  2890. goto err;
  2891. }
  2892. }
  2893. if (param_buf->roam_msg_info && param_buf->num_roam_msg_info) {
  2894. roam_msg_info = qdf_mem_malloc(param_buf->num_roam_msg_info *
  2895. sizeof(*roam_msg_info));
  2896. if (!roam_msg_info) {
  2897. status = QDF_STATUS_E_NOMEM;
  2898. goto err;
  2899. }
  2900. stats_info->roam_msg_info = roam_msg_info;
  2901. for (i = 0; i < param_buf->num_roam_msg_info; i++) {
  2902. status = wmi_unified_extract_roam_msg_info(wmi_handle,
  2903. evt_buf,
  2904. &roam_msg_info[i], i);
  2905. if (QDF_IS_STATUS_ERROR(status)) {
  2906. wmi_err("roam msg stats extract fail vdev %d",
  2907. vdev_id);
  2908. status = QDF_STATUS_E_INVAL;
  2909. goto err;
  2910. }
  2911. }
  2912. }
  2913. return QDF_STATUS_SUCCESS;
  2914. err:
  2915. if (stats_info) {
  2916. if (roam_msg_info)
  2917. qdf_mem_free(roam_msg_info);
  2918. qdf_mem_free(stats_info);
  2919. }
  2920. return status;
  2921. }
  2922. static QDF_STATUS
  2923. extract_auth_offload_event_tlv(wmi_unified_t wmi_handle,
  2924. uint8_t *event, uint32_t len,
  2925. struct auth_offload_event *auth_event)
  2926. {
  2927. wmi_roam_preauth_start_event_fixed_param *rso_auth_start_ev;
  2928. WMI_ROAM_PREAUTH_START_EVENTID_param_tlvs *param_buf;
  2929. param_buf = (WMI_ROAM_PREAUTH_START_EVENTID_param_tlvs *) event;
  2930. rso_auth_start_ev = param_buf->fixed_param;
  2931. if (!rso_auth_start_ev) {
  2932. wmi_debug("received null event data from target");
  2933. return QDF_STATUS_E_INVAL;
  2934. }
  2935. if (rso_auth_start_ev->vdev_id > WLAN_MAX_VDEVS) {
  2936. wmi_debug("received invalid vdev_id %d",
  2937. rso_auth_start_ev->vdev_id);
  2938. return QDF_STATUS_E_INVAL;
  2939. }
  2940. auth_event->vdev_id = rso_auth_start_ev->vdev_id;
  2941. auth_event->akm = rso_auth_start_ev->akm_suite_type;
  2942. WMI_MAC_ADDR_TO_CHAR_ARRAY(&rso_auth_start_ev->candidate_ap_bssid,
  2943. auth_event->ap_bssid.bytes);
  2944. WMI_MAC_ADDR_TO_CHAR_ARRAY(&rso_auth_start_ev->transmit_addr,
  2945. auth_event->ta.bytes);
  2946. if (qdf_is_macaddr_zero(&auth_event->ap_bssid) ||
  2947. qdf_is_macaddr_broadcast(&auth_event->ap_bssid) ||
  2948. qdf_is_macaddr_group(&auth_event->ap_bssid)) {
  2949. wmi_debug("Invalid bssid");
  2950. return -EINVAL;
  2951. }
  2952. wmi_debug("Received Roam auth offload event for bss:"
  2953. QDF_MAC_ADDR_FMT " ta:" QDF_MAC_ADDR_FMT " vdev_id: %d akm: %d",
  2954. QDF_MAC_ADDR_REF(auth_event->ap_bssid.bytes),
  2955. QDF_MAC_ADDR_REF(auth_event->ta.bytes),
  2956. auth_event->vdev_id, auth_event->akm);
  2957. return QDF_STATUS_SUCCESS;
  2958. }
  2959. /**
  2960. * extract_roam_pmkid_request_tlv() - Extract the roam pmkid request event
  2961. * @wmi_handle: wmi handle
  2962. * @evt_buf: Pointer to the event buffer
  2963. * @len: Data length
  2964. * @list: Extract the data and fill in list
  2965. */
  2966. static QDF_STATUS
  2967. extract_roam_pmkid_request_tlv(wmi_unified_t wmi_handle, uint8_t *evt_buf,
  2968. uint32_t len,
  2969. struct roam_pmkid_req_event **list)
  2970. {
  2971. WMI_ROAM_PMKID_REQUEST_EVENTID_param_tlvs *param_buf;
  2972. wmi_roam_pmkid_request_event_fixed_param *roam_pmkid_req_ev;
  2973. wmi_roam_pmkid_request_tlv_param *src_list;
  2974. struct qdf_mac_addr *roam_bsslist;
  2975. uint32_t num_entries, i;
  2976. struct roam_pmkid_req_event *dst_list;
  2977. if (!evt_buf || !len) {
  2978. wmi_err("received null event from target");
  2979. return QDF_STATUS_E_INVAL;
  2980. }
  2981. param_buf = (WMI_ROAM_PMKID_REQUEST_EVENTID_param_tlvs *)evt_buf;
  2982. if (!param_buf) {
  2983. wmi_err("received null buf from target");
  2984. return QDF_STATUS_E_INVAL;
  2985. }
  2986. roam_pmkid_req_ev = param_buf->fixed_param;
  2987. if (!roam_pmkid_req_ev) {
  2988. wmi_err("received null event data from target");
  2989. return QDF_STATUS_E_INVAL;
  2990. }
  2991. if (roam_pmkid_req_ev->vdev_id >= WLAN_MAX_VDEVS) {
  2992. wmi_err_rl("Invalid vdev_id %d", roam_pmkid_req_ev->vdev_id);
  2993. return QDF_STATUS_E_INVAL;
  2994. }
  2995. num_entries = param_buf->num_pmkid_request;
  2996. if (num_entries > MAX_RSSI_AVOID_BSSID_LIST) {
  2997. wmi_err("num bssid entries:%d exceeds maximum value",
  2998. num_entries);
  2999. return QDF_STATUS_E_INVAL;
  3000. }
  3001. src_list = param_buf->pmkid_request;
  3002. if (len < (sizeof(*roam_pmkid_req_ev) +
  3003. (num_entries * sizeof(*src_list)))) {
  3004. wmi_err("Invalid length: %d", len);
  3005. return QDF_STATUS_E_INVAL;
  3006. }
  3007. dst_list = qdf_mem_malloc(sizeof(struct roam_pmkid_req_event) +
  3008. (sizeof(struct qdf_mac_addr) * num_entries));
  3009. if (!dst_list)
  3010. return QDF_STATUS_E_NOMEM;
  3011. dst_list->vdev_id = roam_pmkid_req_ev->vdev_id;
  3012. for (i = 0; i < num_entries; i++) {
  3013. roam_bsslist = &dst_list->ap_bssid[i];
  3014. WMI_MAC_ADDR_TO_CHAR_ARRAY(&src_list->bssid,
  3015. roam_bsslist->bytes);
  3016. if (qdf_is_macaddr_zero(roam_bsslist) ||
  3017. qdf_is_macaddr_broadcast(roam_bsslist) ||
  3018. qdf_is_macaddr_group(roam_bsslist)) {
  3019. wmi_err("Invalid bssid");
  3020. qdf_mem_free(dst_list);
  3021. return QDF_STATUS_E_INVAL;
  3022. }
  3023. wmi_debug("Received pmkid fallback for bssid: " QDF_MAC_ADDR_FMT" vdev_id:%d",
  3024. QDF_MAC_ADDR_REF(roam_bsslist->bytes),
  3025. roam_pmkid_req_ev->vdev_id);
  3026. src_list++;
  3027. }
  3028. dst_list->num_entries = num_entries;
  3029. *list = dst_list;
  3030. return QDF_STATUS_SUCCESS;
  3031. }
  3032. static QDF_STATUS
  3033. extract_roam_candidate_frame_tlv(wmi_unified_t wmi_handle, uint8_t *event,
  3034. uint32_t len,
  3035. struct roam_scan_candidate_frame *data)
  3036. {
  3037. WMI_ROAM_FRAME_EVENTID_param_tlvs *param_buf = NULL;
  3038. wmi_roam_frame_event_fixed_param *frame_params = NULL;
  3039. if (!event || !len) {
  3040. wmi_debug("Empty roam candidate frame event");
  3041. return QDF_STATUS_E_FAILURE;
  3042. }
  3043. param_buf = (WMI_ROAM_FRAME_EVENTID_param_tlvs *)event;
  3044. if (!param_buf) {
  3045. wmi_err("received null buf from target");
  3046. return -EINVAL;
  3047. }
  3048. frame_params =
  3049. (wmi_roam_frame_event_fixed_param *)param_buf->fixed_param;
  3050. if (frame_params->vdev_id >= WLAN_MAX_VDEVS) {
  3051. wmi_debug("Invalid VDEV id %d", frame_params->vdev_id);
  3052. return QDF_STATUS_E_FAILURE;
  3053. }
  3054. if (frame_params->frame_length > param_buf->num_frame) {
  3055. wmi_debug("Invalid frame length %d expected : %d",
  3056. frame_params->frame_length,
  3057. param_buf->num_frame);
  3058. return QDF_STATUS_E_FAILURE;
  3059. }
  3060. if (!param_buf->frame) {
  3061. wmi_debug("Frame pointer is Null");
  3062. return QDF_STATUS_E_FAILURE;
  3063. }
  3064. data->vdev_id = frame_params->vdev_id;
  3065. data->frame_length = frame_params->frame_length;
  3066. data->frame = (uint8_t *)param_buf->frame;
  3067. data->roam_offload_candidate_frm = true;
  3068. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
  3069. data->frame, data->frame_length);
  3070. return QDF_STATUS_SUCCESS;
  3071. }
  3072. #ifdef WLAN_FEATURE_ROAM_OFFLOAD
  3073. static QDF_STATUS
  3074. extract_peer_oper_mode_event_tlv(wmi_unified_t wmi_handle, uint8_t *event,
  3075. uint32_t len,
  3076. struct peer_oper_mode_event *data)
  3077. {
  3078. WMI_PEER_OPER_MODE_CHANGE_EVENTID_param_tlvs *param_buf = NULL;
  3079. wmi_peer_oper_mode_change_event_fixed_param *params = NULL;
  3080. if (!event || !len) {
  3081. wmi_debug("Empty operating mode change event");
  3082. return QDF_STATUS_E_FAILURE;
  3083. }
  3084. param_buf = (WMI_PEER_OPER_MODE_CHANGE_EVENTID_param_tlvs *)event;
  3085. if (!param_buf) {
  3086. wmi_err("Received null buf from target");
  3087. return -EINVAL;
  3088. }
  3089. params =
  3090. (wmi_peer_oper_mode_change_event_fixed_param *)param_buf->fixed_param;
  3091. WMI_MAC_ADDR_TO_CHAR_ARRAY(&params->peer_mac_address,
  3092. data->peer_mac_address.bytes);
  3093. data->ind_type = params->ind_type;
  3094. data->new_rxnss = params->new_rxnss;
  3095. data->new_bw = params->new_bw;
  3096. data->new_txnss = params->new_txnss;
  3097. data->new_disablemu = params->new_disablemu;
  3098. wmi_debug("peer_mac_addr: " QDF_MAC_ADDR_FMT " ind_type: %d new_rxnss: %d new_bw: %d new_txnss: %d new_disablemu: %d",
  3099. QDF_MAC_ADDR_REF(data->peer_mac_address.bytes),
  3100. data->ind_type,
  3101. data->new_rxnss,
  3102. data->new_bw,
  3103. data->new_txnss,
  3104. data->new_disablemu);
  3105. return QDF_STATUS_SUCCESS;
  3106. }
  3107. #endif
  3108. #ifdef WLAN_VENDOR_HANDOFF_CONTROL
  3109. /**
  3110. * convert_roam_vendor_control_param() - Function to convert
  3111. * vendor_control_roam_param enum to TLV specific
  3112. * WMI_ROAM_GET_VENDOR_CONTROL_PARAM_ID
  3113. * @param_id: Roam vendor control param id
  3114. *
  3115. * Return: wmi roam vendor control param id
  3116. */
  3117. static WMI_ROAM_GET_VENDOR_CONTROL_PARAM_ID
  3118. convert_roam_vendor_control_param(enum vendor_control_roam_param param_id)
  3119. {
  3120. switch (param_id) {
  3121. case VENDOR_CONTROL_PARAM_ROAM_TRIGGER:
  3122. return ROAM_VENDOR_CONTROL_PARAM_TRIGGER;
  3123. case VENDOR_CONTROL_PARAM_ROAM_DELTA:
  3124. return ROAM_VENDOR_CONTROL_PARAM_DELTA;
  3125. case VENDOR_CONTROL_PARAM_ROAM_FULL_SCANPERIOD:
  3126. return ROAM_VENDOR_CONTROL_PARAM_FULL_SCANPERIOD;
  3127. case VENDOR_CONTROL_PARAM_ROAM_PARTIAL_SCANPERIOD:
  3128. return ROAM_VENDOR_CONTROL_PARAM_PARTIAL_SCANPERIOD;
  3129. case VENDOR_CONTROL_PARAM_ROAM_ACTIVE_CH_DWELLTIME:
  3130. return ROAM_VENDOR_CONTROL_PARAM_ACTIVE_CH_DWELLTIME;
  3131. case VENDOR_CONTROL_PARAM_ROAM_PASSIVE_CH_DWELLTIME:
  3132. return ROAM_VENDOR_CONTROL_PARAM_PASSIVE_CH_DWELLTIME;
  3133. case VENDOR_CONTROL_PARAM_ROAM_HOME_CH_TIME:
  3134. return ROAM_VENDOR_CONTROL_PARAM_HOME_CH_TIME;
  3135. case VENDOR_CONTROL_PARAM_ROAM_AWAY_TIME:
  3136. return ROAM_VENDOR_CONTROL_PARAM_AWAY_TIME;
  3137. case VENDOR_CONTROL_PARAM_ROAM_ALL:
  3138. return ROAM_VENDOR_CONTROL_PARAM_ALL;
  3139. default:
  3140. wmi_debug("Invalid param id");
  3141. return 0;
  3142. }
  3143. }
  3144. /**
  3145. * convert_wmi_roam_vendor_control_param() - Function to convert TLV specific
  3146. * WMI_ROAM_GET_VENDOR_CONTROL_PARAM_ID to vendor_control_roam_param
  3147. * @param_id: wmi vendor control param id
  3148. *
  3149. * Return: roam vendor control param id
  3150. */
  3151. static enum vendor_control_roam_param convert_wmi_roam_vendor_control_param(
  3152. WMI_ROAM_GET_VENDOR_CONTROL_PARAM_ID param_id)
  3153. {
  3154. switch (param_id) {
  3155. case ROAM_VENDOR_CONTROL_PARAM_TRIGGER:
  3156. return VENDOR_CONTROL_PARAM_ROAM_TRIGGER;
  3157. case ROAM_VENDOR_CONTROL_PARAM_DELTA:
  3158. return VENDOR_CONTROL_PARAM_ROAM_DELTA;
  3159. case ROAM_VENDOR_CONTROL_PARAM_FULL_SCANPERIOD:
  3160. return VENDOR_CONTROL_PARAM_ROAM_FULL_SCANPERIOD;
  3161. case ROAM_VENDOR_CONTROL_PARAM_PARTIAL_SCANPERIOD:
  3162. return VENDOR_CONTROL_PARAM_ROAM_PARTIAL_SCANPERIOD;
  3163. case ROAM_VENDOR_CONTROL_PARAM_ACTIVE_CH_DWELLTIME:
  3164. return VENDOR_CONTROL_PARAM_ROAM_ACTIVE_CH_DWELLTIME;
  3165. case ROAM_VENDOR_CONTROL_PARAM_PASSIVE_CH_DWELLTIME:
  3166. return VENDOR_CONTROL_PARAM_ROAM_PASSIVE_CH_DWELLTIME;
  3167. case ROAM_VENDOR_CONTROL_PARAM_HOME_CH_TIME:
  3168. return VENDOR_CONTROL_PARAM_ROAM_HOME_CH_TIME;
  3169. case ROAM_VENDOR_CONTROL_PARAM_AWAY_TIME:
  3170. return VENDOR_CONTROL_PARAM_ROAM_AWAY_TIME;
  3171. case ROAM_VENDOR_CONTROL_PARAM_ALL:
  3172. return VENDOR_CONTROL_PARAM_ROAM_ALL;
  3173. default:
  3174. wmi_debug("Invalid param id");
  3175. return 0;
  3176. }
  3177. }
  3178. static QDF_STATUS
  3179. extract_roam_vendor_control_param_event_tlv(wmi_unified_t wmi_handle,
  3180. uint8_t *event, uint32_t len,
  3181. struct roam_vendor_handoff_params **list)
  3182. {
  3183. WMI_ROAM_GET_VENDOR_CONTROL_PARAM_EVENTID_param_tlvs *param_buf = NULL;
  3184. wmi_roam_get_vendor_control_param_event_fixed_param *fixed_param = NULL;
  3185. uint32_t num_entries, i;
  3186. wmi_vendor_control_param *src_list;
  3187. struct roam_vendor_handoff_params *dst_list;
  3188. struct roam_param_info *param_info;
  3189. if (!event || !len) {
  3190. wmi_debug("Empty roam vendor control param event");
  3191. return QDF_STATUS_E_FAILURE;
  3192. }
  3193. param_buf =
  3194. (WMI_ROAM_GET_VENDOR_CONTROL_PARAM_EVENTID_param_tlvs *)event;
  3195. if (!param_buf) {
  3196. wmi_err("received null buf from target");
  3197. return QDF_STATUS_E_INVAL;
  3198. }
  3199. fixed_param = (wmi_roam_get_vendor_control_param_event_fixed_param *)
  3200. param_buf->fixed_param;
  3201. if (!fixed_param) {
  3202. wmi_err("received null event data from target");
  3203. return QDF_STATUS_E_INVAL;
  3204. }
  3205. if (fixed_param->vdev_id >= WLAN_MAX_VDEVS) {
  3206. wmi_debug("Invalid VDEV id %d", fixed_param->vdev_id);
  3207. return QDF_STATUS_E_FAILURE;
  3208. }
  3209. num_entries = param_buf->num_vendor_control_param;
  3210. src_list = param_buf->vendor_control_param;
  3211. if (len < (sizeof(*fixed_param) + (num_entries * sizeof(*src_list)))) {
  3212. wmi_err("Invalid length: %d", len);
  3213. return QDF_STATUS_E_FAILURE;
  3214. }
  3215. dst_list = qdf_mem_malloc(sizeof(struct roam_vendor_handoff_params));
  3216. if (!dst_list)
  3217. return QDF_STATUS_E_FAILURE;
  3218. dst_list->vdev_id = fixed_param->vdev_id;
  3219. wmi_debug("vdev_id:%d, num_tlv:%d", dst_list->vdev_id, num_entries);
  3220. param_info = &dst_list->param_info[0];
  3221. for (i = 0; i < num_entries; i++) {
  3222. param_info->param_id =
  3223. convert_wmi_roam_vendor_control_param(src_list->param_id);
  3224. param_info->param_value = src_list->param_value;
  3225. wmi_debug("param_info->param_id:%d, param_info->param_value:%d",
  3226. param_info->param_id, param_info->param_value);
  3227. param_info++;
  3228. src_list++;
  3229. }
  3230. dst_list->num_entries = num_entries;
  3231. *list = dst_list;
  3232. return QDF_STATUS_SUCCESS;
  3233. }
  3234. /**
  3235. * send_process_roam_vendor_handoff_req_cmd_tlv() - Send vendor handoff command
  3236. * to fw.
  3237. * @wmi_handle: wmi handle
  3238. * @vdev_id: vdev id
  3239. * @param_id: parameter ID to set
  3240. *
  3241. * Return: QDF STATUS
  3242. */
  3243. static QDF_STATUS
  3244. send_process_roam_vendor_handoff_req_cmd_tlv(wmi_unified_t wmi_handle,
  3245. uint8_t vdev_id,
  3246. uint32_t param_id)
  3247. {
  3248. wmi_roam_get_vendor_control_param_cmd_fixed_param *cmd;
  3249. wmi_buf_t wmi_buf;
  3250. uint8_t *buf_ptr;
  3251. uint16_t len;
  3252. len = sizeof(wmi_roam_get_vendor_control_param_cmd_fixed_param);
  3253. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  3254. if (!wmi_buf)
  3255. return QDF_STATUS_E_NOMEM;
  3256. cmd = (wmi_roam_get_vendor_control_param_cmd_fixed_param *)wmi_buf_data(
  3257. wmi_buf);
  3258. buf_ptr = (uint8_t *)cmd;
  3259. WMITLV_SET_HDR(&cmd->tlv_header,
  3260. WMITLV_TAG_STRUC_wmi_roam_get_vendor_control_param_cmd_fixed_param,
  3261. WMITLV_GET_STRUCT_TLVLEN
  3262. (wmi_roam_get_vendor_control_param_cmd_fixed_param));
  3263. cmd->vdev_id = vdev_id;
  3264. cmd->param_id = convert_roam_vendor_control_param(param_id);
  3265. wmi_debug("Send GET_VENDOR_CONTROL_PARAM cmd vdev_id:%d, param_id:0x%x",
  3266. cmd->vdev_id, cmd->param_id);
  3267. wmi_mtrace(WMI_ROAM_GET_VENDOR_CONTROL_PARAM_CMDID, cmd->vdev_id, 0);
  3268. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  3269. WMI_ROAM_GET_VENDOR_CONTROL_PARAM_CMDID)) {
  3270. wmi_err("Failed to send get vendor control param command");
  3271. wmi_buf_free(wmi_buf);
  3272. return QDF_STATUS_E_FAILURE;
  3273. }
  3274. return QDF_STATUS_SUCCESS;
  3275. }
  3276. /**
  3277. * wmi_roam_offload_attach_vendor_handoff_tlv() - register wmi ops for vendor
  3278. * handoff related command and event
  3279. * @ops: wmi ops
  3280. *
  3281. * Return: none
  3282. */
  3283. static inline void
  3284. wmi_roam_offload_attach_vendor_handoff_tlv(struct wmi_ops *ops)
  3285. {
  3286. ops->extract_roam_vendor_control_param_event =
  3287. extract_roam_vendor_control_param_event_tlv;
  3288. ops->send_process_roam_vendor_handoff_req_cmd =
  3289. send_process_roam_vendor_handoff_req_cmd_tlv;
  3290. }
  3291. #else
  3292. static inline void
  3293. wmi_roam_offload_attach_vendor_handoff_tlv(struct wmi_ops *ops)
  3294. {
  3295. }
  3296. #endif
  3297. #if defined(WLAN_FEATURE_ROAM_OFFLOAD) && defined(WLAN_FEATURE_11BE_MLO)
  3298. static inline
  3299. enum wlan_crypto_cipher_type wlan_wmi_cipher_to_crypto(uint8_t cipher)
  3300. {
  3301. switch (cipher) {
  3302. case WMI_CIPHER_NONE:
  3303. return WLAN_CRYPTO_CIPHER_NONE;
  3304. case WMI_CIPHER_WEP:
  3305. return WLAN_CRYPTO_CIPHER_WEP;
  3306. case WMI_CIPHER_WAPI:
  3307. return WLAN_CRYPTO_CIPHER_WAPI_SMS4;
  3308. case WMI_CIPHER_AES_CCM:
  3309. return WLAN_CRYPTO_CIPHER_AES_CCM;
  3310. case WMI_CIPHER_AES_CMAC:
  3311. return WLAN_CRYPTO_CIPHER_AES_CMAC;
  3312. case WMI_CIPHER_AES_GMAC:
  3313. return WLAN_CRYPTO_CIPHER_AES_GMAC;
  3314. case WMI_CIPHER_AES_GCM:
  3315. return WLAN_CRYPTO_CIPHER_AES_GCM;
  3316. default:
  3317. return 0;
  3318. }
  3319. }
  3320. #define MLO_PAIRWISE_LINKID 0xF
  3321. /**
  3322. * wmi_fill_keys_from_tlv - Fill the destination key buffer from the WMI TLV
  3323. * @ml_keys: ML Keys TLV pointer
  3324. * @dst_key: Destination keys
  3325. * @dst_key_len: Destination keys length
  3326. * @count: TLV count
  3327. * @max_num_tlv: Total number of TLVs
  3328. *
  3329. * Return: None
  3330. */
  3331. static void
  3332. wmi_fill_keys_from_tlv(wmi_roam_ml_key_material_param **ml_keys,
  3333. uint8_t *dst_key, uint8_t *dst_key_len, uint8_t *count,
  3334. uint8_t max_num_tlv)
  3335. {
  3336. uint8_t rem_key_len, bytes_filled, key_len, total_key_len;
  3337. uint8_t max_key_len = WLAN_CRYPTO_KEYBUF_SIZE + WLAN_CRYPTO_MICBUF_SIZE;
  3338. *dst_key_len = (*ml_keys)->key_len;
  3339. if (*dst_key_len > max_key_len)
  3340. *dst_key_len = max_key_len;
  3341. total_key_len = *dst_key_len;
  3342. rem_key_len = *dst_key_len;
  3343. while (rem_key_len) {
  3344. if (!(*ml_keys)) {
  3345. wmi_err_rl("ml_keys is NULL. rem_key_len:%d",
  3346. rem_key_len);
  3347. return;
  3348. }
  3349. if (*count >= max_num_tlv) {
  3350. wmi_debug("Read all TLVs count:%d", *count);
  3351. return;
  3352. }
  3353. if (rem_key_len < WMI_MAX_KEY_LEN)
  3354. key_len = rem_key_len;
  3355. else
  3356. key_len = WMI_MAX_KEY_LEN;
  3357. bytes_filled = total_key_len - rem_key_len;
  3358. qdf_mem_copy(dst_key + bytes_filled, (*ml_keys)->key_buff,
  3359. key_len);
  3360. (*ml_keys)++;
  3361. (*count)++;
  3362. rem_key_len -= key_len;
  3363. }
  3364. }
  3365. #define WMI_NUM_KEYS_ALLOCATED (WLAN_MAX_ML_BSS_LINKS * 4)
  3366. static QDF_STATUS
  3367. extract_roam_synch_key_event_tlv(wmi_unified_t wmi_handle,
  3368. uint8_t *event, uint32_t data_len,
  3369. struct wlan_crypto_key_entry **entries,
  3370. uint8_t *num_entries,
  3371. struct qdf_mac_addr *mld_addr)
  3372. {
  3373. WMI_ROAM_SYNCH_KEY_EVENTID_param_tlvs *param_buf = NULL;
  3374. wmi_roam_ml_key_material_param *ml_keys = NULL;
  3375. struct wlan_crypto_key_entry *key_entry;
  3376. struct wlan_crypto_keys *all_keys;
  3377. struct wlan_crypto_key *dst_key, *pairwise;
  3378. struct wlan_crypto_key *key_alloc_buf[WMI_NUM_KEYS_ALLOCATED];
  3379. bool flush_keybuf;
  3380. uint8_t total_num_tlv, j = 0, k = 0;
  3381. uint8_t count = 0, total_links = 0, dst_key_count = 0;
  3382. uint8_t igtk_idx = 0, bigtk_idx = 0;
  3383. bool slot_found;
  3384. QDF_STATUS status = QDF_STATUS_SUCCESS;
  3385. param_buf = (WMI_ROAM_SYNCH_KEY_EVENTID_param_tlvs *)event;
  3386. if (!param_buf) {
  3387. wmi_err_rl("received null buf from target");
  3388. return QDF_STATUS_E_INVAL;
  3389. }
  3390. total_num_tlv = param_buf->num_ml_key_material;
  3391. ml_keys = (wmi_roam_ml_key_material_param *)param_buf->ml_key_material;
  3392. if (!ml_keys) {
  3393. wmi_err_rl("received ml keys param is null");
  3394. return QDF_STATUS_E_INVAL;
  3395. }
  3396. *entries = qdf_mem_malloc(WLAN_MAX_ML_BSS_LINKS * sizeof(*key_entry));
  3397. if (!*entries)
  3398. return QDF_STATUS_E_NOMEM;
  3399. /*
  3400. * Allocate memory for each PTK, GTK, IGTK, BIGTK keys.
  3401. * So total WLAN_MAX_ML_BSS_LINKS * 4 keys are needed
  3402. */
  3403. for (k = 0; k < WMI_NUM_KEYS_ALLOCATED; k++) {
  3404. key_alloc_buf[k] = qdf_mem_malloc(sizeof(*dst_key));
  3405. if (!key_alloc_buf[k]) {
  3406. flush_keybuf = true;
  3407. status = QDF_STATUS_E_NOMEM;
  3408. goto free_entries;
  3409. }
  3410. }
  3411. /*
  3412. * key_entry is the master structure that is given directly to the
  3413. * crypto module and stored for each link.
  3414. * key_entry -> keys ->key filled from dst_key has the PTK & GTK indexed
  3415. * with corresponding key index
  3416. *
  3417. * key_entry -> keys -> iGTK holds the iGTK key
  3418. * key_entry -> keys -> BIGTK holds the BIGTK key
  3419. */
  3420. key_entry = *entries;
  3421. /*
  3422. * Initialize all the Key Entry structures with invalid Link
  3423. * ID to identify empty links allocated and will be freed
  3424. * at the end.
  3425. */
  3426. for (j = 0; j < WLAN_MAX_ML_BSS_LINKS; j++)
  3427. key_entry[j].link_id = MLO_INVALID_LINK_IDX;
  3428. /*
  3429. * TLV Format to parse:
  3430. * 1. wmi_roam_ml_key_material_param -> For PTK with Link ID = 0xF
  3431. * Copy this PTK to all the key entry of all the links.
  3432. *
  3433. * 2. wmi_roam_ml_key_material_param -> GTK for a valid Link.
  3434. * Get available entry, and fill the GTK to that entry
  3435. *
  3436. * 3. wmi_roam_ml_key_material_param -> IGTK for a valid link
  3437. *
  3438. * 4. wmi_roam_ml_key_material_param -> BIGTK for a valid link
  3439. *
  3440. * 5. wmi_roam_ml_key_material_param -> For LTF Keyseed with Link ID =
  3441. * 0xF and flags has LTF_USAGE set.
  3442. *
  3443. * If any of the key length is > WMI_MAX_KEY_LEN, then multiple
  3444. * wmi_roam_ml_key_material_param TLVs follow to get the entire key
  3445. */
  3446. while (ml_keys && count < total_num_tlv &&
  3447. dst_key_count < WMI_NUM_KEYS_ALLOCATED) {
  3448. /*
  3449. * Track individual keys with key_alloc_buf[dst_key_count] array
  3450. * pointer to avoid mem leaks if parsing/validating any of the
  3451. * keys fail.
  3452. * Freeing the allocated keys it done at the end of this
  3453. * function
  3454. */
  3455. dst_key = key_alloc_buf[dst_key_count];
  3456. wmi_debug("link_id:%d key_ix:%d key_cipher:%d key_len:%d key_flags:%d",
  3457. ml_keys->link_id, ml_keys->key_ix,
  3458. ml_keys->key_cipher,
  3459. ml_keys->key_len, ml_keys->key_flags);
  3460. if (!is_valid_keyix(ml_keys->key_ix)) {
  3461. wmi_err_rl("invalid key index:%d", ml_keys->key_ix);
  3462. status = QDF_STATUS_E_INVAL;
  3463. flush_keybuf = true;
  3464. goto free_entries;
  3465. }
  3466. /* Copy pairwise keys to all the entries */
  3467. if (ml_keys->link_id == MLO_PAIRWISE_LINKID) {
  3468. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ml_keys->mac_addr,
  3469. mld_addr->bytes);
  3470. if (!ml_keys->key_len) {
  3471. wmi_err_rl("Received key_len as 0 for tlv:%d",
  3472. count);
  3473. status = QDF_STATUS_E_INVAL;
  3474. flush_keybuf = true;
  3475. goto free_entries;
  3476. }
  3477. if (ml_keys->key_flags & LTF_USAGE) {
  3478. struct wlan_crypto_ltf_keyseed_data key_seed;
  3479. uint8_t key_seed_len;
  3480. if (ml_keys->key_len >
  3481. WLAN_MAX_SECURE_LTF_KEYSEED_LEN)
  3482. ml_keys->key_len =
  3483. WLAN_MAX_SECURE_LTF_KEYSEED_LEN;
  3484. /*
  3485. * Filling the keys from multiple TLVs is
  3486. * handled by below API and ml_keys ptr gets
  3487. * incremented accordingly inside
  3488. */
  3489. wmi_fill_keys_from_tlv(&ml_keys,
  3490. key_seed.key_seed,
  3491. &key_seed_len, &count,
  3492. total_num_tlv);
  3493. key_seed.key_seed_len = key_seed_len;
  3494. wmi_debug("ML_KEY: Got LTF keyseed key for MLD: "
  3495. QDF_MAC_ADDR_FMT " key_seed_len:%d",
  3496. QDF_MAC_ADDR_REF(mld_addr->bytes),
  3497. key_seed.key_seed_len);
  3498. for (j = 0; j < WLAN_MAX_ML_BSS_LINKS; j++)
  3499. key_entry[j].keys.ltf_key_seed =
  3500. key_seed;
  3501. continue;
  3502. }
  3503. dst_key->valid = true;
  3504. dst_key->keylen = ml_keys->key_len;
  3505. dst_key->flags = ml_keys->key_flags;
  3506. dst_key->keyix = ml_keys->key_ix;
  3507. dst_key->key_type =
  3508. WLAN_CRYPTO_KEY_TYPE_UNICAST;
  3509. dst_key->cipher_type =
  3510. wlan_wmi_cipher_to_crypto(ml_keys->key_cipher);
  3511. dst_key->keylen = ml_keys->key_len;
  3512. wmi_fill_keys_from_tlv(&ml_keys, dst_key->keyval,
  3513. &dst_key->keylen, &count,
  3514. total_num_tlv);
  3515. wmi_err_rl("ML_KEY: Got Pairwise key for MLD: "
  3516. QDF_MAC_ADDR_FMT " rem_len:%d",
  3517. QDF_MAC_ADDR_REF(mld_addr->bytes),
  3518. dst_key->keylen);
  3519. pairwise = dst_key;
  3520. /*
  3521. * Pairwise keys will be sent only once. Copy that for
  3522. * all the link entries
  3523. */
  3524. for (j = 0; j < WLAN_MAX_ML_BSS_LINKS; j++) {
  3525. dst_key = key_alloc_buf[dst_key_count];
  3526. *dst_key = *pairwise;
  3527. key_entry[j].keys.key[dst_key->keyix] = dst_key;
  3528. dst_key_count++;
  3529. }
  3530. continue;
  3531. }
  3532. slot_found = false;
  3533. for (j = 0; j < WLAN_MAX_ML_BSS_LINKS; j++) {
  3534. if (ml_keys->link_id == MLO_INVALID_LINK_IDX)
  3535. break;
  3536. if (key_entry[j].link_id == MLO_INVALID_LINK_IDX ||
  3537. key_entry[j].link_id == ml_keys->link_id) {
  3538. slot_found = true;
  3539. break;
  3540. }
  3541. }
  3542. if (!slot_found) {
  3543. wmi_err_rl("Not able to find a entry for link:%d j=%d",
  3544. ml_keys->link_id, j);
  3545. break;
  3546. }
  3547. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ml_keys->mac_addr,
  3548. dst_key->macaddr);
  3549. key_entry[j].link_id = ml_keys->link_id;
  3550. qdf_copy_macaddr((struct qdf_mac_addr *)key_entry[j].mac_addr.raw,
  3551. (struct qdf_mac_addr *)dst_key->macaddr);
  3552. all_keys = &key_entry[j].keys;
  3553. dst_key->valid = true;
  3554. dst_key->keyix = ml_keys->key_ix;
  3555. dst_key->cipher_type =
  3556. wlan_wmi_cipher_to_crypto(ml_keys->key_cipher);
  3557. qdf_mem_copy(dst_key->keyrsc, ml_keys->pn, WMI_MAX_PN_LEN);
  3558. /*
  3559. * For LTF keyseed or FILS SHA 384, FILS SHA 512 cases, the key
  3560. * size will go beyond WMI_MAX_KEY_LEN(32). So extract first 32
  3561. * bytes from 1st TLV and extract the rest of the bytes from
  3562. * the following TLVs
  3563. */
  3564. dst_key->keylen = ml_keys->key_len;
  3565. wmi_fill_keys_from_tlv(&ml_keys, dst_key->keyval,
  3566. &dst_key->keylen, &count, total_num_tlv);
  3567. if (is_igtk(dst_key->keyix)) {
  3568. dst_key->key_type = WLAN_CRYPTO_KEY_TYPE_GROUP;
  3569. igtk_idx = dst_key->keyix - WLAN_CRYPTO_MAXKEYIDX;
  3570. bigtk_idx = igtk_idx - WLAN_CRYPTO_MAXIGTKKEYIDX;
  3571. wmi_debug("ML_KEY: Slot:%d link_id:%d addr: " QDF_MAC_ADDR_FMT "Key is IGTK key_ix:%d igtk_idx:%d bigtk:%d",
  3572. j, key_entry[j].link_id,
  3573. QDF_MAC_ADDR_REF(dst_key->macaddr),
  3574. dst_key->keyix, igtk_idx, bigtk_idx);
  3575. all_keys->igtk_key[igtk_idx] = dst_key;
  3576. all_keys->def_igtk_tx_keyid = igtk_idx;
  3577. bigtk_idx = 0;
  3578. igtk_idx = 0;
  3579. } else if (is_bigtk(dst_key->keyix)) {
  3580. dst_key->key_type = WLAN_CRYPTO_KEY_TYPE_GROUP;
  3581. igtk_idx = dst_key->keyix - WLAN_CRYPTO_MAXKEYIDX;
  3582. bigtk_idx = igtk_idx - WLAN_CRYPTO_MAXIGTKKEYIDX;
  3583. wmi_debug("ML_KEY: Slot:%d link_id:%d addr: " QDF_MAC_ADDR_FMT "Key is BIGTK key_ix:%d igtk_idx:%d bigtk:%d",
  3584. j, key_entry[j].link_id,
  3585. QDF_MAC_ADDR_REF(dst_key->macaddr),
  3586. dst_key->keyix, igtk_idx, bigtk_idx);
  3587. all_keys->bigtk_key[bigtk_idx] = dst_key;
  3588. all_keys->def_bigtk_tx_keyid = bigtk_idx;
  3589. bigtk_idx = 0;
  3590. igtk_idx = 0;
  3591. } else if (is_gtk(dst_key->keyix)) {
  3592. wmi_debug("ML_KEY: Slot:%d link_id:%d addr: " QDF_MAC_ADDR_FMT " Key is GTK key_ix:%d",
  3593. j, key_entry[j].link_id,
  3594. QDF_MAC_ADDR_REF(dst_key->macaddr),
  3595. dst_key->keyix);
  3596. dst_key->key_type = WLAN_CRYPTO_KEY_TYPE_GROUP;
  3597. all_keys->key[dst_key->keyix] = dst_key;
  3598. } else {
  3599. wmi_debug("Key is Pairwise. Shouldn't reach here");
  3600. /* Pairwise key */
  3601. dst_key->key_type = WLAN_CRYPTO_KEY_TYPE_UNICAST;
  3602. all_keys->key[dst_key->keyix] = dst_key;
  3603. }
  3604. dst_key_count++;
  3605. }
  3606. for (j = 0; j < WLAN_MAX_ML_BSS_LINKS; j++) {
  3607. if (key_entry[j].link_id != MLO_INVALID_LINK_IDX)
  3608. total_links++;
  3609. }
  3610. *num_entries = total_links;
  3611. /* Free the invalid dst_keys allocated */
  3612. if (!*num_entries)
  3613. goto free_entries;
  3614. /*
  3615. * This is to free the unfilled key_alloc_buf that
  3616. * was allocated initially
  3617. */
  3618. flush_keybuf = false;
  3619. wmi_err_rl("ML_KEYS: total_entries filled:%d total_num_tlv:%d dst_key_count:%d",
  3620. *num_entries, total_num_tlv, dst_key_count);
  3621. goto free_keys;
  3622. free_entries:
  3623. qdf_mem_zero(*entries,
  3624. WLAN_MAX_ML_BSS_LINKS * sizeof(**entries));
  3625. qdf_mem_free(*entries);
  3626. free_keys:
  3627. for (k = 0; k < WMI_NUM_KEYS_ALLOCATED; k++) {
  3628. if (!key_alloc_buf[k])
  3629. continue;
  3630. if (!flush_keybuf && key_alloc_buf[k]->valid)
  3631. continue;
  3632. wmi_debug("Free key allocated at idx:%d", k);
  3633. qdf_mem_zero(key_alloc_buf[k], sizeof(key_alloc_buf[k]));
  3634. qdf_mem_free(key_alloc_buf[k]);
  3635. }
  3636. return status;
  3637. }
  3638. static void
  3639. wmi_roam_offload_attach_mlo_tlv(struct wmi_ops *ops)
  3640. {
  3641. ops->extract_roam_synch_key_event = extract_roam_synch_key_event_tlv;
  3642. }
  3643. #else
  3644. static inline void
  3645. wmi_roam_offload_attach_mlo_tlv(struct wmi_ops *ops)
  3646. {}
  3647. #endif
  3648. void wmi_roam_offload_attach_tlv(wmi_unified_t wmi_handle)
  3649. {
  3650. struct wmi_ops *ops = wmi_handle->ops;
  3651. ops->extract_roam_btm_response_stats =
  3652. extract_roam_btm_response_stats_tlv;
  3653. ops->extract_roam_initial_info = extract_roam_initial_info_tlv;
  3654. ops->extract_roam_msg_info = extract_roam_msg_info_tlv;
  3655. ops->extract_roam_frame_info = extract_roam_frame_info_tlv;
  3656. ops->extract_roam_sync_event = extract_roam_sync_event_tlv;
  3657. ops->extract_roam_sync_frame_event = extract_roam_sync_frame_event_tlv;
  3658. ops->extract_roam_event = extract_roam_event_tlv;
  3659. ops->extract_btm_dl_event = extract_btm_denylist_event;
  3660. ops->extract_vdev_disconnect_event = extract_vdev_disconnect_event_tlv;
  3661. ops->extract_roam_scan_chan_list = extract_roam_scan_chan_list_tlv;
  3662. ops->extract_roam_stats_event = extract_roam_stats_event_tlv;
  3663. ops->extract_auth_offload_event = extract_auth_offload_event_tlv;
  3664. ops->extract_roam_pmkid_request = extract_roam_pmkid_request_tlv;
  3665. ops->send_set_ric_req_cmd = send_set_ric_req_cmd_tlv;
  3666. ops->send_process_roam_synch_complete_cmd =
  3667. send_process_roam_synch_complete_cmd_tlv;
  3668. ops->send_roam_invoke_cmd = send_roam_invoke_cmd_tlv;
  3669. ops->send_vdev_set_pcl_cmd = send_vdev_set_pcl_cmd_tlv;
  3670. ops->send_set_roam_trigger_cmd = send_set_roam_trigger_cmd_tlv;
  3671. ops->extract_roam_candidate_frame = extract_roam_candidate_frame_tlv;
  3672. ops->extract_peer_oper_mode_event = extract_peer_oper_mode_event_tlv;
  3673. wmi_roam_offload_attach_vendor_handoff_tlv(ops);
  3674. wmi_roam_offload_attach_mlo_tlv(ops);
  3675. }
  3676. #else
  3677. static inline QDF_STATUS
  3678. extract_roam_btm_response_stats_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  3679. struct roam_btm_response_data *dst,
  3680. uint8_t idx)
  3681. {
  3682. return QDF_STATUS_E_NOSUPPORT;
  3683. }
  3684. static inline QDF_STATUS
  3685. extract_roam_initial_info_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  3686. struct roam_initial_data *dst, uint8_t idx)
  3687. {
  3688. return QDF_STATUS_E_NOSUPPORT;
  3689. }
  3690. static inline QDF_STATUS
  3691. extract_roam_msg_info_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  3692. struct roam_msg_info *dst, uint8_t idx)
  3693. {
  3694. return QDF_STATUS_E_NOSUPPORT;
  3695. }
  3696. static inline QDF_STATUS
  3697. extract_roam_sync_event(wmi_unified_t wmi_handle, void *evt_buf,
  3698. uint32_t len,
  3699. struct roam_offload_synch_ind **roam_sync_ind)
  3700. {
  3701. return QDF_STATUS_E_NOSUPPORT;
  3702. }
  3703. static inline QDF_STATUS
  3704. extract_roam_sync_frame_event(wmi_unified_t wmi_handle, void *evt_buf,
  3705. struct roam_msg_info *dst, uint8_t idx)
  3706. {
  3707. return QDF_STATUS_E_NOSUPPORT;
  3708. }
  3709. static inline QDF_STATUS
  3710. extract_roam_event(wmi_unified_t wmi_handle, void *evt_buf, uint32_t len,
  3711. struct roam_offload_roam_event *roam_event)
  3712. {
  3713. return QDF_STATUS_E_NOSUPPORT;
  3714. }
  3715. #endif /* WLAN_FEATURE_ROAM_OFFLOAD */
  3716. #ifdef WLAN_FEATURE_ROAM_OFFLOAD
  3717. /**
  3718. * wmi_fill_roam_offload_11r_params() - Fill roam scan params to send it to fw
  3719. * @akm: Authentication key management type
  3720. * @roam_offload_11r: TLV to be filled with 11r params
  3721. * @roam_req: roam request param
  3722. */
  3723. static void wmi_fill_roam_offload_11r_params(
  3724. uint32_t akm,
  3725. wmi_roam_11r_offload_tlv_param *roam_offload_11r,
  3726. struct wlan_roam_scan_offload_params *roam_req)
  3727. {
  3728. struct wlan_rso_11r_params *src_11r_params;
  3729. uint8_t *psk_msk, len;
  3730. src_11r_params = &roam_req->rso_11r_info;
  3731. if ((akm == WMI_AUTH_FT_RSNA_FILS_SHA256 ||
  3732. akm == WMI_AUTH_FT_RSNA_FILS_SHA384) &&
  3733. roam_req->fils_roam_config.fils_ft_len) {
  3734. wmi_debug("Update the FILS FT key to Firmware");
  3735. psk_msk = roam_req->fils_roam_config.fils_ft;
  3736. len = roam_req->fils_roam_config.fils_ft_len;
  3737. } else {
  3738. psk_msk = src_11r_params->psk_pmk;
  3739. len = src_11r_params->pmk_len;
  3740. }
  3741. /*
  3742. * For SHA384 based akm, the pmk length is 48 bytes. So fill
  3743. * first 32 bytes in roam_offload_11r->psk_msk and the remaining
  3744. * bytes in roam_offload_11r->psk_msk_ext buffer
  3745. */
  3746. roam_offload_11r->psk_msk_len = len > ROAM_OFFLOAD_PSK_MSK_BYTES ?
  3747. ROAM_OFFLOAD_PSK_MSK_BYTES : len;
  3748. qdf_mem_copy(roam_offload_11r->psk_msk, psk_msk,
  3749. roam_offload_11r->psk_msk_len);
  3750. roam_offload_11r->psk_msk_ext_len = 0;
  3751. if (len > ROAM_OFFLOAD_PSK_MSK_BYTES) {
  3752. roam_offload_11r->psk_msk_ext_len =
  3753. len - roam_offload_11r->psk_msk_len;
  3754. qdf_mem_copy(roam_offload_11r->psk_msk_ext,
  3755. &psk_msk[roam_offload_11r->psk_msk_len],
  3756. roam_offload_11r->psk_msk_ext_len);
  3757. }
  3758. }
  3759. /**
  3760. * wmi_is_ft_akm() - Check if the akm is FT akm. Based on the AKM 11r params
  3761. * will be sent for lfr-3.0 roaming offload
  3762. * @akm: AKM negotiated for the connection
  3763. * @roam_req: roam request sent to firmware
  3764. *
  3765. * Return: true if the akm is 11r based
  3766. */
  3767. static bool wmi_is_ft_akm(int akm,
  3768. struct wlan_roam_scan_offload_params *roam_req)
  3769. {
  3770. switch (akm) {
  3771. case WMI_AUTH_FT_RSNA:
  3772. case WMI_AUTH_FT_RSNA_PSK:
  3773. case WMI_AUTH_FT_RSNA_SAE:
  3774. case WMI_AUTH_FT_RSNA_SUITE_B_8021X_SHA384:
  3775. case WMI_AUTH_FT_RSNA_FILS_SHA256:
  3776. case WMI_AUTH_FT_RSNA_FILS_SHA384:
  3777. case WMI_AUTH_FT_RSNA_SAE_SHA384:
  3778. return true;
  3779. case WMI_AUTH_OPEN:
  3780. if (roam_req->rso_11r_info.mdid.mdie_present &&
  3781. roam_req->rso_11r_info.is_11r_assoc)
  3782. return true;
  3783. break;
  3784. default:
  3785. return false;
  3786. }
  3787. return false;
  3788. }
  3789. /**
  3790. * wmi_get_rso_buf_len() - calculate the length needed to allocate buffer
  3791. * for RSO mode command
  3792. * @roam_req: roam request parameters
  3793. */
  3794. static uint32_t
  3795. wmi_get_rso_buf_len(struct wlan_roam_scan_offload_params *roam_req)
  3796. {
  3797. wmi_tlv_buf_len_param *assoc_ies;
  3798. uint32_t buf_len;
  3799. uint32_t fils_tlv_len = 0;
  3800. int akm = roam_req->akm;
  3801. /*
  3802. * Allocate room for wmi_roam_offload_tlv_param and
  3803. * 11i or 11r or ese roam offload tlv param
  3804. * Todo: Test if below headroom of 2 TLV header is needed
  3805. */
  3806. buf_len = (2 * WMI_TLV_HDR_SIZE);
  3807. if (roam_req->is_rso_stop ||
  3808. !roam_req->roam_offload_enabled) {
  3809. buf_len += (4 * WMI_TLV_HDR_SIZE);
  3810. if (!roam_req->is_rso_stop)
  3811. wmi_debug("vdev[%d]: %s roam offload: %d",
  3812. roam_req->vdev_id,
  3813. roam_req->is_rso_stop ? "RSO stop cmd." : "",
  3814. roam_req->roam_offload_enabled);
  3815. return buf_len;
  3816. }
  3817. wmi_debug("wmi akm = %d", akm);
  3818. buf_len += sizeof(wmi_roam_offload_tlv_param);
  3819. buf_len += 2 * WMI_TLV_HDR_SIZE;
  3820. if ((akm != WMI_AUTH_OPEN || roam_req->rso_ese_info.is_ese_assoc ||
  3821. wmi_is_ft_akm(akm, roam_req)) && akm != WMI_AUTH_NONE) {
  3822. if (roam_req->rso_ese_info.is_ese_assoc)
  3823. buf_len += sizeof(wmi_roam_ese_offload_tlv_param);
  3824. else if (wmi_is_ft_akm(akm, roam_req))
  3825. buf_len += sizeof(wmi_roam_11r_offload_tlv_param);
  3826. else
  3827. buf_len += sizeof(wmi_roam_11i_offload_tlv_param);
  3828. }
  3829. buf_len += (sizeof(*assoc_ies) + (2 * WMI_TLV_HDR_SIZE) +
  3830. roundup(roam_req->assoc_ie_length, sizeof(uint32_t)));
  3831. /* Fils TLV */
  3832. buf_len += WMI_TLV_HDR_SIZE;
  3833. if (roam_req->add_fils_tlv) {
  3834. fils_tlv_len = sizeof(wmi_roam_fils_offload_tlv_param);
  3835. buf_len += fils_tlv_len;
  3836. }
  3837. if (roam_req->rso_11i_info.is_sae_same_pmk)
  3838. buf_len += WMI_TLV_HDR_SIZE +
  3839. sizeof(wmi_roam_sae_offload_tlv_param);
  3840. roam_req->rso_mode_info.roam_scan_mode |=
  3841. WMI_ROAM_SCAN_MODE_ROAMOFFLOAD;
  3842. return buf_len;
  3843. }
  3844. #if defined(WLAN_FEATURE_FILS_SK)
  3845. /**
  3846. * wmi_add_fils_tlv() - Add FILS TLV to roam scan offload command
  3847. * @wmi_handle: wmi handle
  3848. * @roam_req: Roam scan offload params
  3849. * @buf_ptr: command buffer to send
  3850. * @fils_tlv_len: fils tlv length
  3851. *
  3852. * Return: Updated buffer pointer
  3853. */
  3854. static uint8_t *wmi_add_fils_tlv(wmi_unified_t wmi_handle,
  3855. struct wlan_roam_scan_offload_params *roam_req,
  3856. uint8_t *buf_ptr, uint32_t fils_tlv_len)
  3857. {
  3858. wmi_roam_fils_offload_tlv_param *fils_tlv;
  3859. wmi_erp_info *erp_info;
  3860. struct wlan_roam_fils_params *roam_fils_params;
  3861. if (!roam_req->add_fils_tlv) {
  3862. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, 0);
  3863. buf_ptr += WMI_TLV_HDR_SIZE;
  3864. return buf_ptr;
  3865. }
  3866. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  3867. sizeof(*fils_tlv));
  3868. buf_ptr += WMI_TLV_HDR_SIZE;
  3869. fils_tlv = (wmi_roam_fils_offload_tlv_param *)buf_ptr;
  3870. WMITLV_SET_HDR(&fils_tlv->tlv_header,
  3871. WMITLV_TAG_STRUC_wmi_roam_fils_offload_tlv_param,
  3872. WMITLV_GET_STRUCT_TLVLEN
  3873. (wmi_roam_fils_offload_tlv_param));
  3874. roam_fils_params = &roam_req->fils_roam_config;
  3875. erp_info = (wmi_erp_info *)(&fils_tlv->vdev_erp_info);
  3876. erp_info->username_length = roam_fils_params->username_length;
  3877. qdf_mem_copy(erp_info->username, roam_fils_params->username,
  3878. erp_info->username_length);
  3879. erp_info->next_erp_seq_num = roam_fils_params->next_erp_seq_num;
  3880. erp_info->rRk_length = roam_fils_params->rrk_length;
  3881. qdf_mem_copy(erp_info->rRk, roam_fils_params->rrk,
  3882. erp_info->rRk_length);
  3883. erp_info->rIk_length = roam_fils_params->rik_length;
  3884. qdf_mem_copy(erp_info->rIk, roam_fils_params->rik,
  3885. erp_info->rIk_length);
  3886. erp_info->realm_len = roam_fils_params->realm_len;
  3887. qdf_mem_copy(erp_info->realm, roam_fils_params->realm,
  3888. erp_info->realm_len);
  3889. buf_ptr += sizeof(*fils_tlv);
  3890. wmi_debug("RSO_CFG: ERP: usrname_len:%d next_erp_seq_num:%d rRk_len:%d rIk_len:%d realm_len:%d",
  3891. erp_info->username_length, erp_info->next_erp_seq_num,
  3892. erp_info->rRk_length, erp_info->rIk_length,
  3893. erp_info->realm_len);
  3894. return buf_ptr;
  3895. }
  3896. #else
  3897. static inline
  3898. uint8_t *wmi_add_fils_tlv(wmi_unified_t wmi_handle,
  3899. struct wlan_roam_scan_offload_params *roam_req,
  3900. uint8_t *buf_ptr, uint32_t fils_tlv_len)
  3901. {
  3902. return buf_ptr;
  3903. }
  3904. #endif
  3905. #ifdef WLAN_SAE_SINGLE_PMK
  3906. static inline void
  3907. wmi_fill_sae_single_pmk_param(struct wlan_rso_11i_params *src_11i,
  3908. wmi_roam_11i_offload_tlv_param *roam_offload_11i)
  3909. {
  3910. if (src_11i->is_sae_same_pmk)
  3911. roam_offload_11i->flags |=
  3912. 1 << WMI_ROAM_OFFLOAD_FLAG_SAE_SAME_PMKID;
  3913. }
  3914. static uint8_t *wmi_fill_sae_single_pmk_tlv(
  3915. struct wlan_roam_scan_offload_params *roam_req, uint8_t *buf_ptr)
  3916. {
  3917. wmi_roam_sae_offload_tlv_param *sae_offload_param;
  3918. if (!roam_req->rso_11i_info.is_sae_same_pmk)
  3919. return buf_ptr;
  3920. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  3921. sizeof(wmi_roam_sae_offload_tlv_param));
  3922. buf_ptr += WMI_TLV_HDR_SIZE;
  3923. sae_offload_param = (wmi_roam_sae_offload_tlv_param *)buf_ptr;
  3924. WMITLV_SET_HDR(&sae_offload_param->tlv_header,
  3925. WMITLV_TAG_STRUC_wmi_roam_sae_offload_tlv_param,
  3926. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_sae_offload_tlv_param));
  3927. sae_offload_param->spmk_timeout =
  3928. roam_req->sae_offload_params.spmk_timeout;
  3929. wmi_debug("spmk_timeout:%d seconds", sae_offload_param->spmk_timeout);
  3930. buf_ptr += sizeof(*sae_offload_param);
  3931. return buf_ptr;
  3932. }
  3933. #else
  3934. static inline void
  3935. wmi_fill_sae_single_pmk_param(struct wlan_rso_11i_params *src_11i,
  3936. wmi_roam_11i_offload_tlv_param *roam_offload_11i)
  3937. {}
  3938. static inline uint8_t *wmi_fill_sae_single_pmk_tlv(
  3939. struct wlan_roam_scan_offload_params *roam_req,
  3940. uint8_t *buf_ptr)
  3941. {
  3942. return buf_ptr;
  3943. }
  3944. #endif
  3945. static QDF_STATUS
  3946. wmi_fill_rso_tlvs(wmi_unified_t wmi_handle, uint8_t *buf,
  3947. struct wlan_roam_scan_offload_params *roam_req)
  3948. {
  3949. wmi_roam_offload_tlv_param *roam_offload_params;
  3950. wmi_roam_11i_offload_tlv_param *roam_offload_11i;
  3951. wmi_roam_11r_offload_tlv_param *roam_offload_11r;
  3952. wmi_roam_ese_offload_tlv_param *roam_offload_ese;
  3953. wmi_tlv_buf_len_param *assoc_ies;
  3954. uint32_t fils_tlv_len = 0;
  3955. int akm = roam_req->akm;
  3956. struct wlan_rso_lfr3_params *src_lfr3_params =
  3957. &roam_req->rso_lfr3_params;
  3958. struct wlan_rso_lfr3_caps *src_lfr3_caps =
  3959. &roam_req->rso_lfr3_caps;
  3960. struct wlan_rso_11i_params *src_11i_info =
  3961. &roam_req->rso_11i_info;
  3962. struct wlan_rso_ese_params *src_ese_info =
  3963. &roam_req->rso_ese_info;
  3964. struct wlan_rso_11r_params *src_11r_info =
  3965. &roam_req->rso_11r_info;
  3966. /* For RSO stop command, dont fill 11i, 11r or ese tlv */
  3967. if (roam_req->is_rso_stop || !roam_req->roam_offload_enabled) {
  3968. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  3969. WMITLV_GET_STRUCT_TLVLEN(0));
  3970. buf += WMI_TLV_HDR_SIZE;
  3971. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  3972. WMITLV_GET_STRUCT_TLVLEN(0));
  3973. buf += WMI_TLV_HDR_SIZE;
  3974. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  3975. WMITLV_GET_STRUCT_TLVLEN(0));
  3976. buf += WMI_TLV_HDR_SIZE;
  3977. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  3978. WMITLV_GET_STRUCT_TLVLEN(0));
  3979. buf += WMI_TLV_HDR_SIZE;
  3980. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  3981. WMITLV_GET_STRUCT_TLVLEN(0));
  3982. buf += WMI_TLV_HDR_SIZE;
  3983. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_BYTE,
  3984. WMITLV_GET_STRUCT_TLVLEN(0));
  3985. return QDF_STATUS_SUCCESS;
  3986. }
  3987. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  3988. sizeof(wmi_roam_offload_tlv_param));
  3989. buf += WMI_TLV_HDR_SIZE;
  3990. roam_offload_params = (wmi_roam_offload_tlv_param *)buf;
  3991. WMITLV_SET_HDR(buf,
  3992. WMITLV_TAG_STRUC_wmi_roam_offload_tlv_param,
  3993. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_offload_tlv_param));
  3994. roam_offload_params->prefer_5g = src_lfr3_params->prefer_5ghz;
  3995. roam_offload_params->rssi_cat_gap = src_lfr3_params->roam_rssi_cat_gap;
  3996. roam_offload_params->select_5g_margin =
  3997. src_lfr3_params->select_5ghz_margin;
  3998. roam_offload_params->handoff_delay_for_rx =
  3999. src_lfr3_params->ho_delay_for_rx;
  4000. roam_offload_params->max_mlme_sw_retries =
  4001. src_lfr3_params->roam_retry_count;
  4002. roam_offload_params->no_ack_timeout =
  4003. src_lfr3_params->roam_preauth_no_ack_timeout;
  4004. roam_offload_params->reassoc_failure_timeout =
  4005. src_lfr3_params->reassoc_failure_timeout;
  4006. roam_offload_params->roam_candidate_validity_time =
  4007. src_lfr3_params->rct_validity_timer;
  4008. roam_offload_params->roam_to_current_bss_disable =
  4009. src_lfr3_params->disable_self_roam;
  4010. wmi_debug("RSO_CFG: prefer_5g:%d rssi_cat_gap:%d select_5g_margin:%d ho_delay:%d max_sw_retry:%d no_ack_timeout:%d",
  4011. roam_offload_params->prefer_5g,
  4012. roam_offload_params->rssi_cat_gap,
  4013. roam_offload_params->select_5g_margin,
  4014. roam_offload_params->handoff_delay_for_rx,
  4015. roam_offload_params->max_mlme_sw_retries,
  4016. roam_offload_params->no_ack_timeout);
  4017. wmi_debug("RSO_CFG: reassoc_fail_timeout:%d rct_validity_time:%d disable_self_roam:%d",
  4018. roam_offload_params->reassoc_failure_timeout,
  4019. roam_offload_params->roam_candidate_validity_time,
  4020. roam_offload_params->roam_to_current_bss_disable);
  4021. /* Fill the capabilities */
  4022. roam_offload_params->capability = src_lfr3_caps->capability;
  4023. roam_offload_params->ht_caps_info = src_lfr3_caps->ht_caps_info;
  4024. roam_offload_params->ampdu_param = src_lfr3_caps->ampdu_param;
  4025. roam_offload_params->ht_ext_cap = src_lfr3_caps->ht_ext_cap;
  4026. roam_offload_params->ht_txbf = src_lfr3_caps->ht_txbf;
  4027. roam_offload_params->asel_cap = src_lfr3_caps->asel_cap;
  4028. roam_offload_params->qos_caps = src_lfr3_caps->qos_caps;
  4029. roam_offload_params->qos_enabled = src_lfr3_caps->qos_enabled;
  4030. roam_offload_params->wmm_caps = src_lfr3_caps->wmm_caps;
  4031. qdf_mem_copy((uint8_t *)roam_offload_params->mcsset,
  4032. (uint8_t *)src_lfr3_caps->mcsset,
  4033. ROAM_OFFLOAD_NUM_MCS_SET);
  4034. wmi_debug("RSO_CFG: capability:0x%x ht_caps:0x%x ampdu_param:0%x ht_ext_cap:0x%x ht_txbf:0x%x asel_cap:0x%x qos_caps:0x%x qos_en:%d wmm_caps:0x%x",
  4035. roam_offload_params->capability,
  4036. roam_offload_params->ht_caps_info,
  4037. roam_offload_params->ampdu_param,
  4038. roam_offload_params->ht_ext_cap,
  4039. roam_offload_params->ht_txbf, roam_offload_params->asel_cap,
  4040. roam_offload_params->qos_caps,
  4041. roam_offload_params->qos_enabled,
  4042. roam_offload_params->wmm_caps);
  4043. buf += sizeof(wmi_roam_offload_tlv_param);
  4044. /*
  4045. * The TLV's are in the order of 11i, 11R, ESE. Hence,
  4046. * they are filled in the same order.Depending on the
  4047. * authentication type, the other mode TLV's are nullified
  4048. * and only headers are filled.
  4049. */
  4050. if ((akm != WMI_AUTH_OPEN || roam_req->rso_ese_info.is_ese_assoc ||
  4051. wmi_is_ft_akm(akm, roam_req)) && akm != WMI_AUTH_NONE) {
  4052. if (roam_req->rso_ese_info.is_ese_assoc) {
  4053. /* Fill the length of 11i, 11r TLV as 0 */
  4054. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4055. buf += WMI_TLV_HDR_SIZE;
  4056. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4057. buf += WMI_TLV_HDR_SIZE;
  4058. /* Start filling the ESE TLV */
  4059. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  4060. sizeof(wmi_roam_ese_offload_tlv_param));
  4061. buf += WMI_TLV_HDR_SIZE;
  4062. roam_offload_ese =
  4063. (wmi_roam_ese_offload_tlv_param *)buf;
  4064. qdf_mem_copy(roam_offload_ese->krk, src_ese_info->krk,
  4065. sizeof(src_ese_info->krk));
  4066. qdf_mem_copy(roam_offload_ese->btk, src_ese_info->btk,
  4067. sizeof(src_ese_info->btk));
  4068. WMITLV_SET_HDR(&roam_offload_ese->tlv_header,
  4069. WMITLV_TAG_STRUC_wmi_roam_ese_offload_tlv_param,
  4070. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_ese_offload_tlv_param));
  4071. buf += sizeof(wmi_roam_ese_offload_tlv_param);
  4072. } else if (wmi_is_ft_akm(akm, roam_req)) {
  4073. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4074. buf += WMI_TLV_HDR_SIZE;
  4075. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  4076. sizeof(wmi_roam_11r_offload_tlv_param));
  4077. buf += WMI_TLV_HDR_SIZE;
  4078. roam_offload_11r =
  4079. (wmi_roam_11r_offload_tlv_param *)buf;
  4080. roam_offload_11r->r0kh_id_len =
  4081. src_11r_info->r0kh_id_length;
  4082. qdf_mem_copy(roam_offload_11r->r0kh_id,
  4083. src_11r_info->r0kh_id,
  4084. src_11r_info->r0kh_id_length);
  4085. wmi_fill_roam_offload_11r_params(akm, roam_offload_11r,
  4086. roam_req);
  4087. roam_offload_11r->mdie_present =
  4088. src_11r_info->mdid.mdie_present;
  4089. roam_offload_11r->mdid =
  4090. src_11r_info->mdid.mobility_domain;
  4091. roam_offload_11r->adaptive_11r =
  4092. src_11r_info->is_adaptive_11r;
  4093. roam_offload_11r->ft_im_for_deauth =
  4094. src_11r_info->enable_ft_im_roaming;
  4095. roam_offload_11r->ft_over_ds_enable =
  4096. src_11r_info->enable_ft_over_ds;
  4097. if (akm == WMI_AUTH_OPEN) {
  4098. /*
  4099. * If FT-Open ensure pmk length
  4100. * and r0khid len are zero
  4101. */
  4102. roam_offload_11r->r0kh_id_len = 0;
  4103. roam_offload_11r->psk_msk_len = 0;
  4104. }
  4105. WMITLV_SET_HDR(&roam_offload_11r->tlv_header,
  4106. WMITLV_TAG_STRUC_wmi_roam_11r_offload_tlv_param,
  4107. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_11r_offload_tlv_param));
  4108. buf += sizeof(wmi_roam_11r_offload_tlv_param);
  4109. /* Set ESE TLV len to 0*/
  4110. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4111. buf += WMI_TLV_HDR_SIZE;
  4112. wmi_debug("RSO_CFG: vdev[%d] 11r TLV psk_msk_len = %d psk_msk_ext:%d md:0x%x",
  4113. roam_req->vdev_id,
  4114. roam_offload_11r->psk_msk_len,
  4115. roam_offload_11r->psk_msk_ext_len,
  4116. roam_offload_11r->mdid);
  4117. if (roam_offload_11r->psk_msk_len)
  4118. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI,
  4119. QDF_TRACE_LEVEL_DEBUG,
  4120. roam_offload_11r->psk_msk,
  4121. WLAN_MAX_PMK_DUMP_BYTES);
  4122. } else {
  4123. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  4124. sizeof(wmi_roam_11i_offload_tlv_param));
  4125. buf += WMI_TLV_HDR_SIZE;
  4126. roam_offload_11i =
  4127. (wmi_roam_11i_offload_tlv_param *)buf;
  4128. if (src_11i_info->roam_key_mgmt_offload_enabled &&
  4129. src_11i_info->fw_okc)
  4130. WMI_SET_ROAM_OFFLOAD_OKC_ENABLED(
  4131. roam_offload_11i->flags);
  4132. else
  4133. WMI_SET_ROAM_OFFLOAD_OKC_DISABLED(
  4134. roam_offload_11i->flags);
  4135. if (src_11i_info->roam_key_mgmt_offload_enabled &&
  4136. src_11i_info->fw_pmksa_cache)
  4137. WMI_SET_ROAM_OFFLOAD_PMK_CACHE_ENABLED(
  4138. roam_offload_11i->flags);
  4139. else
  4140. WMI_SET_ROAM_OFFLOAD_PMK_CACHE_DISABLED(
  4141. roam_offload_11i->flags);
  4142. wmi_fill_sae_single_pmk_param(src_11i_info,
  4143. roam_offload_11i);
  4144. roam_offload_11i->pmk_len =
  4145. src_11i_info->pmk_len > ROAM_OFFLOAD_PMK_BYTES ?
  4146. ROAM_OFFLOAD_PMK_BYTES : src_11i_info->pmk_len;
  4147. qdf_mem_copy(roam_offload_11i->pmk,
  4148. src_11i_info->psk_pmk,
  4149. roam_offload_11i->pmk_len);
  4150. roam_offload_11i->pmk_ext_len = 0;
  4151. if (src_11i_info->pmk_len > ROAM_OFFLOAD_PMK_BYTES) {
  4152. roam_offload_11i->pmk_ext_len =
  4153. QDF_MIN(src_11i_info->pmk_len -
  4154. ROAM_OFFLOAD_PMK_BYTES,
  4155. ROAM_OFFLOAD_PMK_BYTES);
  4156. }
  4157. qdf_mem_copy(
  4158. roam_offload_11i->pmk_ext,
  4159. &src_11i_info->psk_pmk[ROAM_OFFLOAD_PMK_BYTES],
  4160. roam_offload_11i->pmk_ext_len);
  4161. WMITLV_SET_HDR(&roam_offload_11i->tlv_header,
  4162. WMITLV_TAG_STRUC_wmi_roam_11i_offload_tlv_param,
  4163. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_11i_offload_tlv_param));
  4164. buf += sizeof(wmi_roam_11i_offload_tlv_param);
  4165. /*
  4166. * Set 11r TLV len to 0, since security profile is not
  4167. * FT
  4168. */
  4169. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4170. buf += WMI_TLV_HDR_SIZE;
  4171. /*
  4172. * Set ESE TLV len to 0 since security profile is not
  4173. * ESE
  4174. */
  4175. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4176. buf += WMI_TLV_HDR_SIZE;
  4177. wmi_info("RSO_CFG: vdev:%d pmk_len = %d pmksa caching:%d OKC:%d sae_same_pmk:%d key_mgmt_offload:%d",
  4178. roam_req->vdev_id, roam_offload_11i->pmk_len,
  4179. src_11i_info->fw_pmksa_cache,
  4180. src_11i_info->fw_okc,
  4181. src_11i_info->is_sae_same_pmk,
  4182. src_11i_info->roam_key_mgmt_offload_enabled);
  4183. if (roam_offload_11i->pmk_len)
  4184. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI,
  4185. QDF_TRACE_LEVEL_DEBUG,
  4186. roam_offload_11i->pmk,
  4187. WLAN_MAX_PMK_DUMP_BYTES);
  4188. if (roam_offload_11i->pmk_ext_len)
  4189. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI,
  4190. QDF_TRACE_LEVEL_DEBUG,
  4191. roam_offload_11i->pmk_ext,
  4192. WLAN_MAX_PMK_DUMP_BYTES);
  4193. }
  4194. } else {
  4195. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4196. buf += WMI_TLV_HDR_SIZE;
  4197. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4198. buf += WMI_TLV_HDR_SIZE;
  4199. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  4200. buf += WMI_TLV_HDR_SIZE;
  4201. }
  4202. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, sizeof(*assoc_ies));
  4203. buf += WMI_TLV_HDR_SIZE;
  4204. assoc_ies = (wmi_tlv_buf_len_param *)buf;
  4205. WMITLV_SET_HDR(&assoc_ies->tlv_header,
  4206. WMITLV_TAG_STRUC_wmi_tlv_buf_len_param,
  4207. WMITLV_GET_STRUCT_TLVLEN(wmi_tlv_buf_len_param));
  4208. assoc_ies->buf_len = roam_req->assoc_ie_length;
  4209. buf += sizeof(*assoc_ies);
  4210. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_BYTE,
  4211. roundup(assoc_ies->buf_len, sizeof(uint32_t)));
  4212. buf += WMI_TLV_HDR_SIZE;
  4213. wmi_debug("RSO_CFG: akm:%d assoc_ies len:%d", akm, assoc_ies->buf_len);
  4214. if (assoc_ies->buf_len)
  4215. qdf_mem_copy(buf, roam_req->assoc_ie, assoc_ies->buf_len);
  4216. buf += qdf_roundup(assoc_ies->buf_len, sizeof(uint32_t));
  4217. buf = wmi_add_fils_tlv(wmi_handle, roam_req, buf, fils_tlv_len);
  4218. buf = wmi_fill_sae_single_pmk_tlv(roam_req, buf);
  4219. return QDF_STATUS_SUCCESS;
  4220. }
  4221. #else
  4222. static inline
  4223. uint32_t wmi_get_rso_buf_len(struct wlan_roam_scan_offload_params *roam_req)
  4224. {
  4225. return 0;
  4226. }
  4227. static inline QDF_STATUS
  4228. wmi_fill_rso_tlvs(wmi_unified_t wmi_handle, uint8_t *buf_ptr,
  4229. struct wlan_roam_scan_offload_params *roam_req)
  4230. {
  4231. return QDF_STATUS_SUCCESS;
  4232. }
  4233. #endif
  4234. static QDF_STATUS
  4235. wmi_fill_rso_start_scan_tlv(struct wlan_roam_scan_offload_params *rso_req,
  4236. wmi_start_scan_cmd_fixed_param *scan_tlv)
  4237. {
  4238. struct wlan_roam_scan_params *src_scan_params;
  4239. src_scan_params = &rso_req->rso_scan_params;
  4240. scan_tlv->scan_ctrl_flags = WMI_SCAN_ADD_CCK_RATES |
  4241. WMI_SCAN_ADD_OFDM_RATES |
  4242. WMI_SCAN_ADD_DS_IE_IN_PROBE_REQ |
  4243. WMI_SCAN_FILTER_PROBE_REQ;
  4244. if (rso_req->is_rso_stop) {
  4245. scan_tlv->dwell_time_active =
  4246. ROAM_SCAN_DWELL_TIME_ACTIVE_DEFAULT;
  4247. scan_tlv->dwell_time_passive =
  4248. ROAM_SCAN_DWELL_TIME_PASSIVE_DEFAULT;
  4249. scan_tlv->min_rest_time = ROAM_SCAN_MIN_REST_TIME_DEFAULT;
  4250. scan_tlv->max_rest_time = ROAM_SCAN_MAX_REST_TIME_DEFAULT;
  4251. scan_tlv->repeat_probe_time = 0;
  4252. scan_tlv->probe_spacing_time = 0;
  4253. scan_tlv->probe_delay = 0;
  4254. scan_tlv->max_scan_time = ROAM_SCAN_HW_DEF_SCAN_MAX_DURATION;
  4255. scan_tlv->idle_time = src_scan_params->min_rest_time;
  4256. scan_tlv->burst_duration = 0;
  4257. return QDF_STATUS_SUCCESS;
  4258. }
  4259. scan_tlv->dwell_time_active = src_scan_params->dwell_time_active;
  4260. scan_tlv->dwell_time_passive = src_scan_params->dwell_time_passive;
  4261. scan_tlv->min_dwell_time_6ghz = src_scan_params->min_dwell_time_6ghz;
  4262. scan_tlv->burst_duration = src_scan_params->burst_duration;
  4263. scan_tlv->min_rest_time = src_scan_params->min_rest_time;
  4264. scan_tlv->max_rest_time = src_scan_params->max_rest_time;
  4265. scan_tlv->repeat_probe_time = src_scan_params->repeat_probe_time;
  4266. scan_tlv->probe_spacing_time = src_scan_params->probe_spacing_time;
  4267. scan_tlv->probe_delay = src_scan_params->probe_delay;
  4268. scan_tlv->max_scan_time = ROAM_SCAN_HW_DEF_SCAN_MAX_DURATION;
  4269. scan_tlv->idle_time = src_scan_params->idle_time;
  4270. scan_tlv->n_probes = src_scan_params->n_probes;
  4271. scan_tlv->scan_ctrl_flags |= src_scan_params->scan_ctrl_flags;
  4272. scan_tlv->dwell_time_active_6ghz =
  4273. src_scan_params->dwell_time_active_6ghz;
  4274. scan_tlv->dwell_time_passive_6ghz =
  4275. src_scan_params->dwell_time_passive_6ghz;
  4276. WMI_SCAN_SET_DWELL_MODE(scan_tlv->scan_ctrl_flags,
  4277. src_scan_params->rso_adaptive_dwell_mode);
  4278. /* Configure roaming scan behavior (DBS/Non-DBS scan) */
  4279. if (rso_req->roaming_scan_policy)
  4280. scan_tlv->scan_ctrl_flags_ext |=
  4281. WMI_SCAN_DBS_POLICY_FORCE_NONDBS;
  4282. else
  4283. scan_tlv->scan_ctrl_flags_ext |=
  4284. WMI_SCAN_DBS_POLICY_DEFAULT;
  4285. wmi_debug("RSO_CFG: dwell time: active %d passive %d, burst_duration:%d, active 6g %d passive 6g %d, min_rest_time %d max rest %d repeat probe time %d probe_spacing:%d",
  4286. scan_tlv->dwell_time_active, scan_tlv->dwell_time_passive,
  4287. scan_tlv->burst_duration,
  4288. scan_tlv->dwell_time_active_6ghz,
  4289. scan_tlv->dwell_time_passive_6ghz,
  4290. scan_tlv->min_rest_time, scan_tlv->max_rest_time,
  4291. scan_tlv->repeat_probe_time, scan_tlv->probe_spacing_time);
  4292. wmi_debug("RSO_CFG: ctrl_flags:0x%x probe_delay:%d max_scan_time:%d idle_time:%d n_probes:%d",
  4293. scan_tlv->scan_ctrl_flags_ext, scan_tlv->probe_delay,
  4294. scan_tlv->max_scan_time, scan_tlv->idle_time,
  4295. scan_tlv->n_probes);
  4296. return QDF_STATUS_SUCCESS;
  4297. }
  4298. #ifdef WLAN_FEATURE_11BE_MLO
  4299. static void
  4300. wmi_set_rso_stop_report_status(wmi_roam_scan_mode_fixed_param *rso_fp)
  4301. {
  4302. /**
  4303. * Set the REPORT status flag always, so that firmware sends RSO stop
  4304. * status always
  4305. */
  4306. rso_fp->flags |= WMI_ROAM_SCAN_MODE_FLAG_REPORT_STATUS;
  4307. }
  4308. #else
  4309. static void
  4310. wmi_set_rso_stop_report_status(wmi_roam_scan_mode_fixed_param *rso_fp)
  4311. {
  4312. }
  4313. #endif
  4314. /**
  4315. * send_roam_scan_offload_mode_cmd_tlv() - send roam scan mode request to fw
  4316. * @wmi_handle: wmi handle
  4317. * @rso_req: roam request param
  4318. *
  4319. * send WMI_ROAM_SCAN_MODE TLV to firmware. It has a piggyback
  4320. * of WMI_ROAM_SCAN_MODE.
  4321. *
  4322. * Return: QDF status
  4323. */
  4324. static QDF_STATUS
  4325. send_roam_scan_offload_mode_cmd_tlv(
  4326. wmi_unified_t wmi_handle,
  4327. struct wlan_roam_scan_offload_params *rso_req)
  4328. {
  4329. wmi_buf_t buf = NULL;
  4330. QDF_STATUS status;
  4331. size_t len;
  4332. uint8_t *buf_ptr;
  4333. wmi_roam_scan_mode_fixed_param *roam_scan_mode_fp;
  4334. wmi_start_scan_cmd_fixed_param *scan_cmd_fp;
  4335. struct wlan_roam_scan_mode_params *src_rso_mode_info = NULL;
  4336. /*
  4337. * Need to create a buf with roam_scan command at
  4338. * front and piggyback with scan command
  4339. */
  4340. len = sizeof(wmi_roam_scan_mode_fixed_param) +
  4341. sizeof(wmi_start_scan_cmd_fixed_param);
  4342. len += wmi_get_rso_buf_len(rso_req);
  4343. if (rso_req->rso_mode_info.roam_scan_mode ==
  4344. (WMI_ROAM_SCAN_MODE_NONE | WMI_ROAM_SCAN_MODE_ROAMOFFLOAD))
  4345. len = sizeof(wmi_roam_scan_mode_fixed_param);
  4346. buf = wmi_buf_alloc(wmi_handle, len);
  4347. if (!buf)
  4348. return QDF_STATUS_E_NOMEM;
  4349. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  4350. src_rso_mode_info = &rso_req->rso_mode_info;
  4351. roam_scan_mode_fp = (wmi_roam_scan_mode_fixed_param *)buf_ptr;
  4352. WMITLV_SET_HDR(
  4353. &roam_scan_mode_fp->tlv_header,
  4354. WMITLV_TAG_STRUC_wmi_roam_scan_mode_fixed_param,
  4355. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_scan_mode_fixed_param));
  4356. roam_scan_mode_fp->min_delay_roam_trigger_reason_bitmask =
  4357. src_rso_mode_info->min_delay_roam_trigger_bitmask;
  4358. roam_scan_mode_fp->min_delay_btw_scans =
  4359. WMI_SEC_TO_MSEC(src_rso_mode_info->min_delay_btw_scans);
  4360. roam_scan_mode_fp->roam_scan_mode = src_rso_mode_info->roam_scan_mode;
  4361. roam_scan_mode_fp->vdev_id = rso_req->vdev_id;
  4362. wmi_debug("RSO_CFG: vdev_id:%d roam scan mode:0x%x min_delay_bitmap:0x%x min_delay_btw_scans:%d",
  4363. rso_req->vdev_id,
  4364. roam_scan_mode_fp->roam_scan_mode,
  4365. roam_scan_mode_fp->min_delay_roam_trigger_reason_bitmask,
  4366. roam_scan_mode_fp->min_delay_btw_scans);
  4367. /*
  4368. * For supplicant disabled roaming, all other roam triggers are disabled
  4369. * so send only roam scan mode Fixed param in the command
  4370. */
  4371. if (src_rso_mode_info->roam_scan_mode ==
  4372. (WMI_ROAM_SCAN_MODE_NONE | WMI_ROAM_SCAN_MODE_ROAMOFFLOAD)) {
  4373. roam_scan_mode_fp->flags |=
  4374. WMI_ROAM_SCAN_MODE_FLAG_REPORT_STATUS;
  4375. goto send_roam_scan_mode_cmd;
  4376. } else {
  4377. wmi_set_rso_stop_report_status(roam_scan_mode_fp);
  4378. }
  4379. /* Fill in scan parameters suitable for roaming scan */
  4380. buf_ptr += sizeof(wmi_roam_scan_mode_fixed_param);
  4381. WMITLV_SET_HDR(
  4382. buf_ptr,
  4383. WMITLV_TAG_STRUC_wmi_start_scan_cmd_fixed_param,
  4384. WMITLV_GET_STRUCT_TLVLEN(wmi_start_scan_cmd_fixed_param));
  4385. scan_cmd_fp = (wmi_start_scan_cmd_fixed_param *)buf_ptr;
  4386. wmi_fill_rso_start_scan_tlv(rso_req, scan_cmd_fp);
  4387. /* Ensure there is no additional IEs */
  4388. scan_cmd_fp->ie_len = 0;
  4389. buf_ptr += sizeof(wmi_start_scan_cmd_fixed_param);
  4390. status = wmi_fill_rso_tlvs(wmi_handle, buf_ptr, rso_req);
  4391. if (QDF_IS_STATUS_ERROR(status)) {
  4392. wmi_buf_free(buf);
  4393. return status;
  4394. }
  4395. send_roam_scan_mode_cmd:
  4396. wmi_mtrace(WMI_ROAM_SCAN_MODE, rso_req->vdev_id, 0);
  4397. status = wmi_unified_cmd_send(wmi_handle, buf,
  4398. len, WMI_ROAM_SCAN_MODE);
  4399. if (QDF_IS_STATUS_ERROR(status))
  4400. wmi_buf_free(buf);
  4401. return status;
  4402. }
  4403. #ifdef WLAN_FEATURE_11BE_MLO
  4404. static void
  4405. send_update_mlo_roam_params(wmi_roam_cnd_scoring_param *score_param,
  4406. struct ap_profile_params *ap_profile)
  4407. {
  4408. score_param->eht_weightage_pcnt =
  4409. ap_profile->param.eht_caps_weightage;
  4410. score_param->mlo_weightage_pcnt =
  4411. ap_profile->param.mlo_weightage;
  4412. wmi_debug("11be score params weightage: EHT %d MLO %d",
  4413. score_param->eht_weightage_pcnt,
  4414. score_param->mlo_weightage_pcnt);
  4415. }
  4416. static uint32_t convert_support_link_band_to_wmi(uint32_t bands)
  4417. {
  4418. uint32_t target_bands = 0;
  4419. if (bands & BIT(REG_BAND_2G))
  4420. target_bands |= BIT(0);
  4421. if (bands & BIT(REG_BAND_5G))
  4422. target_bands |= BIT(1);
  4423. if (bands & BIT(REG_BAND_6G))
  4424. target_bands |= BIT(2);
  4425. return target_bands;
  4426. }
  4427. /**
  4428. * send_roam_mlo_config_tlv() - send roam mlo config parameters
  4429. * @wmi_handle: wmi handle
  4430. * @req: pointer to wlan roam mlo config parameters
  4431. *
  4432. * This function sends the roam mlo config parameters to fw.
  4433. *
  4434. * Return: QDF status
  4435. */
  4436. static QDF_STATUS
  4437. send_roam_mlo_config_tlv(wmi_unified_t wmi_handle,
  4438. struct wlan_roam_mlo_config *req)
  4439. {
  4440. wmi_roam_mlo_config_cmd_fixed_param *cmd;
  4441. wmi_buf_t buf;
  4442. uint32_t len;
  4443. len = sizeof(*cmd);
  4444. buf = wmi_buf_alloc(wmi_handle, len);
  4445. if (!buf)
  4446. return QDF_STATUS_E_NOMEM;
  4447. cmd = (wmi_roam_mlo_config_cmd_fixed_param *)wmi_buf_data(buf);
  4448. WMITLV_SET_HDR(
  4449. &cmd->tlv_header,
  4450. WMITLV_TAG_STRUC_wmi_roam_mlo_config_cmd_fixed_param,
  4451. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_mlo_config_cmd_fixed_param));
  4452. cmd->vdev_id = req->vdev_id;
  4453. cmd->support_link_num = req->support_link_num;
  4454. cmd->support_link_band = convert_support_link_band_to_wmi(
  4455. req->support_link_band);
  4456. WMI_CHAR_ARRAY_TO_MAC_ADDR(req->partner_link_addr.bytes,
  4457. &cmd->partner_link_addr);
  4458. wmi_debug("RSO_CFG MLO: vdev_id:%d support_link_num:%d support_link_band:0x%0x link addr:"QDF_MAC_ADDR_FMT,
  4459. cmd->vdev_id, cmd->support_link_num,
  4460. cmd->support_link_band,
  4461. QDF_MAC_ADDR_REF(req->partner_link_addr.bytes));
  4462. wmi_mtrace(WMI_ROAM_MLO_CONFIG_CMDID, cmd->vdev_id, 0);
  4463. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  4464. WMI_ROAM_MLO_CONFIG_CMDID)) {
  4465. wmi_err("Failed to send WMI_ROAM_MLO_CONFIG_CMDID");
  4466. wmi_buf_free(buf);
  4467. return QDF_STATUS_E_FAILURE;
  4468. }
  4469. return QDF_STATUS_SUCCESS;
  4470. }
  4471. static void wmi_roam_mlo_attach_tlv(struct wmi_unified *wmi_handle)
  4472. {
  4473. struct wmi_ops *ops = wmi_handle->ops;
  4474. ops->send_roam_mlo_config = send_roam_mlo_config_tlv;
  4475. }
  4476. #else
  4477. static void
  4478. send_update_mlo_roam_params(wmi_roam_cnd_scoring_param *score_param,
  4479. struct ap_profile_params *ap_profile)
  4480. {
  4481. }
  4482. static void wmi_roam_mlo_attach_tlv(struct wmi_unified *wmi_handle)
  4483. {
  4484. }
  4485. #endif
  4486. #ifdef WLAN_FEATURE_11BE_MLO
  4487. /**
  4488. * update_mlo_prefer_percentage() - Update mlo preference with configured value
  4489. * @psoc: psoc object
  4490. * @mlo_prefer_percentage: pointer to hold mlo preference percentage
  4491. *
  4492. * Return: None
  4493. */
  4494. static void update_mlo_prefer_percentage(struct wlan_objmgr_psoc *psoc,
  4495. int8_t *mlo_prefer_percentage)
  4496. {
  4497. wlan_mlme_get_mlo_prefer_percentage(psoc, mlo_prefer_percentage);
  4498. /* host will deliver actual weighted number based on 100.
  4499. * For example:
  4500. * If percentage value in INI is 20, then host will give 120 (100 + 20)
  4501. * i.e (100 * 1.2) as mlo_etp_weightage_pcnt.
  4502. * If percentage value in INI is -20, then host will give 80 (100 - 20)
  4503. * i.e (100 * 0.8) as mlo_etp_weightage_pcnt.
  4504. */
  4505. *mlo_prefer_percentage += 100;
  4506. }
  4507. #else
  4508. static inline
  4509. void update_mlo_prefer_percentage(struct wlan_objmgr_psoc *psoc,
  4510. int8_t *mlo_preference_pctn)
  4511. {}
  4512. #endif
  4513. /**
  4514. * send_roam_scan_offload_ap_profile_cmd_tlv() - set roam ap profile in fw
  4515. * @wmi_handle: wmi handle
  4516. * @ap_profile: ap profile
  4517. *
  4518. * Send WMI_ROAM_AP_PROFILE to firmware
  4519. *
  4520. * Return: CDF status
  4521. */
  4522. static QDF_STATUS
  4523. send_roam_scan_offload_ap_profile_cmd_tlv(wmi_unified_t wmi_handle,
  4524. struct ap_profile_params *ap_profile)
  4525. {
  4526. wmi_buf_t buf = NULL;
  4527. QDF_STATUS status;
  4528. size_t len;
  4529. uint8_t *buf_ptr;
  4530. wmi_roam_ap_profile_fixed_param *roam_ap_profile_fp;
  4531. wmi_roam_cnd_scoring_param *score_param;
  4532. wmi_ap_profile *profile;
  4533. wmi_roam_score_delta_param *score_delta_param;
  4534. wmi_roam_cnd_min_rssi_param *min_rssi_param;
  4535. wmi_owe_ap_profile *owe_ap_profile;
  4536. enum roam_trigger_reason trig_reason;
  4537. uint32_t *authmode_list;
  4538. int8_t mlo_prefer_percentage = 0;
  4539. wmi_ssid *ssid;
  4540. int i;
  4541. len = sizeof(wmi_roam_ap_profile_fixed_param) + sizeof(wmi_ap_profile);
  4542. len += sizeof(*score_param) + WMI_TLV_HDR_SIZE;
  4543. if (!wmi_service_enabled(wmi_handle,
  4544. wmi_service_configure_roam_trigger_param_support)) {
  4545. len += WMI_TLV_HDR_SIZE;
  4546. len += NUM_OF_ROAM_TRIGGERS * sizeof(*score_delta_param);
  4547. len += WMI_TLV_HDR_SIZE;
  4548. len += NUM_OF_ROAM_MIN_RSSI * sizeof(*min_rssi_param);
  4549. } else {
  4550. len += 2 * WMI_TLV_HDR_SIZE;
  4551. }
  4552. if (ap_profile->owe_ap_profile.is_owe_transition_conn) {
  4553. len += WMI_TLV_HDR_SIZE;
  4554. len += sizeof(*owe_ap_profile);
  4555. } else {
  4556. len += WMI_TLV_HDR_SIZE;
  4557. }
  4558. if (ap_profile->profile.num_allowed_authmode) {
  4559. len += WMI_TLV_HDR_SIZE;
  4560. len += ap_profile->profile.num_allowed_authmode *
  4561. sizeof(uint32_t);
  4562. } else {
  4563. len += WMI_TLV_HDR_SIZE;
  4564. }
  4565. buf = wmi_buf_alloc(wmi_handle, len);
  4566. if (!buf)
  4567. return QDF_STATUS_E_NOMEM;
  4568. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  4569. roam_ap_profile_fp = (wmi_roam_ap_profile_fixed_param *)buf_ptr;
  4570. WMITLV_SET_HDR(&roam_ap_profile_fp->tlv_header,
  4571. WMITLV_TAG_STRUC_wmi_roam_ap_profile_fixed_param,
  4572. WMITLV_GET_STRUCT_TLVLEN
  4573. (wmi_roam_ap_profile_fixed_param));
  4574. /* fill in threshold values */
  4575. roam_ap_profile_fp->vdev_id = ap_profile->vdev_id;
  4576. roam_ap_profile_fp->id = 0;
  4577. buf_ptr += sizeof(wmi_roam_ap_profile_fixed_param);
  4578. profile = (wmi_ap_profile *)buf_ptr;
  4579. WMITLV_SET_HDR(&profile->tlv_header,
  4580. WMITLV_TAG_STRUC_wmi_ap_profile,
  4581. WMITLV_GET_STRUCT_TLVLEN(wmi_ap_profile));
  4582. profile->flags = ap_profile->profile.flags;
  4583. profile->rssi_threshold = ap_profile->profile.rssi_threshold;
  4584. profile->bg_rssi_threshold = ap_profile->profile.bg_rssi_threshold;
  4585. profile->ssid.ssid_len = ap_profile->profile.ssid.length;
  4586. qdf_mem_copy(profile->ssid.ssid, ap_profile->profile.ssid.ssid,
  4587. profile->ssid.ssid_len);
  4588. profile->rsn_authmode = ap_profile->profile.rsn_authmode;
  4589. profile->rsn_ucastcipherset = ap_profile->profile.rsn_ucastcipherset;
  4590. profile->rsn_mcastcipherset = ap_profile->profile.rsn_mcastcipherset;
  4591. profile->rsn_mcastmgmtcipherset =
  4592. ap_profile->profile.rsn_mcastmgmtcipherset;
  4593. profile->rssi_abs_thresh = ap_profile->profile.rssi_abs_thresh;
  4594. wmi_debug("vdev %d AP PROFILE: flags:%x rssi_thres:%d bg_rssi_thres:%d ssid:" QDF_SSID_FMT " authmode:%d uc cipher:%d mc cipher:%d mc mgmt cipher:%d rssi abs thresh:%d",
  4595. roam_ap_profile_fp->vdev_id,
  4596. profile->flags, profile->rssi_threshold,
  4597. profile->bg_rssi_threshold,
  4598. QDF_SSID_REF(profile->ssid.ssid_len,
  4599. ap_profile->profile.ssid.ssid),
  4600. profile->rsn_authmode, profile->rsn_ucastcipherset,
  4601. profile->rsn_mcastcipherset, profile->rsn_mcastmgmtcipherset,
  4602. profile->rssi_abs_thresh);
  4603. buf_ptr += sizeof(wmi_ap_profile);
  4604. score_param = (wmi_roam_cnd_scoring_param *)buf_ptr;
  4605. WMITLV_SET_HDR(&score_param->tlv_header,
  4606. WMITLV_TAG_STRUC_wmi_roam_cnd_scoring_param,
  4607. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_scoring_param));
  4608. score_param->disable_bitmap = ap_profile->param.disable_bitmap;
  4609. score_param->rssi_weightage_pcnt =
  4610. ap_profile->param.rssi_weightage;
  4611. score_param->ht_weightage_pcnt = ap_profile->param.ht_weightage;
  4612. score_param->vht_weightage_pcnt = ap_profile->param.vht_weightage;
  4613. score_param->he_weightage_pcnt = ap_profile->param.he_weightage;
  4614. score_param->bw_weightage_pcnt = ap_profile->param.bw_weightage;
  4615. score_param->band_weightage_pcnt = ap_profile->param.band_weightage;
  4616. score_param->nss_weightage_pcnt = ap_profile->param.nss_weightage;
  4617. score_param->security_weightage_pcnt =
  4618. ap_profile->param.security_weightage;
  4619. score_param->esp_qbss_weightage_pcnt =
  4620. ap_profile->param.esp_qbss_weightage;
  4621. score_param->beamforming_weightage_pcnt =
  4622. ap_profile->param.beamforming_weightage;
  4623. score_param->pcl_weightage_pcnt = ap_profile->param.pcl_weightage;
  4624. score_param->oce_wan_weightage_pcnt =
  4625. ap_profile->param.oce_wan_weightage;
  4626. score_param->oce_ap_tx_pwr_weightage_pcnt =
  4627. ap_profile->param.oce_ap_tx_pwr_weightage;
  4628. score_param->oce_ap_subnet_id_weightage_pcnt =
  4629. ap_profile->param.oce_subnet_id_weightage;
  4630. score_param->vendor_roam_score_algorithm_id =
  4631. ap_profile->param.vendor_roam_score_algorithm;
  4632. score_param->sae_pk_ap_weightage_pcnt =
  4633. ap_profile->param.sae_pk_ap_weightage;
  4634. update_mlo_prefer_percentage(wmi_handle->soc->wmi_psoc,
  4635. &mlo_prefer_percentage);
  4636. score_param->mlo_etp_weightage_pcnt = mlo_prefer_percentage;
  4637. send_update_mlo_roam_params(score_param, ap_profile);
  4638. wmi_debug("Score params weightage: disable_bitmap %x rssi %d ht %d vht %d he %d BW %d band %d NSS %d ESP %d BF %d PCL %d OCE WAN %d APTX %d roam score algo %d subnet id %d sae-pk %d security %d mlo_etp_weight_pct %d",
  4639. score_param->disable_bitmap, score_param->rssi_weightage_pcnt,
  4640. score_param->ht_weightage_pcnt,
  4641. score_param->vht_weightage_pcnt,
  4642. score_param->he_weightage_pcnt,
  4643. score_param->bw_weightage_pcnt,
  4644. score_param->band_weightage_pcnt,
  4645. score_param->nss_weightage_pcnt,
  4646. score_param->esp_qbss_weightage_pcnt,
  4647. score_param->beamforming_weightage_pcnt,
  4648. score_param->pcl_weightage_pcnt,
  4649. score_param->oce_wan_weightage_pcnt,
  4650. score_param->oce_ap_tx_pwr_weightage_pcnt,
  4651. score_param->vendor_roam_score_algorithm_id,
  4652. score_param->oce_ap_subnet_id_weightage_pcnt,
  4653. score_param->sae_pk_ap_weightage_pcnt,
  4654. score_param->security_weightage_pcnt,
  4655. score_param->mlo_etp_weightage_pcnt);
  4656. score_param->bw_scoring.score_pcnt = ap_profile->param.bw_index_score;
  4657. score_param->band_scoring.score_pcnt =
  4658. ap_profile->param.band_index_score;
  4659. score_param->nss_scoring.score_pcnt =
  4660. ap_profile->param.nss_index_score;
  4661. score_param->security_scoring.score_pcnt =
  4662. ap_profile->param.security_index_score;
  4663. wmi_debug("bw_index_score %x band_index_score %x nss_index_score %x security_index_score %x",
  4664. score_param->bw_scoring.score_pcnt,
  4665. score_param->band_scoring.score_pcnt,
  4666. score_param->nss_scoring.score_pcnt,
  4667. score_param->security_scoring.score_pcnt);
  4668. score_param->rssi_scoring.best_rssi_threshold =
  4669. (-1) * ap_profile->param.rssi_scoring.best_rssi_threshold;
  4670. score_param->rssi_scoring.good_rssi_threshold =
  4671. (-1) * ap_profile->param.rssi_scoring.good_rssi_threshold;
  4672. score_param->rssi_scoring.bad_rssi_threshold =
  4673. (-1) * ap_profile->param.rssi_scoring.bad_rssi_threshold;
  4674. score_param->rssi_scoring.good_rssi_pcnt =
  4675. ap_profile->param.rssi_scoring.good_rssi_pcnt;
  4676. score_param->rssi_scoring.bad_rssi_pcnt =
  4677. ap_profile->param.rssi_scoring.bad_rssi_pcnt;
  4678. score_param->rssi_scoring.good_bucket_size =
  4679. ap_profile->param.rssi_scoring.good_rssi_bucket_size;
  4680. score_param->rssi_scoring.bad_bucket_size =
  4681. ap_profile->param.rssi_scoring.bad_rssi_bucket_size;
  4682. score_param->rssi_scoring.rssi_pref_5g_rssi_thresh =
  4683. (-1) * ap_profile->param.rssi_scoring.rssi_pref_5g_rssi_thresh;
  4684. wmi_debug("Rssi scoring threshold: best RSSI %d good RSSI %d bad RSSI %d prefer 5g threshold %d",
  4685. score_param->rssi_scoring.best_rssi_threshold,
  4686. score_param->rssi_scoring.good_rssi_threshold,
  4687. score_param->rssi_scoring.bad_rssi_threshold,
  4688. score_param->rssi_scoring.rssi_pref_5g_rssi_thresh);
  4689. wmi_debug("Good RSSI score for each slot %d bad RSSI score for each slot %d good bucket %d bad bucket %d",
  4690. score_param->rssi_scoring.good_rssi_pcnt,
  4691. score_param->rssi_scoring.bad_rssi_pcnt,
  4692. score_param->rssi_scoring.good_bucket_size,
  4693. score_param->rssi_scoring.bad_bucket_size);
  4694. score_param->esp_qbss_scoring.num_slot =
  4695. ap_profile->param.esp_qbss_scoring.num_slot;
  4696. score_param->esp_qbss_scoring.score_pcnt3_to_0 =
  4697. ap_profile->param.esp_qbss_scoring.score_pcnt3_to_0;
  4698. score_param->esp_qbss_scoring.score_pcnt7_to_4 =
  4699. ap_profile->param.esp_qbss_scoring.score_pcnt7_to_4;
  4700. score_param->esp_qbss_scoring.score_pcnt11_to_8 =
  4701. ap_profile->param.esp_qbss_scoring.score_pcnt11_to_8;
  4702. score_param->esp_qbss_scoring.score_pcnt15_to_12 =
  4703. ap_profile->param.esp_qbss_scoring.score_pcnt15_to_12;
  4704. wmi_debug("ESP QBSS index weight: slots %d weight 0to3 %x weight 4to7 %x weight 8to11 %x weight 12to15 %x",
  4705. score_param->esp_qbss_scoring.num_slot,
  4706. score_param->esp_qbss_scoring.score_pcnt3_to_0,
  4707. score_param->esp_qbss_scoring.score_pcnt7_to_4,
  4708. score_param->esp_qbss_scoring.score_pcnt11_to_8,
  4709. score_param->esp_qbss_scoring.score_pcnt15_to_12);
  4710. score_param->oce_wan_scoring.num_slot =
  4711. ap_profile->param.oce_wan_scoring.num_slot;
  4712. score_param->oce_wan_scoring.score_pcnt3_to_0 =
  4713. ap_profile->param.oce_wan_scoring.score_pcnt3_to_0;
  4714. score_param->oce_wan_scoring.score_pcnt7_to_4 =
  4715. ap_profile->param.oce_wan_scoring.score_pcnt7_to_4;
  4716. score_param->oce_wan_scoring.score_pcnt11_to_8 =
  4717. ap_profile->param.oce_wan_scoring.score_pcnt11_to_8;
  4718. score_param->oce_wan_scoring.score_pcnt15_to_12 =
  4719. ap_profile->param.oce_wan_scoring.score_pcnt15_to_12;
  4720. wmi_debug("OCE WAN index weight: slots %d weight 0to3 %x weight 4to7 %x weight 8to11 %x weight 12to15 %x",
  4721. score_param->oce_wan_scoring.num_slot,
  4722. score_param->oce_wan_scoring.score_pcnt3_to_0,
  4723. score_param->oce_wan_scoring.score_pcnt7_to_4,
  4724. score_param->oce_wan_scoring.score_pcnt11_to_8,
  4725. score_param->oce_wan_scoring.score_pcnt15_to_12);
  4726. score_param->roam_score_delta_pcnt = ap_profile->param.roam_score_delta;
  4727. score_param->roam_score_delta_mask =
  4728. ap_profile->param.roam_trigger_bitmap;
  4729. score_param->candidate_min_roam_score_delta =
  4730. ap_profile->param.cand_min_roam_score_delta;
  4731. wmi_debug("Roam score delta:%d Roam_trigger_bitmap:%x cand min score delta = %d",
  4732. score_param->roam_score_delta_pcnt,
  4733. score_param->roam_score_delta_mask,
  4734. score_param->candidate_min_roam_score_delta);
  4735. buf_ptr += sizeof(*score_param);
  4736. if (!wmi_service_enabled(wmi_handle,
  4737. wmi_service_configure_roam_trigger_param_support)) {
  4738. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  4739. (NUM_OF_ROAM_TRIGGERS * sizeof(*score_delta_param)));
  4740. buf_ptr += WMI_TLV_HDR_SIZE;
  4741. score_delta_param = (wmi_roam_score_delta_param *)buf_ptr;
  4742. WMITLV_SET_HDR(&score_delta_param->tlv_header,
  4743. WMITLV_TAG_STRUC_wmi_roam_score_delta_param,
  4744. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_score_delta_param));
  4745. trig_reason =
  4746. ap_profile->score_delta_param[IDLE_ROAM_TRIGGER].trigger_reason;
  4747. score_delta_param->roam_trigger_reason =
  4748. convert_roam_trigger_reason(trig_reason);
  4749. score_delta_param->roam_score_delta =
  4750. ap_profile->score_delta_param[IDLE_ROAM_TRIGGER].roam_score_delta;
  4751. buf_ptr += sizeof(*score_delta_param);
  4752. score_delta_param = (wmi_roam_score_delta_param *)buf_ptr;
  4753. WMITLV_SET_HDR(&score_delta_param->tlv_header,
  4754. WMITLV_TAG_STRUC_wmi_roam_score_delta_param,
  4755. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_score_delta_param));
  4756. trig_reason =
  4757. ap_profile->score_delta_param[BTM_ROAM_TRIGGER].trigger_reason;
  4758. score_delta_param->roam_trigger_reason =
  4759. convert_roam_trigger_reason(trig_reason);
  4760. score_delta_param->roam_score_delta =
  4761. ap_profile->score_delta_param[BTM_ROAM_TRIGGER].roam_score_delta;
  4762. buf_ptr += sizeof(*score_delta_param);
  4763. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  4764. (NUM_OF_ROAM_MIN_RSSI * sizeof(*min_rssi_param)));
  4765. buf_ptr += WMI_TLV_HDR_SIZE;
  4766. min_rssi_param = (wmi_roam_cnd_min_rssi_param *)buf_ptr;
  4767. WMITLV_SET_HDR(&min_rssi_param->tlv_header,
  4768. WMITLV_TAG_STRUC_wmi_roam_cnd_min_rssi_param,
  4769. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_min_rssi_param));
  4770. trig_reason =
  4771. ap_profile->min_rssi_params[DEAUTH_MIN_RSSI].trigger_reason;
  4772. min_rssi_param->roam_trigger_reason =
  4773. convert_roam_trigger_reason(trig_reason);
  4774. min_rssi_param->candidate_min_rssi =
  4775. ap_profile->min_rssi_params[DEAUTH_MIN_RSSI].min_rssi;
  4776. buf_ptr += sizeof(*min_rssi_param);
  4777. min_rssi_param = (wmi_roam_cnd_min_rssi_param *)buf_ptr;
  4778. WMITLV_SET_HDR(&min_rssi_param->tlv_header,
  4779. WMITLV_TAG_STRUC_wmi_roam_cnd_min_rssi_param,
  4780. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_min_rssi_param));
  4781. trig_reason =
  4782. ap_profile->min_rssi_params[BMISS_MIN_RSSI].trigger_reason;
  4783. min_rssi_param->roam_trigger_reason =
  4784. convert_roam_trigger_reason(trig_reason);
  4785. min_rssi_param->candidate_min_rssi =
  4786. ap_profile->min_rssi_params[BMISS_MIN_RSSI].min_rssi;
  4787. buf_ptr += sizeof(*min_rssi_param);
  4788. min_rssi_param = (wmi_roam_cnd_min_rssi_param *)buf_ptr;
  4789. WMITLV_SET_HDR(&min_rssi_param->tlv_header,
  4790. WMITLV_TAG_STRUC_wmi_roam_cnd_min_rssi_param,
  4791. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_min_rssi_param));
  4792. trig_reason =
  4793. ap_profile->min_rssi_params[MIN_RSSI_2G_TO_5G_ROAM].trigger_reason;
  4794. min_rssi_param->roam_trigger_reason =
  4795. convert_roam_trigger_reason(trig_reason);
  4796. min_rssi_param->candidate_min_rssi =
  4797. ap_profile->min_rssi_params[MIN_RSSI_2G_TO_5G_ROAM].min_rssi;
  4798. buf_ptr += sizeof(*min_rssi_param);
  4799. } else {
  4800. /* set zero TLV's for roam_score_delta_param_list */
  4801. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  4802. WMITLV_GET_STRUCT_TLVLEN(0));
  4803. buf_ptr += WMI_TLV_HDR_SIZE;
  4804. /* set zero TLV's for roam_cnd_min_rssi_param_list */
  4805. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  4806. WMITLV_GET_STRUCT_TLVLEN(0));
  4807. buf_ptr += WMI_TLV_HDR_SIZE;
  4808. }
  4809. /* set zero TLV's for roam_cnd_vendor_scoring_param */
  4810. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  4811. WMITLV_GET_STRUCT_TLVLEN(0));
  4812. buf_ptr += WMI_TLV_HDR_SIZE;
  4813. if (ap_profile->owe_ap_profile.is_owe_transition_conn) {
  4814. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  4815. sizeof(*owe_ap_profile));
  4816. buf_ptr += WMI_TLV_HDR_SIZE;
  4817. owe_ap_profile = (wmi_owe_ap_profile *)buf_ptr;
  4818. ssid = &owe_ap_profile->open_ssid_for_owe_transition;
  4819. WMITLV_SET_HDR(&owe_ap_profile->tlv_header,
  4820. WMITLV_TAG_STRUC_wmi_owe_ap_profile,
  4821. WMITLV_GET_STRUCT_TLVLEN(wmi_owe_ap_profile));
  4822. ssid->ssid_len = ap_profile->owe_ap_profile.ssid.length;
  4823. qdf_mem_copy(ssid->ssid,
  4824. ap_profile->owe_ap_profile.ssid.ssid,
  4825. ap_profile->owe_ap_profile.ssid.length);
  4826. wmi_debug("[OWE_TRANSITION]: open ssid:" QDF_SSID_FMT,
  4827. QDF_SSID_REF(ssid->ssid_len, (char *)ssid->ssid));
  4828. buf_ptr += sizeof(*owe_ap_profile);
  4829. } else {
  4830. /* set zero TLV's for owe_ap_profile */
  4831. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  4832. WMITLV_GET_STRUCT_TLVLEN(0));
  4833. buf_ptr += WMI_TLV_HDR_SIZE;
  4834. }
  4835. /* List of Allowed authmode other than the connected akm */
  4836. if (ap_profile->profile.num_allowed_authmode) {
  4837. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  4838. (ap_profile->profile.num_allowed_authmode *
  4839. sizeof(uint32_t)));
  4840. buf_ptr += WMI_TLV_HDR_SIZE;
  4841. authmode_list = (uint32_t *)buf_ptr;
  4842. for (i = 0; i < ap_profile->profile.num_allowed_authmode; i++)
  4843. authmode_list[i] =
  4844. ap_profile->profile.allowed_authmode[i];
  4845. wmi_debug("[Allowed Authmode]: num_allowed_authmode: %d",
  4846. ap_profile->profile.num_allowed_authmode);
  4847. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
  4848. authmode_list,
  4849. ap_profile->profile.num_allowed_authmode *
  4850. sizeof(uint32_t));
  4851. } else {
  4852. /* set zero TLV's for allowed_authmode */
  4853. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  4854. WMITLV_GET_STRUCT_TLVLEN(0));
  4855. buf_ptr += WMI_TLV_HDR_SIZE;
  4856. }
  4857. wmi_mtrace(WMI_ROAM_AP_PROFILE, NO_SESSION, 0);
  4858. status = wmi_unified_cmd_send(wmi_handle, buf,
  4859. len, WMI_ROAM_AP_PROFILE);
  4860. if (QDF_IS_STATUS_ERROR(status))
  4861. wmi_buf_free(buf);
  4862. return status;
  4863. }
  4864. /**
  4865. * send_roam_scan_offload_cmd_tlv() - set roam offload command
  4866. * @wmi_handle: wmi handle
  4867. * @command: command
  4868. * @vdev_id: vdev id
  4869. *
  4870. * This function set roam offload command to fw.
  4871. *
  4872. * Return: QDF status
  4873. */
  4874. static QDF_STATUS
  4875. send_roam_scan_offload_cmd_tlv(wmi_unified_t wmi_handle,
  4876. uint32_t command, uint32_t vdev_id)
  4877. {
  4878. QDF_STATUS status;
  4879. wmi_roam_scan_cmd_fixed_param *cmd_fp;
  4880. wmi_buf_t buf = NULL;
  4881. int len;
  4882. uint8_t *buf_ptr;
  4883. len = sizeof(wmi_roam_scan_cmd_fixed_param);
  4884. buf = wmi_buf_alloc(wmi_handle, len);
  4885. if (!buf)
  4886. return QDF_STATUS_E_NOMEM;
  4887. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  4888. cmd_fp = (wmi_roam_scan_cmd_fixed_param *)buf_ptr;
  4889. WMITLV_SET_HDR(&cmd_fp->tlv_header,
  4890. WMITLV_TAG_STRUC_wmi_roam_scan_cmd_fixed_param,
  4891. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_scan_cmd_fixed_param));
  4892. cmd_fp->vdev_id = vdev_id;
  4893. cmd_fp->command_arg = command;
  4894. wmi_mtrace(WMI_ROAM_SCAN_CMD, NO_SESSION, 0);
  4895. status = wmi_unified_cmd_send(wmi_handle, buf,
  4896. len, WMI_ROAM_SCAN_CMD);
  4897. if (QDF_IS_STATUS_ERROR(status))
  4898. goto error;
  4899. wmi_info("WMI --> WMI_ROAM_SCAN_CMD");
  4900. return QDF_STATUS_SUCCESS;
  4901. error:
  4902. wmi_buf_free(buf);
  4903. return status;
  4904. }
  4905. /**
  4906. * send_roam_scan_offload_chan_list_cmd_tlv() - set roam offload channel list
  4907. * @wmi_handle: wmi handle
  4908. * @rso_ch_info: Roam offload channel information
  4909. *
  4910. * Set roam offload channel list.
  4911. *
  4912. * Return: QDF status
  4913. */
  4914. static QDF_STATUS send_roam_scan_offload_chan_list_cmd_tlv(
  4915. wmi_unified_t wmi_handle,
  4916. struct wlan_roam_scan_channel_list *rso_ch_info)
  4917. {
  4918. wmi_buf_t buf = NULL;
  4919. QDF_STATUS status;
  4920. int len, list_tlv_len;
  4921. int i;
  4922. uint8_t *buf_ptr;
  4923. wmi_roam_chan_list_fixed_param *chan_list_fp;
  4924. uint32_t *roam_chan_list_array;
  4925. uint8_t chan_count = rso_ch_info->chan_count;
  4926. uint32_t *chan_list = rso_ch_info->chan_freq_list;
  4927. /* Channel list is a table of 2 TLV's */
  4928. list_tlv_len = WMI_TLV_HDR_SIZE + chan_count * sizeof(uint32_t);
  4929. len = sizeof(wmi_roam_chan_list_fixed_param) + list_tlv_len;
  4930. buf = wmi_buf_alloc(wmi_handle, len);
  4931. if (!buf)
  4932. return QDF_STATUS_E_NOMEM;
  4933. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  4934. chan_list_fp = (wmi_roam_chan_list_fixed_param *)buf_ptr;
  4935. WMITLV_SET_HDR(&chan_list_fp->tlv_header,
  4936. WMITLV_TAG_STRUC_wmi_roam_chan_list_fixed_param,
  4937. WMITLV_GET_STRUCT_TLVLEN
  4938. (wmi_roam_chan_list_fixed_param));
  4939. chan_list_fp->vdev_id = rso_ch_info->vdev_id;
  4940. chan_list_fp->num_chan = chan_count;
  4941. if (rso_ch_info->chan_cache_type == WMI_CHANNEL_LIST_STATIC)
  4942. /* external app is controlling channel list */
  4943. chan_list_fp->chan_list_type =
  4944. WMI_ROAM_SCAN_CHAN_LIST_TYPE_STATIC;
  4945. else
  4946. /* umac supplied occupied channel list in LFR */
  4947. chan_list_fp->chan_list_type =
  4948. WMI_ROAM_SCAN_CHAN_LIST_TYPE_DYNAMIC;
  4949. buf_ptr += sizeof(wmi_roam_chan_list_fixed_param);
  4950. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  4951. (chan_list_fp->num_chan * sizeof(uint32_t)));
  4952. roam_chan_list_array = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
  4953. for (i = 0; ((i < chan_list_fp->num_chan) &&
  4954. (i < WMI_ROAM_MAX_CHANNELS)); i++)
  4955. roam_chan_list_array[i] = chan_list[i];
  4956. wmi_debug("RSO_CFG: vdev:%d num_chan:%d cache_type:%d",
  4957. chan_list_fp->vdev_id, chan_list_fp->num_chan,
  4958. rso_ch_info->chan_cache_type);
  4959. wmi_mtrace(WMI_ROAM_CHAN_LIST, NO_SESSION, 0);
  4960. status = wmi_unified_cmd_send(wmi_handle, buf,
  4961. len, WMI_ROAM_CHAN_LIST);
  4962. if (QDF_IS_STATUS_ERROR(status))
  4963. goto error;
  4964. return QDF_STATUS_SUCCESS;
  4965. error:
  4966. wmi_buf_free(buf);
  4967. return status;
  4968. }
  4969. /**
  4970. * send_roam_scan_offload_rssi_change_cmd_tlv() - set roam offload RSSI th
  4971. * @wmi_handle: wmi handle
  4972. * @params: RSSI change parameters
  4973. *
  4974. * Send WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD parameters to fw.
  4975. *
  4976. * Return: CDF status
  4977. */
  4978. static QDF_STATUS send_roam_scan_offload_rssi_change_cmd_tlv(
  4979. wmi_unified_t wmi_handle,
  4980. struct wlan_roam_rssi_change_params *params)
  4981. {
  4982. wmi_buf_t buf = NULL;
  4983. QDF_STATUS status;
  4984. int len;
  4985. uint8_t *buf_ptr;
  4986. wmi_roam_scan_rssi_change_threshold_fixed_param *rssi_change_fp;
  4987. /* Send rssi change parameters */
  4988. len = sizeof(wmi_roam_scan_rssi_change_threshold_fixed_param);
  4989. buf = wmi_buf_alloc(wmi_handle, len);
  4990. if (!buf)
  4991. return QDF_STATUS_E_NOMEM;
  4992. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  4993. rssi_change_fp =
  4994. (wmi_roam_scan_rssi_change_threshold_fixed_param *)buf_ptr;
  4995. WMITLV_SET_HDR(&rssi_change_fp->tlv_header,
  4996. WMITLV_TAG_STRUC_wmi_roam_scan_rssi_change_threshold_fixed_param,
  4997. WMITLV_GET_STRUCT_TLVLEN
  4998. (wmi_roam_scan_rssi_change_threshold_fixed_param));
  4999. /* fill in rssi change threshold (hysteresis) values */
  5000. rssi_change_fp->vdev_id = params->vdev_id;
  5001. rssi_change_fp->roam_scan_rssi_change_thresh =
  5002. params->rssi_change_thresh;
  5003. rssi_change_fp->bcn_rssi_weight = params->bcn_rssi_weight;
  5004. rssi_change_fp->hirssi_delay_btw_scans = params->hirssi_delay_btw_scans;
  5005. wmi_nofl_debug("RSO_CFG: vdev %d rssi_change_thresh:%d bcn_rssi_weight:%d hirssi_delay_btw_scans:%d",
  5006. rssi_change_fp->vdev_id,
  5007. rssi_change_fp->roam_scan_rssi_change_thresh,
  5008. rssi_change_fp->bcn_rssi_weight,
  5009. rssi_change_fp->hirssi_delay_btw_scans);
  5010. wmi_mtrace(WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD,
  5011. rssi_change_fp->vdev_id, 0);
  5012. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  5013. WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD);
  5014. if (QDF_IS_STATUS_ERROR(status))
  5015. goto error;
  5016. return QDF_STATUS_SUCCESS;
  5017. error:
  5018. wmi_buf_free(buf);
  5019. return status;
  5020. }
  5021. /**
  5022. * send_per_roam_config_cmd_tlv() - set per roaming config to FW
  5023. * @wmi_handle: wmi handle
  5024. * @req_buf: per roam config buffer
  5025. *
  5026. * Return: QDF status
  5027. */
  5028. static QDF_STATUS
  5029. send_per_roam_config_cmd_tlv(wmi_unified_t wmi_handle,
  5030. struct wlan_per_roam_config_req *req_buf)
  5031. {
  5032. wmi_buf_t buf = NULL;
  5033. QDF_STATUS status;
  5034. int len;
  5035. uint8_t *buf_ptr;
  5036. wmi_roam_per_config_fixed_param *wmi_per_config;
  5037. len = sizeof(wmi_roam_per_config_fixed_param);
  5038. buf = wmi_buf_alloc(wmi_handle, len);
  5039. if (!buf)
  5040. return QDF_STATUS_E_NOMEM;
  5041. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  5042. wmi_per_config =
  5043. (wmi_roam_per_config_fixed_param *)buf_ptr;
  5044. WMITLV_SET_HDR(&wmi_per_config->tlv_header,
  5045. WMITLV_TAG_STRUC_wmi_roam_per_config_fixed_param,
  5046. WMITLV_GET_STRUCT_TLVLEN
  5047. (wmi_roam_per_config_fixed_param));
  5048. /* fill in per roam config values */
  5049. wmi_per_config->vdev_id = req_buf->vdev_id;
  5050. wmi_per_config->enable = req_buf->per_config.enable;
  5051. wmi_per_config->high_rate_thresh =
  5052. (req_buf->per_config.tx_high_rate_thresh << 16) |
  5053. (req_buf->per_config.rx_high_rate_thresh & 0x0000ffff);
  5054. wmi_per_config->low_rate_thresh =
  5055. (req_buf->per_config.tx_low_rate_thresh << 16) |
  5056. (req_buf->per_config.rx_low_rate_thresh & 0x0000ffff);
  5057. wmi_per_config->pkt_err_rate_thresh_pct =
  5058. (req_buf->per_config.tx_rate_thresh_percnt << 16) |
  5059. (req_buf->per_config.rx_rate_thresh_percnt & 0x0000ffff);
  5060. wmi_per_config->per_rest_time = req_buf->per_config.per_rest_time;
  5061. wmi_per_config->pkt_err_rate_mon_time =
  5062. (req_buf->per_config.tx_per_mon_time << 16) |
  5063. (req_buf->per_config.rx_per_mon_time & 0x0000ffff);
  5064. wmi_per_config->min_candidate_rssi =
  5065. req_buf->per_config.min_candidate_rssi;
  5066. /* Send per roam config parameters */
  5067. wmi_mtrace(WMI_ROAM_PER_CONFIG_CMDID, NO_SESSION, 0);
  5068. status = wmi_unified_cmd_send(wmi_handle, buf,
  5069. len, WMI_ROAM_PER_CONFIG_CMDID);
  5070. if (QDF_IS_STATUS_ERROR(status)) {
  5071. wmi_err("WMI_ROAM_PER_CONFIG_CMDID failed, Error %d", status);
  5072. wmi_buf_free(buf);
  5073. return status;
  5074. }
  5075. wmi_debug("per roam enable=%d, vdev=%d",
  5076. req_buf->per_config.enable, req_buf->vdev_id);
  5077. return QDF_STATUS_SUCCESS;
  5078. }
  5079. /**
  5080. * send_limit_off_chan_cmd_tlv() - send wmi cmd of limit off chan
  5081. * configuration params
  5082. * @wmi_handle: wmi handler
  5083. * @limit_off_chan_param: pointer to wmi_off_chan_param
  5084. *
  5085. * Return: 0 for success and non zero for failure
  5086. */
  5087. static QDF_STATUS send_limit_off_chan_cmd_tlv(
  5088. wmi_unified_t wmi_handle,
  5089. struct wmi_limit_off_chan_param *limit_off_chan_param)
  5090. {
  5091. wmi_vdev_limit_offchan_cmd_fixed_param *cmd;
  5092. wmi_buf_t buf;
  5093. uint32_t len = sizeof(*cmd);
  5094. int err;
  5095. buf = wmi_buf_alloc(wmi_handle, len);
  5096. if (!buf)
  5097. return QDF_STATUS_E_NOMEM;
  5098. cmd = (wmi_vdev_limit_offchan_cmd_fixed_param *)wmi_buf_data(buf);
  5099. WMITLV_SET_HDR(&cmd->tlv_header,
  5100. WMITLV_TAG_STRUC_wmi_vdev_limit_offchan_cmd_fixed_param,
  5101. WMITLV_GET_STRUCT_TLVLEN(
  5102. wmi_vdev_limit_offchan_cmd_fixed_param));
  5103. cmd->vdev_id = limit_off_chan_param->vdev_id;
  5104. cmd->flags &= 0;
  5105. if (limit_off_chan_param->status)
  5106. cmd->flags |= WMI_VDEV_LIMIT_OFFCHAN_ENABLE;
  5107. if (limit_off_chan_param->skip_dfs_chans)
  5108. cmd->flags |= WMI_VDEV_LIMIT_OFFCHAN_SKIP_DFS;
  5109. cmd->max_offchan_time = limit_off_chan_param->max_offchan_time;
  5110. cmd->rest_time = limit_off_chan_param->rest_time;
  5111. wmi_debug("vdev_id=%d, flags =%x, max_offchan_time=%d, rest_time=%d",
  5112. cmd->vdev_id, cmd->flags, cmd->max_offchan_time,
  5113. cmd->rest_time);
  5114. wmi_mtrace(WMI_VDEV_LIMIT_OFFCHAN_CMDID, cmd->vdev_id, 0);
  5115. err = wmi_unified_cmd_send(wmi_handle, buf,
  5116. len, WMI_VDEV_LIMIT_OFFCHAN_CMDID);
  5117. if (QDF_IS_STATUS_ERROR(err)) {
  5118. wmi_err("Failed to send limit off chan cmd err=%d", err);
  5119. wmi_buf_free(buf);
  5120. return QDF_STATUS_E_FAILURE;
  5121. }
  5122. return QDF_STATUS_SUCCESS;
  5123. }
  5124. #ifdef WLAN_FEATURE_FILS_SK
  5125. static QDF_STATUS send_roam_scan_send_hlp_cmd_tlv(wmi_unified_t wmi_handle,
  5126. struct hlp_params *params)
  5127. {
  5128. uint32_t len;
  5129. uint8_t *buf_ptr;
  5130. wmi_buf_t buf = NULL;
  5131. wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param *hlp_params;
  5132. len = sizeof(wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param);
  5133. len += WMI_TLV_HDR_SIZE;
  5134. len += qdf_roundup(params->hlp_ie_len, sizeof(uint32_t));
  5135. buf = wmi_buf_alloc(wmi_handle, len);
  5136. if (!buf)
  5137. return QDF_STATUS_E_NOMEM;
  5138. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  5139. hlp_params = (wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param *)buf_ptr;
  5140. WMITLV_SET_HDR(&hlp_params->tlv_header,
  5141. WMITLV_TAG_STRUC_wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param,
  5142. WMITLV_GET_STRUCT_TLVLEN(
  5143. wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param));
  5144. hlp_params->vdev_id = params->vdev_id;
  5145. hlp_params->size = params->hlp_ie_len;
  5146. hlp_params->pkt_type = WMI_FILS_HLP_PKT_TYPE_DHCP_DISCOVER;
  5147. buf_ptr += sizeof(*hlp_params);
  5148. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE,
  5149. round_up(params->hlp_ie_len, sizeof(uint32_t)));
  5150. buf_ptr += WMI_TLV_HDR_SIZE;
  5151. qdf_mem_copy(buf_ptr, params->hlp_ie, params->hlp_ie_len);
  5152. wmi_debug("send FILS HLP pkt vdev %d len %d",
  5153. hlp_params->vdev_id, hlp_params->size);
  5154. wmi_mtrace(WMI_PDEV_UPDATE_FILS_HLP_PKT_CMDID, NO_SESSION, 0);
  5155. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  5156. WMI_PDEV_UPDATE_FILS_HLP_PKT_CMDID)) {
  5157. wmi_err("Failed to send FILS HLP pkt cmd");
  5158. wmi_buf_free(buf);
  5159. return QDF_STATUS_E_FAILURE;
  5160. }
  5161. return QDF_STATUS_SUCCESS;
  5162. }
  5163. void wmi_fils_sk_attach_tlv(wmi_unified_t wmi_handle)
  5164. {
  5165. struct wmi_ops *ops = wmi_handle->ops;
  5166. ops->send_roam_scan_hlp_cmd = send_roam_scan_send_hlp_cmd_tlv;
  5167. }
  5168. #endif /* WLAN_FEATURE_FILS_SK */
  5169. /*
  5170. * send_btm_config_cmd_tlv() - Send wmi cmd for BTM config
  5171. * @wmi_handle: wmi handle
  5172. * @params: pointer to wlan_roam_btm_config
  5173. *
  5174. * Return: QDF_STATUS
  5175. */
  5176. static QDF_STATUS send_btm_config_cmd_tlv(wmi_unified_t wmi_handle,
  5177. struct wlan_roam_btm_config *params)
  5178. {
  5179. wmi_btm_config_fixed_param *cmd;
  5180. wmi_buf_t buf;
  5181. uint32_t len;
  5182. len = sizeof(*cmd);
  5183. buf = wmi_buf_alloc(wmi_handle, len);
  5184. if (!buf)
  5185. return QDF_STATUS_E_NOMEM;
  5186. cmd = (wmi_btm_config_fixed_param *)wmi_buf_data(buf);
  5187. WMITLV_SET_HDR(&cmd->tlv_header,
  5188. WMITLV_TAG_STRUC_wmi_btm_config_fixed_param,
  5189. WMITLV_GET_STRUCT_TLVLEN(wmi_btm_config_fixed_param));
  5190. cmd->vdev_id = params->vdev_id;
  5191. cmd->flags = params->btm_offload_config;
  5192. cmd->max_attempt_cnt = params->btm_max_attempt_cnt;
  5193. cmd->solicited_timeout_ms = params->btm_solicited_timeout;
  5194. cmd->stick_time_seconds = params->btm_sticky_time;
  5195. cmd->disassoc_timer_threshold = params->disassoc_timer_threshold;
  5196. cmd->btm_bitmap = params->btm_query_bitmask;
  5197. cmd->btm_candidate_min_score = params->btm_candidate_min_score;
  5198. wmi_debug("RSO_CFG: vdev_id:%u btm_offload:%u btm_query_bitmask:%u btm_candidate_min_score:%u",
  5199. cmd->vdev_id, cmd->flags, cmd->btm_bitmap,
  5200. cmd->btm_candidate_min_score);
  5201. wmi_debug("RSO_CFG: btm_solicited_timeout:%u btm_max_attempt_cnt:%u btm_sticky_time:%u disassoc_timer_threshold:%u",
  5202. cmd->solicited_timeout_ms, cmd->max_attempt_cnt,
  5203. cmd->stick_time_seconds, cmd->disassoc_timer_threshold);
  5204. wmi_mtrace(WMI_ROAM_BTM_CONFIG_CMDID, cmd->vdev_id, 0);
  5205. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  5206. WMI_ROAM_BTM_CONFIG_CMDID)) {
  5207. wmi_err("Failed to send WMI_ROAM_BTM_CONFIG_CMDID");
  5208. wmi_buf_free(buf);
  5209. return QDF_STATUS_E_FAILURE;
  5210. }
  5211. return QDF_STATUS_SUCCESS;
  5212. }
  5213. /**
  5214. * send_roam_bss_load_config_tlv() - send roam load bss trigger configuration
  5215. * @wmi_handle: wmi handle
  5216. * @params: pointer to wlan_roam_bss_load_config
  5217. *
  5218. * This function sends the roam load bss trigger configuration to fw.
  5219. * the bss_load_threshold parameter is used to configure the maximum
  5220. * bss load percentage, above which the firmware should trigger roaming
  5221. *
  5222. * Return: QDF status
  5223. */
  5224. static QDF_STATUS
  5225. send_roam_bss_load_config_tlv(wmi_unified_t wmi_handle,
  5226. struct wlan_roam_bss_load_config *params)
  5227. {
  5228. wmi_roam_bss_load_config_cmd_fixed_param *cmd;
  5229. wmi_buf_t buf;
  5230. uint32_t len;
  5231. len = sizeof(*cmd);
  5232. buf = wmi_buf_alloc(wmi_handle, len);
  5233. if (!buf)
  5234. return QDF_STATUS_E_NOMEM;
  5235. cmd = (wmi_roam_bss_load_config_cmd_fixed_param *)wmi_buf_data(buf);
  5236. WMITLV_SET_HDR(
  5237. &cmd->tlv_header,
  5238. WMITLV_TAG_STRUC_wmi_roam_bss_load_config_cmd_fixed_param,
  5239. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_bss_load_config_cmd_fixed_param));
  5240. cmd->vdev_id = params->vdev_id;
  5241. cmd->bss_load_threshold = params->bss_load_threshold;
  5242. cmd->monitor_time_window = params->bss_load_sample_time;
  5243. cmd->rssi_2g_threshold = params->rssi_threshold_24ghz;
  5244. cmd->rssi_5g_threshold = params->rssi_threshold_5ghz;
  5245. cmd->rssi_6g_threshold = params->rssi_threshold_6ghz;
  5246. wmi_debug("RSO_CFG: vdev:%d bss_load_thres:%d monitor_time:%d rssi_2g:%d rssi_5g:%d, rssi_6g:%d",
  5247. cmd->vdev_id, cmd->bss_load_threshold,
  5248. cmd->monitor_time_window, cmd->rssi_2g_threshold,
  5249. cmd->rssi_5g_threshold, cmd->rssi_6g_threshold);
  5250. wmi_mtrace(WMI_ROAM_BSS_LOAD_CONFIG_CMDID, cmd->vdev_id, 0);
  5251. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  5252. WMI_ROAM_BSS_LOAD_CONFIG_CMDID)) {
  5253. wmi_err("Failed to send WMI_ROAM_BSS_LOAD_CONFIG_CMDID");
  5254. wmi_buf_free(buf);
  5255. return QDF_STATUS_E_FAILURE;
  5256. }
  5257. return QDF_STATUS_SUCCESS;
  5258. }
  5259. #ifdef WLAN_FEATURE_ROAM_OFFLOAD
  5260. /**
  5261. * send_disconnect_roam_params_tlv() - send disconnect roam trigger parameters
  5262. * @wmi_handle: wmi handle
  5263. * @req: pointer to wlan_roam_disconnect_params which carries the
  5264. * disconnect_roam_trigger parameters
  5265. *
  5266. * This function sends the disconnect roam trigger parameters to fw.
  5267. *
  5268. * Return: QDF status
  5269. */
  5270. static QDF_STATUS
  5271. send_disconnect_roam_params_tlv(wmi_unified_t wmi_handle,
  5272. struct wlan_roam_disconnect_params *req)
  5273. {
  5274. wmi_roam_deauth_config_cmd_fixed_param *cmd;
  5275. wmi_buf_t buf;
  5276. uint32_t len;
  5277. len = sizeof(*cmd);
  5278. buf = wmi_buf_alloc(wmi_handle, len);
  5279. if (!buf)
  5280. return QDF_STATUS_E_NOMEM;
  5281. cmd = (wmi_roam_deauth_config_cmd_fixed_param *)wmi_buf_data(buf);
  5282. WMITLV_SET_HDR(
  5283. &cmd->tlv_header,
  5284. WMITLV_TAG_STRUC_wmi_roam_deauth_config_cmd_fixed_param,
  5285. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_deauth_config_cmd_fixed_param));
  5286. cmd->vdev_id = req->vdev_id;
  5287. cmd->enable = req->enable;
  5288. wmi_debug("RSO_CFG: vdev_id:%d enable:%d", cmd->vdev_id, cmd->enable);
  5289. wmi_mtrace(WMI_ROAM_DEAUTH_CONFIG_CMDID, cmd->vdev_id, 0);
  5290. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  5291. WMI_ROAM_DEAUTH_CONFIG_CMDID)) {
  5292. wmi_err("Failed to send WMI_ROAM_DEAUTH_CONFIG_CMDID");
  5293. wmi_buf_free(buf);
  5294. return QDF_STATUS_E_FAILURE;
  5295. }
  5296. return QDF_STATUS_SUCCESS;
  5297. }
  5298. #define WLAN_TIME_IN_MS 1000
  5299. /**
  5300. * send_idle_roam_params_tlv() - send idle roam trigger parameters
  5301. * @wmi_handle: wmi handle
  5302. * @idle_roam_params: pointer to wlan_roam_idle_params which carries the
  5303. * idle roam parameters from CSR
  5304. *
  5305. * This function sends the idle roam trigger parameters to fw.
  5306. *
  5307. * Return: QDF status
  5308. */
  5309. static QDF_STATUS
  5310. send_idle_roam_params_tlv(wmi_unified_t wmi_handle,
  5311. struct wlan_roam_idle_params *idle_roam_params)
  5312. {
  5313. wmi_roam_idle_config_cmd_fixed_param *cmd;
  5314. wmi_buf_t buf;
  5315. uint32_t len;
  5316. len = sizeof(*cmd);
  5317. buf = wmi_buf_alloc(wmi_handle, len);
  5318. if (!buf)
  5319. return QDF_STATUS_E_NOMEM;
  5320. cmd = (wmi_roam_idle_config_cmd_fixed_param *)wmi_buf_data(buf);
  5321. WMITLV_SET_HDR(
  5322. &cmd->tlv_header,
  5323. WMITLV_TAG_STRUC_wmi_roam_idle_config_cmd_fixed_param,
  5324. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_idle_config_cmd_fixed_param));
  5325. cmd->vdev_id = idle_roam_params->vdev_id;
  5326. cmd->enable = idle_roam_params->enable;
  5327. cmd->band = idle_roam_params->band;
  5328. cmd->rssi_delta = idle_roam_params->conn_ap_rssi_delta;
  5329. cmd->min_rssi = idle_roam_params->conn_ap_min_rssi;
  5330. cmd->idle_time = idle_roam_params->inactive_time / WLAN_TIME_IN_MS;
  5331. cmd->data_packet_count = idle_roam_params->data_pkt_count;
  5332. wmi_debug("RSO_CFG: vdev_id:%d enable:%d band:%d rssi_delta:%d min_rssi:%d idle_time:%d data_pkt:%d",
  5333. cmd->vdev_id, cmd->enable,
  5334. cmd->band, cmd->rssi_delta, cmd->min_rssi,
  5335. cmd->idle_time, cmd->data_packet_count);
  5336. wmi_mtrace(WMI_ROAM_IDLE_CONFIG_CMDID, cmd->vdev_id, 0);
  5337. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  5338. WMI_ROAM_IDLE_CONFIG_CMDID)) {
  5339. wmi_err("Failed to send WMI_ROAM_IDLE_CONFIG_CMDID");
  5340. wmi_buf_free(buf);
  5341. return QDF_STATUS_E_FAILURE;
  5342. }
  5343. return QDF_STATUS_SUCCESS;
  5344. }
  5345. /**
  5346. * send_roam_preauth_status_tlv() - send roam pre-authentication status
  5347. * @wmi_handle: wmi handle
  5348. * @params: pre-auth status params
  5349. *
  5350. * This function sends the roam pre-authentication status for WPA3 SAE
  5351. * pre-auth to target.
  5352. *
  5353. * Return: QDF status
  5354. */
  5355. static QDF_STATUS
  5356. send_roam_preauth_status_tlv(wmi_unified_t wmi_handle,
  5357. struct wmi_roam_auth_status_params *params)
  5358. {
  5359. wmi_roam_preauth_status_cmd_fixed_param *cmd;
  5360. wmi_buf_t buf;
  5361. uint32_t len;
  5362. uint8_t *buf_ptr;
  5363. len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + PMKID_LEN;
  5364. buf = wmi_buf_alloc(wmi_handle, len);
  5365. if (!buf)
  5366. return QDF_STATUS_E_NOMEM;
  5367. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  5368. cmd = (wmi_roam_preauth_status_cmd_fixed_param *)buf_ptr;
  5369. WMITLV_SET_HDR(
  5370. &cmd->tlv_header,
  5371. WMITLV_TAG_STRUC_wmi_roam_preauth_status_cmd_fixed_param,
  5372. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_preauth_status_cmd_fixed_param));
  5373. cmd->vdev_id = params->vdev_id;
  5374. cmd->preauth_status = params->preauth_status;
  5375. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->bssid.bytes,
  5376. &cmd->candidate_ap_bssid);
  5377. buf_ptr += sizeof(wmi_roam_preauth_status_cmd_fixed_param);
  5378. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, PMKID_LEN);
  5379. buf_ptr += WMI_TLV_HDR_SIZE;
  5380. qdf_mem_copy(buf_ptr, params->pmkid, PMKID_LEN);
  5381. wmi_debug("vdev_id:%d status:%d bssid:"QDF_MAC_ADDR_FMT,
  5382. cmd->vdev_id, cmd->preauth_status,
  5383. QDF_MAC_ADDR_REF(params->bssid.bytes));
  5384. wmi_mtrace(WMI_ROAM_PREAUTH_STATUS_CMDID, cmd->vdev_id, 0);
  5385. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  5386. WMI_ROAM_PREAUTH_STATUS_CMDID)) {
  5387. wmi_buf_free(buf);
  5388. return QDF_STATUS_E_FAILURE;
  5389. }
  5390. return QDF_STATUS_SUCCESS;
  5391. }
  5392. #else
  5393. static inline QDF_STATUS
  5394. send_disconnect_roam_params_tlv(wmi_unified_t wmi_handle,
  5395. struct wlan_roam_disconnect_params *req)
  5396. {
  5397. return QDF_STATUS_E_FAILURE;
  5398. }
  5399. static inline QDF_STATUS
  5400. send_idle_roam_params_tlv(wmi_unified_t wmi_handle,
  5401. struct wlan_roam_idle_params *idle_roam_params)
  5402. {
  5403. return QDF_STATUS_E_FAILURE;
  5404. }
  5405. static inline QDF_STATUS
  5406. send_roam_preauth_status_tlv(wmi_unified_t wmi_handle,
  5407. struct wmi_roam_auth_status_params *params)
  5408. {
  5409. return QDF_STATUS_E_FAILURE;
  5410. }
  5411. #endif
  5412. /**
  5413. * send_offload_11k_cmd_tlv() - send wmi cmd with 11k offload params
  5414. * @wmi_handle: wmi handler
  5415. * @params: pointer to 11k offload params
  5416. *
  5417. * Return: 0 for success and non zero for failure
  5418. */
  5419. static QDF_STATUS
  5420. send_offload_11k_cmd_tlv(wmi_unified_t wmi_handle,
  5421. struct wlan_roam_11k_offload_params *params)
  5422. {
  5423. wmi_11k_offload_report_fixed_param *cmd;
  5424. wmi_buf_t buf;
  5425. QDF_STATUS status;
  5426. uint8_t *buf_ptr;
  5427. wmi_neighbor_report_11k_offload_tlv_param
  5428. *neighbor_report_offload_params;
  5429. wmi_neighbor_report_offload *neighbor_report_offload;
  5430. uint32_t len = sizeof(*cmd);
  5431. if (params->offload_11k_bitmask &
  5432. WMI_11K_OFFLOAD_BITMAP_NEIGHBOR_REPORT_REQ)
  5433. len += WMI_TLV_HDR_SIZE +
  5434. sizeof(wmi_neighbor_report_11k_offload_tlv_param);
  5435. buf = wmi_buf_alloc(wmi_handle, len);
  5436. if (!buf)
  5437. return QDF_STATUS_E_NOMEM;
  5438. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  5439. cmd = (wmi_11k_offload_report_fixed_param *)buf_ptr;
  5440. WMITLV_SET_HDR(&cmd->tlv_header,
  5441. WMITLV_TAG_STRUC_wmi_offload_11k_report_fixed_param,
  5442. WMITLV_GET_STRUCT_TLVLEN(
  5443. wmi_11k_offload_report_fixed_param));
  5444. cmd->vdev_id = params->vdev_id;
  5445. cmd->offload_11k = params->offload_11k_bitmask;
  5446. if (params->offload_11k_bitmask &
  5447. WMI_11K_OFFLOAD_BITMAP_NEIGHBOR_REPORT_REQ) {
  5448. buf_ptr += sizeof(wmi_11k_offload_report_fixed_param);
  5449. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  5450. sizeof(wmi_neighbor_report_11k_offload_tlv_param));
  5451. buf_ptr += WMI_TLV_HDR_SIZE;
  5452. neighbor_report_offload_params =
  5453. (wmi_neighbor_report_11k_offload_tlv_param *)buf_ptr;
  5454. WMITLV_SET_HDR(&neighbor_report_offload_params->tlv_header,
  5455. WMITLV_TAG_STRUC_wmi_neighbor_report_offload_tlv_param,
  5456. WMITLV_GET_STRUCT_TLVLEN(
  5457. wmi_neighbor_report_11k_offload_tlv_param));
  5458. neighbor_report_offload = &neighbor_report_offload_params->
  5459. neighbor_rep_ofld_params;
  5460. neighbor_report_offload->time_offset =
  5461. params->neighbor_report_params.time_offset;
  5462. neighbor_report_offload->low_rssi_offset =
  5463. params->neighbor_report_params.low_rssi_offset;
  5464. neighbor_report_offload->bmiss_count_trigger =
  5465. params->neighbor_report_params.bmiss_count_trigger;
  5466. neighbor_report_offload->per_threshold_offset =
  5467. params->neighbor_report_params.per_threshold_offset;
  5468. neighbor_report_offload->neighbor_report_cache_timeout =
  5469. params->neighbor_report_params.
  5470. neighbor_report_cache_timeout;
  5471. neighbor_report_offload->max_neighbor_report_req_cap =
  5472. params->neighbor_report_params.
  5473. max_neighbor_report_req_cap;
  5474. neighbor_report_offload->ssid.ssid_len =
  5475. params->neighbor_report_params.ssid.length;
  5476. qdf_mem_copy(neighbor_report_offload->ssid.ssid,
  5477. &params->neighbor_report_params.ssid.ssid,
  5478. neighbor_report_offload->ssid.ssid_len);
  5479. }
  5480. wmi_debug("RSO_CFG: vdev %d 11k_bitmask:%u time_offset:%u low_rssi_offset:%u bmiss_count_trigger:%u per_threshold_offset%u",
  5481. cmd->vdev_id, params->offload_11k_bitmask,
  5482. params->neighbor_report_params.time_offset,
  5483. params->neighbor_report_params.low_rssi_offset,
  5484. params->neighbor_report_params.bmiss_count_trigger,
  5485. params->neighbor_report_params.per_threshold_offset);
  5486. wmi_debug("RSO_CFG: neighbor_report_cache_timeout:%u max_neighbor_report_req_cap:%u SSID:" QDF_SSID_FMT,
  5487. params->neighbor_report_params.neighbor_report_cache_timeout,
  5488. params->neighbor_report_params.max_neighbor_report_req_cap,
  5489. QDF_SSID_REF(params->neighbor_report_params.ssid.length,
  5490. params->neighbor_report_params.ssid.ssid));
  5491. wmi_mtrace(WMI_11K_OFFLOAD_REPORT_CMDID, cmd->vdev_id, 0);
  5492. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  5493. WMI_11K_OFFLOAD_REPORT_CMDID);
  5494. if (status != QDF_STATUS_SUCCESS) {
  5495. wmi_err("Failed to send 11k offload command %d", status);
  5496. wmi_buf_free(buf);
  5497. }
  5498. return status;
  5499. }
  5500. /**
  5501. * send_invoke_neighbor_report_cmd_tlv() - send invoke 11k neighbor report
  5502. * command
  5503. * @wmi_handle: wmi handler
  5504. * @params: pointer to neighbor report invoke params
  5505. *
  5506. * Return: 0 for success and non zero for failure
  5507. */
  5508. static QDF_STATUS send_invoke_neighbor_report_cmd_tlv(
  5509. wmi_unified_t wmi_handle,
  5510. struct wmi_invoke_neighbor_report_params *params)
  5511. {
  5512. wmi_11k_offload_invoke_neighbor_report_fixed_param *cmd;
  5513. wmi_buf_t buf;
  5514. QDF_STATUS status;
  5515. uint8_t *buf_ptr;
  5516. uint32_t len = sizeof(*cmd);
  5517. buf = wmi_buf_alloc(wmi_handle, len);
  5518. if (!buf)
  5519. return QDF_STATUS_E_NOMEM;
  5520. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  5521. cmd = (wmi_11k_offload_invoke_neighbor_report_fixed_param *)buf_ptr;
  5522. WMITLV_SET_HDR(&cmd->tlv_header,
  5523. WMITLV_TAG_STRUC_wmi_invoke_neighbor_report_fixed_param,
  5524. WMITLV_GET_STRUCT_TLVLEN(
  5525. wmi_11k_offload_invoke_neighbor_report_fixed_param));
  5526. cmd->vdev_id = params->vdev_id;
  5527. cmd->flags = params->send_resp_to_host;
  5528. cmd->ssid.ssid_len = params->ssid.length;
  5529. qdf_mem_copy(cmd->ssid.ssid, &params->ssid.ssid, cmd->ssid.ssid_len);
  5530. wmi_mtrace(WMI_11K_INVOKE_NEIGHBOR_REPORT_CMDID, cmd->vdev_id, 0);
  5531. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  5532. WMI_11K_INVOKE_NEIGHBOR_REPORT_CMDID);
  5533. if (status != QDF_STATUS_SUCCESS) {
  5534. wmi_err("Failed to send invoke neighbor report command %d",
  5535. status);
  5536. wmi_buf_free(buf);
  5537. }
  5538. return status;
  5539. }
  5540. void wmi_roam_attach_tlv(wmi_unified_t wmi_handle)
  5541. {
  5542. struct wmi_ops *ops = wmi_handle->ops;
  5543. ops->send_roam_scan_offload_rssi_thresh_cmd =
  5544. send_roam_scan_offload_rssi_thresh_cmd_tlv;
  5545. ops->send_roam_mawc_params_cmd = send_roam_mawc_params_cmd_tlv;
  5546. ops->send_roam_scan_filter_cmd =
  5547. send_roam_scan_filter_cmd_tlv;
  5548. ops->send_roam_scan_offload_mode_cmd =
  5549. send_roam_scan_offload_mode_cmd_tlv;
  5550. ops->send_roam_scan_offload_ap_profile_cmd =
  5551. send_roam_scan_offload_ap_profile_cmd_tlv;
  5552. ops->send_roam_scan_offload_cmd = send_roam_scan_offload_cmd_tlv;
  5553. ops->send_roam_scan_offload_scan_period_cmd =
  5554. send_roam_scan_offload_scan_period_cmd_tlv;
  5555. ops->send_roam_scan_offload_chan_list_cmd =
  5556. send_roam_scan_offload_chan_list_cmd_tlv;
  5557. ops->send_roam_scan_offload_rssi_change_cmd =
  5558. send_roam_scan_offload_rssi_change_cmd_tlv;
  5559. ops->send_per_roam_config_cmd = send_per_roam_config_cmd_tlv;
  5560. ops->send_limit_off_chan_cmd = send_limit_off_chan_cmd_tlv;
  5561. ops->send_btm_config = send_btm_config_cmd_tlv;
  5562. ops->send_offload_11k_cmd = send_offload_11k_cmd_tlv;
  5563. ops->send_invoke_neighbor_report_cmd =
  5564. send_invoke_neighbor_report_cmd_tlv;
  5565. ops->send_roam_bss_load_config = send_roam_bss_load_config_tlv;
  5566. ops->send_idle_roam_params = send_idle_roam_params_tlv;
  5567. ops->send_disconnect_roam_params = send_disconnect_roam_params_tlv;
  5568. ops->send_roam_preauth_status = send_roam_preauth_status_tlv;
  5569. ops->extract_roam_event = extract_roam_event_tlv;
  5570. wmi_roam_mlo_attach_tlv(wmi_handle);
  5571. wmi_lfr_subnet_detection_attach_tlv(wmi_handle);
  5572. wmi_rssi_monitor_attach_tlv(wmi_handle);
  5573. wmi_ese_attach_tlv(wmi_handle);
  5574. wmi_roam_offload_attach_tlv(wmi_handle);
  5575. wmi_fils_sk_attach_tlv(wmi_handle);
  5576. }