1 /*
2  * NXP Wireless LAN device driver: AP event handling
3  *
4  * Copyright 2011-2020 NXP
5  *
6  * This software file (the "File") is distributed by NXP
7  * under the terms of the GNU General Public License Version 2, June 1991
8  * (the "License").  You may use, redistribute and/or modify this File in
9  * accordance with the terms and conditions of the License, a copy of which
10  * is available by writing to the Free Software Foundation, Inc.,
11  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
12  * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
13  *
14  * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
15  * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
16  * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about
17  * this warranty disclaimer.
18  */
19 
20 #include "decl.h"
21 #include "main.h"
22 #include "11n.h"
23 
24 #define MWIFIEX_BSS_START_EVT_FIX_SIZE    12
25 
mwifiex_check_uap_capabilities(struct mwifiex_private * priv,struct sk_buff * event)26 static int mwifiex_check_uap_capabilities(struct mwifiex_private *priv,
27 					  struct sk_buff *event)
28 {
29 	int evt_len;
30 	u8 *curr;
31 	u16 tlv_len;
32 	struct mwifiex_ie_types_data *tlv_hdr;
33 	struct ieee_types_wmm_parameter *wmm_param_ie = NULL;
34 	int mask = IEEE80211_WMM_IE_AP_QOSINFO_PARAM_SET_CNT_MASK;
35 
36 	priv->wmm_enabled = false;
37 	skb_pull(event, MWIFIEX_BSS_START_EVT_FIX_SIZE);
38 	evt_len = event->len;
39 	curr = event->data;
40 
41 	mwifiex_dbg_dump(priv->adapter, EVT_D, "uap capabilities:",
42 			 event->data, event->len);
43 
44 	skb_push(event, MWIFIEX_BSS_START_EVT_FIX_SIZE);
45 
46 	while ((evt_len >= sizeof(tlv_hdr->header))) {
47 		tlv_hdr = (struct mwifiex_ie_types_data *)curr;
48 		tlv_len = le16_to_cpu(tlv_hdr->header.len);
49 
50 		if (evt_len < tlv_len + sizeof(tlv_hdr->header))
51 			break;
52 
53 		switch (le16_to_cpu(tlv_hdr->header.type)) {
54 		case WLAN_EID_HT_CAPABILITY:
55 			priv->ap_11n_enabled = true;
56 			break;
57 
58 		case WLAN_EID_VHT_CAPABILITY:
59 			priv->ap_11ac_enabled = true;
60 			break;
61 
62 		case WLAN_EID_VENDOR_SPECIFIC:
63 			/* Point the regular IEEE IE 2 bytes into the Marvell IE
64 			 * and setup the IEEE IE type and length byte fields
65 			 */
66 			wmm_param_ie = (void *)(curr + 2);
67 			wmm_param_ie->vend_hdr.len = (u8)tlv_len;
68 			wmm_param_ie->vend_hdr.element_id =
69 						WLAN_EID_VENDOR_SPECIFIC;
70 			mwifiex_dbg(priv->adapter, EVENT,
71 				    "info: check uap capabilities:\t"
72 				    "wmm parameter set count: %d\n",
73 				    wmm_param_ie->qos_info_bitmap & mask);
74 
75 			mwifiex_wmm_setup_ac_downgrade(priv);
76 			priv->wmm_enabled = true;
77 			mwifiex_wmm_setup_queue_priorities(priv, wmm_param_ie);
78 			break;
79 
80 		default:
81 			break;
82 		}
83 
84 		curr += (tlv_len + sizeof(tlv_hdr->header));
85 		evt_len -= (tlv_len + sizeof(tlv_hdr->header));
86 	}
87 
88 	return 0;
89 }
90 
91 /*
92  * This function handles AP interface specific events generated by firmware.
93  *
94  * Event specific routines are called by this function based
95  * upon the generated event cause.
96  *
97  *
98  * Events supported for AP -
99  *      - EVENT_UAP_STA_ASSOC
100  *      - EVENT_UAP_STA_DEAUTH
101  *      - EVENT_UAP_BSS_ACTIVE
102  *      - EVENT_UAP_BSS_START
103  *      - EVENT_UAP_BSS_IDLE
104  *      - EVENT_UAP_MIC_COUNTERMEASURES:
105  */
mwifiex_process_uap_event(struct mwifiex_private * priv)106 int mwifiex_process_uap_event(struct mwifiex_private *priv)
107 {
108 	struct mwifiex_adapter *adapter = priv->adapter;
109 	int len, i;
110 	u32 eventcause = adapter->event_cause;
111 	struct station_info *sinfo;
112 	struct mwifiex_assoc_event *event;
113 	struct mwifiex_sta_node *node;
114 	u8 *deauth_mac;
115 	struct host_cmd_ds_11n_batimeout *ba_timeout;
116 	u16 ctrl;
117 
118 	switch (eventcause) {
119 	case EVENT_UAP_STA_ASSOC:
120 		sinfo = kzalloc(sizeof(*sinfo), GFP_KERNEL);
121 		if (!sinfo)
122 			return -ENOMEM;
123 
124 		event = (struct mwifiex_assoc_event *)
125 			(adapter->event_body + MWIFIEX_UAP_EVENT_EXTRA_HEADER);
126 		if (le16_to_cpu(event->type) == TLV_TYPE_UAP_MGMT_FRAME) {
127 			len = -1;
128 
129 			if (ieee80211_is_assoc_req(event->frame_control))
130 				len = 0;
131 			else if (ieee80211_is_reassoc_req(event->frame_control))
132 				/* There will be ETH_ALEN bytes of
133 				 * current_ap_addr before the re-assoc ies.
134 				 */
135 				len = ETH_ALEN;
136 
137 			if (len != -1) {
138 				sinfo->assoc_req_ies = &event->data[len];
139 				len = (u8 *)sinfo->assoc_req_ies -
140 				      (u8 *)&event->frame_control;
141 				sinfo->assoc_req_ies_len =
142 					le16_to_cpu(event->len) - (u16)len;
143 			}
144 		}
145 		cfg80211_new_sta(priv->netdev, event->sta_addr, sinfo,
146 				 GFP_KERNEL);
147 
148 		node = mwifiex_add_sta_entry(priv, event->sta_addr);
149 		if (!node) {
150 			mwifiex_dbg(adapter, ERROR,
151 				    "could not create station entry!\n");
152 			kfree(sinfo);
153 			return -1;
154 		}
155 
156 		if (!priv->ap_11n_enabled) {
157 			kfree(sinfo);
158 			break;
159 		}
160 
161 		mwifiex_set_sta_ht_cap(priv, sinfo->assoc_req_ies,
162 				       sinfo->assoc_req_ies_len, node);
163 
164 		for (i = 0; i < MAX_NUM_TID; i++) {
165 			if (node->is_11n_enabled)
166 				node->ampdu_sta[i] =
167 					      priv->aggr_prio_tbl[i].ampdu_user;
168 			else
169 				node->ampdu_sta[i] = BA_STREAM_NOT_ALLOWED;
170 		}
171 		memset(node->rx_seq, 0xff, sizeof(node->rx_seq));
172 		kfree(sinfo);
173 		break;
174 	case EVENT_UAP_STA_DEAUTH:
175 		deauth_mac = adapter->event_body +
176 			     MWIFIEX_UAP_EVENT_EXTRA_HEADER;
177 		cfg80211_del_sta(priv->netdev, deauth_mac, GFP_KERNEL);
178 
179 		if (priv->ap_11n_enabled) {
180 			mwifiex_11n_del_rx_reorder_tbl_by_ta(priv, deauth_mac);
181 			mwifiex_del_tx_ba_stream_tbl_by_ra(priv, deauth_mac);
182 		}
183 		mwifiex_wmm_del_peer_ra_list(priv, deauth_mac);
184 		mwifiex_del_sta_entry(priv, deauth_mac);
185 		break;
186 	case EVENT_UAP_BSS_IDLE:
187 		priv->media_connected = false;
188 		priv->port_open = false;
189 		mwifiex_clean_txrx(priv);
190 		mwifiex_del_all_sta_list(priv);
191 		break;
192 	case EVENT_UAP_BSS_ACTIVE:
193 		priv->media_connected = true;
194 		priv->port_open = true;
195 		break;
196 	case EVENT_UAP_BSS_START:
197 		mwifiex_dbg(adapter, EVENT,
198 			    "AP EVENT: event id: %#x\n", eventcause);
199 		priv->port_open = false;
200 		eth_hw_addr_set(priv->netdev, adapter->event_body + 2);
201 		if (priv->hist_data)
202 			mwifiex_hist_data_reset(priv);
203 		mwifiex_check_uap_capabilities(priv, adapter->event_skb);
204 		break;
205 	case EVENT_UAP_MIC_COUNTERMEASURES:
206 		/* For future development */
207 		mwifiex_dbg(adapter, EVENT,
208 			    "AP EVENT: event id: %#x\n", eventcause);
209 		break;
210 	case EVENT_AMSDU_AGGR_CTRL:
211 		ctrl = get_unaligned_le16(adapter->event_body);
212 		mwifiex_dbg(adapter, EVENT,
213 			    "event: AMSDU_AGGR_CTRL %d\n", ctrl);
214 
215 		if (priv->media_connected) {
216 			adapter->tx_buf_size =
217 				min_t(u16, adapter->curr_tx_buf_size, ctrl);
218 			mwifiex_dbg(adapter, EVENT,
219 				    "event: tx_buf_size %d\n",
220 				    adapter->tx_buf_size);
221 		}
222 		break;
223 	case EVENT_ADDBA:
224 		mwifiex_dbg(adapter, EVENT, "event: ADDBA Request\n");
225 		if (priv->media_connected)
226 			mwifiex_send_cmd(priv, HostCmd_CMD_11N_ADDBA_RSP,
227 					 HostCmd_ACT_GEN_SET, 0,
228 					 adapter->event_body, false);
229 		break;
230 	case EVENT_DELBA:
231 		mwifiex_dbg(adapter, EVENT, "event: DELBA Request\n");
232 		if (priv->media_connected)
233 			mwifiex_11n_delete_ba_stream(priv, adapter->event_body);
234 		break;
235 	case EVENT_BA_STREAM_TIEMOUT:
236 		mwifiex_dbg(adapter, EVENT, "event:  BA Stream timeout\n");
237 		if (priv->media_connected) {
238 			ba_timeout = (void *)adapter->event_body;
239 			mwifiex_11n_ba_stream_timeout(priv, ba_timeout);
240 		}
241 		break;
242 	case EVENT_EXT_SCAN_REPORT:
243 		mwifiex_dbg(adapter, EVENT, "event: EXT_SCAN Report\n");
244 		if (adapter->ext_scan)
245 			return mwifiex_handle_event_ext_scan_report(priv,
246 						adapter->event_skb->data);
247 		break;
248 	case EVENT_TX_STATUS_REPORT:
249 		mwifiex_dbg(adapter, EVENT, "event: TX_STATUS Report\n");
250 		mwifiex_parse_tx_status_event(priv, adapter->event_body);
251 		break;
252 	case EVENT_PS_SLEEP:
253 		mwifiex_dbg(adapter, EVENT, "info: EVENT: SLEEP\n");
254 
255 		adapter->ps_state = PS_STATE_PRE_SLEEP;
256 
257 		mwifiex_check_ps_cond(adapter);
258 		break;
259 
260 	case EVENT_PS_AWAKE:
261 		mwifiex_dbg(adapter, EVENT, "info: EVENT: AWAKE\n");
262 		if (!adapter->pps_uapsd_mode &&
263 		    priv->media_connected && adapter->sleep_period.period) {
264 				adapter->pps_uapsd_mode = true;
265 				mwifiex_dbg(adapter, EVENT,
266 					    "event: PPS/UAPSD mode activated\n");
267 		}
268 		adapter->tx_lock_flag = false;
269 		if (adapter->pps_uapsd_mode && adapter->gen_null_pkt) {
270 			if (mwifiex_check_last_packet_indication(priv)) {
271 				if (adapter->data_sent ||
272 				    (adapter->if_ops.is_port_ready &&
273 				     !adapter->if_ops.is_port_ready(priv))) {
274 					adapter->ps_state = PS_STATE_AWAKE;
275 					adapter->pm_wakeup_card_req = false;
276 					adapter->pm_wakeup_fw_try = false;
277 					break;
278 				}
279 				if (!mwifiex_send_null_packet
280 					(priv,
281 					 MWIFIEX_TxPD_POWER_MGMT_NULL_PACKET |
282 					 MWIFIEX_TxPD_POWER_MGMT_LAST_PACKET))
283 						adapter->ps_state =
284 							PS_STATE_SLEEP;
285 					return 0;
286 			}
287 		}
288 		adapter->ps_state = PS_STATE_AWAKE;
289 		adapter->pm_wakeup_card_req = false;
290 		adapter->pm_wakeup_fw_try = false;
291 		break;
292 
293 	case EVENT_CHANNEL_REPORT_RDY:
294 		mwifiex_dbg(adapter, EVENT, "event: Channel Report\n");
295 		mwifiex_11h_handle_chanrpt_ready(priv, adapter->event_skb);
296 		break;
297 	case EVENT_RADAR_DETECTED:
298 		mwifiex_dbg(adapter, EVENT, "event: Radar detected\n");
299 		mwifiex_11h_handle_radar_detected(priv, adapter->event_skb);
300 		break;
301 	case EVENT_BT_COEX_WLAN_PARA_CHANGE:
302 		mwifiex_dbg(adapter, EVENT, "event: BT coex wlan param update\n");
303 		mwifiex_bt_coex_wlan_param_update_event(priv,
304 							adapter->event_skb);
305 		break;
306 	case EVENT_TX_DATA_PAUSE:
307 		mwifiex_dbg(adapter, EVENT, "event: TX DATA PAUSE\n");
308 		mwifiex_process_tx_pause_event(priv, adapter->event_skb);
309 		break;
310 
311 	case EVENT_MULTI_CHAN_INFO:
312 		mwifiex_dbg(adapter, EVENT, "event: multi-chan info\n");
313 		mwifiex_process_multi_chan_event(priv, adapter->event_skb);
314 		break;
315 	case EVENT_RXBA_SYNC:
316 		dev_dbg(adapter->dev, "EVENT: RXBA_SYNC\n");
317 		mwifiex_11n_rxba_sync_event(priv, adapter->event_body,
318 					    adapter->event_skb->len -
319 					    sizeof(eventcause));
320 		break;
321 
322 	case EVENT_REMAIN_ON_CHAN_EXPIRED:
323 		mwifiex_dbg(adapter, EVENT,
324 			    "event: uap: Remain on channel expired\n");
325 		cfg80211_remain_on_channel_expired(&priv->wdev,
326 						   priv->roc_cfg.cookie,
327 						   &priv->roc_cfg.chan,
328 						   GFP_ATOMIC);
329 		memset(&priv->roc_cfg, 0x00, sizeof(struct mwifiex_roc_cfg));
330 		break;
331 
332 	default:
333 		mwifiex_dbg(adapter, EVENT,
334 			    "event: unknown event id: %#x\n", eventcause);
335 		break;
336 	}
337 
338 	return 0;
339 }
340 
341 /* This function deletes station entry from associated station list.
342  * Also if both AP and STA are 11n enabled, RxReorder tables and TxBA stream
343  * tables created for this station are deleted.
344  */
mwifiex_uap_del_sta_data(struct mwifiex_private * priv,struct mwifiex_sta_node * node)345 void mwifiex_uap_del_sta_data(struct mwifiex_private *priv,
346 			      struct mwifiex_sta_node *node)
347 {
348 	if (priv->ap_11n_enabled && node->is_11n_enabled) {
349 		mwifiex_11n_del_rx_reorder_tbl_by_ta(priv, node->mac_addr);
350 		mwifiex_del_tx_ba_stream_tbl_by_ra(priv, node->mac_addr);
351 	}
352 	mwifiex_del_sta_entry(priv, node->mac_addr);
353 
354 	return;
355 }
356