wmi_unified_non_tlv.c 290 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786378737883789379037913792379337943795379637973798379938003801380238033804380538063807380838093810381138123813381438153816381738183819382038213822382338243825382638273828382938303831383238333834383538363837383838393840384138423843384438453846384738483849385038513852385338543855385638573858385938603861386238633864386538663867386838693870387138723873387438753876387738783879388038813882388338843885388638873888388938903891389238933894389538963897389838993900390139023903390439053906390739083909391039113912391339143915391639173918391939203921392239233924392539263927392839293930393139323933393439353936393739383939394039413942394339443945394639473948394939503951395239533954395539563957395839593960396139623963396439653966396739683969397039713972397339743975397639773978397939803981398239833984398539863987398839893990399139923993399439953996399739983999400040014002400340044005400640074008400940104011401240134014401540164017401840194020402140224023402440254026402740284029403040314032403340344035403640374038403940404041404240434044404540464047404840494050405140524053405440554056405740584059406040614062406340644065406640674068406940704071407240734074407540764077407840794080408140824083408440854086408740884089409040914092409340944095409640974098409941004101410241034104410541064107410841094110411141124113411441154116411741184119412041214122412341244125412641274128412941304131413241334134413541364137413841394140414141424143414441454146414741484149415041514152415341544155415641574158415941604161416241634164416541664167416841694170417141724173417441754176417741784179418041814182418341844185418641874188418941904191419241934194419541964197419841994200420142024203420442054206420742084209421042114212421342144215421642174218421942204221422242234224422542264227422842294230423142324233423442354236423742384239424042414242424342444245424642474248424942504251425242534254425542564257425842594260426142624263426442654266426742684269427042714272427342744275427642774278427942804281428242834284428542864287428842894290429142924293429442954296429742984299430043014302430343044305430643074308430943104311431243134314431543164317431843194320432143224323432443254326432743284329433043314332433343344335433643374338433943404341434243434344434543464347434843494350435143524353435443554356435743584359436043614362436343644365436643674368436943704371437243734374437543764377437843794380438143824383438443854386438743884389439043914392439343944395439643974398439944004401440244034404440544064407440844094410441144124413441444154416441744184419442044214422442344244425442644274428442944304431443244334434443544364437443844394440444144424443444444454446444744484449445044514452445344544455445644574458445944604461446244634464446544664467446844694470447144724473447444754476447744784479448044814482448344844485448644874488448944904491449244934494449544964497449844994500450145024503450445054506450745084509451045114512451345144515451645174518451945204521452245234524452545264527452845294530453145324533453445354536453745384539454045414542454345444545454645474548454945504551455245534554455545564557455845594560456145624563456445654566456745684569457045714572457345744575457645774578457945804581458245834584458545864587458845894590459145924593459445954596459745984599460046014602460346044605460646074608460946104611461246134614461546164617461846194620462146224623462446254626462746284629463046314632463346344635463646374638463946404641464246434644464546464647464846494650465146524653465446554656465746584659466046614662466346644665466646674668466946704671467246734674467546764677467846794680468146824683468446854686468746884689469046914692469346944695469646974698469947004701470247034704470547064707470847094710471147124713471447154716471747184719472047214722472347244725472647274728472947304731473247334734473547364737473847394740474147424743474447454746474747484749475047514752475347544755475647574758475947604761476247634764476547664767476847694770477147724773477447754776477747784779478047814782478347844785478647874788478947904791479247934794479547964797479847994800480148024803480448054806480748084809481048114812481348144815481648174818481948204821482248234824482548264827482848294830483148324833483448354836483748384839484048414842484348444845484648474848484948504851485248534854485548564857485848594860486148624863486448654866486748684869487048714872487348744875487648774878487948804881488248834884488548864887488848894890489148924893489448954896489748984899490049014902490349044905490649074908490949104911491249134914491549164917491849194920492149224923492449254926492749284929493049314932493349344935493649374938493949404941494249434944494549464947494849494950495149524953495449554956495749584959496049614962496349644965496649674968496949704971497249734974497549764977497849794980498149824983498449854986498749884989499049914992499349944995499649974998499950005001500250035004500550065007500850095010501150125013501450155016501750185019502050215022502350245025502650275028502950305031503250335034503550365037503850395040504150425043504450455046504750485049505050515052505350545055505650575058505950605061506250635064506550665067506850695070507150725073507450755076507750785079508050815082508350845085508650875088508950905091509250935094509550965097509850995100510151025103510451055106510751085109511051115112511351145115511651175118511951205121512251235124512551265127512851295130513151325133513451355136513751385139514051415142514351445145514651475148514951505151515251535154515551565157515851595160516151625163516451655166516751685169517051715172517351745175517651775178517951805181518251835184518551865187518851895190519151925193519451955196519751985199520052015202520352045205520652075208520952105211521252135214521552165217521852195220522152225223522452255226522752285229523052315232523352345235523652375238523952405241524252435244524552465247524852495250525152525253525452555256525752585259526052615262526352645265526652675268526952705271527252735274527552765277527852795280528152825283528452855286528752885289529052915292529352945295529652975298529953005301530253035304530553065307530853095310531153125313531453155316531753185319532053215322532353245325532653275328532953305331533253335334533553365337533853395340534153425343534453455346534753485349535053515352535353545355535653575358535953605361536253635364536553665367536853695370537153725373537453755376537753785379538053815382538353845385538653875388538953905391539253935394539553965397539853995400540154025403540454055406540754085409541054115412541354145415541654175418541954205421542254235424542554265427542854295430543154325433543454355436543754385439544054415442544354445445544654475448544954505451545254535454545554565457545854595460546154625463546454655466546754685469547054715472547354745475547654775478547954805481548254835484548554865487548854895490549154925493549454955496549754985499550055015502550355045505550655075508550955105511551255135514551555165517551855195520552155225523552455255526552755285529553055315532553355345535553655375538553955405541554255435544554555465547554855495550555155525553555455555556555755585559556055615562556355645565556655675568556955705571557255735574557555765577557855795580558155825583558455855586558755885589559055915592559355945595559655975598559956005601560256035604560556065607560856095610561156125613561456155616561756185619562056215622562356245625562656275628562956305631563256335634563556365637563856395640564156425643564456455646564756485649565056515652565356545655565656575658565956605661566256635664566556665667566856695670567156725673567456755676567756785679568056815682568356845685568656875688568956905691569256935694569556965697569856995700570157025703570457055706570757085709571057115712571357145715571657175718571957205721572257235724572557265727572857295730573157325733573457355736573757385739574057415742574357445745574657475748574957505751575257535754575557565757575857595760576157625763576457655766576757685769577057715772577357745775577657775778577957805781578257835784578557865787578857895790579157925793579457955796579757985799580058015802580358045805580658075808580958105811581258135814581558165817581858195820582158225823582458255826582758285829583058315832583358345835583658375838583958405841584258435844584558465847584858495850585158525853585458555856585758585859586058615862586358645865586658675868586958705871587258735874587558765877587858795880588158825883588458855886588758885889589058915892589358945895589658975898589959005901590259035904590559065907590859095910591159125913591459155916591759185919592059215922592359245925592659275928592959305931593259335934593559365937593859395940594159425943594459455946594759485949595059515952595359545955595659575958595959605961596259635964596559665967596859695970597159725973597459755976597759785979598059815982598359845985598659875988598959905991599259935994599559965997599859996000600160026003600460056006600760086009601060116012601360146015601660176018601960206021602260236024602560266027602860296030603160326033603460356036603760386039604060416042604360446045604660476048604960506051605260536054605560566057605860596060606160626063606460656066606760686069607060716072607360746075607660776078607960806081608260836084608560866087608860896090609160926093609460956096609760986099610061016102610361046105610661076108610961106111611261136114611561166117611861196120612161226123612461256126612761286129613061316132613361346135613661376138613961406141614261436144614561466147614861496150615161526153615461556156615761586159616061616162616361646165616661676168616961706171617261736174617561766177617861796180618161826183618461856186618761886189619061916192619361946195619661976198619962006201620262036204620562066207620862096210621162126213621462156216621762186219622062216222622362246225622662276228622962306231623262336234623562366237623862396240624162426243624462456246624762486249625062516252625362546255625662576258625962606261626262636264626562666267626862696270627162726273627462756276627762786279628062816282628362846285628662876288628962906291629262936294629562966297629862996300630163026303630463056306630763086309631063116312631363146315631663176318631963206321632263236324632563266327632863296330633163326333633463356336633763386339634063416342634363446345634663476348634963506351635263536354635563566357635863596360636163626363636463656366636763686369637063716372637363746375637663776378637963806381638263836384638563866387638863896390639163926393639463956396639763986399640064016402640364046405640664076408640964106411641264136414641564166417641864196420642164226423642464256426642764286429643064316432643364346435643664376438643964406441644264436444644564466447644864496450645164526453645464556456645764586459646064616462646364646465646664676468646964706471647264736474647564766477647864796480648164826483648464856486648764886489649064916492649364946495649664976498649965006501650265036504650565066507650865096510651165126513651465156516651765186519652065216522652365246525652665276528652965306531653265336534653565366537653865396540654165426543654465456546654765486549655065516552655365546555655665576558655965606561656265636564656565666567656865696570657165726573657465756576657765786579658065816582658365846585658665876588658965906591659265936594659565966597659865996600660166026603660466056606660766086609661066116612661366146615661666176618661966206621662266236624662566266627662866296630663166326633663466356636663766386639664066416642664366446645664666476648664966506651665266536654665566566657665866596660666166626663666466656666666766686669667066716672667366746675667666776678667966806681668266836684668566866687668866896690669166926693669466956696669766986699670067016702670367046705670667076708670967106711671267136714671567166717671867196720672167226723672467256726672767286729673067316732673367346735673667376738673967406741674267436744674567466747674867496750675167526753675467556756675767586759676067616762676367646765676667676768676967706771677267736774677567766777677867796780678167826783678467856786678767886789679067916792679367946795679667976798679968006801680268036804680568066807680868096810681168126813681468156816681768186819682068216822682368246825682668276828682968306831683268336834683568366837683868396840684168426843684468456846684768486849685068516852685368546855685668576858685968606861686268636864686568666867686868696870687168726873687468756876687768786879688068816882688368846885688668876888688968906891689268936894689568966897689868996900690169026903690469056906690769086909691069116912691369146915691669176918691969206921692269236924692569266927692869296930693169326933693469356936693769386939694069416942694369446945694669476948694969506951695269536954695569566957695869596960696169626963696469656966696769686969697069716972697369746975697669776978697969806981698269836984698569866987698869896990699169926993699469956996699769986999700070017002700370047005700670077008700970107011701270137014701570167017701870197020702170227023702470257026702770287029703070317032703370347035703670377038703970407041704270437044704570467047704870497050705170527053705470557056705770587059706070617062706370647065706670677068706970707071707270737074707570767077707870797080708170827083708470857086708770887089709070917092709370947095709670977098709971007101710271037104710571067107710871097110711171127113711471157116711771187119712071217122712371247125712671277128712971307131713271337134713571367137713871397140714171427143714471457146714771487149715071517152715371547155715671577158715971607161716271637164716571667167716871697170717171727173717471757176717771787179718071817182718371847185718671877188718971907191719271937194719571967197719871997200720172027203720472057206720772087209721072117212721372147215721672177218721972207221722272237224722572267227722872297230723172327233723472357236723772387239724072417242724372447245724672477248724972507251725272537254725572567257725872597260726172627263726472657266726772687269727072717272727372747275727672777278727972807281728272837284728572867287728872897290729172927293729472957296729772987299730073017302730373047305730673077308730973107311731273137314731573167317731873197320732173227323732473257326732773287329733073317332733373347335733673377338733973407341734273437344734573467347734873497350735173527353735473557356735773587359736073617362736373647365736673677368736973707371737273737374737573767377737873797380738173827383738473857386738773887389739073917392739373947395739673977398739974007401740274037404740574067407740874097410741174127413741474157416741774187419742074217422742374247425742674277428742974307431743274337434743574367437743874397440744174427443744474457446744774487449745074517452745374547455745674577458745974607461746274637464746574667467746874697470747174727473747474757476747774787479748074817482748374847485748674877488748974907491749274937494749574967497749874997500750175027503750475057506750775087509751075117512751375147515751675177518751975207521752275237524752575267527752875297530753175327533753475357536753775387539754075417542754375447545754675477548754975507551755275537554755575567557755875597560756175627563756475657566756775687569757075717572757375747575757675777578757975807581758275837584758575867587758875897590759175927593759475957596759775987599760076017602760376047605760676077608760976107611761276137614761576167617761876197620762176227623762476257626762776287629763076317632763376347635763676377638763976407641764276437644764576467647764876497650765176527653765476557656765776587659766076617662766376647665766676677668766976707671767276737674767576767677767876797680768176827683768476857686768776887689769076917692769376947695769676977698769977007701770277037704770577067707770877097710771177127713771477157716771777187719772077217722772377247725772677277728772977307731773277337734773577367737773877397740774177427743774477457746774777487749775077517752775377547755775677577758775977607761776277637764776577667767776877697770777177727773777477757776777777787779778077817782778377847785778677877788778977907791779277937794779577967797779877997800780178027803780478057806780778087809781078117812781378147815781678177818781978207821782278237824782578267827782878297830783178327833783478357836783778387839784078417842784378447845784678477848784978507851785278537854785578567857785878597860786178627863786478657866786778687869787078717872787378747875787678777878787978807881788278837884788578867887788878897890789178927893789478957896789778987899790079017902790379047905790679077908790979107911791279137914791579167917791879197920792179227923792479257926792779287929793079317932793379347935793679377938793979407941794279437944794579467947794879497950795179527953795479557956795779587959796079617962796379647965796679677968796979707971797279737974797579767977797879797980798179827983798479857986798779887989799079917992799379947995799679977998799980008001800280038004800580068007800880098010801180128013801480158016801780188019802080218022802380248025802680278028802980308031803280338034803580368037803880398040804180428043804480458046804780488049805080518052805380548055805680578058805980608061806280638064806580668067806880698070807180728073807480758076807780788079808080818082808380848085808680878088808980908091809280938094809580968097809880998100810181028103810481058106810781088109811081118112811381148115811681178118811981208121812281238124812581268127812881298130813181328133813481358136813781388139814081418142814381448145814681478148814981508151815281538154815581568157815881598160816181628163816481658166816781688169817081718172817381748175817681778178817981808181818281838184818581868187818881898190819181928193819481958196819781988199820082018202820382048205820682078208820982108211821282138214821582168217821882198220822182228223822482258226822782288229823082318232823382348235823682378238823982408241824282438244824582468247824882498250825182528253825482558256825782588259826082618262826382648265826682678268826982708271827282738274827582768277827882798280828182828283828482858286828782888289829082918292829382948295829682978298829983008301830283038304830583068307830883098310831183128313831483158316831783188319832083218322832383248325832683278328832983308331833283338334833583368337833883398340834183428343834483458346834783488349835083518352835383548355835683578358835983608361836283638364836583668367836883698370837183728373837483758376837783788379838083818382838383848385838683878388838983908391839283938394839583968397839883998400840184028403840484058406840784088409841084118412841384148415841684178418841984208421842284238424842584268427842884298430843184328433843484358436843784388439844084418442844384448445844684478448844984508451845284538454845584568457845884598460846184628463846484658466846784688469847084718472847384748475847684778478847984808481848284838484848584868487848884898490849184928493849484958496849784988499850085018502850385048505850685078508850985108511851285138514851585168517851885198520852185228523852485258526852785288529853085318532853385348535853685378538853985408541854285438544854585468547854885498550855185528553855485558556855785588559856085618562856385648565856685678568856985708571857285738574857585768577857885798580858185828583858485858586858785888589859085918592859385948595859685978598859986008601860286038604860586068607860886098610861186128613861486158616861786188619862086218622862386248625862686278628862986308631863286338634863586368637863886398640864186428643864486458646864786488649865086518652865386548655865686578658865986608661866286638664866586668667866886698670867186728673867486758676867786788679868086818682868386848685868686878688868986908691869286938694869586968697869886998700870187028703870487058706870787088709871087118712871387148715871687178718871987208721872287238724872587268727872887298730873187328733873487358736873787388739874087418742874387448745874687478748874987508751875287538754875587568757875887598760876187628763876487658766876787688769877087718772877387748775877687778778877987808781878287838784878587868787878887898790879187928793879487958796879787988799880088018802880388048805880688078808880988108811881288138814881588168817881888198820882188228823882488258826882788288829883088318832883388348835883688378838883988408841884288438844884588468847884888498850885188528853885488558856885788588859886088618862886388648865886688678868886988708871887288738874887588768877887888798880888188828883888488858886888788888889889088918892889388948895889688978898889989008901890289038904890589068907890889098910891189128913891489158916891789188919892089218922892389248925892689278928892989308931893289338934893589368937893889398940894189428943894489458946894789488949895089518952895389548955895689578958895989608961896289638964896589668967896889698970897189728973897489758976897789788979898089818982898389848985898689878988898989908991899289938994899589968997899889999000900190029003900490059006900790089009901090119012901390149015901690179018901990209021902290239024902590269027902890299030903190329033903490359036903790389039904090419042904390449045904690479048904990509051905290539054905590569057905890599060906190629063906490659066906790689069907090719072907390749075907690779078907990809081908290839084908590869087908890899090909190929093909490959096909790989099910091019102910391049105910691079108910991109111911291139114911591169117911891199120912191229123912491259126912791289129913091319132913391349135913691379138913991409141914291439144914591469147914891499150915191529153915491559156915791589159916091619162916391649165916691679168916991709171917291739174917591769177917891799180918191829183918491859186918791889189919091919192919391949195919691979198919992009201920292039204920592069207920892099210921192129213921492159216921792189219922092219222922392249225922692279228922992309231923292339234923592369237923892399240924192429243924492459246924792489249925092519252925392549255925692579258925992609261926292639264926592669267926892699270927192729273927492759276927792789279928092819282928392849285928692879288928992909291929292939294929592969297929892999300930193029303930493059306930793089309931093119312931393149315931693179318931993209321932293239324932593269327932893299330933193329333933493359336933793389339934093419342934393449345934693479348934993509351935293539354935593569357
  1. /*
  2. * Copyright (c) 2016-2018 The Linux Foundation. All rights reserved.
  3. *
  4. * Previously licensed under the ISC license by Qualcomm Atheros, Inc.
  5. *
  6. *
  7. * Permission to use, copy, modify, and/or distribute this software for
  8. * any purpose with or without fee is hereby granted, provided that the
  9. * above copyright notice and this permission notice appear in all
  10. * copies.
  11. *
  12. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  13. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  14. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  15. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  16. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  17. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  18. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  19. * PERFORMANCE OF THIS SOFTWARE.
  20. */
  21. /*
  22. * This file was originally distributed by Qualcomm Atheros, Inc.
  23. * under proprietary terms before Copyright ownership was assigned
  24. * to the Linux Foundation.
  25. */
  26. #include "wmi_unified_api.h"
  27. #include "wmi_unified_priv.h"
  28. #include "target_type.h"
  29. #if defined(WMI_NON_TLV_SUPPORT) || defined(WMI_TLV_AND_NON_TLV_SUPPORT)
  30. #include "wmi.h"
  31. #include "wmi_unified.h"
  32. /* pdev_id is used to distinguish the radio for which event
  33. * is recieved. Since non-tlv target has only one radio, setting
  34. * default pdev_id to one to keep rest of the code using WMI APIs unfiorm.
  35. */
  36. #define WMI_NON_TLV_DEFAULT_PDEV_ID WMI_HOST_PDEV_ID_0
  37. /**
  38. * send_vdev_create_cmd_non_tlv() - send VDEV create command to fw
  39. * @wmi_handle: wmi handle
  40. * @param: pointer to hold vdev create parameter
  41. * @macaddr: vdev mac address
  42. *
  43. * Return: 0 for success or error code
  44. */
  45. static QDF_STATUS send_vdev_create_cmd_non_tlv(wmi_unified_t wmi_handle,
  46. uint8_t macaddr[IEEE80211_ADDR_LEN],
  47. struct vdev_create_params *param)
  48. {
  49. wmi_vdev_create_cmd *cmd;
  50. wmi_buf_t buf;
  51. int32_t len = sizeof(wmi_vdev_create_cmd);
  52. buf = wmi_buf_alloc(wmi_handle, len);
  53. if (!buf) {
  54. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  55. return QDF_STATUS_E_NOMEM;
  56. }
  57. cmd = (wmi_vdev_create_cmd *)wmi_buf_data(buf);
  58. cmd->vdev_id = param->if_id;
  59. cmd->vdev_type = param->type;
  60. cmd->vdev_subtype = param->subtype;
  61. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->vdev_macaddr);
  62. qdf_print("%s: ID = %d Type = %d, Subtype = %d "
  63. "VAP Addr = %02x:%02x:%02x:%02x:%02x:%02x:\n",
  64. __func__, param->if_id, param->type, param->subtype,
  65. macaddr[0], macaddr[1], macaddr[2],
  66. macaddr[3], macaddr[4], macaddr[5]);
  67. return wmi_unified_cmd_send(wmi_handle, buf, len,
  68. WMI_VDEV_CREATE_CMDID);
  69. }
  70. /**
  71. * send_vdev_delete_cmd_non_tlv() - send VDEV delete command to fw
  72. * @wmi_handle: wmi handle
  73. * @if_id: vdev id
  74. *
  75. * Return: 0 for success or error code
  76. */
  77. static QDF_STATUS send_vdev_delete_cmd_non_tlv(wmi_unified_t wmi_handle,
  78. uint8_t if_id)
  79. {
  80. wmi_vdev_delete_cmd *cmd;
  81. wmi_buf_t buf;
  82. int32_t len = sizeof(wmi_vdev_delete_cmd);
  83. buf = wmi_buf_alloc(wmi_handle, len);
  84. if (!buf) {
  85. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  86. return QDF_STATUS_E_NOMEM;
  87. }
  88. cmd = (wmi_vdev_delete_cmd *)wmi_buf_data(buf);
  89. cmd->vdev_id = if_id;
  90. qdf_print("%s for vap %d (%pK)\n", __func__, if_id, wmi_handle);
  91. return wmi_unified_cmd_send(wmi_handle, buf, len,
  92. WMI_VDEV_DELETE_CMDID);
  93. }
  94. /**
  95. * send_vdev_stop_cmd_non_tlv() - send vdev stop command to fw
  96. * @wmi: wmi handle
  97. * @vdev_id: vdev id
  98. *
  99. * Return: 0 for success or erro code
  100. */
  101. static QDF_STATUS send_vdev_stop_cmd_non_tlv(wmi_unified_t wmi,
  102. uint8_t vdev_id)
  103. {
  104. wmi_vdev_stop_cmd *cmd;
  105. wmi_buf_t buf;
  106. int len = sizeof(wmi_vdev_stop_cmd);
  107. buf = wmi_buf_alloc(wmi, len);
  108. if (!buf) {
  109. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  110. return QDF_STATUS_E_NOMEM;
  111. }
  112. cmd = (wmi_vdev_stop_cmd *)wmi_buf_data(buf);
  113. cmd->vdev_id = vdev_id;
  114. return wmi_unified_cmd_send(wmi, buf, len, WMI_VDEV_STOP_CMDID);
  115. }
  116. /**
  117. * send_vdev_down_cmd_non_tlv() - send vdev down command to fw
  118. * @wmi_handle: wmi handle
  119. * @vdev_id: vdev id
  120. *
  121. * Return: 0 for success or error code
  122. */
  123. static QDF_STATUS send_vdev_down_cmd_non_tlv(wmi_unified_t wmi_handle,
  124. uint8_t vdev_id)
  125. {
  126. wmi_vdev_down_cmd *cmd;
  127. wmi_buf_t buf;
  128. int len = sizeof(wmi_vdev_down_cmd);
  129. buf = wmi_buf_alloc(wmi_handle, len);
  130. if (!buf) {
  131. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  132. return QDF_STATUS_E_NOMEM;
  133. }
  134. cmd = (wmi_vdev_down_cmd *)wmi_buf_data(buf);
  135. cmd->vdev_id = vdev_id;
  136. qdf_print("%s for vap %d (%pK)\n", __func__, vdev_id, wmi_handle);
  137. return wmi_unified_cmd_send(wmi_handle, buf, len, WMI_VDEV_DOWN_CMDID);
  138. }
  139. /**
  140. * send_vdev_start_cmd_non_tlv() - send vdev start command to fw
  141. * @wmi: wmi handle
  142. * @vdev_id: vdev id
  143. *
  144. * Return: 0 for success or error code
  145. */
  146. static QDF_STATUS send_vdev_start_cmd_non_tlv(wmi_unified_t wmi,
  147. struct vdev_start_params *param)
  148. {
  149. wmi_vdev_start_request_cmd *cmd;
  150. wmi_buf_t buf;
  151. int len = sizeof(wmi_vdev_start_request_cmd);
  152. int ret;
  153. buf = wmi_buf_alloc(wmi, len);
  154. if (!buf) {
  155. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  156. return QDF_STATUS_E_NOMEM;
  157. }
  158. cmd = (wmi_vdev_start_request_cmd *)wmi_buf_data(buf);
  159. cmd->vdev_id = param->vdev_id;
  160. cmd->chan.mhz = param->channel.mhz;
  161. WMI_SET_CHANNEL_MODE(&cmd->chan, param->channel.phy_mode);
  162. cmd->chan.band_center_freq1 = param->channel.cfreq1;
  163. cmd->chan.band_center_freq2 = param->channel.cfreq2;
  164. cmd->disable_hw_ack = param->disable_hw_ack;
  165. WMI_SET_CHANNEL_MIN_POWER(&cmd->chan, param->channel.minpower);
  166. WMI_SET_CHANNEL_MAX_POWER(&cmd->chan, param->channel.maxpower);
  167. WMI_SET_CHANNEL_REG_POWER(&cmd->chan, param->channel.maxregpower);
  168. WMI_SET_CHANNEL_ANTENNA_MAX(&cmd->chan, param->channel.antennamax);
  169. WMI_SET_CHANNEL_REG_CLASSID(&cmd->chan, param->channel.reg_class_id);
  170. if (param->channel.dfs_set)
  171. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_DFS);
  172. if (param->channel.dfs_set_cfreq2)
  173. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_DFS_CFREQ2);
  174. if (param->channel.set_agile)
  175. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_AGILE_MODE);
  176. if (param->channel.half_rate)
  177. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_HALF);
  178. if (param->channel.quarter_rate)
  179. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_QUARTER);
  180. if (param->is_restart) {
  181. qdf_print("VDEV RESTART\n");
  182. ret = wmi_unified_cmd_send(wmi, buf, len,
  183. WMI_VDEV_RESTART_REQUEST_CMDID);
  184. } else {
  185. qdf_print("VDEV START\n");
  186. ret = wmi_unified_cmd_send(wmi, buf, len,
  187. WMI_VDEV_START_REQUEST_CMDID);
  188. }
  189. return ret;
  190. /*
  191. For VDEV_RESTART command, the sequence of code remains the same except the
  192. command sent as WMI_VDEV_RESTART_REQUEST_CMDID instead of START_REQUEST.
  193. In that case, can we introduce a flag that takes in to check if start or
  194. restart and use the same function?? Currently implemented as two separate
  195. functions in OL layer
  196. */
  197. }
  198. /**
  199. * send_vdev_set_nac_rssi_cmd_non_tlv() - send set NAC_RSSI command to fw
  200. * @wmi: wmi handle
  201. * @param: Pointer to hold nac rssi stats
  202. *
  203. * Return: 0 for success or error code
  204. */
  205. QDF_STATUS send_vdev_set_nac_rssi_cmd_non_tlv(wmi_unified_t wmi,
  206. struct vdev_scan_nac_rssi_params *param)
  207. {
  208. wmi_vdev_scan_nac_rssi_config_cmd *cmd;
  209. wmi_buf_t buf;
  210. int len = sizeof(wmi_vdev_scan_nac_rssi_config_cmd);
  211. buf = wmi_buf_alloc(wmi, len);
  212. if (!buf) {
  213. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  214. return QDF_STATUS_E_NOMEM;
  215. }
  216. cmd = (wmi_vdev_scan_nac_rssi_config_cmd *)wmi_buf_data(buf);
  217. cmd->vdev_id = param->vdev_id;
  218. cmd->action = param->action;
  219. cmd->chan_num = param->chan_num;
  220. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->bssid_addr, &cmd->bssid_addr);
  221. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->client_addr, &cmd->client_addr);
  222. if (wmi_unified_cmd_send(wmi, buf, len, WMI_VDEV_SET_SCAN_NAC_RSSI_CMDID)) {
  223. qdf_print("%s: ERROR: Host unable to send LOWI request to FW\n", __func__);
  224. wmi_buf_free(buf);
  225. return QDF_STATUS_E_FAILURE;
  226. }
  227. return QDF_STATUS_SUCCESS;
  228. }
  229. /**
  230. * send_vdev_set_neighbour_rx_cmd_non_tlv() - set neighbour rx param in fw
  231. * @wmi_handle: wmi handle
  232. * @macaddr: vdev mac address
  233. * @param: pointer to hold neigbour rx param
  234. * Return: 0 for success or error code
  235. */
  236. static QDF_STATUS send_vdev_set_neighbour_rx_cmd_non_tlv(wmi_unified_t wmi_handle,
  237. uint8_t macaddr[IEEE80211_ADDR_LEN],
  238. struct set_neighbour_rx_params *param)
  239. {
  240. wmi_vdev_filter_nrp_config_cmd *cmd;
  241. wmi_buf_t buf;
  242. int len = sizeof(wmi_vdev_filter_nrp_config_cmd);
  243. buf = wmi_buf_alloc(wmi_handle, len);
  244. if (!buf) {
  245. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  246. return QDF_STATUS_E_FAILURE;
  247. }
  248. cmd = (wmi_vdev_filter_nrp_config_cmd *)wmi_buf_data(buf);
  249. cmd->vdev_id = param->vdev_id;
  250. cmd->bssid_idx = param->idx;
  251. cmd->action = param->action;
  252. cmd->type = param->type;
  253. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->addr);
  254. return wmi_unified_cmd_send(wmi_handle, buf, len,
  255. WMI_VDEV_FILTER_NEIGHBOR_RX_PACKETS_CMDID);
  256. }
  257. /**
  258. * send_vdev_set_fwtest_param_cmd_non_tlv() - send fwtest param in fw
  259. * @wmi_handle: wmi handle
  260. * @param: pointer to hold fwtest param
  261. *
  262. * Return: 0 for success or error code
  263. */
  264. static QDF_STATUS send_vdev_set_fwtest_param_cmd_non_tlv(wmi_unified_t wmi_handle,
  265. struct set_fwtest_params *param)
  266. {
  267. wmi_fwtest_set_param_cmd *cmd;
  268. wmi_buf_t buf;
  269. int len = sizeof(wmi_fwtest_set_param_cmd);
  270. buf = wmi_buf_alloc(wmi_handle, len);
  271. if (!buf) {
  272. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  273. return QDF_STATUS_E_FAILURE;
  274. }
  275. cmd = (wmi_fwtest_set_param_cmd *)wmi_buf_data(buf);
  276. cmd->param_id = param->arg;
  277. cmd->param_value = param->value;
  278. return wmi_unified_cmd_send(wmi_handle, buf, len, WMI_FWTEST_CMDID);
  279. }
  280. /**
  281. * send_vdev_config_ratemask_cmd_non_tlv() - config ratemask param in fw
  282. * @wmi_handle: wmi handle
  283. * @param: pointer to hold config ratemask params
  284. *
  285. * Return: 0 for success or error code
  286. */
  287. static QDF_STATUS send_vdev_config_ratemask_cmd_non_tlv(wmi_unified_t wmi_handle,
  288. struct config_ratemask_params *param)
  289. {
  290. wmi_vdev_config_ratemask *cmd;
  291. wmi_buf_t buf;
  292. int len = sizeof(wmi_vdev_config_ratemask);
  293. buf = wmi_buf_alloc(wmi_handle, len);
  294. if (!buf) {
  295. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  296. return QDF_STATUS_E_FAILURE;
  297. }
  298. cmd = (wmi_vdev_config_ratemask *)wmi_buf_data(buf);
  299. cmd->vdev_id = param->vdev_id;
  300. cmd->type = param->type;
  301. cmd->mask_lower32 = param->lower32;
  302. cmd->mask_higher32 = param->higher32;
  303. qdf_print("Setting vdev ratemask vdev id = 0x%X, type = 0x%X,"
  304. "mask_l32 = 0x%X mask_h32 = 0x%X\n",
  305. param->vdev_id, param->type, param->lower32, param->higher32);
  306. return wmi_unified_cmd_send(wmi_handle, buf, len,
  307. WMI_VDEV_RATEMASK_CMDID);
  308. }
  309. /**
  310. * send_setup_install_key_cmd_non_tlv() - config security key in fw
  311. * @wmi_handle: wmi handle
  312. * @param: pointer to hold key params
  313. * @macaddr: vdev mac address
  314. *
  315. * Return: 0 for success or error code
  316. */
  317. static QDF_STATUS send_setup_install_key_cmd_non_tlv(wmi_unified_t wmi_handle,
  318. struct set_key_params *param)
  319. {
  320. wmi_vdev_install_key_cmd *cmd;
  321. wmi_buf_t buf;
  322. /* length depends on ieee key length */
  323. int len = sizeof(wmi_vdev_install_key_cmd) + param->key_len;
  324. uint8_t wmi_cipher_type;
  325. int i;
  326. wmi_cipher_type = param->key_cipher;
  327. /* ieee_key length does not have mic keylen */
  328. if ((wmi_cipher_type == WMI_CIPHER_TKIP) ||
  329. (wmi_cipher_type == WMI_CIPHER_WAPI))
  330. len = len + IEEE80211_MICBUF_SIZE;
  331. len = roundup(len, sizeof(u_int32_t));
  332. buf = wmi_buf_alloc(wmi_handle, len);
  333. if (!buf) {
  334. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  335. return QDF_STATUS_E_NOMEM;
  336. }
  337. cmd = (wmi_vdev_install_key_cmd *)wmi_buf_data(buf);
  338. cmd->vdev_id = param->vdev_id;
  339. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_mac, &cmd->peer_macaddr);
  340. cmd->key_ix = param->key_idx;
  341. /* If this WEP key is the default xmit key, TX_USAGE flag is enabled */
  342. cmd->key_flags = param->key_flags;
  343. cmd->key_len = param->key_len;
  344. cmd->key_cipher = wmi_cipher_type;
  345. cmd->key_txmic_len = param->key_txmic_len;
  346. cmd->key_rxmic_len = param->key_rxmic_len;
  347. /* target will use the same rsc counter for
  348. various tids from from ieee key rsc */
  349. if ((wmi_cipher_type == WMI_CIPHER_TKIP) ||
  350. (wmi_cipher_type == WMI_CIPHER_AES_OCB)
  351. || (wmi_cipher_type == WMI_CIPHER_AES_CCM)) {
  352. qdf_mem_copy(&cmd->key_rsc_counter, &param->key_rsc_counter[0],
  353. sizeof(param->key_rsc_counter[0]));
  354. qdf_mem_copy(&cmd->key_tsc_counter, &param->key_tsc_counter,
  355. sizeof(param->key_tsc_counter));
  356. }
  357. #ifdef ATH_SUPPORT_WAPI
  358. if (wmi_cipher_type == WMI_CIPHER_WAPI) {
  359. int j;
  360. /* For WAPI, TSC and RSC has to be initialized with predefined
  361. * value.Here, Indicating TSC, RSC to target as part of set
  362. * key message
  363. */
  364. /* since wk_recviv and wk_txiv initialized in reverse order,
  365. * Before indicating the Target FW, Reversing TSC and RSC
  366. */
  367. for (i = (WPI_IV_LEN-1), j = 0; i >= 0; i--, j++) {
  368. cmd->wpi_key_rsc_counter[j] =
  369. param->rx_iv[i];
  370. cmd->wpi_key_tsc_counter[j] =
  371. param->tx_iv[i];
  372. }
  373. qdf_print("RSC:");
  374. for (i = 0; i < 16; i++)
  375. qdf_print("0x%x ",
  376. *(((uint8_t *)&cmd->wpi_key_rsc_counter)+i));
  377. qdf_print("\n");
  378. qdf_print("TSC:");
  379. for (i = 0; i < 16; i++)
  380. qdf_print("0x%x ",
  381. *(((uint8_t *)&cmd->wpi_key_tsc_counter)+i));
  382. qdf_print("\n");
  383. }
  384. #endif
  385. /* for big endian host, copy engine byte_swap is enabled
  386. * But the key data content is in network byte order
  387. * Need to byte swap the key data content - so when copy engine
  388. * does byte_swap - target gets key_data content in the correct order
  389. */
  390. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(cmd->key_data, param->key_data,
  391. cmd->key_len);
  392. return wmi_unified_cmd_send(wmi_handle, buf, len,
  393. WMI_VDEV_INSTALL_KEY_CMDID);
  394. }
  395. /**
  396. * send_peer_flush_tids_cmd_non_tlv() - flush peer tids packets in fw
  397. * @wmi_handle: wmi handle
  398. * @peer_addr: peer mac address
  399. * @param: pointer to hold peer flush tid parameter
  400. *
  401. * Return: 0 for sucess or error code
  402. */
  403. static QDF_STATUS send_peer_flush_tids_cmd_non_tlv(wmi_unified_t wmi_handle,
  404. uint8_t peer_addr[IEEE80211_ADDR_LEN],
  405. struct peer_flush_params *param)
  406. {
  407. wmi_peer_flush_tids_cmd *cmd;
  408. wmi_buf_t buf;
  409. int len = sizeof(wmi_peer_flush_tids_cmd);
  410. buf = wmi_buf_alloc(wmi_handle, len);
  411. if (!buf) {
  412. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  413. return QDF_STATUS_E_NOMEM;
  414. }
  415. cmd = (wmi_peer_flush_tids_cmd *)wmi_buf_data(buf);
  416. WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr);
  417. cmd->peer_tid_bitmap = param->peer_tid_bitmap;
  418. cmd->vdev_id = param->vdev_id;
  419. return wmi_unified_cmd_send(wmi_handle, buf, len,
  420. WMI_PEER_FLUSH_TIDS_CMDID);
  421. }
  422. /**
  423. * send_peer_delete_cmd_non_tlv() - send PEER delete command to fw
  424. * @wmi_handle: wmi handle
  425. * @peer_addr: peer mac addr
  426. * @vdev_id: vdev id
  427. *
  428. * Return: 0 for success or error code
  429. */
  430. static QDF_STATUS send_peer_delete_cmd_non_tlv(wmi_unified_t wmi_handle,
  431. uint8_t
  432. peer_addr[IEEE80211_ADDR_LEN],
  433. uint8_t vdev_id)
  434. {
  435. wmi_peer_delete_cmd *cmd;
  436. wmi_buf_t buf;
  437. int len = sizeof(wmi_peer_delete_cmd);
  438. buf = wmi_buf_alloc(wmi_handle, len);
  439. if (!buf) {
  440. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  441. return QDF_STATUS_E_NOMEM;
  442. }
  443. cmd = (wmi_peer_delete_cmd *)wmi_buf_data(buf);
  444. WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr);
  445. cmd->vdev_id = vdev_id;
  446. return wmi_unified_cmd_send(wmi_handle, buf, len,
  447. WMI_PEER_DELETE_CMDID);
  448. }
  449. /**
  450. * convert_host_peer_id_to_target_id_non_tlv - convert host peer param_id
  451. * to target id.
  452. * @targ_paramid: Target parameter id to hold the result.
  453. * @peer_param_id: host param id.
  454. *
  455. * Return: QDF_STATUS_SUCCESS for success
  456. * QDF_STATUS_E_NOSUPPORT when the param_id in not supported in tareget
  457. */
  458. static QDF_STATUS convert_host_peer_id_to_target_id_non_tlv(
  459. uint32_t *targ_paramid,
  460. uint32_t peer_param_id)
  461. {
  462. switch (peer_param_id) {
  463. case WMI_HOST_PEER_MIMO_PS_STATE:
  464. *targ_paramid = WMI_PEER_MIMO_PS_STATE;
  465. break;
  466. case WMI_HOST_PEER_AMPDU:
  467. *targ_paramid = WMI_PEER_AMPDU;
  468. break;
  469. case WMI_HOST_PEER_AUTHORIZE:
  470. *targ_paramid = WMI_PEER_AUTHORIZE;
  471. break;
  472. case WMI_HOST_PEER_CHWIDTH:
  473. *targ_paramid = WMI_PEER_CHWIDTH;
  474. break;
  475. case WMI_HOST_PEER_NSS:
  476. *targ_paramid = WMI_PEER_NSS;
  477. break;
  478. case WMI_HOST_PEER_USE_4ADDR:
  479. *targ_paramid = WMI_PEER_USE_4ADDR;
  480. break;
  481. case WMI_HOST_PEER_USE_FIXED_PWR:
  482. *targ_paramid = WMI_PEER_USE_FIXED_PWR;
  483. break;
  484. case WMI_HOST_PEER_PARAM_FIXED_RATE:
  485. *targ_paramid = WMI_PEER_PARAM_FIXED_RATE;
  486. break;
  487. case WMI_HOST_PEER_SET_MU_WHITELIST:
  488. *targ_paramid = WMI_PEER_SET_MU_WHITELIST;
  489. break;
  490. case WMI_HOST_PEER_EXT_STATS_ENABLE:
  491. *targ_paramid = WMI_PEER_EXT_STATS_ENABLE;
  492. break;
  493. case WMI_HOST_PEER_NSS_VHT160:
  494. *targ_paramid = WMI_PEER_NSS_VHT160;
  495. break;
  496. case WMI_HOST_PEER_NSS_VHT80_80:
  497. *targ_paramid = WMI_PEER_NSS_VHT80_80;
  498. break;
  499. default:
  500. return QDF_STATUS_E_NOSUPPORT;
  501. }
  502. return QDF_STATUS_SUCCESS;
  503. }
  504. /**
  505. * send_peer_param_cmd_non_tlv() - set peer parameter in fw
  506. * @wmi_handle: wmi handle
  507. * @peer_addr: peer mac address
  508. * @param : pointer to hold peer set parameter
  509. *
  510. * Return: 0 for success or error code
  511. */
  512. static QDF_STATUS send_peer_param_cmd_non_tlv(wmi_unified_t wmi_handle,
  513. uint8_t peer_addr[IEEE80211_ADDR_LEN],
  514. struct peer_set_params *param)
  515. {
  516. wmi_peer_set_param_cmd *cmd;
  517. wmi_buf_t buf;
  518. int len = sizeof(wmi_peer_set_param_cmd);
  519. uint32_t param_id;
  520. if (convert_host_peer_id_to_target_id_non_tlv(&param_id,
  521. param->param_id) != QDF_STATUS_SUCCESS)
  522. return QDF_STATUS_E_NOSUPPORT;
  523. buf = wmi_buf_alloc(wmi_handle, len);
  524. if (!buf) {
  525. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  526. return QDF_STATUS_E_NOMEM;
  527. }
  528. cmd = (wmi_peer_set_param_cmd *)wmi_buf_data(buf);
  529. WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr);
  530. cmd->param_id = param_id;
  531. cmd->param_value = param->param_value;
  532. cmd->vdev_id = param->vdev_id;
  533. return wmi_unified_cmd_send(wmi_handle, buf, len,
  534. WMI_PEER_SET_PARAM_CMDID);
  535. }
  536. /**
  537. * send_vdev_up_cmd_non_tlv() - send vdev up command in fw
  538. * @wmi_handle: wmi handle
  539. * @bssid: bssid
  540. * @vdev_up_params: pointer to hold vdev up parameter
  541. *
  542. * Return: 0 for success or error code
  543. */
  544. static QDF_STATUS send_vdev_up_cmd_non_tlv(wmi_unified_t wmi_handle,
  545. uint8_t bssid[IEEE80211_ADDR_LEN],
  546. struct vdev_up_params *param)
  547. {
  548. wmi_vdev_up_cmd *cmd;
  549. wmi_buf_t buf;
  550. int len = sizeof(wmi_vdev_up_cmd);
  551. buf = wmi_buf_alloc(wmi_handle, len);
  552. if (!buf) {
  553. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  554. return QDF_STATUS_E_NOMEM;
  555. }
  556. cmd = (wmi_vdev_up_cmd *)wmi_buf_data(buf);
  557. cmd->vdev_id = param->vdev_id;
  558. cmd->vdev_assoc_id = param->assoc_id;
  559. WMI_CHAR_ARRAY_TO_MAC_ADDR(bssid, &cmd->vdev_bssid);
  560. qdf_print("%s for vap %d (%pK)\n", __func__, param->vdev_id, wmi_handle);
  561. return wmi_unified_cmd_send(wmi_handle, buf, len, WMI_VDEV_UP_CMDID);
  562. }
  563. /**
  564. * send_peer_create_cmd_non_tlv() - send peer create command to fw
  565. * @wmi_handle: wmi handle
  566. * @param: pointer to hold peer create parameter
  567. *
  568. * Return: 0 for success or error code
  569. */
  570. static QDF_STATUS send_peer_create_cmd_non_tlv(wmi_unified_t wmi_handle,
  571. struct peer_create_params *param)
  572. {
  573. wmi_peer_create_cmd *cmd;
  574. wmi_buf_t buf;
  575. int len = sizeof(wmi_peer_create_cmd);
  576. buf = wmi_buf_alloc(wmi_handle, len);
  577. if (!buf) {
  578. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  579. return QDF_STATUS_E_NOMEM;
  580. }
  581. cmd = (wmi_peer_create_cmd *)wmi_buf_data(buf);
  582. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_addr, &cmd->peer_macaddr);
  583. cmd->vdev_id = param->vdev_id;
  584. return wmi_unified_cmd_send(wmi_handle, buf, len,
  585. WMI_PEER_CREATE_CMDID);
  586. }
  587. /**
  588. * send_peer_add_wds_entry_cmd_non_tlv() - send peer add command to fw
  589. * @wmi_handle: wmi handle
  590. * @param: pointer holding peer details
  591. *
  592. * Return: 0 for success or error code
  593. */
  594. static QDF_STATUS send_peer_add_wds_entry_cmd_non_tlv(wmi_unified_t wmi_handle,
  595. struct peer_add_wds_entry_params *param)
  596. {
  597. wmi_peer_add_wds_entry_cmd *cmd;
  598. wmi_buf_t buf;
  599. int len = sizeof(wmi_peer_add_wds_entry_cmd);
  600. buf = wmi_buf_alloc(wmi_handle, len);
  601. if (!buf) {
  602. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  603. return QDF_STATUS_E_FAILURE;
  604. }
  605. cmd = (wmi_peer_add_wds_entry_cmd *)wmi_buf_data(buf);
  606. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->dest_addr, &cmd->wds_macaddr);
  607. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_addr, &cmd->peer_macaddr);
  608. cmd->flags = param->flags;
  609. return wmi_unified_cmd_send(wmi_handle, buf, len,
  610. WMI_PEER_ADD_WDS_ENTRY_CMDID);
  611. }
  612. /**
  613. * send_peer_del_wds_entry_cmd_non_tlv() - send peer delete command to fw
  614. * @wmi_handle: wmi handle
  615. * @param: pointer holding peer details
  616. *
  617. * Return: 0 for success or error code
  618. */
  619. static QDF_STATUS send_peer_del_wds_entry_cmd_non_tlv(wmi_unified_t wmi_handle,
  620. struct peer_del_wds_entry_params *param)
  621. {
  622. wmi_peer_remove_wds_entry_cmd *cmd;
  623. wmi_buf_t buf;
  624. int len = sizeof(wmi_peer_remove_wds_entry_cmd);
  625. buf = wmi_buf_alloc(wmi_handle, len);
  626. if (!buf) {
  627. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  628. return QDF_STATUS_E_NOMEM;
  629. }
  630. cmd = (wmi_peer_remove_wds_entry_cmd *)wmi_buf_data(buf);
  631. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->dest_addr, &cmd->wds_macaddr);
  632. return wmi_unified_cmd_send(wmi_handle, buf, len,
  633. WMI_PEER_REMOVE_WDS_ENTRY_CMDID);
  634. }
  635. /**
  636. * send_set_bridge_mac_addr_cmd_non_tlv() - send set bridge MAC addr command to fw
  637. * @wmi_handle: wmi handle
  638. * @param: pointer holding bridge addr details
  639. *
  640. * Return: 0 for success or error code
  641. */
  642. QDF_STATUS send_set_bridge_mac_addr_cmd_non_tlv(wmi_unified_t wmi_handle,
  643. struct set_bridge_mac_addr_params *param)
  644. {
  645. wmi_peer_add_wds_entry_cmd *cmd;
  646. wmi_buf_t buf;
  647. uint8_t null_macaddr[IEEE80211_ADDR_LEN];
  648. int len = sizeof(wmi_peer_add_wds_entry_cmd);
  649. buf = wmi_buf_alloc(wmi_handle, len);
  650. if (!buf) {
  651. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  652. return QDF_STATUS_E_NOMEM;
  653. }
  654. qdf_mem_zero(null_macaddr, IEEE80211_ADDR_LEN);
  655. cmd = (wmi_peer_add_wds_entry_cmd *)wmi_buf_data(buf);
  656. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->bridge_addr, &cmd->wds_macaddr);
  657. WMI_CHAR_ARRAY_TO_MAC_ADDR(null_macaddr, &cmd->peer_macaddr);
  658. cmd->flags = 0xffffffff;
  659. return wmi_unified_cmd_send(wmi_handle, buf, len,
  660. WMI_PEER_ADD_WDS_ENTRY_CMDID);
  661. }
  662. /**
  663. * send_peer_update_wds_entry_cmd_non_tlv() - send peer update command to fw
  664. * @wmi_handle: wmi handle
  665. * @param: pointer holding peer details
  666. *
  667. * Return: 0 for success or error code
  668. */
  669. static QDF_STATUS send_peer_update_wds_entry_cmd_non_tlv(wmi_unified_t wmi_handle,
  670. struct peer_update_wds_entry_params *param)
  671. {
  672. wmi_peer_update_wds_entry_cmd *cmd;
  673. wmi_buf_t buf;
  674. int len = sizeof(wmi_peer_update_wds_entry_cmd);
  675. buf = wmi_buf_alloc(wmi_handle, len);
  676. if (!buf) {
  677. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  678. return QDF_STATUS_E_NOMEM;
  679. }
  680. /* wmi_buf_alloc returns zeroed command buffer */
  681. cmd = (wmi_peer_update_wds_entry_cmd *)wmi_buf_data(buf);
  682. cmd->flags = (param->flags) ? WMI_WDS_FLAG_STATIC : 0;
  683. if (param->wds_macaddr)
  684. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->wds_macaddr,
  685. &cmd->wds_macaddr);
  686. if (param->peer_macaddr)
  687. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_macaddr,
  688. &cmd->peer_macaddr);
  689. return wmi_unified_cmd_send(wmi_handle, buf, len,
  690. WMI_PEER_UPDATE_WDS_ENTRY_CMDID);
  691. }
  692. #ifdef WLAN_SUPPORT_GREEN_AP
  693. /**
  694. * send_green_ap_ps_cmd_non_tlv() - enable green ap powersave command
  695. * @wmi_handle: wmi handle
  696. * @value: value
  697. * @pdev_id: pdev id to have radio context
  698. *
  699. * Return: 0 for success or error code
  700. */
  701. static QDF_STATUS send_green_ap_ps_cmd_non_tlv(wmi_unified_t wmi_handle,
  702. uint32_t value, uint8_t pdev_id)
  703. {
  704. wmi_pdev_green_ap_ps_enable_cmd *cmd;
  705. wmi_buf_t buf;
  706. int len = 0;
  707. int ret;
  708. len = sizeof(wmi_pdev_green_ap_ps_enable_cmd);
  709. buf = wmi_buf_alloc(wmi_handle, len);
  710. if (!buf) {
  711. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  712. return QDF_STATUS_E_NOMEM;
  713. }
  714. cmd = (wmi_pdev_green_ap_ps_enable_cmd *)wmi_buf_data(buf);
  715. cmd->enable = value;
  716. ret = wmi_unified_cmd_send(wmi_handle,
  717. buf,
  718. len,
  719. WMI_PDEV_GREEN_AP_PS_ENABLE_CMDID);
  720. #ifdef OL_GREEN_AP_DEBUG_CONFIG_INTERACTIONS
  721. qdf_print("%s: Sent WMI_PDEV_GREEN_AP_PS_ENABLE_CMDID.\n"
  722. "enable=%u status=%d\n",
  723. __func__,
  724. value,
  725. ret);
  726. #endif /* OL_GREEN_AP_DEBUG_CONFIG_INTERACTIONS */
  727. return ret;
  728. }
  729. #endif
  730. /**
  731. * send_pdev_utf_cmd_non_tlv() - send utf command to fw
  732. * @wmi_handle: wmi handle
  733. * @param: pointer to pdev_utf_params
  734. * @mac_id: mac id to have radio context
  735. *
  736. * Return: 0 for success or error code
  737. */
  738. static QDF_STATUS
  739. send_pdev_utf_cmd_non_tlv(wmi_unified_t wmi_handle,
  740. struct pdev_utf_params *param,
  741. uint8_t mac_id)
  742. {
  743. wmi_buf_t buf;
  744. u_int8_t *cmd;
  745. int ret = 0;
  746. /* We can initialize the value and increment.*/
  747. static uint8_t msgref = 1;
  748. uint8_t segNumber = 0, segInfo, numSegments;
  749. uint16_t chunkLen, totalBytes;
  750. uint8_t *bufpos;
  751. struct seg_hdr_info segHdrInfo;
  752. bufpos = param->utf_payload;
  753. totalBytes = param->len;
  754. numSegments = (uint8_t) (totalBytes / MAX_WMI_UTF_LEN);
  755. if (param->len - (numSegments * MAX_WMI_UTF_LEN))
  756. numSegments++;
  757. while (param->len) {
  758. if (param->len > MAX_WMI_UTF_LEN)
  759. chunkLen = MAX_WMI_UTF_LEN; /* MAX messsage.. */
  760. else
  761. chunkLen = param->len;
  762. buf = wmi_buf_alloc(wmi_handle,
  763. (chunkLen + sizeof(segHdrInfo)));
  764. if (!buf) {
  765. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  766. return QDF_STATUS_E_FAILURE;
  767. }
  768. cmd = (uint8_t *)wmi_buf_data(buf);
  769. segHdrInfo.len = totalBytes;
  770. segHdrInfo.msgref = msgref;
  771. segInfo = ((numSegments << 4) & 0xF0) | (segNumber & 0xF);
  772. segHdrInfo.segmentInfo = segInfo;
  773. segNumber++;
  774. qdf_mem_copy(cmd, &segHdrInfo, sizeof(segHdrInfo));
  775. #ifdef BIG_ENDIAN_HOST
  776. if (param->is_ar900b) {
  777. /* for big endian host, copy engine byte_swap is
  778. * enable But this ART command frame buffer content is
  779. * in network byte order.
  780. * Need to byte swap the mgmt frame buffer content - so
  781. * when copy engine does byte_swap - target gets buffer
  782. * content in the correct order
  783. */
  784. int i;
  785. uint32_t *destp, *srcp;
  786. destp = (uint32_t *)(&(cmd[sizeof(segHdrInfo)]));
  787. srcp = (uint32_t *)bufpos;
  788. for (i = 0; i < (roundup(chunkLen,
  789. sizeof(uint32_t)) / 4); i++) {
  790. *destp = qdf_le32_to_cpu(*srcp);
  791. destp++; srcp++;
  792. }
  793. } else {
  794. qdf_mem_copy(&cmd[sizeof(segHdrInfo)],
  795. bufpos, chunkLen);
  796. }
  797. #else
  798. qdf_mem_copy(&cmd[sizeof(segHdrInfo)], bufpos, chunkLen);
  799. #endif
  800. ret = wmi_unified_cmd_send(wmi_handle, buf,
  801. (chunkLen + sizeof(segHdrInfo)),
  802. WMI_PDEV_UTF_CMDID);
  803. if (ret != 0)
  804. break;
  805. param->len -= chunkLen;
  806. bufpos += chunkLen;
  807. }
  808. msgref++;
  809. return ret;
  810. }
  811. /**
  812. * send_pdev_qvit_cmd_non_tlv() - send qvit command to fw
  813. * @wmi_handle: wmi handle
  814. * @param: pointer to pdev_qvit_params
  815. *
  816. * Return: 0 for success or error code
  817. */
  818. static QDF_STATUS
  819. send_pdev_qvit_cmd_non_tlv(wmi_unified_t wmi_handle,
  820. struct pdev_qvit_params *param)
  821. {
  822. wmi_buf_t buf;
  823. u_int8_t *cmd;
  824. int ret = 0;
  825. /* We can initialize the value and increment.*/
  826. static u_int8_t msgref = 1;
  827. u_int8_t segNumber = 0, segInfo, numSegments;
  828. u_int16_t chunkLen, totalBytes;
  829. u_int8_t *bufpos;
  830. QVIT_SEG_HDR_INFO_STRUCT segHdrInfo;
  831. /*
  832. #ifdef QVIT_DEBUG
  833. qdf_print(KERN_INFO "QVIT: %s: called\n", __func__);
  834. #endif
  835. */
  836. bufpos = param->utf_payload;
  837. totalBytes = param->len;
  838. numSegments = (totalBytes / MAX_WMI_QVIT_LEN);
  839. if (param->len - (numSegments * MAX_WMI_QVIT_LEN))
  840. numSegments++;
  841. while (param->len) {
  842. if (param->len > MAX_WMI_QVIT_LEN)
  843. chunkLen = MAX_WMI_QVIT_LEN; /* MAX messsage.. */
  844. else
  845. chunkLen = param->len;
  846. buf = wmi_buf_alloc(wmi_handle,
  847. (chunkLen + sizeof(segHdrInfo)));
  848. if (!buf) {
  849. qdf_print(KERN_ERR "QVIT: %s: wmi_buf_alloc failed\n",
  850. __func__);
  851. return QDF_STATUS_E_FAILURE;
  852. }
  853. cmd = (u_int8_t *)wmi_buf_data(buf);
  854. segHdrInfo.len = totalBytes;
  855. segHdrInfo.msgref = msgref;
  856. segInfo = ((numSegments << 4) & 0xF0) | (segNumber & 0xF);
  857. segHdrInfo.segmentInfo = segInfo;
  858. segNumber++;
  859. qdf_mem_copy(cmd, &segHdrInfo, sizeof(segHdrInfo));
  860. qdf_mem_copy(&cmd[sizeof(segHdrInfo)], bufpos, chunkLen);
  861. ret = wmi_unified_cmd_send(wmi_handle, buf,
  862. (chunkLen + sizeof(segHdrInfo)),
  863. WMI_PDEV_QVIT_CMDID);
  864. if (ret != 0) {
  865. qdf_print
  866. (KERN_ERR "QVIT: %s: wmi_unified_cmd_send failed\n",
  867. __func__);
  868. break;
  869. }
  870. param->len -= chunkLen;
  871. bufpos += chunkLen;
  872. }
  873. msgref++;
  874. return ret;
  875. }
  876. /**
  877. * send_pdev_param_cmd_non_tlv() - set pdev parameters
  878. * @wmi_handle: wmi handle
  879. * @param: pointer to pdev parameter
  880. * @mac_id: radio context
  881. *
  882. * Return: 0 on success, errno on failure
  883. */
  884. static QDF_STATUS
  885. send_pdev_param_cmd_non_tlv(wmi_unified_t wmi_handle,
  886. struct pdev_params *param, uint8_t mac_id)
  887. {
  888. wmi_pdev_set_param_cmd *cmd;
  889. wmi_buf_t buf;
  890. int len = sizeof(wmi_pdev_set_param_cmd);
  891. if ((param->param_id < wmi_pdev_param_max) &&
  892. (wmi_handle->pdev_param[param->param_id]
  893. != WMI_UNAVAILABLE_PARAM)) {
  894. buf = wmi_buf_alloc(wmi_handle, len);
  895. if (!buf) {
  896. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  897. return QDF_STATUS_E_FAILURE;
  898. }
  899. cmd = (wmi_pdev_set_param_cmd *)wmi_buf_data(buf);
  900. cmd->param_id = wmi_handle->pdev_param[param->param_id];
  901. cmd->param_value = param->param_value;
  902. return wmi_unified_cmd_send(wmi_handle, buf, len,
  903. WMI_PDEV_SET_PARAM_CMDID);
  904. }
  905. return QDF_STATUS_E_FAILURE;
  906. }
  907. /**
  908. * send_suspend_cmd_non_tlv() - WMI suspend function
  909. *
  910. * @param wmi_handle : handle to WMI.
  911. * @param param : pointer to hold suspend parameter
  912. * @mac_id: radio context
  913. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  914. */
  915. static QDF_STATUS send_suspend_cmd_non_tlv(wmi_unified_t wmi_handle,
  916. struct suspend_params *param,
  917. uint8_t mac_id)
  918. {
  919. wmi_pdev_suspend_cmd *cmd;
  920. wmi_buf_t wmibuf;
  921. uint32_t len = sizeof(wmi_pdev_suspend_cmd);
  922. /*send the comand to Target to ignore the
  923. * PCIE reset so as to ensure that Host and target
  924. * states are in sync*/
  925. wmibuf = wmi_buf_alloc(wmi_handle, len);
  926. if (wmibuf == NULL)
  927. return QDF_STATUS_E_FAILURE;
  928. cmd = (wmi_pdev_suspend_cmd *)wmi_buf_data(wmibuf);
  929. if (param->disable_target_intr)
  930. cmd->suspend_opt = WMI_PDEV_SUSPEND_AND_DISABLE_INTR;
  931. else
  932. cmd->suspend_opt = WMI_PDEV_SUSPEND;
  933. /*
  934. * Flush pending packets in HTC endpoint queue
  935. *
  936. */
  937. wmi_flush_endpoint(wmi_handle);
  938. return wmi_unified_cmd_send(wmi_handle, wmibuf, len,
  939. WMI_PDEV_SUSPEND_CMDID);
  940. }
  941. /**
  942. * send_resume_cmd_non_tlv() - WMI resume function
  943. *
  944. * @param wmi_handle : handle to WMI.
  945. * @mac_id: radio context
  946. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  947. */
  948. static QDF_STATUS send_resume_cmd_non_tlv(wmi_unified_t wmi_handle,
  949. uint8_t mac_id)
  950. {
  951. wmi_buf_t wmibuf;
  952. wmibuf = wmi_buf_alloc(wmi_handle, 0);
  953. if (wmibuf == NULL)
  954. return QDF_STATUS_E_NOMEM;
  955. return wmi_unified_cmd_send(wmi_handle, wmibuf, 0,
  956. WMI_PDEV_RESUME_CMDID);
  957. }
  958. /**
  959. * send_wow_enable_cmd_non_tlv() - WMI wow enable function
  960. *
  961. * @param wmi_handle : handle to WMI.
  962. * @param param : pointer to hold wow enable parameter
  963. * @mac_id: radio context
  964. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  965. */
  966. static QDF_STATUS send_wow_enable_cmd_non_tlv(wmi_unified_t wmi_handle,
  967. struct wow_cmd_params *param, uint8_t mac_id)
  968. {
  969. QDF_STATUS res;
  970. wmi_buf_t buf = NULL;
  971. buf = wmi_buf_alloc(wmi_handle, 4);
  972. if (!buf) {
  973. qdf_print("buf alloc failed\n");
  974. return QDF_STATUS_E_NOMEM;
  975. }
  976. res = wmi_unified_cmd_send(wmi_handle, buf, 4, WMI_WOW_ENABLE_CMDID);
  977. qdf_print("send_wow_enable result: %d\n", res);
  978. return (res == QDF_STATUS_SUCCESS) ?
  979. QDF_STATUS_SUCCESS : QDF_STATUS_E_FAILURE;
  980. }
  981. /**
  982. * send_wow_wakeup_cmd_non_tlv() - WMI wow wakeup function
  983. *
  984. * @param wmi_handle : handle to WMI.
  985. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  986. */
  987. static QDF_STATUS send_wow_wakeup_cmd_non_tlv(wmi_unified_t wmi_handle)
  988. {
  989. QDF_STATUS res;
  990. wmi_buf_t buf = NULL;
  991. buf = wmi_buf_alloc(wmi_handle, 4);
  992. if (!buf) {
  993. qdf_print("buf alloc failed\n");
  994. return QDF_STATUS_E_NOMEM;
  995. }
  996. res = wmi_unified_cmd_send(wmi_handle, buf, 4,
  997. WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID);
  998. qdf_print("ol_wow_wakeup result: %d\n", res);
  999. return (res == QDF_STATUS_SUCCESS) ?
  1000. QDF_STATUS_SUCCESS : QDF_STATUS_E_FAILURE;
  1001. }
  1002. /**
  1003. * send_wow_add_wakeup_event_cmd_non_tlv() - WMI wow add wakeup event function
  1004. *
  1005. * @param wmi_handle : handle to WMI.
  1006. * @param param : pointer to hold wow wakeup event parameter
  1007. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1008. */
  1009. static QDF_STATUS send_wow_add_wakeup_event_cmd_non_tlv(wmi_unified_t wmi_handle,
  1010. struct wow_add_wakeup_params *param)
  1011. {
  1012. QDF_STATUS res;
  1013. WMI_WOW_ADD_DEL_EVT_CMD *cmd;
  1014. wmi_buf_t buf = NULL;
  1015. int len = sizeof(WMI_WOW_ADD_DEL_EVT_CMD);
  1016. buf = wmi_buf_alloc(wmi_handle, len);
  1017. if (!buf) {
  1018. qdf_print("buf alloc failed\n");
  1019. return QDF_STATUS_E_NOMEM;
  1020. }
  1021. cmd = (WMI_WOW_ADD_DEL_EVT_CMD *)wmi_buf_data(buf);
  1022. cmd->is_add = 1;
  1023. cmd->event_bitmap = param->type;
  1024. res = wmi_unified_cmd_send(wmi_handle, buf, len,
  1025. WMI_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID);
  1026. return (res == QDF_STATUS_SUCCESS) ?
  1027. QDF_STATUS_SUCCESS : QDF_STATUS_E_FAILURE;
  1028. }
  1029. /**
  1030. * send_wow_add_wakeup_pattern_cmd_non_tlv() - WMI wow add wakeup pattern function
  1031. *
  1032. * @param wmi_handle : handle to WMI.
  1033. * @param param : pointer to hold wow wakeup pattern parameter
  1034. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1035. */
  1036. static QDF_STATUS send_wow_add_wakeup_pattern_cmd_non_tlv(wmi_unified_t wmi_handle,
  1037. struct wow_add_wakeup_pattern_params *param)
  1038. {
  1039. WOW_BITMAP_PATTERN_T bitmap_pattern;
  1040. uint32_t j;
  1041. /*
  1042. struct ol_wow_info *wowInfo;
  1043. OL_WOW_PATTERN *pattern;
  1044. struct ol_ath_softc_net80211 *scn = OL_ATH_SOFTC_NET80211(ic);
  1045. */
  1046. QDF_STATUS res;
  1047. WMI_WOW_ADD_PATTERN_CMD *cmd;
  1048. wmi_buf_t buf = NULL;
  1049. int len = sizeof(WMI_WOW_ADD_PATTERN_CMD);
  1050. buf = wmi_buf_alloc(wmi_handle, len);
  1051. if (!buf) {
  1052. qdf_print("buf alloc failed\n");
  1053. return QDF_STATUS_E_NOMEM;
  1054. }
  1055. cmd = (WMI_WOW_ADD_PATTERN_CMD *)wmi_buf_data(buf);
  1056. cmd->pattern_id = param->pattern_id;
  1057. cmd->pattern_type = WOW_BITMAP_PATTERN;
  1058. for (j = 0; j < WOW_DEFAULT_BITMAP_PATTERN_SIZE; j++)
  1059. bitmap_pattern.patternbuf[j] = param->pattern_bytes[j];
  1060. for (j = 0; j < WOW_DEFAULT_BITMASK_SIZE; j++)
  1061. bitmap_pattern.bitmaskbuf[j] = param->mask_bytes[j];
  1062. bitmap_pattern.pattern_offset = 0;
  1063. cmd->pattern_info.bitmap = bitmap_pattern;
  1064. res = wmi_unified_cmd_send(wmi_handle, buf, len,
  1065. WMI_WOW_ADD_WAKE_PATTERN_CMDID);
  1066. return (res == QDF_STATUS_SUCCESS) ?
  1067. QDF_STATUS_SUCCESS : QDF_STATUS_E_FAILURE;
  1068. }
  1069. /**
  1070. * send_wow_remove_wakeup_pattern_cmd_non_tlv() - WMI wow remove wakeup
  1071. * pattern function
  1072. *
  1073. * @param wmi_handle : handle to WMI.
  1074. * @param param : pointer to hold wow wakeup pattern parameter
  1075. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1076. */
  1077. static QDF_STATUS send_wow_remove_wakeup_pattern_cmd_non_tlv(wmi_unified_t wmi_handle,
  1078. struct wow_remove_wakeup_pattern_params *param)
  1079. {
  1080. WMI_WOW_DEL_PATTERN_CMD *cmd;
  1081. QDF_STATUS res;
  1082. wmi_buf_t buf = NULL;
  1083. int len = sizeof(WMI_WOW_DEL_PATTERN_CMD);
  1084. buf = wmi_buf_alloc(wmi_handle, len);
  1085. if (!buf) {
  1086. qdf_print("buf alloc failed\n");
  1087. return QDF_STATUS_E_NOMEM;
  1088. }
  1089. cmd = (WMI_WOW_DEL_PATTERN_CMD *)wmi_buf_data(buf);
  1090. cmd->pattern_id = param->pattern_id;
  1091. cmd->pattern_type = WOW_BITMAP_PATTERN;
  1092. res = wmi_unified_cmd_send(wmi_handle, buf, len,
  1093. WMI_WOW_DEL_WAKE_PATTERN_CMDID);
  1094. return (res == QDF_STATUS_SUCCESS) ?
  1095. QDF_STATUS_SUCCESS : QDF_STATUS_E_FAILURE;
  1096. }
  1097. /**
  1098. * send_set_ap_ps_param_cmd_non_tlv() - set ap powersave parameters
  1099. * @param wmi_handle : handle to WMI.
  1100. * @peer_addr: peer mac address
  1101. * @param: pointer to ap_ps parameter structure
  1102. *
  1103. * Return: 0 for success or error code
  1104. */
  1105. static QDF_STATUS send_set_ap_ps_param_cmd_non_tlv(wmi_unified_t wmi_handle,
  1106. uint8_t *peer_addr,
  1107. struct ap_ps_params *param)
  1108. {
  1109. wmi_ap_ps_peer_cmd *cmd;
  1110. wmi_buf_t buf;
  1111. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1112. if (!buf) {
  1113. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1114. return QDF_STATUS_E_FAILURE;
  1115. }
  1116. cmd = (wmi_ap_ps_peer_cmd *)wmi_buf_data(buf);
  1117. cmd->vdev_id = param->vdev_id;
  1118. WMI_CHAR_ARRAY_TO_MAC_ADDR(peer_addr, &cmd->peer_macaddr);
  1119. cmd->param = param->param;
  1120. cmd->value = param->value;
  1121. return wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1122. WMI_AP_PS_PEER_PARAM_CMDID);
  1123. }
  1124. /**
  1125. * send_set_sta_ps_param_cmd_non_tlv() - set sta powersave parameters
  1126. * @param wmi_handle : handle to WMI.
  1127. * @param: pointer to sta_ps parameter structure
  1128. *
  1129. * Return: 0 for success or error code
  1130. */
  1131. static QDF_STATUS send_set_sta_ps_param_cmd_non_tlv(wmi_unified_t wmi_handle,
  1132. struct sta_ps_params *param)
  1133. {
  1134. wmi_sta_powersave_param_cmd *cmd;
  1135. wmi_buf_t buf;
  1136. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1137. if (!buf) {
  1138. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1139. return QDF_STATUS_E_FAILURE;
  1140. }
  1141. cmd = (wmi_sta_powersave_param_cmd *)wmi_buf_data(buf);
  1142. cmd->vdev_id = param->vdev_id;
  1143. cmd->param = param->param;
  1144. cmd->value = param->value;
  1145. return wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1146. WMI_STA_POWERSAVE_PARAM_CMDID);
  1147. }
  1148. /**
  1149. * send_set_ps_mode_cmd_non_tlv() - set powersave mode
  1150. * @wmi_handle: wmi handle
  1151. * @param: pointer to ps_mode parameter structure
  1152. *
  1153. * Return: 0 for success or error code
  1154. */
  1155. static QDF_STATUS send_set_ps_mode_cmd_non_tlv(wmi_unified_t wmi_handle,
  1156. struct set_ps_mode_params *param)
  1157. {
  1158. wmi_sta_powersave_mode_cmd *cmd;
  1159. wmi_buf_t buf;
  1160. int ret;
  1161. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1162. if (!buf) {
  1163. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1164. return QDF_STATUS_E_FAILURE;
  1165. }
  1166. qdf_print("%s:set psmode=%d\n", __func__, param->psmode);
  1167. cmd = (wmi_sta_powersave_mode_cmd *)wmi_buf_data(buf);
  1168. cmd->vdev_id = param->vdev_id;
  1169. cmd->sta_ps_mode = param->psmode;
  1170. ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  1171. WMI_STA_POWERSAVE_MODE_CMDID);
  1172. return ret;
  1173. }
  1174. /**
  1175. * send_crash_inject_cmd_non_tlv() - inject fw crash
  1176. * @param wmi_handle : handle to WMI.
  1177. * @param: ponirt to crash inject paramter structure
  1178. *
  1179. * Return: 0 for success or return error
  1180. */
  1181. static QDF_STATUS send_crash_inject_cmd_non_tlv(wmi_unified_t wmi_handle,
  1182. struct crash_inject *param)
  1183. {
  1184. WMI_FORCE_FW_HANG_CMD *cmd;
  1185. wmi_buf_t buf;
  1186. int32_t len = sizeof(WMI_FORCE_FW_HANG_CMD);
  1187. buf = wmi_buf_alloc(wmi_handle, len);
  1188. if (!buf) {
  1189. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  1190. return QDF_STATUS_E_FAILURE;
  1191. }
  1192. cmd = (WMI_FORCE_FW_HANG_CMD *)wmi_buf_data(buf);
  1193. cmd->type = 1;
  1194. /* Should this be param->type ? */
  1195. cmd->delay_time_ms = param->delay_time_ms;
  1196. return wmi_unified_cmd_send(wmi_handle, buf, len,
  1197. WMI_FORCE_FW_HANG_CMDID);
  1198. }
  1199. /**
  1200. * send_dbglog_cmd_non_tlv() - set debug log level
  1201. *
  1202. * @param wmi_handle : handle to WMI.
  1203. * @param param : pointer to hold dbglog level parameter
  1204. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1205. */
  1206. static QDF_STATUS
  1207. send_dbglog_cmd_non_tlv(wmi_unified_t wmi_handle,
  1208. struct dbglog_params *dbglog_param)
  1209. {
  1210. wmi_buf_t osbuf;
  1211. WMI_DBGLOG_CFG_CMD *cmd;
  1212. QDF_STATUS status;
  1213. osbuf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  1214. if (osbuf == NULL)
  1215. return QDF_STATUS_E_NOMEM;
  1216. qdf_nbuf_put_tail(osbuf, sizeof(*cmd));
  1217. cmd = (WMI_DBGLOG_CFG_CMD *)(wmi_buf_data(osbuf));
  1218. qdf_print("wmi_dbg_cfg_send: mod[0]%08x dbgcfg%08x cfgvalid[0] %08x"
  1219. " cfgvalid[1] %08x\n",
  1220. dbglog_param->module_id_bitmap[0],
  1221. dbglog_param->val, dbglog_param->cfgvalid[0],
  1222. dbglog_param->cfgvalid[1]);
  1223. cmd->config.cfgvalid[0] = dbglog_param->cfgvalid[0];
  1224. cmd->config.cfgvalid[1] = dbglog_param->cfgvalid[1];
  1225. qdf_mem_copy(&cmd->config.config.mod_id[0],
  1226. dbglog_param->module_id_bitmap,
  1227. sizeof(cmd->config.config.mod_id));
  1228. cmd->config.config.dbg_config = dbglog_param->val;
  1229. status = wmi_unified_cmd_send(wmi_handle, osbuf,
  1230. sizeof(WMI_DBGLOG_CFG_CMD),
  1231. WMI_DBGLOG_CFG_CMDID);
  1232. return status;
  1233. }
  1234. /**
  1235. * send_vdev_set_param_cmd_non_tlv() - WMI vdev set parameter function
  1236. *
  1237. * @param wmi_handle : handle to WMI.
  1238. * @param param : pointer to hold vdev set parameter
  1239. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1240. */
  1241. static QDF_STATUS send_vdev_set_param_cmd_non_tlv(wmi_unified_t wmi_handle,
  1242. struct vdev_set_params *param)
  1243. {
  1244. wmi_vdev_set_param_cmd *cmd;
  1245. wmi_buf_t buf;
  1246. int len = sizeof(wmi_vdev_set_param_cmd);
  1247. if ((param->param_id < wmi_vdev_param_max) &&
  1248. (wmi_handle->vdev_param[param->param_id] !=
  1249. WMI_UNAVAILABLE_PARAM)) {
  1250. buf = wmi_buf_alloc(wmi_handle, len);
  1251. if (!buf) {
  1252. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  1253. return QDF_STATUS_E_FAILURE;
  1254. }
  1255. cmd = (wmi_vdev_set_param_cmd *)wmi_buf_data(buf);
  1256. cmd->vdev_id = param->if_id;
  1257. cmd->param_id = wmi_handle->vdev_param[param->param_id];
  1258. cmd->param_value = param->param_value;
  1259. return wmi_unified_cmd_send(wmi_handle, buf, len,
  1260. WMI_VDEV_SET_PARAM_CMDID);
  1261. }
  1262. return QDF_STATUS_E_FAILURE;
  1263. }
  1264. /**
  1265. * get_stats_id_non_tlv() - Get stats identifier function
  1266. *
  1267. * @param host_stats_id: host stats identifier value
  1268. * @return stats_id based on host_stats_id
  1269. */
  1270. static uint32_t get_stats_id_non_tlv(wmi_host_stats_id host_stats_id)
  1271. {
  1272. uint32_t stats_id = 0;
  1273. if (host_stats_id & WMI_HOST_REQUEST_PEER_STAT)
  1274. stats_id |= WMI_REQUEST_PEER_STAT;
  1275. if (host_stats_id & WMI_HOST_REQUEST_AP_STAT)
  1276. stats_id |= WMI_REQUEST_AP_STAT;
  1277. if (host_stats_id & WMI_HOST_REQUEST_INST_STAT)
  1278. stats_id |= WMI_REQUEST_INST_STAT;
  1279. if (host_stats_id & WMI_HOST_REQUEST_PEER_EXTD_STAT)
  1280. stats_id |= WMI_REQUEST_PEER_EXTD_STAT;
  1281. if (host_stats_id & WMI_HOST_REQUEST_NAC_RSSI)
  1282. stats_id |= WMI_REQUEST_NAC_RSSI_STAT;
  1283. return stats_id;
  1284. }
  1285. /**
  1286. * send_stats_request_cmd_non_tlv() - WMI request stats function
  1287. *
  1288. * @param wmi_handle : handle to WMI.
  1289. * @param macaddr : MAC address
  1290. * @param param : pointer to hold stats request parameter
  1291. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1292. */
  1293. static QDF_STATUS send_stats_request_cmd_non_tlv(wmi_unified_t wmi_handle,
  1294. uint8_t macaddr[IEEE80211_ADDR_LEN],
  1295. struct stats_request_params *param)
  1296. {
  1297. wmi_buf_t buf;
  1298. wmi_request_stats_cmd *cmd;
  1299. uint8_t len = sizeof(wmi_request_stats_cmd);
  1300. buf = wmi_buf_alloc(wmi_handle, len);
  1301. if (!buf) {
  1302. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  1303. return QDF_STATUS_E_INVAL;
  1304. }
  1305. cmd = (wmi_request_stats_cmd *)wmi_buf_data(buf);
  1306. cmd->stats_id = get_stats_id_non_tlv(param->stats_id);
  1307. cmd->vdev_id = param->vdev_id;
  1308. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  1309. cmd->inst_rssi_args.cfg_retry_count = param->rssi_args.cfg_retry_count;
  1310. cmd->inst_rssi_args.retry_count = param->rssi_args.retry_count;
  1311. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1312. WMI_REQUEST_STATS_CMDID)) {
  1313. return QDF_STATUS_E_INVAL;
  1314. }
  1315. return QDF_STATUS_SUCCESS;
  1316. }
  1317. /**
  1318. * send_bss_chan_info_request_cmd_non_tlv() - WMI request bss chan info
  1319. *
  1320. * @param wmi_handle : handle to WMI.
  1321. * @param param : pointer to hold bss chan info request parameter
  1322. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1323. */
  1324. static QDF_STATUS send_bss_chan_info_request_cmd_non_tlv(wmi_unified_t wmi_handle,
  1325. struct bss_chan_info_request_params *param)
  1326. {
  1327. wmi_buf_t buf;
  1328. wmi_pdev_bss_chan_info_request *cmd;
  1329. u_int8_t len = sizeof(wmi_pdev_bss_chan_info_request);
  1330. buf = wmi_buf_alloc(wmi_handle, len);
  1331. if (!buf) {
  1332. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  1333. return QDF_STATUS_E_INVAL;
  1334. }
  1335. cmd = (wmi_pdev_bss_chan_info_request *)wmi_buf_data(buf);
  1336. cmd->param = param->param;
  1337. cmd->reserved = 0;
  1338. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1339. WMI_PDEV_BSS_CHAN_INFO_REQUEST_CMDID)) {
  1340. return QDF_STATUS_E_INVAL;
  1341. }
  1342. return QDF_STATUS_SUCCESS;
  1343. }
  1344. /**
  1345. * send_packet_log_enable_cmd_non_tlv() - WMI request stats function
  1346. *
  1347. * @param wmi_handle : handle to WMI.
  1348. * @param PKTLOG_EVENT : packet log event
  1349. * @mac_id: mac id to have radio context
  1350. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1351. */
  1352. static QDF_STATUS send_packet_log_enable_cmd_non_tlv(wmi_unified_t wmi_handle,
  1353. WMI_HOST_PKTLOG_EVENT PKTLOG_EVENT, uint8_t mac_id)
  1354. {
  1355. wmi_pdev_pktlog_enable_cmd *cmd;
  1356. int len = 0;
  1357. wmi_buf_t buf;
  1358. len = sizeof(wmi_pdev_pktlog_enable_cmd);
  1359. buf = wmi_buf_alloc(wmi_handle, len);
  1360. if (!buf) {
  1361. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  1362. return QDF_STATUS_E_NOMEM;
  1363. }
  1364. cmd = (wmi_pdev_pktlog_enable_cmd *)wmi_buf_data(buf);
  1365. cmd->evlist = PKTLOG_EVENT;
  1366. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1367. WMI_PDEV_PKTLOG_ENABLE_CMDID)) {
  1368. return QDF_STATUS_E_FAILURE;
  1369. }
  1370. return QDF_STATUS_SUCCESS;
  1371. }
  1372. /**
  1373. * send_packet_log_disable_cmd_non_tlv() - WMI disable packet log send function
  1374. *
  1375. * @param wmi_handle : handle to WMI.
  1376. * @mac_id: mac id to have radio context
  1377. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1378. */
  1379. static QDF_STATUS send_packet_log_disable_cmd_non_tlv(wmi_unified_t wmi_handle,
  1380. uint8_t mac_id)
  1381. {
  1382. int len = 0;
  1383. wmi_buf_t buf;
  1384. buf = wmi_buf_alloc(wmi_handle, 0);
  1385. if (!buf) {
  1386. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  1387. return QDF_STATUS_E_NOMEM;
  1388. }
  1389. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1390. WMI_PDEV_PKTLOG_DISABLE_CMDID)) {
  1391. return QDF_STATUS_E_FAILURE;
  1392. }
  1393. return QDF_STATUS_SUCCESS;
  1394. }
  1395. /**
  1396. * send_beacon_send_cmd_non_tlv() - WMI beacon send function
  1397. *
  1398. * @param wmi_handle : handle to WMI.
  1399. * @param param : pointer to hold beacon send cmd parameter
  1400. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1401. */
  1402. static QDF_STATUS send_beacon_send_cmd_non_tlv(wmi_unified_t wmi_handle,
  1403. struct beacon_params *param)
  1404. {
  1405. if (param->is_high_latency) {
  1406. wmi_bcn_tx_cmd *cmd;
  1407. wmi_buf_t wmi_buf;
  1408. int bcn_len = qdf_nbuf_len(param->wbuf);
  1409. int len = sizeof(wmi_bcn_tx_hdr) + bcn_len;
  1410. /*************************************************************
  1411. * TODO: Once we have the host target transport framework for
  1412. * sending management frames this wmi function will be replaced
  1413. * with calls to HTT. The buffer will changed to match the right
  1414. * format to be used with HTT.
  1415. *************************************************************/
  1416. wmi_buf = wmi_buf_alloc(wmi_handle, roundup(len,
  1417. sizeof(u_int32_t)));
  1418. if (!wmi_buf) {
  1419. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1420. return QDF_STATUS_E_NOMEM;
  1421. }
  1422. cmd = (wmi_bcn_tx_cmd *)wmi_buf_data(wmi_buf);
  1423. cmd->hdr.vdev_id = param->vdev_id;
  1424. cmd->hdr.buf_len = bcn_len;
  1425. #ifdef BIG_ENDIAN_HOST
  1426. {
  1427. /* for big endian host, copy engine byte_swap is enabled
  1428. * But the beacon buffer content is in network byte
  1429. * order Need to byte swap the beacon buffer content -
  1430. * so when copy engine does byte_swap - target gets
  1431. * buffer content in the correct order
  1432. */
  1433. int i;
  1434. u_int32_t *destp, *srcp;
  1435. destp = (u_int32_t *)cmd->bufp;
  1436. srcp = (u_int32_t *)wmi_buf_data(param->wbuf);
  1437. for (i = 0; i < (roundup(bcn_len,
  1438. sizeof(u_int32_t))/4); i++) {
  1439. *destp = qdf_le32_to_cpu(*srcp);
  1440. destp++; srcp++;
  1441. }
  1442. }
  1443. #else
  1444. qdf_mem_copy(cmd->bufp, wmi_buf_data(param->wbuf), bcn_len);
  1445. #endif
  1446. #ifdef DEBUG_BEACON
  1447. qdf_print("%s frm length %d\n", __func__, bcn_len);
  1448. #endif
  1449. wmi_unified_cmd_send(wmi_handle, wmi_buf,
  1450. roundup(len, sizeof(u_int32_t)), WMI_BCN_TX_CMDID);
  1451. } else {
  1452. wmi_bcn_send_from_host_cmd_t *cmd;
  1453. wmi_buf_t wmi_buf;
  1454. int bcn_len = qdf_nbuf_len(param->wbuf);
  1455. int len = sizeof(wmi_bcn_send_from_host_cmd_t);
  1456. A_UINT32 dtim_flag = 0;
  1457. /* get the DTIM count */
  1458. if (param->is_dtim_count_zero) {
  1459. dtim_flag |= WMI_BCN_SEND_DTIM_ZERO;
  1460. if (param->is_bitctl_reqd) {
  1461. /* deliver CAB traffic in next DTIM beacon */
  1462. dtim_flag |= WMI_BCN_SEND_DTIM_BITCTL_SET;
  1463. }
  1464. }
  1465. /* Map the beacon buffer to DMA region */
  1466. wmi_buf = wmi_buf_alloc(wmi_handle, roundup(len,
  1467. sizeof(u_int32_t)));
  1468. if (!wmi_buf) {
  1469. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1470. return QDF_STATUS_E_NOMEM;
  1471. }
  1472. cmd = (wmi_bcn_send_from_host_cmd_t *)wmi_buf_data(wmi_buf);
  1473. cmd->vdev_id = param->vdev_id;
  1474. cmd->data_len = bcn_len;
  1475. cmd->frame_ctrl = param->frame_ctrl;
  1476. cmd->dtim_flag = dtim_flag;
  1477. cmd->frag_ptr = qdf_nbuf_get_frag_paddr(param->wbuf, 0);
  1478. cmd->virt_addr = (uintptr_t)param->wbuf;
  1479. cmd->bcn_antenna = param->bcn_txant;
  1480. wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  1481. WMI_PDEV_SEND_BCN_CMDID);
  1482. }
  1483. return QDF_STATUS_SUCCESS;
  1484. }
  1485. #if 0
  1486. /**
  1487. * send_bcn_prb_template_cmd_non_tlv() - WMI beacon probe template function
  1488. *
  1489. * @param wmi_handle : handle to WMI.
  1490. * @param macaddr : MAC address
  1491. * @param param : pointer to hold beacon prb template cmd parameter
  1492. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1493. */
  1494. static QDF_STATUS send_bcn_prb_template_cmd_non_tlv(wmi_unified_t wmi_handle,
  1495. struct bcn_prb_template_params *param)
  1496. {
  1497. wmi_bcn_prb_tmpl_cmd *cmd;
  1498. wmi_buf_t buf;
  1499. wmi_bcn_prb_info *template;
  1500. int len = sizeof(wmi_bcn_prb_tmpl_cmd);
  1501. int ret;
  1502. /*
  1503. * The target will store this information for use with
  1504. * the beacons and probes.
  1505. */
  1506. buf = wmi_buf_alloc(wmi_handle, len);
  1507. if (!buf) {
  1508. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1509. return QDF_STATUS_E_NOMEM;
  1510. }
  1511. cmd = (wmi_bcn_prb_tmpl_cmd *)wmi_buf_data(buf);
  1512. cmd->vdev_id = param->vdev_id;
  1513. cmd->buf_len = param->buf_len;
  1514. template = &cmd->bcn_prb_info;
  1515. template->caps = param->caps;
  1516. template->erp = param->erp;
  1517. /* TODO: Few more elements to be added and copied to the template
  1518. * buffer */
  1519. /* Send the beacon probe template to the target */
  1520. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1521. WMI_BCN_PRB_TMPL_CMDID);
  1522. return ret;
  1523. }
  1524. #endif
  1525. /**
  1526. * send_peer_assoc_cmd_non_tlv() - WMI peer assoc function
  1527. *
  1528. * @param wmi_handle : handle to WMI.
  1529. * @param param : pointer to peer assoc parameter
  1530. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1531. */
  1532. static QDF_STATUS send_peer_assoc_cmd_non_tlv(wmi_unified_t wmi_handle,
  1533. struct peer_assoc_params *param)
  1534. {
  1535. wmi_peer_assoc_complete_cmd *cmd;
  1536. int len = sizeof(wmi_peer_assoc_complete_cmd);
  1537. #ifdef BIG_ENDIAN_HOST
  1538. int i;
  1539. #endif
  1540. wmi_buf_t buf;
  1541. buf = wmi_buf_alloc(wmi_handle, len);
  1542. if (!buf) {
  1543. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1544. return QDF_STATUS_E_FAILURE;
  1545. }
  1546. cmd = (wmi_peer_assoc_complete_cmd *)wmi_buf_data(buf);
  1547. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->peer_mac, &cmd->peer_macaddr);
  1548. cmd->vdev_id = param->vdev_id;
  1549. cmd->peer_new_assoc = param->peer_new_assoc;
  1550. cmd->peer_associd = param->peer_associd;
  1551. cmd->peer_bw_rxnss_override = 0;
  1552. /*
  1553. * The target only needs a subset of the flags maintained in the host.
  1554. * Just populate those flags and send it down
  1555. */
  1556. cmd->peer_flags = 0;
  1557. if (param->is_pmf_enabled)
  1558. cmd->peer_flags |= WMI_PEER_PMF_ENABLED;
  1559. /*
  1560. * Do not enable HT/VHT if WMM/wme is disabled for vap.
  1561. */
  1562. if (param->is_wme_set) {
  1563. if (param->qos_flag)
  1564. cmd->peer_flags |= WMI_PEER_QOS;
  1565. if (param->apsd_flag)
  1566. cmd->peer_flags |= WMI_PEER_APSD;
  1567. if (param->ht_flag)
  1568. cmd->peer_flags |= WMI_PEER_HT;
  1569. if (param->bw_40)
  1570. cmd->peer_flags |= WMI_PEER_40MHZ;
  1571. if (param->bw_80)
  1572. cmd->peer_flags |= WMI_PEER_80MHZ;
  1573. if (param->bw_160)
  1574. cmd->peer_flags |= WMI_PEER_160MHZ;
  1575. /* Typically if STBC is enabled for VHT it should be enabled
  1576. * for HT as well */
  1577. if (param->stbc_flag)
  1578. cmd->peer_flags |= WMI_PEER_STBC;
  1579. /* Typically if LDPC is enabled for VHT it should be enabled
  1580. * for HT as well */
  1581. if (param->ldpc_flag)
  1582. cmd->peer_flags |= WMI_PEER_LDPC;
  1583. if (param->static_mimops_flag)
  1584. cmd->peer_flags |= WMI_PEER_STATIC_MIMOPS;
  1585. if (param->dynamic_mimops_flag)
  1586. cmd->peer_flags |= WMI_PEER_DYN_MIMOPS;
  1587. if (param->spatial_mux_flag)
  1588. cmd->peer_flags |= WMI_PEER_SPATIAL_MUX;
  1589. if (param->vht_flag)
  1590. cmd->peer_flags |= WMI_PEER_VHT;
  1591. if (param->vht_ng_flag)
  1592. cmd->peer_flags |= WMI_PEER_VHT_2G;
  1593. }
  1594. /*
  1595. * Suppress authorization for all AUTH modes that need 4-way handshake
  1596. * (during re-association).
  1597. * Authorization will be done for these modes on key installation.
  1598. */
  1599. if (param->auth_flag)
  1600. cmd->peer_flags |= WMI_PEER_AUTH;
  1601. if (param->need_ptk_4_way)
  1602. cmd->peer_flags |= WMI_PEER_NEED_PTK_4_WAY;
  1603. else
  1604. cmd->peer_flags &= ~WMI_PEER_NEED_PTK_4_WAY;
  1605. if (param->need_gtk_2_way)
  1606. cmd->peer_flags |= WMI_PEER_NEED_GTK_2_WAY;
  1607. /* safe mode bypass the 4-way handshake */
  1608. if (param->safe_mode_enabled)
  1609. cmd->peer_flags &=
  1610. ~(WMI_PEER_NEED_PTK_4_WAY | WMI_PEER_NEED_GTK_2_WAY);
  1611. /* Disable AMSDU for station transmit, if user configures it */
  1612. /* Disable AMSDU for AP transmit to 11n Stations, if user configures
  1613. * it */
  1614. if (param->amsdu_disable)
  1615. cmd->peer_flags |= WMI_PEER_AMSDU_DISABLE;
  1616. cmd->peer_caps = param->peer_caps;
  1617. cmd->peer_listen_intval = param->peer_listen_intval;
  1618. cmd->peer_ht_caps = param->peer_ht_caps;
  1619. cmd->peer_max_mpdu = param->peer_max_mpdu;
  1620. cmd->peer_mpdu_density = param->peer_mpdu_density;
  1621. cmd->peer_vht_caps = param->peer_vht_caps;
  1622. /* Update peer rate information */
  1623. cmd->peer_rate_caps = param->peer_rate_caps;
  1624. cmd->peer_legacy_rates.num_rates = param->peer_legacy_rates.num_rates;
  1625. /* NOTE: cmd->peer_legacy_rates.rates is of type A_UINT32 */
  1626. /* ni->ni_rates.rs_rates is of type u_int8_t */
  1627. /**
  1628. * for cmd->peer_legacy_rates.rates:
  1629. * rates (each 8bit value) packed into a 32 bit word.
  1630. * the rates are filled from least significant byte to most
  1631. * significant byte.
  1632. */
  1633. qdf_mem_copy(cmd->peer_legacy_rates.rates,
  1634. param->peer_legacy_rates.rates,
  1635. param->peer_legacy_rates.num_rates);
  1636. #ifdef BIG_ENDIAN_HOST
  1637. for (i = 0;
  1638. i < param->peer_legacy_rates.num_rates/sizeof(A_UINT32) + 1;
  1639. i++)
  1640. cmd->peer_legacy_rates.rates[i] =
  1641. qdf_le32_to_cpu(cmd->peer_legacy_rates.rates[i]);
  1642. #endif
  1643. cmd->peer_ht_rates.num_rates = param->peer_ht_rates.num_rates;
  1644. qdf_mem_copy(cmd->peer_ht_rates.rates, param->peer_ht_rates.rates,
  1645. param->peer_ht_rates.num_rates);
  1646. #ifdef BIG_ENDIAN_HOST
  1647. for (i = 0; i < param->peer_ht_rates.num_rates/sizeof(A_UINT32) + 1;
  1648. i++)
  1649. cmd->peer_ht_rates.rates[i] =
  1650. qdf_le32_to_cpu(cmd->peer_ht_rates.rates[i]);
  1651. #endif
  1652. if (param->ht_flag &&
  1653. (param->peer_ht_rates.num_rates == 0)) {
  1654. /* Workaround for EV 116382: The node is marked HT but with
  1655. * supported rx mcs set is set to 0. 11n spec mandates MCS0-7
  1656. * for a HT STA. So forcing the supported rx mcs rate to MCS
  1657. * 0-7.
  1658. * This workaround will be removed once we get clarification
  1659. * from WFA regarding this STA behavior
  1660. */
  1661. u_int8_t temp_ni_rates[8] = {
  1662. 0x0, 0x1, 0x2, 0x3, 0x4, 0x5, 0x6, 0x7};
  1663. cmd->peer_ht_rates.num_rates = 8;
  1664. qdf_mem_copy(cmd->peer_ht_rates.rates, temp_ni_rates,
  1665. cmd->peer_ht_rates.num_rates);
  1666. }
  1667. /* Target asserts if node is marked HT and all MCS is set to 0.
  1668. Mark the node as non-HT if all the mcs rates are disabled through
  1669. iwpriv */
  1670. if (cmd->peer_ht_rates.num_rates == 0)
  1671. cmd->peer_flags &= ~WMI_PEER_HT;
  1672. cmd->peer_nss = param->peer_nss;
  1673. if (param->vht_capable) {
  1674. wmi_vht_rate_set *mcs;
  1675. mcs = &cmd->peer_vht_rates;
  1676. mcs->rx_max_rate = param->rx_max_rate;
  1677. mcs->rx_mcs_set = param->rx_mcs_set;
  1678. mcs->tx_max_rate = param->tx_max_rate;
  1679. mcs->tx_mcs_set = param->tx_mcs_set;
  1680. mcs->tx_max_mcs_nss = param->tx_max_mcs_nss;
  1681. }
  1682. cmd->peer_phymode = param->peer_phymode;
  1683. /*Send bandwidth-NSS mapping to FW*/
  1684. cmd->peer_bw_rxnss_override |= param->peer_bw_rxnss_override;
  1685. return wmi_unified_cmd_send(wmi_handle, buf, len, WMI_PEER_ASSOC_CMDID);
  1686. }
  1687. /**
  1688. * send_scan_start_cmd_non_tlv() - WMI scan start function
  1689. *
  1690. * @param wmi_handle : handle to WMI.
  1691. * @param param : pointer to hold scan start cmd parameter
  1692. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1693. */
  1694. static QDF_STATUS send_scan_start_cmd_non_tlv(wmi_unified_t wmi_handle,
  1695. struct scan_req_params *param)
  1696. {
  1697. wmi_start_scan_cmd *cmd;
  1698. wmi_buf_t buf;
  1699. wmi_chan_list *chan_list;
  1700. wmi_bssid_list *bssid_list;
  1701. wmi_ssid_list *ssid_list;
  1702. wmi_ie_data *ie_data;
  1703. A_UINT32 *tmp_ptr;
  1704. int i, len = sizeof(wmi_start_scan_cmd);
  1705. #ifdef TEST_CODE
  1706. len += sizeof(wmi_chan_list) + 3 * sizeof(A_UINT32);
  1707. #else
  1708. if (param->chan_list.num_chan) {
  1709. len += sizeof(wmi_chan_list) + (param->chan_list.num_chan - 1)
  1710. * sizeof(A_UINT32);
  1711. }
  1712. #endif
  1713. if (param->num_ssids) {
  1714. len += sizeof(wmi_ssid_list) + (param->num_ssids - 1)
  1715. * sizeof(wmi_ssid);
  1716. }
  1717. if (param->num_bssid) {
  1718. len += sizeof(wmi_bssid_list) + (param->num_bssid - 1)
  1719. * sizeof(wmi_mac_addr);
  1720. }
  1721. if (param->extraie.len) {
  1722. i = param->extraie.len % sizeof(A_UINT32);
  1723. if (i)
  1724. len += sizeof(A_UINT32) - i;
  1725. len += 2 * sizeof(A_UINT32) + param->extraie.len;
  1726. }
  1727. buf = wmi_buf_alloc(wmi_handle, len);
  1728. if (!buf) {
  1729. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1730. return QDF_STATUS_E_NOMEM;
  1731. }
  1732. cmd = (wmi_start_scan_cmd *)wmi_buf_data(buf);
  1733. OS_MEMZERO(cmd, len);
  1734. cmd->vdev_id = param->vdev_id;
  1735. cmd->scan_priority = param->scan_priority;
  1736. cmd->scan_id = param->scan_id;
  1737. cmd->scan_req_id = param->scan_req_id;
  1738. /* Scan events subscription */
  1739. if (param->scan_ev_started)
  1740. cmd->notify_scan_events |= WMI_SCAN_EVENT_STARTED;
  1741. if (param->scan_ev_completed)
  1742. cmd->notify_scan_events |= WMI_SCAN_EVENT_COMPLETED;
  1743. if (param->scan_ev_bss_chan)
  1744. cmd->notify_scan_events |= WMI_SCAN_EVENT_BSS_CHANNEL;
  1745. if (param->scan_ev_foreign_chan)
  1746. cmd->notify_scan_events |= WMI_SCAN_EVENT_FOREIGN_CHANNEL;
  1747. if (param->scan_ev_dequeued)
  1748. cmd->notify_scan_events |= WMI_SCAN_EVENT_DEQUEUED;
  1749. if (param->scan_ev_preempted)
  1750. cmd->notify_scan_events |= WMI_SCAN_EVENT_PREEMPTED;
  1751. if (param->scan_ev_start_failed)
  1752. cmd->notify_scan_events |= WMI_SCAN_EVENT_START_FAILED;
  1753. if (param->scan_ev_restarted)
  1754. cmd->notify_scan_events |= WMI_SCAN_EVENT_RESTARTED;
  1755. if (param->scan_ev_foreign_chn_exit)
  1756. cmd->notify_scan_events |= WMI_SCAN_EVENT_FOREIGN_CHANNEL_EXIT;
  1757. if (param->scan_ev_invalid)
  1758. cmd->notify_scan_events |= WMI_SCAN_EVENT_INVALID;
  1759. if (param->scan_ev_gpio_timeout)
  1760. cmd->notify_scan_events |= WMI_SCAN_EVENT_GPIO_TIMEOUT;
  1761. /** Max. active channel dwell time */
  1762. cmd->dwell_time_active = param->dwell_time_active;
  1763. /** Passive channel dwell time */
  1764. cmd->dwell_time_passive = param->dwell_time_passive;
  1765. /** Scan control flags */
  1766. cmd->scan_ctrl_flags = 0;
  1767. if (param->scan_f_passive)
  1768. cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_PASSIVE;
  1769. if (param->scan_f_strict_passive_pch)
  1770. cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_STRICT_PASSIVE_ON_PCHN;
  1771. if (param->scan_f_promisc_mode)
  1772. cmd->scan_ctrl_flags |= WMI_SCAN_PROMISCOUS_MODE;
  1773. if (param->scan_f_capture_phy_err)
  1774. cmd->scan_ctrl_flags |= WMI_SCAN_CAPTURE_PHY_ERROR;
  1775. if (param->scan_f_half_rate)
  1776. cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_HALF_RATE_SUPPORT;
  1777. if (param->scan_f_quarter_rate)
  1778. cmd->scan_ctrl_flags |= WMI_SCAN_FLAG_QUARTER_RATE_SUPPORT;
  1779. if (param->scan_f_cck_rates)
  1780. cmd->scan_ctrl_flags |= WMI_SCAN_ADD_CCK_RATES;
  1781. if (param->scan_f_chan_stat_evnt)
  1782. cmd->scan_ctrl_flags |= WMI_SCAN_CHAN_STAT_EVENT;
  1783. if (param->scan_f_bcast_probe)
  1784. cmd->scan_ctrl_flags |= WMI_SCAN_ADD_BCAST_PROBE_REQ;
  1785. if (param->scan_f_offchan_mgmt_tx)
  1786. cmd->scan_ctrl_flags |= WMI_SCAN_OFFCHAN_MGMT_TX;
  1787. if (param->scan_f_offchan_data_tx)
  1788. cmd->scan_ctrl_flags |= WMI_SCAN_OFFCHAN_DATA_TX;
  1789. /* Always enable ofdm rates */
  1790. cmd->scan_ctrl_flags |= WMI_SCAN_ADD_OFDM_RATES;
  1791. /** send multiple braodcast probe req with this delay in between */
  1792. cmd->repeat_probe_time = param->repeat_probe_time;
  1793. cmd->probe_spacing_time = param->probe_spacing_time;
  1794. /** delay between channel change and first probe request */
  1795. cmd->probe_delay = param->probe_delay;
  1796. /** idle time on channel for which if no traffic is seen
  1797. then scanner can switch to off channel */
  1798. cmd->idle_time = param->idle_time;
  1799. cmd->min_rest_time = param->min_rest_time;
  1800. /** maximum rest time allowed on bss channel, overwrites
  1801. * other conditions and changes channel to off channel
  1802. * even if min beacon count, idle time requirements are not met.
  1803. */
  1804. cmd->max_rest_time = param->max_rest_time;
  1805. /** maxmimum scan time allowed */
  1806. #if IPQ4019_EMU
  1807. cmd->max_scan_time = 0xffffffff;
  1808. #else
  1809. cmd->max_scan_time = param->max_scan_time;
  1810. #endif
  1811. tmp_ptr = (A_UINT32 *) (cmd + 1);
  1812. #ifdef TEST_CODE
  1813. #define DEFAULT_TIME 150
  1814. cmd->min_rest_time = DEFAULT_TIME;
  1815. cmd->idle_time = 10*DEFAULT_TIME;
  1816. cmd->max_rest_time = 30*DEFAULT_TIME;
  1817. chan_list = (wmi_chan_list *) tmp_ptr;
  1818. chan_list->tag = WMI_CHAN_LIST_TAG;
  1819. chan_list->num_chan = 4;
  1820. chan_list->channel_list[0] = 2412; /* 1 */
  1821. chan_list->channel_list[1] = 2437; /* 6 */
  1822. chan_list->channel_list[2] = 5180; /* 36 */-
  1823. chan_list->channel_list[3] = 5680; /* 136 */
  1824. tmp_ptr += (2 + chan_list->num_chan); /* increase by words */-
  1825. #else
  1826. #define FREQUENCY_THRESH 1000
  1827. if (param->chan_list.num_chan) {
  1828. chan_list = (wmi_chan_list *) tmp_ptr;
  1829. chan_list->tag = WMI_CHAN_LIST_TAG;
  1830. chan_list->num_chan = param->chan_list.num_chan;
  1831. for (i = 0; i < param->chan_list.num_chan; ++i)
  1832. chan_list->channel_list[i] =
  1833. param->chan_list.chan[i].freq;
  1834. tmp_ptr += (2 + param->chan_list.num_chan);
  1835. }
  1836. #endif
  1837. if (param->num_ssids) {
  1838. ssid_list = (wmi_ssid_list *) tmp_ptr;
  1839. ssid_list->tag = WMI_SSID_LIST_TAG;
  1840. ssid_list->num_ssids = param->num_ssids;
  1841. for (i = 0; i < param->num_ssids; ++i) {
  1842. ssid_list->ssids[i].ssid_len = param->ssid[i].length;
  1843. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(
  1844. ssid_list->ssids[i].ssid,
  1845. param->ssid[i].ssid,
  1846. param->ssid[i].length);
  1847. }
  1848. tmp_ptr += (2 + (sizeof(wmi_ssid) *
  1849. param->num_ssids)/sizeof(A_UINT32));
  1850. }
  1851. if (param->num_bssid) {
  1852. bssid_list = (wmi_bssid_list *) tmp_ptr;
  1853. bssid_list->tag = WMI_BSSID_LIST_TAG;
  1854. bssid_list->num_bssid = param->num_bssid;
  1855. for (i = 0; i < param->num_bssid; ++i) {
  1856. WMI_CHAR_ARRAY_TO_MAC_ADDR(
  1857. &(param->bssid_list[i].bytes[0]),
  1858. &bssid_list->bssid_list[i]);
  1859. }
  1860. tmp_ptr += (2 + (sizeof(wmi_mac_addr) *
  1861. param->num_bssid)/sizeof(A_UINT32));
  1862. }
  1863. if (param->extraie.len) {
  1864. ie_data = (wmi_ie_data *) tmp_ptr;
  1865. ie_data->tag = WMI_IE_TAG;
  1866. ie_data->ie_len = param->extraie.len;
  1867. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(ie_data->ie_data,
  1868. param->extraie.ptr, param->extraie.len);
  1869. }
  1870. qdf_print("Sending SCAN START cmd\n");
  1871. return wmi_unified_cmd_send(wmi_handle, buf, len, WMI_START_SCAN_CMDID);
  1872. }
  1873. /**
  1874. * send_scan_stop_cmd_non_tlv() - WMI scan stop function
  1875. *
  1876. * @param wmi_handle : handle to WMI.
  1877. * @param param : pointer to hold scan start cmd parameter
  1878. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1879. */
  1880. static QDF_STATUS send_scan_stop_cmd_non_tlv(wmi_unified_t wmi_handle,
  1881. struct scan_cancel_param *param)
  1882. {
  1883. wmi_stop_scan_cmd *cmd = NULL;
  1884. wmi_buf_t buf;
  1885. u_int32_t len = sizeof(wmi_stop_scan_cmd);
  1886. buf = wmi_buf_alloc(wmi_handle, len);
  1887. if (!buf) {
  1888. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  1889. return QDF_STATUS_E_NOMEM;
  1890. }
  1891. cmd = (wmi_stop_scan_cmd *)wmi_buf_data(buf);
  1892. OS_MEMZERO(cmd, len);
  1893. /* scan scheduler is not supportd yet */
  1894. cmd->scan_id = param->scan_id;
  1895. cmd->requestor = param->requester;
  1896. cmd->vdev_id = param->vdev_id;
  1897. if (param->req_type == WLAN_SCAN_CANCEL_PDEV_ALL) {
  1898. /* Cancelling all scans - always match scan id */
  1899. cmd->req_type = WMI_SCAN_STOP_ALL;
  1900. } else if (param->req_type == WLAN_SCAN_CANCEL_VDEV_ALL) {
  1901. /*-
  1902. * Cancelling VAP scans - report a match if scan was requested
  1903. * by the same VAP trying to cancel it.
  1904. */
  1905. cmd->req_type = WMI_SCN_STOP_VAP_ALL;
  1906. } else if (param->req_type == WLAN_SCAN_CANCEL_SINGLE) {
  1907. /*-
  1908. * Cancelling specific scan - report a match if specified scan
  1909. * id matches the request's scan id.
  1910. */
  1911. cmd->req_type = WMI_SCAN_STOP_ONE;
  1912. }
  1913. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_STOP_SCAN_CMDID);
  1914. return QDF_STATUS_SUCCESS;
  1915. }
  1916. /**
  1917. * send_scan_chan_list_cmd_non_tlv() - WMI scan channel list function
  1918. *
  1919. * @param wmi_handle : handle to WMI.
  1920. * @param param : pointer to hold scan channel list parameter
  1921. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1922. */
  1923. static QDF_STATUS send_scan_chan_list_cmd_non_tlv(wmi_unified_t wmi_handle,
  1924. struct scan_chan_list_params *param)
  1925. {
  1926. uint32_t i;
  1927. wmi_buf_t buf;
  1928. wmi_scan_chan_list_cmd *cmd;
  1929. int len = sizeof(wmi_scan_chan_list_cmd);
  1930. len = sizeof(wmi_scan_chan_list_cmd) +
  1931. sizeof(wmi_channel)*param->nallchans;
  1932. buf = wmi_buf_alloc(wmi_handle, len);
  1933. if (!buf) {
  1934. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  1935. return QDF_STATUS_E_NOMEM;
  1936. }
  1937. cmd = (wmi_scan_chan_list_cmd *)wmi_buf_data(buf);
  1938. cmd->num_scan_chans = param->nallchans;
  1939. OS_MEMZERO(cmd->chan_info, sizeof(wmi_channel)*cmd->num_scan_chans);
  1940. for (i = 0; i < param->nallchans; ++i) {
  1941. cmd->chan_info[i].mhz = param->ch_param[i].mhz;
  1942. if (param->ch_param[i].is_chan_passive)
  1943. WMI_SET_CHANNEL_FLAG(&(cmd->chan_info[i]),
  1944. WMI_CHAN_FLAG_PASSIVE);
  1945. if (param->ch_param[i].allow_vht)
  1946. WMI_SET_CHANNEL_FLAG(&(cmd->chan_info[i]),
  1947. WMI_CHAN_FLAG_ALLOW_VHT);
  1948. else if (param->ch_param[i].allow_ht)
  1949. WMI_SET_CHANNEL_FLAG(&(cmd->chan_info[i]),
  1950. WMI_CHAN_FLAG_ALLOW_HT);
  1951. cmd->chan_info[i].band_center_freq1 =
  1952. param->ch_param[i].cfreq1;
  1953. cmd->chan_info[i].band_center_freq2 =
  1954. param->ch_param[i].cfreq2;
  1955. WMI_SET_CHANNEL_MODE(&cmd->chan_info[i],
  1956. param->ch_param[i].phy_mode);
  1957. if (param->ch_param[i].half_rate)
  1958. WMI_SET_CHANNEL_FLAG(&(cmd->chan_info[i]),
  1959. WMI_CHAN_FLAG_HALF);
  1960. if (param->ch_param[i].quarter_rate)
  1961. WMI_SET_CHANNEL_FLAG(&(cmd->chan_info[i]),
  1962. WMI_CHAN_FLAG_QUARTER);
  1963. /* also fill in power information */
  1964. WMI_SET_CHANNEL_MIN_POWER(&cmd->chan_info[i],
  1965. param->ch_param[i].minpower);
  1966. WMI_SET_CHANNEL_MAX_POWER(&cmd->chan_info[i],
  1967. param->ch_param[i].maxpower);
  1968. WMI_SET_CHANNEL_REG_POWER(&cmd->chan_info[i],
  1969. param->ch_param[i].maxregpower);
  1970. WMI_SET_CHANNEL_ANTENNA_MAX(&cmd->chan_info[i],
  1971. param->ch_param[i].antennamax);
  1972. WMI_SET_CHANNEL_REG_CLASSID(&cmd->chan_info[i],
  1973. param->ch_param[i].reg_class_id);
  1974. }
  1975. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_SCAN_CHAN_LIST_CMDID);
  1976. return QDF_STATUS_SUCCESS;
  1977. }
  1978. /**
  1979. * send_thermal_mitigation_param_cmd_non_tlv() - WMI scan channel list function
  1980. *
  1981. * @param wmi_handle : handle to WMI.
  1982. * @param param : pointer to hold thermal mitigation param
  1983. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  1984. */
  1985. static QDF_STATUS send_thermal_mitigation_param_cmd_non_tlv(wmi_unified_t wmi_handle,
  1986. struct thermal_mitigation_params *param)
  1987. {
  1988. wmi_buf_t buf = NULL;
  1989. tt_config_t *cmd = NULL;
  1990. int error = 0;
  1991. int32_t len = 0;
  1992. int i = 0;
  1993. len = sizeof(tt_config_t);
  1994. buf = wmi_buf_alloc(wmi_handle, len);
  1995. if (!buf) {
  1996. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  1997. return QDF_STATUS_E_NOMEM;
  1998. }
  1999. cmd = (tt_config_t *) wmi_buf_data(buf);
  2000. cmd->enable = param->enable;
  2001. cmd->dc = param->dc;
  2002. cmd->dc_per_event = param->dc_per_event;
  2003. for (i = 0; i < THERMAL_LEVELS; i++) {
  2004. cmd->levelconf[i].tmplwm = param->levelconf[i].tmplwm;
  2005. cmd->levelconf[i].tmphwm = param->levelconf[i].tmphwm;
  2006. cmd->levelconf[i].dcoffpercent =
  2007. param->levelconf[i].dcoffpercent;
  2008. cmd->levelconf[i].prio = param->levelconf[i].priority;
  2009. }
  2010. error = wmi_unified_cmd_send(wmi_handle, buf, len,
  2011. WMI_TT_SET_CONF_CMDID);
  2012. return error;
  2013. }
  2014. /**
  2015. * send_phyerr_enable_cmd_non_tlv() - WMI phyerr enable function
  2016. *
  2017. * @param wmi_handle : handle to WMI.
  2018. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  2019. */
  2020. static QDF_STATUS send_phyerr_enable_cmd_non_tlv(wmi_unified_t wmi_handle)
  2021. {
  2022. wmi_buf_t buf;
  2023. /*
  2024. * Passing a NULL pointer to wmi_unified_cmd_send() panics it,
  2025. * so let's just use a 32 byte fake array for now.
  2026. */
  2027. buf = wmi_buf_alloc(wmi_handle, 32);
  2028. if (buf == NULL) {
  2029. /* XXX error? */
  2030. return QDF_STATUS_E_NOMEM;
  2031. }
  2032. qdf_print("%s: about to send\n", __func__);
  2033. if (wmi_unified_cmd_send(wmi_handle, buf, 32,
  2034. WMI_PDEV_DFS_ENABLE_CMDID) != QDF_STATUS_SUCCESS) {
  2035. qdf_print("%s: send failed\n", __func__);
  2036. return QDF_STATUS_E_FAILURE;
  2037. }
  2038. return QDF_STATUS_SUCCESS;
  2039. }
  2040. /**
  2041. * send_phyerr_disable_cmd_non_tlv() - WMI phyerr disable function
  2042. *
  2043. * @param wmi_handle : handle to WMI.
  2044. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  2045. */
  2046. static QDF_STATUS send_phyerr_disable_cmd_non_tlv(wmi_unified_t wmi_handle)
  2047. {
  2048. wmi_buf_t buf;
  2049. /*
  2050. * Passing a NULL pointer to wmi_unified_cmd_send() panics it,
  2051. * so let's just use a 32 byte fake array for now.
  2052. */
  2053. buf = wmi_buf_alloc(wmi_handle, 32);
  2054. if (buf == NULL) {
  2055. /* XXX error? */
  2056. return QDF_STATUS_E_NOMEM;
  2057. }
  2058. qdf_print("%s: about to send\n", __func__);
  2059. if (wmi_unified_cmd_send(wmi_handle, buf, 32,
  2060. WMI_PDEV_DFS_DISABLE_CMDID) != QDF_STATUS_SUCCESS) {
  2061. qdf_print("%s: send failed\n", __func__);
  2062. return QDF_STATUS_E_FAILURE;
  2063. }
  2064. return QDF_STATUS_SUCCESS;
  2065. }
  2066. /**
  2067. * send_smart_ant_enable_cmd_non_tlv() - WMI smart ant enable function
  2068. *
  2069. * @param wmi_handle : handle to WMI.
  2070. * @param param : pointer to antenna param
  2071. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  2072. */
  2073. static QDF_STATUS send_smart_ant_enable_cmd_non_tlv(wmi_unified_t wmi_handle,
  2074. struct smart_ant_enable_params *param)
  2075. {
  2076. /* Send WMI COMMAND to Enable */
  2077. wmi_pdev_smart_ant_enable_cmd *cmd;
  2078. wmi_buf_t buf;
  2079. int len = 0;
  2080. int ret;
  2081. len = sizeof(wmi_pdev_smart_ant_enable_cmd);
  2082. buf = wmi_buf_alloc(wmi_handle, len);
  2083. if (!buf) {
  2084. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2085. return QDF_STATUS_E_NOMEM;
  2086. }
  2087. cmd = (wmi_pdev_smart_ant_enable_cmd *)wmi_buf_data(buf);
  2088. cmd->enable = param->enable;
  2089. cmd->mode = param->mode;
  2090. cmd->rx_antenna = param->rx_antenna;
  2091. cmd->tx_default_antenna = param->rx_antenna;
  2092. if (param->mode == SMART_ANT_MODE_SERIAL) {
  2093. cmd->gpio_pin[0] = param->gpio_pin[0];
  2094. cmd->gpio_pin[1] = param->gpio_pin[1];
  2095. cmd->gpio_pin[2] = 0;
  2096. cmd->gpio_pin[3] = 0;
  2097. cmd->gpio_func[0] = param->gpio_func[0];
  2098. cmd->gpio_func[1] = param->gpio_func[1];
  2099. cmd->gpio_func[2] = 0;
  2100. cmd->gpio_func[3] = 0;
  2101. } else if (param->mode == SMART_ANT_MODE_PARALLEL) {
  2102. cmd->gpio_pin[0] = param->gpio_pin[0];
  2103. cmd->gpio_pin[1] = param->gpio_pin[1];
  2104. cmd->gpio_pin[2] = param->gpio_pin[2];
  2105. cmd->gpio_pin[3] = param->gpio_pin[3];
  2106. cmd->gpio_func[0] = param->gpio_func[0];
  2107. cmd->gpio_func[1] = param->gpio_func[1];
  2108. cmd->gpio_func[2] = param->gpio_func[2];
  2109. cmd->gpio_func[3] = param->gpio_func[3];
  2110. }
  2111. ret = wmi_unified_cmd_send(wmi_handle,
  2112. buf,
  2113. len,
  2114. WMI_PDEV_SMART_ANT_ENABLE_CMDID);
  2115. if (ret != 0) {
  2116. qdf_print(" %s :WMI Failed\n", __func__);
  2117. qdf_print("%s: Failed to send WMI_PDEV_SMART_ANT_ENABLE_CMDID.\n"
  2118. "enable:%d mode:%d rx_antenna: 0x%08x PINS: "
  2119. "[%d %d %d %d] Func[%d %d %d %d] cmdstatus=%d\n",
  2120. __func__,
  2121. cmd->enable,
  2122. cmd->mode,
  2123. cmd->rx_antenna,
  2124. cmd->gpio_pin[0],
  2125. cmd->gpio_pin[1],
  2126. cmd->gpio_pin[2],
  2127. cmd->gpio_pin[3],
  2128. cmd->gpio_func[0],
  2129. cmd->gpio_func[1],
  2130. cmd->gpio_func[2],
  2131. cmd->gpio_func[3],
  2132. ret);
  2133. wmi_buf_free(buf);
  2134. }
  2135. return ret;
  2136. }
  2137. /**
  2138. * send_smart_ant_set_rx_ant_cmd_non_tlv() - WMI set rx antenna function
  2139. *
  2140. * @param wmi_handle : handle to WMI.
  2141. * @param param : pointer to rx antenna param
  2142. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  2143. */
  2144. static QDF_STATUS send_smart_ant_set_rx_ant_cmd_non_tlv(wmi_unified_t wmi_handle,
  2145. struct smart_ant_rx_ant_params *param)
  2146. {
  2147. wmi_pdev_smart_ant_set_rx_antenna_cmd *cmd;
  2148. wmi_buf_t buf;
  2149. int len = 0;
  2150. int ret;
  2151. len = sizeof(wmi_pdev_smart_ant_set_rx_antenna_cmd);
  2152. buf = wmi_buf_alloc(wmi_handle, len);
  2153. if (!buf) {
  2154. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2155. return QDF_STATUS_E_NOMEM;
  2156. }
  2157. cmd = (wmi_pdev_smart_ant_set_rx_antenna_cmd *)wmi_buf_data(buf);
  2158. cmd->rx_antenna = param->antenna;
  2159. ret = wmi_unified_cmd_send(wmi_handle,
  2160. buf,
  2161. len,
  2162. WMI_PDEV_SMART_ANT_SET_RX_ANTENNA_CMDID);
  2163. if (ret != 0) {
  2164. qdf_print(" %s :WMI Failed\n", __func__);
  2165. qdf_print("%s: Failed to send WMI_PDEV_SMART_ANT_SET_RX_ANTENNA_CMDID.\n"
  2166. " rx_antenna: 0x%08x cmdstatus=%d\n",
  2167. __func__,
  2168. cmd->rx_antenna,
  2169. ret);
  2170. wmi_buf_free(buf);
  2171. }
  2172. return ret;
  2173. }
  2174. /**
  2175. * send_smart_ant_set_tx_ant_cmd_non_tlv() - WMI set tx antenna function
  2176. * @param wmi_handle : handle to WMI.
  2177. * @param macaddr : vdev mac address
  2178. * @param param : pointer to tx antenna param
  2179. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  2180. */
  2181. static QDF_STATUS send_smart_ant_set_tx_ant_cmd_non_tlv(wmi_unified_t wmi_handle,
  2182. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2183. struct smart_ant_tx_ant_params *param)
  2184. {
  2185. wmi_peer_sant_set_tx_antenna_cmd *cmd;
  2186. wmi_buf_t buf;
  2187. int len = 0;
  2188. int ret;
  2189. len = sizeof(wmi_peer_sant_set_tx_antenna_cmd);
  2190. buf = wmi_buf_alloc(wmi_handle, len);
  2191. if (!buf) {
  2192. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2193. return QDF_STATUS_E_NOMEM;
  2194. }
  2195. cmd = (wmi_peer_sant_set_tx_antenna_cmd *)wmi_buf_data(buf);
  2196. cmd->vdev_id = param->vdev_id;
  2197. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2198. cmd->antenna_series[0] = param->antenna_array[0];
  2199. cmd->antenna_series[1] = param->antenna_array[1];
  2200. ret = wmi_unified_cmd_send(wmi_handle,
  2201. buf,
  2202. len,
  2203. WMI_PEER_SMART_ANT_SET_TX_ANTENNA_CMDID);
  2204. if (ret != 0) {
  2205. qdf_print(" %s :WMI Failed\n", __func__);
  2206. qdf_print("%s: Failed to send WMI_PEER_SMART_ANT_SET_TX_ANTENNA_CMDID.\n"
  2207. " Node: %s tx_antennas: [0x%08x 0x%08x] cmdstatus=%d\n",
  2208. __func__,
  2209. ether_sprintf(macaddr),
  2210. cmd->antenna_series[0],
  2211. cmd->antenna_series[1],
  2212. ret);
  2213. wmi_buf_free(buf);
  2214. }
  2215. return ret;
  2216. }
  2217. /**
  2218. * send_smart_ant_set_training_info_cmd_non_tlv() - WMI set smart antenna
  2219. * training information function
  2220. * @param wmi_handle : handle to WMI.
  2221. * @macaddr : vdev mac address
  2222. * @param param : pointer to tx antenna param
  2223. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  2224. */
  2225. static QDF_STATUS send_smart_ant_set_training_info_cmd_non_tlv(
  2226. wmi_unified_t wmi_handle,
  2227. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2228. struct smart_ant_training_info_params *param)
  2229. {
  2230. wmi_peer_sant_set_train_antenna_cmd *cmd;
  2231. wmi_buf_t buf;
  2232. int len = 0;
  2233. int ret;
  2234. len = sizeof(wmi_peer_sant_set_train_antenna_cmd);
  2235. buf = wmi_buf_alloc(wmi_handle, len);
  2236. if (!buf) {
  2237. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2238. return QDF_STATUS_E_NOMEM;
  2239. }
  2240. cmd = (wmi_peer_sant_set_train_antenna_cmd *)wmi_buf_data(buf);
  2241. cmd->vdev_id = param->vdev_id;
  2242. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2243. qdf_mem_copy(&cmd->train_rate_series[0], &param->rate_array[0],
  2244. (sizeof(uint32_t)*SMART_ANT_MAX_RATE_SERIES));
  2245. qdf_mem_copy(&cmd->train_antenna_series[0], &param->antenna_array[0],
  2246. (sizeof(uint32_t)*SMART_ANT_MAX_RATE_SERIES));
  2247. cmd->num_pkts = param->numpkts;
  2248. ret = wmi_unified_cmd_send(wmi_handle,
  2249. buf,
  2250. len,
  2251. WMI_PEER_SMART_ANT_SET_TRAIN_INFO_CMDID);
  2252. if (ret != 0) {
  2253. qdf_print(" %s :WMI Failed\n", __func__);
  2254. qdf_print("%s: Failed to Send WMI_PEER_SMART_ANT_SET_TRAIN_INFO_CMDID.\n"
  2255. " Train Node: %s rate_array[0x%02x 0x%02x] "
  2256. "tx_antennas: [0x%08x 0x%08x] cmdstatus=%d\n",
  2257. __func__,
  2258. ether_sprintf(macaddr),
  2259. cmd->train_rate_series[0],
  2260. cmd->train_rate_series[1],
  2261. cmd->train_antenna_series[0],
  2262. cmd->train_antenna_series[1],
  2263. ret);
  2264. wmi_buf_free(buf);
  2265. }
  2266. return ret;
  2267. }
  2268. /**
  2269. * send_smart_ant_set_node_config_cmd_non_tlv() - WMI set node
  2270. * configuration function
  2271. * @param wmi_handle : handle to WMI.
  2272. * @macaddr : vdev mad address
  2273. * @param param : pointer to tx antenna param
  2274. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  2275. */
  2276. static QDF_STATUS send_smart_ant_set_node_config_cmd_non_tlv(wmi_unified_t wmi_handle,
  2277. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2278. struct smart_ant_node_config_params *param)
  2279. {
  2280. wmi_peer_sant_set_node_config_ops_cmd *cmd;
  2281. wmi_buf_t buf;
  2282. int len = 0;
  2283. int ret;
  2284. int i = 0;
  2285. len = sizeof(wmi_peer_sant_set_node_config_ops_cmd);
  2286. if ((param->args_count == 0) || (param->args_count >
  2287. (sizeof(cmd->args) / sizeof(cmd->args[0])))) {
  2288. qdf_print("%s: Can't send a command with %d arguments\n",
  2289. __func__, param->args_count);
  2290. return QDF_STATUS_E_FAILURE;
  2291. }
  2292. buf = wmi_buf_alloc(wmi_handle, len);
  2293. if (!buf) {
  2294. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2295. return QDF_STATUS_E_NOMEM;
  2296. }
  2297. cmd = (wmi_peer_sant_set_node_config_ops_cmd *)wmi_buf_data(buf);
  2298. cmd->vdev_id = param->vdev_id;
  2299. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2300. cmd->cmd_id = param->cmd_id;
  2301. cmd->args_count = param->args_count;
  2302. for (i = 0; i < param->args_count; i++)
  2303. cmd->args[i] = param->args_arr[i];
  2304. ret = wmi_unified_cmd_send(wmi_handle,
  2305. buf,
  2306. len,
  2307. WMI_PEER_SMART_ANT_SET_NODE_CONFIG_OPS_CMDID);
  2308. if (ret != 0) {
  2309. qdf_print(" %s :WMI Failed\n", __func__);
  2310. qdf_print("%s: Sent "
  2311. "WMI_PEER_SMART_ANT_SET_NODE_CONFIG_OPS_CMDID, cmd_id:"
  2312. " 0x%x\n Node: %s cmdstatus=%d\n",
  2313. __func__, param->cmd_id, ether_sprintf(macaddr), ret);
  2314. }
  2315. return ret;
  2316. }
  2317. /**
  2318. * send_smart_ant_enable_tx_feedback_cmd_non_tlv() - WMI enable smart antenna
  2319. * tx feedback function
  2320. * @param wmi_handle : handle to WMI.
  2321. * @param param : pointer to hold enable param
  2322. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  2323. */
  2324. static QDF_STATUS send_smart_ant_enable_tx_feedback_cmd_non_tlv(
  2325. wmi_unified_t wmi_handle,
  2326. struct smart_ant_enable_tx_feedback_params *param)
  2327. {
  2328. uint32_t types = 0;
  2329. int len = 0;
  2330. wmi_buf_t buf;
  2331. wmi_pdev_pktlog_enable_cmd *cmd;
  2332. if (param->enable == 1) {
  2333. types |= WMI_PKTLOG_EVENT_TX;
  2334. types |= WMI_PKTLOG_EVENT_SMART_ANTENNA;
  2335. len = sizeof(wmi_pdev_pktlog_enable_cmd);
  2336. buf = wmi_buf_alloc(wmi_handle, len);
  2337. if (!buf) {
  2338. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2339. return QDF_STATUS_E_FAILURE;
  2340. }
  2341. cmd = (wmi_pdev_pktlog_enable_cmd *)wmi_buf_data(buf);
  2342. cmd->evlist = types;
  2343. /*enabling the pktlog for smart antenna tx feedback*/
  2344. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  2345. WMI_PDEV_PKTLOG_ENABLE_CMDID))
  2346. return QDF_STATUS_E_FAILURE;
  2347. return QDF_STATUS_SUCCESS;
  2348. } else if (param->enable == 0) {
  2349. buf = wmi_buf_alloc(wmi_handle, 0);
  2350. if (!buf) {
  2351. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2352. return QDF_STATUS_E_FAILURE;
  2353. }
  2354. if (!wmi_unified_cmd_send(wmi_handle, buf, len,
  2355. WMI_PDEV_PKTLOG_DISABLE_CMDID))
  2356. return QDF_STATUS_E_FAILURE;
  2357. return QDF_STATUS_SUCCESS;
  2358. } else
  2359. return QDF_STATUS_E_FAILURE;
  2360. }
  2361. /**
  2362. * send_vdev_spectral_configure_cmd_non_tlv() - send VDEV spectral configure
  2363. * command to fw
  2364. * @wmi_handle: wmi handle
  2365. * @param: pointer to hold spectral config parameter
  2366. *
  2367. * Return: 0 for success or error code
  2368. */
  2369. static QDF_STATUS send_vdev_spectral_configure_cmd_non_tlv(wmi_unified_t wmi_handle,
  2370. struct vdev_spectral_configure_params *param)
  2371. {
  2372. wmi_vdev_spectral_configure_cmd *cmd;
  2373. wmi_buf_t buf;
  2374. int len = 0;
  2375. int ret;
  2376. len = sizeof(wmi_vdev_spectral_configure_cmd);
  2377. buf = wmi_buf_alloc(wmi_handle, len);
  2378. if (!buf) {
  2379. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2380. return QDF_STATUS_E_NOMEM;
  2381. }
  2382. cmd = (wmi_vdev_spectral_configure_cmd *)wmi_buf_data(buf);
  2383. cmd->vdev_id = param->vdev_id;
  2384. cmd->spectral_scan_count = param->count;
  2385. cmd->spectral_scan_period = param->period;
  2386. cmd->spectral_scan_priority = param->spectral_pri;
  2387. cmd->spectral_scan_fft_size = param->fft_size;
  2388. cmd->spectral_scan_gc_ena = param->gc_enable;
  2389. cmd->spectral_scan_restart_ena = param->restart_enable;
  2390. cmd->spectral_scan_noise_floor_ref = param->noise_floor_ref;
  2391. cmd->spectral_scan_init_delay = param->init_delay;
  2392. cmd->spectral_scan_nb_tone_thr = param->nb_tone_thr;
  2393. cmd->spectral_scan_str_bin_thr = param->str_bin_thr;
  2394. cmd->spectral_scan_wb_rpt_mode = param->wb_rpt_mode;
  2395. cmd->spectral_scan_rssi_rpt_mode = param->rssi_rpt_mode;
  2396. cmd->spectral_scan_rssi_thr = param->rssi_thr;
  2397. cmd->spectral_scan_pwr_format = param->pwr_format;
  2398. cmd->spectral_scan_rpt_mode = param->rpt_mode;
  2399. cmd->spectral_scan_bin_scale = param->bin_scale;
  2400. cmd->spectral_scan_dBm_adj = param->dbm_adj;
  2401. cmd->spectral_scan_chn_mask = param->chn_mask;
  2402. ret = wmi_unified_cmd_send(wmi_handle,
  2403. buf,
  2404. len,
  2405. WMI_VDEV_SPECTRAL_SCAN_CONFIGURE_CMDID);
  2406. #ifdef OL_SPECTRAL_DEBUG_CONFIG_INTERACTIONS
  2407. qdf_print("%s: Sent "
  2408. "WMI_VDEV_SPECTRAL_SCAN_CONFIGURE_CMDID\n", __func__);
  2409. qdf_print("vdev_id = %u\n"
  2410. "spectral_scan_count = %u\n"
  2411. "spectral_scan_period = %u\n"
  2412. "spectral_scan_priority = %u\n"
  2413. "spectral_scan_fft_size = %u\n"
  2414. "spectral_scan_gc_ena = %u\n"
  2415. "spectral_scan_restart_ena = %u\n"
  2416. "spectral_scan_noise_floor_ref = %u\n"
  2417. "spectral_scan_init_delay = %u\n"
  2418. "spectral_scan_nb_tone_thr = %u\n"
  2419. "spectral_scan_str_bin_thr = %u\n"
  2420. "spectral_scan_wb_rpt_mode = %u\n"
  2421. "spectral_scan_rssi_rpt_mode = %u\n"
  2422. "spectral_scan_rssi_thr = %u\n"
  2423. "spectral_scan_pwr_format = %u\n"
  2424. "spectral_scan_rpt_mode = %u\n"
  2425. "spectral_scan_bin_scale = %u\n"
  2426. "spectral_scan_dBm_adj = %u\n"
  2427. "spectral_scan_chn_mask = %u\n",
  2428. param->vdev_id,
  2429. param->count,
  2430. param->period,
  2431. param->spectral_pri,
  2432. param->fft_size,
  2433. param->gc_enable,
  2434. param->restart_enable,
  2435. param->noise_floor_ref,
  2436. param->init_delay,
  2437. param->nb_tone_thr,
  2438. param->str_bin_thr,
  2439. param->wb_rpt_mode,
  2440. param->rssi_rpt_mode,
  2441. param->rssi_thr,
  2442. param->pwr_format,
  2443. param->rpt_mode,
  2444. param->bin_scale,
  2445. param->dbm_adj,
  2446. param->chn_mask);
  2447. qdf_print("%s: Status: %d\n\n", __func__, ret);
  2448. #endif /* OL_SPECTRAL_DEBUG_CONFIG_INTERACTIONS */
  2449. return ret;
  2450. }
  2451. #ifdef WLAN_SUPPORT_FILS
  2452. /**
  2453. * send_fils_discovery_send_cmd_non_tlv() - WMI FILS Discovery send function
  2454. * @wmi_handle: handle to WMI
  2455. * @param: pointer to hold FD send cmd parameter
  2456. *
  2457. * Return: QDF_STATUS_SUCCESS on success and QDF_STATUS error code on failure.
  2458. */
  2459. static QDF_STATUS
  2460. send_fils_discovery_send_cmd_non_tlv(wmi_unified_t wmi_handle,
  2461. struct fd_params *param)
  2462. {
  2463. wmi_fd_send_from_host_cmd_t *cmd;
  2464. wmi_buf_t wmi_buf;
  2465. QDF_STATUS status;
  2466. int fd_len = qdf_nbuf_len(param->wbuf);
  2467. int len = sizeof(wmi_fd_send_from_host_cmd_t);
  2468. wmi_buf = wmi_buf_alloc(wmi_handle, roundup(len, sizeof(u_int32_t)));
  2469. if (!wmi_buf) {
  2470. WMI_LOGE("wmi_buf_alloc failed\n");
  2471. return QDF_STATUS_E_NOMEM;
  2472. }
  2473. cmd = (wmi_fd_send_from_host_cmd_t *)wmi_buf_data(wmi_buf);
  2474. cmd->vdev_id = param->vdev_id;
  2475. cmd->data_len = fd_len;
  2476. cmd->frag_ptr = qdf_nbuf_get_frag_paddr(param->wbuf, 0);
  2477. cmd->frame_ctrl = param->frame_ctrl;
  2478. status = wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  2479. WMI_PDEV_SEND_FD_CMDID);
  2480. if (status != QDF_STATUS_SUCCESS) {
  2481. wmi_buf_free(wmi_buf);
  2482. return QDF_STATUS_E_FAILURE;
  2483. }
  2484. return QDF_STATUS_SUCCESS;
  2485. }
  2486. /**
  2487. * send_vdev_fils_enable_cmd_non_tlv() - enable/Disable FD Frame command to fw
  2488. * @wmi_handle: wmi handle
  2489. * @param: pointer to hold FILS discovery enable param
  2490. *
  2491. * Return: QDF_STATUS_SUCCESS on success or QDF_STATUS error code on failure
  2492. */
  2493. static QDF_STATUS
  2494. send_vdev_fils_enable_cmd_non_tlv(wmi_unified_t wmi_handle,
  2495. struct config_fils_params *param)
  2496. {
  2497. wmi_enable_fils_cmd *cmd;
  2498. wmi_buf_t buf;
  2499. QDF_STATUS status;
  2500. int len = sizeof(wmi_enable_fils_cmd);
  2501. buf = wmi_buf_alloc(wmi_handle, len);
  2502. if (!buf) {
  2503. WMI_LOGE("wmi_buf_alloc failed\n");
  2504. return QDF_STATUS_E_FAILURE;
  2505. }
  2506. cmd = (wmi_enable_fils_cmd *)wmi_buf_data(buf);
  2507. cmd->vdev_id = param->vdev_id;
  2508. cmd->fd_period = param->fd_period;
  2509. WMI_LOGI("Setting FD period to %d vdev id : %d\n",
  2510. param->fd_period, param->vdev_id);
  2511. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  2512. WMI_ENABLE_FILS_CMDID);
  2513. if (status != QDF_STATUS_SUCCESS) {
  2514. wmi_buf_free(buf);
  2515. return QDF_STATUS_E_FAILURE;
  2516. }
  2517. return QDF_STATUS_SUCCESS;
  2518. }
  2519. /**
  2520. * extract_swfda_vdev_id_non_tlv() - extract swfda vdev id from event
  2521. * @wmi_handle: wmi handle
  2522. * @evt_buf: pointer to event buffer
  2523. * @vdev_id: pointer to hold vdev id
  2524. *
  2525. * Return: QDF_STATUS_SUCCESS
  2526. */
  2527. static QDF_STATUS
  2528. extract_swfda_vdev_id_non_tlv(wmi_unified_t wmi_handle,
  2529. void *evt_buf, uint32_t *vdev_id)
  2530. {
  2531. wmi_host_swfda_event *swfda_event = (wmi_host_swfda_event *)evt_buf;
  2532. *vdev_id = swfda_event->vdev_id;
  2533. return QDF_STATUS_SUCCESS;
  2534. }
  2535. #endif /* WLAN_SUPPORT_FILS */
  2536. /**
  2537. * send_vdev_spectral_enable_cmd_non_tlv() - send VDEV spectral configure
  2538. * command to fw
  2539. * @wmi_handle: wmi handle
  2540. * @param: pointer to hold spectral enable parameter
  2541. *
  2542. * Return: 0 for success or error code
  2543. */
  2544. static QDF_STATUS send_vdev_spectral_enable_cmd_non_tlv(wmi_unified_t wmi_handle,
  2545. struct vdev_spectral_enable_params *param)
  2546. {
  2547. wmi_vdev_spectral_enable_cmd *cmd;
  2548. wmi_buf_t buf;
  2549. int len = 0;
  2550. int ret;
  2551. len = sizeof(wmi_vdev_spectral_enable_cmd);
  2552. buf = wmi_buf_alloc(wmi_handle, len);
  2553. if (!buf) {
  2554. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2555. return QDF_STATUS_E_NOMEM;
  2556. }
  2557. cmd = (wmi_vdev_spectral_enable_cmd *)wmi_buf_data(buf);
  2558. cmd->vdev_id = param->vdev_id;
  2559. if (param->active_valid) {
  2560. cmd->trigger_cmd = param->active ? 1 : 2;
  2561. /* 1: Trigger, 2: Clear Trigger */
  2562. } else {
  2563. cmd->trigger_cmd = 0; /* 0: Ignore */
  2564. }
  2565. if (param->enabled_valid) {
  2566. cmd->enable_cmd = param->enabled ? 1 : 2;
  2567. /* 1: Enable 2: Disable */
  2568. } else {
  2569. cmd->enable_cmd = 0; /* 0: Ignore */
  2570. }
  2571. #ifdef OL_SPECTRAL_DEBUG_CONFIG_INTERACTIONS
  2572. qdf_print
  2573. ("%s: Sent WMI_VDEV_SPECTRAL_SCAN_ENABLE_CMDID\n", __func__);
  2574. qdf_print("vdev_id = %u\n"
  2575. "trigger_cmd = %u\n"
  2576. "enable_cmd = %u\n",
  2577. cmd->vdev_id,
  2578. cmd->trigger_cmd,
  2579. cmd->enable_cmd);
  2580. qdf_print("%s: Status: %d\n\n", __func__, ret);
  2581. #endif /* OL_SPECTRAL_DEBUG_CONFIG_INTERACTIONS */
  2582. ret = wmi_unified_cmd_send(wmi_handle,
  2583. buf,
  2584. len,
  2585. WMI_VDEV_SPECTRAL_SCAN_ENABLE_CMDID);
  2586. return ret;
  2587. }
  2588. /**
  2589. * send_pdev_set_regdomain_cmd_non_tlv() - send set regdomain command to fw
  2590. * @wmi_handle: wmi handle
  2591. * @param: pointer to pdev regdomain params
  2592. *
  2593. * Return: 0 for success or error code
  2594. */
  2595. static QDF_STATUS
  2596. send_pdev_set_regdomain_cmd_non_tlv(wmi_unified_t wmi_handle,
  2597. struct pdev_set_regdomain_params *param)
  2598. {
  2599. wmi_pdev_set_regdomain_cmd *cmd;
  2600. wmi_buf_t buf;
  2601. int len = sizeof(wmi_pdev_set_regdomain_cmd);
  2602. buf = wmi_buf_alloc(wmi_handle, len);
  2603. if (!buf) {
  2604. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2605. return QDF_STATUS_E_FAILURE;
  2606. }
  2607. cmd = (wmi_pdev_set_regdomain_cmd *)wmi_buf_data(buf);
  2608. cmd->reg_domain = param->currentRDinuse;
  2609. cmd->reg_domain_2G = param->currentRD2G;
  2610. cmd->reg_domain_5G = param->currentRD5G;
  2611. cmd->conformance_test_limit_2G = param->ctl_2G;
  2612. cmd->conformance_test_limit_5G = param->ctl_5G;
  2613. cmd->dfs_domain = param->dfsDomain;
  2614. return wmi_unified_cmd_send(wmi_handle, buf, len,
  2615. WMI_PDEV_SET_REGDOMAIN_CMDID);
  2616. }
  2617. /**
  2618. * send_set_quiet_mode_cmd_non_tlv() - send set quiet mode command to fw
  2619. * @wmi_handle: wmi handle
  2620. * @param: pointer to quiet mode params
  2621. *
  2622. * Return: 0 for success or error code
  2623. */
  2624. static QDF_STATUS
  2625. send_set_quiet_mode_cmd_non_tlv(wmi_unified_t wmi_handle,
  2626. struct set_quiet_mode_params *param)
  2627. {
  2628. wmi_buf_t buf;
  2629. wmi_pdev_set_quiet_cmd *quiet_cmd;
  2630. int len = sizeof(wmi_pdev_set_quiet_cmd);
  2631. buf = wmi_buf_alloc(wmi_handle, len);
  2632. if (!buf) {
  2633. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  2634. return QDF_STATUS_E_NOMEM;
  2635. }
  2636. quiet_cmd = (wmi_pdev_set_quiet_cmd *)wmi_buf_data(buf);
  2637. quiet_cmd->enabled = param->enabled;
  2638. quiet_cmd->period = (param->period)*(param->intval);
  2639. quiet_cmd->duration = param->duration;
  2640. quiet_cmd->next_start = param->offset;
  2641. wmi_unified_cmd_send(wmi_handle, buf, len,
  2642. WMI_PDEV_SET_QUIET_MODE_CMDID);
  2643. return QDF_STATUS_SUCCESS;
  2644. }
  2645. /**
  2646. * send_set_beacon_filter_cmd_non_tlv() - send beacon filter command to fw
  2647. * @wmi_handle: wmi handle
  2648. * @param: pointer to beacon filter params
  2649. *
  2650. * Return: 0 for success or error code
  2651. */
  2652. static QDF_STATUS
  2653. send_set_beacon_filter_cmd_non_tlv(wmi_unified_t wmi_handle,
  2654. struct set_beacon_filter_params *param)
  2655. {
  2656. /* Issue WMI command to set beacon filter */
  2657. int i;
  2658. wmi_add_bcn_filter_cmd_t *cmd;
  2659. QDF_STATUS res;
  2660. wmi_buf_t buf = NULL;
  2661. int len = sizeof(wmi_add_bcn_filter_cmd_t);
  2662. buf = wmi_buf_alloc(wmi_handle, len);
  2663. if (!buf) {
  2664. qdf_print("buf alloc failed\n");
  2665. return QDF_STATUS_E_NOMEM;
  2666. }
  2667. cmd = (wmi_add_bcn_filter_cmd_t *)wmi_buf_data(buf);
  2668. cmd->vdev_id = param->vdev_id;
  2669. qdf_print("vdev_id: %d\n", cmd->vdev_id);
  2670. for (i = 0; i < BCN_FLT_MAX_ELEMS_IE_LIST; i++)
  2671. cmd->ie_map[i] = 0;
  2672. if (param->ie) {
  2673. for (i = 0; i < BCN_FLT_MAX_ELEMS_IE_LIST; i++)
  2674. cmd->ie_map[i] = param->ie[i];
  2675. }
  2676. res = wmi_unified_cmd_send(wmi_handle, buf, len,
  2677. WMI_ADD_BCN_FILTER_CMDID);
  2678. return (res == QDF_STATUS_SUCCESS) ?
  2679. QDF_STATUS_SUCCESS : QDF_STATUS_E_FAILURE;
  2680. }
  2681. /**
  2682. * send_remove_beacon_filter_cmd_non_tlv() - send remove beacon filter command
  2683. * to fw
  2684. * @wmi_handle: wmi handle
  2685. * @param: pointer to remove beacon filter params
  2686. *
  2687. * Return: 0 for success or error code
  2688. */
  2689. static QDF_STATUS
  2690. send_remove_beacon_filter_cmd_non_tlv(wmi_unified_t wmi_handle,
  2691. struct remove_beacon_filter_params *param)
  2692. {
  2693. wmi_rmv_bcn_filter_cmd_t *cmd;
  2694. QDF_STATUS res;
  2695. wmi_buf_t buf = NULL;
  2696. int len = sizeof(wmi_rmv_bcn_filter_cmd_t);
  2697. buf = wmi_buf_alloc(wmi_handle, len);
  2698. if (!buf) {
  2699. qdf_print("buf alloc failed\n");
  2700. return QDF_STATUS_E_NOMEM;
  2701. }
  2702. cmd = (wmi_rmv_bcn_filter_cmd_t *)wmi_buf_data(buf);
  2703. cmd->vdev_id = param->vdev_id;
  2704. res = wmi_unified_cmd_send(wmi_handle, buf, len,
  2705. WMI_RMV_BCN_FILTER_CMDID);
  2706. return (res == QDF_STATUS_SUCCESS) ?
  2707. QDF_STATUS_SUCCESS : QDF_STATUS_E_FAILURE;
  2708. }
  2709. /**
  2710. * send_mgmt_cmd_non_tlv() - send mgmt command to fw
  2711. * @wmi_handle: wmi handle
  2712. * @param: pointer to mgmt params
  2713. * Return: 0 for success or error code
  2714. */
  2715. static QDF_STATUS
  2716. send_mgmt_cmd_non_tlv(wmi_unified_t wmi_handle,
  2717. struct wmi_mgmt_params *param)
  2718. {
  2719. wmi_mgmt_tx_cmd *cmd;
  2720. wmi_buf_t wmi_buf;
  2721. int len = sizeof(wmi_mgmt_tx_hdr) + param->frm_len;
  2722. wmi_buf = wmi_buf_alloc(wmi_handle, roundup(len, sizeof(u_int32_t)));
  2723. if (!wmi_buf) {
  2724. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2725. return QDF_STATUS_E_FAILURE;
  2726. }
  2727. cmd = (wmi_mgmt_tx_cmd *)wmi_buf_data(wmi_buf);
  2728. cmd->hdr.vdev_id = param->vdev_id;
  2729. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->macaddr, &cmd->hdr.peer_macaddr);
  2730. cmd->hdr.buf_len = param->frm_len;
  2731. #ifdef BIG_ENDIAN_HOST
  2732. {
  2733. /* for big endian host, copy engine byte_swap is enabled
  2734. * But the mgmt frame buffer content is in network byte order
  2735. * Need to byte swap the mgmt frame buffer content - so when
  2736. * copy engine does byte_swap - target gets buffer content in
  2737. * the correct order
  2738. */
  2739. int i;
  2740. u_int32_t *destp, *srcp;
  2741. destp = (u_int32_t *)cmd->bufp;
  2742. srcp = (u_int32_t *)wmi_buf_data(param->tx_frame);
  2743. for (i = 0; i < (roundup(param->frm_len,
  2744. sizeof(u_int32_t))/4); i++) {
  2745. *destp = qdf_le32_to_cpu(*srcp);
  2746. destp++; srcp++;
  2747. }
  2748. }
  2749. #else
  2750. qdf_mem_copy(cmd->bufp, wmi_buf_data(param->tx_frame), param->frm_len);
  2751. #endif
  2752. /* Send the management frame buffer to the target */
  2753. wmi_unified_cmd_send(wmi_handle, wmi_buf, roundup(len,
  2754. sizeof(u_int32_t)), WMI_MGMT_TX_CMDID);
  2755. return QDF_STATUS_SUCCESS;
  2756. }
  2757. /**
  2758. * send_addba_clearresponse_cmd_non_tlv() - send addba clear response command
  2759. * to fw
  2760. * @wmi_handle: wmi handle
  2761. * @param: pointer to addba clearresp params
  2762. * @macaddr: vdev mac address
  2763. * Return: 0 for success or error code
  2764. */
  2765. static QDF_STATUS
  2766. send_addba_clearresponse_cmd_non_tlv(wmi_unified_t wmi_handle,
  2767. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2768. struct addba_clearresponse_params *param)
  2769. {
  2770. wmi_addba_clear_resp_cmd *cmd;
  2771. wmi_buf_t buf;
  2772. int len = sizeof(wmi_addba_clear_resp_cmd);
  2773. buf = wmi_buf_alloc(wmi_handle, len);
  2774. if (!buf) {
  2775. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2776. return QDF_STATUS_E_FAILURE;
  2777. }
  2778. cmd = (wmi_addba_clear_resp_cmd *)wmi_buf_data(buf);
  2779. cmd->vdev_id = param->vdev_id;
  2780. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2781. /* Send the management frame buffer to the target */
  2782. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_ADDBA_CLEAR_RESP_CMDID);
  2783. return QDF_STATUS_SUCCESS;
  2784. }
  2785. /**
  2786. * send_addba_send_cmd_non_tlv() - send addba send command to fw
  2787. * @wmi_handle: wmi handle
  2788. * @param: pointer to addba send params
  2789. * @macaddr: vdev mac address
  2790. * Return: 0 for success or error code
  2791. */
  2792. static QDF_STATUS
  2793. send_addba_send_cmd_non_tlv(wmi_unified_t wmi_handle,
  2794. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2795. struct addba_send_params *param)
  2796. {
  2797. wmi_addba_send_cmd *cmd;
  2798. wmi_buf_t buf;
  2799. int len = sizeof(wmi_addba_send_cmd);
  2800. buf = wmi_buf_alloc(wmi_handle, len);
  2801. if (!buf) {
  2802. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2803. return QDF_STATUS_E_FAILURE;
  2804. }
  2805. cmd = (wmi_addba_send_cmd *)wmi_buf_data(buf);
  2806. cmd->vdev_id = param->vdev_id;
  2807. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2808. cmd->tid = param->tidno;
  2809. cmd->buffersize = param->buffersize;
  2810. /* Send the management frame buffer to the target */
  2811. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_ADDBA_SEND_CMDID);
  2812. return QDF_STATUS_SUCCESS;
  2813. }
  2814. /**
  2815. * send_delba_send_cmd_non_tlv() - send delba send command to fw
  2816. * @wmi_handle: wmi handle
  2817. * @param: pointer to delba send params
  2818. * @macaddr: vdev mac address
  2819. * Return: 0 for success or error code
  2820. */
  2821. static QDF_STATUS
  2822. send_delba_send_cmd_non_tlv(wmi_unified_t wmi_handle,
  2823. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2824. struct delba_send_params *param)
  2825. {
  2826. wmi_delba_send_cmd *cmd;
  2827. wmi_buf_t buf;
  2828. int len = sizeof(wmi_delba_send_cmd);
  2829. buf = wmi_buf_alloc(wmi_handle, len);
  2830. if (!buf) {
  2831. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2832. return QDF_STATUS_E_NOMEM;
  2833. }
  2834. cmd = (wmi_delba_send_cmd *)wmi_buf_data(buf);
  2835. cmd->vdev_id = param->vdev_id;
  2836. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2837. cmd->tid = param->tidno;
  2838. cmd->initiator = param->initiator;
  2839. cmd->reasoncode = param->reasoncode;
  2840. /* send the management frame buffer to the target */
  2841. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_DELBA_SEND_CMDID);
  2842. return QDF_STATUS_SUCCESS;
  2843. }
  2844. /**
  2845. * send_addba_setresponse_cmd_non_tlv() - send addba set response command to fw
  2846. * @wmi_handle: wmi handle
  2847. * @param: pointer to addba setresp params
  2848. * @macaddr: vdev mac address
  2849. * Return: 0 for success or error code
  2850. */
  2851. static QDF_STATUS
  2852. send_addba_setresponse_cmd_non_tlv(wmi_unified_t wmi_handle,
  2853. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2854. struct addba_setresponse_params *param)
  2855. {
  2856. wmi_addba_setresponse_cmd *cmd;
  2857. wmi_buf_t buf;
  2858. int len = sizeof(wmi_addba_setresponse_cmd);
  2859. buf = wmi_buf_alloc(wmi_handle, len);
  2860. if (!buf) {
  2861. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2862. return QDF_STATUS_E_NOMEM;
  2863. }
  2864. cmd = (wmi_addba_setresponse_cmd *)wmi_buf_data(buf);
  2865. cmd->vdev_id = param->vdev_id;
  2866. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2867. cmd->tid = param->tidno;
  2868. cmd->statuscode = param->statuscode;
  2869. /* send the management frame buffer to the target */
  2870. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_ADDBA_SET_RESP_CMDID);
  2871. return QDF_STATUS_SUCCESS;
  2872. }
  2873. /**
  2874. * send_singleamsdu_cmd_non_tlv() - send single amsdu command to fw
  2875. * @wmi_handle: wmi handle
  2876. * @param: pointer to single amsdu params
  2877. * @macaddr: vdev mac address
  2878. * Return: 0 for success or error code
  2879. */
  2880. static QDF_STATUS
  2881. send_singleamsdu_cmd_non_tlv(wmi_unified_t wmi_handle,
  2882. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2883. struct singleamsdu_params *param)
  2884. {
  2885. wmi_send_singleamsdu_cmd *cmd;
  2886. wmi_buf_t buf;
  2887. int len = sizeof(wmi_send_singleamsdu_cmd);
  2888. buf = wmi_buf_alloc(wmi_handle, len);
  2889. if (!buf) {
  2890. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2891. return QDF_STATUS_E_NOMEM;
  2892. }
  2893. cmd = (wmi_send_singleamsdu_cmd *)wmi_buf_data(buf);
  2894. cmd->vdev_id = param->vdev_id;
  2895. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2896. cmd->tid = param->tidno;
  2897. /* send the management frame buffer to the target */
  2898. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_SEND_SINGLEAMSDU_CMDID);
  2899. return QDF_STATUS_SUCCESS;
  2900. }
  2901. /**
  2902. * send_set_qboost_param_cmd_non_tlv() - send set qboost command to fw
  2903. * @wmi_handle: wmi handle
  2904. * @param: pointer to qboost params
  2905. * @macaddr: vdev mac address
  2906. * Return: 0 for success or error code
  2907. */
  2908. static QDF_STATUS
  2909. send_set_qboost_param_cmd_non_tlv(wmi_unified_t wmi_handle,
  2910. uint8_t macaddr[IEEE80211_ADDR_LEN],
  2911. struct set_qboost_params *param)
  2912. {
  2913. WMI_QBOOST_CFG_CMD *cmd;
  2914. wmi_buf_t buf;
  2915. int ret;
  2916. buf = wmi_buf_alloc(wmi_handle, sizeof(*cmd));
  2917. if (!buf) {
  2918. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2919. return QDF_STATUS_E_FAILURE;
  2920. }
  2921. cmd = (WMI_QBOOST_CFG_CMD *)wmi_buf_data(buf);
  2922. cmd->vdev_id = param->vdev_id;
  2923. WMI_CHAR_ARRAY_TO_MAC_ADDR(macaddr, &cmd->peer_macaddr);
  2924. cmd->qb_enable = param->value;
  2925. ret = wmi_unified_cmd_send(wmi_handle, buf, sizeof(*cmd),
  2926. WMI_QBOOST_CFG_CMDID);
  2927. return ret;
  2928. }
  2929. /**
  2930. * send_mu_scan_cmd_non_tlv() - send mu scan command to fw
  2931. * @wmi_handle: wmi handle
  2932. * @param: pointer to mu scan params
  2933. * Return: 0 for success or error code
  2934. */
  2935. static QDF_STATUS
  2936. send_mu_scan_cmd_non_tlv(wmi_unified_t wmi_handle,
  2937. struct mu_scan_params *param)
  2938. {
  2939. wmi_mu_start_cmd *cmd;
  2940. wmi_buf_t buf;
  2941. buf = wmi_buf_alloc(wmi_handle, sizeof(wmi_mu_start_cmd));
  2942. if (!buf) {
  2943. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2944. return QDF_STATUS_E_FAILURE;
  2945. }
  2946. cmd = (wmi_mu_start_cmd *)wmi_buf_data(buf);
  2947. cmd->mu_request_id = param->id;
  2948. cmd->mu_duration = param->duration;
  2949. cmd->mu_type = param->type;
  2950. cmd->lteu_tx_power = param->lteu_tx_power;
  2951. cmd->rssi_thr_bssid = param->rssi_thr_bssid;
  2952. cmd->rssi_thr_sta = param->rssi_thr_sta;
  2953. cmd->rssi_thr_sc = param->rssi_thr_sc;
  2954. cmd->plmn_id = param->plmn_id;
  2955. cmd->alpha_num_bssid = param->alpha_num_bssid;
  2956. return wmi_unified_cmd_send(wmi_handle, buf,
  2957. sizeof(wmi_mu_start_cmd),
  2958. WMI_MU_CAL_START_CMDID);
  2959. }
  2960. /**
  2961. * send_lteu_config_cmd_non_tlv() - send lteu config command to fw
  2962. * @wmi_handle: wmi handle
  2963. * @param: pointer to lteu config params
  2964. * Return: 0 for success or error code
  2965. */
  2966. static QDF_STATUS
  2967. send_lteu_config_cmd_non_tlv(wmi_unified_t wmi_handle,
  2968. struct lteu_config_params *param)
  2969. {
  2970. wmi_set_lteu_config *cmd;
  2971. wmi_buf_t buf;
  2972. int i;
  2973. buf = wmi_buf_alloc(wmi_handle, sizeof(wmi_set_lteu_config));
  2974. if (!buf) {
  2975. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  2976. return QDF_STATUS_E_FAILURE;
  2977. }
  2978. cmd = (wmi_set_lteu_config *)wmi_buf_data(buf);
  2979. cmd->gpio_enable = param->lteu_gpio_start;
  2980. cmd->num_lteu_bins = param->lteu_num_bins;
  2981. for (i = 0; i < cmd->num_lteu_bins; i++) {
  2982. cmd->mu_rssi_threshold[i] = param->lteu_thresh[i];
  2983. cmd->mu_weight[i] = param->lteu_weight[i];
  2984. cmd->mu_gamma[i] = param->lteu_gamma[i];
  2985. }
  2986. cmd->mu_scan_timeout = param->lteu_scan_timeout;
  2987. cmd->alpha_num_bssid = param->alpha_num_bssid;
  2988. cmd->use_actual_nf = param->use_actual_nf;
  2989. cmd->wifi_tx_power = param->wifi_tx_power;
  2990. cmd->allow_err_packets = param->allow_err_packets;
  2991. return wmi_unified_cmd_send(wmi_handle, buf,
  2992. sizeof(wmi_set_lteu_config),
  2993. WMI_SET_LTEU_CONFIG_CMDID);
  2994. }
  2995. /**
  2996. * send_pdev_get_tpc_config_cmd_non_tlv() - send get tpc config command to fw
  2997. * @wmi_handle: wmi handle
  2998. * @param: pointer to get tpc config params
  2999. *
  3000. * Return: 0 for success or error code
  3001. */
  3002. static QDF_STATUS
  3003. send_pdev_get_tpc_config_cmd_non_tlv(wmi_unified_t wmi_handle,
  3004. uint32_t param)
  3005. {
  3006. wmi_pdev_get_tpc_config_cmd *cmd;
  3007. wmi_buf_t buf;
  3008. int32_t len = sizeof(wmi_pdev_get_tpc_config_cmd);
  3009. buf = wmi_buf_alloc(wmi_handle, len);
  3010. if (!buf) {
  3011. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3012. return QDF_STATUS_E_FAILURE;
  3013. }
  3014. cmd = (wmi_pdev_get_tpc_config_cmd *)wmi_buf_data(buf);
  3015. cmd->param = param;
  3016. return wmi_unified_cmd_send(wmi_handle, buf, len,
  3017. WMI_PDEV_GET_TPC_CONFIG_CMDID);
  3018. }
  3019. /**
  3020. * send_set_bwf_cmd_non_tlv() - send set bwf command to fw
  3021. * @wmi_handle: wmi handle
  3022. * @param: pointer to set bwf param
  3023. *
  3024. * Return: 0 for success or error code
  3025. */
  3026. static QDF_STATUS
  3027. send_set_bwf_cmd_non_tlv(wmi_unified_t wmi_handle,
  3028. struct set_bwf_params *param)
  3029. {
  3030. struct wmi_bwf_peer_info *peer_info;
  3031. wmi_peer_bwf_request *cmd;
  3032. wmi_buf_t buf;
  3033. int len = sizeof(wmi_peer_bwf_request);
  3034. int i, retval = 0;
  3035. len += param->num_peers * sizeof(struct wmi_bwf_peer_info);
  3036. buf = wmi_buf_alloc(wmi_handle, len);
  3037. if (!buf) {
  3038. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3039. return QDF_STATUS_E_FAILURE;
  3040. }
  3041. cmd = (wmi_peer_bwf_request *)wmi_buf_data(buf);
  3042. qdf_mem_copy(&(cmd->num_peers), &(param->num_peers), sizeof(uint32_t));
  3043. peer_info = (struct wmi_bwf_peer_info *)&(cmd->peer_info[0]);
  3044. for (i = 0; i < param->num_peers; i++) {
  3045. qdf_mem_copy(&(peer_info[i].peer_macaddr),
  3046. &(param->peer_info[i].peer_macaddr),
  3047. sizeof(wmi_mac_addr));
  3048. peer_info[i].bwf_guaranteed_bandwidth =
  3049. param->peer_info[i].throughput;
  3050. peer_info[i].bwf_max_airtime = param->peer_info[i].max_airtime;
  3051. peer_info[i].bwf_peer_priority = param->peer_info[i].priority;
  3052. }
  3053. retval = wmi_unified_cmd_send(wmi_handle, buf, len,
  3054. WMI_PEER_BWF_REQUEST_CMDID);
  3055. if (retval)
  3056. wmi_buf_free(buf);
  3057. return retval;
  3058. }
  3059. /**
  3060. * send_set_atf_cmd_non_tlv() - send set atf command to fw
  3061. * @wmi_handle: wmi handle
  3062. * @param: pointer to set atf param
  3063. *
  3064. * Return: 0 for success or error code
  3065. */
  3066. static QDF_STATUS
  3067. send_set_atf_cmd_non_tlv(wmi_unified_t wmi_handle,
  3068. struct set_atf_params *param)
  3069. {
  3070. struct wmi_atf_peer_info *peer_info;
  3071. wmi_peer_atf_request *cmd;
  3072. wmi_buf_t buf;
  3073. int len = sizeof(wmi_peer_atf_request);
  3074. int i, retval = 0;
  3075. len += param->num_peers * sizeof(struct wmi_atf_peer_info);
  3076. buf = wmi_buf_alloc(wmi_handle, len);
  3077. if (!buf) {
  3078. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3079. return QDF_STATUS_E_FAILURE;
  3080. }
  3081. cmd = (wmi_peer_atf_request *)wmi_buf_data(buf);
  3082. qdf_mem_copy(&(cmd->num_peers), &(param->num_peers), sizeof(uint32_t));
  3083. peer_info = (struct wmi_atf_peer_info *)&(cmd->peer_info[0]);
  3084. for (i = 0; i < param->num_peers; i++) {
  3085. qdf_mem_copy(&(peer_info[i].peer_macaddr),
  3086. &(param->peer_info[i].peer_macaddr),
  3087. sizeof(wmi_mac_addr));
  3088. peer_info[i].atf_units = param->peer_info[i].percentage_peer;
  3089. }
  3090. /* qdf_print("wmi_unified_pdev_set_atf peer_num=%d\n", cmd->num_peers); */
  3091. retval = wmi_unified_cmd_send(wmi_handle, buf, len,
  3092. WMI_PEER_ATF_REQUEST_CMDID);
  3093. return retval;
  3094. }
  3095. /**
  3096. * send_atf_peer_request_cmd_non_tlv() - send atf peer request command to fw
  3097. * @wmi_handle: wmi handle
  3098. * @param: pointer to atf peer request param
  3099. *
  3100. * Return: 0 for success or error code
  3101. */
  3102. static QDF_STATUS
  3103. send_atf_peer_request_cmd_non_tlv(wmi_unified_t wmi_handle,
  3104. struct atf_peer_request_params *param)
  3105. {
  3106. struct wmi_atf_peer_ext_info *peer_ext_info;
  3107. wmi_peer_atf_ext_request *cmd;
  3108. wmi_buf_t buf;
  3109. int len = sizeof(wmi_peer_atf_ext_request);
  3110. int i, retval = 0;
  3111. len += param->num_peers * sizeof(struct wmi_atf_peer_ext_info);
  3112. buf = wmi_buf_alloc(wmi_handle, len);
  3113. if (!buf) {
  3114. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3115. return QDF_STATUS_E_FAILURE;
  3116. }
  3117. cmd = (wmi_peer_atf_ext_request *)wmi_buf_data(buf);
  3118. qdf_mem_copy(&(cmd->num_peers), &(param->num_peers), sizeof(uint32_t));
  3119. peer_ext_info =
  3120. (struct wmi_atf_peer_ext_info *)&(cmd->peer_ext_info[0]);
  3121. for (i = 0; i < param->num_peers; i++) {
  3122. qdf_mem_copy(&(peer_ext_info[i].peer_macaddr),
  3123. &(param->peer_ext_info[i].peer_macaddr),
  3124. sizeof(wmi_mac_addr));
  3125. peer_ext_info[i].atf_groupid =
  3126. param->peer_ext_info[i].group_index;
  3127. peer_ext_info[i].atf_units_reserved =
  3128. param->peer_ext_info[i].atf_index_reserved;
  3129. }
  3130. retval = wmi_unified_cmd_send(wmi_handle, buf, len,
  3131. WMI_PEER_ATF_EXT_REQUEST_CMDID);
  3132. return retval;
  3133. }
  3134. /**
  3135. * send_set_atf_grouping_cmd_non_tlv() - send set atf grouping command to fw
  3136. * @wmi_handle: wmi handle
  3137. * @param: pointer to set atf grouping param
  3138. *
  3139. * Return: 0 for success or error code
  3140. */
  3141. static QDF_STATUS
  3142. send_set_atf_grouping_cmd_non_tlv(wmi_unified_t wmi_handle,
  3143. struct atf_grouping_params *param)
  3144. {
  3145. struct wmi_atf_group_info *group_info;
  3146. wmi_atf_ssid_grp_request *cmd;
  3147. wmi_buf_t buf;
  3148. int len = sizeof(wmi_atf_ssid_grp_request);
  3149. int i, retval = 0;
  3150. len += param->num_groups * sizeof(struct wmi_atf_group_info);
  3151. buf = wmi_buf_alloc(wmi_handle, len);
  3152. if (!buf) {
  3153. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3154. return QDF_STATUS_E_FAILURE;
  3155. }
  3156. cmd = (wmi_atf_ssid_grp_request *)wmi_buf_data(buf);
  3157. qdf_mem_copy(&(cmd->num_groups), &(param->num_groups),
  3158. sizeof(uint32_t));
  3159. group_info = (struct wmi_atf_group_info *)&(cmd->group_info[0]);
  3160. for (i = 0; i < param->num_groups; i++) {
  3161. group_info[i].atf_group_units =
  3162. param->group_info[i].percentage_group;
  3163. group_info[i].atf_group_units_reserved =
  3164. param->group_info[i].atf_group_units_reserved;
  3165. }
  3166. retval = wmi_unified_cmd_send(wmi_handle, buf, len,
  3167. WMI_ATF_SSID_GROUPING_REQUEST_CMDID);
  3168. return retval;
  3169. }
  3170. /**
  3171. * send_wlan_profile_enable_cmd_non_tlv() - send wlan profile enable command
  3172. * to fw
  3173. * @wmi_handle: wmi handle
  3174. * @param: pointer to wlan profile param
  3175. *
  3176. * Return: 0 for success or error code
  3177. */
  3178. static QDF_STATUS
  3179. send_wlan_profile_enable_cmd_non_tlv(wmi_unified_t wmi_handle,
  3180. struct wlan_profile_params *param)
  3181. {
  3182. wmi_buf_t buf;
  3183. uint16_t len;
  3184. wmi_wlan_profile_enable_profile_id_cmd *cmd;
  3185. len = sizeof(wmi_wlan_profile_enable_profile_id_cmd);
  3186. buf = wmi_buf_alloc(wmi_handle, len);
  3187. if (!buf) {
  3188. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3189. return QDF_STATUS_E_FAILURE;
  3190. }
  3191. cmd = (wmi_wlan_profile_enable_profile_id_cmd *)wmi_buf_data(buf);
  3192. cmd->profile_id = param->profile_id;
  3193. cmd->enable = param->enable;
  3194. return wmi_unified_cmd_send(wmi_handle, buf, len,
  3195. WMI_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID);
  3196. }
  3197. /**
  3198. * send_wlan_profile_trigger_cmd_non_tlv() - send wlan profile trigger command
  3199. * to fw
  3200. * @wmi_handle: wmi handle
  3201. * @param: pointer to wlan profile param
  3202. *
  3203. * Return: 0 for success or error code
  3204. */
  3205. static QDF_STATUS
  3206. send_wlan_profile_trigger_cmd_non_tlv(wmi_unified_t wmi_handle,
  3207. struct wlan_profile_params *param)
  3208. {
  3209. wmi_buf_t buf;
  3210. uint16_t len;
  3211. wmi_wlan_profile_trigger_cmd *cmd;
  3212. len = sizeof(wmi_wlan_profile_trigger_cmd);
  3213. buf = wmi_buf_alloc(wmi_handle, len);
  3214. if (!buf) {
  3215. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3216. return QDF_STATUS_E_FAILURE;
  3217. }
  3218. cmd = (wmi_wlan_profile_trigger_cmd *)wmi_buf_data(buf);
  3219. cmd->enable = param->enable;
  3220. return wmi_unified_cmd_send(wmi_handle, buf, len,
  3221. WMI_WLAN_PROFILE_TRIGGER_CMDID);
  3222. }
  3223. #ifdef BIG_ENDIAN_HOST
  3224. void wmi_host_swap_bytes(void *pv, size_t n)
  3225. {
  3226. int noWords;
  3227. int i;
  3228. A_UINT32 *wordPtr;
  3229. noWords = n/sizeof(u_int32_t);
  3230. wordPtr = (u_int32_t *)pv;
  3231. for (i = 0; i < noWords; i++)
  3232. *(wordPtr + i) = __cpu_to_le32(*(wordPtr + i));
  3233. }
  3234. #define WMI_HOST_SWAPME(x, len) wmi_host_swap_bytes(&x, len);
  3235. #endif
  3236. /**
  3237. * send_set_ht_ie_cmd_non_tlv() - send ht ie command to fw
  3238. * @wmi_handle: wmi handle
  3239. * @param: pointer to ht ie param
  3240. *
  3241. * Return: 0 for success or error code
  3242. */
  3243. static QDF_STATUS
  3244. send_set_ht_ie_cmd_non_tlv(wmi_unified_t wmi_handle,
  3245. struct ht_ie_params *param)
  3246. {
  3247. wmi_pdev_set_ht_ie_cmd *cmd;
  3248. wmi_buf_t buf;
  3249. /* adjust length to be next multiple of four */
  3250. int len = (param->ie_len + (sizeof(uint32_t) - 1)) &
  3251. (~(sizeof(uint32_t) - 1));
  3252. /* to account for extra four bytes of ie data in the struct */
  3253. len += (sizeof(wmi_pdev_set_ht_ie_cmd) - 4);
  3254. buf = wmi_buf_alloc(wmi_handle, len);
  3255. if (!buf) {
  3256. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3257. return QDF_STATUS_E_FAILURE;
  3258. }
  3259. cmd = (wmi_pdev_set_ht_ie_cmd *)wmi_buf_data(buf);
  3260. cmd->ie_len = param->ie_len;
  3261. qdf_mem_copy(cmd->ie_data, param->ie_data, param->ie_len);
  3262. #ifdef BIG_ENDIAN_HOST
  3263. WMI_HOST_SWAPME(cmd->ie_data, len-(offsetof(wmi_pdev_set_ht_ie_cmd,
  3264. ie_data)));
  3265. #endif
  3266. return wmi_unified_cmd_send(wmi_handle, buf, len,
  3267. WMI_PDEV_SET_HT_CAP_IE_CMDID);
  3268. }
  3269. /**
  3270. * send_set_vht_ie_cmd_non_tlv() - send vht ie command to fw
  3271. * @wmi_handle: wmi handle
  3272. * @param: pointer to vht ie param
  3273. *
  3274. * Return: 0 for success or error code
  3275. */
  3276. static QDF_STATUS
  3277. send_set_vht_ie_cmd_non_tlv(wmi_unified_t wmi_handle,
  3278. struct vht_ie_params *param)
  3279. {
  3280. wmi_pdev_set_vht_ie_cmd *cmd;
  3281. wmi_buf_t buf;
  3282. /* adjust length to be next multiple of four */
  3283. int len = (param->ie_len + (sizeof(u_int32_t) - 1)) &
  3284. (~(sizeof(u_int32_t) - 1));
  3285. /* to account for extra four bytes of ie data in the struct */
  3286. len += (sizeof(wmi_pdev_set_vht_ie_cmd) - 4);
  3287. buf = wmi_buf_alloc(wmi_handle, len);
  3288. if (!buf) {
  3289. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3290. return QDF_STATUS_E_FAILURE;
  3291. }
  3292. cmd = (wmi_pdev_set_vht_ie_cmd *)wmi_buf_data(buf);
  3293. cmd->ie_len = param->ie_len;
  3294. qdf_mem_copy(cmd->ie_data, param->ie_data, param->ie_len);
  3295. #ifdef BIG_ENDIAN_HOST
  3296. WMI_HOST_SWAPME(cmd->ie_data, len-(offsetof(wmi_pdev_set_vht_ie_cmd,
  3297. ie_data)));
  3298. #endif
  3299. return wmi_unified_cmd_send(wmi_handle, buf, len,
  3300. WMI_PDEV_SET_VHT_CAP_IE_CMDID);
  3301. }
  3302. /**
  3303. * send_wmm_update_cmd_non_tlv() - send wmm update command to fw
  3304. * @wmi_handle: wmi handle
  3305. * @param: pointer to wmm update param
  3306. *
  3307. * Return: 0 for success or error code
  3308. */
  3309. static QDF_STATUS
  3310. send_wmm_update_cmd_non_tlv(wmi_unified_t wmi_handle,
  3311. struct wmm_update_params *param)
  3312. {
  3313. wmi_buf_t buf;
  3314. wmi_pdev_set_wmm_params_cmd *cmd;
  3315. wmi_wmm_params *wmi_param = 0;
  3316. int ac;
  3317. int len = sizeof(wmi_pdev_set_wmm_params_cmd);
  3318. struct wmi_host_wmeParams *wmep;
  3319. buf = wmi_buf_alloc(wmi_handle, len);
  3320. if (!buf) {
  3321. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3322. return QDF_STATUS_SUCCESS;
  3323. }
  3324. cmd = (wmi_pdev_set_wmm_params_cmd *)wmi_buf_data(buf);
  3325. for (ac = 0; ac < WME_NUM_AC; ac++) {
  3326. wmep = &param->wmep_array[ac];
  3327. switch (ac) {
  3328. case WMI_HOST_AC_BE:
  3329. wmi_param = &cmd->wmm_params_ac_be;
  3330. break;
  3331. case WMI_HOST_AC_BK:
  3332. wmi_param = &cmd->wmm_params_ac_bk;
  3333. break;
  3334. case WMI_HOST_AC_VI:
  3335. wmi_param = &cmd->wmm_params_ac_vi;
  3336. break;
  3337. case WMI_HOST_AC_VO:
  3338. wmi_param = &cmd->wmm_params_ac_vo;
  3339. break;
  3340. default:
  3341. break;
  3342. }
  3343. wmi_param->aifs = wmep->wmep_aifsn;
  3344. wmi_param->cwmin = ATH_EXPONENT_TO_VALUE(wmep->wmep_logcwmin);
  3345. wmi_param->cwmax = ATH_EXPONENT_TO_VALUE(wmep->wmep_logcwmax);
  3346. wmi_param->txoplimit = ATH_TXOP_TO_US(wmep->wmep_txopLimit);
  3347. wmi_param->acm = wmep->wmep_acm;
  3348. wmi_param->no_ack = wmep->wmep_noackPolicy;
  3349. }
  3350. wmi_unified_cmd_send(wmi_handle, buf, len,
  3351. WMI_PDEV_SET_WMM_PARAMS_CMDID);
  3352. return QDF_STATUS_SUCCESS;
  3353. }
  3354. /**
  3355. * send_set_ant_switch_tbl_cmd_non_tlv() - send ant switch tbl cmd to fw
  3356. * @wmi_handle: wmi handle
  3357. * @param: pointer to hold ant switch tbl param
  3358. *
  3359. * Return: 0 for success or error code
  3360. */
  3361. static QDF_STATUS
  3362. send_set_ant_switch_tbl_cmd_non_tlv(wmi_unified_t wmi_handle,
  3363. struct ant_switch_tbl_params *param)
  3364. {
  3365. uint8_t len;
  3366. wmi_buf_t buf;
  3367. wmi_pdev_set_ant_switch_tbl_cmd *cmd;
  3368. len = sizeof(wmi_pdev_set_ant_switch_tbl_cmd);
  3369. buf = wmi_buf_alloc(wmi_handle, len);
  3370. if (!buf) {
  3371. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3372. return QDF_STATUS_E_NOMEM;
  3373. }
  3374. cmd = (wmi_pdev_set_ant_switch_tbl_cmd *)wmi_buf_data(buf);
  3375. cmd->antCtrlCommon1 = param->ant_ctrl_common1;
  3376. cmd->antCtrlCommon2 = param->ant_ctrl_common2;
  3377. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  3378. WMI_PDEV_SET_ANTENNA_SWITCH_TABLE_CMDID)) {
  3379. return QDF_STATUS_E_FAILURE;
  3380. }
  3381. return QDF_STATUS_SUCCESS;
  3382. }
  3383. /**
  3384. * send_set_ratepwr_table_cmd_non_tlv() - send rate power table cmd to fw
  3385. * @wmi_handle: wmi handle
  3386. * @param: pointer to hold rate power table param
  3387. *
  3388. * Return: 0 for success or error code
  3389. */
  3390. static QDF_STATUS
  3391. send_set_ratepwr_table_cmd_non_tlv(wmi_unified_t wmi_handle,
  3392. struct ratepwr_table_params *param)
  3393. {
  3394. uint16_t len;
  3395. wmi_buf_t buf;
  3396. wmi_pdev_ratepwr_table_cmd *cmd;
  3397. if (!param->ratepwr_tbl)
  3398. return QDF_STATUS_E_FAILURE;
  3399. len = sizeof(wmi_pdev_ratepwr_table_cmd);
  3400. len += roundup(param->ratepwr_len, sizeof(A_UINT32)) - sizeof(A_UINT32);
  3401. /* already 4 bytes in cmd structure */
  3402. qdf_print("wmi buf len = %d\n", len);
  3403. buf = wmi_buf_alloc(wmi_handle, len);
  3404. if (!buf) {
  3405. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3406. return QDF_STATUS_E_NOMEM;
  3407. }
  3408. cmd = (wmi_pdev_ratepwr_table_cmd *)wmi_buf_data(buf);
  3409. cmd->op = RATEPWR_TABLE_OPS_SET;
  3410. cmd->ratepwr_len = param->ratepwr_len;
  3411. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(&cmd->ratepwr_tbl[0],
  3412. param->ratepwr_tbl, param->ratepwr_len);
  3413. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  3414. WMI_PDEV_RATEPWR_TABLE_CMDID)) {
  3415. return QDF_STATUS_E_FAILURE;
  3416. }
  3417. return QDF_STATUS_SUCCESS;
  3418. }
  3419. /**
  3420. * send_get_ratepwr_table_cmd_non_tlv() - send rate power table cmd to fw
  3421. * @wmi_handle: wmi handle
  3422. *
  3423. * Return: 0 for success or error code
  3424. */
  3425. static QDF_STATUS
  3426. send_get_ratepwr_table_cmd_non_tlv(wmi_unified_t wmi_handle)
  3427. {
  3428. uint16_t len;
  3429. wmi_buf_t buf;
  3430. wmi_pdev_ratepwr_table_cmd *cmd;
  3431. len = sizeof(wmi_pdev_ratepwr_table_cmd);
  3432. qdf_print("wmi buf len = %d\n", len);
  3433. buf = wmi_buf_alloc(wmi_handle, len);
  3434. if (!buf) {
  3435. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3436. return QDF_STATUS_E_NOMEM;
  3437. }
  3438. cmd = (wmi_pdev_ratepwr_table_cmd *)wmi_buf_data(buf);
  3439. cmd->op = RATEPWR_TABLE_OPS_GET;
  3440. cmd->ratepwr_len = 0;
  3441. cmd->ratepwr_tbl[0] = 0;
  3442. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  3443. WMI_PDEV_RATEPWR_TABLE_CMDID)) {
  3444. return QDF_STATUS_E_FAILURE;
  3445. }
  3446. return QDF_STATUS_SUCCESS;
  3447. }
  3448. /**
  3449. * send_set_ctl_table_cmd_non_tlv() - send ctl table cmd to fw
  3450. * @wmi_handle: wmi handle
  3451. * @param: pointer to hold ctl table param
  3452. *
  3453. * Return: 0 for success or error code
  3454. */
  3455. static QDF_STATUS
  3456. send_set_ctl_table_cmd_non_tlv(wmi_unified_t wmi_handle,
  3457. struct ctl_table_params *param)
  3458. {
  3459. uint16_t len;
  3460. wmi_buf_t buf;
  3461. wmi_pdev_set_ctl_table_cmd *cmd;
  3462. if (!param->ctl_array)
  3463. return QDF_STATUS_E_FAILURE;
  3464. /* CTL array length check for Beeliner family */
  3465. if (param->target_type == TARGET_TYPE_AR900B ||
  3466. param->target_type == TARGET_TYPE_QCA9984 ||
  3467. param->target_type == TARGET_TYPE_IPQ4019 ||
  3468. param->target_type == TARGET_TYPE_QCA9888) {
  3469. if (param->is_2g) {
  3470. /* For 2G, CTL array length should be 688*/
  3471. if (param->ctl_cmd_len !=
  3472. (4 + (WMI_HOST_NUM_CTLS_2G_11B * 2) +
  3473. (WMI_HOST_NUM_BAND_EDGES_2G_11B * 3) +
  3474. 1 + (WMI_HOST_NUM_CTLS_2G_11B *
  3475. WMI_HOST_NUM_BAND_EDGES_2G_11B) +
  3476. (WMI_HOST_NUM_CTLS_2G_20MHZ * 2) +
  3477. (WMI_HOST_NUM_BAND_EDGES_2G_20MHZ * 3) +
  3478. 1 + (WMI_HOST_NUM_CTLS_2G_20MHZ *
  3479. WMI_HOST_NUM_BAND_EDGES_2G_20MHZ) +
  3480. (WMI_HOST_NUM_CTLS_2G_40MHZ * 2) +
  3481. (WMI_HOST_NUM_BAND_EDGES_2G_40MHZ * 3) +
  3482. (WMI_HOST_NUM_CTLS_2G_40MHZ *
  3483. WMI_HOST_NUM_BAND_EDGES_2G_40MHZ) + 4)) {
  3484. qdf_print("CTL array len not correct\n");
  3485. return QDF_STATUS_E_FAILURE;
  3486. }
  3487. } else {
  3488. /* For 5G, CTL array length should be 1540 */
  3489. if (param->ctl_cmd_len !=
  3490. (4 + (WMI_HOST_NUM_CTLS_5G_11A * 2) +
  3491. (WMI_HOST_NUM_BAND_EDGES_5G_11A * 3) +
  3492. 1 + (WMI_HOST_NUM_CTLS_5G_11A *
  3493. WMI_HOST_NUM_BAND_EDGES_5G_11A) + 1
  3494. + (WMI_HOST_NUM_CTLS_5G_HT20 * 2) +
  3495. (WMI_HOST_NUM_BAND_EDGES_5G_HT20 * 3) +
  3496. 1 + (WMI_HOST_NUM_CTLS_5G_HT20 *
  3497. WMI_HOST_NUM_BAND_EDGES_5G_HT20) +
  3498. (WMI_HOST_NUM_CTLS_5G_HT40 * 2) +
  3499. (WMI_HOST_NUM_BAND_EDGES_5G_HT40 * 3) +
  3500. (WMI_HOST_NUM_CTLS_5G_HT40 *
  3501. WMI_HOST_NUM_BAND_EDGES_5G_HT40) +
  3502. (WMI_HOST_NUM_CTLS_5G_HT80 * 2) +
  3503. (WMI_HOST_NUM_BAND_EDGES_5G_HT80 * 3) +
  3504. (WMI_HOST_NUM_CTLS_5G_HT80 *
  3505. WMI_HOST_NUM_BAND_EDGES_5G_HT80) +
  3506. (WMI_HOST_NUM_CTLS_5G_HT160 * 2) +
  3507. (WMI_HOST_NUM_BAND_EDGES_5G_HT160 * 3) +
  3508. (WMI_HOST_NUM_CTLS_5G_HT160 *
  3509. WMI_HOST_NUM_BAND_EDGES_5G_HT160))) {
  3510. qdf_print("CTL array len not correct\n");
  3511. return QDF_STATUS_E_FAILURE;
  3512. }
  3513. }
  3514. } else {
  3515. if (param->ctl_cmd_len !=
  3516. WMI_HOST_NUM_CTLS_2G * WMI_HOST_NUM_BAND_EDGES_2G * 2 +
  3517. WMI_HOST_NUM_CTLS_5G * WMI_HOST_NUM_BAND_EDGES_5G * 2) {
  3518. qdf_print("CTL array len not correct\n");
  3519. return QDF_STATUS_E_FAILURE;
  3520. }
  3521. }
  3522. len = sizeof(wmi_pdev_set_ctl_table_cmd);
  3523. len += roundup(param->ctl_cmd_len, sizeof(A_UINT32)) - sizeof(A_UINT32);
  3524. qdf_print("wmi buf len = %d\n", len);
  3525. buf = wmi_buf_alloc(wmi_handle, len);
  3526. if (!buf) {
  3527. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3528. return QDF_STATUS_E_FAILURE;
  3529. }
  3530. cmd = (wmi_pdev_set_ctl_table_cmd *)wmi_buf_data(buf);
  3531. cmd->ctl_len = param->ctl_cmd_len;
  3532. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(&cmd->ctl_info[0], &param->ctl_band,
  3533. sizeof(param->ctl_band));
  3534. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(&cmd->ctl_info[1], param->ctl_array,
  3535. param->ctl_cmd_len - sizeof(param->ctl_band));
  3536. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  3537. WMI_PDEV_SET_CTL_TABLE_CMDID)) {
  3538. qdf_print("%s:Failed to send command\n", __func__);
  3539. return QDF_STATUS_E_FAILURE;
  3540. }
  3541. return QDF_STATUS_SUCCESS;
  3542. }
  3543. /**
  3544. * send_set_mimogain_table_cmd_non_tlv() - send mimogain table cmd to fw
  3545. * @wmi_handle: wmi handle
  3546. * @param: pointer to hold mimogain table param
  3547. *
  3548. * Return: 0 for success or error code
  3549. */
  3550. static QDF_STATUS
  3551. send_set_mimogain_table_cmd_non_tlv(wmi_unified_t wmi_handle,
  3552. struct mimogain_table_params *param)
  3553. {
  3554. uint16_t len;
  3555. wmi_buf_t buf;
  3556. wmi_pdev_set_mimogain_table_cmd *cmd;
  3557. if (!param->array_gain)
  3558. return QDF_STATUS_E_FAILURE;
  3559. /* len must be multiple of a single array gain table */
  3560. if (param->tbl_len %
  3561. ((WMI_HOST_TX_NUM_CHAIN-1) * WMI_HOST_TPC_REGINDEX_MAX *
  3562. WMI_HOST_ARRAY_GAIN_NUM_STREAMS) != 0) {
  3563. qdf_print("Array gain table len not correct\n");
  3564. return QDF_STATUS_E_FAILURE;
  3565. }
  3566. len = sizeof(wmi_pdev_set_mimogain_table_cmd);
  3567. len += roundup(param->tbl_len, sizeof(A_UINT32)) - sizeof(A_UINT32);
  3568. buf = wmi_buf_alloc(wmi_handle, len);
  3569. if (!buf) {
  3570. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3571. return QDF_STATUS_E_FAILURE;
  3572. }
  3573. cmd = (wmi_pdev_set_mimogain_table_cmd *)wmi_buf_data(buf);
  3574. WMI_MIMOGAIN_ARRAY_GAIN_LEN_SET(cmd->mimogain_info, param->tbl_len);
  3575. WMI_MIMOGAIN_MULTI_CHAIN_BYPASS_SET(cmd->mimogain_info,
  3576. param->multichain_gain_bypass);
  3577. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(&cmd->arraygain_tbl[0],
  3578. param->array_gain,
  3579. param->tbl_len);
  3580. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  3581. WMI_PDEV_SET_MIMOGAIN_TABLE_CMDID)) {
  3582. return QDF_STATUS_E_FAILURE;
  3583. }
  3584. return QDF_STATUS_SUCCESS;
  3585. }
  3586. /**
  3587. * send_set_ratepwr_chainmsk_cmd_non_tlv() - send ratepwr chainmask cmd to fw
  3588. * @wmi_handle: wmi handle
  3589. * @param: pointer to hold ratepwr chainmask param
  3590. *
  3591. * Return: 0 for success or error code
  3592. */
  3593. static QDF_STATUS
  3594. send_set_ratepwr_chainmsk_cmd_non_tlv(wmi_unified_t wmi_handle,
  3595. struct ratepwr_chainmsk_params *param)
  3596. {
  3597. #define RC_CCK_OFDM_RATES 0
  3598. #define RC_HT_RATES 1
  3599. #define RC_VHT_RATES 2
  3600. uint16_t len;
  3601. wmi_buf_t buf;
  3602. wmi_pdev_ratepwr_chainmsk_tbl_cmd *cmd;
  3603. if (!param->ratepwr_chain_tbl)
  3604. return QDF_STATUS_E_FAILURE;
  3605. len = sizeof(wmi_pdev_ratepwr_chainmsk_tbl_cmd);
  3606. len += roundup(param->num_rate*sizeof(uint32_t), sizeof(A_UINT32));
  3607. buf = wmi_buf_alloc(wmi_handle, len);
  3608. if (!buf) {
  3609. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3610. return QDF_STATUS_E_NOMEM;
  3611. }
  3612. cmd = (wmi_pdev_ratepwr_chainmsk_tbl_cmd *)wmi_buf_data(buf);
  3613. cmd->op = param->ops;
  3614. cmd->pream_type = param->pream_type;
  3615. cmd->rate_len = param->num_rate;
  3616. if (param->ops == RATEPWR_CHAINMSK_TABLE_OPS_EN) {
  3617. qdf_mem_copy(&cmd->ratepwr_chaintbl[0],
  3618. param->ratepwr_chain_tbl,
  3619. param->num_rate*sizeof(u_int32_t));
  3620. }
  3621. wmi_unified_cmd_send(wmi_handle, buf, len,
  3622. WMI_PDEV_RATEPWR_CHAINMSK_TABLE_CMDID);
  3623. return QDF_STATUS_SUCCESS;
  3624. }
  3625. /**
  3626. * send_set_macaddr_cmd_non_tlv() - send set macaddr cmd to fw
  3627. * @wmi_handle: wmi handle
  3628. * @param: pointer to hold macaddr param
  3629. *
  3630. * Return: 0 for success or error code
  3631. */
  3632. static QDF_STATUS
  3633. send_set_macaddr_cmd_non_tlv(wmi_unified_t wmi_handle,
  3634. struct macaddr_params *param)
  3635. {
  3636. uint8_t len;
  3637. wmi_buf_t buf;
  3638. wmi_pdev_set_base_macaddr_cmd *cmd;
  3639. len = sizeof(wmi_pdev_set_base_macaddr_cmd);
  3640. buf = wmi_buf_alloc(wmi_handle, len);
  3641. if (!buf) {
  3642. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3643. return QDF_STATUS_E_FAILURE;
  3644. }
  3645. cmd = (wmi_pdev_set_base_macaddr_cmd *)wmi_buf_data(buf);
  3646. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->macaddr, &cmd->base_macaddr);
  3647. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  3648. WMI_PDEV_SET_BASE_MACADDR_CMDID)) {
  3649. return QDF_STATUS_E_FAILURE;
  3650. }
  3651. return QDF_STATUS_SUCCESS;
  3652. }
  3653. /**
  3654. * send_pdev_scan_start_cmd_non_tlv() - send pdev scan start cmd to fw
  3655. * @wmi_handle: wmi handle
  3656. *
  3657. * Return: 0 for success or error code
  3658. */
  3659. static QDF_STATUS
  3660. send_pdev_scan_start_cmd_non_tlv(wmi_unified_t wmi_handle)
  3661. {
  3662. /*
  3663. * this command was added to support host scan egine which is
  3664. * deprecated. now the scan engine is in FW and host directly
  3665. * isssues a scan request to perform scan and provide results back
  3666. * to host
  3667. */
  3668. wmi_buf_t buf;
  3669. wmi_pdev_scan_cmd *cmd;
  3670. int len = sizeof(wmi_pdev_scan_cmd);
  3671. buf = wmi_buf_alloc(wmi_handle, len);
  3672. qdf_print("%s:\n", __func__);
  3673. if (!buf) {
  3674. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3675. return QDF_STATUS_E_NOMEM;
  3676. }
  3677. cmd = (wmi_pdev_scan_cmd *)wmi_buf_data(buf);
  3678. cmd->scan_start = TRUE;
  3679. #if DEPRECATE_WMI
  3680. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_PDEV_SCAN_CMDID);
  3681. #endif
  3682. return QDF_STATUS_SUCCESS;
  3683. }
  3684. /**
  3685. * send_pdev_scan_end_cmd_non_tlv() - send pdev scan end cmd to fw
  3686. * @wmi_handle: wmi handle
  3687. *
  3688. * Return: 0 for success or error code
  3689. */
  3690. static QDF_STATUS
  3691. send_pdev_scan_end_cmd_non_tlv(wmi_unified_t wmi_handle)
  3692. {
  3693. /*
  3694. * this command was added to support host scan egine which is
  3695. * deprecated. now the scan engine is in FW and host directly isssues
  3696. * a scan request to perform scan and provide results back to host
  3697. */
  3698. wmi_pdev_scan_cmd *cmd;
  3699. wmi_buf_t buf;
  3700. int len = sizeof(wmi_pdev_scan_cmd);
  3701. buf = wmi_buf_alloc(wmi_handle, len);
  3702. qdf_print("%s:\n", __func__);
  3703. if (!buf) {
  3704. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3705. return QDF_STATUS_E_NOMEM;
  3706. }
  3707. cmd = (wmi_pdev_scan_cmd *)wmi_buf_data(buf);
  3708. cmd->scan_start = FALSE;
  3709. #if DEPRECATE_WMI
  3710. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_PDEV_SCAN_CMDID);
  3711. #endif
  3712. return QDF_STATUS_SUCCESS;
  3713. }
  3714. /**
  3715. * send_set_acparams_cmd_non_tlv() - send acparams cmd to fw
  3716. * @wmi_handle: wmi handle
  3717. * @param: pointer to hold acparams
  3718. *
  3719. * Return: 0 for success or error code
  3720. */
  3721. static QDF_STATUS
  3722. send_set_acparams_cmd_non_tlv(wmi_unified_t wmi_handle,
  3723. struct acparams_params *param)
  3724. {
  3725. wmi_pdev_set_param_cmd *cmd;
  3726. wmi_buf_t buf;
  3727. uint32_t param_value = 0;
  3728. int len = sizeof(wmi_pdev_set_param_cmd);
  3729. buf = wmi_buf_alloc(wmi_handle, len);
  3730. if (!buf) {
  3731. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3732. return QDF_STATUS_E_NOMEM;
  3733. }
  3734. cmd = (wmi_pdev_set_param_cmd *)wmi_buf_data(buf);
  3735. cmd->param_id = WMI_PDEV_PARAM_AC_AGGRSIZE_SCALING;
  3736. param_value = param->ac;
  3737. param_value |= (param->aggrsize_scaling << 8);
  3738. cmd->param_value = param_value;
  3739. wmi_unified_cmd_send(wmi_handle, buf, len, WMI_PDEV_SET_PARAM_CMDID);
  3740. return QDF_STATUS_SUCCESS;
  3741. }
  3742. /**
  3743. * send_set_vap_dscp_tid_map_cmd_non_tlv() - send vap dscp tid map cmd to fw
  3744. * @wmi_handle: wmi handle
  3745. * @param: pointer to hold vap dscp tid map param
  3746. *
  3747. * Return: 0 for success or error code
  3748. */
  3749. static QDF_STATUS
  3750. send_set_vap_dscp_tid_map_cmd_non_tlv(wmi_unified_t wmi_handle,
  3751. struct vap_dscp_tid_map_params *param)
  3752. {
  3753. wmi_buf_t buf;
  3754. wmi_vdev_set_dscp_tid_map_cmd *cmd_vdev;
  3755. int len_vdev = sizeof(wmi_vdev_set_dscp_tid_map_cmd);
  3756. buf = wmi_buf_alloc(wmi_handle, len_vdev);
  3757. if (!buf) {
  3758. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3759. return QDF_STATUS_E_FAILURE;
  3760. }
  3761. cmd_vdev = (wmi_vdev_set_dscp_tid_map_cmd *)wmi_buf_data(buf);
  3762. qdf_mem_copy(cmd_vdev->dscp_to_tid_map, param->dscp_to_tid_map,
  3763. sizeof(A_UINT32) * WMI_DSCP_MAP_MAX);
  3764. cmd_vdev->vdev_id = param->vdev_id;
  3765. qdf_print("Setting dscp for vap id: %d\n", cmd_vdev->vdev_id);
  3766. return wmi_unified_cmd_send(wmi_handle, buf, len_vdev,
  3767. WMI_VDEV_SET_DSCP_TID_MAP_CMDID);
  3768. }
  3769. /**
  3770. * send_proxy_ast_reserve_cmd_non_tlv() - send proxy ast reserve cmd to fw
  3771. * @wmi_handle: wmi handle
  3772. * @param: pointer to hold proxy ast reserve param
  3773. *
  3774. * Return: 0 for success or error code
  3775. */
  3776. static QDF_STATUS
  3777. send_proxy_ast_reserve_cmd_non_tlv(wmi_unified_t wmi_handle,
  3778. struct proxy_ast_reserve_params *param)
  3779. {
  3780. wmi_pdev_reserve_ast_entry_cmd *cmd;
  3781. wmi_buf_t buf;
  3782. int len = sizeof(wmi_pdev_reserve_ast_entry_cmd);
  3783. buf = wmi_buf_alloc(wmi_handle, len);
  3784. if (!buf) {
  3785. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3786. return QDF_STATUS_E_FAILURE;
  3787. }
  3788. cmd = (wmi_pdev_reserve_ast_entry_cmd *)wmi_buf_data(buf);
  3789. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->macaddr, &cmd->mac_addr);
  3790. cmd->key_id = 0;
  3791. cmd->mcast = 0;
  3792. qdf_print("%s macaddr=%s key_id=%d mcast=%d\n", __func__,
  3793. ether_sprintf(param->macaddr), cmd->key_id, cmd->mcast);
  3794. return wmi_unified_cmd_send(wmi_handle, buf, len,
  3795. WMI_PDEV_RESERVE_AST_ENTRY_CMDID);
  3796. }
  3797. /**
  3798. * send_pdev_fips_cmd_non_tlv() - send pdev fips cmd to fw
  3799. * @wmi_handle: wmi handle
  3800. * @param: pointer to hold pdev fips param
  3801. *
  3802. * Return: 0 for success or error code
  3803. */
  3804. static QDF_STATUS
  3805. send_pdev_fips_cmd_non_tlv(wmi_unified_t wmi_handle,
  3806. struct fips_params *param)
  3807. {
  3808. wmi_pdev_fips_cmd *cmd;
  3809. wmi_buf_t buf;
  3810. int len = sizeof(wmi_pdev_fips_cmd) + param->data_len;
  3811. int retval = 0;
  3812. /* Data length must be multiples of 16 bytes - checked against 0xF -
  3813. * and must be less than WMI_SVC_MSG_SIZE - static size of
  3814. * wmi_pdev_fips_cmd structure
  3815. */
  3816. /* do sanity on the input */
  3817. if (!(((param->data_len & 0xF) == 0) &&
  3818. ((param->data_len > 0) &&
  3819. (param->data_len < (WMI_HOST_MAX_BUFFER_SIZE -
  3820. sizeof(wmi_pdev_fips_cmd)))))) {
  3821. return QDF_STATUS_E_INVAL;
  3822. }
  3823. buf = wmi_buf_alloc(wmi_handle, len);
  3824. if (!buf) {
  3825. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3826. return QDF_STATUS_E_FAILURE;
  3827. }
  3828. cmd = (wmi_pdev_fips_cmd *)wmi_buf_data(buf);
  3829. if (param->key != NULL && param->data != NULL) {
  3830. cmd->key_len = param->key_len;
  3831. cmd->data_len = param->data_len;
  3832. cmd->fips_cmd = !!(param->op);
  3833. #ifdef BIG_ENDIAN_HOST
  3834. {
  3835. /****************BE to LE conversion*****************/
  3836. /* Assigning unaligned space to copy the key */
  3837. unsigned char *key_unaligned = qdf_mem_malloc(
  3838. sizeof(u_int8_t)*param->key_len + FIPS_ALIGN);
  3839. u_int8_t *key_aligned = NULL;
  3840. unsigned char *data_unaligned = qdf_mem_malloc(
  3841. sizeof(u_int8_t)*param->data_len + FIPS_ALIGN);
  3842. u_int8_t *data_aligned = NULL;
  3843. int c;
  3844. /* Checking if kmalloc is succesful to allocate space */
  3845. if (key_unaligned == NULL)
  3846. return QDF_STATUS_SUCCESS;
  3847. /* Checking if space is aligned */
  3848. if (!FIPS_IS_ALIGNED(key_unaligned, FIPS_ALIGN)) {
  3849. /* align to 4 */
  3850. key_aligned =
  3851. (u_int8_t *)FIPS_ALIGNTO(key_unaligned,
  3852. FIPS_ALIGN);
  3853. } else {
  3854. key_aligned = (u_int8_t *)key_unaligned;
  3855. }
  3856. /* memset and copy content from key to key aligned */
  3857. OS_MEMSET(key_aligned, 0, param->key_len);
  3858. OS_MEMCPY(key_aligned, param->key, param->key_len);
  3859. /* print a hexdump for host debug */
  3860. print_hex_dump(KERN_DEBUG,
  3861. "\t Aligned and Copied Key:@@@@ ",
  3862. DUMP_PREFIX_NONE,
  3863. 16, 1, key_aligned, param->key_len, true);
  3864. /* Checking if kmalloc is succesful to allocate space */
  3865. if (data_unaligned == NULL)
  3866. return QDF_STATUS_SUCCESS;
  3867. /* Checking of space is aligned */
  3868. if (!FIPS_IS_ALIGNED(data_unaligned, FIPS_ALIGN)) {
  3869. /* align to 4 */
  3870. data_aligned =
  3871. (u_int8_t *)FIPS_ALIGNTO(data_unaligned,
  3872. FIPS_ALIGN);
  3873. } else {
  3874. data_aligned = (u_int8_t *)data_unaligned;
  3875. }
  3876. /* memset and copy content from data to data aligned */
  3877. OS_MEMSET(data_aligned, 0, param->data_len);
  3878. OS_MEMCPY(data_aligned, param->data, param->data_len);
  3879. /* print a hexdump for host debug */
  3880. print_hex_dump(KERN_DEBUG,
  3881. "\t Properly Aligned and Copied Data:@@@@ ",
  3882. DUMP_PREFIX_NONE,
  3883. 16, 1, data_aligned, param->data_len, true);
  3884. /* converting to little Endian both key_aligned and
  3885. * data_aligned*/
  3886. for (c = 0; c < param->key_len/4; c++) {
  3887. *((u_int32_t *)key_aligned+c) =
  3888. qdf_cpu_to_le32(*((u_int32_t *)key_aligned+c));
  3889. }
  3890. for (c = 0; c < param->data_len/4; c++) {
  3891. *((u_int32_t *)data_aligned+c) =
  3892. qdf_cpu_to_le32(*((u_int32_t *)data_aligned+c));
  3893. }
  3894. /* update endian data to key and data vectors */
  3895. OS_MEMCPY(param->key, key_aligned, param->key_len);
  3896. OS_MEMCPY(param->data, data_aligned, param->data_len);
  3897. /* clean up allocated spaces */
  3898. qdf_mem_free(key_unaligned);
  3899. key_unaligned = NULL;
  3900. key_aligned = NULL;
  3901. qdf_mem_free(data_unaligned);
  3902. data_unaligned = NULL;
  3903. data_aligned = NULL;
  3904. /*****************************************************/
  3905. }
  3906. #endif
  3907. qdf_mem_copy(cmd->key, param->key, param->key_len);
  3908. qdf_mem_copy(cmd->data, param->data, param->data_len);
  3909. if (param->mode == FIPS_ENGINE_AES_CTR ||
  3910. param->mode == FIPS_ENGINE_AES_MIC) {
  3911. cmd->mode = param->mode;
  3912. } else {
  3913. cmd->mode = FIPS_ENGINE_AES_CTR;
  3914. }
  3915. qdf_print(KERN_ERR "Key len = %d, Data len = %d\n",
  3916. cmd->key_len, cmd->data_len);
  3917. print_hex_dump(KERN_DEBUG, "Key: ", DUMP_PREFIX_NONE, 16, 1,
  3918. cmd->key, cmd->key_len, true);
  3919. print_hex_dump(KERN_DEBUG, "Plain text: ", DUMP_PREFIX_NONE,
  3920. 16, 1, cmd->data, cmd->data_len, true);
  3921. retval = wmi_unified_cmd_send(wmi_handle, buf, len,
  3922. WMI_PDEV_FIPS_CMDID);
  3923. qdf_print("%s return value %d\n", __func__, retval);
  3924. } else {
  3925. qdf_print("\n%s:%d Key or Data is NULL\n", __func__, __LINE__);
  3926. retval = -EFAULT;
  3927. }
  3928. return retval;
  3929. }
  3930. /**
  3931. * send_pdev_set_chan_cmd_non_tlv() - send pdev set chan cmd to fw
  3932. * @wmi_handle: wmi handle
  3933. * @param: pointer to hold set chan param
  3934. *
  3935. * Return: 0 for success or error code
  3936. */
  3937. static QDF_STATUS
  3938. send_pdev_set_chan_cmd_non_tlv(wmi_unified_t wmi_handle,
  3939. struct channel_param *param)
  3940. {
  3941. wmi_set_channel_cmd *cmd;
  3942. wmi_buf_t buf;
  3943. int len = sizeof(wmi_set_channel_cmd);
  3944. buf = wmi_buf_alloc(wmi_handle, len);
  3945. if (!buf) {
  3946. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  3947. return QDF_STATUS_E_FAILURE;
  3948. }
  3949. cmd = (wmi_set_channel_cmd *)wmi_buf_data(buf);
  3950. cmd->chan.mhz = param->mhz;
  3951. WMI_SET_CHANNEL_MODE(&cmd->chan, param->phy_mode);
  3952. cmd->chan.band_center_freq1 = param->cfreq1;
  3953. cmd->chan.band_center_freq2 = param->cfreq2;
  3954. WMI_SET_CHANNEL_MIN_POWER(&cmd->chan, param->minpower);
  3955. WMI_SET_CHANNEL_MAX_POWER(&cmd->chan, param->maxpower);
  3956. WMI_SET_CHANNEL_REG_POWER(&cmd->chan, param->maxregpower);
  3957. WMI_SET_CHANNEL_ANTENNA_MAX(&cmd->chan, param->antennamax);
  3958. WMI_SET_CHANNEL_REG_CLASSID(&cmd->chan, param->reg_class_id);
  3959. if (param->dfs_set)
  3960. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_DFS);
  3961. if (param->dfs_set_cfreq2)
  3962. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_DFS_CFREQ2);
  3963. if (param->half_rate)
  3964. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_HALF);
  3965. if (param->quarter_rate)
  3966. WMI_SET_CHANNEL_FLAG(&cmd->chan, WMI_CHAN_FLAG_QUARTER);
  3967. if ((param->phy_mode == MODE_11AC_VHT80_80) ||
  3968. (param->phy_mode == MODE_11AC_VHT160)) {
  3969. qdf_print(
  3970. "WMI channel freq=%d, mode=%x band_center_freq1=%d band_center_freq2=%d\n",
  3971. cmd->chan.mhz,
  3972. WMI_GET_CHANNEL_MODE(&cmd->chan), cmd->chan.band_center_freq1,
  3973. cmd->chan.band_center_freq2);
  3974. } else {
  3975. qdf_print("WMI channel freq=%d, mode=%x band_center_freq1=%d\n"
  3976. , cmd->chan.mhz,
  3977. WMI_GET_CHANNEL_MODE(&cmd->chan),
  3978. cmd->chan.band_center_freq1);
  3979. }
  3980. return wmi_unified_cmd_send(wmi_handle, buf, len,
  3981. WMI_PDEV_SET_CHANNEL_CMDID);
  3982. }
  3983. /**
  3984. * send_mcast_group_update_cmd_non_tlv() - send mcast group update cmd to fw
  3985. * @wmi_handle: wmi handle
  3986. * @param: pointer to hold mcast update param
  3987. *
  3988. * Return: 0 for success or error code
  3989. */
  3990. static QDF_STATUS
  3991. send_mcast_group_update_cmd_non_tlv(wmi_unified_t wmi_handle,
  3992. struct mcast_group_update_params *param)
  3993. {
  3994. wmi_peer_mcast_group_cmd *cmd;
  3995. wmi_buf_t buf;
  3996. int len;
  3997. int offset = 0;
  3998. static char dummymask[4] = { 0xFF, 0xFF, 0xFF, 0xFF};
  3999. len = sizeof(wmi_peer_mcast_group_cmd);
  4000. buf = wmi_buf_alloc(wmi_handle, len);
  4001. if (!buf) {
  4002. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  4003. return QDF_STATUS_E_NOMEM;
  4004. }
  4005. cmd = (wmi_peer_mcast_group_cmd *) wmi_buf_data(buf);
  4006. /* confirm the buffer is 4-byte aligned */
  4007. ASSERT((((size_t) cmd) & 0x3) == 0);
  4008. OS_MEMZERO(cmd, sizeof(wmi_peer_mcast_group_cmd));
  4009. cmd->vdev_id = param->vap_id;
  4010. /* construct the message assuming our endianness matches the target */
  4011. cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_ACTION_M &
  4012. (param->action << WMI_PEER_MCAST_GROUP_FLAG_ACTION_S);
  4013. cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_WILDCARD_M &
  4014. (param->wildcard << WMI_PEER_MCAST_GROUP_FLAG_WILDCARD_S);
  4015. if (param->is_action_delete)
  4016. cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_DELETEALL_M;
  4017. if (param->is_mcast_addr_len)
  4018. cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_IPV6_M;
  4019. if (param->is_filter_mode_snoop)
  4020. cmd->flags |= WMI_PEER_MCAST_GROUP_FLAG_SRC_FILTER_EXCLUDE_M;
  4021. /* unicast address spec only applies for non-wildcard cases */
  4022. if (!param->wildcard && param->ucast_mac_addr) {
  4023. qdf_mem_copy(
  4024. &cmd->ucast_mac_addr,
  4025. param->ucast_mac_addr,
  4026. sizeof(cmd->ucast_mac_addr));
  4027. }
  4028. if (param->mcast_ip_addr) {
  4029. ASSERT(param->mcast_ip_addr_bytes <=
  4030. sizeof(cmd->mcast_ip_addr));
  4031. offset = sizeof(cmd->mcast_ip_addr) -
  4032. param->mcast_ip_addr_bytes;
  4033. qdf_mem_copy(((u_int8_t *) &cmd->mcast_ip_addr) + offset,
  4034. param->mcast_ip_addr,
  4035. param->mcast_ip_addr_bytes);
  4036. }
  4037. if (!param->mask)
  4038. param->mask = &dummymask[0];
  4039. qdf_mem_copy(((u_int8_t *) &cmd->mcast_ip_mask) + offset, param->mask,
  4040. param->mcast_ip_addr_bytes);
  4041. if (param->srcs && param->nsrcs) {
  4042. cmd->num_filter_addr = param->nsrcs;
  4043. ASSERT((param->nsrcs * param->mcast_ip_addr_bytes) <=
  4044. sizeof(cmd->srcs));
  4045. qdf_mem_copy(((u_int8_t *) &cmd->filter_addr), param->srcs,
  4046. param->nsrcs * param->mcast_ip_addr_bytes);
  4047. }
  4048. /* now correct for endianness, if necessary */
  4049. /*
  4050. * For Little Endian, N/w Stack gives packets in Network byte order and
  4051. * issue occurs if both Host and Target happens to be in Little Endian.
  4052. * Target when compares IP addresses in packet with MCAST_GROUP_CMDID
  4053. * given IP addresses, it fails. Hence swap only mcast_ip_addr
  4054. * (16 bytes) for now.
  4055. * TODO : filter
  4056. */
  4057. /* TBD in OL Layer
  4058. #ifdef BIG_ENDIAN_HOST
  4059. ol_bytestream_endian_fix(
  4060. (u_int32_t *)&cmd->ucast_mac_addr,
  4061. (sizeof(*cmd)-4) / sizeof(u_int32_t));
  4062. #else
  4063. ol_bytestream_endian_fix(
  4064. (u_int32_t *)&cmd->mcast_ip_addr,
  4065. (sizeof(cmd->mcast_ip_addr)) / sizeof(u_int32_t));
  4066. #endif Little Endian */
  4067. wmi_unified_cmd_send(
  4068. wmi_handle, buf, len, WMI_PEER_MCAST_GROUP_CMDID);
  4069. return QDF_STATUS_SUCCESS;
  4070. }
  4071. /**
  4072. * send_periodic_chan_stats_config_cmd_non_tlv() - send periodic chan stats cmd
  4073. * to fw
  4074. * @wmi_handle: wmi handle
  4075. * @param: pointer to hold periodic chan stats param
  4076. *
  4077. * Return: 0 for success or error code
  4078. */
  4079. static QDF_STATUS
  4080. send_periodic_chan_stats_config_cmd_non_tlv(wmi_unified_t wmi_handle,
  4081. struct periodic_chan_stats_params *param)
  4082. {
  4083. wmi_buf_t buf = NULL;
  4084. wmi_set_periodic_channel_stats_config *cmd = NULL;
  4085. QDF_STATUS error = 0;
  4086. int32_t len = 0;
  4087. len = sizeof(wmi_set_periodic_channel_stats_config);
  4088. buf = wmi_buf_alloc(wmi_handle, len);
  4089. if (!buf) {
  4090. qdf_print("%s: Unable to allocate merory\n", __func__);
  4091. return QDF_STATUS_E_NOMEM;
  4092. }
  4093. cmd = (wmi_set_periodic_channel_stats_config *) wmi_buf_data(buf);
  4094. cmd->enable = param->enable;
  4095. cmd->stats_period = param->stats_period;
  4096. error = wmi_unified_cmd_send(wmi_handle, buf, len,
  4097. WMI_SET_PERIODIC_CHANNEL_STATS_CONFIG);
  4098. if (error)
  4099. qdf_print(" %s :WMI Failed\n", __func__);
  4100. return error;
  4101. }
  4102. /**
  4103. * send_nf_dbr_dbm_info_get_cmd_non_tlv() - send request to get nf to fw
  4104. * @wmi_handle: wmi handle
  4105. * @mac_id: radio context
  4106. *
  4107. * Return: 0 for success or error code
  4108. */
  4109. static QDF_STATUS
  4110. send_nf_dbr_dbm_info_get_cmd_non_tlv(wmi_unified_t wmi_handle, uint8_t mac_id)
  4111. {
  4112. wmi_buf_t wmibuf;
  4113. wmibuf = wmi_buf_alloc(wmi_handle, 0);
  4114. if (wmibuf == NULL)
  4115. return QDF_STATUS_E_NOMEM;
  4116. return wmi_unified_cmd_send(wmi_handle, wmibuf, 0,
  4117. WMI_PDEV_GET_NFCAL_POWER_CMDID);
  4118. }
  4119. /**
  4120. * enum packet_power_non_tlv_flags: Target defined
  4121. * packet power rate flags
  4122. * @WMI_NON_TLV_FLAG_ONE_CHAIN: one chain
  4123. * @WMI_NON_TLV_FLAG_TWO_CHAIN: two chain
  4124. * @WMI_NON_TLV_FLAG_THREE_CHAIN: three chain
  4125. * @WMI_NON_TLV_FLAG_FOUR_CHAIN: four chain
  4126. * @WMI_NON_TLV_FLAG_STBC: STBC is set
  4127. * @WMI_NON_TLV_FLAG_40MHZ: 40MHz channel width
  4128. * @WMI_NON_TLV_FLAG_80MHZ: 80MHz channel width
  4129. * @WMI_NON_TLV_FLAG_1600MHZ: 1600MHz channel width
  4130. * @WMI_NON_TLV_FLAG_TXBF: Tx Bf enabled
  4131. * @WMI_NON_TLV_FLAG_RTSENA: RTS enabled
  4132. * @WMI_NON_TLV_FLAG_CTSENA: CTS enabled
  4133. * @WMI_NON_TLV_FLAG_LDPC: LDPC is set
  4134. * @WMI_NON_TLV_FLAG_SERIES1: Rate series 1
  4135. * @WMI_NON_TLV_FLAG_SGI: Short gaurd interval
  4136. * @WMI_NON_TLV_FLAG_MU2: MU2 data
  4137. * @WMI_NON_TLV_FLAG_MU3: MU3 data
  4138. */
  4139. enum packet_power_non_tlv_flags {
  4140. WMI_NON_TLV_FLAG_ONE_CHAIN = 0x0001,
  4141. WMI_NON_TLV_FLAG_TWO_CHAIN = 0x0005,
  4142. WMI_NON_TLV_FLAG_THREE_CHAIN = 0x0007,
  4143. WMI_NON_TLV_FLAG_FOUR_CHAIN = 0x000F,
  4144. WMI_NON_TLV_FLAG_STBC = 0x0010,
  4145. WMI_NON_TLV_FLAG_40MHZ = 0x0020,
  4146. WMI_NON_TLV_FLAG_80MHZ = 0x0040,
  4147. WMI_NON_TLV_FLAG_160MHZ = 0x0080,
  4148. WMI_NON_TLV_FLAG_TXBF = 0x0100,
  4149. WMI_NON_TLV_FLAG_RTSENA = 0x0200,
  4150. WMI_NON_TLV_FLAG_CTSENA = 0x0400,
  4151. WMI_NON_TLV_FLAG_LDPC = 0x0800,
  4152. WMI_NON_TLV_FLAG_SERIES1 = 0x1000,
  4153. WMI_NON_TLV_FLAG_SGI = 0x2000,
  4154. WMI_NON_TLV_FLAG_MU2 = 0x4000,
  4155. WMI_NON_TLV_FLAG_MU3 = 0x8000,
  4156. };
  4157. /**
  4158. * convert_to_power_info_rate_flags() - convert packet_power_info_params
  4159. * to FW understandable format
  4160. * @param: pointer to hold packet power info param
  4161. *
  4162. * @return FW understandable 16 bit rate flags
  4163. */
  4164. static uint16_t
  4165. convert_to_power_info_rate_flags(struct packet_power_info_params *param)
  4166. {
  4167. uint16_t rateflags = 0;
  4168. if (param->chainmask)
  4169. rateflags |= (param->chainmask & 0xf);
  4170. if (param->chan_width == WMI_HOST_CHAN_WIDTH_40)
  4171. rateflags |= WMI_NON_TLV_FLAG_40MHZ;
  4172. if (param->chan_width == WMI_HOST_CHAN_WIDTH_80)
  4173. rateflags |= WMI_NON_TLV_FLAG_80MHZ;
  4174. if (param->chan_width == WMI_HOST_CHAN_WIDTH_160)
  4175. rateflags |= WMI_NON_TLV_FLAG_160MHZ;
  4176. if (param->rate_flags & WMI_HOST_FLAG_STBC)
  4177. rateflags |= WMI_NON_TLV_FLAG_STBC;
  4178. if (param->rate_flags & WMI_HOST_FLAG_LDPC)
  4179. rateflags |= WMI_NON_TLV_FLAG_LDPC;
  4180. if (param->rate_flags & WMI_HOST_FLAG_TXBF)
  4181. rateflags |= WMI_NON_TLV_FLAG_TXBF;
  4182. if (param->rate_flags & WMI_HOST_FLAG_RTSENA)
  4183. rateflags |= WMI_NON_TLV_FLAG_RTSENA;
  4184. if (param->rate_flags & WMI_HOST_FLAG_CTSENA)
  4185. rateflags |= WMI_NON_TLV_FLAG_CTSENA;
  4186. if (param->rate_flags & WMI_HOST_FLAG_SGI)
  4187. rateflags |= WMI_NON_TLV_FLAG_SGI;
  4188. if (param->rate_flags & WMI_HOST_FLAG_SERIES1)
  4189. rateflags |= WMI_NON_TLV_FLAG_SERIES1;
  4190. if (param->rate_flags & WMI_HOST_FLAG_MU2)
  4191. rateflags |= WMI_NON_TLV_FLAG_MU2;
  4192. if (param->rate_flags & WMI_HOST_FLAG_MU3)
  4193. rateflags |= WMI_NON_TLV_FLAG_MU3;
  4194. return rateflags;
  4195. }
  4196. /**
  4197. * send_packet_power_info_get_cmd_non_tlv() - send request to get packet power
  4198. * info to fw
  4199. * @wmi_handle: wmi handle
  4200. * @param: pointer to hold packet power info param
  4201. *
  4202. * Return: 0 for success or error code
  4203. */
  4204. static QDF_STATUS
  4205. send_packet_power_info_get_cmd_non_tlv(wmi_unified_t wmi_handle,
  4206. struct packet_power_info_params *param)
  4207. {
  4208. wmi_pdev_get_tpc_cmd *cmd;
  4209. wmi_buf_t wmibuf;
  4210. u_int32_t len = sizeof(wmi_pdev_get_tpc_cmd);
  4211. wmibuf = wmi_buf_alloc(wmi_handle, len);
  4212. if (wmibuf == NULL)
  4213. return QDF_STATUS_E_NOMEM;
  4214. cmd = (wmi_pdev_get_tpc_cmd *)wmi_buf_data(wmibuf);
  4215. cmd->rate_flags = convert_to_power_info_rate_flags(param);
  4216. cmd->nss = param->nss;
  4217. cmd->preamble = param->preamble;
  4218. cmd->hw_rate = param->hw_rate;
  4219. cmd->rsvd = 0x0;
  4220. WMI_LOGD("%s[%d] commandID %d, wmi_pdev_get_tpc_cmd=0x%x,"
  4221. "rate_flags: 0x%x, nss: %d, preamble: %d, hw_rate: %d\n",
  4222. __func__, __LINE__, WMI_PDEV_GET_TPC_CMDID, *((u_int32_t *)cmd),
  4223. cmd->rate_flags, cmd->nss, cmd->preamble, cmd->hw_rate);
  4224. return wmi_unified_cmd_send(wmi_handle, wmibuf, len,
  4225. WMI_PDEV_GET_TPC_CMDID);
  4226. }
  4227. /**
  4228. * send_gpio_config_cmd_non_tlv() - send gpio config to fw
  4229. * @wmi_handle: wmi handle
  4230. * @param: pointer to hold gpio config param
  4231. *
  4232. * Return: 0 for success or error code
  4233. */
  4234. static QDF_STATUS
  4235. send_gpio_config_cmd_non_tlv(wmi_unified_t wmi_handle,
  4236. struct gpio_config_params *param)
  4237. {
  4238. wmi_gpio_config_cmd *cmd;
  4239. wmi_buf_t wmibuf;
  4240. u_int32_t len = sizeof(wmi_gpio_config_cmd);
  4241. /* Sanity Checks */
  4242. if (param->pull_type > WMI_GPIO_PULL_DOWN ||
  4243. param->intr_mode > WMI_GPIO_INTTYPE_LEVEL_HIGH) {
  4244. return QDF_STATUS_E_FAILURE;
  4245. }
  4246. wmibuf = wmi_buf_alloc(wmi_handle, len);
  4247. if (wmibuf == NULL)
  4248. return QDF_STATUS_E_FAILURE;
  4249. cmd = (wmi_gpio_config_cmd *)wmi_buf_data(wmibuf);
  4250. cmd->gpio_num = param->gpio_num;
  4251. cmd->input = param->input;
  4252. cmd->pull_type = param->pull_type;
  4253. cmd->intr_mode = param->intr_mode;
  4254. return wmi_unified_cmd_send(wmi_handle, wmibuf, len,
  4255. WMI_GPIO_CONFIG_CMDID);
  4256. }
  4257. /**
  4258. * send_gpio_output_cmd_non_tlv() - send gpio output to fw
  4259. * @wmi_handle: wmi handle
  4260. * @param: pointer to hold gpio output param
  4261. *
  4262. * Return: 0 for success or error code
  4263. */
  4264. static QDF_STATUS
  4265. send_gpio_output_cmd_non_tlv(wmi_unified_t wmi_handle,
  4266. struct gpio_output_params *param)
  4267. {
  4268. wmi_gpio_output_cmd *cmd;
  4269. wmi_buf_t wmibuf;
  4270. u_int32_t len = sizeof(wmi_gpio_output_cmd);
  4271. wmibuf = wmi_buf_alloc(wmi_handle, len);
  4272. if (wmibuf == NULL)
  4273. return QDF_STATUS_E_FAILURE;
  4274. cmd = (wmi_gpio_output_cmd *)wmi_buf_data(wmibuf);
  4275. cmd->gpio_num = param->gpio_num;
  4276. cmd->set = param->set;
  4277. return wmi_unified_cmd_send(wmi_handle, wmibuf, len,
  4278. WMI_GPIO_OUTPUT_CMDID);
  4279. }
  4280. /*
  4281. * send_rtt_meas_req_test_cmd_non_tlv() - send rtt meas req test cmd to fw
  4282. * @wmi_handle: wmi handle
  4283. * @param: pointer to hold rtt meas req test param
  4284. *
  4285. * Return: 0 for success or error code
  4286. */
  4287. static QDF_STATUS
  4288. send_rtt_meas_req_test_cmd_non_tlv(wmi_unified_t wmi_handle,
  4289. struct rtt_meas_req_test_params *param)
  4290. {
  4291. wmi_buf_t buf;
  4292. u_int8_t *p;
  4293. int ret;
  4294. u_int16_t len;
  4295. wmi_rtt_measreq_head *head;
  4296. wmi_rtt_measreq_body *body;
  4297. wmi_channel *w_chan;
  4298. qdf_print("%s: The request ID is: %d\n", __func__, param->req_id);
  4299. len = sizeof(wmi_rtt_measreq_head) + param->req_num_req *
  4300. sizeof(wmi_rtt_measreq_body);
  4301. buf = wmi_buf_alloc(wmi_handle, len);
  4302. if (!buf) {
  4303. qdf_print("No WMI resource!");
  4304. return QDF_STATUS_E_NOMEM;
  4305. }
  4306. p = (u_int8_t *) wmi_buf_data(buf);
  4307. qdf_mem_set(p, len, 0);
  4308. head = (wmi_rtt_measreq_head *) p;
  4309. WMI_RTT_REQ_ID_SET(head->req_id, param->req_id);
  4310. WMI_RTT_SPS_SET(head->req_id, 1);
  4311. WMI_RTT_NUM_STA_SET(head->sta_num, param->req_num_req);
  4312. body = &(head->body[0]);
  4313. WMI_RTT_VDEV_ID_SET(body->measure_info, 0);
  4314. WMI_RTT_TIMEOUT_SET(body->measure_info, 100);
  4315. WMI_RTT_REPORT_TYPE_SET(body->measure_info, param->req_report_type);
  4316. WMI_RTT_FRAME_TYPE_SET(body->control_flag, param->req_frame_type);
  4317. WMI_RTT_TX_CHAIN_SET(body->control_flag, 001);
  4318. WMI_RTT_QCA_PEER_SET(body->control_flag, 1);
  4319. if (param->req_preamble == WMI_RTT_PREAM_LEGACY)
  4320. WMI_RTT_MCS_SET(body->control_flag, 3);
  4321. else
  4322. WMI_RTT_MCS_SET(body->control_flag, 0);
  4323. WMI_RTT_RETRIES_SET(body->control_flag, 1);
  4324. /*
  4325. qdf_mem_copy(peer, param->mac_addr, 6);
  4326. qdf_print("The mac_addr is"
  4327. " %.2x:%.2x:%.2x:%.2x:%.2x:%.2x extra=%d\n",
  4328. peer[0], peer[1], peer[2],
  4329. peer[3], peer[4], peer[5], param->extra);
  4330. */
  4331. /* start from here, embed the first req in each RTT measurement
  4332. * Command */
  4333. /*peer[5] = 0x12;
  4334. peer[4] = 0x90;
  4335. peer[3] = 0x78;
  4336. peer[2] = 0x56;
  4337. peer[1] = 0x34;
  4338. peer[0] = 0x12;
  4339. >---*/
  4340. head->channel.mhz = param->channel.mhz;
  4341. head->channel.band_center_freq1 = param->channel.cfreq1;
  4342. head->channel.band_center_freq2 = param->channel.cfreq2;
  4343. w_chan = (wmi_channel *)&head->channel;
  4344. WMI_SET_CHANNEL_MODE(w_chan, param->channel.phy_mode);
  4345. WMI_SET_CHANNEL_MIN_POWER(w_chan, param->channel.minpower);
  4346. WMI_SET_CHANNEL_MAX_POWER(w_chan, param->channel.maxpower);
  4347. WMI_SET_CHANNEL_REG_POWER(w_chan, param->channel.maxregpower);
  4348. WMI_SET_CHANNEL_ANTENNA_MAX(w_chan, param->channel.antennamax);
  4349. WMI_SET_CHANNEL_REG_CLASSID(w_chan, param->channel.reg_class_id);
  4350. WMI_CHAR_ARRAY_TO_MAC_ADDR(((u_int8_t *)param->peer), &body->dest_mac);
  4351. WMI_CHAR_ARRAY_TO_MAC_ADDR(((u_int8_t *)param->peer),
  4352. &body->spoof_bssid);
  4353. WMI_RTT_BW_SET(body->control_flag, param->req_bw);
  4354. WMI_RTT_PREAMBLE_SET(body->control_flag, param->req_preamble);
  4355. WMI_RTT_MEAS_NUM_SET(body->measure_info, param->num_measurements);
  4356. body->measure_params_1 = 0;
  4357. body->measure_params_2 = 0;
  4358. WMI_RTT_ASAP_MODE_SET(body->measure_params_1, param->asap_mode);
  4359. WMI_RTT_LCI_REQ_SET(body->measure_params_1, param->lci_requested);
  4360. WMI_RTT_LOC_CIV_REQ_SET(body->measure_params_1,
  4361. param->loc_civ_requested);
  4362. WMI_RTT_NUM_BURST_EXP_SET(body->measure_params_1, 0);
  4363. WMI_RTT_BURST_DUR_SET(body->measure_params_1, 15);
  4364. WMI_RTT_BURST_PERIOD_SET(body->measure_params_1, 0);
  4365. WMI_RTT_TSF_DELTA_VALID_SET(body->measure_params_1, 1);
  4366. WMI_RTT_TSF_DELTA_SET(body->measure_params_2, 0);
  4367. /** other requests are same with first request */
  4368. p = (u_int8_t *) body;
  4369. while (--param->req_num_req) {
  4370. body++;
  4371. qdf_mem_copy(body, p, sizeof(wmi_rtt_measreq_body));
  4372. }
  4373. ret = wmi_unified_cmd_send(wmi_handle, buf, len, WMI_RTT_MEASREQ_CMDID);
  4374. qdf_print("send rtt cmd to FW with length %d and return %d\n",
  4375. len, ret);
  4376. return QDF_STATUS_SUCCESS;
  4377. }
  4378. /**
  4379. * send_rtt_meas_req_cmd_non_tlv() - send rtt meas req cmd to fw
  4380. * @wmi_handle: wmi handle
  4381. * @param: pointer to hold rtt meas req param
  4382. *
  4383. * Return: 0 for success or error code
  4384. */
  4385. static QDF_STATUS
  4386. send_rtt_meas_req_cmd_non_tlv(wmi_unified_t wmi_handle,
  4387. struct rtt_meas_req_params *param)
  4388. {
  4389. wmi_buf_t buf;
  4390. uint8_t *p;
  4391. int ret;
  4392. uint16_t len;
  4393. uint8_t peer[6];
  4394. uint8_t spoof[6];
  4395. wmi_rtt_measreq_head *head;
  4396. wmi_rtt_measreq_body *body;
  4397. int req_frame_type, req_preamble;
  4398. wmi_channel *w_chan;
  4399. /* Temporarily, hardcoding peer mac address for test purpose will be
  4400. * removed once RTT host has been developed for even req_id, like
  4401. * 0, 2, 4, there is no channel_swicth for odd req_id, like 1, 3 , 5,
  4402. * there is channel switch currently, for both cases, we have 3 req in
  4403. * each command please change here if you only have one (or just let
  4404. * it be). Even == HC, odd == OC.
  4405. */
  4406. if (!(param->req_id & 0x1)) {
  4407. len = sizeof(wmi_rtt_measreq_head);
  4408. /* + 2 * sizeof(wmi_rtt_measreq_body);*/
  4409. } else {
  4410. len = sizeof(wmi_rtt_measreq_head);
  4411. /* + 2 * sizeof(wmi_rtt_measreq_body);*/
  4412. }
  4413. buf = wmi_buf_alloc(wmi_handle, len);
  4414. if (!buf) {
  4415. qdf_print("No WMI resource!");
  4416. return QDF_STATUS_E_FAILURE;
  4417. }
  4418. p = (uint8_t *) wmi_buf_data(buf);
  4419. qdf_mem_set(p, len, 0);
  4420. /* encode header */
  4421. head = (wmi_rtt_measreq_head *) p;
  4422. /* head->req_id = req_id;*/
  4423. WMI_RTT_REQ_ID_SET(head->req_id, param->req_id);
  4424. /* WMI_RTT_SPS_SET(head->req_id, 1);*/
  4425. if (!(param->req_id & 0x1)) { /*even req id */
  4426. #ifndef RTT_TEST
  4427. /* we actually only have 3 sta to measure
  4428. this is used to test over limit request protection
  4429. XIN:WMI_RTT_NUM_STA_SET(head->sta_num, 5);*/
  4430. #else
  4431. /* XIN:WMI_RTT_NUM_STA_SET(head->sta_num, 2);*/
  4432. WMI_RTT_NUM_STA_SET(head->sta_num, 1);
  4433. #endif
  4434. WMI_RTT_NUM_STA_SET(head->sta_num, 1);
  4435. } else { /* odd req id */
  4436. /* XIN:WMI_RTT_NUM_STA_SET(head->sta_num, 3); */
  4437. WMI_RTT_NUM_STA_SET(head->sta_num, 1);
  4438. }
  4439. req_frame_type = RTT_MEAS_FRAME_NULL;
  4440. /* MS(extra, RTT_REQ_FRAME_TYPE);*/
  4441. /* req_bw = //MS(extra, RTT_REQ_BW);*/
  4442. req_preamble = WMI_RTT_PREAM_LEGACY;/*MS(extra, RTT_REQ_PREAMBLE);*/
  4443. /*encode common parts for each RTT measurement command body
  4444. The value here can be overwrite in following each req hardcoding */
  4445. body = &(head->body[0]);
  4446. WMI_RTT_VDEV_ID_SET(body->measure_info, param->vdev_id);
  4447. WMI_RTT_TIMEOUT_SET(body->measure_info, RTT_TIMEOUT_MS);
  4448. WMI_RTT_REPORT_TYPE_SET(body->measure_info, 1);
  4449. WMI_RTT_FRAME_TYPE_SET(body->control_flag, req_frame_type);
  4450. WMI_RTT_TX_CHAIN_SET(body->control_flag, 001);
  4451. WMI_RTT_QCA_PEER_SET(body->control_flag, 1);
  4452. if (req_preamble == WMI_RTT_PREAM_LEGACY)
  4453. WMI_RTT_MCS_SET(body->control_flag, 3);
  4454. else
  4455. WMI_RTT_MCS_SET(body->control_flag, 0);
  4456. WMI_RTT_RETRIES_SET(body->control_flag, 1);
  4457. if (!(param->req_id & 0x1)) { /* even time */
  4458. qdf_mem_copy(peer, param->sta_mac_addr, 6);
  4459. } else { /* odd time */
  4460. qdf_mem_copy(peer, param->sta_mac_addr, 6);
  4461. }
  4462. head->channel.mhz = param->channel.mhz;
  4463. head->channel.band_center_freq1 = param->channel.cfreq1;
  4464. head->channel.band_center_freq2 = param->channel.cfreq2;
  4465. w_chan = (wmi_channel *)&head->channel;
  4466. WMI_SET_CHANNEL_MAX_POWER(w_chan, param->channel.phy_mode);
  4467. WMI_SET_CHANNEL_MIN_POWER(w_chan, param->channel.minpower);
  4468. WMI_SET_CHANNEL_MAX_POWER(w_chan, param->channel.maxpower);
  4469. WMI_SET_CHANNEL_REG_POWER(w_chan, param->channel.maxregpower);
  4470. WMI_SET_CHANNEL_ANTENNA_MAX(w_chan, param->channel.antennamax);
  4471. WMI_SET_CHANNEL_REG_CLASSID(w_chan, param->channel.reg_class_id);
  4472. if (param->is_mode_na)
  4473. WMI_SET_CHANNEL_MODE(w_chan, MODE_11NG_HT20);
  4474. else if (param->is_mode_ac)
  4475. WMI_SET_CHANNEL_MODE(w_chan, MODE_11NA_HT20);
  4476. if (param->channel.dfs_set)
  4477. WMI_SET_CHANNEL_FLAG(w_chan, WMI_CHAN_FLAG_DFS);
  4478. WMI_CHAR_ARRAY_TO_MAC_ADDR(((uint8_t *)peer), &body->dest_mac);
  4479. qdf_mem_set(spoof, IEEE80211_ADDR_LEN, 0);
  4480. WMI_CHAR_ARRAY_TO_MAC_ADDR(((uint8_t *)param->spoof_mac_addr),
  4481. &body->spoof_bssid);
  4482. /** embedded varing part of each request
  4483. set Preamble, BW, measurement times */
  4484. if (param->is_bw_20)
  4485. WMI_RTT_BW_SET(body->control_flag, WMI_RTT_BW_20);
  4486. else if (param->is_bw_40)
  4487. WMI_RTT_BW_SET(body->control_flag, WMI_RTT_BW_40);
  4488. else if (param->is_bw_80)
  4489. WMI_RTT_BW_SET(body->control_flag, WMI_RTT_BW_80);
  4490. else
  4491. WMI_RTT_BW_SET(body->control_flag, WMI_RTT_BW_20);
  4492. WMI_RTT_PREAMBLE_SET(body->control_flag, req_preamble);
  4493. WMI_RTT_MEAS_NUM_SET(body->measure_info, param->num_probe_rqst);
  4494. ret = wmi_unified_cmd_send(wmi_handle, buf, len, WMI_RTT_MEASREQ_CMDID);
  4495. qdf_print("send rtt cmd to FW with length %d and return %d\n",
  4496. len, ret);
  4497. return ret;
  4498. }
  4499. /**
  4500. * send_rtt_keepalive_req_cmd_non_tlv() - send rtt keepalive req cmd to fw
  4501. * @wmi_handle: wmi handle
  4502. * @param: pointer to hold rtt keepalive req param
  4503. *
  4504. * Return: 0 for success or error code
  4505. */
  4506. static QDF_STATUS
  4507. send_rtt_keepalive_req_cmd_non_tlv(wmi_unified_t wmi_handle,
  4508. struct rtt_keepalive_req_params *param)
  4509. {
  4510. wmi_buf_t buf;
  4511. wmi_rtt_keepalive_cmd *cmd;
  4512. int ret;
  4513. uint16_t len;
  4514. uint8_t *ptr;
  4515. len = sizeof(wmi_rtt_keepalive_cmd);
  4516. buf = wmi_buf_alloc(wmi_handle, len);
  4517. if (!buf) {
  4518. qdf_print("No WMI resource\n");
  4519. return QDF_STATUS_E_FAILURE;
  4520. }
  4521. ptr = (uint8_t *)wmi_buf_data(buf);
  4522. OS_MEMSET(ptr, 0, len);
  4523. cmd = (wmi_rtt_keepalive_cmd *)wmi_buf_data(buf);
  4524. WMI_RTT_REQ_ID_SET(cmd->req_id, param->req_id);
  4525. WMI_RTT_KEEPALIVE_ACTION_SET(cmd->req_id, param->stop);
  4526. WMI_RTT_VDEV_ID_SET(cmd->probe_info, param->vdev_id);
  4527. /* 3ms probe interval by default */
  4528. WMI_RTT_KEEPALIVE_PERIOD_SET(cmd->probe_info, 3);
  4529. /* max retry of 50 by default */
  4530. WMI_RTT_TIMEOUT_SET(cmd->probe_info, 20);
  4531. /* set frame type */
  4532. WMI_RTT_FRAME_TYPE_SET(cmd->control_flag, RTT_MEAS_FRAME_KEEPALIVE);
  4533. WMI_CHAR_ARRAY_TO_MAC_ADDR(param->macaddr, &cmd->sta_mac);
  4534. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  4535. WMI_RTT_KEEPALIVE_CMDID);
  4536. qdf_print("send rtt keepalive cmd to FW with length %d and return %d\n"
  4537. , len, ret);
  4538. param->req_id++;
  4539. return QDF_STATUS_SUCCESS;
  4540. }
  4541. /**
  4542. * send_lci_set_cmd_non_tlv() - send lci cmd to fw
  4543. * @wmi_handle: wmi handle
  4544. * @param: pointer to hold lci param
  4545. *
  4546. * Return: 0 for success or error code
  4547. */
  4548. static QDF_STATUS
  4549. send_lci_set_cmd_non_tlv(wmi_unified_t wmi_handle,
  4550. struct lci_set_params *param)
  4551. {
  4552. wmi_buf_t buf;
  4553. uint8_t *p;
  4554. wmi_oem_measreq_head *head;
  4555. int len;
  4556. int colocated_bss_len = 0;
  4557. wmi_rtt_lci_cfg_head *rtt_req;
  4558. rtt_req = (wmi_rtt_lci_cfg_head *) param->lci_data;
  4559. len = param->msg_len;
  4560. /* colocated_bss[1] contains num of vaps */
  4561. /* Provide colocated bssid subIE only when there are 2 vaps or more */
  4562. if (param->colocated_bss[1] > 1) {
  4563. qdf_print("%s: Adding %d co-located BSSIDs to LCI data\n",
  4564. __func__, param->colocated_bss[1]);
  4565. /* Convert num_vaps to octets:
  4566. 6*Num_of_vap + 1 (Max BSSID Indicator field) */
  4567. param->colocated_bss[1] =
  4568. (param->colocated_bss[1]*IEEE80211_ADDR_LEN)+1;
  4569. colocated_bss_len = param->colocated_bss[1]+2;
  4570. qdf_mem_copy(rtt_req->colocated_bssids_info,
  4571. param->colocated_bss,
  4572. colocated_bss_len);
  4573. rtt_req->co_located_bssid_len = colocated_bss_len;
  4574. qdf_print("%s: co_located_bssid_len: %d\n", __func__,
  4575. param->colocated_bss[1]+2);
  4576. } else {
  4577. qdf_print("No co-located BSSID was added to LCI data\n");
  4578. }
  4579. buf = wmi_buf_alloc(wmi_handle, len);
  4580. if (!buf) {
  4581. qdf_print("No WMI resource!");
  4582. return QDF_STATUS_E_FAILURE;
  4583. }
  4584. p = (uint8_t *) wmi_buf_data(buf);
  4585. qdf_mem_set(p, len, 0);
  4586. head = (wmi_oem_measreq_head *)p;
  4587. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(head, param->lci_data, len);
  4588. if (wmi_unified_cmd_send(wmi_handle, buf, len, WMI_OEM_REQ_CMDID))
  4589. return QDF_STATUS_E_FAILURE;
  4590. /* Save LCI data in host buffer */
  4591. {
  4592. param->latitude_unc = WMI_RTT_LCI_LAT_UNC_GET(
  4593. rtt_req->lci_cfg_param_info);
  4594. param->latitude_0_1 = ((uint32_t)(rtt_req->latitude & 0x3));
  4595. param->latitude_2_33 = (uint32_t)
  4596. (((uint64_t)(rtt_req->latitude)) >> 2);
  4597. param->longitude_unc =
  4598. WMI_RTT_LCI_LON_UNC_GET(rtt_req->lci_cfg_param_info);
  4599. param->longitude_0_1 = ((uint32_t)(rtt_req->longitude & 0x3));
  4600. param->longitude_2_33 =
  4601. (uint32_t)(((uint64_t)(rtt_req->longitude)) >> 2);
  4602. param->altitude_type =
  4603. WMI_RTT_LCI_ALT_TYPE_GET(rtt_req->altitude_info);
  4604. param->altitude_unc_0_3 =
  4605. (WMI_RTT_LCI_ALT_UNC_GET(rtt_req->altitude_info) & 0xF);
  4606. param->altitude_unc_4_5 =
  4607. ((WMI_RTT_LCI_ALT_UNC_GET(rtt_req->altitude_info) >> 4) &
  4608. 0x3);
  4609. param->altitude = (rtt_req->altitude & RTT_LCI_ALTITUDE_MASK);
  4610. param->datum =
  4611. WMI_RTT_LCI_DATUM_GET(rtt_req->lci_cfg_param_info);
  4612. param->reg_loc_agmt =
  4613. WMI_RTT_LCI_REG_LOC_AGMT_GET(rtt_req->lci_cfg_param_info);
  4614. param->reg_loc_dse =
  4615. WMI_RTT_LCI_REG_LOC_DSE_GET(rtt_req->lci_cfg_param_info);
  4616. param->dep_sta =
  4617. WMI_RTT_LCI_DEP_STA_GET(rtt_req->lci_cfg_param_info);
  4618. param->version =
  4619. WMI_RTT_LCI_VERSION_GET(rtt_req->lci_cfg_param_info);
  4620. }
  4621. return QDF_STATUS_SUCCESS;
  4622. }
  4623. /**
  4624. * send_lcr_set_cmd_non_tlv() - send lcr cmd to fw
  4625. * @wmi_handle: wmi handle
  4626. * @param: pointer to hold lcr param
  4627. *
  4628. * Return: 0 for success or error code
  4629. */
  4630. static QDF_STATUS
  4631. send_lcr_set_cmd_non_tlv(wmi_unified_t wmi_handle,
  4632. struct lcr_set_params *param)
  4633. {
  4634. wmi_buf_t buf;
  4635. uint8_t *p;
  4636. wmi_oem_measreq_head *head;
  4637. int len;
  4638. len = param->msg_len;
  4639. buf = wmi_buf_alloc(wmi_handle, len);
  4640. if (!buf) {
  4641. qdf_print("No WMI resource!");
  4642. return QDF_STATUS_E_FAILURE;
  4643. }
  4644. p = (uint8_t *) wmi_buf_data(buf);
  4645. qdf_mem_set(p, len, 0);
  4646. head = (wmi_oem_measreq_head *)p;
  4647. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(head, param->lcr_data, len);
  4648. if (wmi_unified_cmd_send(wmi_handle, buf, len, WMI_OEM_REQ_CMDID))
  4649. return QDF_STATUS_E_FAILURE;
  4650. return QDF_STATUS_SUCCESS;
  4651. }
  4652. /**
  4653. * send_start_oem_data_cmd_non_tlv() - send oem req cmd to fw
  4654. * @wmi_handle: wmi handle
  4655. * @param: pointer to hold oem req param
  4656. */
  4657. static QDF_STATUS
  4658. send_start_oem_data_cmd_non_tlv(wmi_unified_t wmi_handle,
  4659. uint32_t data_len,
  4660. uint8_t *data)
  4661. {
  4662. wmi_buf_t buf;
  4663. uint8_t *p;
  4664. wmi_oem_measreq_head *head;
  4665. buf = wmi_buf_alloc(wmi_handle, data_len);
  4666. if (!buf) {
  4667. qdf_print("%s: No WMI resource!\n", __func__);
  4668. return QDF_STATUS_E_FAILURE;
  4669. }
  4670. p = (uint8_t *) wmi_buf_data(buf);
  4671. qdf_mem_set(p, data_len, 0);
  4672. head = (wmi_oem_measreq_head *)p;
  4673. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(head, data, data_len);
  4674. if (wmi_unified_cmd_send(wmi_handle, buf,
  4675. data_len, WMI_OEM_REQ_CMDID)) {
  4676. qdf_print("%s: ERROR: Host unable to send LOWI request to FW\n",
  4677. __func__);
  4678. wmi_buf_free(buf);
  4679. return QDF_STATUS_E_FAILURE;
  4680. }
  4681. return QDF_STATUS_SUCCESS;
  4682. }
  4683. /**
  4684. * send_get_user_position_cmd_non_tlv() - send cmd get user position from fw
  4685. * @wmi_handle: wmi handle
  4686. * @value: user pos value
  4687. *
  4688. * Return: 0 for success or error code
  4689. */
  4690. static QDF_STATUS
  4691. send_get_user_position_cmd_non_tlv(wmi_unified_t wmi_handle, uint32_t value)
  4692. {
  4693. wmi_buf_t buf;
  4694. wmi_peer_gid_userpos_list_cmd *cmd;
  4695. buf = wmi_buf_alloc(wmi_handle, sizeof(wmi_peer_gid_userpos_list_cmd));
  4696. if (!buf) {
  4697. qdf_print("No WMI resource!");
  4698. return QDF_STATUS_E_FAILURE;
  4699. }
  4700. qdf_nbuf_put_tail(buf, sizeof(wmi_peer_gid_userpos_list_cmd));
  4701. cmd = (wmi_peer_gid_userpos_list_cmd *)(wmi_buf_data(buf));
  4702. cmd->aid = value;
  4703. if (wmi_unified_cmd_send(wmi_handle, buf,
  4704. sizeof(wmi_peer_gid_userpos_list_cmd),
  4705. WMI_PEER_GID_USERPOS_LIST_CMDID)) {
  4706. wmi_buf_free(buf);
  4707. return QDF_STATUS_E_FAILURE;
  4708. }
  4709. return QDF_STATUS_SUCCESS;
  4710. }
  4711. /**
  4712. * send_reset_peer_mumimo_tx_count_cmd_non_tlv() - send mumimo reset tx count fw
  4713. * @wmi_handle: wmi handle
  4714. * @value: reset tx count
  4715. *
  4716. * Return: 0 for success or error code
  4717. */
  4718. static QDF_STATUS
  4719. send_reset_peer_mumimo_tx_count_cmd_non_tlv(wmi_unified_t wmi_handle,
  4720. uint32_t value)
  4721. {
  4722. wmi_buf_t buf;
  4723. wmi_peer_txmu_rstcnt_cmd *cmd;
  4724. buf = wmi_buf_alloc(wmi_handle, sizeof(wmi_peer_txmu_rstcnt_cmd));
  4725. if (!buf) {
  4726. qdf_print("No WMI resource!");
  4727. return QDF_STATUS_E_FAILURE;
  4728. }
  4729. qdf_nbuf_put_tail(buf, sizeof(wmi_peer_txmu_rstcnt_cmd));
  4730. cmd = (wmi_peer_txmu_rstcnt_cmd *)(wmi_buf_data(buf));
  4731. cmd->aid = value;
  4732. if (wmi_unified_cmd_send(wmi_handle, buf,
  4733. sizeof(wmi_peer_txmu_rstcnt_cmd),
  4734. WMI_PEER_TX_MU_TXMIT_RSTCNT_CMDID)) {
  4735. wmi_buf_free(buf);
  4736. return QDF_STATUS_E_FAILURE;
  4737. }
  4738. return QDF_STATUS_SUCCESS;
  4739. }
  4740. /**
  4741. * send_get_peer_mumimo_tx_count_cmd_non_tlv() - send cmd to get mumimo tx count from fw
  4742. * @wmi_handle: wmi handle
  4743. *
  4744. * Return: 0 for success or error code
  4745. */
  4746. static QDF_STATUS
  4747. send_get_peer_mumimo_tx_count_cmd_non_tlv(wmi_unified_t wmi_handle,
  4748. uint32_t value)
  4749. {
  4750. wmi_buf_t buf;
  4751. wmi_peer_txmu_cnt_cmd *cmd;
  4752. buf = wmi_buf_alloc(wmi_handle, sizeof(wmi_peer_txmu_cnt_cmd));
  4753. if (!buf) {
  4754. qdf_print("No WMI resource!");
  4755. return QDF_STATUS_E_FAILURE;
  4756. }
  4757. qdf_nbuf_put_tail(buf, sizeof(wmi_peer_txmu_cnt_cmd));
  4758. cmd = (wmi_peer_txmu_cnt_cmd *)(wmi_buf_data(buf));
  4759. cmd->aid = value;
  4760. if (wmi_unified_cmd_send(wmi_handle, buf,
  4761. sizeof(wmi_peer_txmu_cnt_cmd),
  4762. WMI_PEER_TX_MU_TXMIT_COUNT_CMDID)) {
  4763. wmi_buf_free(buf);
  4764. return QDF_STATUS_E_FAILURE;
  4765. }
  4766. return QDF_STATUS_SUCCESS;
  4767. }
  4768. /**
  4769. * send_pdev_caldata_version_check_cmd_non_tlv() - send caldata check cmd to fw
  4770. * @wmi_handle: wmi handle
  4771. * @param: reserved param
  4772. *
  4773. * Return: 0 for success or error code
  4774. */
  4775. static QDF_STATUS
  4776. send_pdev_caldata_version_check_cmd_non_tlv(wmi_unified_t wmi_handle,
  4777. uint32_t param)
  4778. {
  4779. wmi_pdev_check_cal_version_cmd *cmd;
  4780. wmi_buf_t buf;
  4781. int32_t len = sizeof(wmi_pdev_check_cal_version_cmd);
  4782. buf = wmi_buf_alloc(wmi_handle, len);
  4783. if (!buf) {
  4784. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  4785. return QDF_STATUS_E_FAILURE;
  4786. }
  4787. cmd = (wmi_pdev_check_cal_version_cmd *)wmi_buf_data(buf);
  4788. cmd->reserved = param; /* set to 0x0 as expected from FW */
  4789. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  4790. WMI_PDEV_CHECK_CAL_VERSION_CMDID)) {
  4791. wmi_buf_free(buf);
  4792. return QDF_STATUS_E_FAILURE;
  4793. }
  4794. return QDF_STATUS_SUCCESS;
  4795. }
  4796. /**
  4797. * send_btcoex_wlan_priority_cmd_non_tlv() - send btcoex wlan priority fw
  4798. * @wmi_handle: wmi handle
  4799. * @param: btcoex config params
  4800. *
  4801. * Return: 0 for success or error code
  4802. */
  4803. static QDF_STATUS
  4804. send_btcoex_wlan_priority_cmd_non_tlv(wmi_unified_t wmi_handle,
  4805. struct btcoex_cfg_params *param)
  4806. {
  4807. wmi_buf_t buf;
  4808. wmi_btcoex_cfg_cmd *cmd;
  4809. int len = sizeof(wmi_btcoex_cfg_cmd);
  4810. buf = wmi_buf_alloc(wmi_handle, len);
  4811. if (!buf) {
  4812. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  4813. return QDF_STATUS_E_FAILURE;
  4814. }
  4815. cmd = (wmi_btcoex_cfg_cmd *) wmi_buf_data(buf);
  4816. cmd->btcoex_wlan_priority_bitmap = param->btcoex_wlan_priority_bitmap;
  4817. cmd->btcoex_param_flags = param->btcoex_param_flags;
  4818. if (wmi_unified_cmd_send(wmi_handle, buf, len, WMI_BTCOEX_CFG_CMDID)) {
  4819. wmi_buf_free(buf);
  4820. return QDF_STATUS_E_FAILURE;
  4821. }
  4822. return QDF_STATUS_SUCCESS;
  4823. }
  4824. /**
  4825. * send_btcoex_duty_cycle_cmd_non_tlv() - send btcoex wlan priority fw
  4826. * @wmi_handle: wmi handle
  4827. * @param: period and duration
  4828. *
  4829. * Return: 0 for success or error code
  4830. */
  4831. static QDF_STATUS
  4832. send_btcoex_duty_cycle_cmd_non_tlv(wmi_unified_t wmi_handle,
  4833. struct btcoex_cfg_params *param)
  4834. {
  4835. wmi_buf_t buf;
  4836. wmi_btcoex_cfg_cmd *cmd;
  4837. int len = sizeof(wmi_btcoex_cfg_cmd);
  4838. buf = wmi_buf_alloc(wmi_handle, len);
  4839. if (!buf) {
  4840. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  4841. return QDF_STATUS_E_FAILURE;
  4842. }
  4843. cmd = (wmi_btcoex_cfg_cmd *) wmi_buf_data(buf);
  4844. cmd->wlan_duration = param->wlan_duration;
  4845. cmd->period = param->period;
  4846. cmd->btcoex_param_flags = param->btcoex_param_flags;
  4847. if (wmi_unified_cmd_send(wmi_handle, buf, len, WMI_BTCOEX_CFG_CMDID)) {
  4848. wmi_buf_free(buf);
  4849. return QDF_STATUS_E_FAILURE;
  4850. }
  4851. return QDF_STATUS_SUCCESS;
  4852. }
  4853. /**
  4854. * send_coex_ver_cfg_cmd_non_tlv() - send coex ver cfg
  4855. * @wmi_handle: wmi handle
  4856. * @param: coex ver and configuration
  4857. *
  4858. * Return: 0 for success or error code
  4859. */
  4860. static QDF_STATUS
  4861. send_coex_ver_cfg_cmd_non_tlv(wmi_unified_t wmi_handle, coex_ver_cfg_t *param)
  4862. {
  4863. wmi_buf_t buf;
  4864. coex_ver_cfg_t *cmd;
  4865. int len = sizeof(wmi_coex_ver_cfg_cmd);
  4866. buf = wmi_buf_alloc(wmi_handle, len);
  4867. if (!buf) {
  4868. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  4869. return QDF_STATUS_E_FAILURE;
  4870. }
  4871. cmd = (coex_ver_cfg_t *)wmi_buf_data(buf);
  4872. cmd->coex_version = param->coex_version;
  4873. cmd->length = param->length;
  4874. qdf_mem_copy(cmd->config_buf, param->config_buf,
  4875. sizeof(cmd->config_buf));
  4876. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  4877. WMI_COEX_VERSION_CFG_CMID)) {
  4878. wmi_buf_free(buf);
  4879. return QDF_STATUS_E_FAILURE;
  4880. }
  4881. return QDF_STATUS_SUCCESS;
  4882. }
  4883. /**
  4884. * wmi_copy_resource_config_non_tlv() - copy resource configuration function
  4885. * @param resource_cfg: pointer to resource configuration
  4886. * @param tgt_res_cfg: pointer to target resource configuration
  4887. *
  4888. * Return: None
  4889. */
  4890. static void wmi_copy_resource_config_non_tlv(wmi_resource_config *resource_cfg,
  4891. target_resource_config *tgt_res_cfg)
  4892. {
  4893. resource_cfg->num_vdevs = tgt_res_cfg->num_vdevs;
  4894. resource_cfg->num_peers = tgt_res_cfg->num_peers;
  4895. resource_cfg->num_active_peers = tgt_res_cfg->num_active_peers;
  4896. resource_cfg->num_offload_peers = tgt_res_cfg->num_offload_peers;
  4897. resource_cfg->num_offload_reorder_buffs =
  4898. tgt_res_cfg->num_offload_reorder_buffs;
  4899. resource_cfg->num_peer_keys = tgt_res_cfg->num_peer_keys;
  4900. resource_cfg->num_tids = tgt_res_cfg->num_tids;
  4901. resource_cfg->ast_skid_limit = tgt_res_cfg->ast_skid_limit;
  4902. resource_cfg->tx_chain_mask = tgt_res_cfg->tx_chain_mask;
  4903. resource_cfg->rx_chain_mask = tgt_res_cfg->rx_chain_mask;
  4904. resource_cfg->rx_timeout_pri[0] = tgt_res_cfg->rx_timeout_pri[0];
  4905. resource_cfg->rx_timeout_pri[1] = tgt_res_cfg->rx_timeout_pri[1];
  4906. resource_cfg->rx_timeout_pri[2] = tgt_res_cfg->rx_timeout_pri[2];
  4907. resource_cfg->rx_timeout_pri[3] = tgt_res_cfg->rx_timeout_pri[3];
  4908. resource_cfg->rx_decap_mode = tgt_res_cfg->rx_decap_mode;
  4909. resource_cfg->scan_max_pending_req = tgt_res_cfg->scan_max_pending_req;
  4910. resource_cfg->bmiss_offload_max_vdev =
  4911. tgt_res_cfg->bmiss_offload_max_vdev;
  4912. resource_cfg->roam_offload_max_vdev =
  4913. tgt_res_cfg->roam_offload_max_vdev;
  4914. resource_cfg->roam_offload_max_ap_profiles =
  4915. tgt_res_cfg->roam_offload_max_ap_profiles;
  4916. resource_cfg->num_mcast_groups = tgt_res_cfg->num_mcast_groups;
  4917. resource_cfg->num_mcast_table_elems =
  4918. tgt_res_cfg->num_mcast_table_elems;
  4919. resource_cfg->mcast2ucast_mode = tgt_res_cfg->mcast2ucast_mode;
  4920. resource_cfg->tx_dbg_log_size = tgt_res_cfg->tx_dbg_log_size;
  4921. resource_cfg->num_wds_entries = tgt_res_cfg->num_wds_entries;
  4922. resource_cfg->dma_burst_size = tgt_res_cfg->dma_burst_size;
  4923. resource_cfg->mac_aggr_delim = tgt_res_cfg->mac_aggr_delim;
  4924. resource_cfg->rx_skip_defrag_timeout_dup_detection_check =
  4925. tgt_res_cfg->rx_skip_defrag_timeout_dup_detection_check;
  4926. resource_cfg->vow_config = tgt_res_cfg->vow_config;
  4927. resource_cfg->gtk_offload_max_vdev = tgt_res_cfg->gtk_offload_max_vdev;
  4928. resource_cfg->num_msdu_desc = tgt_res_cfg->num_msdu_desc;
  4929. resource_cfg->max_frag_entries = tgt_res_cfg->max_frag_entries;
  4930. resource_cfg->max_peer_ext_stats = tgt_res_cfg->max_peer_ext_stats;
  4931. resource_cfg->smart_ant_cap = tgt_res_cfg->smart_ant_cap;
  4932. resource_cfg->BK_Minfree = tgt_res_cfg->BK_Minfree;
  4933. resource_cfg->BE_Minfree = tgt_res_cfg->BE_Minfree;
  4934. resource_cfg->VI_Minfree = tgt_res_cfg->VI_Minfree;
  4935. resource_cfg->VO_Minfree = tgt_res_cfg->VO_Minfree;
  4936. resource_cfg->rx_batchmode = tgt_res_cfg->rx_batchmode;
  4937. resource_cfg->tt_support = tgt_res_cfg->tt_support;
  4938. resource_cfg->atf_config = tgt_res_cfg->atf_config;
  4939. resource_cfg->iphdr_pad_config = tgt_res_cfg->iphdr_pad_config;
  4940. WMI_SET_QWRAP(resource_cfg, tgt_res_cfg->qwrap_config);
  4941. WMI_SET_ALLOC_FRAG(resource_cfg,
  4942. tgt_res_cfg->alloc_frag_desc_for_data_pkt);
  4943. }
  4944. /**
  4945. * init_cmd_send_non_tlv() - send initialization cmd to fw
  4946. * @wmi_handle: wmi handle
  4947. * @param param: pointer to wmi init param
  4948. *
  4949. * Return: 0 for success or error code
  4950. */
  4951. static QDF_STATUS init_cmd_send_non_tlv(wmi_unified_t wmi_handle,
  4952. struct wmi_init_cmd_param *param)
  4953. {
  4954. wmi_buf_t buf;
  4955. wmi_init_cmd *cmd;
  4956. wlan_host_memory_chunk *host_mem_chunks;
  4957. uint32_t mem_chunk_len = 0;
  4958. uint16_t idx;
  4959. int len;
  4960. len = sizeof(*cmd);
  4961. mem_chunk_len = (sizeof(wlan_host_memory_chunk) * MAX_MEM_CHUNKS);
  4962. buf = wmi_buf_alloc(wmi_handle, len + mem_chunk_len);
  4963. if (!buf) {
  4964. qdf_print("%s: wmi_buf_alloc failed\n", __func__);
  4965. return QDF_STATUS_E_FAILURE;
  4966. }
  4967. cmd = (wmi_init_cmd *) wmi_buf_data(buf);
  4968. wmi_copy_resource_config_non_tlv(&cmd->resource_config, param->res_cfg);
  4969. host_mem_chunks = cmd->host_mem_chunks;
  4970. for (idx = 0; idx < param->num_mem_chunks; ++idx) {
  4971. host_mem_chunks[idx].ptr = param->mem_chunks[idx].paddr;
  4972. host_mem_chunks[idx].size = param->mem_chunks[idx].len;
  4973. host_mem_chunks[idx].req_id = param->mem_chunks[idx].req_id;
  4974. qdf_print("chunk %d len %d requested , ptr 0x%x\n",
  4975. idx, cmd->host_mem_chunks[idx].size,
  4976. cmd->host_mem_chunks[idx].ptr);
  4977. }
  4978. cmd->num_host_mem_chunks = param->num_mem_chunks;
  4979. if (param->num_mem_chunks > 1)
  4980. len += ((param->num_mem_chunks-1) *
  4981. sizeof(wlan_host_memory_chunk));
  4982. if (wmi_unified_cmd_send(wmi_handle, buf, len, WMI_INIT_CMDID) < 0) {
  4983. wmi_buf_free(buf);
  4984. return QDF_STATUS_E_FAILURE;
  4985. }
  4986. return QDF_STATUS_SUCCESS;
  4987. }
  4988. /**
  4989. * send_ext_resource_config_non_tlv() - send extended resource configuration
  4990. * @wmi_handle: wmi handle
  4991. * @param ext_cfg: pointer to extended resource configuration
  4992. *
  4993. * Return: 0 for success or error code
  4994. */
  4995. static QDF_STATUS send_ext_resource_config_non_tlv(wmi_unified_t wmi_handle,
  4996. wmi_host_ext_resource_config *ext_cfg)
  4997. {
  4998. wmi_buf_t buf;
  4999. int len = 0;
  5000. wmi_ext_resource_config *cmd_cfg;
  5001. #define PAD_LENGTH 100
  5002. buf = wmi_buf_alloc(wmi_handle,
  5003. len + (sizeof(wmi_ext_resource_config) + PAD_LENGTH));
  5004. if (!buf) {
  5005. qdf_print("%s:wmi_buf_alloc failed\n", __func__);
  5006. return QDF_STATUS_E_FAILURE;
  5007. }
  5008. cmd_cfg = (wmi_ext_resource_config *)wmi_buf_data(buf);
  5009. qdf_mem_copy(cmd_cfg, ext_cfg, sizeof(wmi_ext_resource_config));
  5010. qdf_print("\nSending Ext resource cfg: HOST PLATFORM as %d\n"
  5011. "fw_feature_bitmap as %x to TGT\n",
  5012. cmd_cfg->host_platform_config,
  5013. cmd_cfg->fw_feature_bitmap);
  5014. if (wmi_unified_cmd_send(wmi_handle, buf,
  5015. sizeof(wmi_ext_resource_config),
  5016. WMI_EXT_RESOURCE_CFG_CMDID) < 0) {
  5017. wmi_buf_free(buf);
  5018. return QDF_STATUS_E_FAILURE;
  5019. }
  5020. return QDF_STATUS_SUCCESS;
  5021. }
  5022. /**
  5023. * save_service_bitmap_non_tlv() - save service bitmap
  5024. * @wmi_handle: wmi handle
  5025. * @param evt_buf: pointer to event buffer
  5026. * @param bitmap_buf: bitmap buffer for converged legacy support
  5027. *
  5028. * Return: QDF_STATUS
  5029. */
  5030. static QDF_STATUS save_service_bitmap_non_tlv(wmi_unified_t wmi_handle,
  5031. void *evt_buf, void *bitmap_buf)
  5032. {
  5033. wmi_service_ready_event *ev;
  5034. struct wmi_soc *soc = wmi_handle->soc;
  5035. ev = (wmi_service_ready_event *) evt_buf;
  5036. /* If it is already allocated, use that buffer. This can happen
  5037. * during target stop/start scenarios where host allocation is skipped.
  5038. */
  5039. if (!soc->wmi_service_bitmap) {
  5040. soc->wmi_service_bitmap =
  5041. qdf_mem_malloc(WMI_SERVICE_BM_SIZE * sizeof(uint32_t));
  5042. if (!soc->wmi_service_bitmap) {
  5043. WMI_LOGE("Failed memory alloc for service bitmap\n");
  5044. return QDF_STATUS_E_NOMEM;
  5045. }
  5046. }
  5047. qdf_mem_copy(soc->wmi_service_bitmap, ev->wmi_service_bitmap,
  5048. (WMI_SERVICE_BM_SIZE * sizeof(uint32_t)));
  5049. if (bitmap_buf)
  5050. qdf_mem_copy(bitmap_buf, ev->wmi_service_bitmap,
  5051. (WMI_SERVICE_BM_SIZE * sizeof(uint32_t)));
  5052. return QDF_STATUS_SUCCESS;
  5053. }
  5054. /**
  5055. * is_service_enabled_non_tlv() - Check if service enabled
  5056. * @param wmi_handle: wmi handle
  5057. * @param service_id: service identifier
  5058. *
  5059. * Return: 1 enabled, 0 disabled
  5060. */
  5061. static bool is_service_enabled_non_tlv(wmi_unified_t wmi_handle,
  5062. uint32_t service_id)
  5063. {
  5064. struct wmi_soc *soc = wmi_handle->soc;
  5065. if (!soc->wmi_service_bitmap) {
  5066. WMI_LOGE("WMI service bit map is not saved yet\n");
  5067. return false;
  5068. }
  5069. return WMI_SERVICE_IS_ENABLED(soc->wmi_service_bitmap,
  5070. service_id);
  5071. }
  5072. static inline void copy_ht_cap_info(uint32_t ev_target_cap,
  5073. struct wlan_psoc_target_capability_info *cap)
  5074. {
  5075. cap->ht_cap_info |= ev_target_cap & (
  5076. WMI_HT_CAP_ENABLED
  5077. | WMI_HT_CAP_HT20_SGI
  5078. | WMI_HT_CAP_DYNAMIC_SMPS
  5079. | WMI_HT_CAP_TX_STBC
  5080. | WMI_HT_CAP_TX_STBC_MASK_SHIFT
  5081. | WMI_HT_CAP_RX_STBC
  5082. | WMI_HT_CAP_RX_STBC_MASK_SHIFT
  5083. | WMI_HT_CAP_LDPC
  5084. | WMI_HT_CAP_L_SIG_TXOP_PROT
  5085. | WMI_HT_CAP_MPDU_DENSITY
  5086. | WMI_HT_CAP_MPDU_DENSITY_MASK_SHIFT
  5087. | WMI_HT_CAP_HT40_SGI
  5088. | WMI_HT_CAP_IBF_BFER);
  5089. if (ev_target_cap & WMI_HT_CAP_IBF_BFER)
  5090. cap->ht_cap_info |= WMI_HOST_HT_CAP_IBF_BFER;
  5091. }
  5092. /**
  5093. * extract_service_ready_non_tlv() - extract service ready event
  5094. * @wmi_handle: wmi handle
  5095. * @param evt_buf: pointer to received event buffer
  5096. * @param cap: pointer to hold target capability information extracted from even
  5097. *
  5098. * Return: 0 for success or error code
  5099. */
  5100. static QDF_STATUS extract_service_ready_non_tlv(wmi_unified_t wmi_handle,
  5101. void *evt_buf,
  5102. struct wlan_psoc_target_capability_info *cap)
  5103. {
  5104. wmi_service_ready_event *ev;
  5105. ev = (wmi_service_ready_event *) evt_buf;
  5106. cap->phy_capability = ev->phy_capability;
  5107. cap->max_frag_entry = ev->max_frag_entry;
  5108. cap->num_rf_chains = ev->num_rf_chains;
  5109. copy_ht_cap_info(ev->ht_cap_info, cap);
  5110. cap->vht_cap_info = ev->vht_cap_info;
  5111. cap->vht_supp_mcs = ev->vht_supp_mcs;
  5112. cap->hw_min_tx_power = ev->hw_min_tx_power;
  5113. cap->hw_max_tx_power = ev->hw_max_tx_power;
  5114. cap->sys_cap_info = ev->sys_cap_info;
  5115. cap->min_pkt_size_enable = ev->min_pkt_size_enable;
  5116. cap->max_bcn_ie_size = ev->max_bcn_ie_size;
  5117. cap->fw_version = ev->sw_version;
  5118. cap->fw_version_1 = ev->sw_version_1;
  5119. /* Following caps not recieved in older fw/hw
  5120. * Initialize it as zero(default). */
  5121. cap->max_num_scan_channels = 0;
  5122. cap->max_supported_macs = 0;
  5123. cap->wmi_fw_sub_feat_caps = 0;
  5124. cap->txrx_chainmask = 0;
  5125. cap->default_dbs_hw_mode_index = 0;
  5126. cap->num_msdu_desc = 0;
  5127. return QDF_STATUS_SUCCESS;
  5128. }
  5129. /**
  5130. * extract_fw_version_non_tlv() - extract fw version
  5131. * @wmi_handle: wmi handle
  5132. * @param evt_buf: pointer to event buffer
  5133. * @param fw_ver: Pointer to hold fw version
  5134. *
  5135. * Return: 0 for success or error code
  5136. */
  5137. static QDF_STATUS extract_fw_version_non_tlv(wmi_unified_t wmi_handle,
  5138. void *evt_buf, struct wmi_host_fw_ver *fw_ver)
  5139. {
  5140. wmi_service_ready_event *ev;
  5141. ev = (wmi_service_ready_event *) evt_buf;
  5142. fw_ver->sw_version = ev->sw_version;
  5143. fw_ver->sw_version_1 = ev->sw_version_1;
  5144. return QDF_STATUS_SUCCESS;
  5145. }
  5146. /**
  5147. * extract_fw_abi_version_non_tlv() - extract fw abi version
  5148. * @wmi_handle: wmi handle
  5149. * @param evt_buf: Pointer to event buffer
  5150. * @param fw_ver: Pointer to hold fw abi version
  5151. *
  5152. * Return: 0 for success or error code
  5153. */
  5154. static QDF_STATUS extract_fw_abi_version_non_tlv(wmi_unified_t wmi_handle,
  5155. void *evt_buf, struct wmi_host_fw_abi_ver *fw_ver)
  5156. {
  5157. wmi_ready_event *ev;
  5158. ev = (wmi_ready_event *) evt_buf;
  5159. fw_ver->sw_version = ev->sw_version;
  5160. fw_ver->abi_version = ev->abi_version;
  5161. return QDF_STATUS_SUCCESS;
  5162. }
  5163. /**
  5164. * extract_hal_reg_cap_non_tlv() - extract HAL registered capabilities
  5165. * @wmi_handle: wmi handle
  5166. * @param evt_buf: Pointer to event buffer
  5167. * @param cap: pointer to hold HAL reg capabilities
  5168. *
  5169. * Return: 0 for success or error code
  5170. */
  5171. static QDF_STATUS extract_hal_reg_cap_non_tlv(wmi_unified_t wmi_handle,
  5172. void *evt_buf,
  5173. struct wlan_psoc_hal_reg_capability *cap)
  5174. {
  5175. wmi_service_ready_event *ev;
  5176. u_int32_t wireless_modes_orig = 0;
  5177. ev = (wmi_service_ready_event *) evt_buf;
  5178. qdf_mem_copy(cap, &ev->hal_reg_capabilities,
  5179. sizeof(struct wlan_psoc_hal_reg_capability));
  5180. /* Convert REGDMN_MODE values sent by target to host internal
  5181. * WMI_HOST_REGDMN_MODE values.
  5182. *
  5183. * REGULATORY TODO :
  5184. * REGDMN_MODE_11AC_VHT*_2G values are not used by the
  5185. * host currently. Add this in the future if required.
  5186. */
  5187. wireless_modes_orig = ev->hal_reg_capabilities.wireless_modes;
  5188. cap->wireless_modes = 0;
  5189. if (wireless_modes_orig & REGDMN_MODE_11A)
  5190. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11A;
  5191. if (wireless_modes_orig & REGDMN_MODE_TURBO)
  5192. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_TURBO;
  5193. if (wireless_modes_orig & REGDMN_MODE_11B)
  5194. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11B;
  5195. if (wireless_modes_orig & REGDMN_MODE_PUREG)
  5196. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_PUREG;
  5197. if (wireless_modes_orig & REGDMN_MODE_11G)
  5198. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11G;
  5199. if (wireless_modes_orig & REGDMN_MODE_108G)
  5200. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_108G;
  5201. if (wireless_modes_orig & REGDMN_MODE_108A)
  5202. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_108A;
  5203. if (wireless_modes_orig & REGDMN_MODE_XR)
  5204. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_XR;
  5205. if (wireless_modes_orig & REGDMN_MODE_11A_HALF_RATE)
  5206. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11A_HALF_RATE;
  5207. if (wireless_modes_orig & REGDMN_MODE_11A_QUARTER_RATE)
  5208. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11A_QUARTER_RATE;
  5209. if (wireless_modes_orig & REGDMN_MODE_11NG_HT20)
  5210. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11NG_HT20;
  5211. if (wireless_modes_orig & REGDMN_MODE_11NA_HT20)
  5212. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11NA_HT20;
  5213. if (wireless_modes_orig & REGDMN_MODE_11NG_HT40PLUS)
  5214. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11NG_HT40PLUS;
  5215. if (wireless_modes_orig & REGDMN_MODE_11NG_HT40MINUS)
  5216. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11NG_HT40MINUS;
  5217. if (wireless_modes_orig & REGDMN_MODE_11NA_HT40PLUS)
  5218. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11NA_HT40PLUS;
  5219. if (wireless_modes_orig & REGDMN_MODE_11NA_HT40MINUS)
  5220. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11NA_HT40MINUS;
  5221. if (wireless_modes_orig & REGDMN_MODE_11AC_VHT20)
  5222. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT20;
  5223. if (wireless_modes_orig & REGDMN_MODE_11AC_VHT40PLUS)
  5224. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT40PLUS;
  5225. if (wireless_modes_orig & REGDMN_MODE_11AC_VHT40MINUS)
  5226. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT40MINUS;
  5227. if (wireless_modes_orig & REGDMN_MODE_11AC_VHT80)
  5228. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT80;
  5229. if (wireless_modes_orig & REGDMN_MODE_11AC_VHT160)
  5230. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT160;
  5231. if (wireless_modes_orig & REGDMN_MODE_11AC_VHT80_80)
  5232. cap->wireless_modes |= WMI_HOST_REGDMN_MODE_11AC_VHT80_80;
  5233. return QDF_STATUS_SUCCESS;
  5234. }
  5235. /**
  5236. * extract_host_mem_req_non_tlv() - Extract host memory request event
  5237. * @wmi_handle: wmi handle
  5238. * @param evt_buf: pointer to event buffer
  5239. * @param num_entries: pointer to hold number of entries requested
  5240. *
  5241. * Return: Number of entries requested
  5242. */
  5243. static host_mem_req *extract_host_mem_req_non_tlv(wmi_unified_t wmi_handle,
  5244. void *evt_buf, uint8_t *num_entries)
  5245. {
  5246. wmi_service_ready_event *ev;
  5247. ev = (wmi_service_ready_event *) evt_buf;
  5248. *num_entries = ev->num_mem_reqs;
  5249. return (host_mem_req *)ev->mem_reqs;
  5250. }
  5251. /**
  5252. * save_fw_version_in_service_ready_non_tlv() - Save fw version in service
  5253. * ready function
  5254. * @wmi_handle: wmi handle
  5255. * @param evt_buf: pointer to event buffer
  5256. *
  5257. * Return: 0 for success or error code
  5258. */
  5259. static QDF_STATUS save_fw_version_in_service_ready_non_tlv(
  5260. wmi_unified_t wmi_handle,
  5261. void *evt_buf)
  5262. {
  5263. /* Version check and exchange is not present in non-tlv implementation*/
  5264. return QDF_STATUS_SUCCESS;
  5265. }
  5266. /**
  5267. * ready_check_and_update_fw_version_non_tlv() - Ready and fw version check
  5268. * function
  5269. * @wmi_handle: wmi handle
  5270. * @param evt_buf: pointer to event buffer
  5271. *
  5272. * Return: 0 for success or error code
  5273. */
  5274. static QDF_STATUS ready_check_and_update_fw_version_non_tlv(
  5275. wmi_unified_t wmi_handle,
  5276. void *evt_buf)
  5277. {
  5278. /* Version check and exchange is not present in non-tlv implementation*/
  5279. return QDF_STATUS_SUCCESS;
  5280. }
  5281. /**
  5282. * ready_extract_init_status_non_tlv() - Extract init status from ready event
  5283. * @wmi_handle: wmi handle
  5284. * @param evt_buf: Pointer to event buffer
  5285. *
  5286. * Return: ready status
  5287. */
  5288. static uint32_t ready_extract_init_status_non_tlv(wmi_unified_t wmi_hdl,
  5289. void *evt_buf)
  5290. {
  5291. wmi_ready_event *ev = (wmi_ready_event *) evt_buf;
  5292. qdf_print("Version = %d %d status = %d\n", ev->sw_version,
  5293. ev->abi_version, ev->status);
  5294. return ev->status;
  5295. }
  5296. /**
  5297. * ready_extract_mac_addr_non_tlv() - extract mac address from ready event
  5298. * @wmi_handle: wmi handle
  5299. * @param evt_buf: pointer to event buffer
  5300. * @param macaddr: Pointer to hold MAC address
  5301. *
  5302. * Return: 0 for success or error code
  5303. */
  5304. static QDF_STATUS ready_extract_mac_addr_non_tlv(wmi_unified_t wmi_hdl,
  5305. void *evt_buf,
  5306. uint8_t *macaddr)
  5307. {
  5308. wmi_ready_event *ev = (wmi_ready_event *) evt_buf;
  5309. WMI_MAC_ADDR_TO_CHAR_ARRAY(&ev->mac_addr, macaddr);
  5310. return QDF_STATUS_SUCCESS;
  5311. }
  5312. /**
  5313. * extract_ready_params_non_tlv() - Extract data from ready event apart from
  5314. * status, macaddr and version.
  5315. * @wmi_handle: Pointer to WMI handle.
  5316. * @evt_buf: Pointer to Ready event buffer.
  5317. * @ev_param: Pointer to host defined struct to copy the data from event.
  5318. *
  5319. * Return: QDF_STATUS_SUCCESS on success.
  5320. */
  5321. static QDF_STATUS extract_ready_event_params_non_tlv(wmi_unified_t wmi_handle,
  5322. void *evt_buf, struct wmi_host_ready_ev_param *ev_param)
  5323. {
  5324. wmi_ready_event *ev = (wmi_ready_event *) evt_buf;
  5325. ev_param->status = ev->status;
  5326. ev_param->num_dscp_table = ev->num_dscp_table;
  5327. if (ev->agile_capability)
  5328. ev_param->agile_capability = true;
  5329. else
  5330. ev_param->agile_capability = false;
  5331. /* Following params not present in non-TLV target. Set Defaults */
  5332. ev_param->num_extra_mac_addr = 0;
  5333. ev_param->num_total_peer = 0;
  5334. ev_param->num_extra_peer = 0;
  5335. return QDF_STATUS_SUCCESS;
  5336. }
  5337. /**
  5338. * extract_dbglog_data_len_non_tlv() - extract debuglog data length
  5339. * @wmi_handle: wmi handle
  5340. * @param evt_buf: pointer to event buffer
  5341. *
  5342. * Return: length
  5343. */
  5344. static uint8_t *extract_dbglog_data_len_non_tlv(wmi_unified_t wmi_handle,
  5345. void *evt_buf,
  5346. uint32_t *len)
  5347. {
  5348. /*Len is already valid from event. No need to change it */
  5349. return evt_buf;
  5350. }
  5351. /**
  5352. * extract_wds_addr_event_non_tlv() - extract wds address from event
  5353. * @wmi_handle: wmi handle
  5354. * @param evt_buf: pointer to event buffer
  5355. * @param wds_ev: Pointer to hold wds address
  5356. *
  5357. * Return: 0 for success or error code
  5358. */
  5359. static QDF_STATUS extract_wds_addr_event_non_tlv(wmi_unified_t wmi_handle,
  5360. void *evt_buf,
  5361. uint16_t len, wds_addr_event_t *wds_ev)
  5362. {
  5363. wmi_wds_addr_event_t *ev = (wmi_wds_addr_event_t *) evt_buf;
  5364. int i;
  5365. #ifdef BIG_ENDIAN_HOST
  5366. {
  5367. uint8_t *datap = (uint8_t *) ev;
  5368. /*Skip swapping the first long word*/
  5369. datap += sizeof(uint32_t);
  5370. for (i = 0; i < ((len / sizeof(uint32_t))-1);
  5371. i++, datap += sizeof(uint32_t))
  5372. *(uint32_t *)datap =
  5373. qdf_le32_to_cpu(*(uint32_t *)datap);
  5374. }
  5375. #endif
  5376. qdf_mem_copy(wds_ev->event_type, ev->event_type,
  5377. sizeof(wds_ev->event_type));
  5378. for (i = 0; i < 4; i++) {
  5379. wds_ev->peer_mac[i] =
  5380. ((u_int8_t *)&(ev->peer_mac.mac_addr31to0))[i];
  5381. wds_ev->dest_mac[i] =
  5382. ((u_int8_t *)&(ev->dest_mac.mac_addr31to0))[i];
  5383. }
  5384. for (i = 0; i < 2; i++) {
  5385. wds_ev->peer_mac[4+i] =
  5386. ((u_int8_t *)&(ev->peer_mac.mac_addr47to32))[i];
  5387. wds_ev->dest_mac[4+i] =
  5388. ((u_int8_t *)&(ev->dest_mac.mac_addr47to32))[i];
  5389. }
  5390. /* vdev_id is not available in legacy. It is required only to get
  5391. * pdev, hence setting it to zero as legacy as only one pdev.
  5392. */
  5393. wds_ev->vdev_id = 0;
  5394. return QDF_STATUS_SUCCESS;
  5395. }
  5396. /**
  5397. * extract_dcs_interference_type_non_tlv() - extract dcs interference type
  5398. * from event
  5399. * @wmi_handle: wmi handle
  5400. * @param evt_buf: pointer to event buffer
  5401. * @param param: Pointer to hold dcs interference param
  5402. *
  5403. * Return: 0 for success or error code
  5404. */
  5405. static QDF_STATUS extract_dcs_interference_type_non_tlv(
  5406. wmi_unified_t wmi_handle,
  5407. void *evt_buf, struct wmi_host_dcs_interference_param *param)
  5408. {
  5409. wmi_dcs_interference_event_t *ev =
  5410. (wmi_dcs_interference_event_t *) evt_buf;
  5411. param->interference_type = ev->interference_type;
  5412. param->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  5413. return QDF_STATUS_SUCCESS;
  5414. }
  5415. /*
  5416. * extract_dcs_cw_int_non_tlv() - extract dcs cw interference from event
  5417. * @wmi_handle: wmi handle
  5418. * @param evt_buf: pointer to event buffer
  5419. * @param cw_int: Pointer to hold cw interference
  5420. *
  5421. * Return: 0 for success or error code
  5422. */
  5423. static QDF_STATUS extract_dcs_cw_int_non_tlv(wmi_unified_t wmi_handle,
  5424. void *evt_buf,
  5425. wmi_host_ath_dcs_cw_int *cw_int)
  5426. {
  5427. wmi_dcs_interference_event_t *ev =
  5428. (wmi_dcs_interference_event_t *) evt_buf;
  5429. qdf_mem_copy(cw_int, &ev->int_event.cw_int, sizeof(*cw_int));
  5430. return QDF_STATUS_SUCCESS;
  5431. }
  5432. /**
  5433. * extract_dcs_im_tgt_stats_non_tlv() - extract dcs im target stats from event
  5434. * @wmi_handle: wmi handle
  5435. * @param evt_buf: pointer to event buffer
  5436. * @param wlan_stat: Pointer to hold wlan stats
  5437. *
  5438. * Return: 0 for success or error code
  5439. */
  5440. static QDF_STATUS extract_dcs_im_tgt_stats_non_tlv(wmi_unified_t wmi_handle,
  5441. void *evt_buf,
  5442. wmi_host_dcs_im_tgt_stats_t *wlan_stat)
  5443. {
  5444. wmi_dcs_interference_event_t *ev =
  5445. (wmi_dcs_interference_event_t *) evt_buf;
  5446. qdf_mem_copy(wlan_stat, &ev->int_event.wlan_stat,
  5447. sizeof(wmi_host_dcs_im_tgt_stats_t));
  5448. return QDF_STATUS_SUCCESS;
  5449. }
  5450. /**
  5451. * extract_fips_event_data_non_tlv() - extract fips event data
  5452. * @wmi_handle: wmi handle
  5453. * @param evt_buf: pointer to event buffer
  5454. * @param param: pointer FIPS event params
  5455. *
  5456. * Return: 0 for success or error code
  5457. */
  5458. static QDF_STATUS extract_fips_event_data_non_tlv(wmi_unified_t wmi_handle,
  5459. void *evt_buf,
  5460. struct wmi_host_fips_event_param *param)
  5461. {
  5462. wmi_pdev_fips_event *event = (wmi_pdev_fips_event *)evt_buf;
  5463. param->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  5464. #ifdef BIG_ENDIAN_HOST
  5465. {
  5466. /*****************LE to BE conversion*************************/
  5467. /* Assigning unaligned space to copy the data */
  5468. unsigned char *data_unaligned = qdf_mem_malloc(
  5469. (sizeof(u_int8_t)*event->data_len + FIPS_ALIGN));
  5470. u_int8_t *data_aligned = NULL;
  5471. int c;
  5472. /* Checking if kmalloc does succesful allocation */
  5473. if (data_unaligned == NULL)
  5474. return QDF_STATUS_E_FAILURE;
  5475. /* Checking if space is alligned */
  5476. if (!FIPS_IS_ALIGNED(data_unaligned, FIPS_ALIGN)) {
  5477. /* align the data space */
  5478. data_aligned =
  5479. (u_int8_t *)FIPS_ALIGNTO(data_unaligned, FIPS_ALIGN);
  5480. } else {
  5481. data_aligned = (u_int8_t *)data_unaligned;
  5482. }
  5483. /* memset and copy content from data to data aligned */
  5484. OS_MEMSET(data_aligned, 0, event->data_len);
  5485. OS_MEMCPY(data_aligned, event->data, event->data_len);
  5486. /* Endianness to LE */
  5487. for (c = 0; c < event->data_len/4; c++) {
  5488. *((u_int32_t *)data_aligned+c) =
  5489. qdf_le32_to_cpu(*((u_int32_t *)data_aligned+c));
  5490. }
  5491. /* Copy content to event->data */
  5492. OS_MEMCPY(event->data, data_aligned, event->data_len);
  5493. /* clean up allocated space */
  5494. qdf_mem_free(data_unaligned);
  5495. data_aligned = NULL;
  5496. data_unaligned = NULL;
  5497. /*************************************************************/
  5498. }
  5499. #endif
  5500. param->data = event->data;
  5501. param->data_len = event->data_len;
  5502. param->error_status = event->error_status;
  5503. return QDF_STATUS_SUCCESS;
  5504. }
  5505. /**
  5506. * extract_vdev_start_resp_non_tlv() - extract vdev start response
  5507. * @wmi_handle: wmi handle
  5508. * @param evt_buf: pointer to event buffer
  5509. * @param vdev_rsp: Pointer to hold vdev response
  5510. *
  5511. * Return: 0 for success or error code
  5512. */
  5513. static QDF_STATUS extract_vdev_start_resp_non_tlv(wmi_unified_t wmi_handle,
  5514. void *evt_buf,
  5515. wmi_host_vdev_start_resp *vdev_rsp)
  5516. {
  5517. wmi_vdev_start_response_event *ev =
  5518. (wmi_vdev_start_response_event *) evt_buf;
  5519. qdf_mem_zero(vdev_rsp, sizeof(*vdev_rsp));
  5520. vdev_rsp->vdev_id = ev->vdev_id;
  5521. vdev_rsp->requestor_id = ev->requestor_id;
  5522. vdev_rsp->resp_type = ev->resp_type;
  5523. vdev_rsp->status = ev->status;
  5524. return QDF_STATUS_SUCCESS;
  5525. }
  5526. /**
  5527. * extract_tbttoffset_num_vdevs_non_tlv() - extract tbtt offset num vdevs
  5528. * @wmi_handle: wmi handle
  5529. * @param evt_buf: pointer to event buffer
  5530. * @param num_vdev: Pointer to hold num vdev
  5531. *
  5532. * Return: 0 for success or error code
  5533. */
  5534. static QDF_STATUS extract_tbttoffset_num_vdevs_non_tlv(void *wmi_hdl,
  5535. void *evt_buf,
  5536. uint32_t *num_vdevs)
  5537. {
  5538. wmi_tbtt_offset_event *tbtt_offset_event =
  5539. (wmi_tbtt_offset_event *)evt_buf;
  5540. uint32_t vdev_map;
  5541. vdev_map = tbtt_offset_event->vdev_map;
  5542. *num_vdevs = wmi_vdev_map_to_num_vdevs(vdev_map);
  5543. return QDF_STATUS_SUCCESS;
  5544. }
  5545. /**
  5546. * extract_tbttoffset_update_params_non_tlv() - extract tbtt offset update param
  5547. * @wmi_handle: wmi handle
  5548. * @param evt_buf: pointer to event buffer
  5549. * @param idx: Index refering to a vdev
  5550. * @param tbtt_param: Pointer to tbttoffset event param
  5551. *
  5552. * Return: 0 for success or error code
  5553. */
  5554. static QDF_STATUS extract_tbttoffset_update_params_non_tlv(void *wmi_hdl,
  5555. void *evt_buf, uint8_t idx,
  5556. struct tbttoffset_params *tbtt_param)
  5557. {
  5558. wmi_tbtt_offset_event *tbtt_offset_event =
  5559. (wmi_tbtt_offset_event *)evt_buf;
  5560. uint32_t vdev_map;
  5561. vdev_map = tbtt_offset_event->vdev_map;
  5562. tbtt_param->vdev_id = wmi_vdev_map_to_vdev_id(vdev_map, idx);
  5563. if (tbtt_param->vdev_id == WLAN_INVALID_VDEV_ID)
  5564. return QDF_STATUS_E_INVAL;
  5565. tbtt_param->tbttoffset =
  5566. tbtt_offset_event->tbttoffset_list[tbtt_param->vdev_id];
  5567. return QDF_STATUS_SUCCESS;
  5568. }
  5569. /**
  5570. * extract_mgmt_rx_params_non_tlv() - extract management rx params from event
  5571. * @wmi_handle: wmi handle
  5572. * @param evt_buf: pointer to event buffer
  5573. * @param hdr: Pointer to hold header
  5574. * @param bufp: Pointer to hold pointer to rx param buffer
  5575. *
  5576. * Return: 0 for success or error code
  5577. */
  5578. static QDF_STATUS extract_mgmt_rx_params_non_tlv(wmi_unified_t wmi_handle,
  5579. void *evt_buf,
  5580. struct mgmt_rx_event_params *hdr, uint8_t **bufp)
  5581. {
  5582. wmi_mgmt_rx_event *ev = (wmi_mgmt_rx_event *)evt_buf;
  5583. hdr->channel = ev->hdr.channel;
  5584. hdr->snr = ev->hdr.snr;
  5585. hdr->rssi = ev->hdr.snr;
  5586. hdr->rate = ev->hdr.rate;
  5587. hdr->phy_mode = ev->hdr.phy_mode;
  5588. hdr->buf_len = ev->hdr.buf_len;
  5589. hdr->status = ev->hdr.status;
  5590. hdr->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  5591. qdf_mem_copy(hdr->rssi_ctl, ev->hdr.rssi_ctl, sizeof(hdr->rssi_ctl));
  5592. *bufp = ev->bufp;
  5593. return QDF_STATUS_SUCCESS;
  5594. }
  5595. /**
  5596. * extract_vdev_stopped_param_non_tlv() - extract vdev stop param from event
  5597. * @wmi_handle: wmi handle
  5598. * @param evt_buf: pointer to event buffer
  5599. * @param vdev_id: Pointer to hold vdev identifier
  5600. *
  5601. * Return: 0 for success or error code
  5602. */
  5603. static QDF_STATUS extract_vdev_stopped_param_non_tlv(wmi_unified_t wmi_handle,
  5604. void *evt_buf,
  5605. uint32_t *vdev_id)
  5606. {
  5607. wmi_vdev_stopped_event *event = (wmi_vdev_stopped_event *)evt_buf;
  5608. *vdev_id = event->vdev_id;
  5609. return QDF_STATUS_SUCCESS;
  5610. }
  5611. /**
  5612. * extract_vdev_roam_param_non_tlv() - extract vdev roam param from event
  5613. * @wmi_handle: wmi handle
  5614. * @param evt_buf: pointer to event buffer
  5615. * @param param: Pointer to hold roam param
  5616. *
  5617. * Return: 0 for success or error code
  5618. */
  5619. static QDF_STATUS extract_vdev_roam_param_non_tlv(wmi_unified_t wmi_handle,
  5620. void *evt_buf,
  5621. wmi_host_roam_event *param)
  5622. {
  5623. wmi_roam_event *evt = (wmi_roam_event *)evt_buf;
  5624. qdf_mem_zero(param, sizeof(*param));
  5625. param->vdev_id = evt->vdev_id;
  5626. param->reason = evt->reason;
  5627. return QDF_STATUS_SUCCESS;
  5628. }
  5629. /**
  5630. * extract_vdev_scan_ev_param_non_tlv() - extract vdev scan param from event
  5631. * @wmi_handle: wmi handle
  5632. * @param evt_buf: pointer to event buffer
  5633. * @param param: Pointer to hold vdev scan param
  5634. *
  5635. * Return: 0 for success or error code
  5636. */
  5637. static QDF_STATUS extract_vdev_scan_ev_param_non_tlv(wmi_unified_t wmi_handle,
  5638. void *evt_buf,
  5639. struct scan_event *param)
  5640. {
  5641. wmi_scan_event *evt = (wmi_scan_event *)evt_buf;
  5642. qdf_mem_zero(param, sizeof(*param));
  5643. switch (evt->event) {
  5644. case WMI_SCAN_EVENT_STARTED:
  5645. param->type = SCAN_EVENT_TYPE_STARTED;
  5646. break;
  5647. case WMI_SCAN_EVENT_COMPLETED:
  5648. param->type = SCAN_EVENT_TYPE_COMPLETED;
  5649. break;
  5650. case WMI_SCAN_EVENT_BSS_CHANNEL:
  5651. param->type = SCAN_EVENT_TYPE_BSS_CHANNEL;
  5652. break;
  5653. case WMI_SCAN_EVENT_FOREIGN_CHANNEL:
  5654. param->type = SCAN_EVENT_TYPE_FOREIGN_CHANNEL;
  5655. break;
  5656. case WMI_SCAN_EVENT_DEQUEUED:
  5657. param->type = SCAN_EVENT_TYPE_DEQUEUED;
  5658. break;
  5659. case WMI_SCAN_EVENT_PREEMPTED:
  5660. param->type = SCAN_EVENT_TYPE_PREEMPTED;
  5661. break;
  5662. case WMI_SCAN_EVENT_START_FAILED:
  5663. param->type = SCAN_EVENT_TYPE_START_FAILED;
  5664. break;
  5665. case WMI_SCAN_EVENT_RESTARTED:
  5666. param->type = SCAN_EVENT_TYPE_RESTARTED;
  5667. break;
  5668. case WMI_HOST_SCAN_EVENT_FOREIGN_CHANNEL_EXIT:
  5669. param->type = SCAN_EVENT_TYPE_FOREIGN_CHANNEL_EXIT;
  5670. break;
  5671. case WMI_SCAN_EVENT_INVALID:
  5672. param->type = SCAN_EVENT_TYPE_INVALID;
  5673. break;
  5674. case WMI_SCAN_EVENT_MAX:
  5675. default:
  5676. param->type = SCAN_EVENT_TYPE_MAX;
  5677. break;
  5678. };
  5679. switch (evt->reason) {
  5680. case WMI_SCAN_REASON_NONE:
  5681. param->reason = SCAN_REASON_NONE;
  5682. break;
  5683. case WMI_SCAN_REASON_COMPLETED:
  5684. param->reason = SCAN_REASON_COMPLETED;
  5685. break;
  5686. case WMI_SCAN_REASON_CANCELLED:
  5687. param->reason = SCAN_REASON_CANCELLED;
  5688. break;
  5689. case WMI_SCAN_REASON_PREEMPTED:
  5690. param->reason = SCAN_REASON_PREEMPTED;
  5691. break;
  5692. case WMI_SCAN_REASON_TIMEDOUT:
  5693. param->reason = SCAN_REASON_TIMEDOUT;
  5694. break;
  5695. case WMI_SCAN_REASON_INTERNAL_FAILURE:
  5696. param->reason = SCAN_REASON_INTERNAL_FAILURE;
  5697. break;
  5698. case WMI_SCAN_REASON_MAX:
  5699. default:
  5700. param->reason = SCAN_REASON_MAX;
  5701. break;
  5702. };
  5703. param->chan_freq = evt->channel_freq;
  5704. param->requester = evt->requestor;
  5705. param->scan_id = evt->scan_id;
  5706. param->vdev_id = evt->vdev_id;
  5707. return QDF_STATUS_SUCCESS;
  5708. }
  5709. /**
  5710. * extract_mu_ev_param_non_tlv() - extract mu param from event
  5711. * @wmi_handle: wmi handle
  5712. * @param evt_buf: pointer to event buffer
  5713. * @param param: Pointer to hold mu report
  5714. *
  5715. * Return: 0 for success or error code
  5716. */
  5717. static QDF_STATUS extract_mu_ev_param_non_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  5718. wmi_host_mu_report_event *param)
  5719. {
  5720. wmi_mu_report_event *event = (wmi_mu_report_event *)evt_buf;
  5721. param->mu_request_id = event->mu_request_id;
  5722. param->status_reason = event->status_reason;
  5723. qdf_mem_copy(param->total_mu, event->total_mu, sizeof(param->total_mu));
  5724. param->num_active_bssid = event->num_active_bssid;
  5725. qdf_mem_copy(param->hidden_node_mu, event->hidden_node_mu,
  5726. sizeof(param->hidden_node_mu));
  5727. param->num_TA_entries = event->num_TA_entries;
  5728. return QDF_STATUS_SUCCESS;
  5729. }
  5730. /**
  5731. * extract_mu_db_entry_non_tlv() - extract mu db entry from event
  5732. * @wmi_handle: wmi handle
  5733. * @param evt_buf: pointer to event buffer
  5734. * @param profile_data: Pointer to hold mu_db_entry
  5735. *
  5736. * Return: 0 for success or error code
  5737. */
  5738. static QDF_STATUS extract_mu_db_entry_non_tlv(wmi_unified_t wmi_handle,
  5739. void *evt_buf, uint8_t idx,
  5740. wmi_host_mu_db_entry *db_entry)
  5741. {
  5742. wmi_mu_report_event *event = (wmi_mu_report_event *)evt_buf;
  5743. if (idx > event->num_TA_entries)
  5744. return QDF_STATUS_E_INVAL;
  5745. qdf_mem_copy(db_entry, &event->mu_entry[idx],
  5746. sizeof(wmi_host_mu_db_entry));
  5747. return QDF_STATUS_SUCCESS;
  5748. }
  5749. /**
  5750. * extract_mumimo_tx_count_ev_param_non_tlv() - extract mumimo tx count from event
  5751. * @wmi_handle: wmi handle
  5752. * @param evt_buf: pointer to event buffer
  5753. * @param param: Pointer to hold mu report
  5754. *
  5755. * Return: 0 for success or error code
  5756. */
  5757. static QDF_STATUS extract_mumimo_tx_count_ev_param_non_tlv(wmi_unified_t wmi_handle,
  5758. void *evt_buf, wmi_host_peer_txmu_cnt_event *param)
  5759. {
  5760. wmi_peer_txmu_cnt_event *event = (wmi_peer_txmu_cnt_event *)evt_buf;
  5761. param->tx_mu_transmitted = event->tx_mu_transmitted;
  5762. return QDF_STATUS_SUCCESS;
  5763. }
  5764. /**
  5765. * extract_peer_gid_userpos_list_ev_param_non_tlv() - extract gid user position
  5766. * from event
  5767. * @wmi_handle: wmi handle
  5768. * @param evt_buf: pointer to event buffer
  5769. * @param param: Pointer to hold peer user position list
  5770. *
  5771. * Return: 0 for success or error code
  5772. */
  5773. static QDF_STATUS extract_peer_gid_userpos_list_ev_param_non_tlv(
  5774. wmi_unified_t wmi_handle,
  5775. void *evt_buf,
  5776. wmi_host_peer_gid_userpos_list_event *param)
  5777. {
  5778. wmi_peer_gid_userpos_list_event *event =
  5779. (wmi_peer_gid_userpos_list_event *)evt_buf;
  5780. qdf_mem_copy(param->usr_list, event->usr_list, sizeof(param->usr_list));
  5781. return QDF_STATUS_SUCCESS;
  5782. }
  5783. /**
  5784. * extract_pdev_caldata_version_check_ev_param_non_tlv() - extract caldata from event
  5785. * @wmi_handle: wmi handle
  5786. * @param evt_buf: pointer to event buffer
  5787. * @param param: Pointer to hold peer caldata version data
  5788. *
  5789. * Return: 0 for success or error code
  5790. */
  5791. static QDF_STATUS extract_pdev_caldata_version_check_ev_param_non_tlv(
  5792. wmi_unified_t wmi_handle,
  5793. void *evt_buf,
  5794. wmi_host_pdev_check_cal_version_event *param)
  5795. {
  5796. wmi_pdev_check_cal_version_event *event =
  5797. (wmi_pdev_check_cal_version_event *)evt_buf;
  5798. param->software_cal_version = event->software_cal_version;
  5799. param->board_cal_version = event->board_cal_version;
  5800. param->cal_ok = event->cal_ok;
  5801. if (event->board_mcn_detail[WMI_BOARD_MCN_STRING_MAX_SIZE] != '\0')
  5802. event->board_mcn_detail[WMI_BOARD_MCN_STRING_MAX_SIZE] = '\0';
  5803. WMI_HOST_IF_MSG_COPY_CHAR_ARRAY(param->board_mcn_detail,
  5804. event->board_mcn_detail, WMI_BOARD_MCN_STRING_BUF_SIZE);
  5805. return QDF_STATUS_SUCCESS;
  5806. }
  5807. /**
  5808. * extract_pdev_tpc_config_ev_param_non_tlv() - extract pdev tpc configuration
  5809. * param from event
  5810. * @wmi_handle: wmi handle
  5811. * @param evt_buf: pointer to event buffer
  5812. * @param param: Pointer to hold tpc configuration
  5813. *
  5814. * Return: 0 for success or error code
  5815. */
  5816. static QDF_STATUS extract_pdev_tpc_config_ev_param_non_tlv(wmi_unified_t wmi_handle,
  5817. void *evt_buf,
  5818. wmi_host_pdev_tpc_config_event *param)
  5819. {
  5820. wmi_pdev_tpc_config_event *event = (wmi_pdev_tpc_config_event *)evt_buf;
  5821. param->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  5822. param->regDomain = event->regDomain;
  5823. param->chanFreq = event->chanFreq;
  5824. param->phyMode = event->phyMode;
  5825. param->twiceAntennaReduction = event->twiceAntennaReduction;
  5826. param->twiceMaxRDPower = event->twiceMaxRDPower;
  5827. param->powerLimit = event->powerLimit;
  5828. param->rateMax = event->rateMax;
  5829. param->numTxChain = event->numTxChain;
  5830. param->ctl = event->ctl;
  5831. param->flags = event->flags;
  5832. qdf_mem_copy(param->maxRegAllowedPower, event->maxRegAllowedPower,
  5833. sizeof(param->maxRegAllowedPower));
  5834. qdf_mem_copy(param->maxRegAllowedPowerAGCDD,
  5835. event->maxRegAllowedPowerAGCDD,
  5836. sizeof(param->maxRegAllowedPowerAGCDD));
  5837. qdf_mem_copy(param->maxRegAllowedPowerAGSTBC,
  5838. event->maxRegAllowedPowerAGSTBC,
  5839. sizeof(param->maxRegAllowedPowerAGSTBC));
  5840. qdf_mem_copy(param->maxRegAllowedPowerAGTXBF,
  5841. event->maxRegAllowedPowerAGTXBF,
  5842. sizeof(param->maxRegAllowedPowerAGTXBF));
  5843. qdf_mem_copy(param->ratesArray, event->ratesArray,
  5844. sizeof(param->ratesArray));
  5845. return QDF_STATUS_SUCCESS;
  5846. }
  5847. /**
  5848. * extract_nfcal_power_ev_param_non_tlv() - extract noise floor calibration
  5849. * power param from event
  5850. * @wmi_handle: wmi handle
  5851. * @param evt_buf: pointer to event buffer
  5852. * @param param: Pointer to hold nf cal power param
  5853. *
  5854. * Return: 0 for success or error code
  5855. */
  5856. static QDF_STATUS extract_nfcal_power_ev_param_non_tlv(wmi_unified_t wmi_handle,
  5857. void *evt_buf,
  5858. wmi_host_pdev_nfcal_power_all_channels_event *param)
  5859. {
  5860. wmi_pdev_nfcal_power_all_channels_event *event =
  5861. (wmi_pdev_nfcal_power_all_channels_event *)evt_buf;
  5862. if ((sizeof(event->nfdBr) == sizeof(param->nfdbr)) &&
  5863. (sizeof(event->nfdBm) == sizeof(param->nfdbm)) &&
  5864. (sizeof(event->freqNum) == sizeof(param->freqnum))) {
  5865. qdf_mem_copy(param->nfdbr, event->nfdBr, sizeof(param->nfdbr));
  5866. qdf_mem_copy(param->nfdbm, event->nfdBm, sizeof(param->nfdbm));
  5867. qdf_mem_copy(param->freqnum, event->freqNum,
  5868. sizeof(param->freqnum));
  5869. } else {
  5870. WMI_LOGE("%s: %d Failed copy out of bound memory!\n", __func__, __LINE__);
  5871. return QDF_STATUS_E_RESOURCES;
  5872. }
  5873. param->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  5874. return QDF_STATUS_SUCCESS;
  5875. }
  5876. /**
  5877. * extract_pdev_tpc_ev_param_non_tlv() - extract tpc param from event
  5878. * @wmi_handle: wmi handle
  5879. * @param evt_buf: pointer to event buffer
  5880. * @param param: Pointer to hold tpc param
  5881. *
  5882. * Return: 0 for success or error code
  5883. */
  5884. static QDF_STATUS extract_pdev_tpc_ev_param_non_tlv(wmi_unified_t wmi_handle,
  5885. void *evt_buf,
  5886. wmi_host_pdev_tpc_event *param)
  5887. {
  5888. wmi_pdev_tpc_event *event = (wmi_pdev_tpc_event *)evt_buf;
  5889. qdf_mem_copy(param->tpc, event->tpc, sizeof(param->tpc));
  5890. param->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  5891. return QDF_STATUS_SUCCESS;
  5892. }
  5893. /**
  5894. * extract_pdev_generic_buffer_ev_param_non_tlv() - extract pdev generic buffer
  5895. * from event
  5896. * @wmi_handle: wmi handle
  5897. * @param evt_buf: pointer to event buffer
  5898. * @param param: Pointer to generic buffer param
  5899. *
  5900. * Return: 0 for success or error code
  5901. */
  5902. static QDF_STATUS extract_pdev_generic_buffer_ev_param_non_tlv(
  5903. wmi_unified_t wmi_handle, void *evt_buf,
  5904. wmi_host_pdev_generic_buffer_event *param)
  5905. {
  5906. wmi_pdev_generic_buffer_event *event =
  5907. (wmi_pdev_generic_buffer_event *)evt_buf;
  5908. param->buf_type = event->buf_type;
  5909. param->frag_id = event->frag_id;
  5910. param->more_frag = event->more_frag;
  5911. param->buf_len = event->buf_len;
  5912. qdf_mem_copy(param->buf_info, event->buf_info, event->buf_len);
  5913. return QDF_STATUS_SUCCESS;
  5914. }
  5915. /**
  5916. * extract_gpio_input_ev_param_non_tlv() - extract gpio input param from event
  5917. * @wmi_handle: wmi handle
  5918. * @param evt_buf: pointer to event buffer
  5919. * @param gpio_num: Pointer to hold gpio number
  5920. *
  5921. * Return: 0 for success or error code
  5922. */
  5923. static QDF_STATUS extract_gpio_input_ev_param_non_tlv(wmi_unified_t wmi_handle,
  5924. void *evt_buf, uint32_t *gpio_num)
  5925. {
  5926. wmi_gpio_input_event *ev = (wmi_gpio_input_event *) evt_buf;
  5927. *gpio_num = ev->gpio_num;
  5928. return QDF_STATUS_SUCCESS;
  5929. }
  5930. /**
  5931. * extract_pdev_reserve_ast_ev_param_non_tlv() - extract reserve ast entry
  5932. * param from event
  5933. * @wmi_handle: wmi handle
  5934. * @param evt_buf: pointer to event buffer
  5935. * @param result: Pointer to hold reserve ast entry param
  5936. *
  5937. * Return: 0 for success or error code
  5938. */
  5939. static QDF_STATUS extract_pdev_reserve_ast_ev_param_non_tlv(
  5940. wmi_unified_t wmi_handle,
  5941. void *evt_buf, struct wmi_host_proxy_ast_reserve_param *param)
  5942. {
  5943. wmi_pdev_reserve_ast_entry_event *ev =
  5944. (wmi_pdev_reserve_ast_entry_event *) evt_buf;
  5945. param->result = ev->result;
  5946. param->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  5947. return QDF_STATUS_SUCCESS;
  5948. }
  5949. /**
  5950. * extract_swba_num_vdevs_non_tlv() - extract swba num vdevs from event
  5951. * @wmi_handle: wmi handle
  5952. * @param evt_buf: pointer to event buffer
  5953. * @param num_vdevs: Pointer to hold num vdevs
  5954. *
  5955. * Return: 0 for success or error code
  5956. */
  5957. static QDF_STATUS extract_swba_num_vdevs_non_tlv(wmi_unified_t wmi_handle,
  5958. void *evt_buf,
  5959. uint32_t *num_vdevs)
  5960. {
  5961. wmi_host_swba_event *swba_event = (wmi_host_swba_event *)evt_buf;
  5962. uint32_t vdev_map;
  5963. vdev_map = swba_event->vdev_map;
  5964. *num_vdevs = wmi_vdev_map_to_num_vdevs(vdev_map);
  5965. return QDF_STATUS_SUCCESS;
  5966. }
  5967. /**
  5968. * extract_swba_tim_info_non_tlv() - extract swba tim info from event
  5969. * @wmi_handle: wmi handle
  5970. * @param evt_buf: pointer to event buffer
  5971. * @param idx: Index to bcn info
  5972. * @param tim_info: Pointer to hold tim info
  5973. *
  5974. * Return: 0 for success or error code
  5975. */
  5976. static QDF_STATUS extract_swba_tim_info_non_tlv(wmi_unified_t wmi_handle,
  5977. void *evt_buf,
  5978. uint32_t idx, wmi_host_tim_info *tim_info)
  5979. {
  5980. wmi_host_swba_event *swba_event = (wmi_host_swba_event *)evt_buf;
  5981. wmi_bcn_info *bcn_info;
  5982. uint32_t vdev_map;
  5983. bcn_info = &swba_event->bcn_info[idx];
  5984. vdev_map = swba_event->vdev_map;
  5985. tim_info->vdev_id = wmi_vdev_map_to_vdev_id(vdev_map, idx);
  5986. if (tim_info->vdev_id == WLAN_INVALID_VDEV_ID)
  5987. return QDF_STATUS_E_INVAL;
  5988. tim_info->tim_len = bcn_info->tim_info.tim_len;
  5989. tim_info->tim_mcast = bcn_info->tim_info.tim_mcast;
  5990. qdf_mem_copy(tim_info->tim_bitmap, bcn_info->tim_info.tim_bitmap,
  5991. (sizeof(uint32_t) * WMI_TIM_BITMAP_ARRAY_SIZE));
  5992. tim_info->tim_changed = bcn_info->tim_info.tim_changed;
  5993. tim_info->tim_num_ps_pending = bcn_info->tim_info.tim_num_ps_pending;
  5994. return QDF_STATUS_SUCCESS;
  5995. }
  5996. /**
  5997. * extract_swba_noa_info_non_tlv() - extract swba NoA information from event
  5998. * @wmi_handle: wmi handle
  5999. * @param evt_buf: pointer to event buffer
  6000. * @param idx: Index to bcn info
  6001. * @param p2p_desc: Pointer to hold p2p NoA info
  6002. *
  6003. * Return: 0 for success or error code
  6004. */
  6005. static QDF_STATUS extract_swba_noa_info_non_tlv(wmi_unified_t wmi_handle,
  6006. void *evt_buf,
  6007. uint32_t idx, wmi_host_p2p_noa_info *p2p_desc)
  6008. {
  6009. wmi_host_swba_event *swba_event = (wmi_host_swba_event *)evt_buf;
  6010. wmi_p2p_noa_info *p2p_noa_info;
  6011. wmi_bcn_info *bcn_info;
  6012. uint8_t i = 0;
  6013. uint32_t vdev_map;
  6014. bcn_info = &swba_event->bcn_info[idx];
  6015. vdev_map = swba_event->vdev_map;
  6016. p2p_noa_info = &bcn_info->p2p_noa_info;
  6017. p2p_desc->vdev_id = wmi_vdev_map_to_vdev_id(vdev_map, idx);
  6018. if (p2p_desc->vdev_id == WLAN_INVALID_VDEV_ID)
  6019. return QDF_STATUS_E_INVAL;
  6020. p2p_desc->modified = false;
  6021. p2p_desc->num_descriptors = 0;
  6022. if (WMI_UNIFIED_NOA_ATTR_IS_MODIFIED(p2p_noa_info)) {
  6023. p2p_desc->modified = true;
  6024. p2p_desc->index =
  6025. (uint8_t) WMI_UNIFIED_NOA_ATTR_INDEX_GET(p2p_noa_info);
  6026. p2p_desc->oppPS =
  6027. (uint8_t) WMI_UNIFIED_NOA_ATTR_OPP_PS_GET(p2p_noa_info);
  6028. p2p_desc->ctwindow =
  6029. (uint8_t) WMI_UNIFIED_NOA_ATTR_CTWIN_GET(p2p_noa_info);
  6030. p2p_desc->num_descriptors =
  6031. (uint8_t) WMI_UNIFIED_NOA_ATTR_NUM_DESC_GET(p2p_noa_info);
  6032. for (i = 0; i < p2p_desc->num_descriptors; i++) {
  6033. p2p_desc->noa_descriptors[i].type_count =
  6034. (uint8_t) p2p_noa_info->noa_descriptors[i].
  6035. type_count;
  6036. p2p_desc->noa_descriptors[i].duration =
  6037. p2p_noa_info->noa_descriptors[i].duration;
  6038. p2p_desc->noa_descriptors[i].interval =
  6039. p2p_noa_info->noa_descriptors[i].interval;
  6040. p2p_desc->noa_descriptors[i].start_time =
  6041. p2p_noa_info->noa_descriptors[i].start_time;
  6042. }
  6043. }
  6044. return QDF_STATUS_SUCCESS;
  6045. }
  6046. /**
  6047. * extract_peer_sta_ps_statechange_ev_non_tlv() - extract peer sta ps state
  6048. * from event
  6049. * @wmi_handle: wmi handle
  6050. * @param evt_buf: pointer to event buffer
  6051. * @param ev: Pointer to hold peer param and ps state
  6052. *
  6053. * Return: 0 for success or error code
  6054. */
  6055. static QDF_STATUS extract_peer_sta_ps_statechange_ev_non_tlv(wmi_unified_t wmi_handle,
  6056. void *evt_buf, wmi_host_peer_sta_ps_statechange_event *ev)
  6057. {
  6058. wmi_peer_sta_ps_statechange_event *event =
  6059. (wmi_peer_sta_ps_statechange_event *)evt_buf;
  6060. WMI_MAC_ADDR_TO_CHAR_ARRAY(&event->peer_macaddr, ev->peer_macaddr);
  6061. ev->peer_ps_state = event->peer_ps_state;
  6062. return QDF_STATUS_SUCCESS;
  6063. }
  6064. /**
  6065. * extract_peer_sta_kickout_ev_non_tlv() - extract peer sta kickout event
  6066. * @wmi_handle: wmi handle
  6067. * @param evt_buf: pointer to event buffer
  6068. * @param ev: Pointer to hold peer param
  6069. *
  6070. * Return: 0 for success or error code
  6071. */
  6072. static QDF_STATUS extract_peer_sta_kickout_ev_non_tlv(wmi_unified_t wmi_handle,
  6073. void *evt_buf,
  6074. wmi_host_peer_sta_kickout_event *ev)
  6075. {
  6076. wmi_peer_sta_kickout_event *kickout_event =
  6077. (wmi_peer_sta_kickout_event *)evt_buf;
  6078. WMI_MAC_ADDR_TO_CHAR_ARRAY(&kickout_event->peer_macaddr,
  6079. ev->peer_macaddr);
  6080. /**Following not available in legacy wmi*/
  6081. ev->reason = 0;
  6082. ev->rssi = 0;
  6083. return QDF_STATUS_SUCCESS;
  6084. }
  6085. /**
  6086. * extract_peer_ratecode_list_ev_non_tlv() - extract peer ratecode from event
  6087. * @wmi_handle: wmi handle
  6088. * @param evt_buf: pointer to event buffer
  6089. * @param peer_mac: Pointer to hold peer mac address
  6090. * @param rate_cap: Pointer to hold ratecode
  6091. *
  6092. * Return: 0 for success or error code
  6093. */
  6094. static QDF_STATUS extract_peer_ratecode_list_ev_non_tlv(wmi_unified_t wmi_handle,
  6095. void *evt_buf,
  6096. uint8_t *peer_mac, wmi_sa_rate_cap *rate_cap)
  6097. {
  6098. wmi_peer_ratecode_list_event_t *rate_event =
  6099. (wmi_peer_ratecode_list_event_t *)evt_buf;
  6100. int i, htindex, j;
  6101. uint8_t shift = 0;
  6102. WMI_MAC_ADDR_TO_CHAR_ARRAY(&rate_event->peer_macaddr, peer_mac);
  6103. htindex = 0;
  6104. rate_cap->ratecount[0] =
  6105. ((rate_event->peer_rate_info.ratecount) & SA_MASK_BYTE);
  6106. rate_cap->ratecount[1] =
  6107. ((rate_event->peer_rate_info.ratecount >> 8) & SA_MASK_BYTE);
  6108. rate_cap->ratecount[2] =
  6109. ((rate_event->peer_rate_info.ratecount >> 16) & SA_MASK_BYTE);
  6110. rate_cap->ratecount[3] =
  6111. ((rate_event->peer_rate_info.ratecount >> 24) & SA_MASK_BYTE);
  6112. if (rate_cap->ratecount[0]) {
  6113. for (i = 0; i < SA_MAX_LEGACY_RATE_DWORDS; i++) {
  6114. for (j = 0; j < SA_BYTES_IN_DWORD; j++) {
  6115. rate_cap->ratecode_legacy[htindex] =
  6116. ((rate_event->peer_rate_info.ratecode_legacy[i]
  6117. >> (8*j)) & SA_MASK_BYTE);
  6118. htindex++;
  6119. }
  6120. }
  6121. }
  6122. htindex = 0;
  6123. for (i = 0; i < SA_MAX_HT_RATE_DWORDS; i++) {
  6124. for (j = 0; j < SA_BYTES_IN_DWORD; j++) {
  6125. shift = (8*j);
  6126. rate_cap->ratecode_20[htindex] =
  6127. ((rate_event->peer_rate_info.ratecode_20[i]
  6128. >> (shift)) & SA_MASK_BYTE);
  6129. rate_cap->ratecode_40[htindex] =
  6130. ((rate_event->peer_rate_info.ratecode_40[i]
  6131. >> (shift)) & SA_MASK_BYTE);
  6132. rate_cap->ratecode_80[htindex] =
  6133. ((rate_event->peer_rate_info.ratecode_80[i]
  6134. >> (shift)) & SA_MASK_BYTE);
  6135. htindex++;
  6136. }
  6137. }
  6138. return QDF_STATUS_SUCCESS;
  6139. }
  6140. /**
  6141. * extract_rtt_header_internal_non_tlv() - extract internal rtt header from
  6142. * event
  6143. * @param ev: pointer to internal rtt event header
  6144. * @param hdr: Pointer to received rtt event header
  6145. *
  6146. * Return: None
  6147. */
  6148. static void extract_rtt_header_internal_non_tlv(wmi_host_rtt_event_hdr *ev,
  6149. wmi_rtt_event_hdr *hdr)
  6150. {
  6151. ev->req_id = WMI_RTT_REQ_ID_GET(hdr->req_id);
  6152. ev->result = (hdr->req_id & 0xffff0000) >> 16;
  6153. ev->meas_type = WMI_RTT_REPORT_MEAS_TYPE_GET(hdr->req_id);
  6154. ev->report_type = WMI_RTT_REPORT_REPORT_TYPE_GET(hdr->req_id);
  6155. ev->v3_status = WMI_RTT_REPORT_V3_STATUS_GET(hdr->req_id);
  6156. ev->v3_finish = WMI_RTT_REPORT_V3_FINISH_GET(hdr->req_id);
  6157. ev->v3_tm_start = WMI_RTT_REPORT_V3_TM_START_GET(hdr->req_id);
  6158. ev->num_ap = WMI_RTT_REPORT_NUM_AP_GET(hdr->req_id);
  6159. WMI_MAC_ADDR_TO_CHAR_ARRAY(&hdr->dest_mac, ev->dest_mac);
  6160. }
  6161. /**
  6162. * extract_rtt_error_report_ev_non_tlv() - extract rtt error report from event
  6163. * @wmi_handle: wmi handle
  6164. * @param evt_buf: pointer to event buffer
  6165. * @param wds_ev: Pointer to hold rtt error report
  6166. *
  6167. * Return: 0 for success or error code
  6168. */
  6169. static QDF_STATUS extract_rtt_error_report_ev_non_tlv(wmi_unified_t wmi_handle,
  6170. void *evt_buf,
  6171. wmi_host_rtt_error_report_event *ev)
  6172. {
  6173. wmi_rtt_error_report_event *error_report =
  6174. (wmi_rtt_error_report_event *) evt_buf;
  6175. extract_rtt_header_internal_non_tlv(&ev->hdr, &error_report->header);
  6176. ev->reject_reason = error_report->reject_reason;
  6177. return QDF_STATUS_SUCCESS;
  6178. }
  6179. /**
  6180. * extract_rtt_hdr_non_tlv() - extract rtt header from event
  6181. * @wmi_handle: wmi handle
  6182. * @param evt_buf: pointer to event buffer
  6183. * @param ev: Pointer to hold rtt header
  6184. *
  6185. * Return: 0 for success or error code
  6186. */
  6187. static QDF_STATUS extract_rtt_hdr_non_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  6188. wmi_host_rtt_event_hdr *ev)
  6189. {
  6190. wmi_rtt_event_hdr *hdr = (wmi_rtt_event_hdr *) evt_buf;
  6191. extract_rtt_header_internal_non_tlv(ev, hdr);
  6192. return QDF_STATUS_SUCCESS;
  6193. }
  6194. /**
  6195. * copy_rtt_report_cfr
  6196. * @ev: pointer to destination event pointer
  6197. * @report_type: report type recieved in event
  6198. * @p: pointer to event data
  6199. * @hdump: pointer to destination buffer
  6200. * @hdump_len: length of dest buffer
  6201. *
  6202. * Return: Pointer to current offset in p
  6203. */
  6204. static uint8_t *copy_rtt_report_cfr(wmi_host_rtt_meas_event *ev,
  6205. uint8_t report_type, uint8_t *p,
  6206. uint8_t *hdump, int16_t hdump_len)
  6207. {
  6208. uint8_t index, i;
  6209. uint8_t *tmp, *temp1, *temp2;
  6210. #define TONE_LEGACY_20M 53
  6211. #define TONE_VHT_20M 56
  6212. #define TONE_VHT_40M 117
  6213. #define TONE_VHT_80M 242
  6214. int tone_number[4] = {
  6215. TONE_LEGACY_20M, TONE_VHT_20M, TONE_VHT_40M, TONE_VHT_80M};
  6216. #define MEM_ALIGN(x) ((((x)<<1)+3) & 0xFFFC)
  6217. /* the buffer size of 1 chain for each BW 0-3 */
  6218. u_int16_t bw_size[4] = {
  6219. MEM_ALIGN(TONE_LEGACY_20M),
  6220. MEM_ALIGN(TONE_VHT_20M),
  6221. MEM_ALIGN(TONE_VHT_40M),
  6222. MEM_ALIGN(TONE_VHT_80M)
  6223. };
  6224. if (hdump == NULL) {
  6225. qdf_print("Destination buffer is NULL\n");
  6226. return p;
  6227. }
  6228. temp1 = temp2 = hdump;
  6229. for (index = 0; index < 4; index++) {
  6230. if (ev->chain_mask & (1 << index)) {
  6231. if (index == 0)
  6232. ev->rssi0 = *((u_int32_t *)p);
  6233. if (index == 1)
  6234. ev->rssi1 = *((u_int32_t *)p);
  6235. if (index == 2)
  6236. ev->rssi2 = *((u_int32_t *)p);
  6237. if (index == 3)
  6238. ev->rssi3 = *((u_int32_t *)p);
  6239. p += sizeof(u_int32_t);
  6240. if (report_type == WMI_RTT_REPORT_CFR) {
  6241. tmp = p + bw_size[ev->bw];
  6242. ev->txrxchain_mask = tone_number[ev->bw];
  6243. temp2 = temp2 + bw_size[ev->bw];
  6244. for (i = 0; (i < tone_number[ev->bw]); i++) {
  6245. qdf_mem_copy(temp1, p, 2);
  6246. temp1 += 2;
  6247. p += 2;
  6248. hdump_len -= 2;
  6249. if (hdump_len <= 0)
  6250. break;
  6251. }
  6252. temp1 = temp2;
  6253. p = tmp;
  6254. }
  6255. }
  6256. }
  6257. return p;
  6258. }
  6259. /**
  6260. * extract_rtt_ev_non_tlv() - extract rtt event
  6261. * @wmi_handle: wmi handle
  6262. * @param evt_buf: Pointer to event buffer
  6263. * @param ev: Pointer to hold rtt event
  6264. * @param hdump: Pointer to hold hex dump
  6265. * @param hdump_len: hex dump length
  6266. *
  6267. * Return: 0 for success or error code
  6268. */
  6269. static QDF_STATUS extract_rtt_ev_non_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  6270. wmi_host_rtt_meas_event *ev, uint8_t *hdump, uint16_t h_len)
  6271. {
  6272. wmi_rtt_meas_event *body = (wmi_rtt_meas_event *) evt_buf;
  6273. uint8_t meas_type, report_type;
  6274. uint8_t *p;
  6275. int16_t hdump_len = h_len;
  6276. A_TIME64 *time;
  6277. if (body) {
  6278. meas_type = WMI_RTT_REPORT_MEAS_TYPE_GET(body->header.req_id);
  6279. report_type =
  6280. WMI_RTT_REPORT_REPORT_TYPE_GET(body->header.req_id);
  6281. ev->chain_mask = WMI_RTT_REPORT_RX_CHAIN_GET(body->rx_chain);
  6282. ev->bw = WMI_RTT_REPORT_RX_BW_GET(body->rx_chain);
  6283. /* If report type is not WMI_RTT_REPORT_CFR */
  6284. ev->txrxchain_mask = 0;
  6285. ev->tod = ((u_int64_t) body->tod.time32) << 32;
  6286. ev->tod |= body->tod.time0; /*tmp1 is the 64 bit tod*/
  6287. ev->toa = ((u_int64_t) body->toa.time32) << 32;
  6288. ev->toa |= body->toa.time0;
  6289. p = (u_int8_t *) (++body);
  6290. /* if the measurement is TMR, we should have T3 and T4 */
  6291. if (meas_type == RTT_MEAS_FRAME_TMR) {
  6292. time = (A_TIME64 *) body;
  6293. ev->t3 = (u_int64_t) (time->time32) << 32;
  6294. ev->t3 |= time->time0;
  6295. time++;
  6296. ev->t4 = (u_int64_t)(time->time32) << 32;
  6297. ev->t4 |= time->time0;
  6298. p = (u_int8_t *) (++time);
  6299. } else {
  6300. ev->t3 = 0;
  6301. ev->t4 = 0;
  6302. }
  6303. ev->rssi0 = 0;
  6304. ev->rssi1 = 0;
  6305. ev->rssi2 = 0;
  6306. ev->rssi3 = 0;
  6307. p = copy_rtt_report_cfr(ev, report_type, p, hdump, hdump_len);
  6308. } else {
  6309. qdf_print("Error!body is NULL\n");
  6310. return QDF_STATUS_E_FAILURE;
  6311. }
  6312. return QDF_STATUS_SUCCESS;
  6313. }
  6314. /**
  6315. * extract_thermal_stats_non_tlv() - extract thermal stats from event
  6316. * @wmi_handle: wmi handle
  6317. * @param evt_buf: Pointer to event buffer
  6318. * @param temp: Pointer to hold extracted temperature
  6319. * @param level: Pointer to hold extracted level
  6320. *
  6321. * Return: 0 for success or error code
  6322. */
  6323. static QDF_STATUS extract_thermal_stats_non_tlv(wmi_unified_t wmi_handle,
  6324. void *evt_buf,
  6325. uint32_t *temp, uint32_t *level, uint32_t *pdev_id)
  6326. {
  6327. tt_stats_t *tt_stats_event = NULL;
  6328. tt_stats_event = (tt_stats_t *) evt_buf;
  6329. *pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  6330. *temp = tt_stats_event->temp;
  6331. *level = tt_stats_event->level;
  6332. return QDF_STATUS_SUCCESS;
  6333. }
  6334. /**
  6335. * extract_thermal_level_stats_non_tlv() - extract thermal level stats from
  6336. * event
  6337. * @wmi_handle: wmi handle
  6338. * @param evt_buf: pointer to event buffer
  6339. * @param idx: Index to level stats
  6340. * @param levelcount: Pointer to hold levelcount
  6341. * @param dccount: Pointer to hold dccount
  6342. *
  6343. * Return: 0 for success or error code
  6344. */
  6345. static QDF_STATUS extract_thermal_level_stats_non_tlv(wmi_unified_t wmi_handle,
  6346. void *evt_buf,
  6347. uint8_t idx, uint32_t *levelcount, uint32_t *dccount)
  6348. {
  6349. tt_stats_t *tt_stats_event = NULL;
  6350. tt_stats_event = (tt_stats_t *) evt_buf;
  6351. if (idx < TT_LEVELS) {
  6352. *levelcount = tt_stats_event->levstats[idx].levelcount;
  6353. *dccount = tt_stats_event->levstats[idx].dccount;
  6354. return QDF_STATUS_SUCCESS;
  6355. }
  6356. return QDF_STATUS_E_FAILURE;
  6357. }
  6358. /**
  6359. * extract_comb_phyerr_non_tlv() - extract comb phy error from event
  6360. * @wmi_handle: wmi handle
  6361. * @param evt_buf: pointer to event buffer
  6362. * @param datalen: data length of event buffer
  6363. * @param buf_offset: Pointer to hold value of current event buffer offset
  6364. * post extraction
  6365. * @param phyer: Pointer to hold phyerr
  6366. *
  6367. * Return: 0 for success or error code
  6368. */
  6369. static QDF_STATUS extract_comb_phyerr_non_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  6370. uint16_t datalen, uint16_t *buf_offset,
  6371. wmi_host_phyerr_t *phyerr)
  6372. {
  6373. wmi_comb_phyerr_rx_event *pe;
  6374. #if ATH_PHYERR_DEBUG
  6375. int i;
  6376. #endif /* ATH_PHYERR_DEBUG */
  6377. uint8_t *data;
  6378. data = (uint8_t *) evt_buf;
  6379. #if ATH_PHYERR_DEBUG
  6380. qdf_print("%s: data=%pK, datalen=%d\n", __func__, data, datalen);
  6381. /* XXX for now */
  6382. for (i = 0; i < datalen; i++) {
  6383. qdf_print("%02X ", data[i]);
  6384. if (i % 32 == 31)
  6385. qdf_print("\n");
  6386. }
  6387. qdf_print("\n");
  6388. #endif /* ATH_PHYERR_DEBUG */
  6389. /* Ensure it's at least the size of the header */
  6390. if (datalen < sizeof(*pe)) {
  6391. return QDF_STATUS_E_FAILURE;
  6392. /* XXX what should errors be? */
  6393. }
  6394. pe = (wmi_comb_phyerr_rx_event *) data;
  6395. #if ATH_PHYERR_DEBUG
  6396. qdf_print("%s: pe->hdr.num_phyerr_events=%d\n",
  6397. __func__,
  6398. pe->hdr.num_phyerr_events);
  6399. #endif /* ATH_PHYERR_DEBUG */
  6400. /*
  6401. * Reconstruct the 64 bit event TSF. This isn't from the MAC, it's
  6402. * at the time the event was sent to us, the TSF value will be
  6403. * in the future.
  6404. */
  6405. phyerr->tsf64 = pe->hdr.tsf_l32;
  6406. phyerr->tsf64 |= (((uint64_t) pe->hdr.tsf_u32) << 32);
  6407. *buf_offset = sizeof(pe->hdr);
  6408. phyerr->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  6409. return QDF_STATUS_SUCCESS;
  6410. }
  6411. /**
  6412. * extract_single_phyerr_non_tlv() - extract single phy error from event
  6413. * @wmi_handle: wmi handle
  6414. * @param evt_buf: pointer to event buffer
  6415. * @param datalen: data length of event buffer
  6416. * @param buf_offset: Pointer to hold value of current event buffer offset
  6417. * post extraction
  6418. * @param phyerr: Pointer to hold phyerr
  6419. *
  6420. * Return: 0 for success or error code
  6421. */
  6422. static QDF_STATUS extract_single_phyerr_non_tlv(wmi_unified_t wmi_handle,
  6423. void *evt_buf,
  6424. uint16_t datalen, uint16_t *buf_offset,
  6425. wmi_host_phyerr_t *phyerr)
  6426. {
  6427. wmi_single_phyerr_rx_event *ev;
  6428. #if ATH_PHYERR_DEBUG
  6429. int i;
  6430. #endif /* ATH_PHYERR_DEBUG */
  6431. int n = 0;
  6432. uint8_t *data;
  6433. phyerr->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  6434. n = (int) *buf_offset;
  6435. data = (uint8_t *) evt_buf;
  6436. /* Loop over the bufp, extracting out phyerrors */
  6437. /*
  6438. * XXX wmi_unified_comb_phyerr_rx_event.bufp is a char pointer,
  6439. * which isn't correct here - what we have received here
  6440. * is an array of TLV-style PHY errors.
  6441. */
  6442. if (n < datalen) {
  6443. /* ensure there's at least space for the header */
  6444. if ((datalen - n) < sizeof(ev->hdr)) {
  6445. qdf_print(
  6446. "%s: not enough space? (datalen=%d, n=%d, hdr=%zd bytes\n",
  6447. __func__,
  6448. datalen,
  6449. n,
  6450. sizeof(ev->hdr));
  6451. return QDF_STATUS_SUCCESS;
  6452. }
  6453. /*
  6454. * Obtain a pointer to the beginning of the current event.
  6455. * data[0] is the beginning of the WMI payload.
  6456. */
  6457. ev = (wmi_single_phyerr_rx_event *) &data[n];
  6458. /*
  6459. * Sanity check the buffer length of the event against
  6460. * what we currently have.
  6461. *
  6462. * Since buf_len is 32 bits, we check if it overflows
  6463. * a large 32 bit value. It's not 0x7fffffff because
  6464. * we increase n by (buf_len + sizeof(hdr)), which would
  6465. * in itself cause n to overflow.
  6466. *
  6467. * If "int" is 64 bits then this becomes a moot point.
  6468. */
  6469. if (ev->hdr.buf_len > PHYERROR_MAX_BUFFER_LENGTH) {
  6470. qdf_print("%s: buf_len is garbage? (0x%x\n)\n",
  6471. __func__,
  6472. ev->hdr.buf_len);
  6473. return QDF_STATUS_SUCCESS;
  6474. }
  6475. if (n + ev->hdr.buf_len > datalen) {
  6476. qdf_print("%s: buf_len exceeds available space "
  6477. "(n=%d, buf_len=%d, datalen=%d\n",
  6478. __func__,
  6479. n,
  6480. ev->hdr.buf_len,
  6481. datalen);
  6482. return QDF_STATUS_SUCCESS;
  6483. }
  6484. phyerr->phy_err_code = WMI_UNIFIED_PHYERRCODE_GET(&ev->hdr);
  6485. #if ATH_PHYERR_DEBUG
  6486. qdf_print("%s: len=%d, tsf=0x%08x, rssi = 0x%x/0x%x/0x%x/0x%x, "
  6487. "comb rssi = 0x%x, phycode=%d\n",
  6488. __func__,
  6489. ev->hdr.buf_len,
  6490. ev->hdr.tsf_timestamp,
  6491. ev->hdr.rssi_chain0,
  6492. ev->hdr.rssi_chain1,
  6493. ev->hdr.rssi_chain2,
  6494. ev->hdr.rssi_chain3,
  6495. WMI_UNIFIED_RSSI_COMB_GET(&ev->hdr),
  6496. phyerr->phy_err_code);
  6497. /*
  6498. * For now, unroll this loop - the chain 'value' field isn't
  6499. * a variable but glued together into a macro field definition.
  6500. * Grr. :-)
  6501. */
  6502. qdf_print(
  6503. "%s: chain 0: raw=0x%08x; pri20=%d sec20=%d sec40=%d sec80=%d\n",
  6504. __func__,
  6505. ev->hdr.rssi_chain0,
  6506. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 0, PRI20),
  6507. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 0, SEC20),
  6508. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 0, SEC40),
  6509. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 0, SEC80));
  6510. qdf_print(
  6511. "%s: chain 1: raw=0x%08x: pri20=%d sec20=%d sec40=%d sec80=%d\n",
  6512. __func__,
  6513. ev->hdr.rssi_chain1,
  6514. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 1, PRI20),
  6515. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 1, SEC20),
  6516. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 1, SEC40),
  6517. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 1, SEC80));
  6518. qdf_print(
  6519. "%s: chain 2: raw=0x%08x: pri20=%d sec20=%d sec40=%d sec80=%d\n",
  6520. __func__,
  6521. ev->hdr.rssi_chain2,
  6522. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 2, PRI20),
  6523. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 2, SEC20),
  6524. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 2, SEC40),
  6525. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 2, SEC80));
  6526. qdf_print(
  6527. "%s: chain 3: raw=0x%08x: pri20=%d sec20=%d sec40=%d sec80=%d\n",
  6528. __func__,
  6529. ev->hdr.rssi_chain3,
  6530. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 3, PRI20),
  6531. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 3, SEC20),
  6532. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 3, SEC40),
  6533. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 3, SEC80));
  6534. qdf_print(
  6535. "%s: freq_info_1=0x%08x, freq_info_2=0x%08x\n",
  6536. __func__, ev->hdr.freq_info_1, ev->hdr.freq_info_2);
  6537. /*
  6538. * The NF chain values are signed and are negative - hence
  6539. * the cast evilness.
  6540. */
  6541. qdf_print(
  6542. "%s: nfval[1]=0x%08x, nfval[2]=0x%08x, nf=%d/%d/%d/%d, "
  6543. "freq1=%d, freq2=%d, cw=%d\n",
  6544. __func__,
  6545. ev->hdr.nf_list_1,
  6546. ev->hdr.nf_list_2,
  6547. (int) WMI_UNIFIED_NF_CHAIN_GET(&ev->hdr, 0),
  6548. (int) WMI_UNIFIED_NF_CHAIN_GET(&ev->hdr, 1),
  6549. (int) WMI_UNIFIED_NF_CHAIN_GET(&ev->hdr, 2),
  6550. (int) WMI_UNIFIED_NF_CHAIN_GET(&ev->hdr, 3),
  6551. WMI_UNIFIED_FREQ_INFO_GET(&ev->hdr, 1),
  6552. WMI_UNIFIED_FREQ_INFO_GET(&ev->hdr, 2),
  6553. WMI_UNIFIED_CHWIDTH_GET(&ev->hdr));
  6554. #endif /* ATH_PHYERR_DEBUG */
  6555. #if ATH_SUPPORT_DFS
  6556. /*
  6557. * If required, pass radar events to the dfs pattern matching
  6558. * code.
  6559. *
  6560. * Don't pass radar events with no buffer payload.
  6561. */
  6562. phyerr->tsf_timestamp = ev->hdr.tsf_timestamp;
  6563. phyerr->bufp = &ev->bufp[0];
  6564. phyerr->buf_len = ev->hdr.buf_len;
  6565. #endif /* ATH_SUPPORT_DFS */
  6566. /* populate the rf info */
  6567. phyerr->rf_info.rssi_comb =
  6568. WMI_UNIFIED_RSSI_COMB_GET(&ev->hdr);
  6569. #ifdef WLAN_CONV_SPECTRAL_ENABLE
  6570. /*
  6571. * If required, pass spectral events to the spectral module
  6572. *
  6573. */
  6574. if (phyerr->phy_err_code == WMI_HOST_PHY_ERROR_FALSE_RADAR_EXT
  6575. || phyerr->phy_err_code == WMI_HOST_PHY_ERROR_SPECTRAL_SCAN) {
  6576. if (ev->hdr.buf_len > 0) {
  6577. /* Initialize the NF values to Zero. */
  6578. phyerr->rf_info.noise_floor[0] =
  6579. WMI_UNIFIED_NF_CHAIN_GET(&ev->hdr, 0);
  6580. phyerr->rf_info.noise_floor[1] =
  6581. WMI_UNIFIED_NF_CHAIN_GET(&ev->hdr, 1);
  6582. phyerr->rf_info.noise_floor[2] =
  6583. WMI_UNIFIED_NF_CHAIN_GET(&ev->hdr, 2);
  6584. phyerr->rf_info.noise_floor[3] =
  6585. WMI_UNIFIED_NF_CHAIN_GET(&ev->hdr, 3);
  6586. /* Need to unroll loop due to macro
  6587. * constraints
  6588. * chain 0 */
  6589. phyerr->rf_info.pc_rssi_info[0].rssi_pri20 =
  6590. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 0, PRI20);
  6591. phyerr->rf_info.pc_rssi_info[0].rssi_sec20 =
  6592. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 0, SEC20);
  6593. phyerr->rf_info.pc_rssi_info[0].rssi_sec40 =
  6594. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 0, SEC40);
  6595. phyerr->rf_info.pc_rssi_info[0].rssi_sec80 =
  6596. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 0, SEC80);
  6597. /* chain 1 */
  6598. phyerr->rf_info.pc_rssi_info[1].rssi_pri20 =
  6599. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 1, PRI20);
  6600. phyerr->rf_info.pc_rssi_info[1].rssi_sec20 =
  6601. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 1, SEC20);
  6602. phyerr->rf_info.pc_rssi_info[1].rssi_sec40 =
  6603. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 1, SEC40);
  6604. phyerr->rf_info.pc_rssi_info[1].rssi_sec80 =
  6605. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 1, SEC80);
  6606. /* chain 2 */
  6607. phyerr->rf_info.pc_rssi_info[2].rssi_pri20 =
  6608. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 2, PRI20);
  6609. phyerr->rf_info.pc_rssi_info[2].rssi_sec20 =
  6610. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 2, SEC20);
  6611. phyerr->rf_info.pc_rssi_info[2].rssi_sec40 =
  6612. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 2, SEC40);
  6613. phyerr->rf_info.pc_rssi_info[2].rssi_sec80 =
  6614. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 2, SEC80);
  6615. /* chain 3 */
  6616. phyerr->rf_info.pc_rssi_info[3].rssi_pri20 =
  6617. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 3, PRI20);
  6618. phyerr->rf_info.pc_rssi_info[3].rssi_sec20 =
  6619. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 3, SEC20);
  6620. phyerr->rf_info.pc_rssi_info[3].rssi_sec40 =
  6621. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 3, SEC40);
  6622. phyerr->rf_info.pc_rssi_info[3].rssi_sec80 =
  6623. WMI_UNIFIED_RSSI_CHAN_GET(&ev->hdr, 3, SEC80);
  6624. phyerr->chan_info.center_freq1 =
  6625. WMI_UNIFIED_FREQ_INFO_GET(&ev->hdr, 1);
  6626. phyerr->chan_info.center_freq2 =
  6627. WMI_UNIFIED_FREQ_INFO_GET(&ev->hdr, 2);
  6628. }
  6629. }
  6630. #endif /* WLAN_CONV_SPECTRAL_ENABLE */
  6631. /*
  6632. * Advance the buffer pointer to the next PHY error.
  6633. * buflen is the length of this payload, so we need to
  6634. * advance past the current header _AND_ the payload.
  6635. */
  6636. n += sizeof(*ev) + ev->hdr.buf_len;
  6637. }
  6638. *buf_offset = n;
  6639. return QDF_STATUS_SUCCESS;
  6640. }
  6641. /**
  6642. * extract_composite_phyerr_non_tlv() - extract composite phy error from event
  6643. * @wmi_handle: wmi handle
  6644. * @param evt_buf: pointer to event buffer
  6645. * @param datalen: Length of event buffer
  6646. * @param phyerr: Pointer to hold phy error
  6647. *
  6648. * Return: 0 for success or error code
  6649. */
  6650. static QDF_STATUS extract_composite_phyerr_non_tlv(wmi_unified_t wmi_handle,
  6651. void *evt_buf,
  6652. uint16_t datalen, wmi_host_phyerr_t *phyerr)
  6653. {
  6654. wmi_composite_phyerr_rx_event *pe;
  6655. wmi_composite_phyerr_rx_hdr *ph;
  6656. /* Ensure it's at least the size of the header */
  6657. if (datalen < sizeof(*pe)) {
  6658. return QDF_STATUS_E_FAILURE;
  6659. /* XXX what should errors be? */
  6660. }
  6661. phyerr->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  6662. pe = (wmi_composite_phyerr_rx_event *) evt_buf;
  6663. ph = &pe->hdr;
  6664. /*
  6665. * Reconstruct the 64 bit event TSF. This isn't from the MAC, it's
  6666. * at the time the event was sent to us, the TSF value will be
  6667. * in the future.
  6668. */
  6669. phyerr->tsf64 = ph->tsf_l32;
  6670. phyerr->tsf64 |= (((uint64_t) ph->tsf_u32) << 32);
  6671. phyerr->tsf_timestamp = ph->tsf_timestamp;
  6672. phyerr->bufp = &pe->bufp[0];
  6673. phyerr->buf_len = ph->buf_len;
  6674. phyerr->phy_err_mask0 = ph->phy_err_mask0;
  6675. phyerr->phy_err_mask1 = ph->phy_err_mask1;
  6676. phyerr->rf_info.rssi_comb =
  6677. WMI_UNIFIED_RSSI_COMB_GET(ph);
  6678. /* Handle Spectral PHY Error */
  6679. if ((ph->phy_err_mask0 & WMI_HOST_AR900B_SPECTRAL_PHYERR_MASK)) {
  6680. #ifdef WLAN_CONV_SPECTRAL_ENABLE
  6681. if (ph->buf_len > 0) {
  6682. /* Initialize the NF values to Zero. */
  6683. phyerr->rf_info.noise_floor[0] =
  6684. WMI_UNIFIED_NF_CHAIN_GET(ph, 0);
  6685. phyerr->rf_info.noise_floor[1] =
  6686. WMI_UNIFIED_NF_CHAIN_GET(ph, 1);
  6687. phyerr->rf_info.noise_floor[2] =
  6688. WMI_UNIFIED_NF_CHAIN_GET(ph, 2);
  6689. phyerr->rf_info.noise_floor[3] =
  6690. WMI_UNIFIED_NF_CHAIN_GET(ph, 3);
  6691. /* populate the rf info */
  6692. /* Need to unroll loop due to macro constraints */
  6693. /* chain 0 */
  6694. phyerr->rf_info.pc_rssi_info[0].rssi_pri20 =
  6695. WMI_UNIFIED_RSSI_CHAN_GET(ph, 0, PRI20);
  6696. phyerr->rf_info.pc_rssi_info[0].rssi_sec20 =
  6697. WMI_UNIFIED_RSSI_CHAN_GET(ph, 0, SEC20);
  6698. phyerr->rf_info.pc_rssi_info[0].rssi_sec40 =
  6699. WMI_UNIFIED_RSSI_CHAN_GET(ph, 0, SEC40);
  6700. phyerr->rf_info.pc_rssi_info[0].rssi_sec80 =
  6701. WMI_UNIFIED_RSSI_CHAN_GET(ph, 0, SEC80);
  6702. /* chain 1 */
  6703. phyerr->rf_info.pc_rssi_info[1].rssi_pri20 =
  6704. WMI_UNIFIED_RSSI_CHAN_GET(ph, 1, PRI20);
  6705. phyerr->rf_info.pc_rssi_info[1].rssi_sec20 =
  6706. WMI_UNIFIED_RSSI_CHAN_GET(ph, 1, SEC20);
  6707. phyerr->rf_info.pc_rssi_info[1].rssi_sec40 =
  6708. WMI_UNIFIED_RSSI_CHAN_GET(ph, 1, SEC40);
  6709. phyerr->rf_info.pc_rssi_info[1].rssi_sec80 =
  6710. WMI_UNIFIED_RSSI_CHAN_GET(ph, 1, SEC80);
  6711. /* chain 2 */
  6712. phyerr->rf_info.pc_rssi_info[2].rssi_pri20 =
  6713. WMI_UNIFIED_RSSI_CHAN_GET(ph, 2, PRI20);
  6714. phyerr->rf_info.pc_rssi_info[2].rssi_sec20 =
  6715. WMI_UNIFIED_RSSI_CHAN_GET(ph, 2, SEC20);
  6716. phyerr->rf_info.pc_rssi_info[2].rssi_sec40 =
  6717. WMI_UNIFIED_RSSI_CHAN_GET(ph, 2, SEC40);
  6718. phyerr->rf_info.pc_rssi_info[2].rssi_sec80 =
  6719. WMI_UNIFIED_RSSI_CHAN_GET(ph, 2, SEC80);
  6720. /* chain 3 */
  6721. phyerr->rf_info.pc_rssi_info[3].rssi_pri20 =
  6722. WMI_UNIFIED_RSSI_CHAN_GET(ph, 3, PRI20);
  6723. phyerr->rf_info.pc_rssi_info[3].rssi_sec20 =
  6724. WMI_UNIFIED_RSSI_CHAN_GET(ph, 3, SEC20);
  6725. phyerr->rf_info.pc_rssi_info[3].rssi_sec40 =
  6726. WMI_UNIFIED_RSSI_CHAN_GET(ph, 3, SEC40);
  6727. phyerr->rf_info.pc_rssi_info[3].rssi_sec80 =
  6728. WMI_UNIFIED_RSSI_CHAN_GET(ph, 3, SEC80);
  6729. phyerr->chan_info.center_freq1 =
  6730. WMI_UNIFIED_FREQ_INFO_GET(ph, 1);
  6731. phyerr->chan_info.center_freq2 =
  6732. WMI_UNIFIED_FREQ_INFO_GET(ph, 2);
  6733. }
  6734. #endif /* WLAN_CONV_SPECTRAL_ENABLE */
  6735. }
  6736. return QDF_STATUS_SUCCESS;
  6737. }
  6738. /**
  6739. * extract_all_stats_counts_non_tlv() - extract all stats count from event
  6740. * @wmi_handle: wmi handle
  6741. * @param evt_buf: pointer to event buffer
  6742. * @param stats_param: Pointer to hold stats count
  6743. *
  6744. * Return: 0 for success or error code
  6745. */
  6746. static QDF_STATUS extract_all_stats_counts_non_tlv(wmi_unified_t wmi_handle,
  6747. void *evt_buf,
  6748. wmi_host_stats_event *stats_param)
  6749. {
  6750. wmi_stats_event *ev = (wmi_stats_event *) evt_buf;
  6751. wmi_stats_id stats_id = ev->stats_id;
  6752. wmi_host_stats_id nac_rssi_ev = 0;
  6753. if (stats_id & WMI_REQUEST_NAC_RSSI_STAT) {
  6754. nac_rssi_ev = WMI_HOST_REQUEST_NAC_RSSI;
  6755. stats_id &= ~WMI_REQUEST_NAC_RSSI_STAT;
  6756. }
  6757. switch (stats_id) {
  6758. case WMI_REQUEST_PEER_STAT:
  6759. stats_param->stats_id |= WMI_HOST_REQUEST_PEER_STAT;
  6760. break;
  6761. case WMI_REQUEST_AP_STAT:
  6762. stats_param->stats_id |= WMI_HOST_REQUEST_AP_STAT;
  6763. break;
  6764. case WMI_REQUEST_INST_STAT:
  6765. stats_param->stats_id |= WMI_HOST_REQUEST_INST_STAT;
  6766. break;
  6767. case WMI_REQUEST_PEER_EXTD_STAT:
  6768. stats_param->stats_id |= WMI_HOST_REQUEST_PEER_EXTD_STAT;
  6769. break;
  6770. case WMI_REQUEST_VDEV_EXTD_STAT:
  6771. stats_param->stats_id |= WMI_HOST_REQUEST_VDEV_EXTD_STAT;
  6772. break;
  6773. case WMI_REQUEST_PDEV_EXT2_STAT:
  6774. stats_param->stats_id |= nac_rssi_ev;
  6775. break;
  6776. default:
  6777. stats_param->stats_id = 0;
  6778. break;
  6779. }
  6780. stats_param->num_pdev_stats = ev->num_pdev_stats;
  6781. stats_param->num_pdev_ext_stats = ev->num_pdev_ext_stats;
  6782. stats_param->num_vdev_stats = ev->num_vdev_stats;
  6783. stats_param->num_peer_stats = ev->num_peer_stats;
  6784. stats_param->num_bcnflt_stats = ev->num_bcnflt_stats;
  6785. stats_param->num_chan_stats = 0;
  6786. stats_param->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  6787. return QDF_STATUS_SUCCESS;
  6788. }
  6789. /**
  6790. * extract_pdev_stats_non_tlv() - extract pdev stats from event
  6791. * @wmi_handle: wmi handle
  6792. * @param evt_buf: pointer to event buffer
  6793. * @param index: Index into pdev stats
  6794. * @param pdev_stats: Pointer to hold pdev stats
  6795. *
  6796. * Return: 0 for success or error code
  6797. */
  6798. static QDF_STATUS extract_pdev_stats_non_tlv(wmi_unified_t wmi_handle,
  6799. void *evt_buf,
  6800. uint32_t index, wmi_host_pdev_stats *pdev_stats)
  6801. {
  6802. if (index < ((wmi_stats_event *)evt_buf)->num_pdev_stats) {
  6803. wmi_pdev_stats *ev =
  6804. (wmi_pdev_stats *) ((((wmi_stats_event *)evt_buf)->data) +
  6805. (index * sizeof(wmi_pdev_stats)));
  6806. /* direct copy possible since wmi_host_pdev_stats is same as
  6807. * wmi_pdev_stats for non-tlv */
  6808. /* qdf_mem_copy(pdev_stats, ev, sizeof(wmi_pdev_stats));*/
  6809. pdev_stats->chan_nf = ev->chan_nf;
  6810. pdev_stats->tx_frame_count = ev->tx_frame_count;
  6811. pdev_stats->rx_frame_count = ev->rx_frame_count;
  6812. pdev_stats->rx_clear_count = ev->rx_clear_count;
  6813. pdev_stats->cycle_count = ev->cycle_count;
  6814. pdev_stats->phy_err_count = ev->phy_err_count;
  6815. pdev_stats->chan_tx_pwr = ev->chan_tx_pwr;
  6816. #define tx_stats (pdev_stats->pdev_stats.tx)
  6817. #define ev_tx_stats (ev->pdev_stats.tx)
  6818. /* Tx Stats */
  6819. tx_stats.comp_queued = ev_tx_stats.comp_queued;
  6820. tx_stats.comp_delivered = ev_tx_stats.comp_delivered;
  6821. tx_stats.msdu_enqued = ev_tx_stats.msdu_enqued;
  6822. tx_stats.mpdu_enqued = ev_tx_stats.mpdu_enqued;
  6823. tx_stats.wmm_drop = ev_tx_stats.wmm_drop;
  6824. tx_stats.local_enqued = ev_tx_stats.local_enqued;
  6825. tx_stats.local_freed = ev_tx_stats.local_freed;
  6826. tx_stats.hw_queued = ev_tx_stats.hw_queued;
  6827. tx_stats.hw_reaped = ev_tx_stats.hw_reaped;
  6828. tx_stats.underrun = ev_tx_stats.underrun;
  6829. tx_stats.hw_paused = ev_tx_stats.hw_paused;
  6830. tx_stats.tx_abort = ev_tx_stats.tx_abort;
  6831. tx_stats.mpdus_requed = ev_tx_stats.mpdus_requed;
  6832. tx_stats.tx_xretry = ev_tx_stats.tx_xretry;
  6833. tx_stats.data_rc = ev_tx_stats.data_rc;
  6834. tx_stats.self_triggers = ev_tx_stats.self_triggers;
  6835. tx_stats.sw_retry_failure = ev_tx_stats.sw_retry_failure;
  6836. tx_stats.illgl_rate_phy_err = ev_tx_stats.illgl_rate_phy_err;
  6837. tx_stats.pdev_cont_xretry = ev_tx_stats.pdev_cont_xretry;
  6838. tx_stats.pdev_tx_timeout = ev_tx_stats.pdev_tx_timeout;
  6839. tx_stats.pdev_resets = ev_tx_stats.pdev_resets;
  6840. tx_stats.stateless_tid_alloc_failure =
  6841. ev_tx_stats.stateless_tid_alloc_failure;
  6842. tx_stats.phy_underrun = ev_tx_stats.phy_underrun;
  6843. tx_stats.txop_ovf = ev_tx_stats.txop_ovf;
  6844. tx_stats.seq_posted = ev_tx_stats.seq_posted;
  6845. tx_stats.seq_failed_queueing = ev_tx_stats.seq_failed_queueing;
  6846. tx_stats.seq_completed = ev_tx_stats.seq_completed;
  6847. tx_stats.seq_restarted = ev_tx_stats.seq_restarted;
  6848. tx_stats.mu_seq_posted = ev_tx_stats.mu_seq_posted;
  6849. tx_stats.mpdus_sw_flush = ev_tx_stats.mpdus_sw_flush;
  6850. tx_stats.mpdus_hw_filter = ev_tx_stats.mpdus_hw_filter;
  6851. tx_stats.mpdus_truncated = ev_tx_stats.mpdus_truncated;
  6852. tx_stats.mpdus_ack_failed = ev_tx_stats.mpdus_ack_failed;
  6853. tx_stats.mpdus_expired = ev_tx_stats.mpdus_expired;
  6854. /* Only NON-TLV */
  6855. tx_stats.mc_drop = ev_tx_stats.mc_drop;
  6856. /* Only TLV */
  6857. tx_stats.tx_ko = 0;
  6858. #define rx_stats (pdev_stats->pdev_stats.rx)
  6859. #define ev_rx_stats (ev->pdev_stats.rx)
  6860. /* Rx Stats */
  6861. rx_stats.mid_ppdu_route_change =
  6862. ev_rx_stats.mid_ppdu_route_change;
  6863. rx_stats.status_rcvd = ev_rx_stats.status_rcvd;
  6864. rx_stats.r0_frags = ev_rx_stats.r0_frags;
  6865. rx_stats.r1_frags = ev_rx_stats.r1_frags;
  6866. rx_stats.r2_frags = ev_rx_stats.r2_frags;
  6867. /* Only TLV */
  6868. rx_stats.r3_frags = 0;
  6869. rx_stats.htt_msdus = ev_rx_stats.htt_msdus;
  6870. rx_stats.htt_mpdus = ev_rx_stats.htt_mpdus;
  6871. rx_stats.loc_msdus = ev_rx_stats.loc_msdus;
  6872. rx_stats.loc_mpdus = ev_rx_stats.loc_mpdus;
  6873. rx_stats.oversize_amsdu = ev_rx_stats.oversize_amsdu;
  6874. rx_stats.phy_errs = ev_rx_stats.phy_errs;
  6875. rx_stats.phy_err_drop = ev_rx_stats.phy_err_drop;
  6876. rx_stats.mpdu_errs = ev_rx_stats.mpdu_errs;
  6877. rx_stats.pdev_rx_timeout = ev_rx_stats.pdev_rx_timeout;
  6878. rx_stats.rx_ovfl_errs = ev_rx_stats.rx_ovfl_errs;
  6879. /* mem stats */
  6880. pdev_stats->pdev_stats.mem.iram_free_size =
  6881. ev->pdev_stats.mem.iram_free_size;
  6882. pdev_stats->pdev_stats.mem.dram_free_size =
  6883. ev->pdev_stats.mem.dram_free_size;
  6884. /* Only Non-TLV */
  6885. pdev_stats->pdev_stats.mem.sram_free_size =
  6886. ev->pdev_stats.mem.sram_free_size;
  6887. /* Peer stats */
  6888. /* Only TLV */
  6889. pdev_stats->pdev_stats.peer.dummy = 0;
  6890. /* Only NON-TLV */
  6891. pdev_stats->ackRcvBad = ev->ackRcvBad;
  6892. pdev_stats->rtsBad = ev->rtsBad;
  6893. pdev_stats->rtsGood = ev->rtsGood;
  6894. pdev_stats->fcsBad = ev->fcsBad;
  6895. pdev_stats->noBeacons = ev->noBeacons;
  6896. pdev_stats->mib_int_count = ev->mib_int_count;
  6897. }
  6898. return QDF_STATUS_SUCCESS;
  6899. }
  6900. /**
  6901. * extract_pdev_ext_stats_non_tlv() - extract extended pdev stats from event
  6902. * @wmi_handle: wmi handle
  6903. * @param evt_buf: pointer to event buffer
  6904. * @param index: Index into extended pdev stats
  6905. * @param pdev_ext_stats: Pointer to hold extended pdev stats
  6906. *
  6907. * Return: 0 for success or error code
  6908. */
  6909. static QDF_STATUS extract_pdev_ext_stats_non_tlv(wmi_unified_t wmi_handle,
  6910. void *evt_buf,
  6911. uint32_t index, wmi_host_pdev_ext_stats *pdev_ext_stats)
  6912. {
  6913. if (index < ((wmi_stats_event *)evt_buf)->num_pdev_ext_stats) {
  6914. wmi_pdev_ext_stats *ev =
  6915. (wmi_pdev_ext_stats *) ((((wmi_stats_event *)evt_buf)->data) +
  6916. ((((wmi_stats_event *)evt_buf)->num_pdev_stats) *
  6917. sizeof(wmi_pdev_stats)) +
  6918. (index * sizeof(wmi_pdev_ext_stats)));
  6919. /* Copy content to event->data */
  6920. OS_MEMCPY(pdev_ext_stats, ev, sizeof(wmi_pdev_ext_stats));
  6921. }
  6922. return QDF_STATUS_SUCCESS;
  6923. }
  6924. /**
  6925. * extract_vdev_stats_non_tlv() - extract vdev stats from event
  6926. * @wmi_handle: wmi handle
  6927. * @param evt_buf: pointer to event buffer
  6928. * @param index: Index into vdev stats
  6929. * @param vdev_stats: Pointer to hold vdev stats
  6930. *
  6931. * Return: 0 for success or error code
  6932. */
  6933. static QDF_STATUS extract_vdev_stats_non_tlv(wmi_unified_t wmi_handle,
  6934. void *evt_buf, uint32_t index, wmi_host_vdev_stats *vdev_stats)
  6935. {
  6936. if (index < ((wmi_stats_event *)evt_buf)->num_vdev_stats) {
  6937. wmi_vdev_stats *ev =
  6938. (wmi_vdev_stats *) ((((wmi_stats_event *)evt_buf)->data) +
  6939. ((((wmi_stats_event *)evt_buf)->num_pdev_stats) *
  6940. sizeof(wmi_pdev_stats)) +
  6941. ((((wmi_stats_event *)evt_buf)->num_pdev_ext_stats) *
  6942. sizeof(wmi_pdev_ext_stats)) +
  6943. (index * sizeof(wmi_vdev_stats)));
  6944. OS_MEMSET(vdev_stats, 0, sizeof(wmi_host_vdev_stats));
  6945. vdev_stats->vdev_id = ev->vdev_id;
  6946. }
  6947. return QDF_STATUS_SUCCESS;
  6948. }
  6949. /**
  6950. * extract_peer_stats_non_tlv() - extract peer stats from event
  6951. * @wmi_handle: wmi handle
  6952. * @param evt_buf: pointer to event buffer
  6953. * @param index: Index into peer stats
  6954. * @param peer_stats: Pointer to hold peer stats
  6955. *
  6956. * Return: 0 for success or error code
  6957. */
  6958. static QDF_STATUS extract_peer_stats_non_tlv(wmi_unified_t wmi_handle,
  6959. void *evt_buf, uint32_t index, wmi_host_peer_stats *peer_stats)
  6960. {
  6961. if (index < ((wmi_stats_event *)evt_buf)->num_peer_stats) {
  6962. wmi_peer_stats *ev =
  6963. (wmi_peer_stats *) ((((wmi_stats_event *)evt_buf)->data) +
  6964. ((((wmi_stats_event *)evt_buf)->num_pdev_stats) *
  6965. sizeof(wmi_pdev_stats)) +
  6966. ((((wmi_stats_event *)evt_buf)->num_pdev_ext_stats) *
  6967. sizeof(wmi_pdev_ext_stats)) +
  6968. ((((wmi_stats_event *)evt_buf)->num_vdev_stats) *
  6969. sizeof(wmi_vdev_stats)) +
  6970. (index * sizeof(wmi_peer_stats)));
  6971. OS_MEMCPY(&(peer_stats->peer_macaddr), &(ev->peer_macaddr),
  6972. sizeof(wmi_mac_addr));
  6973. peer_stats->peer_rssi = ev->peer_rssi;
  6974. peer_stats->peer_rssi_seq_num = ev->peer_rssi_seq_num;
  6975. peer_stats->peer_tx_rate = ev->peer_tx_rate;
  6976. peer_stats->peer_rx_rate = ev->peer_rx_rate;
  6977. peer_stats->currentper = ev->currentper;
  6978. peer_stats->retries = ev->retries;
  6979. peer_stats->txratecount = ev->txratecount;
  6980. peer_stats->max4msframelen = ev->max4msframelen;
  6981. peer_stats->totalsubframes = ev->totalsubframes;
  6982. peer_stats->txbytes = ev->txbytes;
  6983. OS_MEMCPY(peer_stats->nobuffs, ev->nobuffs,
  6984. sizeof(peer_stats->nobuffs));
  6985. OS_MEMCPY(peer_stats->excretries, ev->excretries,
  6986. sizeof(peer_stats->excretries));
  6987. peer_stats->peer_rssi_changed = ev->peer_rssi_changed;
  6988. }
  6989. return QDF_STATUS_SUCCESS;
  6990. }
  6991. /**
  6992. * extract_bcnflt_stats_non_tlv() - extract bcn fault stats from event
  6993. * @wmi_handle: wmi handle
  6994. * @param evt_buf: pointer to event buffer
  6995. * @param index: Index into bcn fault stats
  6996. * @param bcnflt_stats: Pointer to hold bcn fault stats
  6997. *
  6998. * Return: 0 for success or error code
  6999. */
  7000. static QDF_STATUS extract_bcnflt_stats_non_tlv(wmi_unified_t wmi_handle,
  7001. void *evt_buf, uint32_t index, wmi_host_bcnflt_stats *bcnflt_stats)
  7002. {
  7003. return QDF_STATUS_SUCCESS;
  7004. }
  7005. /**
  7006. * extract_peer_extd_stats_non_tlv() - extract extended peer stats from event
  7007. * @wmi_handle: wmi handle
  7008. * @param evt_buf: pointer to event buffer
  7009. * @param index: Index into extended peer stats
  7010. * @param peer_extd_stats: Pointer to hold extended peer stats
  7011. *
  7012. * Return: 0 for success or error code
  7013. */
  7014. static QDF_STATUS extract_peer_extd_stats_non_tlv(wmi_unified_t wmi_handle,
  7015. void *evt_buf, uint32_t index,
  7016. wmi_host_peer_extd_stats *peer_extd_stats)
  7017. {
  7018. uint8_t *pdata = ((wmi_stats_event *)evt_buf)->data;
  7019. if (WMI_REQUEST_PEER_EXTD_STAT &
  7020. ((wmi_stats_event *)evt_buf)->stats_id) {
  7021. if (index < ((wmi_stats_event *)evt_buf)->num_peer_stats) {
  7022. wmi_peer_extd_stats *ev = (wmi_peer_extd_stats *)
  7023. ((pdata) +
  7024. ((((wmi_stats_event *)evt_buf)->num_pdev_stats) *
  7025. sizeof(wmi_pdev_stats)) +
  7026. ((((wmi_stats_event *)evt_buf)->num_pdev_ext_stats) *
  7027. sizeof(wmi_pdev_ext_stats)) +
  7028. ((((wmi_stats_event *)evt_buf)->num_vdev_stats) *
  7029. sizeof(wmi_vdev_stats)) +
  7030. ((((wmi_stats_event *)evt_buf)->num_peer_stats) *
  7031. sizeof(wmi_peer_stats)) +
  7032. (index * sizeof(wmi_peer_extd_stats)));
  7033. OS_MEMCPY(peer_extd_stats, ev,
  7034. sizeof(wmi_host_peer_extd_stats));
  7035. }
  7036. }
  7037. return QDF_STATUS_SUCCESS;
  7038. }
  7039. /**
  7040. * extract_vdev_extd_stats_non_tlv() - extract extended vdev stats from event
  7041. * @wmi_handle: wmi handle
  7042. * @param evt_buf: pointer to event buffer
  7043. * @param index: Index into extended vdev stats
  7044. * @param vdev_extd_stats: Pointer to hold extended vdev stats
  7045. *
  7046. * Return: 0 for success or error code
  7047. */
  7048. static QDF_STATUS extract_vdev_extd_stats_non_tlv(wmi_unified_t wmi_handle,
  7049. void *evt_buf, uint32_t index,
  7050. wmi_host_vdev_extd_stats *vdev_extd_stats)
  7051. {
  7052. uint8_t *pdata = ((wmi_stats_event *)evt_buf)->data;
  7053. if (WMI_REQUEST_PEER_EXTD_STAT &
  7054. ((wmi_stats_event *)evt_buf)->stats_id) {
  7055. if (index < ((wmi_stats_event *)evt_buf)->num_vdev_stats) {
  7056. wmi_vdev_extd_stats *ev = (wmi_vdev_extd_stats *)
  7057. ((pdata) +
  7058. ((((wmi_stats_event *)evt_buf)->num_pdev_stats) *
  7059. sizeof(wmi_pdev_stats)) +
  7060. ((((wmi_stats_event *)evt_buf)->num_pdev_ext_stats) *
  7061. sizeof(wmi_pdev_ext_stats)) +
  7062. ((((wmi_stats_event *)evt_buf)->num_vdev_stats) *
  7063. sizeof(wmi_vdev_stats)) +
  7064. ((((wmi_stats_event *)evt_buf)->num_peer_stats) *
  7065. sizeof(wmi_peer_stats)) +
  7066. ((((wmi_stats_event *)evt_buf)->num_peer_stats) *
  7067. sizeof(wmi_peer_extd_stats)) +
  7068. (index * sizeof(wmi_vdev_extd_stats)));
  7069. OS_MEMCPY(vdev_extd_stats, ev,
  7070. sizeof(wmi_host_vdev_extd_stats));
  7071. }
  7072. }
  7073. return QDF_STATUS_SUCCESS;
  7074. }
  7075. /**
  7076. * extract_vdev_nac_rssi_stats_non_tlv() - extract vdev NAC_RSSI stats from event
  7077. * @wmi_handle: wmi handle
  7078. * @param evt_buf: pointer to event buffer
  7079. * @param vdev_nac_rssi_event: Pointer to hold vdev NAC_RSSI stats
  7080. *
  7081. * Return: 0 for success or error code
  7082. */
  7083. static QDF_STATUS extract_vdev_nac_rssi_stats_non_tlv(wmi_unified_t wmi_handle,
  7084. void *evt_buf, struct wmi_host_vdev_nac_rssi_event *vdev_nac_rssi_stats)
  7085. {
  7086. uint8_t *pdata = ((wmi_stats_event *)evt_buf)->data;
  7087. if (WMI_REQUEST_NAC_RSSI_STAT &
  7088. ((wmi_stats_event *)evt_buf)->stats_id) {
  7089. struct wmi_host_vdev_nac_rssi_event *ev = (struct wmi_host_vdev_nac_rssi_event *)
  7090. ((pdata) +
  7091. ((((wmi_stats_event *)evt_buf)->num_pdev_stats) *
  7092. sizeof(wmi_pdev_stats)) +
  7093. ((((wmi_stats_event *)evt_buf)->num_pdev_ext_stats) *
  7094. sizeof(wmi_pdev_ext_stats)) +
  7095. ((((wmi_stats_event *)evt_buf)->num_vdev_stats) *
  7096. sizeof(wmi_vdev_stats)) +
  7097. ((((wmi_stats_event *)evt_buf)->num_peer_stats) *
  7098. sizeof(wmi_peer_stats)) +
  7099. ((((wmi_stats_event *)evt_buf)->num_bcnflt_stats) *
  7100. sizeof(wmi_bcnfilter_stats_t)) +
  7101. ((WMI_REQUEST_PEER_EXTD_STAT &
  7102. ((wmi_stats_event *)evt_buf)->stats_id) ? ((((wmi_stats_event *)evt_buf)->num_peer_stats) *
  7103. sizeof(wmi_peer_extd_stats)) : 0) +
  7104. ((WMI_REQUEST_VDEV_EXTD_STAT &
  7105. ((wmi_stats_event *)evt_buf)->stats_id) ? ((((wmi_stats_event *)evt_buf)->num_vdev_stats)*
  7106. sizeof(wmi_vdev_extd_stats)) : 0) +
  7107. ((((wmi_stats_event *)evt_buf)->num_pdev_stats) *
  7108. (sizeof(wmi_pdev_ext2_stats))));
  7109. OS_MEMCPY(vdev_nac_rssi_stats, ev,
  7110. sizeof(struct wmi_host_vdev_nac_rssi_event));
  7111. }
  7112. return QDF_STATUS_SUCCESS;
  7113. }
  7114. /**
  7115. * extract_chan_stats_non_tlv() - extract chan stats from event
  7116. * @wmi_handle: wmi handle
  7117. * @param evt_buf: pointer to event buffer
  7118. * @param index: Index into chan stats
  7119. * @param vdev_extd_stats: Pointer to hold chan stats
  7120. *
  7121. * Return: 0 for success or error code
  7122. */
  7123. static QDF_STATUS extract_chan_stats_non_tlv(wmi_unified_t wmi_handle,
  7124. void *evt_buf,
  7125. uint32_t index, wmi_host_chan_stats *chan_stats)
  7126. {
  7127. /* Non-TLV doesnt have num_chan_stats */
  7128. return QDF_STATUS_SUCCESS;
  7129. }
  7130. /**
  7131. * extract_profile_ctx_non_tlv() - extract profile context from event
  7132. * @wmi_handle: wmi handle
  7133. * @param evt_buf: pointer to event buffer
  7134. * @param profile_ctx: Pointer to hold profile context
  7135. *
  7136. * Return: 0 for success or error code
  7137. */
  7138. static QDF_STATUS extract_profile_ctx_non_tlv(wmi_unified_t wmi_handle,
  7139. void *evt_buf,
  7140. wmi_host_wlan_profile_ctx_t *profile_ctx)
  7141. {
  7142. wmi_profile_stats_event *profile_ev =
  7143. (wmi_profile_stats_event *)evt_buf;
  7144. qdf_mem_copy(profile_ctx, &(profile_ev->profile_ctx),
  7145. sizeof(wmi_host_wlan_profile_ctx_t));
  7146. return QDF_STATUS_SUCCESS;
  7147. }
  7148. /**
  7149. * extract_profile_data_non_tlv() - extract profile data from event
  7150. * @wmi_handle: wmi handle
  7151. * @param evt_buf: pointer to event buffer
  7152. * @param profile_data: Pointer to hold profile data
  7153. *
  7154. * Return: 0 for success or error code
  7155. */
  7156. static QDF_STATUS extract_profile_data_non_tlv(wmi_unified_t wmi_handle,
  7157. void *evt_buf, uint8_t idx,
  7158. wmi_host_wlan_profile_t *profile_data)
  7159. {
  7160. wmi_profile_stats_event *profile_ev =
  7161. (wmi_profile_stats_event *)evt_buf;
  7162. if (idx > profile_ev->profile_ctx.bin_count)
  7163. return QDF_STATUS_E_INVAL;
  7164. qdf_mem_copy(profile_data, &profile_ev->profile_data[idx],
  7165. sizeof(wmi_host_wlan_profile_t));
  7166. return QDF_STATUS_SUCCESS;
  7167. }
  7168. /**
  7169. * extract_chan_info_event_non_tlv() - extract chan information from event
  7170. * @wmi_handle: wmi handle
  7171. * @param evt_buf: pointer to event buffer
  7172. * @param chan_info: Pointer to hold chan information
  7173. *
  7174. * Return: 0 for success or error code
  7175. */
  7176. static QDF_STATUS extract_chan_info_event_non_tlv(wmi_unified_t wmi_handle,
  7177. void *evt_buf,
  7178. wmi_host_chan_info_event *chan_info)
  7179. {
  7180. wmi_chan_info_event *chan_info_ev = (wmi_chan_info_event *)evt_buf;
  7181. chan_info->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  7182. chan_info->err_code = chan_info_ev->err_code;
  7183. chan_info->freq = chan_info_ev->freq;
  7184. chan_info->cmd_flags = chan_info_ev->cmd_flags;
  7185. chan_info->noise_floor = chan_info_ev->noise_floor;
  7186. chan_info->rx_clear_count = chan_info_ev->rx_clear_count;
  7187. chan_info->cycle_count = chan_info_ev->cycle_count;
  7188. chan_info->rx_11b_mode_data_duration =
  7189. chan_info_ev->rx_11b_mode_data_duration;
  7190. /* ONLY NON-TLV */
  7191. chan_info->chan_tx_pwr_range = chan_info_ev->chan_tx_pwr_range;
  7192. chan_info->chan_tx_pwr_tp = chan_info_ev->chan_tx_pwr_tp;
  7193. chan_info->rx_frame_count = chan_info_ev->rx_frame_count;
  7194. return QDF_STATUS_SUCCESS;
  7195. }
  7196. /**
  7197. * extract_channel_hopping_event_non_tlv() - extract channel hopping param
  7198. * from event
  7199. * @wmi_handle: wmi handle
  7200. * @param evt_buf: pointer to event buffer
  7201. * @param ch_hopping: Pointer to hold channel hopping param
  7202. *
  7203. * Return: 0 for success or error code
  7204. */
  7205. static QDF_STATUS extract_channel_hopping_event_non_tlv(
  7206. wmi_unified_t wmi_handle, void *evt_buf,
  7207. wmi_host_pdev_channel_hopping_event *ch_hopping)
  7208. {
  7209. wmi_pdev_channel_hopping_event *event =
  7210. (wmi_pdev_channel_hopping_event *)evt_buf;
  7211. ch_hopping->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  7212. ch_hopping->noise_floor_report_iter = event->noise_floor_report_iter;
  7213. ch_hopping->noise_floor_total_iter = event->noise_floor_total_iter;
  7214. return QDF_STATUS_SUCCESS;
  7215. }
  7216. /**
  7217. * extract_bss_chan_info_event_non_tlv() - extract bss channel information
  7218. * from event
  7219. * @wmi_handle: wmi handle
  7220. * @param evt_buf: pointer to event buffer
  7221. * @param bss_chan_info: Pointer to hold bss channel information
  7222. *
  7223. * Return: 0 for success or error code
  7224. */
  7225. static QDF_STATUS extract_bss_chan_info_event_non_tlv(wmi_unified_t wmi_handle,
  7226. void *evt_buf, wmi_host_pdev_bss_chan_info_event *bss_chan_info)
  7227. {
  7228. wmi_pdev_bss_chan_info_event *event =
  7229. (wmi_pdev_bss_chan_info_event *)evt_buf;
  7230. bss_chan_info->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  7231. bss_chan_info->freq = event->freq;
  7232. bss_chan_info->noise_floor = event->noise_floor;
  7233. bss_chan_info->rx_clear_count_low = event->rx_clear_count_low;
  7234. bss_chan_info->rx_clear_count_high = event->rx_clear_count_high;
  7235. bss_chan_info->cycle_count_low = event->cycle_count_low;
  7236. bss_chan_info->cycle_count_high = event->cycle_count_high;
  7237. bss_chan_info->tx_cycle_count_low = event->tx_cycle_count_low;
  7238. bss_chan_info->tx_cycle_count_high = event->tx_cycle_count_high;
  7239. bss_chan_info->rx_cycle_count_low = event->rx_cycle_count_low;
  7240. bss_chan_info->rx_cycle_count_high = event->rx_cycle_count_high;
  7241. bss_chan_info->rx_bss_cycle_count_low = event->rx_bss_cycle_count_low;
  7242. bss_chan_info->rx_bss_cycle_count_high = event->rx_bss_cycle_count_high;
  7243. bss_chan_info->reserved = event->reserved;
  7244. return QDF_STATUS_SUCCESS;
  7245. }
  7246. /**
  7247. * extract_inst_rssi_stats_event_non_tlv() - extract inst rssi stats from event
  7248. * @wmi_handle: wmi handle
  7249. * @param evt_buf: pointer to event buffer
  7250. * @param inst_rssi_resp: Pointer to hold inst rssi response
  7251. *
  7252. * Return: 0 for success or error code
  7253. */
  7254. static QDF_STATUS extract_inst_rssi_stats_event_non_tlv(
  7255. wmi_unified_t wmi_handle, void *evt_buf,
  7256. wmi_host_inst_stats_resp *inst_rssi_resp)
  7257. {
  7258. wmi_inst_stats_resp *event = (wmi_inst_stats_resp *)evt_buf;
  7259. inst_rssi_resp->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  7260. qdf_mem_copy(inst_rssi_resp, event, sizeof(wmi_inst_stats_resp));
  7261. return QDF_STATUS_SUCCESS;
  7262. }
  7263. /**
  7264. * extract_tx_data_traffic_ctrl_ev_non_tlv() - extract tx data traffic control
  7265. * from event
  7266. * @wmi_handle: wmi handle
  7267. * @param evt_buf: pointer to event buffer
  7268. * @param ev: Pointer to hold data traffic control
  7269. *
  7270. * Return: 0 for success or error code
  7271. */
  7272. static QDF_STATUS extract_tx_data_traffic_ctrl_ev_non_tlv(
  7273. wmi_unified_t wmi_handle, void *evt_buf,
  7274. wmi_host_tx_data_traffic_ctrl_event *ev)
  7275. {
  7276. wmi_tx_data_traffic_ctrl_event *evt =
  7277. (wmi_tx_data_traffic_ctrl_event *)evt_buf;
  7278. ev->peer_ast_idx = evt->peer_ast_idx;
  7279. ev->vdev_id = evt->vdev_id;
  7280. ev->ctrl_cmd = evt->ctrl_cmd;
  7281. return QDF_STATUS_SUCCESS;
  7282. }
  7283. /**
  7284. * extract_atf_peer_stats_ev_non_tlv() - extract atf peer stats
  7285. * from event
  7286. * @wmi_handle: wmi handle
  7287. * @param evt_buf: pointer to event buffer
  7288. * @param ev: Pointer to hold atf stats event data
  7289. *
  7290. * Return: 0 for success or error code
  7291. */
  7292. static QDF_STATUS extract_atf_peer_stats_ev_non_tlv(
  7293. wmi_unified_t wmi_handle, void *evt_buf,
  7294. wmi_host_atf_peer_stats_event *ev)
  7295. {
  7296. wmi_atf_peer_stats_event *evt =
  7297. (wmi_atf_peer_stats_event *)evt_buf;
  7298. ev->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  7299. ev->num_atf_peers = evt->num_atf_peers;
  7300. ev->comp_usable_airtime = evt->comp_usable_airtime;
  7301. qdf_mem_copy(&ev->reserved[0], &evt->reserved[0],
  7302. sizeof(evt->reserved));
  7303. return QDF_STATUS_SUCCESS;
  7304. }
  7305. /**
  7306. * extract_atf_token_info_ev_non_tlv() - extract atf token info
  7307. * from event
  7308. * @wmi_handle: wmi handle
  7309. * @param evt_buf: pointer to event buffer
  7310. * @idx: Index indicating the peer number
  7311. * @param atf_token_info: Pointer to hold atf token info
  7312. *
  7313. * Return: 0 for success or error code
  7314. */
  7315. static QDF_STATUS extract_atf_token_info_ev_non_tlv(
  7316. wmi_unified_t wmi_handle, void *evt_buf,
  7317. uint8_t idx, wmi_host_atf_peer_stats_info *atf_token_info)
  7318. {
  7319. wmi_atf_peer_stats_event *evt =
  7320. (wmi_atf_peer_stats_event *)evt_buf;
  7321. if (idx > evt->num_atf_peers)
  7322. return QDF_STATUS_E_INVAL;
  7323. atf_token_info->field1 = evt->token_info_list[idx].field1;
  7324. atf_token_info->field2 = evt->token_info_list[idx].field2;
  7325. atf_token_info->field3 = evt->token_info_list[idx].field3;
  7326. return QDF_STATUS_SUCCESS;
  7327. }
  7328. /**
  7329. * extract_pdev_utf_event_non_tlv() - extract UTF data info from event
  7330. * @wmi_handle: WMI handle
  7331. * @param evt_buf: Pointer to event buffer
  7332. * @param param: Pointer to hold data
  7333. *
  7334. * Return : QDF_STATUS_SUCCESS for success or error code
  7335. */
  7336. static QDF_STATUS extract_pdev_utf_event_non_tlv(
  7337. wmi_unified_t wmi_handle,
  7338. uint8_t *evt_buf,
  7339. struct wmi_host_pdev_utf_event *event)
  7340. {
  7341. event->data = evt_buf;
  7342. event->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  7343. return QDF_STATUS_SUCCESS;
  7344. }
  7345. /**
  7346. * extract_pdev_qvit_event_non_tlv() - extract QVIT data info from event
  7347. * @wmi_handle: WMI handle
  7348. * @param evt_buf: Pointer to event buffer
  7349. * @param param: Pointer to hold data
  7350. *
  7351. * Return : QDF_STATUS_SUCCESS for success or error code
  7352. */
  7353. static QDF_STATUS extract_pdev_qvit_event_non_tlv(
  7354. wmi_unified_t wmi_handle,
  7355. uint8_t *evt_buf,
  7356. struct wmi_host_pdev_qvit_event *event)
  7357. {
  7358. event->data = evt_buf;
  7359. event->pdev_id = WMI_NON_TLV_DEFAULT_PDEV_ID;
  7360. return QDF_STATUS_SUCCESS;
  7361. }
  7362. /**
  7363. * extract_wds_entry_non_tlv() - extract wds entry from event
  7364. * @wmi_handle: wmi handle
  7365. * @evt_buf: pointer to event buffer
  7366. * @wds_entry: wds entry
  7367. * @idx: index to point wds entry in event buffer
  7368. *
  7369. * Return: 0 for success or error code
  7370. */
  7371. static QDF_STATUS extract_wds_entry_non_tlv(wmi_unified_t wmi_handle,
  7372. u_int8_t *evt_buf,
  7373. struct wdsentry *wds_entry,
  7374. u_int32_t idx)
  7375. {
  7376. wmi_pdev_wds_entry_dump_event *wds_entry_dump_event =
  7377. (wmi_pdev_wds_entry_dump_event *)evt_buf;
  7378. if (idx >= wds_entry_dump_event->num_entries)
  7379. return QDF_STATUS_E_INVAL;
  7380. qdf_mem_zero(wds_entry, sizeof(struct wdsentry));
  7381. WMI_MAC_ADDR_TO_CHAR_ARRAY(
  7382. &(wds_entry_dump_event->wds_entry[idx].peer_macaddr),
  7383. wds_entry->peer_mac);
  7384. WMI_MAC_ADDR_TO_CHAR_ARRAY(
  7385. &(wds_entry_dump_event->wds_entry[idx].wds_macaddr),
  7386. wds_entry->wds_mac);
  7387. wds_entry->flags = wds_entry_dump_event->wds_entry[idx].flags;
  7388. return QDF_STATUS_SUCCESS;
  7389. }
  7390. static bool is_management_record_non_tlv(uint32_t cmd_id)
  7391. {
  7392. if ((cmd_id == WMI_BCN_TX_CMDID) ||
  7393. (cmd_id == WMI_PDEV_SEND_BCN_CMDID) ||
  7394. (cmd_id == WMI_MGMT_TX_CMDID) ||
  7395. (cmd_id == WMI_GPIO_OUTPUT_CMDID) ||
  7396. (cmd_id == WMI_HOST_SWBA_EVENTID)) {
  7397. return true;
  7398. }
  7399. return false;
  7400. }
  7401. /**
  7402. * wmi_set_htc_tx_tag_non_tlv() - set HTC TX tag for WMI commands
  7403. * @wmi_handle: WMI handle
  7404. * @buf: WMI buffer
  7405. * @cmd_id: WMI command Id
  7406. *
  7407. * Return htc_tx_tag
  7408. */
  7409. static uint16_t wmi_set_htc_tx_tag_non_tlv(wmi_unified_t wmi_handle,
  7410. wmi_buf_t buf, uint32_t cmd_id)
  7411. {
  7412. return 0;
  7413. }
  7414. /**
  7415. * send_dfs_phyerr_offload_en_cmd_non_tlv() - send dfs phyerr offload en cmd
  7416. * @wmi_handle: wmi handle
  7417. * @pdev_id: pdev id
  7418. *
  7419. * Send WMI_PDEV_DFS_PHYERR_OFFLOAD_ENABLE_CMDID command to firmware.
  7420. *
  7421. * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error
  7422. */
  7423. static QDF_STATUS send_dfs_phyerr_offload_en_cmd_non_tlv(
  7424. wmi_unified_t wmi_handle,
  7425. uint32_t pdev_id)
  7426. {
  7427. return QDF_STATUS_SUCCESS;
  7428. }
  7429. /**
  7430. * send_dfs_phyerr_offload_dis_cmd_non_tlv() - send dfs phyerr offload dis cmd
  7431. * @wmi_handle: wmi handle
  7432. * @pdev_id: pdev id
  7433. *
  7434. * Send WMI_PDEV_DFS_PHYERR_OFFLOAD_DISABLE_CMDID command to firmware.
  7435. *
  7436. * Return: QDF_STATUS_SUCCESS on success, QDF_STATUS_E_** on error
  7437. */
  7438. static QDF_STATUS send_dfs_phyerr_offload_dis_cmd_non_tlv(
  7439. wmi_unified_t wmi_handle,
  7440. uint32_t pdev_id)
  7441. {
  7442. return QDF_STATUS_SUCCESS;
  7443. }
  7444. /**
  7445. * send_wds_entry_list_cmd_non_tlv() - WMI function to get list of
  7446. * wds entries from FW
  7447. *
  7448. * @param wmi_handle : handle to WMI.
  7449. * @return QDF_STATUS_SUCCESS on success and -ve on failure.
  7450. */
  7451. QDF_STATUS send_wds_entry_list_cmd_non_tlv(wmi_unified_t wmi_handle)
  7452. {
  7453. wmi_buf_t buf;
  7454. /*
  7455. * Passing a NULL pointer to wmi_unified_cmd_send() panics it,
  7456. * so let's just use a 32 byte fake array for now.
  7457. */
  7458. buf = wmi_buf_alloc(wmi_handle, 32);
  7459. if (buf == NULL)
  7460. return QDF_STATUS_E_NOMEM;
  7461. if (wmi_unified_cmd_send(wmi_handle, buf, 32,
  7462. WMI_PDEV_WDS_ENTRY_LIST_CMDID) != QDF_STATUS_SUCCESS) {
  7463. qdf_print("%s: send failed\n", __func__);
  7464. wmi_buf_free(buf);
  7465. return QDF_STATUS_E_FAILURE;
  7466. }
  7467. return QDF_STATUS_SUCCESS;
  7468. }
  7469. /**
  7470. * wmi_non_tlv_pdev_id_conversion_enable() - Enable pdev_id conversion
  7471. *
  7472. * Return None.
  7473. */
  7474. void wmi_non_tlv_pdev_id_conversion_enable(wmi_unified_t wmi_handle)
  7475. {
  7476. qdf_print("PDEV conversion Not Available");
  7477. }
  7478. struct wmi_ops non_tlv_ops = {
  7479. .send_vdev_create_cmd = send_vdev_create_cmd_non_tlv,
  7480. .send_vdev_delete_cmd = send_vdev_delete_cmd_non_tlv,
  7481. .send_vdev_down_cmd = send_vdev_down_cmd_non_tlv,
  7482. .send_peer_flush_tids_cmd = send_peer_flush_tids_cmd_non_tlv,
  7483. .send_peer_param_cmd = send_peer_param_cmd_non_tlv,
  7484. .send_vdev_up_cmd = send_vdev_up_cmd_non_tlv,
  7485. .send_peer_create_cmd = send_peer_create_cmd_non_tlv,
  7486. .send_peer_delete_cmd = send_peer_delete_cmd_non_tlv,
  7487. #ifdef WLAN_SUPPORT_GREEN_AP
  7488. .send_green_ap_ps_cmd = send_green_ap_ps_cmd_non_tlv,
  7489. #endif
  7490. .send_pdev_utf_cmd = send_pdev_utf_cmd_non_tlv,
  7491. .send_pdev_param_cmd = send_pdev_param_cmd_non_tlv,
  7492. .send_suspend_cmd = send_suspend_cmd_non_tlv,
  7493. .send_resume_cmd = send_resume_cmd_non_tlv,
  7494. .send_wow_enable_cmd = send_wow_enable_cmd_non_tlv,
  7495. .send_set_ap_ps_param_cmd = send_set_ap_ps_param_cmd_non_tlv,
  7496. .send_set_sta_ps_param_cmd = send_set_sta_ps_param_cmd_non_tlv,
  7497. .send_crash_inject_cmd = send_crash_inject_cmd_non_tlv,
  7498. .send_dbglog_cmd = send_dbglog_cmd_non_tlv,
  7499. .send_vdev_set_param_cmd = send_vdev_set_param_cmd_non_tlv,
  7500. .send_stats_request_cmd = send_stats_request_cmd_non_tlv,
  7501. .send_packet_log_enable_cmd = send_packet_log_enable_cmd_non_tlv,
  7502. .send_packet_log_disable_cmd = send_packet_log_disable_cmd_non_tlv,
  7503. .send_beacon_send_cmd = send_beacon_send_cmd_non_tlv,
  7504. .send_peer_assoc_cmd = send_peer_assoc_cmd_non_tlv,
  7505. .send_scan_start_cmd = send_scan_start_cmd_non_tlv,
  7506. .send_scan_stop_cmd = send_scan_stop_cmd_non_tlv,
  7507. .send_scan_chan_list_cmd = send_scan_chan_list_cmd_non_tlv,
  7508. .send_pdev_get_tpc_config_cmd = send_pdev_get_tpc_config_cmd_non_tlv,
  7509. .send_set_atf_cmd = send_set_atf_cmd_non_tlv,
  7510. .send_atf_peer_request_cmd = send_atf_peer_request_cmd_non_tlv,
  7511. .send_set_atf_grouping_cmd = send_set_atf_grouping_cmd_non_tlv,
  7512. .send_set_bwf_cmd = send_set_bwf_cmd_non_tlv,
  7513. .send_pdev_fips_cmd = send_pdev_fips_cmd_non_tlv,
  7514. .send_wlan_profile_enable_cmd = send_wlan_profile_enable_cmd_non_tlv,
  7515. .send_wlan_profile_trigger_cmd = send_wlan_profile_trigger_cmd_non_tlv,
  7516. .send_pdev_set_chan_cmd = send_pdev_set_chan_cmd_non_tlv,
  7517. .send_set_ht_ie_cmd = send_set_ht_ie_cmd_non_tlv,
  7518. .send_set_vht_ie_cmd = send_set_vht_ie_cmd_non_tlv,
  7519. .send_wmm_update_cmd = send_wmm_update_cmd_non_tlv,
  7520. .send_set_ant_switch_tbl_cmd = send_set_ant_switch_tbl_cmd_non_tlv,
  7521. .send_set_ratepwr_table_cmd = send_set_ratepwr_table_cmd_non_tlv,
  7522. .send_get_ratepwr_table_cmd = send_get_ratepwr_table_cmd_non_tlv,
  7523. .send_set_ctl_table_cmd = send_set_ctl_table_cmd_non_tlv,
  7524. .send_set_mimogain_table_cmd = send_set_mimogain_table_cmd_non_tlv,
  7525. .send_set_ratepwr_chainmsk_cmd = send_set_ratepwr_chainmsk_cmd_non_tlv,
  7526. .send_set_macaddr_cmd = send_set_macaddr_cmd_non_tlv,
  7527. .send_pdev_scan_start_cmd = send_pdev_scan_start_cmd_non_tlv,
  7528. .send_pdev_scan_end_cmd = send_pdev_scan_end_cmd_non_tlv,
  7529. .send_set_acparams_cmd = send_set_acparams_cmd_non_tlv,
  7530. .send_set_vap_dscp_tid_map_cmd = send_set_vap_dscp_tid_map_cmd_non_tlv,
  7531. .send_proxy_ast_reserve_cmd = send_proxy_ast_reserve_cmd_non_tlv,
  7532. .send_pdev_qvit_cmd = send_pdev_qvit_cmd_non_tlv,
  7533. .send_mcast_group_update_cmd = send_mcast_group_update_cmd_non_tlv,
  7534. .send_peer_add_wds_entry_cmd = send_peer_add_wds_entry_cmd_non_tlv,
  7535. .send_peer_del_wds_entry_cmd = send_peer_del_wds_entry_cmd_non_tlv,
  7536. .send_set_bridge_mac_addr_cmd = send_set_bridge_mac_addr_cmd_non_tlv,
  7537. .send_peer_update_wds_entry_cmd =
  7538. send_peer_update_wds_entry_cmd_non_tlv,
  7539. .send_phyerr_enable_cmd = send_phyerr_enable_cmd_non_tlv,
  7540. .send_phyerr_disable_cmd = send_phyerr_disable_cmd_non_tlv,
  7541. .send_smart_ant_enable_cmd = send_smart_ant_enable_cmd_non_tlv,
  7542. .send_smart_ant_set_rx_ant_cmd = send_smart_ant_set_rx_ant_cmd_non_tlv,
  7543. .send_smart_ant_set_tx_ant_cmd = send_smart_ant_set_tx_ant_cmd_non_tlv,
  7544. .send_smart_ant_set_training_info_cmd =
  7545. send_smart_ant_set_training_info_cmd_non_tlv,
  7546. .send_smart_ant_set_node_config_cmd =
  7547. send_smart_ant_set_node_config_cmd_non_tlv,
  7548. .send_smart_ant_enable_tx_feedback_cmd =
  7549. send_smart_ant_enable_tx_feedback_cmd_non_tlv,
  7550. .send_vdev_spectral_configure_cmd =
  7551. send_vdev_spectral_configure_cmd_non_tlv,
  7552. .send_vdev_spectral_enable_cmd =
  7553. send_vdev_spectral_enable_cmd_non_tlv,
  7554. .send_bss_chan_info_request_cmd =
  7555. send_bss_chan_info_request_cmd_non_tlv,
  7556. .send_thermal_mitigation_param_cmd =
  7557. send_thermal_mitigation_param_cmd_non_tlv,
  7558. .send_vdev_start_cmd = send_vdev_start_cmd_non_tlv,
  7559. .send_vdev_set_nac_rssi_cmd = send_vdev_set_nac_rssi_cmd_non_tlv,
  7560. .send_vdev_stop_cmd = send_vdev_stop_cmd_non_tlv,
  7561. .send_vdev_set_neighbour_rx_cmd =
  7562. send_vdev_set_neighbour_rx_cmd_non_tlv,
  7563. .send_vdev_set_fwtest_param_cmd =
  7564. send_vdev_set_fwtest_param_cmd_non_tlv,
  7565. .send_vdev_config_ratemask_cmd = send_vdev_config_ratemask_cmd_non_tlv,
  7566. .send_setup_install_key_cmd =
  7567. send_setup_install_key_cmd_non_tlv,
  7568. .send_wow_wakeup_cmd = send_wow_wakeup_cmd_non_tlv,
  7569. .send_wow_add_wakeup_event_cmd = send_wow_add_wakeup_event_cmd_non_tlv,
  7570. .send_wow_add_wakeup_pattern_cmd =
  7571. send_wow_add_wakeup_pattern_cmd_non_tlv,
  7572. .send_wow_remove_wakeup_pattern_cmd =
  7573. send_wow_remove_wakeup_pattern_cmd_non_tlv,
  7574. .send_pdev_set_regdomain_cmd =
  7575. send_pdev_set_regdomain_cmd_non_tlv,
  7576. .send_set_quiet_mode_cmd = send_set_quiet_mode_cmd_non_tlv,
  7577. .send_set_beacon_filter_cmd = send_set_beacon_filter_cmd_non_tlv,
  7578. .send_remove_beacon_filter_cmd = send_remove_beacon_filter_cmd_non_tlv,
  7579. .send_mgmt_cmd = send_mgmt_cmd_non_tlv,
  7580. .send_addba_clearresponse_cmd = send_addba_clearresponse_cmd_non_tlv,
  7581. .send_addba_send_cmd = send_addba_send_cmd_non_tlv,
  7582. .send_delba_send_cmd = send_delba_send_cmd_non_tlv,
  7583. .send_addba_setresponse_cmd = send_addba_setresponse_cmd_non_tlv,
  7584. .send_singleamsdu_cmd = send_singleamsdu_cmd_non_tlv,
  7585. .send_set_qboost_param_cmd = send_set_qboost_param_cmd_non_tlv,
  7586. .send_mu_scan_cmd = send_mu_scan_cmd_non_tlv,
  7587. .send_lteu_config_cmd = send_lteu_config_cmd_non_tlv,
  7588. .send_set_ps_mode_cmd = send_set_ps_mode_cmd_non_tlv,
  7589. .init_cmd_send = init_cmd_send_non_tlv,
  7590. .send_ext_resource_config = send_ext_resource_config_non_tlv,
  7591. #if 0
  7592. .send_bcn_prb_template_cmd = send_bcn_prb_template_cmd_non_tlv,
  7593. #endif
  7594. .send_nf_dbr_dbm_info_get_cmd = send_nf_dbr_dbm_info_get_cmd_non_tlv,
  7595. .send_packet_power_info_get_cmd =
  7596. send_packet_power_info_get_cmd_non_tlv,
  7597. .send_gpio_config_cmd = send_gpio_config_cmd_non_tlv,
  7598. .send_gpio_output_cmd = send_gpio_output_cmd_non_tlv,
  7599. .send_rtt_meas_req_test_cmd = send_rtt_meas_req_test_cmd_non_tlv,
  7600. .send_rtt_meas_req_cmd = send_rtt_meas_req_cmd_non_tlv,
  7601. .send_lci_set_cmd = send_lci_set_cmd_non_tlv,
  7602. .send_lcr_set_cmd = send_lcr_set_cmd_non_tlv,
  7603. .send_start_oem_data_cmd = send_start_oem_data_cmd_non_tlv,
  7604. .send_rtt_keepalive_req_cmd = send_rtt_keepalive_req_cmd_non_tlv,
  7605. .send_periodic_chan_stats_config_cmd =
  7606. send_periodic_chan_stats_config_cmd_non_tlv,
  7607. .send_get_user_position_cmd = send_get_user_position_cmd_non_tlv,
  7608. .send_reset_peer_mumimo_tx_count_cmd =
  7609. send_reset_peer_mumimo_tx_count_cmd_non_tlv,
  7610. .send_get_peer_mumimo_tx_count_cmd =
  7611. send_get_peer_mumimo_tx_count_cmd_non_tlv,
  7612. .send_pdev_caldata_version_check_cmd =
  7613. send_pdev_caldata_version_check_cmd_non_tlv,
  7614. .send_btcoex_wlan_priority_cmd = send_btcoex_wlan_priority_cmd_non_tlv,
  7615. .send_btcoex_duty_cycle_cmd = send_btcoex_duty_cycle_cmd_non_tlv,
  7616. .send_coex_ver_cfg_cmd = send_coex_ver_cfg_cmd_non_tlv,
  7617. .get_target_cap_from_service_ready = extract_service_ready_non_tlv,
  7618. .extract_fw_version = extract_fw_version_non_tlv,
  7619. .extract_fw_abi_version = extract_fw_abi_version_non_tlv,
  7620. .extract_hal_reg_cap = extract_hal_reg_cap_non_tlv,
  7621. .extract_host_mem_req = extract_host_mem_req_non_tlv,
  7622. .save_service_bitmap = save_service_bitmap_non_tlv,
  7623. .is_service_enabled = is_service_enabled_non_tlv,
  7624. .save_fw_version = save_fw_version_in_service_ready_non_tlv,
  7625. .check_and_update_fw_version =
  7626. ready_check_and_update_fw_version_non_tlv,
  7627. .extract_dbglog_data_len = extract_dbglog_data_len_non_tlv,
  7628. .ready_extract_init_status = ready_extract_init_status_non_tlv,
  7629. .ready_extract_mac_addr = ready_extract_mac_addr_non_tlv,
  7630. .extract_ready_event_params = extract_ready_event_params_non_tlv,
  7631. .extract_wds_addr_event = extract_wds_addr_event_non_tlv,
  7632. .extract_dcs_interference_type = extract_dcs_interference_type_non_tlv,
  7633. .extract_dcs_cw_int = extract_dcs_cw_int_non_tlv,
  7634. .extract_dcs_im_tgt_stats = extract_dcs_im_tgt_stats_non_tlv,
  7635. .extract_vdev_start_resp = extract_vdev_start_resp_non_tlv,
  7636. .extract_tbttoffset_update_params =
  7637. extract_tbttoffset_update_params_non_tlv,
  7638. .extract_tbttoffset_num_vdevs =
  7639. extract_tbttoffset_num_vdevs_non_tlv,
  7640. .extract_mgmt_rx_params = extract_mgmt_rx_params_non_tlv,
  7641. .extract_vdev_stopped_param = extract_vdev_stopped_param_non_tlv,
  7642. .extract_vdev_roam_param = extract_vdev_roam_param_non_tlv,
  7643. .extract_vdev_scan_ev_param = extract_vdev_scan_ev_param_non_tlv,
  7644. .extract_mu_ev_param = extract_mu_ev_param_non_tlv,
  7645. .extract_pdev_tpc_config_ev_param =
  7646. extract_pdev_tpc_config_ev_param_non_tlv,
  7647. .extract_nfcal_power_ev_param = extract_nfcal_power_ev_param_non_tlv,
  7648. .extract_pdev_tpc_ev_param = extract_pdev_tpc_ev_param_non_tlv,
  7649. .extract_pdev_generic_buffer_ev_param =
  7650. extract_pdev_generic_buffer_ev_param_non_tlv,
  7651. .extract_gpio_input_ev_param = extract_gpio_input_ev_param_non_tlv,
  7652. .extract_pdev_reserve_ast_ev_param =
  7653. extract_pdev_reserve_ast_ev_param_non_tlv,
  7654. .extract_swba_num_vdevs = extract_swba_num_vdevs_non_tlv,
  7655. .extract_swba_tim_info = extract_swba_tim_info_non_tlv,
  7656. .extract_swba_noa_info = extract_swba_noa_info_non_tlv,
  7657. .extract_peer_sta_ps_statechange_ev =
  7658. extract_peer_sta_ps_statechange_ev_non_tlv,
  7659. .extract_peer_sta_kickout_ev = extract_peer_sta_kickout_ev_non_tlv,
  7660. .extract_peer_ratecode_list_ev = extract_peer_ratecode_list_ev_non_tlv,
  7661. .extract_comb_phyerr = extract_comb_phyerr_non_tlv,
  7662. .extract_single_phyerr = extract_single_phyerr_non_tlv,
  7663. .extract_composite_phyerr = extract_composite_phyerr_non_tlv,
  7664. .extract_rtt_hdr = extract_rtt_hdr_non_tlv,
  7665. .extract_rtt_ev = extract_rtt_ev_non_tlv,
  7666. .extract_rtt_error_report_ev = extract_rtt_error_report_ev_non_tlv,
  7667. .extract_all_stats_count = extract_all_stats_counts_non_tlv,
  7668. .extract_pdev_stats = extract_pdev_stats_non_tlv,
  7669. .extract_pdev_ext_stats = extract_pdev_ext_stats_non_tlv,
  7670. .extract_vdev_stats = extract_vdev_stats_non_tlv,
  7671. .extract_peer_stats = extract_peer_stats_non_tlv,
  7672. .extract_bcnflt_stats = extract_bcnflt_stats_non_tlv,
  7673. .extract_peer_extd_stats = extract_peer_extd_stats_non_tlv,
  7674. .extract_chan_stats = extract_chan_stats_non_tlv,
  7675. .extract_thermal_stats = extract_thermal_stats_non_tlv,
  7676. .extract_thermal_level_stats = extract_thermal_level_stats_non_tlv,
  7677. .extract_profile_ctx = extract_profile_ctx_non_tlv,
  7678. .extract_profile_data = extract_profile_data_non_tlv,
  7679. .extract_chan_info_event = extract_chan_info_event_non_tlv,
  7680. .extract_channel_hopping_event = extract_channel_hopping_event_non_tlv,
  7681. .extract_bss_chan_info_event = extract_bss_chan_info_event_non_tlv,
  7682. .extract_inst_rssi_stats_event = extract_inst_rssi_stats_event_non_tlv,
  7683. .extract_tx_data_traffic_ctrl_ev =
  7684. extract_tx_data_traffic_ctrl_ev_non_tlv,
  7685. .extract_vdev_extd_stats = extract_vdev_extd_stats_non_tlv,
  7686. .extract_vdev_nac_rssi_stats = extract_vdev_nac_rssi_stats_non_tlv,
  7687. .extract_fips_event_data = extract_fips_event_data_non_tlv,
  7688. .extract_mumimo_tx_count_ev_param =
  7689. extract_mumimo_tx_count_ev_param_non_tlv,
  7690. .extract_peer_gid_userpos_list_ev_param =
  7691. extract_peer_gid_userpos_list_ev_param_non_tlv,
  7692. .extract_pdev_caldata_version_check_ev_param =
  7693. extract_pdev_caldata_version_check_ev_param_non_tlv,
  7694. .extract_mu_db_entry = extract_mu_db_entry_non_tlv,
  7695. .extract_atf_peer_stats_ev = extract_atf_peer_stats_ev_non_tlv,
  7696. .extract_atf_token_info_ev = extract_atf_token_info_ev_non_tlv,
  7697. .extract_pdev_utf_event = extract_pdev_utf_event_non_tlv,
  7698. .wmi_set_htc_tx_tag = wmi_set_htc_tx_tag_non_tlv,
  7699. .is_management_record = is_management_record_non_tlv,
  7700. .send_dfs_phyerr_offload_en_cmd =
  7701. send_dfs_phyerr_offload_en_cmd_non_tlv,
  7702. .send_dfs_phyerr_offload_dis_cmd =
  7703. send_dfs_phyerr_offload_dis_cmd_non_tlv,
  7704. .send_wds_entry_list_cmd = send_wds_entry_list_cmd_non_tlv,
  7705. .extract_wds_entry = extract_wds_entry_non_tlv,
  7706. #ifdef WLAN_SUPPORT_FILS
  7707. .send_vdev_fils_enable_cmd = send_vdev_fils_enable_cmd_non_tlv,
  7708. .send_fils_discovery_send_cmd = send_fils_discovery_send_cmd_non_tlv,
  7709. .extract_swfda_vdev_id = extract_swfda_vdev_id_non_tlv,
  7710. #endif /* WLAN_SUPPORT_FILS */
  7711. .wmi_pdev_id_conversion_enable = wmi_non_tlv_pdev_id_conversion_enable,
  7712. };
  7713. /**
  7714. * populate_non_tlv_service() - populates wmi services
  7715. *
  7716. * @param wmi_service: Pointer to hold wmi_service
  7717. * Return: None
  7718. */
  7719. static void populate_non_tlv_service(uint32_t *wmi_service)
  7720. {
  7721. wmi_service[wmi_service_beacon_offload] = WMI_SERVICE_BEACON_OFFLOAD;
  7722. wmi_service[wmi_service_scan_offload] = WMI_SERVICE_SCAN_OFFLOAD;
  7723. wmi_service[wmi_service_roam_offload] = WMI_SERVICE_ROAM_OFFLOAD;
  7724. wmi_service[wmi_service_bcn_miss_offload] =
  7725. WMI_SERVICE_BCN_MISS_OFFLOAD;
  7726. wmi_service[wmi_service_sta_pwrsave] = WMI_SERVICE_STA_PWRSAVE;
  7727. wmi_service[wmi_service_sta_advanced_pwrsave] =
  7728. WMI_SERVICE_STA_ADVANCED_PWRSAVE;
  7729. wmi_service[wmi_service_ap_uapsd] = WMI_SERVICE_AP_UAPSD;
  7730. wmi_service[wmi_service_ap_dfs] = WMI_SERVICE_AP_DFS;
  7731. wmi_service[wmi_service_11ac] = WMI_SERVICE_11AC;
  7732. wmi_service[wmi_service_blockack] = WMI_SERVICE_BLOCKACK;
  7733. wmi_service[wmi_service_phyerr] = WMI_SERVICE_PHYERR;
  7734. wmi_service[wmi_service_bcn_filter] = WMI_SERVICE_BCN_FILTER;
  7735. wmi_service[wmi_service_rtt] = WMI_SERVICE_RTT;
  7736. wmi_service[wmi_service_ratectrl] = WMI_SERVICE_RATECTRL;
  7737. wmi_service[wmi_service_wow] = WMI_SERVICE_WOW;
  7738. wmi_service[wmi_service_ratectrl_cache] = WMI_SERVICE_RATECTRL_CACHE;
  7739. wmi_service[wmi_service_iram_tids] = WMI_SERVICE_IRAM_TIDS;
  7740. wmi_service[wmi_service_burst] = WMI_SERVICE_BURST;
  7741. wmi_service[wmi_service_smart_antenna_sw_support] =
  7742. WMI_SERVICE_SMART_ANTENNA_SW_SUPPORT;
  7743. wmi_service[wmi_service_gtk_offload] = WMI_SERVICE_GTK_OFFLOAD;
  7744. wmi_service[wmi_service_scan_sch] = WMI_SERVICE_SCAN_SCH;
  7745. wmi_service[wmi_service_csa_offload] = WMI_SERVICE_CSA_OFFLOAD;
  7746. wmi_service[wmi_service_chatter] = WMI_SERVICE_CHATTER;
  7747. wmi_service[wmi_service_coex_freqavoid] = WMI_SERVICE_COEX_FREQAVOID;
  7748. wmi_service[wmi_service_packet_power_save] =
  7749. WMI_SERVICE_PACKET_POWER_SAVE;
  7750. wmi_service[wmi_service_force_fw_hang] = WMI_SERVICE_FORCE_FW_HANG;
  7751. wmi_service[wmi_service_smart_antenna_hw_support] =
  7752. WMI_SERVICE_SMART_ANTENNA_HW_SUPPORT;
  7753. wmi_service[wmi_service_gpio] = WMI_SERVICE_GPIO;
  7754. wmi_service[wmi_sta_uapsd_basic_auto_trig] =
  7755. WMI_STA_UAPSD_BASIC_AUTO_TRIG;
  7756. wmi_service[wmi_sta_uapsd_var_auto_trig] = WMI_STA_UAPSD_VAR_AUTO_TRIG;
  7757. wmi_service[wmi_service_sta_keep_alive] = WMI_SERVICE_STA_KEEP_ALIVE;
  7758. wmi_service[wmi_service_tx_encap] = WMI_SERVICE_TX_ENCAP;
  7759. wmi_service[wmi_service_ap_ps_detect_out_of_sync] =
  7760. WMI_SERVICE_AP_PS_DETECT_OUT_OF_SYNC;
  7761. wmi_service[wmi_service_early_rx] =
  7762. WMI_SERVICE_EARLY_RX;
  7763. wmi_service[wmi_service_enhanced_proxy_sta] =
  7764. WMI_SERVICE_ENHANCED_PROXY_STA;
  7765. wmi_service[wmi_service_tt] = WMI_SERVICE_TT;
  7766. wmi_service[wmi_service_atf] = WMI_SERVICE_ATF;
  7767. wmi_service[wmi_service_peer_caching] = WMI_SERVICE_PEER_CACHING;
  7768. wmi_service[wmi_service_coex_gpio] = WMI_SERVICE_COEX_GPIO;
  7769. wmi_service[wmi_service_aux_spectral_intf] =
  7770. WMI_SERVICE_AUX_SPECTRAL_INTF;
  7771. wmi_service[wmi_service_aux_chan_load_intf] =
  7772. WMI_SERVICE_AUX_CHAN_LOAD_INTF;
  7773. wmi_service[wmi_service_bss_channel_info_64] =
  7774. WMI_SERVICE_BSS_CHANNEL_INFO_64;
  7775. wmi_service[wmi_service_ext_res_cfg_support] =
  7776. WMI_SERVICE_EXT_RES_CFG_SUPPORT;
  7777. wmi_service[wmi_service_mesh] = WMI_SERVICE_MESH;
  7778. wmi_service[wmi_service_restrt_chnl_support] =
  7779. WMI_SERVICE_RESTRT_CHNL_SUPPORT;
  7780. wmi_service[wmi_service_peer_stats] = WMI_SERVICE_PEER_STATS;
  7781. wmi_service[wmi_service_mesh_11s] = WMI_SERVICE_MESH_11S;
  7782. wmi_service[wmi_service_periodic_chan_stat_support] =
  7783. WMI_SERVICE_PERIODIC_CHAN_STAT_SUPPORT;
  7784. wmi_service[wmi_service_tx_mode_push_only] =
  7785. WMI_SERVICE_TX_MODE_PUSH_ONLY;
  7786. wmi_service[wmi_service_tx_mode_push_pull] =
  7787. WMI_SERVICE_TX_MODE_PUSH_PULL;
  7788. wmi_service[wmi_service_tx_mode_dynamic] = WMI_SERVICE_TX_MODE_DYNAMIC;
  7789. wmi_service[wmi_service_check_cal_version] =
  7790. WMI_SERVICE_CHECK_CAL_VERSION;
  7791. wmi_service[wmi_service_btcoex_duty_cycle] =
  7792. WMI_SERVICE_BTCOEX_DUTY_CYCLE;
  7793. wmi_service[wmi_service_4_wire_coex_support] =
  7794. WMI_SERVICE_4_WIRE_COEX_SUPPORT;
  7795. wmi_service[wmi_service_extended_nss_support] =
  7796. WMI_SERVICE_EXTENDED_NSS_SUPPORT;
  7797. wmi_service[wmi_service_roam_scan_offload] = WMI_SERVICE_UNAVAILABLE;
  7798. wmi_service[wmi_service_arpns_offload] = WMI_SERVICE_UNAVAILABLE;
  7799. wmi_service[wmi_service_nlo] = WMI_SERVICE_UNAVAILABLE;
  7800. wmi_service[wmi_service_sta_dtim_ps_modulated_dtim] =
  7801. WMI_SERVICE_UNAVAILABLE;
  7802. wmi_service[wmi_service_sta_smps] = WMI_SERVICE_UNAVAILABLE;
  7803. wmi_service[wmi_service_fwtest] = WMI_SERVICE_UNAVAILABLE;
  7804. wmi_service[wmi_service_sta_wmmac] = WMI_SERVICE_UNAVAILABLE;
  7805. wmi_service[wmi_service_tdls] = WMI_SERVICE_UNAVAILABLE;
  7806. wmi_service[wmi_service_mcc_bcn_interval_change] =
  7807. WMI_SERVICE_UNAVAILABLE;
  7808. wmi_service[wmi_service_adaptive_ocs] = WMI_SERVICE_UNAVAILABLE;
  7809. wmi_service[wmi_service_ba_ssn_support] = WMI_SERVICE_UNAVAILABLE;
  7810. wmi_service[wmi_service_filter_ipsec_natkeepalive] =
  7811. WMI_SERVICE_UNAVAILABLE;
  7812. wmi_service[wmi_service_wlan_hb] = WMI_SERVICE_UNAVAILABLE;
  7813. wmi_service[wmi_service_lte_ant_share_support] =
  7814. WMI_SERVICE_UNAVAILABLE;
  7815. wmi_service[wmi_service_batch_scan] = WMI_SERVICE_UNAVAILABLE;
  7816. wmi_service[wmi_service_qpower] = WMI_SERVICE_UNAVAILABLE;
  7817. wmi_service[wmi_service_plmreq] = WMI_SERVICE_UNAVAILABLE;
  7818. wmi_service[wmi_service_thermal_mgmt] = WMI_SERVICE_UNAVAILABLE;
  7819. wmi_service[wmi_service_rmc] = WMI_SERVICE_UNAVAILABLE;
  7820. wmi_service[wmi_service_mhf_offload] = WMI_SERVICE_UNAVAILABLE;
  7821. wmi_service[wmi_service_coex_sar] = WMI_SERVICE_UNAVAILABLE;
  7822. wmi_service[wmi_service_bcn_txrate_override] = WMI_SERVICE_UNAVAILABLE;
  7823. wmi_service[wmi_service_nan] = WMI_SERVICE_UNAVAILABLE;
  7824. wmi_service[wmi_service_l1ss_stat] = WMI_SERVICE_UNAVAILABLE;
  7825. wmi_service[wmi_service_estimate_linkspeed] = WMI_SERVICE_UNAVAILABLE;
  7826. wmi_service[wmi_service_obss_scan] = WMI_SERVICE_UNAVAILABLE;
  7827. wmi_service[wmi_service_tdls_offchan] = WMI_SERVICE_UNAVAILABLE;
  7828. wmi_service[wmi_service_tdls_uapsd_buffer_sta] =
  7829. WMI_SERVICE_UNAVAILABLE;
  7830. wmi_service[wmi_service_tdls_uapsd_sleep_sta] = WMI_SERVICE_UNAVAILABLE;
  7831. wmi_service[wmi_service_ibss_pwrsave] = WMI_SERVICE_UNAVAILABLE;
  7832. wmi_service[wmi_service_lpass] = WMI_SERVICE_UNAVAILABLE;
  7833. wmi_service[wmi_service_extscan] = WMI_SERVICE_UNAVAILABLE;
  7834. wmi_service[wmi_service_d0wow] = WMI_SERVICE_UNAVAILABLE;
  7835. wmi_service[wmi_service_hsoffload] = WMI_SERVICE_UNAVAILABLE;
  7836. wmi_service[wmi_service_roam_ho_offload] = WMI_SERVICE_UNAVAILABLE;
  7837. wmi_service[wmi_service_rx_full_reorder] = WMI_SERVICE_UNAVAILABLE;
  7838. wmi_service[wmi_service_dhcp_offload] = WMI_SERVICE_UNAVAILABLE;
  7839. wmi_service[wmi_service_sta_rx_ipa_offload_support] =
  7840. WMI_SERVICE_UNAVAILABLE;
  7841. wmi_service[wmi_service_mdns_offload] = WMI_SERVICE_UNAVAILABLE;
  7842. wmi_service[wmi_service_sap_auth_offload] = WMI_SERVICE_UNAVAILABLE;
  7843. wmi_service[wmi_service_dual_band_simultaneous_support] =
  7844. WMI_SERVICE_UNAVAILABLE;
  7845. wmi_service[wmi_service_ocb] = WMI_SERVICE_UNAVAILABLE;
  7846. wmi_service[wmi_service_ap_arpns_offload] = WMI_SERVICE_UNAVAILABLE;
  7847. wmi_service[wmi_service_per_band_chainmask_support] =
  7848. WMI_SERVICE_UNAVAILABLE;
  7849. wmi_service[wmi_service_packet_filter_offload] =
  7850. WMI_SERVICE_UNAVAILABLE;
  7851. wmi_service[wmi_service_mgmt_tx_htt] = WMI_SERVICE_UNAVAILABLE;
  7852. wmi_service[wmi_service_mgmt_tx_wmi] = WMI_SERVICE_UNAVAILABLE;
  7853. wmi_service[wmi_service_ext_msg] = WMI_SERVICE_UNAVAILABLE;
  7854. wmi_service[wmi_service_mawc] = WMI_SERVICE_UNAVAILABLE;
  7855. wmi_service[wmi_service_multiple_vdev_restart] =
  7856. WMI_SERVICE_UNAVAILABLE;
  7857. wmi_service[wmi_service_peer_assoc_conf] = WMI_SERVICE_UNAVAILABLE;
  7858. wmi_service[wmi_service_egap] = WMI_SERVICE_UNAVAILABLE;
  7859. wmi_service[wmi_service_sta_pmf_offload] = WMI_SERVICE_UNAVAILABLE;
  7860. wmi_service[wmi_service_unified_wow_capability] =
  7861. WMI_SERVICE_UNAVAILABLE;
  7862. wmi_service[wmi_service_enterprise_mesh] = WMI_SERVICE_UNAVAILABLE;
  7863. wmi_service[wmi_service_bpf_offload] = WMI_SERVICE_UNAVAILABLE;
  7864. wmi_service[wmi_service_sync_delete_cmds] = WMI_SERVICE_UNAVAILABLE;
  7865. wmi_service[wmi_service_ratectrl_limit_max_min_rates] =
  7866. WMI_SERVICE_UNAVAILABLE;
  7867. wmi_service[wmi_service_nan_data] = WMI_SERVICE_UNAVAILABLE;
  7868. wmi_service[wmi_service_nan_rtt] = WMI_SERVICE_UNAVAILABLE;
  7869. wmi_service[wmi_service_11ax] = WMI_SERVICE_UNAVAILABLE;
  7870. wmi_service[wmi_service_deprecated_replace] = WMI_SERVICE_UNAVAILABLE;
  7871. wmi_service[wmi_service_tdls_conn_tracker_in_host_mode] =
  7872. WMI_SERVICE_UNAVAILABLE;
  7873. wmi_service[wmi_service_enhanced_mcast_filter] =WMI_SERVICE_UNAVAILABLE;
  7874. wmi_service[wmi_service_half_rate_quarter_rate_support] =
  7875. WMI_SERVICE_UNAVAILABLE;
  7876. wmi_service[wmi_service_vdev_rx_filter] = WMI_SERVICE_UNAVAILABLE;
  7877. wmi_service[wmi_service_p2p_listen_offload_support] =
  7878. WMI_SERVICE_UNAVAILABLE;
  7879. wmi_service[wmi_service_mark_first_wakeup_packet] =
  7880. WMI_SERVICE_UNAVAILABLE;
  7881. wmi_service[wmi_service_multiple_mcast_filter_set] =
  7882. WMI_SERVICE_UNAVAILABLE;
  7883. wmi_service[wmi_service_host_managed_rx_reorder] =
  7884. WMI_SERVICE_UNAVAILABLE;
  7885. wmi_service[wmi_service_flash_rdwr_support] = WMI_SERVICE_UNAVAILABLE;
  7886. wmi_service[wmi_service_wlan_stats_report] = WMI_SERVICE_UNAVAILABLE;
  7887. wmi_service[wmi_service_tx_msdu_id_new_partition_support] =
  7888. WMI_SERVICE_UNAVAILABLE;
  7889. wmi_service[wmi_service_dfs_phyerr_offload] = WMI_SERVICE_UNAVAILABLE;
  7890. wmi_service[wmi_service_rcpi_support] = WMI_SERVICE_UNAVAILABLE;
  7891. wmi_service[wmi_service_fw_mem_dump_support] = WMI_SERVICE_UNAVAILABLE;
  7892. wmi_service[wmi_service_peer_stats_info] = WMI_SERVICE_UNAVAILABLE;
  7893. wmi_service[wmi_service_regulatory_db] = WMI_SERVICE_UNAVAILABLE;
  7894. wmi_service[wmi_service_11d_offload] = WMI_SERVICE_UNAVAILABLE;
  7895. wmi_service[wmi_service_hw_data_filtering] = WMI_SERVICE_UNAVAILABLE;
  7896. wmi_service[wmi_service_pkt_routing] = WMI_SERVICE_UNAVAILABLE;
  7897. wmi_service[wmi_service_offchan_tx_wmi] = WMI_SERVICE_UNAVAILABLE;
  7898. wmi_service[wmi_service_chan_load_info] = WMI_SERVICE_UNAVAILABLE;
  7899. wmi_service[wmi_service_ack_timeout] = WMI_SERVICE_UNAVAILABLE;
  7900. wmi_service[wmi_service_widebw_scan] = WMI_SERVICE_UNAVAILABLE;
  7901. wmi_service[wmi_service_support_dma] =
  7902. WMI_SERVICE_UNAVAILABLE;
  7903. }
  7904. /**
  7905. * populate_non_tlv_event_id() - populates wmi event ids
  7906. *
  7907. * @param event_ids: Pointer to hold event ids
  7908. * Return: None
  7909. */
  7910. static void populate_non_tlv_events_id(uint32_t *event_ids)
  7911. {
  7912. event_ids[wmi_service_ready_event_id] = WMI_SERVICE_READY_EVENTID;
  7913. event_ids[wmi_ready_event_id] = WMI_READY_EVENTID;
  7914. event_ids[wmi_dbg_msg_event_id] = WMI_DEBUG_MESG_EVENTID;
  7915. event_ids[wmi_scan_event_id] = WMI_SCAN_EVENTID;
  7916. event_ids[wmi_echo_event_id] = WMI_ECHO_EVENTID;
  7917. event_ids[wmi_update_stats_event_id] = WMI_UPDATE_STATS_EVENTID;
  7918. event_ids[wmi_inst_rssi_stats_event_id] = WMI_INST_RSSI_STATS_EVENTID;
  7919. event_ids[wmi_vdev_start_resp_event_id] = WMI_VDEV_START_RESP_EVENTID;
  7920. event_ids[wmi_vdev_standby_req_event_id] = WMI_VDEV_STANDBY_REQ_EVENTID;
  7921. event_ids[wmi_vdev_resume_req_event_id] = WMI_VDEV_RESUME_REQ_EVENTID;
  7922. event_ids[wmi_vdev_stopped_event_id] = WMI_VDEV_STOPPED_EVENTID;
  7923. event_ids[wmi_peer_sta_kickout_event_id] = WMI_PEER_STA_KICKOUT_EVENTID;
  7924. event_ids[wmi_host_swba_event_id] = WMI_HOST_SWBA_EVENTID;
  7925. event_ids[wmi_tbttoffset_update_event_id] =
  7926. WMI_TBTTOFFSET_UPDATE_EVENTID;
  7927. event_ids[wmi_mgmt_rx_event_id] = WMI_MGMT_RX_EVENTID;
  7928. event_ids[wmi_chan_info_event_id] = WMI_CHAN_INFO_EVENTID;
  7929. event_ids[wmi_phyerr_event_id] = WMI_PHYERR_EVENTID;
  7930. event_ids[wmi_roam_event_id] = WMI_ROAM_EVENTID;
  7931. event_ids[wmi_profile_match] = WMI_PROFILE_MATCH;
  7932. event_ids[wmi_debug_print_event_id] = WMI_DEBUG_PRINT_EVENTID;
  7933. event_ids[wmi_pdev_qvit_event_id] = WMI_PDEV_QVIT_EVENTID;
  7934. event_ids[wmi_wlan_profile_data_event_id] =
  7935. WMI_WLAN_PROFILE_DATA_EVENTID;
  7936. event_ids[wmi_rtt_meas_report_event_id] =
  7937. WMI_RTT_MEASUREMENT_REPORT_EVENTID;
  7938. event_ids[wmi_tsf_meas_report_event_id] =
  7939. WMI_TSF_MEASUREMENT_REPORT_EVENTID;
  7940. event_ids[wmi_rtt_error_report_event_id] = WMI_RTT_ERROR_REPORT_EVENTID;
  7941. event_ids[wmi_rtt_keepalive_event_id] = WMI_RTT_KEEPALIVE_EVENTID;
  7942. event_ids[wmi_oem_cap_event_id] = WMI_OEM_CAPABILITY_EVENTID;
  7943. event_ids[wmi_oem_meas_report_event_id] =
  7944. WMI_OEM_MEASUREMENT_REPORT_EVENTID;
  7945. event_ids[wmi_oem_report_event_id] = WMI_OEM_ERROR_REPORT_EVENTID;
  7946. event_ids[wmi_nan_event_id] = WMI_NAN_EVENTID;
  7947. event_ids[wmi_wow_wakeup_host_event_id] = WMI_WOW_WAKEUP_HOST_EVENTID;
  7948. event_ids[wmi_gtk_offload_status_event_id] =
  7949. WMI_GTK_OFFLOAD_STATUS_EVENTID;
  7950. event_ids[wmi_gtk_rekey_fail_event_id] = WMI_GTK_REKEY_FAIL_EVENTID;
  7951. event_ids[wmi_dcs_interference_event_id] = WMI_DCS_INTERFERENCE_EVENTID;
  7952. event_ids[wmi_pdev_tpc_config_event_id] = WMI_PDEV_TPC_CONFIG_EVENTID;
  7953. event_ids[wmi_csa_handling_event_id] = WMI_CSA_HANDLING_EVENTID;
  7954. event_ids[wmi_gpio_input_event_id] = WMI_GPIO_INPUT_EVENTID;
  7955. event_ids[wmi_peer_ratecode_list_event_id] =
  7956. WMI_PEER_RATECODE_LIST_EVENTID;
  7957. event_ids[wmi_generic_buffer_event_id] = WMI_GENERIC_BUFFER_EVENTID;
  7958. event_ids[wmi_mcast_buf_release_event_id] =
  7959. WMI_MCAST_BUF_RELEASE_EVENTID;
  7960. event_ids[wmi_mcast_list_ageout_event_id] =
  7961. WMI_MCAST_LIST_AGEOUT_EVENTID;
  7962. event_ids[wmi_vdev_get_keepalive_event_id] =
  7963. WMI_VDEV_GET_KEEPALIVE_EVENTID;
  7964. event_ids[wmi_wds_peer_event_id] = WMI_WDS_PEER_EVENTID;
  7965. event_ids[wmi_peer_sta_ps_statechg_event_id] =
  7966. WMI_PEER_STA_PS_STATECHG_EVENTID;
  7967. event_ids[wmi_pdev_fips_event_id] = WMI_PDEV_FIPS_EVENTID;
  7968. event_ids[wmi_tt_stats_event_id] = WMI_TT_STATS_EVENTID;
  7969. event_ids[wmi_pdev_channel_hopping_event_id] =
  7970. WMI_PDEV_CHANNEL_HOPPING_EVENTID;
  7971. event_ids[wmi_pdev_ani_cck_level_event_id] =
  7972. WMI_PDEV_ANI_CCK_LEVEL_EVENTID;
  7973. event_ids[wmi_pdev_ani_ofdm_level_event_id] =
  7974. WMI_PDEV_ANI_OFDM_LEVEL_EVENTID;
  7975. event_ids[wmi_pdev_reserve_ast_entry_event_id] =
  7976. WMI_PDEV_RESERVE_AST_ENTRY_EVENTID;
  7977. event_ids[wmi_pdev_nfcal_power_event_id] = WMI_PDEV_NFCAL_POWER_EVENTID;
  7978. event_ids[wmi_pdev_tpc_event_id] = WMI_PDEV_TPC_EVENTID;
  7979. event_ids[wmi_pdev_get_ast_info_event_id] =
  7980. WMI_PDEV_GET_AST_INFO_EVENTID;
  7981. event_ids[wmi_pdev_temperature_event_id] = WMI_PDEV_TEMPERATURE_EVENTID;
  7982. event_ids[wmi_pdev_nfcal_power_all_channels_event_id] =
  7983. WMI_PDEV_NFCAL_POWER_ALL_CHANNELS_EVENTID;
  7984. event_ids[wmi_pdev_bss_chan_info_event_id] =
  7985. WMI_PDEV_BSS_CHAN_INFO_EVENTID;
  7986. event_ids[wmi_mu_report_event_id] = WMI_MU_REPORT_EVENTID;
  7987. event_ids[wmi_tx_data_traffic_ctrl_event_id] =
  7988. WMI_TX_DATA_TRAFFIC_CTRL_EVENTID;
  7989. event_ids[wmi_pdev_utf_event_id] = WMI_PDEV_UTF_EVENTID;
  7990. event_ids[wmi_peer_tx_mu_txmit_count_event_id] =
  7991. WMI_PEER_TX_MU_TXMIT_COUNT_EVENTID;
  7992. event_ids[wmi_peer_gid_userpos_list_event_id] =
  7993. WMI_PEER_GID_USERPOS_LIST_EVENTID;
  7994. event_ids[wmi_pdev_check_cal_version_event_id] =
  7995. WMI_PDEV_CHECK_CAL_VERSION_EVENTID;
  7996. event_ids[wmi_atf_peer_stats_event_id] =
  7997. WMI_ATF_PEER_STATS_EVENTID;
  7998. event_ids[wmi_pdev_wds_entry_list_event_id] =
  7999. WMI_PDEV_WDS_ENTRY_LIST_EVENTID;
  8000. event_ids[wmi_host_swfda_event_id] = WMI_HOST_SWFDA_EVENTID;
  8001. }
  8002. /**
  8003. * populate_pdev_param_non_tlv() - populates pdev params
  8004. *
  8005. * @param pdev_param: Pointer to hold pdev params
  8006. * Return: None
  8007. */
  8008. static void populate_pdev_param_non_tlv(uint32_t *pdev_param)
  8009. {
  8010. pdev_param[wmi_pdev_param_tx_chain_mask] = WMI_PDEV_PARAM_TX_CHAIN_MASK;
  8011. pdev_param[wmi_pdev_param_rx_chain_mask] = WMI_PDEV_PARAM_RX_CHAIN_MASK;
  8012. pdev_param[wmi_pdev_param_txpower_limit2g] =
  8013. WMI_PDEV_PARAM_TXPOWER_LIMIT2G;
  8014. pdev_param[wmi_pdev_param_txpower_limit5g] =
  8015. WMI_PDEV_PARAM_TXPOWER_LIMIT5G;
  8016. pdev_param[wmi_pdev_param_txpower_scale] = WMI_PDEV_PARAM_TXPOWER_SCALE;
  8017. pdev_param[wmi_pdev_param_beacon_gen_mode] =
  8018. WMI_PDEV_PARAM_BEACON_GEN_MODE;
  8019. pdev_param[wmi_pdev_param_beacon_tx_mode] =
  8020. WMI_PDEV_PARAM_BEACON_TX_MODE;
  8021. pdev_param[wmi_pdev_param_resmgr_offchan_mode] =
  8022. WMI_PDEV_PARAM_RESMGR_OFFCHAN_MODE;
  8023. pdev_param[wmi_pdev_param_protection_mode] =
  8024. WMI_PDEV_PARAM_PROTECTION_MODE;
  8025. pdev_param[wmi_pdev_param_dynamic_bw] = WMI_PDEV_PARAM_DYNAMIC_BW;
  8026. pdev_param[wmi_pdev_param_non_agg_sw_retry_th] =
  8027. WMI_PDEV_PARAM_NON_AGG_SW_RETRY_TH;
  8028. pdev_param[wmi_pdev_param_agg_sw_retry_th] =
  8029. WMI_PDEV_PARAM_AGG_SW_RETRY_TH;
  8030. pdev_param[wmi_pdev_param_sta_kickout_th] =
  8031. WMI_PDEV_PARAM_STA_KICKOUT_TH;
  8032. pdev_param[wmi_pdev_param_ac_aggrsize_scaling] =
  8033. WMI_PDEV_PARAM_AC_AGGRSIZE_SCALING;
  8034. pdev_param[wmi_pdev_param_ltr_enable] = WMI_PDEV_PARAM_LTR_ENABLE;
  8035. pdev_param[wmi_pdev_param_ltr_ac_latency_be] =
  8036. WMI_PDEV_PARAM_LTR_AC_LATENCY_BE;
  8037. pdev_param[wmi_pdev_param_ltr_ac_latency_bk] =
  8038. WMI_PDEV_PARAM_LTR_AC_LATENCY_BK;
  8039. pdev_param[wmi_pdev_param_ltr_ac_latency_vi] =
  8040. WMI_PDEV_PARAM_LTR_AC_LATENCY_VI;
  8041. pdev_param[wmi_pdev_param_ltr_ac_latency_vo] =
  8042. WMI_PDEV_PARAM_LTR_AC_LATENCY_VO;
  8043. pdev_param[wmi_pdev_param_ltr_ac_latency_timeout] =
  8044. WMI_PDEV_PARAM_LTR_AC_LATENCY_TIMEOUT;
  8045. pdev_param[wmi_pdev_param_ltr_sleep_override] =
  8046. WMI_PDEV_PARAM_LTR_SLEEP_OVERRIDE;
  8047. pdev_param[wmi_pdev_param_ltr_rx_override] =
  8048. WMI_PDEV_PARAM_LTR_RX_OVERRIDE;
  8049. pdev_param[wmi_pdev_param_ltr_tx_activity_timeout] =
  8050. WMI_PDEV_PARAM_LTR_TX_ACTIVITY_TIMEOUT;
  8051. pdev_param[wmi_pdev_param_l1ss_enable] = WMI_PDEV_PARAM_L1SS_ENABLE;
  8052. pdev_param[wmi_pdev_param_dsleep_enable] = WMI_PDEV_PARAM_DSLEEP_ENABLE;
  8053. pdev_param[wmi_pdev_param_pcielp_txbuf_flush] =
  8054. WMI_PDEV_PARAM_PCIELP_TXBUF_FLUSH;
  8055. pdev_param[wmi_pdev_param_pcielp_txbuf_watermark] =
  8056. WMI_PDEV_PARAM_PCIELP_TXBUF_WATERMARK;
  8057. pdev_param[wmi_pdev_param_pcielp_txbuf_tmo_en] =
  8058. WMI_PDEV_PARAM_PCIELP_TXBUF_TMO_EN;
  8059. pdev_param[wmi_pdev_param_pcielp_txbuf_tmo_value] =
  8060. WMI_PDEV_PARAM_PCIELP_TXBUF_TMO_VALUE;
  8061. pdev_param[wmi_pdev_param_pdev_stats_update_period] =
  8062. WMI_PDEV_PARAM_PDEV_STATS_UPDATE_PERIOD;
  8063. pdev_param[wmi_pdev_param_vdev_stats_update_period] =
  8064. WMI_PDEV_PARAM_VDEV_STATS_UPDATE_PERIOD;
  8065. pdev_param[wmi_pdev_param_peer_stats_update_period] =
  8066. WMI_PDEV_PARAM_PEER_STATS_UPDATE_PERIOD;
  8067. pdev_param[wmi_pdev_param_bcnflt_stats_update_period] =
  8068. WMI_PDEV_PARAM_BCNFLT_STATS_UPDATE_PERIOD;
  8069. pdev_param[wmi_pdev_param_pmf_qos] =
  8070. WMI_PDEV_PARAM_PMF_QOS;
  8071. pdev_param[wmi_pdev_param_arp_ac_override] =
  8072. WMI_PDEV_PARAM_ARP_AC_OVERRIDE;
  8073. pdev_param[wmi_pdev_param_dcs] =
  8074. WMI_PDEV_PARAM_DCS;
  8075. pdev_param[wmi_pdev_param_ani_enable] = WMI_PDEV_PARAM_ANI_ENABLE;
  8076. pdev_param[wmi_pdev_param_ani_poll_period] =
  8077. WMI_PDEV_PARAM_ANI_POLL_PERIOD;
  8078. pdev_param[wmi_pdev_param_ani_listen_period] =
  8079. WMI_PDEV_PARAM_ANI_LISTEN_PERIOD;
  8080. pdev_param[wmi_pdev_param_ani_ofdm_level] =
  8081. WMI_PDEV_PARAM_ANI_OFDM_LEVEL;
  8082. pdev_param[wmi_pdev_param_ani_cck_level] = WMI_PDEV_PARAM_ANI_CCK_LEVEL;
  8083. pdev_param[wmi_pdev_param_dyntxchain] = WMI_PDEV_PARAM_DYNTXCHAIN;
  8084. pdev_param[wmi_pdev_param_proxy_sta] = WMI_PDEV_PARAM_PROXY_STA;
  8085. pdev_param[wmi_pdev_param_idle_ps_config] =
  8086. WMI_PDEV_PARAM_IDLE_PS_CONFIG;
  8087. pdev_param[wmi_pdev_param_power_gating_sleep] =
  8088. WMI_PDEV_PARAM_POWER_GATING_SLEEP;
  8089. pdev_param[wmi_pdev_param_aggr_burst] = WMI_PDEV_PARAM_AGGR_BURST;
  8090. pdev_param[wmi_pdev_param_rx_decap_mode] = WMI_PDEV_PARAM_RX_DECAP_MODE;
  8091. pdev_param[wmi_pdev_param_fast_channel_reset] =
  8092. WMI_PDEV_PARAM_FAST_CHANNEL_RESET;
  8093. pdev_param[wmi_pdev_param_burst_dur] = WMI_PDEV_PARAM_BURST_DUR;
  8094. pdev_param[wmi_pdev_param_burst_enable] = WMI_PDEV_PARAM_BURST_ENABLE;
  8095. pdev_param[wmi_pdev_param_smart_antenna_default_antenna] =
  8096. WMI_PDEV_PARAM_SMART_ANTENNA_DEFAULT_ANTENNA;
  8097. pdev_param[wmi_pdev_param_igmpmld_override] =
  8098. WMI_PDEV_PARAM_IGMPMLD_OVERRIDE;
  8099. pdev_param[wmi_pdev_param_igmpmld_tid] =
  8100. WMI_PDEV_PARAM_IGMPMLD_TID;
  8101. pdev_param[wmi_pdev_param_antenna_gain] = WMI_PDEV_PARAM_ANTENNA_GAIN;
  8102. pdev_param[wmi_pdev_param_rx_filter] = WMI_PDEV_PARAM_RX_FILTER;
  8103. pdev_param[wmi_pdev_set_mcast_to_ucast_tid] =
  8104. WMI_PDEV_SET_MCAST_TO_UCAST_TID;
  8105. pdev_param[wmi_pdev_param_proxy_sta_mode] =
  8106. WMI_PDEV_PARAM_PROXY_STA_MODE;
  8107. pdev_param[wmi_pdev_param_set_mcast2ucast_mode] =
  8108. WMI_PDEV_PARAM_SET_MCAST2UCAST_MODE;
  8109. pdev_param[wmi_pdev_param_set_mcast2ucast_buffer] =
  8110. WMI_PDEV_PARAM_SET_MCAST2UCAST_BUFFER;
  8111. pdev_param[wmi_pdev_param_remove_mcast2ucast_buffer] =
  8112. WMI_PDEV_PARAM_REMOVE_MCAST2UCAST_BUFFER;
  8113. pdev_param[wmi_pdev_peer_sta_ps_statechg_enable] =
  8114. WMI_PDEV_PEER_STA_PS_STATECHG_ENABLE;
  8115. pdev_param[wmi_pdev_param_igmpmld_ac_override] =
  8116. WMI_PDEV_PARAM_IGMPMLD_AC_OVERRIDE;
  8117. pdev_param[wmi_pdev_param_block_interbss] =
  8118. WMI_PDEV_PARAM_BLOCK_INTERBSS;
  8119. pdev_param[wmi_pdev_param_set_disable_reset_cmdid] =
  8120. WMI_PDEV_PARAM_SET_DISABLE_RESET_CMDID;
  8121. pdev_param[wmi_pdev_param_set_msdu_ttl_cmdid] =
  8122. WMI_PDEV_PARAM_SET_MSDU_TTL_CMDID;
  8123. pdev_param[wmi_pdev_param_set_ppdu_duration_cmdid] =
  8124. WMI_PDEV_PARAM_SET_PPDU_DURATION_CMDID;
  8125. pdev_param[wmi_pdev_param_txbf_sound_period_cmdid] =
  8126. WMI_PDEV_PARAM_TXBF_SOUND_PERIOD_CMDID;
  8127. pdev_param[wmi_pdev_param_set_promisc_mode_cmdid] =
  8128. WMI_PDEV_PARAM_SET_PROMISC_MODE_CMDID;
  8129. pdev_param[wmi_pdev_param_set_burst_mode_cmdid] =
  8130. WMI_PDEV_PARAM_SET_BURST_MODE_CMDID;
  8131. pdev_param[wmi_pdev_param_en_stats] = WMI_PDEV_PARAM_EN_STATS;
  8132. pdev_param[wmi_pdev_param_mu_group_policy] =
  8133. WMI_PDEV_PARAM_MU_GROUP_POLICY;
  8134. pdev_param[wmi_pdev_param_noise_detection] =
  8135. WMI_PDEV_PARAM_NOISE_DETECTION;
  8136. pdev_param[wmi_pdev_param_noise_threshold] =
  8137. WMI_PDEV_PARAM_NOISE_THRESHOLD;
  8138. pdev_param[wmi_pdev_param_dpd_enable] =
  8139. WMI_PDEV_PARAM_DPD_ENABLE;
  8140. pdev_param[wmi_pdev_param_set_mcast_bcast_echo] =
  8141. WMI_PDEV_PARAM_SET_MCAST_BCAST_ECHO;
  8142. pdev_param[wmi_pdev_param_atf_strict_sch] =
  8143. WMI_PDEV_PARAM_ATF_STRICT_SCH;
  8144. pdev_param[wmi_pdev_param_atf_sched_duration] =
  8145. WMI_PDEV_PARAM_ATF_SCHED_DURATION;
  8146. pdev_param[wmi_pdev_param_ant_plzn] = WMI_PDEV_PARAM_ANT_PLZN;
  8147. pdev_param[wmi_pdev_param_mgmt_retry_limit] =
  8148. WMI_PDEV_PARAM_MGMT_RETRY_LIMIT;
  8149. pdev_param[wmi_pdev_param_sensitivity_level] =
  8150. WMI_PDEV_PARAM_SENSITIVITY_LEVEL;
  8151. pdev_param[wmi_pdev_param_signed_txpower_2g] =
  8152. WMI_PDEV_PARAM_SIGNED_TXPOWER_2G;
  8153. pdev_param[wmi_pdev_param_signed_txpower_5g] =
  8154. WMI_PDEV_PARAM_SIGNED_TXPOWER_5G;
  8155. pdev_param[wmi_pdev_param_enable_per_tid_amsdu] =
  8156. WMI_PDEV_PARAM_ENABLE_PER_TID_AMSDU;
  8157. pdev_param[wmi_pdev_param_enable_per_tid_ampdu] =
  8158. WMI_PDEV_PARAM_ENABLE_PER_TID_AMPDU;
  8159. pdev_param[wmi_pdev_param_cca_threshold] = WMI_PDEV_PARAM_CCA_THRESHOLD;
  8160. pdev_param[wmi_pdev_param_rts_fixed_rate] =
  8161. WMI_PDEV_PARAM_RTS_FIXED_RATE;
  8162. pdev_param[wmi_pdev_param_cal_period] = WMI_PDEV_PARAM_CAL_PERIOD;
  8163. pdev_param[wmi_pdev_param_pdev_reset] = WMI_PDEV_PARAM_PDEV_RESET;
  8164. pdev_param[wmi_pdev_param_wapi_mbssid_offset] =
  8165. WMI_PDEV_PARAM_WAPI_MBSSID_OFFSET;
  8166. pdev_param[wmi_pdev_param_arp_srcaddr] = WMI_PDEV_PARAM_ARP_SRCADDR;
  8167. pdev_param[wmi_pdev_param_arp_dstaddr] = WMI_PDEV_PARAM_ARP_DSTADDR;
  8168. pdev_param[wmi_pdev_param_txpower_decr_db] =
  8169. WMI_PDEV_PARAM_TXPOWER_DECR_DB;
  8170. pdev_param[wmi_pdev_param_rx_batchmode] = WMI_PDEV_PARAM_RX_BATCHMODE;
  8171. pdev_param[wmi_pdev_param_packet_aggr_delay] =
  8172. WMI_PDEV_PARAM_PACKET_AGGR_DELAY;
  8173. pdev_param[wmi_pdev_param_atf_obss_noise_sch] =
  8174. WMI_PDEV_PARAM_ATF_OBSS_NOISE_SCH;
  8175. pdev_param[wmi_pdev_param_atf_obss_noise_scaling_factor] =
  8176. WMI_PDEV_PARAM_ATF_OBSS_NOISE_SCALING_FACTOR;
  8177. pdev_param[wmi_pdev_param_cust_txpower_scale] =
  8178. WMI_PDEV_PARAM_CUST_TXPOWER_SCALE;
  8179. pdev_param[wmi_pdev_param_atf_dynamic_enable] =
  8180. WMI_PDEV_PARAM_ATF_DYNAMIC_ENABLE;
  8181. pdev_param[wmi_pdev_param_atf_ssid_group_policy] =
  8182. WMI_PDEV_PARAM_ATF_SSID_GROUP_POLICY;
  8183. pdev_param[wmi_pdev_param_enable_btcoex] =
  8184. WMI_PDEV_PARAM_ENABLE_BTCOEX;
  8185. pdev_param[wmi_pdev_param_atf_peer_stats] =
  8186. WMI_PDEV_PARAM_ATF_PEER_STATS;
  8187. pdev_param[wmi_pdev_param_tx_ack_timeout] = WMI_UNAVAILABLE_PARAM;
  8188. pdev_param[wmi_pdev_param_soft_tx_chain_mask] =
  8189. WMI_PDEV_PARAM_SOFT_TX_CHAIN_MASK;
  8190. pdev_param[wmi_pdev_param_rfkill_enable] = WMI_UNAVAILABLE_PARAM;
  8191. pdev_param[wmi_pdev_param_hw_rfkill_config] = WMI_UNAVAILABLE_PARAM;
  8192. pdev_param[wmi_pdev_param_low_power_rf_enable] = WMI_UNAVAILABLE_PARAM;
  8193. pdev_param[wmi_pdev_param_l1ss_track] = WMI_UNAVAILABLE_PARAM;
  8194. pdev_param[wmi_pdev_param_hyst_en] = WMI_UNAVAILABLE_PARAM;
  8195. pdev_param[wmi_pdev_param_power_collapse_enable] =
  8196. WMI_UNAVAILABLE_PARAM;
  8197. pdev_param[wmi_pdev_param_led_sys_state] = WMI_UNAVAILABLE_PARAM;
  8198. pdev_param[wmi_pdev_param_led_enable] = WMI_UNAVAILABLE_PARAM;
  8199. pdev_param[wmi_pdev_param_audio_over_wlan_latency] =
  8200. WMI_UNAVAILABLE_PARAM;
  8201. pdev_param[wmi_pdev_param_audio_over_wlan_enable] =
  8202. WMI_UNAVAILABLE_PARAM;
  8203. pdev_param[wmi_pdev_param_whal_mib_stats_update_enable] =
  8204. WMI_UNAVAILABLE_PARAM;
  8205. pdev_param[wmi_pdev_param_vdev_rate_stats_update_period] =
  8206. WMI_UNAVAILABLE_PARAM;
  8207. pdev_param[wmi_pdev_param_cts_cbw] = WMI_UNAVAILABLE_PARAM;
  8208. pdev_param[wmi_pdev_param_wnts_config] = WMI_UNAVAILABLE_PARAM;
  8209. pdev_param[wmi_pdev_param_adaptive_early_rx_enable] =
  8210. WMI_UNAVAILABLE_PARAM;
  8211. pdev_param[wmi_pdev_param_adaptive_early_rx_min_sleep_slop] =
  8212. WMI_UNAVAILABLE_PARAM;
  8213. pdev_param[wmi_pdev_param_adaptive_early_rx_inc_dec_step] =
  8214. WMI_UNAVAILABLE_PARAM;
  8215. pdev_param[wmi_pdev_param_early_rx_fix_sleep_slop] =
  8216. WMI_UNAVAILABLE_PARAM;
  8217. pdev_param[wmi_pdev_param_bmiss_based_adaptive_bto_enable] =
  8218. WMI_UNAVAILABLE_PARAM;
  8219. pdev_param[wmi_pdev_param_bmiss_bto_min_bcn_timeout] =
  8220. WMI_UNAVAILABLE_PARAM;
  8221. pdev_param[wmi_pdev_param_bmiss_bto_inc_dec_step] =
  8222. WMI_UNAVAILABLE_PARAM;
  8223. pdev_param[wmi_pdev_param_bto_fix_bcn_timeout] =
  8224. WMI_UNAVAILABLE_PARAM;
  8225. pdev_param[wmi_pdev_param_ce_based_adaptive_bto_enable] =
  8226. WMI_UNAVAILABLE_PARAM;
  8227. pdev_param[wmi_pdev_param_ce_bto_combo_ce_value] =
  8228. WMI_UNAVAILABLE_PARAM;
  8229. pdev_param[wmi_pdev_param_tx_chain_mask_2g] = WMI_UNAVAILABLE_PARAM;
  8230. pdev_param[wmi_pdev_param_rx_chain_mask_2g] = WMI_UNAVAILABLE_PARAM;
  8231. pdev_param[wmi_pdev_param_tx_chain_mask_5g] = WMI_UNAVAILABLE_PARAM;
  8232. pdev_param[wmi_pdev_param_rx_chain_mask_5g] = WMI_UNAVAILABLE_PARAM;
  8233. pdev_param[wmi_pdev_param_tx_chain_mask_cck] = WMI_UNAVAILABLE_PARAM;
  8234. pdev_param[wmi_pdev_param_tx_chain_mask_1ss] = WMI_UNAVAILABLE_PARAM;
  8235. }
  8236. /**
  8237. * populate_vdev_param_non_tlv() - populates vdev params
  8238. *
  8239. * @param vdev_param: Pointer to hold vdev params
  8240. * Return: None
  8241. */
  8242. static void populate_vdev_param_non_tlv(uint32_t *vdev_param)
  8243. {
  8244. vdev_param[wmi_vdev_param_rts_threshold] = WMI_VDEV_PARAM_RTS_THRESHOLD;
  8245. vdev_param[wmi_vdev_param_fragmentation_threshold] =
  8246. WMI_VDEV_PARAM_FRAGMENTATION_THRESHOLD;
  8247. vdev_param[wmi_vdev_param_beacon_interval] =
  8248. WMI_VDEV_PARAM_BEACON_INTERVAL;
  8249. vdev_param[wmi_vdev_param_listen_interval] =
  8250. WMI_VDEV_PARAM_LISTEN_INTERVAL;
  8251. vdev_param[wmi_vdev_param_multicast_rate] =
  8252. WMI_VDEV_PARAM_MULTICAST_RATE;
  8253. vdev_param[wmi_vdev_param_mgmt_tx_rate] =
  8254. WMI_VDEV_PARAM_MGMT_TX_RATE;
  8255. vdev_param[wmi_vdev_param_slot_time] = WMI_VDEV_PARAM_SLOT_TIME;
  8256. vdev_param[wmi_vdev_param_preamble] = WMI_VDEV_PARAM_PREAMBLE;
  8257. vdev_param[wmi_vdev_param_swba_time] = WMI_VDEV_PARAM_SWBA_TIME;
  8258. vdev_param[wmi_vdev_stats_update_period] = WMI_VDEV_STATS_UPDATE_PERIOD;
  8259. vdev_param[wmi_vdev_pwrsave_ageout_time] = WMI_VDEV_PWRSAVE_AGEOUT_TIME;
  8260. vdev_param[wmi_vdev_host_swba_interval] = WMI_VDEV_HOST_SWBA_INTERVAL;
  8261. vdev_param[wmi_vdev_param_dtim_period] = WMI_VDEV_PARAM_DTIM_PERIOD;
  8262. vdev_param[wmi_vdev_oc_scheduler_air_time_limit] =
  8263. WMI_VDEV_OC_SCHEDULER_AIR_TIME_LIMIT;
  8264. vdev_param[wmi_vdev_param_wds] = WMI_VDEV_PARAM_WDS;
  8265. vdev_param[wmi_vdev_param_atim_window] = WMI_VDEV_PARAM_ATIM_WINDOW;
  8266. vdev_param[wmi_vdev_param_bmiss_count_max] =
  8267. WMI_VDEV_PARAM_BMISS_COUNT_MAX;
  8268. vdev_param[wmi_vdev_param_bmiss_first_bcnt] =
  8269. WMI_VDEV_PARAM_BMISS_FIRST_BCNT;
  8270. vdev_param[wmi_vdev_param_bmiss_final_bcnt] =
  8271. WMI_VDEV_PARAM_BMISS_FINAL_BCNT;
  8272. vdev_param[wmi_vdev_param_feature_wmm] = WMI_VDEV_PARAM_FEATURE_WMM;
  8273. vdev_param[wmi_vdev_param_chwidth] = WMI_VDEV_PARAM_CHWIDTH;
  8274. vdev_param[wmi_vdev_param_chextoffset] = WMI_VDEV_PARAM_CHEXTOFFSET;
  8275. vdev_param[wmi_vdev_param_disable_htprotection] =
  8276. WMI_VDEV_PARAM_DISABLE_HTPROTECTION;
  8277. vdev_param[wmi_vdev_param_sta_quickkickout] =
  8278. WMI_VDEV_PARAM_STA_QUICKKICKOUT;
  8279. vdev_param[wmi_vdev_param_mgmt_rate] = WMI_VDEV_PARAM_MGMT_RATE;
  8280. vdev_param[wmi_vdev_param_protection_mode] =
  8281. WMI_VDEV_PARAM_PROTECTION_MODE;
  8282. vdev_param[wmi_vdev_param_fixed_rate] = WMI_VDEV_PARAM_FIXED_RATE;
  8283. vdev_param[wmi_vdev_param_sgi] = WMI_VDEV_PARAM_SGI;
  8284. vdev_param[wmi_vdev_param_ldpc] = WMI_VDEV_PARAM_LDPC;
  8285. vdev_param[wmi_vdev_param_tx_stbc] = WMI_VDEV_PARAM_TX_STBC;
  8286. vdev_param[wmi_vdev_param_rx_stbc] = WMI_VDEV_PARAM_RX_STBC;
  8287. vdev_param[wmi_vdev_param_intra_bss_fwd] = WMI_VDEV_PARAM_INTRA_BSS_FWD;
  8288. vdev_param[wmi_vdev_param_def_keyid] = WMI_VDEV_PARAM_DEF_KEYID;
  8289. vdev_param[wmi_vdev_param_nss] = WMI_VDEV_PARAM_NSS;
  8290. vdev_param[wmi_vdev_param_bcast_data_rate] =
  8291. WMI_VDEV_PARAM_BCAST_DATA_RATE;
  8292. vdev_param[wmi_vdev_param_mcast_data_rate] =
  8293. WMI_VDEV_PARAM_MCAST_DATA_RATE;
  8294. vdev_param[wmi_vdev_param_mcast_indicate] =
  8295. WMI_VDEV_PARAM_MCAST_INDICATE;
  8296. vdev_param[wmi_vdev_param_dhcp_indicate] = WMI_VDEV_PARAM_DHCP_INDICATE;
  8297. vdev_param[wmi_vdev_param_unknown_dest_indicate] =
  8298. WMI_VDEV_PARAM_UNKNOWN_DEST_INDICATE;
  8299. vdev_param[wmi_vdev_param_ap_keepalive_min_idle_inactive_time_secs] =
  8300. WMI_VDEV_PARAM_AP_KEEPALIVE_MIN_IDLE_INACTIVE_TIME_SECS;
  8301. vdev_param[wmi_vdev_param_ap_keepalive_max_idle_inactive_time_secs] =
  8302. WMI_VDEV_PARAM_AP_KEEPALIVE_MAX_IDLE_INACTIVE_TIME_SECS;
  8303. vdev_param[wmi_vdev_param_ap_keepalive_max_unresponsive_time_secs] =
  8304. WMI_VDEV_PARAM_AP_KEEPALIVE_MAX_UNRESPONSIVE_TIME_SECS;
  8305. vdev_param[wmi_vdev_param_ap_enable_nawds] =
  8306. WMI_VDEV_PARAM_AP_ENABLE_NAWDS;
  8307. vdev_param[wmi_vdev_param_mcast2ucast_set] =
  8308. WMI_VDEV_PARAM_MCAST2UCAST_SET;
  8309. vdev_param[wmi_vdev_param_enable_rtscts] = WMI_VDEV_PARAM_ENABLE_RTSCTS;
  8310. vdev_param[wmi_vdev_param_rc_num_retries] =
  8311. WMI_VDEV_PARAM_RC_NUM_RETRIES;
  8312. vdev_param[wmi_vdev_param_txbf] = WMI_VDEV_PARAM_TXBF;
  8313. vdev_param[wmi_vdev_param_packet_powersave] =
  8314. WMI_VDEV_PARAM_PACKET_POWERSAVE;
  8315. vdev_param[wmi_vdev_param_drop_unencry] = WMI_VDEV_PARAM_DROP_UNENCRY;
  8316. vdev_param[wmi_vdev_param_tx_encap_type] = WMI_VDEV_PARAM_TX_ENCAP_TYPE;
  8317. vdev_param[wmi_vdev_param_ap_detect_out_of_sync_sleeping_sta_time_secs]
  8318. = WMI_VDEV_PARAM_AP_DETECT_OUT_OF_SYNC_SLEEPING_STA_TIME_SECS;
  8319. vdev_param[wmi_vdev_param_cabq_maxdur] = WMI_VDEV_PARAM_CABQ_MAXDUR;
  8320. vdev_param[wmi_vdev_param_mfptest_set] = WMI_VDEV_PARAM_MFPTEST_SET;
  8321. vdev_param[wmi_vdev_param_rts_fixed_rate] =
  8322. WMI_VDEV_PARAM_RTS_FIXED_RATE;
  8323. vdev_param[wmi_vdev_param_vht_sgimask] = WMI_VDEV_PARAM_VHT_SGIMASK;
  8324. vdev_param[wmi_vdev_param_vht80_ratemask] =
  8325. WMI_VDEV_PARAM_VHT80_RATEMASK;
  8326. vdev_param[wmi_vdev_param_early_rx_adjust_enable] =
  8327. WMI_VDEV_PARAM_EARLY_RX_ADJUST_ENABLE;
  8328. vdev_param[wmi_vdev_param_early_rx_tgt_bmiss_num] =
  8329. WMI_VDEV_PARAM_EARLY_RX_TGT_BMISS_NUM;
  8330. vdev_param[wmi_vdev_param_early_rx_bmiss_sample_cycle] =
  8331. WMI_VDEV_PARAM_EARLY_RX_BMISS_SAMPLE_CYCLE;
  8332. vdev_param[wmi_vdev_param_early_rx_slop_step] =
  8333. WMI_VDEV_PARAM_EARLY_RX_SLOP_STEP;
  8334. vdev_param[wmi_vdev_param_early_rx_init_slop] =
  8335. WMI_VDEV_PARAM_EARLY_RX_INIT_SLOP;
  8336. vdev_param[wmi_vdev_param_early_rx_adjust_pause] =
  8337. WMI_VDEV_PARAM_EARLY_RX_ADJUST_PAUSE;
  8338. vdev_param[wmi_vdev_param_proxy_sta] = WMI_VDEV_PARAM_PROXY_STA;
  8339. vdev_param[wmi_vdev_param_meru_vc] = WMI_VDEV_PARAM_MERU_VC;
  8340. vdev_param[wmi_vdev_param_rx_decap_type] = WMI_VDEV_PARAM_RX_DECAP_TYPE;
  8341. vdev_param[wmi_vdev_param_bw_nss_ratemask] =
  8342. WMI_VDEV_PARAM_BW_NSS_RATEMASK;
  8343. vdev_param[wmi_vdev_param_sensor_ap] = WMI_VDEV_PARAM_SENSOR_AP;
  8344. vdev_param[wmi_vdev_param_beacon_rate] = WMI_VDEV_PARAM_BEACON_RATE;
  8345. vdev_param[wmi_vdev_param_dtim_enable_cts] =
  8346. WMI_VDEV_PARAM_DTIM_ENABLE_CTS;
  8347. vdev_param[wmi_vdev_param_sta_kickout] = WMI_VDEV_PARAM_STA_KICKOUT;
  8348. vdev_param[wmi_vdev_param_capabilities] =
  8349. WMI_VDEV_PARAM_CAPABILITIES;
  8350. vdev_param[wmi_vdev_param_mgmt_tx_power] = WMI_VDEV_PARAM_MGMT_TX_POWER;
  8351. vdev_param[wmi_vdev_param_tx_power] = WMI_VDEV_PARAM_TX_POWER;
  8352. vdev_param[wmi_vdev_param_atf_ssid_sched_policy] =
  8353. WMI_VDEV_PARAM_ATF_SSID_SCHED_POLICY;
  8354. vdev_param[wmi_vdev_param_disable_dyn_bw_rts] =
  8355. WMI_VDEV_PARAM_DISABLE_DYN_BW_RTS;
  8356. vdev_param[wmi_vdev_param_ampdu_subframe_size_per_ac] =
  8357. WMI_VDEV_PARAM_AMPDU_SUBFRAME_SIZE_PER_AC;
  8358. vdev_param[wmi_vdev_param_disable_cabq] =
  8359. WMI_VDEV_PARAM_DISABLE_CABQ;
  8360. }
  8361. #endif
  8362. /**
  8363. * wmi_get_non_tlv_ops() - gives pointer to wmi tlv ops
  8364. *
  8365. * Return: pointer to wmi tlv ops
  8366. */
  8367. void wmi_non_tlv_attach(struct wmi_unified *wmi_handle)
  8368. {
  8369. #if defined(WMI_NON_TLV_SUPPORT) || defined(WMI_TLV_AND_NON_TLV_SUPPORT)
  8370. wmi_handle->ops = &non_tlv_ops;
  8371. populate_non_tlv_service(wmi_handle->services);
  8372. populate_non_tlv_events_id(wmi_handle->wmi_events);
  8373. populate_pdev_param_non_tlv(wmi_handle->pdev_param);
  8374. populate_vdev_param_non_tlv(wmi_handle->vdev_param);
  8375. #ifdef WMI_INTERFACE_EVENT_LOGGING
  8376. wmi_handle->log_info.buf_offset_command = 0;
  8377. wmi_handle->log_info.buf_offset_event = 0;
  8378. /*(uint8 *)(*wmi_id_to_name)(uint32_t cmd_id);*/
  8379. #endif
  8380. #else
  8381. qdf_print("%s: Not supported\n", __func__);
  8382. #endif
  8383. }
  8384. EXPORT_SYMBOL(wmi_non_tlv_attach);
  8385. /**
  8386. * wmi_non_tlv_init() - Initialize WMI NON TLV module by registering Non TLV
  8387. * attach routine.
  8388. *
  8389. * Return: None
  8390. */
  8391. void wmi_non_tlv_init(void)
  8392. {
  8393. wmi_unified_register_module(WMI_NON_TLV_TARGET, &wmi_non_tlv_attach);
  8394. }