wmi_unified_non_tlv.c 290 KB

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