2 * Copyright (c) 2013 Eugene Krasnikov <k.eugene.e@gmail.com>
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
14 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19 #include <linux/bitfield.h>
20 #include <linux/etherdevice.h>
21 #include <linux/firmware.h>
22 #include <linux/bitops.h>
23 #include <linux/rpmsg.h>
26 struct wcn36xx_cfg_val {
31 #define WCN36XX_CFG_VAL(id, val) \
33 .cfg_id = WCN36XX_HAL_CFG_ ## id, \
37 static struct wcn36xx_cfg_val wcn36xx_cfg_vals[] = {
38 WCN36XX_CFG_VAL(CURRENT_TX_ANTENNA, 1),
39 WCN36XX_CFG_VAL(CURRENT_RX_ANTENNA, 1),
40 WCN36XX_CFG_VAL(LOW_GAIN_OVERRIDE, 0),
41 WCN36XX_CFG_VAL(POWER_STATE_PER_CHAIN, 785),
42 WCN36XX_CFG_VAL(CAL_PERIOD, 5),
43 WCN36XX_CFG_VAL(CAL_CONTROL, 1),
44 WCN36XX_CFG_VAL(PROXIMITY, 0),
45 WCN36XX_CFG_VAL(NETWORK_DENSITY, 3),
46 WCN36XX_CFG_VAL(MAX_MEDIUM_TIME, 6000),
47 WCN36XX_CFG_VAL(MAX_MPDUS_IN_AMPDU, 64),
48 WCN36XX_CFG_VAL(RTS_THRESHOLD, 2347),
49 WCN36XX_CFG_VAL(SHORT_RETRY_LIMIT, 15),
50 WCN36XX_CFG_VAL(LONG_RETRY_LIMIT, 15),
51 WCN36XX_CFG_VAL(FRAGMENTATION_THRESHOLD, 8000),
52 WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_ZERO, 5),
53 WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_ONE, 10),
54 WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_TWO, 15),
55 WCN36XX_CFG_VAL(FIXED_RATE, 0),
56 WCN36XX_CFG_VAL(RETRYRATE_POLICY, 4),
57 WCN36XX_CFG_VAL(RETRYRATE_SECONDARY, 0),
58 WCN36XX_CFG_VAL(RETRYRATE_TERTIARY, 0),
59 WCN36XX_CFG_VAL(FORCE_POLICY_PROTECTION, 5),
60 WCN36XX_CFG_VAL(FIXED_RATE_MULTICAST_24GHZ, 1),
61 WCN36XX_CFG_VAL(FIXED_RATE_MULTICAST_5GHZ, 5),
62 WCN36XX_CFG_VAL(DEFAULT_RATE_INDEX_5GHZ, 5),
63 WCN36XX_CFG_VAL(MAX_BA_SESSIONS, 40),
64 WCN36XX_CFG_VAL(PS_DATA_INACTIVITY_TIMEOUT, 200),
65 WCN36XX_CFG_VAL(PS_ENABLE_BCN_FILTER, 1),
66 WCN36XX_CFG_VAL(PS_ENABLE_RSSI_MONITOR, 1),
67 WCN36XX_CFG_VAL(NUM_BEACON_PER_RSSI_AVERAGE, 20),
68 WCN36XX_CFG_VAL(STATS_PERIOD, 10),
69 WCN36XX_CFG_VAL(CFP_MAX_DURATION, 30000),
70 WCN36XX_CFG_VAL(FRAME_TRANS_ENABLED, 0),
71 WCN36XX_CFG_VAL(BA_THRESHOLD_HIGH, 128),
72 WCN36XX_CFG_VAL(MAX_BA_BUFFERS, 2560),
73 WCN36XX_CFG_VAL(DYNAMIC_PS_POLL_VALUE, 0),
74 WCN36XX_CFG_VAL(TX_PWR_CTRL_ENABLE, 1),
75 WCN36XX_CFG_VAL(ENABLE_CLOSE_LOOP, 1),
76 WCN36XX_CFG_VAL(ENABLE_LPWR_IMG_TRANSITION, 0),
77 WCN36XX_CFG_VAL(BTC_STATIC_LEN_LE_BT, 120000),
78 WCN36XX_CFG_VAL(BTC_STATIC_LEN_LE_WLAN, 30000),
79 WCN36XX_CFG_VAL(MAX_ASSOC_LIMIT, 10),
80 WCN36XX_CFG_VAL(ENABLE_MCC_ADAPTIVE_SCHEDULER, 0),
81 WCN36XX_CFG_VAL(ENABLE_DYNAMIC_RA_START_RATE, 133), /* MCS 5 */
82 WCN36XX_CFG_VAL(LINK_FAIL_TX_CNT, 1000),
85 static struct wcn36xx_cfg_val wcn3680_cfg_vals[] = {
86 WCN36XX_CFG_VAL(CURRENT_TX_ANTENNA, 1),
87 WCN36XX_CFG_VAL(CURRENT_RX_ANTENNA, 1),
88 WCN36XX_CFG_VAL(LOW_GAIN_OVERRIDE, 0),
89 WCN36XX_CFG_VAL(POWER_STATE_PER_CHAIN, 785),
90 WCN36XX_CFG_VAL(CAL_PERIOD, 5),
91 WCN36XX_CFG_VAL(CAL_CONTROL, 1),
92 WCN36XX_CFG_VAL(PROXIMITY, 0),
93 WCN36XX_CFG_VAL(NETWORK_DENSITY, 3),
94 WCN36XX_CFG_VAL(MAX_MEDIUM_TIME, 4096),
95 WCN36XX_CFG_VAL(MAX_MPDUS_IN_AMPDU, 64),
96 WCN36XX_CFG_VAL(RTS_THRESHOLD, 2347),
97 WCN36XX_CFG_VAL(SHORT_RETRY_LIMIT, 15),
98 WCN36XX_CFG_VAL(LONG_RETRY_LIMIT, 15),
99 WCN36XX_CFG_VAL(FRAGMENTATION_THRESHOLD, 8000),
100 WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_ZERO, 5),
101 WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_ONE, 10),
102 WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_TWO, 15),
103 WCN36XX_CFG_VAL(FIXED_RATE, 0),
104 WCN36XX_CFG_VAL(RETRYRATE_POLICY, 4),
105 WCN36XX_CFG_VAL(RETRYRATE_SECONDARY, 0),
106 WCN36XX_CFG_VAL(RETRYRATE_TERTIARY, 0),
107 WCN36XX_CFG_VAL(FORCE_POLICY_PROTECTION, 5),
108 WCN36XX_CFG_VAL(FIXED_RATE_MULTICAST_24GHZ, 1),
109 WCN36XX_CFG_VAL(FIXED_RATE_MULTICAST_5GHZ, 5),
110 WCN36XX_CFG_VAL(DEFAULT_RATE_INDEX_24GHZ, 1),
111 WCN36XX_CFG_VAL(DEFAULT_RATE_INDEX_5GHZ, 5),
112 WCN36XX_CFG_VAL(MAX_BA_SESSIONS, 40),
113 WCN36XX_CFG_VAL(PS_DATA_INACTIVITY_TIMEOUT, 200),
114 WCN36XX_CFG_VAL(PS_ENABLE_BCN_FILTER, 1),
115 WCN36XX_CFG_VAL(PS_ENABLE_RSSI_MONITOR, 1),
116 WCN36XX_CFG_VAL(NUM_BEACON_PER_RSSI_AVERAGE, 20),
117 WCN36XX_CFG_VAL(STATS_PERIOD, 10),
118 WCN36XX_CFG_VAL(CFP_MAX_DURATION, 30000),
119 WCN36XX_CFG_VAL(FRAME_TRANS_ENABLED, 0),
120 WCN36XX_CFG_VAL(BA_THRESHOLD_HIGH, 128),
121 WCN36XX_CFG_VAL(MAX_BA_BUFFERS, 2560),
122 WCN36XX_CFG_VAL(DYNAMIC_PS_POLL_VALUE, 0),
123 WCN36XX_CFG_VAL(TX_PWR_CTRL_ENABLE, 1),
124 WCN36XX_CFG_VAL(ENABLE_CLOSE_LOOP, 1),
125 WCN36XX_CFG_VAL(ENABLE_LPWR_IMG_TRANSITION, 0),
126 WCN36XX_CFG_VAL(BTC_STATIC_LEN_LE_BT, 120000),
127 WCN36XX_CFG_VAL(BTC_STATIC_LEN_LE_WLAN, 30000),
128 WCN36XX_CFG_VAL(MAX_ASSOC_LIMIT, 10),
129 WCN36XX_CFG_VAL(ENABLE_MCC_ADAPTIVE_SCHEDULER, 0),
130 WCN36XX_CFG_VAL(TDLS_PUAPSD_MASK, 0),
131 WCN36XX_CFG_VAL(TDLS_PUAPSD_BUFFER_STA_CAPABLE, 1),
132 WCN36XX_CFG_VAL(TDLS_PUAPSD_INACTIVITY_TIME, 0),
133 WCN36XX_CFG_VAL(TDLS_PUAPSD_RX_FRAME_THRESHOLD, 10),
134 WCN36XX_CFG_VAL(TDLS_OFF_CHANNEL_CAPABLE, 1),
135 WCN36XX_CFG_VAL(ENABLE_ADAPTIVE_RX_DRAIN, 1),
136 WCN36XX_CFG_VAL(FLEXCONNECT_POWER_FACTOR, 0),
137 WCN36XX_CFG_VAL(ANTENNA_DIVERSITY, 3),
138 WCN36XX_CFG_VAL(ATH_DISABLE, 0),
139 WCN36XX_CFG_VAL(BTC_STATIC_OPP_WLAN_ACTIVE_WLAN_LEN, 60000),
140 WCN36XX_CFG_VAL(BTC_STATIC_OPP_WLAN_ACTIVE_BT_LEN, 90000),
141 WCN36XX_CFG_VAL(BTC_SAP_STATIC_OPP_ACTIVE_WLAN_LEN, 30000),
142 WCN36XX_CFG_VAL(BTC_SAP_STATIC_OPP_ACTIVE_BT_LEN, 30000),
143 WCN36XX_CFG_VAL(ASD_PROBE_INTERVAL, 50),
144 WCN36XX_CFG_VAL(ASD_TRIGGER_THRESHOLD, -60),
145 WCN36XX_CFG_VAL(ASD_RTT_RSSI_HYST_THRESHOLD, 3),
146 WCN36XX_CFG_VAL(BTC_CTS2S_ON_STA_DURING_SCO, 0),
147 WCN36XX_CFG_VAL(RA_FILTER_ENABLE, 0),
148 WCN36XX_CFG_VAL(RA_RATE_LIMIT_INTERVAL, 60),
149 WCN36XX_CFG_VAL(BTC_FATAL_HID_NSNIFF_BLK, 2),
150 WCN36XX_CFG_VAL(BTC_CRITICAL_HID_NSNIFF_BLK, 1),
151 WCN36XX_CFG_VAL(BTC_DYN_A2DP_TX_QUEUE_THOLD, 0),
152 WCN36XX_CFG_VAL(BTC_DYN_OPP_TX_QUEUE_THOLD, 1),
153 WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_SP, 10),
154 WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_RX_CNT, 50),
155 WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_TX_CNT, 50),
156 WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_TX_CNT_MEAS_WINDOW, 500),
157 WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_RX_CNT_MEAS_WINDOW, 500),
158 WCN36XX_CFG_VAL(MAX_PSPOLL_IN_WMM_UAPSD_PS_MODE, 0),
159 WCN36XX_CFG_VAL(MAX_UAPSD_INACTIVITY_INTERVALS, 10),
160 WCN36XX_CFG_VAL(ENABLE_DYNAMIC_WMMPS, 1),
161 WCN36XX_CFG_VAL(BURST_MODE_BE_TXOP_VALUE, 0),
162 WCN36XX_CFG_VAL(ENABLE_DYNAMIC_RA_START_RATE, 136),
163 WCN36XX_CFG_VAL(BTC_FAST_WLAN_CONN_PREF, 1),
164 WCN36XX_CFG_VAL(ENABLE_RTSCTS_HTVHT, 0),
165 WCN36XX_CFG_VAL(BTC_STATIC_OPP_WLAN_IDLE_WLAN_LEN, 30000),
166 WCN36XX_CFG_VAL(BTC_STATIC_OPP_WLAN_IDLE_BT_LEN, 120000),
167 WCN36XX_CFG_VAL(LINK_FAIL_TX_CNT, 1000),
168 WCN36XX_CFG_VAL(TOGGLE_ARP_BDRATES, 0),
169 WCN36XX_CFG_VAL(OPTIMIZE_CA_EVENT, 0),
170 WCN36XX_CFG_VAL(EXT_SCAN_CONC_MODE, 0),
171 WCN36XX_CFG_VAL(BAR_WAKEUP_HOST_DISABLE, 0),
172 WCN36XX_CFG_VAL(SAR_BOFFSET_CORRECTION_ENABLE, 0),
173 WCN36XX_CFG_VAL(BTC_DISABLE_WLAN_LINK_CRITICAL, 5),
174 WCN36XX_CFG_VAL(DISABLE_SCAN_DURING_SCO, 2),
175 WCN36XX_CFG_VAL(CONS_BCNMISS_COUNT, 0),
176 WCN36XX_CFG_VAL(UNITS_OF_BCN_WAIT_TIME, 0),
177 WCN36XX_CFG_VAL(TRIGGER_NULLFRAME_BEFORE_HB, 0),
178 WCN36XX_CFG_VAL(ENABLE_POWERSAVE_OFFLOAD, 0),
181 static int put_cfg_tlv_u32(struct wcn36xx *wcn, size_t *len, u32 id, u32 value)
183 struct wcn36xx_hal_cfg *entry;
186 if (*len + sizeof(*entry) + sizeof(u32) >= WCN36XX_HAL_BUF_SIZE) {
187 wcn36xx_err("Not enough room for TLV entry\n");
191 entry = (struct wcn36xx_hal_cfg *) (wcn->hal_buf + *len);
193 entry->len = sizeof(u32);
194 entry->pad_bytes = 0;
197 val = (u32 *) (entry + 1);
200 *len += sizeof(*entry) + sizeof(u32);
205 static void wcn36xx_smd_set_bss_nw_type(struct wcn36xx *wcn,
206 struct ieee80211_sta *sta,
207 struct wcn36xx_hal_config_bss_params *bss_params)
209 if (NL80211_BAND_5GHZ == WCN36XX_BAND(wcn))
210 bss_params->nw_type = WCN36XX_HAL_11A_NW_TYPE;
211 else if (sta && sta->deflink.ht_cap.ht_supported)
212 bss_params->nw_type = WCN36XX_HAL_11N_NW_TYPE;
213 else if (sta && (sta->deflink.supp_rates[NL80211_BAND_2GHZ] & 0x7f))
214 bss_params->nw_type = WCN36XX_HAL_11G_NW_TYPE;
216 bss_params->nw_type = WCN36XX_HAL_11B_NW_TYPE;
219 static inline u8 is_cap_supported(unsigned long caps, unsigned long flag)
221 return caps & flag ? 1 : 0;
224 static void wcn36xx_smd_set_bss_ht_params(struct ieee80211_vif *vif,
225 struct ieee80211_sta *sta,
226 struct wcn36xx_hal_config_bss_params *bss_params)
228 if (sta && sta->deflink.ht_cap.ht_supported) {
229 unsigned long caps = sta->deflink.ht_cap.cap;
231 bss_params->ht = sta->deflink.ht_cap.ht_supported;
232 bss_params->tx_channel_width_set = is_cap_supported(caps,
233 IEEE80211_HT_CAP_SUP_WIDTH_20_40);
234 bss_params->lsig_tx_op_protection_full_support =
235 is_cap_supported(caps,
236 IEEE80211_HT_CAP_LSIG_TXOP_PROT);
238 bss_params->ht_oper_mode = vif->bss_conf.ht_operation_mode;
239 bss_params->lln_non_gf_coexist =
240 !!(vif->bss_conf.ht_operation_mode &
241 IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT);
242 /* IEEE80211_HT_STBC_PARAM_DUAL_CTS_PROT */
243 bss_params->dual_cts_protection = 0;
244 /* IEEE80211_HT_OP_MODE_PROTECTION_20MHZ */
245 bss_params->ht20_coexist = 0;
250 wcn36xx_smd_set_bss_vht_params(struct ieee80211_vif *vif,
251 struct ieee80211_sta *sta,
252 struct wcn36xx_hal_config_bss_params_v1 *bss)
254 if (sta && sta->deflink.vht_cap.vht_supported)
255 bss->vht_capable = 1;
258 static void wcn36xx_smd_set_sta_ht_params(struct ieee80211_sta *sta,
259 struct wcn36xx_hal_config_sta_params *sta_params)
261 if (sta->deflink.ht_cap.ht_supported) {
262 unsigned long caps = sta->deflink.ht_cap.cap;
264 sta_params->ht_capable = sta->deflink.ht_cap.ht_supported;
265 sta_params->tx_channel_width_set = is_cap_supported(caps,
266 IEEE80211_HT_CAP_SUP_WIDTH_20_40);
267 sta_params->lsig_txop_protection = is_cap_supported(caps,
268 IEEE80211_HT_CAP_LSIG_TXOP_PROT);
270 sta_params->max_ampdu_size = sta->deflink.ht_cap.ampdu_factor;
271 sta_params->max_ampdu_density = sta->deflink.ht_cap.ampdu_density;
272 /* max_amsdu_size: 1 : 3839 bytes, 0 : 7935 bytes (max) */
273 sta_params->max_amsdu_size = !is_cap_supported(caps,
274 IEEE80211_HT_CAP_MAX_AMSDU);
275 sta_params->sgi_20Mhz = is_cap_supported(caps,
276 IEEE80211_HT_CAP_SGI_20);
277 sta_params->sgi_40mhz = is_cap_supported(caps,
278 IEEE80211_HT_CAP_SGI_40);
279 sta_params->green_field_capable = is_cap_supported(caps,
280 IEEE80211_HT_CAP_GRN_FLD);
281 sta_params->delayed_ba_support = is_cap_supported(caps,
282 IEEE80211_HT_CAP_DELAY_BA);
283 sta_params->dsss_cck_mode_40mhz = is_cap_supported(caps,
284 IEEE80211_HT_CAP_DSSSCCK40);
288 static void wcn36xx_smd_set_sta_vht_params(struct wcn36xx *wcn,
289 struct ieee80211_sta *sta,
290 struct wcn36xx_hal_config_sta_params_v1 *sta_params)
292 if (sta->deflink.vht_cap.vht_supported) {
293 unsigned long caps = sta->deflink.vht_cap.cap;
295 sta_params->vht_capable = sta->deflink.vht_cap.vht_supported;
296 sta_params->vht_ldpc_enabled =
297 is_cap_supported(caps, IEEE80211_VHT_CAP_RXLDPC);
298 if (get_feat_caps(wcn->fw_feat_caps, MU_MIMO)) {
299 sta_params->vht_tx_mu_beamformee_capable =
300 is_cap_supported(caps, IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE);
301 if (sta_params->vht_tx_mu_beamformee_capable)
302 sta_params->vht_tx_bf_enabled = 1;
304 sta_params->vht_tx_mu_beamformee_capable = 0;
306 sta_params->vht_tx_channel_width_set = 0;
310 static void wcn36xx_smd_set_sta_ht_ldpc_params(struct ieee80211_sta *sta,
311 struct wcn36xx_hal_config_sta_params_v1 *sta_params)
313 if (sta->deflink.ht_cap.ht_supported) {
314 sta_params->ht_ldpc_enabled =
315 is_cap_supported(sta->deflink.ht_cap.cap,
316 IEEE80211_HT_CAP_LDPC_CODING);
320 static void wcn36xx_smd_set_sta_default_ht_params(
321 struct wcn36xx_hal_config_sta_params *sta_params)
323 sta_params->ht_capable = 1;
324 sta_params->tx_channel_width_set = 1;
325 sta_params->lsig_txop_protection = 1;
326 sta_params->max_ampdu_size = 3;
327 sta_params->max_ampdu_density = 5;
328 sta_params->max_amsdu_size = 0;
329 sta_params->sgi_20Mhz = 1;
330 sta_params->sgi_40mhz = 1;
331 sta_params->green_field_capable = 1;
332 sta_params->delayed_ba_support = 0;
333 sta_params->dsss_cck_mode_40mhz = 1;
336 static void wcn36xx_smd_set_sta_default_vht_params(struct wcn36xx *wcn,
337 struct wcn36xx_hal_config_sta_params_v1 *sta_params)
339 if (wcn->rf_id == RF_IRIS_WCN3680) {
340 sta_params->vht_capable = 1;
341 sta_params->vht_tx_mu_beamformee_capable = 1;
343 sta_params->vht_capable = 0;
344 sta_params->vht_tx_mu_beamformee_capable = 0;
347 sta_params->vht_ldpc_enabled = 0;
348 sta_params->vht_tx_channel_width_set = 0;
349 sta_params->vht_tx_bf_enabled = 0;
352 static void wcn36xx_smd_set_sta_default_ht_ldpc_params(struct wcn36xx *wcn,
353 struct wcn36xx_hal_config_sta_params_v1 *sta_params)
355 if (wcn->rf_id == RF_IRIS_WCN3680)
356 sta_params->ht_ldpc_enabled = 1;
358 sta_params->ht_ldpc_enabled = 0;
361 static void wcn36xx_smd_set_sta_params(struct wcn36xx *wcn,
362 struct ieee80211_vif *vif,
363 struct ieee80211_sta *sta,
364 struct wcn36xx_hal_config_sta_params *sta_params)
366 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
367 struct wcn36xx_sta *sta_priv = NULL;
368 if (vif->type == NL80211_IFTYPE_ADHOC ||
369 vif->type == NL80211_IFTYPE_AP ||
370 vif->type == NL80211_IFTYPE_MESH_POINT) {
371 sta_params->type = 1;
372 sta_params->sta_index = WCN36XX_HAL_STA_INVALID_IDX;
374 sta_params->type = 0;
375 sta_params->sta_index = vif_priv->self_sta_index;
378 sta_params->listen_interval = WCN36XX_LISTEN_INTERVAL(wcn);
381 * In STA mode ieee80211_sta contains bssid and ieee80211_vif
382 * contains our mac address. In AP mode we are bssid so vif
383 * contains bssid and ieee80211_sta contains mac.
385 if (NL80211_IFTYPE_STATION == vif->type)
386 memcpy(&sta_params->mac, vif->addr, ETH_ALEN);
388 memcpy(&sta_params->bssid, vif->addr, ETH_ALEN);
390 sta_params->encrypt_type = vif_priv->encrypt_type;
391 sta_params->short_preamble_supported = true;
393 sta_params->rifs_mode = 0;
395 sta_params->action = 0;
396 sta_params->uapsd = 0;
397 sta_params->mimo_ps = WCN36XX_HAL_HT_MIMO_PS_STATIC;
398 sta_params->max_ampdu_duration = 0;
399 sta_params->bssid_index = vif_priv->bss_index;
403 sta_priv = wcn36xx_sta_to_priv(sta);
404 if (NL80211_IFTYPE_STATION == vif->type)
405 memcpy(&sta_params->bssid, sta->addr, ETH_ALEN);
407 memcpy(&sta_params->mac, sta->addr, ETH_ALEN);
408 sta_params->wmm_enabled = sta->wme;
409 sta_params->max_sp_len = sta->max_sp;
410 sta_params->aid = sta_priv->aid;
411 wcn36xx_smd_set_sta_ht_params(sta, sta_params);
412 memcpy(&sta_params->supported_rates, &sta_priv->supported_rates,
413 sizeof(struct wcn36xx_hal_supported_rates));
415 wcn36xx_set_default_rates((struct wcn36xx_hal_supported_rates *)
416 &sta_params->supported_rates);
417 wcn36xx_smd_set_sta_default_ht_params(sta_params);
421 static int wcn36xx_smd_send_and_wait(struct wcn36xx *wcn, size_t len)
425 struct wcn36xx_hal_msg_header *hdr =
426 (struct wcn36xx_hal_msg_header *)wcn->hal_buf;
427 u16 req_type = hdr->msg_type;
429 wcn36xx_dbg_dump(WCN36XX_DBG_SMD_DUMP, "HAL >>> ", wcn->hal_buf, len);
431 init_completion(&wcn->hal_rsp_compl);
433 ret = rpmsg_send(wcn->smd_channel, wcn->hal_buf, len);
435 wcn36xx_err("HAL TX failed for req %d\n", req_type);
438 if (wait_for_completion_timeout(&wcn->hal_rsp_compl,
439 msecs_to_jiffies(HAL_MSG_TIMEOUT)) <= 0) {
440 wcn36xx_err("Timeout! No SMD response to req %d in %dms\n",
441 req_type, HAL_MSG_TIMEOUT);
445 wcn36xx_dbg(WCN36XX_DBG_SMD,
446 "SMD command (req %d, rsp %d) completed in %dms\n",
447 req_type, hdr->msg_type,
448 jiffies_to_msecs(jiffies - start));
453 #define __INIT_HAL_MSG(msg_body, type, version) \
455 memset(&(msg_body), 0, sizeof(msg_body)); \
456 (msg_body).header.msg_type = type; \
457 (msg_body).header.msg_version = version; \
458 (msg_body).header.len = sizeof(msg_body); \
461 #define INIT_HAL_MSG(msg_body, type) \
462 __INIT_HAL_MSG(msg_body, type, WCN36XX_HAL_MSG_VERSION0)
464 #define INIT_HAL_MSG_V1(msg_body, type) \
465 __INIT_HAL_MSG(msg_body, type, WCN36XX_HAL_MSG_VERSION1)
467 #define INIT_HAL_PTT_MSG(p_msg_body, ppt_msg_len) \
469 memset(p_msg_body, 0, sizeof(*p_msg_body) + ppt_msg_len); \
470 p_msg_body->header.msg_type = WCN36XX_HAL_PROCESS_PTT_REQ; \
471 p_msg_body->header.msg_version = WCN36XX_HAL_MSG_VERSION0; \
472 p_msg_body->header.len = sizeof(*p_msg_body) + ppt_msg_len; \
475 #define PREPARE_HAL_BUF(send_buf, msg_body) \
477 memset(send_buf, 0, msg_body.header.len); \
478 memcpy(send_buf, &msg_body, sizeof(msg_body)); \
481 #define PREPARE_HAL_PTT_MSG_BUF(send_buf, p_msg_body) \
483 memcpy(send_buf, p_msg_body, p_msg_body->header.len); \
486 static int wcn36xx_smd_rsp_status_check(void *buf, size_t len)
488 struct wcn36xx_fw_msg_status_rsp *rsp;
490 if (len < sizeof(struct wcn36xx_hal_msg_header) +
491 sizeof(struct wcn36xx_fw_msg_status_rsp))
494 rsp = (struct wcn36xx_fw_msg_status_rsp *)
495 (buf + sizeof(struct wcn36xx_hal_msg_header));
497 if (WCN36XX_FW_MSG_RESULT_SUCCESS != rsp->status)
503 int wcn36xx_smd_load_nv(struct wcn36xx *wcn)
505 struct nv_data *nv_d;
506 struct wcn36xx_hal_nv_img_download_req_msg msg_body;
512 ret = reject_firmware(&wcn->nv, wcn->nv_file, wcn->dev);
514 wcn36xx_err("Failed to load nv file %s: %d\n",
520 nv_d = (struct nv_data *)wcn->nv->data;
521 INIT_HAL_MSG(msg_body, WCN36XX_HAL_DOWNLOAD_NV_REQ);
523 msg_body.header.len += WCN36XX_NV_FRAGMENT_SIZE;
525 msg_body.frag_number = 0;
526 /* hal_buf must be protected with mutex */
527 mutex_lock(&wcn->hal_mutex);
530 fw_bytes_left = wcn->nv->size - fm_offset - 4;
531 if (fw_bytes_left > WCN36XX_NV_FRAGMENT_SIZE) {
532 msg_body.last_fragment = 0;
533 msg_body.nv_img_buffer_size = WCN36XX_NV_FRAGMENT_SIZE;
535 msg_body.last_fragment = 1;
536 msg_body.nv_img_buffer_size = fw_bytes_left;
538 /* Do not forget update general message len */
539 msg_body.header.len = sizeof(msg_body) + fw_bytes_left;
543 /* Add load NV request message header */
544 memcpy(wcn->hal_buf, &msg_body, sizeof(msg_body));
546 /* Add NV body itself */
547 memcpy(wcn->hal_buf + sizeof(msg_body),
548 &nv_d->table + fm_offset,
549 msg_body.nv_img_buffer_size);
551 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
554 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf,
557 wcn36xx_err("hal_load_nv response failed err=%d\n",
561 msg_body.frag_number++;
562 fm_offset += WCN36XX_NV_FRAGMENT_SIZE;
564 } while (msg_body.last_fragment != 1);
567 mutex_unlock(&wcn->hal_mutex);
571 static int wcn36xx_smd_start_rsp(struct wcn36xx *wcn, void *buf, size_t len)
573 struct wcn36xx_hal_mac_start_rsp_msg *rsp;
575 if (len < sizeof(*rsp))
578 rsp = (struct wcn36xx_hal_mac_start_rsp_msg *)buf;
580 if (WCN36XX_FW_MSG_RESULT_SUCCESS != rsp->start_rsp_params.status)
583 memcpy(wcn->crm_version, rsp->start_rsp_params.crm_version,
584 WCN36XX_HAL_VERSION_LENGTH);
585 memcpy(wcn->wlan_version, rsp->start_rsp_params.wlan_version,
586 WCN36XX_HAL_VERSION_LENGTH);
588 /* null terminate the strings, just in case */
589 wcn->crm_version[WCN36XX_HAL_VERSION_LENGTH] = '\0';
590 wcn->wlan_version[WCN36XX_HAL_VERSION_LENGTH] = '\0';
592 wcn->fw_revision = rsp->start_rsp_params.version.revision;
593 wcn->fw_version = rsp->start_rsp_params.version.version;
594 wcn->fw_minor = rsp->start_rsp_params.version.minor;
595 wcn->fw_major = rsp->start_rsp_params.version.major;
597 if (wcn->first_boot) {
598 wcn->first_boot = false;
599 wcn36xx_info("firmware WLAN version '%s' and CRM version '%s'\n",
600 wcn->wlan_version, wcn->crm_version);
602 wcn36xx_info("firmware API %u.%u.%u.%u, %u stations, %u bssids\n",
603 wcn->fw_major, wcn->fw_minor,
604 wcn->fw_version, wcn->fw_revision,
605 rsp->start_rsp_params.stations,
606 rsp->start_rsp_params.bssids);
611 int wcn36xx_smd_start(struct wcn36xx *wcn)
613 struct wcn36xx_hal_mac_start_req_msg msg_body, *body;
618 static struct wcn36xx_cfg_val *cfg_vals;
620 mutex_lock(&wcn->hal_mutex);
621 INIT_HAL_MSG(msg_body, WCN36XX_HAL_START_REQ);
623 msg_body.params.type = DRIVER_TYPE_PRODUCTION;
624 msg_body.params.len = 0;
626 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
628 body = (struct wcn36xx_hal_mac_start_req_msg *)wcn->hal_buf;
629 len = body->header.len;
631 if (wcn->rf_id == RF_IRIS_WCN3680) {
632 cfg_vals = wcn3680_cfg_vals;
633 cfg_elements = ARRAY_SIZE(wcn3680_cfg_vals);
635 cfg_vals = wcn36xx_cfg_vals;
636 cfg_elements = ARRAY_SIZE(wcn36xx_cfg_vals);
639 for (i = 0; i < cfg_elements; i++) {
640 ret = put_cfg_tlv_u32(wcn, &len, cfg_vals[i].cfg_id,
645 body->header.len = len;
646 body->params.len = len - sizeof(*body);
648 wcn36xx_dbg(WCN36XX_DBG_HAL, "hal start type %d\n",
649 msg_body.params.type);
651 ret = wcn36xx_smd_send_and_wait(wcn, body->header.len);
653 wcn36xx_err("Sending hal_start failed\n");
657 ret = wcn36xx_smd_start_rsp(wcn, wcn->hal_buf, wcn->hal_rsp_len);
659 wcn36xx_err("hal_start response failed err=%d\n", ret);
664 mutex_unlock(&wcn->hal_mutex);
668 int wcn36xx_smd_stop(struct wcn36xx *wcn)
670 struct wcn36xx_hal_mac_stop_req_msg msg_body;
673 mutex_lock(&wcn->hal_mutex);
674 INIT_HAL_MSG(msg_body, WCN36XX_HAL_STOP_REQ);
676 msg_body.stop_req_params.reason = HAL_STOP_TYPE_RF_KILL;
678 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
680 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
682 wcn36xx_err("Sending hal_stop failed\n");
685 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
687 wcn36xx_err("hal_stop response failed err=%d\n", ret);
691 mutex_unlock(&wcn->hal_mutex);
695 int wcn36xx_smd_init_scan(struct wcn36xx *wcn, enum wcn36xx_hal_sys_mode mode,
696 struct ieee80211_vif *vif)
698 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
699 struct wcn36xx_hal_init_scan_req_msg msg_body;
702 mutex_lock(&wcn->hal_mutex);
703 INIT_HAL_MSG(msg_body, WCN36XX_HAL_INIT_SCAN_REQ);
705 msg_body.mode = mode;
706 if (vif_priv->bss_index != WCN36XX_HAL_BSS_INVALID_IDX) {
707 /* Notify BSSID with null DATA packet */
708 msg_body.frame_type = 2;
710 msg_body.scan_entry.bss_index[0] = vif_priv->bss_index;
711 msg_body.scan_entry.active_bss_count = 1;
714 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
716 wcn36xx_dbg(WCN36XX_DBG_HAL, "hal init scan mode %d\n", msg_body.mode);
718 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
720 wcn36xx_err("Sending hal_init_scan failed\n");
723 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
725 wcn36xx_err("hal_init_scan response failed err=%d\n", ret);
728 wcn->sw_scan_init = true;
730 mutex_unlock(&wcn->hal_mutex);
734 int wcn36xx_smd_start_scan(struct wcn36xx *wcn, u8 scan_channel)
736 struct wcn36xx_hal_start_scan_req_msg msg_body;
739 mutex_lock(&wcn->hal_mutex);
740 INIT_HAL_MSG(msg_body, WCN36XX_HAL_START_SCAN_REQ);
742 msg_body.scan_channel = scan_channel;
744 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
746 wcn36xx_dbg(WCN36XX_DBG_HAL, "hal start scan channel %d\n",
747 msg_body.scan_channel);
749 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
751 wcn36xx_err("Sending hal_start_scan failed\n");
754 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
756 wcn36xx_err("hal_start_scan response failed err=%d\n", ret);
759 wcn->sw_scan_channel = scan_channel;
761 mutex_unlock(&wcn->hal_mutex);
765 int wcn36xx_smd_end_scan(struct wcn36xx *wcn, u8 scan_channel)
767 struct wcn36xx_hal_end_scan_req_msg msg_body;
770 mutex_lock(&wcn->hal_mutex);
771 INIT_HAL_MSG(msg_body, WCN36XX_HAL_END_SCAN_REQ);
773 msg_body.scan_channel = scan_channel;
775 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
777 wcn36xx_dbg(WCN36XX_DBG_HAL, "hal end scan channel %d\n",
778 msg_body.scan_channel);
780 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
782 wcn36xx_err("Sending hal_end_scan failed\n");
785 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
787 wcn36xx_err("hal_end_scan response failed err=%d\n", ret);
790 wcn->sw_scan_channel = 0;
792 mutex_unlock(&wcn->hal_mutex);
796 int wcn36xx_smd_finish_scan(struct wcn36xx *wcn,
797 enum wcn36xx_hal_sys_mode mode,
798 struct ieee80211_vif *vif)
800 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
801 struct wcn36xx_hal_finish_scan_req_msg msg_body;
804 mutex_lock(&wcn->hal_mutex);
805 INIT_HAL_MSG(msg_body, WCN36XX_HAL_FINISH_SCAN_REQ);
807 msg_body.mode = mode;
808 msg_body.oper_channel = WCN36XX_HW_CHANNEL(wcn);
809 if (vif_priv->bss_index != WCN36XX_HAL_BSS_INVALID_IDX) {
810 /* Notify BSSID with null data packet */
812 msg_body.frame_type = 2;
813 msg_body.scan_entry.bss_index[0] = vif_priv->bss_index;
814 msg_body.scan_entry.active_bss_count = 1;
817 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
819 wcn36xx_dbg(WCN36XX_DBG_HAL, "hal finish scan mode %d\n",
822 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
824 wcn36xx_err("Sending hal_finish_scan failed\n");
827 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
829 wcn36xx_err("hal_finish_scan response failed err=%d\n", ret);
832 wcn->sw_scan_init = false;
834 mutex_unlock(&wcn->hal_mutex);
838 int wcn36xx_smd_start_hw_scan(struct wcn36xx *wcn, struct ieee80211_vif *vif,
839 struct cfg80211_scan_request *req)
841 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
842 struct wcn36xx_hal_start_scan_offload_req_msg *msg_body;
845 if (req->ie_len > WCN36XX_MAX_SCAN_IE_LEN)
848 mutex_lock(&wcn->hal_mutex);
849 msg_body = kzalloc(sizeof(*msg_body), GFP_KERNEL);
855 INIT_HAL_MSG((*msg_body), WCN36XX_HAL_START_SCAN_OFFLOAD_REQ);
857 msg_body->scan_type = WCN36XX_HAL_SCAN_TYPE_ACTIVE;
858 msg_body->min_ch_time = 30;
859 msg_body->max_ch_time = 100;
860 msg_body->scan_hidden = 1;
861 memcpy(msg_body->mac, vif->addr, ETH_ALEN);
862 msg_body->bss_type = vif_priv->bss_type;
863 msg_body->p2p_search = vif->p2p;
865 msg_body->num_ssid = min_t(u8, req->n_ssids, ARRAY_SIZE(msg_body->ssids));
866 for (i = 0; i < msg_body->num_ssid; i++) {
867 msg_body->ssids[i].length = min_t(u8, req->ssids[i].ssid_len,
868 sizeof(msg_body->ssids[i].ssid));
869 memcpy(msg_body->ssids[i].ssid, req->ssids[i].ssid,
870 msg_body->ssids[i].length);
873 msg_body->num_channel = min_t(u8, req->n_channels,
874 sizeof(msg_body->channels));
875 for (i = 0; i < msg_body->num_channel; i++) {
876 msg_body->channels[i] =
877 HW_VALUE_CHANNEL(req->channels[i]->hw_value);
880 msg_body->header.len -= WCN36XX_MAX_SCAN_IE_LEN;
882 if (req->ie_len > 0) {
883 msg_body->ie_len = req->ie_len;
884 msg_body->header.len += req->ie_len;
885 memcpy(msg_body->ie, req->ie, req->ie_len);
888 PREPARE_HAL_BUF(wcn->hal_buf, (*msg_body));
890 wcn36xx_dbg(WCN36XX_DBG_HAL,
891 "hal start hw-scan (channels: %u; ssids: %u; p2p: %s)\n",
892 msg_body->num_channel, msg_body->num_ssid,
893 msg_body->p2p_search ? "yes" : "no");
895 ret = wcn36xx_smd_send_and_wait(wcn, msg_body->header.len);
897 wcn36xx_err("Sending hal_start_scan_offload failed\n");
900 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
902 wcn36xx_err("hal_start_scan_offload response failed err=%d\n",
908 mutex_unlock(&wcn->hal_mutex);
912 int wcn36xx_smd_stop_hw_scan(struct wcn36xx *wcn)
914 struct wcn36xx_hal_stop_scan_offload_req_msg msg_body;
917 mutex_lock(&wcn->hal_mutex);
918 INIT_HAL_MSG(msg_body, WCN36XX_HAL_STOP_SCAN_OFFLOAD_REQ);
919 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
921 wcn36xx_dbg(WCN36XX_DBG_HAL, "hal stop hw-scan\n");
923 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
925 wcn36xx_err("Sending hal_stop_scan_offload failed\n");
928 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
930 wcn36xx_err("hal_stop_scan_offload response failed err=%d\n",
935 mutex_unlock(&wcn->hal_mutex);
939 int wcn36xx_smd_update_channel_list(struct wcn36xx *wcn, struct cfg80211_scan_request *req)
941 struct wcn36xx_hal_update_channel_list_req_msg *msg_body;
944 msg_body = kzalloc(sizeof(*msg_body), GFP_KERNEL);
948 INIT_HAL_MSG((*msg_body), WCN36XX_HAL_UPDATE_CHANNEL_LIST_REQ);
950 msg_body->num_channel = min_t(u8, req->n_channels, ARRAY_SIZE(msg_body->channels));
951 for (i = 0; i < msg_body->num_channel; i++) {
952 struct wcn36xx_hal_channel_param *param = &msg_body->channels[i];
953 u32 min_power = WCN36XX_HAL_DEFAULT_MIN_POWER;
954 u32 ant_gain = WCN36XX_HAL_DEFAULT_ANT_GAIN;
956 param->mhz = req->channels[i]->center_freq;
957 param->band_center_freq1 = req->channels[i]->center_freq;
958 param->band_center_freq2 = 0;
960 if (req->channels[i]->flags & IEEE80211_CHAN_NO_IR)
961 param->channel_info |= WCN36XX_HAL_CHAN_INFO_FLAG_PASSIVE;
963 if (req->channels[i]->flags & IEEE80211_CHAN_RADAR)
964 param->channel_info |= WCN36XX_HAL_CHAN_INFO_FLAG_DFS;
966 if (req->channels[i]->band == NL80211_BAND_5GHZ) {
967 param->channel_info |= WCN36XX_HAL_CHAN_INFO_FLAG_HT;
968 param->channel_info |= WCN36XX_HAL_CHAN_INFO_FLAG_VHT;
969 param->channel_info |= WCN36XX_HAL_CHAN_INFO_PHY_11A;
971 param->channel_info |= WCN36XX_HAL_CHAN_INFO_PHY_11BG;
974 if (min_power > req->channels[i]->max_power)
975 min_power = req->channels[i]->max_power;
977 if (req->channels[i]->max_antenna_gain)
978 ant_gain = req->channels[i]->max_antenna_gain;
980 u32p_replace_bits(¶m->reg_info_1, min_power,
981 WCN36XX_HAL_CHAN_REG1_MIN_PWR_MASK);
982 u32p_replace_bits(¶m->reg_info_1, req->channels[i]->max_power,
983 WCN36XX_HAL_CHAN_REG1_MAX_PWR_MASK);
984 u32p_replace_bits(¶m->reg_info_1, req->channels[i]->max_reg_power,
985 WCN36XX_HAL_CHAN_REG1_REG_PWR_MASK);
986 u32p_replace_bits(¶m->reg_info_1, 0,
987 WCN36XX_HAL_CHAN_REG1_CLASS_ID_MASK);
988 u32p_replace_bits(¶m->reg_info_2, ant_gain,
989 WCN36XX_HAL_CHAN_REG2_ANT_GAIN_MASK);
991 wcn36xx_dbg(WCN36XX_DBG_HAL,
992 "%s: freq=%u, channel_info=%08x, reg_info1=%08x, reg_info2=%08x\n",
993 __func__, param->mhz, param->channel_info, param->reg_info_1,
997 mutex_lock(&wcn->hal_mutex);
999 PREPARE_HAL_BUF(wcn->hal_buf, (*msg_body));
1001 ret = wcn36xx_smd_send_and_wait(wcn, msg_body->header.len);
1003 wcn36xx_err("Sending hal_update_channel_list failed\n");
1007 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
1009 wcn36xx_err("hal_update_channel_list response failed err=%d\n", ret);
1015 mutex_unlock(&wcn->hal_mutex);
1019 static int wcn36xx_smd_switch_channel_rsp(void *buf, size_t len)
1021 struct wcn36xx_hal_switch_channel_rsp_msg *rsp;
1024 ret = wcn36xx_smd_rsp_status_check(buf, len);
1027 rsp = (struct wcn36xx_hal_switch_channel_rsp_msg *)buf;
1028 wcn36xx_dbg(WCN36XX_DBG_HAL, "channel switched to: %d, status: %d\n",
1029 rsp->channel_number, rsp->status);
1033 int wcn36xx_smd_switch_channel(struct wcn36xx *wcn,
1034 struct ieee80211_vif *vif, int ch)
1036 struct wcn36xx_hal_switch_channel_req_msg msg_body;
1039 mutex_lock(&wcn->hal_mutex);
1040 INIT_HAL_MSG(msg_body, WCN36XX_HAL_CH_SWITCH_REQ);
1042 msg_body.channel_number = (u8)ch;
1043 msg_body.tx_mgmt_power = 0xbf;
1044 msg_body.max_tx_power = 0xbf;
1045 memcpy(msg_body.self_sta_mac_addr, vif->addr, ETH_ALEN);
1047 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1049 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1051 wcn36xx_err("Sending hal_switch_channel failed\n");
1054 ret = wcn36xx_smd_switch_channel_rsp(wcn->hal_buf, wcn->hal_rsp_len);
1056 wcn36xx_err("hal_switch_channel response failed err=%d\n", ret);
1060 mutex_unlock(&wcn->hal_mutex);
1064 static int wcn36xx_smd_process_ptt_msg_rsp(void *buf, size_t len,
1065 void **p_ptt_rsp_msg)
1067 struct wcn36xx_hal_process_ptt_msg_rsp_msg *rsp;
1070 ret = wcn36xx_smd_rsp_status_check(buf, len);
1074 rsp = (struct wcn36xx_hal_process_ptt_msg_rsp_msg *)buf;
1076 wcn36xx_dbg(WCN36XX_DBG_HAL, "process ptt msg responded with length %d\n",
1078 wcn36xx_dbg_dump(WCN36XX_DBG_HAL_DUMP, "HAL_PTT_MSG_RSP:", rsp->ptt_msg,
1079 rsp->header.len - sizeof(rsp->ptt_msg_resp_status));
1081 if (rsp->header.len > 0) {
1082 *p_ptt_rsp_msg = kmemdup(rsp->ptt_msg, rsp->header.len,
1084 if (!*p_ptt_rsp_msg)
1090 int wcn36xx_smd_process_ptt_msg(struct wcn36xx *wcn,
1091 struct ieee80211_vif *vif, void *ptt_msg, size_t len,
1094 struct wcn36xx_hal_process_ptt_msg_req_msg *p_msg_body;
1097 mutex_lock(&wcn->hal_mutex);
1098 p_msg_body = kmalloc(
1099 sizeof(struct wcn36xx_hal_process_ptt_msg_req_msg) + len,
1105 INIT_HAL_PTT_MSG(p_msg_body, len);
1107 memcpy(&p_msg_body->ptt_msg, ptt_msg, len);
1109 PREPARE_HAL_PTT_MSG_BUF(wcn->hal_buf, p_msg_body);
1111 ret = wcn36xx_smd_send_and_wait(wcn, p_msg_body->header.len);
1113 wcn36xx_err("Sending hal_process_ptt_msg failed\n");
1116 ret = wcn36xx_smd_process_ptt_msg_rsp(wcn->hal_buf, wcn->hal_rsp_len,
1119 wcn36xx_err("process_ptt_msg response failed err=%d\n", ret);
1125 mutex_unlock(&wcn->hal_mutex);
1129 static int wcn36xx_smd_update_scan_params_rsp(void *buf, size_t len)
1131 struct wcn36xx_hal_update_scan_params_resp *rsp;
1133 rsp = (struct wcn36xx_hal_update_scan_params_resp *)buf;
1135 /* Remove the PNO version bit */
1136 rsp->status &= (~(WCN36XX_FW_MSG_PNO_VERSION_MASK));
1138 if (WCN36XX_FW_MSG_RESULT_SUCCESS != rsp->status) {
1139 wcn36xx_warn("error response from update scan\n");
1146 int wcn36xx_smd_update_scan_params(struct wcn36xx *wcn,
1147 u8 *channels, size_t channel_count)
1149 struct wcn36xx_hal_update_scan_params_req_ex msg_body;
1152 mutex_lock(&wcn->hal_mutex);
1153 INIT_HAL_MSG(msg_body, WCN36XX_HAL_UPDATE_SCAN_PARAM_REQ);
1155 msg_body.dot11d_enabled = false;
1156 msg_body.dot11d_resolved = true;
1158 msg_body.channel_count = channel_count;
1159 memcpy(msg_body.channels, channels, channel_count);
1160 msg_body.active_min_ch_time = 60;
1161 msg_body.active_max_ch_time = 120;
1162 msg_body.passive_min_ch_time = 60;
1163 msg_body.passive_max_ch_time = 110;
1164 msg_body.state = PHY_SINGLE_CHANNEL_CENTERED;
1166 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1168 wcn36xx_dbg(WCN36XX_DBG_HAL,
1169 "hal update scan params channel_count %d\n",
1170 msg_body.channel_count);
1172 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1174 wcn36xx_err("Sending hal_update_scan_params failed\n");
1177 ret = wcn36xx_smd_update_scan_params_rsp(wcn->hal_buf,
1180 wcn36xx_err("hal_update_scan_params response failed err=%d\n",
1185 mutex_unlock(&wcn->hal_mutex);
1189 static int wcn36xx_smd_add_sta_self_rsp(struct wcn36xx *wcn,
1190 struct ieee80211_vif *vif,
1194 struct wcn36xx_hal_add_sta_self_rsp_msg *rsp;
1195 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
1197 if (len < sizeof(*rsp))
1200 rsp = (struct wcn36xx_hal_add_sta_self_rsp_msg *)buf;
1202 if (rsp->status != WCN36XX_FW_MSG_RESULT_SUCCESS) {
1203 wcn36xx_warn("hal add sta self failure: %d\n",
1208 wcn36xx_dbg(WCN36XX_DBG_HAL,
1209 "hal add sta self status %d self_sta_index %d dpu_index %d\n",
1210 rsp->status, rsp->self_sta_index, rsp->dpu_index);
1212 vif_priv->self_sta_index = rsp->self_sta_index;
1213 vif_priv->self_dpu_desc_index = rsp->dpu_index;
1218 int wcn36xx_smd_add_sta_self(struct wcn36xx *wcn, struct ieee80211_vif *vif)
1220 struct wcn36xx_hal_add_sta_self_req msg_body;
1223 mutex_lock(&wcn->hal_mutex);
1224 INIT_HAL_MSG(msg_body, WCN36XX_HAL_ADD_STA_SELF_REQ);
1226 memcpy(&msg_body.self_addr, vif->addr, ETH_ALEN);
1228 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1230 wcn36xx_dbg(WCN36XX_DBG_HAL,
1231 "hal add sta self self_addr %pM status %d\n",
1232 msg_body.self_addr, msg_body.status);
1234 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1236 wcn36xx_err("Sending hal_add_sta_self failed\n");
1239 ret = wcn36xx_smd_add_sta_self_rsp(wcn,
1244 wcn36xx_err("hal_add_sta_self response failed err=%d\n", ret);
1248 mutex_unlock(&wcn->hal_mutex);
1252 int wcn36xx_smd_delete_sta_self(struct wcn36xx *wcn, u8 *addr)
1254 struct wcn36xx_hal_del_sta_self_req_msg msg_body;
1257 mutex_lock(&wcn->hal_mutex);
1258 INIT_HAL_MSG(msg_body, WCN36XX_HAL_DEL_STA_SELF_REQ);
1260 memcpy(&msg_body.self_addr, addr, ETH_ALEN);
1262 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1264 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1266 wcn36xx_err("Sending hal_delete_sta_self failed\n");
1269 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
1271 wcn36xx_err("hal_delete_sta_self response failed err=%d\n",
1276 mutex_unlock(&wcn->hal_mutex);
1280 int wcn36xx_smd_delete_sta(struct wcn36xx *wcn, u8 sta_index)
1282 struct wcn36xx_hal_delete_sta_req_msg msg_body;
1285 mutex_lock(&wcn->hal_mutex);
1286 INIT_HAL_MSG(msg_body, WCN36XX_HAL_DELETE_STA_REQ);
1288 msg_body.sta_index = sta_index;
1290 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1292 wcn36xx_dbg(WCN36XX_DBG_HAL,
1293 "hal delete sta sta_index %d\n",
1294 msg_body.sta_index);
1296 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1298 wcn36xx_err("Sending hal_delete_sta failed\n");
1301 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
1303 wcn36xx_err("hal_delete_sta response failed err=%d\n", ret);
1307 mutex_unlock(&wcn->hal_mutex);
1311 static int wcn36xx_smd_join_rsp(void *buf, size_t len)
1313 struct wcn36xx_hal_join_rsp_msg *rsp;
1315 if (wcn36xx_smd_rsp_status_check(buf, len))
1318 rsp = (struct wcn36xx_hal_join_rsp_msg *)buf;
1320 wcn36xx_dbg(WCN36XX_DBG_HAL,
1321 "hal rsp join status %d tx_mgmt_power %d\n",
1322 rsp->status, rsp->tx_mgmt_power);
1327 int wcn36xx_smd_join(struct wcn36xx *wcn, const u8 *bssid, u8 *vif, u8 ch)
1329 struct wcn36xx_hal_join_req_msg msg_body;
1332 mutex_lock(&wcn->hal_mutex);
1333 INIT_HAL_MSG(msg_body, WCN36XX_HAL_JOIN_REQ);
1335 memcpy(&msg_body.bssid, bssid, ETH_ALEN);
1336 memcpy(&msg_body.self_sta_mac_addr, vif, ETH_ALEN);
1337 msg_body.channel = ch;
1339 if (conf_is_ht40_minus(&wcn->hw->conf))
1340 msg_body.secondary_channel_offset =
1341 PHY_DOUBLE_CHANNEL_HIGH_PRIMARY;
1342 else if (conf_is_ht40_plus(&wcn->hw->conf))
1343 msg_body.secondary_channel_offset =
1344 PHY_DOUBLE_CHANNEL_LOW_PRIMARY;
1346 msg_body.secondary_channel_offset =
1347 PHY_SINGLE_CHANNEL_CENTERED;
1349 msg_body.link_state = WCN36XX_HAL_LINK_PREASSOC_STATE;
1351 msg_body.max_tx_power = 0xbf;
1352 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1354 wcn36xx_dbg(WCN36XX_DBG_HAL,
1355 "hal join req bssid %pM self_sta_mac_addr %pM channel %d link_state %d\n",
1356 msg_body.bssid, msg_body.self_sta_mac_addr,
1357 msg_body.channel, msg_body.link_state);
1359 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1361 wcn36xx_err("Sending hal_join failed\n");
1364 ret = wcn36xx_smd_join_rsp(wcn->hal_buf, wcn->hal_rsp_len);
1366 wcn36xx_err("hal_join response failed err=%d\n", ret);
1370 mutex_unlock(&wcn->hal_mutex);
1374 int wcn36xx_smd_set_link_st(struct wcn36xx *wcn, const u8 *bssid,
1376 enum wcn36xx_hal_link_state state)
1378 struct wcn36xx_hal_set_link_state_req_msg msg_body;
1381 mutex_lock(&wcn->hal_mutex);
1382 INIT_HAL_MSG(msg_body, WCN36XX_HAL_SET_LINK_ST_REQ);
1384 memcpy(&msg_body.bssid, bssid, ETH_ALEN);
1385 memcpy(&msg_body.self_mac_addr, sta_mac, ETH_ALEN);
1386 msg_body.state = state;
1388 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1390 wcn36xx_dbg(WCN36XX_DBG_HAL,
1391 "hal set link state bssid %pM self_mac_addr %pM state %d\n",
1392 msg_body.bssid, msg_body.self_mac_addr, msg_body.state);
1394 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1396 wcn36xx_err("Sending hal_set_link_st failed\n");
1399 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
1401 wcn36xx_err("hal_set_link_st response failed err=%d\n", ret);
1405 mutex_unlock(&wcn->hal_mutex);
1409 static void wcn36xx_smd_convert_sta_to_v1(struct wcn36xx *wcn,
1410 const struct wcn36xx_hal_config_sta_params *orig,
1411 struct wcn36xx_hal_config_sta_params_v1 *v1)
1413 /* convert orig to v1 format */
1414 memcpy(&v1->bssid, orig->bssid, ETH_ALEN);
1415 memcpy(&v1->mac, orig->mac, ETH_ALEN);
1416 v1->aid = orig->aid;
1417 v1->type = orig->type;
1418 v1->short_preamble_supported = orig->short_preamble_supported;
1419 v1->listen_interval = orig->listen_interval;
1420 v1->wmm_enabled = orig->wmm_enabled;
1421 v1->ht_capable = orig->ht_capable;
1422 v1->tx_channel_width_set = orig->tx_channel_width_set;
1423 v1->rifs_mode = orig->rifs_mode;
1424 v1->lsig_txop_protection = orig->lsig_txop_protection;
1425 v1->max_ampdu_size = orig->max_ampdu_size;
1426 v1->max_ampdu_density = orig->max_ampdu_density;
1427 v1->sgi_40mhz = orig->sgi_40mhz;
1428 v1->sgi_20Mhz = orig->sgi_20Mhz;
1429 v1->rmf = orig->rmf;
1430 v1->encrypt_type = orig->encrypt_type;
1431 v1->action = orig->action;
1432 v1->uapsd = orig->uapsd;
1433 v1->max_sp_len = orig->max_sp_len;
1434 v1->green_field_capable = orig->green_field_capable;
1435 v1->mimo_ps = orig->mimo_ps;
1436 v1->delayed_ba_support = orig->delayed_ba_support;
1437 v1->max_ampdu_duration = orig->max_ampdu_duration;
1438 v1->dsss_cck_mode_40mhz = orig->dsss_cck_mode_40mhz;
1439 memcpy(&v1->supported_rates, &orig->supported_rates,
1440 sizeof(orig->supported_rates));
1441 v1->sta_index = orig->sta_index;
1442 v1->bssid_index = orig->bssid_index;
1443 v1->p2p = orig->p2p;
1447 wcn36xx_smd_set_sta_params_v1(struct wcn36xx *wcn,
1448 struct ieee80211_vif *vif,
1449 struct ieee80211_sta *sta,
1450 struct wcn36xx_hal_config_sta_params_v1 *sta_par)
1452 struct wcn36xx_sta *sta_priv = NULL;
1453 struct wcn36xx_hal_config_sta_params sta_par_v0;
1455 wcn36xx_smd_set_sta_params(wcn, vif, sta, &sta_par_v0);
1456 wcn36xx_smd_convert_sta_to_v1(wcn, &sta_par_v0, sta_par);
1459 sta_priv = wcn36xx_sta_to_priv(sta);
1460 wcn36xx_smd_set_sta_vht_params(wcn, sta, sta_par);
1461 wcn36xx_smd_set_sta_ht_ldpc_params(sta, sta_par);
1462 memcpy(&sta_par->supported_rates, &sta_priv->supported_rates,
1463 sizeof(sta_par->supported_rates));
1465 wcn36xx_set_default_rates_v1(&sta_par->supported_rates);
1466 wcn36xx_smd_set_sta_default_vht_params(wcn, sta_par);
1467 wcn36xx_smd_set_sta_default_ht_ldpc_params(wcn, sta_par);
1471 static int wcn36xx_smd_config_sta_rsp(struct wcn36xx *wcn,
1472 struct ieee80211_sta *sta,
1476 struct wcn36xx_hal_config_sta_rsp_msg *rsp;
1477 struct config_sta_rsp_params *params;
1478 struct wcn36xx_sta *sta_priv = wcn36xx_sta_to_priv(sta);
1480 if (len < sizeof(*rsp))
1483 rsp = (struct wcn36xx_hal_config_sta_rsp_msg *)buf;
1484 params = &rsp->params;
1486 if (params->status != WCN36XX_FW_MSG_RESULT_SUCCESS) {
1487 wcn36xx_warn("hal config sta response failure: %d\n",
1492 sta_priv->sta_index = params->sta_index;
1493 sta_priv->dpu_desc_index = params->dpu_index;
1494 sta_priv->ucast_dpu_sign = params->uc_ucast_sig;
1496 wcn36xx_dbg(WCN36XX_DBG_HAL,
1497 "hal config sta rsp status %d sta_index %d bssid_index %d uc_ucast_sig %d p2p %d\n",
1498 params->status, params->sta_index, params->bssid_index,
1499 params->uc_ucast_sig, params->p2p);
1504 static int wcn36xx_smd_config_sta_v1(struct wcn36xx *wcn,
1505 struct ieee80211_vif *vif,
1506 struct ieee80211_sta *sta)
1508 struct wcn36xx_hal_config_sta_req_msg_v1 msg_body;
1509 struct wcn36xx_hal_config_sta_params_v1 *sta_params;
1511 if (wcn->rf_id == RF_IRIS_WCN3680) {
1512 INIT_HAL_MSG_V1(msg_body, WCN36XX_HAL_CONFIG_STA_REQ);
1514 INIT_HAL_MSG(msg_body, WCN36XX_HAL_CONFIG_STA_REQ);
1515 msg_body.header.len -= WCN36XX_DIFF_STA_PARAMS_V1_NOVHT;
1518 sta_params = &msg_body.sta_params;
1520 wcn36xx_smd_set_sta_params_v1(wcn, vif, sta, sta_params);
1522 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1524 wcn36xx_dbg(WCN36XX_DBG_HAL,
1525 "hal config sta v1 action %d sta_index %d bssid_index %d bssid %pM type %d mac %pM aid %d\n",
1526 sta_params->action, sta_params->sta_index, sta_params->bssid_index,
1527 sta_params->bssid, sta_params->type, sta_params->mac, sta_params->aid);
1529 return wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1532 static int wcn36xx_smd_config_sta_v0(struct wcn36xx *wcn,
1533 struct ieee80211_vif *vif,
1534 struct ieee80211_sta *sta)
1536 struct wcn36xx_hal_config_sta_req_msg msg;
1537 struct wcn36xx_hal_config_sta_params *sta_params;
1539 INIT_HAL_MSG(msg, WCN36XX_HAL_CONFIG_STA_REQ);
1541 sta_params = &msg.sta_params;
1543 wcn36xx_smd_set_sta_params(wcn, vif, sta, sta_params);
1545 PREPARE_HAL_BUF(wcn->hal_buf, msg);
1547 wcn36xx_dbg(WCN36XX_DBG_HAL,
1548 "hal config sta action %d sta_index %d bssid_index %d bssid %pM type %d mac %pM aid %d\n",
1549 sta_params->action, sta_params->sta_index,
1550 sta_params->bssid_index, sta_params->bssid,
1551 sta_params->type, sta_params->mac, sta_params->aid);
1553 return wcn36xx_smd_send_and_wait(wcn, msg.header.len);
1556 int wcn36xx_smd_config_sta(struct wcn36xx *wcn, struct ieee80211_vif *vif,
1557 struct ieee80211_sta *sta)
1561 mutex_lock(&wcn->hal_mutex);
1563 if (!wcn36xx_is_fw_version(wcn, 1, 2, 2, 24))
1564 ret = wcn36xx_smd_config_sta_v1(wcn, vif, sta);
1566 ret = wcn36xx_smd_config_sta_v0(wcn, vif, sta);
1569 wcn36xx_err("Sending hal_config_sta failed\n");
1572 ret = wcn36xx_smd_config_sta_rsp(wcn,
1577 wcn36xx_err("hal_config_sta response failed err=%d\n", ret);
1581 mutex_unlock(&wcn->hal_mutex);
1585 static void wcn36xx_smd_set_bss_params(struct wcn36xx *wcn,
1586 struct ieee80211_vif *vif,
1587 struct ieee80211_sta *sta,
1590 struct wcn36xx_hal_config_bss_params *bss)
1592 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
1594 WARN_ON(is_zero_ether_addr(bssid));
1596 memcpy(&bss->bssid, bssid, ETH_ALEN);
1598 memcpy(bss->self_mac_addr, vif->addr, ETH_ALEN);
1600 if (vif->type == NL80211_IFTYPE_STATION) {
1601 bss->bss_type = WCN36XX_HAL_INFRASTRUCTURE_MODE;
1605 bss->wcn36xx_hal_persona = WCN36XX_HAL_STA_MODE;
1606 } else if (vif->type == NL80211_IFTYPE_AP ||
1607 vif->type == NL80211_IFTYPE_MESH_POINT) {
1608 bss->bss_type = WCN36XX_HAL_INFRA_AP_MODE;
1612 bss->wcn36xx_hal_persona = WCN36XX_HAL_STA_SAP_MODE;
1613 } else if (vif->type == NL80211_IFTYPE_ADHOC) {
1614 bss->bss_type = WCN36XX_HAL_IBSS_MODE;
1619 wcn36xx_warn("Unknown type for bss config: %d\n", vif->type);
1622 if (vif->type == NL80211_IFTYPE_STATION)
1623 wcn36xx_smd_set_bss_nw_type(wcn, sta, bss);
1625 bss->nw_type = WCN36XX_HAL_11N_NW_TYPE;
1627 bss->short_slot_time_supported = vif->bss_conf.use_short_slot;
1628 bss->lla_coexist = 0;
1629 bss->llb_coexist = 0;
1630 bss->llg_coexist = 0;
1632 bss->beacon_interval = vif->bss_conf.beacon_int;
1633 bss->dtim_period = vif_priv->dtim_period;
1635 wcn36xx_smd_set_bss_ht_params(vif, sta, bss);
1637 bss->oper_channel = WCN36XX_HW_CHANNEL(wcn);
1639 if (conf_is_ht40_minus(&wcn->hw->conf))
1640 bss->ext_channel = IEEE80211_HT_PARAM_CHA_SEC_BELOW;
1641 else if (conf_is_ht40_plus(&wcn->hw->conf))
1642 bss->ext_channel = IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
1644 bss->ext_channel = IEEE80211_HT_PARAM_CHA_SEC_NONE;
1648 /* wcn->ssid is only valid in AP and IBSS mode */
1649 bss->ssid.length = vif_priv->ssid.length;
1650 memcpy(bss->ssid.ssid, vif_priv->ssid.ssid, vif_priv->ssid.length);
1652 bss->obss_prot_enabled = 0;
1654 bss->max_probe_resp_retry_limit = 0;
1655 bss->hidden_ssid = vif->bss_conf.hidden_ssid;
1656 bss->proxy_probe_resp = 0;
1657 bss->edca_params_valid = 0;
1659 /* FIXME: set acbe, acbk, acvi and acvo */
1661 bss->ext_set_sta_key_param_valid = 0;
1663 /* FIXME: set ext_set_sta_key_param */
1665 bss->spectrum_mgt_enable = 0;
1666 bss->tx_mgmt_power = 0;
1667 bss->max_tx_power = WCN36XX_MAX_POWER(wcn);
1668 bss->action = update;
1670 vif_priv->bss_type = bss->bss_type;
1673 static int wcn36xx_smd_config_bss_v1(struct wcn36xx *wcn,
1674 struct ieee80211_vif *vif,
1675 struct ieee80211_sta *sta_80211,
1679 struct wcn36xx_hal_config_bss_req_msg_v1 *msg_body;
1680 struct wcn36xx_hal_config_bss_params_v1 *bss;
1681 struct wcn36xx_hal_config_bss_params bss_v0;
1682 struct wcn36xx_hal_config_sta_params_v1 *sta;
1683 struct cfg80211_chan_def *chandef;
1686 msg_body = kzalloc(sizeof(*msg_body), GFP_KERNEL);
1690 if (wcn->rf_id == RF_IRIS_WCN3680) {
1691 INIT_HAL_MSG_V1((*msg_body), WCN36XX_HAL_CONFIG_BSS_REQ);
1693 INIT_HAL_MSG((*msg_body), WCN36XX_HAL_CONFIG_BSS_REQ);
1694 msg_body->header.len -= WCN36XX_DIFF_BSS_PARAMS_V1_NOVHT;
1697 bss = &msg_body->bss_params;
1700 memset(&bss_v0, 0x00, sizeof(bss_v0));
1701 wcn36xx_smd_set_bss_params(wcn, vif, sta_80211, bssid, update, &bss_v0);
1702 wcn36xx_smd_set_sta_params_v1(wcn, vif, sta_80211, sta);
1704 /* convert orig to v1 */
1705 memcpy(bss->bssid, &bss_v0.bssid, ETH_ALEN);
1706 memcpy(bss->self_mac_addr, &bss_v0.self_mac_addr, ETH_ALEN);
1708 bss->bss_type = bss_v0.bss_type;
1709 bss->oper_mode = bss_v0.oper_mode;
1710 bss->nw_type = bss_v0.nw_type;
1712 bss->short_slot_time_supported =
1713 bss_v0.short_slot_time_supported;
1714 bss->lla_coexist = bss_v0.lla_coexist;
1715 bss->llb_coexist = bss_v0.llb_coexist;
1716 bss->llg_coexist = bss_v0.llg_coexist;
1717 bss->ht20_coexist = bss_v0.ht20_coexist;
1718 bss->lln_non_gf_coexist = bss_v0.lln_non_gf_coexist;
1720 bss->lsig_tx_op_protection_full_support =
1721 bss_v0.lsig_tx_op_protection_full_support;
1722 bss->rifs_mode = bss_v0.rifs_mode;
1723 bss->beacon_interval = bss_v0.beacon_interval;
1724 bss->dtim_period = bss_v0.dtim_period;
1725 bss->tx_channel_width_set = bss_v0.tx_channel_width_set;
1726 bss->oper_channel = bss_v0.oper_channel;
1728 if (wcn->hw->conf.chandef.width == NL80211_CHAN_WIDTH_80) {
1729 chandef = &wcn->hw->conf.chandef;
1730 bss->ext_channel = HW_VALUE_PHY(chandef->chan->hw_value);
1732 bss->ext_channel = bss_v0.ext_channel;
1735 bss->reserved = bss_v0.reserved;
1737 memcpy(&bss->ssid, &bss_v0.ssid,
1738 sizeof(bss_v0.ssid));
1740 bss->action = bss_v0.action;
1741 bss->rateset = bss_v0.rateset;
1742 bss->ht = bss_v0.ht;
1743 bss->obss_prot_enabled = bss_v0.obss_prot_enabled;
1744 bss->rmf = bss_v0.rmf;
1745 bss->ht_oper_mode = bss_v0.ht_oper_mode;
1746 bss->dual_cts_protection = bss_v0.dual_cts_protection;
1748 bss->max_probe_resp_retry_limit =
1749 bss_v0.max_probe_resp_retry_limit;
1750 bss->hidden_ssid = bss_v0.hidden_ssid;
1751 bss->proxy_probe_resp = bss_v0.proxy_probe_resp;
1752 bss->edca_params_valid = bss_v0.edca_params_valid;
1754 memcpy(&bss->acbe, &bss_v0.acbe,
1755 sizeof(bss_v0.acbe));
1756 memcpy(&bss->acbk, &bss_v0.acbk,
1757 sizeof(bss_v0.acbk));
1758 memcpy(&bss->acvi, &bss_v0.acvi,
1759 sizeof(bss_v0.acvi));
1760 memcpy(&bss->acvo, &bss_v0.acvo,
1761 sizeof(bss_v0.acvo));
1763 bss->ext_set_sta_key_param_valid =
1764 bss_v0.ext_set_sta_key_param_valid;
1766 memcpy(&bss->ext_set_sta_key_param,
1767 &bss_v0.ext_set_sta_key_param,
1768 sizeof(bss_v0.acvo));
1770 bss->wcn36xx_hal_persona = bss_v0.wcn36xx_hal_persona;
1771 bss->spectrum_mgt_enable = bss_v0.spectrum_mgt_enable;
1772 bss->tx_mgmt_power = bss_v0.tx_mgmt_power;
1773 bss->max_tx_power = bss_v0.max_tx_power;
1775 wcn36xx_smd_set_bss_vht_params(vif, sta_80211, bss);
1777 PREPARE_HAL_BUF(wcn->hal_buf, (*msg_body));
1779 wcn36xx_dbg(WCN36XX_DBG_HAL,
1780 "hal config bss v1 bssid %pM self_mac_addr %pM bss_type %d oper_mode %d nw_type %d\n",
1781 bss->bssid, bss->self_mac_addr, bss->bss_type,
1782 bss->oper_mode, bss->nw_type);
1784 wcn36xx_dbg(WCN36XX_DBG_HAL,
1785 "- sta bssid %pM action %d sta_index %d bssid_index %d aid %d type %d mac %pM\n",
1786 sta->bssid, sta->action, sta->sta_index,
1787 sta->bssid_index, sta->aid, sta->type, sta->mac);
1789 ret = wcn36xx_smd_send_and_wait(wcn, msg_body->header.len);
1795 static int wcn36xx_smd_config_bss_v0(struct wcn36xx *wcn,
1796 struct ieee80211_vif *vif,
1797 struct ieee80211_sta *sta,
1801 struct wcn36xx_hal_config_bss_req_msg *msg;
1802 struct wcn36xx_hal_config_bss_params *bss;
1803 struct wcn36xx_hal_config_sta_params *sta_params;
1806 msg = kzalloc(sizeof(*msg), GFP_KERNEL);
1810 INIT_HAL_MSG((*msg), WCN36XX_HAL_CONFIG_BSS_REQ);
1812 bss = &msg->bss_params;
1813 sta_params = &bss->sta;
1815 wcn36xx_smd_set_bss_params(wcn, vif, sta, bssid, update, bss);
1816 wcn36xx_smd_set_sta_params(wcn, vif, sta, sta_params);
1818 PREPARE_HAL_BUF(wcn->hal_buf, (*msg));
1820 wcn36xx_dbg(WCN36XX_DBG_HAL,
1821 "hal config bss bssid %pM self_mac_addr %pM bss_type %d oper_mode %d nw_type %d\n",
1822 bss->bssid, bss->self_mac_addr, bss->bss_type,
1823 bss->oper_mode, bss->nw_type);
1825 wcn36xx_dbg(WCN36XX_DBG_HAL,
1826 "- sta bssid %pM action %d sta_index %d bssid_index %d aid %d type %d mac %pM\n",
1827 sta_params->bssid, sta_params->action,
1828 sta_params->sta_index, sta_params->bssid_index,
1829 sta_params->aid, sta_params->type,
1832 ret = wcn36xx_smd_send_and_wait(wcn, msg->header.len);
1838 static int wcn36xx_smd_config_bss_rsp(struct wcn36xx *wcn,
1839 struct ieee80211_vif *vif,
1840 struct ieee80211_sta *sta,
1844 struct wcn36xx_hal_config_bss_rsp_msg *rsp;
1845 struct wcn36xx_hal_config_bss_rsp_params *params;
1846 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
1848 if (len < sizeof(*rsp))
1851 rsp = (struct wcn36xx_hal_config_bss_rsp_msg *)buf;
1852 params = &rsp->bss_rsp_params;
1854 if (params->status != WCN36XX_FW_MSG_RESULT_SUCCESS) {
1855 wcn36xx_warn("hal config bss response failure: %d\n",
1860 wcn36xx_dbg(WCN36XX_DBG_HAL,
1861 "hal config bss rsp status %d bss_idx %d dpu_desc_index %d"
1862 " sta_idx %d self_idx %d bcast_idx %d mac %pM"
1863 " power %d ucast_dpu_signature %d\n",
1864 params->status, params->bss_index, params->dpu_desc_index,
1865 params->bss_sta_index, params->bss_self_sta_index,
1866 params->bss_bcast_sta_idx, params->mac,
1867 params->tx_mgmt_power, params->ucast_dpu_signature);
1869 vif_priv->bss_index = params->bss_index;
1872 struct wcn36xx_sta *sta_priv = wcn36xx_sta_to_priv(sta);
1873 sta_priv->bss_sta_index = params->bss_sta_index;
1874 sta_priv->bss_dpu_desc_index = params->dpu_desc_index;
1877 vif_priv->self_ucast_dpu_sign = params->ucast_dpu_signature;
1882 int wcn36xx_smd_config_bss(struct wcn36xx *wcn, struct ieee80211_vif *vif,
1883 struct ieee80211_sta *sta, const u8 *bssid,
1888 mutex_lock(&wcn->hal_mutex);
1890 if (!wcn36xx_is_fw_version(wcn, 1, 2, 2, 24))
1891 ret = wcn36xx_smd_config_bss_v1(wcn, vif, sta, bssid, update);
1893 ret = wcn36xx_smd_config_bss_v0(wcn, vif, sta, bssid, update);
1896 wcn36xx_err("Sending hal_config_bss failed\n");
1899 ret = wcn36xx_smd_config_bss_rsp(wcn,
1905 wcn36xx_err("hal_config_bss response failed err=%d\n", ret);
1908 mutex_unlock(&wcn->hal_mutex);
1912 int wcn36xx_smd_delete_bss(struct wcn36xx *wcn, struct ieee80211_vif *vif)
1914 struct wcn36xx_hal_delete_bss_req_msg msg_body;
1915 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
1918 mutex_lock(&wcn->hal_mutex);
1920 if (vif_priv->bss_index == WCN36XX_HAL_BSS_INVALID_IDX)
1923 INIT_HAL_MSG(msg_body, WCN36XX_HAL_DELETE_BSS_REQ);
1925 msg_body.bss_index = vif_priv->bss_index;
1927 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
1929 wcn36xx_dbg(WCN36XX_DBG_HAL, "hal delete bss %d\n", msg_body.bss_index);
1931 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
1933 wcn36xx_err("Sending hal_delete_bss failed\n");
1936 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
1938 wcn36xx_err("hal_delete_bss response failed err=%d\n", ret);
1942 vif_priv->bss_index = WCN36XX_HAL_BSS_INVALID_IDX;
1944 mutex_unlock(&wcn->hal_mutex);
1948 int wcn36xx_smd_send_beacon(struct wcn36xx *wcn, struct ieee80211_vif *vif,
1949 struct sk_buff *skb_beacon, u16 tim_off,
1952 struct wcn36xx_hal_send_beacon_req_msg msg_body;
1953 int ret, pad, pvm_len;
1955 mutex_lock(&wcn->hal_mutex);
1956 INIT_HAL_MSG(msg_body, WCN36XX_HAL_SEND_BEACON_REQ);
1958 pvm_len = skb_beacon->data[tim_off + 1] - 3;
1959 pad = TIM_MIN_PVM_SIZE - pvm_len;
1961 /* Padding is irrelevant to mesh mode since tim_off is always 0. */
1962 if (vif->type == NL80211_IFTYPE_MESH_POINT)
1965 msg_body.beacon_length = skb_beacon->len + pad;
1966 /* TODO need to find out why + 6 is needed */
1967 msg_body.beacon_length6 = msg_body.beacon_length + 6;
1969 if (msg_body.beacon_length > BEACON_TEMPLATE_SIZE) {
1970 wcn36xx_err("Beacon is too big: beacon size=%d\n",
1971 msg_body.beacon_length);
1975 memcpy(msg_body.beacon, skb_beacon->data, skb_beacon->len);
1976 memcpy(msg_body.bssid, vif->addr, ETH_ALEN);
1980 * The wcn36xx FW has a fixed size for the PVM in the TIM. If
1981 * given the beacon template from mac80211 with a PVM shorter
1982 * than the FW expectes it will overwrite the data after the
1985 wcn36xx_dbg(WCN36XX_DBG_HAL, "Pad TIM PVM. %d bytes at %d\n",
1987 memmove(&msg_body.beacon[tim_off + 5 + pvm_len + pad],
1988 &msg_body.beacon[tim_off + 5 + pvm_len],
1989 skb_beacon->len - (tim_off + 5 + pvm_len));
1990 memset(&msg_body.beacon[tim_off + 5 + pvm_len], 0, pad);
1991 msg_body.beacon[tim_off + 1] += pad;
1994 /* TODO need to find out why this is needed? */
1995 if (vif->type == NL80211_IFTYPE_MESH_POINT)
1996 /* mesh beacon don't need this, so push further down */
1997 msg_body.tim_ie_offset = 256;
1999 msg_body.tim_ie_offset = tim_off+4;
2000 msg_body.p2p_ie_offset = p2p_off;
2001 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2003 wcn36xx_dbg(WCN36XX_DBG_HAL,
2004 "hal send beacon beacon_length %d\n",
2005 msg_body.beacon_length);
2007 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2009 wcn36xx_err("Sending hal_send_beacon failed\n");
2012 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2014 wcn36xx_err("hal_send_beacon response failed err=%d\n", ret);
2018 mutex_unlock(&wcn->hal_mutex);
2022 int wcn36xx_smd_update_proberesp_tmpl(struct wcn36xx *wcn,
2023 struct ieee80211_vif *vif,
2024 struct sk_buff *skb)
2026 struct wcn36xx_hal_send_probe_resp_req_msg msg;
2029 mutex_lock(&wcn->hal_mutex);
2030 INIT_HAL_MSG(msg, WCN36XX_HAL_UPDATE_PROBE_RSP_TEMPLATE_REQ);
2032 if (skb->len > BEACON_TEMPLATE_SIZE) {
2033 wcn36xx_warn("probe response template is too big: %d\n",
2039 msg.probe_resp_template_len = skb->len;
2040 memcpy(&msg.probe_resp_template, skb->data, skb->len);
2042 memcpy(msg.bssid, vif->addr, ETH_ALEN);
2044 PREPARE_HAL_BUF(wcn->hal_buf, msg);
2046 wcn36xx_dbg(WCN36XX_DBG_HAL,
2047 "hal update probe rsp len %d bssid %pM\n",
2048 msg.probe_resp_template_len, msg.bssid);
2050 ret = wcn36xx_smd_send_and_wait(wcn, msg.header.len);
2052 wcn36xx_err("Sending hal_update_proberesp_tmpl failed\n");
2055 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2057 wcn36xx_err("hal_update_proberesp_tmpl response failed err=%d\n",
2062 mutex_unlock(&wcn->hal_mutex);
2066 int wcn36xx_smd_set_stakey(struct wcn36xx *wcn,
2067 enum ani_ed_type enc_type,
2073 struct wcn36xx_hal_set_sta_key_req_msg msg_body;
2076 mutex_lock(&wcn->hal_mutex);
2077 INIT_HAL_MSG(msg_body, WCN36XX_HAL_SET_STAKEY_REQ);
2079 msg_body.set_sta_key_params.sta_index = sta_index;
2080 msg_body.set_sta_key_params.enc_type = enc_type;
2082 if (enc_type == WCN36XX_HAL_ED_WEP104 ||
2083 enc_type == WCN36XX_HAL_ED_WEP40) {
2084 /* Use bss key for wep (static) */
2085 msg_body.set_sta_key_params.def_wep_idx = keyidx;
2086 msg_body.set_sta_key_params.wep_type = 0;
2088 msg_body.set_sta_key_params.key[0].id = keyidx;
2089 msg_body.set_sta_key_params.key[0].unicast = 1;
2090 msg_body.set_sta_key_params.key[0].direction = WCN36XX_HAL_TX_RX;
2091 msg_body.set_sta_key_params.key[0].pae_role = 0;
2092 msg_body.set_sta_key_params.key[0].length = keylen;
2093 memcpy(msg_body.set_sta_key_params.key[0].key, key, keylen);
2096 msg_body.set_sta_key_params.single_tid_rc = 1;
2098 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2100 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2102 wcn36xx_err("Sending hal_set_stakey failed\n");
2105 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2107 wcn36xx_err("hal_set_stakey response failed err=%d\n", ret);
2111 mutex_unlock(&wcn->hal_mutex);
2115 int wcn36xx_smd_set_bsskey(struct wcn36xx *wcn,
2116 enum ani_ed_type enc_type,
2122 struct wcn36xx_hal_set_bss_key_req_msg msg_body;
2125 mutex_lock(&wcn->hal_mutex);
2126 INIT_HAL_MSG(msg_body, WCN36XX_HAL_SET_BSSKEY_REQ);
2127 msg_body.bss_idx = bssidx;
2128 msg_body.enc_type = enc_type;
2129 msg_body.num_keys = 1;
2130 msg_body.keys[0].id = keyidx;
2131 msg_body.keys[0].unicast = 0;
2132 msg_body.keys[0].direction = WCN36XX_HAL_RX_ONLY;
2133 msg_body.keys[0].pae_role = 0;
2134 msg_body.keys[0].length = keylen;
2135 memcpy(msg_body.keys[0].key, key, keylen);
2137 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2139 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2141 wcn36xx_err("Sending hal_set_bsskey failed\n");
2144 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2146 wcn36xx_err("hal_set_bsskey response failed err=%d\n", ret);
2150 mutex_unlock(&wcn->hal_mutex);
2154 int wcn36xx_smd_remove_stakey(struct wcn36xx *wcn,
2155 enum ani_ed_type enc_type,
2159 struct wcn36xx_hal_remove_sta_key_req_msg msg_body;
2162 mutex_lock(&wcn->hal_mutex);
2163 INIT_HAL_MSG(msg_body, WCN36XX_HAL_RMV_STAKEY_REQ);
2165 msg_body.sta_idx = sta_index;
2166 msg_body.enc_type = enc_type;
2167 msg_body.key_id = keyidx;
2169 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2171 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2173 wcn36xx_err("Sending hal_remove_stakey failed\n");
2176 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2178 wcn36xx_err("hal_remove_stakey response failed err=%d\n", ret);
2182 mutex_unlock(&wcn->hal_mutex);
2186 int wcn36xx_smd_remove_bsskey(struct wcn36xx *wcn,
2187 enum ani_ed_type enc_type,
2191 struct wcn36xx_hal_remove_bss_key_req_msg msg_body;
2194 mutex_lock(&wcn->hal_mutex);
2195 INIT_HAL_MSG(msg_body, WCN36XX_HAL_RMV_BSSKEY_REQ);
2196 msg_body.bss_idx = bssidx;
2197 msg_body.enc_type = enc_type;
2198 msg_body.key_id = keyidx;
2200 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2202 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2204 wcn36xx_err("Sending hal_remove_bsskey failed\n");
2207 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2209 wcn36xx_err("hal_remove_bsskey response failed err=%d\n", ret);
2213 mutex_unlock(&wcn->hal_mutex);
2217 int wcn36xx_smd_enter_bmps(struct wcn36xx *wcn, struct ieee80211_vif *vif)
2219 struct wcn36xx_hal_enter_bmps_req_msg msg_body;
2220 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
2223 mutex_lock(&wcn->hal_mutex);
2224 INIT_HAL_MSG(msg_body, WCN36XX_HAL_ENTER_BMPS_REQ);
2226 msg_body.bss_index = vif_priv->bss_index;
2227 msg_body.tbtt = vif->bss_conf.sync_tsf;
2228 msg_body.dtim_period = vif_priv->dtim_period;
2230 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2232 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2234 wcn36xx_err("Sending hal_enter_bmps failed\n");
2237 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2239 wcn36xx_err("hal_enter_bmps response failed err=%d\n", ret);
2243 mutex_unlock(&wcn->hal_mutex);
2247 int wcn36xx_smd_exit_bmps(struct wcn36xx *wcn, struct ieee80211_vif *vif)
2249 struct wcn36xx_hal_exit_bmps_req_msg msg_body;
2250 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
2253 mutex_lock(&wcn->hal_mutex);
2254 INIT_HAL_MSG(msg_body, WCN36XX_HAL_EXIT_BMPS_REQ);
2256 msg_body.bss_index = vif_priv->bss_index;
2257 msg_body.send_data_null = 1;
2259 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2261 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2263 wcn36xx_err("Sending hal_exit_bmps failed\n");
2266 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2268 wcn36xx_err("hal_exit_bmps response failed err=%d\n", ret);
2272 mutex_unlock(&wcn->hal_mutex);
2276 int wcn36xx_smd_enter_imps(struct wcn36xx *wcn)
2278 struct wcn36xx_hal_enter_imps_req_msg msg_body;
2281 mutex_lock(&wcn->hal_mutex);
2282 INIT_HAL_MSG(msg_body, WCN36XX_HAL_ENTER_IMPS_REQ);
2284 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2286 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2288 wcn36xx_err("Sending hal_enter_imps failed\n");
2291 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2293 wcn36xx_err("hal_enter_imps response failed err=%d\n", ret);
2297 wcn36xx_dbg(WCN36XX_DBG_HAL, "Entered idle mode\n");
2299 mutex_unlock(&wcn->hal_mutex);
2303 int wcn36xx_smd_exit_imps(struct wcn36xx *wcn)
2305 struct wcn36xx_hal_exit_imps_req_msg msg_body;
2308 mutex_lock(&wcn->hal_mutex);
2309 INIT_HAL_MSG(msg_body, WCN36XX_HAL_EXIT_IMPS_REQ);
2311 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2313 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2315 wcn36xx_err("Sending hal_exit_imps failed\n");
2318 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2320 wcn36xx_err("hal_exit_imps response failed err=%d\n", ret);
2323 wcn36xx_dbg(WCN36XX_DBG_HAL, "Exited idle mode\n");
2325 mutex_unlock(&wcn->hal_mutex);
2329 int wcn36xx_smd_set_power_params(struct wcn36xx *wcn, bool ignore_dtim)
2331 struct wcn36xx_hal_set_power_params_req_msg msg_body;
2334 mutex_lock(&wcn->hal_mutex);
2335 INIT_HAL_MSG(msg_body, WCN36XX_HAL_SET_POWER_PARAMS_REQ);
2338 * When host is down ignore every second dtim
2341 msg_body.ignore_dtim = 1;
2342 msg_body.dtim_period = 2;
2344 msg_body.listen_interval = WCN36XX_LISTEN_INTERVAL(wcn);
2346 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2348 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2350 wcn36xx_err("Sending hal_set_power_params failed\n");
2355 mutex_unlock(&wcn->hal_mutex);
2359 /* Notice: This function should be called after associated, or else it
2362 int wcn36xx_smd_keep_alive_req(struct wcn36xx *wcn,
2363 struct ieee80211_vif *vif,
2366 struct wcn36xx_hal_keep_alive_req_msg msg_body;
2367 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
2370 mutex_lock(&wcn->hal_mutex);
2371 INIT_HAL_MSG(msg_body, WCN36XX_HAL_KEEP_ALIVE_REQ);
2373 if (packet_type == WCN36XX_HAL_KEEP_ALIVE_NULL_PKT) {
2374 msg_body.bss_index = vif_priv->bss_index;
2375 msg_body.packet_type = WCN36XX_HAL_KEEP_ALIVE_NULL_PKT;
2376 msg_body.time_period = WCN36XX_KEEP_ALIVE_TIME_PERIOD;
2377 } else if (packet_type == WCN36XX_HAL_KEEP_ALIVE_UNSOLICIT_ARP_RSP) {
2378 /* TODO: it also support ARP response type */
2380 wcn36xx_warn("unknown keep alive packet type %d\n", packet_type);
2385 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2387 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2389 wcn36xx_err("Sending hal_keep_alive failed\n");
2392 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2394 wcn36xx_err("hal_keep_alive response failed err=%d\n", ret);
2398 mutex_unlock(&wcn->hal_mutex);
2402 int wcn36xx_smd_dump_cmd_req(struct wcn36xx *wcn, u32 arg1, u32 arg2,
2403 u32 arg3, u32 arg4, u32 arg5)
2405 struct wcn36xx_hal_dump_cmd_req_msg msg_body;
2408 mutex_lock(&wcn->hal_mutex);
2409 INIT_HAL_MSG(msg_body, WCN36XX_HAL_DUMP_COMMAND_REQ);
2411 msg_body.arg1 = arg1;
2412 msg_body.arg2 = arg2;
2413 msg_body.arg3 = arg3;
2414 msg_body.arg4 = arg4;
2415 msg_body.arg5 = arg5;
2417 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2419 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2421 wcn36xx_err("Sending hal_dump_cmd failed\n");
2424 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2426 wcn36xx_err("hal_dump_cmd response failed err=%d\n", ret);
2430 mutex_unlock(&wcn->hal_mutex);
2434 void set_feat_caps(u32 *bitmap, enum place_holder_in_cap_bitmap cap)
2436 int arr_idx, bit_idx;
2438 if (cap < 0 || cap > 127) {
2439 wcn36xx_warn("error cap idx %d\n", cap);
2445 bitmap[arr_idx] |= (1 << bit_idx);
2448 int get_feat_caps(u32 *bitmap, enum place_holder_in_cap_bitmap cap)
2450 int arr_idx, bit_idx;
2452 if (cap < 0 || cap > 127) {
2453 wcn36xx_warn("error cap idx %d\n", cap);
2460 return (bitmap[arr_idx] & (1 << bit_idx)) ? 1 : 0;
2463 void clear_feat_caps(u32 *bitmap, enum place_holder_in_cap_bitmap cap)
2465 int arr_idx, bit_idx;
2467 if (cap < 0 || cap > 127) {
2468 wcn36xx_warn("error cap idx %d\n", cap);
2474 bitmap[arr_idx] &= ~(1 << bit_idx);
2477 int wcn36xx_smd_feature_caps_exchange(struct wcn36xx *wcn)
2479 struct wcn36xx_hal_feat_caps_msg msg_body, *rsp;
2482 mutex_lock(&wcn->hal_mutex);
2483 INIT_HAL_MSG(msg_body, WCN36XX_HAL_FEATURE_CAPS_EXCHANGE_REQ);
2485 set_feat_caps(msg_body.feat_caps, STA_POWERSAVE);
2486 if (wcn->rf_id == RF_IRIS_WCN3680) {
2487 set_feat_caps(msg_body.feat_caps, DOT11AC);
2488 set_feat_caps(msg_body.feat_caps, WLAN_CH144);
2489 set_feat_caps(msg_body.feat_caps, ANTENNA_DIVERSITY_SELECTION);
2492 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2494 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2496 wcn36xx_err("Sending hal_feature_caps_exchange failed\n");
2499 if (wcn->hal_rsp_len != sizeof(*rsp)) {
2500 wcn36xx_err("Invalid hal_feature_caps_exchange response");
2504 rsp = (struct wcn36xx_hal_feat_caps_msg *) wcn->hal_buf;
2506 for (i = 0; i < WCN36XX_HAL_CAPS_SIZE; i++)
2507 wcn->fw_feat_caps[i] = rsp->feat_caps[i];
2509 mutex_unlock(&wcn->hal_mutex);
2513 static int wcn36xx_smd_add_ba_session_rsp(void *buf, int len, u8 *session)
2515 struct wcn36xx_hal_add_ba_session_rsp_msg *rsp;
2517 if (len < sizeof(*rsp))
2520 rsp = (struct wcn36xx_hal_add_ba_session_rsp_msg *)buf;
2521 if (rsp->status != WCN36XX_FW_MSG_RESULT_SUCCESS)
2524 *session = rsp->ba_session_id;
2529 int wcn36xx_smd_add_ba_session(struct wcn36xx *wcn,
2530 struct ieee80211_sta *sta,
2536 struct wcn36xx_hal_add_ba_session_req_msg msg_body;
2540 mutex_lock(&wcn->hal_mutex);
2541 INIT_HAL_MSG(msg_body, WCN36XX_HAL_ADD_BA_SESSION_REQ);
2543 msg_body.sta_index = sta_index;
2544 memcpy(&msg_body.mac_addr, sta->addr, ETH_ALEN);
2545 msg_body.dialog_token = 0x10;
2548 /* Immediate BA because Delayed BA is not supported */
2549 msg_body.policy = 1;
2550 msg_body.buffer_size = WCN36XX_AGGR_BUFFER_SIZE;
2551 msg_body.timeout = 0;
2553 msg_body.ssn = *ssn;
2554 msg_body.direction = direction;
2556 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2558 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2560 wcn36xx_err("Sending hal_add_ba_session failed\n");
2563 ret = wcn36xx_smd_add_ba_session_rsp(wcn->hal_buf, wcn->hal_rsp_len,
2566 wcn36xx_err("hal_add_ba_session response failed err=%d\n", ret);
2573 mutex_unlock(&wcn->hal_mutex);
2577 int wcn36xx_smd_add_ba(struct wcn36xx *wcn, u8 session_id)
2579 struct wcn36xx_hal_add_ba_req_msg msg_body;
2582 mutex_lock(&wcn->hal_mutex);
2583 INIT_HAL_MSG(msg_body, WCN36XX_HAL_ADD_BA_REQ);
2585 msg_body.session_id = session_id;
2586 msg_body.win_size = WCN36XX_AGGR_BUFFER_SIZE;
2588 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2590 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2592 wcn36xx_err("Sending hal_add_ba failed\n");
2595 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2597 wcn36xx_err("hal_add_ba response failed err=%d\n", ret);
2601 mutex_unlock(&wcn->hal_mutex);
2605 int wcn36xx_smd_del_ba(struct wcn36xx *wcn, u16 tid, u8 direction, u8 sta_index)
2607 struct wcn36xx_hal_del_ba_req_msg msg_body;
2610 mutex_lock(&wcn->hal_mutex);
2611 INIT_HAL_MSG(msg_body, WCN36XX_HAL_DEL_BA_REQ);
2613 msg_body.sta_index = sta_index;
2615 msg_body.direction = direction;
2616 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2618 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2620 wcn36xx_err("Sending hal_del_ba failed\n");
2623 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2625 wcn36xx_err("hal_del_ba response failed err=%d\n", ret);
2629 mutex_unlock(&wcn->hal_mutex);
2633 int wcn36xx_smd_get_stats(struct wcn36xx *wcn, u8 sta_index, u32 stats_mask,
2634 struct station_info *sinfo)
2636 struct wcn36xx_hal_stats_req_msg msg_body;
2637 struct wcn36xx_hal_stats_rsp_msg *rsp;
2641 if (stats_mask & ~HAL_GLOBAL_CLASS_A_STATS_INFO) {
2642 wcn36xx_err("stats_mask 0x%x contains unimplemented types\n",
2647 mutex_lock(&wcn->hal_mutex);
2648 INIT_HAL_MSG(msg_body, WCN36XX_HAL_GET_STATS_REQ);
2650 msg_body.sta_id = sta_index;
2651 msg_body.stats_mask = stats_mask;
2653 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2655 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2657 wcn36xx_err("sending hal_get_stats failed\n");
2661 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2663 wcn36xx_err("hal_get_stats response failed err=%d\n", ret);
2667 rsp = (struct wcn36xx_hal_stats_rsp_msg *)wcn->hal_buf;
2668 rsp_body = (wcn->hal_buf + sizeof(struct wcn36xx_hal_stats_rsp_msg));
2670 if (rsp->stats_mask != stats_mask) {
2671 wcn36xx_err("stats_mask 0x%x differs from requested 0x%x\n",
2672 rsp->stats_mask, stats_mask);
2676 if (rsp->stats_mask & HAL_GLOBAL_CLASS_A_STATS_INFO) {
2677 struct ani_global_class_a_stats_info *stats_info = rsp_body;
2679 wcn36xx_process_tx_rate(stats_info, &sinfo->txrate);
2680 sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BITRATE);
2681 rsp_body += sizeof(struct ani_global_class_a_stats_info);
2684 mutex_unlock(&wcn->hal_mutex);
2689 static int wcn36xx_smd_trigger_ba_rsp(void *buf, int len, struct add_ba_info *ba_info)
2691 struct wcn36xx_hal_trigger_ba_rsp_candidate *candidate;
2692 struct wcn36xx_hal_trigger_ba_rsp_msg *rsp;
2695 if (len < sizeof(*rsp))
2698 rsp = (struct wcn36xx_hal_trigger_ba_rsp_msg *) buf;
2700 if (rsp->candidate_cnt < 1)
2701 return rsp->status ? rsp->status : -EINVAL;
2703 candidate = (struct wcn36xx_hal_trigger_ba_rsp_candidate *)(buf + sizeof(*rsp));
2705 for (i = 0; i < STACFG_MAX_TC; i++) {
2706 ba_info[i] = candidate->ba_info[i];
2712 int wcn36xx_smd_trigger_ba(struct wcn36xx *wcn, u8 sta_index, u16 tid, u16 *ssn)
2714 struct wcn36xx_hal_trigger_ba_req_msg msg_body;
2715 struct wcn36xx_hal_trigger_ba_req_candidate *candidate;
2716 struct add_ba_info ba_info[STACFG_MAX_TC];
2719 if (tid >= STACFG_MAX_TC)
2722 mutex_lock(&wcn->hal_mutex);
2723 INIT_HAL_MSG(msg_body, WCN36XX_HAL_TRIGGER_BA_REQ);
2725 msg_body.session_id = 0; /* not really used */
2726 msg_body.candidate_cnt = 1;
2727 msg_body.header.len += sizeof(*candidate);
2728 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2730 candidate = (struct wcn36xx_hal_trigger_ba_req_candidate *)
2731 (wcn->hal_buf + sizeof(msg_body));
2732 candidate->sta_index = sta_index;
2733 candidate->tid_bitmap = 1 << tid;
2735 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
2737 wcn36xx_err("Sending hal_trigger_ba failed\n");
2740 ret = wcn36xx_smd_trigger_ba_rsp(wcn->hal_buf, wcn->hal_rsp_len, ba_info);
2742 wcn36xx_err("hal_trigger_ba response failed err=%d\n", ret);
2746 mutex_unlock(&wcn->hal_mutex);
2749 *ssn = ba_info[tid].starting_seq_num;
2754 static int wcn36xx_smd_tx_compl_ind(struct wcn36xx *wcn, void *buf, size_t len)
2756 struct wcn36xx_hal_tx_compl_ind_msg *rsp = buf;
2758 if (len != sizeof(*rsp)) {
2759 wcn36xx_warn("Bad TX complete indication\n");
2763 wcn36xx_dxe_tx_ack_ind(wcn, rsp->status);
2768 static int wcn36xx_smd_hw_scan_ind(struct wcn36xx *wcn, void *buf, size_t len)
2770 struct wcn36xx_hal_scan_offload_ind *rsp = buf;
2771 struct cfg80211_scan_info scan_info = {};
2773 if (len != sizeof(*rsp)) {
2774 wcn36xx_warn("Corrupted delete scan indication\n");
2778 wcn36xx_dbg(WCN36XX_DBG_HAL, "scan indication (type %x)\n", rsp->type);
2780 switch (rsp->type) {
2781 case WCN36XX_HAL_SCAN_IND_FAILED:
2782 case WCN36XX_HAL_SCAN_IND_DEQUEUED:
2783 scan_info.aborted = true;
2785 case WCN36XX_HAL_SCAN_IND_COMPLETED:
2786 mutex_lock(&wcn->scan_lock);
2787 wcn->scan_req = NULL;
2788 if (wcn->scan_aborted)
2789 scan_info.aborted = true;
2790 mutex_unlock(&wcn->scan_lock);
2791 ieee80211_scan_completed(wcn->hw, &scan_info);
2793 case WCN36XX_HAL_SCAN_IND_STARTED:
2794 case WCN36XX_HAL_SCAN_IND_FOREIGN_CHANNEL:
2795 case WCN36XX_HAL_SCAN_IND_PREEMPTED:
2796 case WCN36XX_HAL_SCAN_IND_RESTARTED:
2799 wcn36xx_warn("Unknown scan indication type %x\n", rsp->type);
2805 static int wcn36xx_smd_missed_beacon_ind(struct wcn36xx *wcn,
2809 struct wcn36xx_hal_missed_beacon_ind_msg *rsp = buf;
2810 struct ieee80211_vif *vif = NULL;
2811 struct wcn36xx_vif *tmp;
2813 /* Old FW does not have bss index */
2814 if (wcn36xx_is_fw_version(wcn, 1, 2, 2, 24)) {
2815 list_for_each_entry(tmp, &wcn->vif_list, list) {
2816 wcn36xx_dbg(WCN36XX_DBG_HAL, "beacon missed bss_index %d\n",
2818 vif = wcn36xx_priv_to_vif(tmp);
2819 ieee80211_beacon_loss(vif);
2824 if (len != sizeof(*rsp)) {
2825 wcn36xx_warn("Corrupted missed beacon indication\n");
2829 list_for_each_entry(tmp, &wcn->vif_list, list) {
2830 if (tmp->bss_index == rsp->bss_index) {
2831 wcn36xx_dbg(WCN36XX_DBG_HAL, "beacon missed bss_index %d\n",
2833 vif = wcn36xx_priv_to_vif(tmp);
2834 ieee80211_beacon_loss(vif);
2839 wcn36xx_warn("BSS index %d not found\n", rsp->bss_index);
2843 static int wcn36xx_smd_delete_sta_context_ind(struct wcn36xx *wcn,
2847 struct wcn36xx_hal_delete_sta_context_ind_msg *rsp = buf;
2848 struct wcn36xx_vif *vif_priv;
2849 struct ieee80211_vif *vif;
2850 struct ieee80211_bss_conf *bss_conf;
2851 struct ieee80211_sta *sta;
2854 if (len != sizeof(*rsp)) {
2855 wcn36xx_warn("Corrupted delete sta indication\n");
2859 wcn36xx_dbg(WCN36XX_DBG_HAL,
2860 "delete station indication %pM index %d reason %d\n",
2861 rsp->addr2, rsp->sta_id, rsp->reason_code);
2863 list_for_each_entry(vif_priv, &wcn->vif_list, list) {
2865 vif = wcn36xx_priv_to_vif(vif_priv);
2867 if (vif->type == NL80211_IFTYPE_STATION) {
2868 /* We could call ieee80211_find_sta too, but checking
2869 * bss_conf is clearer.
2871 bss_conf = &vif->bss_conf;
2872 if (vif_priv->sta_assoc &&
2873 !memcmp(bss_conf->bssid, rsp->addr2, ETH_ALEN)) {
2875 wcn36xx_dbg(WCN36XX_DBG_HAL,
2876 "connection loss bss_index %d\n",
2877 vif_priv->bss_index);
2878 ieee80211_connection_loss(vif);
2881 sta = ieee80211_find_sta(vif, rsp->addr2);
2884 ieee80211_report_low_ack(sta, 0);
2893 wcn36xx_warn("BSS or STA with addr %pM not found\n", rsp->addr2);
2897 static int wcn36xx_smd_print_reg_info_ind(struct wcn36xx *wcn,
2901 struct wcn36xx_hal_print_reg_info_ind *rsp = buf;
2904 if (len < sizeof(*rsp)) {
2905 wcn36xx_warn("Corrupted print reg info indication\n");
2909 wcn36xx_dbg(WCN36XX_DBG_HAL,
2910 "reginfo indication, scenario: 0x%x reason: 0x%x\n",
2911 rsp->scenario, rsp->reason);
2913 for (i = 0; i < rsp->count; i++) {
2914 wcn36xx_dbg(WCN36XX_DBG_HAL, "\t0x%x: 0x%x\n",
2915 rsp->regs[i].addr, rsp->regs[i].value);
2921 int wcn36xx_smd_update_cfg(struct wcn36xx *wcn, u32 cfg_id, u32 value)
2923 struct wcn36xx_hal_update_cfg_req_msg msg_body, *body;
2927 mutex_lock(&wcn->hal_mutex);
2928 INIT_HAL_MSG(msg_body, WCN36XX_HAL_UPDATE_CFG_REQ);
2930 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
2932 body = (struct wcn36xx_hal_update_cfg_req_msg *) wcn->hal_buf;
2933 len = msg_body.header.len;
2935 put_cfg_tlv_u32(wcn, &len, cfg_id, value);
2936 body->header.len = len;
2937 body->len = len - sizeof(*body);
2939 ret = wcn36xx_smd_send_and_wait(wcn, body->header.len);
2941 wcn36xx_err("Sending hal_update_cfg failed\n");
2944 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2946 wcn36xx_err("hal_update_cfg response failed err=%d\n", ret);
2950 mutex_unlock(&wcn->hal_mutex);
2954 int wcn36xx_smd_set_mc_list(struct wcn36xx *wcn,
2955 struct ieee80211_vif *vif,
2956 struct wcn36xx_hal_rcv_flt_mc_addr_list_type *fp)
2958 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
2959 struct wcn36xx_hal_rcv_flt_pkt_set_mc_list_req_msg *msg_body = NULL;
2962 mutex_lock(&wcn->hal_mutex);
2964 msg_body = (struct wcn36xx_hal_rcv_flt_pkt_set_mc_list_req_msg *)
2966 INIT_HAL_MSG(*msg_body, WCN36XX_HAL_8023_MULTICAST_LIST_REQ);
2968 /* An empty list means all mc traffic will be received */
2970 memcpy(&msg_body->mc_addr_list, fp,
2971 sizeof(msg_body->mc_addr_list));
2973 msg_body->mc_addr_list.mc_addr_count = 0;
2975 msg_body->mc_addr_list.bss_index = vif_priv->bss_index;
2977 ret = wcn36xx_smd_send_and_wait(wcn, msg_body->header.len);
2979 wcn36xx_err("Sending HAL_8023_MULTICAST_LIST failed\n");
2982 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
2984 wcn36xx_err("HAL_8023_MULTICAST_LIST rsp failed err=%d\n", ret);
2988 mutex_unlock(&wcn->hal_mutex);
2992 int wcn36xx_smd_arp_offload(struct wcn36xx *wcn, struct ieee80211_vif *vif,
2995 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
2996 struct wcn36xx_hal_host_offload_req_msg msg_body;
2999 mutex_lock(&wcn->hal_mutex);
3001 INIT_HAL_MSG(msg_body, WCN36XX_HAL_HOST_OFFLOAD_REQ);
3002 msg_body.host_offload_params.offload_type =
3003 WCN36XX_HAL_IPV4_ARP_REPLY_OFFLOAD;
3005 msg_body.host_offload_params.enable =
3006 WCN36XX_HAL_OFFLOAD_ARP_AND_BCAST_FILTER_ENABLE;
3007 memcpy(&msg_body.host_offload_params.u,
3008 &vif->bss_conf.arp_addr_list[0], sizeof(__be32));
3010 msg_body.ns_offload_params.bss_index = vif_priv->bss_index;
3012 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
3014 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
3016 wcn36xx_err("Sending host_offload_arp failed\n");
3019 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
3021 wcn36xx_err("host_offload_arp failed err=%d\n", ret);
3025 mutex_unlock(&wcn->hal_mutex);
3029 #if IS_ENABLED(CONFIG_IPV6)
3030 int wcn36xx_smd_ipv6_ns_offload(struct wcn36xx *wcn, struct ieee80211_vif *vif,
3033 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
3034 struct wcn36xx_hal_host_offload_req_msg msg_body;
3035 struct wcn36xx_hal_ns_offload_params *ns_params;
3036 struct wcn36xx_hal_host_offload_req *ho_params;
3039 mutex_lock(&wcn->hal_mutex);
3041 INIT_HAL_MSG(msg_body, WCN36XX_HAL_HOST_OFFLOAD_REQ);
3042 ho_params = &msg_body.host_offload_params;
3043 ns_params = &msg_body.ns_offload_params;
3045 ho_params->offload_type = WCN36XX_HAL_IPV6_NS_OFFLOAD;
3048 WCN36XX_HAL_OFFLOAD_NS_AND_MCAST_FILTER_ENABLE;
3049 if (vif_priv->num_target_ipv6_addrs) {
3050 memcpy(&ho_params->u,
3051 &vif_priv->target_ipv6_addrs[0].in6_u,
3052 sizeof(struct in6_addr));
3053 memcpy(&ns_params->target_ipv6_addr1,
3054 &vif_priv->target_ipv6_addrs[0].in6_u,
3055 sizeof(struct in6_addr));
3056 ns_params->target_ipv6_addr1_valid = 1;
3058 if (vif_priv->num_target_ipv6_addrs > 1) {
3059 memcpy(&ns_params->target_ipv6_addr2,
3060 &vif_priv->target_ipv6_addrs[1].in6_u,
3061 sizeof(struct in6_addr));
3062 ns_params->target_ipv6_addr2_valid = 1;
3065 memcpy(&ns_params->self_addr, vif->addr, ETH_ALEN);
3066 ns_params->bss_index = vif_priv->bss_index;
3068 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
3070 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
3072 wcn36xx_err("Sending host_offload_arp failed\n");
3075 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
3077 wcn36xx_err("host_offload_arp failed err=%d\n", ret);
3081 mutex_unlock(&wcn->hal_mutex);
3085 int wcn36xx_smd_ipv6_ns_offload(struct wcn36xx *wcn, struct ieee80211_vif *vif,
3092 int wcn36xx_smd_gtk_offload(struct wcn36xx *wcn, struct ieee80211_vif *vif,
3095 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
3096 struct wcn36xx_hal_gtk_offload_req_msg msg_body;
3099 mutex_lock(&wcn->hal_mutex);
3101 INIT_HAL_MSG(msg_body, WCN36XX_HAL_GTK_OFFLOAD_REQ);
3104 memcpy(&msg_body.kek, vif_priv->rekey_data.kek, NL80211_KEK_LEN);
3105 memcpy(&msg_body.kck, vif_priv->rekey_data.kck, NL80211_KCK_LEN);
3106 msg_body.key_replay_counter =
3107 le64_to_cpu(vif_priv->rekey_data.replay_ctr);
3108 msg_body.bss_index = vif_priv->bss_index;
3110 msg_body.flags = WCN36XX_HAL_GTK_OFFLOAD_FLAGS_DISABLE;
3113 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
3115 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
3117 wcn36xx_err("Sending host_offload_arp failed\n");
3120 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
3122 wcn36xx_err("host_offload_arp failed err=%d\n", ret);
3126 mutex_unlock(&wcn->hal_mutex);
3130 static int wcn36xx_smd_gtk_offload_get_info_rsp(struct wcn36xx *wcn,
3131 struct ieee80211_vif *vif)
3133 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
3134 struct wcn36xx_hal_gtk_offload_get_info_rsp_msg *rsp;
3137 if (wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len))
3140 rsp = (struct wcn36xx_hal_gtk_offload_get_info_rsp_msg *)wcn->hal_buf;
3142 if (rsp->bss_index != vif_priv->bss_index) {
3143 wcn36xx_err("gtk_offload_info invalid response bss index %d\n",
3148 if (vif_priv->rekey_data.replay_ctr != cpu_to_le64(rsp->key_replay_counter)) {
3149 replay_ctr = cpu_to_be64(rsp->key_replay_counter);
3150 vif_priv->rekey_data.replay_ctr =
3151 cpu_to_le64(rsp->key_replay_counter);
3152 ieee80211_gtk_rekey_notify(vif, vif->bss_conf.bssid,
3153 (void *)&replay_ctr, GFP_KERNEL);
3154 wcn36xx_dbg(WCN36XX_DBG_HAL,
3155 "GTK replay counter increment %llu\n",
3156 rsp->key_replay_counter);
3159 wcn36xx_dbg(WCN36XX_DBG_HAL,
3160 "gtk offload info status %d last_rekey_status %d "
3161 "replay_counter %llu total_rekey_count %d gtk_rekey_count %d "
3162 "igtk_rekey_count %d bss_index %d\n",
3163 rsp->status, rsp->last_rekey_status,
3164 rsp->key_replay_counter, rsp->total_rekey_count,
3165 rsp->gtk_rekey_count, rsp->igtk_rekey_count,
3171 int wcn36xx_smd_gtk_offload_get_info(struct wcn36xx *wcn,
3172 struct ieee80211_vif *vif)
3174 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
3175 struct wcn36xx_hal_gtk_offload_get_info_req_msg msg_body;
3178 mutex_lock(&wcn->hal_mutex);
3180 INIT_HAL_MSG(msg_body, WCN36XX_HAL_GTK_OFFLOAD_GETINFO_REQ);
3182 msg_body.bss_index = vif_priv->bss_index;
3184 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
3186 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
3188 wcn36xx_err("Sending gtk_offload_get_info failed\n");
3191 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
3193 wcn36xx_err("gtk_offload_get_info failed err=%d\n", ret);
3196 ret = wcn36xx_smd_gtk_offload_get_info_rsp(wcn, vif);
3198 mutex_unlock(&wcn->hal_mutex);
3202 int wcn36xx_smd_wlan_host_suspend_ind(struct wcn36xx *wcn)
3204 struct wcn36xx_hal_wlan_host_suspend_ind_msg msg_body;
3207 mutex_lock(&wcn->hal_mutex);
3209 INIT_HAL_MSG(msg_body, WCN36XX_HAL_HOST_SUSPEND_IND);
3210 msg_body.configured_mcst_bcst_filter_setting = 0;
3211 msg_body.active_session_count = 1;
3212 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
3214 ret = rpmsg_send(wcn->smd_channel, wcn->hal_buf, msg_body.header.len);
3216 mutex_unlock(&wcn->hal_mutex);
3221 int wcn36xx_smd_host_resume(struct wcn36xx *wcn)
3223 struct wcn36xx_hal_wlan_host_resume_req_msg msg_body;
3224 struct wcn36xx_hal_host_resume_rsp_msg *rsp;
3227 mutex_lock(&wcn->hal_mutex);
3229 INIT_HAL_MSG(msg_body, WCN36XX_HAL_HOST_RESUME_REQ);
3230 msg_body.configured_mcst_bcst_filter_setting = 0;
3232 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
3234 ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
3236 wcn36xx_err("Sending wlan_host_resume failed\n");
3239 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
3241 wcn36xx_err("wlan_host_resume err=%d\n", ret);
3245 rsp = (struct wcn36xx_hal_host_resume_rsp_msg *)wcn->hal_buf;
3247 wcn36xx_warn("wlan_host_resume status=%d\n", rsp->status);
3250 mutex_unlock(&wcn->hal_mutex);
3255 #define BEACON_FILTER(eid, presence, offs, val, mask, ref_val) \
3257 .element_id = eid, \
3258 .check_ie_presence = presence, \
3265 static const struct beacon_filter_ie bcn_filter_ies[] = {
3266 BEACON_FILTER(WLAN_EID_DS_PARAMS, 0, 0, 0,
3267 WCN36XX_FILTER_IE_DS_CHANNEL_MASK, 0),
3268 BEACON_FILTER(WLAN_EID_ERP_INFO, 0, 0, 0,
3269 WCN36XX_FILTER_IE_ERP_FILTER_MASK, 0),
3270 BEACON_FILTER(WLAN_EID_EDCA_PARAM_SET, 0, 0, 0,
3271 WCN36XX_FILTER_IE_EDCA_FILTER_MASK, 0),
3272 BEACON_FILTER(WLAN_EID_QOS_CAPA, 0, 0, 0,
3273 WCN36XX_FILTER_IE_QOS_FILTER_MASK, 0),
3274 BEACON_FILTER(WLAN_EID_CHANNEL_SWITCH, 1, 0, 0,
3275 WCN36XX_FILTER_IE_CHANNEL_SWITCH_MASK, 0),
3276 BEACON_FILTER(WLAN_EID_HT_OPERATION, 0, 0, 0,
3277 WCN36XX_FILTER_IE_HT_BYTE0_FILTER_MASK, 0),
3278 BEACON_FILTER(WLAN_EID_HT_OPERATION, 0, 2, 0,
3279 WCN36XX_FILTER_IE_HT_BYTE2_FILTER_MASK, 0),
3280 BEACON_FILTER(WLAN_EID_HT_OPERATION, 0, 5, 0,
3281 WCN36XX_FILTER_IE_HT_BYTE5_FILTER_MASK, 0),
3282 BEACON_FILTER(WLAN_EID_PWR_CONSTRAINT, 0, 0, 0,
3283 WCN36XX_FILTER_IE_PWR_CONSTRAINT_MASK, 0),
3284 BEACON_FILTER(WLAN_EID_OPMODE_NOTIF, 0, 0, 0,
3285 WCN36XX_FILTER_IE_OPMODE_NOTIF_MASK, 0),
3286 BEACON_FILTER(WLAN_EID_VHT_OPERATION, 0, 0, 0,
3287 WCN36XX_FILTER_IE_VHTOP_CHWIDTH_MASK, 0),
3288 BEACON_FILTER(WLAN_EID_RSN, 1, 0, 0,
3289 WCN36XX_FILTER_IE_RSN_MASK, 0),
3290 BEACON_FILTER(WLAN_EID_VENDOR_SPECIFIC, 1, 0, 0,
3291 WCN36XX_FILTER_IE_VENDOR_MASK, 0),
3294 int wcn36xx_smd_add_beacon_filter(struct wcn36xx *wcn,
3295 struct ieee80211_vif *vif)
3297 struct wcn36xx_hal_add_bcn_filter_req_msg msg_body, *body;
3298 struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
3300 size_t payload_size;
3303 if (!get_feat_caps(wcn->fw_feat_caps, BCN_FILTER))
3306 mutex_lock(&wcn->hal_mutex);
3307 INIT_HAL_MSG(msg_body, WCN36XX_HAL_ADD_BCN_FILTER_REQ);
3309 PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
3311 body = (struct wcn36xx_hal_add_bcn_filter_req_msg *)wcn->hal_buf;
3312 body->capability_info = vif->bss_conf.assoc_capability;
3313 body->capability_mask = WCN36XX_FILTER_CAPABILITY_MASK;
3314 body->beacon_interval = vif->bss_conf.beacon_int;
3315 body->ie_num = ARRAY_SIZE(bcn_filter_ies);
3316 body->bss_index = vif_priv->bss_index;
3318 payload = ((u8 *)body) + body->header.len;
3319 payload_size = sizeof(bcn_filter_ies);
3320 memcpy(payload, &bcn_filter_ies, payload_size);
3322 body->header.len += payload_size;
3324 ret = wcn36xx_smd_send_and_wait(wcn, body->header.len);
3326 wcn36xx_err("Sending add bcn_filter failed\n");
3330 ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
3332 wcn36xx_err("add bcn filter response failed err=%d\n", ret);
3336 mutex_unlock(&wcn->hal_mutex);
3340 int wcn36xx_smd_rsp_process(struct rpmsg_device *rpdev,
3341 void *buf, int len, void *priv, u32 addr)
3343 const struct wcn36xx_hal_msg_header *msg_header = buf;
3344 struct ieee80211_hw *hw = priv;
3345 struct wcn36xx *wcn = hw->priv;
3346 struct wcn36xx_hal_ind_msg *msg_ind;
3347 wcn36xx_dbg_dump(WCN36XX_DBG_SMD_DUMP, "SMD <<< ", buf, len);
3349 switch (msg_header->msg_type) {
3350 case WCN36XX_HAL_START_RSP:
3351 case WCN36XX_HAL_CONFIG_STA_RSP:
3352 case WCN36XX_HAL_CONFIG_BSS_RSP:
3353 case WCN36XX_HAL_ADD_STA_SELF_RSP:
3354 case WCN36XX_HAL_STOP_RSP:
3355 case WCN36XX_HAL_DEL_STA_SELF_RSP:
3356 case WCN36XX_HAL_DELETE_STA_RSP:
3357 case WCN36XX_HAL_INIT_SCAN_RSP:
3358 case WCN36XX_HAL_START_SCAN_RSP:
3359 case WCN36XX_HAL_END_SCAN_RSP:
3360 case WCN36XX_HAL_FINISH_SCAN_RSP:
3361 case WCN36XX_HAL_DOWNLOAD_NV_RSP:
3362 case WCN36XX_HAL_DELETE_BSS_RSP:
3363 case WCN36XX_HAL_SEND_BEACON_RSP:
3364 case WCN36XX_HAL_SET_LINK_ST_RSP:
3365 case WCN36XX_HAL_UPDATE_PROBE_RSP_TEMPLATE_RSP:
3366 case WCN36XX_HAL_SET_BSSKEY_RSP:
3367 case WCN36XX_HAL_SET_STAKEY_RSP:
3368 case WCN36XX_HAL_RMV_STAKEY_RSP:
3369 case WCN36XX_HAL_RMV_BSSKEY_RSP:
3370 case WCN36XX_HAL_ENTER_BMPS_RSP:
3371 case WCN36XX_HAL_SET_POWER_PARAMS_RSP:
3372 case WCN36XX_HAL_EXIT_BMPS_RSP:
3373 case WCN36XX_HAL_KEEP_ALIVE_RSP:
3374 case WCN36XX_HAL_DUMP_COMMAND_RSP:
3375 case WCN36XX_HAL_ADD_BA_SESSION_RSP:
3376 case WCN36XX_HAL_ADD_BA_RSP:
3377 case WCN36XX_HAL_DEL_BA_RSP:
3378 case WCN36XX_HAL_GET_STATS_RSP:
3379 case WCN36XX_HAL_TRIGGER_BA_RSP:
3380 case WCN36XX_HAL_UPDATE_CFG_RSP:
3381 case WCN36XX_HAL_JOIN_RSP:
3382 case WCN36XX_HAL_UPDATE_SCAN_PARAM_RSP:
3383 case WCN36XX_HAL_CH_SWITCH_RSP:
3384 case WCN36XX_HAL_PROCESS_PTT_RSP:
3385 case WCN36XX_HAL_FEATURE_CAPS_EXCHANGE_RSP:
3386 case WCN36XX_HAL_8023_MULTICAST_LIST_RSP:
3387 case WCN36XX_HAL_START_SCAN_OFFLOAD_RSP:
3388 case WCN36XX_HAL_STOP_SCAN_OFFLOAD_RSP:
3389 case WCN36XX_HAL_HOST_OFFLOAD_RSP:
3390 case WCN36XX_HAL_GTK_OFFLOAD_RSP:
3391 case WCN36XX_HAL_GTK_OFFLOAD_GETINFO_RSP:
3392 case WCN36XX_HAL_HOST_RESUME_RSP:
3393 case WCN36XX_HAL_ENTER_IMPS_RSP:
3394 case WCN36XX_HAL_EXIT_IMPS_RSP:
3395 case WCN36XX_HAL_UPDATE_CHANNEL_LIST_RSP:
3396 case WCN36XX_HAL_ADD_BCN_FILTER_RSP:
3397 memcpy(wcn->hal_buf, buf, len);
3398 wcn->hal_rsp_len = len;
3399 complete(&wcn->hal_rsp_compl);
3402 case WCN36XX_HAL_COEX_IND:
3403 case WCN36XX_HAL_AVOID_FREQ_RANGE_IND:
3404 case WCN36XX_HAL_DEL_BA_IND:
3405 case WCN36XX_HAL_OTA_TX_COMPL_IND:
3406 case WCN36XX_HAL_MISSED_BEACON_IND:
3407 case WCN36XX_HAL_DELETE_STA_CONTEXT_IND:
3408 case WCN36XX_HAL_PRINT_REG_INFO_IND:
3409 case WCN36XX_HAL_SCAN_OFFLOAD_IND:
3410 msg_ind = kmalloc(struct_size(msg_ind, msg, len), GFP_ATOMIC);
3412 wcn36xx_err("Run out of memory while handling SMD_EVENT (%d)\n",
3413 msg_header->msg_type);
3417 msg_ind->msg_len = len;
3418 memcpy(msg_ind->msg, buf, len);
3420 spin_lock(&wcn->hal_ind_lock);
3421 list_add_tail(&msg_ind->list, &wcn->hal_ind_queue);
3422 queue_work(wcn->hal_ind_wq, &wcn->hal_ind_work);
3423 spin_unlock(&wcn->hal_ind_lock);
3424 wcn36xx_dbg(WCN36XX_DBG_HAL, "indication arrived\n");
3427 wcn36xx_err("SMD_EVENT (%d) not supported\n",
3428 msg_header->msg_type);
3434 static void wcn36xx_ind_smd_work(struct work_struct *work)
3436 struct wcn36xx *wcn =
3437 container_of(work, struct wcn36xx, hal_ind_work);
3440 struct wcn36xx_hal_msg_header *msg_header;
3441 struct wcn36xx_hal_ind_msg *hal_ind_msg;
3442 unsigned long flags;
3444 spin_lock_irqsave(&wcn->hal_ind_lock, flags);
3446 if (list_empty(&wcn->hal_ind_queue)) {
3447 spin_unlock_irqrestore(&wcn->hal_ind_lock, flags);
3451 hal_ind_msg = list_first_entry(&wcn->hal_ind_queue,
3452 struct wcn36xx_hal_ind_msg,
3454 list_del(&hal_ind_msg->list);
3455 spin_unlock_irqrestore(&wcn->hal_ind_lock, flags);
3457 msg_header = (struct wcn36xx_hal_msg_header *)hal_ind_msg->msg;
3459 switch (msg_header->msg_type) {
3460 case WCN36XX_HAL_COEX_IND:
3461 case WCN36XX_HAL_DEL_BA_IND:
3462 case WCN36XX_HAL_AVOID_FREQ_RANGE_IND:
3464 case WCN36XX_HAL_OTA_TX_COMPL_IND:
3465 wcn36xx_smd_tx_compl_ind(wcn,
3467 hal_ind_msg->msg_len);
3469 case WCN36XX_HAL_MISSED_BEACON_IND:
3470 wcn36xx_smd_missed_beacon_ind(wcn,
3472 hal_ind_msg->msg_len);
3474 case WCN36XX_HAL_DELETE_STA_CONTEXT_IND:
3475 wcn36xx_smd_delete_sta_context_ind(wcn,
3477 hal_ind_msg->msg_len);
3479 case WCN36XX_HAL_PRINT_REG_INFO_IND:
3480 wcn36xx_smd_print_reg_info_ind(wcn,
3482 hal_ind_msg->msg_len);
3484 case WCN36XX_HAL_SCAN_OFFLOAD_IND:
3485 wcn36xx_smd_hw_scan_ind(wcn, hal_ind_msg->msg,
3486 hal_ind_msg->msg_len);
3489 wcn36xx_err("SMD_EVENT (%d) not supported\n",
3490 msg_header->msg_type);
3497 int wcn36xx_smd_open(struct wcn36xx *wcn)
3499 wcn->hal_ind_wq = create_freezable_workqueue("wcn36xx_smd_ind");
3500 if (!wcn->hal_ind_wq)
3503 INIT_WORK(&wcn->hal_ind_work, wcn36xx_ind_smd_work);
3504 INIT_LIST_HEAD(&wcn->hal_ind_queue);
3505 spin_lock_init(&wcn->hal_ind_lock);
3510 void wcn36xx_smd_close(struct wcn36xx *wcn)
3512 struct wcn36xx_hal_ind_msg *msg, *tmp;
3514 cancel_work_sync(&wcn->hal_ind_work);
3515 destroy_workqueue(wcn->hal_ind_wq);
3517 list_for_each_entry_safe(msg, tmp, &wcn->hal_ind_queue, list)