wmi_unified.c 109 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808
  1. /*
  2. * Copyright (c) 2015-2021 The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2021-2022 Qualcomm Innovation Center, Inc. All rights reserved.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for
  6. * any purpose with or without fee is hereby granted, provided that the
  7. * above copyright notice and this permission notice appear in all
  8. * copies.
  9. *
  10. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  11. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  12. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  13. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  14. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  15. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  16. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  17. * PERFORMANCE OF THIS SOFTWARE.
  18. */
  19. /*
  20. * Host WMI unified implementation
  21. */
  22. #include "htc_api.h"
  23. #include "htc_api.h"
  24. #include "wmi_unified_priv.h"
  25. #include "wmi_unified_api.h"
  26. #include "qdf_module.h"
  27. #include "qdf_platform.h"
  28. #ifdef WMI_EXT_DBG
  29. #include "qdf_list.h"
  30. #include "qdf_atomic.h"
  31. #endif
  32. #ifndef WMI_NON_TLV_SUPPORT
  33. #include "wmi_tlv_helper.h"
  34. #endif
  35. #include <linux/debugfs.h>
  36. #include <target_if.h>
  37. #include <qdf_debugfs.h>
  38. #include "wmi_filtered_logging.h"
  39. #include <wmi_hang_event.h>
  40. /* This check for CONFIG_WIN temporary added due to redeclaration compilation
  41. error in MCL. Error is caused due to inclusion of wmi.h in wmi_unified_api.h
  42. which gets included here through ol_if_athvar.h. Eventually it is expected that
  43. wmi.h will be removed from wmi_unified_api.h after cleanup, which will need
  44. WMI_CMD_HDR to be defined here. */
  45. /* Copied from wmi.h */
  46. #undef MS
  47. #define MS(_v, _f) (((_v) & _f##_MASK) >> _f##_LSB)
  48. #undef SM
  49. #define SM(_v, _f) (((_v) << _f##_LSB) & _f##_MASK)
  50. #undef WO
  51. #define WO(_f) ((_f##_OFFSET) >> 2)
  52. #undef GET_FIELD
  53. #define GET_FIELD(_addr, _f) MS(*((uint32_t *)(_addr) + WO(_f)), _f)
  54. #undef SET_FIELD
  55. #define SET_FIELD(_addr, _f, _val) \
  56. (*((uint32_t *)(_addr) + WO(_f)) = \
  57. (*((uint32_t *)(_addr) + WO(_f)) & ~_f##_MASK) | SM(_val, _f))
  58. #define WMI_GET_FIELD(_msg_buf, _msg_type, _f) \
  59. GET_FIELD(_msg_buf, _msg_type ## _ ## _f)
  60. #define WMI_SET_FIELD(_msg_buf, _msg_type, _f, _val) \
  61. SET_FIELD(_msg_buf, _msg_type ## _ ## _f, _val)
  62. #define WMI_EP_APASS 0x0
  63. #define WMI_EP_LPASS 0x1
  64. #define WMI_EP_SENSOR 0x2
  65. #define WMI_INFOS_DBG_FILE_PERM (QDF_FILE_USR_READ | \
  66. QDF_FILE_USR_WRITE | \
  67. QDF_FILE_GRP_READ | \
  68. QDF_FILE_OTH_READ)
  69. /*
  70. * * Control Path
  71. * */
  72. typedef PREPACK struct {
  73. uint32_t commandId:24,
  74. reserved:2, /* used for WMI endpoint ID */
  75. plt_priv:6; /* platform private */
  76. } POSTPACK WMI_CMD_HDR; /* used for commands and events */
  77. #define WMI_CMD_HDR_COMMANDID_LSB 0
  78. #define WMI_CMD_HDR_COMMANDID_MASK 0x00ffffff
  79. #define WMI_CMD_HDR_COMMANDID_OFFSET 0x00000000
  80. #define WMI_CMD_HDR_WMI_ENDPOINTID_MASK 0x03000000
  81. #define WMI_CMD_HDR_WMI_ENDPOINTID_OFFSET 24
  82. #define WMI_CMD_HDR_PLT_PRIV_LSB 24
  83. #define WMI_CMD_HDR_PLT_PRIV_MASK 0xff000000
  84. #define WMI_CMD_HDR_PLT_PRIV_OFFSET 0x00000000
  85. /* end of copy wmi.h */
  86. #define WMI_MIN_HEAD_ROOM 64
  87. /* WBUFF pool sizes for WMI */
  88. /* Allocation of size 256 bytes */
  89. #define WMI_WBUFF_POOL_0_SIZE 128
  90. /* Allocation of size 512 bytes */
  91. #define WMI_WBUFF_POOL_1_SIZE 16
  92. /* Allocation of size 1024 bytes */
  93. #define WMI_WBUFF_POOL_2_SIZE 8
  94. /* Allocation of size 2048 bytes */
  95. #define WMI_WBUFF_POOL_3_SIZE 8
  96. #define RX_DIAG_EVENT_WORK_PROCESS_MAX_COUNT 500
  97. #ifdef WMI_INTERFACE_EVENT_LOGGING
  98. #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 3, 0))
  99. /* TODO Cleanup this backported function */
  100. static int wmi_bp_seq_printf(qdf_debugfs_file_t m, const char *f, ...)
  101. {
  102. va_list args;
  103. va_start(args, f);
  104. seq_vprintf(m, f, args);
  105. va_end(args);
  106. return 0;
  107. }
  108. #else
  109. #define wmi_bp_seq_printf(m, fmt, ...) seq_printf((m), fmt, ##__VA_ARGS__)
  110. #endif
  111. #ifndef MAX_WMI_INSTANCES
  112. #define CUSTOM_MGMT_CMD_DATA_SIZE 4
  113. #endif
  114. #ifndef WMI_INTERFACE_EVENT_LOGGING_DYNAMIC_ALLOC
  115. /* WMI commands */
  116. uint32_t g_wmi_command_buf_idx = 0;
  117. struct wmi_command_debug wmi_command_log_buffer[WMI_CMD_DEBUG_MAX_ENTRY];
  118. /* WMI commands TX completed */
  119. uint32_t g_wmi_command_tx_cmp_buf_idx = 0;
  120. struct wmi_command_cmp_debug
  121. wmi_command_tx_cmp_log_buffer[WMI_CMD_CMPL_DEBUG_MAX_ENTRY];
  122. /* WMI events when processed */
  123. uint32_t g_wmi_event_buf_idx = 0;
  124. struct wmi_event_debug wmi_event_log_buffer[WMI_EVENT_DEBUG_MAX_ENTRY];
  125. /* WMI events when queued */
  126. uint32_t g_wmi_rx_event_buf_idx = 0;
  127. struct wmi_event_debug wmi_rx_event_log_buffer[WMI_EVENT_DEBUG_MAX_ENTRY];
  128. #endif
  129. static void wmi_minidump_detach(struct wmi_unified *wmi_handle)
  130. {
  131. struct wmi_log_buf_t *info =
  132. &wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info;
  133. uint32_t buf_size = info->size * sizeof(struct wmi_command_cmp_debug);
  134. qdf_minidump_remove(info->buf, buf_size, "wmi_tx_cmp");
  135. }
  136. static void wmi_minidump_attach(struct wmi_unified *wmi_handle)
  137. {
  138. struct wmi_log_buf_t *info =
  139. &wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info;
  140. uint32_t buf_size = info->size * sizeof(struct wmi_command_cmp_debug);
  141. qdf_minidump_log(info->buf, buf_size, "wmi_tx_cmp");
  142. }
  143. #define WMI_COMMAND_RECORD(h, a, b) { \
  144. if (wmi_cmd_log_max_entry <= \
  145. *(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx)) \
  146. *(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx) = 0;\
  147. ((struct wmi_command_debug *)h->log_info.wmi_command_log_buf_info.buf)\
  148. [*(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx)]\
  149. .command = a; \
  150. qdf_mem_copy(((struct wmi_command_debug *)h->log_info. \
  151. wmi_command_log_buf_info.buf) \
  152. [*(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx)].data,\
  153. b, wmi_record_max_length); \
  154. ((struct wmi_command_debug *)h->log_info.wmi_command_log_buf_info.buf)\
  155. [*(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx)].\
  156. time = qdf_get_log_timestamp(); \
  157. (*(h->log_info.wmi_command_log_buf_info.p_buf_tail_idx))++; \
  158. h->log_info.wmi_command_log_buf_info.length++; \
  159. }
  160. #define WMI_COMMAND_TX_CMP_RECORD(h, a, b, da, pa) { \
  161. if (wmi_cmd_cmpl_log_max_entry <= \
  162. *(h->log_info.wmi_command_tx_cmp_log_buf_info.p_buf_tail_idx))\
  163. *(h->log_info.wmi_command_tx_cmp_log_buf_info. \
  164. p_buf_tail_idx) = 0; \
  165. ((struct wmi_command_cmp_debug *)h->log_info. \
  166. wmi_command_tx_cmp_log_buf_info.buf) \
  167. [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
  168. p_buf_tail_idx)]. \
  169. command = a; \
  170. qdf_mem_copy(((struct wmi_command_cmp_debug *)h->log_info. \
  171. wmi_command_tx_cmp_log_buf_info.buf) \
  172. [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
  173. p_buf_tail_idx)]. \
  174. data, b, wmi_record_max_length); \
  175. ((struct wmi_command_cmp_debug *)h->log_info. \
  176. wmi_command_tx_cmp_log_buf_info.buf) \
  177. [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
  178. p_buf_tail_idx)]. \
  179. time = qdf_get_log_timestamp(); \
  180. ((struct wmi_command_cmp_debug *)h->log_info. \
  181. wmi_command_tx_cmp_log_buf_info.buf) \
  182. [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
  183. p_buf_tail_idx)]. \
  184. dma_addr = da; \
  185. ((struct wmi_command_cmp_debug *)h->log_info. \
  186. wmi_command_tx_cmp_log_buf_info.buf) \
  187. [*(h->log_info.wmi_command_tx_cmp_log_buf_info. \
  188. p_buf_tail_idx)]. \
  189. phy_addr = pa; \
  190. (*(h->log_info.wmi_command_tx_cmp_log_buf_info.p_buf_tail_idx))++;\
  191. h->log_info.wmi_command_tx_cmp_log_buf_info.length++; \
  192. }
  193. #define WMI_EVENT_RECORD(h, a, b) { \
  194. if (wmi_event_log_max_entry <= \
  195. *(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx)) \
  196. *(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx) = 0;\
  197. ((struct wmi_event_debug *)h->log_info.wmi_event_log_buf_info.buf)\
  198. [*(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx)]. \
  199. event = a; \
  200. qdf_mem_copy(((struct wmi_event_debug *)h->log_info. \
  201. wmi_event_log_buf_info.buf) \
  202. [*(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx)].data, b,\
  203. wmi_record_max_length); \
  204. ((struct wmi_event_debug *)h->log_info.wmi_event_log_buf_info.buf)\
  205. [*(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx)].time =\
  206. qdf_get_log_timestamp(); \
  207. (*(h->log_info.wmi_event_log_buf_info.p_buf_tail_idx))++; \
  208. h->log_info.wmi_event_log_buf_info.length++; \
  209. }
  210. #define WMI_RX_EVENT_RECORD(h, a, b) { \
  211. if (wmi_event_log_max_entry <= \
  212. *(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx))\
  213. *(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx) = 0;\
  214. ((struct wmi_event_debug *)h->log_info.wmi_rx_event_log_buf_info.buf)\
  215. [*(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx)].\
  216. event = a; \
  217. qdf_mem_copy(((struct wmi_event_debug *)h->log_info. \
  218. wmi_rx_event_log_buf_info.buf) \
  219. [*(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx)].\
  220. data, b, wmi_record_max_length); \
  221. ((struct wmi_event_debug *)h->log_info.wmi_rx_event_log_buf_info.buf)\
  222. [*(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx)].\
  223. time = qdf_get_log_timestamp(); \
  224. (*(h->log_info.wmi_rx_event_log_buf_info.p_buf_tail_idx))++; \
  225. h->log_info.wmi_rx_event_log_buf_info.length++; \
  226. }
  227. #ifndef WMI_INTERFACE_EVENT_LOGGING_DYNAMIC_ALLOC
  228. uint32_t g_wmi_mgmt_command_buf_idx = 0;
  229. struct
  230. wmi_command_debug wmi_mgmt_command_log_buffer[WMI_MGMT_TX_DEBUG_MAX_ENTRY];
  231. /* wmi_mgmt commands TX completed */
  232. uint32_t g_wmi_mgmt_command_tx_cmp_buf_idx = 0;
  233. struct wmi_command_debug
  234. wmi_mgmt_command_tx_cmp_log_buffer[WMI_MGMT_TX_CMPL_DEBUG_MAX_ENTRY];
  235. /* wmi_mgmt events when received */
  236. uint32_t g_wmi_mgmt_rx_event_buf_idx = 0;
  237. struct wmi_event_debug
  238. wmi_mgmt_rx_event_log_buffer[WMI_MGMT_RX_DEBUG_MAX_ENTRY];
  239. /* wmi_diag events when received */
  240. uint32_t g_wmi_diag_rx_event_buf_idx = 0;
  241. struct wmi_event_debug
  242. wmi_diag_rx_event_log_buffer[WMI_DIAG_RX_EVENT_DEBUG_MAX_ENTRY];
  243. #endif
  244. #define WMI_MGMT_COMMAND_RECORD(h, a, b) { \
  245. if (wmi_mgmt_tx_log_max_entry <= \
  246. *(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx)) \
  247. *(h->log_info.wmi_mgmt_command_log_buf_info. \
  248. p_buf_tail_idx) = 0; \
  249. ((struct wmi_command_debug *)h->log_info. \
  250. wmi_mgmt_command_log_buf_info.buf) \
  251. [*(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx)].\
  252. command = a; \
  253. qdf_mem_copy(((struct wmi_command_debug *)h->log_info. \
  254. wmi_mgmt_command_log_buf_info.buf) \
  255. [*(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx)].\
  256. data, b, \
  257. wmi_record_max_length); \
  258. ((struct wmi_command_debug *)h->log_info. \
  259. wmi_mgmt_command_log_buf_info.buf) \
  260. [*(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx)].\
  261. time = qdf_get_log_timestamp(); \
  262. (*(h->log_info.wmi_mgmt_command_log_buf_info.p_buf_tail_idx))++;\
  263. h->log_info.wmi_mgmt_command_log_buf_info.length++; \
  264. }
  265. #define WMI_MGMT_COMMAND_TX_CMP_RECORD(h, a, b) { \
  266. if (wmi_mgmt_tx_cmpl_log_max_entry <= \
  267. *(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
  268. p_buf_tail_idx)) \
  269. *(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
  270. p_buf_tail_idx) = 0; \
  271. ((struct wmi_command_debug *)h->log_info. \
  272. wmi_mgmt_command_tx_cmp_log_buf_info.buf) \
  273. [*(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
  274. p_buf_tail_idx)].command = a; \
  275. qdf_mem_copy(((struct wmi_command_debug *)h->log_info. \
  276. wmi_mgmt_command_tx_cmp_log_buf_info.buf)\
  277. [*(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
  278. p_buf_tail_idx)].data, b, \
  279. wmi_record_max_length); \
  280. ((struct wmi_command_debug *)h->log_info. \
  281. wmi_mgmt_command_tx_cmp_log_buf_info.buf) \
  282. [*(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
  283. p_buf_tail_idx)].time = \
  284. qdf_get_log_timestamp(); \
  285. (*(h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info. \
  286. p_buf_tail_idx))++; \
  287. h->log_info.wmi_mgmt_command_tx_cmp_log_buf_info.length++; \
  288. }
  289. #define WMI_MGMT_RX_EVENT_RECORD(h, a, b) do { \
  290. if (wmi_mgmt_rx_log_max_entry <= \
  291. *(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx))\
  292. *(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx) = 0;\
  293. ((struct wmi_event_debug *)h->log_info.wmi_mgmt_event_log_buf_info.buf)\
  294. [*(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx)]\
  295. .event = a; \
  296. qdf_mem_copy(((struct wmi_event_debug *)h->log_info. \
  297. wmi_mgmt_event_log_buf_info.buf) \
  298. [*(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx)].\
  299. data, b, wmi_record_max_length); \
  300. ((struct wmi_event_debug *)h->log_info.wmi_mgmt_event_log_buf_info.buf)\
  301. [*(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx)].\
  302. time = qdf_get_log_timestamp(); \
  303. (*(h->log_info.wmi_mgmt_event_log_buf_info.p_buf_tail_idx))++; \
  304. h->log_info.wmi_mgmt_event_log_buf_info.length++; \
  305. } while (0);
  306. #define WMI_DIAG_RX_EVENT_RECORD(h, a, b) do { \
  307. if (wmi_diag_log_max_entry <= \
  308. *(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx))\
  309. *(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx) = 0;\
  310. ((struct wmi_event_debug *)h->log_info.wmi_diag_event_log_buf_info.buf)\
  311. [*(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx)]\
  312. .event = a; \
  313. qdf_mem_copy(((struct wmi_event_debug *)h->log_info. \
  314. wmi_diag_event_log_buf_info.buf) \
  315. [*(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx)].\
  316. data, b, wmi_record_max_length); \
  317. ((struct wmi_event_debug *)h->log_info.wmi_diag_event_log_buf_info.buf)\
  318. [*(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx)].\
  319. time = qdf_get_log_timestamp(); \
  320. (*(h->log_info.wmi_diag_event_log_buf_info.p_buf_tail_idx))++; \
  321. h->log_info.wmi_diag_event_log_buf_info.length++; \
  322. } while (0);
  323. /* These are defined to made it as module param, which can be configured */
  324. /* WMI Commands */
  325. uint32_t wmi_cmd_log_max_entry = WMI_CMD_DEBUG_MAX_ENTRY;
  326. uint32_t wmi_cmd_cmpl_log_max_entry = WMI_CMD_CMPL_DEBUG_MAX_ENTRY;
  327. /* WMI Events */
  328. uint32_t wmi_event_log_max_entry = WMI_EVENT_DEBUG_MAX_ENTRY;
  329. /* WMI MGMT Tx */
  330. uint32_t wmi_mgmt_tx_log_max_entry = WMI_MGMT_TX_DEBUG_MAX_ENTRY;
  331. uint32_t wmi_mgmt_tx_cmpl_log_max_entry = WMI_MGMT_TX_CMPL_DEBUG_MAX_ENTRY;
  332. /* WMI MGMT Rx */
  333. uint32_t wmi_mgmt_rx_log_max_entry = WMI_MGMT_RX_DEBUG_MAX_ENTRY;
  334. /* WMI Diag Event */
  335. uint32_t wmi_diag_log_max_entry = WMI_DIAG_RX_EVENT_DEBUG_MAX_ENTRY;
  336. /* WMI capture size */
  337. uint32_t wmi_record_max_length = WMI_DEBUG_ENTRY_MAX_LENGTH;
  338. uint32_t wmi_display_size = 100;
  339. /**
  340. * wmi_log_init() - Initialize WMI event logging
  341. * @wmi_handle: WMI handle.
  342. *
  343. * Return: Initialization status
  344. */
  345. #ifndef WMI_INTERFACE_EVENT_LOGGING_DYNAMIC_ALLOC
  346. static QDF_STATUS wmi_log_init(struct wmi_unified *wmi_handle)
  347. {
  348. struct wmi_log_buf_t *cmd_log_buf =
  349. &wmi_handle->log_info.wmi_command_log_buf_info;
  350. struct wmi_log_buf_t *cmd_tx_cmpl_log_buf =
  351. &wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info;
  352. struct wmi_log_buf_t *event_log_buf =
  353. &wmi_handle->log_info.wmi_event_log_buf_info;
  354. struct wmi_log_buf_t *rx_event_log_buf =
  355. &wmi_handle->log_info.wmi_rx_event_log_buf_info;
  356. struct wmi_log_buf_t *mgmt_cmd_log_buf =
  357. &wmi_handle->log_info.wmi_mgmt_command_log_buf_info;
  358. struct wmi_log_buf_t *mgmt_cmd_tx_cmp_log_buf =
  359. &wmi_handle->log_info.wmi_mgmt_command_tx_cmp_log_buf_info;
  360. struct wmi_log_buf_t *mgmt_event_log_buf =
  361. &wmi_handle->log_info.wmi_mgmt_event_log_buf_info;
  362. struct wmi_log_buf_t *diag_event_log_buf =
  363. &wmi_handle->log_info.wmi_diag_event_log_buf_info;
  364. /* WMI commands */
  365. cmd_log_buf->length = 0;
  366. cmd_log_buf->buf_tail_idx = 0;
  367. cmd_log_buf->buf = wmi_command_log_buffer;
  368. cmd_log_buf->p_buf_tail_idx = &g_wmi_command_buf_idx;
  369. cmd_log_buf->size = WMI_CMD_DEBUG_MAX_ENTRY;
  370. /* WMI commands TX completed */
  371. cmd_tx_cmpl_log_buf->length = 0;
  372. cmd_tx_cmpl_log_buf->buf_tail_idx = 0;
  373. cmd_tx_cmpl_log_buf->buf = wmi_command_tx_cmp_log_buffer;
  374. cmd_tx_cmpl_log_buf->p_buf_tail_idx = &g_wmi_command_tx_cmp_buf_idx;
  375. cmd_tx_cmpl_log_buf->size = WMI_CMD_CMPL_DEBUG_MAX_ENTRY;
  376. /* WMI events when processed */
  377. event_log_buf->length = 0;
  378. event_log_buf->buf_tail_idx = 0;
  379. event_log_buf->buf = wmi_event_log_buffer;
  380. event_log_buf->p_buf_tail_idx = &g_wmi_event_buf_idx;
  381. event_log_buf->size = WMI_EVENT_DEBUG_MAX_ENTRY;
  382. /* WMI events when queued */
  383. rx_event_log_buf->length = 0;
  384. rx_event_log_buf->buf_tail_idx = 0;
  385. rx_event_log_buf->buf = wmi_rx_event_log_buffer;
  386. rx_event_log_buf->p_buf_tail_idx = &g_wmi_rx_event_buf_idx;
  387. rx_event_log_buf->size = WMI_EVENT_DEBUG_MAX_ENTRY;
  388. /* WMI Management commands */
  389. mgmt_cmd_log_buf->length = 0;
  390. mgmt_cmd_log_buf->buf_tail_idx = 0;
  391. mgmt_cmd_log_buf->buf = wmi_mgmt_command_log_buffer;
  392. mgmt_cmd_log_buf->p_buf_tail_idx = &g_wmi_mgmt_command_buf_idx;
  393. mgmt_cmd_log_buf->size = WMI_MGMT_TX_DEBUG_MAX_ENTRY;
  394. /* WMI Management commands Tx completed*/
  395. mgmt_cmd_tx_cmp_log_buf->length = 0;
  396. mgmt_cmd_tx_cmp_log_buf->buf_tail_idx = 0;
  397. mgmt_cmd_tx_cmp_log_buf->buf = wmi_mgmt_command_tx_cmp_log_buffer;
  398. mgmt_cmd_tx_cmp_log_buf->p_buf_tail_idx =
  399. &g_wmi_mgmt_command_tx_cmp_buf_idx;
  400. mgmt_cmd_tx_cmp_log_buf->size = WMI_MGMT_TX_CMPL_DEBUG_MAX_ENTRY;
  401. /* WMI Management events when received */
  402. mgmt_event_log_buf->length = 0;
  403. mgmt_event_log_buf->buf_tail_idx = 0;
  404. mgmt_event_log_buf->buf = wmi_mgmt_rx_event_log_buffer;
  405. mgmt_event_log_buf->p_buf_tail_idx = &g_wmi_mgmt_rx_event_buf_idx;
  406. mgmt_event_log_buf->size = WMI_MGMT_RX_DEBUG_MAX_ENTRY;
  407. /* WMI diag events when received */
  408. diag_event_log_buf->length = 0;
  409. diag_event_log_buf->buf_tail_idx = 0;
  410. diag_event_log_buf->buf = wmi_diag_rx_event_log_buffer;
  411. diag_event_log_buf->p_buf_tail_idx = &g_wmi_diag_rx_event_buf_idx;
  412. diag_event_log_buf->size = WMI_DIAG_RX_EVENT_DEBUG_MAX_ENTRY;
  413. qdf_spinlock_create(&wmi_handle->log_info.wmi_record_lock);
  414. wmi_handle->log_info.wmi_logging_enable = 1;
  415. return QDF_STATUS_SUCCESS;
  416. }
  417. #else
  418. static QDF_STATUS wmi_log_init(struct wmi_unified *wmi_handle)
  419. {
  420. struct wmi_log_buf_t *cmd_log_buf =
  421. &wmi_handle->log_info.wmi_command_log_buf_info;
  422. struct wmi_log_buf_t *cmd_tx_cmpl_log_buf =
  423. &wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info;
  424. struct wmi_log_buf_t *event_log_buf =
  425. &wmi_handle->log_info.wmi_event_log_buf_info;
  426. struct wmi_log_buf_t *rx_event_log_buf =
  427. &wmi_handle->log_info.wmi_rx_event_log_buf_info;
  428. struct wmi_log_buf_t *mgmt_cmd_log_buf =
  429. &wmi_handle->log_info.wmi_mgmt_command_log_buf_info;
  430. struct wmi_log_buf_t *mgmt_cmd_tx_cmp_log_buf =
  431. &wmi_handle->log_info.wmi_mgmt_command_tx_cmp_log_buf_info;
  432. struct wmi_log_buf_t *mgmt_event_log_buf =
  433. &wmi_handle->log_info.wmi_mgmt_event_log_buf_info;
  434. struct wmi_log_buf_t *diag_event_log_buf =
  435. &wmi_handle->log_info.wmi_diag_event_log_buf_info;
  436. wmi_handle->log_info.wmi_logging_enable = 0;
  437. /* WMI commands */
  438. cmd_log_buf->length = 0;
  439. cmd_log_buf->buf_tail_idx = 0;
  440. cmd_log_buf->buf = (struct wmi_command_debug *) qdf_mem_malloc(
  441. wmi_cmd_log_max_entry * sizeof(struct wmi_command_debug));
  442. cmd_log_buf->size = wmi_cmd_log_max_entry;
  443. if (!cmd_log_buf->buf)
  444. return QDF_STATUS_E_NOMEM;
  445. cmd_log_buf->p_buf_tail_idx = &cmd_log_buf->buf_tail_idx;
  446. /* WMI commands TX completed */
  447. cmd_tx_cmpl_log_buf->length = 0;
  448. cmd_tx_cmpl_log_buf->buf_tail_idx = 0;
  449. cmd_tx_cmpl_log_buf->buf = (struct wmi_command_cmp_debug *) qdf_mem_malloc(
  450. wmi_cmd_cmpl_log_max_entry * sizeof(struct wmi_command_cmp_debug));
  451. cmd_tx_cmpl_log_buf->size = wmi_cmd_cmpl_log_max_entry;
  452. if (!cmd_tx_cmpl_log_buf->buf)
  453. return QDF_STATUS_E_NOMEM;
  454. cmd_tx_cmpl_log_buf->p_buf_tail_idx =
  455. &cmd_tx_cmpl_log_buf->buf_tail_idx;
  456. /* WMI events when processed */
  457. event_log_buf->length = 0;
  458. event_log_buf->buf_tail_idx = 0;
  459. event_log_buf->buf = (struct wmi_event_debug *) qdf_mem_malloc(
  460. wmi_event_log_max_entry * sizeof(struct wmi_event_debug));
  461. event_log_buf->size = wmi_event_log_max_entry;
  462. if (!event_log_buf->buf)
  463. return QDF_STATUS_E_NOMEM;
  464. event_log_buf->p_buf_tail_idx = &event_log_buf->buf_tail_idx;
  465. /* WMI events when queued */
  466. rx_event_log_buf->length = 0;
  467. rx_event_log_buf->buf_tail_idx = 0;
  468. rx_event_log_buf->buf = (struct wmi_event_debug *) qdf_mem_malloc(
  469. wmi_event_log_max_entry * sizeof(struct wmi_event_debug));
  470. rx_event_log_buf->size = wmi_event_log_max_entry;
  471. if (!rx_event_log_buf->buf)
  472. return QDF_STATUS_E_NOMEM;
  473. rx_event_log_buf->p_buf_tail_idx = &rx_event_log_buf->buf_tail_idx;
  474. /* WMI Management commands */
  475. mgmt_cmd_log_buf->length = 0;
  476. mgmt_cmd_log_buf->buf_tail_idx = 0;
  477. mgmt_cmd_log_buf->buf = (struct wmi_command_debug *) qdf_mem_malloc(
  478. wmi_mgmt_tx_log_max_entry * sizeof(struct wmi_command_debug));
  479. mgmt_cmd_log_buf->size = wmi_mgmt_tx_log_max_entry;
  480. if (!mgmt_cmd_log_buf->buf)
  481. return QDF_STATUS_E_NOMEM;
  482. mgmt_cmd_log_buf->p_buf_tail_idx = &mgmt_cmd_log_buf->buf_tail_idx;
  483. /* WMI Management commands Tx completed*/
  484. mgmt_cmd_tx_cmp_log_buf->length = 0;
  485. mgmt_cmd_tx_cmp_log_buf->buf_tail_idx = 0;
  486. mgmt_cmd_tx_cmp_log_buf->buf = (struct wmi_command_debug *)
  487. qdf_mem_malloc(
  488. wmi_mgmt_tx_cmpl_log_max_entry *
  489. sizeof(struct wmi_command_debug));
  490. mgmt_cmd_tx_cmp_log_buf->size = wmi_mgmt_tx_cmpl_log_max_entry;
  491. if (!mgmt_cmd_tx_cmp_log_buf->buf)
  492. return QDF_STATUS_E_NOMEM;
  493. mgmt_cmd_tx_cmp_log_buf->p_buf_tail_idx =
  494. &mgmt_cmd_tx_cmp_log_buf->buf_tail_idx;
  495. /* WMI Management events when received */
  496. mgmt_event_log_buf->length = 0;
  497. mgmt_event_log_buf->buf_tail_idx = 0;
  498. mgmt_event_log_buf->buf = (struct wmi_event_debug *) qdf_mem_malloc(
  499. wmi_mgmt_rx_log_max_entry *
  500. sizeof(struct wmi_event_debug));
  501. mgmt_event_log_buf->size = wmi_mgmt_rx_log_max_entry;
  502. if (!mgmt_event_log_buf->buf)
  503. return QDF_STATUS_E_NOMEM;
  504. mgmt_event_log_buf->p_buf_tail_idx = &mgmt_event_log_buf->buf_tail_idx;
  505. /* WMI diag events when received */
  506. diag_event_log_buf->length = 0;
  507. diag_event_log_buf->buf_tail_idx = 0;
  508. diag_event_log_buf->buf = (struct wmi_event_debug *) qdf_mem_malloc(
  509. wmi_diag_log_max_entry *
  510. sizeof(struct wmi_event_debug));
  511. diag_event_log_buf->size = wmi_diag_log_max_entry;
  512. if (!diag_event_log_buf->buf)
  513. return QDF_STATUS_E_NOMEM;
  514. diag_event_log_buf->p_buf_tail_idx = &diag_event_log_buf->buf_tail_idx;
  515. qdf_spinlock_create(&wmi_handle->log_info.wmi_record_lock);
  516. wmi_handle->log_info.wmi_logging_enable = 1;
  517. wmi_filtered_logging_init(wmi_handle);
  518. return QDF_STATUS_SUCCESS;
  519. }
  520. #endif
  521. /**
  522. * wmi_log_buffer_free() - Free all dynamic allocated buffer memory for
  523. * event logging
  524. * @wmi_handle: WMI handle.
  525. *
  526. * Return: None
  527. */
  528. #ifdef WMI_INTERFACE_EVENT_LOGGING_DYNAMIC_ALLOC
  529. static inline void wmi_log_buffer_free(struct wmi_unified *wmi_handle)
  530. {
  531. wmi_filtered_logging_free(wmi_handle);
  532. if (wmi_handle->log_info.wmi_command_log_buf_info.buf)
  533. qdf_mem_free(wmi_handle->log_info.wmi_command_log_buf_info.buf);
  534. if (wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info.buf)
  535. qdf_mem_free(
  536. wmi_handle->log_info.wmi_command_tx_cmp_log_buf_info.buf);
  537. if (wmi_handle->log_info.wmi_event_log_buf_info.buf)
  538. qdf_mem_free(wmi_handle->log_info.wmi_event_log_buf_info.buf);
  539. if (wmi_handle->log_info.wmi_rx_event_log_buf_info.buf)
  540. qdf_mem_free(
  541. wmi_handle->log_info.wmi_rx_event_log_buf_info.buf);
  542. if (wmi_handle->log_info.wmi_mgmt_command_log_buf_info.buf)
  543. qdf_mem_free(
  544. wmi_handle->log_info.wmi_mgmt_command_log_buf_info.buf);
  545. if (wmi_handle->log_info.wmi_mgmt_command_tx_cmp_log_buf_info.buf)
  546. qdf_mem_free(
  547. wmi_handle->log_info.wmi_mgmt_command_tx_cmp_log_buf_info.buf);
  548. if (wmi_handle->log_info.wmi_mgmt_event_log_buf_info.buf)
  549. qdf_mem_free(
  550. wmi_handle->log_info.wmi_mgmt_event_log_buf_info.buf);
  551. if (wmi_handle->log_info.wmi_diag_event_log_buf_info.buf)
  552. qdf_mem_free(
  553. wmi_handle->log_info.wmi_diag_event_log_buf_info.buf);
  554. wmi_handle->log_info.wmi_logging_enable = 0;
  555. qdf_spinlock_destroy(&wmi_handle->log_info.wmi_record_lock);
  556. }
  557. #else
  558. static inline void wmi_log_buffer_free(struct wmi_unified *wmi_handle)
  559. {
  560. /* Do Nothing */
  561. }
  562. #endif
  563. /**
  564. * wmi_print_cmd_log_buffer() - an output agnostic wmi command log printer
  565. * @log_buffer: the command log buffer metadata of the buffer to print
  566. * @count: the maximum number of entries to print
  567. * @print: an abstract print method, e.g. a qdf_print() or seq_printf() wrapper
  568. * @print_priv: any data required by the print method, e.g. a file handle
  569. *
  570. * Return: None
  571. */
  572. static void
  573. wmi_print_cmd_log_buffer(struct wmi_log_buf_t *log_buffer, uint32_t count,
  574. qdf_abstract_print *print, void *print_priv)
  575. {
  576. static const int data_len =
  577. WMI_DEBUG_ENTRY_MAX_LENGTH / sizeof(uint32_t);
  578. char str[128];
  579. uint32_t idx;
  580. if (count > log_buffer->size)
  581. count = log_buffer->size;
  582. if (count > log_buffer->length)
  583. count = log_buffer->length;
  584. /* subtract count from index, and wrap if necessary */
  585. idx = log_buffer->size + *log_buffer->p_buf_tail_idx - count;
  586. idx %= log_buffer->size;
  587. print(print_priv, "Time (seconds) Cmd Id Payload");
  588. while (count) {
  589. struct wmi_command_debug *cmd_log = (struct wmi_command_debug *)
  590. &((struct wmi_command_debug *)log_buffer->buf)[idx];
  591. uint64_t secs, usecs;
  592. int len = 0;
  593. int i;
  594. qdf_log_timestamp_to_secs(cmd_log->time, &secs, &usecs);
  595. len += scnprintf(str + len, sizeof(str) - len,
  596. "% 8lld.%06lld %6u (0x%06x) ",
  597. secs, usecs,
  598. cmd_log->command, cmd_log->command);
  599. for (i = 0; i < data_len; ++i) {
  600. len += scnprintf(str + len, sizeof(str) - len,
  601. "0x%08x ", cmd_log->data[i]);
  602. }
  603. print(print_priv, str);
  604. --count;
  605. ++idx;
  606. if (idx >= log_buffer->size)
  607. idx = 0;
  608. }
  609. }
  610. /**
  611. * wmi_print_cmd_cmp_log_buffer() - wmi command completion log printer
  612. * @log_buffer: the command completion log buffer metadata of the buffer to print
  613. * @count: the maximum number of entries to print
  614. * @print: an abstract print method, e.g. a qdf_print() or seq_printf() wrapper
  615. * @print_priv: any data required by the print method, e.g. a file handle
  616. *
  617. * Return: None
  618. */
  619. static void
  620. wmi_print_cmd_cmp_log_buffer(struct wmi_log_buf_t *log_buffer, uint32_t count,
  621. qdf_abstract_print *print, void *print_priv)
  622. {
  623. static const int data_len =
  624. WMI_DEBUG_ENTRY_MAX_LENGTH / sizeof(uint32_t);
  625. char str[128];
  626. uint32_t idx;
  627. if (count > log_buffer->size)
  628. count = log_buffer->size;
  629. if (count > log_buffer->length)
  630. count = log_buffer->length;
  631. /* subtract count from index, and wrap if necessary */
  632. idx = log_buffer->size + *log_buffer->p_buf_tail_idx - count;
  633. idx %= log_buffer->size;
  634. print(print_priv, "Time (seconds) Cmd Id Payload");
  635. while (count) {
  636. struct wmi_command_cmp_debug *cmd_log = (struct wmi_command_cmp_debug *)
  637. &((struct wmi_command_cmp_debug *)log_buffer->buf)[idx];
  638. uint64_t secs, usecs;
  639. int len = 0;
  640. int i;
  641. qdf_log_timestamp_to_secs(cmd_log->time, &secs, &usecs);
  642. len += scnprintf(str + len, sizeof(str) - len,
  643. "% 8lld.%06lld %6u (0x%06x) ",
  644. secs, usecs,
  645. cmd_log->command, cmd_log->command);
  646. for (i = 0; i < data_len; ++i) {
  647. len += scnprintf(str + len, sizeof(str) - len,
  648. "0x%08x ", cmd_log->data[i]);
  649. }
  650. print(print_priv, str);
  651. --count;
  652. ++idx;
  653. if (idx >= log_buffer->size)
  654. idx = 0;
  655. }
  656. }
  657. /**
  658. * wmi_print_event_log_buffer() - an output agnostic wmi event log printer
  659. * @log_buffer: the event log buffer metadata of the buffer to print
  660. * @count: the maximum number of entries to print
  661. * @print: an abstract print method, e.g. a qdf_print() or seq_printf() wrapper
  662. * @print_priv: any data required by the print method, e.g. a file handle
  663. *
  664. * Return: None
  665. */
  666. static void
  667. wmi_print_event_log_buffer(struct wmi_log_buf_t *log_buffer, uint32_t count,
  668. qdf_abstract_print *print, void *print_priv)
  669. {
  670. static const int data_len =
  671. WMI_DEBUG_ENTRY_MAX_LENGTH / sizeof(uint32_t);
  672. char str[128];
  673. uint32_t idx;
  674. if (count > log_buffer->size)
  675. count = log_buffer->size;
  676. if (count > log_buffer->length)
  677. count = log_buffer->length;
  678. /* subtract count from index, and wrap if necessary */
  679. idx = log_buffer->size + *log_buffer->p_buf_tail_idx - count;
  680. idx %= log_buffer->size;
  681. print(print_priv, "Time (seconds) Event Id Payload");
  682. while (count) {
  683. struct wmi_event_debug *event_log = (struct wmi_event_debug *)
  684. &((struct wmi_event_debug *)log_buffer->buf)[idx];
  685. uint64_t secs, usecs;
  686. int len = 0;
  687. int i;
  688. qdf_log_timestamp_to_secs(event_log->time, &secs, &usecs);
  689. len += scnprintf(str + len, sizeof(str) - len,
  690. "% 8lld.%06lld %6u (0x%06x) ",
  691. secs, usecs,
  692. event_log->event, event_log->event);
  693. for (i = 0; i < data_len; ++i) {
  694. len += scnprintf(str + len, sizeof(str) - len,
  695. "0x%08x ", event_log->data[i]);
  696. }
  697. print(print_priv, str);
  698. --count;
  699. ++idx;
  700. if (idx >= log_buffer->size)
  701. idx = 0;
  702. }
  703. }
  704. inline void
  705. wmi_print_cmd_log(wmi_unified_t wmi, uint32_t count,
  706. qdf_abstract_print *print, void *print_priv)
  707. {
  708. wmi_print_cmd_log_buffer(
  709. &wmi->log_info.wmi_command_log_buf_info,
  710. count, print, print_priv);
  711. }
  712. inline void
  713. wmi_print_cmd_tx_cmp_log(wmi_unified_t wmi, uint32_t count,
  714. qdf_abstract_print *print, void *print_priv)
  715. {
  716. wmi_print_cmd_cmp_log_buffer(
  717. &wmi->log_info.wmi_command_tx_cmp_log_buf_info,
  718. count, print, print_priv);
  719. }
  720. inline void
  721. wmi_print_mgmt_cmd_log(wmi_unified_t wmi, uint32_t count,
  722. qdf_abstract_print *print, void *print_priv)
  723. {
  724. wmi_print_cmd_log_buffer(
  725. &wmi->log_info.wmi_mgmt_command_log_buf_info,
  726. count, print, print_priv);
  727. }
  728. inline void
  729. wmi_print_mgmt_cmd_tx_cmp_log(wmi_unified_t wmi, uint32_t count,
  730. qdf_abstract_print *print, void *print_priv)
  731. {
  732. wmi_print_cmd_log_buffer(
  733. &wmi->log_info.wmi_mgmt_command_tx_cmp_log_buf_info,
  734. count, print, print_priv);
  735. }
  736. inline void
  737. wmi_print_event_log(wmi_unified_t wmi, uint32_t count,
  738. qdf_abstract_print *print, void *print_priv)
  739. {
  740. wmi_print_event_log_buffer(
  741. &wmi->log_info.wmi_event_log_buf_info,
  742. count, print, print_priv);
  743. }
  744. inline void
  745. wmi_print_rx_event_log(wmi_unified_t wmi, uint32_t count,
  746. qdf_abstract_print *print, void *print_priv)
  747. {
  748. wmi_print_event_log_buffer(
  749. &wmi->log_info.wmi_rx_event_log_buf_info,
  750. count, print, print_priv);
  751. }
  752. inline void
  753. wmi_print_mgmt_event_log(wmi_unified_t wmi, uint32_t count,
  754. qdf_abstract_print *print, void *print_priv)
  755. {
  756. wmi_print_event_log_buffer(
  757. &wmi->log_info.wmi_mgmt_event_log_buf_info,
  758. count, print, print_priv);
  759. }
  760. /* debugfs routines*/
  761. /**
  762. * debug_wmi_##func_base##_show() - debugfs functions to display content of
  763. * command and event buffers. Macro uses max buffer length to display
  764. * buffer when it is wraparound.
  765. *
  766. * @m: debugfs handler to access wmi_handle
  767. * @v: Variable arguments (not used)
  768. *
  769. * Return: Length of characters printed
  770. */
  771. #define GENERATE_COMMAND_DEBUG_SHOW_FUNCS(func_base, wmi_ring_size, wmi_record_type)\
  772. static int debug_wmi_##func_base##_show(struct seq_file *m, \
  773. void *v) \
  774. { \
  775. wmi_unified_t wmi_handle = (wmi_unified_t) m->private; \
  776. struct wmi_log_buf_t *wmi_log = \
  777. &wmi_handle->log_info.wmi_##func_base##_buf_info;\
  778. int pos, nread, outlen; \
  779. int i; \
  780. uint64_t secs, usecs; \
  781. \
  782. qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);\
  783. if (!wmi_log->length) { \
  784. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
  785. return wmi_bp_seq_printf(m, \
  786. "no elements to read from ring buffer!\n"); \
  787. } \
  788. \
  789. if (wmi_log->length <= wmi_ring_size) \
  790. nread = wmi_log->length; \
  791. else \
  792. nread = wmi_ring_size; \
  793. \
  794. if (*(wmi_log->p_buf_tail_idx) == 0) \
  795. /* tail can be 0 after wrap-around */ \
  796. pos = wmi_ring_size - 1; \
  797. else \
  798. pos = *(wmi_log->p_buf_tail_idx) - 1; \
  799. \
  800. outlen = wmi_bp_seq_printf(m, "Length = %d\n", wmi_log->length);\
  801. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
  802. while (nread--) { \
  803. struct wmi_record_type *wmi_record; \
  804. \
  805. wmi_record = (struct wmi_record_type *) \
  806. &(((struct wmi_record_type *)wmi_log->buf)[pos]);\
  807. outlen += wmi_bp_seq_printf(m, "CMD ID = %x\n", \
  808. (wmi_record->command)); \
  809. qdf_log_timestamp_to_secs(wmi_record->time, &secs,\
  810. &usecs); \
  811. outlen += \
  812. wmi_bp_seq_printf(m, "CMD TIME = [%llu.%06llu]\n",\
  813. secs, usecs); \
  814. outlen += wmi_bp_seq_printf(m, "CMD = "); \
  815. for (i = 0; i < (wmi_record_max_length/ \
  816. sizeof(uint32_t)); i++) \
  817. outlen += wmi_bp_seq_printf(m, "%x ", \
  818. wmi_record->data[i]); \
  819. outlen += wmi_bp_seq_printf(m, "\n"); \
  820. \
  821. if (pos == 0) \
  822. pos = wmi_ring_size - 1; \
  823. else \
  824. pos--; \
  825. } \
  826. return outlen; \
  827. } \
  828. #define GENERATE_EVENT_DEBUG_SHOW_FUNCS(func_base, wmi_ring_size) \
  829. static int debug_wmi_##func_base##_show(struct seq_file *m, \
  830. void *v) \
  831. { \
  832. wmi_unified_t wmi_handle = (wmi_unified_t) m->private; \
  833. struct wmi_log_buf_t *wmi_log = \
  834. &wmi_handle->log_info.wmi_##func_base##_buf_info;\
  835. int pos, nread, outlen; \
  836. int i; \
  837. uint64_t secs, usecs; \
  838. \
  839. qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);\
  840. if (!wmi_log->length) { \
  841. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
  842. return wmi_bp_seq_printf(m, \
  843. "no elements to read from ring buffer!\n"); \
  844. } \
  845. \
  846. if (wmi_log->length <= wmi_ring_size) \
  847. nread = wmi_log->length; \
  848. else \
  849. nread = wmi_ring_size; \
  850. \
  851. if (*(wmi_log->p_buf_tail_idx) == 0) \
  852. /* tail can be 0 after wrap-around */ \
  853. pos = wmi_ring_size - 1; \
  854. else \
  855. pos = *(wmi_log->p_buf_tail_idx) - 1; \
  856. \
  857. outlen = wmi_bp_seq_printf(m, "Length = %d\n", wmi_log->length);\
  858. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
  859. while (nread--) { \
  860. struct wmi_event_debug *wmi_record; \
  861. \
  862. wmi_record = (struct wmi_event_debug *) \
  863. &(((struct wmi_event_debug *)wmi_log->buf)[pos]);\
  864. qdf_log_timestamp_to_secs(wmi_record->time, &secs,\
  865. &usecs); \
  866. outlen += wmi_bp_seq_printf(m, "Event ID = %x\n",\
  867. (wmi_record->event)); \
  868. outlen += \
  869. wmi_bp_seq_printf(m, "Event TIME = [%llu.%06llu]\n",\
  870. secs, usecs); \
  871. outlen += wmi_bp_seq_printf(m, "CMD = "); \
  872. for (i = 0; i < (wmi_record_max_length/ \
  873. sizeof(uint32_t)); i++) \
  874. outlen += wmi_bp_seq_printf(m, "%x ", \
  875. wmi_record->data[i]); \
  876. outlen += wmi_bp_seq_printf(m, "\n"); \
  877. \
  878. if (pos == 0) \
  879. pos = wmi_ring_size - 1; \
  880. else \
  881. pos--; \
  882. } \
  883. return outlen; \
  884. }
  885. GENERATE_COMMAND_DEBUG_SHOW_FUNCS(command_log, wmi_display_size,
  886. wmi_command_debug);
  887. GENERATE_COMMAND_DEBUG_SHOW_FUNCS(command_tx_cmp_log, wmi_display_size,
  888. wmi_command_cmp_debug);
  889. GENERATE_EVENT_DEBUG_SHOW_FUNCS(event_log, wmi_display_size);
  890. GENERATE_EVENT_DEBUG_SHOW_FUNCS(rx_event_log, wmi_display_size);
  891. GENERATE_COMMAND_DEBUG_SHOW_FUNCS(mgmt_command_log, wmi_display_size,
  892. wmi_command_debug);
  893. GENERATE_COMMAND_DEBUG_SHOW_FUNCS(mgmt_command_tx_cmp_log,
  894. wmi_display_size,
  895. wmi_command_debug);
  896. GENERATE_EVENT_DEBUG_SHOW_FUNCS(mgmt_event_log, wmi_display_size);
  897. /**
  898. * debug_wmi_enable_show() - debugfs functions to display enable state of
  899. * wmi logging feature.
  900. *
  901. * @m: debugfs handler to access wmi_handle
  902. * @v: Variable arguments (not used)
  903. *
  904. * Return: always 1
  905. */
  906. static int debug_wmi_enable_show(struct seq_file *m, void *v)
  907. {
  908. wmi_unified_t wmi_handle = (wmi_unified_t) m->private;
  909. return wmi_bp_seq_printf(m, "%d\n",
  910. wmi_handle->log_info.wmi_logging_enable);
  911. }
  912. /**
  913. * debug_wmi_log_size_show() - debugfs functions to display configured size of
  914. * wmi logging command/event buffer and management command/event buffer.
  915. *
  916. * @m: debugfs handler to access wmi_handle
  917. * @v: Variable arguments (not used)
  918. *
  919. * Return: Length of characters printed
  920. */
  921. static int debug_wmi_log_size_show(struct seq_file *m, void *v)
  922. {
  923. wmi_bp_seq_printf(m, "WMI command/cmpl log max size:%d/%d\n",
  924. wmi_cmd_log_max_entry, wmi_cmd_cmpl_log_max_entry);
  925. wmi_bp_seq_printf(m, "WMI management Tx/cmpl log max size:%d/%d\n",
  926. wmi_mgmt_tx_log_max_entry,
  927. wmi_mgmt_tx_cmpl_log_max_entry);
  928. wmi_bp_seq_printf(m, "WMI event log max size:%d\n",
  929. wmi_event_log_max_entry);
  930. wmi_bp_seq_printf(m, "WMI management Rx log max size:%d\n",
  931. wmi_mgmt_rx_log_max_entry);
  932. return wmi_bp_seq_printf(m,
  933. "WMI diag log max size:%d\n",
  934. wmi_diag_log_max_entry);
  935. }
  936. /**
  937. * debug_wmi_##func_base##_write() - debugfs functions to clear
  938. * wmi logging command/event buffer and management command/event buffer.
  939. *
  940. * @file: file handler to access wmi_handle
  941. * @buf: received data buffer
  942. * @count: length of received buffer
  943. * @ppos: Not used
  944. *
  945. * Return: count
  946. */
  947. #define GENERATE_DEBUG_WRITE_FUNCS(func_base, wmi_ring_size, wmi_record_type)\
  948. static ssize_t debug_wmi_##func_base##_write(struct file *file, \
  949. const char __user *buf, \
  950. size_t count, loff_t *ppos) \
  951. { \
  952. int k, ret; \
  953. wmi_unified_t wmi_handle = \
  954. ((struct seq_file *)file->private_data)->private;\
  955. struct wmi_log_buf_t *wmi_log = &wmi_handle->log_info. \
  956. wmi_##func_base##_buf_info; \
  957. char locbuf[50]; \
  958. \
  959. if ((!buf) || (count > 50)) \
  960. return -EFAULT; \
  961. \
  962. if (copy_from_user(locbuf, buf, count)) \
  963. return -EFAULT; \
  964. \
  965. ret = sscanf(locbuf, "%d", &k); \
  966. if ((ret != 1) || (k != 0)) { \
  967. wmi_err("Wrong input, echo 0 to clear the wmi buffer");\
  968. return -EINVAL; \
  969. } \
  970. \
  971. qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);\
  972. qdf_mem_zero(wmi_log->buf, wmi_ring_size * \
  973. sizeof(struct wmi_record_type)); \
  974. wmi_log->length = 0; \
  975. *(wmi_log->p_buf_tail_idx) = 0; \
  976. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);\
  977. \
  978. return count; \
  979. }
  980. GENERATE_DEBUG_WRITE_FUNCS(command_log, wmi_cmd_log_max_entry,
  981. wmi_command_debug);
  982. GENERATE_DEBUG_WRITE_FUNCS(command_tx_cmp_log, wmi_cmd_cmpl_log_max_entry,
  983. wmi_command_cmp_debug);
  984. GENERATE_DEBUG_WRITE_FUNCS(event_log, wmi_event_log_max_entry,
  985. wmi_event_debug);
  986. GENERATE_DEBUG_WRITE_FUNCS(rx_event_log, wmi_event_log_max_entry,
  987. wmi_event_debug);
  988. GENERATE_DEBUG_WRITE_FUNCS(mgmt_command_log, wmi_mgmt_tx_log_max_entry,
  989. wmi_command_debug);
  990. GENERATE_DEBUG_WRITE_FUNCS(mgmt_command_tx_cmp_log,
  991. wmi_mgmt_tx_cmpl_log_max_entry, wmi_command_debug);
  992. GENERATE_DEBUG_WRITE_FUNCS(mgmt_event_log, wmi_mgmt_rx_log_max_entry,
  993. wmi_event_debug);
  994. /**
  995. * debug_wmi_enable_write() - debugfs functions to enable/disable
  996. * wmi logging feature.
  997. *
  998. * @file: file handler to access wmi_handle
  999. * @buf: received data buffer
  1000. * @count: length of received buffer
  1001. * @ppos: Not used
  1002. *
  1003. * Return: count
  1004. */
  1005. static ssize_t debug_wmi_enable_write(struct file *file, const char __user *buf,
  1006. size_t count, loff_t *ppos)
  1007. {
  1008. wmi_unified_t wmi_handle =
  1009. ((struct seq_file *)file->private_data)->private;
  1010. int k, ret;
  1011. char locbuf[50];
  1012. if ((!buf) || (count > 50))
  1013. return -EFAULT;
  1014. if (copy_from_user(locbuf, buf, count))
  1015. return -EFAULT;
  1016. ret = sscanf(locbuf, "%d", &k);
  1017. if ((ret != 1) || ((k != 0) && (k != 1)))
  1018. return -EINVAL;
  1019. wmi_handle->log_info.wmi_logging_enable = k;
  1020. return count;
  1021. }
  1022. /**
  1023. * debug_wmi_log_size_write() - reserved.
  1024. *
  1025. * @file: file handler to access wmi_handle
  1026. * @buf: received data buffer
  1027. * @count: length of received buffer
  1028. * @ppos: Not used
  1029. *
  1030. * Return: count
  1031. */
  1032. static ssize_t debug_wmi_log_size_write(struct file *file,
  1033. const char __user *buf, size_t count, loff_t *ppos)
  1034. {
  1035. return -EINVAL;
  1036. }
  1037. /* Structure to maintain debug information */
  1038. struct wmi_debugfs_info {
  1039. const char *name;
  1040. const struct file_operations *ops;
  1041. };
  1042. #define DEBUG_FOO(func_base) { .name = #func_base, \
  1043. .ops = &debug_##func_base##_ops }
  1044. /**
  1045. * debug_##func_base##_open() - Open debugfs entry for respective command
  1046. * and event buffer.
  1047. *
  1048. * @inode: node for debug dir entry
  1049. * @file: file handler
  1050. *
  1051. * Return: open status
  1052. */
  1053. #define GENERATE_DEBUG_STRUCTS(func_base) \
  1054. static int debug_##func_base##_open(struct inode *inode, \
  1055. struct file *file) \
  1056. { \
  1057. return single_open(file, debug_##func_base##_show, \
  1058. inode->i_private); \
  1059. } \
  1060. \
  1061. \
  1062. static struct file_operations debug_##func_base##_ops = { \
  1063. .open = debug_##func_base##_open, \
  1064. .read = seq_read, \
  1065. .llseek = seq_lseek, \
  1066. .write = debug_##func_base##_write, \
  1067. .release = single_release, \
  1068. };
  1069. GENERATE_DEBUG_STRUCTS(wmi_command_log);
  1070. GENERATE_DEBUG_STRUCTS(wmi_command_tx_cmp_log);
  1071. GENERATE_DEBUG_STRUCTS(wmi_event_log);
  1072. GENERATE_DEBUG_STRUCTS(wmi_rx_event_log);
  1073. GENERATE_DEBUG_STRUCTS(wmi_mgmt_command_log);
  1074. GENERATE_DEBUG_STRUCTS(wmi_mgmt_command_tx_cmp_log);
  1075. GENERATE_DEBUG_STRUCTS(wmi_mgmt_event_log);
  1076. GENERATE_DEBUG_STRUCTS(wmi_enable);
  1077. GENERATE_DEBUG_STRUCTS(wmi_log_size);
  1078. #ifdef WMI_INTERFACE_FILTERED_EVENT_LOGGING
  1079. GENERATE_DEBUG_STRUCTS(filtered_wmi_cmds);
  1080. GENERATE_DEBUG_STRUCTS(filtered_wmi_evts);
  1081. GENERATE_DEBUG_STRUCTS(wmi_filtered_command_log);
  1082. GENERATE_DEBUG_STRUCTS(wmi_filtered_event_log);
  1083. #endif
  1084. struct wmi_debugfs_info wmi_debugfs_infos[NUM_DEBUG_INFOS] = {
  1085. DEBUG_FOO(wmi_command_log),
  1086. DEBUG_FOO(wmi_command_tx_cmp_log),
  1087. DEBUG_FOO(wmi_event_log),
  1088. DEBUG_FOO(wmi_rx_event_log),
  1089. DEBUG_FOO(wmi_mgmt_command_log),
  1090. DEBUG_FOO(wmi_mgmt_command_tx_cmp_log),
  1091. DEBUG_FOO(wmi_mgmt_event_log),
  1092. DEBUG_FOO(wmi_enable),
  1093. DEBUG_FOO(wmi_log_size),
  1094. #ifdef WMI_INTERFACE_FILTERED_EVENT_LOGGING
  1095. DEBUG_FOO(filtered_wmi_cmds),
  1096. DEBUG_FOO(filtered_wmi_evts),
  1097. DEBUG_FOO(wmi_filtered_command_log),
  1098. DEBUG_FOO(wmi_filtered_event_log),
  1099. #endif
  1100. };
  1101. /**
  1102. * wmi_debugfs_create() - Create debug_fs entry for wmi logging.
  1103. *
  1104. * @wmi_handle: wmi handle
  1105. * @par_entry: debug directory entry
  1106. * @id: Index to debug info data array
  1107. *
  1108. * Return: none
  1109. */
  1110. static void wmi_debugfs_create(wmi_unified_t wmi_handle,
  1111. struct dentry *par_entry)
  1112. {
  1113. int i;
  1114. if (!par_entry)
  1115. goto out;
  1116. for (i = 0; i < NUM_DEBUG_INFOS; ++i) {
  1117. wmi_handle->debugfs_de[i] = qdf_debugfs_create_entry(
  1118. wmi_debugfs_infos[i].name,
  1119. WMI_INFOS_DBG_FILE_PERM,
  1120. par_entry,
  1121. wmi_handle,
  1122. wmi_debugfs_infos[i].ops);
  1123. if (!wmi_handle->debugfs_de[i]) {
  1124. wmi_err("debug Entry creation failed!");
  1125. goto out;
  1126. }
  1127. }
  1128. return;
  1129. out:
  1130. wmi_err("debug Entry creation failed!");
  1131. wmi_log_buffer_free(wmi_handle);
  1132. return;
  1133. }
  1134. /**
  1135. * wmi_debugfs_remove() - Remove debugfs entry for wmi logging.
  1136. * @wmi_handle: wmi handle
  1137. * @dentry: debugfs directory entry
  1138. * @id: Index to debug info data array
  1139. *
  1140. * Return: none
  1141. */
  1142. static void wmi_debugfs_remove(wmi_unified_t wmi_handle)
  1143. {
  1144. int i;
  1145. struct dentry *dentry = wmi_handle->log_info.wmi_log_debugfs_dir;
  1146. if (dentry) {
  1147. for (i = 0; i < NUM_DEBUG_INFOS; ++i) {
  1148. if (wmi_handle->debugfs_de[i])
  1149. wmi_handle->debugfs_de[i] = NULL;
  1150. }
  1151. }
  1152. if (dentry)
  1153. qdf_debugfs_remove_dir_recursive(dentry);
  1154. }
  1155. /**
  1156. * wmi_debugfs_init() - debugfs functions to create debugfs directory and to
  1157. * create debugfs enteries.
  1158. *
  1159. * @h: wmi handler
  1160. *
  1161. * Return: init status
  1162. */
  1163. static QDF_STATUS wmi_debugfs_init(wmi_unified_t wmi_handle, uint32_t pdev_idx)
  1164. {
  1165. char buf[32];
  1166. snprintf(buf, sizeof(buf), "WMI_SOC%u_PDEV%u",
  1167. wmi_handle->soc->soc_idx, pdev_idx);
  1168. wmi_handle->log_info.wmi_log_debugfs_dir =
  1169. qdf_debugfs_create_dir(buf, NULL);
  1170. if (!wmi_handle->log_info.wmi_log_debugfs_dir) {
  1171. wmi_err("error while creating debugfs dir for %s", buf);
  1172. return QDF_STATUS_E_FAILURE;
  1173. }
  1174. wmi_debugfs_create(wmi_handle,
  1175. wmi_handle->log_info.wmi_log_debugfs_dir);
  1176. return QDF_STATUS_SUCCESS;
  1177. }
  1178. /**
  1179. * wmi_mgmt_cmd_record() - Wrapper function for mgmt command logging macro
  1180. *
  1181. * @wmi_handle: wmi handle
  1182. * @cmd: mgmt command
  1183. * @header: pointer to 802.11 header
  1184. * @vdev_id: vdev id
  1185. * @chanfreq: channel frequency
  1186. *
  1187. * Return: none
  1188. */
  1189. void wmi_mgmt_cmd_record(wmi_unified_t wmi_handle, uint32_t cmd,
  1190. void *header, uint32_t vdev_id, uint32_t chanfreq)
  1191. {
  1192. uint32_t data[CUSTOM_MGMT_CMD_DATA_SIZE];
  1193. data[0] = ((struct wmi_command_header *)header)->type;
  1194. data[1] = ((struct wmi_command_header *)header)->sub_type;
  1195. data[2] = vdev_id;
  1196. data[3] = chanfreq;
  1197. qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);
  1198. WMI_MGMT_COMMAND_RECORD(wmi_handle, cmd, (uint8_t *)data);
  1199. wmi_specific_cmd_record(wmi_handle, cmd, (uint8_t *)data);
  1200. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);
  1201. }
  1202. #else
  1203. /**
  1204. * wmi_debugfs_remove() - Remove debugfs entry for wmi logging.
  1205. * @wmi_handle: wmi handle
  1206. * @dentry: debugfs directory entry
  1207. * @id: Index to debug info data array
  1208. *
  1209. * Return: none
  1210. */
  1211. static void wmi_debugfs_remove(wmi_unified_t wmi_handle) { }
  1212. void wmi_mgmt_cmd_record(wmi_unified_t wmi_handle, uint32_t cmd,
  1213. void *header, uint32_t vdev_id, uint32_t chanfreq) { }
  1214. static inline void wmi_log_buffer_free(struct wmi_unified *wmi_handle) { }
  1215. static void wmi_minidump_detach(struct wmi_unified *wmi_handle) { }
  1216. static void wmi_minidump_attach(struct wmi_unified *wmi_handle) { }
  1217. #endif /*WMI_INTERFACE_EVENT_LOGGING */
  1218. qdf_export_symbol(wmi_mgmt_cmd_record);
  1219. #ifdef WMI_EXT_DBG
  1220. /**
  1221. * wmi_ext_dbg_msg_enqueue() - enqueue wmi message
  1222. * @wmi_handle: wmi handler
  1223. *
  1224. * Return: size of wmi message queue after enqueue
  1225. */
  1226. static uint32_t wmi_ext_dbg_msg_enqueue(struct wmi_unified *wmi_handle,
  1227. struct wmi_ext_dbg_msg *msg)
  1228. {
  1229. uint32_t list_size;
  1230. qdf_spinlock_acquire(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
  1231. qdf_list_insert_back_size(&wmi_handle->wmi_ext_dbg_msg_queue,
  1232. &msg->node, &list_size);
  1233. qdf_spinlock_release(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
  1234. return list_size;
  1235. }
  1236. /**
  1237. * wmi_ext_dbg_msg_dequeue() - dequeue wmi message
  1238. * @wmi_handle: wmi handler
  1239. *
  1240. * Return: wmi msg on success else NULL
  1241. */
  1242. static struct wmi_ext_dbg_msg *wmi_ext_dbg_msg_dequeue(struct wmi_unified
  1243. *wmi_handle)
  1244. {
  1245. qdf_list_node_t *list_node = NULL;
  1246. qdf_spinlock_acquire(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
  1247. qdf_list_remove_front(&wmi_handle->wmi_ext_dbg_msg_queue, &list_node);
  1248. qdf_spinlock_release(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
  1249. if (!list_node)
  1250. return NULL;
  1251. return qdf_container_of(list_node, struct wmi_ext_dbg_msg, node);
  1252. }
  1253. /**
  1254. * wmi_ext_dbg_msg_record() - record wmi messages
  1255. * @wmi_handle: wmi handler
  1256. * @buf: wmi message buffer
  1257. * @len: wmi message length
  1258. * @type: wmi message type
  1259. *
  1260. * Return: QDF_STATUS_SUCCESS on successful recording else failure.
  1261. */
  1262. static QDF_STATUS wmi_ext_dbg_msg_record(struct wmi_unified *wmi_handle,
  1263. uint8_t *buf, uint32_t len,
  1264. enum WMI_MSG_TYPE type)
  1265. {
  1266. struct wmi_ext_dbg_msg *msg;
  1267. uint32_t list_size;
  1268. msg = wmi_ext_dbg_msg_get(len);
  1269. if (!msg)
  1270. return QDF_STATUS_E_NOMEM;
  1271. msg->len = len;
  1272. msg->type = type;
  1273. qdf_mem_copy(msg->buf, buf, len);
  1274. msg->ts = qdf_get_log_timestamp();
  1275. list_size = wmi_ext_dbg_msg_enqueue(wmi_handle, msg);
  1276. if (list_size >= wmi_handle->wmi_ext_dbg_msg_queue_size) {
  1277. msg = wmi_ext_dbg_msg_dequeue(wmi_handle);
  1278. wmi_ext_dbg_msg_put(msg);
  1279. }
  1280. return QDF_STATUS_SUCCESS;
  1281. }
  1282. /**
  1283. * wmi_ext_dbg_msg_cmd_record() - record wmi command messages
  1284. * @wmi_handle: wmi handler
  1285. * @buf: wmi command buffer
  1286. * @len: wmi command message length
  1287. *
  1288. * Return: QDF_STATUS_SUCCESS on successful recording else failure.
  1289. */
  1290. static QDF_STATUS wmi_ext_dbg_msg_cmd_record(struct wmi_unified *wmi_handle,
  1291. uint8_t *buf, uint32_t len)
  1292. {
  1293. return wmi_ext_dbg_msg_record(wmi_handle, buf, len,
  1294. WMI_MSG_TYPE_CMD);
  1295. }
  1296. /**
  1297. * wmi_ext_dbg_msg_event_record() - record wmi event messages
  1298. * @wmi_handle: wmi handler
  1299. * @buf: wmi event buffer
  1300. * @len: wmi event message length
  1301. *
  1302. * Return: QDF_STATUS_SUCCESS on successful recording else failure.
  1303. */
  1304. static QDF_STATUS wmi_ext_dbg_msg_event_record(struct wmi_unified *wmi_handle,
  1305. uint8_t *buf, uint32_t len)
  1306. {
  1307. uint32_t id;
  1308. id = WMI_GET_FIELD(buf, WMI_CMD_HDR, COMMANDID);
  1309. if (id != wmi_handle->wmi_events[wmi_diag_event_id])
  1310. return wmi_ext_dbg_msg_record(wmi_handle, buf, len,
  1311. WMI_MSG_TYPE_EVENT);
  1312. return QDF_STATUS_SUCCESS;
  1313. }
  1314. /**
  1315. * wmi_ext_dbg_msg_queue_init() - create debugfs queue and associated lock
  1316. * @wmi_handle: wmi handler
  1317. *
  1318. * Return: none
  1319. */
  1320. static void wmi_ext_dbg_msg_queue_init(struct wmi_unified *wmi_handle)
  1321. {
  1322. qdf_list_create(&wmi_handle->wmi_ext_dbg_msg_queue,
  1323. wmi_handle->wmi_ext_dbg_msg_queue_size);
  1324. qdf_spinlock_create(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
  1325. }
  1326. /**
  1327. * wmi_ext_dbg_msg_queue_deinit() - destroy debugfs queue and associated lock
  1328. * @wmi_handle: wmi handler
  1329. *
  1330. * Return: none
  1331. */
  1332. static void wmi_ext_dbg_msg_queue_deinit(struct wmi_unified *wmi_handle)
  1333. {
  1334. qdf_list_destroy(&wmi_handle->wmi_ext_dbg_msg_queue);
  1335. qdf_spinlock_destroy(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
  1336. }
  1337. /**
  1338. * wmi_ext_dbg_msg_show() - debugfs function to display whole content of
  1339. * wmi command/event messages including headers.
  1340. * @file: qdf debugfs file handler
  1341. * @arg: pointer to wmi handler
  1342. *
  1343. * Return: QDF_STATUS_SUCCESS if all the messages are shown successfully,
  1344. * else QDF_STATUS_E_AGAIN if more data to show.
  1345. */
  1346. static QDF_STATUS wmi_ext_dbg_msg_show(qdf_debugfs_file_t file, void *arg)
  1347. {
  1348. struct wmi_unified *wmi_handle = (struct wmi_unified *)arg;
  1349. struct wmi_ext_dbg_msg *msg;
  1350. uint64_t secs, usecs;
  1351. msg = wmi_ext_dbg_msg_dequeue(wmi_handle);
  1352. if (!msg)
  1353. return QDF_STATUS_SUCCESS;
  1354. qdf_debugfs_printf(file, "%s: 0x%x\n",
  1355. msg->type == WMI_MSG_TYPE_CMD ? "COMMAND" :
  1356. "EVENT", WMI_GET_FIELD(msg->buf, WMI_CMD_HDR,
  1357. COMMANDID));
  1358. qdf_log_timestamp_to_secs(msg->ts, &secs, &usecs);
  1359. qdf_debugfs_printf(file, "Time: %llu.%llu\n", secs, usecs);
  1360. qdf_debugfs_printf(file, "Length:%d\n", msg->len);
  1361. qdf_debugfs_hexdump(file, msg->buf, msg->len,
  1362. WMI_EXT_DBG_DUMP_ROW_SIZE,
  1363. WMI_EXT_DBG_DUMP_GROUP_SIZE);
  1364. qdf_debugfs_printf(file, "\n");
  1365. if (qdf_debugfs_overflow(file)) {
  1366. qdf_spinlock_acquire(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
  1367. qdf_list_insert_front(&wmi_handle->wmi_ext_dbg_msg_queue,
  1368. &msg->node);
  1369. qdf_spinlock_release(&wmi_handle->wmi_ext_dbg_msg_queue_lock);
  1370. } else {
  1371. wmi_ext_dbg_msg_put(msg);
  1372. }
  1373. return QDF_STATUS_E_AGAIN;
  1374. }
  1375. /**
  1376. * wmi_ext_dbg_msg_write() - debugfs write not supported
  1377. * @priv: private data
  1378. * @buf: received data buffer
  1379. * @len: length of received buffer
  1380. *
  1381. * Return: QDF_STATUS_E_NOSUPPORT.
  1382. */
  1383. static QDF_STATUS wmi_ext_dbg_msg_write(void *priv, const char *buf,
  1384. qdf_size_t len)
  1385. {
  1386. return QDF_STATUS_E_NOSUPPORT;
  1387. }
  1388. static struct qdf_debugfs_fops wmi_ext_dbgfs_ops[WMI_MAX_RADIOS];
  1389. /**
  1390. * wmi_ext_debugfs_init() - init debugfs items for extended wmi dump.
  1391. * @wmi_handle: wmi handler
  1392. * @pdev_idx: pdev index
  1393. *
  1394. * Return: QDF_STATUS_SUCCESS if debugfs is initialized else
  1395. * QDF_STATUS_E_FAILURE
  1396. */
  1397. static QDF_STATUS wmi_ext_dbgfs_init(struct wmi_unified *wmi_handle,
  1398. uint32_t pdev_idx)
  1399. {
  1400. qdf_dentry_t dentry;
  1401. char buf[32];
  1402. /* To maintain backward compatibility, naming convention for PDEV 0
  1403. * dentry is kept same as before. For more than 1 PDEV, dentry
  1404. * names will be appended with PDEVx.
  1405. */
  1406. if (wmi_handle->soc->soc_idx == 0 && pdev_idx == 0) {
  1407. dentry = qdf_debugfs_create_dir(WMI_EXT_DBG_DIR, NULL);
  1408. } else {
  1409. snprintf(buf, sizeof(buf), "WMI_EXT_DBG_SOC%u_PDEV%u",
  1410. wmi_handle->soc->soc_idx, pdev_idx);
  1411. dentry = qdf_debugfs_create_dir(buf, NULL);
  1412. }
  1413. if (!dentry) {
  1414. wmi_err("error while creating extended wmi debugfs dir");
  1415. return QDF_STATUS_E_FAILURE;
  1416. }
  1417. wmi_ext_dbgfs_ops[pdev_idx].show = wmi_ext_dbg_msg_show;
  1418. wmi_ext_dbgfs_ops[pdev_idx].write = wmi_ext_dbg_msg_write;
  1419. wmi_ext_dbgfs_ops[pdev_idx].priv = wmi_handle;
  1420. if (!qdf_debugfs_create_file(WMI_EXT_DBG_FILE, WMI_EXT_DBG_FILE_PERM,
  1421. dentry, &wmi_ext_dbgfs_ops[pdev_idx])) {
  1422. qdf_debugfs_remove_dir(dentry);
  1423. wmi_err("Error while creating extended wmi debugfs file");
  1424. return QDF_STATUS_E_FAILURE;
  1425. }
  1426. wmi_handle->wmi_ext_dbg_dentry = dentry;
  1427. wmi_handle->wmi_ext_dbg_msg_queue_size = WMI_EXT_DBG_QUEUE_SIZE;
  1428. wmi_ext_dbg_msg_queue_init(wmi_handle);
  1429. return QDF_STATUS_SUCCESS;
  1430. }
  1431. /**
  1432. * wmi_ext_debugfs_deinit() - cleanup/deinit debugfs items of extended wmi dump.
  1433. * @wmi_handle: wmi handler
  1434. *
  1435. * Return: QDF_STATUS_SUCCESS if cleanup is successful
  1436. */
  1437. static QDF_STATUS wmi_ext_dbgfs_deinit(struct wmi_unified *wmi_handle)
  1438. {
  1439. struct wmi_ext_dbg_msg *msg;
  1440. while ((msg = wmi_ext_dbg_msg_dequeue(wmi_handle)))
  1441. wmi_ext_dbg_msg_put(msg);
  1442. wmi_ext_dbg_msg_queue_deinit(wmi_handle);
  1443. qdf_debugfs_remove_dir_recursive(wmi_handle->wmi_ext_dbg_dentry);
  1444. return QDF_STATUS_SUCCESS;
  1445. }
  1446. #else
  1447. static inline QDF_STATUS wmi_ext_dbg_msg_cmd_record(struct wmi_unified
  1448. *wmi_handle,
  1449. uint8_t *buf, uint32_t len)
  1450. {
  1451. return QDF_STATUS_SUCCESS;
  1452. }
  1453. static inline QDF_STATUS wmi_ext_dbg_msg_event_record(struct wmi_unified
  1454. *wmi_handle,
  1455. uint8_t *buf, uint32_t len)
  1456. {
  1457. return QDF_STATUS_SUCCESS;
  1458. }
  1459. static inline QDF_STATUS wmi_ext_dbgfs_init(struct wmi_unified *wmi_handle,
  1460. uint32_t pdev_idx)
  1461. {
  1462. return QDF_STATUS_SUCCESS;
  1463. }
  1464. static inline QDF_STATUS wmi_ext_dbgfs_deinit(struct wmi_unified *wmi_handle)
  1465. {
  1466. return QDF_STATUS_SUCCESS;
  1467. }
  1468. #endif /*WMI_EXT_DBG */
  1469. int wmi_get_host_credits(wmi_unified_t wmi_handle);
  1470. /* WMI buffer APIs */
  1471. #ifdef NBUF_MEMORY_DEBUG
  1472. wmi_buf_t
  1473. wmi_buf_alloc_debug(wmi_unified_t wmi_handle, uint32_t len,
  1474. const char *func_name,
  1475. uint32_t line_num)
  1476. {
  1477. wmi_buf_t wmi_buf;
  1478. if (roundup(len, 4) > wmi_handle->max_msg_len) {
  1479. wmi_err("Invalid length %u (via %s:%u) max size: %u",
  1480. len, func_name, line_num,
  1481. wmi_handle->max_msg_len);
  1482. QDF_ASSERT(0);
  1483. return NULL;
  1484. }
  1485. wmi_buf = wbuff_buff_get(wmi_handle->wbuff_handle, len, func_name,
  1486. line_num);
  1487. if (!wmi_buf)
  1488. wmi_buf = qdf_nbuf_alloc_debug(NULL,
  1489. roundup(len + WMI_MIN_HEAD_ROOM,
  1490. 4),
  1491. WMI_MIN_HEAD_ROOM, 4, false,
  1492. func_name, line_num);
  1493. if (!wmi_buf)
  1494. return NULL;
  1495. /* Clear the wmi buffer */
  1496. OS_MEMZERO(qdf_nbuf_data(wmi_buf), len);
  1497. /*
  1498. * Set the length of the buffer to match the allocation size.
  1499. */
  1500. qdf_nbuf_set_pktlen(wmi_buf, len);
  1501. return wmi_buf;
  1502. }
  1503. qdf_export_symbol(wmi_buf_alloc_debug);
  1504. void wmi_buf_free(wmi_buf_t net_buf)
  1505. {
  1506. net_buf = wbuff_buff_put(net_buf);
  1507. if (net_buf)
  1508. qdf_nbuf_free(net_buf);
  1509. }
  1510. qdf_export_symbol(wmi_buf_free);
  1511. #else
  1512. wmi_buf_t wmi_buf_alloc_fl(wmi_unified_t wmi_handle, uint32_t len,
  1513. const char *func, uint32_t line)
  1514. {
  1515. wmi_buf_t wmi_buf;
  1516. if (roundup(len, 4) > wmi_handle->max_msg_len) {
  1517. QDF_DEBUG_PANIC("Invalid length %u (via %s:%u) max size: %u",
  1518. len, func, line, wmi_handle->max_msg_len);
  1519. return NULL;
  1520. }
  1521. wmi_buf = wbuff_buff_get(wmi_handle->wbuff_handle, len, __func__,
  1522. __LINE__);
  1523. if (!wmi_buf)
  1524. wmi_buf = qdf_nbuf_alloc_fl(NULL, roundup(len +
  1525. WMI_MIN_HEAD_ROOM, 4), WMI_MIN_HEAD_ROOM, 4,
  1526. false, func, line);
  1527. if (!wmi_buf) {
  1528. wmi_nofl_err("%s:%d, failed to alloc len:%d", func, line, len);
  1529. return NULL;
  1530. }
  1531. /* Clear the wmi buffer */
  1532. OS_MEMZERO(qdf_nbuf_data(wmi_buf), len);
  1533. /*
  1534. * Set the length of the buffer to match the allocation size.
  1535. */
  1536. qdf_nbuf_set_pktlen(wmi_buf, len);
  1537. return wmi_buf;
  1538. }
  1539. qdf_export_symbol(wmi_buf_alloc_fl);
  1540. void wmi_buf_free(wmi_buf_t net_buf)
  1541. {
  1542. net_buf = wbuff_buff_put(net_buf);
  1543. if (net_buf)
  1544. qdf_nbuf_free(net_buf);
  1545. }
  1546. qdf_export_symbol(wmi_buf_free);
  1547. #endif
  1548. /**
  1549. * wmi_get_max_msg_len() - get maximum WMI message length
  1550. * @wmi_handle: WMI handle.
  1551. *
  1552. * This function returns the maximum WMI message length
  1553. *
  1554. * Return: maximum WMI message length
  1555. */
  1556. uint16_t wmi_get_max_msg_len(wmi_unified_t wmi_handle)
  1557. {
  1558. return wmi_handle->max_msg_len - WMI_MIN_HEAD_ROOM;
  1559. }
  1560. qdf_export_symbol(wmi_get_max_msg_len);
  1561. #ifndef WMI_CMD_STRINGS
  1562. static uint8_t *wmi_id_to_name(uint32_t wmi_command)
  1563. {
  1564. return "Invalid WMI cmd";
  1565. }
  1566. #endif
  1567. static inline void wmi_log_cmd_id(uint32_t cmd_id, uint32_t tag)
  1568. {
  1569. wmi_debug("Send WMI command:%s command_id:%d htc_tag:%d",
  1570. wmi_id_to_name(cmd_id), cmd_id, tag);
  1571. }
  1572. /**
  1573. * wmi_is_pm_resume_cmd() - check if a cmd is part of the resume sequence
  1574. * @cmd_id: command to check
  1575. *
  1576. * Return: true if the command is part of the resume sequence.
  1577. */
  1578. #ifdef WLAN_POWER_MANAGEMENT_OFFLOAD
  1579. static bool wmi_is_pm_resume_cmd(uint32_t cmd_id)
  1580. {
  1581. switch (cmd_id) {
  1582. case WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID:
  1583. case WMI_PDEV_RESUME_CMDID:
  1584. return true;
  1585. default:
  1586. return false;
  1587. }
  1588. }
  1589. #else
  1590. static bool wmi_is_pm_resume_cmd(uint32_t cmd_id)
  1591. {
  1592. return false;
  1593. }
  1594. #endif
  1595. #ifdef FEATURE_WLAN_D0WOW
  1596. static bool wmi_is_legacy_d0wow_disable_cmd(wmi_buf_t buf, uint32_t cmd_id)
  1597. {
  1598. wmi_d0_wow_enable_disable_cmd_fixed_param *cmd;
  1599. if (cmd_id == WMI_D0_WOW_ENABLE_DISABLE_CMDID) {
  1600. cmd = (wmi_d0_wow_enable_disable_cmd_fixed_param *)
  1601. wmi_buf_data(buf);
  1602. if (!cmd->enable)
  1603. return true;
  1604. else
  1605. return false;
  1606. }
  1607. return false;
  1608. }
  1609. #else
  1610. static bool wmi_is_legacy_d0wow_disable_cmd(wmi_buf_t buf, uint32_t cmd_id)
  1611. {
  1612. return false;
  1613. }
  1614. #endif
  1615. #ifdef WMI_INTERFACE_SEQUENCE_CHECK
  1616. static inline void wmi_interface_sequence_reset(struct wmi_unified *wmi_handle)
  1617. {
  1618. wmi_handle->wmi_sequence = 0;
  1619. wmi_handle->wmi_exp_sequence = 0;
  1620. wmi_handle->wmi_sequence_stop = false;
  1621. }
  1622. static inline void wmi_interface_sequence_init(struct wmi_unified *wmi_handle)
  1623. {
  1624. qdf_spinlock_create(&wmi_handle->wmi_seq_lock);
  1625. wmi_interface_sequence_reset(wmi_handle);
  1626. }
  1627. static inline void wmi_interface_sequence_deinit(struct wmi_unified *wmi_handle)
  1628. {
  1629. qdf_spinlock_destroy(&wmi_handle->wmi_seq_lock);
  1630. }
  1631. void wmi_interface_sequence_stop(struct wmi_unified *wmi_handle)
  1632. {
  1633. wmi_handle->wmi_sequence_stop = true;
  1634. }
  1635. static inline QDF_STATUS wmi_htc_send_pkt(struct wmi_unified *wmi_handle,
  1636. HTC_PACKET *pkt,
  1637. const char *func, uint32_t line)
  1638. {
  1639. wmi_buf_t buf = GET_HTC_PACKET_NET_BUF_CONTEXT(pkt);
  1640. QDF_STATUS status;
  1641. qdf_spin_lock_bh(&wmi_handle->wmi_seq_lock);
  1642. status = htc_send_pkt(wmi_handle->htc_handle, pkt);
  1643. if (QDF_STATUS_SUCCESS != status) {
  1644. qdf_spin_unlock_bh(&wmi_handle->wmi_seq_lock);
  1645. qdf_atomic_dec(&wmi_handle->pending_cmds);
  1646. wmi_nofl_err("%s:%d, htc_send_pkt failed, status:%d",
  1647. func, line, status);
  1648. qdf_mem_free(pkt);
  1649. return status;
  1650. }
  1651. /* Record the sequence number in the SKB */
  1652. qdf_nbuf_set_mark(buf, wmi_handle->wmi_sequence);
  1653. /* Increment the sequence number */
  1654. wmi_handle->wmi_sequence = (wmi_handle->wmi_sequence + 1)
  1655. & (wmi_handle->wmi_max_cmds - 1);
  1656. qdf_spin_unlock_bh(&wmi_handle->wmi_seq_lock);
  1657. return status;
  1658. }
  1659. static inline void wmi_interface_sequence_check(struct wmi_unified *wmi_handle,
  1660. wmi_buf_t buf)
  1661. {
  1662. /* Skip sequence check when wmi sequence stop is set */
  1663. if (wmi_handle->wmi_sequence_stop)
  1664. return;
  1665. qdf_spin_lock_bh(&wmi_handle->wmi_seq_lock);
  1666. /* Match the completion sequence and expected sequence number */
  1667. if (qdf_nbuf_get_mark(buf) != wmi_handle->wmi_exp_sequence) {
  1668. qdf_spin_unlock_bh(&wmi_handle->wmi_seq_lock);
  1669. wmi_nofl_err("WMI Tx Completion Sequence number mismatch");
  1670. wmi_nofl_err("Expected %d Received %d",
  1671. wmi_handle->wmi_exp_sequence,
  1672. qdf_nbuf_get_mark(buf));
  1673. /* Trigger Recovery */
  1674. qdf_trigger_self_recovery(wmi_handle->soc,
  1675. QDF_WMI_BUF_SEQUENCE_MISMATCH);
  1676. } else {
  1677. /* Increment the expected sequence number */
  1678. wmi_handle->wmi_exp_sequence =
  1679. (wmi_handle->wmi_exp_sequence + 1)
  1680. & (wmi_handle->wmi_max_cmds - 1);
  1681. qdf_spin_unlock_bh(&wmi_handle->wmi_seq_lock);
  1682. }
  1683. }
  1684. #else
  1685. static inline void wmi_interface_sequence_reset(struct wmi_unified *wmi_handle)
  1686. {
  1687. }
  1688. static inline void wmi_interface_sequence_init(struct wmi_unified *wmi_handle)
  1689. {
  1690. }
  1691. static inline void wmi_interface_sequence_deinit(struct wmi_unified *wmi_handle)
  1692. {
  1693. }
  1694. void wmi_interface_sequence_stop(struct wmi_unified *wmi_handle)
  1695. {
  1696. }
  1697. static inline QDF_STATUS wmi_htc_send_pkt(struct wmi_unified *wmi_handle,
  1698. HTC_PACKET *pkt,
  1699. const char *func, uint32_t line)
  1700. {
  1701. QDF_STATUS status;
  1702. status = htc_send_pkt(wmi_handle->htc_handle, pkt);
  1703. if (QDF_STATUS_SUCCESS != status) {
  1704. qdf_atomic_dec(&wmi_handle->pending_cmds);
  1705. wmi_nofl_err("%s:%d, htc_send_pkt failed, status:%d",
  1706. func, line, status);
  1707. qdf_mem_free(pkt);
  1708. return status;
  1709. }
  1710. return status;
  1711. }
  1712. static inline void wmi_interface_sequence_check(struct wmi_unified *wmi_handle,
  1713. wmi_buf_t buf)
  1714. {
  1715. }
  1716. #endif
  1717. static inline void wmi_unified_debug_dump(wmi_unified_t wmi_handle)
  1718. {
  1719. wmi_nofl_err("Endpoint ID = %d, Tx Queue Depth = %d, soc_id = %u, target type = %s",
  1720. wmi_handle->wmi_endpoint_id,
  1721. htc_get_tx_queue_depth(wmi_handle->htc_handle,
  1722. wmi_handle->wmi_endpoint_id),
  1723. wmi_handle->soc->soc_idx,
  1724. (wmi_handle->target_type ==
  1725. WMI_TLV_TARGET ? "WMI_TLV_TARGET" :
  1726. "WMI_NON_TLV_TARGET"));
  1727. }
  1728. #ifdef SYSTEM_PM_CHECK
  1729. /**
  1730. * wmi_set_system_pm_pkt_tag() - API to set tag for system pm packets
  1731. * @htc_tag: HTC tag
  1732. * @buf: wmi cmd buffer
  1733. * @cmd_id: cmd id
  1734. *
  1735. * Return: None
  1736. */
  1737. static void wmi_set_system_pm_pkt_tag(uint16_t *htc_tag, wmi_buf_t buf,
  1738. uint32_t cmd_id)
  1739. {
  1740. switch (cmd_id) {
  1741. case WMI_WOW_ENABLE_CMDID:
  1742. case WMI_PDEV_SUSPEND_CMDID:
  1743. *htc_tag = HTC_TX_PACKET_SYSTEM_SUSPEND;
  1744. break;
  1745. case WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID:
  1746. case WMI_PDEV_RESUME_CMDID:
  1747. *htc_tag = HTC_TX_PACKET_SYSTEM_RESUME;
  1748. break;
  1749. case WMI_D0_WOW_ENABLE_DISABLE_CMDID:
  1750. if (wmi_is_legacy_d0wow_disable_cmd(buf, cmd_id))
  1751. *htc_tag = HTC_TX_PACKET_SYSTEM_RESUME;
  1752. else
  1753. *htc_tag = HTC_TX_PACKET_SYSTEM_SUSPEND;
  1754. break;
  1755. default:
  1756. break;
  1757. }
  1758. }
  1759. #else
  1760. static inline void wmi_set_system_pm_pkt_tag(uint16_t *htc_tag, wmi_buf_t buf,
  1761. uint32_t cmd_id)
  1762. {
  1763. }
  1764. #endif
  1765. QDF_STATUS wmi_unified_cmd_send_fl(wmi_unified_t wmi_handle, wmi_buf_t buf,
  1766. uint32_t len, uint32_t cmd_id,
  1767. const char *func, uint32_t line)
  1768. {
  1769. HTC_PACKET *pkt;
  1770. uint16_t htc_tag = 0;
  1771. bool rtpm_inprogress;
  1772. rtpm_inprogress = wmi_get_runtime_pm_inprogress(wmi_handle);
  1773. if (rtpm_inprogress) {
  1774. htc_tag = wmi_handle->ops->wmi_set_htc_tx_tag(wmi_handle, buf,
  1775. cmd_id);
  1776. } else if (qdf_atomic_read(&wmi_handle->is_target_suspended) &&
  1777. !wmi_is_pm_resume_cmd(cmd_id) &&
  1778. !wmi_is_legacy_d0wow_disable_cmd(buf, cmd_id)) {
  1779. wmi_nofl_err("Target is suspended (via %s:%u)",
  1780. func, line);
  1781. return QDF_STATUS_E_BUSY;
  1782. }
  1783. if (wmi_handle->wmi_stopinprogress) {
  1784. wmi_nofl_err("%s:%d, WMI stop in progress, wmi_handle:%pK",
  1785. func, line, wmi_handle);
  1786. return QDF_STATUS_E_INVAL;
  1787. }
  1788. #ifndef WMI_NON_TLV_SUPPORT
  1789. /* Do sanity check on the TLV parameter structure */
  1790. if (wmi_handle->target_type == WMI_TLV_TARGET) {
  1791. void *buf_ptr = (void *)qdf_nbuf_data(buf);
  1792. if (wmi_handle->ops->wmi_check_command_params(NULL, buf_ptr, len, cmd_id)
  1793. != 0) {
  1794. wmi_nofl_err("%s:%d, Invalid WMI Param Buffer for Cmd:%d",
  1795. func, line, cmd_id);
  1796. return QDF_STATUS_E_INVAL;
  1797. }
  1798. }
  1799. #endif
  1800. if (qdf_nbuf_push_head(buf, sizeof(WMI_CMD_HDR)) == NULL) {
  1801. wmi_nofl_err("%s:%d, Failed to send cmd %x, no memory",
  1802. func, line, cmd_id);
  1803. return QDF_STATUS_E_NOMEM;
  1804. }
  1805. qdf_mem_zero(qdf_nbuf_data(buf), sizeof(WMI_CMD_HDR));
  1806. WMI_SET_FIELD(qdf_nbuf_data(buf), WMI_CMD_HDR, COMMANDID, cmd_id);
  1807. qdf_atomic_inc(&wmi_handle->pending_cmds);
  1808. if (qdf_atomic_read(&wmi_handle->pending_cmds) >=
  1809. wmi_handle->wmi_max_cmds) {
  1810. wmi_nofl_err("hostcredits = %d",
  1811. wmi_get_host_credits(wmi_handle));
  1812. htc_dump_counter_info(wmi_handle->htc_handle);
  1813. qdf_atomic_dec(&wmi_handle->pending_cmds);
  1814. wmi_nofl_err("%s:%d, MAX %d WMI Pending cmds reached",
  1815. func, line, wmi_handle->wmi_max_cmds);
  1816. wmi_unified_debug_dump(wmi_handle);
  1817. htc_ce_tasklet_debug_dump(wmi_handle->htc_handle);
  1818. qdf_trigger_self_recovery(wmi_handle->soc->wmi_psoc,
  1819. QDF_WMI_EXCEED_MAX_PENDING_CMDS);
  1820. return QDF_STATUS_E_BUSY;
  1821. }
  1822. pkt = qdf_mem_malloc_fl(sizeof(*pkt), func, line);
  1823. if (!pkt) {
  1824. qdf_atomic_dec(&wmi_handle->pending_cmds);
  1825. return QDF_STATUS_E_NOMEM;
  1826. }
  1827. if (!rtpm_inprogress)
  1828. wmi_set_system_pm_pkt_tag(&htc_tag, buf, cmd_id);
  1829. SET_HTC_PACKET_INFO_TX(pkt,
  1830. NULL,
  1831. qdf_nbuf_data(buf), len + sizeof(WMI_CMD_HDR),
  1832. wmi_handle->wmi_endpoint_id, htc_tag);
  1833. SET_HTC_PACKET_NET_BUF_CONTEXT(pkt, buf);
  1834. wmi_log_cmd_id(cmd_id, htc_tag);
  1835. wmi_ext_dbg_msg_cmd_record(wmi_handle,
  1836. qdf_nbuf_data(buf), qdf_nbuf_len(buf));
  1837. #ifdef WMI_INTERFACE_EVENT_LOGGING
  1838. if (wmi_handle->log_info.wmi_logging_enable) {
  1839. qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);
  1840. /*
  1841. * Record 16 bytes of WMI cmd data -
  1842. * exclude TLV and WMI headers
  1843. *
  1844. * WMI mgmt command already recorded in wmi_mgmt_cmd_record
  1845. */
  1846. if (wmi_handle->ops->is_management_record(cmd_id) == false) {
  1847. uint8_t *tmpbuf = (uint8_t *)qdf_nbuf_data(buf) +
  1848. wmi_handle->soc->buf_offset_command;
  1849. WMI_COMMAND_RECORD(wmi_handle, cmd_id, tmpbuf);
  1850. wmi_specific_cmd_record(wmi_handle, cmd_id, tmpbuf);
  1851. }
  1852. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);
  1853. }
  1854. #endif
  1855. return wmi_htc_send_pkt(wmi_handle, pkt, func, line);
  1856. }
  1857. qdf_export_symbol(wmi_unified_cmd_send_fl);
  1858. /**
  1859. * wmi_unified_get_event_handler_ix() - gives event handler's index
  1860. * @wmi_handle: handle to wmi
  1861. * @event_id: wmi event id
  1862. *
  1863. * Return: event handler's index
  1864. */
  1865. static int wmi_unified_get_event_handler_ix(wmi_unified_t wmi_handle,
  1866. uint32_t event_id)
  1867. {
  1868. uint32_t idx = 0;
  1869. int32_t invalid_idx = -1;
  1870. struct wmi_soc *soc = wmi_handle->soc;
  1871. for (idx = 0; (idx < soc->max_event_idx &&
  1872. idx < WMI_UNIFIED_MAX_EVENT); ++idx) {
  1873. if (wmi_handle->event_id[idx] == event_id &&
  1874. wmi_handle->event_handler[idx]) {
  1875. return idx;
  1876. }
  1877. }
  1878. return invalid_idx;
  1879. }
  1880. /**
  1881. * wmi_register_event_handler_with_ctx() - register event handler with
  1882. * exec ctx and buffer type
  1883. * @wmi_handle: handle to wmi
  1884. * @event_id: wmi event id
  1885. * @handler_func: wmi event handler function
  1886. * @rx_ctx: rx execution context for wmi rx events
  1887. * @rx_buf_type: rx execution context for wmi rx events
  1888. *
  1889. * Return: QDF_STATUS_SUCCESS on successful register event else failure.
  1890. */
  1891. static QDF_STATUS
  1892. wmi_register_event_handler_with_ctx(wmi_unified_t wmi_handle,
  1893. uint32_t event_id,
  1894. wmi_unified_event_handler handler_func,
  1895. enum wmi_rx_exec_ctx rx_ctx,
  1896. enum wmi_rx_buff_type rx_buf_type)
  1897. {
  1898. uint32_t idx = 0;
  1899. uint32_t evt_id;
  1900. struct wmi_soc *soc;
  1901. if (!wmi_handle) {
  1902. wmi_err("WMI handle is NULL");
  1903. return QDF_STATUS_E_FAILURE;
  1904. }
  1905. soc = wmi_handle->soc;
  1906. if (event_id >= wmi_events_max) {
  1907. QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_INFO,
  1908. "%s: Event id %d is unavailable",
  1909. __func__, event_id);
  1910. return QDF_STATUS_E_FAILURE;
  1911. }
  1912. if (wmi_handle->wmi_events[event_id] == WMI_EVENT_ID_INVALID) {
  1913. QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
  1914. "%s: Event id %d is not supported",
  1915. __func__, event_id);
  1916. return QDF_STATUS_E_NOSUPPORT;
  1917. }
  1918. evt_id = wmi_handle->wmi_events[event_id];
  1919. if (wmi_unified_get_event_handler_ix(wmi_handle, evt_id) != -1) {
  1920. wmi_info("event handler already registered 0x%x", evt_id);
  1921. return QDF_STATUS_E_FAILURE;
  1922. }
  1923. if (soc->max_event_idx == WMI_UNIFIED_MAX_EVENT) {
  1924. wmi_err("no more event handlers 0x%x",
  1925. evt_id);
  1926. return QDF_STATUS_E_FAILURE;
  1927. }
  1928. QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_DEBUG,
  1929. "Registered event handler for event 0x%8x", evt_id);
  1930. idx = soc->max_event_idx;
  1931. wmi_handle->event_handler[idx] = handler_func;
  1932. wmi_handle->event_id[idx] = evt_id;
  1933. qdf_spin_lock_bh(&soc->ctx_lock);
  1934. wmi_handle->ctx[idx].exec_ctx = rx_ctx;
  1935. wmi_handle->ctx[idx].buff_type = rx_buf_type;
  1936. qdf_spin_unlock_bh(&soc->ctx_lock);
  1937. soc->max_event_idx++;
  1938. return QDF_STATUS_SUCCESS;
  1939. }
  1940. QDF_STATUS
  1941. wmi_unified_register_event(wmi_unified_t wmi_handle,
  1942. uint32_t event_id,
  1943. wmi_unified_event_handler handler_func)
  1944. {
  1945. return wmi_register_event_handler_with_ctx(wmi_handle, event_id,
  1946. handler_func,
  1947. WMI_RX_UMAC_CTX,
  1948. WMI_RX_PROCESSED_BUFF);
  1949. }
  1950. QDF_STATUS
  1951. wmi_unified_register_event_handler(wmi_unified_t wmi_handle,
  1952. wmi_conv_event_id event_id,
  1953. wmi_unified_event_handler handler_func,
  1954. uint8_t rx_ctx)
  1955. {
  1956. return wmi_register_event_handler_with_ctx(wmi_handle, event_id,
  1957. handler_func, rx_ctx,
  1958. WMI_RX_PROCESSED_BUFF);
  1959. }
  1960. qdf_export_symbol(wmi_unified_register_event_handler);
  1961. QDF_STATUS
  1962. wmi_unified_register_raw_event_handler(wmi_unified_t wmi_handle,
  1963. wmi_conv_event_id event_id,
  1964. wmi_unified_event_handler handler_func,
  1965. enum wmi_rx_exec_ctx rx_ctx)
  1966. {
  1967. return wmi_register_event_handler_with_ctx(wmi_handle, event_id,
  1968. handler_func, rx_ctx,
  1969. WMI_RX_RAW_BUFF);
  1970. }
  1971. qdf_export_symbol(wmi_unified_register_raw_event_handler);
  1972. QDF_STATUS wmi_unified_unregister_event(wmi_unified_t wmi_handle,
  1973. uint32_t event_id)
  1974. {
  1975. uint32_t idx = 0;
  1976. uint32_t evt_id;
  1977. struct wmi_soc *soc;
  1978. if (!wmi_handle) {
  1979. wmi_err("WMI handle is NULL");
  1980. return QDF_STATUS_E_FAILURE;
  1981. }
  1982. soc = wmi_handle->soc;
  1983. if (event_id >= wmi_events_max ||
  1984. wmi_handle->wmi_events[event_id] == WMI_EVENT_ID_INVALID) {
  1985. QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_INFO,
  1986. "%s: Event id %d is unavailable",
  1987. __func__, event_id);
  1988. return QDF_STATUS_E_FAILURE;
  1989. }
  1990. evt_id = wmi_handle->wmi_events[event_id];
  1991. idx = wmi_unified_get_event_handler_ix(wmi_handle, evt_id);
  1992. if (idx == -1) {
  1993. wmi_warn("event handler is not registered: evt id 0x%x",
  1994. evt_id);
  1995. return QDF_STATUS_E_FAILURE;
  1996. }
  1997. wmi_handle->event_handler[idx] = NULL;
  1998. wmi_handle->event_id[idx] = 0;
  1999. --soc->max_event_idx;
  2000. wmi_handle->event_handler[idx] =
  2001. wmi_handle->event_handler[soc->max_event_idx];
  2002. wmi_handle->event_id[idx] =
  2003. wmi_handle->event_id[soc->max_event_idx];
  2004. qdf_spin_lock_bh(&soc->ctx_lock);
  2005. wmi_handle->ctx[idx].exec_ctx =
  2006. wmi_handle->ctx[soc->max_event_idx].exec_ctx;
  2007. wmi_handle->ctx[idx].buff_type =
  2008. wmi_handle->ctx[soc->max_event_idx].buff_type;
  2009. qdf_spin_unlock_bh(&soc->ctx_lock);
  2010. return QDF_STATUS_SUCCESS;
  2011. }
  2012. QDF_STATUS wmi_unified_unregister_event_handler(wmi_unified_t wmi_handle,
  2013. wmi_conv_event_id event_id)
  2014. {
  2015. uint32_t idx = 0;
  2016. uint32_t evt_id;
  2017. struct wmi_soc *soc;
  2018. if (!wmi_handle) {
  2019. wmi_err("WMI handle is NULL");
  2020. return QDF_STATUS_E_FAILURE;
  2021. }
  2022. soc = wmi_handle->soc;
  2023. if (event_id >= wmi_events_max) {
  2024. wmi_err("Event id %d is unavailable", event_id);
  2025. return QDF_STATUS_E_FAILURE;
  2026. }
  2027. if (wmi_handle->wmi_events[event_id] == WMI_EVENT_ID_INVALID) {
  2028. wmi_debug("Event id %d is not supported", event_id);
  2029. return QDF_STATUS_E_NOSUPPORT;
  2030. }
  2031. evt_id = wmi_handle->wmi_events[event_id];
  2032. idx = wmi_unified_get_event_handler_ix(wmi_handle, evt_id);
  2033. if (idx == -1) {
  2034. wmi_err("event handler is not registered: evt id 0x%x",
  2035. evt_id);
  2036. return QDF_STATUS_E_FAILURE;
  2037. }
  2038. wmi_handle->event_handler[idx] = NULL;
  2039. wmi_handle->event_id[idx] = 0;
  2040. --soc->max_event_idx;
  2041. wmi_handle->event_handler[idx] =
  2042. wmi_handle->event_handler[soc->max_event_idx];
  2043. wmi_handle->event_id[idx] =
  2044. wmi_handle->event_id[soc->max_event_idx];
  2045. qdf_spin_lock_bh(&soc->ctx_lock);
  2046. wmi_handle->ctx[idx].exec_ctx =
  2047. wmi_handle->ctx[soc->max_event_idx].exec_ctx;
  2048. wmi_handle->ctx[idx].buff_type =
  2049. wmi_handle->ctx[soc->max_event_idx].buff_type;
  2050. qdf_spin_unlock_bh(&soc->ctx_lock);
  2051. return QDF_STATUS_SUCCESS;
  2052. }
  2053. qdf_export_symbol(wmi_unified_unregister_event_handler);
  2054. static void
  2055. wmi_process_rx_diag_event_worker_thread_ctx(struct wmi_unified *wmi_handle,
  2056. void *evt_buf)
  2057. {
  2058. uint32_t num_diag_events_pending;
  2059. qdf_spin_lock_bh(&wmi_handle->diag_eventq_lock);
  2060. if (RX_DIAG_WQ_MAX_SIZE > 0) {
  2061. num_diag_events_pending = qdf_nbuf_queue_len(
  2062. &wmi_handle->diag_event_queue);
  2063. if (num_diag_events_pending >= RX_DIAG_WQ_MAX_SIZE) {
  2064. qdf_spin_unlock_bh(&wmi_handle->diag_eventq_lock);
  2065. wmi_handle->wmi_rx_diag_events_dropped++;
  2066. wmi_debug_rl("Rx diag events dropped count: %d",
  2067. wmi_handle->wmi_rx_diag_events_dropped);
  2068. qdf_nbuf_free(evt_buf);
  2069. return;
  2070. }
  2071. }
  2072. qdf_nbuf_queue_add(&wmi_handle->diag_event_queue, evt_buf);
  2073. qdf_spin_unlock_bh(&wmi_handle->diag_eventq_lock);
  2074. qdf_queue_work(0, wmi_handle->wmi_rx_diag_work_queue,
  2075. &wmi_handle->rx_diag_event_work);
  2076. }
  2077. void wmi_process_fw_event_worker_thread_ctx(struct wmi_unified *wmi_handle,
  2078. void *evt_buf)
  2079. {
  2080. qdf_spin_lock_bh(&wmi_handle->eventq_lock);
  2081. qdf_nbuf_queue_add(&wmi_handle->event_queue, evt_buf);
  2082. qdf_spin_unlock_bh(&wmi_handle->eventq_lock);
  2083. qdf_queue_work(0, wmi_handle->wmi_rx_work_queue,
  2084. &wmi_handle->rx_event_work);
  2085. return;
  2086. }
  2087. qdf_export_symbol(wmi_process_fw_event_worker_thread_ctx);
  2088. uint32_t wmi_critical_events_in_flight(struct wmi_unified *wmi)
  2089. {
  2090. return qdf_atomic_read(&wmi->critical_events_in_flight);
  2091. }
  2092. static bool
  2093. wmi_is_event_critical(struct wmi_unified *wmi_handle, uint32_t event_id)
  2094. {
  2095. if (wmi_handle->wmi_events[wmi_roam_synch_event_id] == event_id)
  2096. return true;
  2097. return false;
  2098. }
  2099. static QDF_STATUS wmi_discard_fw_event(struct scheduler_msg *msg)
  2100. {
  2101. struct wmi_process_fw_event_params *event_param;
  2102. if (!msg->bodyptr)
  2103. return QDF_STATUS_E_INVAL;
  2104. event_param = (struct wmi_process_fw_event_params *)msg->bodyptr;
  2105. qdf_nbuf_free(event_param->evt_buf);
  2106. qdf_mem_free(msg->bodyptr);
  2107. msg->bodyptr = NULL;
  2108. msg->bodyval = 0;
  2109. msg->type = 0;
  2110. return QDF_STATUS_SUCCESS;
  2111. }
  2112. static QDF_STATUS wmi_process_fw_event_handler(struct scheduler_msg *msg)
  2113. {
  2114. struct wmi_process_fw_event_params *params =
  2115. (struct wmi_process_fw_event_params *)msg->bodyptr;
  2116. struct wmi_unified *wmi_handle;
  2117. uint32_t event_id;
  2118. wmi_handle = (struct wmi_unified *)params->wmi_handle;
  2119. event_id = WMI_GET_FIELD(qdf_nbuf_data(params->evt_buf),
  2120. WMI_CMD_HDR, COMMANDID);
  2121. wmi_process_fw_event(wmi_handle, params->evt_buf);
  2122. if (wmi_is_event_critical(wmi_handle, event_id))
  2123. qdf_atomic_dec(&wmi_handle->critical_events_in_flight);
  2124. qdf_mem_free(msg->bodyptr);
  2125. return QDF_STATUS_SUCCESS;
  2126. }
  2127. /**
  2128. * wmi_process_fw_event_sched_thread_ctx() - common event handler to serialize
  2129. * event processing through scheduler thread
  2130. * @ctx: wmi context
  2131. * @ev: event buffer
  2132. * @rx_ctx: rx execution context
  2133. *
  2134. * Return: 0 on success, errno on failure
  2135. */
  2136. static QDF_STATUS
  2137. wmi_process_fw_event_sched_thread_ctx(struct wmi_unified *wmi,
  2138. void *ev)
  2139. {
  2140. struct wmi_process_fw_event_params *params_buf;
  2141. struct scheduler_msg msg = { 0 };
  2142. uint32_t event_id;
  2143. params_buf = qdf_mem_malloc(sizeof(struct wmi_process_fw_event_params));
  2144. if (!params_buf) {
  2145. wmi_err("malloc failed");
  2146. qdf_nbuf_free(ev);
  2147. return QDF_STATUS_E_NOMEM;
  2148. }
  2149. params_buf->wmi_handle = wmi;
  2150. params_buf->evt_buf = ev;
  2151. event_id = WMI_GET_FIELD(qdf_nbuf_data(params_buf->evt_buf),
  2152. WMI_CMD_HDR, COMMANDID);
  2153. if (wmi_is_event_critical(wmi, event_id))
  2154. qdf_atomic_inc(&wmi->critical_events_in_flight);
  2155. msg.bodyptr = params_buf;
  2156. msg.bodyval = 0;
  2157. msg.callback = wmi_process_fw_event_handler;
  2158. msg.flush_callback = wmi_discard_fw_event;
  2159. if (QDF_STATUS_SUCCESS !=
  2160. scheduler_post_message(QDF_MODULE_ID_TARGET_IF,
  2161. QDF_MODULE_ID_TARGET_IF,
  2162. QDF_MODULE_ID_TARGET_IF, &msg)) {
  2163. qdf_nbuf_free(ev);
  2164. qdf_mem_free(params_buf);
  2165. return QDF_STATUS_E_FAULT;
  2166. }
  2167. return QDF_STATUS_SUCCESS;
  2168. }
  2169. /**
  2170. * wmi_get_pdev_ep: Get wmi handle based on endpoint
  2171. * @soc: handle to wmi soc
  2172. * @ep: endpoint id
  2173. *
  2174. * Return: none
  2175. */
  2176. static struct wmi_unified *wmi_get_pdev_ep(struct wmi_soc *soc,
  2177. HTC_ENDPOINT_ID ep)
  2178. {
  2179. uint32_t i;
  2180. for (i = 0; i < WMI_MAX_RADIOS; i++)
  2181. if (soc->wmi_endpoint_id[i] == ep)
  2182. break;
  2183. if (i == WMI_MAX_RADIOS)
  2184. return NULL;
  2185. return soc->wmi_pdev[i];
  2186. }
  2187. /**
  2188. * wmi_mtrace_rx() - Wrappper function for qdf_mtrace api
  2189. * @message_id: 32-Bit Wmi message ID
  2190. * @vdev_id: Vdev ID
  2191. * @data: Actual message contents
  2192. *
  2193. * This function converts the 32-bit WMI message ID in 15-bit message ID
  2194. * format for qdf_mtrace as in qdf_mtrace message there are only 15
  2195. * bits reserved for message ID.
  2196. * out of these 15-bits, 8-bits (From LSB) specifies the WMI_GRP_ID
  2197. * and remaining 7-bits specifies the actual WMI command. With this
  2198. * notation there can be maximum 256 groups and each group can have
  2199. * max 128 commands can be supported.
  2200. *
  2201. * Return: None
  2202. */
  2203. static void wmi_mtrace_rx(uint32_t message_id, uint16_t vdev_id, uint32_t data)
  2204. {
  2205. uint16_t mtrace_message_id;
  2206. mtrace_message_id = QDF_WMI_MTRACE_CMD_ID(message_id) |
  2207. (QDF_WMI_MTRACE_GRP_ID(message_id) <<
  2208. QDF_WMI_MTRACE_CMD_NUM_BITS);
  2209. qdf_mtrace(QDF_MODULE_ID_WMI, QDF_MODULE_ID_WMA,
  2210. mtrace_message_id, vdev_id, data);
  2211. }
  2212. /**
  2213. * wmi_process_control_rx() - process fw events callbacks
  2214. * @wmi_handle: handle to wmi_unified
  2215. * @evt_buf: handle to wmi_buf_t
  2216. *
  2217. * Return: none
  2218. */
  2219. static void wmi_process_control_rx(struct wmi_unified *wmi_handle,
  2220. wmi_buf_t evt_buf)
  2221. {
  2222. struct wmi_soc *soc = wmi_handle->soc;
  2223. uint32_t id;
  2224. uint32_t idx;
  2225. enum wmi_rx_exec_ctx exec_ctx;
  2226. id = WMI_GET_FIELD(qdf_nbuf_data(evt_buf), WMI_CMD_HDR, COMMANDID);
  2227. idx = wmi_unified_get_event_handler_ix(wmi_handle, id);
  2228. if (qdf_unlikely(idx == A_ERROR)) {
  2229. wmi_debug("no handler registered for event id 0x%x", id);
  2230. qdf_nbuf_free(evt_buf);
  2231. return;
  2232. }
  2233. wmi_mtrace_rx(id, 0xFF, idx);
  2234. qdf_spin_lock_bh(&soc->ctx_lock);
  2235. exec_ctx = wmi_handle->ctx[idx].exec_ctx;
  2236. qdf_spin_unlock_bh(&soc->ctx_lock);
  2237. #ifdef WMI_INTERFACE_EVENT_LOGGING
  2238. if (wmi_handle->log_info.wmi_logging_enable) {
  2239. uint8_t *data;
  2240. data = qdf_nbuf_data(evt_buf);
  2241. qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);
  2242. /* Exclude 4 bytes of TLV header */
  2243. if (wmi_handle->ops->is_diag_event(id)) {
  2244. WMI_DIAG_RX_EVENT_RECORD(wmi_handle, id,
  2245. ((uint8_t *) data +
  2246. wmi_handle->soc->buf_offset_event));
  2247. } else if (wmi_handle->ops->is_management_record(id)) {
  2248. WMI_MGMT_RX_EVENT_RECORD(wmi_handle, id,
  2249. ((uint8_t *) data +
  2250. wmi_handle->soc->buf_offset_event));
  2251. } else {
  2252. WMI_RX_EVENT_RECORD(wmi_handle, id, ((uint8_t *) data +
  2253. wmi_handle->soc->buf_offset_event));
  2254. }
  2255. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);
  2256. }
  2257. #endif
  2258. if (exec_ctx == WMI_RX_WORK_CTX) {
  2259. wmi_process_fw_event_worker_thread_ctx(wmi_handle, evt_buf);
  2260. } else if (exec_ctx == WMI_RX_TASKLET_CTX) {
  2261. wmi_process_fw_event(wmi_handle, evt_buf);
  2262. } else if (exec_ctx == WMI_RX_SERIALIZER_CTX) {
  2263. wmi_process_fw_event_sched_thread_ctx(wmi_handle, evt_buf);
  2264. } else if (exec_ctx == WMI_RX_DIAG_WORK_CTX) {
  2265. wmi_process_rx_diag_event_worker_thread_ctx(wmi_handle,
  2266. evt_buf);
  2267. } else {
  2268. wmi_err("Invalid event context %d", exec_ctx);
  2269. qdf_nbuf_free(evt_buf);
  2270. }
  2271. }
  2272. /**
  2273. * wmi_control_rx() - process fw events callbacks
  2274. * @ctx: handle to wmi
  2275. * @htc_packet: pointer to htc packet
  2276. *
  2277. * Return: none
  2278. */
  2279. static void wmi_control_rx(void *ctx, HTC_PACKET *htc_packet)
  2280. {
  2281. struct wmi_soc *soc = (struct wmi_soc *)ctx;
  2282. struct wmi_unified *wmi_handle;
  2283. wmi_buf_t evt_buf;
  2284. evt_buf = (wmi_buf_t)htc_packet->pPktContext;
  2285. wmi_handle = wmi_get_pdev_ep(soc, htc_packet->Endpoint);
  2286. if (!wmi_handle) {
  2287. wmi_err("unable to get wmi_handle to Endpoint %d",
  2288. htc_packet->Endpoint);
  2289. qdf_nbuf_free(evt_buf);
  2290. return;
  2291. }
  2292. wmi_process_control_rx(wmi_handle, evt_buf);
  2293. }
  2294. #if defined(WLAN_FEATURE_WMI_DIAG_OVER_CE7) || \
  2295. defined(WLAN_DIAG_AND_DBR_OVER_SEPARATE_CE)
  2296. /**
  2297. * wmi_control_diag_rx() - process diag fw events callbacks
  2298. * @ctx: handle to wmi
  2299. * @htc_packet: pointer to htc packet
  2300. *
  2301. * Return: none
  2302. */
  2303. static void wmi_control_diag_rx(void *ctx, HTC_PACKET *htc_packet)
  2304. {
  2305. struct wmi_soc *soc = (struct wmi_soc *)ctx;
  2306. struct wmi_unified *wmi_handle;
  2307. wmi_buf_t evt_buf;
  2308. evt_buf = (wmi_buf_t)htc_packet->pPktContext;
  2309. wmi_handle = soc->wmi_pdev[0];
  2310. if (!wmi_handle) {
  2311. wmi_err("unable to get wmi_handle for diag event end point id:%d", htc_packet->Endpoint);
  2312. qdf_nbuf_free(evt_buf);
  2313. return;
  2314. }
  2315. wmi_process_control_rx(wmi_handle, evt_buf);
  2316. }
  2317. #endif
  2318. #ifdef WLAN_FEATURE_WMI_SEND_RECV_QMI
  2319. QDF_STATUS wmi_unified_cmd_send_over_qmi(struct wmi_unified *wmi_handle,
  2320. wmi_buf_t buf, uint32_t buflen,
  2321. uint32_t cmd_id)
  2322. {
  2323. QDF_STATUS status;
  2324. int32_t ret;
  2325. if (!qdf_nbuf_push_head(buf, sizeof(WMI_CMD_HDR))) {
  2326. wmi_err("Failed to send cmd %x, no memory", cmd_id);
  2327. return QDF_STATUS_E_NOMEM;
  2328. }
  2329. qdf_mem_zero(qdf_nbuf_data(buf), sizeof(WMI_CMD_HDR));
  2330. WMI_SET_FIELD(qdf_nbuf_data(buf), WMI_CMD_HDR, COMMANDID, cmd_id);
  2331. wmi_debug("Sending WMI_CMD_ID: 0x%x over qmi", cmd_id);
  2332. status = qdf_wmi_send_recv_qmi(qdf_nbuf_data(buf),
  2333. buflen + sizeof(WMI_CMD_HDR),
  2334. wmi_handle,
  2335. wmi_process_qmi_fw_event);
  2336. if (QDF_IS_STATUS_ERROR(status)) {
  2337. qdf_nbuf_pull_head(buf, sizeof(WMI_CMD_HDR));
  2338. wmi_warn("WMI send on QMI failed. Retrying WMI on HTC");
  2339. } else {
  2340. ret = qdf_atomic_inc_return(&wmi_handle->num_stats_over_qmi);
  2341. wmi_debug("num stats over qmi: %d", ret);
  2342. wmi_buf_free(buf);
  2343. }
  2344. return status;
  2345. }
  2346. static int __wmi_process_qmi_fw_event(void *wmi_cb_ctx, void *buf, int len)
  2347. {
  2348. struct wmi_unified *wmi_handle = wmi_cb_ctx;
  2349. wmi_buf_t evt_buf;
  2350. uint32_t evt_id;
  2351. if (!wmi_handle || !buf || !len) {
  2352. wmi_err_rl("%s is invalid", !wmi_handle ?
  2353. "wmi_buf" : !buf ? "buf" : "length");
  2354. return -EINVAL;
  2355. }
  2356. evt_buf = wmi_buf_alloc(wmi_handle, len);
  2357. if (!evt_buf)
  2358. return -ENOMEM;
  2359. qdf_mem_copy(qdf_nbuf_data(evt_buf), buf, len);
  2360. evt_id = WMI_GET_FIELD(qdf_nbuf_data(evt_buf), WMI_CMD_HDR, COMMANDID);
  2361. wmi_debug("Received WMI_EVT_ID: 0x%x over qmi", evt_id);
  2362. wmi_process_control_rx(wmi_handle, evt_buf);
  2363. return 0;
  2364. }
  2365. int wmi_process_qmi_fw_event(void *wmi_cb_ctx, void *buf, int len)
  2366. {
  2367. struct qdf_op_sync *op_sync;
  2368. int ret;
  2369. if (qdf_op_protect(&op_sync))
  2370. return -EINVAL;
  2371. ret = __wmi_process_qmi_fw_event(wmi_cb_ctx, buf, len);
  2372. qdf_op_unprotect(op_sync);
  2373. return ret;
  2374. }
  2375. #endif
  2376. /**
  2377. * wmi_process_fw_event() - process any fw event
  2378. * @wmi_handle: wmi handle
  2379. * @evt_buf: fw event buffer
  2380. *
  2381. * This function process fw event in caller context
  2382. *
  2383. * Return: none
  2384. */
  2385. void wmi_process_fw_event(struct wmi_unified *wmi_handle, wmi_buf_t evt_buf)
  2386. {
  2387. __wmi_control_rx(wmi_handle, evt_buf);
  2388. }
  2389. /**
  2390. * __wmi_control_rx() - process serialize wmi event callback
  2391. * @wmi_handle: wmi handle
  2392. * @evt_buf: fw event buffer
  2393. *
  2394. * Return: none
  2395. */
  2396. void __wmi_control_rx(struct wmi_unified *wmi_handle, wmi_buf_t evt_buf)
  2397. {
  2398. uint32_t id;
  2399. uint8_t *data;
  2400. uint32_t len;
  2401. void *wmi_cmd_struct_ptr = NULL;
  2402. #ifndef WMI_NON_TLV_SUPPORT
  2403. int tlv_ok_status = 0;
  2404. #endif
  2405. uint32_t idx = 0;
  2406. struct wmi_raw_event_buffer ev_buf;
  2407. enum wmi_rx_buff_type ev_buff_type;
  2408. id = WMI_GET_FIELD(qdf_nbuf_data(evt_buf), WMI_CMD_HDR, COMMANDID);
  2409. wmi_ext_dbg_msg_event_record(wmi_handle, qdf_nbuf_data(evt_buf),
  2410. qdf_nbuf_len(evt_buf));
  2411. if (qdf_nbuf_pull_head(evt_buf, sizeof(WMI_CMD_HDR)) == NULL)
  2412. goto end;
  2413. data = qdf_nbuf_data(evt_buf);
  2414. len = qdf_nbuf_len(evt_buf);
  2415. #ifndef WMI_NON_TLV_SUPPORT
  2416. if (wmi_handle->target_type == WMI_TLV_TARGET) {
  2417. /* Validate and pad(if necessary) the TLVs */
  2418. tlv_ok_status =
  2419. wmi_handle->ops->wmi_check_and_pad_event(wmi_handle->scn_handle,
  2420. data, len, id,
  2421. &wmi_cmd_struct_ptr);
  2422. if (tlv_ok_status != 0) {
  2423. QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_ERROR,
  2424. "%s: Error: id=0x%x, wmitlv check status=%d",
  2425. __func__, id, tlv_ok_status);
  2426. goto end;
  2427. }
  2428. }
  2429. #endif
  2430. idx = wmi_unified_get_event_handler_ix(wmi_handle, id);
  2431. if (idx == A_ERROR) {
  2432. QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_ERROR,
  2433. "%s : event handler is not registered: event id 0x%x",
  2434. __func__, id);
  2435. goto end;
  2436. }
  2437. #ifdef WMI_INTERFACE_EVENT_LOGGING
  2438. if (wmi_handle->log_info.wmi_logging_enable) {
  2439. qdf_spin_lock_bh(&wmi_handle->log_info.wmi_record_lock);
  2440. /* Exclude 4 bytes of TLV header */
  2441. if (wmi_handle->ops->is_diag_event(id)) {
  2442. /*
  2443. * skip diag event logging in WMI event buffer
  2444. * as its already logged in WMI RX event buffer
  2445. */
  2446. } else if (wmi_handle->ops->is_management_record(id)) {
  2447. /*
  2448. * skip wmi mgmt event logging in WMI event buffer
  2449. * as its already logged in WMI RX event buffer
  2450. */
  2451. } else {
  2452. uint8_t *tmpbuf = (uint8_t *)data +
  2453. wmi_handle->soc->buf_offset_event;
  2454. WMI_EVENT_RECORD(wmi_handle, id, tmpbuf);
  2455. wmi_specific_evt_record(wmi_handle, id, tmpbuf);
  2456. }
  2457. qdf_spin_unlock_bh(&wmi_handle->log_info.wmi_record_lock);
  2458. }
  2459. #endif
  2460. /* Call the WMI registered event handler */
  2461. if (wmi_handle->target_type == WMI_TLV_TARGET) {
  2462. ev_buff_type = wmi_handle->ctx[idx].buff_type;
  2463. if (ev_buff_type == WMI_RX_PROCESSED_BUFF) {
  2464. wmi_handle->event_handler[idx] (wmi_handle->scn_handle,
  2465. wmi_cmd_struct_ptr, len);
  2466. } else if (ev_buff_type == WMI_RX_RAW_BUFF) {
  2467. ev_buf.evt_raw_buf = data;
  2468. ev_buf.evt_processed_buf = wmi_cmd_struct_ptr;
  2469. wmi_handle->event_handler[idx] (wmi_handle->scn_handle,
  2470. (void *)&ev_buf, len);
  2471. }
  2472. }
  2473. else
  2474. wmi_handle->event_handler[idx] (wmi_handle->scn_handle,
  2475. data, len);
  2476. end:
  2477. /* Free event buffer and allocated event tlv */
  2478. #ifndef WMI_NON_TLV_SUPPORT
  2479. if (wmi_handle->target_type == WMI_TLV_TARGET)
  2480. wmi_handle->ops->wmi_free_allocated_event(id, &wmi_cmd_struct_ptr);
  2481. #endif
  2482. qdf_nbuf_free(evt_buf);
  2483. }
  2484. #define WMI_WQ_WD_TIMEOUT (30 * 1000) /* 30s */
  2485. static inline void wmi_workqueue_watchdog_warn(uint32_t msg_type_id)
  2486. {
  2487. QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_ERROR,
  2488. "%s: WLAN_BUG_RCA: Message type %x has exceeded its alloted time of %ds",
  2489. __func__, msg_type_id, WMI_WQ_WD_TIMEOUT / 1000);
  2490. }
  2491. #ifdef CONFIG_SLUB_DEBUG_ON
  2492. static void wmi_workqueue_watchdog_bite(void *arg)
  2493. {
  2494. struct wmi_wq_dbg_info *info = arg;
  2495. wmi_workqueue_watchdog_warn(info->wd_msg_type_id);
  2496. qdf_print_thread_trace(info->task);
  2497. QDF_TRACE(QDF_MODULE_ID_QDF, QDF_TRACE_LEVEL_ERROR,
  2498. "%s: Going down for WMI WQ Watchdog Bite!", __func__);
  2499. QDF_BUG(0);
  2500. }
  2501. #else
  2502. static inline void wmi_workqueue_watchdog_bite(void *arg)
  2503. {
  2504. struct wmi_wq_dbg_info *info = arg;
  2505. wmi_workqueue_watchdog_warn(info->wd_msg_type_id);
  2506. qdf_print_thread_trace(info->task);
  2507. }
  2508. #endif
  2509. /**
  2510. * wmi_rx_event_work() - process rx event in rx work queue context
  2511. * @arg: opaque pointer to wmi handle
  2512. *
  2513. * This function process any fw event to serialize it through rx worker thread.
  2514. *
  2515. * Return: none
  2516. */
  2517. static void wmi_rx_event_work(void *arg)
  2518. {
  2519. wmi_buf_t buf;
  2520. struct wmi_unified *wmi = arg;
  2521. qdf_timer_t wd_timer;
  2522. struct wmi_wq_dbg_info info;
  2523. /* initialize WMI workqueue watchdog timer */
  2524. qdf_timer_init(NULL, &wd_timer, &wmi_workqueue_watchdog_bite,
  2525. &info, QDF_TIMER_TYPE_SW);
  2526. qdf_spin_lock_bh(&wmi->eventq_lock);
  2527. buf = qdf_nbuf_queue_remove(&wmi->event_queue);
  2528. qdf_spin_unlock_bh(&wmi->eventq_lock);
  2529. while (buf) {
  2530. qdf_timer_start(&wd_timer, WMI_WQ_WD_TIMEOUT);
  2531. info.wd_msg_type_id =
  2532. WMI_GET_FIELD(qdf_nbuf_data(buf), WMI_CMD_HDR, COMMANDID);
  2533. info.wmi_wq = wmi->wmi_rx_work_queue;
  2534. info.task = qdf_get_current_task();
  2535. __wmi_control_rx(wmi, buf);
  2536. qdf_timer_stop(&wd_timer);
  2537. qdf_spin_lock_bh(&wmi->eventq_lock);
  2538. buf = qdf_nbuf_queue_remove(&wmi->event_queue);
  2539. qdf_spin_unlock_bh(&wmi->eventq_lock);
  2540. }
  2541. qdf_timer_free(&wd_timer);
  2542. }
  2543. /**
  2544. * wmi_rx_diag_event_work() - process rx diag event in work queue context
  2545. * @arg: opaque pointer to wmi handle
  2546. *
  2547. * This function process fw diag event to serialize it through rx worker thread.
  2548. *
  2549. * Return: none
  2550. */
  2551. static void wmi_rx_diag_event_work(void *arg)
  2552. {
  2553. wmi_buf_t buf;
  2554. struct wmi_unified *wmi = arg;
  2555. qdf_timer_t wd_timer;
  2556. struct wmi_wq_dbg_info info;
  2557. uint32_t diag_event_process_count = 0;
  2558. if (!wmi) {
  2559. wmi_err("Invalid WMI handle");
  2560. return;
  2561. }
  2562. /* initialize WMI workqueue watchdog timer */
  2563. qdf_timer_init(NULL, &wd_timer, &wmi_workqueue_watchdog_bite,
  2564. &info, QDF_TIMER_TYPE_SW);
  2565. qdf_spin_lock_bh(&wmi->diag_eventq_lock);
  2566. buf = qdf_nbuf_queue_remove(&wmi->diag_event_queue);
  2567. qdf_spin_unlock_bh(&wmi->diag_eventq_lock);
  2568. while (buf) {
  2569. qdf_timer_start(&wd_timer, WMI_WQ_WD_TIMEOUT);
  2570. info.wd_msg_type_id =
  2571. WMI_GET_FIELD(qdf_nbuf_data(buf), WMI_CMD_HDR, COMMANDID);
  2572. info.wmi_wq = NULL;
  2573. info.task = qdf_get_current_task();
  2574. __wmi_control_rx(wmi, buf);
  2575. qdf_timer_stop(&wd_timer);
  2576. if (diag_event_process_count++ >
  2577. RX_DIAG_EVENT_WORK_PROCESS_MAX_COUNT) {
  2578. qdf_queue_work(0, wmi->wmi_rx_diag_work_queue,
  2579. &wmi->rx_diag_event_work);
  2580. break;
  2581. }
  2582. qdf_spin_lock_bh(&wmi->diag_eventq_lock);
  2583. buf = qdf_nbuf_queue_remove(&wmi->diag_event_queue);
  2584. qdf_spin_unlock_bh(&wmi->diag_eventq_lock);
  2585. }
  2586. qdf_timer_free(&wd_timer);
  2587. }
  2588. #ifdef FEATURE_RUNTIME_PM
  2589. /**
  2590. * wmi_runtime_pm_init() - initialize runtime pm wmi variables
  2591. * @wmi_handle: wmi context
  2592. */
  2593. static void wmi_runtime_pm_init(struct wmi_unified *wmi_handle)
  2594. {
  2595. qdf_atomic_init(&wmi_handle->runtime_pm_inprogress);
  2596. }
  2597. /**
  2598. * wmi_set_runtime_pm_inprogress() - set runtime pm progress flag
  2599. * @wmi_handle: wmi context
  2600. * @val: runtime pm progress flag
  2601. */
  2602. void wmi_set_runtime_pm_inprogress(wmi_unified_t wmi_handle, A_BOOL val)
  2603. {
  2604. qdf_atomic_set(&wmi_handle->runtime_pm_inprogress, val);
  2605. }
  2606. /**
  2607. * wmi_get_runtime_pm_inprogress() - get runtime pm progress flag
  2608. * @wmi_handle: wmi context
  2609. */
  2610. inline bool wmi_get_runtime_pm_inprogress(wmi_unified_t wmi_handle)
  2611. {
  2612. return qdf_atomic_read(&wmi_handle->runtime_pm_inprogress);
  2613. }
  2614. #else
  2615. static void wmi_runtime_pm_init(struct wmi_unified *wmi_handle)
  2616. {
  2617. }
  2618. #endif
  2619. /**
  2620. * wmi_unified_get_soc_handle: Get WMI SoC handle
  2621. * @param wmi_handle: WMI context got from wmi_attach
  2622. *
  2623. * return: Pointer to Soc handle
  2624. */
  2625. void *wmi_unified_get_soc_handle(struct wmi_unified *wmi_handle)
  2626. {
  2627. return wmi_handle->soc;
  2628. }
  2629. /**
  2630. * wmi_interface_logging_init: Interface looging init
  2631. * @param wmi_handle: Pointer to wmi handle object
  2632. *
  2633. * return: None
  2634. */
  2635. #ifdef WMI_INTERFACE_EVENT_LOGGING
  2636. static inline void wmi_interface_logging_init(struct wmi_unified *wmi_handle,
  2637. uint32_t pdev_idx)
  2638. {
  2639. if (QDF_STATUS_SUCCESS == wmi_log_init(wmi_handle)) {
  2640. qdf_spinlock_create(&wmi_handle->log_info.wmi_record_lock);
  2641. wmi_debugfs_init(wmi_handle, pdev_idx);
  2642. }
  2643. }
  2644. #else
  2645. static inline void wmi_interface_logging_init(struct wmi_unified *wmi_handle,
  2646. uint32_t pdev_idx)
  2647. {
  2648. }
  2649. #endif
  2650. static QDF_STATUS wmi_initialize_worker_context(struct wmi_unified *wmi_handle)
  2651. {
  2652. wmi_handle->wmi_rx_work_queue =
  2653. qdf_alloc_unbound_workqueue("wmi_rx_event_work_queue");
  2654. if (!wmi_handle->wmi_rx_work_queue) {
  2655. wmi_err("failed to create wmi_rx_event_work_queue");
  2656. return QDF_STATUS_E_RESOURCES;
  2657. }
  2658. qdf_spinlock_create(&wmi_handle->eventq_lock);
  2659. qdf_nbuf_queue_init(&wmi_handle->event_queue);
  2660. qdf_create_work(0, &wmi_handle->rx_event_work,
  2661. wmi_rx_event_work, wmi_handle);
  2662. wmi_handle->wmi_rx_diag_work_queue =
  2663. qdf_alloc_unbound_workqueue("wmi_rx_diag_event_work_queue");
  2664. if (!wmi_handle->wmi_rx_diag_work_queue) {
  2665. wmi_err("failed to create wmi_rx_diag_event_work_queue");
  2666. return QDF_STATUS_E_RESOURCES;
  2667. }
  2668. qdf_spinlock_create(&wmi_handle->diag_eventq_lock);
  2669. qdf_nbuf_queue_init(&wmi_handle->diag_event_queue);
  2670. qdf_create_work(0, &wmi_handle->rx_diag_event_work,
  2671. wmi_rx_diag_event_work, wmi_handle);
  2672. wmi_handle->wmi_rx_diag_events_dropped = 0;
  2673. return QDF_STATUS_SUCCESS;
  2674. }
  2675. /**
  2676. * wmi_unified_get_pdev_handle: Get WMI SoC handle
  2677. * @param wmi_soc: Pointer to wmi soc object
  2678. * @param pdev_idx: pdev index
  2679. *
  2680. * return: Pointer to wmi handle or NULL on failure
  2681. */
  2682. void *wmi_unified_get_pdev_handle(struct wmi_soc *soc, uint32_t pdev_idx)
  2683. {
  2684. struct wmi_unified *wmi_handle;
  2685. QDF_STATUS status;
  2686. if (pdev_idx >= WMI_MAX_RADIOS)
  2687. return NULL;
  2688. if (!soc->wmi_pdev[pdev_idx]) {
  2689. wmi_handle =
  2690. (struct wmi_unified *) qdf_mem_malloc(
  2691. sizeof(struct wmi_unified));
  2692. if (!wmi_handle)
  2693. return NULL;
  2694. status = wmi_initialize_worker_context(wmi_handle);
  2695. if (QDF_IS_STATUS_ERROR(status))
  2696. goto error;
  2697. wmi_handle->scn_handle = soc->scn_handle;
  2698. wmi_handle->event_id = soc->event_id;
  2699. wmi_handle->event_handler = soc->event_handler;
  2700. wmi_handle->ctx = soc->ctx;
  2701. wmi_handle->ops = soc->ops;
  2702. wmi_handle->wmi_events = soc->wmi_events;
  2703. wmi_handle->services = soc->services;
  2704. wmi_handle->soc = soc;
  2705. wmi_handle->cmd_pdev_id_map = soc->cmd_pdev_id_map;
  2706. wmi_handle->evt_pdev_id_map = soc->evt_pdev_id_map;
  2707. wmi_handle->cmd_phy_id_map = soc->cmd_phy_id_map;
  2708. wmi_handle->evt_phy_id_map = soc->evt_phy_id_map;
  2709. wmi_interface_logging_init(wmi_handle, pdev_idx);
  2710. qdf_atomic_init(&wmi_handle->pending_cmds);
  2711. qdf_atomic_init(&wmi_handle->is_target_suspended);
  2712. wmi_handle->target_type = soc->target_type;
  2713. wmi_handle->wmi_max_cmds = soc->wmi_max_cmds;
  2714. wmi_interface_sequence_init(wmi_handle);
  2715. if (wmi_ext_dbgfs_init(wmi_handle, pdev_idx) !=
  2716. QDF_STATUS_SUCCESS)
  2717. wmi_err("Failed to initialize wmi extended debugfs");
  2718. soc->wmi_pdev[pdev_idx] = wmi_handle;
  2719. } else
  2720. wmi_handle = soc->wmi_pdev[pdev_idx];
  2721. wmi_handle->wmi_stopinprogress = 0;
  2722. wmi_handle->wmi_endpoint_id = soc->wmi_endpoint_id[pdev_idx];
  2723. wmi_handle->htc_handle = soc->htc_handle;
  2724. wmi_handle->max_msg_len = soc->max_msg_len[pdev_idx];
  2725. wmi_handle->tag_crash_inject = false;
  2726. wmi_interface_sequence_reset(wmi_handle);
  2727. return wmi_handle;
  2728. error:
  2729. qdf_mem_free(wmi_handle);
  2730. return NULL;
  2731. }
  2732. qdf_export_symbol(wmi_unified_get_pdev_handle);
  2733. static void (*wmi_attach_register[WMI_MAX_TARGET_TYPE])(wmi_unified_t);
  2734. void wmi_unified_register_module(enum wmi_target_type target_type,
  2735. void (*wmi_attach)(wmi_unified_t wmi_handle))
  2736. {
  2737. if (target_type < WMI_MAX_TARGET_TYPE)
  2738. wmi_attach_register[target_type] = wmi_attach;
  2739. return;
  2740. }
  2741. qdf_export_symbol(wmi_unified_register_module);
  2742. /**
  2743. * wmi_wbuff_register() - register wmi with wbuff
  2744. * @wmi_handle: handle to wmi
  2745. *
  2746. * @Return: void
  2747. */
  2748. static void wmi_wbuff_register(struct wmi_unified *wmi_handle)
  2749. {
  2750. struct wbuff_alloc_request wbuff_alloc[4];
  2751. wbuff_alloc[0].slot = WBUFF_POOL_0;
  2752. wbuff_alloc[0].size = WMI_WBUFF_POOL_0_SIZE;
  2753. wbuff_alloc[1].slot = WBUFF_POOL_1;
  2754. wbuff_alloc[1].size = WMI_WBUFF_POOL_1_SIZE;
  2755. wbuff_alloc[2].slot = WBUFF_POOL_2;
  2756. wbuff_alloc[2].size = WMI_WBUFF_POOL_2_SIZE;
  2757. wbuff_alloc[3].slot = WBUFF_POOL_3;
  2758. wbuff_alloc[3].size = WMI_WBUFF_POOL_3_SIZE;
  2759. wmi_handle->wbuff_handle = wbuff_module_register(wbuff_alloc, 4,
  2760. WMI_MIN_HEAD_ROOM, 4);
  2761. }
  2762. /**
  2763. * wmi_wbuff_deregister() - deregister wmi with wbuff
  2764. * @wmi_handle: handle to wmi
  2765. *
  2766. * @Return: void
  2767. */
  2768. static inline void wmi_wbuff_deregister(struct wmi_unified *wmi_handle)
  2769. {
  2770. wbuff_module_deregister(wmi_handle->wbuff_handle);
  2771. wmi_handle->wbuff_handle = NULL;
  2772. }
  2773. /**
  2774. * wmi_unified_attach() - attach for unified WMI
  2775. * @scn_handle: handle to SCN
  2776. * @osdev: OS device context
  2777. * @target_type: TLV or not-TLV based target
  2778. * @use_cookie: cookie based allocation enabled/disabled
  2779. * @ops: umac rx callbacks
  2780. * @psoc: objmgr psoc
  2781. *
  2782. * @Return: wmi handle.
  2783. */
  2784. void *wmi_unified_attach(void *scn_handle,
  2785. struct wmi_unified_attach_params *param)
  2786. {
  2787. struct wmi_unified *wmi_handle;
  2788. struct wmi_soc *soc;
  2789. QDF_STATUS status;
  2790. soc = (struct wmi_soc *) qdf_mem_malloc(sizeof(struct wmi_soc));
  2791. if (!soc)
  2792. return NULL;
  2793. wmi_handle =
  2794. (struct wmi_unified *) qdf_mem_malloc(
  2795. sizeof(struct wmi_unified));
  2796. if (!wmi_handle) {
  2797. qdf_mem_free(soc);
  2798. return NULL;
  2799. }
  2800. status = wmi_initialize_worker_context(wmi_handle);
  2801. if (QDF_IS_STATUS_ERROR(status))
  2802. goto error;
  2803. wmi_handle->soc = soc;
  2804. wmi_handle->soc->soc_idx = param->soc_id;
  2805. wmi_handle->soc->is_async_ep = param->is_async_ep;
  2806. wmi_handle->event_id = soc->event_id;
  2807. wmi_handle->event_handler = soc->event_handler;
  2808. wmi_handle->ctx = soc->ctx;
  2809. wmi_handle->wmi_events = soc->wmi_events;
  2810. wmi_handle->services = soc->services;
  2811. wmi_handle->scn_handle = scn_handle;
  2812. wmi_handle->cmd_pdev_id_map = soc->cmd_pdev_id_map;
  2813. wmi_handle->evt_pdev_id_map = soc->evt_pdev_id_map;
  2814. wmi_handle->cmd_phy_id_map = soc->cmd_phy_id_map;
  2815. wmi_handle->evt_phy_id_map = soc->evt_phy_id_map;
  2816. soc->scn_handle = scn_handle;
  2817. wmi_handle->target_type = param->target_type;
  2818. soc->target_type = param->target_type;
  2819. if (param->target_type >= WMI_MAX_TARGET_TYPE)
  2820. goto error;
  2821. if (wmi_attach_register[param->target_type]) {
  2822. wmi_attach_register[param->target_type](wmi_handle);
  2823. } else {
  2824. wmi_err("wmi attach is not registered");
  2825. goto error;
  2826. }
  2827. qdf_atomic_init(&wmi_handle->pending_cmds);
  2828. qdf_atomic_init(&wmi_handle->is_target_suspended);
  2829. qdf_atomic_init(&wmi_handle->is_target_suspend_acked);
  2830. qdf_atomic_init(&wmi_handle->num_stats_over_qmi);
  2831. wmi_runtime_pm_init(wmi_handle);
  2832. wmi_interface_logging_init(wmi_handle, WMI_HOST_PDEV_ID_0);
  2833. wmi_interface_sequence_init(wmi_handle);
  2834. /* Assign target cookie capablity */
  2835. wmi_handle->use_cookie = param->use_cookie;
  2836. wmi_handle->osdev = param->osdev;
  2837. wmi_handle->wmi_stopinprogress = 0;
  2838. wmi_handle->wmi_max_cmds = param->max_commands;
  2839. soc->wmi_max_cmds = param->max_commands;
  2840. /* Increase the ref count once refcount infra is present */
  2841. soc->wmi_psoc = param->psoc;
  2842. qdf_spinlock_create(&soc->ctx_lock);
  2843. soc->ops = wmi_handle->ops;
  2844. soc->wmi_pdev[0] = wmi_handle;
  2845. if (wmi_ext_dbgfs_init(wmi_handle, 0) != QDF_STATUS_SUCCESS)
  2846. wmi_err("Failed to initialize wmi extended debugfs");
  2847. wmi_wbuff_register(wmi_handle);
  2848. wmi_hang_event_notifier_register(wmi_handle);
  2849. wmi_minidump_attach(wmi_handle);
  2850. return wmi_handle;
  2851. error:
  2852. qdf_mem_free(soc);
  2853. qdf_mem_free(wmi_handle);
  2854. return NULL;
  2855. }
  2856. /**
  2857. * wmi_unified_detach() - detach for unified WMI
  2858. *
  2859. * @wmi_handle : handle to wmi.
  2860. *
  2861. * @Return: none.
  2862. */
  2863. void wmi_unified_detach(struct wmi_unified *wmi_handle)
  2864. {
  2865. wmi_buf_t buf;
  2866. struct wmi_soc *soc;
  2867. uint8_t i;
  2868. wmi_minidump_detach(wmi_handle);
  2869. wmi_hang_event_notifier_unregister();
  2870. wmi_wbuff_deregister(wmi_handle);
  2871. soc = wmi_handle->soc;
  2872. for (i = 0; i < WMI_MAX_RADIOS; i++) {
  2873. if (soc->wmi_pdev[i]) {
  2874. qdf_flush_workqueue(0,
  2875. soc->wmi_pdev[i]->wmi_rx_work_queue);
  2876. qdf_destroy_workqueue(0,
  2877. soc->wmi_pdev[i]->wmi_rx_work_queue);
  2878. wmi_debugfs_remove(soc->wmi_pdev[i]);
  2879. buf = qdf_nbuf_queue_remove(
  2880. &soc->wmi_pdev[i]->event_queue);
  2881. while (buf) {
  2882. qdf_nbuf_free(buf);
  2883. buf = qdf_nbuf_queue_remove(
  2884. &soc->wmi_pdev[i]->event_queue);
  2885. }
  2886. qdf_flush_work(&soc->wmi_pdev[i]->rx_diag_event_work);
  2887. buf = qdf_nbuf_queue_remove(
  2888. &soc->wmi_pdev[i]->diag_event_queue);
  2889. while (buf) {
  2890. qdf_nbuf_free(buf);
  2891. buf = qdf_nbuf_queue_remove(
  2892. &soc->wmi_pdev[i]->diag_event_queue);
  2893. }
  2894. wmi_log_buffer_free(soc->wmi_pdev[i]);
  2895. /* Free events logs list */
  2896. if (soc->wmi_pdev[i]->events_logs_list)
  2897. qdf_mem_free(
  2898. soc->wmi_pdev[i]->events_logs_list);
  2899. qdf_spinlock_destroy(&soc->wmi_pdev[i]->eventq_lock);
  2900. qdf_spinlock_destroy(
  2901. &soc->wmi_pdev[i]->diag_eventq_lock);
  2902. wmi_interface_sequence_deinit(soc->wmi_pdev[i]);
  2903. wmi_ext_dbgfs_deinit(soc->wmi_pdev[i]);
  2904. qdf_mem_free(soc->wmi_pdev[i]);
  2905. }
  2906. }
  2907. qdf_spinlock_destroy(&soc->ctx_lock);
  2908. if (soc->wmi_service_bitmap) {
  2909. qdf_mem_free(soc->wmi_service_bitmap);
  2910. soc->wmi_service_bitmap = NULL;
  2911. }
  2912. if (soc->wmi_ext_service_bitmap) {
  2913. qdf_mem_free(soc->wmi_ext_service_bitmap);
  2914. soc->wmi_ext_service_bitmap = NULL;
  2915. }
  2916. if (soc->wmi_ext2_service_bitmap) {
  2917. qdf_mem_free(soc->wmi_ext2_service_bitmap);
  2918. soc->wmi_ext2_service_bitmap = NULL;
  2919. }
  2920. /* Decrease the ref count once refcount infra is present */
  2921. soc->wmi_psoc = NULL;
  2922. qdf_mem_free(soc);
  2923. }
  2924. /**
  2925. * wmi_unified_remove_work() - detach for WMI work
  2926. * @wmi_handle: handle to WMI
  2927. *
  2928. * A function that does not fully detach WMI, but just remove work
  2929. * queue items associated with it. This is used to make sure that
  2930. * before any other processing code that may destroy related contexts
  2931. * (HTC, etc), work queue processing on WMI has already been stopped.
  2932. *
  2933. * Return: None
  2934. */
  2935. void
  2936. wmi_unified_remove_work(struct wmi_unified *wmi_handle)
  2937. {
  2938. wmi_buf_t buf;
  2939. qdf_flush_workqueue(0, wmi_handle->wmi_rx_work_queue);
  2940. qdf_spin_lock_bh(&wmi_handle->eventq_lock);
  2941. buf = qdf_nbuf_queue_remove(&wmi_handle->event_queue);
  2942. while (buf) {
  2943. qdf_nbuf_free(buf);
  2944. buf = qdf_nbuf_queue_remove(&wmi_handle->event_queue);
  2945. }
  2946. qdf_spin_unlock_bh(&wmi_handle->eventq_lock);
  2947. /* Remove diag events work */
  2948. qdf_flush_workqueue(0, wmi_handle->wmi_rx_diag_work_queue);
  2949. qdf_spin_lock_bh(&wmi_handle->diag_eventq_lock);
  2950. buf = qdf_nbuf_queue_remove(&wmi_handle->diag_event_queue);
  2951. while (buf) {
  2952. qdf_nbuf_free(buf);
  2953. buf = qdf_nbuf_queue_remove(&wmi_handle->diag_event_queue);
  2954. }
  2955. qdf_spin_unlock_bh(&wmi_handle->diag_eventq_lock);
  2956. }
  2957. /**
  2958. * wmi_htc_tx_complete() - Process htc tx completion
  2959. *
  2960. * @ctx: handle to wmi
  2961. * @htc_packet: pointer to htc packet
  2962. *
  2963. * @Return: none.
  2964. */
  2965. static void wmi_htc_tx_complete(void *ctx, HTC_PACKET *htc_pkt)
  2966. {
  2967. struct wmi_soc *soc = (struct wmi_soc *) ctx;
  2968. wmi_buf_t wmi_cmd_buf = GET_HTC_PACKET_NET_BUF_CONTEXT(htc_pkt);
  2969. u_int8_t *buf_ptr;
  2970. u_int32_t len;
  2971. struct wmi_unified *wmi_handle;
  2972. #ifdef WMI_INTERFACE_EVENT_LOGGING
  2973. struct wmi_debug_log_info *log_info;
  2974. uint32_t cmd_id;
  2975. uint8_t *offset_ptr;
  2976. qdf_dma_addr_t dma_addr;
  2977. uint64_t phy_addr;
  2978. #endif
  2979. ASSERT(wmi_cmd_buf);
  2980. wmi_handle = wmi_get_pdev_ep(soc, htc_pkt->Endpoint);
  2981. if (!wmi_handle) {
  2982. wmi_err("Unable to get wmi handle");
  2983. QDF_ASSERT(0);
  2984. return;
  2985. }
  2986. buf_ptr = (u_int8_t *)wmi_buf_data(wmi_cmd_buf);
  2987. #ifdef WMI_INTERFACE_EVENT_LOGGING
  2988. log_info = &wmi_handle->log_info;
  2989. if (wmi_handle && log_info->wmi_logging_enable) {
  2990. cmd_id = WMI_GET_FIELD(qdf_nbuf_data(wmi_cmd_buf),
  2991. WMI_CMD_HDR, COMMANDID);
  2992. dma_addr = QDF_NBUF_CB_PADDR(wmi_cmd_buf);
  2993. phy_addr = qdf_mem_virt_to_phys(qdf_nbuf_data(wmi_cmd_buf));
  2994. qdf_spin_lock_bh(&log_info->wmi_record_lock);
  2995. /* Record 16 bytes of WMI cmd tx complete data
  2996. * - exclude TLV and WMI headers
  2997. */
  2998. offset_ptr = buf_ptr + wmi_handle->soc->buf_offset_command;
  2999. if (wmi_handle->ops->is_management_record(cmd_id)) {
  3000. WMI_MGMT_COMMAND_TX_CMP_RECORD(wmi_handle, cmd_id,
  3001. offset_ptr);
  3002. } else {
  3003. WMI_COMMAND_TX_CMP_RECORD(wmi_handle, cmd_id,
  3004. offset_ptr, dma_addr,
  3005. phy_addr);
  3006. }
  3007. qdf_spin_unlock_bh(&log_info->wmi_record_lock);
  3008. }
  3009. #endif
  3010. wmi_interface_sequence_check(wmi_handle, wmi_cmd_buf);
  3011. len = qdf_nbuf_len(wmi_cmd_buf);
  3012. qdf_mem_zero(buf_ptr, len);
  3013. wmi_buf_free(wmi_cmd_buf);
  3014. qdf_mem_free(htc_pkt);
  3015. qdf_atomic_dec(&wmi_handle->pending_cmds);
  3016. }
  3017. #ifdef FEATURE_RUNTIME_PM
  3018. /**
  3019. * wmi_htc_log_pkt() - Print information of WMI command from HTC packet
  3020. *
  3021. * @ctx: handle of WMI context
  3022. * @htc_pkt: handle of HTC packet
  3023. *
  3024. * @Return: none
  3025. */
  3026. static void wmi_htc_log_pkt(void *ctx, HTC_PACKET *htc_pkt)
  3027. {
  3028. wmi_buf_t wmi_cmd_buf = GET_HTC_PACKET_NET_BUF_CONTEXT(htc_pkt);
  3029. uint32_t cmd_id;
  3030. ASSERT(wmi_cmd_buf);
  3031. cmd_id = WMI_GET_FIELD(qdf_nbuf_data(wmi_cmd_buf), WMI_CMD_HDR,
  3032. COMMANDID);
  3033. wmi_debug("WMI command from HTC packet: %s, ID: %d",
  3034. wmi_id_to_name(cmd_id), cmd_id);
  3035. }
  3036. #else
  3037. static void wmi_htc_log_pkt(void *ctx, HTC_PACKET *htc_pkt)
  3038. {
  3039. }
  3040. #endif
  3041. /**
  3042. * wmi_connect_pdev_htc_service() - WMI API to get connect to HTC service
  3043. *
  3044. * @wmi_handle: handle to WMI.
  3045. * @pdev_idx: Pdev index
  3046. *
  3047. * @Return: QDF_STATUS
  3048. */
  3049. static QDF_STATUS wmi_connect_pdev_htc_service(struct wmi_soc *soc,
  3050. uint32_t pdev_idx)
  3051. {
  3052. QDF_STATUS status;
  3053. struct htc_service_connect_resp response;
  3054. struct htc_service_connect_req connect;
  3055. OS_MEMZERO(&connect, sizeof(connect));
  3056. OS_MEMZERO(&response, sizeof(response));
  3057. /* meta data is unused for now */
  3058. connect.pMetaData = NULL;
  3059. connect.MetaDataLength = 0;
  3060. /* these fields are the same for all service endpoints */
  3061. connect.EpCallbacks.pContext = soc;
  3062. connect.EpCallbacks.EpTxCompleteMultiple =
  3063. NULL /* Control path completion ar6000_tx_complete */;
  3064. connect.EpCallbacks.EpRecv = wmi_control_rx /* Control path rx */;
  3065. connect.EpCallbacks.EpRecvRefill = NULL /* ar6000_rx_refill */;
  3066. connect.EpCallbacks.EpSendFull = NULL /* ar6000_tx_queue_full */;
  3067. connect.EpCallbacks.EpTxComplete =
  3068. wmi_htc_tx_complete /* ar6000_tx_queue_full */;
  3069. connect.EpCallbacks.ep_log_pkt = wmi_htc_log_pkt;
  3070. /* connect to control service */
  3071. connect.service_id = soc->svc_ids[pdev_idx];
  3072. status = htc_connect_service(soc->htc_handle, &connect, &response);
  3073. if (QDF_IS_STATUS_ERROR(status)) {
  3074. wmi_err("Failed to connect to WMI CONTROL service status:%d",
  3075. status);
  3076. return status;
  3077. }
  3078. if (soc->is_async_ep)
  3079. htc_set_async_ep(soc->htc_handle, response.Endpoint, true);
  3080. soc->wmi_endpoint_id[pdev_idx] = response.Endpoint;
  3081. soc->max_msg_len[pdev_idx] = response.MaxMsgLength;
  3082. return QDF_STATUS_SUCCESS;
  3083. }
  3084. QDF_STATUS
  3085. wmi_unified_connect_htc_service(struct wmi_unified *wmi_handle,
  3086. HTC_HANDLE htc_handle)
  3087. {
  3088. uint32_t i;
  3089. uint8_t wmi_ep_count;
  3090. wmi_handle->soc->htc_handle = htc_handle;
  3091. wmi_ep_count = htc_get_wmi_endpoint_count(htc_handle);
  3092. if (wmi_ep_count > WMI_MAX_RADIOS)
  3093. return QDF_STATUS_E_FAULT;
  3094. for (i = 0; i < wmi_ep_count; i++)
  3095. wmi_connect_pdev_htc_service(wmi_handle->soc, i);
  3096. wmi_handle->htc_handle = htc_handle;
  3097. wmi_handle->wmi_endpoint_id = wmi_handle->soc->wmi_endpoint_id[0];
  3098. wmi_handle->max_msg_len = wmi_handle->soc->max_msg_len[0];
  3099. return QDF_STATUS_SUCCESS;
  3100. }
  3101. #if defined(WLAN_FEATURE_WMI_DIAG_OVER_CE7) || \
  3102. defined(WLAN_DIAG_AND_DBR_OVER_SEPARATE_CE)
  3103. QDF_STATUS wmi_diag_connect_pdev_htc_service(struct wmi_unified *wmi_handle,
  3104. HTC_HANDLE htc_handle)
  3105. {
  3106. QDF_STATUS status;
  3107. struct htc_service_connect_resp response = {0};
  3108. struct htc_service_connect_req connect = {0};
  3109. /* meta data is unused for now */
  3110. connect.pMetaData = NULL;
  3111. connect.MetaDataLength = 0;
  3112. connect.EpCallbacks.pContext = wmi_handle->soc;
  3113. connect.EpCallbacks.EpTxCompleteMultiple = NULL;
  3114. connect.EpCallbacks.EpRecv = wmi_control_diag_rx /* wmi diag rx */;
  3115. connect.EpCallbacks.EpRecvRefill = NULL;
  3116. connect.EpCallbacks.EpSendFull = NULL;
  3117. connect.EpCallbacks.EpTxComplete = NULL;
  3118. connect.EpCallbacks.ep_log_pkt = wmi_htc_log_pkt;
  3119. /* connect to wmi diag service */
  3120. connect.service_id = WMI_CONTROL_DIAG_SVC;
  3121. status = htc_connect_service(htc_handle, &connect, &response);
  3122. if (QDF_IS_STATUS_ERROR(status)) {
  3123. wmi_err("Failed to connect to WMI DIAG service status:%d",
  3124. status);
  3125. return status;
  3126. }
  3127. if (wmi_handle->soc->is_async_ep)
  3128. htc_set_async_ep(htc_handle, response.Endpoint, true);
  3129. wmi_handle->soc->wmi_diag_endpoint_id = response.Endpoint;
  3130. return QDF_STATUS_SUCCESS;
  3131. }
  3132. #endif
  3133. /**
  3134. * wmi_get_host_credits() - WMI API to get updated host_credits
  3135. *
  3136. * @wmi_handle: handle to WMI.
  3137. *
  3138. * @Return: updated host_credits.
  3139. */
  3140. int wmi_get_host_credits(wmi_unified_t wmi_handle)
  3141. {
  3142. int host_credits = 0;
  3143. htc_get_control_endpoint_tx_host_credits(wmi_handle->htc_handle,
  3144. &host_credits);
  3145. return host_credits;
  3146. }
  3147. /**
  3148. * wmi_get_pending_cmds() - WMI API to get WMI Pending Commands in the HTC
  3149. * queue
  3150. *
  3151. * @wmi_handle: handle to WMI.
  3152. *
  3153. * @Return: Pending Commands in the HTC queue.
  3154. */
  3155. int wmi_get_pending_cmds(wmi_unified_t wmi_handle)
  3156. {
  3157. return qdf_atomic_read(&wmi_handle->pending_cmds);
  3158. }
  3159. /**
  3160. * wmi_set_target_suspend() - WMI API to set target suspend state
  3161. *
  3162. * @wmi_handle: handle to WMI.
  3163. * @val: suspend state boolean.
  3164. *
  3165. * @Return: none.
  3166. */
  3167. void wmi_set_target_suspend(wmi_unified_t wmi_handle, A_BOOL val)
  3168. {
  3169. qdf_atomic_set(&wmi_handle->is_target_suspended, val);
  3170. }
  3171. /**
  3172. * wmi_set_target_suspend_acked() - WMI API to set target suspend acked flag
  3173. *
  3174. * @wmi_handle: handle to WMI.
  3175. * @val: target suspend command acked flag.
  3176. *
  3177. * @Return: none.
  3178. */
  3179. void wmi_set_target_suspend_acked(wmi_unified_t wmi_handle, A_BOOL val)
  3180. {
  3181. qdf_atomic_set(&wmi_handle->is_target_suspend_acked, val);
  3182. qdf_atomic_set(&wmi_handle->num_stats_over_qmi, 0);
  3183. }
  3184. /**
  3185. * wmi_is_target_suspended() - WMI API to check target suspend state
  3186. * @wmi_handle: handle to WMI.
  3187. *
  3188. * WMI API to check target suspend state
  3189. *
  3190. * Return: true if target is suspended, else false.
  3191. */
  3192. bool wmi_is_target_suspended(struct wmi_unified *wmi_handle)
  3193. {
  3194. return qdf_atomic_read(&wmi_handle->is_target_suspended);
  3195. }
  3196. qdf_export_symbol(wmi_is_target_suspended);
  3197. /**
  3198. * wmi_is_target_suspend_acked() - WMI API to check target suspend command is
  3199. * acked or not
  3200. * @wmi_handle: handle to WMI.
  3201. *
  3202. * WMI API to check whether the target suspend command is acked or not
  3203. *
  3204. * Return: true if target suspend command is acked, else false.
  3205. */
  3206. bool wmi_is_target_suspend_acked(struct wmi_unified *wmi_handle)
  3207. {
  3208. return qdf_atomic_read(&wmi_handle->is_target_suspend_acked);
  3209. }
  3210. qdf_export_symbol(wmi_is_target_suspend_acked);
  3211. #ifdef WLAN_FEATURE_WMI_SEND_RECV_QMI
  3212. void wmi_set_qmi_stats(wmi_unified_t wmi_handle, bool val)
  3213. {
  3214. wmi_handle->is_qmi_stats_enabled = val;
  3215. }
  3216. bool wmi_is_qmi_stats_enabled(struct wmi_unified *wmi_handle)
  3217. {
  3218. return wmi_handle->is_qmi_stats_enabled;
  3219. }
  3220. #endif
  3221. /**
  3222. * WMI API to set crash injection state
  3223. * @param wmi_handle: handle to WMI.
  3224. * @param val: crash injection state boolean.
  3225. */
  3226. void wmi_tag_crash_inject(wmi_unified_t wmi_handle, A_BOOL flag)
  3227. {
  3228. wmi_handle->tag_crash_inject = flag;
  3229. }
  3230. /**
  3231. * WMI API to set bus suspend state
  3232. * @param wmi_handle: handle to WMI.
  3233. * @param val: suspend state boolean.
  3234. */
  3235. void wmi_set_is_wow_bus_suspended(wmi_unified_t wmi_handle, A_BOOL val)
  3236. {
  3237. qdf_atomic_set(&wmi_handle->is_wow_bus_suspended, val);
  3238. }
  3239. void wmi_set_tgt_assert(wmi_unified_t wmi_handle, bool val)
  3240. {
  3241. wmi_handle->tgt_force_assert_enable = val;
  3242. }
  3243. /**
  3244. * wmi_stop() - generic function to block unified WMI command
  3245. * @wmi_handle: handle to WMI.
  3246. *
  3247. * @Return: success always.
  3248. */
  3249. int
  3250. wmi_stop(wmi_unified_t wmi_handle)
  3251. {
  3252. QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_INFO,
  3253. "WMI Stop");
  3254. wmi_handle->wmi_stopinprogress = 1;
  3255. return 0;
  3256. }
  3257. /**
  3258. * wmi_start() - generic function to allow unified WMI command
  3259. * @wmi_handle: handle to WMI.
  3260. *
  3261. * @Return: success always.
  3262. */
  3263. int
  3264. wmi_start(wmi_unified_t wmi_handle)
  3265. {
  3266. QDF_TRACE(QDF_MODULE_ID_WMI, QDF_TRACE_LEVEL_INFO,
  3267. "WMI Start");
  3268. wmi_handle->wmi_stopinprogress = 0;
  3269. return 0;
  3270. }
  3271. /**
  3272. * wmi_is_blocked() - generic function to check if WMI is blocked
  3273. * @wmi_handle: handle to WMI.
  3274. *
  3275. * @Return: true, if blocked, false if not blocked
  3276. */
  3277. bool
  3278. wmi_is_blocked(wmi_unified_t wmi_handle)
  3279. {
  3280. return (!(!wmi_handle->wmi_stopinprogress));
  3281. }
  3282. /**
  3283. * API to flush all the previous packets associated with the wmi endpoint
  3284. *
  3285. * @param wmi_handle : handle to WMI.
  3286. */
  3287. void
  3288. wmi_flush_endpoint(wmi_unified_t wmi_handle)
  3289. {
  3290. htc_flush_endpoint(wmi_handle->htc_handle,
  3291. wmi_handle->wmi_endpoint_id, 0);
  3292. }
  3293. qdf_export_symbol(wmi_flush_endpoint);
  3294. /**
  3295. * wmi_pdev_id_conversion_enable() - API to enable pdev_id/phy_id conversion
  3296. * in WMI. By default pdev_id conversion is not done in WMI.
  3297. * This API can be used enable conversion in WMI.
  3298. * @param wmi_handle : handle to WMI
  3299. * @param pdev_map : pointer to pdev_map
  3300. * @size : size of pdev_id_map
  3301. * Return none
  3302. */
  3303. void wmi_pdev_id_conversion_enable(wmi_unified_t wmi_handle,
  3304. uint32_t *pdev_id_map,
  3305. uint8_t size)
  3306. {
  3307. if (wmi_handle->target_type == WMI_TLV_TARGET)
  3308. wmi_handle->ops->wmi_pdev_id_conversion_enable(wmi_handle,
  3309. pdev_id_map,
  3310. size);
  3311. }
  3312. int __wmi_validate_handle(wmi_unified_t wmi_handle, const char *func)
  3313. {
  3314. if (!wmi_handle) {
  3315. wmi_err("Invalid WMI handle (via %s)", func);
  3316. return -EINVAL;
  3317. }
  3318. return 0;
  3319. }