wmi_unified_roam_tlv.c 204 KB

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