wmi_unified_roam_tlv.c 171 KB

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