Line data Source code
1 : /*
2 : * hostapd / IEEE 802.11 Management
3 : * Copyright (c) 2002-2012, Jouni Malinen <j@w1.fi>
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 "hostapd.h"
14 : #include "sta_info.h"
15 : #include "ap_config.h"
16 : #include "ap_drv_ops.h"
17 : #include "ieee802_11.h"
18 :
19 :
20 : #ifdef CONFIG_IEEE80211W
21 :
22 4 : u8 * hostapd_eid_assoc_comeback_time(struct hostapd_data *hapd,
23 : struct sta_info *sta, u8 *eid)
24 : {
25 4 : u8 *pos = eid;
26 : u32 timeout, tu;
27 : struct os_reltime now, passed;
28 :
29 4 : *pos++ = WLAN_EID_TIMEOUT_INTERVAL;
30 4 : *pos++ = 5;
31 4 : *pos++ = WLAN_TIMEOUT_ASSOC_COMEBACK;
32 4 : os_get_reltime(&now);
33 4 : os_reltime_sub(&now, &sta->sa_query_start, &passed);
34 4 : tu = (passed.sec * 1000000 + passed.usec) / 1024;
35 4 : if (hapd->conf->assoc_sa_query_max_timeout > tu)
36 3 : timeout = hapd->conf->assoc_sa_query_max_timeout - tu;
37 : else
38 1 : timeout = 0;
39 4 : if (timeout < hapd->conf->assoc_sa_query_max_timeout)
40 4 : timeout++; /* add some extra time for local timers */
41 4 : WPA_PUT_LE32(pos, timeout);
42 4 : pos += 4;
43 :
44 4 : return pos;
45 : }
46 :
47 :
48 : /* MLME-SAQuery.request */
49 18 : void ieee802_11_send_sa_query_req(struct hostapd_data *hapd,
50 : const u8 *addr, const u8 *trans_id)
51 : {
52 : struct ieee80211_mgmt mgmt;
53 : u8 *end;
54 :
55 108 : wpa_printf(MSG_DEBUG, "IEEE 802.11: Sending SA Query Request to "
56 108 : MACSTR, MAC2STR(addr));
57 18 : wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
58 : trans_id, WLAN_SA_QUERY_TR_ID_LEN);
59 :
60 18 : os_memset(&mgmt, 0, sizeof(mgmt));
61 18 : mgmt.frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
62 : WLAN_FC_STYPE_ACTION);
63 18 : os_memcpy(mgmt.da, addr, ETH_ALEN);
64 18 : os_memcpy(mgmt.sa, hapd->own_addr, ETH_ALEN);
65 18 : os_memcpy(mgmt.bssid, hapd->own_addr, ETH_ALEN);
66 18 : mgmt.u.action.category = WLAN_ACTION_SA_QUERY;
67 18 : mgmt.u.action.u.sa_query_req.action = WLAN_SA_QUERY_REQUEST;
68 18 : os_memcpy(mgmt.u.action.u.sa_query_req.trans_id, trans_id,
69 : WLAN_SA_QUERY_TR_ID_LEN);
70 18 : end = mgmt.u.action.u.sa_query_req.trans_id + WLAN_SA_QUERY_TR_ID_LEN;
71 18 : if (hostapd_drv_send_mlme(hapd, &mgmt, end - (u8 *) &mgmt, 0) < 0)
72 0 : wpa_printf(MSG_INFO, "ieee802_11_send_sa_query_req: send failed");
73 18 : }
74 :
75 :
76 3 : static void ieee802_11_send_sa_query_resp(struct hostapd_data *hapd,
77 : const u8 *sa, const u8 *trans_id)
78 : {
79 : struct sta_info *sta;
80 : struct ieee80211_mgmt resp;
81 : u8 *end;
82 :
83 18 : wpa_printf(MSG_DEBUG, "IEEE 802.11: Received SA Query Request from "
84 18 : MACSTR, MAC2STR(sa));
85 3 : wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
86 : trans_id, WLAN_SA_QUERY_TR_ID_LEN);
87 :
88 3 : sta = ap_get_sta(hapd, sa);
89 3 : if (sta == NULL || !(sta->flags & WLAN_STA_ASSOC)) {
90 0 : wpa_printf(MSG_DEBUG, "IEEE 802.11: Ignore SA Query Request "
91 0 : "from unassociated STA " MACSTR, MAC2STR(sa));
92 3 : return;
93 : }
94 :
95 18 : wpa_printf(MSG_DEBUG, "IEEE 802.11: Sending SA Query Response to "
96 18 : MACSTR, MAC2STR(sa));
97 :
98 3 : os_memset(&resp, 0, sizeof(resp));
99 3 : resp.frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
100 : WLAN_FC_STYPE_ACTION);
101 3 : os_memcpy(resp.da, sa, ETH_ALEN);
102 3 : os_memcpy(resp.sa, hapd->own_addr, ETH_ALEN);
103 3 : os_memcpy(resp.bssid, hapd->own_addr, ETH_ALEN);
104 3 : resp.u.action.category = WLAN_ACTION_SA_QUERY;
105 3 : resp.u.action.u.sa_query_req.action = WLAN_SA_QUERY_RESPONSE;
106 3 : os_memcpy(resp.u.action.u.sa_query_req.trans_id, trans_id,
107 : WLAN_SA_QUERY_TR_ID_LEN);
108 3 : end = resp.u.action.u.sa_query_req.trans_id + WLAN_SA_QUERY_TR_ID_LEN;
109 3 : if (hostapd_drv_send_mlme(hapd, &resp, end - (u8 *) &resp, 0) < 0)
110 0 : wpa_printf(MSG_INFO, "ieee80211_mgmt_sa_query_request: send failed");
111 : }
112 :
113 :
114 5 : void ieee802_11_sa_query_action(struct hostapd_data *hapd, const u8 *sa,
115 : const u8 action_type, const u8 *trans_id)
116 : {
117 : struct sta_info *sta;
118 : int i;
119 :
120 5 : if (action_type == WLAN_SA_QUERY_REQUEST) {
121 3 : ieee802_11_send_sa_query_resp(hapd, sa, trans_id);
122 3 : return;
123 : }
124 :
125 2 : if (action_type != WLAN_SA_QUERY_RESPONSE) {
126 0 : wpa_printf(MSG_DEBUG, "IEEE 802.11: Unexpected SA Query "
127 : "Action %d", action_type);
128 0 : return;
129 : }
130 :
131 12 : wpa_printf(MSG_DEBUG, "IEEE 802.11: Received SA Query Response from "
132 12 : MACSTR, MAC2STR(sa));
133 2 : wpa_hexdump(MSG_DEBUG, "IEEE 802.11: SA Query Transaction ID",
134 : trans_id, WLAN_SA_QUERY_TR_ID_LEN);
135 :
136 : /* MLME-SAQuery.confirm */
137 :
138 2 : sta = ap_get_sta(hapd, sa);
139 2 : if (sta == NULL || sta->sa_query_trans_id == NULL) {
140 2 : wpa_printf(MSG_DEBUG, "IEEE 802.11: No matching STA with "
141 : "pending SA Query request found");
142 2 : return;
143 : }
144 :
145 0 : for (i = 0; i < sta->sa_query_count; i++) {
146 0 : if (os_memcmp(sta->sa_query_trans_id +
147 : i * WLAN_SA_QUERY_TR_ID_LEN,
148 : trans_id, WLAN_SA_QUERY_TR_ID_LEN) == 0)
149 0 : break;
150 : }
151 :
152 0 : if (i >= sta->sa_query_count) {
153 0 : wpa_printf(MSG_DEBUG, "IEEE 802.11: No matching SA Query "
154 : "transaction identifier found");
155 0 : return;
156 : }
157 :
158 0 : hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
159 : HOSTAPD_LEVEL_DEBUG,
160 : "Reply to pending SA Query received");
161 0 : ap_sta_stop_sa_query(hapd, sta);
162 : }
163 :
164 : #endif /* CONFIG_IEEE80211W */
165 :
166 :
167 130592 : static void hostapd_ext_capab_byte(struct hostapd_data *hapd, u8 *pos, int idx)
168 : {
169 130592 : *pos = 0x00;
170 :
171 130592 : switch (idx) {
172 : case 0: /* Bits 0-7 */
173 16398 : if (hapd->iconf->obss_interval)
174 28 : *pos |= 0x01; /* Bit 0 - Coexistence management */
175 16398 : break;
176 : case 1: /* Bits 8-15 */
177 16398 : if (hapd->conf->proxy_arp)
178 35 : *pos |= 0x10; /* Bit 12 - Proxy ARP */
179 16398 : break;
180 : case 2: /* Bits 16-23 */
181 16398 : if (hapd->conf->wnm_sleep_mode)
182 28 : *pos |= 0x02; /* Bit 17 - WNM-Sleep Mode */
183 16398 : if (hapd->conf->bss_transition)
184 97 : *pos |= 0x08; /* Bit 19 - BSS Transition */
185 16398 : break;
186 : case 3: /* Bits 24-31 */
187 : #ifdef CONFIG_WNM
188 16398 : *pos |= 0x02; /* Bit 25 - SSID List */
189 : #endif /* CONFIG_WNM */
190 16398 : if (hapd->conf->time_advertisement == 2)
191 28 : *pos |= 0x08; /* Bit 27 - UTC TSF Offset */
192 16398 : if (hapd->conf->interworking)
193 662 : *pos |= 0x80; /* Bit 31 - Interworking */
194 16398 : break;
195 : case 4: /* Bits 32-39 */
196 16250 : if (hapd->conf->qos_map_set_len)
197 5 : *pos |= 0x01; /* Bit 32 - QoS Map */
198 16250 : if (hapd->conf->tdls & TDLS_PROHIBIT)
199 0 : *pos |= 0x40; /* Bit 38 - TDLS Prohibited */
200 16250 : if (hapd->conf->tdls & TDLS_PROHIBIT_CHAN_SWITCH) {
201 : /* Bit 39 - TDLS Channel Switching Prohibited */
202 0 : *pos |= 0x80;
203 : }
204 16250 : break;
205 : case 5: /* Bits 40-47 */
206 : #ifdef CONFIG_HS20
207 16250 : if (hapd->conf->hs20)
208 660 : *pos |= 0x40; /* Bit 46 - WNM-Notification */
209 : #endif /* CONFIG_HS20 */
210 16250 : break;
211 : case 6: /* Bits 48-55 */
212 16250 : if (hapd->conf->ssid.utf8_ssid)
213 6 : *pos |= 0x01; /* Bit 48 - UTF-8 SSID */
214 16250 : break;
215 : }
216 130592 : }
217 :
218 :
219 16398 : u8 * hostapd_eid_ext_capab(struct hostapd_data *hapd, u8 *eid)
220 : {
221 16398 : u8 *pos = eid;
222 16398 : u8 len = 0, i;
223 :
224 16398 : if (hapd->conf->tdls & (TDLS_PROHIBIT | TDLS_PROHIBIT_CHAN_SWITCH))
225 0 : len = 5;
226 16398 : if (len < 4 && hapd->conf->interworking)
227 662 : len = 4;
228 16398 : if (len < 3 && hapd->conf->wnm_sleep_mode)
229 28 : len = 3;
230 16398 : if (len < 1 && hapd->iconf->obss_interval)
231 28 : len = 1;
232 16398 : if (len < 7 && hapd->conf->ssid.utf8_ssid)
233 6 : len = 7;
234 : #ifdef CONFIG_WNM
235 16398 : if (len < 4)
236 15730 : len = 4;
237 : #endif /* CONFIG_WNM */
238 : #ifdef CONFIG_HS20
239 16398 : if (hapd->conf->hs20 && len < 6)
240 660 : len = 6;
241 : #endif /* CONFIG_HS20 */
242 16398 : if (len < hapd->iface->extended_capa_len)
243 16250 : len = hapd->iface->extended_capa_len;
244 16398 : if (len == 0)
245 0 : return eid;
246 :
247 16398 : *pos++ = WLAN_EID_EXT_CAPAB;
248 16398 : *pos++ = len;
249 146990 : for (i = 0; i < len; i++, pos++) {
250 130592 : hostapd_ext_capab_byte(hapd, pos, i);
251 :
252 130592 : if (i < hapd->iface->extended_capa_len) {
253 130000 : *pos &= ~hapd->iface->extended_capa_mask[i];
254 130000 : *pos |= hapd->iface->extended_capa[i];
255 : }
256 : }
257 :
258 32796 : while (len > 0 && eid[1 + len] == 0) {
259 0 : len--;
260 0 : eid[1] = len;
261 : }
262 16398 : if (len == 0)
263 0 : return eid;
264 :
265 16398 : return eid + 2 + len;
266 : }
267 :
268 :
269 3213 : u8 * hostapd_eid_qos_map_set(struct hostapd_data *hapd, u8 *eid)
270 : {
271 3213 : u8 *pos = eid;
272 3213 : u8 len = hapd->conf->qos_map_set_len;
273 :
274 3213 : if (!len)
275 3212 : return eid;
276 :
277 1 : *pos++ = WLAN_EID_QOS_MAP_SET;
278 1 : *pos++ = len;
279 1 : os_memcpy(pos, hapd->conf->qos_map_set, len);
280 1 : pos += len;
281 :
282 1 : return pos;
283 : }
284 :
285 :
286 13052 : u8 * hostapd_eid_interworking(struct hostapd_data *hapd, u8 *eid)
287 : {
288 13052 : u8 *pos = eid;
289 : #ifdef CONFIG_INTERWORKING
290 : u8 *len;
291 :
292 13052 : if (!hapd->conf->interworking)
293 12488 : return eid;
294 :
295 564 : *pos++ = WLAN_EID_INTERWORKING;
296 564 : len = pos++;
297 :
298 564 : *pos = hapd->conf->access_network_type;
299 564 : if (hapd->conf->internet)
300 562 : *pos |= INTERWORKING_ANO_INTERNET;
301 564 : if (hapd->conf->asra)
302 0 : *pos |= INTERWORKING_ANO_ASRA;
303 564 : if (hapd->conf->esr)
304 0 : *pos |= INTERWORKING_ANO_ESR;
305 564 : if (hapd->conf->uesa)
306 0 : *pos |= INTERWORKING_ANO_UESA;
307 564 : pos++;
308 :
309 564 : if (hapd->conf->venue_info_set) {
310 558 : *pos++ = hapd->conf->venue_group;
311 558 : *pos++ = hapd->conf->venue_type;
312 : }
313 :
314 564 : if (!is_zero_ether_addr(hapd->conf->hessid)) {
315 236 : os_memcpy(pos, hapd->conf->hessid, ETH_ALEN);
316 236 : pos += ETH_ALEN;
317 : }
318 :
319 564 : *len = pos - len - 1;
320 : #endif /* CONFIG_INTERWORKING */
321 :
322 564 : return pos;
323 : }
324 :
325 :
326 13052 : u8 * hostapd_eid_adv_proto(struct hostapd_data *hapd, u8 *eid)
327 : {
328 13052 : u8 *pos = eid;
329 : #ifdef CONFIG_INTERWORKING
330 :
331 : /* TODO: Separate configuration for ANQP? */
332 13052 : if (!hapd->conf->interworking)
333 12488 : return eid;
334 :
335 564 : *pos++ = WLAN_EID_ADV_PROTO;
336 564 : *pos++ = 2;
337 564 : *pos++ = 0x7F; /* Query Response Length Limit | PAME-BI */
338 564 : *pos++ = ACCESS_NETWORK_QUERY_PROTOCOL;
339 : #endif /* CONFIG_INTERWORKING */
340 :
341 564 : return pos;
342 : }
343 :
344 :
345 13052 : u8 * hostapd_eid_roaming_consortium(struct hostapd_data *hapd, u8 *eid)
346 : {
347 13052 : u8 *pos = eid;
348 : #ifdef CONFIG_INTERWORKING
349 : u8 *len;
350 : unsigned int i, count;
351 :
352 13616 : if (!hapd->conf->interworking ||
353 1126 : hapd->conf->roaming_consortium == NULL ||
354 562 : hapd->conf->roaming_consortium_count == 0)
355 12490 : return eid;
356 :
357 562 : *pos++ = WLAN_EID_ROAMING_CONSORTIUM;
358 562 : len = pos++;
359 :
360 : /* Number of ANQP OIs (in addition to the max 3 listed here) */
361 562 : if (hapd->conf->roaming_consortium_count > 3 + 255)
362 0 : *pos++ = 255;
363 562 : else if (hapd->conf->roaming_consortium_count > 3)
364 543 : *pos++ = hapd->conf->roaming_consortium_count - 3;
365 : else
366 19 : *pos++ = 0;
367 :
368 : /* OU #1 and #2 Lengths */
369 562 : *pos = hapd->conf->roaming_consortium[0].len;
370 562 : if (hapd->conf->roaming_consortium_count > 1)
371 543 : *pos |= hapd->conf->roaming_consortium[1].len << 4;
372 562 : pos++;
373 :
374 562 : if (hapd->conf->roaming_consortium_count > 3)
375 543 : count = 3;
376 : else
377 19 : count = hapd->conf->roaming_consortium_count;
378 :
379 2210 : for (i = 0; i < count; i++) {
380 1648 : os_memcpy(pos, hapd->conf->roaming_consortium[i].oi,
381 : hapd->conf->roaming_consortium[i].len);
382 1648 : pos += hapd->conf->roaming_consortium[i].len;
383 : }
384 :
385 562 : *len = pos - len - 1;
386 : #endif /* CONFIG_INTERWORKING */
387 :
388 562 : return pos;
389 : }
390 :
391 :
392 13052 : u8 * hostapd_eid_time_adv(struct hostapd_data *hapd, u8 *eid)
393 : {
394 13052 : if (hapd->conf->time_advertisement != 2)
395 13030 : return eid;
396 :
397 28 : if (hapd->time_adv == NULL &&
398 6 : hostapd_update_time_adv(hapd) < 0)
399 0 : return eid;
400 :
401 22 : if (hapd->time_adv == NULL)
402 0 : return eid;
403 :
404 22 : os_memcpy(eid, wpabuf_head(hapd->time_adv),
405 : wpabuf_len(hapd->time_adv));
406 22 : eid += wpabuf_len(hapd->time_adv);
407 :
408 22 : return eid;
409 : }
410 :
411 :
412 8552 : u8 * hostapd_eid_time_zone(struct hostapd_data *hapd, u8 *eid)
413 : {
414 : size_t len;
415 :
416 8552 : if (hapd->conf->time_advertisement != 2)
417 8536 : return eid;
418 :
419 16 : len = os_strlen(hapd->conf->time_zone);
420 :
421 16 : *eid++ = WLAN_EID_TIME_ZONE;
422 16 : *eid++ = len;
423 16 : os_memcpy(eid, hapd->conf->time_zone, len);
424 16 : eid += len;
425 :
426 16 : return eid;
427 : }
428 :
429 :
430 6 : int hostapd_update_time_adv(struct hostapd_data *hapd)
431 : {
432 6 : const int elen = 2 + 1 + 10 + 5 + 1;
433 : struct os_time t;
434 : struct os_tm tm;
435 : u8 *pos;
436 :
437 6 : if (hapd->conf->time_advertisement != 2)
438 0 : return 0;
439 :
440 6 : if (os_get_time(&t) < 0 || os_gmtime(t.sec, &tm) < 0)
441 0 : return -1;
442 :
443 6 : if (!hapd->time_adv) {
444 6 : hapd->time_adv = wpabuf_alloc(elen);
445 6 : if (hapd->time_adv == NULL)
446 0 : return -1;
447 6 : pos = wpabuf_put(hapd->time_adv, elen);
448 : } else
449 0 : pos = wpabuf_mhead_u8(hapd->time_adv);
450 :
451 6 : *pos++ = WLAN_EID_TIME_ADVERTISEMENT;
452 6 : *pos++ = 1 + 10 + 5 + 1;
453 :
454 6 : *pos++ = 2; /* UTC time at which the TSF timer is 0 */
455 :
456 : /* Time Value at TSF 0 */
457 : /* FIX: need to calculate this based on the current TSF value */
458 6 : WPA_PUT_LE16(pos, tm.year); /* Year */
459 6 : pos += 2;
460 6 : *pos++ = tm.month; /* Month */
461 6 : *pos++ = tm.day; /* Day of month */
462 6 : *pos++ = tm.hour; /* Hours */
463 6 : *pos++ = tm.min; /* Minutes */
464 6 : *pos++ = tm.sec; /* Seconds */
465 6 : WPA_PUT_LE16(pos, 0); /* Milliseconds (not used) */
466 6 : pos += 2;
467 6 : *pos++ = 0; /* Reserved */
468 :
469 : /* Time Error */
470 : /* TODO: fill in an estimate on the error */
471 6 : *pos++ = 0;
472 6 : *pos++ = 0;
473 6 : *pos++ = 0;
474 6 : *pos++ = 0;
475 6 : *pos++ = 0;
476 :
477 6 : *pos++ = hapd->time_update_counter++;
478 :
479 6 : return 0;
480 : }
481 :
482 :
483 3346 : u8 * hostapd_eid_bss_max_idle_period(struct hostapd_data *hapd, u8 *eid)
484 : {
485 3346 : u8 *pos = eid;
486 :
487 : #ifdef CONFIG_WNM
488 3346 : if (hapd->conf->ap_max_inactivity > 0) {
489 : unsigned int val;
490 3346 : *pos++ = WLAN_EID_BSS_MAX_IDLE_PERIOD;
491 3346 : *pos++ = 3;
492 3346 : val = hapd->conf->ap_max_inactivity;
493 3346 : if (val > 68000)
494 0 : val = 68000;
495 3346 : val *= 1000;
496 3346 : val /= 1024;
497 3346 : if (val == 0)
498 6 : val = 1;
499 3346 : if (val > 65535)
500 0 : val = 65535;
501 3346 : WPA_PUT_LE16(pos, val);
502 3346 : pos += 2;
503 3346 : *pos++ = 0x00; /* TODO: Protected Keep-Alive Required */
504 : }
505 : #endif /* CONFIG_WNM */
506 :
507 3346 : return pos;
508 : }
|
