123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759376037613762376337643765376637673768376937703771377237733774377537763777377837793780378137823783378437853786 |
- /*
- * Copyright (c) 2015-2021 The Linux Foundation. All rights reserved.
- *
- * Permission to use, copy, modify, and/or distribute this software for
- * any purpose with or without fee is hereby granted, provided that the
- * above copyright notice and this permission notice appear in all
- * copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
- * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
- * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
- * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
- * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
- * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
- * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
- * PERFORMANCE OF THIS SOFTWARE.
- */
- /*
- * Host WMI unified implementation
- */
- #include "htc_api.h"
- #include "htc_api.h"
- #include "wmi_unified_priv.h"
- #include "wmi_unified_api.h"
- #include "qdf_module.h"
- #include "qdf_platform.h"
- #ifdef WMI_EXT_DBG
- #include "qdf_list.h"
- #include "qdf_atomic.h"
- #endif
- #ifndef WMI_NON_TLV_SUPPORT
- #include "wmi_tlv_helper.h"
- #endif
- #include <linux/debugfs.h>
- #include <target_if.h>
- #include <qdf_debugfs.h>
- #include "wmi_filtered_logging.h"
- #include <wmi_hang_event.h>
- /* This check for CONFIG_WIN temporary added due to redeclaration compilation
- error in MCL. Error is caused due to inclusion of wmi.h in wmi_unified_api.h
- which gets included here through ol_if_athvar.h. Eventually it is expected that
- wmi.h will be removed from wmi_unified_api.h after cleanup, which will need
- WMI_CMD_HDR to be defined here. */
- /* Copied from wmi.h */
- #undef MS
- #define MS(_v, _f) (((_v) & _f##_MASK) >> _f##_LSB)
- #undef SM
- #define SM(_v, _f) (((_v) << _f##_LSB) & _f##_MASK)
- #undef WO
- #define WO(_f) ((_f##_OFFSET) >> 2)
- #undef GET_FIELD
- #define GET_FIELD(_addr, _f) MS(*((uint32_t *)(_addr) + WO(_f)), _f)
- #undef SET_FIELD
- #define SET_FIELD(_addr, _f, _val) \
- (*((uint32_t *)(_addr) + WO(_f)) = \
- (*((uint32_t *)(_addr) + WO(_f)) & ~_f##_MASK) | SM(_val, _f))
- #define WMI_GET_FIELD(_msg_buf, _msg_type, _f) \
- GET_FIELD(_msg_buf, _msg_type ## _ ## _f)
- #define WMI_SET_FIELD(_msg_buf, _msg_type, _f, _val) \
- SET_FIELD(_msg_buf, _msg_type ## _ ## _f, _val)
- #define WMI_EP_APASS 0x0
- #define WMI_EP_LPASS 0x1
- #define WMI_EP_SENSOR 0x2
- #define WMI_INFOS_DBG_FILE_PERM (QDF_FILE_USR_READ | \
- QDF_FILE_USR_WRITE | \
- QDF_FILE_GRP_READ | \
- QDF_FILE_OTH_READ)
- /*
- * * Control Path
- * */
- typedef PREPACK struct {
- uint32_t commandId:24,
- reserved:2, /* used for WMI endpoint ID */
- plt_priv:6; /* platform private */
- } POSTPACK WMI_CMD_HDR; /* used for commands and events */
- #define WMI_CMD_HDR_COMMANDID_LSB 0
- #define WMI_CMD_HDR_COMMANDID_MASK 0x00ffffff
- #define WMI_CMD_HDR_COMMANDID_OFFSET 0x00000000
- #define WMI_CMD_HDR_WMI_ENDPOINTID_MASK 0x03000000
- #define WMI_CMD_HDR_WMI_ENDPOINTID_OFFSET 24
- #define WMI_CMD_HDR_PLT_PRIV_LSB 24
- #define WMI_CMD_HDR_PLT_PRIV_MASK 0xff000000
- #define WMI_CMD_HDR_PLT_PRIV_OFFSET 0x00000000
- /* end of copy wmi.h */
- #define WMI_MIN_HEAD_ROOM 64
- /* WBUFF pool sizes for WMI */
- /* Allocation of size 256 bytes */
- #define WMI_WBUFF_POOL_0_SIZE 128
- /* Allocation of size 512 bytes */
- #define WMI_WBUFF_POOL_1_SIZE 16
- /* Allocation of size 1024 bytes */
- #define WMI_WBUFF_POOL_2_SIZE 8
- /* Allocation of size 2048 bytes */
- #define WMI_WBUFF_POOL_3_SIZE 8
- #define RX_DIAG_EVENT_WORK_PROCESS_MAX_COUNT 500
- #ifdef WMI_INTERFACE_EVENT_LOGGING
- #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 3, 0))
- /* TODO Cleanup this backported function */
- static int wmi_bp_seq_printf(qdf_debugfs_file_t m, const char *f, ...)
- {
- va_list args;
- va_start(args, f);
- seq_vprintf(m, f, args);
- va_end(args);
- return 0;
- }
- #else
- #define wmi_bp_seq_printf(m, fmt, ...) seq_printf((m), fmt, ##__VA_ARGS__)
- #endif
- #ifndef MAX_WMI_INSTANCES
- #define CUSTOM_MGMT_CMD_DATA_SIZE 4
- #endif
- #ifndef WMI_INTERFACE_EVENT_LOGGING_DYNAMIC_ALLOC
- /* WMI commands */
- uint32_t g_wmi_command_buf_idx = 0;
- struct wmi_command_debug wmi_command_log_buffer[WMI_CMD_DEBUG_MAX_ENTRY];
- /* WMI commands TX completed */
- uint32_t g_wmi_command_tx_cmp_buf_idx = 0;
- struct wmi_command_cmp_debug
- wmi_command_tx_cmp_log_buffer[WMI_CMD_CMPL_DEBUG_MAX_ENTRY];
- /* WMI events when processed */
- uint32_t g_wmi_event_buf_idx = 0;
- struct wmi_event_debug wmi_event_log_buffer[WMI_EVENT_DEBUG_MAX_ENTRY];
- /* WMI events when queued */
- uint32_t g_wmi_rx_event_buf_idx = 0;
- struct wmi_event_debug wmi_rx_event_log_buffer[WMI_EVENT_DEBUG_MAX_ENTRY];
- #endif
- static void wmi_minidump_detach(struct wmi_unified *wmi_handle)
- {
- struct wmi_log_buf_t *info =
- &wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info;
- uint32_t buf_size = info->size * sizeof(struct wmi_command_cmp_debug);
- qdf_minidump_remove(info->buf, buf_size, "wmi_tx_cmp");
- }
- static void wmi_minidump_attach(struct wmi_unified *wmi_handle)
- {
- struct wmi_log_buf_t *info =
- &wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info;
- uint32_t buf_size = info->size * sizeof(struct wmi_command_cmp_debug);
- qdf_minidump_log(info->buf, buf_size, "wmi_tx_cmp");
- }
- #define WMI_COMMAND_RECORD(h, a, b) { \
- if (wmi_cmd_log_max_entry <= \
- *(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx)) \
- *(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx) = 0;\
- ((struct wmi_command_debug *)h->log_info.wmi_command_log_buf_info.buf)\
- [*(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx)]\
- .command = a; \
- qdf_mem_copy(((struct wmi_command_debug *)h->log_info. \
- wmi_command_log_buf_info.buf) \
- [*(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx)].data,\
- b, wmi_record_max_length); \
- ((struct wmi_command_debug *)h->log_info.wmi_command_log_buf_info.buf)\
- [*(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx)].\
- time = qdf_get_log_timestamp(); \
- (*(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx))++; \
- h->log_info.wmi_command_log_buf_info.length++; \
- }
- #define WMI_COMMAND_TX_CMP_RECORD(h, a, b, da, pa) { \
- if (wmi_cmd_cmpl_log_max_entry <= \
- *(h->log_info.wmi_command_tx_cmp_log_buf_info.p_buf_tail_idx))\
- *(h->log_info.wmi_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx) = 0; \
- ((struct wmi_command_cmp_debug *)h->log_info. \
- wmi_command_tx_cmp_log_buf_info.buf) \
- [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)]. \
- command = a; \
- qdf_mem_copy(((struct wmi_command_cmp_debug *)h->log_info. \
- wmi_command_tx_cmp_log_buf_info.buf) \
- [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)]. \
- data, b, wmi_record_max_length); \
- ((struct wmi_command_cmp_debug *)h->log_info. \
- wmi_command_tx_cmp_log_buf_info.buf) \
- [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)]. \
- time = qdf_get_log_timestamp(); \
- ((struct wmi_command_cmp_debug *)h->log_info. \
- wmi_command_tx_cmp_log_buf_info.buf) \
- [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)]. \
- dma_addr = da; \
- ((struct wmi_command_cmp_debug *)h->log_info. \
- wmi_command_tx_cmp_log_buf_info.buf) \
- [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)]. \
- phy_addr = pa; \
- (*(h->log_info.wmi_command_tx_cmp_log_buf_info.p_buf_tail_idx))++;\
- h->log_info.wmi_command_tx_cmp_log_buf_info.length++; \
- }
- #define WMI_EVENT_RECORD(h, a, b) { \
- if (wmi_event_log_max_entry <= \
- *(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx)) \
- *(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx) = 0;\
- ((struct wmi_event_debug *)h->log_info.wmi_event_log_buf_info.buf)\
- [*(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx)]. \
- event = a; \
- qdf_mem_copy(((struct wmi_event_debug *)h->log_info. \
- wmi_event_log_buf_info.buf) \
- [*(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx)].data, b,\
- wmi_record_max_length); \
- ((struct wmi_event_debug *)h->log_info.wmi_event_log_buf_info.buf)\
- [*(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx)].time =\
- qdf_get_log_timestamp(); \
- (*(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx))++; \
- h->log_info.wmi_event_log_buf_info.length++; \
- }
- #define WMI_RX_EVENT_RECORD(h, a, b) { \
- if (wmi_event_log_max_entry <= \
- *(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx))\
- *(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx) = 0;\
- ((struct wmi_event_debug *)h->log_info.wmi_rx_event_log_buf_info.buf)\
- [*(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx)].\
- event = a; \
- qdf_mem_copy(((struct wmi_event_debug *)h->log_info. \
- wmi_rx_event_log_buf_info.buf) \
- [*(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx)].\
- data, b, wmi_record_max_length); \
- ((struct wmi_event_debug *)h->log_info.wmi_rx_event_log_buf_info.buf)\
- [*(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx)].\
- time = qdf_get_log_timestamp(); \
- (*(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx))++; \
- h->log_info.wmi_rx_event_log_buf_info.length++; \
- }
- #ifndef WMI_INTERFACE_EVENT_LOGGING_DYNAMIC_ALLOC
- uint32_t g_wmi_mgmt_command_buf_idx = 0;
- struct
- wmi_command_debug wmi_mgmt_command_log_buffer[WMI_MGMT_TX_DEBUG_MAX_ENTRY];
- /* wmi_mgmt commands TX completed */
- uint32_t g_wmi_mgmt_command_tx_cmp_buf_idx = 0;
- struct wmi_command_debug
- wmi_mgmt_command_tx_cmp_log_buffer[WMI_MGMT_TX_CMPL_DEBUG_MAX_ENTRY];
- /* wmi_mgmt events when received */
- uint32_t g_wmi_mgmt_rx_event_buf_idx = 0;
- struct wmi_event_debug
- wmi_mgmt_rx_event_log_buffer[WMI_MGMT_RX_DEBUG_MAX_ENTRY];
- /* wmi_diag events when received */
- uint32_t g_wmi_diag_rx_event_buf_idx = 0;
- struct wmi_event_debug
- wmi_diag_rx_event_log_buffer[WMI_DIAG_RX_EVENT_DEBUG_MAX_ENTRY];
- #endif
- #define WMI_MGMT_COMMAND_RECORD(h, a, b) { \
- if (wmi_mgmt_tx_log_max_entry <= \
- *(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx)) \
- *(h->log_info.wmi_mgmt_command_log_buf_info. \
- p_buf_tail_idx) = 0; \
- ((struct wmi_command_debug *)h->log_info. \
- wmi_mgmt_command_log_buf_info.buf) \
- [*(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx)].\
- command = a; \
- qdf_mem_copy(((struct wmi_command_debug *)h->log_info. \
- wmi_mgmt_command_log_buf_info.buf) \
- [*(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx)].\
- data, b, \
- wmi_record_max_length); \
- ((struct wmi_command_debug *)h->log_info. \
- wmi_mgmt_command_log_buf_info.buf) \
- [*(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx)].\
- time = qdf_get_log_timestamp(); \
- (*(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx))++;\
- h->log_info.wmi_mgmt_command_log_buf_info.length++; \
- }
- #define WMI_MGMT_COMMAND_TX_CMP_RECORD(h, a, b) { \
- if (wmi_mgmt_tx_cmpl_log_max_entry <= \
- *(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)) \
- *(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx) = 0; \
- ((struct wmi_command_debug *)h->log_info. \
- wmi_mgmt_command_tx_cmp_log_buf_info.buf) \
- [*(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)].command = a; \
- qdf_mem_copy(((struct wmi_command_debug *)h->log_info. \
- wmi_mgmt_command_tx_cmp_log_buf_info.buf)\
- [*(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)].data, b, \
- wmi_record_max_length); \
- ((struct wmi_command_debug *)h->log_info. \
- wmi_mgmt_command_tx_cmp_log_buf_info.buf) \
- [*(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx)].time = \
- qdf_get_log_timestamp(); \
- (*(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
- p_buf_tail_idx))++; \
- h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info.length++; \
- }
- #define WMI_MGMT_RX_EVENT_RECORD(h, a, b) do { \
- if (wmi_mgmt_rx_log_max_entry <= \
- *(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx))\
- *(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx) = 0;\
- ((struct wmi_event_debug *)h->log_info.wmi_mgmt_event_log_buf_info.buf)\
- [*(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx)]\
- .event = a; \
- qdf_mem_copy(((struct wmi_event_debug *)h->log_info. \
- wmi_mgmt_event_log_buf_info.buf) \
- [*(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx)].\
- data, b, wmi_record_max_length); \
- ((struct wmi_event_debug *)h->log_info.wmi_mgmt_event_log_buf_info.buf)\
- [*(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx)].\
- time = qdf_get_log_timestamp(); \
- (*(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx))++; \
- h->log_info.wmi_mgmt_event_log_buf_info.length++; \
- } while (0);
- #define WMI_DIAG_RX_EVENT_RECORD(h, a, b) do { \
- if (wmi_diag_log_max_entry <= \
- *(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx))\
- *(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx) = 0;\
- ((struct wmi_event_debug *)h->log_info.wmi_diag_event_log_buf_info.buf)\
- [*(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx)]\
- .event = a; \
- qdf_mem_copy(((struct wmi_event_debug *)h->log_info. \
- wmi_diag_event_log_buf_info.buf) \
- [*(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx)].\
- data, b, wmi_record_max_length); \
- ((struct wmi_event_debug *)h->log_info.wmi_diag_event_log_buf_info.buf)\
- [*(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx)].\
- time = qdf_get_log_timestamp(); \
- (*(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx))++; \
- h->log_info.wmi_diag_event_log_buf_info.length++; \
- } while (0);
- /* These are defined to made it as module param, which can be configured */
- /* WMI Commands */
- uint32_t wmi_cmd_log_max_entry = WMI_CMD_DEBUG_MAX_ENTRY;
- uint32_t wmi_cmd_cmpl_log_max_entry = WMI_CMD_CMPL_DEBUG_MAX_ENTRY;
- /* WMI Events */
- uint32_t wmi_event_log_max_entry = WMI_EVENT_DEBUG_MAX_ENTRY;
- /* WMI MGMT Tx */
- uint32_t wmi_mgmt_tx_log_max_entry = WMI_MGMT_TX_DEBUG_MAX_ENTRY;
- uint32_t wmi_mgmt_tx_cmpl_log_max_entry = WMI_MGMT_TX_CMPL_DEBUG_MAX_ENTRY;
- /* WMI MGMT Rx */
- uint32_t wmi_mgmt_rx_log_max_entry = WMI_MGMT_RX_DEBUG_MAX_ENTRY;
- /* WMI Diag Event */
- uint32_t wmi_diag_log_max_entry = WMI_DIAG_RX_EVENT_DEBUG_MAX_ENTRY;
- /* WMI capture size */
- uint32_t wmi_record_max_length = WMI_DEBUG_ENTRY_MAX_LENGTH;
- uint32_t wmi_display_size = 100;
- /**
- * wmi_log_init() - Initialize WMI event logging
- * @wmi_handle: WMI handle.
- *
- * Return: Initialization status
- */
- #ifndef WMI_INTERFACE_EVENT_LOGGING_DYNAMIC_ALLOC
- static QDF_STATUS wmi_log_init(struct wmi_unified *wmi_handle)
- {
- struct wmi_log_buf_t *cmd_log_buf =
- &wmi_handle->log_info.wmi_command_log_buf_info;
- struct wmi_log_buf_t *cmd_tx_cmpl_log_buf =
- &wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info;
- struct wmi_log_buf_t *event_log_buf =
- &wmi_handle->log_info.wmi_event_log_buf_info;
- struct wmi_log_buf_t *rx_event_log_buf =
- &wmi_handle->log_info.wmi_rx_event_log_buf_info;
- struct wmi_log_buf_t *mgmt_cmd_log_buf =
- &wmi_handle->log_info.wmi_mgmt_command_log_buf_info;
- struct wmi_log_buf_t *mgmt_cmd_tx_cmp_log_buf =
- &wmi_handle->log_info.wmi_mgmt_command_tx_cmp_log_buf_info;
- struct wmi_log_buf_t *mgmt_event_log_buf =
- &wmi_handle->log_info.wmi_mgmt_event_log_buf_info;
- struct wmi_log_buf_t *diag_event_log_buf =
- &wmi_handle->log_info.wmi_diag_event_log_buf_info;
- /* WMI commands */
- cmd_log_buf->length = 0;
- cmd_log_buf->buf_tail_idx = 0;
- cmd_log_buf->buf = wmi_command_log_buffer;
- cmd_log_buf->p_buf_tail_idx = &g_wmi_command_buf_idx;
- cmd_log_buf->size = WMI_CMD_DEBUG_MAX_ENTRY;
- /* WMI commands TX completed */
- cmd_tx_cmpl_log_buf->length = 0;
- cmd_tx_cmpl_log_buf->buf_tail_idx = 0;
- cmd_tx_cmpl_log_buf->buf = wmi_command_tx_cmp_log_buffer;
- cmd_tx_cmpl_log_buf->p_buf_tail_idx = &g_wmi_command_tx_cmp_buf_idx;
- cmd_tx_cmpl_log_buf->size = WMI_CMD_CMPL_DEBUG_MAX_ENTRY;
- /* WMI events when processed */
- event_log_buf->length = 0;
- event_log_buf->buf_tail_idx = 0;
- event_log_buf->buf = wmi_event_log_buffer;
- event_log_buf->p_buf_tail_idx = &g_wmi_event_buf_idx;
- event_log_buf->size = WMI_EVENT_DEBUG_MAX_ENTRY;
- /* WMI events when queued */
- rx_event_log_buf->length = 0;
- rx_event_log_buf->buf_tail_idx = 0;
- rx_event_log_buf->buf = wmi_rx_event_log_buffer;
- rx_event_log_buf->p_buf_tail_idx = &g_wmi_rx_event_buf_idx;
- rx_event_log_buf->size = WMI_EVENT_DEBUG_MAX_ENTRY;
- /* WMI Management commands */
- mgmt_cmd_log_buf->length = 0;
- mgmt_cmd_log_buf->buf_tail_idx = 0;
- mgmt_cmd_log_buf->buf = wmi_mgmt_command_log_buffer;
- mgmt_cmd_log_buf->p_buf_tail_idx = &g_wmi_mgmt_command_buf_idx;
- mgmt_cmd_log_buf->size = WMI_MGMT_TX_DEBUG_MAX_ENTRY;
- /* WMI Management commands Tx completed*/
- mgmt_cmd_tx_cmp_log_buf->length = 0;
- mgmt_cmd_tx_cmp_log_buf->buf_tail_idx = 0;
- mgmt_cmd_tx_cmp_log_buf->buf = wmi_mgmt_command_tx_cmp_log_buffer;
- mgmt_cmd_tx_cmp_log_buf->p_buf_tail_idx =
- &g_wmi_mgmt_command_tx_cmp_buf_idx;
- mgmt_cmd_tx_cmp_log_buf->size = WMI_MGMT_TX_CMPL_DEBUG_MAX_ENTRY;
- /* WMI Management events when received */
- mgmt_event_log_buf->length = 0;
- mgmt_event_log_buf->buf_tail_idx = 0;
- mgmt_event_log_buf->buf = wmi_mgmt_rx_event_log_buffer;
- mgmt_event_log_buf->p_buf_tail_idx = &g_wmi_mgmt_rx_event_buf_idx;
- mgmt_event_log_buf->size = WMI_MGMT_RX_DEBUG_MAX_ENTRY;
- /* WMI diag events when received */
- diag_event_log_buf->length = 0;
- diag_event_log_buf->buf_tail_idx = 0;
- diag_event_log_buf->buf = wmi_diag_rx_event_log_buffer;
- diag_event_log_buf->p_buf_tail_idx = &g_wmi_diag_rx_event_buf_idx;
- diag_event_log_buf->size = WMI_DIAG_RX_EVENT_DEBUG_MAX_ENTRY;
- qdf_spinlock_create(&wmi_handle->log_info.wmi_record_lock);
- wmi_handle->log_info.wmi_logging_enable = 1;
- return QDF_STATUS_SUCCESS;
- }
- #else
- static QDF_STATUS wmi_log_init(struct wmi_unified *wmi_handle)
- {
- struct wmi_log_buf_t *cmd_log_buf =
- &wmi_handle->log_info.wmi_command_log_buf_info;
- struct wmi_log_buf_t *cmd_tx_cmpl_log_buf =
- &wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info;
- struct wmi_log_buf_t *event_log_buf =
- &wmi_handle->log_info.wmi_event_log_buf_info;
- struct wmi_log_buf_t *rx_event_log_buf =
- &wmi_handle->log_info.wmi_rx_event_log_buf_info;
- struct wmi_log_buf_t *mgmt_cmd_log_buf =
- &wmi_handle->log_info.wmi_mgmt_command_log_buf_info;
- struct wmi_log_buf_t *mgmt_cmd_tx_cmp_log_buf =
- &wmi_handle->log_info.wmi_mgmt_command_tx_cmp_log_buf_info;
- struct wmi_log_buf_t *mgmt_event_log_buf =
- &wmi_handle->log_info.wmi_mgmt_event_log_buf_info;
- struct wmi_log_buf_t *diag_event_log_buf =
- &wmi_handle->log_info.wmi_diag_event_log_buf_info;
- wmi_handle->log_info.wmi_logging_enable = 0;
- /* WMI commands */
- cmd_log_buf->length = 0;
- cmd_log_buf->buf_tail_idx = 0;
- cmd_log_buf->buf = (struct wmi_command_debug *) qdf_mem_malloc(
- wmi_cmd_log_max_entry * sizeof(struct wmi_command_debug));
- cmd_log_buf->size = wmi_cmd_log_max_entry;
- if (!cmd_log_buf->buf)
- return QDF_STATUS_E_NOMEM;
- cmd_log_buf->p_buf_tail_idx = &cmd_log_buf->buf_tail_idx;
- /* WMI commands TX completed */
- cmd_tx_cmpl_log_buf->length = 0;
- cmd_tx_cmpl_log_buf->buf_tail_idx = 0;
- cmd_tx_cmpl_log_buf->buf = (struct wmi_command_cmp_debug *) qdf_mem_malloc(
- wmi_cmd_cmpl_log_max_entry * sizeof(struct wmi_command_cmp_debug));
- cmd_tx_cmpl_log_buf->size = wmi_cmd_cmpl_log_max_entry;
- if (!cmd_tx_cmpl_log_buf->buf)
- return QDF_STATUS_E_NOMEM;
- cmd_tx_cmpl_log_buf->p_buf_tail_idx =
- &cmd_tx_cmpl_log_buf->buf_tail_idx;
- /* WMI events when processed */
- event_log_buf->length = 0;
- event_log_buf->buf_tail_idx = 0;
- event_log_buf->buf = (struct wmi_event_debug *) qdf_mem_malloc(
- wmi_event_log_max_entry * sizeof(struct wmi_event_debug));
- event_log_buf->size = wmi_event_log_max_entry;
- if (!event_log_buf->buf)
- return QDF_STATUS_E_NOMEM;
- event_log_buf->p_buf_tail_idx = &event_log_buf->buf_tail_idx;
- /* WMI events when queued */
- rx_event_log_buf->length = 0;
- rx_event_log_buf->buf_tail_idx = 0;
- rx_event_log_buf->buf = (struct wmi_event_debug *) qdf_mem_malloc(
- wmi_event_log_max_entry * sizeof(struct wmi_event_debug));
- rx_event_log_buf->size = wmi_event_log_max_entry;
- if (!rx_event_log_buf->buf)
- return QDF_STATUS_E_NOMEM;
- rx_event_log_buf->p_buf_tail_idx = &rx_event_log_buf->buf_tail_idx;
- /* WMI Management commands */
- mgmt_cmd_log_buf->length = 0;
- mgmt_cmd_log_buf->buf_tail_idx = 0;
- mgmt_cmd_log_buf->buf = (struct wmi_command_debug *) qdf_mem_malloc(
- wmi_mgmt_tx_log_max_entry * sizeof(struct wmi_command_debug));
- mgmt_cmd_log_buf->size = wmi_mgmt_tx_log_max_entry;
- if (!mgmt_cmd_log_buf->buf)
- return QDF_STATUS_E_NOMEM;
- mgmt_cmd_log_buf->p_buf_tail_idx = &mgmt_cmd_log_buf->buf_tail_idx;
- /* WMI Management commands Tx completed*/
- mgmt_cmd_tx_cmp_log_buf->length = 0;
- mgmt_cmd_tx_cmp_log_buf->buf_tail_idx = 0;
- mgmt_cmd_tx_cmp_log_buf->buf = (struct wmi_command_debug *)
- qdf_mem_malloc(
- wmi_mgmt_tx_cmpl_log_max_entry *
- sizeof(struct wmi_command_debug));
- mgmt_cmd_tx_cmp_log_buf->size = wmi_mgmt_tx_cmpl_log_max_entry;
- if (!mgmt_cmd_tx_cmp_log_buf->buf)
- return QDF_STATUS_E_NOMEM;
- mgmt_cmd_tx_cmp_log_buf->p_buf_tail_idx =
- &mgmt_cmd_tx_cmp_log_buf->buf_tail_idx;
- /* WMI Management events when received */
- mgmt_event_log_buf->length = 0;
- mgmt_event_log_buf->buf_tail_idx = 0;
- mgmt_event_log_buf->buf = (struct wmi_event_debug *) qdf_mem_malloc(
- wmi_mgmt_rx_log_max_entry *
- sizeof(struct wmi_event_debug));
- mgmt_event_log_buf->size = wmi_mgmt_rx_log_max_entry;
- if (!mgmt_event_log_buf->buf)
- return QDF_STATUS_E_NOMEM;
- mgmt_event_log_buf->p_buf_tail_idx = &mgmt_event_log_buf->buf_tail_idx;
- /* WMI diag events when received */
- diag_event_log_buf->length = 0;
- diag_event_log_buf->buf_tail_idx = 0;
- diag_event_log_buf->buf = (struct wmi_event_debug *) qdf_mem_malloc(
- wmi_diag_log_max_entry *
- sizeof(struct wmi_event_debug));
- diag_event_log_buf->size = wmi_diag_log_max_entry;
- if (!diag_event_log_buf->buf)
- return QDF_STATUS_E_NOMEM;
- diag_event_log_buf->p_buf_tail_idx = &diag_event_log_buf->buf_tail_idx;
- qdf_spinlock_create(&wmi_handle->log_info.wmi_record_lock);
- wmi_handle->log_info.wmi_logging_enable = 1;
- wmi_filtered_logging_init(wmi_handle);
- return QDF_STATUS_SUCCESS;
- }
- #endif
- /**
- * wmi_log_buffer_free() - Free all dynamic allocated buffer memory for
- * event logging
- * @wmi_handle: WMI handle.
- *
- * Return: None
- */
- #ifdef WMI_INTERFACE_EVENT_LOGGING_DYNAMIC_ALLOC
- static inline void wmi_log_buffer_free(struct wmi_unified *wmi_handle)
- {
- wmi_filtered_logging_free(wmi_handle);
- if (wmi_handle->log_info.wmi_command_log_buf_info.buf)
- qdf_mem_free(wmi_handle->log_info.wmi_command_log_buf_info.buf);
- if (wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info.buf)
- qdf_mem_free(
- wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info.buf);
- if (wmi_handle->log_info.wmi_event_log_buf_info.buf)
- qdf_mem_free(wmi_handle->log_info.wmi_event_log_buf_info.buf);
- if (wmi_handle->log_info.wmi_rx_event_log_buf_info.buf)
- qdf_mem_free(
- wmi_handle->log_info.wmi_rx_event_log_buf_info.buf);
- if (wmi_handle->log_info.wmi_mgmt_command_log_buf_info.buf)
- qdf_mem_free(
- wmi_handle->log_info.wmi_mgmt_command_log_buf_info.buf);
- if (wmi_handle->log_info.wmi_mgmt_command_tx_cmp_log_buf_info.buf)
- qdf_mem_free(
- wmi_handle->log_info.wmi_mgmt_command_tx_cmp_log_buf_info.buf);
- if (wmi_handle->log_info.wmi_mgmt_event_log_buf_info.buf)
- qdf_mem_free(
- wmi_handle->log_info.wmi_mgmt_event_log_buf_info.buf);
- if (wmi_handle->log_info.wmi_diag_event_log_buf_info.buf)
- qdf_mem_free(
- wmi_handle->log_info.wmi_diag_event_log_buf_info.buf);
- wmi_handle->log_info.wmi_logging_enable = 0;
- qdf_spinlock_destroy(&wmi_handle->log_info.wmi_record_lock);
- }
- #else
- static inline void wmi_log_buffer_free(struct wmi_unified *wmi_handle)
- {
- /* Do Nothing */
- }
- #endif
- /**
- * wmi_print_cmd_log_buffer() - an output agnostic wmi command log printer
- * @log_buffer: the command log buffer metadata of the buffer to print
- * @count: the maximum number of entries to print
- * @print: an abstract print method, e.g. a qdf_print() or seq_printf() wrapper
- * @print_priv: any data required by the print method, e.g. a file handle
- *
- * Return: None
- */
- static void
- wmi_print_cmd_log_buffer(struct wmi_log_buf_t *log_buffer, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- static const int data_len =
- WMI_DEBUG_ENTRY_MAX_LENGTH / sizeof(uint32_t);
- char str[128];
- uint32_t idx;
- if (count > log_buffer->size)
- count = log_buffer->size;
- if (count > log_buffer->length)
- count = log_buffer->length;
- /* subtract count from index, and wrap if necessary */
- idx = log_buffer->size + *log_buffer->p_buf_tail_idx - count;
- idx %= log_buffer->size;
- print(print_priv, "Time (seconds) Cmd Id Payload");
- while (count) {
- struct wmi_command_debug *cmd_log = (struct wmi_command_debug *)
- &((struct wmi_command_debug *)log_buffer->buf)[idx];
- uint64_t secs, usecs;
- int len = 0;
- int i;
- qdf_log_timestamp_to_secs(cmd_log->time, &secs, &usecs);
- len += scnprintf(str + len, sizeof(str) - len,
- "% 8lld.%06lld %6u (0x%06x) ",
- secs, usecs,
- cmd_log->command, cmd_log->command);
- for (i = 0; i < data_len; ++i) {
- len += scnprintf(str + len, sizeof(str) - len,
- "0x%08x ", cmd_log->data[i]);
- }
- print(print_priv, str);
- --count;
- ++idx;
- if (idx >= log_buffer->size)
- idx = 0;
- }
- }
- /**
- * wmi_print_cmd_cmp_log_buffer() - wmi command completion log printer
- * @log_buffer: the command completion log buffer metadata of the buffer to print
- * @count: the maximum number of entries to print
- * @print: an abstract print method, e.g. a qdf_print() or seq_printf() wrapper
- * @print_priv: any data required by the print method, e.g. a file handle
- *
- * Return: None
- */
- static void
- wmi_print_cmd_cmp_log_buffer(struct wmi_log_buf_t *log_buffer, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- static const int data_len =
- WMI_DEBUG_ENTRY_MAX_LENGTH / sizeof(uint32_t);
- char str[128];
- uint32_t idx;
- if (count > log_buffer->size)
- count = log_buffer->size;
- if (count > log_buffer->length)
- count = log_buffer->length;
- /* subtract count from index, and wrap if necessary */
- idx = log_buffer->size + *log_buffer->p_buf_tail_idx - count;
- idx %= log_buffer->size;
- print(print_priv, "Time (seconds) Cmd Id Payload");
- while (count) {
- struct wmi_command_cmp_debug *cmd_log = (struct wmi_command_cmp_debug *)
- &((struct wmi_command_cmp_debug *)log_buffer->buf)[idx];
- uint64_t secs, usecs;
- int len = 0;
- int i;
- qdf_log_timestamp_to_secs(cmd_log->time, &secs, &usecs);
- len += scnprintf(str + len, sizeof(str) - len,
- "% 8lld.%06lld %6u (0x%06x) ",
- secs, usecs,
- cmd_log->command, cmd_log->command);
- for (i = 0; i < data_len; ++i) {
- len += scnprintf(str + len, sizeof(str) - len,
- "0x%08x ", cmd_log->data[i]);
- }
- print(print_priv, str);
- --count;
- ++idx;
- if (idx >= log_buffer->size)
- idx = 0;
- }
- }
- /**
- * wmi_print_event_log_buffer() - an output agnostic wmi event log printer
- * @log_buffer: the event log buffer metadata of the buffer to print
- * @count: the maximum number of entries to print
- * @print: an abstract print method, e.g. a qdf_print() or seq_printf() wrapper
- * @print_priv: any data required by the print method, e.g. a file handle
- *
- * Return: None
- */
- static void
- wmi_print_event_log_buffer(struct wmi_log_buf_t *log_buffer, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- static const int data_len =
- WMI_DEBUG_ENTRY_MAX_LENGTH / sizeof(uint32_t);
- char str[128];
- uint32_t idx;
- if (count > log_buffer->size)
- count = log_buffer->size;
- if (count > log_buffer->length)
- count = log_buffer->length;
- /* subtract count from index, and wrap if necessary */
- idx = log_buffer->size + *log_buffer->p_buf_tail_idx - count;
- idx %= log_buffer->size;
- print(print_priv, "Time (seconds) Event Id Payload");
- while (count) {
- struct wmi_event_debug *event_log = (struct wmi_event_debug *)
- &((struct wmi_event_debug *)log_buffer->buf)[idx];
- uint64_t secs, usecs;
- int len = 0;
- int i;
- qdf_log_timestamp_to_secs(event_log->time, &secs, &usecs);
- len += scnprintf(str + len, sizeof(str) - len,
- "% 8lld.%06lld %6u (0x%06x) ",
- secs, usecs,
- event_log->event, event_log->event);
- for (i = 0; i < data_len; ++i) {
- len += scnprintf(str + len, sizeof(str) - len,
- "0x%08x ", event_log->data[i]);
- }
- print(print_priv, str);
- --count;
- ++idx;
- if (idx >= log_buffer->size)
- idx = 0;
- }
- }
- inline void
- wmi_print_cmd_log(wmi_unified_t wmi, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- wmi_print_cmd_log_buffer(
- &wmi->log_info.wmi_command_log_buf_info,
- count, print, print_priv);
- }
- inline void
- wmi_print_cmd_tx_cmp_log(wmi_unified_t wmi, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- wmi_print_cmd_cmp_log_buffer(
- &wmi->log_info.wmi_command_tx_cmp_log_buf_info,
- count, print, print_priv);
- }
- inline void
- wmi_print_mgmt_cmd_log(wmi_unified_t wmi, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- wmi_print_cmd_log_buffer(
- &wmi->log_info.wmi_mgmt_command_log_buf_info,
- count, print, print_priv);
- }
- inline void
- wmi_print_mgmt_cmd_tx_cmp_log(wmi_unified_t wmi, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- wmi_print_cmd_log_buffer(
- &wmi->log_info.wmi_mgmt_command_tx_cmp_log_buf_info,
- count, print, print_priv);
- }
- inline void
- wmi_print_event_log(wmi_unified_t wmi, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- wmi_print_event_log_buffer(
- &wmi->log_info.wmi_event_log_buf_info,
- count, print, print_priv);
- }
- inline void
- wmi_print_rx_event_log(wmi_unified_t wmi, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- wmi_print_event_log_buffer(
- &wmi->log_info.wmi_rx_event_log_buf_info,
- count, print, print_priv);
- }
- inline void
- wmi_print_mgmt_event_log(wmi_unified_t wmi, uint32_t count,
- qdf_abstract_print *print, void *print_priv)
- {
- wmi_print_event_log_buffer(
- &wmi->log_info.wmi_mgmt_event_log_buf_info,
- count, print, print_priv);
- }
- /* debugfs routines*/
- /**
- * debug_wmi_##func_base##_show() - debugfs functions to display content of
- * command and event buffers. Macro uses max buffer length to display
- * buffer when it is wraparound.
- *
- * @m: debugfs handler to access wmi_handle
- * @v: Variable arguments (not used)
- *
- * Return: Length of characters printed
- */
- #define GENERATE_COMMAND_DEBUG_SHOW_FUNCS(func_base, wmi_ring_size, wmi_record_type)\
- static int debug_wmi_##func_base##_show(struct seq_file *m, \
- void *v) \
- { \
- wmi_unified_t wmi_handle = (wmi_unified_t) m->private; \
- struct wmi_log_buf_t *wmi_log = \
- &wmi_handle->log_info.wmi_##func_base##_buf_info;\
- int pos, nread, outlen; \
- int i; \
- uint64_t secs, usecs; \
- \
- qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);\
- if (!wmi_log->length) { \
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
- return wmi_bp_seq_printf(m, \
- "no elements to read from ring buffer!\n"); \
- } \
- \
- if (wmi_log->length <= wmi_ring_size) \
- nread = wmi_log->length; \
- else \
- nread = wmi_ring_size; \
- \
- if (*(wmi_log->p_buf_tail_idx) == 0) \
- /* tail can be 0 after wrap-around */ \
- pos = wmi_ring_size - 1; \
- else \
- pos = *(wmi_log->p_buf_tail_idx) - 1; \
- \
- outlen = wmi_bp_seq_printf(m, "Length = %d\n", wmi_log->length);\
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
- while (nread--) { \
- struct wmi_record_type *wmi_record; \
- \
- wmi_record = (struct wmi_record_type *) \
- &(((struct wmi_record_type *)wmi_log->buf)[pos]);\
- outlen += wmi_bp_seq_printf(m, "CMD ID = %x\n", \
- (wmi_record->command)); \
- qdf_log_timestamp_to_secs(wmi_record->time, &secs,\
- &usecs); \
- outlen += \
- wmi_bp_seq_printf(m, "CMD TIME = [%llu.%06llu]\n",\
- secs, usecs); \
- outlen += wmi_bp_seq_printf(m, "CMD = "); \
- for (i = 0; i < (wmi_record_max_length/ \
- sizeof(uint32_t)); i++) \
- outlen += wmi_bp_seq_printf(m, "%x ", \
- wmi_record->data[i]); \
- outlen += wmi_bp_seq_printf(m, "\n"); \
- \
- if (pos == 0) \
- pos = wmi_ring_size - 1; \
- else \
- pos--; \
- } \
- return outlen; \
- } \
- #define GENERATE_EVENT_DEBUG_SHOW_FUNCS(func_base, wmi_ring_size) \
- static int debug_wmi_##func_base##_show(struct seq_file *m, \
- void *v) \
- { \
- wmi_unified_t wmi_handle = (wmi_unified_t) m->private; \
- struct wmi_log_buf_t *wmi_log = \
- &wmi_handle->log_info.wmi_##func_base##_buf_info;\
- int pos, nread, outlen; \
- int i; \
- uint64_t secs, usecs; \
- \
- qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);\
- if (!wmi_log->length) { \
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
- return wmi_bp_seq_printf(m, \
- "no elements to read from ring buffer!\n"); \
- } \
- \
- if (wmi_log->length <= wmi_ring_size) \
- nread = wmi_log->length; \
- else \
- nread = wmi_ring_size; \
- \
- if (*(wmi_log->p_buf_tail_idx) == 0) \
- /* tail can be 0 after wrap-around */ \
- pos = wmi_ring_size - 1; \
- else \
- pos = *(wmi_log->p_buf_tail_idx) - 1; \
- \
- outlen = wmi_bp_seq_printf(m, "Length = %d\n", wmi_log->length);\
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
- while (nread--) { \
- struct wmi_event_debug *wmi_record; \
- \
- wmi_record = (struct wmi_event_debug *) \
- &(((struct wmi_event_debug *)wmi_log->buf)[pos]);\
- qdf_log_timestamp_to_secs(wmi_record->time, &secs,\
- &usecs); \
- outlen += wmi_bp_seq_printf(m, "Event ID = %x\n",\
- (wmi_record->event)); \
- outlen += \
- wmi_bp_seq_printf(m, "Event TIME = [%llu.%06llu]\n",\
- secs, usecs); \
- outlen += wmi_bp_seq_printf(m, "CMD = "); \
- for (i = 0; i < (wmi_record_max_length/ \
- sizeof(uint32_t)); i++) \
- outlen += wmi_bp_seq_printf(m, "%x ", \
- wmi_record->data[i]); \
- outlen += wmi_bp_seq_printf(m, "\n"); \
- \
- if (pos == 0) \
- pos = wmi_ring_size - 1; \
- else \
- pos--; \
- } \
- return outlen; \
- }
- GENERATE_COMMAND_DEBUG_SHOW_FUNCS(command_log, wmi_display_size,
- wmi_command_debug);
- GENERATE_COMMAND_DEBUG_SHOW_FUNCS(command_tx_cmp_log, wmi_display_size,
- wmi_command_cmp_debug);
- GENERATE_EVENT_DEBUG_SHOW_FUNCS(event_log, wmi_display_size);
- GENERATE_EVENT_DEBUG_SHOW_FUNCS(rx_event_log, wmi_display_size);
- GENERATE_COMMAND_DEBUG_SHOW_FUNCS(mgmt_command_log, wmi_display_size,
- wmi_command_debug);
- GENERATE_COMMAND_DEBUG_SHOW_FUNCS(mgmt_command_tx_cmp_log,
- wmi_display_size,
- wmi_command_debug);
- GENERATE_EVENT_DEBUG_SHOW_FUNCS(mgmt_event_log, wmi_display_size);
- /**
- * debug_wmi_enable_show() - debugfs functions to display enable state of
- * wmi logging feature.
- *
- * @m: debugfs handler to access wmi_handle
- * @v: Variable arguments (not used)
- *
- * Return: always 1
- */
- static int debug_wmi_enable_show(struct seq_file *m, void *v)
- {
- wmi_unified_t wmi_handle = (wmi_unified_t) m->private;
- return wmi_bp_seq_printf(m, "%d\n",
- wmi_handle->log_info.wmi_logging_enable);
- }
- /**
- * debug_wmi_log_size_show() - debugfs functions to display configured size of
- * wmi logging command/event buffer and management command/event buffer.
- *
- * @m: debugfs handler to access wmi_handle
- * @v: Variable arguments (not used)
- *
- * Return: Length of characters printed
- */
- static int debug_wmi_log_size_show(struct seq_file *m, void *v)
- {
- wmi_bp_seq_printf(m, "WMI command/cmpl log max size:%d/%d\n",
- wmi_cmd_log_max_entry, wmi_cmd_cmpl_log_max_entry);
- wmi_bp_seq_printf(m, "WMI management Tx/cmpl log max size:%d/%d\n",
- wmi_mgmt_tx_log_max_entry,
- wmi_mgmt_tx_cmpl_log_max_entry);
- wmi_bp_seq_printf(m, "WMI event log max size:%d\n",
- wmi_event_log_max_entry);
- wmi_bp_seq_printf(m, "WMI management Rx log max size:%d\n",
- wmi_mgmt_rx_log_max_entry);
- return wmi_bp_seq_printf(m,
- "WMI diag log max size:%d\n",
- wmi_diag_log_max_entry);
- }
- /**
- * debug_wmi_##func_base##_write() - debugfs functions to clear
- * wmi logging command/event buffer and management command/event buffer.
- *
- * @file: file handler to access wmi_handle
- * @buf: received data buffer
- * @count: length of received buffer
- * @ppos: Not used
- *
- * Return: count
- */
- #define GENERATE_DEBUG_WRITE_FUNCS(func_base, wmi_ring_size, wmi_record_type)\
- static ssize_t debug_wmi_##func_base##_write(struct file *file, \
- const char __user *buf, \
- size_t count, loff_t *ppos) \
- { \
- int k, ret; \
- wmi_unified_t wmi_handle = \
- ((struct seq_file *)file->private_data)->private;\
- struct wmi_log_buf_t *wmi_log = &wmi_handle->log_info. \
- wmi_##func_base##_buf_info; \
- char locbuf[50]; \
- \
- if ((!buf) || (count > 50)) \
- return -EFAULT; \
- \
- if (copy_from_user(locbuf, buf, count)) \
- return -EFAULT; \
- \
- ret = sscanf(locbuf, "%d", &k); \
- if ((ret != 1) || (k != 0)) { \
- wmi_err("Wrong input, echo 0 to clear the wmi buffer");\
- return -EINVAL; \
- } \
- \
- qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);\
- qdf_mem_zero(wmi_log->buf, wmi_ring_size * \
- sizeof(struct wmi_record_type)); \
- wmi_log->length = 0; \
- *(wmi_log->p_buf_tail_idx) = 0; \
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
- \
- return count; \
- }
- GENERATE_DEBUG_WRITE_FUNCS(command_log, wmi_cmd_log_max_entry,
- wmi_command_debug);
- GENERATE_DEBUG_WRITE_FUNCS(command_tx_cmp_log, wmi_cmd_cmpl_log_max_entry,
- wmi_command_cmp_debug);
- GENERATE_DEBUG_WRITE_FUNCS(event_log, wmi_event_log_max_entry,
- wmi_event_debug);
- GENERATE_DEBUG_WRITE_FUNCS(rx_event_log, wmi_event_log_max_entry,
- wmi_event_debug);
- GENERATE_DEBUG_WRITE_FUNCS(mgmt_command_log, wmi_mgmt_tx_log_max_entry,
- wmi_command_debug);
- GENERATE_DEBUG_WRITE_FUNCS(mgmt_command_tx_cmp_log,
- wmi_mgmt_tx_cmpl_log_max_entry, wmi_command_debug);
- GENERATE_DEBUG_WRITE_FUNCS(mgmt_event_log, wmi_mgmt_rx_log_max_entry,
- wmi_event_debug);
- /**
- * debug_wmi_enable_write() - debugfs functions to enable/disable
- * wmi logging feature.
- *
- * @file: file handler to access wmi_handle
- * @buf: received data buffer
- * @count: length of received buffer
- * @ppos: Not used
- *
- * Return: count
- */
- static ssize_t debug_wmi_enable_write(struct file *file, const char __user *buf,
- size_t count, loff_t *ppos)
- {
- wmi_unified_t wmi_handle =
- ((struct seq_file *)file->private_data)->private;
- int k, ret;
- char locbuf[50];
- if ((!buf) || (count > 50))
- return -EFAULT;
- if (copy_from_user(locbuf, buf, count))
- return -EFAULT;
- ret = sscanf(locbuf, "%d", &k);
- if ((ret != 1) || ((k != 0) && (k != 1)))
- return -EINVAL;
- wmi_handle->log_info.wmi_logging_enable = k;
- return count;
- }
- /**
- * debug_wmi_log_size_write() - reserved.
- *
- * @file: file handler to access wmi_handle
- * @buf: received data buffer
- * @count: length of received buffer
- * @ppos: Not used
- *
- * Return: count
- */
- static ssize_t debug_wmi_log_size_write(struct file *file,
- const char __user *buf, size_t count, loff_t *ppos)
- {
- return -EINVAL;
- }
- /* Structure to maintain debug information */
- struct wmi_debugfs_info {
- const char *name;
- const struct file_operations *ops;
- };
- #define DEBUG_FOO(func_base) { .name = #func_base, \
- .ops = &debug_##func_base##_ops }
- /**
- * debug_##func_base##_open() - Open debugfs entry for respective command
- * and event buffer.
- *
- * @inode: node for debug dir entry
- * @file: file handler
- *
- * Return: open status
- */
- #define GENERATE_DEBUG_STRUCTS(func_base) \
- static int debug_##func_base##_open(struct inode *inode, \
- struct file *file) \
- { \
- return single_open(file, debug_##func_base##_show, \
- inode->i_private); \
- } \
- \
- \
- static struct file_operations debug_##func_base##_ops = { \
- .open = debug_##func_base##_open, \
- .read = seq_read, \
- .llseek = seq_lseek, \
- .write = debug_##func_base##_write, \
- .release = single_release, \
- };
- GENERATE_DEBUG_STRUCTS(wmi_command_log);
- GENERATE_DEBUG_STRUCTS(wmi_command_tx_cmp_log);
- GENERATE_DEBUG_STRUCTS(wmi_event_log);
- GENERATE_DEBUG_STRUCTS(wmi_rx_event_log);
- GENERATE_DEBUG_STRUCTS(wmi_mgmt_command_log);
- GENERATE_DEBUG_STRUCTS(wmi_mgmt_command_tx_cmp_log);
- GENERATE_DEBUG_STRUCTS(wmi_mgmt_event_log);
- GENERATE_DEBUG_STRUCTS(wmi_enable);
- GENERATE_DEBUG_STRUCTS(wmi_log_size);
- #ifdef WMI_INTERFACE_FILTERED_EVENT_LOGGING
- GENERATE_DEBUG_STRUCTS(filtered_wmi_cmds);
- GENERATE_DEBUG_STRUCTS(filtered_wmi_evts);
- GENERATE_DEBUG_STRUCTS(wmi_filtered_command_log);
- GENERATE_DEBUG_STRUCTS(wmi_filtered_event_log);
- #endif
- struct wmi_debugfs_info wmi_debugfs_infos[NUM_DEBUG_INFOS] = {
- DEBUG_FOO(wmi_command_log),
- DEBUG_FOO(wmi_command_tx_cmp_log),
- DEBUG_FOO(wmi_event_log),
- DEBUG_FOO(wmi_rx_event_log),
- DEBUG_FOO(wmi_mgmt_command_log),
- DEBUG_FOO(wmi_mgmt_command_tx_cmp_log),
- DEBUG_FOO(wmi_mgmt_event_log),
- DEBUG_FOO(wmi_enable),
- DEBUG_FOO(wmi_log_size),
- #ifdef WMI_INTERFACE_FILTERED_EVENT_LOGGING
- DEBUG_FOO(filtered_wmi_cmds),
- DEBUG_FOO(filtered_wmi_evts),
- DEBUG_FOO(wmi_filtered_command_log),
- DEBUG_FOO(wmi_filtered_event_log),
- #endif
- };
- /**
- * wmi_debugfs_create() - Create debug_fs entry for wmi logging.
- *
- * @wmi_handle: wmi handle
- * @par_entry: debug directory entry
- * @id: Index to debug info data array
- *
- * Return: none
- */
- static void wmi_debugfs_create(wmi_unified_t wmi_handle,
- struct dentry *par_entry)
- {
- int i;
- if (!par_entry)
- goto out;
- for (i = 0; i < NUM_DEBUG_INFOS; ++i) {
- wmi_handle->debugfs_de[i] = qdf_debugfs_create_entry(
- wmi_debugfs_infos[i].name,
- WMI_INFOS_DBG_FILE_PERM,
- par_entry,
- wmi_handle,
- wmi_debugfs_infos[i].ops);
- if (!wmi_handle->debugfs_de[i]) {
- wmi_err("debug Entry creation failed!");
- goto out;
- }
- }
- return;
- out:
- wmi_err("debug Entry creation failed!");
- wmi_log_buffer_free(wmi_handle);
- return;
- }
- /**
- * wmi_debugfs_remove() - Remove debugfs entry for wmi logging.
- * @wmi_handle: wmi handle
- * @dentry: debugfs directory entry
- * @id: Index to debug info data array
- *
- * Return: none
- */
- static void wmi_debugfs_remove(wmi_unified_t wmi_handle)
- {
- int i;
- struct dentry *dentry = wmi_handle->log_info.wmi_log_debugfs_dir;
- if (dentry) {
- for (i = 0; i < NUM_DEBUG_INFOS; ++i) {
- if (wmi_handle->debugfs_de[i])
- wmi_handle->debugfs_de[i] = NULL;
- }
- }
- if (dentry)
- qdf_debugfs_remove_dir_recursive(dentry);
- }
- /**
- * wmi_debugfs_init() - debugfs functions to create debugfs directory and to
- * create debugfs enteries.
- *
- * @h: wmi handler
- *
- * Return: init status
- */
- static QDF_STATUS wmi_debugfs_init(wmi_unified_t wmi_handle, uint32_t pdev_idx)
- {
- char buf[32];
- snprintf(buf, sizeof(buf), "WMI_SOC%u_PDEV%u",
- wmi_handle->soc->soc_idx, pdev_idx);
- wmi_handle->log_info.wmi_log_debugfs_dir =
- qdf_debugfs_create_dir(buf, NULL);
- if (!wmi_handle->log_info.wmi_log_debugfs_dir) {
- wmi_err("error while creating debugfs dir for %s", buf);
- return QDF_STATUS_E_FAILURE;
- }
- wmi_debugfs_create(wmi_handle,
- wmi_handle->log_info.wmi_log_debugfs_dir);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * wmi_mgmt_cmd_record() - Wrapper function for mgmt command logging macro
- *
- * @wmi_handle: wmi handle
- * @cmd: mgmt command
- * @header: pointer to 802.11 header
- * @vdev_id: vdev id
- * @chanfreq: channel frequency
- *
- * Return: none
- */
- void wmi_mgmt_cmd_record(wmi_unified_t wmi_handle, uint32_t cmd,
- void *header, uint32_t vdev_id, uint32_t chanfreq)
- {
- uint32_t data[CUSTOM_MGMT_CMD_DATA_SIZE];
- data[0] = ((struct wmi_command_header *)header)->type;
- data[1] = ((struct wmi_command_header *)header)->sub_type;
- data[2] = vdev_id;
- data[3] = chanfreq;
- qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);
- WMI_MGMT_COMMAND_RECORD(wmi_handle, cmd, (uint8_t *)data);
- wmi_specific_cmd_record(wmi_handle, cmd, (uint8_t *)data);
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);
- }
- #else
- /**
- * wmi_debugfs_remove() - Remove debugfs entry for wmi logging.
- * @wmi_handle: wmi handle
- * @dentry: debugfs directory entry
- * @id: Index to debug info data array
- *
- * Return: none
- */
- static void wmi_debugfs_remove(wmi_unified_t wmi_handle) { }
- void wmi_mgmt_cmd_record(wmi_unified_t wmi_handle, uint32_t cmd,
- void *header, uint32_t vdev_id, uint32_t chanfreq) { }
- static inline void wmi_log_buffer_free(struct wmi_unified *wmi_handle) { }
- static void wmi_minidump_detach(struct wmi_unified *wmi_handle) { }
- static void wmi_minidump_attach(struct wmi_unified *wmi_handle) { }
- #endif /*WMI_INTERFACE_EVENT_LOGGING */
- qdf_export_symbol(wmi_mgmt_cmd_record);
- #ifdef WMI_EXT_DBG
- /**
- * wmi_ext_dbg_msg_enqueue() - enqueue wmi message
- * @wmi_handle: wmi handler
- *
- * Return: size of wmi message queue after enqueue
- */
- static uint32_t wmi_ext_dbg_msg_enqueue(struct wmi_unified *wmi_handle,
- struct wmi_ext_dbg_msg *msg)
- {
- uint32_t list_size;
- qdf_spinlock_acquire(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
- qdf_list_insert_back_size(&wmi_handle->wmi_ext_dbg_msg_queue,
- &msg->node, &list_size);
- qdf_spinlock_release(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
- return list_size;
- }
- /**
- * wmi_ext_dbg_msg_dequeue() - dequeue wmi message
- * @wmi_handle: wmi handler
- *
- * Return: wmi msg on success else NULL
- */
- static struct wmi_ext_dbg_msg *wmi_ext_dbg_msg_dequeue(struct wmi_unified
- *wmi_handle)
- {
- qdf_list_node_t *list_node = NULL;
- qdf_spinlock_acquire(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
- qdf_list_remove_front(&wmi_handle->wmi_ext_dbg_msg_queue, &list_node);
- qdf_spinlock_release(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
- if (!list_node)
- return NULL;
- return qdf_container_of(list_node, struct wmi_ext_dbg_msg, node);
- }
- /**
- * wmi_ext_dbg_msg_record() - record wmi messages
- * @wmi_handle: wmi handler
- * @buf: wmi message buffer
- * @len: wmi message length
- * @type: wmi message type
- *
- * Return: QDF_STATUS_SUCCESS on successful recording else failure.
- */
- static QDF_STATUS wmi_ext_dbg_msg_record(struct wmi_unified *wmi_handle,
- uint8_t *buf, uint32_t len,
- enum WMI_MSG_TYPE type)
- {
- struct wmi_ext_dbg_msg *msg;
- uint32_t list_size;
- msg = wmi_ext_dbg_msg_get(len);
- if (!msg)
- return QDF_STATUS_E_NOMEM;
- msg->len = len;
- msg->type = type;
- qdf_mem_copy(msg->buf, buf, len);
- msg->ts = qdf_get_log_timestamp();
- list_size = wmi_ext_dbg_msg_enqueue(wmi_handle, msg);
- if (list_size >= wmi_handle->wmi_ext_dbg_msg_queue_size) {
- msg = wmi_ext_dbg_msg_dequeue(wmi_handle);
- wmi_ext_dbg_msg_put(msg);
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * wmi_ext_dbg_msg_cmd_record() - record wmi command messages
- * @wmi_handle: wmi handler
- * @buf: wmi command buffer
- * @len: wmi command message length
- *
- * Return: QDF_STATUS_SUCCESS on successful recording else failure.
- */
- static QDF_STATUS wmi_ext_dbg_msg_cmd_record(struct wmi_unified *wmi_handle,
- uint8_t *buf, uint32_t len)
- {
- return wmi_ext_dbg_msg_record(wmi_handle, buf, len,
- WMI_MSG_TYPE_CMD);
- }
- /**
- * wmi_ext_dbg_msg_event_record() - record wmi event messages
- * @wmi_handle: wmi handler
- * @buf: wmi event buffer
- * @len: wmi event message length
- *
- * Return: QDF_STATUS_SUCCESS on successful recording else failure.
- */
- static QDF_STATUS wmi_ext_dbg_msg_event_record(struct wmi_unified *wmi_handle,
- uint8_t *buf, uint32_t len)
- {
- uint32_t id;
- id = WMI_GET_FIELD(buf, WMI_CMD_HDR, COMMANDID);
- if (id != wmi_handle->wmi_events[wmi_diag_event_id])
- return wmi_ext_dbg_msg_record(wmi_handle, buf, len,
- WMI_MSG_TYPE_EVENT);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * wmi_ext_dbg_msg_queue_init() - create debugfs queue and associated lock
- * @wmi_handle: wmi handler
- *
- * Return: none
- */
- static void wmi_ext_dbg_msg_queue_init(struct wmi_unified *wmi_handle)
- {
- qdf_list_create(&wmi_handle->wmi_ext_dbg_msg_queue,
- wmi_handle->wmi_ext_dbg_msg_queue_size);
- qdf_spinlock_create(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
- }
- /**
- * wmi_ext_dbg_msg_queue_deinit() - destroy debugfs queue and associated lock
- * @wmi_handle: wmi handler
- *
- * Return: none
- */
- static void wmi_ext_dbg_msg_queue_deinit(struct wmi_unified *wmi_handle)
- {
- qdf_list_destroy(&wmi_handle->wmi_ext_dbg_msg_queue);
- qdf_spinlock_destroy(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
- }
- /**
- * wmi_ext_dbg_msg_show() - debugfs function to display whole content of
- * wmi command/event messages including headers.
- * @file: qdf debugfs file handler
- * @arg: pointer to wmi handler
- *
- * Return: QDF_STATUS_SUCCESS if all the messages are shown successfully,
- * else QDF_STATUS_E_AGAIN if more data to show.
- */
- static QDF_STATUS wmi_ext_dbg_msg_show(qdf_debugfs_file_t file, void *arg)
- {
- struct wmi_unified *wmi_handle = (struct wmi_unified *)arg;
- struct wmi_ext_dbg_msg *msg;
- uint64_t secs, usecs;
- msg = wmi_ext_dbg_msg_dequeue(wmi_handle);
- if (!msg)
- return QDF_STATUS_SUCCESS;
- qdf_debugfs_printf(file, "%s: 0x%x\n",
- msg->type == WMI_MSG_TYPE_CMD ? "COMMAND" :
- "EVENT", WMI_GET_FIELD(msg->buf, WMI_CMD_HDR,
- COMMANDID));
- qdf_log_timestamp_to_secs(msg->ts, &secs, &usecs);
- qdf_debugfs_printf(file, "Time: %llu.%llu\n", secs, usecs);
- qdf_debugfs_printf(file, "Length:%d\n", msg->len);
- qdf_debugfs_hexdump(file, msg->buf, msg->len,
- WMI_EXT_DBG_DUMP_ROW_SIZE,
- WMI_EXT_DBG_DUMP_GROUP_SIZE);
- qdf_debugfs_printf(file, "\n");
- if (qdf_debugfs_overflow(file)) {
- qdf_spinlock_acquire(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
- qdf_list_insert_front(&wmi_handle->wmi_ext_dbg_msg_queue,
- &msg->node);
- qdf_spinlock_release(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
- } else {
- wmi_ext_dbg_msg_put(msg);
- }
- return QDF_STATUS_E_AGAIN;
- }
- /**
- * wmi_ext_dbg_msg_write() - debugfs write not supported
- * @priv: private data
- * @buf: received data buffer
- * @len: length of received buffer
- *
- * Return: QDF_STATUS_E_NOSUPPORT.
- */
- static QDF_STATUS wmi_ext_dbg_msg_write(void *priv, const char *buf,
- qdf_size_t len)
- {
- return QDF_STATUS_E_NOSUPPORT;
- }
- static struct qdf_debugfs_fops wmi_ext_dbgfs_ops[WMI_MAX_RADIOS];
- /**
- * wmi_ext_debugfs_init() - init debugfs items for extended wmi dump.
- * @wmi_handle: wmi handler
- * @pdev_idx: pdev index
- *
- * Return: QDF_STATUS_SUCCESS if debugfs is initialized else
- * QDF_STATUS_E_FAILURE
- */
- static QDF_STATUS wmi_ext_dbgfs_init(struct wmi_unified *wmi_handle,
- uint32_t pdev_idx)
- {
- qdf_dentry_t dentry;
- char buf[32];
- /* To maintain backward compatibility, naming convention for PDEV 0
- * dentry is kept same as before. For more than 1 PDEV, dentry
- * names will be appended with PDEVx.
- */
- if (wmi_handle->soc->soc_idx == 0 && pdev_idx == 0) {
- dentry = qdf_debugfs_create_dir(WMI_EXT_DBG_DIR, NULL);
- } else {
- snprintf(buf, sizeof(buf), "WMI_EXT_DBG_SOC%u_PDEV%u",
- wmi_handle->soc->soc_idx, pdev_idx);
- dentry = qdf_debugfs_create_dir(buf, NULL);
- }
- if (!dentry) {
- wmi_err("error while creating extended wmi debugfs dir");
- return QDF_STATUS_E_FAILURE;
- }
- wmi_ext_dbgfs_ops[pdev_idx].show = wmi_ext_dbg_msg_show;
- wmi_ext_dbgfs_ops[pdev_idx].write = wmi_ext_dbg_msg_write;
- wmi_ext_dbgfs_ops[pdev_idx].priv = wmi_handle;
- if (!qdf_debugfs_create_file(WMI_EXT_DBG_FILE, WMI_EXT_DBG_FILE_PERM,
- dentry, &wmi_ext_dbgfs_ops[pdev_idx])) {
- qdf_debugfs_remove_dir(dentry);
- wmi_err("Error while creating extended wmi debugfs file");
- return QDF_STATUS_E_FAILURE;
- }
- wmi_handle->wmi_ext_dbg_dentry = dentry;
- wmi_handle->wmi_ext_dbg_msg_queue_size = WMI_EXT_DBG_QUEUE_SIZE;
- wmi_ext_dbg_msg_queue_init(wmi_handle);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * wmi_ext_debugfs_deinit() - cleanup/deinit debugfs items of extended wmi dump.
- * @wmi_handle: wmi handler
- *
- * Return: QDF_STATUS_SUCCESS if cleanup is successful
- */
- static QDF_STATUS wmi_ext_dbgfs_deinit(struct wmi_unified *wmi_handle)
- {
- struct wmi_ext_dbg_msg *msg;
- while ((msg = wmi_ext_dbg_msg_dequeue(wmi_handle)))
- wmi_ext_dbg_msg_put(msg);
- wmi_ext_dbg_msg_queue_deinit(wmi_handle);
- qdf_debugfs_remove_dir_recursive(wmi_handle->wmi_ext_dbg_dentry);
- return QDF_STATUS_SUCCESS;
- }
- #else
- static inline QDF_STATUS wmi_ext_dbg_msg_cmd_record(struct wmi_unified
- *wmi_handle,
- uint8_t *buf, uint32_t len)
- {
- return QDF_STATUS_SUCCESS;
- }
- static inline QDF_STATUS wmi_ext_dbg_msg_event_record(struct wmi_unified
- *wmi_handle,
- uint8_t *buf, uint32_t len)
- {
- return QDF_STATUS_SUCCESS;
- }
- static inline QDF_STATUS wmi_ext_dbgfs_init(struct wmi_unified *wmi_handle,
- uint32_t pdev_idx)
- {
- return QDF_STATUS_SUCCESS;
- }
- static inline QDF_STATUS wmi_ext_dbgfs_deinit(struct wmi_unified *wmi_handle)
- {
- return QDF_STATUS_SUCCESS;
- }
- #endif /*WMI_EXT_DBG */
- int wmi_get_host_credits(wmi_unified_t wmi_handle);
- /* WMI buffer APIs */
- #ifdef NBUF_MEMORY_DEBUG
- wmi_buf_t
- wmi_buf_alloc_debug(wmi_unified_t wmi_handle, uint32_t len,
- const char *func_name,
- uint32_t line_num)
- {
- wmi_buf_t wmi_buf;
- if (roundup(len + sizeof(WMI_CMD_HDR), 4) > wmi_handle->max_msg_len) {
- QDF_ASSERT(0);
- return NULL;
- }
- wmi_buf = wbuff_buff_get(wmi_handle->wbuff_handle, len, func_name,
- line_num);
- if (!wmi_buf)
- wmi_buf = qdf_nbuf_alloc_debug(NULL,
- roundup(len + WMI_MIN_HEAD_ROOM,
- 4),
- WMI_MIN_HEAD_ROOM, 4, false,
- func_name, line_num);
- if (!wmi_buf)
- return NULL;
- /* Clear the wmi buffer */
- OS_MEMZERO(qdf_nbuf_data(wmi_buf), len);
- /*
- * Set the length of the buffer to match the allocation size.
- */
- qdf_nbuf_set_pktlen(wmi_buf, len);
- return wmi_buf;
- }
- qdf_export_symbol(wmi_buf_alloc_debug);
- void wmi_buf_free(wmi_buf_t net_buf)
- {
- net_buf = wbuff_buff_put(net_buf);
- if (net_buf)
- qdf_nbuf_free(net_buf);
- }
- qdf_export_symbol(wmi_buf_free);
- #else
- wmi_buf_t wmi_buf_alloc_fl(wmi_unified_t wmi_handle, uint32_t len,
- const char *func, uint32_t line)
- {
- wmi_buf_t wmi_buf;
- if (roundup(len + sizeof(WMI_CMD_HDR), 4) > wmi_handle->max_msg_len) {
- QDF_DEBUG_PANIC("Invalid length %u (via %s:%u)",
- len, func, line);
- return NULL;
- }
- wmi_buf = wbuff_buff_get(wmi_handle->wbuff_handle, len, __func__,
- __LINE__);
- if (!wmi_buf)
- wmi_buf = qdf_nbuf_alloc_fl(NULL, roundup(len +
- WMI_MIN_HEAD_ROOM, 4), WMI_MIN_HEAD_ROOM, 4,
- false, func, line);
- if (!wmi_buf) {
- wmi_nofl_err("%s:%d, failed to alloc len:%d", func, line, len);
- return NULL;
- }
- /* Clear the wmi buffer */
- OS_MEMZERO(qdf_nbuf_data(wmi_buf), len);
- /*
- * Set the length of the buffer to match the allocation size.
- */
- qdf_nbuf_set_pktlen(wmi_buf, len);
- return wmi_buf;
- }
- qdf_export_symbol(wmi_buf_alloc_fl);
- void wmi_buf_free(wmi_buf_t net_buf)
- {
- net_buf = wbuff_buff_put(net_buf);
- if (net_buf)
- qdf_nbuf_free(net_buf);
- }
- qdf_export_symbol(wmi_buf_free);
- #endif
- /**
- * wmi_get_max_msg_len() - get maximum WMI message length
- * @wmi_handle: WMI handle.
- *
- * This function returns the maximum WMI message length
- *
- * Return: maximum WMI message length
- */
- uint16_t wmi_get_max_msg_len(wmi_unified_t wmi_handle)
- {
- return wmi_handle->max_msg_len - WMI_MIN_HEAD_ROOM;
- }
- qdf_export_symbol(wmi_get_max_msg_len);
- #ifndef WMI_CMD_STRINGS
- static uint8_t *wmi_id_to_name(uint32_t wmi_command)
- {
- return "Invalid WMI cmd";
- }
- #endif
- static inline void wmi_log_cmd_id(uint32_t cmd_id, uint32_t tag)
- {
- wmi_debug("Send WMI command:%s command_id:%d htc_tag:%d",
- wmi_id_to_name(cmd_id), cmd_id, tag);
- }
- /**
- * wmi_is_pm_resume_cmd() - check if a cmd is part of the resume sequence
- * @cmd_id: command to check
- *
- * Return: true if the command is part of the resume sequence.
- */
- #ifdef WLAN_POWER_MANAGEMENT_OFFLOAD
- static bool wmi_is_pm_resume_cmd(uint32_t cmd_id)
- {
- switch (cmd_id) {
- case WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID:
- case WMI_PDEV_RESUME_CMDID:
- return true;
- default:
- return false;
- }
- }
- #else
- static bool wmi_is_pm_resume_cmd(uint32_t cmd_id)
- {
- return false;
- }
- #endif
- #ifdef FEATURE_WLAN_D0WOW
- static bool wmi_is_legacy_d0wow_disable_cmd(wmi_buf_t buf, uint32_t cmd_id)
- {
- wmi_d0_wow_enable_disable_cmd_fixed_param *cmd;
- if (cmd_id == WMI_D0_WOW_ENABLE_DISABLE_CMDID) {
- cmd = (wmi_d0_wow_enable_disable_cmd_fixed_param *)
- wmi_buf_data(buf);
- if (!cmd->enable)
- return true;
- else
- return false;
- }
- return false;
- }
- #else
- static bool wmi_is_legacy_d0wow_disable_cmd(wmi_buf_t buf, uint32_t cmd_id)
- {
- return false;
- }
- #endif
- #ifdef WMI_INTERFACE_SEQUENCE_CHECK
- static inline void wmi_interface_sequence_reset(struct wmi_unified *wmi_handle)
- {
- wmi_handle->wmi_sequence = 0;
- wmi_handle->wmi_exp_sequence = 0;
- wmi_handle->wmi_sequence_stop = false;
- }
- static inline void wmi_interface_sequence_init(struct wmi_unified *wmi_handle)
- {
- qdf_spinlock_create(&wmi_handle->wmi_seq_lock);
- wmi_interface_sequence_reset(wmi_handle);
- }
- static inline void wmi_interface_sequence_deinit(struct wmi_unified *wmi_handle)
- {
- qdf_spinlock_destroy(&wmi_handle->wmi_seq_lock);
- }
- void wmi_interface_sequence_stop(struct wmi_unified *wmi_handle)
- {
- wmi_handle->wmi_sequence_stop = true;
- }
- static inline QDF_STATUS wmi_htc_send_pkt(struct wmi_unified *wmi_handle,
- HTC_PACKET *pkt,
- const char *func, uint32_t line)
- {
- wmi_buf_t buf = GET_HTC_PACKET_NET_BUF_CONTEXT(pkt);
- QDF_STATUS status;
- qdf_spin_lock_bh(&wmi_handle->wmi_seq_lock);
- status = htc_send_pkt(wmi_handle->htc_handle, pkt);
- if (QDF_STATUS_SUCCESS != status) {
- qdf_spin_unlock_bh(&wmi_handle->wmi_seq_lock);
- qdf_atomic_dec(&wmi_handle->pending_cmds);
- wmi_nofl_err("%s:%d, htc_send_pkt failed, status:%d",
- func, line, status);
- qdf_mem_free(pkt);
- return status;
- }
- /* Record the sequence number in the SKB */
- qdf_nbuf_set_mark(buf, wmi_handle->wmi_sequence);
- /* Increment the sequence number */
- wmi_handle->wmi_sequence = (wmi_handle->wmi_sequence + 1)
- & (wmi_handle->wmi_max_cmds - 1);
- qdf_spin_unlock_bh(&wmi_handle->wmi_seq_lock);
- return status;
- }
- static inline void wmi_interface_sequence_check(struct wmi_unified *wmi_handle,
- wmi_buf_t buf)
- {
- /* Skip sequence check when wmi sequence stop is set */
- if (wmi_handle->wmi_sequence_stop)
- return;
- qdf_spin_lock_bh(&wmi_handle->wmi_seq_lock);
- /* Match the completion sequence and expected sequence number */
- if (qdf_nbuf_get_mark(buf) != wmi_handle->wmi_exp_sequence) {
- qdf_spin_unlock_bh(&wmi_handle->wmi_seq_lock);
- wmi_nofl_err("WMI Tx Completion Sequence number mismatch");
- wmi_nofl_err("Expected %d Received %d",
- wmi_handle->wmi_exp_sequence,
- qdf_nbuf_get_mark(buf));
- /* Trigger Recovery */
- qdf_trigger_self_recovery(wmi_handle->soc,
- QDF_WMI_BUF_SEQUENCE_MISMATCH);
- } else {
- /* Increment the expected sequence number */
- wmi_handle->wmi_exp_sequence =
- (wmi_handle->wmi_exp_sequence + 1)
- & (wmi_handle->wmi_max_cmds - 1);
- qdf_spin_unlock_bh(&wmi_handle->wmi_seq_lock);
- }
- }
- #else
- static inline void wmi_interface_sequence_reset(struct wmi_unified *wmi_handle)
- {
- }
- static inline void wmi_interface_sequence_init(struct wmi_unified *wmi_handle)
- {
- }
- static inline void wmi_interface_sequence_deinit(struct wmi_unified *wmi_handle)
- {
- }
- void wmi_interface_sequence_stop(struct wmi_unified *wmi_handle)
- {
- }
- static inline QDF_STATUS wmi_htc_send_pkt(struct wmi_unified *wmi_handle,
- HTC_PACKET *pkt,
- const char *func, uint32_t line)
- {
- QDF_STATUS status;
- status = htc_send_pkt(wmi_handle->htc_handle, pkt);
- if (QDF_STATUS_SUCCESS != status) {
- qdf_atomic_dec(&wmi_handle->pending_cmds);
- wmi_nofl_err("%s:%d, htc_send_pkt failed, status:%d",
- func, line, status);
- qdf_mem_free(pkt);
- return status;
- }
- return status;
- }
- static inline void wmi_interface_sequence_check(struct wmi_unified *wmi_handle,
- wmi_buf_t buf)
- {
- }
- #endif
- static inline void wmi_unified_debug_dump(wmi_unified_t wmi_handle)
- {
- wmi_nofl_err("Endpoint ID = %d, Tx Queue Depth = %d, soc_id = %u, target type = %s",
- wmi_handle->wmi_endpoint_id,
- htc_get_tx_queue_depth(wmi_handle->htc_handle,
- wmi_handle->wmi_endpoint_id),
- wmi_handle->soc->soc_idx,
- (wmi_handle->target_type ==
- WMI_TLV_TARGET ? "WMI_TLV_TARGET" :
- "WMI_NON_TLV_TARGET"));
- }
- #ifdef SYSTEM_PM_CHECK
- /**
- * wmi_set_system_pm_pkt_tag() - API to set tag for system pm packets
- * @htc_tag: HTC tag
- * @buf: wmi cmd buffer
- * @cmd_id: cmd id
- *
- * Return: None
- */
- static void wmi_set_system_pm_pkt_tag(uint16_t *htc_tag, wmi_buf_t buf,
- uint32_t cmd_id)
- {
- switch (cmd_id) {
- case WMI_WOW_ENABLE_CMDID:
- case WMI_PDEV_SUSPEND_CMDID:
- *htc_tag = HTC_TX_PACKET_SYSTEM_SUSPEND;
- break;
- case WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID:
- case WMI_PDEV_RESUME_CMDID:
- *htc_tag = HTC_TX_PACKET_SYSTEM_RESUME;
- break;
- case WMI_D0_WOW_ENABLE_DISABLE_CMDID:
- if (wmi_is_legacy_d0wow_disable_cmd(buf, cmd_id))
- *htc_tag = HTC_TX_PACKET_SYSTEM_RESUME;
- else
- *htc_tag = HTC_TX_PACKET_SYSTEM_SUSPEND;
- break;
- default:
- break;
- }
- }
- #else
- static inline void wmi_set_system_pm_pkt_tag(uint16_t *htc_tag, wmi_buf_t buf,
- uint32_t cmd_id)
- {
- }
- #endif
- QDF_STATUS wmi_unified_cmd_send_fl(wmi_unified_t wmi_handle, wmi_buf_t buf,
- uint32_t len, uint32_t cmd_id,
- const char *func, uint32_t line)
- {
- HTC_PACKET *pkt;
- uint16_t htc_tag = 0;
- bool rtpm_inprogress;
- rtpm_inprogress = wmi_get_runtime_pm_inprogress(wmi_handle);
- if (rtpm_inprogress) {
- htc_tag = wmi_handle->ops->wmi_set_htc_tx_tag(wmi_handle, buf,
- cmd_id);
- } else if (qdf_atomic_read(&wmi_handle->is_target_suspended) &&
- !wmi_is_pm_resume_cmd(cmd_id) &&
- !wmi_is_legacy_d0wow_disable_cmd(buf, cmd_id)) {
- wmi_nofl_err("Target is suspended (via %s:%u)",
- func, line);
- return QDF_STATUS_E_BUSY;
- }
- if (wmi_handle->wmi_stopinprogress) {
- wmi_nofl_err("%s:%d, WMI stop in progress, wmi_handle:%pK",
- func, line, wmi_handle);
- return QDF_STATUS_E_INVAL;
- }
- #ifndef WMI_NON_TLV_SUPPORT
- /* Do sanity check on the TLV parameter structure */
- if (wmi_handle->target_type == WMI_TLV_TARGET) {
- void *buf_ptr = (void *)qdf_nbuf_data(buf);
- if (wmi_handle->ops->wmi_check_command_params(NULL, buf_ptr, len, cmd_id)
- != 0) {
- wmi_nofl_err("%s:%d, Invalid WMI Param Buffer for Cmd:%d",
- func, line, cmd_id);
- return QDF_STATUS_E_INVAL;
- }
- }
- #endif
- if (qdf_nbuf_push_head(buf, sizeof(WMI_CMD_HDR)) == NULL) {
- wmi_nofl_err("%s:%d, Failed to send cmd %x, no memory",
- func, line, cmd_id);
- return QDF_STATUS_E_NOMEM;
- }
- qdf_mem_zero(qdf_nbuf_data(buf), sizeof(WMI_CMD_HDR));
- WMI_SET_FIELD(qdf_nbuf_data(buf), WMI_CMD_HDR, COMMANDID, cmd_id);
- qdf_atomic_inc(&wmi_handle->pending_cmds);
- if (qdf_atomic_read(&wmi_handle->pending_cmds) >=
- wmi_handle->wmi_max_cmds) {
- wmi_nofl_err("hostcredits = %d",
- wmi_get_host_credits(wmi_handle));
- htc_dump_counter_info(wmi_handle->htc_handle);
- qdf_atomic_dec(&wmi_handle->pending_cmds);
- wmi_nofl_err("%s:%d, MAX %d WMI Pending cmds reached",
- func, line, wmi_handle->wmi_max_cmds);
- wmi_unified_debug_dump(wmi_handle);
- htc_ce_tasklet_debug_dump(wmi_handle->htc_handle);
- qdf_trigger_self_recovery(wmi_handle->soc->wmi_psoc,
- QDF_WMI_EXCEED_MAX_PENDING_CMDS);
- return QDF_STATUS_E_BUSY;
- }
- pkt = qdf_mem_malloc_fl(sizeof(*pkt), func, line);
- if (!pkt) {
- qdf_atomic_dec(&wmi_handle->pending_cmds);
- return QDF_STATUS_E_NOMEM;
- }
- if (!rtpm_inprogress)
- wmi_set_system_pm_pkt_tag(&htc_tag, buf, cmd_id);
- SET_HTC_PACKET_INFO_TX(pkt,
- NULL,
- qdf_nbuf_data(buf), len + sizeof(WMI_CMD_HDR),
- wmi_handle->wmi_endpoint_id, htc_tag);
- SET_HTC_PACKET_NET_BUF_CONTEXT(pkt, buf);
- wmi_log_cmd_id(cmd_id, htc_tag);
- wmi_ext_dbg_msg_cmd_record(wmi_handle,
- qdf_nbuf_data(buf), qdf_nbuf_len(buf));
- #ifdef WMI_INTERFACE_EVENT_LOGGING
- if (wmi_handle->log_info.wmi_logging_enable) {
- qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);
- /*
- * Record 16 bytes of WMI cmd data -
- * exclude TLV and WMI headers
- *
- * WMI mgmt command already recorded in wmi_mgmt_cmd_record
- */
- if (wmi_handle->ops->is_management_record(cmd_id) == false) {
- uint8_t *tmpbuf = (uint8_t *)qdf_nbuf_data(buf) +
- wmi_handle->soc->buf_offset_command;
- WMI_COMMAND_RECORD(wmi_handle, cmd_id, tmpbuf);
- wmi_specific_cmd_record(wmi_handle, cmd_id, tmpbuf);
- }
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);
- }
- #endif
- return wmi_htc_send_pkt(wmi_handle, pkt, func, line);
- }
- qdf_export_symbol(wmi_unified_cmd_send_fl);
- /**
- * wmi_unified_get_event_handler_ix() - gives event handler's index
- * @wmi_handle: handle to wmi
- * @event_id: wmi event id
- *
- * Return: event handler's index
- */
- static int wmi_unified_get_event_handler_ix(wmi_unified_t wmi_handle,
- uint32_t event_id)
- {
- uint32_t idx = 0;
- int32_t invalid_idx = -1;
- struct wmi_soc *soc = wmi_handle->soc;
- for (idx = 0; (idx < soc->max_event_idx &&
- idx < WMI_UNIFIED_MAX_EVENT); ++idx) {
- if (wmi_handle->event_id[idx] == event_id &&
- wmi_handle->event_handler[idx]) {
- return idx;
- }
- }
- return invalid_idx;
- }
- /**
- * wmi_register_event_handler_with_ctx() - register event handler with
- * exec ctx and buffer type
- * @wmi_handle: handle to wmi
- * @event_id: wmi event id
- * @handler_func: wmi event handler function
- * @rx_ctx: rx execution context for wmi rx events
- * @rx_buf_type: rx execution context for wmi rx events
- *
- * Return: QDF_STATUS_SUCCESS on successful register event else failure.
- */
- static QDF_STATUS
- wmi_register_event_handler_with_ctx(wmi_unified_t wmi_handle,
- uint32_t event_id,
- wmi_unified_event_handler handler_func,
- enum wmi_rx_exec_ctx rx_ctx,
- enum wmi_rx_buff_type rx_buf_type)
- {
- uint32_t idx = 0;
- uint32_t evt_id;
- struct wmi_soc *soc;
- if (!wmi_handle) {
- wmi_err("WMI handle is NULL");
- return QDF_STATUS_E_FAILURE;
- }
- soc = wmi_handle->soc;
- if (event_id >= wmi_events_max ||
- wmi_handle->wmi_events[event_id] == WMI_EVENT_ID_INVALID) {
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_INFO,
- "%s: Event id %d is unavailable",
- __func__, event_id);
- return QDF_STATUS_E_FAILURE;
- }
- evt_id = wmi_handle->wmi_events[event_id];
- if (wmi_unified_get_event_handler_ix(wmi_handle, evt_id) != -1) {
- wmi_info("event handler already registered 0x%x", evt_id);
- return QDF_STATUS_E_FAILURE;
- }
- if (soc->max_event_idx == WMI_UNIFIED_MAX_EVENT) {
- wmi_err("no more event handlers 0x%x",
- evt_id);
- return QDF_STATUS_E_FAILURE;
- }
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
- "Registered event handler for event 0x%8x", evt_id);
- idx = soc->max_event_idx;
- wmi_handle->event_handler[idx] = handler_func;
- wmi_handle->event_id[idx] = evt_id;
- qdf_spin_lock_bh(&soc->ctx_lock);
- wmi_handle->ctx[idx].exec_ctx = rx_ctx;
- wmi_handle->ctx[idx].buff_type = rx_buf_type;
- qdf_spin_unlock_bh(&soc->ctx_lock);
- soc->max_event_idx++;
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS
- wmi_unified_register_event(wmi_unified_t wmi_handle,
- uint32_t event_id,
- wmi_unified_event_handler handler_func)
- {
- return wmi_register_event_handler_with_ctx(wmi_handle, event_id,
- handler_func,
- WMI_RX_UMAC_CTX,
- WMI_RX_PROCESSED_BUFF);
- }
- QDF_STATUS
- wmi_unified_register_event_handler(wmi_unified_t wmi_handle,
- wmi_conv_event_id event_id,
- wmi_unified_event_handler handler_func,
- uint8_t rx_ctx)
- {
- return wmi_register_event_handler_with_ctx(wmi_handle, event_id,
- handler_func, rx_ctx,
- WMI_RX_PROCESSED_BUFF);
- }
- qdf_export_symbol(wmi_unified_register_event_handler);
- QDF_STATUS
- wmi_unified_register_raw_event_handler(wmi_unified_t wmi_handle,
- wmi_conv_event_id event_id,
- wmi_unified_event_handler handler_func,
- enum wmi_rx_exec_ctx rx_ctx)
- {
- return wmi_register_event_handler_with_ctx(wmi_handle, event_id,
- handler_func, rx_ctx,
- WMI_RX_RAW_BUFF);
- }
- qdf_export_symbol(wmi_unified_register_raw_event_handler);
- QDF_STATUS wmi_unified_unregister_event(wmi_unified_t wmi_handle,
- uint32_t event_id)
- {
- uint32_t idx = 0;
- uint32_t evt_id;
- struct wmi_soc *soc;
- if (!wmi_handle) {
- wmi_err("WMI handle is NULL");
- return QDF_STATUS_E_FAILURE;
- }
- soc = wmi_handle->soc;
- if (event_id >= wmi_events_max ||
- wmi_handle->wmi_events[event_id] == WMI_EVENT_ID_INVALID) {
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_INFO,
- "%s: Event id %d is unavailable",
- __func__, event_id);
- return QDF_STATUS_E_FAILURE;
- }
- evt_id = wmi_handle->wmi_events[event_id];
- idx = wmi_unified_get_event_handler_ix(wmi_handle, evt_id);
- if (idx == -1) {
- wmi_warn("event handler is not registered: evt id 0x%x",
- evt_id);
- return QDF_STATUS_E_FAILURE;
- }
- wmi_handle->event_handler[idx] = NULL;
- wmi_handle->event_id[idx] = 0;
- --soc->max_event_idx;
- wmi_handle->event_handler[idx] =
- wmi_handle->event_handler[soc->max_event_idx];
- wmi_handle->event_id[idx] =
- wmi_handle->event_id[soc->max_event_idx];
- qdf_spin_lock_bh(&soc->ctx_lock);
- wmi_handle->ctx[idx].exec_ctx =
- wmi_handle->ctx[soc->max_event_idx].exec_ctx;
- wmi_handle->ctx[idx].buff_type =
- wmi_handle->ctx[soc->max_event_idx].buff_type;
- qdf_spin_unlock_bh(&soc->ctx_lock);
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS wmi_unified_unregister_event_handler(wmi_unified_t wmi_handle,
- wmi_conv_event_id event_id)
- {
- uint32_t idx = 0;
- uint32_t evt_id;
- struct wmi_soc *soc;
- if (!wmi_handle) {
- wmi_err("WMI handle is NULL");
- return QDF_STATUS_E_FAILURE;
- }
- soc = wmi_handle->soc;
- if (event_id >= wmi_events_max ||
- wmi_handle->wmi_events[event_id] == WMI_EVENT_ID_INVALID) {
- wmi_err("Event id %d is unavailable", event_id);
- return QDF_STATUS_E_FAILURE;
- }
- evt_id = wmi_handle->wmi_events[event_id];
- idx = wmi_unified_get_event_handler_ix(wmi_handle, evt_id);
- if (idx == -1) {
- wmi_err("event handler is not registered: evt id 0x%x",
- evt_id);
- return QDF_STATUS_E_FAILURE;
- }
- wmi_handle->event_handler[idx] = NULL;
- wmi_handle->event_id[idx] = 0;
- --soc->max_event_idx;
- wmi_handle->event_handler[idx] =
- wmi_handle->event_handler[soc->max_event_idx];
- wmi_handle->event_id[idx] =
- wmi_handle->event_id[soc->max_event_idx];
- qdf_spin_lock_bh(&soc->ctx_lock);
- wmi_handle->ctx[idx].exec_ctx =
- wmi_handle->ctx[soc->max_event_idx].exec_ctx;
- wmi_handle->ctx[idx].buff_type =
- wmi_handle->ctx[soc->max_event_idx].buff_type;
- qdf_spin_unlock_bh(&soc->ctx_lock);
- return QDF_STATUS_SUCCESS;
- }
- qdf_export_symbol(wmi_unified_unregister_event_handler);
- static void
- wmi_process_rx_diag_event_worker_thread_ctx(struct wmi_unified *wmi_handle,
- void *evt_buf)
- {
- uint32_t num_diag_events_pending;
- qdf_spin_lock_bh(&wmi_handle->diag_eventq_lock);
- if (RX_DIAG_WQ_MAX_SIZE > 0) {
- num_diag_events_pending = qdf_nbuf_queue_len(
- &wmi_handle->diag_event_queue);
- if (num_diag_events_pending >= RX_DIAG_WQ_MAX_SIZE) {
- qdf_spin_unlock_bh(&wmi_handle->diag_eventq_lock);
- wmi_handle->wmi_rx_diag_events_dropped++;
- wmi_debug_rl("Rx diag events dropped count: %d",
- wmi_handle->wmi_rx_diag_events_dropped);
- qdf_nbuf_free(evt_buf);
- return;
- }
- }
- qdf_nbuf_queue_add(&wmi_handle->diag_event_queue, evt_buf);
- qdf_spin_unlock_bh(&wmi_handle->diag_eventq_lock);
- qdf_queue_work(0, wmi_handle->wmi_rx_diag_work_queue,
- &wmi_handle->rx_diag_event_work);
- }
- void wmi_process_fw_event_worker_thread_ctx(struct wmi_unified *wmi_handle,
- void *evt_buf)
- {
- qdf_spin_lock_bh(&wmi_handle->eventq_lock);
- qdf_nbuf_queue_add(&wmi_handle->event_queue, evt_buf);
- qdf_spin_unlock_bh(&wmi_handle->eventq_lock);
- qdf_queue_work(0, wmi_handle->wmi_rx_work_queue,
- &wmi_handle->rx_event_work);
- return;
- }
- qdf_export_symbol(wmi_process_fw_event_worker_thread_ctx);
- uint32_t wmi_critical_events_in_flight(struct wmi_unified *wmi)
- {
- return qdf_atomic_read(&wmi->critical_events_in_flight);
- }
- static bool
- wmi_is_event_critical(struct wmi_unified *wmi_handle, uint32_t event_id)
- {
- if (wmi_handle->wmi_events[wmi_roam_synch_event_id] == event_id)
- return true;
- return false;
- }
- static QDF_STATUS wmi_discard_fw_event(struct scheduler_msg *msg)
- {
- struct wmi_process_fw_event_params *event_param;
- if (!msg->bodyptr)
- return QDF_STATUS_E_INVAL;
- event_param = (struct wmi_process_fw_event_params *)msg->bodyptr;
- qdf_nbuf_free(event_param->evt_buf);
- qdf_mem_free(msg->bodyptr);
- msg->bodyptr = NULL;
- msg->bodyval = 0;
- msg->type = 0;
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS wmi_process_fw_event_handler(struct scheduler_msg *msg)
- {
- struct wmi_process_fw_event_params *params =
- (struct wmi_process_fw_event_params *)msg->bodyptr;
- struct wmi_unified *wmi_handle;
- uint32_t event_id;
- wmi_handle = (struct wmi_unified *)params->wmi_handle;
- event_id = WMI_GET_FIELD(qdf_nbuf_data(params->evt_buf),
- WMI_CMD_HDR, COMMANDID);
- wmi_process_fw_event(wmi_handle, params->evt_buf);
- if (wmi_is_event_critical(wmi_handle, event_id))
- qdf_atomic_dec(&wmi_handle->critical_events_in_flight);
- qdf_mem_free(msg->bodyptr);
- return QDF_STATUS_SUCCESS;
- }
- /**
- * wmi_process_fw_event_sched_thread_ctx() - common event handler to serialize
- * event processing through scheduler thread
- * @ctx: wmi context
- * @ev: event buffer
- * @rx_ctx: rx execution context
- *
- * Return: 0 on success, errno on failure
- */
- static QDF_STATUS
- wmi_process_fw_event_sched_thread_ctx(struct wmi_unified *wmi,
- void *ev)
- {
- struct wmi_process_fw_event_params *params_buf;
- struct scheduler_msg msg = { 0 };
- uint32_t event_id;
- params_buf = qdf_mem_malloc(sizeof(struct wmi_process_fw_event_params));
- if (!params_buf) {
- wmi_err("malloc failed");
- qdf_nbuf_free(ev);
- return QDF_STATUS_E_NOMEM;
- }
- params_buf->wmi_handle = wmi;
- params_buf->evt_buf = ev;
- event_id = WMI_GET_FIELD(qdf_nbuf_data(params_buf->evt_buf),
- WMI_CMD_HDR, COMMANDID);
- if (wmi_is_event_critical(wmi, event_id))
- qdf_atomic_inc(&wmi->critical_events_in_flight);
- msg.bodyptr = params_buf;
- msg.bodyval = 0;
- msg.callback = wmi_process_fw_event_handler;
- msg.flush_callback = wmi_discard_fw_event;
- if (QDF_STATUS_SUCCESS !=
- scheduler_post_message(QDF_MODULE_ID_TARGET_IF,
- QDF_MODULE_ID_TARGET_IF,
- QDF_MODULE_ID_TARGET_IF, &msg)) {
- qdf_nbuf_free(ev);
- qdf_mem_free(params_buf);
- return QDF_STATUS_E_FAULT;
- }
- return QDF_STATUS_SUCCESS;
- }
- /**
- * wmi_get_pdev_ep: Get wmi handle based on endpoint
- * @soc: handle to wmi soc
- * @ep: endpoint id
- *
- * Return: none
- */
- static struct wmi_unified *wmi_get_pdev_ep(struct wmi_soc *soc,
- HTC_ENDPOINT_ID ep)
- {
- uint32_t i;
- for (i = 0; i < WMI_MAX_RADIOS; i++)
- if (soc->wmi_endpoint_id[i] == ep)
- break;
- if (i == WMI_MAX_RADIOS)
- return NULL;
- return soc->wmi_pdev[i];
- }
- /**
- * wmi_mtrace_rx() - Wrappper function for qdf_mtrace api
- * @message_id: 32-Bit Wmi message ID
- * @vdev_id: Vdev ID
- * @data: Actual message contents
- *
- * This function converts the 32-bit WMI message ID in 15-bit message ID
- * format for qdf_mtrace as in qdf_mtrace message there are only 15
- * bits reserved for message ID.
- * out of these 15-bits, 8-bits (From LSB) specifies the WMI_GRP_ID
- * and remaining 7-bits specifies the actual WMI command. With this
- * notation there can be maximum 256 groups and each group can have
- * max 128 commands can be supported.
- *
- * Return: None
- */
- static void wmi_mtrace_rx(uint32_t message_id, uint16_t vdev_id, uint32_t data)
- {
- uint16_t mtrace_message_id;
- mtrace_message_id = QDF_WMI_MTRACE_CMD_ID(message_id) |
- (QDF_WMI_MTRACE_GRP_ID(message_id) <<
- QDF_WMI_MTRACE_CMD_NUM_BITS);
- qdf_mtrace(QDF_MODULE_ID_WMI, QDF_MODULE_ID_WMA,
- mtrace_message_id, vdev_id, data);
- }
- /**
- * wmi_process_control_rx() - process fw events callbacks
- * @wmi_handle: handle to wmi_unified
- * @evt_buf: handle to wmi_buf_t
- *
- * Return: none
- */
- static void wmi_process_control_rx(struct wmi_unified *wmi_handle,
- wmi_buf_t evt_buf)
- {
- struct wmi_soc *soc = wmi_handle->soc;
- uint32_t id;
- uint32_t idx;
- enum wmi_rx_exec_ctx exec_ctx;
- id = WMI_GET_FIELD(qdf_nbuf_data(evt_buf), WMI_CMD_HDR, COMMANDID);
- idx = wmi_unified_get_event_handler_ix(wmi_handle, id);
- if (qdf_unlikely(idx == A_ERROR)) {
- wmi_debug("no handler registered for event id 0x%x", id);
- qdf_nbuf_free(evt_buf);
- return;
- }
- wmi_mtrace_rx(id, 0xFF, idx);
- qdf_spin_lock_bh(&soc->ctx_lock);
- exec_ctx = wmi_handle->ctx[idx].exec_ctx;
- qdf_spin_unlock_bh(&soc->ctx_lock);
- #ifdef WMI_INTERFACE_EVENT_LOGGING
- if (wmi_handle->log_info.wmi_logging_enable) {
- uint8_t *data;
- data = qdf_nbuf_data(evt_buf);
- qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);
- /* Exclude 4 bytes of TLV header */
- if (wmi_handle->ops->is_diag_event(id)) {
- WMI_DIAG_RX_EVENT_RECORD(wmi_handle, id,
- ((uint8_t *) data +
- wmi_handle->soc->buf_offset_event));
- } else if (wmi_handle->ops->is_management_record(id)) {
- WMI_MGMT_RX_EVENT_RECORD(wmi_handle, id,
- ((uint8_t *) data +
- wmi_handle->soc->buf_offset_event));
- } else {
- WMI_RX_EVENT_RECORD(wmi_handle, id, ((uint8_t *) data +
- wmi_handle->soc->buf_offset_event));
- }
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);
- }
- #endif
- if (exec_ctx == WMI_RX_WORK_CTX) {
- wmi_process_fw_event_worker_thread_ctx(wmi_handle, evt_buf);
- } else if (exec_ctx == WMI_RX_TASKLET_CTX) {
- wmi_process_fw_event(wmi_handle, evt_buf);
- } else if (exec_ctx == WMI_RX_SERIALIZER_CTX) {
- wmi_process_fw_event_sched_thread_ctx(wmi_handle, evt_buf);
- } else if (exec_ctx == WMI_RX_DIAG_WORK_CTX) {
- wmi_process_rx_diag_event_worker_thread_ctx(wmi_handle,
- evt_buf);
- } else {
- wmi_err("Invalid event context %d", exec_ctx);
- qdf_nbuf_free(evt_buf);
- }
- }
- /**
- * wmi_control_rx() - process fw events callbacks
- * @ctx: handle to wmi
- * @htc_packet: pointer to htc packet
- *
- * Return: none
- */
- static void wmi_control_rx(void *ctx, HTC_PACKET *htc_packet)
- {
- struct wmi_soc *soc = (struct wmi_soc *)ctx;
- struct wmi_unified *wmi_handle;
- wmi_buf_t evt_buf;
- evt_buf = (wmi_buf_t)htc_packet->pPktContext;
- wmi_handle = wmi_get_pdev_ep(soc, htc_packet->Endpoint);
- if (!wmi_handle) {
- wmi_err("unable to get wmi_handle to Endpoint %d",
- htc_packet->Endpoint);
- qdf_nbuf_free(evt_buf);
- return;
- }
- wmi_process_control_rx(wmi_handle, evt_buf);
- }
- #ifdef WLAN_FEATURE_WMI_DIAG_OVER_CE7
- /**
- * wmi_control_diag_rx() - process diag fw events callbacks
- * @ctx: handle to wmi
- * @htc_packet: pointer to htc packet
- *
- * Return: none
- */
- static void wmi_control_diag_rx(void *ctx, HTC_PACKET *htc_packet)
- {
- struct wmi_soc *soc = (struct wmi_soc *)ctx;
- struct wmi_unified *wmi_handle;
- wmi_buf_t evt_buf;
- evt_buf = (wmi_buf_t)htc_packet->pPktContext;
- wmi_handle = soc->wmi_pdev[0];
- if (!wmi_handle) {
- wmi_err("unable to get wmi_handle for diag event end point id:%d", htc_packet->Endpoint);
- qdf_nbuf_free(evt_buf);
- return;
- }
- wmi_process_control_rx(wmi_handle, evt_buf);
- }
- #endif
- #ifdef WLAN_FEATURE_WMI_SEND_RECV_QMI
- QDF_STATUS wmi_unified_cmd_send_over_qmi(struct wmi_unified *wmi_handle,
- wmi_buf_t buf, uint32_t buflen,
- uint32_t cmd_id)
- {
- QDF_STATUS status;
- int32_t ret;
- if (!qdf_nbuf_push_head(buf, sizeof(WMI_CMD_HDR))) {
- wmi_err("Failed to send cmd %x, no memory", cmd_id);
- return QDF_STATUS_E_NOMEM;
- }
- qdf_mem_zero(qdf_nbuf_data(buf), sizeof(WMI_CMD_HDR));
- WMI_SET_FIELD(qdf_nbuf_data(buf), WMI_CMD_HDR, COMMANDID, cmd_id);
- wmi_debug("Sending WMI_CMD_ID: 0x%x over qmi", cmd_id);
- status = qdf_wmi_send_recv_qmi(qdf_nbuf_data(buf),
- buflen + sizeof(WMI_CMD_HDR),
- wmi_handle,
- wmi_process_qmi_fw_event);
- if (QDF_IS_STATUS_ERROR(status)) {
- qdf_nbuf_pull_head(buf, sizeof(WMI_CMD_HDR));
- wmi_warn("WMI send on QMI failed. Retrying WMI on HTC");
- } else {
- ret = qdf_atomic_inc_return(&wmi_handle->num_stats_over_qmi);
- wmi_debug("num stats over qmi: %d", ret);
- wmi_buf_free(buf);
- }
- return status;
- }
- static int __wmi_process_qmi_fw_event(void *wmi_cb_ctx, void *buf, int len)
- {
- struct wmi_unified *wmi_handle = wmi_cb_ctx;
- wmi_buf_t evt_buf;
- uint32_t evt_id;
- if (!wmi_handle || !buf)
- return -EINVAL;
- evt_buf = wmi_buf_alloc(wmi_handle, len);
- if (!evt_buf)
- return -ENOMEM;
- qdf_mem_copy(qdf_nbuf_data(evt_buf), buf, len);
- evt_id = WMI_GET_FIELD(qdf_nbuf_data(evt_buf), WMI_CMD_HDR, COMMANDID);
- wmi_debug("Received WMI_EVT_ID: %d over qmi", evt_id);
- wmi_process_control_rx(wmi_handle, evt_buf);
- return 0;
- }
- int wmi_process_qmi_fw_event(void *wmi_cb_ctx, void *buf, int len)
- {
- struct qdf_op_sync *op_sync;
- int ret;
- if (qdf_op_protect(&op_sync))
- return -EINVAL;
- ret = __wmi_process_qmi_fw_event(wmi_cb_ctx, buf, len);
- qdf_op_unprotect(op_sync);
- return ret;
- }
- #endif
- /**
- * wmi_process_fw_event() - process any fw event
- * @wmi_handle: wmi handle
- * @evt_buf: fw event buffer
- *
- * This function process fw event in caller context
- *
- * Return: none
- */
- void wmi_process_fw_event(struct wmi_unified *wmi_handle, wmi_buf_t evt_buf)
- {
- __wmi_control_rx(wmi_handle, evt_buf);
- }
- /**
- * __wmi_control_rx() - process serialize wmi event callback
- * @wmi_handle: wmi handle
- * @evt_buf: fw event buffer
- *
- * Return: none
- */
- void __wmi_control_rx(struct wmi_unified *wmi_handle, wmi_buf_t evt_buf)
- {
- uint32_t id;
- uint8_t *data;
- uint32_t len;
- void *wmi_cmd_struct_ptr = NULL;
- #ifndef WMI_NON_TLV_SUPPORT
- int tlv_ok_status = 0;
- #endif
- uint32_t idx = 0;
- struct wmi_raw_event_buffer ev_buf;
- enum wmi_rx_buff_type ev_buff_type;
- id = WMI_GET_FIELD(qdf_nbuf_data(evt_buf), WMI_CMD_HDR, COMMANDID);
- wmi_ext_dbg_msg_event_record(wmi_handle, qdf_nbuf_data(evt_buf),
- qdf_nbuf_len(evt_buf));
- if (qdf_nbuf_pull_head(evt_buf, sizeof(WMI_CMD_HDR)) == NULL)
- goto end;
- data = qdf_nbuf_data(evt_buf);
- len = qdf_nbuf_len(evt_buf);
- #ifndef WMI_NON_TLV_SUPPORT
- if (wmi_handle->target_type == WMI_TLV_TARGET) {
- /* Validate and pad(if necessary) the TLVs */
- tlv_ok_status =
- wmi_handle->ops->wmi_check_and_pad_event(wmi_handle->scn_handle,
- data, len, id,
- &wmi_cmd_struct_ptr);
- if (tlv_ok_status != 0) {
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_ERROR,
- "%s: Error: id=0x%x, wmitlv check status=%d",
- __func__, id, tlv_ok_status);
- goto end;
- }
- }
- #endif
- idx = wmi_unified_get_event_handler_ix(wmi_handle, id);
- if (idx == A_ERROR) {
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_ERROR,
- "%s : event handler is not registered: event id 0x%x",
- __func__, id);
- goto end;
- }
- #ifdef WMI_INTERFACE_EVENT_LOGGING
- if (wmi_handle->log_info.wmi_logging_enable) {
- qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);
- /* Exclude 4 bytes of TLV header */
- if (wmi_handle->ops->is_diag_event(id)) {
- /*
- * skip diag event logging in WMI event buffer
- * as its already logged in WMI RX event buffer
- */
- } else if (wmi_handle->ops->is_management_record(id)) {
- /*
- * skip wmi mgmt event logging in WMI event buffer
- * as its already logged in WMI RX event buffer
- */
- } else {
- uint8_t *tmpbuf = (uint8_t *)data +
- wmi_handle->soc->buf_offset_event;
- WMI_EVENT_RECORD(wmi_handle, id, tmpbuf);
- wmi_specific_evt_record(wmi_handle, id, tmpbuf);
- }
- qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);
- }
- #endif
- /* Call the WMI registered event handler */
- if (wmi_handle->target_type == WMI_TLV_TARGET) {
- ev_buff_type = wmi_handle->ctx[idx].buff_type;
- if (ev_buff_type == WMI_RX_PROCESSED_BUFF) {
- wmi_handle->event_handler[idx] (wmi_handle->scn_handle,
- wmi_cmd_struct_ptr, len);
- } else if (ev_buff_type == WMI_RX_RAW_BUFF) {
- ev_buf.evt_raw_buf = data;
- ev_buf.evt_processed_buf = wmi_cmd_struct_ptr;
- wmi_handle->event_handler[idx] (wmi_handle->scn_handle,
- (void *)&ev_buf, len);
- }
- }
- else
- wmi_handle->event_handler[idx] (wmi_handle->scn_handle,
- data, len);
- end:
- /* Free event buffer and allocated event tlv */
- #ifndef WMI_NON_TLV_SUPPORT
- if (wmi_handle->target_type == WMI_TLV_TARGET)
- wmi_handle->ops->wmi_free_allocated_event(id, &wmi_cmd_struct_ptr);
- #endif
- qdf_nbuf_free(evt_buf);
- }
- #define WMI_WQ_WD_TIMEOUT (30 * 1000) /* 30s */
- static inline void wmi_workqueue_watchdog_warn(uint32_t msg_type_id)
- {
- QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_ERROR,
- "%s: WLAN_BUG_RCA: Message type %x has exceeded its alloted time of %ds",
- __func__, msg_type_id, WMI_WQ_WD_TIMEOUT / 1000);
- }
- #ifdef CONFIG_SLUB_DEBUG_ON
- static void wmi_workqueue_watchdog_bite(void *arg)
- {
- struct wmi_wq_dbg_info *info = arg;
- wmi_workqueue_watchdog_warn(info->wd_msg_type_id);
- qdf_print_thread_trace(info->task);
- QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_ERROR,
- "%s: Going down for WMI WQ Watchdog Bite!", __func__);
- QDF_BUG(0);
- }
- #else
- static inline void wmi_workqueue_watchdog_bite(void *arg)
- {
- struct wmi_wq_dbg_info *info = arg;
- wmi_workqueue_watchdog_warn(info->wd_msg_type_id);
- qdf_print_thread_trace(info->task);
- }
- #endif
- /**
- * wmi_rx_event_work() - process rx event in rx work queue context
- * @arg: opaque pointer to wmi handle
- *
- * This function process any fw event to serialize it through rx worker thread.
- *
- * Return: none
- */
- static void wmi_rx_event_work(void *arg)
- {
- wmi_buf_t buf;
- struct wmi_unified *wmi = arg;
- qdf_timer_t wd_timer;
- struct wmi_wq_dbg_info info;
- /* initialize WMI workqueue watchdog timer */
- qdf_timer_init(NULL, &wd_timer, &wmi_workqueue_watchdog_bite,
- &info, QDF_TIMER_TYPE_SW);
- qdf_spin_lock_bh(&wmi->eventq_lock);
- buf = qdf_nbuf_queue_remove(&wmi->event_queue);
- qdf_spin_unlock_bh(&wmi->eventq_lock);
- while (buf) {
- qdf_timer_start(&wd_timer, WMI_WQ_WD_TIMEOUT);
- info.wd_msg_type_id =
- WMI_GET_FIELD(qdf_nbuf_data(buf), WMI_CMD_HDR, COMMANDID);
- info.wmi_wq = wmi->wmi_rx_work_queue;
- info.task = qdf_get_current_task();
- __wmi_control_rx(wmi, buf);
- qdf_timer_stop(&wd_timer);
- qdf_spin_lock_bh(&wmi->eventq_lock);
- buf = qdf_nbuf_queue_remove(&wmi->event_queue);
- qdf_spin_unlock_bh(&wmi->eventq_lock);
- }
- qdf_timer_free(&wd_timer);
- }
- /**
- * wmi_rx_diag_event_work() - process rx diag event in work queue context
- * @arg: opaque pointer to wmi handle
- *
- * This function process fw diag event to serialize it through rx worker thread.
- *
- * Return: none
- */
- static void wmi_rx_diag_event_work(void *arg)
- {
- wmi_buf_t buf;
- struct wmi_unified *wmi = arg;
- qdf_timer_t wd_timer;
- struct wmi_wq_dbg_info info;
- uint32_t diag_event_process_count = 0;
- if (!wmi) {
- wmi_err("Invalid WMI handle");
- return;
- }
- /* initialize WMI workqueue watchdog timer */
- qdf_timer_init(NULL, &wd_timer, &wmi_workqueue_watchdog_bite,
- &info, QDF_TIMER_TYPE_SW);
- qdf_spin_lock_bh(&wmi->diag_eventq_lock);
- buf = qdf_nbuf_queue_remove(&wmi->diag_event_queue);
- qdf_spin_unlock_bh(&wmi->diag_eventq_lock);
- while (buf) {
- qdf_timer_start(&wd_timer, WMI_WQ_WD_TIMEOUT);
- info.wd_msg_type_id =
- WMI_GET_FIELD(qdf_nbuf_data(buf), WMI_CMD_HDR, COMMANDID);
- info.wmi_wq = NULL;
- info.task = qdf_get_current_task();
- __wmi_control_rx(wmi, buf);
- qdf_timer_stop(&wd_timer);
- if (diag_event_process_count++ >
- RX_DIAG_EVENT_WORK_PROCESS_MAX_COUNT) {
- qdf_queue_work(0, wmi->wmi_rx_diag_work_queue,
- &wmi->rx_diag_event_work);
- break;
- }
- qdf_spin_lock_bh(&wmi->diag_eventq_lock);
- buf = qdf_nbuf_queue_remove(&wmi->diag_event_queue);
- qdf_spin_unlock_bh(&wmi->diag_eventq_lock);
- }
- qdf_timer_free(&wd_timer);
- }
- #ifdef FEATURE_RUNTIME_PM
- /**
- * wmi_runtime_pm_init() - initialize runtime pm wmi variables
- * @wmi_handle: wmi context
- */
- static void wmi_runtime_pm_init(struct wmi_unified *wmi_handle)
- {
- qdf_atomic_init(&wmi_handle->runtime_pm_inprogress);
- }
- /**
- * wmi_set_runtime_pm_inprogress() - set runtime pm progress flag
- * @wmi_handle: wmi context
- * @val: runtime pm progress flag
- */
- void wmi_set_runtime_pm_inprogress(wmi_unified_t wmi_handle, A_BOOL val)
- {
- qdf_atomic_set(&wmi_handle->runtime_pm_inprogress, val);
- }
- /**
- * wmi_get_runtime_pm_inprogress() - get runtime pm progress flag
- * @wmi_handle: wmi context
- */
- inline bool wmi_get_runtime_pm_inprogress(wmi_unified_t wmi_handle)
- {
- return qdf_atomic_read(&wmi_handle->runtime_pm_inprogress);
- }
- #else
- static void wmi_runtime_pm_init(struct wmi_unified *wmi_handle)
- {
- }
- #endif
- /**
- * wmi_unified_get_soc_handle: Get WMI SoC handle
- * @param wmi_handle: WMI context got from wmi_attach
- *
- * return: Pointer to Soc handle
- */
- void *wmi_unified_get_soc_handle(struct wmi_unified *wmi_handle)
- {
- return wmi_handle->soc;
- }
- /**
- * wmi_interface_logging_init: Interface looging init
- * @param wmi_handle: Pointer to wmi handle object
- *
- * return: None
- */
- #ifdef WMI_INTERFACE_EVENT_LOGGING
- static inline void wmi_interface_logging_init(struct wmi_unified *wmi_handle,
- uint32_t pdev_idx)
- {
- if (QDF_STATUS_SUCCESS == wmi_log_init(wmi_handle)) {
- qdf_spinlock_create(&wmi_handle->log_info.wmi_record_lock);
- wmi_debugfs_init(wmi_handle, pdev_idx);
- }
- }
- #else
- static inline void wmi_interface_logging_init(struct wmi_unified *wmi_handle,
- uint32_t pdev_idx)
- {
- }
- #endif
- static QDF_STATUS wmi_initialize_worker_context(struct wmi_unified *wmi_handle)
- {
- wmi_handle->wmi_rx_work_queue =
- qdf_alloc_unbound_workqueue("wmi_rx_event_work_queue");
- if (!wmi_handle->wmi_rx_work_queue) {
- wmi_err("failed to create wmi_rx_event_work_queue");
- return QDF_STATUS_E_RESOURCES;
- }
- qdf_spinlock_create(&wmi_handle->eventq_lock);
- qdf_nbuf_queue_init(&wmi_handle->event_queue);
- qdf_create_work(0, &wmi_handle->rx_event_work,
- wmi_rx_event_work, wmi_handle);
- wmi_handle->wmi_rx_diag_work_queue =
- qdf_alloc_unbound_workqueue("wmi_rx_diag_event_work_queue");
- if (!wmi_handle->wmi_rx_diag_work_queue) {
- wmi_err("failed to create wmi_rx_diag_event_work_queue");
- return QDF_STATUS_E_RESOURCES;
- }
- qdf_spinlock_create(&wmi_handle->diag_eventq_lock);
- qdf_nbuf_queue_init(&wmi_handle->diag_event_queue);
- qdf_create_work(0, &wmi_handle->rx_diag_event_work,
- wmi_rx_diag_event_work, wmi_handle);
- wmi_handle->wmi_rx_diag_events_dropped = 0;
- return QDF_STATUS_SUCCESS;
- }
- /**
- * wmi_unified_get_pdev_handle: Get WMI SoC handle
- * @param wmi_soc: Pointer to wmi soc object
- * @param pdev_idx: pdev index
- *
- * return: Pointer to wmi handle or NULL on failure
- */
- void *wmi_unified_get_pdev_handle(struct wmi_soc *soc, uint32_t pdev_idx)
- {
- struct wmi_unified *wmi_handle;
- QDF_STATUS status;
- if (pdev_idx >= WMI_MAX_RADIOS)
- return NULL;
- if (!soc->wmi_pdev[pdev_idx]) {
- wmi_handle =
- (struct wmi_unified *) qdf_mem_malloc(
- sizeof(struct wmi_unified));
- if (!wmi_handle)
- return NULL;
- status = wmi_initialize_worker_context(wmi_handle);
- if (QDF_IS_STATUS_ERROR(status))
- goto error;
- wmi_handle->scn_handle = soc->scn_handle;
- wmi_handle->event_id = soc->event_id;
- wmi_handle->event_handler = soc->event_handler;
- wmi_handle->ctx = soc->ctx;
- wmi_handle->ops = soc->ops;
- wmi_handle->wmi_events = soc->wmi_events;
- wmi_handle->services = soc->services;
- wmi_handle->soc = soc;
- wmi_handle->cmd_pdev_id_map = soc->cmd_pdev_id_map;
- wmi_handle->evt_pdev_id_map = soc->evt_pdev_id_map;
- wmi_handle->cmd_phy_id_map = soc->cmd_phy_id_map;
- wmi_handle->evt_phy_id_map = soc->evt_phy_id_map;
- wmi_interface_logging_init(wmi_handle, pdev_idx);
- qdf_atomic_init(&wmi_handle->pending_cmds);
- qdf_atomic_init(&wmi_handle->is_target_suspended);
- wmi_handle->target_type = soc->target_type;
- wmi_handle->wmi_max_cmds = soc->wmi_max_cmds;
- wmi_interface_sequence_init(wmi_handle);
- if (wmi_ext_dbgfs_init(wmi_handle, pdev_idx) !=
- QDF_STATUS_SUCCESS)
- wmi_err("Failed to initialize wmi extended debugfs");
- soc->wmi_pdev[pdev_idx] = wmi_handle;
- } else
- wmi_handle = soc->wmi_pdev[pdev_idx];
- wmi_handle->wmi_stopinprogress = 0;
- wmi_handle->wmi_endpoint_id = soc->wmi_endpoint_id[pdev_idx];
- wmi_handle->htc_handle = soc->htc_handle;
- wmi_handle->max_msg_len = soc->max_msg_len[pdev_idx];
- wmi_handle->tag_crash_inject = false;
- wmi_interface_sequence_reset(wmi_handle);
- return wmi_handle;
- error:
- qdf_mem_free(wmi_handle);
- return NULL;
- }
- qdf_export_symbol(wmi_unified_get_pdev_handle);
- static void (*wmi_attach_register[WMI_MAX_TARGET_TYPE])(wmi_unified_t);
- void wmi_unified_register_module(enum wmi_target_type target_type,
- void (*wmi_attach)(wmi_unified_t wmi_handle))
- {
- if (target_type < WMI_MAX_TARGET_TYPE)
- wmi_attach_register[target_type] = wmi_attach;
- return;
- }
- qdf_export_symbol(wmi_unified_register_module);
- /**
- * wmi_wbuff_register() - register wmi with wbuff
- * @wmi_handle: handle to wmi
- *
- * @Return: void
- */
- static void wmi_wbuff_register(struct wmi_unified *wmi_handle)
- {
- struct wbuff_alloc_request wbuff_alloc[4];
- wbuff_alloc[0].slot = WBUFF_POOL_0;
- wbuff_alloc[0].size = WMI_WBUFF_POOL_0_SIZE;
- wbuff_alloc[1].slot = WBUFF_POOL_1;
- wbuff_alloc[1].size = WMI_WBUFF_POOL_1_SIZE;
- wbuff_alloc[2].slot = WBUFF_POOL_2;
- wbuff_alloc[2].size = WMI_WBUFF_POOL_2_SIZE;
- wbuff_alloc[3].slot = WBUFF_POOL_3;
- wbuff_alloc[3].size = WMI_WBUFF_POOL_3_SIZE;
- wmi_handle->wbuff_handle = wbuff_module_register(wbuff_alloc, 4,
- WMI_MIN_HEAD_ROOM, 4);
- }
- /**
- * wmi_wbuff_deregister() - deregister wmi with wbuff
- * @wmi_handle: handle to wmi
- *
- * @Return: void
- */
- static inline void wmi_wbuff_deregister(struct wmi_unified *wmi_handle)
- {
- wbuff_module_deregister(wmi_handle->wbuff_handle);
- wmi_handle->wbuff_handle = NULL;
- }
- /**
- * wmi_unified_attach() - attach for unified WMI
- * @scn_handle: handle to SCN
- * @osdev: OS device context
- * @target_type: TLV or not-TLV based target
- * @use_cookie: cookie based allocation enabled/disabled
- * @ops: umac rx callbacks
- * @psoc: objmgr psoc
- *
- * @Return: wmi handle.
- */
- void *wmi_unified_attach(void *scn_handle,
- struct wmi_unified_attach_params *param)
- {
- struct wmi_unified *wmi_handle;
- struct wmi_soc *soc;
- QDF_STATUS status;
- soc = (struct wmi_soc *) qdf_mem_malloc(sizeof(struct wmi_soc));
- if (!soc)
- return NULL;
- wmi_handle =
- (struct wmi_unified *) qdf_mem_malloc(
- sizeof(struct wmi_unified));
- if (!wmi_handle) {
- qdf_mem_free(soc);
- return NULL;
- }
- status = wmi_initialize_worker_context(wmi_handle);
- if (QDF_IS_STATUS_ERROR(status))
- goto error;
- wmi_handle->soc = soc;
- wmi_handle->soc->soc_idx = param->soc_id;
- wmi_handle->soc->is_async_ep = param->is_async_ep;
- wmi_handle->event_id = soc->event_id;
- wmi_handle->event_handler = soc->event_handler;
- wmi_handle->ctx = soc->ctx;
- wmi_handle->wmi_events = soc->wmi_events;
- wmi_handle->services = soc->services;
- wmi_handle->scn_handle = scn_handle;
- wmi_handle->cmd_pdev_id_map = soc->cmd_pdev_id_map;
- wmi_handle->evt_pdev_id_map = soc->evt_pdev_id_map;
- wmi_handle->cmd_phy_id_map = soc->cmd_phy_id_map;
- wmi_handle->evt_phy_id_map = soc->evt_phy_id_map;
- soc->scn_handle = scn_handle;
- wmi_handle->target_type = param->target_type;
- soc->target_type = param->target_type;
- if (param->target_type >= WMI_MAX_TARGET_TYPE)
- goto error;
- if (wmi_attach_register[param->target_type]) {
- wmi_attach_register[param->target_type](wmi_handle);
- } else {
- wmi_err("wmi attach is not registered");
- goto error;
- }
- qdf_atomic_init(&wmi_handle->pending_cmds);
- qdf_atomic_init(&wmi_handle->is_target_suspended);
- qdf_atomic_init(&wmi_handle->is_target_suspend_acked);
- qdf_atomic_init(&wmi_handle->num_stats_over_qmi);
- wmi_runtime_pm_init(wmi_handle);
- wmi_interface_logging_init(wmi_handle, WMI_HOST_PDEV_ID_0);
- wmi_interface_sequence_init(wmi_handle);
- /* Assign target cookie capablity */
- wmi_handle->use_cookie = param->use_cookie;
- wmi_handle->osdev = param->osdev;
- wmi_handle->wmi_stopinprogress = 0;
- wmi_handle->wmi_max_cmds = param->max_commands;
- soc->wmi_max_cmds = param->max_commands;
- /* Increase the ref count once refcount infra is present */
- soc->wmi_psoc = param->psoc;
- qdf_spinlock_create(&soc->ctx_lock);
- soc->ops = wmi_handle->ops;
- soc->wmi_pdev[0] = wmi_handle;
- if (wmi_ext_dbgfs_init(wmi_handle, 0) != QDF_STATUS_SUCCESS)
- wmi_err("Failed to initialize wmi extended debugfs");
- wmi_wbuff_register(wmi_handle);
- wmi_hang_event_notifier_register(wmi_handle);
- wmi_minidump_attach(wmi_handle);
- return wmi_handle;
- error:
- qdf_mem_free(soc);
- qdf_mem_free(wmi_handle);
- return NULL;
- }
- /**
- * wmi_unified_detach() - detach for unified WMI
- *
- * @wmi_handle : handle to wmi.
- *
- * @Return: none.
- */
- void wmi_unified_detach(struct wmi_unified *wmi_handle)
- {
- wmi_buf_t buf;
- struct wmi_soc *soc;
- uint8_t i;
- wmi_minidump_detach(wmi_handle);
- wmi_hang_event_notifier_unregister();
- wmi_wbuff_deregister(wmi_handle);
- soc = wmi_handle->soc;
- for (i = 0; i < WMI_MAX_RADIOS; i++) {
- if (soc->wmi_pdev[i]) {
- qdf_flush_workqueue(0,
- soc->wmi_pdev[i]->wmi_rx_work_queue);
- qdf_destroy_workqueue(0,
- soc->wmi_pdev[i]->wmi_rx_work_queue);
- wmi_debugfs_remove(soc->wmi_pdev[i]);
- buf = qdf_nbuf_queue_remove(
- &soc->wmi_pdev[i]->event_queue);
- while (buf) {
- qdf_nbuf_free(buf);
- buf = qdf_nbuf_queue_remove(
- &soc->wmi_pdev[i]->event_queue);
- }
- qdf_flush_work(&soc->wmi_pdev[i]->rx_diag_event_work);
- buf = qdf_nbuf_queue_remove(
- &soc->wmi_pdev[i]->diag_event_queue);
- while (buf) {
- qdf_nbuf_free(buf);
- buf = qdf_nbuf_queue_remove(
- &soc->wmi_pdev[i]->diag_event_queue);
- }
- wmi_log_buffer_free(soc->wmi_pdev[i]);
- /* Free events logs list */
- if (soc->wmi_pdev[i]->events_logs_list)
- qdf_mem_free(
- soc->wmi_pdev[i]->events_logs_list);
- qdf_spinlock_destroy(&soc->wmi_pdev[i]->eventq_lock);
- qdf_spinlock_destroy(
- &soc->wmi_pdev[i]->diag_eventq_lock);
- wmi_interface_sequence_deinit(soc->wmi_pdev[i]);
- wmi_ext_dbgfs_deinit(soc->wmi_pdev[i]);
- qdf_mem_free(soc->wmi_pdev[i]);
- }
- }
- qdf_spinlock_destroy(&soc->ctx_lock);
- if (soc->wmi_service_bitmap) {
- qdf_mem_free(soc->wmi_service_bitmap);
- soc->wmi_service_bitmap = NULL;
- }
- if (soc->wmi_ext_service_bitmap) {
- qdf_mem_free(soc->wmi_ext_service_bitmap);
- soc->wmi_ext_service_bitmap = NULL;
- }
- if (soc->wmi_ext2_service_bitmap) {
- qdf_mem_free(soc->wmi_ext2_service_bitmap);
- soc->wmi_ext2_service_bitmap = NULL;
- }
- /* Decrease the ref count once refcount infra is present */
- soc->wmi_psoc = NULL;
- qdf_mem_free(soc);
- }
- /**
- * wmi_unified_remove_work() - detach for WMI work
- * @wmi_handle: handle to WMI
- *
- * A function that does not fully detach WMI, but just remove work
- * queue items associated with it. This is used to make sure that
- * before any other processing code that may destroy related contexts
- * (HTC, etc), work queue processing on WMI has already been stopped.
- *
- * Return: None
- */
- void
- wmi_unified_remove_work(struct wmi_unified *wmi_handle)
- {
- wmi_buf_t buf;
- qdf_flush_workqueue(0, wmi_handle->wmi_rx_work_queue);
- qdf_spin_lock_bh(&wmi_handle->eventq_lock);
- buf = qdf_nbuf_queue_remove(&wmi_handle->event_queue);
- while (buf) {
- qdf_nbuf_free(buf);
- buf = qdf_nbuf_queue_remove(&wmi_handle->event_queue);
- }
- qdf_spin_unlock_bh(&wmi_handle->eventq_lock);
- /* Remove diag events work */
- qdf_flush_workqueue(0, wmi_handle->wmi_rx_diag_work_queue);
- qdf_spin_lock_bh(&wmi_handle->diag_eventq_lock);
- buf = qdf_nbuf_queue_remove(&wmi_handle->diag_event_queue);
- while (buf) {
- qdf_nbuf_free(buf);
- buf = qdf_nbuf_queue_remove(&wmi_handle->diag_event_queue);
- }
- qdf_spin_unlock_bh(&wmi_handle->diag_eventq_lock);
- }
- /**
- * wmi_htc_tx_complete() - Process htc tx completion
- *
- * @ctx: handle to wmi
- * @htc_packet: pointer to htc packet
- *
- * @Return: none.
- */
- static void wmi_htc_tx_complete(void *ctx, HTC_PACKET *htc_pkt)
- {
- struct wmi_soc *soc = (struct wmi_soc *) ctx;
- wmi_buf_t wmi_cmd_buf = GET_HTC_PACKET_NET_BUF_CONTEXT(htc_pkt);
- u_int8_t *buf_ptr;
- u_int32_t len;
- struct wmi_unified *wmi_handle;
- #ifdef WMI_INTERFACE_EVENT_LOGGING
- struct wmi_debug_log_info *log_info;
- uint32_t cmd_id;
- uint8_t *offset_ptr;
- qdf_dma_addr_t dma_addr;
- uint64_t phy_addr;
- #endif
- ASSERT(wmi_cmd_buf);
- wmi_handle = wmi_get_pdev_ep(soc, htc_pkt->Endpoint);
- if (!wmi_handle) {
- wmi_err("Unable to get wmi handle");
- QDF_ASSERT(0);
- return;
- }
- buf_ptr = (u_int8_t *)wmi_buf_data(wmi_cmd_buf);
- #ifdef WMI_INTERFACE_EVENT_LOGGING
- log_info = &wmi_handle->log_info;
- if (wmi_handle && log_info->wmi_logging_enable) {
- cmd_id = WMI_GET_FIELD(qdf_nbuf_data(wmi_cmd_buf),
- WMI_CMD_HDR, COMMANDID);
- dma_addr = QDF_NBUF_CB_PADDR(wmi_cmd_buf);
- phy_addr = qdf_mem_virt_to_phys(qdf_nbuf_data(wmi_cmd_buf));
- qdf_spin_lock_bh(&log_info->wmi_record_lock);
- /* Record 16 bytes of WMI cmd tx complete data
- * - exclude TLV and WMI headers
- */
- offset_ptr = buf_ptr + wmi_handle->soc->buf_offset_command;
- if (wmi_handle->ops->is_management_record(cmd_id)) {
- WMI_MGMT_COMMAND_TX_CMP_RECORD(wmi_handle, cmd_id,
- offset_ptr);
- } else {
- WMI_COMMAND_TX_CMP_RECORD(wmi_handle, cmd_id,
- offset_ptr, dma_addr,
- phy_addr);
- }
- qdf_spin_unlock_bh(&log_info->wmi_record_lock);
- }
- #endif
- wmi_interface_sequence_check(wmi_handle, wmi_cmd_buf);
- len = qdf_nbuf_len(wmi_cmd_buf);
- qdf_mem_zero(buf_ptr, len);
- wmi_buf_free(wmi_cmd_buf);
- qdf_mem_free(htc_pkt);
- qdf_atomic_dec(&wmi_handle->pending_cmds);
- }
- #ifdef FEATURE_RUNTIME_PM
- /**
- * wmi_htc_log_pkt() - Print information of WMI command from HTC packet
- *
- * @ctx: handle of WMI context
- * @htc_pkt: handle of HTC packet
- *
- * @Return: none
- */
- static void wmi_htc_log_pkt(void *ctx, HTC_PACKET *htc_pkt)
- {
- wmi_buf_t wmi_cmd_buf = GET_HTC_PACKET_NET_BUF_CONTEXT(htc_pkt);
- uint32_t cmd_id;
- ASSERT(wmi_cmd_buf);
- cmd_id = WMI_GET_FIELD(qdf_nbuf_data(wmi_cmd_buf), WMI_CMD_HDR,
- COMMANDID);
- wmi_debug("WMI command from HTC packet: %s, ID: %d",
- wmi_id_to_name(cmd_id), cmd_id);
- }
- #else
- static void wmi_htc_log_pkt(void *ctx, HTC_PACKET *htc_pkt)
- {
- }
- #endif
- /**
- * wmi_connect_pdev_htc_service() - WMI API to get connect to HTC service
- *
- * @wmi_handle: handle to WMI.
- * @pdev_idx: Pdev index
- *
- * @Return: QDF_STATUS
- */
- static QDF_STATUS wmi_connect_pdev_htc_service(struct wmi_soc *soc,
- uint32_t pdev_idx)
- {
- QDF_STATUS status;
- struct htc_service_connect_resp response;
- struct htc_service_connect_req connect;
- OS_MEMZERO(&connect, sizeof(connect));
- OS_MEMZERO(&response, sizeof(response));
- /* meta data is unused for now */
- connect.pMetaData = NULL;
- connect.MetaDataLength = 0;
- /* these fields are the same for all service endpoints */
- connect.EpCallbacks.pContext = soc;
- connect.EpCallbacks.EpTxCompleteMultiple =
- NULL /* Control path completion ar6000_tx_complete */;
- connect.EpCallbacks.EpRecv = wmi_control_rx /* Control path rx */;
- connect.EpCallbacks.EpRecvRefill = NULL /* ar6000_rx_refill */;
- connect.EpCallbacks.EpSendFull = NULL /* ar6000_tx_queue_full */;
- connect.EpCallbacks.EpTxComplete =
- wmi_htc_tx_complete /* ar6000_tx_queue_full */;
- connect.EpCallbacks.ep_log_pkt = wmi_htc_log_pkt;
- /* connect to control service */
- connect.service_id = soc->svc_ids[pdev_idx];
- status = htc_connect_service(soc->htc_handle, &connect, &response);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to connect to WMI CONTROL service status:%d",
- status);
- return status;
- }
- if (soc->is_async_ep)
- htc_set_async_ep(soc->htc_handle, response.Endpoint, true);
- soc->wmi_endpoint_id[pdev_idx] = response.Endpoint;
- soc->max_msg_len[pdev_idx] = response.MaxMsgLength;
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS
- wmi_unified_connect_htc_service(struct wmi_unified *wmi_handle,
- HTC_HANDLE htc_handle)
- {
- uint32_t i;
- uint8_t wmi_ep_count;
- wmi_handle->soc->htc_handle = htc_handle;
- wmi_ep_count = htc_get_wmi_endpoint_count(htc_handle);
- if (wmi_ep_count > WMI_MAX_RADIOS)
- return QDF_STATUS_E_FAULT;
- for (i = 0; i < wmi_ep_count; i++)
- wmi_connect_pdev_htc_service(wmi_handle->soc, i);
- wmi_handle->htc_handle = htc_handle;
- wmi_handle->wmi_endpoint_id = wmi_handle->soc->wmi_endpoint_id[0];
- wmi_handle->max_msg_len = wmi_handle->soc->max_msg_len[0];
- return QDF_STATUS_SUCCESS;
- }
- #ifdef WLAN_FEATURE_WMI_DIAG_OVER_CE7
- QDF_STATUS wmi_diag_connect_pdev_htc_service(struct wmi_unified *wmi_handle,
- HTC_HANDLE htc_handle)
- {
- QDF_STATUS status;
- struct htc_service_connect_resp response = {0};
- struct htc_service_connect_req connect = {0};
- /* meta data is unused for now */
- connect.pMetaData = NULL;
- connect.MetaDataLength = 0;
- connect.EpCallbacks.pContext = wmi_handle->soc;
- connect.EpCallbacks.EpTxCompleteMultiple = NULL;
- connect.EpCallbacks.EpRecv = wmi_control_diag_rx /* wmi diag rx */;
- connect.EpCallbacks.EpRecvRefill = NULL;
- connect.EpCallbacks.EpSendFull = NULL;
- connect.EpCallbacks.EpTxComplete = NULL;
- connect.EpCallbacks.ep_log_pkt = wmi_htc_log_pkt;
- /* connect to wmi diag service */
- connect.service_id = WMI_CONTROL_DIAG_SVC;
- status = htc_connect_service(htc_handle, &connect, &response);
- if (QDF_IS_STATUS_ERROR(status)) {
- wmi_err("Failed to connect to WMI DIAG service status:%d",
- status);
- return status;
- }
- if (wmi_handle->soc->is_async_ep)
- htc_set_async_ep(htc_handle, response.Endpoint, true);
- wmi_handle->soc->wmi_diag_endpoint_id = response.Endpoint;
- return QDF_STATUS_SUCCESS;
- }
- #endif
- /**
- * wmi_get_host_credits() - WMI API to get updated host_credits
- *
- * @wmi_handle: handle to WMI.
- *
- * @Return: updated host_credits.
- */
- int wmi_get_host_credits(wmi_unified_t wmi_handle)
- {
- int host_credits = 0;
- htc_get_control_endpoint_tx_host_credits(wmi_handle->htc_handle,
- &host_credits);
- return host_credits;
- }
- /**
- * wmi_get_pending_cmds() - WMI API to get WMI Pending Commands in the HTC
- * queue
- *
- * @wmi_handle: handle to WMI.
- *
- * @Return: Pending Commands in the HTC queue.
- */
- int wmi_get_pending_cmds(wmi_unified_t wmi_handle)
- {
- return qdf_atomic_read(&wmi_handle->pending_cmds);
- }
- /**
- * wmi_set_target_suspend() - WMI API to set target suspend state
- *
- * @wmi_handle: handle to WMI.
- * @val: suspend state boolean.
- *
- * @Return: none.
- */
- void wmi_set_target_suspend(wmi_unified_t wmi_handle, A_BOOL val)
- {
- qdf_atomic_set(&wmi_handle->is_target_suspended, val);
- }
- /**
- * wmi_set_target_suspend_acked() - WMI API to set target suspend acked flag
- *
- * @wmi_handle: handle to WMI.
- * @val: target suspend command acked flag.
- *
- * @Return: none.
- */
- void wmi_set_target_suspend_acked(wmi_unified_t wmi_handle, A_BOOL val)
- {
- qdf_atomic_set(&wmi_handle->is_target_suspend_acked, val);
- }
- /**
- * wmi_is_target_suspended() - WMI API to check target suspend state
- * @wmi_handle: handle to WMI.
- *
- * WMI API to check target suspend state
- *
- * Return: true if target is suspended, else false.
- */
- bool wmi_is_target_suspended(struct wmi_unified *wmi_handle)
- {
- return qdf_atomic_read(&wmi_handle->is_target_suspended);
- }
- qdf_export_symbol(wmi_is_target_suspended);
- /**
- * wmi_is_target_suspend_acked() - WMI API to check target suspend command is
- * acked or not
- * @wmi_handle: handle to WMI.
- *
- * WMI API to check whether the target suspend command is acked or not
- *
- * Return: true if target suspend command is acked, else false.
- */
- bool wmi_is_target_suspend_acked(struct wmi_unified *wmi_handle)
- {
- return qdf_atomic_read(&wmi_handle->is_target_suspend_acked);
- }
- qdf_export_symbol(wmi_is_target_suspend_acked);
- #ifdef WLAN_FEATURE_WMI_SEND_RECV_QMI
- void wmi_set_qmi_stats(wmi_unified_t wmi_handle, bool val)
- {
- wmi_handle->is_qmi_stats_enabled = val;
- }
- bool wmi_is_qmi_stats_enabled(struct wmi_unified *wmi_handle)
- {
- return wmi_handle->is_qmi_stats_enabled;
- }
- #endif
- /**
- * WMI API to set crash injection state
- * @param wmi_handle: handle to WMI.
- * @param val: crash injection state boolean.
- */
- void wmi_tag_crash_inject(wmi_unified_t wmi_handle, A_BOOL flag)
- {
- wmi_handle->tag_crash_inject = flag;
- }
- /**
- * WMI API to set bus suspend state
- * @param wmi_handle: handle to WMI.
- * @param val: suspend state boolean.
- */
- void wmi_set_is_wow_bus_suspended(wmi_unified_t wmi_handle, A_BOOL val)
- {
- qdf_atomic_set(&wmi_handle->is_wow_bus_suspended, val);
- }
- void wmi_set_tgt_assert(wmi_unified_t wmi_handle, bool val)
- {
- wmi_handle->tgt_force_assert_enable = val;
- }
- /**
- * wmi_stop() - generic function to block unified WMI command
- * @wmi_handle: handle to WMI.
- *
- * @Return: success always.
- */
- int
- wmi_stop(wmi_unified_t wmi_handle)
- {
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_INFO,
- "WMI Stop");
- wmi_handle->wmi_stopinprogress = 1;
- return 0;
- }
- /**
- * wmi_start() - generic function to allow unified WMI command
- * @wmi_handle: handle to WMI.
- *
- * @Return: success always.
- */
- int
- wmi_start(wmi_unified_t wmi_handle)
- {
- QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_INFO,
- "WMI Start");
- wmi_handle->wmi_stopinprogress = 0;
- return 0;
- }
- /**
- * wmi_is_blocked() - generic function to check if WMI is blocked
- * @wmi_handle: handle to WMI.
- *
- * @Return: true, if blocked, false if not blocked
- */
- bool
- wmi_is_blocked(wmi_unified_t wmi_handle)
- {
- return (!(!wmi_handle->wmi_stopinprogress));
- }
- /**
- * API to flush all the previous packets associated with the wmi endpoint
- *
- * @param wmi_handle : handle to WMI.
- */
- void
- wmi_flush_endpoint(wmi_unified_t wmi_handle)
- {
- htc_flush_endpoint(wmi_handle->htc_handle,
- wmi_handle->wmi_endpoint_id, 0);
- }
- qdf_export_symbol(wmi_flush_endpoint);
- /**
- * wmi_pdev_id_conversion_enable() - API to enable pdev_id/phy_id conversion
- * in WMI. By default pdev_id conversion is not done in WMI.
- * This API can be used enable conversion in WMI.
- * @param wmi_handle : handle to WMI
- * @param pdev_map : pointer to pdev_map
- * @size : size of pdev_id_map
- * Return none
- */
- void wmi_pdev_id_conversion_enable(wmi_unified_t wmi_handle,
- uint32_t *pdev_id_map,
- uint8_t size)
- {
- if (wmi_handle->target_type == WMI_TLV_TARGET)
- wmi_handle->ops->wmi_pdev_id_conversion_enable(wmi_handle,
- pdev_id_map,
- size);
- }
- int __wmi_validate_handle(wmi_unified_t wmi_handle, const char *func)
- {
- if (!wmi_handle) {
- wmi_err("Invalid WMI handle (via %s)", func);
- return -EINVAL;
- }
- return 0;
- }
|