1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * NXP Wireless LAN device driver: AP event handling
4 *
5 * Copyright 2011-2024 NXP
6 */
7
8 #include "cfg.h"
9 #include "main.h"
10 #include "cmdevt.h"
11 #include "11n.h"
12
13 #define NXPWIFI_BSS_START_EVT_FIX_SIZE 12
14
15 static int
nxpwifi_uap_event_ps_awake(struct nxpwifi_private * priv)16 nxpwifi_uap_event_ps_awake(struct nxpwifi_private *priv)
17 {
18 struct nxpwifi_adapter *adapter = priv->adapter;
19
20 if (!adapter->pps_uapsd_mode &&
21 priv->media_connected && adapter->sleep_period.period) {
22 adapter->pps_uapsd_mode = true;
23 nxpwifi_dbg(adapter, EVENT,
24 "event: PPS/UAPSD mode activated\n");
25 }
26 adapter->tx_lock_flag = false;
27 if (adapter->pps_uapsd_mode && adapter->gen_null_pkt) {
28 if (nxpwifi_check_last_packet_indication(priv)) {
29 if (adapter->data_sent) {
30 adapter->ps_state = PS_STATE_AWAKE;
31 adapter->pm_wakeup_card_req = false;
32 adapter->pm_wakeup_fw_try = false;
33 } else {
34 if (!nxpwifi_send_null_packet
35 (priv,
36 NXPWIFI_TxPD_POWER_MGMT_NULL_PACKET |
37 NXPWIFI_TxPD_POWER_MGMT_LAST_PACKET))
38 adapter->ps_state = PS_STATE_SLEEP;
39 }
40
41 return 0;
42 }
43 }
44
45 adapter->ps_state = PS_STATE_AWAKE;
46 adapter->pm_wakeup_card_req = false;
47 adapter->pm_wakeup_fw_try = false;
48
49 return 0;
50 }
51
52 static int
nxpwifi_uap_event_ps_sleep(struct nxpwifi_private * priv)53 nxpwifi_uap_event_ps_sleep(struct nxpwifi_private *priv)
54 {
55 struct nxpwifi_adapter *adapter = priv->adapter;
56
57 adapter->ps_state = PS_STATE_PRE_SLEEP;
58 nxpwifi_check_ps_cond(adapter);
59
60 return 0;
61 }
62
63 static int
nxpwifi_uap_event_sta_deauth(struct nxpwifi_private * priv)64 nxpwifi_uap_event_sta_deauth(struct nxpwifi_private *priv)
65 {
66 struct nxpwifi_adapter *adapter = priv->adapter;
67 u8 *deauth_mac;
68
69 deauth_mac = adapter->event_body +
70 NXPWIFI_UAP_EVENT_EXTRA_HEADER;
71 cfg80211_del_sta(priv->netdev->ieee80211_ptr, deauth_mac, GFP_KERNEL);
72
73 if (priv->ap_11n_enabled) {
74 nxpwifi_11n_del_rx_reorder_tbl_by_ta(priv, deauth_mac);
75 nxpwifi_del_tx_ba_stream_tbl_by_ra(priv, deauth_mac);
76 }
77 nxpwifi_wmm_del_peer_ra_list(priv, deauth_mac);
78
79 return 0;
80 }
81
82 static int
nxpwifi_uap_event_sta_assoc(struct nxpwifi_private * priv)83 nxpwifi_uap_event_sta_assoc(struct nxpwifi_private *priv)
84 {
85 struct nxpwifi_adapter *adapter = priv->adapter;
86 struct station_info *sinfo;
87 struct nxpwifi_assoc_event *event;
88 struct nxpwifi_sta_node *node;
89 int len, i;
90
91 sinfo = kzalloc_obj(*sinfo, GFP_KERNEL);
92 if (!sinfo)
93 return -ENOMEM;
94
95 event = (struct nxpwifi_assoc_event *)
96 (adapter->event_body + NXPWIFI_UAP_EVENT_EXTRA_HEADER);
97 if (le16_to_cpu(event->type) == TLV_TYPE_UAP_MGMT_FRAME) {
98 len = -1;
99
100 if (ieee80211_is_assoc_req(event->frame_control))
101 len = 0;
102 else if (ieee80211_is_reassoc_req(event->frame_control))
103 /*
104 * There will be ETH_ALEN bytes of
105 * current_ap_addr before the re-assoc ies.
106 */
107 len = ETH_ALEN;
108
109 if (len != -1) {
110 u16 evt_len = le16_to_cpu(event->len);
111
112 sinfo->assoc_req_ies = &event->data[len];
113 len = (u8 *)sinfo->assoc_req_ies -
114 (u8 *)&event->frame_control;
115
116 /*
117 * event->len is reported by the device firmware
118 * and is not otherwise validated. Reject a length
119 * that underflows the header or that would place
120 * the association request IEs outside the fixed
121 * event_body[] buffer.
122 */
123 if (evt_len < len ||
124 (u8 *)&event->frame_control + evt_len >
125 adapter->event_body + MAX_EVENT_SIZE) {
126 nxpwifi_dbg(adapter, ERROR,
127 "invalid STA assoc event length\n");
128 kfree(sinfo);
129 return -EINVAL;
130 }
131
132 sinfo->assoc_req_ies_len = evt_len - (u16)len;
133 }
134 }
135 cfg80211_new_sta(priv->netdev->ieee80211_ptr, event->sta_addr, sinfo,
136 GFP_KERNEL);
137
138 node = nxpwifi_add_sta_entry(priv, event->sta_addr);
139 if (!node) {
140 nxpwifi_dbg(adapter, ERROR,
141 "could not create station entry!\n");
142 kfree(sinfo);
143 return -ENOENT;
144 }
145
146 if (!priv->ap_11n_enabled) {
147 kfree(sinfo);
148 return 0;
149 }
150
151 nxpwifi_set_sta_ht_cap(priv, sinfo->assoc_req_ies,
152 sinfo->assoc_req_ies_len, node);
153
154 for (i = 0; i < MAX_NUM_TID; i++) {
155 if (node->is_11n_enabled || node->is_11ax_enabled)
156 node->ampdu_sta[i] =
157 priv->aggr_prio_tbl[i].ampdu_user;
158 else
159 node->ampdu_sta[i] = BA_STREAM_NOT_ALLOWED;
160 }
161 memset(node->rx_seq, 0xff, sizeof(node->rx_seq));
162 kfree(sinfo);
163
164 return 0;
165 }
166
167 static int
nxpwifi_check_uap_capabilities(struct nxpwifi_private * priv,struct sk_buff * event)168 nxpwifi_check_uap_capabilities(struct nxpwifi_private *priv,
169 struct sk_buff *event)
170 {
171 int evt_len;
172 u8 *curr;
173 u16 tlv_len;
174 struct nxpwifi_ie_types_data *tlv_hdr;
175 struct ieee80211_wmm_param_ie *wmm_param_ie = NULL;
176 int mask = IEEE80211_WMM_IE_AP_QOSINFO_PARAM_SET_CNT_MASK;
177
178 priv->wmm_enabled = false;
179 skb_pull(event, NXPWIFI_BSS_START_EVT_FIX_SIZE);
180 evt_len = event->len;
181 curr = event->data;
182
183 nxpwifi_dbg_dump(priv->adapter, EVT_D, "uap capabilities:",
184 event->data, event->len);
185
186 skb_push(event, NXPWIFI_BSS_START_EVT_FIX_SIZE);
187
188 while ((evt_len >= sizeof(tlv_hdr->header))) {
189 tlv_hdr = (struct nxpwifi_ie_types_data *)curr;
190 tlv_len = le16_to_cpu(tlv_hdr->header.len);
191
192 if (evt_len < tlv_len + sizeof(tlv_hdr->header))
193 break;
194
195 switch (le16_to_cpu(tlv_hdr->header.type)) {
196 case WLAN_EID_HT_CAPABILITY:
197 priv->ap_11n_enabled = true;
198 break;
199
200 case WLAN_EID_VHT_CAPABILITY:
201 priv->ap_11ac_enabled = true;
202 break;
203
204 case WLAN_EID_VENDOR_SPECIFIC:
205 /*
206 * Point the regular IEEE element 2 bytes into the NXP element
207 * and setup the IEEE element type and length byte fields
208 */
209 wmm_param_ie = (void *)(curr + 2);
210 wmm_param_ie->len = (u8)tlv_len;
211 wmm_param_ie->element_id =
212 WLAN_EID_VENDOR_SPECIFIC;
213 nxpwifi_dbg(priv->adapter, EVENT,
214 "info: check uap capabilities:\t"
215 "wmm parameter set count: %d\n",
216 wmm_param_ie->qos_info & mask);
217
218 nxpwifi_wmm_setup_ac_downgrade(priv);
219 priv->wmm_enabled = true;
220 nxpwifi_wmm_setup_queue_priorities(priv, wmm_param_ie);
221 break;
222
223 default:
224 break;
225 }
226
227 curr += (tlv_len + sizeof(tlv_hdr->header));
228 evt_len -= (tlv_len + sizeof(tlv_hdr->header));
229 }
230
231 return 0;
232 }
233
234 static int
nxpwifi_uap_event_bss_start(struct nxpwifi_private * priv)235 nxpwifi_uap_event_bss_start(struct nxpwifi_private *priv)
236 {
237 struct nxpwifi_adapter *adapter = priv->adapter;
238
239 priv->port_open = false;
240 eth_hw_addr_set(priv->netdev, adapter->event_body + 2);
241 if (priv->hist_data)
242 nxpwifi_hist_data_reset(priv);
243 return nxpwifi_check_uap_capabilities(priv, adapter->event_skb);
244 }
245
246 static int
nxpwifi_uap_event_addba(struct nxpwifi_private * priv)247 nxpwifi_uap_event_addba(struct nxpwifi_private *priv)
248 {
249 struct nxpwifi_adapter *adapter = priv->adapter;
250
251 if (priv->media_connected)
252 nxpwifi_send_cmd(priv, HOST_CMD_11N_ADDBA_RSP,
253 HOST_ACT_GEN_SET, 0,
254 adapter->event_body, false);
255
256 return 0;
257 }
258
259 static int
nxpwifi_uap_event_delba(struct nxpwifi_private * priv)260 nxpwifi_uap_event_delba(struct nxpwifi_private *priv)
261 {
262 struct nxpwifi_adapter *adapter = priv->adapter;
263
264 if (priv->media_connected)
265 nxpwifi_11n_delete_ba_stream(priv, adapter->event_body);
266
267 return 0;
268 }
269
270 static int
nxpwifi_uap_event_ba_stream_timeout(struct nxpwifi_private * priv)271 nxpwifi_uap_event_ba_stream_timeout(struct nxpwifi_private *priv)
272 {
273 struct nxpwifi_adapter *adapter = priv->adapter;
274 struct host_cmd_ds_11n_batimeout *ba_timeout;
275
276 if (priv->media_connected) {
277 ba_timeout = (void *)adapter->event_body;
278 nxpwifi_11n_ba_stream_timeout(priv, ba_timeout);
279 }
280
281 return 0;
282 }
283
284 static int
nxpwifi_uap_event_amsdu_aggr_ctrl(struct nxpwifi_private * priv)285 nxpwifi_uap_event_amsdu_aggr_ctrl(struct nxpwifi_private *priv)
286 {
287 struct nxpwifi_adapter *adapter = priv->adapter;
288 u16 ctrl;
289
290 ctrl = get_unaligned_le16(adapter->event_body);
291 nxpwifi_dbg(adapter, EVENT,
292 "event: AMSDU_AGGR_CTRL %d\n", ctrl);
293
294 if (priv->media_connected) {
295 adapter->tx_buf_size =
296 min_t(u16, adapter->curr_tx_buf_size, ctrl);
297 nxpwifi_dbg(adapter, EVENT,
298 "event: tx_buf_size %d\n",
299 adapter->tx_buf_size);
300 }
301
302 return 0;
303 }
304
305 static int
nxpwifi_uap_event_bss_idle(struct nxpwifi_private * priv)306 nxpwifi_uap_event_bss_idle(struct nxpwifi_private *priv)
307 {
308 priv->media_connected = false;
309 priv->port_open = false;
310 nxpwifi_clean_txrx(priv);
311 nxpwifi_del_all_sta_list(priv);
312
313 return 0;
314 }
315
316 static int
nxpwifi_uap_event_bss_active(struct nxpwifi_private * priv)317 nxpwifi_uap_event_bss_active(struct nxpwifi_private *priv)
318 {
319 priv->media_connected = true;
320 priv->port_open = true;
321
322 return 0;
323 }
324
325 static int
nxpwifi_uap_event_mic_countermeasures(struct nxpwifi_private * priv)326 nxpwifi_uap_event_mic_countermeasures(struct nxpwifi_private *priv)
327 {
328 /* For future development */
329
330 return 0;
331 }
332
333 static int
nxpwifi_uap_event_radar_detected(struct nxpwifi_private * priv)334 nxpwifi_uap_event_radar_detected(struct nxpwifi_private *priv)
335 {
336 struct nxpwifi_adapter *adapter = priv->adapter;
337
338 return nxpwifi_11h_handle_radar_detected(priv, adapter->event_skb);
339 }
340
341 static int
nxpwifi_uap_event_channel_report_rdy(struct nxpwifi_private * priv)342 nxpwifi_uap_event_channel_report_rdy(struct nxpwifi_private *priv)
343 {
344 struct nxpwifi_adapter *adapter = priv->adapter;
345
346 return nxpwifi_11h_handle_chanrpt_ready(priv, adapter->event_skb);
347 }
348
349 static int
nxpwifi_uap_event_tx_data_pause(struct nxpwifi_private * priv)350 nxpwifi_uap_event_tx_data_pause(struct nxpwifi_private *priv)
351 {
352 struct nxpwifi_adapter *adapter = priv->adapter;
353
354 nxpwifi_process_tx_pause_event(priv, adapter->event_skb);
355
356 return 0;
357 }
358
359 static int
nxpwifi_uap_event_ext_scan_report(struct nxpwifi_private * priv)360 nxpwifi_uap_event_ext_scan_report(struct nxpwifi_private *priv)
361 {
362 struct nxpwifi_adapter *adapter = priv->adapter;
363 void *buf = adapter->event_skb->data;
364 int ret = 0;
365
366 if (adapter->ext_scan)
367 ret = nxpwifi_handle_event_ext_scan_report(priv, buf);
368
369 return ret;
370 }
371
372 static int
nxpwifi_uap_event_rxba_sync(struct nxpwifi_private * priv)373 nxpwifi_uap_event_rxba_sync(struct nxpwifi_private *priv)
374 {
375 struct nxpwifi_adapter *adapter = priv->adapter;
376
377 nxpwifi_11n_rxba_sync_event(priv, adapter->event_body,
378 adapter->event_skb->len -
379 sizeof(adapter->event_cause));
380
381 return 0;
382 }
383
384 static int
nxpwifi_uap_event_remain_on_chan_expired(struct nxpwifi_private * priv)385 nxpwifi_uap_event_remain_on_chan_expired(struct nxpwifi_private *priv)
386 {
387 cfg80211_remain_on_channel_expired(&priv->wdev,
388 priv->roc_cfg.cookie,
389 &priv->roc_cfg.chan,
390 GFP_ATOMIC);
391 memset(&priv->roc_cfg, 0x00, sizeof(struct nxpwifi_roc_cfg));
392
393 return 0;
394 }
395
396 static int
nxpwifi_uap_event_multi_chan_info(struct nxpwifi_private * priv)397 nxpwifi_uap_event_multi_chan_info(struct nxpwifi_private *priv)
398 {
399 struct nxpwifi_adapter *adapter = priv->adapter;
400
401 nxpwifi_process_multi_chan_event(priv, adapter->event_skb);
402
403 return 0;
404 }
405
406 static int
nxpwifi_uap_event_tx_status_report(struct nxpwifi_private * priv)407 nxpwifi_uap_event_tx_status_report(struct nxpwifi_private *priv)
408 {
409 struct nxpwifi_adapter *adapter = priv->adapter;
410
411 nxpwifi_parse_tx_status_event(priv, adapter->event_body);
412
413 return 0;
414 }
415
416 static int
nxpwifi_uap_event_bt_coex_wlan_para_change(struct nxpwifi_private * priv)417 nxpwifi_uap_event_bt_coex_wlan_para_change(struct nxpwifi_private *priv)
418 {
419 struct nxpwifi_adapter *adapter = priv->adapter;
420
421 nxpwifi_bt_coex_wlan_param_update_event(priv, adapter->event_skb);
422
423 return 0;
424 }
425
426 static int
nxpwifi_uap_event_vdll_ind(struct nxpwifi_private * priv)427 nxpwifi_uap_event_vdll_ind(struct nxpwifi_private *priv)
428 {
429 struct nxpwifi_adapter *adapter = priv->adapter;
430
431 return nxpwifi_process_vdll_event(priv, adapter->event_skb);
432 }
433
434 static const struct nxpwifi_evt_entry evt_table_uap[] = {
435 {.event_cause = EVENT_PS_AWAKE,
436 .event_handler = nxpwifi_uap_event_ps_awake},
437 {.event_cause = EVENT_PS_SLEEP,
438 .event_handler = nxpwifi_uap_event_ps_sleep},
439 {.event_cause = EVENT_UAP_STA_DEAUTH,
440 .event_handler = nxpwifi_uap_event_sta_deauth},
441 {.event_cause = EVENT_UAP_STA_ASSOC,
442 .event_handler = nxpwifi_uap_event_sta_assoc},
443 {.event_cause = EVENT_UAP_BSS_START,
444 .event_handler = nxpwifi_uap_event_bss_start},
445 {.event_cause = EVENT_ADDBA,
446 .event_handler = nxpwifi_uap_event_addba},
447 {.event_cause = EVENT_DELBA,
448 .event_handler = nxpwifi_uap_event_delba},
449 {.event_cause = EVENT_BA_STREAM_TIEMOUT,
450 .event_handler = nxpwifi_uap_event_ba_stream_timeout},
451 {.event_cause = EVENT_AMSDU_AGGR_CTRL,
452 .event_handler = nxpwifi_uap_event_amsdu_aggr_ctrl},
453 {.event_cause = EVENT_UAP_BSS_IDLE,
454 .event_handler = nxpwifi_uap_event_bss_idle},
455 {.event_cause = EVENT_UAP_BSS_ACTIVE,
456 .event_handler = nxpwifi_uap_event_bss_active},
457 {.event_cause = EVENT_UAP_MIC_COUNTERMEASURES,
458 .event_handler = nxpwifi_uap_event_mic_countermeasures},
459 {.event_cause = EVENT_RADAR_DETECTED,
460 .event_handler = nxpwifi_uap_event_radar_detected},
461 {.event_cause = EVENT_CHANNEL_REPORT_RDY,
462 .event_handler = nxpwifi_uap_event_channel_report_rdy},
463 {.event_cause = EVENT_TX_DATA_PAUSE,
464 .event_handler = nxpwifi_uap_event_tx_data_pause},
465 {.event_cause = EVENT_EXT_SCAN_REPORT,
466 .event_handler = nxpwifi_uap_event_ext_scan_report},
467 {.event_cause = EVENT_RXBA_SYNC,
468 .event_handler = nxpwifi_uap_event_rxba_sync},
469 {.event_cause = EVENT_REMAIN_ON_CHAN_EXPIRED,
470 .event_handler = nxpwifi_uap_event_remain_on_chan_expired},
471 {.event_cause = EVENT_MULTI_CHAN_INFO,
472 .event_handler = nxpwifi_uap_event_multi_chan_info},
473 {.event_cause = EVENT_TX_STATUS_REPORT,
474 .event_handler = nxpwifi_uap_event_tx_status_report},
475 {.event_cause = EVENT_BT_COEX_WLAN_PARA_CHANGE,
476 .event_handler = nxpwifi_uap_event_bt_coex_wlan_para_change},
477 {.event_cause = EVENT_VDLL_IND,
478 .event_handler = nxpwifi_uap_event_vdll_ind},
479 };
480
481 /* Handle AP‑interface events by dispatching them to event‑specific routines. */
nxpwifi_process_uap_event(struct nxpwifi_private * priv)482 int nxpwifi_process_uap_event(struct nxpwifi_private *priv)
483 {
484 struct nxpwifi_adapter *adapter = priv->adapter;
485 u32 eventcause = adapter->event_cause;
486 int evt, ret = 0;
487
488 for (evt = 0; evt < ARRAY_SIZE(evt_table_uap); evt++) {
489 if (eventcause == evt_table_uap[evt].event_cause) {
490 if (evt_table_uap[evt].event_handler)
491 ret = evt_table_uap[evt].event_handler(priv);
492 break;
493 }
494 }
495
496 if (evt == ARRAY_SIZE(evt_table_uap))
497 nxpwifi_dbg(adapter, EVENT,
498 "%s: unknown event id: %#x\n",
499 __func__, eventcause);
500 else
501 nxpwifi_dbg(adapter, EVENT,
502 "%s: event id: %#x\n",
503 __func__, eventcause);
504
505 return ret;
506 }
507