Branch data Line data Source code
1 : : /*
2 : : * wpa_supplicant - WNM
3 : : * Copyright (c) 2011-2013, Qualcomm Atheros, Inc.
4 : : *
5 : : * This software may be distributed under the terms of the BSD license.
6 : : * See README for more details.
7 : : */
8 : :
9 : : #include "utils/includes.h"
10 : :
11 : : #include "utils/common.h"
12 : : #include "common/ieee802_11_defs.h"
13 : : #include "common/wpa_ctrl.h"
14 : : #include "rsn_supp/wpa.h"
15 : : #include "wpa_supplicant_i.h"
16 : : #include "driver_i.h"
17 : : #include "scan.h"
18 : : #include "ctrl_iface.h"
19 : : #include "bss.h"
20 : : #include "wnm_sta.h"
21 : :
22 : : #define MAX_TFS_IE_LEN 1024
23 : : #define WNM_MAX_NEIGHBOR_REPORT 10
24 : :
25 : :
26 : : /* get the TFS IE from driver */
27 : 6 : static int ieee80211_11_get_tfs_ie(struct wpa_supplicant *wpa_s, u8 *buf,
28 : : u16 *buf_len, enum wnm_oper oper)
29 : : {
30 : 6 : wpa_printf(MSG_DEBUG, "%s: TFS get operation %d", __func__, oper);
31 : :
32 : 6 : return wpa_drv_wnm_oper(wpa_s, oper, wpa_s->bssid, buf, buf_len);
33 : : }
34 : :
35 : :
36 : : /* set the TFS IE to driver */
37 : 0 : static int ieee80211_11_set_tfs_ie(struct wpa_supplicant *wpa_s,
38 : : const u8 *addr, u8 *buf, u16 *buf_len,
39 : : enum wnm_oper oper)
40 : : {
41 : 0 : wpa_printf(MSG_DEBUG, "%s: TFS set operation %d", __func__, oper);
42 : :
43 : 0 : return wpa_drv_wnm_oper(wpa_s, oper, addr, buf, buf_len);
44 : : }
45 : :
46 : :
47 : : /* MLME-SLEEPMODE.request */
48 : 6 : int ieee802_11_send_wnmsleep_req(struct wpa_supplicant *wpa_s,
49 : : u8 action, u16 intval, struct wpabuf *tfs_req)
50 : : {
51 : : struct ieee80211_mgmt *mgmt;
52 : : int res;
53 : : size_t len;
54 : : struct wnm_sleep_element *wnmsleep_ie;
55 : : u8 *wnmtfs_ie;
56 : : u8 wnmsleep_ie_len;
57 : : u16 wnmtfs_ie_len; /* possibly multiple IE(s) */
58 [ + + ]: 6 : enum wnm_oper tfs_oper = action == 0 ? WNM_SLEEP_TFS_REQ_IE_ADD :
59 : : WNM_SLEEP_TFS_REQ_IE_NONE;
60 : :
61 [ + + ]: 6 : wpa_printf(MSG_DEBUG, "WNM: Request to send WNM-Sleep Mode Request "
62 : : "action=%s to " MACSTR,
63 : : action == 0 ? "enter" : "exit",
64 : 36 : MAC2STR(wpa_s->bssid));
65 : :
66 : : /* WNM-Sleep Mode IE */
67 : 6 : wnmsleep_ie_len = sizeof(struct wnm_sleep_element);
68 : 6 : wnmsleep_ie = os_zalloc(sizeof(struct wnm_sleep_element));
69 [ - + ]: 6 : if (wnmsleep_ie == NULL)
70 : 0 : return -1;
71 : 6 : wnmsleep_ie->eid = WLAN_EID_WNMSLEEP;
72 : 6 : wnmsleep_ie->len = wnmsleep_ie_len - 2;
73 : 6 : wnmsleep_ie->action_type = action;
74 : 6 : wnmsleep_ie->status = WNM_STATUS_SLEEP_ACCEPT;
75 : 6 : wnmsleep_ie->intval = host_to_le16(intval);
76 : 6 : wpa_hexdump(MSG_DEBUG, "WNM: WNM-Sleep Mode element",
77 : : (u8 *) wnmsleep_ie, wnmsleep_ie_len);
78 : :
79 : : /* TFS IE(s) */
80 [ - + ]: 6 : if (tfs_req) {
81 : 0 : wnmtfs_ie_len = wpabuf_len(tfs_req);
82 : 0 : wnmtfs_ie = os_malloc(wnmtfs_ie_len);
83 [ # # ]: 0 : if (wnmtfs_ie == NULL) {
84 : 0 : os_free(wnmsleep_ie);
85 : 0 : return -1;
86 : : }
87 : 0 : os_memcpy(wnmtfs_ie, wpabuf_head(tfs_req), wnmtfs_ie_len);
88 : : } else {
89 : 6 : wnmtfs_ie = os_zalloc(MAX_TFS_IE_LEN);
90 [ - + ]: 6 : if (wnmtfs_ie == NULL) {
91 : 0 : os_free(wnmsleep_ie);
92 : 0 : return -1;
93 : : }
94 [ + - ]: 6 : if (ieee80211_11_get_tfs_ie(wpa_s, wnmtfs_ie, &wnmtfs_ie_len,
95 : : tfs_oper)) {
96 : 6 : wnmtfs_ie_len = 0;
97 : 6 : os_free(wnmtfs_ie);
98 : 6 : wnmtfs_ie = NULL;
99 : : }
100 : : }
101 : 6 : wpa_hexdump(MSG_DEBUG, "WNM: TFS Request element",
102 : : (u8 *) wnmtfs_ie, wnmtfs_ie_len);
103 : :
104 : 6 : mgmt = os_zalloc(sizeof(*mgmt) + wnmsleep_ie_len + wnmtfs_ie_len);
105 [ - + ]: 6 : if (mgmt == NULL) {
106 : 0 : wpa_printf(MSG_DEBUG, "MLME: Failed to allocate buffer for "
107 : : "WNM-Sleep Request action frame");
108 : 0 : os_free(wnmsleep_ie);
109 : 0 : os_free(wnmtfs_ie);
110 : 0 : return -1;
111 : : }
112 : :
113 : 6 : os_memcpy(mgmt->da, wpa_s->bssid, ETH_ALEN);
114 : 6 : os_memcpy(mgmt->sa, wpa_s->own_addr, ETH_ALEN);
115 : 6 : os_memcpy(mgmt->bssid, wpa_s->bssid, ETH_ALEN);
116 : 6 : mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
117 : : WLAN_FC_STYPE_ACTION);
118 : 6 : mgmt->u.action.category = WLAN_ACTION_WNM;
119 : 6 : mgmt->u.action.u.wnm_sleep_req.action = WNM_SLEEP_MODE_REQ;
120 : 6 : mgmt->u.action.u.wnm_sleep_req.dialogtoken = 1;
121 : 6 : os_memcpy(mgmt->u.action.u.wnm_sleep_req.variable, wnmsleep_ie,
122 : : wnmsleep_ie_len);
123 : : /* copy TFS IE here */
124 [ - + ]: 6 : if (wnmtfs_ie_len > 0) {
125 : 0 : os_memcpy(mgmt->u.action.u.wnm_sleep_req.variable +
126 : : wnmsleep_ie_len, wnmtfs_ie, wnmtfs_ie_len);
127 : : }
128 : :
129 : 6 : len = 1 + sizeof(mgmt->u.action.u.wnm_sleep_req) + wnmsleep_ie_len +
130 : : wnmtfs_ie_len;
131 : :
132 : 6 : res = wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
133 : 6 : wpa_s->own_addr, wpa_s->bssid,
134 : 6 : &mgmt->u.action.category, len, 0);
135 [ - + ]: 6 : if (res < 0)
136 : 0 : wpa_printf(MSG_DEBUG, "Failed to send WNM-Sleep Request "
137 : : "(action=%d, intval=%d)", action, intval);
138 : :
139 : 6 : os_free(wnmsleep_ie);
140 : 6 : os_free(wnmtfs_ie);
141 : 6 : os_free(mgmt);
142 : :
143 : 6 : return res;
144 : : }
145 : :
146 : :
147 : 5 : static void wnm_sleep_mode_enter_success(struct wpa_supplicant *wpa_s,
148 : : u8 *tfsresp_ie_start,
149 : : u8 *tfsresp_ie_end)
150 : : {
151 : 5 : wpa_drv_wnm_oper(wpa_s, WNM_SLEEP_ENTER_CONFIRM,
152 : 5 : wpa_s->bssid, NULL, NULL);
153 : : /* remove GTK/IGTK ?? */
154 : :
155 : : /* set the TFS Resp IE(s) */
156 [ - + ][ # # ]: 5 : if (tfsresp_ie_start && tfsresp_ie_end &&
[ # # ]
157 : 0 : tfsresp_ie_end - tfsresp_ie_start >= 0) {
158 : : u16 tfsresp_ie_len;
159 : 0 : tfsresp_ie_len = (tfsresp_ie_end + tfsresp_ie_end[1] + 2) -
160 : : tfsresp_ie_start;
161 : 0 : wpa_printf(MSG_DEBUG, "TFS Resp IE(s) found");
162 : : /* pass the TFS Resp IE(s) to driver for processing */
163 [ # # ]: 0 : if (ieee80211_11_set_tfs_ie(wpa_s, wpa_s->bssid,
164 : : tfsresp_ie_start,
165 : : &tfsresp_ie_len,
166 : : WNM_SLEEP_TFS_RESP_IE_SET))
167 : 0 : wpa_printf(MSG_DEBUG, "WNM: Fail to set TFS Resp IE");
168 : : }
169 : 5 : }
170 : :
171 : :
172 : 5 : static void wnm_sleep_mode_exit_success(struct wpa_supplicant *wpa_s,
173 : : const u8 *frm, u16 key_len_total)
174 : : {
175 : : u8 *ptr, *end;
176 : : u8 gtk_len;
177 : :
178 : 5 : wpa_drv_wnm_oper(wpa_s, WNM_SLEEP_EXIT_CONFIRM, wpa_s->bssid,
179 : : NULL, NULL);
180 : :
181 : : /* Install GTK/IGTK */
182 : :
183 : : /* point to key data field */
184 : 5 : ptr = (u8 *) frm + 1 + 1 + 2;
185 : 5 : end = ptr + key_len_total;
186 : 5 : wpa_hexdump_key(MSG_DEBUG, "WNM: Key Data", ptr, key_len_total);
187 : :
188 [ + + ]: 7 : while (ptr + 1 < end) {
189 [ - + ]: 2 : if (ptr + 2 + ptr[1] > end) {
190 : 0 : wpa_printf(MSG_DEBUG, "WNM: Invalid Key Data element "
191 : : "length");
192 [ # # ]: 0 : if (end > ptr) {
193 : 0 : wpa_hexdump(MSG_DEBUG, "WNM: Remaining data",
194 : 0 : ptr, end - ptr);
195 : : }
196 : 0 : break;
197 : : }
198 [ + + ]: 2 : if (*ptr == WNM_SLEEP_SUBELEM_GTK) {
199 [ - + ]: 1 : if (ptr[1] < 11 + 5) {
200 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short GTK "
201 : : "subelem");
202 : 0 : break;
203 : : }
204 : 1 : gtk_len = *(ptr + 4);
205 [ + - ][ + - ]: 1 : if (ptr[1] < 11 + gtk_len ||
206 [ - + ]: 1 : gtk_len < 5 || gtk_len > 32) {
207 : 0 : wpa_printf(MSG_DEBUG, "WNM: Invalid GTK "
208 : : "subelem");
209 : 0 : break;
210 : : }
211 : 1 : wpa_wnmsleep_install_key(
212 : : wpa_s->wpa,
213 : : WNM_SLEEP_SUBELEM_GTK,
214 : : ptr);
215 : 1 : ptr += 13 + gtk_len;
216 : : #ifdef CONFIG_IEEE80211W
217 [ + - ]: 1 : } else if (*ptr == WNM_SLEEP_SUBELEM_IGTK) {
218 [ - + ]: 1 : if (ptr[1] < 2 + 6 + WPA_IGTK_LEN) {
219 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short IGTK "
220 : : "subelem");
221 : 0 : break;
222 : : }
223 : 1 : wpa_wnmsleep_install_key(wpa_s->wpa,
224 : : WNM_SLEEP_SUBELEM_IGTK, ptr);
225 : 1 : ptr += 10 + WPA_IGTK_LEN;
226 : : #endif /* CONFIG_IEEE80211W */
227 : : } else
228 : 0 : break; /* skip the loop */
229 : : }
230 : 5 : }
231 : :
232 : :
233 : 10 : static void ieee802_11_rx_wnmsleep_resp(struct wpa_supplicant *wpa_s,
234 : : const u8 *frm, int len)
235 : : {
236 : : /*
237 : : * Action [1] | Diaglog Token [1] | Key Data Len [2] | Key Data |
238 : : * WNM-Sleep Mode IE | TFS Response IE
239 : : */
240 : 10 : u8 *pos = (u8 *) frm; /* point to action field */
241 : 10 : u16 key_len_total = le_to_host16(*((u16 *)(frm+2)));
242 : 10 : struct wnm_sleep_element *wnmsleep_ie = NULL;
243 : : /* multiple TFS Resp IE (assuming consecutive) */
244 : 10 : u8 *tfsresp_ie_start = NULL;
245 : 10 : u8 *tfsresp_ie_end = NULL;
246 : :
247 : 10 : wpa_printf(MSG_DEBUG, "action=%d token = %d key_len_total = %d",
248 : 20 : frm[0], frm[1], key_len_total);
249 : 10 : pos += 4 + key_len_total;
250 [ - + ]: 10 : if (pos > frm + len) {
251 : 0 : wpa_printf(MSG_INFO, "WNM: Too short frame for Key Data field");
252 : 0 : return;
253 : : }
254 [ + + ]: 20 : while (pos - frm < len) {
255 : 10 : u8 ie_len = *(pos + 1);
256 [ - + ]: 10 : if (pos + 2 + ie_len > frm + len) {
257 : 0 : wpa_printf(MSG_INFO, "WNM: Invalid IE len %u", ie_len);
258 : 0 : break;
259 : : }
260 : 10 : wpa_hexdump(MSG_DEBUG, "WNM: Element", pos, 2 + ie_len);
261 [ + - ]: 10 : if (*pos == WLAN_EID_WNMSLEEP)
262 : 10 : wnmsleep_ie = (struct wnm_sleep_element *) pos;
263 [ # # ]: 0 : else if (*pos == WLAN_EID_TFS_RESP) {
264 [ # # ]: 0 : if (!tfsresp_ie_start)
265 : 0 : tfsresp_ie_start = pos;
266 : 0 : tfsresp_ie_end = pos;
267 : : } else
268 : 0 : wpa_printf(MSG_DEBUG, "EID %d not recognized", *pos);
269 : 10 : pos += ie_len + 2;
270 : : }
271 : :
272 [ - + ]: 10 : if (!wnmsleep_ie) {
273 : 0 : wpa_printf(MSG_DEBUG, "No WNM-Sleep IE found");
274 : 0 : return;
275 : : }
276 : :
277 [ - + ][ # # ]: 10 : if (wnmsleep_ie->status == WNM_STATUS_SLEEP_ACCEPT ||
278 : 0 : wnmsleep_ie->status == WNM_STATUS_SLEEP_EXIT_ACCEPT_GTK_UPDATE) {
279 : 10 : wpa_printf(MSG_DEBUG, "Successfully recv WNM-Sleep Response "
280 : : "frame (action=%d, intval=%d)",
281 : 20 : wnmsleep_ie->action_type, wnmsleep_ie->intval);
282 [ + + ]: 20 : if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_ENTER) {
283 : 5 : wnm_sleep_mode_enter_success(wpa_s, tfsresp_ie_start,
284 : : tfsresp_ie_end);
285 [ + - ]: 5 : } else if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_EXIT) {
286 : 5 : wnm_sleep_mode_exit_success(wpa_s, frm, key_len_total);
287 : : }
288 : : } else {
289 : 0 : wpa_printf(MSG_DEBUG, "Reject recv WNM-Sleep Response frame "
290 : : "(action=%d, intval=%d)",
291 : 0 : wnmsleep_ie->action_type, wnmsleep_ie->intval);
292 [ # # ]: 0 : if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_ENTER)
293 : 0 : wpa_drv_wnm_oper(wpa_s, WNM_SLEEP_ENTER_FAIL,
294 : 0 : wpa_s->bssid, NULL, NULL);
295 [ # # ]: 0 : else if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_EXIT)
296 : 10 : wpa_drv_wnm_oper(wpa_s, WNM_SLEEP_EXIT_FAIL,
297 : 0 : wpa_s->bssid, NULL, NULL);
298 : : }
299 : : }
300 : :
301 : :
302 : 22 : void wnm_deallocate_memory(struct wpa_supplicant *wpa_s)
303 : : {
304 : : int i;
305 : :
306 [ - + ]: 22 : for (i = 0; i < wpa_s->wnm_num_neighbor_report; i++) {
307 : 0 : os_free(wpa_s->wnm_neighbor_report_elements[i].tsf_info);
308 : 0 : os_free(wpa_s->wnm_neighbor_report_elements[i].con_coun_str);
309 : 0 : os_free(wpa_s->wnm_neighbor_report_elements[i].bss_tran_can);
310 : 0 : os_free(wpa_s->wnm_neighbor_report_elements[i].bss_term_dur);
311 : 0 : os_free(wpa_s->wnm_neighbor_report_elements[i].bearing);
312 : 0 : os_free(wpa_s->wnm_neighbor_report_elements[i].meas_pilot);
313 : 0 : os_free(wpa_s->wnm_neighbor_report_elements[i].rrm_cap);
314 : 0 : os_free(wpa_s->wnm_neighbor_report_elements[i].mul_bssid);
315 : : }
316 : :
317 : 22 : os_free(wpa_s->wnm_neighbor_report_elements);
318 : 22 : wpa_s->wnm_neighbor_report_elements = NULL;
319 : 22 : }
320 : :
321 : :
322 : 0 : static void wnm_parse_neighbor_report_elem(struct neighbor_report *rep,
323 : : u8 id, u8 elen, const u8 *pos)
324 : : {
325 [ # # # # : 0 : switch (id) {
# # # #
# ]
326 : : case WNM_NEIGHBOR_TSF:
327 [ # # ]: 0 : if (elen < 2 + 2) {
328 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short TSF");
329 : 0 : break;
330 : : }
331 : 0 : rep->tsf_info = os_zalloc(sizeof(struct tsf_info));
332 [ # # ]: 0 : if (rep->tsf_info == NULL)
333 : 0 : break;
334 : 0 : rep->tsf_info->present = 1;
335 : 0 : os_memcpy(rep->tsf_info->tsf_offset, pos, 2);
336 : 0 : os_memcpy(rep->tsf_info->beacon_interval, pos + 2, 2);
337 : 0 : break;
338 : : case WNM_NEIGHBOR_CONDENSED_COUNTRY_STRING:
339 [ # # ]: 0 : if (elen < 2) {
340 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short condensed "
341 : : "country string");
342 : 0 : break;
343 : : }
344 : 0 : rep->con_coun_str =
345 : 0 : os_zalloc(sizeof(struct condensed_country_string));
346 [ # # ]: 0 : if (rep->con_coun_str == NULL)
347 : 0 : break;
348 : 0 : rep->con_coun_str->present = 1;
349 : 0 : os_memcpy(rep->con_coun_str->country_string, pos, 2);
350 : 0 : break;
351 : : case WNM_NEIGHBOR_BSS_TRANSITION_CANDIDATE:
352 [ # # ]: 0 : if (elen < 1) {
353 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short BSS transition "
354 : : "candidate");
355 : 0 : break;
356 : : }
357 : 0 : rep->bss_tran_can =
358 : 0 : os_zalloc(sizeof(struct bss_transition_candidate));
359 [ # # ]: 0 : if (rep->bss_tran_can == NULL)
360 : 0 : break;
361 : 0 : rep->bss_tran_can->present = 1;
362 : 0 : rep->bss_tran_can->preference = pos[0];
363 : 0 : break;
364 : : case WNM_NEIGHBOR_BSS_TERMINATION_DURATION:
365 [ # # ]: 0 : if (elen < 12) {
366 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short BSS termination "
367 : : "duration");
368 : 0 : break;
369 : : }
370 : 0 : rep->bss_term_dur =
371 : 0 : os_zalloc(sizeof(struct bss_termination_duration));
372 [ # # ]: 0 : if (rep->bss_term_dur == NULL)
373 : 0 : break;
374 : 0 : rep->bss_term_dur->present = 1;
375 : 0 : os_memcpy(rep->bss_term_dur->duration, pos, 12);
376 : 0 : break;
377 : : case WNM_NEIGHBOR_BEARING:
378 [ # # ]: 0 : if (elen < 8) {
379 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short neighbor "
380 : : "bearing");
381 : 0 : break;
382 : : }
383 : 0 : rep->bearing = os_zalloc(sizeof(struct bearing));
384 [ # # ]: 0 : if (rep->bearing == NULL)
385 : 0 : break;
386 : 0 : rep->bearing->present = 1;
387 : 0 : os_memcpy(rep->bearing->bearing, pos, 8);
388 : 0 : break;
389 : : case WNM_NEIGHBOR_MEASUREMENT_PILOT:
390 [ # # ]: 0 : if (elen < 2) {
391 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short measurement "
392 : : "pilot");
393 : 0 : break;
394 : : }
395 : 0 : rep->meas_pilot = os_zalloc(sizeof(struct measurement_pilot));
396 [ # # ]: 0 : if (rep->meas_pilot == NULL)
397 : 0 : break;
398 : 0 : rep->meas_pilot->present = 1;
399 : 0 : rep->meas_pilot->measurement_pilot = pos[0];
400 : 0 : rep->meas_pilot->num_vendor_specific = pos[1];
401 : 0 : os_memcpy(rep->meas_pilot->vendor_specific, pos + 2, elen - 2);
402 : 0 : break;
403 : : case WNM_NEIGHBOR_RRM_ENABLED_CAPABILITIES:
404 [ # # ]: 0 : if (elen < 4) {
405 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short RRM enabled "
406 : : "capabilities");
407 : 0 : break;
408 : : }
409 : 0 : rep->rrm_cap =
410 : 0 : os_zalloc(sizeof(struct rrm_enabled_capabilities));
411 [ # # ]: 0 : if (rep->rrm_cap == NULL)
412 : 0 : break;
413 : 0 : rep->rrm_cap->present = 1;
414 : 0 : os_memcpy(rep->rrm_cap->capabilities, pos, 4);
415 : 0 : break;
416 : : case WNM_NEIGHBOR_MULTIPLE_BSSID:
417 [ # # ]: 0 : if (elen < 2) {
418 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short multiple BSSID");
419 : 0 : break;
420 : : }
421 : 0 : rep->mul_bssid = os_zalloc(sizeof(struct multiple_bssid));
422 [ # # ]: 0 : if (rep->mul_bssid == NULL)
423 : 0 : break;
424 : 0 : rep->mul_bssid->present = 1;
425 : 0 : rep->mul_bssid->max_bssid_indicator = pos[0];
426 : 0 : rep->mul_bssid->num_vendor_specific = pos[1];
427 : 0 : os_memcpy(rep->mul_bssid->vendor_specific, pos + 2, elen - 2);
428 : 0 : break;
429 : : }
430 : 0 : }
431 : :
432 : :
433 : 0 : static void wnm_parse_neighbor_report(struct wpa_supplicant *wpa_s,
434 : : const u8 *pos, u8 len,
435 : : struct neighbor_report *rep)
436 : : {
437 : 0 : u8 left = len;
438 : :
439 [ # # ]: 0 : if (left < 13) {
440 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short neighbor report");
441 : 0 : return;
442 : : }
443 : :
444 : 0 : os_memcpy(rep->bssid, pos, ETH_ALEN);
445 : 0 : os_memcpy(rep->bssid_information, pos + ETH_ALEN, 4);
446 : 0 : rep->regulatory_class = *(pos + 10);
447 : 0 : rep->channel_number = *(pos + 11);
448 : 0 : rep->phy_type = *(pos + 12);
449 : :
450 : 0 : pos += 13;
451 : 0 : left -= 13;
452 : :
453 [ # # ]: 0 : while (left >= 2) {
454 : : u8 id, elen;
455 : :
456 : 0 : id = *pos++;
457 : 0 : elen = *pos++;
458 : 0 : wnm_parse_neighbor_report_elem(rep, id, elen, pos);
459 : 0 : left -= 2 + elen;
460 : 0 : pos += elen;
461 : : }
462 : : }
463 : :
464 : :
465 : 0 : static int compare_scan_neighbor_results(struct wpa_supplicant *wpa_s,
466 : : struct wpa_scan_results *scan_res,
467 : : struct neighbor_report *neigh_rep,
468 : : u8 num_neigh_rep, u8 *bssid_to_connect)
469 : : {
470 : :
471 : : u8 i, j;
472 : :
473 [ # # ][ # # ]: 0 : if (scan_res == NULL || num_neigh_rep == 0)
474 : 0 : return 0;
475 : :
476 [ # # ]: 0 : wpa_printf(MSG_DEBUG, "WNM: Current BSS " MACSTR " RSSI %d",
477 : 0 : MAC2STR(wpa_s->bssid),
478 : 0 : wpa_s->current_bss ? wpa_s->current_bss->level : 0);
479 : :
480 [ # # ]: 0 : for (i = 0; i < num_neigh_rep; i++) {
481 [ # # ]: 0 : for (j = 0; j < scan_res->num; j++) {
482 : : /* Check for a better RSSI AP */
483 [ # # ]: 0 : if (os_memcmp(scan_res->res[j]->bssid,
484 [ # # ]: 0 : neigh_rep[i].bssid, ETH_ALEN) == 0 &&
485 : 0 : scan_res->res[j]->level >
486 : 0 : wpa_s->current_bss->level) {
487 : : /* Got a BSSID with better RSSI value */
488 : 0 : os_memcpy(bssid_to_connect, neigh_rep[i].bssid,
489 : : ETH_ALEN);
490 : 0 : wpa_printf(MSG_DEBUG, "Found a BSS " MACSTR
491 : : " with better scan RSSI %d",
492 : 0 : MAC2STR(scan_res->res[j]->bssid),
493 : 0 : scan_res->res[j]->level);
494 : 0 : return 1;
495 : : }
496 : 0 : wpa_printf(MSG_DEBUG, "scan_res[%d] " MACSTR
497 : : " RSSI %d", j,
498 : 0 : MAC2STR(scan_res->res[j]->bssid),
499 : 0 : scan_res->res[j]->level);
500 : : }
501 : : }
502 : :
503 : 0 : return 0;
504 : : }
505 : :
506 : :
507 : 4 : static void wnm_send_bss_transition_mgmt_resp(
508 : : struct wpa_supplicant *wpa_s, u8 dialog_token,
509 : : enum bss_trans_mgmt_status_code status, u8 delay,
510 : : const u8 *target_bssid)
511 : : {
512 : : u8 buf[1000], *pos;
513 : : struct ieee80211_mgmt *mgmt;
514 : : size_t len;
515 : :
516 : 4 : wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Response "
517 : : "to " MACSTR " dialog_token=%u status=%u delay=%d",
518 : 24 : MAC2STR(wpa_s->bssid), dialog_token, status, delay);
519 : :
520 : 4 : mgmt = (struct ieee80211_mgmt *) buf;
521 : 4 : os_memset(&buf, 0, sizeof(buf));
522 : 4 : os_memcpy(mgmt->da, wpa_s->bssid, ETH_ALEN);
523 : 4 : os_memcpy(mgmt->sa, wpa_s->own_addr, ETH_ALEN);
524 : 4 : os_memcpy(mgmt->bssid, wpa_s->bssid, ETH_ALEN);
525 : 4 : mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
526 : : WLAN_FC_STYPE_ACTION);
527 : 4 : mgmt->u.action.category = WLAN_ACTION_WNM;
528 : 4 : mgmt->u.action.u.bss_tm_resp.action = WNM_BSS_TRANS_MGMT_RESP;
529 : 4 : mgmt->u.action.u.bss_tm_resp.dialog_token = dialog_token;
530 : 4 : mgmt->u.action.u.bss_tm_resp.status_code = status;
531 : 4 : mgmt->u.action.u.bss_tm_resp.bss_termination_delay = delay;
532 : 4 : pos = mgmt->u.action.u.bss_tm_resp.variable;
533 [ - + ]: 4 : if (target_bssid) {
534 : 0 : os_memcpy(pos, target_bssid, ETH_ALEN);
535 : 0 : pos += ETH_ALEN;
536 [ + + ]: 4 : } else if (status == WNM_BSS_TM_ACCEPT) {
537 : : /*
538 : : * P802.11-REVmc clarifies that the Target BSSID field is always
539 : : * present when status code is zero, so use a fake value here if
540 : : * no BSSID is yet known.
541 : : */
542 : 2 : os_memset(pos, 0, ETH_ALEN);
543 : 2 : pos += ETH_ALEN;
544 : : }
545 : :
546 : 4 : len = pos - (u8 *) &mgmt->u.action.category;
547 : :
548 : 4 : wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
549 : 4 : wpa_s->own_addr, wpa_s->bssid,
550 : 4 : &mgmt->u.action.category, len, 0);
551 : 4 : }
552 : :
553 : :
554 : 0 : void wnm_scan_response(struct wpa_supplicant *wpa_s,
555 : : struct wpa_scan_results *scan_res)
556 : : {
557 : : u8 bssid[ETH_ALEN];
558 : :
559 [ # # ]: 0 : if (scan_res == NULL) {
560 : 0 : wpa_printf(MSG_ERROR, "Scan result is NULL");
561 : 0 : goto send_bss_resp_fail;
562 : : }
563 : :
564 : : /* Compare the Neighbor Report and scan results */
565 [ # # ]: 0 : if (compare_scan_neighbor_results(wpa_s, scan_res,
566 : : wpa_s->wnm_neighbor_report_elements,
567 : 0 : wpa_s->wnm_num_neighbor_report,
568 : : bssid) == 1) {
569 : : /* Associate to the network */
570 : : struct wpa_bss *bss;
571 : 0 : struct wpa_ssid *ssid = wpa_s->current_ssid;
572 : :
573 : 0 : bss = wpa_bss_get_bssid(wpa_s, bssid);
574 [ # # ]: 0 : if (!bss) {
575 : 0 : wpa_printf(MSG_DEBUG, "WNM: Target AP not found from "
576 : : "BSS table");
577 : 0 : goto send_bss_resp_fail;
578 : : }
579 : :
580 : : /* Send the BSS Management Response - Accept */
581 [ # # ]: 0 : if (wpa_s->wnm_reply) {
582 : 0 : wnm_send_bss_transition_mgmt_resp(wpa_s,
583 : 0 : wpa_s->wnm_dialog_token,
584 : : WNM_BSS_TM_ACCEPT,
585 : : 0, bssid);
586 : : }
587 : :
588 : 0 : wpa_s->reassociate = 1;
589 : 0 : wpa_supplicant_connect(wpa_s, bss, ssid);
590 : 0 : wnm_deallocate_memory(wpa_s);
591 : 0 : return;
592 : : }
593 : :
594 : : /* Send reject response for all the failures */
595 : : send_bss_resp_fail:
596 : 0 : wnm_deallocate_memory(wpa_s);
597 [ # # ]: 0 : if (wpa_s->wnm_reply) {
598 : 0 : wnm_send_bss_transition_mgmt_resp(wpa_s,
599 : 0 : wpa_s->wnm_dialog_token,
600 : : WNM_BSS_TM_REJECT_UNSPECIFIED,
601 : : 0, NULL);
602 : : }
603 : 0 : return;
604 : : }
605 : :
606 : :
607 : 4 : static void ieee802_11_rx_bss_trans_mgmt_req(struct wpa_supplicant *wpa_s,
608 : : const u8 *pos, const u8 *end,
609 : : int reply)
610 : : {
611 [ - + ]: 4 : if (pos + 5 > end)
612 : 0 : return;
613 : :
614 : 4 : wpa_s->wnm_dialog_token = pos[0];
615 : 4 : wpa_s->wnm_mode = pos[1];
616 : 4 : wpa_s->wnm_dissoc_timer = WPA_GET_LE16(pos + 2);
617 : 4 : wpa_s->wnm_validity_interval = pos[4];
618 : 4 : wpa_s->wnm_reply = reply;
619 : :
620 : 4 : wpa_printf(MSG_DEBUG, "WNM: BSS Transition Management Request: "
621 : : "dialog_token=%u request_mode=0x%x "
622 : : "disassoc_timer=%u validity_interval=%u",
623 : 8 : wpa_s->wnm_dialog_token, wpa_s->wnm_mode,
624 : 8 : wpa_s->wnm_dissoc_timer, wpa_s->wnm_validity_interval);
625 : :
626 : 4 : pos += 5;
627 : :
628 [ - + ]: 4 : if (wpa_s->wnm_mode & WNM_BSS_TM_REQ_BSS_TERMINATION_INCLUDED) {
629 [ # # ]: 0 : if (pos + 12 > end) {
630 : 0 : wpa_printf(MSG_DEBUG, "WNM: Too short BSS TM Request");
631 : 0 : return;
632 : : }
633 : 0 : os_memcpy(wpa_s->wnm_bss_termination_duration, pos, 12);
634 : 0 : pos += 12; /* BSS Termination Duration */
635 : : }
636 : :
637 [ + + ]: 4 : if (wpa_s->wnm_mode & WNM_BSS_TM_REQ_ESS_DISASSOC_IMMINENT) {
638 : : char url[256];
639 : : unsigned int beacon_int;
640 : :
641 [ + - ][ - + ]: 2 : if (pos + 1 > end || pos + 1 + pos[0] > end) {
642 : 0 : wpa_printf(MSG_DEBUG, "WNM: Invalid BSS Transition "
643 : : "Management Request (URL)");
644 : 0 : return;
645 : : }
646 : 2 : os_memcpy(url, pos + 1, pos[0]);
647 : 2 : url[pos[0]] = '\0';
648 : 2 : pos += 1 + pos[0];
649 : :
650 [ + - ]: 2 : if (wpa_s->current_bss)
651 : 2 : beacon_int = wpa_s->current_bss->beacon_int;
652 : : else
653 : 0 : beacon_int = 100; /* best guess */
654 : :
655 : 2 : wpa_msg(wpa_s, MSG_INFO, ESS_DISASSOC_IMMINENT "%d %u %s",
656 : : wpa_sm_pmf_enabled(wpa_s->wpa),
657 : 2 : wpa_s->wnm_dissoc_timer * beacon_int * 128 / 125, url);
658 : : }
659 : :
660 [ + + ]: 4 : if (wpa_s->wnm_mode & WNM_BSS_TM_REQ_DISASSOC_IMMINENT) {
661 : 3 : wpa_msg(wpa_s, MSG_INFO, "WNM: Disassociation Imminent - "
662 : 3 : "Disassociation Timer %u", wpa_s->wnm_dissoc_timer);
663 [ + - ][ + - ]: 3 : if (wpa_s->wnm_dissoc_timer && !wpa_s->scanning) {
664 : : /* TODO: mark current BSS less preferred for
665 : : * selection */
666 : 3 : wpa_printf(MSG_DEBUG, "Trying to find another BSS");
667 : 3 : wpa_supplicant_req_scan(wpa_s, 0, 0);
668 : : }
669 : : }
670 : :
671 [ - + ]: 4 : if (wpa_s->wnm_mode & WNM_BSS_TM_REQ_PREF_CAND_LIST_INCLUDED) {
672 : 0 : wpa_msg(wpa_s, MSG_INFO, "WNM: Preferred List Available");
673 : 0 : wpa_s->wnm_num_neighbor_report = 0;
674 : 0 : os_free(wpa_s->wnm_neighbor_report_elements);
675 : 0 : wpa_s->wnm_neighbor_report_elements = os_zalloc(
676 : : WNM_MAX_NEIGHBOR_REPORT *
677 : : sizeof(struct neighbor_report));
678 [ # # ]: 0 : if (wpa_s->wnm_neighbor_report_elements == NULL)
679 : 0 : return;
680 : :
681 [ # # ][ # # ]: 0 : while (pos + 2 <= end &&
682 : 0 : wpa_s->wnm_num_neighbor_report < WNM_MAX_NEIGHBOR_REPORT)
683 : : {
684 : 0 : u8 tag = *pos++;
685 : 0 : u8 len = *pos++;
686 : :
687 : 0 : wpa_printf(MSG_DEBUG, "WNM: Neighbor report tag %u",
688 : : tag);
689 [ # # ]: 0 : if (pos + len > end) {
690 : 0 : wpa_printf(MSG_DEBUG, "WNM: Truncated request");
691 : 0 : return;
692 : : }
693 : 0 : wnm_parse_neighbor_report(
694 : : wpa_s, pos, len,
695 : 0 : &wpa_s->wnm_neighbor_report_elements[
696 : 0 : wpa_s->wnm_num_neighbor_report]);
697 : :
698 : 0 : pos += len;
699 : 0 : wpa_s->wnm_num_neighbor_report++;
700 : : }
701 : :
702 : 0 : wpa_s->scan_res_handler = wnm_scan_response;
703 : 0 : wpa_supplicant_req_scan(wpa_s, 0, 0);
704 [ + - ]: 4 : } else if (reply) {
705 : : enum bss_trans_mgmt_status_code status;
706 [ + + ]: 4 : if (wpa_s->wnm_mode & WNM_BSS_TM_REQ_ESS_DISASSOC_IMMINENT)
707 : 2 : status = WNM_BSS_TM_ACCEPT;
708 : : else {
709 : 2 : wpa_msg(wpa_s, MSG_INFO, "WNM: BSS Transition Management Request did not include candidates");
710 : 2 : status = WNM_BSS_TM_REJECT_UNSPECIFIED;
711 : : }
712 : 4 : wnm_send_bss_transition_mgmt_resp(wpa_s,
713 : 4 : wpa_s->wnm_dialog_token,
714 : : status, 0, NULL);
715 : : }
716 : : }
717 : :
718 : :
719 : 1 : int wnm_send_bss_transition_mgmt_query(struct wpa_supplicant *wpa_s,
720 : : u8 query_reason)
721 : : {
722 : : u8 buf[1000], *pos;
723 : : struct ieee80211_mgmt *mgmt;
724 : : size_t len;
725 : : int ret;
726 : :
727 : 1 : wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Query to "
728 : : MACSTR " query_reason=%u",
729 : 6 : MAC2STR(wpa_s->bssid), query_reason);
730 : :
731 : 1 : mgmt = (struct ieee80211_mgmt *) buf;
732 : 1 : os_memset(&buf, 0, sizeof(buf));
733 : 1 : os_memcpy(mgmt->da, wpa_s->bssid, ETH_ALEN);
734 : 1 : os_memcpy(mgmt->sa, wpa_s->own_addr, ETH_ALEN);
735 : 1 : os_memcpy(mgmt->bssid, wpa_s->bssid, ETH_ALEN);
736 : 1 : mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
737 : : WLAN_FC_STYPE_ACTION);
738 : 1 : mgmt->u.action.category = WLAN_ACTION_WNM;
739 : 1 : mgmt->u.action.u.bss_tm_query.action = WNM_BSS_TRANS_MGMT_QUERY;
740 : 1 : mgmt->u.action.u.bss_tm_query.dialog_token = 1;
741 : 1 : mgmt->u.action.u.bss_tm_query.query_reason = query_reason;
742 : 1 : pos = mgmt->u.action.u.bss_tm_query.variable;
743 : :
744 : 1 : len = pos - (u8 *) &mgmt->u.action.category;
745 : :
746 : 1 : ret = wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
747 : 1 : wpa_s->own_addr, wpa_s->bssid,
748 : 1 : &mgmt->u.action.category, len, 0);
749 : :
750 : 1 : return ret;
751 : : }
752 : :
753 : :
754 : 15 : void ieee802_11_rx_wnm_action(struct wpa_supplicant *wpa_s,
755 : : struct rx_action *action)
756 : : {
757 : : const u8 *pos, *end;
758 : : u8 act;
759 : :
760 [ + - ][ - + ]: 15 : if (action->data == NULL || action->len == 0)
761 : 0 : return;
762 : :
763 : 15 : pos = action->data;
764 : 15 : end = pos + action->len;
765 : 15 : act = *pos++;
766 : :
767 : 15 : wpa_printf(MSG_DEBUG, "WNM: RX action %u from " MACSTR,
768 : 90 : act, MAC2STR(action->sa));
769 [ + + ][ - + ]: 15 : if (wpa_s->wpa_state < WPA_ASSOCIATED ||
770 : 14 : os_memcmp(action->sa, wpa_s->bssid, ETH_ALEN) != 0) {
771 : 1 : wpa_printf(MSG_DEBUG, "WNM: Ignore unexpected WNM Action "
772 : : "frame");
773 : 1 : return;
774 : : }
775 : :
776 [ + + - ]: 14 : switch (act) {
777 : : case WNM_BSS_TRANS_MGMT_REQ:
778 : 4 : ieee802_11_rx_bss_trans_mgmt_req(wpa_s, pos, end,
779 : 4 : !(action->da[0] & 0x01));
780 : 4 : break;
781 : : case WNM_SLEEP_MODE_RESP:
782 : 10 : ieee802_11_rx_wnmsleep_resp(wpa_s, action->data, action->len);
783 : 10 : break;
784 : : default:
785 : 0 : wpa_printf(MSG_ERROR, "WNM: Unknown request");
786 : 15 : break;
787 : : }
788 : : }
|
