1 /*
2 * Driver interaction with Linux nl80211/cfg80211 - Event processing
3 * Copyright (c) 2002-2017, Jouni Malinen <j@w1.fi>
4 * Copyright (c) 2007, Johannes Berg <johannes@sipsolutions.net>
5 * Copyright (c) 2009-2010, Atheros Communications
6 *
7 * This software may be distributed under the terms of the BSD license.
8 * See README for more details.
9 */
10
11 #include "includes.h"
12 #include <netlink/genl/genl.h>
13
14 #include "utils/common.h"
15 #include "utils/eloop.h"
16 #include "common/qca-vendor.h"
17 #include "common/qca-vendor-attr.h"
18 #include "common/ieee802_11_defs.h"
19 #include "common/ieee802_11_common.h"
20 #include "driver_nl80211.h"
21
22
nl80211_command_to_string(enum nl80211_commands cmd)23 static const char * nl80211_command_to_string(enum nl80211_commands cmd)
24 {
25 #define C2S(x) case x: return #x;
26 switch (cmd) {
27 C2S(NL80211_CMD_UNSPEC)
28 C2S(NL80211_CMD_GET_WIPHY)
29 C2S(NL80211_CMD_SET_WIPHY)
30 C2S(NL80211_CMD_NEW_WIPHY)
31 C2S(NL80211_CMD_DEL_WIPHY)
32 C2S(NL80211_CMD_GET_INTERFACE)
33 C2S(NL80211_CMD_SET_INTERFACE)
34 C2S(NL80211_CMD_NEW_INTERFACE)
35 C2S(NL80211_CMD_DEL_INTERFACE)
36 C2S(NL80211_CMD_GET_KEY)
37 C2S(NL80211_CMD_SET_KEY)
38 C2S(NL80211_CMD_NEW_KEY)
39 C2S(NL80211_CMD_DEL_KEY)
40 C2S(NL80211_CMD_GET_BEACON)
41 C2S(NL80211_CMD_SET_BEACON)
42 C2S(NL80211_CMD_START_AP)
43 C2S(NL80211_CMD_STOP_AP)
44 C2S(NL80211_CMD_GET_STATION)
45 C2S(NL80211_CMD_SET_STATION)
46 C2S(NL80211_CMD_NEW_STATION)
47 C2S(NL80211_CMD_DEL_STATION)
48 C2S(NL80211_CMD_GET_MPATH)
49 C2S(NL80211_CMD_SET_MPATH)
50 C2S(NL80211_CMD_NEW_MPATH)
51 C2S(NL80211_CMD_DEL_MPATH)
52 C2S(NL80211_CMD_SET_BSS)
53 C2S(NL80211_CMD_SET_REG)
54 C2S(NL80211_CMD_REQ_SET_REG)
55 C2S(NL80211_CMD_GET_MESH_CONFIG)
56 C2S(NL80211_CMD_SET_MESH_CONFIG)
57 C2S(NL80211_CMD_SET_MGMT_EXTRA_IE)
58 C2S(NL80211_CMD_GET_REG)
59 C2S(NL80211_CMD_GET_SCAN)
60 C2S(NL80211_CMD_TRIGGER_SCAN)
61 C2S(NL80211_CMD_NEW_SCAN_RESULTS)
62 C2S(NL80211_CMD_SCAN_ABORTED)
63 C2S(NL80211_CMD_REG_CHANGE)
64 C2S(NL80211_CMD_AUTHENTICATE)
65 C2S(NL80211_CMD_ASSOCIATE)
66 C2S(NL80211_CMD_DEAUTHENTICATE)
67 C2S(NL80211_CMD_DISASSOCIATE)
68 C2S(NL80211_CMD_MICHAEL_MIC_FAILURE)
69 C2S(NL80211_CMD_REG_BEACON_HINT)
70 C2S(NL80211_CMD_JOIN_IBSS)
71 C2S(NL80211_CMD_LEAVE_IBSS)
72 C2S(NL80211_CMD_TESTMODE)
73 C2S(NL80211_CMD_CONNECT)
74 C2S(NL80211_CMD_ROAM)
75 C2S(NL80211_CMD_DISCONNECT)
76 C2S(NL80211_CMD_SET_WIPHY_NETNS)
77 C2S(NL80211_CMD_GET_SURVEY)
78 C2S(NL80211_CMD_NEW_SURVEY_RESULTS)
79 C2S(NL80211_CMD_SET_PMKSA)
80 C2S(NL80211_CMD_DEL_PMKSA)
81 C2S(NL80211_CMD_FLUSH_PMKSA)
82 C2S(NL80211_CMD_REMAIN_ON_CHANNEL)
83 C2S(NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL)
84 C2S(NL80211_CMD_SET_TX_BITRATE_MASK)
85 C2S(NL80211_CMD_REGISTER_FRAME)
86 C2S(NL80211_CMD_FRAME)
87 C2S(NL80211_CMD_FRAME_TX_STATUS)
88 C2S(NL80211_CMD_SET_POWER_SAVE)
89 C2S(NL80211_CMD_GET_POWER_SAVE)
90 C2S(NL80211_CMD_SET_CQM)
91 C2S(NL80211_CMD_NOTIFY_CQM)
92 C2S(NL80211_CMD_SET_CHANNEL)
93 C2S(NL80211_CMD_SET_WDS_PEER)
94 C2S(NL80211_CMD_FRAME_WAIT_CANCEL)
95 C2S(NL80211_CMD_JOIN_MESH)
96 C2S(NL80211_CMD_LEAVE_MESH)
97 C2S(NL80211_CMD_UNPROT_DEAUTHENTICATE)
98 C2S(NL80211_CMD_UNPROT_DISASSOCIATE)
99 C2S(NL80211_CMD_NEW_PEER_CANDIDATE)
100 C2S(NL80211_CMD_GET_WOWLAN)
101 C2S(NL80211_CMD_SET_WOWLAN)
102 C2S(NL80211_CMD_START_SCHED_SCAN)
103 C2S(NL80211_CMD_STOP_SCHED_SCAN)
104 C2S(NL80211_CMD_SCHED_SCAN_RESULTS)
105 C2S(NL80211_CMD_SCHED_SCAN_STOPPED)
106 C2S(NL80211_CMD_SET_REKEY_OFFLOAD)
107 C2S(NL80211_CMD_PMKSA_CANDIDATE)
108 C2S(NL80211_CMD_TDLS_OPER)
109 C2S(NL80211_CMD_TDLS_MGMT)
110 C2S(NL80211_CMD_UNEXPECTED_FRAME)
111 C2S(NL80211_CMD_PROBE_CLIENT)
112 C2S(NL80211_CMD_REGISTER_BEACONS)
113 C2S(NL80211_CMD_UNEXPECTED_4ADDR_FRAME)
114 C2S(NL80211_CMD_SET_NOACK_MAP)
115 C2S(NL80211_CMD_CH_SWITCH_NOTIFY)
116 C2S(NL80211_CMD_START_P2P_DEVICE)
117 C2S(NL80211_CMD_STOP_P2P_DEVICE)
118 C2S(NL80211_CMD_CONN_FAILED)
119 C2S(NL80211_CMD_SET_MCAST_RATE)
120 C2S(NL80211_CMD_SET_MAC_ACL)
121 C2S(NL80211_CMD_RADAR_DETECT)
122 C2S(NL80211_CMD_GET_PROTOCOL_FEATURES)
123 C2S(NL80211_CMD_UPDATE_FT_IES)
124 C2S(NL80211_CMD_FT_EVENT)
125 C2S(NL80211_CMD_CRIT_PROTOCOL_START)
126 C2S(NL80211_CMD_CRIT_PROTOCOL_STOP)
127 C2S(NL80211_CMD_GET_COALESCE)
128 C2S(NL80211_CMD_SET_COALESCE)
129 C2S(NL80211_CMD_CHANNEL_SWITCH)
130 C2S(NL80211_CMD_VENDOR)
131 C2S(NL80211_CMD_SET_QOS_MAP)
132 C2S(NL80211_CMD_ADD_TX_TS)
133 C2S(NL80211_CMD_DEL_TX_TS)
134 C2S(NL80211_CMD_WIPHY_REG_CHANGE)
135 C2S(NL80211_CMD_PORT_AUTHORIZED)
136 C2S(NL80211_CMD_EXTERNAL_AUTH)
137 C2S(NL80211_CMD_STA_OPMODE_CHANGED)
138 C2S(NL80211_CMD_CONTROL_PORT_FRAME)
139 default:
140 return "NL80211_CMD_UNKNOWN";
141 }
142 #undef C2S
143 }
144
145
mlme_event_auth(struct wpa_driver_nl80211_data * drv,const u8 * frame,size_t len)146 static void mlme_event_auth(struct wpa_driver_nl80211_data *drv,
147 const u8 *frame, size_t len)
148 {
149 const struct ieee80211_mgmt *mgmt;
150 union wpa_event_data event;
151
152 if (!(drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
153 drv->force_connect_cmd) {
154 /*
155 * Avoid reporting two association events that would confuse
156 * the core code.
157 */
158 wpa_printf(MSG_DEBUG,
159 "nl80211: Ignore auth event when using driver SME");
160 return;
161 }
162
163 wpa_printf(MSG_DEBUG, "nl80211: Authenticate event");
164 mgmt = (const struct ieee80211_mgmt *) frame;
165 if (len < 24 + sizeof(mgmt->u.auth)) {
166 wpa_printf(MSG_DEBUG, "nl80211: Too short association event "
167 "frame");
168 return;
169 }
170
171 os_memcpy(drv->auth_bssid, mgmt->sa, ETH_ALEN);
172 os_memset(drv->auth_attempt_bssid, 0, ETH_ALEN);
173 os_memset(&event, 0, sizeof(event));
174 os_memcpy(event.auth.peer, mgmt->sa, ETH_ALEN);
175 event.auth.auth_type = le_to_host16(mgmt->u.auth.auth_alg);
176 event.auth.auth_transaction =
177 le_to_host16(mgmt->u.auth.auth_transaction);
178 event.auth.status_code = le_to_host16(mgmt->u.auth.status_code);
179 if (len > 24 + sizeof(mgmt->u.auth)) {
180 event.auth.ies = mgmt->u.auth.variable;
181 event.auth.ies_len = len - 24 - sizeof(mgmt->u.auth);
182 }
183
184 wpa_supplicant_event(drv->ctx, EVENT_AUTH, &event);
185 }
186
187
nl80211_parse_wmm_params(struct nlattr * wmm_attr,struct wmm_params * wmm_params)188 static void nl80211_parse_wmm_params(struct nlattr *wmm_attr,
189 struct wmm_params *wmm_params)
190 {
191 struct nlattr *wmm_info[NL80211_STA_WME_MAX + 1];
192 static struct nla_policy wme_policy[NL80211_STA_WME_MAX + 1] = {
193 [NL80211_STA_WME_UAPSD_QUEUES] = { .type = NLA_U8 },
194 };
195
196 if (!wmm_attr ||
197 nla_parse_nested(wmm_info, NL80211_STA_WME_MAX, wmm_attr,
198 wme_policy) ||
199 !wmm_info[NL80211_STA_WME_UAPSD_QUEUES])
200 return;
201
202 wmm_params->uapsd_queues =
203 nla_get_u8(wmm_info[NL80211_STA_WME_UAPSD_QUEUES]);
204 wmm_params->info_bitmap |= WMM_PARAMS_UAPSD_QUEUES_INFO;
205 }
206
207
mlme_event_assoc(struct wpa_driver_nl80211_data * drv,const u8 * frame,size_t len,struct nlattr * wmm,struct nlattr * req_ie)208 static void mlme_event_assoc(struct wpa_driver_nl80211_data *drv,
209 const u8 *frame, size_t len, struct nlattr *wmm,
210 struct nlattr *req_ie)
211 {
212 const struct ieee80211_mgmt *mgmt;
213 union wpa_event_data event;
214 u16 status;
215 int ssid_len;
216
217 if (!(drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
218 drv->force_connect_cmd) {
219 /*
220 * Avoid reporting two association events that would confuse
221 * the core code.
222 */
223 wpa_printf(MSG_DEBUG,
224 "nl80211: Ignore assoc event when using driver SME");
225 return;
226 }
227
228 wpa_printf(MSG_DEBUG, "nl80211: Associate event");
229 mgmt = (const struct ieee80211_mgmt *) frame;
230 if (len < 24 + sizeof(mgmt->u.assoc_resp)) {
231 wpa_printf(MSG_DEBUG, "nl80211: Too short association event "
232 "frame");
233 return;
234 }
235
236 status = le_to_host16(mgmt->u.assoc_resp.status_code);
237 if (status != WLAN_STATUS_SUCCESS) {
238 os_memset(&event, 0, sizeof(event));
239 event.assoc_reject.bssid = mgmt->bssid;
240 if (len > 24 + sizeof(mgmt->u.assoc_resp)) {
241 event.assoc_reject.resp_ies =
242 (u8 *) mgmt->u.assoc_resp.variable;
243 event.assoc_reject.resp_ies_len =
244 len - 24 - sizeof(mgmt->u.assoc_resp);
245 }
246 event.assoc_reject.status_code = status;
247
248 wpa_supplicant_event(drv->ctx, EVENT_ASSOC_REJECT, &event);
249 return;
250 }
251
252 drv->associated = 1;
253 os_memcpy(drv->bssid, mgmt->sa, ETH_ALEN);
254 os_memcpy(drv->prev_bssid, mgmt->sa, ETH_ALEN);
255
256 os_memset(&event, 0, sizeof(event));
257 event.assoc_info.resp_frame = frame;
258 event.assoc_info.resp_frame_len = len;
259 if (len > 24 + sizeof(mgmt->u.assoc_resp)) {
260 event.assoc_info.resp_ies = (u8 *) mgmt->u.assoc_resp.variable;
261 event.assoc_info.resp_ies_len =
262 len - 24 - sizeof(mgmt->u.assoc_resp);
263 }
264
265 if (req_ie) {
266 event.assoc_info.req_ies = nla_data(req_ie);
267 event.assoc_info.req_ies_len = nla_len(req_ie);
268 }
269
270 /* When this association was initiated outside of wpa_supplicant,
271 * drv->ssid needs to be set here to satisfy later checking. */
272 ssid_len = nl80211_get_assoc_ssid(drv, drv->ssid);
273 if (ssid_len > 0) {
274 drv->ssid_len = ssid_len;
275 wpa_printf(MSG_DEBUG,
276 "nl80211: Set drv->ssid based on scan res info to '%s'",
277 wpa_ssid_txt(drv->ssid, drv->ssid_len));
278 }
279
280 event.assoc_info.freq = drv->assoc_freq;
281 drv->first_bss->freq = drv->assoc_freq;
282
283 nl80211_parse_wmm_params(wmm, &event.assoc_info.wmm_params);
284
285 wpa_supplicant_event(drv->ctx, EVENT_ASSOC, &event);
286 }
287
288
mlme_event_connect(struct wpa_driver_nl80211_data * drv,enum nl80211_commands cmd,struct nlattr * status,struct nlattr * addr,struct nlattr * req_ie,struct nlattr * resp_ie,struct nlattr * timed_out,struct nlattr * timeout_reason,struct nlattr * authorized,struct nlattr * key_replay_ctr,struct nlattr * ptk_kck,struct nlattr * ptk_kek,struct nlattr * subnet_status,struct nlattr * fils_erp_next_seq_num,struct nlattr * fils_pmk,struct nlattr * fils_pmkid)289 static void mlme_event_connect(struct wpa_driver_nl80211_data *drv,
290 enum nl80211_commands cmd, struct nlattr *status,
291 struct nlattr *addr, struct nlattr *req_ie,
292 struct nlattr *resp_ie,
293 struct nlattr *timed_out,
294 struct nlattr *timeout_reason,
295 struct nlattr *authorized,
296 struct nlattr *key_replay_ctr,
297 struct nlattr *ptk_kck,
298 struct nlattr *ptk_kek,
299 struct nlattr *subnet_status,
300 struct nlattr *fils_erp_next_seq_num,
301 struct nlattr *fils_pmk,
302 struct nlattr *fils_pmkid)
303 {
304 union wpa_event_data event;
305 const u8 *ssid = NULL;
306 u16 status_code;
307 int ssid_len;
308
309 if (drv->capa.flags & WPA_DRIVER_FLAGS_SME) {
310 /*
311 * Avoid reporting two association events that would confuse
312 * the core code.
313 */
314 wpa_printf(MSG_DEBUG, "nl80211: Ignore connect event (cmd=%d) "
315 "when using userspace SME", cmd);
316 return;
317 }
318
319 drv->connect_reassoc = 0;
320
321 status_code = status ? nla_get_u16(status) : WLAN_STATUS_SUCCESS;
322
323 if (cmd == NL80211_CMD_CONNECT) {
324 wpa_printf(MSG_DEBUG,
325 "nl80211: Connect event (status=%u ignore_next_local_disconnect=%d)",
326 status_code, drv->ignore_next_local_disconnect);
327 } else if (cmd == NL80211_CMD_ROAM) {
328 wpa_printf(MSG_DEBUG, "nl80211: Roam event");
329 }
330
331 os_memset(&event, 0, sizeof(event));
332 if (cmd == NL80211_CMD_CONNECT && status_code != WLAN_STATUS_SUCCESS) {
333 if (addr)
334 event.assoc_reject.bssid = nla_data(addr);
335 if (drv->ignore_next_local_disconnect) {
336 drv->ignore_next_local_disconnect = 0;
337 if (!event.assoc_reject.bssid ||
338 (os_memcmp(event.assoc_reject.bssid,
339 drv->auth_attempt_bssid,
340 ETH_ALEN) != 0)) {
341 /*
342 * Ignore the event that came without a BSSID or
343 * for the old connection since this is likely
344 * not relevant to the new Connect command.
345 */
346 wpa_printf(MSG_DEBUG,
347 "nl80211: Ignore connection failure event triggered during reassociation");
348 return;
349 }
350 }
351 if (resp_ie) {
352 event.assoc_reject.resp_ies = nla_data(resp_ie);
353 event.assoc_reject.resp_ies_len = nla_len(resp_ie);
354 }
355 event.assoc_reject.status_code = status_code;
356 event.assoc_reject.timed_out = timed_out != NULL;
357 if (timed_out && timeout_reason) {
358 enum nl80211_timeout_reason reason;
359
360 reason = nla_get_u32(timeout_reason);
361 switch (reason) {
362 case NL80211_TIMEOUT_SCAN:
363 event.assoc_reject.timeout_reason = "scan";
364 break;
365 case NL80211_TIMEOUT_AUTH:
366 event.assoc_reject.timeout_reason = "auth";
367 break;
368 case NL80211_TIMEOUT_ASSOC:
369 event.assoc_reject.timeout_reason = "assoc";
370 break;
371 default:
372 break;
373 }
374 }
375 if (fils_erp_next_seq_num)
376 event.assoc_reject.fils_erp_next_seq_num =
377 nla_get_u16(fils_erp_next_seq_num);
378 wpa_supplicant_event(drv->ctx, EVENT_ASSOC_REJECT, &event);
379 return;
380 }
381
382 drv->associated = 1;
383 if (addr) {
384 os_memcpy(drv->bssid, nla_data(addr), ETH_ALEN);
385 os_memcpy(drv->prev_bssid, drv->bssid, ETH_ALEN);
386 }
387
388 if (req_ie) {
389 event.assoc_info.req_ies = nla_data(req_ie);
390 event.assoc_info.req_ies_len = nla_len(req_ie);
391
392 if (cmd == NL80211_CMD_ROAM) {
393 ssid = get_ie(event.assoc_info.req_ies,
394 event.assoc_info.req_ies_len,
395 WLAN_EID_SSID);
396 if (ssid && ssid[1] > 0 && ssid[1] <= 32) {
397 drv->ssid_len = ssid[1];
398 os_memcpy(drv->ssid, ssid + 2, ssid[1]);
399 wpa_printf(MSG_DEBUG,
400 "nl80211: Set drv->ssid based on req_ie to '%s'",
401 wpa_ssid_txt(drv->ssid,
402 drv->ssid_len));
403 }
404 }
405 }
406 if (resp_ie) {
407 event.assoc_info.resp_ies = nla_data(resp_ie);
408 event.assoc_info.resp_ies_len = nla_len(resp_ie);
409 }
410
411 event.assoc_info.freq = nl80211_get_assoc_freq(drv);
412 drv->first_bss->freq = drv->assoc_freq;
413
414 if ((!ssid || ssid[1] == 0 || ssid[1] > 32) &&
415 (ssid_len = nl80211_get_assoc_ssid(drv, drv->ssid)) > 0) {
416 /* When this connection was initiated outside of wpa_supplicant,
417 * drv->ssid needs to be set here to satisfy later checking. */
418 drv->ssid_len = ssid_len;
419 wpa_printf(MSG_DEBUG,
420 "nl80211: Set drv->ssid based on scan res info to '%s'",
421 wpa_ssid_txt(drv->ssid, drv->ssid_len));
422 }
423
424 if (authorized && nla_get_u8(authorized)) {
425 event.assoc_info.authorized = 1;
426 wpa_printf(MSG_DEBUG, "nl80211: connection authorized");
427 }
428 if (key_replay_ctr) {
429 event.assoc_info.key_replay_ctr = nla_data(key_replay_ctr);
430 event.assoc_info.key_replay_ctr_len = nla_len(key_replay_ctr);
431 }
432 if (ptk_kck) {
433 event.assoc_info.ptk_kck = nla_data(ptk_kck);
434 event.assoc_info.ptk_kck_len = nla_len(ptk_kck);
435 }
436 if (ptk_kek) {
437 event.assoc_info.ptk_kek = nla_data(ptk_kek);
438 event.assoc_info.ptk_kek_len = nla_len(ptk_kek);
439 }
440
441 if (subnet_status) {
442 /*
443 * At least for now, this is only available from
444 * QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_SUBNET_STATUS and that
445 * attribute has the same values 0, 1, 2 as are used in the
446 * variable here, so no mapping between different values are
447 * needed.
448 */
449 event.assoc_info.subnet_status = nla_get_u8(subnet_status);
450 }
451
452 if (fils_erp_next_seq_num)
453 event.assoc_info.fils_erp_next_seq_num =
454 nla_get_u16(fils_erp_next_seq_num);
455
456 if (fils_pmk) {
457 event.assoc_info.fils_pmk = nla_data(fils_pmk);
458 event.assoc_info.fils_pmk_len = nla_len(fils_pmk);
459 }
460
461 if (fils_pmkid)
462 event.assoc_info.fils_pmkid = nla_data(fils_pmkid);
463
464 wpa_supplicant_event(drv->ctx, EVENT_ASSOC, &event);
465 }
466
467
mlme_event_disconnect(struct wpa_driver_nl80211_data * drv,struct nlattr * reason,struct nlattr * addr,struct nlattr * by_ap)468 static void mlme_event_disconnect(struct wpa_driver_nl80211_data *drv,
469 struct nlattr *reason, struct nlattr *addr,
470 struct nlattr *by_ap)
471 {
472 union wpa_event_data data;
473 unsigned int locally_generated = by_ap == NULL;
474
475 if (drv->capa.flags & WPA_DRIVER_FLAGS_SME) {
476 /*
477 * Avoid reporting two disassociation events that could
478 * confuse the core code.
479 */
480 wpa_printf(MSG_DEBUG, "nl80211: Ignore disconnect "
481 "event when using userspace SME");
482 return;
483 }
484
485 if (drv->ignore_next_local_disconnect) {
486 drv->ignore_next_local_disconnect = 0;
487 if (locally_generated) {
488 wpa_printf(MSG_DEBUG, "nl80211: Ignore disconnect "
489 "event triggered during reassociation");
490 return;
491 }
492 wpa_printf(MSG_WARNING, "nl80211: Was expecting local "
493 "disconnect but got another disconnect "
494 "event first");
495 }
496
497 wpa_printf(MSG_DEBUG, "nl80211: Disconnect event");
498 nl80211_mark_disconnected(drv);
499 os_memset(&data, 0, sizeof(data));
500 if (reason)
501 data.deauth_info.reason_code = nla_get_u16(reason);
502 data.deauth_info.locally_generated = by_ap == NULL;
503 wpa_supplicant_event(drv->ctx, EVENT_DEAUTH, &data);
504 }
505
506
calculate_chan_offset(int width,int freq,int cf1,int cf2)507 static int calculate_chan_offset(int width, int freq, int cf1, int cf2)
508 {
509 int freq1 = 0;
510
511 switch (convert2width(width)) {
512 case CHAN_WIDTH_20_NOHT:
513 case CHAN_WIDTH_20:
514 return 0;
515 case CHAN_WIDTH_40:
516 freq1 = cf1 - 10;
517 break;
518 case CHAN_WIDTH_80:
519 freq1 = cf1 - 30;
520 break;
521 case CHAN_WIDTH_160:
522 freq1 = cf1 - 70;
523 break;
524 case CHAN_WIDTH_UNKNOWN:
525 case CHAN_WIDTH_80P80:
526 /* FIXME: implement this */
527 return 0;
528 }
529
530 return (abs(freq - freq1) / 20) % 2 == 0 ? 1 : -1;
531 }
532
533
mlme_event_ch_switch(struct wpa_driver_nl80211_data * drv,struct nlattr * ifindex,struct nlattr * freq,struct nlattr * type,struct nlattr * bw,struct nlattr * cf1,struct nlattr * cf2)534 static void mlme_event_ch_switch(struct wpa_driver_nl80211_data *drv,
535 struct nlattr *ifindex, struct nlattr *freq,
536 struct nlattr *type, struct nlattr *bw,
537 struct nlattr *cf1, struct nlattr *cf2)
538 {
539 struct i802_bss *bss;
540 union wpa_event_data data;
541 int ht_enabled = 1;
542 int chan_offset = 0;
543 int ifidx;
544
545 wpa_printf(MSG_DEBUG, "nl80211: Channel switch event");
546
547 if (!freq)
548 return;
549
550 ifidx = nla_get_u32(ifindex);
551 bss = get_bss_ifindex(drv, ifidx);
552 if (bss == NULL) {
553 wpa_printf(MSG_WARNING, "nl80211: Unknown ifindex (%d) for channel switch, ignoring",
554 ifidx);
555 return;
556 }
557
558 if (type) {
559 enum nl80211_channel_type ch_type = nla_get_u32(type);
560
561 wpa_printf(MSG_DEBUG, "nl80211: Channel type: %d", ch_type);
562 switch (ch_type) {
563 case NL80211_CHAN_NO_HT:
564 ht_enabled = 0;
565 break;
566 case NL80211_CHAN_HT20:
567 break;
568 case NL80211_CHAN_HT40PLUS:
569 chan_offset = 1;
570 break;
571 case NL80211_CHAN_HT40MINUS:
572 chan_offset = -1;
573 break;
574 }
575 } else if (bw && cf1) {
576 /* This can happen for example with VHT80 ch switch */
577 chan_offset = calculate_chan_offset(nla_get_u32(bw),
578 nla_get_u32(freq),
579 nla_get_u32(cf1),
580 cf2 ? nla_get_u32(cf2) : 0);
581 } else {
582 wpa_printf(MSG_WARNING, "nl80211: Unknown secondary channel information - following channel definition calculations may fail");
583 }
584
585 os_memset(&data, 0, sizeof(data));
586 data.ch_switch.freq = nla_get_u32(freq);
587 data.ch_switch.ht_enabled = ht_enabled;
588 data.ch_switch.ch_offset = chan_offset;
589 if (bw)
590 data.ch_switch.ch_width = convert2width(nla_get_u32(bw));
591 if (cf1)
592 data.ch_switch.cf1 = nla_get_u32(cf1);
593 if (cf2)
594 data.ch_switch.cf2 = nla_get_u32(cf2);
595
596 bss->freq = data.ch_switch.freq;
597 drv->assoc_freq = data.ch_switch.freq;
598
599 wpa_supplicant_event(bss->ctx, EVENT_CH_SWITCH, &data);
600 }
601
602
mlme_timeout_event(struct wpa_driver_nl80211_data * drv,enum nl80211_commands cmd,struct nlattr * addr)603 static void mlme_timeout_event(struct wpa_driver_nl80211_data *drv,
604 enum nl80211_commands cmd, struct nlattr *addr)
605 {
606 union wpa_event_data event;
607 enum wpa_event_type ev;
608
609 if (nla_len(addr) != ETH_ALEN)
610 return;
611
612 wpa_printf(MSG_DEBUG, "nl80211: MLME event %d; timeout with " MACSTR,
613 cmd, MAC2STR((u8 *) nla_data(addr)));
614
615 if (cmd == NL80211_CMD_AUTHENTICATE)
616 ev = EVENT_AUTH_TIMED_OUT;
617 else if (cmd == NL80211_CMD_ASSOCIATE)
618 ev = EVENT_ASSOC_TIMED_OUT;
619 else
620 return;
621
622 os_memset(&event, 0, sizeof(event));
623 os_memcpy(event.timeout_event.addr, nla_data(addr), ETH_ALEN);
624 wpa_supplicant_event(drv->ctx, ev, &event);
625 }
626
627
mlme_event_mgmt(struct i802_bss * bss,struct nlattr * freq,struct nlattr * sig,const u8 * frame,size_t len)628 static void mlme_event_mgmt(struct i802_bss *bss,
629 struct nlattr *freq, struct nlattr *sig,
630 const u8 *frame, size_t len)
631 {
632 struct wpa_driver_nl80211_data *drv = bss->drv;
633 const struct ieee80211_mgmt *mgmt;
634 union wpa_event_data event;
635 u16 fc, stype;
636 int ssi_signal = 0;
637 int rx_freq = 0;
638
639 wpa_printf(MSG_MSGDUMP, "nl80211: Frame event");
640 mgmt = (const struct ieee80211_mgmt *) frame;
641 if (len < 24) {
642 wpa_printf(MSG_DEBUG, "nl80211: Too short management frame");
643 return;
644 }
645
646 fc = le_to_host16(mgmt->frame_control);
647 stype = WLAN_FC_GET_STYPE(fc);
648
649 if (sig)
650 ssi_signal = (s32) nla_get_u32(sig);
651
652 os_memset(&event, 0, sizeof(event));
653 if (freq) {
654 event.rx_mgmt.freq = nla_get_u32(freq);
655 rx_freq = drv->last_mgmt_freq = event.rx_mgmt.freq;
656 }
657 wpa_printf(MSG_DEBUG,
658 "nl80211: RX frame da=" MACSTR " sa=" MACSTR " bssid=" MACSTR
659 " freq=%d ssi_signal=%d fc=0x%x seq_ctrl=0x%x stype=%u (%s) len=%u",
660 MAC2STR(mgmt->da), MAC2STR(mgmt->sa), MAC2STR(mgmt->bssid),
661 rx_freq, ssi_signal, fc,
662 le_to_host16(mgmt->seq_ctrl), stype, fc2str(fc),
663 (unsigned int) len);
664 event.rx_mgmt.frame = frame;
665 event.rx_mgmt.frame_len = len;
666 event.rx_mgmt.ssi_signal = ssi_signal;
667 event.rx_mgmt.drv_priv = bss;
668 wpa_supplicant_event(drv->ctx, EVENT_RX_MGMT, &event);
669 }
670
671
mlme_event_mgmt_tx_status(struct wpa_driver_nl80211_data * drv,struct nlattr * cookie,const u8 * frame,size_t len,struct nlattr * ack)672 static void mlme_event_mgmt_tx_status(struct wpa_driver_nl80211_data *drv,
673 struct nlattr *cookie, const u8 *frame,
674 size_t len, struct nlattr *ack)
675 {
676 union wpa_event_data event;
677 const struct ieee80211_hdr *hdr;
678 u16 fc;
679
680 wpa_printf(MSG_DEBUG, "nl80211: Frame TX status event");
681 if (!is_ap_interface(drv->nlmode)) {
682 u64 cookie_val;
683
684 if (!cookie)
685 return;
686
687 cookie_val = nla_get_u64(cookie);
688 wpa_printf(MSG_DEBUG, "nl80211: Action TX status:"
689 " cookie=0x%llx%s (ack=%d)",
690 (long long unsigned int) cookie_val,
691 cookie_val == drv->send_action_cookie ?
692 " (match)" : " (unknown)", ack != NULL);
693 if (cookie_val != drv->send_action_cookie)
694 return;
695 }
696
697 hdr = (const struct ieee80211_hdr *) frame;
698 fc = le_to_host16(hdr->frame_control);
699
700 os_memset(&event, 0, sizeof(event));
701 event.tx_status.type = WLAN_FC_GET_TYPE(fc);
702 event.tx_status.stype = WLAN_FC_GET_STYPE(fc);
703 event.tx_status.dst = hdr->addr1;
704 event.tx_status.data = frame;
705 event.tx_status.data_len = len;
706 event.tx_status.ack = ack != NULL;
707 wpa_supplicant_event(drv->ctx, EVENT_TX_STATUS, &event);
708 }
709
710
mlme_event_deauth_disassoc(struct wpa_driver_nl80211_data * drv,enum wpa_event_type type,const u8 * frame,size_t len)711 static void mlme_event_deauth_disassoc(struct wpa_driver_nl80211_data *drv,
712 enum wpa_event_type type,
713 const u8 *frame, size_t len)
714 {
715 const struct ieee80211_mgmt *mgmt;
716 union wpa_event_data event;
717 const u8 *bssid = NULL;
718 u16 reason_code = 0;
719
720 if (type == EVENT_DEAUTH)
721 wpa_printf(MSG_DEBUG, "nl80211: Deauthenticate event");
722 else
723 wpa_printf(MSG_DEBUG, "nl80211: Disassociate event");
724
725 mgmt = (const struct ieee80211_mgmt *) frame;
726 if (len >= 24) {
727 bssid = mgmt->bssid;
728
729 if ((drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
730 !drv->associated &&
731 os_memcmp(bssid, drv->auth_bssid, ETH_ALEN) != 0 &&
732 os_memcmp(bssid, drv->auth_attempt_bssid, ETH_ALEN) != 0 &&
733 os_memcmp(bssid, drv->prev_bssid, ETH_ALEN) == 0) {
734 /*
735 * Avoid issues with some roaming cases where
736 * disconnection event for the old AP may show up after
737 * we have started connection with the new AP.
738 * In case of locally generated event clear
739 * ignore_next_local_deauth as well, to avoid next local
740 * deauth event be wrongly ignored.
741 */
742 if (!os_memcmp(mgmt->sa, drv->first_bss->addr,
743 ETH_ALEN)) {
744 wpa_printf(MSG_DEBUG,
745 "nl80211: Received a locally generated deauth event. Clear ignore_next_local_deauth flag");
746 drv->ignore_next_local_deauth = 0;
747 } else {
748 wpa_printf(MSG_DEBUG,
749 "nl80211: Ignore deauth/disassoc event from old AP " MACSTR " when already authenticating with " MACSTR,
750 MAC2STR(bssid),
751 MAC2STR(drv->auth_attempt_bssid));
752 }
753 return;
754 }
755
756 if (!(drv->capa.flags & WPA_DRIVER_FLAGS_SME) &&
757 drv->connect_reassoc && drv->associated &&
758 os_memcmp(bssid, drv->prev_bssid, ETH_ALEN) == 0 &&
759 os_memcmp(bssid, drv->auth_attempt_bssid, ETH_ALEN) != 0) {
760 /*
761 * Avoid issues with some roaming cases where
762 * disconnection event for the old AP may show up after
763 * we have started connection with the new AP.
764 */
765 wpa_printf(MSG_DEBUG,
766 "nl80211: Ignore deauth/disassoc event from old AP "
767 MACSTR
768 " when already connecting with " MACSTR,
769 MAC2STR(bssid),
770 MAC2STR(drv->auth_attempt_bssid));
771 return;
772 }
773
774 if (drv->associated != 0 &&
775 os_memcmp(bssid, drv->bssid, ETH_ALEN) != 0 &&
776 os_memcmp(bssid, drv->auth_bssid, ETH_ALEN) != 0) {
777 /*
778 * We have presumably received this deauth as a
779 * response to a clear_state_mismatch() outgoing
780 * deauth. Don't let it take us offline!
781 */
782 wpa_printf(MSG_DEBUG, "nl80211: Deauth received "
783 "from Unknown BSSID " MACSTR " -- ignoring",
784 MAC2STR(bssid));
785 return;
786 }
787 }
788
789 nl80211_mark_disconnected(drv);
790 os_memset(&event, 0, sizeof(event));
791
792 /* Note: Same offset for Reason Code in both frame subtypes */
793 if (len >= 24 + sizeof(mgmt->u.deauth))
794 reason_code = le_to_host16(mgmt->u.deauth.reason_code);
795
796 if (type == EVENT_DISASSOC) {
797 event.disassoc_info.locally_generated =
798 !os_memcmp(mgmt->sa, drv->first_bss->addr, ETH_ALEN);
799 event.disassoc_info.addr = bssid;
800 event.disassoc_info.reason_code = reason_code;
801 if (frame + len > mgmt->u.disassoc.variable) {
802 event.disassoc_info.ie = mgmt->u.disassoc.variable;
803 event.disassoc_info.ie_len = frame + len -
804 mgmt->u.disassoc.variable;
805 }
806 } else {
807 event.deauth_info.locally_generated =
808 !os_memcmp(mgmt->sa, drv->first_bss->addr, ETH_ALEN);
809 if (drv->ignore_deauth_event) {
810 wpa_printf(MSG_DEBUG, "nl80211: Ignore deauth event due to previous forced deauth-during-auth");
811 drv->ignore_deauth_event = 0;
812 if (event.deauth_info.locally_generated)
813 drv->ignore_next_local_deauth = 0;
814 return;
815 }
816 if (drv->ignore_next_local_deauth) {
817 drv->ignore_next_local_deauth = 0;
818 if (event.deauth_info.locally_generated) {
819 wpa_printf(MSG_DEBUG, "nl80211: Ignore deauth event triggered due to own deauth request");
820 return;
821 }
822 wpa_printf(MSG_WARNING, "nl80211: Was expecting local deauth but got another disconnect event first");
823 }
824 event.deauth_info.addr = bssid;
825 event.deauth_info.reason_code = reason_code;
826 if (frame + len > mgmt->u.deauth.variable) {
827 event.deauth_info.ie = mgmt->u.deauth.variable;
828 event.deauth_info.ie_len = frame + len -
829 mgmt->u.deauth.variable;
830 }
831 }
832
833 wpa_supplicant_event(drv->ctx, type, &event);
834 }
835
836
mlme_event_unprot_disconnect(struct wpa_driver_nl80211_data * drv,enum wpa_event_type type,const u8 * frame,size_t len)837 static void mlme_event_unprot_disconnect(struct wpa_driver_nl80211_data *drv,
838 enum wpa_event_type type,
839 const u8 *frame, size_t len)
840 {
841 const struct ieee80211_mgmt *mgmt;
842 union wpa_event_data event;
843 u16 reason_code = 0;
844
845 if (type == EVENT_UNPROT_DEAUTH)
846 wpa_printf(MSG_DEBUG, "nl80211: Unprot Deauthenticate event");
847 else
848 wpa_printf(MSG_DEBUG, "nl80211: Unprot Disassociate event");
849
850 if (len < 24)
851 return;
852
853 mgmt = (const struct ieee80211_mgmt *) frame;
854
855 os_memset(&event, 0, sizeof(event));
856 /* Note: Same offset for Reason Code in both frame subtypes */
857 if (len >= 24 + sizeof(mgmt->u.deauth))
858 reason_code = le_to_host16(mgmt->u.deauth.reason_code);
859
860 if (type == EVENT_UNPROT_DISASSOC) {
861 event.unprot_disassoc.sa = mgmt->sa;
862 event.unprot_disassoc.da = mgmt->da;
863 event.unprot_disassoc.reason_code = reason_code;
864 } else {
865 event.unprot_deauth.sa = mgmt->sa;
866 event.unprot_deauth.da = mgmt->da;
867 event.unprot_deauth.reason_code = reason_code;
868 }
869
870 wpa_supplicant_event(drv->ctx, type, &event);
871 }
872
873
mlme_event(struct i802_bss * bss,enum nl80211_commands cmd,struct nlattr * frame,struct nlattr * addr,struct nlattr * timed_out,struct nlattr * freq,struct nlattr * ack,struct nlattr * cookie,struct nlattr * sig,struct nlattr * wmm,struct nlattr * req_ie)874 static void mlme_event(struct i802_bss *bss,
875 enum nl80211_commands cmd, struct nlattr *frame,
876 struct nlattr *addr, struct nlattr *timed_out,
877 struct nlattr *freq, struct nlattr *ack,
878 struct nlattr *cookie, struct nlattr *sig,
879 struct nlattr *wmm, struct nlattr *req_ie)
880 {
881 struct wpa_driver_nl80211_data *drv = bss->drv;
882 const u8 *data;
883 size_t len;
884
885 if (timed_out && addr) {
886 mlme_timeout_event(drv, cmd, addr);
887 return;
888 }
889
890 if (frame == NULL) {
891 wpa_printf(MSG_DEBUG,
892 "nl80211: MLME event %d (%s) without frame data",
893 cmd, nl80211_command_to_string(cmd));
894 return;
895 }
896
897 data = nla_data(frame);
898 len = nla_len(frame);
899 if (len < 4 + 2 * ETH_ALEN) {
900 wpa_printf(MSG_MSGDUMP, "nl80211: MLME event %d (%s) on %s("
901 MACSTR ") - too short",
902 cmd, nl80211_command_to_string(cmd), bss->ifname,
903 MAC2STR(bss->addr));
904 return;
905 }
906 wpa_printf(MSG_MSGDUMP, "nl80211: MLME event %d (%s) on %s(" MACSTR
907 ") A1=" MACSTR " A2=" MACSTR, cmd,
908 nl80211_command_to_string(cmd), bss->ifname,
909 MAC2STR(bss->addr), MAC2STR(data + 4),
910 MAC2STR(data + 4 + ETH_ALEN));
911 if (cmd != NL80211_CMD_FRAME_TX_STATUS && !(data[4] & 0x01) &&
912 os_memcmp(bss->addr, data + 4, ETH_ALEN) != 0 &&
913 (is_zero_ether_addr(bss->rand_addr) ||
914 os_memcmp(bss->rand_addr, data + 4, ETH_ALEN) != 0) &&
915 os_memcmp(bss->addr, data + 4 + ETH_ALEN, ETH_ALEN) != 0) {
916 wpa_printf(MSG_MSGDUMP, "nl80211: %s: Ignore MLME frame event "
917 "for foreign address", bss->ifname);
918 return;
919 }
920 wpa_hexdump(MSG_MSGDUMP, "nl80211: MLME event frame",
921 nla_data(frame), nla_len(frame));
922
923 switch (cmd) {
924 case NL80211_CMD_AUTHENTICATE:
925 mlme_event_auth(drv, nla_data(frame), nla_len(frame));
926 break;
927 case NL80211_CMD_ASSOCIATE:
928 mlme_event_assoc(drv, nla_data(frame), nla_len(frame), wmm,
929 req_ie);
930 break;
931 case NL80211_CMD_DEAUTHENTICATE:
932 mlme_event_deauth_disassoc(drv, EVENT_DEAUTH,
933 nla_data(frame), nla_len(frame));
934 break;
935 case NL80211_CMD_DISASSOCIATE:
936 mlme_event_deauth_disassoc(drv, EVENT_DISASSOC,
937 nla_data(frame), nla_len(frame));
938 break;
939 case NL80211_CMD_FRAME:
940 mlme_event_mgmt(bss, freq, sig, nla_data(frame),
941 nla_len(frame));
942 break;
943 case NL80211_CMD_FRAME_TX_STATUS:
944 mlme_event_mgmt_tx_status(drv, cookie, nla_data(frame),
945 nla_len(frame), ack);
946 break;
947 case NL80211_CMD_UNPROT_DEAUTHENTICATE:
948 mlme_event_unprot_disconnect(drv, EVENT_UNPROT_DEAUTH,
949 nla_data(frame), nla_len(frame));
950 break;
951 case NL80211_CMD_UNPROT_DISASSOCIATE:
952 mlme_event_unprot_disconnect(drv, EVENT_UNPROT_DISASSOC,
953 nla_data(frame), nla_len(frame));
954 break;
955 default:
956 break;
957 }
958 }
959
960
mlme_event_michael_mic_failure(struct i802_bss * bss,struct nlattr * tb[])961 static void mlme_event_michael_mic_failure(struct i802_bss *bss,
962 struct nlattr *tb[])
963 {
964 union wpa_event_data data;
965
966 wpa_printf(MSG_DEBUG, "nl80211: MLME event Michael MIC failure");
967 os_memset(&data, 0, sizeof(data));
968 if (tb[NL80211_ATTR_MAC]) {
969 wpa_hexdump(MSG_DEBUG, "nl80211: Source MAC address",
970 nla_data(tb[NL80211_ATTR_MAC]),
971 nla_len(tb[NL80211_ATTR_MAC]));
972 data.michael_mic_failure.src = nla_data(tb[NL80211_ATTR_MAC]);
973 }
974 if (tb[NL80211_ATTR_KEY_SEQ]) {
975 wpa_hexdump(MSG_DEBUG, "nl80211: TSC",
976 nla_data(tb[NL80211_ATTR_KEY_SEQ]),
977 nla_len(tb[NL80211_ATTR_KEY_SEQ]));
978 }
979 if (tb[NL80211_ATTR_KEY_TYPE]) {
980 enum nl80211_key_type key_type =
981 nla_get_u32(tb[NL80211_ATTR_KEY_TYPE]);
982 wpa_printf(MSG_DEBUG, "nl80211: Key Type %d", key_type);
983 if (key_type == NL80211_KEYTYPE_PAIRWISE)
984 data.michael_mic_failure.unicast = 1;
985 } else
986 data.michael_mic_failure.unicast = 1;
987
988 if (tb[NL80211_ATTR_KEY_IDX]) {
989 u8 key_id = nla_get_u8(tb[NL80211_ATTR_KEY_IDX]);
990 wpa_printf(MSG_DEBUG, "nl80211: Key Id %d", key_id);
991 }
992
993 wpa_supplicant_event(bss->ctx, EVENT_MICHAEL_MIC_FAILURE, &data);
994 }
995
996
mlme_event_join_ibss(struct wpa_driver_nl80211_data * drv,struct nlattr * tb[])997 static void mlme_event_join_ibss(struct wpa_driver_nl80211_data *drv,
998 struct nlattr *tb[])
999 {
1000 unsigned int freq;
1001 union wpa_event_data event;
1002
1003 if (tb[NL80211_ATTR_MAC] == NULL) {
1004 wpa_printf(MSG_DEBUG, "nl80211: No address in IBSS joined "
1005 "event");
1006 return;
1007 }
1008 os_memcpy(drv->bssid, nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1009
1010 drv->associated = 1;
1011 wpa_printf(MSG_DEBUG, "nl80211: IBSS " MACSTR " joined",
1012 MAC2STR(drv->bssid));
1013
1014 freq = nl80211_get_assoc_freq(drv);
1015 if (freq) {
1016 wpa_printf(MSG_DEBUG, "nl80211: IBSS on frequency %u MHz",
1017 freq);
1018 drv->first_bss->freq = freq;
1019 }
1020
1021 os_memset(&event, 0, sizeof(event));
1022 event.assoc_info.freq = freq;
1023
1024 wpa_supplicant_event(drv->ctx, EVENT_ASSOC, &event);
1025 }
1026
1027
mlme_event_remain_on_channel(struct wpa_driver_nl80211_data * drv,int cancel_event,struct nlattr * tb[])1028 static void mlme_event_remain_on_channel(struct wpa_driver_nl80211_data *drv,
1029 int cancel_event, struct nlattr *tb[])
1030 {
1031 unsigned int freq, chan_type, duration;
1032 union wpa_event_data data;
1033 u64 cookie;
1034
1035 if (tb[NL80211_ATTR_WIPHY_FREQ])
1036 freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
1037 else
1038 freq = 0;
1039
1040 if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE])
1041 chan_type = nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]);
1042 else
1043 chan_type = 0;
1044
1045 if (tb[NL80211_ATTR_DURATION])
1046 duration = nla_get_u32(tb[NL80211_ATTR_DURATION]);
1047 else
1048 duration = 0;
1049
1050 if (tb[NL80211_ATTR_COOKIE])
1051 cookie = nla_get_u64(tb[NL80211_ATTR_COOKIE]);
1052 else
1053 cookie = 0;
1054
1055 wpa_printf(MSG_DEBUG, "nl80211: Remain-on-channel event (cancel=%d "
1056 "freq=%u channel_type=%u duration=%u cookie=0x%llx (%s))",
1057 cancel_event, freq, chan_type, duration,
1058 (long long unsigned int) cookie,
1059 cookie == drv->remain_on_chan_cookie ? "match" : "unknown");
1060
1061 if (cookie != drv->remain_on_chan_cookie)
1062 return; /* not for us */
1063
1064 if (cancel_event)
1065 drv->pending_remain_on_chan = 0;
1066
1067 os_memset(&data, 0, sizeof(data));
1068 data.remain_on_channel.freq = freq;
1069 data.remain_on_channel.duration = duration;
1070 wpa_supplicant_event(drv->ctx, cancel_event ?
1071 EVENT_CANCEL_REMAIN_ON_CHANNEL :
1072 EVENT_REMAIN_ON_CHANNEL, &data);
1073 }
1074
1075
mlme_event_ft_event(struct wpa_driver_nl80211_data * drv,struct nlattr * tb[])1076 static void mlme_event_ft_event(struct wpa_driver_nl80211_data *drv,
1077 struct nlattr *tb[])
1078 {
1079 union wpa_event_data data;
1080
1081 os_memset(&data, 0, sizeof(data));
1082
1083 if (tb[NL80211_ATTR_IE]) {
1084 data.ft_ies.ies = nla_data(tb[NL80211_ATTR_IE]);
1085 data.ft_ies.ies_len = nla_len(tb[NL80211_ATTR_IE]);
1086 }
1087
1088 if (tb[NL80211_ATTR_IE_RIC]) {
1089 data.ft_ies.ric_ies = nla_data(tb[NL80211_ATTR_IE_RIC]);
1090 data.ft_ies.ric_ies_len = nla_len(tb[NL80211_ATTR_IE_RIC]);
1091 }
1092
1093 if (tb[NL80211_ATTR_MAC])
1094 os_memcpy(data.ft_ies.target_ap,
1095 nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1096
1097 wpa_printf(MSG_DEBUG, "nl80211: FT event target_ap " MACSTR,
1098 MAC2STR(data.ft_ies.target_ap));
1099
1100 wpa_supplicant_event(drv->ctx, EVENT_FT_RESPONSE, &data);
1101 }
1102
1103
send_scan_event(struct wpa_driver_nl80211_data * drv,int aborted,struct nlattr * tb[],int external_scan)1104 static void send_scan_event(struct wpa_driver_nl80211_data *drv, int aborted,
1105 struct nlattr *tb[], int external_scan)
1106 {
1107 union wpa_event_data event;
1108 struct nlattr *nl;
1109 int rem;
1110 struct scan_info *info;
1111 #define MAX_REPORT_FREQS 50
1112 int freqs[MAX_REPORT_FREQS];
1113 int num_freqs = 0;
1114
1115 if (!external_scan && drv->scan_for_auth) {
1116 drv->scan_for_auth = 0;
1117 wpa_printf(MSG_DEBUG, "nl80211: Scan results for missing "
1118 "cfg80211 BSS entry");
1119 wpa_driver_nl80211_authenticate_retry(drv);
1120 return;
1121 }
1122
1123 os_memset(&event, 0, sizeof(event));
1124 info = &event.scan_info;
1125 info->aborted = aborted;
1126 info->external_scan = external_scan;
1127 info->nl_scan_event = 1;
1128
1129 if (tb[NL80211_ATTR_SCAN_SSIDS]) {
1130 nla_for_each_nested(nl, tb[NL80211_ATTR_SCAN_SSIDS], rem) {
1131 struct wpa_driver_scan_ssid *s =
1132 &info->ssids[info->num_ssids];
1133 s->ssid = nla_data(nl);
1134 s->ssid_len = nla_len(nl);
1135 wpa_printf(MSG_DEBUG, "nl80211: Scan probed for SSID '%s'",
1136 wpa_ssid_txt(s->ssid, s->ssid_len));
1137 info->num_ssids++;
1138 if (info->num_ssids == WPAS_MAX_SCAN_SSIDS)
1139 break;
1140 }
1141 }
1142 if (tb[NL80211_ATTR_SCAN_FREQUENCIES]) {
1143 char msg[300], *pos, *end;
1144 int res;
1145
1146 pos = msg;
1147 end = pos + sizeof(msg);
1148 *pos = '\0';
1149
1150 nla_for_each_nested(nl, tb[NL80211_ATTR_SCAN_FREQUENCIES], rem)
1151 {
1152 freqs[num_freqs] = nla_get_u32(nl);
1153 res = os_snprintf(pos, end - pos, " %d",
1154 freqs[num_freqs]);
1155 if (!os_snprintf_error(end - pos, res))
1156 pos += res;
1157 num_freqs++;
1158 if (num_freqs == MAX_REPORT_FREQS - 1)
1159 break;
1160 }
1161 info->freqs = freqs;
1162 info->num_freqs = num_freqs;
1163 wpa_printf(MSG_DEBUG, "nl80211: Scan included frequencies:%s",
1164 msg);
1165 }
1166
1167 if (tb[NL80211_ATTR_SCAN_START_TIME_TSF] &&
1168 tb[NL80211_ATTR_SCAN_START_TIME_TSF_BSSID]) {
1169 info->scan_start_tsf =
1170 nla_get_u64(tb[NL80211_ATTR_SCAN_START_TIME_TSF]);
1171 os_memcpy(info->scan_start_tsf_bssid,
1172 nla_data(tb[NL80211_ATTR_SCAN_START_TIME_TSF_BSSID]),
1173 ETH_ALEN);
1174 }
1175
1176 wpa_supplicant_event(drv->ctx, EVENT_SCAN_RESULTS, &event);
1177 }
1178
1179
nl80211_cqm_event(struct wpa_driver_nl80211_data * drv,struct nlattr * tb[])1180 static void nl80211_cqm_event(struct wpa_driver_nl80211_data *drv,
1181 struct nlattr *tb[])
1182 {
1183 static struct nla_policy cqm_policy[NL80211_ATTR_CQM_MAX + 1] = {
1184 [NL80211_ATTR_CQM_RSSI_THOLD] = { .type = NLA_U32 },
1185 [NL80211_ATTR_CQM_RSSI_HYST] = { .type = NLA_U8 },
1186 [NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] = { .type = NLA_U32 },
1187 [NL80211_ATTR_CQM_PKT_LOSS_EVENT] = { .type = NLA_U32 },
1188 [NL80211_ATTR_CQM_TXE_RATE] = { .type = NLA_U32 },
1189 [NL80211_ATTR_CQM_TXE_PKTS] = { .type = NLA_U32 },
1190 [NL80211_ATTR_CQM_TXE_INTVL] = { .type = NLA_U32 },
1191 [NL80211_ATTR_CQM_BEACON_LOSS_EVENT] = { .type = NLA_FLAG },
1192 };
1193 struct nlattr *cqm[NL80211_ATTR_CQM_MAX + 1];
1194 enum nl80211_cqm_rssi_threshold_event event;
1195 union wpa_event_data ed;
1196 struct wpa_signal_info sig;
1197 int res;
1198
1199 if (tb[NL80211_ATTR_CQM] == NULL ||
1200 nla_parse_nested(cqm, NL80211_ATTR_CQM_MAX, tb[NL80211_ATTR_CQM],
1201 cqm_policy)) {
1202 wpa_printf(MSG_DEBUG, "nl80211: Ignore invalid CQM event");
1203 return;
1204 }
1205
1206 os_memset(&ed, 0, sizeof(ed));
1207
1208 if (cqm[NL80211_ATTR_CQM_PKT_LOSS_EVENT]) {
1209 if (!tb[NL80211_ATTR_MAC])
1210 return;
1211 os_memcpy(ed.low_ack.addr, nla_data(tb[NL80211_ATTR_MAC]),
1212 ETH_ALEN);
1213 ed.low_ack.num_packets =
1214 nla_get_u32(cqm[NL80211_ATTR_CQM_PKT_LOSS_EVENT]);
1215 wpa_printf(MSG_DEBUG, "nl80211: Packet loss event for " MACSTR
1216 " (num_packets %u)",
1217 MAC2STR(ed.low_ack.addr), ed.low_ack.num_packets);
1218 wpa_supplicant_event(drv->ctx, EVENT_STATION_LOW_ACK, &ed);
1219 return;
1220 }
1221
1222 if (cqm[NL80211_ATTR_CQM_BEACON_LOSS_EVENT]) {
1223 wpa_printf(MSG_DEBUG, "nl80211: Beacon loss event");
1224 wpa_supplicant_event(drv->ctx, EVENT_BEACON_LOSS, NULL);
1225 return;
1226 }
1227
1228 if (cqm[NL80211_ATTR_CQM_TXE_RATE] &&
1229 cqm[NL80211_ATTR_CQM_TXE_PKTS] &&
1230 cqm[NL80211_ATTR_CQM_TXE_INTVL] &&
1231 cqm[NL80211_ATTR_MAC]) {
1232 wpa_printf(MSG_DEBUG, "nl80211: CQM TXE event for " MACSTR
1233 " (rate: %u pkts: %u interval: %u)",
1234 MAC2STR((u8 *) nla_data(cqm[NL80211_ATTR_MAC])),
1235 nla_get_u32(cqm[NL80211_ATTR_CQM_TXE_RATE]),
1236 nla_get_u32(cqm[NL80211_ATTR_CQM_TXE_PKTS]),
1237 nla_get_u32(cqm[NL80211_ATTR_CQM_TXE_INTVL]));
1238 return;
1239 }
1240
1241 if (cqm[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT] == NULL) {
1242 wpa_printf(MSG_DEBUG,
1243 "nl80211: Not a CQM RSSI threshold event");
1244 return;
1245 }
1246 event = nla_get_u32(cqm[NL80211_ATTR_CQM_RSSI_THRESHOLD_EVENT]);
1247
1248 if (event == NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH) {
1249 wpa_printf(MSG_DEBUG, "nl80211: Connection quality monitor "
1250 "event: RSSI high");
1251 ed.signal_change.above_threshold = 1;
1252 } else if (event == NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW) {
1253 wpa_printf(MSG_DEBUG, "nl80211: Connection quality monitor "
1254 "event: RSSI low");
1255 ed.signal_change.above_threshold = 0;
1256 } else {
1257 wpa_printf(MSG_DEBUG,
1258 "nl80211: Unknown CQM RSSI threshold event: %d",
1259 event);
1260 return;
1261 }
1262
1263 res = nl80211_get_link_signal(drv, &sig);
1264 if (res == 0) {
1265 ed.signal_change.current_signal = sig.current_signal;
1266 ed.signal_change.current_txrate = sig.current_txrate;
1267 wpa_printf(MSG_DEBUG, "nl80211: Signal: %d dBm txrate: %d",
1268 sig.current_signal, sig.current_txrate);
1269 }
1270
1271 res = nl80211_get_link_noise(drv, &sig);
1272 if (res == 0) {
1273 ed.signal_change.current_noise = sig.current_noise;
1274 wpa_printf(MSG_DEBUG, "nl80211: Noise: %d dBm",
1275 sig.current_noise);
1276 }
1277
1278 wpa_supplicant_event(drv->ctx, EVENT_SIGNAL_CHANGE, &ed);
1279 }
1280
1281
nl80211_new_peer_candidate(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)1282 static void nl80211_new_peer_candidate(struct wpa_driver_nl80211_data *drv,
1283 struct nlattr **tb)
1284 {
1285 const u8 *addr;
1286 union wpa_event_data data;
1287
1288 if (drv->nlmode != NL80211_IFTYPE_MESH_POINT ||
1289 !tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_IE])
1290 return;
1291
1292 addr = nla_data(tb[NL80211_ATTR_MAC]);
1293 wpa_printf(MSG_DEBUG, "nl80211: New peer candidate " MACSTR,
1294 MAC2STR(addr));
1295
1296 os_memset(&data, 0, sizeof(data));
1297 data.mesh_peer.peer = addr;
1298 data.mesh_peer.ies = nla_data(tb[NL80211_ATTR_IE]);
1299 data.mesh_peer.ie_len = nla_len(tb[NL80211_ATTR_IE]);
1300 wpa_supplicant_event(drv->ctx, EVENT_NEW_PEER_CANDIDATE, &data);
1301 }
1302
1303
nl80211_new_station_event(struct wpa_driver_nl80211_data * drv,struct i802_bss * bss,struct nlattr ** tb)1304 static void nl80211_new_station_event(struct wpa_driver_nl80211_data *drv,
1305 struct i802_bss *bss,
1306 struct nlattr **tb)
1307 {
1308 u8 *addr;
1309 union wpa_event_data data;
1310
1311 if (tb[NL80211_ATTR_MAC] == NULL)
1312 return;
1313 addr = nla_data(tb[NL80211_ATTR_MAC]);
1314 wpa_printf(MSG_DEBUG, "nl80211: New station " MACSTR, MAC2STR(addr));
1315
1316 if (is_ap_interface(drv->nlmode) && drv->device_ap_sme) {
1317 u8 *ies = NULL;
1318 size_t ies_len = 0;
1319 if (tb[NL80211_ATTR_IE]) {
1320 ies = nla_data(tb[NL80211_ATTR_IE]);
1321 ies_len = nla_len(tb[NL80211_ATTR_IE]);
1322 }
1323 wpa_hexdump(MSG_DEBUG, "nl80211: Assoc Req IEs", ies, ies_len);
1324 drv_event_assoc(bss->ctx, addr, ies, ies_len, 0);
1325 return;
1326 }
1327
1328 if (drv->nlmode != NL80211_IFTYPE_ADHOC)
1329 return;
1330
1331 os_memset(&data, 0, sizeof(data));
1332 os_memcpy(data.ibss_rsn_start.peer, addr, ETH_ALEN);
1333 wpa_supplicant_event(bss->ctx, EVENT_IBSS_RSN_START, &data);
1334 }
1335
1336
nl80211_del_station_event(struct wpa_driver_nl80211_data * drv,struct i802_bss * bss,struct nlattr ** tb)1337 static void nl80211_del_station_event(struct wpa_driver_nl80211_data *drv,
1338 struct i802_bss *bss,
1339 struct nlattr **tb)
1340 {
1341 u8 *addr;
1342 union wpa_event_data data;
1343
1344 if (tb[NL80211_ATTR_MAC] == NULL)
1345 return;
1346 addr = nla_data(tb[NL80211_ATTR_MAC]);
1347 wpa_printf(MSG_DEBUG, "nl80211: Delete station " MACSTR,
1348 MAC2STR(addr));
1349
1350 if (is_ap_interface(drv->nlmode) && drv->device_ap_sme) {
1351 drv_event_disassoc(bss->ctx, addr);
1352 return;
1353 }
1354
1355 if (drv->nlmode != NL80211_IFTYPE_ADHOC)
1356 return;
1357
1358 os_memset(&data, 0, sizeof(data));
1359 os_memcpy(data.ibss_peer_lost.peer, addr, ETH_ALEN);
1360 wpa_supplicant_event(bss->ctx, EVENT_IBSS_PEER_LOST, &data);
1361 }
1362
1363
nl80211_rekey_offload_event(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)1364 static void nl80211_rekey_offload_event(struct wpa_driver_nl80211_data *drv,
1365 struct nlattr **tb)
1366 {
1367 struct nlattr *rekey_info[NUM_NL80211_REKEY_DATA];
1368 static struct nla_policy rekey_policy[NUM_NL80211_REKEY_DATA] = {
1369 [NL80211_REKEY_DATA_KEK] = {
1370 .minlen = NL80211_KEK_LEN,
1371 .maxlen = NL80211_KEK_LEN,
1372 },
1373 [NL80211_REKEY_DATA_KCK] = {
1374 .minlen = NL80211_KCK_LEN,
1375 .maxlen = NL80211_KCK_LEN,
1376 },
1377 [NL80211_REKEY_DATA_REPLAY_CTR] = {
1378 .minlen = NL80211_REPLAY_CTR_LEN,
1379 .maxlen = NL80211_REPLAY_CTR_LEN,
1380 },
1381 };
1382 union wpa_event_data data;
1383
1384 if (!tb[NL80211_ATTR_MAC] ||
1385 !tb[NL80211_ATTR_REKEY_DATA] ||
1386 nla_parse_nested(rekey_info, MAX_NL80211_REKEY_DATA,
1387 tb[NL80211_ATTR_REKEY_DATA], rekey_policy) ||
1388 !rekey_info[NL80211_REKEY_DATA_REPLAY_CTR])
1389 return;
1390
1391 os_memset(&data, 0, sizeof(data));
1392 data.driver_gtk_rekey.bssid = nla_data(tb[NL80211_ATTR_MAC]);
1393 wpa_printf(MSG_DEBUG, "nl80211: Rekey offload event for BSSID " MACSTR,
1394 MAC2STR(data.driver_gtk_rekey.bssid));
1395 data.driver_gtk_rekey.replay_ctr =
1396 nla_data(rekey_info[NL80211_REKEY_DATA_REPLAY_CTR]);
1397 wpa_hexdump(MSG_DEBUG, "nl80211: Rekey offload - Replay Counter",
1398 data.driver_gtk_rekey.replay_ctr, NL80211_REPLAY_CTR_LEN);
1399 wpa_supplicant_event(drv->ctx, EVENT_DRIVER_GTK_REKEY, &data);
1400 }
1401
1402
nl80211_pmksa_candidate_event(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)1403 static void nl80211_pmksa_candidate_event(struct wpa_driver_nl80211_data *drv,
1404 struct nlattr **tb)
1405 {
1406 struct nlattr *cand[NUM_NL80211_PMKSA_CANDIDATE];
1407 static struct nla_policy cand_policy[NUM_NL80211_PMKSA_CANDIDATE] = {
1408 [NL80211_PMKSA_CANDIDATE_INDEX] = { .type = NLA_U32 },
1409 [NL80211_PMKSA_CANDIDATE_BSSID] = {
1410 .minlen = ETH_ALEN,
1411 .maxlen = ETH_ALEN,
1412 },
1413 [NL80211_PMKSA_CANDIDATE_PREAUTH] = { .type = NLA_FLAG },
1414 };
1415 union wpa_event_data data;
1416
1417 wpa_printf(MSG_DEBUG, "nl80211: PMKSA candidate event");
1418
1419 if (!tb[NL80211_ATTR_PMKSA_CANDIDATE] ||
1420 nla_parse_nested(cand, MAX_NL80211_PMKSA_CANDIDATE,
1421 tb[NL80211_ATTR_PMKSA_CANDIDATE], cand_policy) ||
1422 !cand[NL80211_PMKSA_CANDIDATE_INDEX] ||
1423 !cand[NL80211_PMKSA_CANDIDATE_BSSID])
1424 return;
1425
1426 os_memset(&data, 0, sizeof(data));
1427 os_memcpy(data.pmkid_candidate.bssid,
1428 nla_data(cand[NL80211_PMKSA_CANDIDATE_BSSID]), ETH_ALEN);
1429 data.pmkid_candidate.index =
1430 nla_get_u32(cand[NL80211_PMKSA_CANDIDATE_INDEX]);
1431 data.pmkid_candidate.preauth =
1432 cand[NL80211_PMKSA_CANDIDATE_PREAUTH] != NULL;
1433 wpa_supplicant_event(drv->ctx, EVENT_PMKID_CANDIDATE, &data);
1434 }
1435
1436
nl80211_client_probe_event(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)1437 static void nl80211_client_probe_event(struct wpa_driver_nl80211_data *drv,
1438 struct nlattr **tb)
1439 {
1440 union wpa_event_data data;
1441 const u8 *addr;
1442 u64 cookie = 0;
1443
1444 addr = nla_data(tb[NL80211_ATTR_MAC]);
1445 if (!addr)
1446 return;
1447 if (tb[NL80211_ATTR_COOKIE])
1448 cookie = nla_get_u64(tb[NL80211_ATTR_COOKIE]);
1449 wpa_printf(MSG_DEBUG, "nl80211: Probe client event (addr=" MACSTR
1450 " ack=%d cookie=%llu)", MAC2STR(addr),
1451 tb[NL80211_ATTR_ACK] != NULL,
1452 (long long unsigned int) cookie);
1453 if (!tb[NL80211_ATTR_ACK])
1454 return;
1455
1456 os_memset(&data, 0, sizeof(data));
1457 os_memcpy(data.client_poll.addr, addr, ETH_ALEN);
1458 wpa_supplicant_event(drv->ctx, EVENT_DRIVER_CLIENT_POLL_OK, &data);
1459 }
1460
1461
nl80211_tdls_oper_event(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)1462 static void nl80211_tdls_oper_event(struct wpa_driver_nl80211_data *drv,
1463 struct nlattr **tb)
1464 {
1465 union wpa_event_data data;
1466
1467 wpa_printf(MSG_DEBUG, "nl80211: TDLS operation event");
1468
1469 if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_TDLS_OPERATION])
1470 return;
1471
1472 os_memset(&data, 0, sizeof(data));
1473 os_memcpy(data.tdls.peer, nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1474 switch (nla_get_u8(tb[NL80211_ATTR_TDLS_OPERATION])) {
1475 case NL80211_TDLS_SETUP:
1476 wpa_printf(MSG_DEBUG, "nl80211: TDLS setup request for peer "
1477 MACSTR, MAC2STR(data.tdls.peer));
1478 data.tdls.oper = TDLS_REQUEST_SETUP;
1479 break;
1480 case NL80211_TDLS_TEARDOWN:
1481 wpa_printf(MSG_DEBUG, "nl80211: TDLS teardown request for peer "
1482 MACSTR, MAC2STR(data.tdls.peer));
1483 data.tdls.oper = TDLS_REQUEST_TEARDOWN;
1484 break;
1485 case NL80211_TDLS_DISCOVERY_REQ:
1486 wpa_printf(MSG_DEBUG,
1487 "nl80211: TDLS discovery request for peer " MACSTR,
1488 MAC2STR(data.tdls.peer));
1489 data.tdls.oper = TDLS_REQUEST_DISCOVER;
1490 break;
1491 default:
1492 wpa_printf(MSG_DEBUG, "nl80211: Unsupported TDLS operatione "
1493 "event");
1494 return;
1495 }
1496 if (tb[NL80211_ATTR_REASON_CODE]) {
1497 data.tdls.reason_code =
1498 nla_get_u16(tb[NL80211_ATTR_REASON_CODE]);
1499 }
1500
1501 wpa_supplicant_event(drv->ctx, EVENT_TDLS, &data);
1502 }
1503
1504
nl80211_stop_ap(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)1505 static void nl80211_stop_ap(struct wpa_driver_nl80211_data *drv,
1506 struct nlattr **tb)
1507 {
1508 wpa_supplicant_event(drv->ctx, EVENT_INTERFACE_UNAVAILABLE, NULL);
1509 }
1510
1511
nl80211_connect_failed_event(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)1512 static void nl80211_connect_failed_event(struct wpa_driver_nl80211_data *drv,
1513 struct nlattr **tb)
1514 {
1515 union wpa_event_data data;
1516 u32 reason;
1517
1518 wpa_printf(MSG_DEBUG, "nl80211: Connect failed event");
1519
1520 if (!tb[NL80211_ATTR_MAC] || !tb[NL80211_ATTR_CONN_FAILED_REASON])
1521 return;
1522
1523 os_memset(&data, 0, sizeof(data));
1524 os_memcpy(data.connect_failed_reason.addr,
1525 nla_data(tb[NL80211_ATTR_MAC]), ETH_ALEN);
1526
1527 reason = nla_get_u32(tb[NL80211_ATTR_CONN_FAILED_REASON]);
1528 switch (reason) {
1529 case NL80211_CONN_FAIL_MAX_CLIENTS:
1530 wpa_printf(MSG_DEBUG, "nl80211: Max client reached");
1531 data.connect_failed_reason.code = MAX_CLIENT_REACHED;
1532 break;
1533 case NL80211_CONN_FAIL_BLOCKED_CLIENT:
1534 wpa_printf(MSG_DEBUG, "nl80211: Blocked client " MACSTR
1535 " tried to connect",
1536 MAC2STR(data.connect_failed_reason.addr));
1537 data.connect_failed_reason.code = BLOCKED_CLIENT;
1538 break;
1539 default:
1540 wpa_printf(MSG_DEBUG, "nl8021l: Unknown connect failed reason "
1541 "%u", reason);
1542 return;
1543 }
1544
1545 wpa_supplicant_event(drv->ctx, EVENT_CONNECT_FAILED_REASON, &data);
1546 }
1547
1548
nl80211_radar_event(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)1549 static void nl80211_radar_event(struct wpa_driver_nl80211_data *drv,
1550 struct nlattr **tb)
1551 {
1552 union wpa_event_data data;
1553 enum nl80211_radar_event event_type;
1554
1555 if (!tb[NL80211_ATTR_WIPHY_FREQ] || !tb[NL80211_ATTR_RADAR_EVENT])
1556 return;
1557
1558 os_memset(&data, 0, sizeof(data));
1559 data.dfs_event.freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
1560 event_type = nla_get_u32(tb[NL80211_ATTR_RADAR_EVENT]);
1561
1562 /* Check HT params */
1563 if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
1564 data.dfs_event.ht_enabled = 1;
1565 data.dfs_event.chan_offset = 0;
1566
1567 switch (nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE])) {
1568 case NL80211_CHAN_NO_HT:
1569 data.dfs_event.ht_enabled = 0;
1570 break;
1571 case NL80211_CHAN_HT20:
1572 break;
1573 case NL80211_CHAN_HT40PLUS:
1574 data.dfs_event.chan_offset = 1;
1575 break;
1576 case NL80211_CHAN_HT40MINUS:
1577 data.dfs_event.chan_offset = -1;
1578 break;
1579 }
1580 }
1581
1582 /* Get VHT params */
1583 if (tb[NL80211_ATTR_CHANNEL_WIDTH])
1584 data.dfs_event.chan_width =
1585 convert2width(nla_get_u32(
1586 tb[NL80211_ATTR_CHANNEL_WIDTH]));
1587 if (tb[NL80211_ATTR_CENTER_FREQ1])
1588 data.dfs_event.cf1 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ1]);
1589 if (tb[NL80211_ATTR_CENTER_FREQ2])
1590 data.dfs_event.cf2 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ2]);
1591
1592 wpa_printf(MSG_DEBUG, "nl80211: DFS event on freq %d MHz, ht: %d, offset: %d, width: %d, cf1: %dMHz, cf2: %dMHz",
1593 data.dfs_event.freq, data.dfs_event.ht_enabled,
1594 data.dfs_event.chan_offset, data.dfs_event.chan_width,
1595 data.dfs_event.cf1, data.dfs_event.cf2);
1596
1597 switch (event_type) {
1598 case NL80211_RADAR_DETECTED:
1599 wpa_supplicant_event(drv->ctx, EVENT_DFS_RADAR_DETECTED, &data);
1600 break;
1601 case NL80211_RADAR_CAC_FINISHED:
1602 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_FINISHED, &data);
1603 break;
1604 case NL80211_RADAR_CAC_ABORTED:
1605 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_ABORTED, &data);
1606 break;
1607 case NL80211_RADAR_NOP_FINISHED:
1608 wpa_supplicant_event(drv->ctx, EVENT_DFS_NOP_FINISHED, &data);
1609 break;
1610 case NL80211_RADAR_PRE_CAC_EXPIRED:
1611 wpa_supplicant_event(drv->ctx, EVENT_DFS_PRE_CAC_EXPIRED,
1612 &data);
1613 break;
1614 case NL80211_RADAR_CAC_STARTED:
1615 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_STARTED, &data);
1616 break;
1617 default:
1618 wpa_printf(MSG_DEBUG, "nl80211: Unknown radar event %d "
1619 "received", event_type);
1620 break;
1621 }
1622 }
1623
1624
nl80211_spurious_frame(struct i802_bss * bss,struct nlattr ** tb,int wds)1625 static void nl80211_spurious_frame(struct i802_bss *bss, struct nlattr **tb,
1626 int wds)
1627 {
1628 struct wpa_driver_nl80211_data *drv = bss->drv;
1629 union wpa_event_data event;
1630
1631 if (!tb[NL80211_ATTR_MAC])
1632 return;
1633
1634 os_memset(&event, 0, sizeof(event));
1635 event.rx_from_unknown.bssid = bss->addr;
1636 event.rx_from_unknown.addr = nla_data(tb[NL80211_ATTR_MAC]);
1637 event.rx_from_unknown.wds = wds;
1638
1639 wpa_supplicant_event(drv->ctx, EVENT_RX_FROM_UNKNOWN, &event);
1640 }
1641
1642
1643 #ifdef CONFIG_DRIVER_NL80211_QCA
1644
qca_nl80211_avoid_freq(struct wpa_driver_nl80211_data * drv,const u8 * data,size_t len)1645 static void qca_nl80211_avoid_freq(struct wpa_driver_nl80211_data *drv,
1646 const u8 *data, size_t len)
1647 {
1648 u32 i, count;
1649 union wpa_event_data event;
1650 struct wpa_freq_range *range = NULL;
1651 const struct qca_avoid_freq_list *freq_range;
1652
1653 freq_range = (const struct qca_avoid_freq_list *) data;
1654 if (len < sizeof(freq_range->count))
1655 return;
1656
1657 count = freq_range->count;
1658 if (len < sizeof(freq_range->count) +
1659 count * sizeof(struct qca_avoid_freq_range)) {
1660 wpa_printf(MSG_DEBUG, "nl80211: Ignored too short avoid frequency list (len=%u)",
1661 (unsigned int) len);
1662 return;
1663 }
1664
1665 if (count > 0) {
1666 range = os_calloc(count, sizeof(struct wpa_freq_range));
1667 if (range == NULL)
1668 return;
1669 }
1670
1671 os_memset(&event, 0, sizeof(event));
1672 for (i = 0; i < count; i++) {
1673 unsigned int idx = event.freq_range.num;
1674 range[idx].min = freq_range->range[i].start_freq;
1675 range[idx].max = freq_range->range[i].end_freq;
1676 wpa_printf(MSG_DEBUG, "nl80211: Avoid frequency range: %u-%u",
1677 range[idx].min, range[idx].max);
1678 if (range[idx].min > range[idx].max) {
1679 wpa_printf(MSG_DEBUG, "nl80211: Ignore invalid frequency range");
1680 continue;
1681 }
1682 event.freq_range.num++;
1683 }
1684 event.freq_range.range = range;
1685
1686 wpa_supplicant_event(drv->ctx, EVENT_AVOID_FREQUENCIES, &event);
1687
1688 os_free(range);
1689 }
1690
1691
get_qca_hw_mode(u8 hw_mode)1692 static enum hostapd_hw_mode get_qca_hw_mode(u8 hw_mode)
1693 {
1694 switch (hw_mode) {
1695 case QCA_ACS_MODE_IEEE80211B:
1696 return HOSTAPD_MODE_IEEE80211B;
1697 case QCA_ACS_MODE_IEEE80211G:
1698 return HOSTAPD_MODE_IEEE80211G;
1699 case QCA_ACS_MODE_IEEE80211A:
1700 return HOSTAPD_MODE_IEEE80211A;
1701 case QCA_ACS_MODE_IEEE80211AD:
1702 return HOSTAPD_MODE_IEEE80211AD;
1703 case QCA_ACS_MODE_IEEE80211ANY:
1704 return HOSTAPD_MODE_IEEE80211ANY;
1705 default:
1706 return NUM_HOSTAPD_MODES;
1707 }
1708 }
1709
1710
qca_nl80211_acs_select_ch(struct wpa_driver_nl80211_data * drv,const u8 * data,size_t len)1711 static void qca_nl80211_acs_select_ch(struct wpa_driver_nl80211_data *drv,
1712 const u8 *data, size_t len)
1713 {
1714 struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_ACS_MAX + 1];
1715 union wpa_event_data event;
1716
1717 wpa_printf(MSG_DEBUG,
1718 "nl80211: ACS channel selection vendor event received");
1719
1720 if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_ACS_MAX,
1721 (struct nlattr *) data, len, NULL) ||
1722 !tb[QCA_WLAN_VENDOR_ATTR_ACS_PRIMARY_CHANNEL] ||
1723 !tb[QCA_WLAN_VENDOR_ATTR_ACS_SECONDARY_CHANNEL])
1724 return;
1725
1726 os_memset(&event, 0, sizeof(event));
1727 event.acs_selected_channels.pri_channel =
1728 nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_PRIMARY_CHANNEL]);
1729 event.acs_selected_channels.sec_channel =
1730 nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_SECONDARY_CHANNEL]);
1731 if (tb[QCA_WLAN_VENDOR_ATTR_ACS_VHT_SEG0_CENTER_CHANNEL])
1732 event.acs_selected_channels.vht_seg0_center_ch =
1733 nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_VHT_SEG0_CENTER_CHANNEL]);
1734 if (tb[QCA_WLAN_VENDOR_ATTR_ACS_VHT_SEG0_CENTER_CHANNEL])
1735 event.acs_selected_channels.vht_seg1_center_ch =
1736 nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_VHT_SEG1_CENTER_CHANNEL]);
1737 if (tb[QCA_WLAN_VENDOR_ATTR_ACS_CHWIDTH])
1738 event.acs_selected_channels.ch_width =
1739 nla_get_u16(tb[QCA_WLAN_VENDOR_ATTR_ACS_CHWIDTH]);
1740 if (tb[QCA_WLAN_VENDOR_ATTR_ACS_HW_MODE]) {
1741 u8 hw_mode = nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_ACS_HW_MODE]);
1742
1743 event.acs_selected_channels.hw_mode = get_qca_hw_mode(hw_mode);
1744 if (event.acs_selected_channels.hw_mode == NUM_HOSTAPD_MODES ||
1745 event.acs_selected_channels.hw_mode ==
1746 HOSTAPD_MODE_IEEE80211ANY) {
1747 wpa_printf(MSG_DEBUG,
1748 "nl80211: Invalid hw_mode %d in ACS selection event",
1749 hw_mode);
1750 return;
1751 }
1752 }
1753
1754 wpa_printf(MSG_INFO,
1755 "nl80211: ACS Results: PCH: %d SCH: %d BW: %d VHT0: %d VHT1: %d HW_MODE: %d",
1756 event.acs_selected_channels.pri_channel,
1757 event.acs_selected_channels.sec_channel,
1758 event.acs_selected_channels.ch_width,
1759 event.acs_selected_channels.vht_seg0_center_ch,
1760 event.acs_selected_channels.vht_seg1_center_ch,
1761 event.acs_selected_channels.hw_mode);
1762
1763 /* Ignore ACS channel list check for backwards compatibility */
1764
1765 wpa_supplicant_event(drv->ctx, EVENT_ACS_CHANNEL_SELECTED, &event);
1766 }
1767
1768
qca_nl80211_key_mgmt_auth(struct wpa_driver_nl80211_data * drv,const u8 * data,size_t len)1769 static void qca_nl80211_key_mgmt_auth(struct wpa_driver_nl80211_data *drv,
1770 const u8 *data, size_t len)
1771 {
1772 struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_MAX + 1];
1773 u8 *bssid;
1774
1775 wpa_printf(MSG_DEBUG,
1776 "nl80211: Key management roam+auth vendor event received");
1777
1778 if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_MAX,
1779 (struct nlattr *) data, len, NULL) ||
1780 !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID] ||
1781 nla_len(tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID]) != ETH_ALEN ||
1782 !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_REQ_IE] ||
1783 !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_RESP_IE] ||
1784 !tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_AUTHORIZED])
1785 return;
1786
1787 bssid = nla_data(tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID]);
1788 wpa_printf(MSG_DEBUG, " * roam BSSID " MACSTR, MAC2STR(bssid));
1789
1790 mlme_event_connect(drv, NL80211_CMD_ROAM, NULL,
1791 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_BSSID],
1792 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_REQ_IE],
1793 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_RESP_IE],
1794 NULL, NULL,
1795 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_AUTHORIZED],
1796 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_KEY_REPLAY_CTR],
1797 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_PTK_KCK],
1798 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_PTK_KEK],
1799 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_SUBNET_STATUS],
1800 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_FILS_ERP_NEXT_SEQ_NUM],
1801 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_PMK],
1802 tb[QCA_WLAN_VENDOR_ATTR_ROAM_AUTH_PMKID]);
1803 }
1804
1805
qca_nl80211_dfs_offload_radar_event(struct wpa_driver_nl80211_data * drv,u32 subcmd,u8 * msg,int length)1806 static void qca_nl80211_dfs_offload_radar_event(
1807 struct wpa_driver_nl80211_data *drv, u32 subcmd, u8 *msg, int length)
1808 {
1809 union wpa_event_data data;
1810 struct nlattr *tb[NL80211_ATTR_MAX + 1];
1811
1812 wpa_printf(MSG_DEBUG,
1813 "nl80211: DFS offload radar vendor event received");
1814
1815 if (nla_parse(tb, NL80211_ATTR_MAX,
1816 (struct nlattr *) msg, length, NULL))
1817 return;
1818
1819 if (!tb[NL80211_ATTR_WIPHY_FREQ]) {
1820 wpa_printf(MSG_INFO,
1821 "nl80211: Error parsing WIPHY_FREQ in FS offload radar vendor event");
1822 return;
1823 }
1824
1825 os_memset(&data, 0, sizeof(data));
1826 data.dfs_event.freq = nla_get_u32(tb[NL80211_ATTR_WIPHY_FREQ]);
1827
1828 wpa_printf(MSG_DEBUG, "nl80211: DFS event on freq %d MHz",
1829 data.dfs_event.freq);
1830
1831 /* Check HT params */
1832 if (tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE]) {
1833 data.dfs_event.ht_enabled = 1;
1834 data.dfs_event.chan_offset = 0;
1835
1836 switch (nla_get_u32(tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE])) {
1837 case NL80211_CHAN_NO_HT:
1838 data.dfs_event.ht_enabled = 0;
1839 break;
1840 case NL80211_CHAN_HT20:
1841 break;
1842 case NL80211_CHAN_HT40PLUS:
1843 data.dfs_event.chan_offset = 1;
1844 break;
1845 case NL80211_CHAN_HT40MINUS:
1846 data.dfs_event.chan_offset = -1;
1847 break;
1848 }
1849 }
1850
1851 /* Get VHT params */
1852 if (tb[NL80211_ATTR_CHANNEL_WIDTH])
1853 data.dfs_event.chan_width =
1854 convert2width(nla_get_u32(
1855 tb[NL80211_ATTR_CHANNEL_WIDTH]));
1856 if (tb[NL80211_ATTR_CENTER_FREQ1])
1857 data.dfs_event.cf1 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ1]);
1858 if (tb[NL80211_ATTR_CENTER_FREQ2])
1859 data.dfs_event.cf2 = nla_get_u32(tb[NL80211_ATTR_CENTER_FREQ2]);
1860
1861 wpa_printf(MSG_DEBUG, "nl80211: DFS event on freq %d MHz, ht: %d, "
1862 "offset: %d, width: %d, cf1: %dMHz, cf2: %dMHz",
1863 data.dfs_event.freq, data.dfs_event.ht_enabled,
1864 data.dfs_event.chan_offset, data.dfs_event.chan_width,
1865 data.dfs_event.cf1, data.dfs_event.cf2);
1866
1867 switch (subcmd) {
1868 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_RADAR_DETECTED:
1869 wpa_supplicant_event(drv->ctx, EVENT_DFS_RADAR_DETECTED, &data);
1870 break;
1871 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_STARTED:
1872 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_STARTED, &data);
1873 break;
1874 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_FINISHED:
1875 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_FINISHED, &data);
1876 break;
1877 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_ABORTED:
1878 wpa_supplicant_event(drv->ctx, EVENT_DFS_CAC_ABORTED, &data);
1879 break;
1880 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_NOP_FINISHED:
1881 wpa_supplicant_event(drv->ctx, EVENT_DFS_NOP_FINISHED, &data);
1882 break;
1883 default:
1884 wpa_printf(MSG_DEBUG,
1885 "nl80211: Unknown DFS offload radar event %d received",
1886 subcmd);
1887 break;
1888 }
1889 }
1890
1891
qca_nl80211_scan_trigger_event(struct wpa_driver_nl80211_data * drv,u8 * data,size_t len)1892 static void qca_nl80211_scan_trigger_event(struct wpa_driver_nl80211_data *drv,
1893 u8 *data, size_t len)
1894 {
1895 struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_SCAN_MAX + 1];
1896 u64 cookie = 0;
1897 union wpa_event_data event;
1898 struct scan_info *info;
1899
1900 if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_SCAN_MAX,
1901 (struct nlattr *) data, len, NULL) ||
1902 !tb[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE])
1903 return;
1904
1905 cookie = nla_get_u64(tb[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE]);
1906 if (cookie != drv->vendor_scan_cookie) {
1907 /* External scan trigger event, ignore */
1908 return;
1909 }
1910
1911 /* Cookie match, own scan */
1912 os_memset(&event, 0, sizeof(event));
1913 info = &event.scan_info;
1914 info->external_scan = 0;
1915 info->nl_scan_event = 0;
1916
1917 drv->scan_state = SCAN_STARTED;
1918 wpa_supplicant_event(drv->ctx, EVENT_SCAN_STARTED, &event);
1919 }
1920
1921
send_vendor_scan_event(struct wpa_driver_nl80211_data * drv,int aborted,struct nlattr * tb[],int external_scan)1922 static void send_vendor_scan_event(struct wpa_driver_nl80211_data *drv,
1923 int aborted, struct nlattr *tb[],
1924 int external_scan)
1925 {
1926 union wpa_event_data event;
1927 struct nlattr *nl;
1928 int rem;
1929 struct scan_info *info;
1930 int freqs[MAX_REPORT_FREQS];
1931 int num_freqs = 0;
1932
1933 os_memset(&event, 0, sizeof(event));
1934 info = &event.scan_info;
1935 info->aborted = aborted;
1936 info->external_scan = external_scan;
1937
1938 if (tb[QCA_WLAN_VENDOR_ATTR_SCAN_SSIDS]) {
1939 nla_for_each_nested(nl,
1940 tb[QCA_WLAN_VENDOR_ATTR_SCAN_SSIDS], rem) {
1941 struct wpa_driver_scan_ssid *s =
1942 &info->ssids[info->num_ssids];
1943 s->ssid = nla_data(nl);
1944 s->ssid_len = nla_len(nl);
1945 wpa_printf(MSG_DEBUG,
1946 "nl80211: Scan probed for SSID '%s'",
1947 wpa_ssid_txt(s->ssid, s->ssid_len));
1948 info->num_ssids++;
1949 if (info->num_ssids == WPAS_MAX_SCAN_SSIDS)
1950 break;
1951 }
1952 }
1953
1954 if (tb[QCA_WLAN_VENDOR_ATTR_SCAN_FREQUENCIES]) {
1955 char msg[300], *pos, *end;
1956 int res;
1957
1958 pos = msg;
1959 end = pos + sizeof(msg);
1960 *pos = '\0';
1961
1962 nla_for_each_nested(nl,
1963 tb[QCA_WLAN_VENDOR_ATTR_SCAN_FREQUENCIES],
1964 rem) {
1965 freqs[num_freqs] = nla_get_u32(nl);
1966 res = os_snprintf(pos, end - pos, " %d",
1967 freqs[num_freqs]);
1968 if (!os_snprintf_error(end - pos, res))
1969 pos += res;
1970 num_freqs++;
1971 if (num_freqs == MAX_REPORT_FREQS - 1)
1972 break;
1973 }
1974
1975 info->freqs = freqs;
1976 info->num_freqs = num_freqs;
1977 wpa_printf(MSG_DEBUG, "nl80211: Scan included frequencies:%s",
1978 msg);
1979 }
1980 wpa_supplicant_event(drv->ctx, EVENT_SCAN_RESULTS, &event);
1981 }
1982
1983
qca_nl80211_scan_done_event(struct wpa_driver_nl80211_data * drv,u8 * data,size_t len)1984 static void qca_nl80211_scan_done_event(struct wpa_driver_nl80211_data *drv,
1985 u8 *data, size_t len)
1986 {
1987 struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_SCAN_MAX + 1];
1988 u64 cookie = 0;
1989 enum scan_status status;
1990 int external_scan;
1991
1992 if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_SCAN_MAX,
1993 (struct nlattr *) data, len, NULL) ||
1994 !tb[QCA_WLAN_VENDOR_ATTR_SCAN_STATUS] ||
1995 !tb[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE])
1996 return;
1997
1998 status = nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_SCAN_STATUS]);
1999 if (status >= VENDOR_SCAN_STATUS_MAX)
2000 return; /* invalid status */
2001
2002 cookie = nla_get_u64(tb[QCA_WLAN_VENDOR_ATTR_SCAN_COOKIE]);
2003 if (cookie != drv->vendor_scan_cookie) {
2004 /* Event from an external scan, get scan results */
2005 external_scan = 1;
2006 } else {
2007 external_scan = 0;
2008 if (status == VENDOR_SCAN_STATUS_NEW_RESULTS)
2009 drv->scan_state = SCAN_COMPLETED;
2010 else
2011 drv->scan_state = SCAN_ABORTED;
2012
2013 eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout, drv,
2014 drv->ctx);
2015 drv->vendor_scan_cookie = 0;
2016 drv->last_scan_cmd = 0;
2017 }
2018
2019 send_vendor_scan_event(drv, (status == VENDOR_SCAN_STATUS_ABORTED), tb,
2020 external_scan);
2021 }
2022
2023
qca_nl80211_p2p_lo_stop_event(struct wpa_driver_nl80211_data * drv,u8 * data,size_t len)2024 static void qca_nl80211_p2p_lo_stop_event(struct wpa_driver_nl80211_data *drv,
2025 u8 *data, size_t len)
2026 {
2027 struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_P2P_LISTEN_OFFLOAD_MAX + 1];
2028 union wpa_event_data event;
2029
2030 wpa_printf(MSG_DEBUG,
2031 "nl80211: P2P listen offload stop vendor event received");
2032
2033 if (nla_parse(tb, QCA_WLAN_VENDOR_ATTR_P2P_LISTEN_OFFLOAD_MAX,
2034 (struct nlattr *) data, len, NULL) ||
2035 !tb[QCA_WLAN_VENDOR_ATTR_P2P_LISTEN_OFFLOAD_STOP_REASON])
2036 return;
2037
2038 os_memset(&event, 0, sizeof(event));
2039 event.p2p_lo_stop.reason_code =
2040 nla_get_u8(tb[QCA_WLAN_VENDOR_ATTR_P2P_LISTEN_OFFLOAD_STOP_REASON]);
2041
2042 wpa_printf(MSG_DEBUG,
2043 "nl80211: P2P Listen offload stop reason: %d",
2044 event.p2p_lo_stop.reason_code);
2045 wpa_supplicant_event(drv->ctx, EVENT_P2P_LO_STOP, &event);
2046 }
2047
2048 #endif /* CONFIG_DRIVER_NL80211_QCA */
2049
2050
nl80211_vendor_event_qca(struct wpa_driver_nl80211_data * drv,u32 subcmd,u8 * data,size_t len)2051 static void nl80211_vendor_event_qca(struct wpa_driver_nl80211_data *drv,
2052 u32 subcmd, u8 *data, size_t len)
2053 {
2054 switch (subcmd) {
2055 case QCA_NL80211_VENDOR_SUBCMD_TEST:
2056 wpa_hexdump(MSG_DEBUG, "nl80211: QCA test event", data, len);
2057 break;
2058 #ifdef CONFIG_DRIVER_NL80211_QCA
2059 case QCA_NL80211_VENDOR_SUBCMD_AVOID_FREQUENCY:
2060 qca_nl80211_avoid_freq(drv, data, len);
2061 break;
2062 case QCA_NL80211_VENDOR_SUBCMD_KEY_MGMT_ROAM_AUTH:
2063 qca_nl80211_key_mgmt_auth(drv, data, len);
2064 break;
2065 case QCA_NL80211_VENDOR_SUBCMD_DO_ACS:
2066 qca_nl80211_acs_select_ch(drv, data, len);
2067 break;
2068 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_STARTED:
2069 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_FINISHED:
2070 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_ABORTED:
2071 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_CAC_NOP_FINISHED:
2072 case QCA_NL80211_VENDOR_SUBCMD_DFS_OFFLOAD_RADAR_DETECTED:
2073 qca_nl80211_dfs_offload_radar_event(drv, subcmd, data, len);
2074 break;
2075 case QCA_NL80211_VENDOR_SUBCMD_TRIGGER_SCAN:
2076 qca_nl80211_scan_trigger_event(drv, data, len);
2077 break;
2078 case QCA_NL80211_VENDOR_SUBCMD_SCAN_DONE:
2079 qca_nl80211_scan_done_event(drv, data, len);
2080 break;
2081 case QCA_NL80211_VENDOR_SUBCMD_P2P_LISTEN_OFFLOAD_STOP:
2082 qca_nl80211_p2p_lo_stop_event(drv, data, len);
2083 break;
2084 #endif /* CONFIG_DRIVER_NL80211_QCA */
2085 default:
2086 wpa_printf(MSG_DEBUG,
2087 "nl80211: Ignore unsupported QCA vendor event %u",
2088 subcmd);
2089 break;
2090 }
2091 }
2092
2093
nl80211_vendor_event(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)2094 static void nl80211_vendor_event(struct wpa_driver_nl80211_data *drv,
2095 struct nlattr **tb)
2096 {
2097 u32 vendor_id, subcmd, wiphy = 0;
2098 int wiphy_idx;
2099 u8 *data = NULL;
2100 size_t len = 0;
2101
2102 if (!tb[NL80211_ATTR_VENDOR_ID] ||
2103 !tb[NL80211_ATTR_VENDOR_SUBCMD])
2104 return;
2105
2106 vendor_id = nla_get_u32(tb[NL80211_ATTR_VENDOR_ID]);
2107 subcmd = nla_get_u32(tb[NL80211_ATTR_VENDOR_SUBCMD]);
2108
2109 if (tb[NL80211_ATTR_WIPHY])
2110 wiphy = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
2111
2112 wpa_printf(MSG_DEBUG, "nl80211: Vendor event: wiphy=%u vendor_id=0x%x subcmd=%u",
2113 wiphy, vendor_id, subcmd);
2114
2115 if (tb[NL80211_ATTR_VENDOR_DATA]) {
2116 data = nla_data(tb[NL80211_ATTR_VENDOR_DATA]);
2117 len = nla_len(tb[NL80211_ATTR_VENDOR_DATA]);
2118 wpa_hexdump(MSG_MSGDUMP, "nl80211: Vendor data", data, len);
2119 }
2120
2121 wiphy_idx = nl80211_get_wiphy_index(drv->first_bss);
2122 if (wiphy_idx >= 0 && wiphy_idx != (int) wiphy) {
2123 wpa_printf(MSG_DEBUG, "nl80211: Ignore vendor event for foreign wiphy %u (own: %d)",
2124 wiphy, wiphy_idx);
2125 return;
2126 }
2127
2128 switch (vendor_id) {
2129 case OUI_QCA:
2130 nl80211_vendor_event_qca(drv, subcmd, data, len);
2131 break;
2132 default:
2133 wpa_printf(MSG_DEBUG, "nl80211: Ignore unsupported vendor event");
2134 break;
2135 }
2136 }
2137
2138
nl80211_reg_change_event(struct wpa_driver_nl80211_data * drv,struct nlattr * tb[])2139 static void nl80211_reg_change_event(struct wpa_driver_nl80211_data *drv,
2140 struct nlattr *tb[])
2141 {
2142 union wpa_event_data data;
2143 enum nl80211_reg_initiator init;
2144
2145 wpa_printf(MSG_DEBUG, "nl80211: Regulatory domain change");
2146
2147 if (tb[NL80211_ATTR_REG_INITIATOR] == NULL)
2148 return;
2149
2150 os_memset(&data, 0, sizeof(data));
2151 init = nla_get_u8(tb[NL80211_ATTR_REG_INITIATOR]);
2152 wpa_printf(MSG_DEBUG, " * initiator=%d", init);
2153 switch (init) {
2154 case NL80211_REGDOM_SET_BY_CORE:
2155 data.channel_list_changed.initiator = REGDOM_SET_BY_CORE;
2156 break;
2157 case NL80211_REGDOM_SET_BY_USER:
2158 data.channel_list_changed.initiator = REGDOM_SET_BY_USER;
2159 break;
2160 case NL80211_REGDOM_SET_BY_DRIVER:
2161 data.channel_list_changed.initiator = REGDOM_SET_BY_DRIVER;
2162 break;
2163 case NL80211_REGDOM_SET_BY_COUNTRY_IE:
2164 data.channel_list_changed.initiator = REGDOM_SET_BY_COUNTRY_IE;
2165 break;
2166 }
2167
2168 if (tb[NL80211_ATTR_REG_TYPE]) {
2169 enum nl80211_reg_type type;
2170 type = nla_get_u8(tb[NL80211_ATTR_REG_TYPE]);
2171 wpa_printf(MSG_DEBUG, " * type=%d", type);
2172 switch (type) {
2173 case NL80211_REGDOM_TYPE_COUNTRY:
2174 data.channel_list_changed.type = REGDOM_TYPE_COUNTRY;
2175 break;
2176 case NL80211_REGDOM_TYPE_WORLD:
2177 data.channel_list_changed.type = REGDOM_TYPE_WORLD;
2178 break;
2179 case NL80211_REGDOM_TYPE_CUSTOM_WORLD:
2180 data.channel_list_changed.type =
2181 REGDOM_TYPE_CUSTOM_WORLD;
2182 break;
2183 case NL80211_REGDOM_TYPE_INTERSECTION:
2184 data.channel_list_changed.type =
2185 REGDOM_TYPE_INTERSECTION;
2186 break;
2187 }
2188 }
2189
2190 if (tb[NL80211_ATTR_REG_ALPHA2]) {
2191 os_strlcpy(data.channel_list_changed.alpha2,
2192 nla_get_string(tb[NL80211_ATTR_REG_ALPHA2]),
2193 sizeof(data.channel_list_changed.alpha2));
2194 wpa_printf(MSG_DEBUG, " * alpha2=%s",
2195 data.channel_list_changed.alpha2);
2196 }
2197
2198 wpa_supplicant_event(drv->ctx, EVENT_CHANNEL_LIST_CHANGED, &data);
2199 }
2200
2201
nl80211_dump_freq(const char * title,struct nlattr * nl_freq)2202 static void nl80211_dump_freq(const char *title, struct nlattr *nl_freq)
2203 {
2204 static struct nla_policy freq_policy[NL80211_FREQUENCY_ATTR_MAX + 1] = {
2205 [NL80211_FREQUENCY_ATTR_FREQ] = { .type = NLA_U32 },
2206 [NL80211_FREQUENCY_ATTR_DISABLED] = { .type = NLA_FLAG },
2207 [NL80211_FREQUENCY_ATTR_NO_IR] = { .type = NLA_FLAG },
2208 [NL80211_FREQUENCY_ATTR_RADAR] = { .type = NLA_FLAG },
2209 [NL80211_FREQUENCY_ATTR_MAX_TX_POWER] = { .type = NLA_U32 },
2210 };
2211 struct nlattr *tb[NL80211_FREQUENCY_ATTR_MAX + 1];
2212 u32 freq = 0, max_tx_power = 0;
2213
2214 nla_parse(tb, NL80211_FREQUENCY_ATTR_MAX,
2215 nla_data(nl_freq), nla_len(nl_freq), freq_policy);
2216
2217 if (tb[NL80211_FREQUENCY_ATTR_FREQ])
2218 freq = nla_get_u32(tb[NL80211_FREQUENCY_ATTR_FREQ]);
2219 if (tb[NL80211_FREQUENCY_ATTR_MAX_TX_POWER])
2220 max_tx_power =
2221 nla_get_u32(tb[NL80211_FREQUENCY_ATTR_MAX_TX_POWER]);
2222
2223 wpa_printf(MSG_DEBUG,
2224 "nl80211: Channel (%s): freq=%u max_tx_power=%u%s%s%s",
2225 title, freq, max_tx_power,
2226 tb[NL80211_FREQUENCY_ATTR_DISABLED] ? " disabled" : "",
2227 tb[NL80211_FREQUENCY_ATTR_NO_IR] ? " no-IR" : "",
2228 tb[NL80211_FREQUENCY_ATTR_RADAR] ? " radar" : "");
2229 }
2230
2231
nl80211_reg_beacon_hint_event(struct wpa_driver_nl80211_data * drv,struct nlattr * tb[])2232 static void nl80211_reg_beacon_hint_event(struct wpa_driver_nl80211_data *drv,
2233 struct nlattr *tb[])
2234 {
2235 union wpa_event_data data;
2236
2237 wpa_printf(MSG_DEBUG, "nl80211: Regulatory beacon hint");
2238 os_memset(&data, 0, sizeof(data));
2239 data.channel_list_changed.initiator = REGDOM_BEACON_HINT;
2240
2241 if (tb[NL80211_ATTR_FREQ_BEFORE])
2242 nl80211_dump_freq("before", tb[NL80211_ATTR_FREQ_BEFORE]);
2243 if (tb[NL80211_ATTR_FREQ_AFTER])
2244 nl80211_dump_freq("after", tb[NL80211_ATTR_FREQ_AFTER]);
2245
2246 wpa_supplicant_event(drv->ctx, EVENT_CHANNEL_LIST_CHANGED, &data);
2247 }
2248
2249
nl80211_external_auth(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)2250 static void nl80211_external_auth(struct wpa_driver_nl80211_data *drv,
2251 struct nlattr **tb)
2252 {
2253 union wpa_event_data event;
2254 enum nl80211_external_auth_action act;
2255
2256 if (!tb[NL80211_ATTR_AKM_SUITES] ||
2257 !tb[NL80211_ATTR_EXTERNAL_AUTH_ACTION] ||
2258 !tb[NL80211_ATTR_BSSID] ||
2259 !tb[NL80211_ATTR_SSID])
2260 return;
2261
2262 os_memset(&event, 0, sizeof(event));
2263 act = nla_get_u32(tb[NL80211_ATTR_EXTERNAL_AUTH_ACTION]);
2264 switch (act) {
2265 case NL80211_EXTERNAL_AUTH_START:
2266 event.external_auth.action = EXT_AUTH_START;
2267 break;
2268 case NL80211_EXTERNAL_AUTH_ABORT:
2269 event.external_auth.action = EXT_AUTH_ABORT;
2270 break;
2271 default:
2272 return;
2273 }
2274
2275 event.external_auth.key_mgmt_suite =
2276 nla_get_u32(tb[NL80211_ATTR_AKM_SUITES]);
2277
2278 event.external_auth.ssid_len = nla_len(tb[NL80211_ATTR_SSID]);
2279 if (event.external_auth.ssid_len > SSID_MAX_LEN)
2280 return;
2281 event.external_auth.ssid = nla_data(tb[NL80211_ATTR_SSID]);
2282
2283 event.external_auth.bssid = nla_data(tb[NL80211_ATTR_BSSID]);
2284
2285 wpa_printf(MSG_DEBUG,
2286 "nl80211: External auth action: %u, AKM: 0x%x",
2287 event.external_auth.action,
2288 event.external_auth.key_mgmt_suite);
2289 wpa_supplicant_event(drv->ctx, EVENT_EXTERNAL_AUTH, &event);
2290 }
2291
2292
nl80211_port_authorized(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)2293 static void nl80211_port_authorized(struct wpa_driver_nl80211_data *drv,
2294 struct nlattr **tb)
2295 {
2296 const u8 *addr;
2297
2298 if (!tb[NL80211_ATTR_MAC] ||
2299 nla_len(tb[NL80211_ATTR_MAC]) != ETH_ALEN) {
2300 wpa_printf(MSG_DEBUG,
2301 "nl80211: Ignore port authorized event without BSSID");
2302 return;
2303 }
2304
2305 addr = nla_data(tb[NL80211_ATTR_MAC]);
2306 if (os_memcmp(addr, drv->bssid, ETH_ALEN) != 0) {
2307 wpa_printf(MSG_DEBUG,
2308 "nl80211: Ignore port authorized event for " MACSTR
2309 " (not the currently connected BSSID " MACSTR ")",
2310 MAC2STR(addr), MAC2STR(drv->bssid));
2311 return;
2312 }
2313
2314 wpa_supplicant_event(drv->ctx, EVENT_PORT_AUTHORIZED, NULL);
2315 }
2316
2317
nl80211_sta_opmode_change_event(struct wpa_driver_nl80211_data * drv,struct nlattr ** tb)2318 static void nl80211_sta_opmode_change_event(struct wpa_driver_nl80211_data *drv,
2319 struct nlattr **tb)
2320 {
2321 union wpa_event_data ed;
2322 u8 smps_mode, max_bw;
2323
2324 if (!tb[NL80211_ATTR_MAC] ||
2325 (!tb[NL80211_ATTR_CHANNEL_WIDTH] &&
2326 !tb[NL80211_ATTR_SMPS_MODE] &&
2327 !tb[NL80211_ATTR_NSS]))
2328 return;
2329
2330 ed.sta_opmode.smps_mode = SMPS_INVALID;
2331 ed.sta_opmode.chan_width = CHAN_WIDTH_UNKNOWN;
2332 ed.sta_opmode.rx_nss = 0xff;
2333 ed.sta_opmode.addr = nla_data(tb[NL80211_ATTR_MAC]);
2334
2335 if (tb[NL80211_ATTR_SMPS_MODE]) {
2336 smps_mode = nla_get_u8(tb[NL80211_ATTR_SMPS_MODE]);
2337 switch (smps_mode) {
2338 case NL80211_SMPS_OFF:
2339 ed.sta_opmode.smps_mode = SMPS_OFF;
2340 break;
2341 case NL80211_SMPS_STATIC:
2342 ed.sta_opmode.smps_mode = SMPS_STATIC;
2343 break;
2344 case NL80211_SMPS_DYNAMIC:
2345 ed.sta_opmode.smps_mode = SMPS_DYNAMIC;
2346 break;
2347 default:
2348 ed.sta_opmode.smps_mode = SMPS_INVALID;
2349 break;
2350 }
2351 }
2352
2353 if (tb[NL80211_ATTR_CHANNEL_WIDTH]) {
2354 max_bw = nla_get_u32(tb[NL80211_ATTR_CHANNEL_WIDTH]);
2355 switch (max_bw) {
2356 case NL80211_CHAN_WIDTH_20_NOHT:
2357 ed.sta_opmode.chan_width = CHAN_WIDTH_20_NOHT;
2358 break;
2359 case NL80211_CHAN_WIDTH_20:
2360 ed.sta_opmode.chan_width = CHAN_WIDTH_20;
2361 break;
2362 case NL80211_CHAN_WIDTH_40:
2363 ed.sta_opmode.chan_width = CHAN_WIDTH_40;
2364 break;
2365 case NL80211_CHAN_WIDTH_80:
2366 ed.sta_opmode.chan_width = CHAN_WIDTH_80;
2367 break;
2368 case NL80211_CHAN_WIDTH_80P80:
2369 ed.sta_opmode.chan_width = CHAN_WIDTH_80P80;
2370 break;
2371 case NL80211_CHAN_WIDTH_160:
2372 ed.sta_opmode.chan_width = CHAN_WIDTH_160;
2373 break;
2374 default:
2375 ed.sta_opmode.chan_width = CHAN_WIDTH_UNKNOWN;
2376 break;
2377
2378 }
2379 }
2380
2381 if (tb[NL80211_ATTR_NSS])
2382 ed.sta_opmode.rx_nss = nla_get_u8(tb[NL80211_ATTR_NSS]);
2383
2384 wpa_supplicant_event(drv->ctx, EVENT_STATION_OPMODE_CHANGED, &ed);
2385 }
2386
2387
do_process_drv_event(struct i802_bss * bss,int cmd,struct nlattr ** tb)2388 static void do_process_drv_event(struct i802_bss *bss, int cmd,
2389 struct nlattr **tb)
2390 {
2391 struct wpa_driver_nl80211_data *drv = bss->drv;
2392 int external_scan_event = 0;
2393
2394 wpa_printf(MSG_DEBUG, "nl80211: Drv Event %d (%s) received for %s",
2395 cmd, nl80211_command_to_string(cmd), bss->ifname);
2396
2397 if (cmd == NL80211_CMD_ROAM &&
2398 (drv->capa.flags & WPA_DRIVER_FLAGS_KEY_MGMT_OFFLOAD)) {
2399 /*
2400 * Device will use roam+auth vendor event to indicate
2401 * roaming, so ignore the regular roam event.
2402 */
2403 wpa_printf(MSG_DEBUG,
2404 "nl80211: Ignore roam event (cmd=%d), device will use vendor event roam+auth",
2405 cmd);
2406 return;
2407 }
2408
2409 if (drv->ap_scan_as_station != NL80211_IFTYPE_UNSPECIFIED &&
2410 (cmd == NL80211_CMD_NEW_SCAN_RESULTS ||
2411 cmd == NL80211_CMD_SCAN_ABORTED)) {
2412 wpa_driver_nl80211_set_mode(drv->first_bss,
2413 drv->ap_scan_as_station);
2414 drv->ap_scan_as_station = NL80211_IFTYPE_UNSPECIFIED;
2415 }
2416
2417 switch (cmd) {
2418 case NL80211_CMD_TRIGGER_SCAN:
2419 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Scan trigger");
2420 drv->scan_state = SCAN_STARTED;
2421 if (drv->scan_for_auth) {
2422 /*
2423 * Cannot indicate EVENT_SCAN_STARTED here since we skip
2424 * EVENT_SCAN_RESULTS in scan_for_auth case and the
2425 * upper layer implementation could get confused about
2426 * scanning state.
2427 */
2428 wpa_printf(MSG_DEBUG, "nl80211: Do not indicate scan-start event due to internal scan_for_auth");
2429 break;
2430 }
2431 wpa_supplicant_event(drv->ctx, EVENT_SCAN_STARTED, NULL);
2432 break;
2433 case NL80211_CMD_START_SCHED_SCAN:
2434 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Sched scan started");
2435 drv->scan_state = SCHED_SCAN_STARTED;
2436 break;
2437 case NL80211_CMD_SCHED_SCAN_STOPPED:
2438 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Sched scan stopped");
2439 drv->scan_state = SCHED_SCAN_STOPPED;
2440 wpa_supplicant_event(drv->ctx, EVENT_SCHED_SCAN_STOPPED, NULL);
2441 break;
2442 case NL80211_CMD_NEW_SCAN_RESULTS:
2443 wpa_dbg(drv->ctx, MSG_DEBUG,
2444 "nl80211: New scan results available");
2445 if (drv->last_scan_cmd != NL80211_CMD_VENDOR)
2446 drv->scan_state = SCAN_COMPLETED;
2447 drv->scan_complete_events = 1;
2448 if (drv->last_scan_cmd == NL80211_CMD_TRIGGER_SCAN) {
2449 eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout,
2450 drv, drv->ctx);
2451 drv->last_scan_cmd = 0;
2452 } else {
2453 external_scan_event = 1;
2454 }
2455 send_scan_event(drv, 0, tb, external_scan_event);
2456 break;
2457 case NL80211_CMD_SCHED_SCAN_RESULTS:
2458 wpa_dbg(drv->ctx, MSG_DEBUG,
2459 "nl80211: New sched scan results available");
2460 drv->scan_state = SCHED_SCAN_RESULTS;
2461 send_scan_event(drv, 0, tb, 0);
2462 break;
2463 case NL80211_CMD_SCAN_ABORTED:
2464 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Scan aborted");
2465 if (drv->last_scan_cmd != NL80211_CMD_VENDOR)
2466 drv->scan_state = SCAN_ABORTED;
2467 if (drv->last_scan_cmd == NL80211_CMD_TRIGGER_SCAN) {
2468 /*
2469 * Need to indicate that scan results are available in
2470 * order not to make wpa_supplicant stop its scanning.
2471 */
2472 eloop_cancel_timeout(wpa_driver_nl80211_scan_timeout,
2473 drv, drv->ctx);
2474 drv->last_scan_cmd = 0;
2475 } else {
2476 external_scan_event = 1;
2477 }
2478 send_scan_event(drv, 1, tb, external_scan_event);
2479 break;
2480 case NL80211_CMD_AUTHENTICATE:
2481 case NL80211_CMD_ASSOCIATE:
2482 case NL80211_CMD_DEAUTHENTICATE:
2483 case NL80211_CMD_DISASSOCIATE:
2484 case NL80211_CMD_FRAME_TX_STATUS:
2485 case NL80211_CMD_UNPROT_DEAUTHENTICATE:
2486 case NL80211_CMD_UNPROT_DISASSOCIATE:
2487 mlme_event(bss, cmd, tb[NL80211_ATTR_FRAME],
2488 tb[NL80211_ATTR_MAC], tb[NL80211_ATTR_TIMED_OUT],
2489 tb[NL80211_ATTR_WIPHY_FREQ], tb[NL80211_ATTR_ACK],
2490 tb[NL80211_ATTR_COOKIE],
2491 tb[NL80211_ATTR_RX_SIGNAL_DBM],
2492 tb[NL80211_ATTR_STA_WME],
2493 tb[NL80211_ATTR_REQ_IE]);
2494 break;
2495 case NL80211_CMD_CONNECT:
2496 case NL80211_CMD_ROAM:
2497 mlme_event_connect(drv, cmd,
2498 tb[NL80211_ATTR_STATUS_CODE],
2499 tb[NL80211_ATTR_MAC],
2500 tb[NL80211_ATTR_REQ_IE],
2501 tb[NL80211_ATTR_RESP_IE],
2502 tb[NL80211_ATTR_TIMED_OUT],
2503 tb[NL80211_ATTR_TIMEOUT_REASON],
2504 NULL, NULL, NULL,
2505 tb[NL80211_ATTR_FILS_KEK],
2506 NULL,
2507 tb[NL80211_ATTR_FILS_ERP_NEXT_SEQ_NUM],
2508 tb[NL80211_ATTR_PMK],
2509 tb[NL80211_ATTR_PMKID]);
2510 break;
2511 case NL80211_CMD_CH_SWITCH_NOTIFY:
2512 mlme_event_ch_switch(drv,
2513 tb[NL80211_ATTR_IFINDEX],
2514 tb[NL80211_ATTR_WIPHY_FREQ],
2515 tb[NL80211_ATTR_WIPHY_CHANNEL_TYPE],
2516 tb[NL80211_ATTR_CHANNEL_WIDTH],
2517 tb[NL80211_ATTR_CENTER_FREQ1],
2518 tb[NL80211_ATTR_CENTER_FREQ2]);
2519 break;
2520 case NL80211_CMD_DISCONNECT:
2521 mlme_event_disconnect(drv, tb[NL80211_ATTR_REASON_CODE],
2522 tb[NL80211_ATTR_MAC],
2523 tb[NL80211_ATTR_DISCONNECTED_BY_AP]);
2524 break;
2525 case NL80211_CMD_MICHAEL_MIC_FAILURE:
2526 mlme_event_michael_mic_failure(bss, tb);
2527 break;
2528 case NL80211_CMD_JOIN_IBSS:
2529 mlme_event_join_ibss(drv, tb);
2530 break;
2531 case NL80211_CMD_REMAIN_ON_CHANNEL:
2532 mlme_event_remain_on_channel(drv, 0, tb);
2533 break;
2534 case NL80211_CMD_CANCEL_REMAIN_ON_CHANNEL:
2535 mlme_event_remain_on_channel(drv, 1, tb);
2536 break;
2537 case NL80211_CMD_NOTIFY_CQM:
2538 nl80211_cqm_event(drv, tb);
2539 break;
2540 case NL80211_CMD_REG_CHANGE:
2541 case NL80211_CMD_WIPHY_REG_CHANGE:
2542 nl80211_reg_change_event(drv, tb);
2543 break;
2544 case NL80211_CMD_REG_BEACON_HINT:
2545 nl80211_reg_beacon_hint_event(drv, tb);
2546 break;
2547 case NL80211_CMD_NEW_STATION:
2548 nl80211_new_station_event(drv, bss, tb);
2549 break;
2550 case NL80211_CMD_DEL_STATION:
2551 nl80211_del_station_event(drv, bss, tb);
2552 break;
2553 case NL80211_CMD_SET_REKEY_OFFLOAD:
2554 nl80211_rekey_offload_event(drv, tb);
2555 break;
2556 case NL80211_CMD_PMKSA_CANDIDATE:
2557 nl80211_pmksa_candidate_event(drv, tb);
2558 break;
2559 case NL80211_CMD_PROBE_CLIENT:
2560 nl80211_client_probe_event(drv, tb);
2561 break;
2562 case NL80211_CMD_TDLS_OPER:
2563 nl80211_tdls_oper_event(drv, tb);
2564 break;
2565 case NL80211_CMD_CONN_FAILED:
2566 nl80211_connect_failed_event(drv, tb);
2567 break;
2568 case NL80211_CMD_FT_EVENT:
2569 mlme_event_ft_event(drv, tb);
2570 break;
2571 case NL80211_CMD_RADAR_DETECT:
2572 nl80211_radar_event(drv, tb);
2573 break;
2574 case NL80211_CMD_STOP_AP:
2575 nl80211_stop_ap(drv, tb);
2576 break;
2577 case NL80211_CMD_VENDOR:
2578 nl80211_vendor_event(drv, tb);
2579 break;
2580 case NL80211_CMD_NEW_PEER_CANDIDATE:
2581 nl80211_new_peer_candidate(drv, tb);
2582 break;
2583 case NL80211_CMD_PORT_AUTHORIZED:
2584 nl80211_port_authorized(drv, tb);
2585 break;
2586 case NL80211_CMD_STA_OPMODE_CHANGED:
2587 nl80211_sta_opmode_change_event(drv, tb);
2588 break;
2589 default:
2590 wpa_dbg(drv->ctx, MSG_DEBUG, "nl80211: Ignored unknown event "
2591 "(cmd=%d)", cmd);
2592 break;
2593 }
2594 }
2595
2596
process_global_event(struct nl_msg * msg,void * arg)2597 int process_global_event(struct nl_msg *msg, void *arg)
2598 {
2599 struct nl80211_global *global = arg;
2600 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
2601 struct nlattr *tb[NL80211_ATTR_MAX + 1];
2602 struct wpa_driver_nl80211_data *drv, *tmp;
2603 int ifidx = -1, wiphy_idx = -1, wiphy_idx_rx = -1;
2604 struct i802_bss *bss;
2605 u64 wdev_id = 0;
2606 int wdev_id_set = 0;
2607 int wiphy_idx_set = 0;
2608
2609 nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
2610 genlmsg_attrlen(gnlh, 0), NULL);
2611
2612 if (tb[NL80211_ATTR_IFINDEX])
2613 ifidx = nla_get_u32(tb[NL80211_ATTR_IFINDEX]);
2614 else if (tb[NL80211_ATTR_WDEV]) {
2615 wdev_id = nla_get_u64(tb[NL80211_ATTR_WDEV]);
2616 wdev_id_set = 1;
2617 } else if (tb[NL80211_ATTR_WIPHY]) {
2618 wiphy_idx_rx = nla_get_u32(tb[NL80211_ATTR_WIPHY]);
2619 wiphy_idx_set = 1;
2620 }
2621
2622 dl_list_for_each_safe(drv, tmp, &global->interfaces,
2623 struct wpa_driver_nl80211_data, list) {
2624 for (bss = drv->first_bss; bss; bss = bss->next) {
2625 if (wiphy_idx_set)
2626 wiphy_idx = nl80211_get_wiphy_index(bss);
2627 if ((ifidx == -1 && !wiphy_idx_set && !wdev_id_set) ||
2628 ifidx == bss->ifindex ||
2629 (wiphy_idx_set && wiphy_idx == wiphy_idx_rx) ||
2630 (wdev_id_set && bss->wdev_id_set &&
2631 wdev_id == bss->wdev_id)) {
2632 do_process_drv_event(bss, gnlh->cmd, tb);
2633 return NL_SKIP;
2634 }
2635 }
2636 wpa_printf(MSG_DEBUG,
2637 "nl80211: Ignored event (cmd=%d) for foreign interface (ifindex %d wdev 0x%llx)",
2638 gnlh->cmd, ifidx, (long long unsigned int) wdev_id);
2639 }
2640
2641 return NL_SKIP;
2642 }
2643
2644
process_bss_event(struct nl_msg * msg,void * arg)2645 int process_bss_event(struct nl_msg *msg, void *arg)
2646 {
2647 struct i802_bss *bss = arg;
2648 struct genlmsghdr *gnlh = nlmsg_data(nlmsg_hdr(msg));
2649 struct nlattr *tb[NL80211_ATTR_MAX + 1];
2650
2651 nla_parse(tb, NL80211_ATTR_MAX, genlmsg_attrdata(gnlh, 0),
2652 genlmsg_attrlen(gnlh, 0), NULL);
2653
2654 wpa_printf(MSG_DEBUG, "nl80211: BSS Event %d (%s) received for %s",
2655 gnlh->cmd, nl80211_command_to_string(gnlh->cmd),
2656 bss->ifname);
2657
2658 switch (gnlh->cmd) {
2659 case NL80211_CMD_FRAME:
2660 case NL80211_CMD_FRAME_TX_STATUS:
2661 mlme_event(bss, gnlh->cmd, tb[NL80211_ATTR_FRAME],
2662 tb[NL80211_ATTR_MAC], tb[NL80211_ATTR_TIMED_OUT],
2663 tb[NL80211_ATTR_WIPHY_FREQ], tb[NL80211_ATTR_ACK],
2664 tb[NL80211_ATTR_COOKIE],
2665 tb[NL80211_ATTR_RX_SIGNAL_DBM],
2666 tb[NL80211_ATTR_STA_WME], NULL);
2667 break;
2668 case NL80211_CMD_UNEXPECTED_FRAME:
2669 nl80211_spurious_frame(bss, tb, 0);
2670 break;
2671 case NL80211_CMD_UNEXPECTED_4ADDR_FRAME:
2672 nl80211_spurious_frame(bss, tb, 1);
2673 break;
2674 case NL80211_CMD_EXTERNAL_AUTH:
2675 nl80211_external_auth(bss->drv, tb);
2676 break;
2677 default:
2678 wpa_printf(MSG_DEBUG, "nl80211: Ignored unknown event "
2679 "(cmd=%d)", gnlh->cmd);
2680 break;
2681 }
2682
2683 return NL_SKIP;
2684 }
2685