src/ap/ieee802_11_shared.c

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