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