wmi.c 81 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776
  1. /*
  2. * Copyright (c) 2005-2011 Atheros Communications Inc.
  3. * Copyright (c) 2011-2013 Qualcomm Atheros, Inc.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for any
  6. * purpose with or without fee is hereby granted, provided that the above
  7. * copyright notice and this permission notice appear in all copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  10. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  11. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  12. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  13. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  14. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  15. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  16. */
  17. #include <linux/skbuff.h>
  18. #include "core.h"
  19. #include "htc.h"
  20. #include "debug.h"
  21. #include "wmi.h"
  22. #include "mac.h"
  23. /* MAIN WMI cmd track */
  24. static struct wmi_cmd_map wmi_cmd_map = {
  25. .init_cmdid = WMI_INIT_CMDID,
  26. .start_scan_cmdid = WMI_START_SCAN_CMDID,
  27. .stop_scan_cmdid = WMI_STOP_SCAN_CMDID,
  28. .scan_chan_list_cmdid = WMI_SCAN_CHAN_LIST_CMDID,
  29. .scan_sch_prio_tbl_cmdid = WMI_SCAN_SCH_PRIO_TBL_CMDID,
  30. .pdev_set_regdomain_cmdid = WMI_PDEV_SET_REGDOMAIN_CMDID,
  31. .pdev_set_channel_cmdid = WMI_PDEV_SET_CHANNEL_CMDID,
  32. .pdev_set_param_cmdid = WMI_PDEV_SET_PARAM_CMDID,
  33. .pdev_pktlog_enable_cmdid = WMI_PDEV_PKTLOG_ENABLE_CMDID,
  34. .pdev_pktlog_disable_cmdid = WMI_PDEV_PKTLOG_DISABLE_CMDID,
  35. .pdev_set_wmm_params_cmdid = WMI_PDEV_SET_WMM_PARAMS_CMDID,
  36. .pdev_set_ht_cap_ie_cmdid = WMI_PDEV_SET_HT_CAP_IE_CMDID,
  37. .pdev_set_vht_cap_ie_cmdid = WMI_PDEV_SET_VHT_CAP_IE_CMDID,
  38. .pdev_set_dscp_tid_map_cmdid = WMI_PDEV_SET_DSCP_TID_MAP_CMDID,
  39. .pdev_set_quiet_mode_cmdid = WMI_PDEV_SET_QUIET_MODE_CMDID,
  40. .pdev_green_ap_ps_enable_cmdid = WMI_PDEV_GREEN_AP_PS_ENABLE_CMDID,
  41. .pdev_get_tpc_config_cmdid = WMI_PDEV_GET_TPC_CONFIG_CMDID,
  42. .pdev_set_base_macaddr_cmdid = WMI_PDEV_SET_BASE_MACADDR_CMDID,
  43. .vdev_create_cmdid = WMI_VDEV_CREATE_CMDID,
  44. .vdev_delete_cmdid = WMI_VDEV_DELETE_CMDID,
  45. .vdev_start_request_cmdid = WMI_VDEV_START_REQUEST_CMDID,
  46. .vdev_restart_request_cmdid = WMI_VDEV_RESTART_REQUEST_CMDID,
  47. .vdev_up_cmdid = WMI_VDEV_UP_CMDID,
  48. .vdev_stop_cmdid = WMI_VDEV_STOP_CMDID,
  49. .vdev_down_cmdid = WMI_VDEV_DOWN_CMDID,
  50. .vdev_set_param_cmdid = WMI_VDEV_SET_PARAM_CMDID,
  51. .vdev_install_key_cmdid = WMI_VDEV_INSTALL_KEY_CMDID,
  52. .peer_create_cmdid = WMI_PEER_CREATE_CMDID,
  53. .peer_delete_cmdid = WMI_PEER_DELETE_CMDID,
  54. .peer_flush_tids_cmdid = WMI_PEER_FLUSH_TIDS_CMDID,
  55. .peer_set_param_cmdid = WMI_PEER_SET_PARAM_CMDID,
  56. .peer_assoc_cmdid = WMI_PEER_ASSOC_CMDID,
  57. .peer_add_wds_entry_cmdid = WMI_PEER_ADD_WDS_ENTRY_CMDID,
  58. .peer_remove_wds_entry_cmdid = WMI_PEER_REMOVE_WDS_ENTRY_CMDID,
  59. .peer_mcast_group_cmdid = WMI_PEER_MCAST_GROUP_CMDID,
  60. .bcn_tx_cmdid = WMI_BCN_TX_CMDID,
  61. .pdev_send_bcn_cmdid = WMI_PDEV_SEND_BCN_CMDID,
  62. .bcn_tmpl_cmdid = WMI_BCN_TMPL_CMDID,
  63. .bcn_filter_rx_cmdid = WMI_BCN_FILTER_RX_CMDID,
  64. .prb_req_filter_rx_cmdid = WMI_PRB_REQ_FILTER_RX_CMDID,
  65. .mgmt_tx_cmdid = WMI_MGMT_TX_CMDID,
  66. .prb_tmpl_cmdid = WMI_PRB_TMPL_CMDID,
  67. .addba_clear_resp_cmdid = WMI_ADDBA_CLEAR_RESP_CMDID,
  68. .addba_send_cmdid = WMI_ADDBA_SEND_CMDID,
  69. .addba_status_cmdid = WMI_ADDBA_STATUS_CMDID,
  70. .delba_send_cmdid = WMI_DELBA_SEND_CMDID,
  71. .addba_set_resp_cmdid = WMI_ADDBA_SET_RESP_CMDID,
  72. .send_singleamsdu_cmdid = WMI_SEND_SINGLEAMSDU_CMDID,
  73. .sta_powersave_mode_cmdid = WMI_STA_POWERSAVE_MODE_CMDID,
  74. .sta_powersave_param_cmdid = WMI_STA_POWERSAVE_PARAM_CMDID,
  75. .sta_mimo_ps_mode_cmdid = WMI_STA_MIMO_PS_MODE_CMDID,
  76. .pdev_dfs_enable_cmdid = WMI_PDEV_DFS_ENABLE_CMDID,
  77. .pdev_dfs_disable_cmdid = WMI_PDEV_DFS_DISABLE_CMDID,
  78. .roam_scan_mode = WMI_ROAM_SCAN_MODE,
  79. .roam_scan_rssi_threshold = WMI_ROAM_SCAN_RSSI_THRESHOLD,
  80. .roam_scan_period = WMI_ROAM_SCAN_PERIOD,
  81. .roam_scan_rssi_change_threshold = WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD,
  82. .roam_ap_profile = WMI_ROAM_AP_PROFILE,
  83. .ofl_scan_add_ap_profile = WMI_ROAM_AP_PROFILE,
  84. .ofl_scan_remove_ap_profile = WMI_OFL_SCAN_REMOVE_AP_PROFILE,
  85. .ofl_scan_period = WMI_OFL_SCAN_PERIOD,
  86. .p2p_dev_set_device_info = WMI_P2P_DEV_SET_DEVICE_INFO,
  87. .p2p_dev_set_discoverability = WMI_P2P_DEV_SET_DISCOVERABILITY,
  88. .p2p_go_set_beacon_ie = WMI_P2P_GO_SET_BEACON_IE,
  89. .p2p_go_set_probe_resp_ie = WMI_P2P_GO_SET_PROBE_RESP_IE,
  90. .p2p_set_vendor_ie_data_cmdid = WMI_P2P_SET_VENDOR_IE_DATA_CMDID,
  91. .ap_ps_peer_param_cmdid = WMI_AP_PS_PEER_PARAM_CMDID,
  92. .ap_ps_peer_uapsd_coex_cmdid = WMI_AP_PS_PEER_UAPSD_COEX_CMDID,
  93. .peer_rate_retry_sched_cmdid = WMI_PEER_RATE_RETRY_SCHED_CMDID,
  94. .wlan_profile_trigger_cmdid = WMI_WLAN_PROFILE_TRIGGER_CMDID,
  95. .wlan_profile_set_hist_intvl_cmdid =
  96. WMI_WLAN_PROFILE_SET_HIST_INTVL_CMDID,
  97. .wlan_profile_get_profile_data_cmdid =
  98. WMI_WLAN_PROFILE_GET_PROFILE_DATA_CMDID,
  99. .wlan_profile_enable_profile_id_cmdid =
  100. WMI_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID,
  101. .wlan_profile_list_profile_id_cmdid =
  102. WMI_WLAN_PROFILE_LIST_PROFILE_ID_CMDID,
  103. .pdev_suspend_cmdid = WMI_PDEV_SUSPEND_CMDID,
  104. .pdev_resume_cmdid = WMI_PDEV_RESUME_CMDID,
  105. .add_bcn_filter_cmdid = WMI_ADD_BCN_FILTER_CMDID,
  106. .rmv_bcn_filter_cmdid = WMI_RMV_BCN_FILTER_CMDID,
  107. .wow_add_wake_pattern_cmdid = WMI_WOW_ADD_WAKE_PATTERN_CMDID,
  108. .wow_del_wake_pattern_cmdid = WMI_WOW_DEL_WAKE_PATTERN_CMDID,
  109. .wow_enable_disable_wake_event_cmdid =
  110. WMI_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID,
  111. .wow_enable_cmdid = WMI_WOW_ENABLE_CMDID,
  112. .wow_hostwakeup_from_sleep_cmdid = WMI_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID,
  113. .rtt_measreq_cmdid = WMI_RTT_MEASREQ_CMDID,
  114. .rtt_tsf_cmdid = WMI_RTT_TSF_CMDID,
  115. .vdev_spectral_scan_configure_cmdid =
  116. WMI_VDEV_SPECTRAL_SCAN_CONFIGURE_CMDID,
  117. .vdev_spectral_scan_enable_cmdid = WMI_VDEV_SPECTRAL_SCAN_ENABLE_CMDID,
  118. .request_stats_cmdid = WMI_REQUEST_STATS_CMDID,
  119. .set_arp_ns_offload_cmdid = WMI_SET_ARP_NS_OFFLOAD_CMDID,
  120. .network_list_offload_config_cmdid =
  121. WMI_NETWORK_LIST_OFFLOAD_CONFIG_CMDID,
  122. .gtk_offload_cmdid = WMI_GTK_OFFLOAD_CMDID,
  123. .csa_offload_enable_cmdid = WMI_CSA_OFFLOAD_ENABLE_CMDID,
  124. .csa_offload_chanswitch_cmdid = WMI_CSA_OFFLOAD_CHANSWITCH_CMDID,
  125. .chatter_set_mode_cmdid = WMI_CHATTER_SET_MODE_CMDID,
  126. .peer_tid_addba_cmdid = WMI_PEER_TID_ADDBA_CMDID,
  127. .peer_tid_delba_cmdid = WMI_PEER_TID_DELBA_CMDID,
  128. .sta_dtim_ps_method_cmdid = WMI_STA_DTIM_PS_METHOD_CMDID,
  129. .sta_uapsd_auto_trig_cmdid = WMI_STA_UAPSD_AUTO_TRIG_CMDID,
  130. .sta_keepalive_cmd = WMI_STA_KEEPALIVE_CMD,
  131. .echo_cmdid = WMI_ECHO_CMDID,
  132. .pdev_utf_cmdid = WMI_PDEV_UTF_CMDID,
  133. .dbglog_cfg_cmdid = WMI_DBGLOG_CFG_CMDID,
  134. .pdev_qvit_cmdid = WMI_PDEV_QVIT_CMDID,
  135. .pdev_ftm_intg_cmdid = WMI_PDEV_FTM_INTG_CMDID,
  136. .vdev_set_keepalive_cmdid = WMI_VDEV_SET_KEEPALIVE_CMDID,
  137. .vdev_get_keepalive_cmdid = WMI_VDEV_GET_KEEPALIVE_CMDID,
  138. .force_fw_hang_cmdid = WMI_FORCE_FW_HANG_CMDID,
  139. .gpio_config_cmdid = WMI_GPIO_CONFIG_CMDID,
  140. .gpio_output_cmdid = WMI_GPIO_OUTPUT_CMDID,
  141. };
  142. /* 10.X WMI cmd track */
  143. static struct wmi_cmd_map wmi_10x_cmd_map = {
  144. .init_cmdid = WMI_10X_INIT_CMDID,
  145. .start_scan_cmdid = WMI_10X_START_SCAN_CMDID,
  146. .stop_scan_cmdid = WMI_10X_STOP_SCAN_CMDID,
  147. .scan_chan_list_cmdid = WMI_10X_SCAN_CHAN_LIST_CMDID,
  148. .scan_sch_prio_tbl_cmdid = WMI_CMD_UNDEFINED,
  149. .pdev_set_regdomain_cmdid = WMI_10X_PDEV_SET_REGDOMAIN_CMDID,
  150. .pdev_set_channel_cmdid = WMI_10X_PDEV_SET_CHANNEL_CMDID,
  151. .pdev_set_param_cmdid = WMI_10X_PDEV_SET_PARAM_CMDID,
  152. .pdev_pktlog_enable_cmdid = WMI_10X_PDEV_PKTLOG_ENABLE_CMDID,
  153. .pdev_pktlog_disable_cmdid = WMI_10X_PDEV_PKTLOG_DISABLE_CMDID,
  154. .pdev_set_wmm_params_cmdid = WMI_10X_PDEV_SET_WMM_PARAMS_CMDID,
  155. .pdev_set_ht_cap_ie_cmdid = WMI_10X_PDEV_SET_HT_CAP_IE_CMDID,
  156. .pdev_set_vht_cap_ie_cmdid = WMI_10X_PDEV_SET_VHT_CAP_IE_CMDID,
  157. .pdev_set_dscp_tid_map_cmdid = WMI_10X_PDEV_SET_DSCP_TID_MAP_CMDID,
  158. .pdev_set_quiet_mode_cmdid = WMI_10X_PDEV_SET_QUIET_MODE_CMDID,
  159. .pdev_green_ap_ps_enable_cmdid = WMI_10X_PDEV_GREEN_AP_PS_ENABLE_CMDID,
  160. .pdev_get_tpc_config_cmdid = WMI_10X_PDEV_GET_TPC_CONFIG_CMDID,
  161. .pdev_set_base_macaddr_cmdid = WMI_10X_PDEV_SET_BASE_MACADDR_CMDID,
  162. .vdev_create_cmdid = WMI_10X_VDEV_CREATE_CMDID,
  163. .vdev_delete_cmdid = WMI_10X_VDEV_DELETE_CMDID,
  164. .vdev_start_request_cmdid = WMI_10X_VDEV_START_REQUEST_CMDID,
  165. .vdev_restart_request_cmdid = WMI_10X_VDEV_RESTART_REQUEST_CMDID,
  166. .vdev_up_cmdid = WMI_10X_VDEV_UP_CMDID,
  167. .vdev_stop_cmdid = WMI_10X_VDEV_STOP_CMDID,
  168. .vdev_down_cmdid = WMI_10X_VDEV_DOWN_CMDID,
  169. .vdev_set_param_cmdid = WMI_10X_VDEV_SET_PARAM_CMDID,
  170. .vdev_install_key_cmdid = WMI_10X_VDEV_INSTALL_KEY_CMDID,
  171. .peer_create_cmdid = WMI_10X_PEER_CREATE_CMDID,
  172. .peer_delete_cmdid = WMI_10X_PEER_DELETE_CMDID,
  173. .peer_flush_tids_cmdid = WMI_10X_PEER_FLUSH_TIDS_CMDID,
  174. .peer_set_param_cmdid = WMI_10X_PEER_SET_PARAM_CMDID,
  175. .peer_assoc_cmdid = WMI_10X_PEER_ASSOC_CMDID,
  176. .peer_add_wds_entry_cmdid = WMI_10X_PEER_ADD_WDS_ENTRY_CMDID,
  177. .peer_remove_wds_entry_cmdid = WMI_10X_PEER_REMOVE_WDS_ENTRY_CMDID,
  178. .peer_mcast_group_cmdid = WMI_10X_PEER_MCAST_GROUP_CMDID,
  179. .bcn_tx_cmdid = WMI_10X_BCN_TX_CMDID,
  180. .pdev_send_bcn_cmdid = WMI_10X_PDEV_SEND_BCN_CMDID,
  181. .bcn_tmpl_cmdid = WMI_CMD_UNDEFINED,
  182. .bcn_filter_rx_cmdid = WMI_10X_BCN_FILTER_RX_CMDID,
  183. .prb_req_filter_rx_cmdid = WMI_10X_PRB_REQ_FILTER_RX_CMDID,
  184. .mgmt_tx_cmdid = WMI_10X_MGMT_TX_CMDID,
  185. .prb_tmpl_cmdid = WMI_CMD_UNDEFINED,
  186. .addba_clear_resp_cmdid = WMI_10X_ADDBA_CLEAR_RESP_CMDID,
  187. .addba_send_cmdid = WMI_10X_ADDBA_SEND_CMDID,
  188. .addba_status_cmdid = WMI_10X_ADDBA_STATUS_CMDID,
  189. .delba_send_cmdid = WMI_10X_DELBA_SEND_CMDID,
  190. .addba_set_resp_cmdid = WMI_10X_ADDBA_SET_RESP_CMDID,
  191. .send_singleamsdu_cmdid = WMI_10X_SEND_SINGLEAMSDU_CMDID,
  192. .sta_powersave_mode_cmdid = WMI_10X_STA_POWERSAVE_MODE_CMDID,
  193. .sta_powersave_param_cmdid = WMI_10X_STA_POWERSAVE_PARAM_CMDID,
  194. .sta_mimo_ps_mode_cmdid = WMI_10X_STA_MIMO_PS_MODE_CMDID,
  195. .pdev_dfs_enable_cmdid = WMI_10X_PDEV_DFS_ENABLE_CMDID,
  196. .pdev_dfs_disable_cmdid = WMI_10X_PDEV_DFS_DISABLE_CMDID,
  197. .roam_scan_mode = WMI_10X_ROAM_SCAN_MODE,
  198. .roam_scan_rssi_threshold = WMI_10X_ROAM_SCAN_RSSI_THRESHOLD,
  199. .roam_scan_period = WMI_10X_ROAM_SCAN_PERIOD,
  200. .roam_scan_rssi_change_threshold =
  201. WMI_10X_ROAM_SCAN_RSSI_CHANGE_THRESHOLD,
  202. .roam_ap_profile = WMI_10X_ROAM_AP_PROFILE,
  203. .ofl_scan_add_ap_profile = WMI_10X_OFL_SCAN_ADD_AP_PROFILE,
  204. .ofl_scan_remove_ap_profile = WMI_10X_OFL_SCAN_REMOVE_AP_PROFILE,
  205. .ofl_scan_period = WMI_10X_OFL_SCAN_PERIOD,
  206. .p2p_dev_set_device_info = WMI_10X_P2P_DEV_SET_DEVICE_INFO,
  207. .p2p_dev_set_discoverability = WMI_10X_P2P_DEV_SET_DISCOVERABILITY,
  208. .p2p_go_set_beacon_ie = WMI_10X_P2P_GO_SET_BEACON_IE,
  209. .p2p_go_set_probe_resp_ie = WMI_10X_P2P_GO_SET_PROBE_RESP_IE,
  210. .p2p_set_vendor_ie_data_cmdid = WMI_CMD_UNDEFINED,
  211. .ap_ps_peer_param_cmdid = WMI_CMD_UNDEFINED,
  212. .ap_ps_peer_uapsd_coex_cmdid = WMI_CMD_UNDEFINED,
  213. .peer_rate_retry_sched_cmdid = WMI_10X_PEER_RATE_RETRY_SCHED_CMDID,
  214. .wlan_profile_trigger_cmdid = WMI_10X_WLAN_PROFILE_TRIGGER_CMDID,
  215. .wlan_profile_set_hist_intvl_cmdid =
  216. WMI_10X_WLAN_PROFILE_SET_HIST_INTVL_CMDID,
  217. .wlan_profile_get_profile_data_cmdid =
  218. WMI_10X_WLAN_PROFILE_GET_PROFILE_DATA_CMDID,
  219. .wlan_profile_enable_profile_id_cmdid =
  220. WMI_10X_WLAN_PROFILE_ENABLE_PROFILE_ID_CMDID,
  221. .wlan_profile_list_profile_id_cmdid =
  222. WMI_10X_WLAN_PROFILE_LIST_PROFILE_ID_CMDID,
  223. .pdev_suspend_cmdid = WMI_10X_PDEV_SUSPEND_CMDID,
  224. .pdev_resume_cmdid = WMI_10X_PDEV_RESUME_CMDID,
  225. .add_bcn_filter_cmdid = WMI_10X_ADD_BCN_FILTER_CMDID,
  226. .rmv_bcn_filter_cmdid = WMI_10X_RMV_BCN_FILTER_CMDID,
  227. .wow_add_wake_pattern_cmdid = WMI_10X_WOW_ADD_WAKE_PATTERN_CMDID,
  228. .wow_del_wake_pattern_cmdid = WMI_10X_WOW_DEL_WAKE_PATTERN_CMDID,
  229. .wow_enable_disable_wake_event_cmdid =
  230. WMI_10X_WOW_ENABLE_DISABLE_WAKE_EVENT_CMDID,
  231. .wow_enable_cmdid = WMI_10X_WOW_ENABLE_CMDID,
  232. .wow_hostwakeup_from_sleep_cmdid =
  233. WMI_10X_WOW_HOSTWAKEUP_FROM_SLEEP_CMDID,
  234. .rtt_measreq_cmdid = WMI_10X_RTT_MEASREQ_CMDID,
  235. .rtt_tsf_cmdid = WMI_10X_RTT_TSF_CMDID,
  236. .vdev_spectral_scan_configure_cmdid =
  237. WMI_10X_VDEV_SPECTRAL_SCAN_CONFIGURE_CMDID,
  238. .vdev_spectral_scan_enable_cmdid =
  239. WMI_10X_VDEV_SPECTRAL_SCAN_ENABLE_CMDID,
  240. .request_stats_cmdid = WMI_10X_REQUEST_STATS_CMDID,
  241. .set_arp_ns_offload_cmdid = WMI_CMD_UNDEFINED,
  242. .network_list_offload_config_cmdid = WMI_CMD_UNDEFINED,
  243. .gtk_offload_cmdid = WMI_CMD_UNDEFINED,
  244. .csa_offload_enable_cmdid = WMI_CMD_UNDEFINED,
  245. .csa_offload_chanswitch_cmdid = WMI_CMD_UNDEFINED,
  246. .chatter_set_mode_cmdid = WMI_CMD_UNDEFINED,
  247. .peer_tid_addba_cmdid = WMI_CMD_UNDEFINED,
  248. .peer_tid_delba_cmdid = WMI_CMD_UNDEFINED,
  249. .sta_dtim_ps_method_cmdid = WMI_CMD_UNDEFINED,
  250. .sta_uapsd_auto_trig_cmdid = WMI_CMD_UNDEFINED,
  251. .sta_keepalive_cmd = WMI_CMD_UNDEFINED,
  252. .echo_cmdid = WMI_10X_ECHO_CMDID,
  253. .pdev_utf_cmdid = WMI_10X_PDEV_UTF_CMDID,
  254. .dbglog_cfg_cmdid = WMI_10X_DBGLOG_CFG_CMDID,
  255. .pdev_qvit_cmdid = WMI_10X_PDEV_QVIT_CMDID,
  256. .pdev_ftm_intg_cmdid = WMI_CMD_UNDEFINED,
  257. .vdev_set_keepalive_cmdid = WMI_CMD_UNDEFINED,
  258. .vdev_get_keepalive_cmdid = WMI_CMD_UNDEFINED,
  259. .force_fw_hang_cmdid = WMI_CMD_UNDEFINED,
  260. .gpio_config_cmdid = WMI_10X_GPIO_CONFIG_CMDID,
  261. .gpio_output_cmdid = WMI_10X_GPIO_OUTPUT_CMDID,
  262. };
  263. int ath10k_wmi_wait_for_service_ready(struct ath10k *ar)
  264. {
  265. int ret;
  266. ret = wait_for_completion_timeout(&ar->wmi.service_ready,
  267. WMI_SERVICE_READY_TIMEOUT_HZ);
  268. return ret;
  269. }
  270. int ath10k_wmi_wait_for_unified_ready(struct ath10k *ar)
  271. {
  272. int ret;
  273. ret = wait_for_completion_timeout(&ar->wmi.unified_ready,
  274. WMI_UNIFIED_READY_TIMEOUT_HZ);
  275. return ret;
  276. }
  277. static struct sk_buff *ath10k_wmi_alloc_skb(u32 len)
  278. {
  279. struct sk_buff *skb;
  280. u32 round_len = roundup(len, 4);
  281. skb = ath10k_htc_alloc_skb(WMI_SKB_HEADROOM + round_len);
  282. if (!skb)
  283. return NULL;
  284. skb_reserve(skb, WMI_SKB_HEADROOM);
  285. if (!IS_ALIGNED((unsigned long)skb->data, 4))
  286. ath10k_warn("Unaligned WMI skb\n");
  287. skb_put(skb, round_len);
  288. memset(skb->data, 0, round_len);
  289. return skb;
  290. }
  291. static void ath10k_wmi_htc_tx_complete(struct ath10k *ar, struct sk_buff *skb)
  292. {
  293. dev_kfree_skb(skb);
  294. }
  295. static int ath10k_wmi_cmd_send_nowait(struct ath10k *ar, struct sk_buff *skb,
  296. u32 cmd_id)
  297. {
  298. struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(skb);
  299. struct wmi_cmd_hdr *cmd_hdr;
  300. int ret;
  301. u32 cmd = 0;
  302. if (skb_push(skb, sizeof(struct wmi_cmd_hdr)) == NULL)
  303. return -ENOMEM;
  304. cmd |= SM(cmd_id, WMI_CMD_HDR_CMD_ID);
  305. cmd_hdr = (struct wmi_cmd_hdr *)skb->data;
  306. cmd_hdr->cmd_id = __cpu_to_le32(cmd);
  307. memset(skb_cb, 0, sizeof(*skb_cb));
  308. ret = ath10k_htc_send(&ar->htc, ar->wmi.eid, skb);
  309. trace_ath10k_wmi_cmd(cmd_id, skb->data, skb->len, ret);
  310. if (ret)
  311. goto err_pull;
  312. return 0;
  313. err_pull:
  314. skb_pull(skb, sizeof(struct wmi_cmd_hdr));
  315. return ret;
  316. }
  317. static void ath10k_wmi_tx_beacon_nowait(struct ath10k_vif *arvif)
  318. {
  319. struct wmi_bcn_tx_arg arg = {0};
  320. int ret;
  321. lockdep_assert_held(&arvif->ar->data_lock);
  322. if (arvif->beacon == NULL)
  323. return;
  324. arg.vdev_id = arvif->vdev_id;
  325. arg.tx_rate = 0;
  326. arg.tx_power = 0;
  327. arg.bcn = arvif->beacon->data;
  328. arg.bcn_len = arvif->beacon->len;
  329. ret = ath10k_wmi_beacon_send_nowait(arvif->ar, &arg);
  330. if (ret)
  331. return;
  332. dev_kfree_skb_any(arvif->beacon);
  333. arvif->beacon = NULL;
  334. }
  335. static void ath10k_wmi_tx_beacons_iter(void *data, u8 *mac,
  336. struct ieee80211_vif *vif)
  337. {
  338. struct ath10k_vif *arvif = ath10k_vif_to_arvif(vif);
  339. ath10k_wmi_tx_beacon_nowait(arvif);
  340. }
  341. static void ath10k_wmi_tx_beacons_nowait(struct ath10k *ar)
  342. {
  343. spin_lock_bh(&ar->data_lock);
  344. ieee80211_iterate_active_interfaces_atomic(ar->hw,
  345. IEEE80211_IFACE_ITER_NORMAL,
  346. ath10k_wmi_tx_beacons_iter,
  347. NULL);
  348. spin_unlock_bh(&ar->data_lock);
  349. }
  350. static void ath10k_wmi_op_ep_tx_credits(struct ath10k *ar)
  351. {
  352. /* try to send pending beacons first. they take priority */
  353. ath10k_wmi_tx_beacons_nowait(ar);
  354. wake_up(&ar->wmi.tx_credits_wq);
  355. }
  356. static int ath10k_wmi_cmd_send(struct ath10k *ar, struct sk_buff *skb,
  357. u32 cmd_id)
  358. {
  359. int ret = -EINVAL;
  360. if (cmd_id == WMI_CMD_UNDEFINED) {
  361. ath10k_warn("wmi command %d is not supported by firmware\n",
  362. cmd_id);
  363. return ret;
  364. }
  365. wait_event_timeout(ar->wmi.tx_credits_wq, ({
  366. /* try to send pending beacons first. they take priority */
  367. ath10k_wmi_tx_beacons_nowait(ar);
  368. ret = ath10k_wmi_cmd_send_nowait(ar, skb, cmd_id);
  369. (ret != -EAGAIN);
  370. }), 3*HZ);
  371. if (ret)
  372. dev_kfree_skb_any(skb);
  373. return ret;
  374. }
  375. static int ath10k_wmi_event_scan(struct ath10k *ar, struct sk_buff *skb)
  376. {
  377. struct wmi_scan_event *event = (struct wmi_scan_event *)skb->data;
  378. enum wmi_scan_event_type event_type;
  379. enum wmi_scan_completion_reason reason;
  380. u32 freq;
  381. u32 req_id;
  382. u32 scan_id;
  383. u32 vdev_id;
  384. event_type = __le32_to_cpu(event->event_type);
  385. reason = __le32_to_cpu(event->reason);
  386. freq = __le32_to_cpu(event->channel_freq);
  387. req_id = __le32_to_cpu(event->scan_req_id);
  388. scan_id = __le32_to_cpu(event->scan_id);
  389. vdev_id = __le32_to_cpu(event->vdev_id);
  390. ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENTID\n");
  391. ath10k_dbg(ATH10K_DBG_WMI,
  392. "scan event type %d reason %d freq %d req_id %d "
  393. "scan_id %d vdev_id %d\n",
  394. event_type, reason, freq, req_id, scan_id, vdev_id);
  395. spin_lock_bh(&ar->data_lock);
  396. switch (event_type) {
  397. case WMI_SCAN_EVENT_STARTED:
  398. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_STARTED\n");
  399. if (ar->scan.in_progress && ar->scan.is_roc)
  400. ieee80211_ready_on_channel(ar->hw);
  401. complete(&ar->scan.started);
  402. break;
  403. case WMI_SCAN_EVENT_COMPLETED:
  404. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_COMPLETED\n");
  405. switch (reason) {
  406. case WMI_SCAN_REASON_COMPLETED:
  407. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_COMPLETED\n");
  408. break;
  409. case WMI_SCAN_REASON_CANCELLED:
  410. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_CANCELED\n");
  411. break;
  412. case WMI_SCAN_REASON_PREEMPTED:
  413. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_PREEMPTED\n");
  414. break;
  415. case WMI_SCAN_REASON_TIMEDOUT:
  416. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_TIMEDOUT\n");
  417. break;
  418. default:
  419. break;
  420. }
  421. ar->scan_channel = NULL;
  422. if (!ar->scan.in_progress) {
  423. ath10k_warn("no scan requested, ignoring\n");
  424. break;
  425. }
  426. if (ar->scan.is_roc) {
  427. ath10k_offchan_tx_purge(ar);
  428. if (!ar->scan.aborting)
  429. ieee80211_remain_on_channel_expired(ar->hw);
  430. } else {
  431. ieee80211_scan_completed(ar->hw, ar->scan.aborting);
  432. }
  433. del_timer(&ar->scan.timeout);
  434. complete_all(&ar->scan.completed);
  435. ar->scan.in_progress = false;
  436. break;
  437. case WMI_SCAN_EVENT_BSS_CHANNEL:
  438. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_BSS_CHANNEL\n");
  439. ar->scan_channel = NULL;
  440. break;
  441. case WMI_SCAN_EVENT_FOREIGN_CHANNEL:
  442. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_FOREIGN_CHANNEL\n");
  443. ar->scan_channel = ieee80211_get_channel(ar->hw->wiphy, freq);
  444. if (ar->scan.in_progress && ar->scan.is_roc &&
  445. ar->scan.roc_freq == freq) {
  446. complete(&ar->scan.on_channel);
  447. }
  448. break;
  449. case WMI_SCAN_EVENT_DEQUEUED:
  450. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_DEQUEUED\n");
  451. break;
  452. case WMI_SCAN_EVENT_PREEMPTED:
  453. ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENT_PREEMPTED\n");
  454. break;
  455. case WMI_SCAN_EVENT_START_FAILED:
  456. ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENT_START_FAILED\n");
  457. break;
  458. default:
  459. break;
  460. }
  461. spin_unlock_bh(&ar->data_lock);
  462. return 0;
  463. }
  464. static inline enum ieee80211_band phy_mode_to_band(u32 phy_mode)
  465. {
  466. enum ieee80211_band band;
  467. switch (phy_mode) {
  468. case MODE_11A:
  469. case MODE_11NA_HT20:
  470. case MODE_11NA_HT40:
  471. case MODE_11AC_VHT20:
  472. case MODE_11AC_VHT40:
  473. case MODE_11AC_VHT80:
  474. band = IEEE80211_BAND_5GHZ;
  475. break;
  476. case MODE_11G:
  477. case MODE_11B:
  478. case MODE_11GONLY:
  479. case MODE_11NG_HT20:
  480. case MODE_11NG_HT40:
  481. case MODE_11AC_VHT20_2G:
  482. case MODE_11AC_VHT40_2G:
  483. case MODE_11AC_VHT80_2G:
  484. default:
  485. band = IEEE80211_BAND_2GHZ;
  486. }
  487. return band;
  488. }
  489. static inline u8 get_rate_idx(u32 rate, enum ieee80211_band band)
  490. {
  491. u8 rate_idx = 0;
  492. /* rate in Kbps */
  493. switch (rate) {
  494. case 1000:
  495. rate_idx = 0;
  496. break;
  497. case 2000:
  498. rate_idx = 1;
  499. break;
  500. case 5500:
  501. rate_idx = 2;
  502. break;
  503. case 11000:
  504. rate_idx = 3;
  505. break;
  506. case 6000:
  507. rate_idx = 4;
  508. break;
  509. case 9000:
  510. rate_idx = 5;
  511. break;
  512. case 12000:
  513. rate_idx = 6;
  514. break;
  515. case 18000:
  516. rate_idx = 7;
  517. break;
  518. case 24000:
  519. rate_idx = 8;
  520. break;
  521. case 36000:
  522. rate_idx = 9;
  523. break;
  524. case 48000:
  525. rate_idx = 10;
  526. break;
  527. case 54000:
  528. rate_idx = 11;
  529. break;
  530. default:
  531. break;
  532. }
  533. if (band == IEEE80211_BAND_5GHZ) {
  534. if (rate_idx > 3)
  535. /* Omit CCK rates */
  536. rate_idx -= 4;
  537. else
  538. rate_idx = 0;
  539. }
  540. return rate_idx;
  541. }
  542. static int ath10k_wmi_event_mgmt_rx(struct ath10k *ar, struct sk_buff *skb)
  543. {
  544. struct wmi_mgmt_rx_event_v1 *ev_v1;
  545. struct wmi_mgmt_rx_event_v2 *ev_v2;
  546. struct wmi_mgmt_rx_hdr_v1 *ev_hdr;
  547. struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
  548. struct ieee80211_hdr *hdr;
  549. u32 rx_status;
  550. u32 channel;
  551. u32 phy_mode;
  552. u32 snr;
  553. u32 rate;
  554. u32 buf_len;
  555. u16 fc;
  556. int pull_len;
  557. if (test_bit(ATH10K_FW_FEATURE_EXT_WMI_MGMT_RX, ar->fw_features)) {
  558. ev_v2 = (struct wmi_mgmt_rx_event_v2 *)skb->data;
  559. ev_hdr = &ev_v2->hdr.v1;
  560. pull_len = sizeof(*ev_v2);
  561. } else {
  562. ev_v1 = (struct wmi_mgmt_rx_event_v1 *)skb->data;
  563. ev_hdr = &ev_v1->hdr;
  564. pull_len = sizeof(*ev_v1);
  565. }
  566. channel = __le32_to_cpu(ev_hdr->channel);
  567. buf_len = __le32_to_cpu(ev_hdr->buf_len);
  568. rx_status = __le32_to_cpu(ev_hdr->status);
  569. snr = __le32_to_cpu(ev_hdr->snr);
  570. phy_mode = __le32_to_cpu(ev_hdr->phy_mode);
  571. rate = __le32_to_cpu(ev_hdr->rate);
  572. memset(status, 0, sizeof(*status));
  573. ath10k_dbg(ATH10K_DBG_MGMT,
  574. "event mgmt rx status %08x\n", rx_status);
  575. if (rx_status & WMI_RX_STATUS_ERR_DECRYPT) {
  576. dev_kfree_skb(skb);
  577. return 0;
  578. }
  579. if (rx_status & WMI_RX_STATUS_ERR_KEY_CACHE_MISS) {
  580. dev_kfree_skb(skb);
  581. return 0;
  582. }
  583. if (rx_status & WMI_RX_STATUS_ERR_CRC)
  584. status->flag |= RX_FLAG_FAILED_FCS_CRC;
  585. if (rx_status & WMI_RX_STATUS_ERR_MIC)
  586. status->flag |= RX_FLAG_MMIC_ERROR;
  587. status->band = phy_mode_to_band(phy_mode);
  588. status->freq = ieee80211_channel_to_frequency(channel, status->band);
  589. status->signal = snr + ATH10K_DEFAULT_NOISE_FLOOR;
  590. status->rate_idx = get_rate_idx(rate, status->band);
  591. skb_pull(skb, pull_len);
  592. hdr = (struct ieee80211_hdr *)skb->data;
  593. fc = le16_to_cpu(hdr->frame_control);
  594. if (fc & IEEE80211_FCTL_PROTECTED) {
  595. status->flag |= RX_FLAG_DECRYPTED | RX_FLAG_IV_STRIPPED |
  596. RX_FLAG_MMIC_STRIPPED;
  597. hdr->frame_control = __cpu_to_le16(fc &
  598. ~IEEE80211_FCTL_PROTECTED);
  599. }
  600. ath10k_dbg(ATH10K_DBG_MGMT,
  601. "event mgmt rx skb %p len %d ftype %02x stype %02x\n",
  602. skb, skb->len,
  603. fc & IEEE80211_FCTL_FTYPE, fc & IEEE80211_FCTL_STYPE);
  604. ath10k_dbg(ATH10K_DBG_MGMT,
  605. "event mgmt rx freq %d band %d snr %d, rate_idx %d\n",
  606. status->freq, status->band, status->signal,
  607. status->rate_idx);
  608. /*
  609. * packets from HTC come aligned to 4byte boundaries
  610. * because they can originally come in along with a trailer
  611. */
  612. skb_trim(skb, buf_len);
  613. ieee80211_rx(ar->hw, skb);
  614. return 0;
  615. }
  616. static int freq_to_idx(struct ath10k *ar, int freq)
  617. {
  618. struct ieee80211_supported_band *sband;
  619. int band, ch, idx = 0;
  620. for (band = IEEE80211_BAND_2GHZ; band < IEEE80211_NUM_BANDS; band++) {
  621. sband = ar->hw->wiphy->bands[band];
  622. if (!sband)
  623. continue;
  624. for (ch = 0; ch < sband->n_channels; ch++, idx++)
  625. if (sband->channels[ch].center_freq == freq)
  626. goto exit;
  627. }
  628. exit:
  629. return idx;
  630. }
  631. static void ath10k_wmi_event_chan_info(struct ath10k *ar, struct sk_buff *skb)
  632. {
  633. struct wmi_chan_info_event *ev;
  634. struct survey_info *survey;
  635. u32 err_code, freq, cmd_flags, noise_floor, rx_clear_count, cycle_count;
  636. int idx;
  637. ev = (struct wmi_chan_info_event *)skb->data;
  638. err_code = __le32_to_cpu(ev->err_code);
  639. freq = __le32_to_cpu(ev->freq);
  640. cmd_flags = __le32_to_cpu(ev->cmd_flags);
  641. noise_floor = __le32_to_cpu(ev->noise_floor);
  642. rx_clear_count = __le32_to_cpu(ev->rx_clear_count);
  643. cycle_count = __le32_to_cpu(ev->cycle_count);
  644. ath10k_dbg(ATH10K_DBG_WMI,
  645. "chan info err_code %d freq %d cmd_flags %d noise_floor %d rx_clear_count %d cycle_count %d\n",
  646. err_code, freq, cmd_flags, noise_floor, rx_clear_count,
  647. cycle_count);
  648. spin_lock_bh(&ar->data_lock);
  649. if (!ar->scan.in_progress) {
  650. ath10k_warn("chan info event without a scan request?\n");
  651. goto exit;
  652. }
  653. idx = freq_to_idx(ar, freq);
  654. if (idx >= ARRAY_SIZE(ar->survey)) {
  655. ath10k_warn("chan info: invalid frequency %d (idx %d out of bounds)\n",
  656. freq, idx);
  657. goto exit;
  658. }
  659. if (cmd_flags & WMI_CHAN_INFO_FLAG_COMPLETE) {
  660. /* During scanning chan info is reported twice for each
  661. * visited channel. The reported cycle count is global
  662. * and per-channel cycle count must be calculated */
  663. cycle_count -= ar->survey_last_cycle_count;
  664. rx_clear_count -= ar->survey_last_rx_clear_count;
  665. survey = &ar->survey[idx];
  666. survey->channel_time = WMI_CHAN_INFO_MSEC(cycle_count);
  667. survey->channel_time_rx = WMI_CHAN_INFO_MSEC(rx_clear_count);
  668. survey->noise = noise_floor;
  669. survey->filled = SURVEY_INFO_CHANNEL_TIME |
  670. SURVEY_INFO_CHANNEL_TIME_RX |
  671. SURVEY_INFO_NOISE_DBM;
  672. }
  673. ar->survey_last_rx_clear_count = rx_clear_count;
  674. ar->survey_last_cycle_count = cycle_count;
  675. exit:
  676. spin_unlock_bh(&ar->data_lock);
  677. }
  678. static void ath10k_wmi_event_echo(struct ath10k *ar, struct sk_buff *skb)
  679. {
  680. ath10k_dbg(ATH10K_DBG_WMI, "WMI_ECHO_EVENTID\n");
  681. }
  682. static void ath10k_wmi_event_debug_mesg(struct ath10k *ar, struct sk_buff *skb)
  683. {
  684. ath10k_dbg(ATH10K_DBG_WMI, "WMI_DEBUG_MESG_EVENTID\n");
  685. }
  686. static void ath10k_wmi_event_update_stats(struct ath10k *ar,
  687. struct sk_buff *skb)
  688. {
  689. struct wmi_stats_event *ev = (struct wmi_stats_event *)skb->data;
  690. ath10k_dbg(ATH10K_DBG_WMI, "WMI_UPDATE_STATS_EVENTID\n");
  691. ath10k_debug_read_target_stats(ar, ev);
  692. }
  693. static void ath10k_wmi_event_vdev_start_resp(struct ath10k *ar,
  694. struct sk_buff *skb)
  695. {
  696. struct wmi_vdev_start_response_event *ev;
  697. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_START_RESP_EVENTID\n");
  698. ev = (struct wmi_vdev_start_response_event *)skb->data;
  699. if (WARN_ON(__le32_to_cpu(ev->status)))
  700. return;
  701. complete(&ar->vdev_setup_done);
  702. }
  703. static void ath10k_wmi_event_vdev_stopped(struct ath10k *ar,
  704. struct sk_buff *skb)
  705. {
  706. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_STOPPED_EVENTID\n");
  707. complete(&ar->vdev_setup_done);
  708. }
  709. static void ath10k_wmi_event_peer_sta_kickout(struct ath10k *ar,
  710. struct sk_buff *skb)
  711. {
  712. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PEER_STA_KICKOUT_EVENTID\n");
  713. }
  714. /*
  715. * FIXME
  716. *
  717. * We don't report to mac80211 sleep state of connected
  718. * stations. Due to this mac80211 can't fill in TIM IE
  719. * correctly.
  720. *
  721. * I know of no way of getting nullfunc frames that contain
  722. * sleep transition from connected stations - these do not
  723. * seem to be sent from the target to the host. There also
  724. * doesn't seem to be a dedicated event for that. So the
  725. * only way left to do this would be to read tim_bitmap
  726. * during SWBA.
  727. *
  728. * We could probably try using tim_bitmap from SWBA to tell
  729. * mac80211 which stations are asleep and which are not. The
  730. * problem here is calling mac80211 functions so many times
  731. * could take too long and make us miss the time to submit
  732. * the beacon to the target.
  733. *
  734. * So as a workaround we try to extend the TIM IE if there
  735. * is unicast buffered for stations with aid > 7 and fill it
  736. * in ourselves.
  737. */
  738. static void ath10k_wmi_update_tim(struct ath10k *ar,
  739. struct ath10k_vif *arvif,
  740. struct sk_buff *bcn,
  741. struct wmi_bcn_info *bcn_info)
  742. {
  743. struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)bcn->data;
  744. struct ieee80211_tim_ie *tim;
  745. u8 *ies, *ie;
  746. u8 ie_len, pvm_len;
  747. /* if next SWBA has no tim_changed the tim_bitmap is garbage.
  748. * we must copy the bitmap upon change and reuse it later */
  749. if (__le32_to_cpu(bcn_info->tim_info.tim_changed)) {
  750. int i;
  751. BUILD_BUG_ON(sizeof(arvif->u.ap.tim_bitmap) !=
  752. sizeof(bcn_info->tim_info.tim_bitmap));
  753. for (i = 0; i < sizeof(arvif->u.ap.tim_bitmap); i++) {
  754. __le32 t = bcn_info->tim_info.tim_bitmap[i / 4];
  755. u32 v = __le32_to_cpu(t);
  756. arvif->u.ap.tim_bitmap[i] = (v >> ((i % 4) * 8)) & 0xFF;
  757. }
  758. /* FW reports either length 0 or 16
  759. * so we calculate this on our own */
  760. arvif->u.ap.tim_len = 0;
  761. for (i = 0; i < sizeof(arvif->u.ap.tim_bitmap); i++)
  762. if (arvif->u.ap.tim_bitmap[i])
  763. arvif->u.ap.tim_len = i;
  764. arvif->u.ap.tim_len++;
  765. }
  766. ies = bcn->data;
  767. ies += ieee80211_hdrlen(hdr->frame_control);
  768. ies += 12; /* fixed parameters */
  769. ie = (u8 *)cfg80211_find_ie(WLAN_EID_TIM, ies,
  770. (u8 *)skb_tail_pointer(bcn) - ies);
  771. if (!ie) {
  772. if (arvif->vdev_type != WMI_VDEV_TYPE_IBSS)
  773. ath10k_warn("no tim ie found;\n");
  774. return;
  775. }
  776. tim = (void *)ie + 2;
  777. ie_len = ie[1];
  778. pvm_len = ie_len - 3; /* exclude dtim count, dtim period, bmap ctl */
  779. if (pvm_len < arvif->u.ap.tim_len) {
  780. int expand_size = sizeof(arvif->u.ap.tim_bitmap) - pvm_len;
  781. int move_size = skb_tail_pointer(bcn) - (ie + 2 + ie_len);
  782. void *next_ie = ie + 2 + ie_len;
  783. if (skb_put(bcn, expand_size)) {
  784. memmove(next_ie + expand_size, next_ie, move_size);
  785. ie[1] += expand_size;
  786. ie_len += expand_size;
  787. pvm_len += expand_size;
  788. } else {
  789. ath10k_warn("tim expansion failed\n");
  790. }
  791. }
  792. if (pvm_len > sizeof(arvif->u.ap.tim_bitmap)) {
  793. ath10k_warn("tim pvm length is too great (%d)\n", pvm_len);
  794. return;
  795. }
  796. tim->bitmap_ctrl = !!__le32_to_cpu(bcn_info->tim_info.tim_mcast);
  797. memcpy(tim->virtual_map, arvif->u.ap.tim_bitmap, pvm_len);
  798. ath10k_dbg(ATH10K_DBG_MGMT, "dtim %d/%d mcast %d pvmlen %d\n",
  799. tim->dtim_count, tim->dtim_period,
  800. tim->bitmap_ctrl, pvm_len);
  801. }
  802. static void ath10k_p2p_fill_noa_ie(u8 *data, u32 len,
  803. struct wmi_p2p_noa_info *noa)
  804. {
  805. struct ieee80211_p2p_noa_attr *noa_attr;
  806. u8 ctwindow_oppps = noa->ctwindow_oppps;
  807. u8 ctwindow = ctwindow_oppps >> WMI_P2P_OPPPS_CTWINDOW_OFFSET;
  808. bool oppps = !!(ctwindow_oppps & WMI_P2P_OPPPS_ENABLE_BIT);
  809. __le16 *noa_attr_len;
  810. u16 attr_len;
  811. u8 noa_descriptors = noa->num_descriptors;
  812. int i;
  813. /* P2P IE */
  814. data[0] = WLAN_EID_VENDOR_SPECIFIC;
  815. data[1] = len - 2;
  816. data[2] = (WLAN_OUI_WFA >> 16) & 0xff;
  817. data[3] = (WLAN_OUI_WFA >> 8) & 0xff;
  818. data[4] = (WLAN_OUI_WFA >> 0) & 0xff;
  819. data[5] = WLAN_OUI_TYPE_WFA_P2P;
  820. /* NOA ATTR */
  821. data[6] = IEEE80211_P2P_ATTR_ABSENCE_NOTICE;
  822. noa_attr_len = (__le16 *)&data[7]; /* 2 bytes */
  823. noa_attr = (struct ieee80211_p2p_noa_attr *)&data[9];
  824. noa_attr->index = noa->index;
  825. noa_attr->oppps_ctwindow = ctwindow;
  826. if (oppps)
  827. noa_attr->oppps_ctwindow |= IEEE80211_P2P_OPPPS_ENABLE_BIT;
  828. for (i = 0; i < noa_descriptors; i++) {
  829. noa_attr->desc[i].count =
  830. __le32_to_cpu(noa->descriptors[i].type_count);
  831. noa_attr->desc[i].duration = noa->descriptors[i].duration;
  832. noa_attr->desc[i].interval = noa->descriptors[i].interval;
  833. noa_attr->desc[i].start_time = noa->descriptors[i].start_time;
  834. }
  835. attr_len = 2; /* index + oppps_ctwindow */
  836. attr_len += noa_descriptors * sizeof(struct ieee80211_p2p_noa_desc);
  837. *noa_attr_len = __cpu_to_le16(attr_len);
  838. }
  839. static u32 ath10k_p2p_calc_noa_ie_len(struct wmi_p2p_noa_info *noa)
  840. {
  841. u32 len = 0;
  842. u8 noa_descriptors = noa->num_descriptors;
  843. u8 opp_ps_info = noa->ctwindow_oppps;
  844. bool opps_enabled = !!(opp_ps_info & WMI_P2P_OPPPS_ENABLE_BIT);
  845. if (!noa_descriptors && !opps_enabled)
  846. return len;
  847. len += 1 + 1 + 4; /* EID + len + OUI */
  848. len += 1 + 2; /* noa attr + attr len */
  849. len += 1 + 1; /* index + oppps_ctwindow */
  850. len += noa_descriptors * sizeof(struct ieee80211_p2p_noa_desc);
  851. return len;
  852. }
  853. static void ath10k_wmi_update_noa(struct ath10k *ar, struct ath10k_vif *arvif,
  854. struct sk_buff *bcn,
  855. struct wmi_bcn_info *bcn_info)
  856. {
  857. struct wmi_p2p_noa_info *noa = &bcn_info->p2p_noa_info;
  858. u8 *new_data, *old_data = arvif->u.ap.noa_data;
  859. u32 new_len;
  860. if (arvif->vdev_subtype != WMI_VDEV_SUBTYPE_P2P_GO)
  861. return;
  862. ath10k_dbg(ATH10K_DBG_MGMT, "noa changed: %d\n", noa->changed);
  863. if (noa->changed & WMI_P2P_NOA_CHANGED_BIT) {
  864. new_len = ath10k_p2p_calc_noa_ie_len(noa);
  865. if (!new_len)
  866. goto cleanup;
  867. new_data = kmalloc(new_len, GFP_ATOMIC);
  868. if (!new_data)
  869. goto cleanup;
  870. ath10k_p2p_fill_noa_ie(new_data, new_len, noa);
  871. spin_lock_bh(&ar->data_lock);
  872. arvif->u.ap.noa_data = new_data;
  873. arvif->u.ap.noa_len = new_len;
  874. spin_unlock_bh(&ar->data_lock);
  875. kfree(old_data);
  876. }
  877. if (arvif->u.ap.noa_data)
  878. if (!pskb_expand_head(bcn, 0, arvif->u.ap.noa_len, GFP_ATOMIC))
  879. memcpy(skb_put(bcn, arvif->u.ap.noa_len),
  880. arvif->u.ap.noa_data,
  881. arvif->u.ap.noa_len);
  882. return;
  883. cleanup:
  884. spin_lock_bh(&ar->data_lock);
  885. arvif->u.ap.noa_data = NULL;
  886. arvif->u.ap.noa_len = 0;
  887. spin_unlock_bh(&ar->data_lock);
  888. kfree(old_data);
  889. }
  890. static void ath10k_wmi_event_host_swba(struct ath10k *ar, struct sk_buff *skb)
  891. {
  892. struct wmi_host_swba_event *ev;
  893. u32 map;
  894. int i = -1;
  895. struct wmi_bcn_info *bcn_info;
  896. struct ath10k_vif *arvif;
  897. struct sk_buff *bcn;
  898. int vdev_id = 0;
  899. ath10k_dbg(ATH10K_DBG_MGMT, "WMI_HOST_SWBA_EVENTID\n");
  900. ev = (struct wmi_host_swba_event *)skb->data;
  901. map = __le32_to_cpu(ev->vdev_map);
  902. ath10k_dbg(ATH10K_DBG_MGMT, "host swba:\n"
  903. "-vdev map 0x%x\n",
  904. ev->vdev_map);
  905. for (; map; map >>= 1, vdev_id++) {
  906. if (!(map & 0x1))
  907. continue;
  908. i++;
  909. if (i >= WMI_MAX_AP_VDEV) {
  910. ath10k_warn("swba has corrupted vdev map\n");
  911. break;
  912. }
  913. bcn_info = &ev->bcn_info[i];
  914. ath10k_dbg(ATH10K_DBG_MGMT,
  915. "-bcn_info[%d]:\n"
  916. "--tim_len %d\n"
  917. "--tim_mcast %d\n"
  918. "--tim_changed %d\n"
  919. "--tim_num_ps_pending %d\n"
  920. "--tim_bitmap 0x%08x%08x%08x%08x\n",
  921. i,
  922. __le32_to_cpu(bcn_info->tim_info.tim_len),
  923. __le32_to_cpu(bcn_info->tim_info.tim_mcast),
  924. __le32_to_cpu(bcn_info->tim_info.tim_changed),
  925. __le32_to_cpu(bcn_info->tim_info.tim_num_ps_pending),
  926. __le32_to_cpu(bcn_info->tim_info.tim_bitmap[3]),
  927. __le32_to_cpu(bcn_info->tim_info.tim_bitmap[2]),
  928. __le32_to_cpu(bcn_info->tim_info.tim_bitmap[1]),
  929. __le32_to_cpu(bcn_info->tim_info.tim_bitmap[0]));
  930. arvif = ath10k_get_arvif(ar, vdev_id);
  931. if (arvif == NULL) {
  932. ath10k_warn("no vif for vdev_id %d found\n", vdev_id);
  933. continue;
  934. }
  935. bcn = ieee80211_beacon_get(ar->hw, arvif->vif);
  936. if (!bcn) {
  937. ath10k_warn("could not get mac80211 beacon\n");
  938. continue;
  939. }
  940. ath10k_tx_h_seq_no(bcn);
  941. ath10k_wmi_update_tim(ar, arvif, bcn, bcn_info);
  942. ath10k_wmi_update_noa(ar, arvif, bcn, bcn_info);
  943. spin_lock_bh(&ar->data_lock);
  944. if (arvif->beacon) {
  945. ath10k_warn("SWBA overrun on vdev %d\n",
  946. arvif->vdev_id);
  947. dev_kfree_skb_any(arvif->beacon);
  948. }
  949. arvif->beacon = bcn;
  950. ath10k_wmi_tx_beacon_nowait(arvif);
  951. spin_unlock_bh(&ar->data_lock);
  952. }
  953. }
  954. static void ath10k_wmi_event_tbttoffset_update(struct ath10k *ar,
  955. struct sk_buff *skb)
  956. {
  957. ath10k_dbg(ATH10K_DBG_WMI, "WMI_TBTTOFFSET_UPDATE_EVENTID\n");
  958. }
  959. static void ath10k_wmi_event_phyerr(struct ath10k *ar, struct sk_buff *skb)
  960. {
  961. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PHYERR_EVENTID\n");
  962. }
  963. static void ath10k_wmi_event_roam(struct ath10k *ar, struct sk_buff *skb)
  964. {
  965. ath10k_dbg(ATH10K_DBG_WMI, "WMI_ROAM_EVENTID\n");
  966. }
  967. static void ath10k_wmi_event_profile_match(struct ath10k *ar,
  968. struct sk_buff *skb)
  969. {
  970. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PROFILE_MATCH\n");
  971. }
  972. static void ath10k_wmi_event_debug_print(struct ath10k *ar,
  973. struct sk_buff *skb)
  974. {
  975. ath10k_dbg(ATH10K_DBG_WMI, "WMI_DEBUG_PRINT_EVENTID\n");
  976. }
  977. static void ath10k_wmi_event_pdev_qvit(struct ath10k *ar, struct sk_buff *skb)
  978. {
  979. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_QVIT_EVENTID\n");
  980. }
  981. static void ath10k_wmi_event_wlan_profile_data(struct ath10k *ar,
  982. struct sk_buff *skb)
  983. {
  984. ath10k_dbg(ATH10K_DBG_WMI, "WMI_WLAN_PROFILE_DATA_EVENTID\n");
  985. }
  986. static void ath10k_wmi_event_rtt_measurement_report(struct ath10k *ar,
  987. struct sk_buff *skb)
  988. {
  989. ath10k_dbg(ATH10K_DBG_WMI, "WMI_RTT_MEASUREMENT_REPORT_EVENTID\n");
  990. }
  991. static void ath10k_wmi_event_tsf_measurement_report(struct ath10k *ar,
  992. struct sk_buff *skb)
  993. {
  994. ath10k_dbg(ATH10K_DBG_WMI, "WMI_TSF_MEASUREMENT_REPORT_EVENTID\n");
  995. }
  996. static void ath10k_wmi_event_rtt_error_report(struct ath10k *ar,
  997. struct sk_buff *skb)
  998. {
  999. ath10k_dbg(ATH10K_DBG_WMI, "WMI_RTT_ERROR_REPORT_EVENTID\n");
  1000. }
  1001. static void ath10k_wmi_event_wow_wakeup_host(struct ath10k *ar,
  1002. struct sk_buff *skb)
  1003. {
  1004. ath10k_dbg(ATH10K_DBG_WMI, "WMI_WOW_WAKEUP_HOST_EVENTID\n");
  1005. }
  1006. static void ath10k_wmi_event_dcs_interference(struct ath10k *ar,
  1007. struct sk_buff *skb)
  1008. {
  1009. ath10k_dbg(ATH10K_DBG_WMI, "WMI_DCS_INTERFERENCE_EVENTID\n");
  1010. }
  1011. static void ath10k_wmi_event_pdev_tpc_config(struct ath10k *ar,
  1012. struct sk_buff *skb)
  1013. {
  1014. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_TPC_CONFIG_EVENTID\n");
  1015. }
  1016. static void ath10k_wmi_event_pdev_ftm_intg(struct ath10k *ar,
  1017. struct sk_buff *skb)
  1018. {
  1019. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_FTM_INTG_EVENTID\n");
  1020. }
  1021. static void ath10k_wmi_event_gtk_offload_status(struct ath10k *ar,
  1022. struct sk_buff *skb)
  1023. {
  1024. ath10k_dbg(ATH10K_DBG_WMI, "WMI_GTK_OFFLOAD_STATUS_EVENTID\n");
  1025. }
  1026. static void ath10k_wmi_event_gtk_rekey_fail(struct ath10k *ar,
  1027. struct sk_buff *skb)
  1028. {
  1029. ath10k_dbg(ATH10K_DBG_WMI, "WMI_GTK_REKEY_FAIL_EVENTID\n");
  1030. }
  1031. static void ath10k_wmi_event_delba_complete(struct ath10k *ar,
  1032. struct sk_buff *skb)
  1033. {
  1034. ath10k_dbg(ATH10K_DBG_WMI, "WMI_TX_DELBA_COMPLETE_EVENTID\n");
  1035. }
  1036. static void ath10k_wmi_event_addba_complete(struct ath10k *ar,
  1037. struct sk_buff *skb)
  1038. {
  1039. ath10k_dbg(ATH10K_DBG_WMI, "WMI_TX_ADDBA_COMPLETE_EVENTID\n");
  1040. }
  1041. static void ath10k_wmi_event_vdev_install_key_complete(struct ath10k *ar,
  1042. struct sk_buff *skb)
  1043. {
  1044. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_INSTALL_KEY_COMPLETE_EVENTID\n");
  1045. }
  1046. static void ath10k_wmi_event_inst_rssi_stats(struct ath10k *ar,
  1047. struct sk_buff *skb)
  1048. {
  1049. ath10k_dbg(ATH10K_DBG_WMI, "WMI_INST_RSSI_STATS_EVENTID\n");
  1050. }
  1051. static void ath10k_wmi_event_vdev_standby_req(struct ath10k *ar,
  1052. struct sk_buff *skb)
  1053. {
  1054. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_STANDBY_REQ_EVENTID\n");
  1055. }
  1056. static void ath10k_wmi_event_vdev_resume_req(struct ath10k *ar,
  1057. struct sk_buff *skb)
  1058. {
  1059. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_RESUME_REQ_EVENTID\n");
  1060. }
  1061. static int ath10k_wmi_alloc_host_mem(struct ath10k *ar, u32 req_id,
  1062. u32 num_units, u32 unit_len)
  1063. {
  1064. dma_addr_t paddr;
  1065. u32 pool_size;
  1066. int idx = ar->wmi.num_mem_chunks;
  1067. pool_size = num_units * round_up(unit_len, 4);
  1068. if (!pool_size)
  1069. return -EINVAL;
  1070. ar->wmi.mem_chunks[idx].vaddr = dma_alloc_coherent(ar->dev,
  1071. pool_size,
  1072. &paddr,
  1073. GFP_ATOMIC);
  1074. if (!ar->wmi.mem_chunks[idx].vaddr) {
  1075. ath10k_warn("failed to allocate memory chunk\n");
  1076. return -ENOMEM;
  1077. }
  1078. memset(ar->wmi.mem_chunks[idx].vaddr, 0, pool_size);
  1079. ar->wmi.mem_chunks[idx].paddr = paddr;
  1080. ar->wmi.mem_chunks[idx].len = pool_size;
  1081. ar->wmi.mem_chunks[idx].req_id = req_id;
  1082. ar->wmi.num_mem_chunks++;
  1083. return 0;
  1084. }
  1085. static void ath10k_wmi_service_ready_event_rx(struct ath10k *ar,
  1086. struct sk_buff *skb)
  1087. {
  1088. struct wmi_service_ready_event *ev = (void *)skb->data;
  1089. if (skb->len < sizeof(*ev)) {
  1090. ath10k_warn("Service ready event was %d B but expected %zu B. Wrong firmware version?\n",
  1091. skb->len, sizeof(*ev));
  1092. return;
  1093. }
  1094. ar->hw_min_tx_power = __le32_to_cpu(ev->hw_min_tx_power);
  1095. ar->hw_max_tx_power = __le32_to_cpu(ev->hw_max_tx_power);
  1096. ar->ht_cap_info = __le32_to_cpu(ev->ht_cap_info);
  1097. ar->vht_cap_info = __le32_to_cpu(ev->vht_cap_info);
  1098. ar->fw_version_major =
  1099. (__le32_to_cpu(ev->sw_version) & 0xff000000) >> 24;
  1100. ar->fw_version_minor = (__le32_to_cpu(ev->sw_version) & 0x00ffffff);
  1101. ar->fw_version_release =
  1102. (__le32_to_cpu(ev->sw_version_1) & 0xffff0000) >> 16;
  1103. ar->fw_version_build = (__le32_to_cpu(ev->sw_version_1) & 0x0000ffff);
  1104. ar->phy_capability = __le32_to_cpu(ev->phy_capability);
  1105. ar->num_rf_chains = __le32_to_cpu(ev->num_rf_chains);
  1106. if (ar->fw_version_build > 636)
  1107. set_bit(ATH10K_FW_FEATURE_EXT_WMI_MGMT_RX, ar->fw_features);
  1108. if (ar->num_rf_chains > WMI_MAX_SPATIAL_STREAM) {
  1109. ath10k_warn("hardware advertises support for more spatial streams than it should (%d > %d)\n",
  1110. ar->num_rf_chains, WMI_MAX_SPATIAL_STREAM);
  1111. ar->num_rf_chains = WMI_MAX_SPATIAL_STREAM;
  1112. }
  1113. ar->ath_common.regulatory.current_rd =
  1114. __le32_to_cpu(ev->hal_reg_capabilities.eeprom_rd);
  1115. ath10k_debug_read_service_map(ar, ev->wmi_service_bitmap,
  1116. sizeof(ev->wmi_service_bitmap));
  1117. if (strlen(ar->hw->wiphy->fw_version) == 0) {
  1118. snprintf(ar->hw->wiphy->fw_version,
  1119. sizeof(ar->hw->wiphy->fw_version),
  1120. "%u.%u.%u.%u",
  1121. ar->fw_version_major,
  1122. ar->fw_version_minor,
  1123. ar->fw_version_release,
  1124. ar->fw_version_build);
  1125. }
  1126. /* FIXME: it probably should be better to support this */
  1127. if (__le32_to_cpu(ev->num_mem_reqs) > 0) {
  1128. ath10k_warn("target requested %d memory chunks; ignoring\n",
  1129. __le32_to_cpu(ev->num_mem_reqs));
  1130. }
  1131. ath10k_dbg(ATH10K_DBG_WMI,
  1132. "wmi event service ready sw_ver 0x%08x sw_ver1 0x%08x abi_ver %u phy_cap 0x%08x ht_cap 0x%08x vht_cap 0x%08x vht_supp_msc 0x%08x sys_cap_info 0x%08x mem_reqs %u num_rf_chains %u\n",
  1133. __le32_to_cpu(ev->sw_version),
  1134. __le32_to_cpu(ev->sw_version_1),
  1135. __le32_to_cpu(ev->abi_version),
  1136. __le32_to_cpu(ev->phy_capability),
  1137. __le32_to_cpu(ev->ht_cap_info),
  1138. __le32_to_cpu(ev->vht_cap_info),
  1139. __le32_to_cpu(ev->vht_supp_mcs),
  1140. __le32_to_cpu(ev->sys_cap_info),
  1141. __le32_to_cpu(ev->num_mem_reqs),
  1142. __le32_to_cpu(ev->num_rf_chains));
  1143. complete(&ar->wmi.service_ready);
  1144. }
  1145. static void ath10k_wmi_10x_service_ready_event_rx(struct ath10k *ar,
  1146. struct sk_buff *skb)
  1147. {
  1148. u32 num_units, req_id, unit_size, num_mem_reqs, num_unit_info, i;
  1149. int ret;
  1150. struct wmi_service_ready_event_10x *ev = (void *)skb->data;
  1151. if (skb->len < sizeof(*ev)) {
  1152. ath10k_warn("Service ready event was %d B but expected %zu B. Wrong firmware version?\n",
  1153. skb->len, sizeof(*ev));
  1154. return;
  1155. }
  1156. ar->hw_min_tx_power = __le32_to_cpu(ev->hw_min_tx_power);
  1157. ar->hw_max_tx_power = __le32_to_cpu(ev->hw_max_tx_power);
  1158. ar->ht_cap_info = __le32_to_cpu(ev->ht_cap_info);
  1159. ar->vht_cap_info = __le32_to_cpu(ev->vht_cap_info);
  1160. ar->fw_version_major =
  1161. (__le32_to_cpu(ev->sw_version) & 0xff000000) >> 24;
  1162. ar->fw_version_minor = (__le32_to_cpu(ev->sw_version) & 0x00ffffff);
  1163. ar->phy_capability = __le32_to_cpu(ev->phy_capability);
  1164. ar->num_rf_chains = __le32_to_cpu(ev->num_rf_chains);
  1165. if (ar->num_rf_chains > WMI_MAX_SPATIAL_STREAM) {
  1166. ath10k_warn("hardware advertises support for more spatial streams than it should (%d > %d)\n",
  1167. ar->num_rf_chains, WMI_MAX_SPATIAL_STREAM);
  1168. ar->num_rf_chains = WMI_MAX_SPATIAL_STREAM;
  1169. }
  1170. ar->ath_common.regulatory.current_rd =
  1171. __le32_to_cpu(ev->hal_reg_capabilities.eeprom_rd);
  1172. ath10k_debug_read_service_map(ar, ev->wmi_service_bitmap,
  1173. sizeof(ev->wmi_service_bitmap));
  1174. if (strlen(ar->hw->wiphy->fw_version) == 0) {
  1175. snprintf(ar->hw->wiphy->fw_version,
  1176. sizeof(ar->hw->wiphy->fw_version),
  1177. "%u.%u",
  1178. ar->fw_version_major,
  1179. ar->fw_version_minor);
  1180. }
  1181. num_mem_reqs = __le32_to_cpu(ev->num_mem_reqs);
  1182. if (num_mem_reqs > ATH10K_MAX_MEM_REQS) {
  1183. ath10k_warn("requested memory chunks number (%d) exceeds the limit\n",
  1184. num_mem_reqs);
  1185. return;
  1186. }
  1187. if (!num_mem_reqs)
  1188. goto exit;
  1189. ath10k_dbg(ATH10K_DBG_WMI, "firmware has requested %d memory chunks\n",
  1190. num_mem_reqs);
  1191. for (i = 0; i < num_mem_reqs; ++i) {
  1192. req_id = __le32_to_cpu(ev->mem_reqs[i].req_id);
  1193. num_units = __le32_to_cpu(ev->mem_reqs[i].num_units);
  1194. unit_size = __le32_to_cpu(ev->mem_reqs[i].unit_size);
  1195. num_unit_info = __le32_to_cpu(ev->mem_reqs[i].num_unit_info);
  1196. if (num_unit_info & NUM_UNITS_IS_NUM_PEERS)
  1197. /* number of units to allocate is number of
  1198. * peers, 1 extra for self peer on target */
  1199. /* this needs to be tied, host and target
  1200. * can get out of sync */
  1201. num_units = TARGET_NUM_PEERS + 1;
  1202. else if (num_unit_info & NUM_UNITS_IS_NUM_VDEVS)
  1203. num_units = TARGET_NUM_VDEVS + 1;
  1204. ath10k_dbg(ATH10K_DBG_WMI,
  1205. "wmi mem_req_id %d num_units %d num_unit_info %d unit size %d actual units %d\n",
  1206. req_id,
  1207. __le32_to_cpu(ev->mem_reqs[i].num_units),
  1208. num_unit_info,
  1209. unit_size,
  1210. num_units);
  1211. ret = ath10k_wmi_alloc_host_mem(ar, req_id, num_units,
  1212. unit_size);
  1213. if (ret)
  1214. return;
  1215. }
  1216. exit:
  1217. ath10k_dbg(ATH10K_DBG_WMI,
  1218. "wmi event service ready sw_ver 0x%08x abi_ver %u phy_cap 0x%08x ht_cap 0x%08x vht_cap 0x%08x vht_supp_msc 0x%08x sys_cap_info 0x%08x mem_reqs %u num_rf_chains %u\n",
  1219. __le32_to_cpu(ev->sw_version),
  1220. __le32_to_cpu(ev->abi_version),
  1221. __le32_to_cpu(ev->phy_capability),
  1222. __le32_to_cpu(ev->ht_cap_info),
  1223. __le32_to_cpu(ev->vht_cap_info),
  1224. __le32_to_cpu(ev->vht_supp_mcs),
  1225. __le32_to_cpu(ev->sys_cap_info),
  1226. __le32_to_cpu(ev->num_mem_reqs),
  1227. __le32_to_cpu(ev->num_rf_chains));
  1228. complete(&ar->wmi.service_ready);
  1229. }
  1230. static int ath10k_wmi_ready_event_rx(struct ath10k *ar, struct sk_buff *skb)
  1231. {
  1232. struct wmi_ready_event *ev = (struct wmi_ready_event *)skb->data;
  1233. if (WARN_ON(skb->len < sizeof(*ev)))
  1234. return -EINVAL;
  1235. memcpy(ar->mac_addr, ev->mac_addr.addr, ETH_ALEN);
  1236. ath10k_dbg(ATH10K_DBG_WMI,
  1237. "wmi event ready sw_version %u abi_version %u mac_addr %pM status %d\n",
  1238. __le32_to_cpu(ev->sw_version),
  1239. __le32_to_cpu(ev->abi_version),
  1240. ev->mac_addr.addr,
  1241. __le32_to_cpu(ev->status));
  1242. complete(&ar->wmi.unified_ready);
  1243. return 0;
  1244. }
  1245. static void ath10k_wmi_main_process_rx(struct ath10k *ar, struct sk_buff *skb)
  1246. {
  1247. struct wmi_cmd_hdr *cmd_hdr;
  1248. enum wmi_event_id id;
  1249. u16 len;
  1250. cmd_hdr = (struct wmi_cmd_hdr *)skb->data;
  1251. id = MS(__le32_to_cpu(cmd_hdr->cmd_id), WMI_CMD_HDR_CMD_ID);
  1252. if (skb_pull(skb, sizeof(struct wmi_cmd_hdr)) == NULL)
  1253. return;
  1254. len = skb->len;
  1255. trace_ath10k_wmi_event(id, skb->data, skb->len);
  1256. switch (id) {
  1257. case WMI_MGMT_RX_EVENTID:
  1258. ath10k_wmi_event_mgmt_rx(ar, skb);
  1259. /* mgmt_rx() owns the skb now! */
  1260. return;
  1261. case WMI_SCAN_EVENTID:
  1262. ath10k_wmi_event_scan(ar, skb);
  1263. break;
  1264. case WMI_CHAN_INFO_EVENTID:
  1265. ath10k_wmi_event_chan_info(ar, skb);
  1266. break;
  1267. case WMI_ECHO_EVENTID:
  1268. ath10k_wmi_event_echo(ar, skb);
  1269. break;
  1270. case WMI_DEBUG_MESG_EVENTID:
  1271. ath10k_wmi_event_debug_mesg(ar, skb);
  1272. break;
  1273. case WMI_UPDATE_STATS_EVENTID:
  1274. ath10k_wmi_event_update_stats(ar, skb);
  1275. break;
  1276. case WMI_VDEV_START_RESP_EVENTID:
  1277. ath10k_wmi_event_vdev_start_resp(ar, skb);
  1278. break;
  1279. case WMI_VDEV_STOPPED_EVENTID:
  1280. ath10k_wmi_event_vdev_stopped(ar, skb);
  1281. break;
  1282. case WMI_PEER_STA_KICKOUT_EVENTID:
  1283. ath10k_wmi_event_peer_sta_kickout(ar, skb);
  1284. break;
  1285. case WMI_HOST_SWBA_EVENTID:
  1286. ath10k_wmi_event_host_swba(ar, skb);
  1287. break;
  1288. case WMI_TBTTOFFSET_UPDATE_EVENTID:
  1289. ath10k_wmi_event_tbttoffset_update(ar, skb);
  1290. break;
  1291. case WMI_PHYERR_EVENTID:
  1292. ath10k_wmi_event_phyerr(ar, skb);
  1293. break;
  1294. case WMI_ROAM_EVENTID:
  1295. ath10k_wmi_event_roam(ar, skb);
  1296. break;
  1297. case WMI_PROFILE_MATCH:
  1298. ath10k_wmi_event_profile_match(ar, skb);
  1299. break;
  1300. case WMI_DEBUG_PRINT_EVENTID:
  1301. ath10k_wmi_event_debug_print(ar, skb);
  1302. break;
  1303. case WMI_PDEV_QVIT_EVENTID:
  1304. ath10k_wmi_event_pdev_qvit(ar, skb);
  1305. break;
  1306. case WMI_WLAN_PROFILE_DATA_EVENTID:
  1307. ath10k_wmi_event_wlan_profile_data(ar, skb);
  1308. break;
  1309. case WMI_RTT_MEASUREMENT_REPORT_EVENTID:
  1310. ath10k_wmi_event_rtt_measurement_report(ar, skb);
  1311. break;
  1312. case WMI_TSF_MEASUREMENT_REPORT_EVENTID:
  1313. ath10k_wmi_event_tsf_measurement_report(ar, skb);
  1314. break;
  1315. case WMI_RTT_ERROR_REPORT_EVENTID:
  1316. ath10k_wmi_event_rtt_error_report(ar, skb);
  1317. break;
  1318. case WMI_WOW_WAKEUP_HOST_EVENTID:
  1319. ath10k_wmi_event_wow_wakeup_host(ar, skb);
  1320. break;
  1321. case WMI_DCS_INTERFERENCE_EVENTID:
  1322. ath10k_wmi_event_dcs_interference(ar, skb);
  1323. break;
  1324. case WMI_PDEV_TPC_CONFIG_EVENTID:
  1325. ath10k_wmi_event_pdev_tpc_config(ar, skb);
  1326. break;
  1327. case WMI_PDEV_FTM_INTG_EVENTID:
  1328. ath10k_wmi_event_pdev_ftm_intg(ar, skb);
  1329. break;
  1330. case WMI_GTK_OFFLOAD_STATUS_EVENTID:
  1331. ath10k_wmi_event_gtk_offload_status(ar, skb);
  1332. break;
  1333. case WMI_GTK_REKEY_FAIL_EVENTID:
  1334. ath10k_wmi_event_gtk_rekey_fail(ar, skb);
  1335. break;
  1336. case WMI_TX_DELBA_COMPLETE_EVENTID:
  1337. ath10k_wmi_event_delba_complete(ar, skb);
  1338. break;
  1339. case WMI_TX_ADDBA_COMPLETE_EVENTID:
  1340. ath10k_wmi_event_addba_complete(ar, skb);
  1341. break;
  1342. case WMI_VDEV_INSTALL_KEY_COMPLETE_EVENTID:
  1343. ath10k_wmi_event_vdev_install_key_complete(ar, skb);
  1344. break;
  1345. case WMI_SERVICE_READY_EVENTID:
  1346. ath10k_wmi_service_ready_event_rx(ar, skb);
  1347. break;
  1348. case WMI_READY_EVENTID:
  1349. ath10k_wmi_ready_event_rx(ar, skb);
  1350. break;
  1351. default:
  1352. ath10k_warn("Unknown eventid: %d\n", id);
  1353. break;
  1354. }
  1355. dev_kfree_skb(skb);
  1356. }
  1357. static void ath10k_wmi_10x_process_rx(struct ath10k *ar, struct sk_buff *skb)
  1358. {
  1359. struct wmi_cmd_hdr *cmd_hdr;
  1360. enum wmi_10x_event_id id;
  1361. u16 len;
  1362. cmd_hdr = (struct wmi_cmd_hdr *)skb->data;
  1363. id = MS(__le32_to_cpu(cmd_hdr->cmd_id), WMI_CMD_HDR_CMD_ID);
  1364. if (skb_pull(skb, sizeof(struct wmi_cmd_hdr)) == NULL)
  1365. return;
  1366. len = skb->len;
  1367. trace_ath10k_wmi_event(id, skb->data, skb->len);
  1368. switch (id) {
  1369. case WMI_10X_MGMT_RX_EVENTID:
  1370. ath10k_wmi_event_mgmt_rx(ar, skb);
  1371. /* mgmt_rx() owns the skb now! */
  1372. return;
  1373. case WMI_10X_SCAN_EVENTID:
  1374. ath10k_wmi_event_scan(ar, skb);
  1375. break;
  1376. case WMI_10X_CHAN_INFO_EVENTID:
  1377. ath10k_wmi_event_chan_info(ar, skb);
  1378. break;
  1379. case WMI_10X_ECHO_EVENTID:
  1380. ath10k_wmi_event_echo(ar, skb);
  1381. break;
  1382. case WMI_10X_DEBUG_MESG_EVENTID:
  1383. ath10k_wmi_event_debug_mesg(ar, skb);
  1384. break;
  1385. case WMI_10X_UPDATE_STATS_EVENTID:
  1386. ath10k_wmi_event_update_stats(ar, skb);
  1387. break;
  1388. case WMI_10X_VDEV_START_RESP_EVENTID:
  1389. ath10k_wmi_event_vdev_start_resp(ar, skb);
  1390. break;
  1391. case WMI_10X_VDEV_STOPPED_EVENTID:
  1392. ath10k_wmi_event_vdev_stopped(ar, skb);
  1393. break;
  1394. case WMI_10X_PEER_STA_KICKOUT_EVENTID:
  1395. ath10k_wmi_event_peer_sta_kickout(ar, skb);
  1396. break;
  1397. case WMI_10X_HOST_SWBA_EVENTID:
  1398. ath10k_wmi_event_host_swba(ar, skb);
  1399. break;
  1400. case WMI_10X_TBTTOFFSET_UPDATE_EVENTID:
  1401. ath10k_wmi_event_tbttoffset_update(ar, skb);
  1402. break;
  1403. case WMI_10X_PHYERR_EVENTID:
  1404. ath10k_wmi_event_phyerr(ar, skb);
  1405. break;
  1406. case WMI_10X_ROAM_EVENTID:
  1407. ath10k_wmi_event_roam(ar, skb);
  1408. break;
  1409. case WMI_10X_PROFILE_MATCH:
  1410. ath10k_wmi_event_profile_match(ar, skb);
  1411. break;
  1412. case WMI_10X_DEBUG_PRINT_EVENTID:
  1413. ath10k_wmi_event_debug_print(ar, skb);
  1414. break;
  1415. case WMI_10X_PDEV_QVIT_EVENTID:
  1416. ath10k_wmi_event_pdev_qvit(ar, skb);
  1417. break;
  1418. case WMI_10X_WLAN_PROFILE_DATA_EVENTID:
  1419. ath10k_wmi_event_wlan_profile_data(ar, skb);
  1420. break;
  1421. case WMI_10X_RTT_MEASUREMENT_REPORT_EVENTID:
  1422. ath10k_wmi_event_rtt_measurement_report(ar, skb);
  1423. break;
  1424. case WMI_10X_TSF_MEASUREMENT_REPORT_EVENTID:
  1425. ath10k_wmi_event_tsf_measurement_report(ar, skb);
  1426. break;
  1427. case WMI_10X_RTT_ERROR_REPORT_EVENTID:
  1428. ath10k_wmi_event_rtt_error_report(ar, skb);
  1429. break;
  1430. case WMI_10X_WOW_WAKEUP_HOST_EVENTID:
  1431. ath10k_wmi_event_wow_wakeup_host(ar, skb);
  1432. break;
  1433. case WMI_10X_DCS_INTERFERENCE_EVENTID:
  1434. ath10k_wmi_event_dcs_interference(ar, skb);
  1435. break;
  1436. case WMI_10X_PDEV_TPC_CONFIG_EVENTID:
  1437. ath10k_wmi_event_pdev_tpc_config(ar, skb);
  1438. break;
  1439. case WMI_10X_INST_RSSI_STATS_EVENTID:
  1440. ath10k_wmi_event_inst_rssi_stats(ar, skb);
  1441. break;
  1442. case WMI_10X_VDEV_STANDBY_REQ_EVENTID:
  1443. ath10k_wmi_event_vdev_standby_req(ar, skb);
  1444. break;
  1445. case WMI_10X_VDEV_RESUME_REQ_EVENTID:
  1446. ath10k_wmi_event_vdev_resume_req(ar, skb);
  1447. break;
  1448. case WMI_10X_SERVICE_READY_EVENTID:
  1449. ath10k_wmi_10x_service_ready_event_rx(ar, skb);
  1450. break;
  1451. case WMI_10X_READY_EVENTID:
  1452. ath10k_wmi_ready_event_rx(ar, skb);
  1453. break;
  1454. default:
  1455. ath10k_warn("Unknown eventid: %d\n", id);
  1456. break;
  1457. }
  1458. dev_kfree_skb(skb);
  1459. }
  1460. static void ath10k_wmi_process_rx(struct ath10k *ar, struct sk_buff *skb)
  1461. {
  1462. if (test_bit(ATH10K_FW_FEATURE_WMI_10X, ar->fw_features))
  1463. ath10k_wmi_10x_process_rx(ar, skb);
  1464. else
  1465. ath10k_wmi_main_process_rx(ar, skb);
  1466. }
  1467. /* WMI Initialization functions */
  1468. int ath10k_wmi_attach(struct ath10k *ar)
  1469. {
  1470. int ret;
  1471. if (test_bit(ATH10K_FW_FEATURE_WMI_10X, ar->fw_features)) {
  1472. ath10k_warn("Firmware 10.X is not yet supported\n");
  1473. ar->wmi.cmd = &wmi_10x_cmd_map;
  1474. ret = -ENOTSUPP;
  1475. } else {
  1476. ar->wmi.cmd = &wmi_cmd_map;
  1477. ret = 0;
  1478. }
  1479. init_completion(&ar->wmi.service_ready);
  1480. init_completion(&ar->wmi.unified_ready);
  1481. init_waitqueue_head(&ar->wmi.tx_credits_wq);
  1482. return ret;
  1483. }
  1484. void ath10k_wmi_detach(struct ath10k *ar)
  1485. {
  1486. int i;
  1487. /* free the host memory chunks requested by firmware */
  1488. for (i = 0; i < ar->wmi.num_mem_chunks; i++) {
  1489. dma_free_coherent(ar->dev,
  1490. ar->wmi.mem_chunks[i].len,
  1491. ar->wmi.mem_chunks[i].vaddr,
  1492. ar->wmi.mem_chunks[i].paddr);
  1493. }
  1494. ar->wmi.num_mem_chunks = 0;
  1495. }
  1496. int ath10k_wmi_connect_htc_service(struct ath10k *ar)
  1497. {
  1498. int status;
  1499. struct ath10k_htc_svc_conn_req conn_req;
  1500. struct ath10k_htc_svc_conn_resp conn_resp;
  1501. memset(&conn_req, 0, sizeof(conn_req));
  1502. memset(&conn_resp, 0, sizeof(conn_resp));
  1503. /* these fields are the same for all service endpoints */
  1504. conn_req.ep_ops.ep_tx_complete = ath10k_wmi_htc_tx_complete;
  1505. conn_req.ep_ops.ep_rx_complete = ath10k_wmi_process_rx;
  1506. conn_req.ep_ops.ep_tx_credits = ath10k_wmi_op_ep_tx_credits;
  1507. /* connect to control service */
  1508. conn_req.service_id = ATH10K_HTC_SVC_ID_WMI_CONTROL;
  1509. status = ath10k_htc_connect_service(&ar->htc, &conn_req, &conn_resp);
  1510. if (status) {
  1511. ath10k_warn("failed to connect to WMI CONTROL service status: %d\n",
  1512. status);
  1513. return status;
  1514. }
  1515. ar->wmi.eid = conn_resp.eid;
  1516. return 0;
  1517. }
  1518. int ath10k_wmi_pdev_set_regdomain(struct ath10k *ar, u16 rd, u16 rd2g,
  1519. u16 rd5g, u16 ctl2g, u16 ctl5g)
  1520. {
  1521. struct wmi_pdev_set_regdomain_cmd *cmd;
  1522. struct sk_buff *skb;
  1523. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1524. if (!skb)
  1525. return -ENOMEM;
  1526. cmd = (struct wmi_pdev_set_regdomain_cmd *)skb->data;
  1527. cmd->reg_domain = __cpu_to_le32(rd);
  1528. cmd->reg_domain_2G = __cpu_to_le32(rd2g);
  1529. cmd->reg_domain_5G = __cpu_to_le32(rd5g);
  1530. cmd->conformance_test_limit_2G = __cpu_to_le32(ctl2g);
  1531. cmd->conformance_test_limit_5G = __cpu_to_le32(ctl5g);
  1532. ath10k_dbg(ATH10K_DBG_WMI,
  1533. "wmi pdev regdomain rd %x rd2g %x rd5g %x ctl2g %x ctl5g %x\n",
  1534. rd, rd2g, rd5g, ctl2g, ctl5g);
  1535. return ath10k_wmi_cmd_send(ar, skb,
  1536. ar->wmi.cmd->pdev_set_regdomain_cmdid);
  1537. }
  1538. int ath10k_wmi_pdev_set_channel(struct ath10k *ar,
  1539. const struct wmi_channel_arg *arg)
  1540. {
  1541. struct wmi_set_channel_cmd *cmd;
  1542. struct sk_buff *skb;
  1543. if (arg->passive)
  1544. return -EINVAL;
  1545. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1546. if (!skb)
  1547. return -ENOMEM;
  1548. cmd = (struct wmi_set_channel_cmd *)skb->data;
  1549. cmd->chan.mhz = __cpu_to_le32(arg->freq);
  1550. cmd->chan.band_center_freq1 = __cpu_to_le32(arg->freq);
  1551. cmd->chan.mode = arg->mode;
  1552. cmd->chan.min_power = arg->min_power;
  1553. cmd->chan.max_power = arg->max_power;
  1554. cmd->chan.reg_power = arg->max_reg_power;
  1555. cmd->chan.reg_classid = arg->reg_class_id;
  1556. cmd->chan.antenna_max = arg->max_antenna_gain;
  1557. ath10k_dbg(ATH10K_DBG_WMI,
  1558. "wmi set channel mode %d freq %d\n",
  1559. arg->mode, arg->freq);
  1560. return ath10k_wmi_cmd_send(ar, skb,
  1561. ar->wmi.cmd->pdev_set_channel_cmdid);
  1562. }
  1563. int ath10k_wmi_pdev_suspend_target(struct ath10k *ar)
  1564. {
  1565. struct wmi_pdev_suspend_cmd *cmd;
  1566. struct sk_buff *skb;
  1567. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1568. if (!skb)
  1569. return -ENOMEM;
  1570. cmd = (struct wmi_pdev_suspend_cmd *)skb->data;
  1571. cmd->suspend_opt = WMI_PDEV_SUSPEND;
  1572. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->pdev_suspend_cmdid);
  1573. }
  1574. int ath10k_wmi_pdev_resume_target(struct ath10k *ar)
  1575. {
  1576. struct sk_buff *skb;
  1577. skb = ath10k_wmi_alloc_skb(0);
  1578. if (skb == NULL)
  1579. return -ENOMEM;
  1580. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->pdev_resume_cmdid);
  1581. }
  1582. int ath10k_wmi_pdev_set_param(struct ath10k *ar, enum wmi_pdev_param id,
  1583. u32 value)
  1584. {
  1585. struct wmi_pdev_set_param_cmd *cmd;
  1586. struct sk_buff *skb;
  1587. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1588. if (!skb)
  1589. return -ENOMEM;
  1590. cmd = (struct wmi_pdev_set_param_cmd *)skb->data;
  1591. cmd->param_id = __cpu_to_le32(id);
  1592. cmd->param_value = __cpu_to_le32(value);
  1593. ath10k_dbg(ATH10K_DBG_WMI, "wmi pdev set param %d value %d\n",
  1594. id, value);
  1595. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->pdev_set_param_cmdid);
  1596. }
  1597. int ath10k_wmi_cmd_init(struct ath10k *ar)
  1598. {
  1599. struct wmi_init_cmd *cmd;
  1600. struct sk_buff *buf;
  1601. struct wmi_resource_config config = {};
  1602. u32 len, val;
  1603. int i;
  1604. config.num_vdevs = __cpu_to_le32(TARGET_NUM_VDEVS);
  1605. config.num_peers = __cpu_to_le32(TARGET_NUM_PEERS + TARGET_NUM_VDEVS);
  1606. config.num_offload_peers = __cpu_to_le32(TARGET_NUM_OFFLOAD_PEERS);
  1607. config.num_offload_reorder_bufs =
  1608. __cpu_to_le32(TARGET_NUM_OFFLOAD_REORDER_BUFS);
  1609. config.num_peer_keys = __cpu_to_le32(TARGET_NUM_PEER_KEYS);
  1610. config.num_tids = __cpu_to_le32(TARGET_NUM_TIDS);
  1611. config.ast_skid_limit = __cpu_to_le32(TARGET_AST_SKID_LIMIT);
  1612. config.tx_chain_mask = __cpu_to_le32(TARGET_TX_CHAIN_MASK);
  1613. config.rx_chain_mask = __cpu_to_le32(TARGET_RX_CHAIN_MASK);
  1614. config.rx_timeout_pri_vo = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI);
  1615. config.rx_timeout_pri_vi = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI);
  1616. config.rx_timeout_pri_be = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI);
  1617. config.rx_timeout_pri_bk = __cpu_to_le32(TARGET_RX_TIMEOUT_HI_PRI);
  1618. config.rx_decap_mode = __cpu_to_le32(TARGET_RX_DECAP_MODE);
  1619. config.scan_max_pending_reqs =
  1620. __cpu_to_le32(TARGET_SCAN_MAX_PENDING_REQS);
  1621. config.bmiss_offload_max_vdev =
  1622. __cpu_to_le32(TARGET_BMISS_OFFLOAD_MAX_VDEV);
  1623. config.roam_offload_max_vdev =
  1624. __cpu_to_le32(TARGET_ROAM_OFFLOAD_MAX_VDEV);
  1625. config.roam_offload_max_ap_profiles =
  1626. __cpu_to_le32(TARGET_ROAM_OFFLOAD_MAX_AP_PROFILES);
  1627. config.num_mcast_groups = __cpu_to_le32(TARGET_NUM_MCAST_GROUPS);
  1628. config.num_mcast_table_elems =
  1629. __cpu_to_le32(TARGET_NUM_MCAST_TABLE_ELEMS);
  1630. config.mcast2ucast_mode = __cpu_to_le32(TARGET_MCAST2UCAST_MODE);
  1631. config.tx_dbg_log_size = __cpu_to_le32(TARGET_TX_DBG_LOG_SIZE);
  1632. config.num_wds_entries = __cpu_to_le32(TARGET_NUM_WDS_ENTRIES);
  1633. config.dma_burst_size = __cpu_to_le32(TARGET_DMA_BURST_SIZE);
  1634. config.mac_aggr_delim = __cpu_to_le32(TARGET_MAC_AGGR_DELIM);
  1635. val = TARGET_RX_SKIP_DEFRAG_TIMEOUT_DUP_DETECTION_CHECK;
  1636. config.rx_skip_defrag_timeout_dup_detection_check = __cpu_to_le32(val);
  1637. config.vow_config = __cpu_to_le32(TARGET_VOW_CONFIG);
  1638. config.gtk_offload_max_vdev =
  1639. __cpu_to_le32(TARGET_GTK_OFFLOAD_MAX_VDEV);
  1640. config.num_msdu_desc = __cpu_to_le32(TARGET_NUM_MSDU_DESC);
  1641. config.max_frag_entries = __cpu_to_le32(TARGET_MAX_FRAG_ENTRIES);
  1642. len = sizeof(*cmd) +
  1643. (sizeof(struct host_memory_chunk) * ar->wmi.num_mem_chunks);
  1644. buf = ath10k_wmi_alloc_skb(len);
  1645. if (!buf)
  1646. return -ENOMEM;
  1647. cmd = (struct wmi_init_cmd *)buf->data;
  1648. if (ar->wmi.num_mem_chunks == 0) {
  1649. cmd->num_host_mem_chunks = 0;
  1650. goto out;
  1651. }
  1652. ath10k_dbg(ATH10K_DBG_WMI, "wmi sending %d memory chunks info.\n",
  1653. __cpu_to_le32(ar->wmi.num_mem_chunks));
  1654. cmd->num_host_mem_chunks = __cpu_to_le32(ar->wmi.num_mem_chunks);
  1655. for (i = 0; i < ar->wmi.num_mem_chunks; i++) {
  1656. cmd->host_mem_chunks[i].ptr =
  1657. __cpu_to_le32(ar->wmi.mem_chunks[i].paddr);
  1658. cmd->host_mem_chunks[i].size =
  1659. __cpu_to_le32(ar->wmi.mem_chunks[i].len);
  1660. cmd->host_mem_chunks[i].req_id =
  1661. __cpu_to_le32(ar->wmi.mem_chunks[i].req_id);
  1662. ath10k_dbg(ATH10K_DBG_WMI,
  1663. "wmi chunk %d len %d requested, addr 0x%x\n",
  1664. i,
  1665. cmd->host_mem_chunks[i].size,
  1666. cmd->host_mem_chunks[i].ptr);
  1667. }
  1668. out:
  1669. memcpy(&cmd->resource_config, &config, sizeof(config));
  1670. ath10k_dbg(ATH10K_DBG_WMI, "wmi init\n");
  1671. return ath10k_wmi_cmd_send(ar, buf, ar->wmi.cmd->init_cmdid);
  1672. }
  1673. static int ath10k_wmi_start_scan_calc_len(const struct wmi_start_scan_arg *arg)
  1674. {
  1675. int len;
  1676. len = sizeof(struct wmi_start_scan_cmd);
  1677. if (arg->ie_len) {
  1678. if (!arg->ie)
  1679. return -EINVAL;
  1680. if (arg->ie_len > WLAN_SCAN_PARAMS_MAX_IE_LEN)
  1681. return -EINVAL;
  1682. len += sizeof(struct wmi_ie_data);
  1683. len += roundup(arg->ie_len, 4);
  1684. }
  1685. if (arg->n_channels) {
  1686. if (!arg->channels)
  1687. return -EINVAL;
  1688. if (arg->n_channels > ARRAY_SIZE(arg->channels))
  1689. return -EINVAL;
  1690. len += sizeof(struct wmi_chan_list);
  1691. len += sizeof(__le32) * arg->n_channels;
  1692. }
  1693. if (arg->n_ssids) {
  1694. if (!arg->ssids)
  1695. return -EINVAL;
  1696. if (arg->n_ssids > WLAN_SCAN_PARAMS_MAX_SSID)
  1697. return -EINVAL;
  1698. len += sizeof(struct wmi_ssid_list);
  1699. len += sizeof(struct wmi_ssid) * arg->n_ssids;
  1700. }
  1701. if (arg->n_bssids) {
  1702. if (!arg->bssids)
  1703. return -EINVAL;
  1704. if (arg->n_bssids > WLAN_SCAN_PARAMS_MAX_BSSID)
  1705. return -EINVAL;
  1706. len += sizeof(struct wmi_bssid_list);
  1707. len += sizeof(struct wmi_mac_addr) * arg->n_bssids;
  1708. }
  1709. return len;
  1710. }
  1711. int ath10k_wmi_start_scan(struct ath10k *ar,
  1712. const struct wmi_start_scan_arg *arg)
  1713. {
  1714. struct wmi_start_scan_cmd *cmd;
  1715. struct sk_buff *skb;
  1716. struct wmi_ie_data *ie;
  1717. struct wmi_chan_list *channels;
  1718. struct wmi_ssid_list *ssids;
  1719. struct wmi_bssid_list *bssids;
  1720. u32 scan_id;
  1721. u32 scan_req_id;
  1722. int off;
  1723. int len = 0;
  1724. int i;
  1725. len = ath10k_wmi_start_scan_calc_len(arg);
  1726. if (len < 0)
  1727. return len; /* len contains error code here */
  1728. skb = ath10k_wmi_alloc_skb(len);
  1729. if (!skb)
  1730. return -ENOMEM;
  1731. scan_id = WMI_HOST_SCAN_REQ_ID_PREFIX;
  1732. scan_id |= arg->scan_id;
  1733. scan_req_id = WMI_HOST_SCAN_REQUESTOR_ID_PREFIX;
  1734. scan_req_id |= arg->scan_req_id;
  1735. cmd = (struct wmi_start_scan_cmd *)skb->data;
  1736. cmd->scan_id = __cpu_to_le32(scan_id);
  1737. cmd->scan_req_id = __cpu_to_le32(scan_req_id);
  1738. cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
  1739. cmd->scan_priority = __cpu_to_le32(arg->scan_priority);
  1740. cmd->notify_scan_events = __cpu_to_le32(arg->notify_scan_events);
  1741. cmd->dwell_time_active = __cpu_to_le32(arg->dwell_time_active);
  1742. cmd->dwell_time_passive = __cpu_to_le32(arg->dwell_time_passive);
  1743. cmd->min_rest_time = __cpu_to_le32(arg->min_rest_time);
  1744. cmd->max_rest_time = __cpu_to_le32(arg->max_rest_time);
  1745. cmd->repeat_probe_time = __cpu_to_le32(arg->repeat_probe_time);
  1746. cmd->probe_spacing_time = __cpu_to_le32(arg->probe_spacing_time);
  1747. cmd->idle_time = __cpu_to_le32(arg->idle_time);
  1748. cmd->max_scan_time = __cpu_to_le32(arg->max_scan_time);
  1749. cmd->probe_delay = __cpu_to_le32(arg->probe_delay);
  1750. cmd->scan_ctrl_flags = __cpu_to_le32(arg->scan_ctrl_flags);
  1751. /* TLV list starts after fields included in the struct */
  1752. off = sizeof(*cmd);
  1753. if (arg->n_channels) {
  1754. channels = (void *)skb->data + off;
  1755. channels->tag = __cpu_to_le32(WMI_CHAN_LIST_TAG);
  1756. channels->num_chan = __cpu_to_le32(arg->n_channels);
  1757. for (i = 0; i < arg->n_channels; i++)
  1758. channels->channel_list[i] =
  1759. __cpu_to_le32(arg->channels[i]);
  1760. off += sizeof(*channels);
  1761. off += sizeof(__le32) * arg->n_channels;
  1762. }
  1763. if (arg->n_ssids) {
  1764. ssids = (void *)skb->data + off;
  1765. ssids->tag = __cpu_to_le32(WMI_SSID_LIST_TAG);
  1766. ssids->num_ssids = __cpu_to_le32(arg->n_ssids);
  1767. for (i = 0; i < arg->n_ssids; i++) {
  1768. ssids->ssids[i].ssid_len =
  1769. __cpu_to_le32(arg->ssids[i].len);
  1770. memcpy(&ssids->ssids[i].ssid,
  1771. arg->ssids[i].ssid,
  1772. arg->ssids[i].len);
  1773. }
  1774. off += sizeof(*ssids);
  1775. off += sizeof(struct wmi_ssid) * arg->n_ssids;
  1776. }
  1777. if (arg->n_bssids) {
  1778. bssids = (void *)skb->data + off;
  1779. bssids->tag = __cpu_to_le32(WMI_BSSID_LIST_TAG);
  1780. bssids->num_bssid = __cpu_to_le32(arg->n_bssids);
  1781. for (i = 0; i < arg->n_bssids; i++)
  1782. memcpy(&bssids->bssid_list[i],
  1783. arg->bssids[i].bssid,
  1784. ETH_ALEN);
  1785. off += sizeof(*bssids);
  1786. off += sizeof(struct wmi_mac_addr) * arg->n_bssids;
  1787. }
  1788. if (arg->ie_len) {
  1789. ie = (void *)skb->data + off;
  1790. ie->tag = __cpu_to_le32(WMI_IE_TAG);
  1791. ie->ie_len = __cpu_to_le32(arg->ie_len);
  1792. memcpy(ie->ie_data, arg->ie, arg->ie_len);
  1793. off += sizeof(*ie);
  1794. off += roundup(arg->ie_len, 4);
  1795. }
  1796. if (off != skb->len) {
  1797. dev_kfree_skb(skb);
  1798. return -EINVAL;
  1799. }
  1800. ath10k_dbg(ATH10K_DBG_WMI, "wmi start scan\n");
  1801. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->start_scan_cmdid);
  1802. }
  1803. void ath10k_wmi_start_scan_init(struct ath10k *ar,
  1804. struct wmi_start_scan_arg *arg)
  1805. {
  1806. /* setup commonly used values */
  1807. arg->scan_req_id = 1;
  1808. arg->scan_priority = WMI_SCAN_PRIORITY_LOW;
  1809. arg->dwell_time_active = 50;
  1810. arg->dwell_time_passive = 150;
  1811. arg->min_rest_time = 50;
  1812. arg->max_rest_time = 500;
  1813. arg->repeat_probe_time = 0;
  1814. arg->probe_spacing_time = 0;
  1815. arg->idle_time = 0;
  1816. arg->max_scan_time = 5000;
  1817. arg->probe_delay = 5;
  1818. arg->notify_scan_events = WMI_SCAN_EVENT_STARTED
  1819. | WMI_SCAN_EVENT_COMPLETED
  1820. | WMI_SCAN_EVENT_BSS_CHANNEL
  1821. | WMI_SCAN_EVENT_FOREIGN_CHANNEL
  1822. | WMI_SCAN_EVENT_DEQUEUED;
  1823. arg->scan_ctrl_flags |= WMI_SCAN_ADD_OFDM_RATES;
  1824. arg->scan_ctrl_flags |= WMI_SCAN_CHAN_STAT_EVENT;
  1825. arg->n_bssids = 1;
  1826. arg->bssids[0].bssid = "\xFF\xFF\xFF\xFF\xFF\xFF";
  1827. }
  1828. int ath10k_wmi_stop_scan(struct ath10k *ar, const struct wmi_stop_scan_arg *arg)
  1829. {
  1830. struct wmi_stop_scan_cmd *cmd;
  1831. struct sk_buff *skb;
  1832. u32 scan_id;
  1833. u32 req_id;
  1834. if (arg->req_id > 0xFFF)
  1835. return -EINVAL;
  1836. if (arg->req_type == WMI_SCAN_STOP_ONE && arg->u.scan_id > 0xFFF)
  1837. return -EINVAL;
  1838. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1839. if (!skb)
  1840. return -ENOMEM;
  1841. scan_id = arg->u.scan_id;
  1842. scan_id |= WMI_HOST_SCAN_REQ_ID_PREFIX;
  1843. req_id = arg->req_id;
  1844. req_id |= WMI_HOST_SCAN_REQUESTOR_ID_PREFIX;
  1845. cmd = (struct wmi_stop_scan_cmd *)skb->data;
  1846. cmd->req_type = __cpu_to_le32(arg->req_type);
  1847. cmd->vdev_id = __cpu_to_le32(arg->u.vdev_id);
  1848. cmd->scan_id = __cpu_to_le32(scan_id);
  1849. cmd->scan_req_id = __cpu_to_le32(req_id);
  1850. ath10k_dbg(ATH10K_DBG_WMI,
  1851. "wmi stop scan reqid %d req_type %d vdev/scan_id %d\n",
  1852. arg->req_id, arg->req_type, arg->u.scan_id);
  1853. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->stop_scan_cmdid);
  1854. }
  1855. int ath10k_wmi_vdev_create(struct ath10k *ar, u32 vdev_id,
  1856. enum wmi_vdev_type type,
  1857. enum wmi_vdev_subtype subtype,
  1858. const u8 macaddr[ETH_ALEN])
  1859. {
  1860. struct wmi_vdev_create_cmd *cmd;
  1861. struct sk_buff *skb;
  1862. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1863. if (!skb)
  1864. return -ENOMEM;
  1865. cmd = (struct wmi_vdev_create_cmd *)skb->data;
  1866. cmd->vdev_id = __cpu_to_le32(vdev_id);
  1867. cmd->vdev_type = __cpu_to_le32(type);
  1868. cmd->vdev_subtype = __cpu_to_le32(subtype);
  1869. memcpy(cmd->vdev_macaddr.addr, macaddr, ETH_ALEN);
  1870. ath10k_dbg(ATH10K_DBG_WMI,
  1871. "WMI vdev create: id %d type %d subtype %d macaddr %pM\n",
  1872. vdev_id, type, subtype, macaddr);
  1873. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_create_cmdid);
  1874. }
  1875. int ath10k_wmi_vdev_delete(struct ath10k *ar, u32 vdev_id)
  1876. {
  1877. struct wmi_vdev_delete_cmd *cmd;
  1878. struct sk_buff *skb;
  1879. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1880. if (!skb)
  1881. return -ENOMEM;
  1882. cmd = (struct wmi_vdev_delete_cmd *)skb->data;
  1883. cmd->vdev_id = __cpu_to_le32(vdev_id);
  1884. ath10k_dbg(ATH10K_DBG_WMI,
  1885. "WMI vdev delete id %d\n", vdev_id);
  1886. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_delete_cmdid);
  1887. }
  1888. static int ath10k_wmi_vdev_start_restart(struct ath10k *ar,
  1889. const struct wmi_vdev_start_request_arg *arg,
  1890. u32 cmd_id)
  1891. {
  1892. struct wmi_vdev_start_request_cmd *cmd;
  1893. struct sk_buff *skb;
  1894. const char *cmdname;
  1895. u32 flags = 0;
  1896. if (cmd_id != ar->wmi.cmd->vdev_start_request_cmdid &&
  1897. cmd_id != ar->wmi.cmd->vdev_restart_request_cmdid)
  1898. return -EINVAL;
  1899. if (WARN_ON(arg->ssid && arg->ssid_len == 0))
  1900. return -EINVAL;
  1901. if (WARN_ON(arg->hidden_ssid && !arg->ssid))
  1902. return -EINVAL;
  1903. if (WARN_ON(arg->ssid_len > sizeof(cmd->ssid.ssid)))
  1904. return -EINVAL;
  1905. if (cmd_id == ar->wmi.cmd->vdev_start_request_cmdid)
  1906. cmdname = "start";
  1907. else if (cmd_id == ar->wmi.cmd->vdev_restart_request_cmdid)
  1908. cmdname = "restart";
  1909. else
  1910. return -EINVAL; /* should not happen, we already check cmd_id */
  1911. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1912. if (!skb)
  1913. return -ENOMEM;
  1914. if (arg->hidden_ssid)
  1915. flags |= WMI_VDEV_START_HIDDEN_SSID;
  1916. if (arg->pmf_enabled)
  1917. flags |= WMI_VDEV_START_PMF_ENABLED;
  1918. cmd = (struct wmi_vdev_start_request_cmd *)skb->data;
  1919. cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
  1920. cmd->disable_hw_ack = __cpu_to_le32(arg->disable_hw_ack);
  1921. cmd->beacon_interval = __cpu_to_le32(arg->bcn_intval);
  1922. cmd->dtim_period = __cpu_to_le32(arg->dtim_period);
  1923. cmd->flags = __cpu_to_le32(flags);
  1924. cmd->bcn_tx_rate = __cpu_to_le32(arg->bcn_tx_rate);
  1925. cmd->bcn_tx_power = __cpu_to_le32(arg->bcn_tx_power);
  1926. if (arg->ssid) {
  1927. cmd->ssid.ssid_len = __cpu_to_le32(arg->ssid_len);
  1928. memcpy(cmd->ssid.ssid, arg->ssid, arg->ssid_len);
  1929. }
  1930. cmd->chan.mhz = __cpu_to_le32(arg->channel.freq);
  1931. cmd->chan.band_center_freq1 =
  1932. __cpu_to_le32(arg->channel.band_center_freq1);
  1933. cmd->chan.mode = arg->channel.mode;
  1934. cmd->chan.min_power = arg->channel.min_power;
  1935. cmd->chan.max_power = arg->channel.max_power;
  1936. cmd->chan.reg_power = arg->channel.max_reg_power;
  1937. cmd->chan.reg_classid = arg->channel.reg_class_id;
  1938. cmd->chan.antenna_max = arg->channel.max_antenna_gain;
  1939. ath10k_dbg(ATH10K_DBG_WMI,
  1940. "wmi vdev %s id 0x%x freq %d, mode %d, ch_flags: 0x%0X,"
  1941. "max_power: %d\n", cmdname, arg->vdev_id, arg->channel.freq,
  1942. arg->channel.mode, flags, arg->channel.max_power);
  1943. return ath10k_wmi_cmd_send(ar, skb, cmd_id);
  1944. }
  1945. int ath10k_wmi_vdev_start(struct ath10k *ar,
  1946. const struct wmi_vdev_start_request_arg *arg)
  1947. {
  1948. u32 cmd_id = ar->wmi.cmd->vdev_start_request_cmdid;
  1949. return ath10k_wmi_vdev_start_restart(ar, arg, cmd_id);
  1950. }
  1951. int ath10k_wmi_vdev_restart(struct ath10k *ar,
  1952. const struct wmi_vdev_start_request_arg *arg)
  1953. {
  1954. u32 cmd_id = ar->wmi.cmd->vdev_restart_request_cmdid;
  1955. return ath10k_wmi_vdev_start_restart(ar, arg, cmd_id);
  1956. }
  1957. int ath10k_wmi_vdev_stop(struct ath10k *ar, u32 vdev_id)
  1958. {
  1959. struct wmi_vdev_stop_cmd *cmd;
  1960. struct sk_buff *skb;
  1961. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1962. if (!skb)
  1963. return -ENOMEM;
  1964. cmd = (struct wmi_vdev_stop_cmd *)skb->data;
  1965. cmd->vdev_id = __cpu_to_le32(vdev_id);
  1966. ath10k_dbg(ATH10K_DBG_WMI, "wmi vdev stop id 0x%x\n", vdev_id);
  1967. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_stop_cmdid);
  1968. }
  1969. int ath10k_wmi_vdev_up(struct ath10k *ar, u32 vdev_id, u32 aid, const u8 *bssid)
  1970. {
  1971. struct wmi_vdev_up_cmd *cmd;
  1972. struct sk_buff *skb;
  1973. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1974. if (!skb)
  1975. return -ENOMEM;
  1976. cmd = (struct wmi_vdev_up_cmd *)skb->data;
  1977. cmd->vdev_id = __cpu_to_le32(vdev_id);
  1978. cmd->vdev_assoc_id = __cpu_to_le32(aid);
  1979. memcpy(&cmd->vdev_bssid.addr, bssid, 6);
  1980. ath10k_dbg(ATH10K_DBG_WMI,
  1981. "wmi mgmt vdev up id 0x%x assoc id %d bssid %pM\n",
  1982. vdev_id, aid, bssid);
  1983. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_up_cmdid);
  1984. }
  1985. int ath10k_wmi_vdev_down(struct ath10k *ar, u32 vdev_id)
  1986. {
  1987. struct wmi_vdev_down_cmd *cmd;
  1988. struct sk_buff *skb;
  1989. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1990. if (!skb)
  1991. return -ENOMEM;
  1992. cmd = (struct wmi_vdev_down_cmd *)skb->data;
  1993. cmd->vdev_id = __cpu_to_le32(vdev_id);
  1994. ath10k_dbg(ATH10K_DBG_WMI,
  1995. "wmi mgmt vdev down id 0x%x\n", vdev_id);
  1996. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_down_cmdid);
  1997. }
  1998. int ath10k_wmi_vdev_set_param(struct ath10k *ar, u32 vdev_id,
  1999. enum wmi_vdev_param param_id, u32 param_value)
  2000. {
  2001. struct wmi_vdev_set_param_cmd *cmd;
  2002. struct sk_buff *skb;
  2003. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2004. if (!skb)
  2005. return -ENOMEM;
  2006. cmd = (struct wmi_vdev_set_param_cmd *)skb->data;
  2007. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2008. cmd->param_id = __cpu_to_le32(param_id);
  2009. cmd->param_value = __cpu_to_le32(param_value);
  2010. ath10k_dbg(ATH10K_DBG_WMI,
  2011. "wmi vdev id 0x%x set param %d value %d\n",
  2012. vdev_id, param_id, param_value);
  2013. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_set_param_cmdid);
  2014. }
  2015. int ath10k_wmi_vdev_install_key(struct ath10k *ar,
  2016. const struct wmi_vdev_install_key_arg *arg)
  2017. {
  2018. struct wmi_vdev_install_key_cmd *cmd;
  2019. struct sk_buff *skb;
  2020. if (arg->key_cipher == WMI_CIPHER_NONE && arg->key_data != NULL)
  2021. return -EINVAL;
  2022. if (arg->key_cipher != WMI_CIPHER_NONE && arg->key_data == NULL)
  2023. return -EINVAL;
  2024. skb = ath10k_wmi_alloc_skb(sizeof(*cmd) + arg->key_len);
  2025. if (!skb)
  2026. return -ENOMEM;
  2027. cmd = (struct wmi_vdev_install_key_cmd *)skb->data;
  2028. cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
  2029. cmd->key_idx = __cpu_to_le32(arg->key_idx);
  2030. cmd->key_flags = __cpu_to_le32(arg->key_flags);
  2031. cmd->key_cipher = __cpu_to_le32(arg->key_cipher);
  2032. cmd->key_len = __cpu_to_le32(arg->key_len);
  2033. cmd->key_txmic_len = __cpu_to_le32(arg->key_txmic_len);
  2034. cmd->key_rxmic_len = __cpu_to_le32(arg->key_rxmic_len);
  2035. if (arg->macaddr)
  2036. memcpy(cmd->peer_macaddr.addr, arg->macaddr, ETH_ALEN);
  2037. if (arg->key_data)
  2038. memcpy(cmd->key_data, arg->key_data, arg->key_len);
  2039. ath10k_dbg(ATH10K_DBG_WMI,
  2040. "wmi vdev install key idx %d cipher %d len %d\n",
  2041. arg->key_idx, arg->key_cipher, arg->key_len);
  2042. return ath10k_wmi_cmd_send(ar, skb,
  2043. ar->wmi.cmd->vdev_install_key_cmdid);
  2044. }
  2045. int ath10k_wmi_peer_create(struct ath10k *ar, u32 vdev_id,
  2046. const u8 peer_addr[ETH_ALEN])
  2047. {
  2048. struct wmi_peer_create_cmd *cmd;
  2049. struct sk_buff *skb;
  2050. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2051. if (!skb)
  2052. return -ENOMEM;
  2053. cmd = (struct wmi_peer_create_cmd *)skb->data;
  2054. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2055. memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN);
  2056. ath10k_dbg(ATH10K_DBG_WMI,
  2057. "wmi peer create vdev_id %d peer_addr %pM\n",
  2058. vdev_id, peer_addr);
  2059. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_create_cmdid);
  2060. }
  2061. int ath10k_wmi_peer_delete(struct ath10k *ar, u32 vdev_id,
  2062. const u8 peer_addr[ETH_ALEN])
  2063. {
  2064. struct wmi_peer_delete_cmd *cmd;
  2065. struct sk_buff *skb;
  2066. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2067. if (!skb)
  2068. return -ENOMEM;
  2069. cmd = (struct wmi_peer_delete_cmd *)skb->data;
  2070. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2071. memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN);
  2072. ath10k_dbg(ATH10K_DBG_WMI,
  2073. "wmi peer delete vdev_id %d peer_addr %pM\n",
  2074. vdev_id, peer_addr);
  2075. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_delete_cmdid);
  2076. }
  2077. int ath10k_wmi_peer_flush(struct ath10k *ar, u32 vdev_id,
  2078. const u8 peer_addr[ETH_ALEN], u32 tid_bitmap)
  2079. {
  2080. struct wmi_peer_flush_tids_cmd *cmd;
  2081. struct sk_buff *skb;
  2082. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2083. if (!skb)
  2084. return -ENOMEM;
  2085. cmd = (struct wmi_peer_flush_tids_cmd *)skb->data;
  2086. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2087. cmd->peer_tid_bitmap = __cpu_to_le32(tid_bitmap);
  2088. memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN);
  2089. ath10k_dbg(ATH10K_DBG_WMI,
  2090. "wmi peer flush vdev_id %d peer_addr %pM tids %08x\n",
  2091. vdev_id, peer_addr, tid_bitmap);
  2092. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_flush_tids_cmdid);
  2093. }
  2094. int ath10k_wmi_peer_set_param(struct ath10k *ar, u32 vdev_id,
  2095. const u8 *peer_addr, enum wmi_peer_param param_id,
  2096. u32 param_value)
  2097. {
  2098. struct wmi_peer_set_param_cmd *cmd;
  2099. struct sk_buff *skb;
  2100. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2101. if (!skb)
  2102. return -ENOMEM;
  2103. cmd = (struct wmi_peer_set_param_cmd *)skb->data;
  2104. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2105. cmd->param_id = __cpu_to_le32(param_id);
  2106. cmd->param_value = __cpu_to_le32(param_value);
  2107. memcpy(&cmd->peer_macaddr.addr, peer_addr, 6);
  2108. ath10k_dbg(ATH10K_DBG_WMI,
  2109. "wmi vdev %d peer 0x%pM set param %d value %d\n",
  2110. vdev_id, peer_addr, param_id, param_value);
  2111. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_set_param_cmdid);
  2112. }
  2113. int ath10k_wmi_set_psmode(struct ath10k *ar, u32 vdev_id,
  2114. enum wmi_sta_ps_mode psmode)
  2115. {
  2116. struct wmi_sta_powersave_mode_cmd *cmd;
  2117. struct sk_buff *skb;
  2118. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2119. if (!skb)
  2120. return -ENOMEM;
  2121. cmd = (struct wmi_sta_powersave_mode_cmd *)skb->data;
  2122. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2123. cmd->sta_ps_mode = __cpu_to_le32(psmode);
  2124. ath10k_dbg(ATH10K_DBG_WMI,
  2125. "wmi set powersave id 0x%x mode %d\n",
  2126. vdev_id, psmode);
  2127. return ath10k_wmi_cmd_send(ar, skb,
  2128. ar->wmi.cmd->sta_powersave_mode_cmdid);
  2129. }
  2130. int ath10k_wmi_set_sta_ps_param(struct ath10k *ar, u32 vdev_id,
  2131. enum wmi_sta_powersave_param param_id,
  2132. u32 value)
  2133. {
  2134. struct wmi_sta_powersave_param_cmd *cmd;
  2135. struct sk_buff *skb;
  2136. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2137. if (!skb)
  2138. return -ENOMEM;
  2139. cmd = (struct wmi_sta_powersave_param_cmd *)skb->data;
  2140. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2141. cmd->param_id = __cpu_to_le32(param_id);
  2142. cmd->param_value = __cpu_to_le32(value);
  2143. ath10k_dbg(ATH10K_DBG_WMI,
  2144. "wmi sta ps param vdev_id 0x%x param %d value %d\n",
  2145. vdev_id, param_id, value);
  2146. return ath10k_wmi_cmd_send(ar, skb,
  2147. ar->wmi.cmd->sta_powersave_param_cmdid);
  2148. }
  2149. int ath10k_wmi_set_ap_ps_param(struct ath10k *ar, u32 vdev_id, const u8 *mac,
  2150. enum wmi_ap_ps_peer_param param_id, u32 value)
  2151. {
  2152. struct wmi_ap_ps_peer_cmd *cmd;
  2153. struct sk_buff *skb;
  2154. if (!mac)
  2155. return -EINVAL;
  2156. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2157. if (!skb)
  2158. return -ENOMEM;
  2159. cmd = (struct wmi_ap_ps_peer_cmd *)skb->data;
  2160. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2161. cmd->param_id = __cpu_to_le32(param_id);
  2162. cmd->param_value = __cpu_to_le32(value);
  2163. memcpy(&cmd->peer_macaddr, mac, ETH_ALEN);
  2164. ath10k_dbg(ATH10K_DBG_WMI,
  2165. "wmi ap ps param vdev_id 0x%X param %d value %d mac_addr %pM\n",
  2166. vdev_id, param_id, value, mac);
  2167. return ath10k_wmi_cmd_send(ar, skb,
  2168. ar->wmi.cmd->ap_ps_peer_param_cmdid);
  2169. }
  2170. int ath10k_wmi_scan_chan_list(struct ath10k *ar,
  2171. const struct wmi_scan_chan_list_arg *arg)
  2172. {
  2173. struct wmi_scan_chan_list_cmd *cmd;
  2174. struct sk_buff *skb;
  2175. struct wmi_channel_arg *ch;
  2176. struct wmi_channel *ci;
  2177. int len;
  2178. int i;
  2179. len = sizeof(*cmd) + arg->n_channels * sizeof(struct wmi_channel);
  2180. skb = ath10k_wmi_alloc_skb(len);
  2181. if (!skb)
  2182. return -EINVAL;
  2183. cmd = (struct wmi_scan_chan_list_cmd *)skb->data;
  2184. cmd->num_scan_chans = __cpu_to_le32(arg->n_channels);
  2185. for (i = 0; i < arg->n_channels; i++) {
  2186. u32 flags = 0;
  2187. ch = &arg->channels[i];
  2188. ci = &cmd->chan_info[i];
  2189. if (ch->passive)
  2190. flags |= WMI_CHAN_FLAG_PASSIVE;
  2191. if (ch->allow_ibss)
  2192. flags |= WMI_CHAN_FLAG_ADHOC_ALLOWED;
  2193. if (ch->allow_ht)
  2194. flags |= WMI_CHAN_FLAG_ALLOW_HT;
  2195. if (ch->allow_vht)
  2196. flags |= WMI_CHAN_FLAG_ALLOW_VHT;
  2197. if (ch->ht40plus)
  2198. flags |= WMI_CHAN_FLAG_HT40_PLUS;
  2199. ci->mhz = __cpu_to_le32(ch->freq);
  2200. ci->band_center_freq1 = __cpu_to_le32(ch->freq);
  2201. ci->band_center_freq2 = 0;
  2202. ci->min_power = ch->min_power;
  2203. ci->max_power = ch->max_power;
  2204. ci->reg_power = ch->max_reg_power;
  2205. ci->antenna_max = ch->max_antenna_gain;
  2206. ci->antenna_max = 0;
  2207. /* mode & flags share storage */
  2208. ci->mode = ch->mode;
  2209. ci->flags |= __cpu_to_le32(flags);
  2210. }
  2211. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->scan_chan_list_cmdid);
  2212. }
  2213. int ath10k_wmi_peer_assoc(struct ath10k *ar,
  2214. const struct wmi_peer_assoc_complete_arg *arg)
  2215. {
  2216. struct wmi_peer_assoc_complete_cmd *cmd;
  2217. struct sk_buff *skb;
  2218. if (arg->peer_mpdu_density > 16)
  2219. return -EINVAL;
  2220. if (arg->peer_legacy_rates.num_rates > MAX_SUPPORTED_RATES)
  2221. return -EINVAL;
  2222. if (arg->peer_ht_rates.num_rates > MAX_SUPPORTED_RATES)
  2223. return -EINVAL;
  2224. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2225. if (!skb)
  2226. return -ENOMEM;
  2227. cmd = (struct wmi_peer_assoc_complete_cmd *)skb->data;
  2228. cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
  2229. cmd->peer_new_assoc = __cpu_to_le32(arg->peer_reassoc ? 0 : 1);
  2230. cmd->peer_associd = __cpu_to_le32(arg->peer_aid);
  2231. cmd->peer_flags = __cpu_to_le32(arg->peer_flags);
  2232. cmd->peer_caps = __cpu_to_le32(arg->peer_caps);
  2233. cmd->peer_listen_intval = __cpu_to_le32(arg->peer_listen_intval);
  2234. cmd->peer_ht_caps = __cpu_to_le32(arg->peer_ht_caps);
  2235. cmd->peer_max_mpdu = __cpu_to_le32(arg->peer_max_mpdu);
  2236. cmd->peer_mpdu_density = __cpu_to_le32(arg->peer_mpdu_density);
  2237. cmd->peer_rate_caps = __cpu_to_le32(arg->peer_rate_caps);
  2238. cmd->peer_nss = __cpu_to_le32(arg->peer_num_spatial_streams);
  2239. cmd->peer_vht_caps = __cpu_to_le32(arg->peer_vht_caps);
  2240. cmd->peer_phymode = __cpu_to_le32(arg->peer_phymode);
  2241. memcpy(cmd->peer_macaddr.addr, arg->addr, ETH_ALEN);
  2242. cmd->peer_legacy_rates.num_rates =
  2243. __cpu_to_le32(arg->peer_legacy_rates.num_rates);
  2244. memcpy(cmd->peer_legacy_rates.rates, arg->peer_legacy_rates.rates,
  2245. arg->peer_legacy_rates.num_rates);
  2246. cmd->peer_ht_rates.num_rates =
  2247. __cpu_to_le32(arg->peer_ht_rates.num_rates);
  2248. memcpy(cmd->peer_ht_rates.rates, arg->peer_ht_rates.rates,
  2249. arg->peer_ht_rates.num_rates);
  2250. cmd->peer_vht_rates.rx_max_rate =
  2251. __cpu_to_le32(arg->peer_vht_rates.rx_max_rate);
  2252. cmd->peer_vht_rates.rx_mcs_set =
  2253. __cpu_to_le32(arg->peer_vht_rates.rx_mcs_set);
  2254. cmd->peer_vht_rates.tx_max_rate =
  2255. __cpu_to_le32(arg->peer_vht_rates.tx_max_rate);
  2256. cmd->peer_vht_rates.tx_mcs_set =
  2257. __cpu_to_le32(arg->peer_vht_rates.tx_mcs_set);
  2258. ath10k_dbg(ATH10K_DBG_WMI,
  2259. "wmi peer assoc vdev %d addr %pM\n",
  2260. arg->vdev_id, arg->addr);
  2261. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_assoc_cmdid);
  2262. }
  2263. int ath10k_wmi_beacon_send_nowait(struct ath10k *ar,
  2264. const struct wmi_bcn_tx_arg *arg)
  2265. {
  2266. struct wmi_bcn_tx_cmd *cmd;
  2267. struct sk_buff *skb;
  2268. skb = ath10k_wmi_alloc_skb(sizeof(*cmd) + arg->bcn_len);
  2269. if (!skb)
  2270. return -ENOMEM;
  2271. cmd = (struct wmi_bcn_tx_cmd *)skb->data;
  2272. cmd->hdr.vdev_id = __cpu_to_le32(arg->vdev_id);
  2273. cmd->hdr.tx_rate = __cpu_to_le32(arg->tx_rate);
  2274. cmd->hdr.tx_power = __cpu_to_le32(arg->tx_power);
  2275. cmd->hdr.bcn_len = __cpu_to_le32(arg->bcn_len);
  2276. memcpy(cmd->bcn, arg->bcn, arg->bcn_len);
  2277. return ath10k_wmi_cmd_send_nowait(ar, skb, ar->wmi.cmd->bcn_tx_cmdid);
  2278. }
  2279. static void ath10k_wmi_pdev_set_wmm_param(struct wmi_wmm_params *params,
  2280. const struct wmi_wmm_params_arg *arg)
  2281. {
  2282. params->cwmin = __cpu_to_le32(arg->cwmin);
  2283. params->cwmax = __cpu_to_le32(arg->cwmax);
  2284. params->aifs = __cpu_to_le32(arg->aifs);
  2285. params->txop = __cpu_to_le32(arg->txop);
  2286. params->acm = __cpu_to_le32(arg->acm);
  2287. params->no_ack = __cpu_to_le32(arg->no_ack);
  2288. }
  2289. int ath10k_wmi_pdev_set_wmm_params(struct ath10k *ar,
  2290. const struct wmi_pdev_set_wmm_params_arg *arg)
  2291. {
  2292. struct wmi_pdev_set_wmm_params *cmd;
  2293. struct sk_buff *skb;
  2294. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2295. if (!skb)
  2296. return -ENOMEM;
  2297. cmd = (struct wmi_pdev_set_wmm_params *)skb->data;
  2298. ath10k_wmi_pdev_set_wmm_param(&cmd->ac_be, &arg->ac_be);
  2299. ath10k_wmi_pdev_set_wmm_param(&cmd->ac_bk, &arg->ac_bk);
  2300. ath10k_wmi_pdev_set_wmm_param(&cmd->ac_vi, &arg->ac_vi);
  2301. ath10k_wmi_pdev_set_wmm_param(&cmd->ac_vo, &arg->ac_vo);
  2302. ath10k_dbg(ATH10K_DBG_WMI, "wmi pdev set wmm params\n");
  2303. return ath10k_wmi_cmd_send(ar, skb,
  2304. ar->wmi.cmd->pdev_set_wmm_params_cmdid);
  2305. }
  2306. int ath10k_wmi_request_stats(struct ath10k *ar, enum wmi_stats_id stats_id)
  2307. {
  2308. struct wmi_request_stats_cmd *cmd;
  2309. struct sk_buff *skb;
  2310. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2311. if (!skb)
  2312. return -ENOMEM;
  2313. cmd = (struct wmi_request_stats_cmd *)skb->data;
  2314. cmd->stats_id = __cpu_to_le32(stats_id);
  2315. ath10k_dbg(ATH10K_DBG_WMI, "wmi request stats %d\n", (int)stats_id);
  2316. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->request_stats_cmdid);
  2317. }
  2318. int ath10k_wmi_force_fw_hang(struct ath10k *ar,
  2319. enum wmi_force_fw_hang_type type, u32 delay_ms)
  2320. {
  2321. struct wmi_force_fw_hang_cmd *cmd;
  2322. struct sk_buff *skb;
  2323. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2324. if (!skb)
  2325. return -ENOMEM;
  2326. cmd = (struct wmi_force_fw_hang_cmd *)skb->data;
  2327. cmd->type = __cpu_to_le32(type);
  2328. cmd->delay_ms = __cpu_to_le32(delay_ms);
  2329. ath10k_dbg(ATH10K_DBG_WMI, "wmi force fw hang %d delay %d\n",
  2330. type, delay_ms);
  2331. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->force_fw_hang_cmdid);
  2332. }