wmi.c 98 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177
  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_UNSUPPORTED,
  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_UNSUPPORTED,
  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_UNSUPPORTED,
  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_UNSUPPORTED,
  211. .ap_ps_peer_param_cmdid = WMI_CMD_UNSUPPORTED,
  212. .ap_ps_peer_uapsd_coex_cmdid = WMI_CMD_UNSUPPORTED,
  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_UNSUPPORTED,
  242. .network_list_offload_config_cmdid = WMI_CMD_UNSUPPORTED,
  243. .gtk_offload_cmdid = WMI_CMD_UNSUPPORTED,
  244. .csa_offload_enable_cmdid = WMI_CMD_UNSUPPORTED,
  245. .csa_offload_chanswitch_cmdid = WMI_CMD_UNSUPPORTED,
  246. .chatter_set_mode_cmdid = WMI_CMD_UNSUPPORTED,
  247. .peer_tid_addba_cmdid = WMI_CMD_UNSUPPORTED,
  248. .peer_tid_delba_cmdid = WMI_CMD_UNSUPPORTED,
  249. .sta_dtim_ps_method_cmdid = WMI_CMD_UNSUPPORTED,
  250. .sta_uapsd_auto_trig_cmdid = WMI_CMD_UNSUPPORTED,
  251. .sta_keepalive_cmd = WMI_CMD_UNSUPPORTED,
  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_UNSUPPORTED,
  257. .vdev_set_keepalive_cmdid = WMI_CMD_UNSUPPORTED,
  258. .vdev_get_keepalive_cmdid = WMI_CMD_UNSUPPORTED,
  259. .force_fw_hang_cmdid = WMI_CMD_UNSUPPORTED,
  260. .gpio_config_cmdid = WMI_10X_GPIO_CONFIG_CMDID,
  261. .gpio_output_cmdid = WMI_10X_GPIO_OUTPUT_CMDID,
  262. };
  263. /* MAIN WMI VDEV param map */
  264. static struct wmi_vdev_param_map wmi_vdev_param_map = {
  265. .rts_threshold = WMI_VDEV_PARAM_RTS_THRESHOLD,
  266. .fragmentation_threshold = WMI_VDEV_PARAM_FRAGMENTATION_THRESHOLD,
  267. .beacon_interval = WMI_VDEV_PARAM_BEACON_INTERVAL,
  268. .listen_interval = WMI_VDEV_PARAM_LISTEN_INTERVAL,
  269. .multicast_rate = WMI_VDEV_PARAM_MULTICAST_RATE,
  270. .mgmt_tx_rate = WMI_VDEV_PARAM_MGMT_TX_RATE,
  271. .slot_time = WMI_VDEV_PARAM_SLOT_TIME,
  272. .preamble = WMI_VDEV_PARAM_PREAMBLE,
  273. .swba_time = WMI_VDEV_PARAM_SWBA_TIME,
  274. .wmi_vdev_stats_update_period = WMI_VDEV_STATS_UPDATE_PERIOD,
  275. .wmi_vdev_pwrsave_ageout_time = WMI_VDEV_PWRSAVE_AGEOUT_TIME,
  276. .wmi_vdev_host_swba_interval = WMI_VDEV_HOST_SWBA_INTERVAL,
  277. .dtim_period = WMI_VDEV_PARAM_DTIM_PERIOD,
  278. .wmi_vdev_oc_scheduler_air_time_limit =
  279. WMI_VDEV_OC_SCHEDULER_AIR_TIME_LIMIT,
  280. .wds = WMI_VDEV_PARAM_WDS,
  281. .atim_window = WMI_VDEV_PARAM_ATIM_WINDOW,
  282. .bmiss_count_max = WMI_VDEV_PARAM_BMISS_COUNT_MAX,
  283. .bmiss_first_bcnt = WMI_VDEV_PARAM_BMISS_FIRST_BCNT,
  284. .bmiss_final_bcnt = WMI_VDEV_PARAM_BMISS_FINAL_BCNT,
  285. .feature_wmm = WMI_VDEV_PARAM_FEATURE_WMM,
  286. .chwidth = WMI_VDEV_PARAM_CHWIDTH,
  287. .chextoffset = WMI_VDEV_PARAM_CHEXTOFFSET,
  288. .disable_htprotection = WMI_VDEV_PARAM_DISABLE_HTPROTECTION,
  289. .sta_quickkickout = WMI_VDEV_PARAM_STA_QUICKKICKOUT,
  290. .mgmt_rate = WMI_VDEV_PARAM_MGMT_RATE,
  291. .protection_mode = WMI_VDEV_PARAM_PROTECTION_MODE,
  292. .fixed_rate = WMI_VDEV_PARAM_FIXED_RATE,
  293. .sgi = WMI_VDEV_PARAM_SGI,
  294. .ldpc = WMI_VDEV_PARAM_LDPC,
  295. .tx_stbc = WMI_VDEV_PARAM_TX_STBC,
  296. .rx_stbc = WMI_VDEV_PARAM_RX_STBC,
  297. .intra_bss_fwd = WMI_VDEV_PARAM_INTRA_BSS_FWD,
  298. .def_keyid = WMI_VDEV_PARAM_DEF_KEYID,
  299. .nss = WMI_VDEV_PARAM_NSS,
  300. .bcast_data_rate = WMI_VDEV_PARAM_BCAST_DATA_RATE,
  301. .mcast_data_rate = WMI_VDEV_PARAM_MCAST_DATA_RATE,
  302. .mcast_indicate = WMI_VDEV_PARAM_MCAST_INDICATE,
  303. .dhcp_indicate = WMI_VDEV_PARAM_DHCP_INDICATE,
  304. .unknown_dest_indicate = WMI_VDEV_PARAM_UNKNOWN_DEST_INDICATE,
  305. .ap_keepalive_min_idle_inactive_time_secs =
  306. WMI_VDEV_PARAM_AP_KEEPALIVE_MIN_IDLE_INACTIVE_TIME_SECS,
  307. .ap_keepalive_max_idle_inactive_time_secs =
  308. WMI_VDEV_PARAM_AP_KEEPALIVE_MAX_IDLE_INACTIVE_TIME_SECS,
  309. .ap_keepalive_max_unresponsive_time_secs =
  310. WMI_VDEV_PARAM_AP_KEEPALIVE_MAX_UNRESPONSIVE_TIME_SECS,
  311. .ap_enable_nawds = WMI_VDEV_PARAM_AP_ENABLE_NAWDS,
  312. .mcast2ucast_set = WMI_VDEV_PARAM_UNSUPPORTED,
  313. .enable_rtscts = WMI_VDEV_PARAM_ENABLE_RTSCTS,
  314. .txbf = WMI_VDEV_PARAM_TXBF,
  315. .packet_powersave = WMI_VDEV_PARAM_PACKET_POWERSAVE,
  316. .drop_unencry = WMI_VDEV_PARAM_DROP_UNENCRY,
  317. .tx_encap_type = WMI_VDEV_PARAM_TX_ENCAP_TYPE,
  318. .ap_detect_out_of_sync_sleeping_sta_time_secs =
  319. WMI_VDEV_PARAM_UNSUPPORTED,
  320. };
  321. /* 10.X WMI VDEV param map */
  322. static struct wmi_vdev_param_map wmi_10x_vdev_param_map = {
  323. .rts_threshold = WMI_10X_VDEV_PARAM_RTS_THRESHOLD,
  324. .fragmentation_threshold = WMI_10X_VDEV_PARAM_FRAGMENTATION_THRESHOLD,
  325. .beacon_interval = WMI_10X_VDEV_PARAM_BEACON_INTERVAL,
  326. .listen_interval = WMI_10X_VDEV_PARAM_LISTEN_INTERVAL,
  327. .multicast_rate = WMI_10X_VDEV_PARAM_MULTICAST_RATE,
  328. .mgmt_tx_rate = WMI_10X_VDEV_PARAM_MGMT_TX_RATE,
  329. .slot_time = WMI_10X_VDEV_PARAM_SLOT_TIME,
  330. .preamble = WMI_10X_VDEV_PARAM_PREAMBLE,
  331. .swba_time = WMI_10X_VDEV_PARAM_SWBA_TIME,
  332. .wmi_vdev_stats_update_period = WMI_10X_VDEV_STATS_UPDATE_PERIOD,
  333. .wmi_vdev_pwrsave_ageout_time = WMI_10X_VDEV_PWRSAVE_AGEOUT_TIME,
  334. .wmi_vdev_host_swba_interval = WMI_10X_VDEV_HOST_SWBA_INTERVAL,
  335. .dtim_period = WMI_10X_VDEV_PARAM_DTIM_PERIOD,
  336. .wmi_vdev_oc_scheduler_air_time_limit =
  337. WMI_10X_VDEV_OC_SCHEDULER_AIR_TIME_LIMIT,
  338. .wds = WMI_10X_VDEV_PARAM_WDS,
  339. .atim_window = WMI_10X_VDEV_PARAM_ATIM_WINDOW,
  340. .bmiss_count_max = WMI_10X_VDEV_PARAM_BMISS_COUNT_MAX,
  341. .bmiss_first_bcnt = WMI_VDEV_PARAM_UNSUPPORTED,
  342. .bmiss_final_bcnt = WMI_VDEV_PARAM_UNSUPPORTED,
  343. .feature_wmm = WMI_10X_VDEV_PARAM_FEATURE_WMM,
  344. .chwidth = WMI_10X_VDEV_PARAM_CHWIDTH,
  345. .chextoffset = WMI_10X_VDEV_PARAM_CHEXTOFFSET,
  346. .disable_htprotection = WMI_10X_VDEV_PARAM_DISABLE_HTPROTECTION,
  347. .sta_quickkickout = WMI_10X_VDEV_PARAM_STA_QUICKKICKOUT,
  348. .mgmt_rate = WMI_10X_VDEV_PARAM_MGMT_RATE,
  349. .protection_mode = WMI_10X_VDEV_PARAM_PROTECTION_MODE,
  350. .fixed_rate = WMI_10X_VDEV_PARAM_FIXED_RATE,
  351. .sgi = WMI_10X_VDEV_PARAM_SGI,
  352. .ldpc = WMI_10X_VDEV_PARAM_LDPC,
  353. .tx_stbc = WMI_10X_VDEV_PARAM_TX_STBC,
  354. .rx_stbc = WMI_10X_VDEV_PARAM_RX_STBC,
  355. .intra_bss_fwd = WMI_10X_VDEV_PARAM_INTRA_BSS_FWD,
  356. .def_keyid = WMI_10X_VDEV_PARAM_DEF_KEYID,
  357. .nss = WMI_10X_VDEV_PARAM_NSS,
  358. .bcast_data_rate = WMI_10X_VDEV_PARAM_BCAST_DATA_RATE,
  359. .mcast_data_rate = WMI_10X_VDEV_PARAM_MCAST_DATA_RATE,
  360. .mcast_indicate = WMI_10X_VDEV_PARAM_MCAST_INDICATE,
  361. .dhcp_indicate = WMI_10X_VDEV_PARAM_DHCP_INDICATE,
  362. .unknown_dest_indicate = WMI_10X_VDEV_PARAM_UNKNOWN_DEST_INDICATE,
  363. .ap_keepalive_min_idle_inactive_time_secs =
  364. WMI_10X_VDEV_PARAM_AP_KEEPALIVE_MIN_IDLE_INACTIVE_TIME_SECS,
  365. .ap_keepalive_max_idle_inactive_time_secs =
  366. WMI_10X_VDEV_PARAM_AP_KEEPALIVE_MAX_IDLE_INACTIVE_TIME_SECS,
  367. .ap_keepalive_max_unresponsive_time_secs =
  368. WMI_10X_VDEV_PARAM_AP_KEEPALIVE_MAX_UNRESPONSIVE_TIME_SECS,
  369. .ap_enable_nawds = WMI_10X_VDEV_PARAM_AP_ENABLE_NAWDS,
  370. .mcast2ucast_set = WMI_10X_VDEV_PARAM_MCAST2UCAST_SET,
  371. .enable_rtscts = WMI_10X_VDEV_PARAM_ENABLE_RTSCTS,
  372. .txbf = WMI_VDEV_PARAM_UNSUPPORTED,
  373. .packet_powersave = WMI_VDEV_PARAM_UNSUPPORTED,
  374. .drop_unencry = WMI_VDEV_PARAM_UNSUPPORTED,
  375. .tx_encap_type = WMI_VDEV_PARAM_UNSUPPORTED,
  376. .ap_detect_out_of_sync_sleeping_sta_time_secs =
  377. WMI_10X_VDEV_PARAM_AP_DETECT_OUT_OF_SYNC_SLEEPING_STA_TIME_SECS,
  378. };
  379. static struct wmi_pdev_param_map wmi_pdev_param_map = {
  380. .tx_chain_mask = WMI_PDEV_PARAM_TX_CHAIN_MASK,
  381. .rx_chain_mask = WMI_PDEV_PARAM_RX_CHAIN_MASK,
  382. .txpower_limit2g = WMI_PDEV_PARAM_TXPOWER_LIMIT2G,
  383. .txpower_limit5g = WMI_PDEV_PARAM_TXPOWER_LIMIT5G,
  384. .txpower_scale = WMI_PDEV_PARAM_TXPOWER_SCALE,
  385. .beacon_gen_mode = WMI_PDEV_PARAM_BEACON_GEN_MODE,
  386. .beacon_tx_mode = WMI_PDEV_PARAM_BEACON_TX_MODE,
  387. .resmgr_offchan_mode = WMI_PDEV_PARAM_RESMGR_OFFCHAN_MODE,
  388. .protection_mode = WMI_PDEV_PARAM_PROTECTION_MODE,
  389. .dynamic_bw = WMI_PDEV_PARAM_DYNAMIC_BW,
  390. .non_agg_sw_retry_th = WMI_PDEV_PARAM_NON_AGG_SW_RETRY_TH,
  391. .agg_sw_retry_th = WMI_PDEV_PARAM_AGG_SW_RETRY_TH,
  392. .sta_kickout_th = WMI_PDEV_PARAM_STA_KICKOUT_TH,
  393. .ac_aggrsize_scaling = WMI_PDEV_PARAM_AC_AGGRSIZE_SCALING,
  394. .ltr_enable = WMI_PDEV_PARAM_LTR_ENABLE,
  395. .ltr_ac_latency_be = WMI_PDEV_PARAM_LTR_AC_LATENCY_BE,
  396. .ltr_ac_latency_bk = WMI_PDEV_PARAM_LTR_AC_LATENCY_BK,
  397. .ltr_ac_latency_vi = WMI_PDEV_PARAM_LTR_AC_LATENCY_VI,
  398. .ltr_ac_latency_vo = WMI_PDEV_PARAM_LTR_AC_LATENCY_VO,
  399. .ltr_ac_latency_timeout = WMI_PDEV_PARAM_LTR_AC_LATENCY_TIMEOUT,
  400. .ltr_sleep_override = WMI_PDEV_PARAM_LTR_SLEEP_OVERRIDE,
  401. .ltr_rx_override = WMI_PDEV_PARAM_LTR_RX_OVERRIDE,
  402. .ltr_tx_activity_timeout = WMI_PDEV_PARAM_LTR_TX_ACTIVITY_TIMEOUT,
  403. .l1ss_enable = WMI_PDEV_PARAM_L1SS_ENABLE,
  404. .dsleep_enable = WMI_PDEV_PARAM_DSLEEP_ENABLE,
  405. .pcielp_txbuf_flush = WMI_PDEV_PARAM_PCIELP_TXBUF_FLUSH,
  406. .pcielp_txbuf_watermark = WMI_PDEV_PARAM_PCIELP_TXBUF_TMO_EN,
  407. .pcielp_txbuf_tmo_en = WMI_PDEV_PARAM_PCIELP_TXBUF_TMO_EN,
  408. .pcielp_txbuf_tmo_value = WMI_PDEV_PARAM_PCIELP_TXBUF_TMO_VALUE,
  409. .pdev_stats_update_period = WMI_PDEV_PARAM_PDEV_STATS_UPDATE_PERIOD,
  410. .vdev_stats_update_period = WMI_PDEV_PARAM_VDEV_STATS_UPDATE_PERIOD,
  411. .peer_stats_update_period = WMI_PDEV_PARAM_PEER_STATS_UPDATE_PERIOD,
  412. .bcnflt_stats_update_period = WMI_PDEV_PARAM_BCNFLT_STATS_UPDATE_PERIOD,
  413. .pmf_qos = WMI_PDEV_PARAM_PMF_QOS,
  414. .arp_ac_override = WMI_PDEV_PARAM_ARP_AC_OVERRIDE,
  415. .arpdhcp_ac_override = WMI_PDEV_PARAM_UNSUPPORTED,
  416. .dcs = WMI_PDEV_PARAM_DCS,
  417. .ani_enable = WMI_PDEV_PARAM_ANI_ENABLE,
  418. .ani_poll_period = WMI_PDEV_PARAM_ANI_POLL_PERIOD,
  419. .ani_listen_period = WMI_PDEV_PARAM_ANI_LISTEN_PERIOD,
  420. .ani_ofdm_level = WMI_PDEV_PARAM_ANI_OFDM_LEVEL,
  421. .ani_cck_level = WMI_PDEV_PARAM_ANI_CCK_LEVEL,
  422. .dyntxchain = WMI_PDEV_PARAM_DYNTXCHAIN,
  423. .proxy_sta = WMI_PDEV_PARAM_PROXY_STA,
  424. .idle_ps_config = WMI_PDEV_PARAM_IDLE_PS_CONFIG,
  425. .power_gating_sleep = WMI_PDEV_PARAM_POWER_GATING_SLEEP,
  426. .fast_channel_reset = WMI_PDEV_PARAM_UNSUPPORTED,
  427. .burst_dur = WMI_PDEV_PARAM_UNSUPPORTED,
  428. .burst_enable = WMI_PDEV_PARAM_UNSUPPORTED,
  429. };
  430. static struct wmi_pdev_param_map wmi_10x_pdev_param_map = {
  431. .tx_chain_mask = WMI_10X_PDEV_PARAM_TX_CHAIN_MASK,
  432. .rx_chain_mask = WMI_10X_PDEV_PARAM_RX_CHAIN_MASK,
  433. .txpower_limit2g = WMI_10X_PDEV_PARAM_TXPOWER_LIMIT2G,
  434. .txpower_limit5g = WMI_10X_PDEV_PARAM_TXPOWER_LIMIT5G,
  435. .txpower_scale = WMI_10X_PDEV_PARAM_TXPOWER_SCALE,
  436. .beacon_gen_mode = WMI_10X_PDEV_PARAM_BEACON_GEN_MODE,
  437. .beacon_tx_mode = WMI_10X_PDEV_PARAM_BEACON_TX_MODE,
  438. .resmgr_offchan_mode = WMI_10X_PDEV_PARAM_RESMGR_OFFCHAN_MODE,
  439. .protection_mode = WMI_10X_PDEV_PARAM_PROTECTION_MODE,
  440. .dynamic_bw = WMI_10X_PDEV_PARAM_DYNAMIC_BW,
  441. .non_agg_sw_retry_th = WMI_10X_PDEV_PARAM_NON_AGG_SW_RETRY_TH,
  442. .agg_sw_retry_th = WMI_10X_PDEV_PARAM_AGG_SW_RETRY_TH,
  443. .sta_kickout_th = WMI_10X_PDEV_PARAM_STA_KICKOUT_TH,
  444. .ac_aggrsize_scaling = WMI_10X_PDEV_PARAM_AC_AGGRSIZE_SCALING,
  445. .ltr_enable = WMI_10X_PDEV_PARAM_LTR_ENABLE,
  446. .ltr_ac_latency_be = WMI_10X_PDEV_PARAM_LTR_AC_LATENCY_BE,
  447. .ltr_ac_latency_bk = WMI_10X_PDEV_PARAM_LTR_AC_LATENCY_BK,
  448. .ltr_ac_latency_vi = WMI_10X_PDEV_PARAM_LTR_AC_LATENCY_VI,
  449. .ltr_ac_latency_vo = WMI_10X_PDEV_PARAM_LTR_AC_LATENCY_VO,
  450. .ltr_ac_latency_timeout = WMI_10X_PDEV_PARAM_LTR_AC_LATENCY_TIMEOUT,
  451. .ltr_sleep_override = WMI_10X_PDEV_PARAM_LTR_SLEEP_OVERRIDE,
  452. .ltr_rx_override = WMI_10X_PDEV_PARAM_LTR_RX_OVERRIDE,
  453. .ltr_tx_activity_timeout = WMI_10X_PDEV_PARAM_LTR_TX_ACTIVITY_TIMEOUT,
  454. .l1ss_enable = WMI_10X_PDEV_PARAM_L1SS_ENABLE,
  455. .dsleep_enable = WMI_10X_PDEV_PARAM_DSLEEP_ENABLE,
  456. .pcielp_txbuf_flush = WMI_PDEV_PARAM_UNSUPPORTED,
  457. .pcielp_txbuf_watermark = WMI_PDEV_PARAM_UNSUPPORTED,
  458. .pcielp_txbuf_tmo_en = WMI_PDEV_PARAM_UNSUPPORTED,
  459. .pcielp_txbuf_tmo_value = WMI_PDEV_PARAM_UNSUPPORTED,
  460. .pdev_stats_update_period = WMI_10X_PDEV_PARAM_PDEV_STATS_UPDATE_PERIOD,
  461. .vdev_stats_update_period = WMI_10X_PDEV_PARAM_VDEV_STATS_UPDATE_PERIOD,
  462. .peer_stats_update_period = WMI_10X_PDEV_PARAM_PEER_STATS_UPDATE_PERIOD,
  463. .bcnflt_stats_update_period =
  464. WMI_10X_PDEV_PARAM_BCNFLT_STATS_UPDATE_PERIOD,
  465. .pmf_qos = WMI_10X_PDEV_PARAM_PMF_QOS,
  466. .arp_ac_override = WMI_PDEV_PARAM_UNSUPPORTED,
  467. .arpdhcp_ac_override = WMI_10X_PDEV_PARAM_ARPDHCP_AC_OVERRIDE,
  468. .dcs = WMI_10X_PDEV_PARAM_DCS,
  469. .ani_enable = WMI_10X_PDEV_PARAM_ANI_ENABLE,
  470. .ani_poll_period = WMI_10X_PDEV_PARAM_ANI_POLL_PERIOD,
  471. .ani_listen_period = WMI_10X_PDEV_PARAM_ANI_LISTEN_PERIOD,
  472. .ani_ofdm_level = WMI_10X_PDEV_PARAM_ANI_OFDM_LEVEL,
  473. .ani_cck_level = WMI_10X_PDEV_PARAM_ANI_CCK_LEVEL,
  474. .dyntxchain = WMI_10X_PDEV_PARAM_DYNTXCHAIN,
  475. .proxy_sta = WMI_PDEV_PARAM_UNSUPPORTED,
  476. .idle_ps_config = WMI_PDEV_PARAM_UNSUPPORTED,
  477. .power_gating_sleep = WMI_PDEV_PARAM_UNSUPPORTED,
  478. .fast_channel_reset = WMI_10X_PDEV_PARAM_FAST_CHANNEL_RESET,
  479. .burst_dur = WMI_10X_PDEV_PARAM_BURST_DUR,
  480. .burst_enable = WMI_10X_PDEV_PARAM_BURST_ENABLE,
  481. };
  482. int ath10k_wmi_wait_for_service_ready(struct ath10k *ar)
  483. {
  484. int ret;
  485. ret = wait_for_completion_timeout(&ar->wmi.service_ready,
  486. WMI_SERVICE_READY_TIMEOUT_HZ);
  487. return ret;
  488. }
  489. int ath10k_wmi_wait_for_unified_ready(struct ath10k *ar)
  490. {
  491. int ret;
  492. ret = wait_for_completion_timeout(&ar->wmi.unified_ready,
  493. WMI_UNIFIED_READY_TIMEOUT_HZ);
  494. return ret;
  495. }
  496. static struct sk_buff *ath10k_wmi_alloc_skb(u32 len)
  497. {
  498. struct sk_buff *skb;
  499. u32 round_len = roundup(len, 4);
  500. skb = ath10k_htc_alloc_skb(WMI_SKB_HEADROOM + round_len);
  501. if (!skb)
  502. return NULL;
  503. skb_reserve(skb, WMI_SKB_HEADROOM);
  504. if (!IS_ALIGNED((unsigned long)skb->data, 4))
  505. ath10k_warn("Unaligned WMI skb\n");
  506. skb_put(skb, round_len);
  507. memset(skb->data, 0, round_len);
  508. return skb;
  509. }
  510. static void ath10k_wmi_htc_tx_complete(struct ath10k *ar, struct sk_buff *skb)
  511. {
  512. dev_kfree_skb(skb);
  513. }
  514. static int ath10k_wmi_cmd_send_nowait(struct ath10k *ar, struct sk_buff *skb,
  515. u32 cmd_id)
  516. {
  517. struct ath10k_skb_cb *skb_cb = ATH10K_SKB_CB(skb);
  518. struct wmi_cmd_hdr *cmd_hdr;
  519. int ret;
  520. u32 cmd = 0;
  521. if (skb_push(skb, sizeof(struct wmi_cmd_hdr)) == NULL)
  522. return -ENOMEM;
  523. cmd |= SM(cmd_id, WMI_CMD_HDR_CMD_ID);
  524. cmd_hdr = (struct wmi_cmd_hdr *)skb->data;
  525. cmd_hdr->cmd_id = __cpu_to_le32(cmd);
  526. memset(skb_cb, 0, sizeof(*skb_cb));
  527. ret = ath10k_htc_send(&ar->htc, ar->wmi.eid, skb);
  528. trace_ath10k_wmi_cmd(cmd_id, skb->data, skb->len, ret);
  529. if (ret)
  530. goto err_pull;
  531. return 0;
  532. err_pull:
  533. skb_pull(skb, sizeof(struct wmi_cmd_hdr));
  534. return ret;
  535. }
  536. static void ath10k_wmi_tx_beacon_nowait(struct ath10k_vif *arvif)
  537. {
  538. struct wmi_bcn_tx_arg arg = {0};
  539. int ret;
  540. lockdep_assert_held(&arvif->ar->data_lock);
  541. if (arvif->beacon == NULL)
  542. return;
  543. arg.vdev_id = arvif->vdev_id;
  544. arg.tx_rate = 0;
  545. arg.tx_power = 0;
  546. arg.bcn = arvif->beacon->data;
  547. arg.bcn_len = arvif->beacon->len;
  548. ret = ath10k_wmi_beacon_send_nowait(arvif->ar, &arg);
  549. if (ret)
  550. return;
  551. dev_kfree_skb_any(arvif->beacon);
  552. arvif->beacon = NULL;
  553. }
  554. static void ath10k_wmi_tx_beacons_iter(void *data, u8 *mac,
  555. struct ieee80211_vif *vif)
  556. {
  557. struct ath10k_vif *arvif = ath10k_vif_to_arvif(vif);
  558. ath10k_wmi_tx_beacon_nowait(arvif);
  559. }
  560. static void ath10k_wmi_tx_beacons_nowait(struct ath10k *ar)
  561. {
  562. spin_lock_bh(&ar->data_lock);
  563. ieee80211_iterate_active_interfaces_atomic(ar->hw,
  564. IEEE80211_IFACE_ITER_NORMAL,
  565. ath10k_wmi_tx_beacons_iter,
  566. NULL);
  567. spin_unlock_bh(&ar->data_lock);
  568. }
  569. static void ath10k_wmi_op_ep_tx_credits(struct ath10k *ar)
  570. {
  571. /* try to send pending beacons first. they take priority */
  572. ath10k_wmi_tx_beacons_nowait(ar);
  573. wake_up(&ar->wmi.tx_credits_wq);
  574. }
  575. static int ath10k_wmi_cmd_send(struct ath10k *ar, struct sk_buff *skb,
  576. u32 cmd_id)
  577. {
  578. int ret = -EOPNOTSUPP;
  579. might_sleep();
  580. if (cmd_id == WMI_CMD_UNSUPPORTED) {
  581. ath10k_warn("wmi command %d is not supported by firmware\n",
  582. cmd_id);
  583. return ret;
  584. }
  585. wait_event_timeout(ar->wmi.tx_credits_wq, ({
  586. /* try to send pending beacons first. they take priority */
  587. ath10k_wmi_tx_beacons_nowait(ar);
  588. ret = ath10k_wmi_cmd_send_nowait(ar, skb, cmd_id);
  589. (ret != -EAGAIN);
  590. }), 3*HZ);
  591. if (ret)
  592. dev_kfree_skb_any(skb);
  593. return ret;
  594. }
  595. int ath10k_wmi_mgmt_tx(struct ath10k *ar, struct sk_buff *skb)
  596. {
  597. int ret = 0;
  598. struct wmi_mgmt_tx_cmd *cmd;
  599. struct ieee80211_hdr *hdr;
  600. struct sk_buff *wmi_skb;
  601. struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
  602. int len;
  603. u16 fc;
  604. hdr = (struct ieee80211_hdr *)skb->data;
  605. fc = le16_to_cpu(hdr->frame_control);
  606. if (WARN_ON_ONCE(!ieee80211_is_mgmt(hdr->frame_control)))
  607. return -EINVAL;
  608. len = sizeof(cmd->hdr) + skb->len;
  609. len = round_up(len, 4);
  610. wmi_skb = ath10k_wmi_alloc_skb(len);
  611. if (!wmi_skb)
  612. return -ENOMEM;
  613. cmd = (struct wmi_mgmt_tx_cmd *)wmi_skb->data;
  614. cmd->hdr.vdev_id = __cpu_to_le32(ATH10K_SKB_CB(skb)->vdev_id);
  615. cmd->hdr.tx_rate = 0;
  616. cmd->hdr.tx_power = 0;
  617. cmd->hdr.buf_len = __cpu_to_le32((u32)(skb->len));
  618. memcpy(cmd->hdr.peer_macaddr.addr, ieee80211_get_DA(hdr), ETH_ALEN);
  619. memcpy(cmd->buf, skb->data, skb->len);
  620. ath10k_dbg(ATH10K_DBG_WMI, "wmi mgmt tx skb %p len %d ftype %02x stype %02x\n",
  621. wmi_skb, wmi_skb->len, fc & IEEE80211_FCTL_FTYPE,
  622. fc & IEEE80211_FCTL_STYPE);
  623. /* Send the management frame buffer to the target */
  624. ret = ath10k_wmi_cmd_send(ar, wmi_skb, ar->wmi.cmd->mgmt_tx_cmdid);
  625. if (ret) {
  626. dev_kfree_skb_any(skb);
  627. return ret;
  628. }
  629. /* TODO: report tx status to mac80211 - temporary just ACK */
  630. info->flags |= IEEE80211_TX_STAT_ACK;
  631. ieee80211_tx_status_irqsafe(ar->hw, skb);
  632. return ret;
  633. }
  634. static int ath10k_wmi_event_scan(struct ath10k *ar, struct sk_buff *skb)
  635. {
  636. struct wmi_scan_event *event = (struct wmi_scan_event *)skb->data;
  637. enum wmi_scan_event_type event_type;
  638. enum wmi_scan_completion_reason reason;
  639. u32 freq;
  640. u32 req_id;
  641. u32 scan_id;
  642. u32 vdev_id;
  643. event_type = __le32_to_cpu(event->event_type);
  644. reason = __le32_to_cpu(event->reason);
  645. freq = __le32_to_cpu(event->channel_freq);
  646. req_id = __le32_to_cpu(event->scan_req_id);
  647. scan_id = __le32_to_cpu(event->scan_id);
  648. vdev_id = __le32_to_cpu(event->vdev_id);
  649. ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENTID\n");
  650. ath10k_dbg(ATH10K_DBG_WMI,
  651. "scan event type %d reason %d freq %d req_id %d "
  652. "scan_id %d vdev_id %d\n",
  653. event_type, reason, freq, req_id, scan_id, vdev_id);
  654. spin_lock_bh(&ar->data_lock);
  655. switch (event_type) {
  656. case WMI_SCAN_EVENT_STARTED:
  657. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_STARTED\n");
  658. if (ar->scan.in_progress && ar->scan.is_roc)
  659. ieee80211_ready_on_channel(ar->hw);
  660. complete(&ar->scan.started);
  661. break;
  662. case WMI_SCAN_EVENT_COMPLETED:
  663. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_COMPLETED\n");
  664. switch (reason) {
  665. case WMI_SCAN_REASON_COMPLETED:
  666. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_COMPLETED\n");
  667. break;
  668. case WMI_SCAN_REASON_CANCELLED:
  669. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_CANCELED\n");
  670. break;
  671. case WMI_SCAN_REASON_PREEMPTED:
  672. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_PREEMPTED\n");
  673. break;
  674. case WMI_SCAN_REASON_TIMEDOUT:
  675. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_REASON_TIMEDOUT\n");
  676. break;
  677. default:
  678. break;
  679. }
  680. ar->scan_channel = NULL;
  681. if (!ar->scan.in_progress) {
  682. ath10k_warn("no scan requested, ignoring\n");
  683. break;
  684. }
  685. if (ar->scan.is_roc) {
  686. ath10k_offchan_tx_purge(ar);
  687. if (!ar->scan.aborting)
  688. ieee80211_remain_on_channel_expired(ar->hw);
  689. } else {
  690. ieee80211_scan_completed(ar->hw, ar->scan.aborting);
  691. }
  692. del_timer(&ar->scan.timeout);
  693. complete_all(&ar->scan.completed);
  694. ar->scan.in_progress = false;
  695. break;
  696. case WMI_SCAN_EVENT_BSS_CHANNEL:
  697. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_BSS_CHANNEL\n");
  698. ar->scan_channel = NULL;
  699. break;
  700. case WMI_SCAN_EVENT_FOREIGN_CHANNEL:
  701. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_FOREIGN_CHANNEL\n");
  702. ar->scan_channel = ieee80211_get_channel(ar->hw->wiphy, freq);
  703. if (ar->scan.in_progress && ar->scan.is_roc &&
  704. ar->scan.roc_freq == freq) {
  705. complete(&ar->scan.on_channel);
  706. }
  707. break;
  708. case WMI_SCAN_EVENT_DEQUEUED:
  709. ath10k_dbg(ATH10K_DBG_WMI, "SCAN_EVENT_DEQUEUED\n");
  710. break;
  711. case WMI_SCAN_EVENT_PREEMPTED:
  712. ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENT_PREEMPTED\n");
  713. break;
  714. case WMI_SCAN_EVENT_START_FAILED:
  715. ath10k_dbg(ATH10K_DBG_WMI, "WMI_SCAN_EVENT_START_FAILED\n");
  716. break;
  717. default:
  718. break;
  719. }
  720. spin_unlock_bh(&ar->data_lock);
  721. return 0;
  722. }
  723. static inline enum ieee80211_band phy_mode_to_band(u32 phy_mode)
  724. {
  725. enum ieee80211_band band;
  726. switch (phy_mode) {
  727. case MODE_11A:
  728. case MODE_11NA_HT20:
  729. case MODE_11NA_HT40:
  730. case MODE_11AC_VHT20:
  731. case MODE_11AC_VHT40:
  732. case MODE_11AC_VHT80:
  733. band = IEEE80211_BAND_5GHZ;
  734. break;
  735. case MODE_11G:
  736. case MODE_11B:
  737. case MODE_11GONLY:
  738. case MODE_11NG_HT20:
  739. case MODE_11NG_HT40:
  740. case MODE_11AC_VHT20_2G:
  741. case MODE_11AC_VHT40_2G:
  742. case MODE_11AC_VHT80_2G:
  743. default:
  744. band = IEEE80211_BAND_2GHZ;
  745. }
  746. return band;
  747. }
  748. static inline u8 get_rate_idx(u32 rate, enum ieee80211_band band)
  749. {
  750. u8 rate_idx = 0;
  751. /* rate in Kbps */
  752. switch (rate) {
  753. case 1000:
  754. rate_idx = 0;
  755. break;
  756. case 2000:
  757. rate_idx = 1;
  758. break;
  759. case 5500:
  760. rate_idx = 2;
  761. break;
  762. case 11000:
  763. rate_idx = 3;
  764. break;
  765. case 6000:
  766. rate_idx = 4;
  767. break;
  768. case 9000:
  769. rate_idx = 5;
  770. break;
  771. case 12000:
  772. rate_idx = 6;
  773. break;
  774. case 18000:
  775. rate_idx = 7;
  776. break;
  777. case 24000:
  778. rate_idx = 8;
  779. break;
  780. case 36000:
  781. rate_idx = 9;
  782. break;
  783. case 48000:
  784. rate_idx = 10;
  785. break;
  786. case 54000:
  787. rate_idx = 11;
  788. break;
  789. default:
  790. break;
  791. }
  792. if (band == IEEE80211_BAND_5GHZ) {
  793. if (rate_idx > 3)
  794. /* Omit CCK rates */
  795. rate_idx -= 4;
  796. else
  797. rate_idx = 0;
  798. }
  799. return rate_idx;
  800. }
  801. static int ath10k_wmi_event_mgmt_rx(struct ath10k *ar, struct sk_buff *skb)
  802. {
  803. struct wmi_mgmt_rx_event_v1 *ev_v1;
  804. struct wmi_mgmt_rx_event_v2 *ev_v2;
  805. struct wmi_mgmt_rx_hdr_v1 *ev_hdr;
  806. struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
  807. struct ieee80211_hdr *hdr;
  808. u32 rx_status;
  809. u32 channel;
  810. u32 phy_mode;
  811. u32 snr;
  812. u32 rate;
  813. u32 buf_len;
  814. u16 fc;
  815. int pull_len;
  816. if (test_bit(ATH10K_FW_FEATURE_EXT_WMI_MGMT_RX, ar->fw_features)) {
  817. ev_v2 = (struct wmi_mgmt_rx_event_v2 *)skb->data;
  818. ev_hdr = &ev_v2->hdr.v1;
  819. pull_len = sizeof(*ev_v2);
  820. } else {
  821. ev_v1 = (struct wmi_mgmt_rx_event_v1 *)skb->data;
  822. ev_hdr = &ev_v1->hdr;
  823. pull_len = sizeof(*ev_v1);
  824. }
  825. channel = __le32_to_cpu(ev_hdr->channel);
  826. buf_len = __le32_to_cpu(ev_hdr->buf_len);
  827. rx_status = __le32_to_cpu(ev_hdr->status);
  828. snr = __le32_to_cpu(ev_hdr->snr);
  829. phy_mode = __le32_to_cpu(ev_hdr->phy_mode);
  830. rate = __le32_to_cpu(ev_hdr->rate);
  831. memset(status, 0, sizeof(*status));
  832. ath10k_dbg(ATH10K_DBG_MGMT,
  833. "event mgmt rx status %08x\n", rx_status);
  834. if (rx_status & WMI_RX_STATUS_ERR_DECRYPT) {
  835. dev_kfree_skb(skb);
  836. return 0;
  837. }
  838. if (rx_status & WMI_RX_STATUS_ERR_KEY_CACHE_MISS) {
  839. dev_kfree_skb(skb);
  840. return 0;
  841. }
  842. if (rx_status & WMI_RX_STATUS_ERR_CRC)
  843. status->flag |= RX_FLAG_FAILED_FCS_CRC;
  844. if (rx_status & WMI_RX_STATUS_ERR_MIC)
  845. status->flag |= RX_FLAG_MMIC_ERROR;
  846. status->band = phy_mode_to_band(phy_mode);
  847. status->freq = ieee80211_channel_to_frequency(channel, status->band);
  848. status->signal = snr + ATH10K_DEFAULT_NOISE_FLOOR;
  849. status->rate_idx = get_rate_idx(rate, status->band);
  850. skb_pull(skb, pull_len);
  851. hdr = (struct ieee80211_hdr *)skb->data;
  852. fc = le16_to_cpu(hdr->frame_control);
  853. if (fc & IEEE80211_FCTL_PROTECTED) {
  854. status->flag |= RX_FLAG_DECRYPTED | RX_FLAG_IV_STRIPPED |
  855. RX_FLAG_MMIC_STRIPPED;
  856. hdr->frame_control = __cpu_to_le16(fc &
  857. ~IEEE80211_FCTL_PROTECTED);
  858. }
  859. ath10k_dbg(ATH10K_DBG_MGMT,
  860. "event mgmt rx skb %p len %d ftype %02x stype %02x\n",
  861. skb, skb->len,
  862. fc & IEEE80211_FCTL_FTYPE, fc & IEEE80211_FCTL_STYPE);
  863. ath10k_dbg(ATH10K_DBG_MGMT,
  864. "event mgmt rx freq %d band %d snr %d, rate_idx %d\n",
  865. status->freq, status->band, status->signal,
  866. status->rate_idx);
  867. /*
  868. * packets from HTC come aligned to 4byte boundaries
  869. * because they can originally come in along with a trailer
  870. */
  871. skb_trim(skb, buf_len);
  872. ieee80211_rx(ar->hw, skb);
  873. return 0;
  874. }
  875. static int freq_to_idx(struct ath10k *ar, int freq)
  876. {
  877. struct ieee80211_supported_band *sband;
  878. int band, ch, idx = 0;
  879. for (band = IEEE80211_BAND_2GHZ; band < IEEE80211_NUM_BANDS; band++) {
  880. sband = ar->hw->wiphy->bands[band];
  881. if (!sband)
  882. continue;
  883. for (ch = 0; ch < sband->n_channels; ch++, idx++)
  884. if (sband->channels[ch].center_freq == freq)
  885. goto exit;
  886. }
  887. exit:
  888. return idx;
  889. }
  890. static void ath10k_wmi_event_chan_info(struct ath10k *ar, struct sk_buff *skb)
  891. {
  892. struct wmi_chan_info_event *ev;
  893. struct survey_info *survey;
  894. u32 err_code, freq, cmd_flags, noise_floor, rx_clear_count, cycle_count;
  895. int idx;
  896. ev = (struct wmi_chan_info_event *)skb->data;
  897. err_code = __le32_to_cpu(ev->err_code);
  898. freq = __le32_to_cpu(ev->freq);
  899. cmd_flags = __le32_to_cpu(ev->cmd_flags);
  900. noise_floor = __le32_to_cpu(ev->noise_floor);
  901. rx_clear_count = __le32_to_cpu(ev->rx_clear_count);
  902. cycle_count = __le32_to_cpu(ev->cycle_count);
  903. ath10k_dbg(ATH10K_DBG_WMI,
  904. "chan info err_code %d freq %d cmd_flags %d noise_floor %d rx_clear_count %d cycle_count %d\n",
  905. err_code, freq, cmd_flags, noise_floor, rx_clear_count,
  906. cycle_count);
  907. spin_lock_bh(&ar->data_lock);
  908. if (!ar->scan.in_progress) {
  909. ath10k_warn("chan info event without a scan request?\n");
  910. goto exit;
  911. }
  912. idx = freq_to_idx(ar, freq);
  913. if (idx >= ARRAY_SIZE(ar->survey)) {
  914. ath10k_warn("chan info: invalid frequency %d (idx %d out of bounds)\n",
  915. freq, idx);
  916. goto exit;
  917. }
  918. if (cmd_flags & WMI_CHAN_INFO_FLAG_COMPLETE) {
  919. /* During scanning chan info is reported twice for each
  920. * visited channel. The reported cycle count is global
  921. * and per-channel cycle count must be calculated */
  922. cycle_count -= ar->survey_last_cycle_count;
  923. rx_clear_count -= ar->survey_last_rx_clear_count;
  924. survey = &ar->survey[idx];
  925. survey->channel_time = WMI_CHAN_INFO_MSEC(cycle_count);
  926. survey->channel_time_rx = WMI_CHAN_INFO_MSEC(rx_clear_count);
  927. survey->noise = noise_floor;
  928. survey->filled = SURVEY_INFO_CHANNEL_TIME |
  929. SURVEY_INFO_CHANNEL_TIME_RX |
  930. SURVEY_INFO_NOISE_DBM;
  931. }
  932. ar->survey_last_rx_clear_count = rx_clear_count;
  933. ar->survey_last_cycle_count = cycle_count;
  934. exit:
  935. spin_unlock_bh(&ar->data_lock);
  936. }
  937. static void ath10k_wmi_event_echo(struct ath10k *ar, struct sk_buff *skb)
  938. {
  939. ath10k_dbg(ATH10K_DBG_WMI, "WMI_ECHO_EVENTID\n");
  940. }
  941. static void ath10k_wmi_event_debug_mesg(struct ath10k *ar, struct sk_buff *skb)
  942. {
  943. ath10k_dbg(ATH10K_DBG_WMI, "WMI_DEBUG_MESG_EVENTID\n");
  944. }
  945. static void ath10k_wmi_event_update_stats(struct ath10k *ar,
  946. struct sk_buff *skb)
  947. {
  948. struct wmi_stats_event *ev = (struct wmi_stats_event *)skb->data;
  949. ath10k_dbg(ATH10K_DBG_WMI, "WMI_UPDATE_STATS_EVENTID\n");
  950. ath10k_debug_read_target_stats(ar, ev);
  951. }
  952. static void ath10k_wmi_event_vdev_start_resp(struct ath10k *ar,
  953. struct sk_buff *skb)
  954. {
  955. struct wmi_vdev_start_response_event *ev;
  956. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_START_RESP_EVENTID\n");
  957. ev = (struct wmi_vdev_start_response_event *)skb->data;
  958. if (WARN_ON(__le32_to_cpu(ev->status)))
  959. return;
  960. complete(&ar->vdev_setup_done);
  961. }
  962. static void ath10k_wmi_event_vdev_stopped(struct ath10k *ar,
  963. struct sk_buff *skb)
  964. {
  965. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_STOPPED_EVENTID\n");
  966. complete(&ar->vdev_setup_done);
  967. }
  968. static void ath10k_wmi_event_peer_sta_kickout(struct ath10k *ar,
  969. struct sk_buff *skb)
  970. {
  971. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PEER_STA_KICKOUT_EVENTID\n");
  972. }
  973. /*
  974. * FIXME
  975. *
  976. * We don't report to mac80211 sleep state of connected
  977. * stations. Due to this mac80211 can't fill in TIM IE
  978. * correctly.
  979. *
  980. * I know of no way of getting nullfunc frames that contain
  981. * sleep transition from connected stations - these do not
  982. * seem to be sent from the target to the host. There also
  983. * doesn't seem to be a dedicated event for that. So the
  984. * only way left to do this would be to read tim_bitmap
  985. * during SWBA.
  986. *
  987. * We could probably try using tim_bitmap from SWBA to tell
  988. * mac80211 which stations are asleep and which are not. The
  989. * problem here is calling mac80211 functions so many times
  990. * could take too long and make us miss the time to submit
  991. * the beacon to the target.
  992. *
  993. * So as a workaround we try to extend the TIM IE if there
  994. * is unicast buffered for stations with aid > 7 and fill it
  995. * in ourselves.
  996. */
  997. static void ath10k_wmi_update_tim(struct ath10k *ar,
  998. struct ath10k_vif *arvif,
  999. struct sk_buff *bcn,
  1000. struct wmi_bcn_info *bcn_info)
  1001. {
  1002. struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)bcn->data;
  1003. struct ieee80211_tim_ie *tim;
  1004. u8 *ies, *ie;
  1005. u8 ie_len, pvm_len;
  1006. /* if next SWBA has no tim_changed the tim_bitmap is garbage.
  1007. * we must copy the bitmap upon change and reuse it later */
  1008. if (__le32_to_cpu(bcn_info->tim_info.tim_changed)) {
  1009. int i;
  1010. BUILD_BUG_ON(sizeof(arvif->u.ap.tim_bitmap) !=
  1011. sizeof(bcn_info->tim_info.tim_bitmap));
  1012. for (i = 0; i < sizeof(arvif->u.ap.tim_bitmap); i++) {
  1013. __le32 t = bcn_info->tim_info.tim_bitmap[i / 4];
  1014. u32 v = __le32_to_cpu(t);
  1015. arvif->u.ap.tim_bitmap[i] = (v >> ((i % 4) * 8)) & 0xFF;
  1016. }
  1017. /* FW reports either length 0 or 16
  1018. * so we calculate this on our own */
  1019. arvif->u.ap.tim_len = 0;
  1020. for (i = 0; i < sizeof(arvif->u.ap.tim_bitmap); i++)
  1021. if (arvif->u.ap.tim_bitmap[i])
  1022. arvif->u.ap.tim_len = i;
  1023. arvif->u.ap.tim_len++;
  1024. }
  1025. ies = bcn->data;
  1026. ies += ieee80211_hdrlen(hdr->frame_control);
  1027. ies += 12; /* fixed parameters */
  1028. ie = (u8 *)cfg80211_find_ie(WLAN_EID_TIM, ies,
  1029. (u8 *)skb_tail_pointer(bcn) - ies);
  1030. if (!ie) {
  1031. if (arvif->vdev_type != WMI_VDEV_TYPE_IBSS)
  1032. ath10k_warn("no tim ie found;\n");
  1033. return;
  1034. }
  1035. tim = (void *)ie + 2;
  1036. ie_len = ie[1];
  1037. pvm_len = ie_len - 3; /* exclude dtim count, dtim period, bmap ctl */
  1038. if (pvm_len < arvif->u.ap.tim_len) {
  1039. int expand_size = sizeof(arvif->u.ap.tim_bitmap) - pvm_len;
  1040. int move_size = skb_tail_pointer(bcn) - (ie + 2 + ie_len);
  1041. void *next_ie = ie + 2 + ie_len;
  1042. if (skb_put(bcn, expand_size)) {
  1043. memmove(next_ie + expand_size, next_ie, move_size);
  1044. ie[1] += expand_size;
  1045. ie_len += expand_size;
  1046. pvm_len += expand_size;
  1047. } else {
  1048. ath10k_warn("tim expansion failed\n");
  1049. }
  1050. }
  1051. if (pvm_len > sizeof(arvif->u.ap.tim_bitmap)) {
  1052. ath10k_warn("tim pvm length is too great (%d)\n", pvm_len);
  1053. return;
  1054. }
  1055. tim->bitmap_ctrl = !!__le32_to_cpu(bcn_info->tim_info.tim_mcast);
  1056. memcpy(tim->virtual_map, arvif->u.ap.tim_bitmap, pvm_len);
  1057. ath10k_dbg(ATH10K_DBG_MGMT, "dtim %d/%d mcast %d pvmlen %d\n",
  1058. tim->dtim_count, tim->dtim_period,
  1059. tim->bitmap_ctrl, pvm_len);
  1060. }
  1061. static void ath10k_p2p_fill_noa_ie(u8 *data, u32 len,
  1062. struct wmi_p2p_noa_info *noa)
  1063. {
  1064. struct ieee80211_p2p_noa_attr *noa_attr;
  1065. u8 ctwindow_oppps = noa->ctwindow_oppps;
  1066. u8 ctwindow = ctwindow_oppps >> WMI_P2P_OPPPS_CTWINDOW_OFFSET;
  1067. bool oppps = !!(ctwindow_oppps & WMI_P2P_OPPPS_ENABLE_BIT);
  1068. __le16 *noa_attr_len;
  1069. u16 attr_len;
  1070. u8 noa_descriptors = noa->num_descriptors;
  1071. int i;
  1072. /* P2P IE */
  1073. data[0] = WLAN_EID_VENDOR_SPECIFIC;
  1074. data[1] = len - 2;
  1075. data[2] = (WLAN_OUI_WFA >> 16) & 0xff;
  1076. data[3] = (WLAN_OUI_WFA >> 8) & 0xff;
  1077. data[4] = (WLAN_OUI_WFA >> 0) & 0xff;
  1078. data[5] = WLAN_OUI_TYPE_WFA_P2P;
  1079. /* NOA ATTR */
  1080. data[6] = IEEE80211_P2P_ATTR_ABSENCE_NOTICE;
  1081. noa_attr_len = (__le16 *)&data[7]; /* 2 bytes */
  1082. noa_attr = (struct ieee80211_p2p_noa_attr *)&data[9];
  1083. noa_attr->index = noa->index;
  1084. noa_attr->oppps_ctwindow = ctwindow;
  1085. if (oppps)
  1086. noa_attr->oppps_ctwindow |= IEEE80211_P2P_OPPPS_ENABLE_BIT;
  1087. for (i = 0; i < noa_descriptors; i++) {
  1088. noa_attr->desc[i].count =
  1089. __le32_to_cpu(noa->descriptors[i].type_count);
  1090. noa_attr->desc[i].duration = noa->descriptors[i].duration;
  1091. noa_attr->desc[i].interval = noa->descriptors[i].interval;
  1092. noa_attr->desc[i].start_time = noa->descriptors[i].start_time;
  1093. }
  1094. attr_len = 2; /* index + oppps_ctwindow */
  1095. attr_len += noa_descriptors * sizeof(struct ieee80211_p2p_noa_desc);
  1096. *noa_attr_len = __cpu_to_le16(attr_len);
  1097. }
  1098. static u32 ath10k_p2p_calc_noa_ie_len(struct wmi_p2p_noa_info *noa)
  1099. {
  1100. u32 len = 0;
  1101. u8 noa_descriptors = noa->num_descriptors;
  1102. u8 opp_ps_info = noa->ctwindow_oppps;
  1103. bool opps_enabled = !!(opp_ps_info & WMI_P2P_OPPPS_ENABLE_BIT);
  1104. if (!noa_descriptors && !opps_enabled)
  1105. return len;
  1106. len += 1 + 1 + 4; /* EID + len + OUI */
  1107. len += 1 + 2; /* noa attr + attr len */
  1108. len += 1 + 1; /* index + oppps_ctwindow */
  1109. len += noa_descriptors * sizeof(struct ieee80211_p2p_noa_desc);
  1110. return len;
  1111. }
  1112. static void ath10k_wmi_update_noa(struct ath10k *ar, struct ath10k_vif *arvif,
  1113. struct sk_buff *bcn,
  1114. struct wmi_bcn_info *bcn_info)
  1115. {
  1116. struct wmi_p2p_noa_info *noa = &bcn_info->p2p_noa_info;
  1117. u8 *new_data, *old_data = arvif->u.ap.noa_data;
  1118. u32 new_len;
  1119. if (arvif->vdev_subtype != WMI_VDEV_SUBTYPE_P2P_GO)
  1120. return;
  1121. ath10k_dbg(ATH10K_DBG_MGMT, "noa changed: %d\n", noa->changed);
  1122. if (noa->changed & WMI_P2P_NOA_CHANGED_BIT) {
  1123. new_len = ath10k_p2p_calc_noa_ie_len(noa);
  1124. if (!new_len)
  1125. goto cleanup;
  1126. new_data = kmalloc(new_len, GFP_ATOMIC);
  1127. if (!new_data)
  1128. goto cleanup;
  1129. ath10k_p2p_fill_noa_ie(new_data, new_len, noa);
  1130. spin_lock_bh(&ar->data_lock);
  1131. arvif->u.ap.noa_data = new_data;
  1132. arvif->u.ap.noa_len = new_len;
  1133. spin_unlock_bh(&ar->data_lock);
  1134. kfree(old_data);
  1135. }
  1136. if (arvif->u.ap.noa_data)
  1137. if (!pskb_expand_head(bcn, 0, arvif->u.ap.noa_len, GFP_ATOMIC))
  1138. memcpy(skb_put(bcn, arvif->u.ap.noa_len),
  1139. arvif->u.ap.noa_data,
  1140. arvif->u.ap.noa_len);
  1141. return;
  1142. cleanup:
  1143. spin_lock_bh(&ar->data_lock);
  1144. arvif->u.ap.noa_data = NULL;
  1145. arvif->u.ap.noa_len = 0;
  1146. spin_unlock_bh(&ar->data_lock);
  1147. kfree(old_data);
  1148. }
  1149. static void ath10k_wmi_event_host_swba(struct ath10k *ar, struct sk_buff *skb)
  1150. {
  1151. struct wmi_host_swba_event *ev;
  1152. u32 map;
  1153. int i = -1;
  1154. struct wmi_bcn_info *bcn_info;
  1155. struct ath10k_vif *arvif;
  1156. struct sk_buff *bcn;
  1157. int vdev_id = 0;
  1158. ath10k_dbg(ATH10K_DBG_MGMT, "WMI_HOST_SWBA_EVENTID\n");
  1159. ev = (struct wmi_host_swba_event *)skb->data;
  1160. map = __le32_to_cpu(ev->vdev_map);
  1161. ath10k_dbg(ATH10K_DBG_MGMT, "host swba:\n"
  1162. "-vdev map 0x%x\n",
  1163. ev->vdev_map);
  1164. for (; map; map >>= 1, vdev_id++) {
  1165. if (!(map & 0x1))
  1166. continue;
  1167. i++;
  1168. if (i >= WMI_MAX_AP_VDEV) {
  1169. ath10k_warn("swba has corrupted vdev map\n");
  1170. break;
  1171. }
  1172. bcn_info = &ev->bcn_info[i];
  1173. ath10k_dbg(ATH10K_DBG_MGMT,
  1174. "-bcn_info[%d]:\n"
  1175. "--tim_len %d\n"
  1176. "--tim_mcast %d\n"
  1177. "--tim_changed %d\n"
  1178. "--tim_num_ps_pending %d\n"
  1179. "--tim_bitmap 0x%08x%08x%08x%08x\n",
  1180. i,
  1181. __le32_to_cpu(bcn_info->tim_info.tim_len),
  1182. __le32_to_cpu(bcn_info->tim_info.tim_mcast),
  1183. __le32_to_cpu(bcn_info->tim_info.tim_changed),
  1184. __le32_to_cpu(bcn_info->tim_info.tim_num_ps_pending),
  1185. __le32_to_cpu(bcn_info->tim_info.tim_bitmap[3]),
  1186. __le32_to_cpu(bcn_info->tim_info.tim_bitmap[2]),
  1187. __le32_to_cpu(bcn_info->tim_info.tim_bitmap[1]),
  1188. __le32_to_cpu(bcn_info->tim_info.tim_bitmap[0]));
  1189. arvif = ath10k_get_arvif(ar, vdev_id);
  1190. if (arvif == NULL) {
  1191. ath10k_warn("no vif for vdev_id %d found\n", vdev_id);
  1192. continue;
  1193. }
  1194. bcn = ieee80211_beacon_get(ar->hw, arvif->vif);
  1195. if (!bcn) {
  1196. ath10k_warn("could not get mac80211 beacon\n");
  1197. continue;
  1198. }
  1199. ath10k_tx_h_seq_no(bcn);
  1200. ath10k_wmi_update_tim(ar, arvif, bcn, bcn_info);
  1201. ath10k_wmi_update_noa(ar, arvif, bcn, bcn_info);
  1202. spin_lock_bh(&ar->data_lock);
  1203. if (arvif->beacon) {
  1204. ath10k_warn("SWBA overrun on vdev %d\n",
  1205. arvif->vdev_id);
  1206. dev_kfree_skb_any(arvif->beacon);
  1207. }
  1208. arvif->beacon = bcn;
  1209. ath10k_wmi_tx_beacon_nowait(arvif);
  1210. spin_unlock_bh(&ar->data_lock);
  1211. }
  1212. }
  1213. static void ath10k_wmi_event_tbttoffset_update(struct ath10k *ar,
  1214. struct sk_buff *skb)
  1215. {
  1216. ath10k_dbg(ATH10K_DBG_WMI, "WMI_TBTTOFFSET_UPDATE_EVENTID\n");
  1217. }
  1218. static void ath10k_wmi_event_phyerr(struct ath10k *ar, struct sk_buff *skb)
  1219. {
  1220. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PHYERR_EVENTID\n");
  1221. }
  1222. static void ath10k_wmi_event_roam(struct ath10k *ar, struct sk_buff *skb)
  1223. {
  1224. ath10k_dbg(ATH10K_DBG_WMI, "WMI_ROAM_EVENTID\n");
  1225. }
  1226. static void ath10k_wmi_event_profile_match(struct ath10k *ar,
  1227. struct sk_buff *skb)
  1228. {
  1229. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PROFILE_MATCH\n");
  1230. }
  1231. static void ath10k_wmi_event_debug_print(struct ath10k *ar,
  1232. struct sk_buff *skb)
  1233. {
  1234. ath10k_dbg(ATH10K_DBG_WMI, "WMI_DEBUG_PRINT_EVENTID\n");
  1235. }
  1236. static void ath10k_wmi_event_pdev_qvit(struct ath10k *ar, struct sk_buff *skb)
  1237. {
  1238. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_QVIT_EVENTID\n");
  1239. }
  1240. static void ath10k_wmi_event_wlan_profile_data(struct ath10k *ar,
  1241. struct sk_buff *skb)
  1242. {
  1243. ath10k_dbg(ATH10K_DBG_WMI, "WMI_WLAN_PROFILE_DATA_EVENTID\n");
  1244. }
  1245. static void ath10k_wmi_event_rtt_measurement_report(struct ath10k *ar,
  1246. struct sk_buff *skb)
  1247. {
  1248. ath10k_dbg(ATH10K_DBG_WMI, "WMI_RTT_MEASUREMENT_REPORT_EVENTID\n");
  1249. }
  1250. static void ath10k_wmi_event_tsf_measurement_report(struct ath10k *ar,
  1251. struct sk_buff *skb)
  1252. {
  1253. ath10k_dbg(ATH10K_DBG_WMI, "WMI_TSF_MEASUREMENT_REPORT_EVENTID\n");
  1254. }
  1255. static void ath10k_wmi_event_rtt_error_report(struct ath10k *ar,
  1256. struct sk_buff *skb)
  1257. {
  1258. ath10k_dbg(ATH10K_DBG_WMI, "WMI_RTT_ERROR_REPORT_EVENTID\n");
  1259. }
  1260. static void ath10k_wmi_event_wow_wakeup_host(struct ath10k *ar,
  1261. struct sk_buff *skb)
  1262. {
  1263. ath10k_dbg(ATH10K_DBG_WMI, "WMI_WOW_WAKEUP_HOST_EVENTID\n");
  1264. }
  1265. static void ath10k_wmi_event_dcs_interference(struct ath10k *ar,
  1266. struct sk_buff *skb)
  1267. {
  1268. ath10k_dbg(ATH10K_DBG_WMI, "WMI_DCS_INTERFERENCE_EVENTID\n");
  1269. }
  1270. static void ath10k_wmi_event_pdev_tpc_config(struct ath10k *ar,
  1271. struct sk_buff *skb)
  1272. {
  1273. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_TPC_CONFIG_EVENTID\n");
  1274. }
  1275. static void ath10k_wmi_event_pdev_ftm_intg(struct ath10k *ar,
  1276. struct sk_buff *skb)
  1277. {
  1278. ath10k_dbg(ATH10K_DBG_WMI, "WMI_PDEV_FTM_INTG_EVENTID\n");
  1279. }
  1280. static void ath10k_wmi_event_gtk_offload_status(struct ath10k *ar,
  1281. struct sk_buff *skb)
  1282. {
  1283. ath10k_dbg(ATH10K_DBG_WMI, "WMI_GTK_OFFLOAD_STATUS_EVENTID\n");
  1284. }
  1285. static void ath10k_wmi_event_gtk_rekey_fail(struct ath10k *ar,
  1286. struct sk_buff *skb)
  1287. {
  1288. ath10k_dbg(ATH10K_DBG_WMI, "WMI_GTK_REKEY_FAIL_EVENTID\n");
  1289. }
  1290. static void ath10k_wmi_event_delba_complete(struct ath10k *ar,
  1291. struct sk_buff *skb)
  1292. {
  1293. ath10k_dbg(ATH10K_DBG_WMI, "WMI_TX_DELBA_COMPLETE_EVENTID\n");
  1294. }
  1295. static void ath10k_wmi_event_addba_complete(struct ath10k *ar,
  1296. struct sk_buff *skb)
  1297. {
  1298. ath10k_dbg(ATH10K_DBG_WMI, "WMI_TX_ADDBA_COMPLETE_EVENTID\n");
  1299. }
  1300. static void ath10k_wmi_event_vdev_install_key_complete(struct ath10k *ar,
  1301. struct sk_buff *skb)
  1302. {
  1303. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_INSTALL_KEY_COMPLETE_EVENTID\n");
  1304. }
  1305. static void ath10k_wmi_event_inst_rssi_stats(struct ath10k *ar,
  1306. struct sk_buff *skb)
  1307. {
  1308. ath10k_dbg(ATH10K_DBG_WMI, "WMI_INST_RSSI_STATS_EVENTID\n");
  1309. }
  1310. static void ath10k_wmi_event_vdev_standby_req(struct ath10k *ar,
  1311. struct sk_buff *skb)
  1312. {
  1313. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_STANDBY_REQ_EVENTID\n");
  1314. }
  1315. static void ath10k_wmi_event_vdev_resume_req(struct ath10k *ar,
  1316. struct sk_buff *skb)
  1317. {
  1318. ath10k_dbg(ATH10K_DBG_WMI, "WMI_VDEV_RESUME_REQ_EVENTID\n");
  1319. }
  1320. static int ath10k_wmi_alloc_host_mem(struct ath10k *ar, u32 req_id,
  1321. u32 num_units, u32 unit_len)
  1322. {
  1323. dma_addr_t paddr;
  1324. u32 pool_size;
  1325. int idx = ar->wmi.num_mem_chunks;
  1326. pool_size = num_units * round_up(unit_len, 4);
  1327. if (!pool_size)
  1328. return -EINVAL;
  1329. ar->wmi.mem_chunks[idx].vaddr = dma_alloc_coherent(ar->dev,
  1330. pool_size,
  1331. &paddr,
  1332. GFP_ATOMIC);
  1333. if (!ar->wmi.mem_chunks[idx].vaddr) {
  1334. ath10k_warn("failed to allocate memory chunk\n");
  1335. return -ENOMEM;
  1336. }
  1337. memset(ar->wmi.mem_chunks[idx].vaddr, 0, pool_size);
  1338. ar->wmi.mem_chunks[idx].paddr = paddr;
  1339. ar->wmi.mem_chunks[idx].len = pool_size;
  1340. ar->wmi.mem_chunks[idx].req_id = req_id;
  1341. ar->wmi.num_mem_chunks++;
  1342. return 0;
  1343. }
  1344. static void ath10k_wmi_service_ready_event_rx(struct ath10k *ar,
  1345. struct sk_buff *skb)
  1346. {
  1347. struct wmi_service_ready_event *ev = (void *)skb->data;
  1348. if (skb->len < sizeof(*ev)) {
  1349. ath10k_warn("Service ready event was %d B but expected %zu B. Wrong firmware version?\n",
  1350. skb->len, sizeof(*ev));
  1351. return;
  1352. }
  1353. ar->hw_min_tx_power = __le32_to_cpu(ev->hw_min_tx_power);
  1354. ar->hw_max_tx_power = __le32_to_cpu(ev->hw_max_tx_power);
  1355. ar->ht_cap_info = __le32_to_cpu(ev->ht_cap_info);
  1356. ar->vht_cap_info = __le32_to_cpu(ev->vht_cap_info);
  1357. ar->fw_version_major =
  1358. (__le32_to_cpu(ev->sw_version) & 0xff000000) >> 24;
  1359. ar->fw_version_minor = (__le32_to_cpu(ev->sw_version) & 0x00ffffff);
  1360. ar->fw_version_release =
  1361. (__le32_to_cpu(ev->sw_version_1) & 0xffff0000) >> 16;
  1362. ar->fw_version_build = (__le32_to_cpu(ev->sw_version_1) & 0x0000ffff);
  1363. ar->phy_capability = __le32_to_cpu(ev->phy_capability);
  1364. ar->num_rf_chains = __le32_to_cpu(ev->num_rf_chains);
  1365. /* only manually set fw features when not using FW IE format */
  1366. if (ar->fw_api == 1 && ar->fw_version_build > 636)
  1367. set_bit(ATH10K_FW_FEATURE_EXT_WMI_MGMT_RX, ar->fw_features);
  1368. if (ar->num_rf_chains > WMI_MAX_SPATIAL_STREAM) {
  1369. ath10k_warn("hardware advertises support for more spatial streams than it should (%d > %d)\n",
  1370. ar->num_rf_chains, WMI_MAX_SPATIAL_STREAM);
  1371. ar->num_rf_chains = WMI_MAX_SPATIAL_STREAM;
  1372. }
  1373. ar->ath_common.regulatory.current_rd =
  1374. __le32_to_cpu(ev->hal_reg_capabilities.eeprom_rd);
  1375. ath10k_debug_read_service_map(ar, ev->wmi_service_bitmap,
  1376. sizeof(ev->wmi_service_bitmap));
  1377. if (strlen(ar->hw->wiphy->fw_version) == 0) {
  1378. snprintf(ar->hw->wiphy->fw_version,
  1379. sizeof(ar->hw->wiphy->fw_version),
  1380. "%u.%u.%u.%u",
  1381. ar->fw_version_major,
  1382. ar->fw_version_minor,
  1383. ar->fw_version_release,
  1384. ar->fw_version_build);
  1385. }
  1386. /* FIXME: it probably should be better to support this */
  1387. if (__le32_to_cpu(ev->num_mem_reqs) > 0) {
  1388. ath10k_warn("target requested %d memory chunks; ignoring\n",
  1389. __le32_to_cpu(ev->num_mem_reqs));
  1390. }
  1391. ath10k_dbg(ATH10K_DBG_WMI,
  1392. "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",
  1393. __le32_to_cpu(ev->sw_version),
  1394. __le32_to_cpu(ev->sw_version_1),
  1395. __le32_to_cpu(ev->abi_version),
  1396. __le32_to_cpu(ev->phy_capability),
  1397. __le32_to_cpu(ev->ht_cap_info),
  1398. __le32_to_cpu(ev->vht_cap_info),
  1399. __le32_to_cpu(ev->vht_supp_mcs),
  1400. __le32_to_cpu(ev->sys_cap_info),
  1401. __le32_to_cpu(ev->num_mem_reqs),
  1402. __le32_to_cpu(ev->num_rf_chains));
  1403. complete(&ar->wmi.service_ready);
  1404. }
  1405. static void ath10k_wmi_10x_service_ready_event_rx(struct ath10k *ar,
  1406. struct sk_buff *skb)
  1407. {
  1408. u32 num_units, req_id, unit_size, num_mem_reqs, num_unit_info, i;
  1409. int ret;
  1410. struct wmi_service_ready_event_10x *ev = (void *)skb->data;
  1411. if (skb->len < sizeof(*ev)) {
  1412. ath10k_warn("Service ready event was %d B but expected %zu B. Wrong firmware version?\n",
  1413. skb->len, sizeof(*ev));
  1414. return;
  1415. }
  1416. ar->hw_min_tx_power = __le32_to_cpu(ev->hw_min_tx_power);
  1417. ar->hw_max_tx_power = __le32_to_cpu(ev->hw_max_tx_power);
  1418. ar->ht_cap_info = __le32_to_cpu(ev->ht_cap_info);
  1419. ar->vht_cap_info = __le32_to_cpu(ev->vht_cap_info);
  1420. ar->fw_version_major =
  1421. (__le32_to_cpu(ev->sw_version) & 0xff000000) >> 24;
  1422. ar->fw_version_minor = (__le32_to_cpu(ev->sw_version) & 0x00ffffff);
  1423. ar->phy_capability = __le32_to_cpu(ev->phy_capability);
  1424. ar->num_rf_chains = __le32_to_cpu(ev->num_rf_chains);
  1425. if (ar->num_rf_chains > WMI_MAX_SPATIAL_STREAM) {
  1426. ath10k_warn("hardware advertises support for more spatial streams than it should (%d > %d)\n",
  1427. ar->num_rf_chains, WMI_MAX_SPATIAL_STREAM);
  1428. ar->num_rf_chains = WMI_MAX_SPATIAL_STREAM;
  1429. }
  1430. ar->ath_common.regulatory.current_rd =
  1431. __le32_to_cpu(ev->hal_reg_capabilities.eeprom_rd);
  1432. ath10k_debug_read_service_map(ar, ev->wmi_service_bitmap,
  1433. sizeof(ev->wmi_service_bitmap));
  1434. if (strlen(ar->hw->wiphy->fw_version) == 0) {
  1435. snprintf(ar->hw->wiphy->fw_version,
  1436. sizeof(ar->hw->wiphy->fw_version),
  1437. "%u.%u",
  1438. ar->fw_version_major,
  1439. ar->fw_version_minor);
  1440. }
  1441. num_mem_reqs = __le32_to_cpu(ev->num_mem_reqs);
  1442. if (num_mem_reqs > ATH10K_MAX_MEM_REQS) {
  1443. ath10k_warn("requested memory chunks number (%d) exceeds the limit\n",
  1444. num_mem_reqs);
  1445. return;
  1446. }
  1447. if (!num_mem_reqs)
  1448. goto exit;
  1449. ath10k_dbg(ATH10K_DBG_WMI, "firmware has requested %d memory chunks\n",
  1450. num_mem_reqs);
  1451. for (i = 0; i < num_mem_reqs; ++i) {
  1452. req_id = __le32_to_cpu(ev->mem_reqs[i].req_id);
  1453. num_units = __le32_to_cpu(ev->mem_reqs[i].num_units);
  1454. unit_size = __le32_to_cpu(ev->mem_reqs[i].unit_size);
  1455. num_unit_info = __le32_to_cpu(ev->mem_reqs[i].num_unit_info);
  1456. if (num_unit_info & NUM_UNITS_IS_NUM_PEERS)
  1457. /* number of units to allocate is number of
  1458. * peers, 1 extra for self peer on target */
  1459. /* this needs to be tied, host and target
  1460. * can get out of sync */
  1461. num_units = TARGET_10X_NUM_PEERS + 1;
  1462. else if (num_unit_info & NUM_UNITS_IS_NUM_VDEVS)
  1463. num_units = TARGET_10X_NUM_VDEVS + 1;
  1464. ath10k_dbg(ATH10K_DBG_WMI,
  1465. "wmi mem_req_id %d num_units %d num_unit_info %d unit size %d actual units %d\n",
  1466. req_id,
  1467. __le32_to_cpu(ev->mem_reqs[i].num_units),
  1468. num_unit_info,
  1469. unit_size,
  1470. num_units);
  1471. ret = ath10k_wmi_alloc_host_mem(ar, req_id, num_units,
  1472. unit_size);
  1473. if (ret)
  1474. return;
  1475. }
  1476. exit:
  1477. ath10k_dbg(ATH10K_DBG_WMI,
  1478. "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",
  1479. __le32_to_cpu(ev->sw_version),
  1480. __le32_to_cpu(ev->abi_version),
  1481. __le32_to_cpu(ev->phy_capability),
  1482. __le32_to_cpu(ev->ht_cap_info),
  1483. __le32_to_cpu(ev->vht_cap_info),
  1484. __le32_to_cpu(ev->vht_supp_mcs),
  1485. __le32_to_cpu(ev->sys_cap_info),
  1486. __le32_to_cpu(ev->num_mem_reqs),
  1487. __le32_to_cpu(ev->num_rf_chains));
  1488. complete(&ar->wmi.service_ready);
  1489. }
  1490. static int ath10k_wmi_ready_event_rx(struct ath10k *ar, struct sk_buff *skb)
  1491. {
  1492. struct wmi_ready_event *ev = (struct wmi_ready_event *)skb->data;
  1493. if (WARN_ON(skb->len < sizeof(*ev)))
  1494. return -EINVAL;
  1495. memcpy(ar->mac_addr, ev->mac_addr.addr, ETH_ALEN);
  1496. ath10k_dbg(ATH10K_DBG_WMI,
  1497. "wmi event ready sw_version %u abi_version %u mac_addr %pM status %d\n",
  1498. __le32_to_cpu(ev->sw_version),
  1499. __le32_to_cpu(ev->abi_version),
  1500. ev->mac_addr.addr,
  1501. __le32_to_cpu(ev->status));
  1502. complete(&ar->wmi.unified_ready);
  1503. return 0;
  1504. }
  1505. static void ath10k_wmi_main_process_rx(struct ath10k *ar, struct sk_buff *skb)
  1506. {
  1507. struct wmi_cmd_hdr *cmd_hdr;
  1508. enum wmi_event_id id;
  1509. u16 len;
  1510. cmd_hdr = (struct wmi_cmd_hdr *)skb->data;
  1511. id = MS(__le32_to_cpu(cmd_hdr->cmd_id), WMI_CMD_HDR_CMD_ID);
  1512. if (skb_pull(skb, sizeof(struct wmi_cmd_hdr)) == NULL)
  1513. return;
  1514. len = skb->len;
  1515. trace_ath10k_wmi_event(id, skb->data, skb->len);
  1516. switch (id) {
  1517. case WMI_MGMT_RX_EVENTID:
  1518. ath10k_wmi_event_mgmt_rx(ar, skb);
  1519. /* mgmt_rx() owns the skb now! */
  1520. return;
  1521. case WMI_SCAN_EVENTID:
  1522. ath10k_wmi_event_scan(ar, skb);
  1523. break;
  1524. case WMI_CHAN_INFO_EVENTID:
  1525. ath10k_wmi_event_chan_info(ar, skb);
  1526. break;
  1527. case WMI_ECHO_EVENTID:
  1528. ath10k_wmi_event_echo(ar, skb);
  1529. break;
  1530. case WMI_DEBUG_MESG_EVENTID:
  1531. ath10k_wmi_event_debug_mesg(ar, skb);
  1532. break;
  1533. case WMI_UPDATE_STATS_EVENTID:
  1534. ath10k_wmi_event_update_stats(ar, skb);
  1535. break;
  1536. case WMI_VDEV_START_RESP_EVENTID:
  1537. ath10k_wmi_event_vdev_start_resp(ar, skb);
  1538. break;
  1539. case WMI_VDEV_STOPPED_EVENTID:
  1540. ath10k_wmi_event_vdev_stopped(ar, skb);
  1541. break;
  1542. case WMI_PEER_STA_KICKOUT_EVENTID:
  1543. ath10k_wmi_event_peer_sta_kickout(ar, skb);
  1544. break;
  1545. case WMI_HOST_SWBA_EVENTID:
  1546. ath10k_wmi_event_host_swba(ar, skb);
  1547. break;
  1548. case WMI_TBTTOFFSET_UPDATE_EVENTID:
  1549. ath10k_wmi_event_tbttoffset_update(ar, skb);
  1550. break;
  1551. case WMI_PHYERR_EVENTID:
  1552. ath10k_wmi_event_phyerr(ar, skb);
  1553. break;
  1554. case WMI_ROAM_EVENTID:
  1555. ath10k_wmi_event_roam(ar, skb);
  1556. break;
  1557. case WMI_PROFILE_MATCH:
  1558. ath10k_wmi_event_profile_match(ar, skb);
  1559. break;
  1560. case WMI_DEBUG_PRINT_EVENTID:
  1561. ath10k_wmi_event_debug_print(ar, skb);
  1562. break;
  1563. case WMI_PDEV_QVIT_EVENTID:
  1564. ath10k_wmi_event_pdev_qvit(ar, skb);
  1565. break;
  1566. case WMI_WLAN_PROFILE_DATA_EVENTID:
  1567. ath10k_wmi_event_wlan_profile_data(ar, skb);
  1568. break;
  1569. case WMI_RTT_MEASUREMENT_REPORT_EVENTID:
  1570. ath10k_wmi_event_rtt_measurement_report(ar, skb);
  1571. break;
  1572. case WMI_TSF_MEASUREMENT_REPORT_EVENTID:
  1573. ath10k_wmi_event_tsf_measurement_report(ar, skb);
  1574. break;
  1575. case WMI_RTT_ERROR_REPORT_EVENTID:
  1576. ath10k_wmi_event_rtt_error_report(ar, skb);
  1577. break;
  1578. case WMI_WOW_WAKEUP_HOST_EVENTID:
  1579. ath10k_wmi_event_wow_wakeup_host(ar, skb);
  1580. break;
  1581. case WMI_DCS_INTERFERENCE_EVENTID:
  1582. ath10k_wmi_event_dcs_interference(ar, skb);
  1583. break;
  1584. case WMI_PDEV_TPC_CONFIG_EVENTID:
  1585. ath10k_wmi_event_pdev_tpc_config(ar, skb);
  1586. break;
  1587. case WMI_PDEV_FTM_INTG_EVENTID:
  1588. ath10k_wmi_event_pdev_ftm_intg(ar, skb);
  1589. break;
  1590. case WMI_GTK_OFFLOAD_STATUS_EVENTID:
  1591. ath10k_wmi_event_gtk_offload_status(ar, skb);
  1592. break;
  1593. case WMI_GTK_REKEY_FAIL_EVENTID:
  1594. ath10k_wmi_event_gtk_rekey_fail(ar, skb);
  1595. break;
  1596. case WMI_TX_DELBA_COMPLETE_EVENTID:
  1597. ath10k_wmi_event_delba_complete(ar, skb);
  1598. break;
  1599. case WMI_TX_ADDBA_COMPLETE_EVENTID:
  1600. ath10k_wmi_event_addba_complete(ar, skb);
  1601. break;
  1602. case WMI_VDEV_INSTALL_KEY_COMPLETE_EVENTID:
  1603. ath10k_wmi_event_vdev_install_key_complete(ar, skb);
  1604. break;
  1605. case WMI_SERVICE_READY_EVENTID:
  1606. ath10k_wmi_service_ready_event_rx(ar, skb);
  1607. break;
  1608. case WMI_READY_EVENTID:
  1609. ath10k_wmi_ready_event_rx(ar, skb);
  1610. break;
  1611. default:
  1612. ath10k_warn("Unknown eventid: %d\n", id);
  1613. break;
  1614. }
  1615. dev_kfree_skb(skb);
  1616. }
  1617. static void ath10k_wmi_10x_process_rx(struct ath10k *ar, struct sk_buff *skb)
  1618. {
  1619. struct wmi_cmd_hdr *cmd_hdr;
  1620. enum wmi_10x_event_id id;
  1621. u16 len;
  1622. cmd_hdr = (struct wmi_cmd_hdr *)skb->data;
  1623. id = MS(__le32_to_cpu(cmd_hdr->cmd_id), WMI_CMD_HDR_CMD_ID);
  1624. if (skb_pull(skb, sizeof(struct wmi_cmd_hdr)) == NULL)
  1625. return;
  1626. len = skb->len;
  1627. trace_ath10k_wmi_event(id, skb->data, skb->len);
  1628. switch (id) {
  1629. case WMI_10X_MGMT_RX_EVENTID:
  1630. ath10k_wmi_event_mgmt_rx(ar, skb);
  1631. /* mgmt_rx() owns the skb now! */
  1632. return;
  1633. case WMI_10X_SCAN_EVENTID:
  1634. ath10k_wmi_event_scan(ar, skb);
  1635. break;
  1636. case WMI_10X_CHAN_INFO_EVENTID:
  1637. ath10k_wmi_event_chan_info(ar, skb);
  1638. break;
  1639. case WMI_10X_ECHO_EVENTID:
  1640. ath10k_wmi_event_echo(ar, skb);
  1641. break;
  1642. case WMI_10X_DEBUG_MESG_EVENTID:
  1643. ath10k_wmi_event_debug_mesg(ar, skb);
  1644. break;
  1645. case WMI_10X_UPDATE_STATS_EVENTID:
  1646. ath10k_wmi_event_update_stats(ar, skb);
  1647. break;
  1648. case WMI_10X_VDEV_START_RESP_EVENTID:
  1649. ath10k_wmi_event_vdev_start_resp(ar, skb);
  1650. break;
  1651. case WMI_10X_VDEV_STOPPED_EVENTID:
  1652. ath10k_wmi_event_vdev_stopped(ar, skb);
  1653. break;
  1654. case WMI_10X_PEER_STA_KICKOUT_EVENTID:
  1655. ath10k_wmi_event_peer_sta_kickout(ar, skb);
  1656. break;
  1657. case WMI_10X_HOST_SWBA_EVENTID:
  1658. ath10k_wmi_event_host_swba(ar, skb);
  1659. break;
  1660. case WMI_10X_TBTTOFFSET_UPDATE_EVENTID:
  1661. ath10k_wmi_event_tbttoffset_update(ar, skb);
  1662. break;
  1663. case WMI_10X_PHYERR_EVENTID:
  1664. ath10k_wmi_event_phyerr(ar, skb);
  1665. break;
  1666. case WMI_10X_ROAM_EVENTID:
  1667. ath10k_wmi_event_roam(ar, skb);
  1668. break;
  1669. case WMI_10X_PROFILE_MATCH:
  1670. ath10k_wmi_event_profile_match(ar, skb);
  1671. break;
  1672. case WMI_10X_DEBUG_PRINT_EVENTID:
  1673. ath10k_wmi_event_debug_print(ar, skb);
  1674. break;
  1675. case WMI_10X_PDEV_QVIT_EVENTID:
  1676. ath10k_wmi_event_pdev_qvit(ar, skb);
  1677. break;
  1678. case WMI_10X_WLAN_PROFILE_DATA_EVENTID:
  1679. ath10k_wmi_event_wlan_profile_data(ar, skb);
  1680. break;
  1681. case WMI_10X_RTT_MEASUREMENT_REPORT_EVENTID:
  1682. ath10k_wmi_event_rtt_measurement_report(ar, skb);
  1683. break;
  1684. case WMI_10X_TSF_MEASUREMENT_REPORT_EVENTID:
  1685. ath10k_wmi_event_tsf_measurement_report(ar, skb);
  1686. break;
  1687. case WMI_10X_RTT_ERROR_REPORT_EVENTID:
  1688. ath10k_wmi_event_rtt_error_report(ar, skb);
  1689. break;
  1690. case WMI_10X_WOW_WAKEUP_HOST_EVENTID:
  1691. ath10k_wmi_event_wow_wakeup_host(ar, skb);
  1692. break;
  1693. case WMI_10X_DCS_INTERFERENCE_EVENTID:
  1694. ath10k_wmi_event_dcs_interference(ar, skb);
  1695. break;
  1696. case WMI_10X_PDEV_TPC_CONFIG_EVENTID:
  1697. ath10k_wmi_event_pdev_tpc_config(ar, skb);
  1698. break;
  1699. case WMI_10X_INST_RSSI_STATS_EVENTID:
  1700. ath10k_wmi_event_inst_rssi_stats(ar, skb);
  1701. break;
  1702. case WMI_10X_VDEV_STANDBY_REQ_EVENTID:
  1703. ath10k_wmi_event_vdev_standby_req(ar, skb);
  1704. break;
  1705. case WMI_10X_VDEV_RESUME_REQ_EVENTID:
  1706. ath10k_wmi_event_vdev_resume_req(ar, skb);
  1707. break;
  1708. case WMI_10X_SERVICE_READY_EVENTID:
  1709. ath10k_wmi_10x_service_ready_event_rx(ar, skb);
  1710. break;
  1711. case WMI_10X_READY_EVENTID:
  1712. ath10k_wmi_ready_event_rx(ar, skb);
  1713. break;
  1714. default:
  1715. ath10k_warn("Unknown eventid: %d\n", id);
  1716. break;
  1717. }
  1718. dev_kfree_skb(skb);
  1719. }
  1720. static void ath10k_wmi_process_rx(struct ath10k *ar, struct sk_buff *skb)
  1721. {
  1722. if (test_bit(ATH10K_FW_FEATURE_WMI_10X, ar->fw_features))
  1723. ath10k_wmi_10x_process_rx(ar, skb);
  1724. else
  1725. ath10k_wmi_main_process_rx(ar, skb);
  1726. }
  1727. /* WMI Initialization functions */
  1728. int ath10k_wmi_attach(struct ath10k *ar)
  1729. {
  1730. if (test_bit(ATH10K_FW_FEATURE_WMI_10X, ar->fw_features)) {
  1731. ar->wmi.cmd = &wmi_10x_cmd_map;
  1732. ar->wmi.vdev_param = &wmi_10x_vdev_param_map;
  1733. ar->wmi.pdev_param = &wmi_10x_pdev_param_map;
  1734. } else {
  1735. ar->wmi.cmd = &wmi_cmd_map;
  1736. ar->wmi.vdev_param = &wmi_vdev_param_map;
  1737. ar->wmi.pdev_param = &wmi_pdev_param_map;
  1738. }
  1739. init_completion(&ar->wmi.service_ready);
  1740. init_completion(&ar->wmi.unified_ready);
  1741. init_waitqueue_head(&ar->wmi.tx_credits_wq);
  1742. return 0;
  1743. }
  1744. void ath10k_wmi_detach(struct ath10k *ar)
  1745. {
  1746. int i;
  1747. /* free the host memory chunks requested by firmware */
  1748. for (i = 0; i < ar->wmi.num_mem_chunks; i++) {
  1749. dma_free_coherent(ar->dev,
  1750. ar->wmi.mem_chunks[i].len,
  1751. ar->wmi.mem_chunks[i].vaddr,
  1752. ar->wmi.mem_chunks[i].paddr);
  1753. }
  1754. ar->wmi.num_mem_chunks = 0;
  1755. }
  1756. int ath10k_wmi_connect_htc_service(struct ath10k *ar)
  1757. {
  1758. int status;
  1759. struct ath10k_htc_svc_conn_req conn_req;
  1760. struct ath10k_htc_svc_conn_resp conn_resp;
  1761. memset(&conn_req, 0, sizeof(conn_req));
  1762. memset(&conn_resp, 0, sizeof(conn_resp));
  1763. /* these fields are the same for all service endpoints */
  1764. conn_req.ep_ops.ep_tx_complete = ath10k_wmi_htc_tx_complete;
  1765. conn_req.ep_ops.ep_rx_complete = ath10k_wmi_process_rx;
  1766. conn_req.ep_ops.ep_tx_credits = ath10k_wmi_op_ep_tx_credits;
  1767. /* connect to control service */
  1768. conn_req.service_id = ATH10K_HTC_SVC_ID_WMI_CONTROL;
  1769. status = ath10k_htc_connect_service(&ar->htc, &conn_req, &conn_resp);
  1770. if (status) {
  1771. ath10k_warn("failed to connect to WMI CONTROL service status: %d\n",
  1772. status);
  1773. return status;
  1774. }
  1775. ar->wmi.eid = conn_resp.eid;
  1776. return 0;
  1777. }
  1778. int ath10k_wmi_pdev_set_regdomain(struct ath10k *ar, u16 rd, u16 rd2g,
  1779. u16 rd5g, u16 ctl2g, u16 ctl5g)
  1780. {
  1781. struct wmi_pdev_set_regdomain_cmd *cmd;
  1782. struct sk_buff *skb;
  1783. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1784. if (!skb)
  1785. return -ENOMEM;
  1786. cmd = (struct wmi_pdev_set_regdomain_cmd *)skb->data;
  1787. cmd->reg_domain = __cpu_to_le32(rd);
  1788. cmd->reg_domain_2G = __cpu_to_le32(rd2g);
  1789. cmd->reg_domain_5G = __cpu_to_le32(rd5g);
  1790. cmd->conformance_test_limit_2G = __cpu_to_le32(ctl2g);
  1791. cmd->conformance_test_limit_5G = __cpu_to_le32(ctl5g);
  1792. ath10k_dbg(ATH10K_DBG_WMI,
  1793. "wmi pdev regdomain rd %x rd2g %x rd5g %x ctl2g %x ctl5g %x\n",
  1794. rd, rd2g, rd5g, ctl2g, ctl5g);
  1795. return ath10k_wmi_cmd_send(ar, skb,
  1796. ar->wmi.cmd->pdev_set_regdomain_cmdid);
  1797. }
  1798. int ath10k_wmi_pdev_set_channel(struct ath10k *ar,
  1799. const struct wmi_channel_arg *arg)
  1800. {
  1801. struct wmi_set_channel_cmd *cmd;
  1802. struct sk_buff *skb;
  1803. if (arg->passive)
  1804. return -EINVAL;
  1805. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1806. if (!skb)
  1807. return -ENOMEM;
  1808. cmd = (struct wmi_set_channel_cmd *)skb->data;
  1809. cmd->chan.mhz = __cpu_to_le32(arg->freq);
  1810. cmd->chan.band_center_freq1 = __cpu_to_le32(arg->freq);
  1811. cmd->chan.mode = arg->mode;
  1812. cmd->chan.min_power = arg->min_power;
  1813. cmd->chan.max_power = arg->max_power;
  1814. cmd->chan.reg_power = arg->max_reg_power;
  1815. cmd->chan.reg_classid = arg->reg_class_id;
  1816. cmd->chan.antenna_max = arg->max_antenna_gain;
  1817. ath10k_dbg(ATH10K_DBG_WMI,
  1818. "wmi set channel mode %d freq %d\n",
  1819. arg->mode, arg->freq);
  1820. return ath10k_wmi_cmd_send(ar, skb,
  1821. ar->wmi.cmd->pdev_set_channel_cmdid);
  1822. }
  1823. int ath10k_wmi_pdev_suspend_target(struct ath10k *ar)
  1824. {
  1825. struct wmi_pdev_suspend_cmd *cmd;
  1826. struct sk_buff *skb;
  1827. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1828. if (!skb)
  1829. return -ENOMEM;
  1830. cmd = (struct wmi_pdev_suspend_cmd *)skb->data;
  1831. cmd->suspend_opt = WMI_PDEV_SUSPEND;
  1832. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->pdev_suspend_cmdid);
  1833. }
  1834. int ath10k_wmi_pdev_resume_target(struct ath10k *ar)
  1835. {
  1836. struct sk_buff *skb;
  1837. skb = ath10k_wmi_alloc_skb(0);
  1838. if (skb == NULL)
  1839. return -ENOMEM;
  1840. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->pdev_resume_cmdid);
  1841. }
  1842. int ath10k_wmi_pdev_set_param(struct ath10k *ar, u32 id, u32 value)
  1843. {
  1844. struct wmi_pdev_set_param_cmd *cmd;
  1845. struct sk_buff *skb;
  1846. if (id == WMI_PDEV_PARAM_UNSUPPORTED) {
  1847. ath10k_warn("pdev param %d not supported by firmware\n", id);
  1848. return -EOPNOTSUPP;
  1849. }
  1850. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  1851. if (!skb)
  1852. return -ENOMEM;
  1853. cmd = (struct wmi_pdev_set_param_cmd *)skb->data;
  1854. cmd->param_id = __cpu_to_le32(id);
  1855. cmd->param_value = __cpu_to_le32(value);
  1856. ath10k_dbg(ATH10K_DBG_WMI, "wmi pdev set param %d value %d\n",
  1857. id, value);
  1858. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->pdev_set_param_cmdid);
  1859. }
  1860. static int ath10k_wmi_main_cmd_init(struct ath10k *ar)
  1861. {
  1862. struct wmi_init_cmd *cmd;
  1863. struct sk_buff *buf;
  1864. struct wmi_resource_config config = {};
  1865. u32 len, val;
  1866. int i;
  1867. config.num_vdevs = __cpu_to_le32(TARGET_NUM_VDEVS);
  1868. config.num_peers = __cpu_to_le32(TARGET_NUM_PEERS + TARGET_NUM_VDEVS);
  1869. config.num_offload_peers = __cpu_to_le32(TARGET_NUM_OFFLOAD_PEERS);
  1870. config.num_offload_reorder_bufs =
  1871. __cpu_to_le32(TARGET_NUM_OFFLOAD_REORDER_BUFS);
  1872. config.num_peer_keys = __cpu_to_le32(TARGET_NUM_PEER_KEYS);
  1873. config.num_tids = __cpu_to_le32(TARGET_NUM_TIDS);
  1874. config.ast_skid_limit = __cpu_to_le32(TARGET_AST_SKID_LIMIT);
  1875. config.tx_chain_mask = __cpu_to_le32(TARGET_TX_CHAIN_MASK);
  1876. config.rx_chain_mask = __cpu_to_le32(TARGET_RX_CHAIN_MASK);
  1877. config.rx_timeout_pri_vo = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI);
  1878. config.rx_timeout_pri_vi = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI);
  1879. config.rx_timeout_pri_be = __cpu_to_le32(TARGET_RX_TIMEOUT_LO_PRI);
  1880. config.rx_timeout_pri_bk = __cpu_to_le32(TARGET_RX_TIMEOUT_HI_PRI);
  1881. config.rx_decap_mode = __cpu_to_le32(TARGET_RX_DECAP_MODE);
  1882. config.scan_max_pending_reqs =
  1883. __cpu_to_le32(TARGET_SCAN_MAX_PENDING_REQS);
  1884. config.bmiss_offload_max_vdev =
  1885. __cpu_to_le32(TARGET_BMISS_OFFLOAD_MAX_VDEV);
  1886. config.roam_offload_max_vdev =
  1887. __cpu_to_le32(TARGET_ROAM_OFFLOAD_MAX_VDEV);
  1888. config.roam_offload_max_ap_profiles =
  1889. __cpu_to_le32(TARGET_ROAM_OFFLOAD_MAX_AP_PROFILES);
  1890. config.num_mcast_groups = __cpu_to_le32(TARGET_NUM_MCAST_GROUPS);
  1891. config.num_mcast_table_elems =
  1892. __cpu_to_le32(TARGET_NUM_MCAST_TABLE_ELEMS);
  1893. config.mcast2ucast_mode = __cpu_to_le32(TARGET_MCAST2UCAST_MODE);
  1894. config.tx_dbg_log_size = __cpu_to_le32(TARGET_TX_DBG_LOG_SIZE);
  1895. config.num_wds_entries = __cpu_to_le32(TARGET_NUM_WDS_ENTRIES);
  1896. config.dma_burst_size = __cpu_to_le32(TARGET_DMA_BURST_SIZE);
  1897. config.mac_aggr_delim = __cpu_to_le32(TARGET_MAC_AGGR_DELIM);
  1898. val = TARGET_RX_SKIP_DEFRAG_TIMEOUT_DUP_DETECTION_CHECK;
  1899. config.rx_skip_defrag_timeout_dup_detection_check = __cpu_to_le32(val);
  1900. config.vow_config = __cpu_to_le32(TARGET_VOW_CONFIG);
  1901. config.gtk_offload_max_vdev =
  1902. __cpu_to_le32(TARGET_GTK_OFFLOAD_MAX_VDEV);
  1903. config.num_msdu_desc = __cpu_to_le32(TARGET_NUM_MSDU_DESC);
  1904. config.max_frag_entries = __cpu_to_le32(TARGET_MAX_FRAG_ENTRIES);
  1905. len = sizeof(*cmd) +
  1906. (sizeof(struct host_memory_chunk) * ar->wmi.num_mem_chunks);
  1907. buf = ath10k_wmi_alloc_skb(len);
  1908. if (!buf)
  1909. return -ENOMEM;
  1910. cmd = (struct wmi_init_cmd *)buf->data;
  1911. if (ar->wmi.num_mem_chunks == 0) {
  1912. cmd->num_host_mem_chunks = 0;
  1913. goto out;
  1914. }
  1915. ath10k_dbg(ATH10K_DBG_WMI, "wmi sending %d memory chunks info.\n",
  1916. __cpu_to_le32(ar->wmi.num_mem_chunks));
  1917. cmd->num_host_mem_chunks = __cpu_to_le32(ar->wmi.num_mem_chunks);
  1918. for (i = 0; i < ar->wmi.num_mem_chunks; i++) {
  1919. cmd->host_mem_chunks[i].ptr =
  1920. __cpu_to_le32(ar->wmi.mem_chunks[i].paddr);
  1921. cmd->host_mem_chunks[i].size =
  1922. __cpu_to_le32(ar->wmi.mem_chunks[i].len);
  1923. cmd->host_mem_chunks[i].req_id =
  1924. __cpu_to_le32(ar->wmi.mem_chunks[i].req_id);
  1925. ath10k_dbg(ATH10K_DBG_WMI,
  1926. "wmi chunk %d len %d requested, addr 0x%x\n",
  1927. i,
  1928. cmd->host_mem_chunks[i].size,
  1929. cmd->host_mem_chunks[i].ptr);
  1930. }
  1931. out:
  1932. memcpy(&cmd->resource_config, &config, sizeof(config));
  1933. ath10k_dbg(ATH10K_DBG_WMI, "wmi init\n");
  1934. return ath10k_wmi_cmd_send(ar, buf, ar->wmi.cmd->init_cmdid);
  1935. }
  1936. static int ath10k_wmi_10x_cmd_init(struct ath10k *ar)
  1937. {
  1938. struct wmi_init_cmd_10x *cmd;
  1939. struct sk_buff *buf;
  1940. struct wmi_resource_config_10x config = {};
  1941. u32 len, val;
  1942. int i;
  1943. config.num_vdevs = __cpu_to_le32(TARGET_10X_NUM_VDEVS);
  1944. config.num_peers = __cpu_to_le32(TARGET_10X_NUM_PEERS);
  1945. config.num_peer_keys = __cpu_to_le32(TARGET_10X_NUM_PEER_KEYS);
  1946. config.num_tids = __cpu_to_le32(TARGET_10X_NUM_TIDS);
  1947. config.ast_skid_limit = __cpu_to_le32(TARGET_10X_AST_SKID_LIMIT);
  1948. config.tx_chain_mask = __cpu_to_le32(TARGET_10X_TX_CHAIN_MASK);
  1949. config.rx_chain_mask = __cpu_to_le32(TARGET_10X_RX_CHAIN_MASK);
  1950. config.rx_timeout_pri_vo = __cpu_to_le32(TARGET_10X_RX_TIMEOUT_LO_PRI);
  1951. config.rx_timeout_pri_vi = __cpu_to_le32(TARGET_10X_RX_TIMEOUT_LO_PRI);
  1952. config.rx_timeout_pri_be = __cpu_to_le32(TARGET_10X_RX_TIMEOUT_LO_PRI);
  1953. config.rx_timeout_pri_bk = __cpu_to_le32(TARGET_10X_RX_TIMEOUT_HI_PRI);
  1954. config.rx_decap_mode = __cpu_to_le32(TARGET_10X_RX_DECAP_MODE);
  1955. config.scan_max_pending_reqs =
  1956. __cpu_to_le32(TARGET_10X_SCAN_MAX_PENDING_REQS);
  1957. config.bmiss_offload_max_vdev =
  1958. __cpu_to_le32(TARGET_10X_BMISS_OFFLOAD_MAX_VDEV);
  1959. config.roam_offload_max_vdev =
  1960. __cpu_to_le32(TARGET_10X_ROAM_OFFLOAD_MAX_VDEV);
  1961. config.roam_offload_max_ap_profiles =
  1962. __cpu_to_le32(TARGET_10X_ROAM_OFFLOAD_MAX_AP_PROFILES);
  1963. config.num_mcast_groups = __cpu_to_le32(TARGET_10X_NUM_MCAST_GROUPS);
  1964. config.num_mcast_table_elems =
  1965. __cpu_to_le32(TARGET_10X_NUM_MCAST_TABLE_ELEMS);
  1966. config.mcast2ucast_mode = __cpu_to_le32(TARGET_10X_MCAST2UCAST_MODE);
  1967. config.tx_dbg_log_size = __cpu_to_le32(TARGET_10X_TX_DBG_LOG_SIZE);
  1968. config.num_wds_entries = __cpu_to_le32(TARGET_10X_NUM_WDS_ENTRIES);
  1969. config.dma_burst_size = __cpu_to_le32(TARGET_10X_DMA_BURST_SIZE);
  1970. config.mac_aggr_delim = __cpu_to_le32(TARGET_10X_MAC_AGGR_DELIM);
  1971. val = TARGET_10X_RX_SKIP_DEFRAG_TIMEOUT_DUP_DETECTION_CHECK;
  1972. config.rx_skip_defrag_timeout_dup_detection_check = __cpu_to_le32(val);
  1973. config.vow_config = __cpu_to_le32(TARGET_10X_VOW_CONFIG);
  1974. config.num_msdu_desc = __cpu_to_le32(TARGET_10X_NUM_MSDU_DESC);
  1975. config.max_frag_entries = __cpu_to_le32(TARGET_10X_MAX_FRAG_ENTRIES);
  1976. len = sizeof(*cmd) +
  1977. (sizeof(struct host_memory_chunk) * ar->wmi.num_mem_chunks);
  1978. buf = ath10k_wmi_alloc_skb(len);
  1979. if (!buf)
  1980. return -ENOMEM;
  1981. cmd = (struct wmi_init_cmd_10x *)buf->data;
  1982. if (ar->wmi.num_mem_chunks == 0) {
  1983. cmd->num_host_mem_chunks = 0;
  1984. goto out;
  1985. }
  1986. ath10k_dbg(ATH10K_DBG_WMI, "wmi sending %d memory chunks info.\n",
  1987. __cpu_to_le32(ar->wmi.num_mem_chunks));
  1988. cmd->num_host_mem_chunks = __cpu_to_le32(ar->wmi.num_mem_chunks);
  1989. for (i = 0; i < ar->wmi.num_mem_chunks; i++) {
  1990. cmd->host_mem_chunks[i].ptr =
  1991. __cpu_to_le32(ar->wmi.mem_chunks[i].paddr);
  1992. cmd->host_mem_chunks[i].size =
  1993. __cpu_to_le32(ar->wmi.mem_chunks[i].len);
  1994. cmd->host_mem_chunks[i].req_id =
  1995. __cpu_to_le32(ar->wmi.mem_chunks[i].req_id);
  1996. ath10k_dbg(ATH10K_DBG_WMI,
  1997. "wmi chunk %d len %d requested, addr 0x%x\n",
  1998. i,
  1999. cmd->host_mem_chunks[i].size,
  2000. cmd->host_mem_chunks[i].ptr);
  2001. }
  2002. out:
  2003. memcpy(&cmd->resource_config, &config, sizeof(config));
  2004. ath10k_dbg(ATH10K_DBG_WMI, "wmi init 10x\n");
  2005. return ath10k_wmi_cmd_send(ar, buf, ar->wmi.cmd->init_cmdid);
  2006. }
  2007. int ath10k_wmi_cmd_init(struct ath10k *ar)
  2008. {
  2009. int ret;
  2010. if (test_bit(ATH10K_FW_FEATURE_WMI_10X, ar->fw_features))
  2011. ret = ath10k_wmi_10x_cmd_init(ar);
  2012. else
  2013. ret = ath10k_wmi_main_cmd_init(ar);
  2014. return ret;
  2015. }
  2016. static int ath10k_wmi_start_scan_calc_len(struct ath10k *ar,
  2017. const struct wmi_start_scan_arg *arg)
  2018. {
  2019. int len;
  2020. if (test_bit(ATH10K_FW_FEATURE_WMI_10X, ar->fw_features))
  2021. len = sizeof(struct wmi_start_scan_cmd_10x);
  2022. else
  2023. len = sizeof(struct wmi_start_scan_cmd);
  2024. if (arg->ie_len) {
  2025. if (!arg->ie)
  2026. return -EINVAL;
  2027. if (arg->ie_len > WLAN_SCAN_PARAMS_MAX_IE_LEN)
  2028. return -EINVAL;
  2029. len += sizeof(struct wmi_ie_data);
  2030. len += roundup(arg->ie_len, 4);
  2031. }
  2032. if (arg->n_channels) {
  2033. if (!arg->channels)
  2034. return -EINVAL;
  2035. if (arg->n_channels > ARRAY_SIZE(arg->channels))
  2036. return -EINVAL;
  2037. len += sizeof(struct wmi_chan_list);
  2038. len += sizeof(__le32) * arg->n_channels;
  2039. }
  2040. if (arg->n_ssids) {
  2041. if (!arg->ssids)
  2042. return -EINVAL;
  2043. if (arg->n_ssids > WLAN_SCAN_PARAMS_MAX_SSID)
  2044. return -EINVAL;
  2045. len += sizeof(struct wmi_ssid_list);
  2046. len += sizeof(struct wmi_ssid) * arg->n_ssids;
  2047. }
  2048. if (arg->n_bssids) {
  2049. if (!arg->bssids)
  2050. return -EINVAL;
  2051. if (arg->n_bssids > WLAN_SCAN_PARAMS_MAX_BSSID)
  2052. return -EINVAL;
  2053. len += sizeof(struct wmi_bssid_list);
  2054. len += sizeof(struct wmi_mac_addr) * arg->n_bssids;
  2055. }
  2056. return len;
  2057. }
  2058. int ath10k_wmi_start_scan(struct ath10k *ar,
  2059. const struct wmi_start_scan_arg *arg)
  2060. {
  2061. struct wmi_start_scan_cmd *cmd;
  2062. struct sk_buff *skb;
  2063. struct wmi_ie_data *ie;
  2064. struct wmi_chan_list *channels;
  2065. struct wmi_ssid_list *ssids;
  2066. struct wmi_bssid_list *bssids;
  2067. u32 scan_id;
  2068. u32 scan_req_id;
  2069. int off;
  2070. int len = 0;
  2071. int i;
  2072. len = ath10k_wmi_start_scan_calc_len(ar, arg);
  2073. if (len < 0)
  2074. return len; /* len contains error code here */
  2075. skb = ath10k_wmi_alloc_skb(len);
  2076. if (!skb)
  2077. return -ENOMEM;
  2078. scan_id = WMI_HOST_SCAN_REQ_ID_PREFIX;
  2079. scan_id |= arg->scan_id;
  2080. scan_req_id = WMI_HOST_SCAN_REQUESTOR_ID_PREFIX;
  2081. scan_req_id |= arg->scan_req_id;
  2082. cmd = (struct wmi_start_scan_cmd *)skb->data;
  2083. cmd->scan_id = __cpu_to_le32(scan_id);
  2084. cmd->scan_req_id = __cpu_to_le32(scan_req_id);
  2085. cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
  2086. cmd->scan_priority = __cpu_to_le32(arg->scan_priority);
  2087. cmd->notify_scan_events = __cpu_to_le32(arg->notify_scan_events);
  2088. cmd->dwell_time_active = __cpu_to_le32(arg->dwell_time_active);
  2089. cmd->dwell_time_passive = __cpu_to_le32(arg->dwell_time_passive);
  2090. cmd->min_rest_time = __cpu_to_le32(arg->min_rest_time);
  2091. cmd->max_rest_time = __cpu_to_le32(arg->max_rest_time);
  2092. cmd->repeat_probe_time = __cpu_to_le32(arg->repeat_probe_time);
  2093. cmd->probe_spacing_time = __cpu_to_le32(arg->probe_spacing_time);
  2094. cmd->idle_time = __cpu_to_le32(arg->idle_time);
  2095. cmd->max_scan_time = __cpu_to_le32(arg->max_scan_time);
  2096. cmd->probe_delay = __cpu_to_le32(arg->probe_delay);
  2097. cmd->scan_ctrl_flags = __cpu_to_le32(arg->scan_ctrl_flags);
  2098. /* TLV list starts after fields included in the struct */
  2099. /* There's just one filed that differes the two start_scan
  2100. * structures - burst_duration, which we are not using btw,
  2101. no point to make the split here, just shift the buffer to fit with
  2102. given FW */
  2103. if (test_bit(ATH10K_FW_FEATURE_WMI_10X, ar->fw_features))
  2104. off = sizeof(struct wmi_start_scan_cmd_10x);
  2105. else
  2106. off = sizeof(struct wmi_start_scan_cmd);
  2107. if (arg->n_channels) {
  2108. channels = (void *)skb->data + off;
  2109. channels->tag = __cpu_to_le32(WMI_CHAN_LIST_TAG);
  2110. channels->num_chan = __cpu_to_le32(arg->n_channels);
  2111. for (i = 0; i < arg->n_channels; i++)
  2112. channels->channel_list[i] =
  2113. __cpu_to_le32(arg->channels[i]);
  2114. off += sizeof(*channels);
  2115. off += sizeof(__le32) * arg->n_channels;
  2116. }
  2117. if (arg->n_ssids) {
  2118. ssids = (void *)skb->data + off;
  2119. ssids->tag = __cpu_to_le32(WMI_SSID_LIST_TAG);
  2120. ssids->num_ssids = __cpu_to_le32(arg->n_ssids);
  2121. for (i = 0; i < arg->n_ssids; i++) {
  2122. ssids->ssids[i].ssid_len =
  2123. __cpu_to_le32(arg->ssids[i].len);
  2124. memcpy(&ssids->ssids[i].ssid,
  2125. arg->ssids[i].ssid,
  2126. arg->ssids[i].len);
  2127. }
  2128. off += sizeof(*ssids);
  2129. off += sizeof(struct wmi_ssid) * arg->n_ssids;
  2130. }
  2131. if (arg->n_bssids) {
  2132. bssids = (void *)skb->data + off;
  2133. bssids->tag = __cpu_to_le32(WMI_BSSID_LIST_TAG);
  2134. bssids->num_bssid = __cpu_to_le32(arg->n_bssids);
  2135. for (i = 0; i < arg->n_bssids; i++)
  2136. memcpy(&bssids->bssid_list[i],
  2137. arg->bssids[i].bssid,
  2138. ETH_ALEN);
  2139. off += sizeof(*bssids);
  2140. off += sizeof(struct wmi_mac_addr) * arg->n_bssids;
  2141. }
  2142. if (arg->ie_len) {
  2143. ie = (void *)skb->data + off;
  2144. ie->tag = __cpu_to_le32(WMI_IE_TAG);
  2145. ie->ie_len = __cpu_to_le32(arg->ie_len);
  2146. memcpy(ie->ie_data, arg->ie, arg->ie_len);
  2147. off += sizeof(*ie);
  2148. off += roundup(arg->ie_len, 4);
  2149. }
  2150. if (off != skb->len) {
  2151. dev_kfree_skb(skb);
  2152. return -EINVAL;
  2153. }
  2154. ath10k_dbg(ATH10K_DBG_WMI, "wmi start scan\n");
  2155. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->start_scan_cmdid);
  2156. }
  2157. void ath10k_wmi_start_scan_init(struct ath10k *ar,
  2158. struct wmi_start_scan_arg *arg)
  2159. {
  2160. /* setup commonly used values */
  2161. arg->scan_req_id = 1;
  2162. arg->scan_priority = WMI_SCAN_PRIORITY_LOW;
  2163. arg->dwell_time_active = 50;
  2164. arg->dwell_time_passive = 150;
  2165. arg->min_rest_time = 50;
  2166. arg->max_rest_time = 500;
  2167. arg->repeat_probe_time = 0;
  2168. arg->probe_spacing_time = 0;
  2169. arg->idle_time = 0;
  2170. arg->max_scan_time = 20000;
  2171. arg->probe_delay = 5;
  2172. arg->notify_scan_events = WMI_SCAN_EVENT_STARTED
  2173. | WMI_SCAN_EVENT_COMPLETED
  2174. | WMI_SCAN_EVENT_BSS_CHANNEL
  2175. | WMI_SCAN_EVENT_FOREIGN_CHANNEL
  2176. | WMI_SCAN_EVENT_DEQUEUED;
  2177. arg->scan_ctrl_flags |= WMI_SCAN_ADD_OFDM_RATES;
  2178. arg->scan_ctrl_flags |= WMI_SCAN_CHAN_STAT_EVENT;
  2179. arg->n_bssids = 1;
  2180. arg->bssids[0].bssid = "\xFF\xFF\xFF\xFF\xFF\xFF";
  2181. }
  2182. int ath10k_wmi_stop_scan(struct ath10k *ar, const struct wmi_stop_scan_arg *arg)
  2183. {
  2184. struct wmi_stop_scan_cmd *cmd;
  2185. struct sk_buff *skb;
  2186. u32 scan_id;
  2187. u32 req_id;
  2188. if (arg->req_id > 0xFFF)
  2189. return -EINVAL;
  2190. if (arg->req_type == WMI_SCAN_STOP_ONE && arg->u.scan_id > 0xFFF)
  2191. return -EINVAL;
  2192. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2193. if (!skb)
  2194. return -ENOMEM;
  2195. scan_id = arg->u.scan_id;
  2196. scan_id |= WMI_HOST_SCAN_REQ_ID_PREFIX;
  2197. req_id = arg->req_id;
  2198. req_id |= WMI_HOST_SCAN_REQUESTOR_ID_PREFIX;
  2199. cmd = (struct wmi_stop_scan_cmd *)skb->data;
  2200. cmd->req_type = __cpu_to_le32(arg->req_type);
  2201. cmd->vdev_id = __cpu_to_le32(arg->u.vdev_id);
  2202. cmd->scan_id = __cpu_to_le32(scan_id);
  2203. cmd->scan_req_id = __cpu_to_le32(req_id);
  2204. ath10k_dbg(ATH10K_DBG_WMI,
  2205. "wmi stop scan reqid %d req_type %d vdev/scan_id %d\n",
  2206. arg->req_id, arg->req_type, arg->u.scan_id);
  2207. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->stop_scan_cmdid);
  2208. }
  2209. int ath10k_wmi_vdev_create(struct ath10k *ar, u32 vdev_id,
  2210. enum wmi_vdev_type type,
  2211. enum wmi_vdev_subtype subtype,
  2212. const u8 macaddr[ETH_ALEN])
  2213. {
  2214. struct wmi_vdev_create_cmd *cmd;
  2215. struct sk_buff *skb;
  2216. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2217. if (!skb)
  2218. return -ENOMEM;
  2219. cmd = (struct wmi_vdev_create_cmd *)skb->data;
  2220. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2221. cmd->vdev_type = __cpu_to_le32(type);
  2222. cmd->vdev_subtype = __cpu_to_le32(subtype);
  2223. memcpy(cmd->vdev_macaddr.addr, macaddr, ETH_ALEN);
  2224. ath10k_dbg(ATH10K_DBG_WMI,
  2225. "WMI vdev create: id %d type %d subtype %d macaddr %pM\n",
  2226. vdev_id, type, subtype, macaddr);
  2227. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_create_cmdid);
  2228. }
  2229. int ath10k_wmi_vdev_delete(struct ath10k *ar, u32 vdev_id)
  2230. {
  2231. struct wmi_vdev_delete_cmd *cmd;
  2232. struct sk_buff *skb;
  2233. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2234. if (!skb)
  2235. return -ENOMEM;
  2236. cmd = (struct wmi_vdev_delete_cmd *)skb->data;
  2237. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2238. ath10k_dbg(ATH10K_DBG_WMI,
  2239. "WMI vdev delete id %d\n", vdev_id);
  2240. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_delete_cmdid);
  2241. }
  2242. static int ath10k_wmi_vdev_start_restart(struct ath10k *ar,
  2243. const struct wmi_vdev_start_request_arg *arg,
  2244. u32 cmd_id)
  2245. {
  2246. struct wmi_vdev_start_request_cmd *cmd;
  2247. struct sk_buff *skb;
  2248. const char *cmdname;
  2249. u32 flags = 0;
  2250. if (cmd_id != ar->wmi.cmd->vdev_start_request_cmdid &&
  2251. cmd_id != ar->wmi.cmd->vdev_restart_request_cmdid)
  2252. return -EINVAL;
  2253. if (WARN_ON(arg->ssid && arg->ssid_len == 0))
  2254. return -EINVAL;
  2255. if (WARN_ON(arg->hidden_ssid && !arg->ssid))
  2256. return -EINVAL;
  2257. if (WARN_ON(arg->ssid_len > sizeof(cmd->ssid.ssid)))
  2258. return -EINVAL;
  2259. if (cmd_id == ar->wmi.cmd->vdev_start_request_cmdid)
  2260. cmdname = "start";
  2261. else if (cmd_id == ar->wmi.cmd->vdev_restart_request_cmdid)
  2262. cmdname = "restart";
  2263. else
  2264. return -EINVAL; /* should not happen, we already check cmd_id */
  2265. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2266. if (!skb)
  2267. return -ENOMEM;
  2268. if (arg->hidden_ssid)
  2269. flags |= WMI_VDEV_START_HIDDEN_SSID;
  2270. if (arg->pmf_enabled)
  2271. flags |= WMI_VDEV_START_PMF_ENABLED;
  2272. cmd = (struct wmi_vdev_start_request_cmd *)skb->data;
  2273. cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
  2274. cmd->disable_hw_ack = __cpu_to_le32(arg->disable_hw_ack);
  2275. cmd->beacon_interval = __cpu_to_le32(arg->bcn_intval);
  2276. cmd->dtim_period = __cpu_to_le32(arg->dtim_period);
  2277. cmd->flags = __cpu_to_le32(flags);
  2278. cmd->bcn_tx_rate = __cpu_to_le32(arg->bcn_tx_rate);
  2279. cmd->bcn_tx_power = __cpu_to_le32(arg->bcn_tx_power);
  2280. if (arg->ssid) {
  2281. cmd->ssid.ssid_len = __cpu_to_le32(arg->ssid_len);
  2282. memcpy(cmd->ssid.ssid, arg->ssid, arg->ssid_len);
  2283. }
  2284. cmd->chan.mhz = __cpu_to_le32(arg->channel.freq);
  2285. cmd->chan.band_center_freq1 =
  2286. __cpu_to_le32(arg->channel.band_center_freq1);
  2287. cmd->chan.mode = arg->channel.mode;
  2288. cmd->chan.min_power = arg->channel.min_power;
  2289. cmd->chan.max_power = arg->channel.max_power;
  2290. cmd->chan.reg_power = arg->channel.max_reg_power;
  2291. cmd->chan.reg_classid = arg->channel.reg_class_id;
  2292. cmd->chan.antenna_max = arg->channel.max_antenna_gain;
  2293. ath10k_dbg(ATH10K_DBG_WMI,
  2294. "wmi vdev %s id 0x%x freq %d, mode %d, ch_flags: 0x%0X,"
  2295. "max_power: %d\n", cmdname, arg->vdev_id, arg->channel.freq,
  2296. arg->channel.mode, flags, arg->channel.max_power);
  2297. return ath10k_wmi_cmd_send(ar, skb, cmd_id);
  2298. }
  2299. int ath10k_wmi_vdev_start(struct ath10k *ar,
  2300. const struct wmi_vdev_start_request_arg *arg)
  2301. {
  2302. u32 cmd_id = ar->wmi.cmd->vdev_start_request_cmdid;
  2303. return ath10k_wmi_vdev_start_restart(ar, arg, cmd_id);
  2304. }
  2305. int ath10k_wmi_vdev_restart(struct ath10k *ar,
  2306. const struct wmi_vdev_start_request_arg *arg)
  2307. {
  2308. u32 cmd_id = ar->wmi.cmd->vdev_restart_request_cmdid;
  2309. return ath10k_wmi_vdev_start_restart(ar, arg, cmd_id);
  2310. }
  2311. int ath10k_wmi_vdev_stop(struct ath10k *ar, u32 vdev_id)
  2312. {
  2313. struct wmi_vdev_stop_cmd *cmd;
  2314. struct sk_buff *skb;
  2315. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2316. if (!skb)
  2317. return -ENOMEM;
  2318. cmd = (struct wmi_vdev_stop_cmd *)skb->data;
  2319. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2320. ath10k_dbg(ATH10K_DBG_WMI, "wmi vdev stop id 0x%x\n", vdev_id);
  2321. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_stop_cmdid);
  2322. }
  2323. int ath10k_wmi_vdev_up(struct ath10k *ar, u32 vdev_id, u32 aid, const u8 *bssid)
  2324. {
  2325. struct wmi_vdev_up_cmd *cmd;
  2326. struct sk_buff *skb;
  2327. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2328. if (!skb)
  2329. return -ENOMEM;
  2330. cmd = (struct wmi_vdev_up_cmd *)skb->data;
  2331. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2332. cmd->vdev_assoc_id = __cpu_to_le32(aid);
  2333. memcpy(&cmd->vdev_bssid.addr, bssid, 6);
  2334. ath10k_dbg(ATH10K_DBG_WMI,
  2335. "wmi mgmt vdev up id 0x%x assoc id %d bssid %pM\n",
  2336. vdev_id, aid, bssid);
  2337. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_up_cmdid);
  2338. }
  2339. int ath10k_wmi_vdev_down(struct ath10k *ar, u32 vdev_id)
  2340. {
  2341. struct wmi_vdev_down_cmd *cmd;
  2342. struct sk_buff *skb;
  2343. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2344. if (!skb)
  2345. return -ENOMEM;
  2346. cmd = (struct wmi_vdev_down_cmd *)skb->data;
  2347. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2348. ath10k_dbg(ATH10K_DBG_WMI,
  2349. "wmi mgmt vdev down id 0x%x\n", vdev_id);
  2350. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_down_cmdid);
  2351. }
  2352. int ath10k_wmi_vdev_set_param(struct ath10k *ar, u32 vdev_id,
  2353. u32 param_id, u32 param_value)
  2354. {
  2355. struct wmi_vdev_set_param_cmd *cmd;
  2356. struct sk_buff *skb;
  2357. if (param_id == WMI_VDEV_PARAM_UNSUPPORTED) {
  2358. ath10k_dbg(ATH10K_DBG_WMI,
  2359. "vdev param %d not supported by firmware\n",
  2360. param_id);
  2361. return -EOPNOTSUPP;
  2362. }
  2363. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2364. if (!skb)
  2365. return -ENOMEM;
  2366. cmd = (struct wmi_vdev_set_param_cmd *)skb->data;
  2367. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2368. cmd->param_id = __cpu_to_le32(param_id);
  2369. cmd->param_value = __cpu_to_le32(param_value);
  2370. ath10k_dbg(ATH10K_DBG_WMI,
  2371. "wmi vdev id 0x%x set param %d value %d\n",
  2372. vdev_id, param_id, param_value);
  2373. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->vdev_set_param_cmdid);
  2374. }
  2375. int ath10k_wmi_vdev_install_key(struct ath10k *ar,
  2376. const struct wmi_vdev_install_key_arg *arg)
  2377. {
  2378. struct wmi_vdev_install_key_cmd *cmd;
  2379. struct sk_buff *skb;
  2380. if (arg->key_cipher == WMI_CIPHER_NONE && arg->key_data != NULL)
  2381. return -EINVAL;
  2382. if (arg->key_cipher != WMI_CIPHER_NONE && arg->key_data == NULL)
  2383. return -EINVAL;
  2384. skb = ath10k_wmi_alloc_skb(sizeof(*cmd) + arg->key_len);
  2385. if (!skb)
  2386. return -ENOMEM;
  2387. cmd = (struct wmi_vdev_install_key_cmd *)skb->data;
  2388. cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
  2389. cmd->key_idx = __cpu_to_le32(arg->key_idx);
  2390. cmd->key_flags = __cpu_to_le32(arg->key_flags);
  2391. cmd->key_cipher = __cpu_to_le32(arg->key_cipher);
  2392. cmd->key_len = __cpu_to_le32(arg->key_len);
  2393. cmd->key_txmic_len = __cpu_to_le32(arg->key_txmic_len);
  2394. cmd->key_rxmic_len = __cpu_to_le32(arg->key_rxmic_len);
  2395. if (arg->macaddr)
  2396. memcpy(cmd->peer_macaddr.addr, arg->macaddr, ETH_ALEN);
  2397. if (arg->key_data)
  2398. memcpy(cmd->key_data, arg->key_data, arg->key_len);
  2399. ath10k_dbg(ATH10K_DBG_WMI,
  2400. "wmi vdev install key idx %d cipher %d len %d\n",
  2401. arg->key_idx, arg->key_cipher, arg->key_len);
  2402. return ath10k_wmi_cmd_send(ar, skb,
  2403. ar->wmi.cmd->vdev_install_key_cmdid);
  2404. }
  2405. int ath10k_wmi_peer_create(struct ath10k *ar, u32 vdev_id,
  2406. const u8 peer_addr[ETH_ALEN])
  2407. {
  2408. struct wmi_peer_create_cmd *cmd;
  2409. struct sk_buff *skb;
  2410. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2411. if (!skb)
  2412. return -ENOMEM;
  2413. cmd = (struct wmi_peer_create_cmd *)skb->data;
  2414. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2415. memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN);
  2416. ath10k_dbg(ATH10K_DBG_WMI,
  2417. "wmi peer create vdev_id %d peer_addr %pM\n",
  2418. vdev_id, peer_addr);
  2419. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_create_cmdid);
  2420. }
  2421. int ath10k_wmi_peer_delete(struct ath10k *ar, u32 vdev_id,
  2422. const u8 peer_addr[ETH_ALEN])
  2423. {
  2424. struct wmi_peer_delete_cmd *cmd;
  2425. struct sk_buff *skb;
  2426. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2427. if (!skb)
  2428. return -ENOMEM;
  2429. cmd = (struct wmi_peer_delete_cmd *)skb->data;
  2430. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2431. memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN);
  2432. ath10k_dbg(ATH10K_DBG_WMI,
  2433. "wmi peer delete vdev_id %d peer_addr %pM\n",
  2434. vdev_id, peer_addr);
  2435. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_delete_cmdid);
  2436. }
  2437. int ath10k_wmi_peer_flush(struct ath10k *ar, u32 vdev_id,
  2438. const u8 peer_addr[ETH_ALEN], u32 tid_bitmap)
  2439. {
  2440. struct wmi_peer_flush_tids_cmd *cmd;
  2441. struct sk_buff *skb;
  2442. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2443. if (!skb)
  2444. return -ENOMEM;
  2445. cmd = (struct wmi_peer_flush_tids_cmd *)skb->data;
  2446. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2447. cmd->peer_tid_bitmap = __cpu_to_le32(tid_bitmap);
  2448. memcpy(cmd->peer_macaddr.addr, peer_addr, ETH_ALEN);
  2449. ath10k_dbg(ATH10K_DBG_WMI,
  2450. "wmi peer flush vdev_id %d peer_addr %pM tids %08x\n",
  2451. vdev_id, peer_addr, tid_bitmap);
  2452. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_flush_tids_cmdid);
  2453. }
  2454. int ath10k_wmi_peer_set_param(struct ath10k *ar, u32 vdev_id,
  2455. const u8 *peer_addr, enum wmi_peer_param param_id,
  2456. u32 param_value)
  2457. {
  2458. struct wmi_peer_set_param_cmd *cmd;
  2459. struct sk_buff *skb;
  2460. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2461. if (!skb)
  2462. return -ENOMEM;
  2463. cmd = (struct wmi_peer_set_param_cmd *)skb->data;
  2464. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2465. cmd->param_id = __cpu_to_le32(param_id);
  2466. cmd->param_value = __cpu_to_le32(param_value);
  2467. memcpy(&cmd->peer_macaddr.addr, peer_addr, 6);
  2468. ath10k_dbg(ATH10K_DBG_WMI,
  2469. "wmi vdev %d peer 0x%pM set param %d value %d\n",
  2470. vdev_id, peer_addr, param_id, param_value);
  2471. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_set_param_cmdid);
  2472. }
  2473. int ath10k_wmi_set_psmode(struct ath10k *ar, u32 vdev_id,
  2474. enum wmi_sta_ps_mode psmode)
  2475. {
  2476. struct wmi_sta_powersave_mode_cmd *cmd;
  2477. struct sk_buff *skb;
  2478. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2479. if (!skb)
  2480. return -ENOMEM;
  2481. cmd = (struct wmi_sta_powersave_mode_cmd *)skb->data;
  2482. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2483. cmd->sta_ps_mode = __cpu_to_le32(psmode);
  2484. ath10k_dbg(ATH10K_DBG_WMI,
  2485. "wmi set powersave id 0x%x mode %d\n",
  2486. vdev_id, psmode);
  2487. return ath10k_wmi_cmd_send(ar, skb,
  2488. ar->wmi.cmd->sta_powersave_mode_cmdid);
  2489. }
  2490. int ath10k_wmi_set_sta_ps_param(struct ath10k *ar, u32 vdev_id,
  2491. enum wmi_sta_powersave_param param_id,
  2492. u32 value)
  2493. {
  2494. struct wmi_sta_powersave_param_cmd *cmd;
  2495. struct sk_buff *skb;
  2496. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2497. if (!skb)
  2498. return -ENOMEM;
  2499. cmd = (struct wmi_sta_powersave_param_cmd *)skb->data;
  2500. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2501. cmd->param_id = __cpu_to_le32(param_id);
  2502. cmd->param_value = __cpu_to_le32(value);
  2503. ath10k_dbg(ATH10K_DBG_WMI,
  2504. "wmi sta ps param vdev_id 0x%x param %d value %d\n",
  2505. vdev_id, param_id, value);
  2506. return ath10k_wmi_cmd_send(ar, skb,
  2507. ar->wmi.cmd->sta_powersave_param_cmdid);
  2508. }
  2509. int ath10k_wmi_set_ap_ps_param(struct ath10k *ar, u32 vdev_id, const u8 *mac,
  2510. enum wmi_ap_ps_peer_param param_id, u32 value)
  2511. {
  2512. struct wmi_ap_ps_peer_cmd *cmd;
  2513. struct sk_buff *skb;
  2514. if (!mac)
  2515. return -EINVAL;
  2516. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2517. if (!skb)
  2518. return -ENOMEM;
  2519. cmd = (struct wmi_ap_ps_peer_cmd *)skb->data;
  2520. cmd->vdev_id = __cpu_to_le32(vdev_id);
  2521. cmd->param_id = __cpu_to_le32(param_id);
  2522. cmd->param_value = __cpu_to_le32(value);
  2523. memcpy(&cmd->peer_macaddr, mac, ETH_ALEN);
  2524. ath10k_dbg(ATH10K_DBG_WMI,
  2525. "wmi ap ps param vdev_id 0x%X param %d value %d mac_addr %pM\n",
  2526. vdev_id, param_id, value, mac);
  2527. return ath10k_wmi_cmd_send(ar, skb,
  2528. ar->wmi.cmd->ap_ps_peer_param_cmdid);
  2529. }
  2530. int ath10k_wmi_scan_chan_list(struct ath10k *ar,
  2531. const struct wmi_scan_chan_list_arg *arg)
  2532. {
  2533. struct wmi_scan_chan_list_cmd *cmd;
  2534. struct sk_buff *skb;
  2535. struct wmi_channel_arg *ch;
  2536. struct wmi_channel *ci;
  2537. int len;
  2538. int i;
  2539. len = sizeof(*cmd) + arg->n_channels * sizeof(struct wmi_channel);
  2540. skb = ath10k_wmi_alloc_skb(len);
  2541. if (!skb)
  2542. return -EINVAL;
  2543. cmd = (struct wmi_scan_chan_list_cmd *)skb->data;
  2544. cmd->num_scan_chans = __cpu_to_le32(arg->n_channels);
  2545. for (i = 0; i < arg->n_channels; i++) {
  2546. u32 flags = 0;
  2547. ch = &arg->channels[i];
  2548. ci = &cmd->chan_info[i];
  2549. if (ch->passive)
  2550. flags |= WMI_CHAN_FLAG_PASSIVE;
  2551. if (ch->allow_ibss)
  2552. flags |= WMI_CHAN_FLAG_ADHOC_ALLOWED;
  2553. if (ch->allow_ht)
  2554. flags |= WMI_CHAN_FLAG_ALLOW_HT;
  2555. if (ch->allow_vht)
  2556. flags |= WMI_CHAN_FLAG_ALLOW_VHT;
  2557. if (ch->ht40plus)
  2558. flags |= WMI_CHAN_FLAG_HT40_PLUS;
  2559. ci->mhz = __cpu_to_le32(ch->freq);
  2560. ci->band_center_freq1 = __cpu_to_le32(ch->freq);
  2561. ci->band_center_freq2 = 0;
  2562. ci->min_power = ch->min_power;
  2563. ci->max_power = ch->max_power;
  2564. ci->reg_power = ch->max_reg_power;
  2565. ci->antenna_max = ch->max_antenna_gain;
  2566. ci->antenna_max = 0;
  2567. /* mode & flags share storage */
  2568. ci->mode = ch->mode;
  2569. ci->flags |= __cpu_to_le32(flags);
  2570. }
  2571. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->scan_chan_list_cmdid);
  2572. }
  2573. int ath10k_wmi_peer_assoc(struct ath10k *ar,
  2574. const struct wmi_peer_assoc_complete_arg *arg)
  2575. {
  2576. struct wmi_peer_assoc_complete_cmd *cmd;
  2577. struct sk_buff *skb;
  2578. if (arg->peer_mpdu_density > 16)
  2579. return -EINVAL;
  2580. if (arg->peer_legacy_rates.num_rates > MAX_SUPPORTED_RATES)
  2581. return -EINVAL;
  2582. if (arg->peer_ht_rates.num_rates > MAX_SUPPORTED_RATES)
  2583. return -EINVAL;
  2584. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2585. if (!skb)
  2586. return -ENOMEM;
  2587. cmd = (struct wmi_peer_assoc_complete_cmd *)skb->data;
  2588. cmd->vdev_id = __cpu_to_le32(arg->vdev_id);
  2589. cmd->peer_new_assoc = __cpu_to_le32(arg->peer_reassoc ? 0 : 1);
  2590. cmd->peer_associd = __cpu_to_le32(arg->peer_aid);
  2591. cmd->peer_flags = __cpu_to_le32(arg->peer_flags);
  2592. cmd->peer_caps = __cpu_to_le32(arg->peer_caps);
  2593. cmd->peer_listen_intval = __cpu_to_le32(arg->peer_listen_intval);
  2594. cmd->peer_ht_caps = __cpu_to_le32(arg->peer_ht_caps);
  2595. cmd->peer_max_mpdu = __cpu_to_le32(arg->peer_max_mpdu);
  2596. cmd->peer_mpdu_density = __cpu_to_le32(arg->peer_mpdu_density);
  2597. cmd->peer_rate_caps = __cpu_to_le32(arg->peer_rate_caps);
  2598. cmd->peer_nss = __cpu_to_le32(arg->peer_num_spatial_streams);
  2599. cmd->peer_vht_caps = __cpu_to_le32(arg->peer_vht_caps);
  2600. cmd->peer_phymode = __cpu_to_le32(arg->peer_phymode);
  2601. memcpy(cmd->peer_macaddr.addr, arg->addr, ETH_ALEN);
  2602. cmd->peer_legacy_rates.num_rates =
  2603. __cpu_to_le32(arg->peer_legacy_rates.num_rates);
  2604. memcpy(cmd->peer_legacy_rates.rates, arg->peer_legacy_rates.rates,
  2605. arg->peer_legacy_rates.num_rates);
  2606. cmd->peer_ht_rates.num_rates =
  2607. __cpu_to_le32(arg->peer_ht_rates.num_rates);
  2608. memcpy(cmd->peer_ht_rates.rates, arg->peer_ht_rates.rates,
  2609. arg->peer_ht_rates.num_rates);
  2610. cmd->peer_vht_rates.rx_max_rate =
  2611. __cpu_to_le32(arg->peer_vht_rates.rx_max_rate);
  2612. cmd->peer_vht_rates.rx_mcs_set =
  2613. __cpu_to_le32(arg->peer_vht_rates.rx_mcs_set);
  2614. cmd->peer_vht_rates.tx_max_rate =
  2615. __cpu_to_le32(arg->peer_vht_rates.tx_max_rate);
  2616. cmd->peer_vht_rates.tx_mcs_set =
  2617. __cpu_to_le32(arg->peer_vht_rates.tx_mcs_set);
  2618. ath10k_dbg(ATH10K_DBG_WMI,
  2619. "wmi peer assoc vdev %d addr %pM\n",
  2620. arg->vdev_id, arg->addr);
  2621. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->peer_assoc_cmdid);
  2622. }
  2623. int ath10k_wmi_beacon_send_nowait(struct ath10k *ar,
  2624. const struct wmi_bcn_tx_arg *arg)
  2625. {
  2626. struct wmi_bcn_tx_cmd *cmd;
  2627. struct sk_buff *skb;
  2628. skb = ath10k_wmi_alloc_skb(sizeof(*cmd) + arg->bcn_len);
  2629. if (!skb)
  2630. return -ENOMEM;
  2631. cmd = (struct wmi_bcn_tx_cmd *)skb->data;
  2632. cmd->hdr.vdev_id = __cpu_to_le32(arg->vdev_id);
  2633. cmd->hdr.tx_rate = __cpu_to_le32(arg->tx_rate);
  2634. cmd->hdr.tx_power = __cpu_to_le32(arg->tx_power);
  2635. cmd->hdr.bcn_len = __cpu_to_le32(arg->bcn_len);
  2636. memcpy(cmd->bcn, arg->bcn, arg->bcn_len);
  2637. return ath10k_wmi_cmd_send_nowait(ar, skb, ar->wmi.cmd->bcn_tx_cmdid);
  2638. }
  2639. static void ath10k_wmi_pdev_set_wmm_param(struct wmi_wmm_params *params,
  2640. const struct wmi_wmm_params_arg *arg)
  2641. {
  2642. params->cwmin = __cpu_to_le32(arg->cwmin);
  2643. params->cwmax = __cpu_to_le32(arg->cwmax);
  2644. params->aifs = __cpu_to_le32(arg->aifs);
  2645. params->txop = __cpu_to_le32(arg->txop);
  2646. params->acm = __cpu_to_le32(arg->acm);
  2647. params->no_ack = __cpu_to_le32(arg->no_ack);
  2648. }
  2649. int ath10k_wmi_pdev_set_wmm_params(struct ath10k *ar,
  2650. const struct wmi_pdev_set_wmm_params_arg *arg)
  2651. {
  2652. struct wmi_pdev_set_wmm_params *cmd;
  2653. struct sk_buff *skb;
  2654. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2655. if (!skb)
  2656. return -ENOMEM;
  2657. cmd = (struct wmi_pdev_set_wmm_params *)skb->data;
  2658. ath10k_wmi_pdev_set_wmm_param(&cmd->ac_be, &arg->ac_be);
  2659. ath10k_wmi_pdev_set_wmm_param(&cmd->ac_bk, &arg->ac_bk);
  2660. ath10k_wmi_pdev_set_wmm_param(&cmd->ac_vi, &arg->ac_vi);
  2661. ath10k_wmi_pdev_set_wmm_param(&cmd->ac_vo, &arg->ac_vo);
  2662. ath10k_dbg(ATH10K_DBG_WMI, "wmi pdev set wmm params\n");
  2663. return ath10k_wmi_cmd_send(ar, skb,
  2664. ar->wmi.cmd->pdev_set_wmm_params_cmdid);
  2665. }
  2666. int ath10k_wmi_request_stats(struct ath10k *ar, enum wmi_stats_id stats_id)
  2667. {
  2668. struct wmi_request_stats_cmd *cmd;
  2669. struct sk_buff *skb;
  2670. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2671. if (!skb)
  2672. return -ENOMEM;
  2673. cmd = (struct wmi_request_stats_cmd *)skb->data;
  2674. cmd->stats_id = __cpu_to_le32(stats_id);
  2675. ath10k_dbg(ATH10K_DBG_WMI, "wmi request stats %d\n", (int)stats_id);
  2676. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->request_stats_cmdid);
  2677. }
  2678. int ath10k_wmi_force_fw_hang(struct ath10k *ar,
  2679. enum wmi_force_fw_hang_type type, u32 delay_ms)
  2680. {
  2681. struct wmi_force_fw_hang_cmd *cmd;
  2682. struct sk_buff *skb;
  2683. skb = ath10k_wmi_alloc_skb(sizeof(*cmd));
  2684. if (!skb)
  2685. return -ENOMEM;
  2686. cmd = (struct wmi_force_fw_hang_cmd *)skb->data;
  2687. cmd->type = __cpu_to_le32(type);
  2688. cmd->delay_ms = __cpu_to_le32(delay_ms);
  2689. ath10k_dbg(ATH10K_DBG_WMI, "wmi force fw hang %d delay %d\n",
  2690. type, delay_ms);
  2691. return ath10k_wmi_cmd_send(ar, skb, ar->wmi.cmd->force_fw_hang_cmdid);
  2692. }