src/ap/ap_drv_ops.c

   1 /*
   2  * hostapd - Driver operations
   3  * Copyright (c) 2009-2010, Jouni Malinen <j@w1.fi>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License version 2 as
   7  * published by the Free Software Foundation.
   8  *
   9  * Alternatively, this software may be distributed under the terms of BSD
  10  * license.
  11  *
  12  * See README and COPYING for more details.
  13  */
  14
  15 #include "utils/includes.h"
  16
  17 #include "utils/common.h"
  18 #include "drivers/driver.h"
  19 #include "common/ieee802_11_defs.h"
  20 #include "wps/wps.h"
  21 #include "hostapd.h"
  22 #include "ieee802_11.h"
  23 #include "sta_info.h"
  24 #include "ap_config.h"
  25 #include "p2p_hostapd.h"
  26 #include "ap_drv_ops.h"
  27
  28
  29 u32 hostapd_sta_flags_to_drv(u32 flags)
  30 {
  31         int res = 0;
  32         if (flags & WLAN_STA_AUTHORIZED)
  33                 res |= WPA_STA_AUTHORIZED;
  34         if (flags & WLAN_STA_WMM)
  35                 res |= WPA_STA_WMM;
  36         if (flags & WLAN_STA_SHORT_PREAMBLE)
  37                 res |= WPA_STA_SHORT_PREAMBLE;
  38         if (flags & WLAN_STA_MFP)
  39                 res |= WPA_STA_MFP;
  40         return res;
  41 }
  42
  43
  44 int hostapd_build_ap_extra_ies(struct hostapd_data *hapd,
  45                                struct wpabuf **beacon_ret,
  46                                struct wpabuf **proberesp_ret,
  47                                struct wpabuf **assocresp_ret)
  48 {
  49         struct wpabuf *beacon = NULL, *proberesp = NULL, *assocresp = NULL;
  50         u8 buf[200], *pos;
  51
  52         *beacon_ret = *proberesp_ret = *assocresp_ret = NULL;
  53
  54         pos = buf;
  55         pos = hostapd_eid_time_adv(hapd, pos);
  56         if (pos != buf) {
  57                 if (wpabuf_resize(&beacon, pos - buf) != 0)
  58                         goto fail;
  59                 wpabuf_put_data(beacon, buf, pos - buf);
  60         }
  61         pos = hostapd_eid_time_zone(hapd, pos);
  62         if (pos != buf) {
  63                 if (wpabuf_resize(&proberesp, pos - buf) != 0)
  64                         goto fail;
  65                 wpabuf_put_data(proberesp, buf, pos - buf);
  66         }
  67
  68         pos = buf;
  69         pos = hostapd_eid_ext_capab(hapd, pos);
  70         if (pos != buf) {
  71                 if (wpabuf_resize(&assocresp, pos - buf) != 0)
  72                         goto fail;
  73                 wpabuf_put_data(assocresp, buf, pos - buf);
  74         }
  75         pos = hostapd_eid_interworking(hapd, pos);
  76         pos = hostapd_eid_adv_proto(hapd, pos);
  77         pos = hostapd_eid_roaming_consortium(hapd, pos);
  78         if (pos != buf) {
  79                 if (wpabuf_resize(&beacon, pos - buf) != 0)
  80                         goto fail;
  81                 wpabuf_put_data(beacon, buf, pos - buf);
  82
  83                 if (wpabuf_resize(&proberesp, pos - buf) != 0)
  84                         goto fail;
  85                 wpabuf_put_data(proberesp, buf, pos - buf);
  86         }
  87
  88         if (hapd->wps_beacon_ie) {
  89                 if (wpabuf_resize(&beacon, wpabuf_len(hapd->wps_beacon_ie)) <
  90                     0)
  91                         goto fail;
  92                 wpabuf_put_buf(beacon, hapd->wps_beacon_ie);
  93         }
  94
  95         if (hapd->wps_probe_resp_ie) {
  96                 if (wpabuf_resize(&proberesp,
  97                                   wpabuf_len(hapd->wps_probe_resp_ie)) < 0)
  98                         goto fail;
  99                 wpabuf_put_buf(proberesp, hapd->wps_probe_resp_ie);
 100         }
 101
 102 #ifdef CONFIG_P2P
 103         if (hapd->p2p_beacon_ie) {
 104                 if (wpabuf_resize(&beacon, wpabuf_len(hapd->p2p_beacon_ie)) <
 105                     0)
 106                         goto fail;
 107                 wpabuf_put_buf(beacon, hapd->p2p_beacon_ie);
 108         }
 109
 110         if (hapd->p2p_probe_resp_ie) {
 111                 if (wpabuf_resize(&proberesp,
 112                                   wpabuf_len(hapd->p2p_probe_resp_ie)) < 0)
 113                         goto fail;
 114                 wpabuf_put_buf(proberesp, hapd->p2p_probe_resp_ie);
 115         }
 116 #endif /* CONFIG_P2P */
 117
 118 #ifdef CONFIG_P2P_MANAGER
 119         if (hapd->conf->p2p & P2P_MANAGE) {
 120                 if (wpabuf_resize(&beacon, 100) == 0) {
 121                         u8 *start, *p;
 122                         start = wpabuf_put(beacon, 0);
 123                         p = hostapd_eid_p2p_manage(hapd, start);
 124                         wpabuf_put(beacon, p - start);
 125                 }
 126
 127                 if (wpabuf_resize(&proberesp, 100) == 0) {
 128                         u8 *start, *p;
 129                         start = wpabuf_put(proberesp, 0);
 130                         p = hostapd_eid_p2p_manage(hapd, start);
 131                         wpabuf_put(proberesp, p - start);
 132                 }
 133         }
 134 #endif /* CONFIG_P2P_MANAGER */
 135
 136 #ifdef CONFIG_WPS2
 137         if (hapd->conf->wps_state) {
 138                 struct wpabuf *a = wps_build_assoc_resp_ie();
 139                 if (a && wpabuf_resize(&assocresp, wpabuf_len(a)) == 0)
 140                         wpabuf_put_buf(assocresp, a);
 141                 wpabuf_free(a);
 142         }
 143 #endif /* CONFIG_WPS2 */
 144
 145 #ifdef CONFIG_P2P_MANAGER
 146         if (hapd->conf->p2p & P2P_MANAGE) {
 147                 if (wpabuf_resize(&assocresp, 100) == 0) {
 148                         u8 *start, *p;
 149                         start = wpabuf_put(assocresp, 0);
 150                         p = hostapd_eid_p2p_manage(hapd, start);
 151                         wpabuf_put(assocresp, p - start);
 152                 }
 153         }
 154 #endif /* CONFIG_P2P_MANAGER */
 155
 156         *beacon_ret = beacon;
 157         *proberesp_ret = proberesp;
 158         *assocresp_ret = assocresp;
 159
 160         return 0;
 161
 162 fail:
 163         wpabuf_free(beacon);
 164         wpabuf_free(proberesp);
 165         wpabuf_free(assocresp);
 166         return -1;
 167 }
 168
 169
 170 void hostapd_free_ap_extra_ies(struct hostapd_data *hapd,
 171                                struct wpabuf *beacon,
 172                                struct wpabuf *proberesp,
 173                                struct wpabuf *assocresp)
 174 {
 175         wpabuf_free(beacon);
 176         wpabuf_free(proberesp);
 177         wpabuf_free(assocresp);
 178 }
 179
 180
 181 int hostapd_set_ap_wps_ie(struct hostapd_data *hapd)
 182 {
 183         struct wpabuf *beacon, *proberesp, *assocresp;
 184         int ret;
 185
 186         if (hapd->driver == NULL || hapd->driver->set_ap_wps_ie == NULL)
 187                 return 0;
 188
 189         if (hostapd_build_ap_extra_ies(hapd, &beacon, &proberesp, &assocresp) <
 190             0)
 191                 return -1;
 192
 193         ret = hapd->driver->set_ap_wps_ie(hapd->drv_priv, beacon, proberesp,
 194                                           assocresp);
 195
 196         hostapd_free_ap_extra_ies(hapd, beacon, proberesp, assocresp);
 197
 198         return ret;
 199 }
 200
 201
 202 int hostapd_set_authorized(struct hostapd_data *hapd,
 203                            struct sta_info *sta, int authorized)
 204 {
 205         if (authorized) {
 206                 return hostapd_sta_set_flags(hapd, sta->addr,
 207                                              hostapd_sta_flags_to_drv(
 208                                                      sta->flags),
 209                                              WPA_STA_AUTHORIZED, ~0);
 210         }
 211
 212         return hostapd_sta_set_flags(hapd, sta->addr,
 213                                      hostapd_sta_flags_to_drv(sta->flags),
 214                                      0, ~WPA_STA_AUTHORIZED);
 215 }
 216
 217
 218 int hostapd_set_sta_flags(struct hostapd_data *hapd, struct sta_info *sta)
 219 {
 220         int set_flags, total_flags, flags_and, flags_or;
 221         total_flags = hostapd_sta_flags_to_drv(sta->flags);
 222         set_flags = WPA_STA_SHORT_PREAMBLE | WPA_STA_WMM | WPA_STA_MFP;
 223         if (((!hapd->conf->ieee802_1x && !hapd->conf->wpa) ||
 224              sta->auth_alg == WLAN_AUTH_FT) &&
 225             sta->flags & WLAN_STA_AUTHORIZED)
 226                 set_flags |= WPA_STA_AUTHORIZED;
 227         flags_or = total_flags & set_flags;
 228         flags_and = total_flags | ~set_flags;
 229         return hostapd_sta_set_flags(hapd, sta->addr, total_flags,
 230                                      flags_or, flags_and);
 231 }
 232
 233
 234 int hostapd_set_drv_ieee8021x(struct hostapd_data *hapd, const char *ifname,
 235                               int enabled)
 236 {
 237         struct wpa_bss_params params;
 238         os_memset(&params, 0, sizeof(params));
 239         params.ifname = ifname;
 240         params.enabled = enabled;
 241         if (enabled) {
 242                 params.wpa = hapd->conf->wpa;
 243                 params.ieee802_1x = hapd->conf->ieee802_1x;
 244                 params.wpa_group = hapd->conf->wpa_group;
 245                 params.wpa_pairwise = hapd->conf->wpa_pairwise;
 246                 params.wpa_key_mgmt = hapd->conf->wpa_key_mgmt;
 247                 params.rsn_preauth = hapd->conf->rsn_preauth;
 248 #ifdef CONFIG_IEEE80211W
 249                 params.ieee80211w = hapd->conf->ieee80211w;
 250 #endif /* CONFIG_IEEE80211W */
 251         }
 252         return hostapd_set_ieee8021x(hapd, &params);
 253 }
 254
 255
 256 int hostapd_vlan_if_add(struct hostapd_data *hapd, const char *ifname)
 257 {
 258         char force_ifname[IFNAMSIZ];
 259         u8 if_addr[ETH_ALEN];
 260         return hostapd_if_add(hapd, WPA_IF_AP_VLAN, ifname, hapd->own_addr,
 261                               NULL, NULL, force_ifname, if_addr, NULL);
 262 }
 263
 264
 265 int hostapd_vlan_if_remove(struct hostapd_data *hapd, const char *ifname)
 266 {
 267         return hostapd_if_remove(hapd, WPA_IF_AP_VLAN, ifname);
 268 }
 269
 270
 271 int hostapd_set_wds_sta(struct hostapd_data *hapd, const u8 *addr, int aid,
 272                         int val)
 273 {
 274         const char *bridge = NULL;
 275
 276         if (hapd->driver == NULL || hapd->driver->set_wds_sta == NULL)
 277                 return 0;
 278         if (hapd->conf->wds_bridge[0])
 279                 bridge = hapd->conf->wds_bridge;
 280         else if (hapd->conf->bridge[0])
 281                 bridge = hapd->conf->bridge;
 282         return hapd->driver->set_wds_sta(hapd->drv_priv, addr, aid, val,
 283                                          bridge);
 284 }
 285
 286
 287 int hostapd_add_sta_node(struct hostapd_data *hapd, const u8 *addr,
 288                          u16 auth_alg)
 289 {
 290         if (hapd->driver == NULL || hapd->driver->add_sta_node == NULL)
 291                 return 0;
 292         return hapd->driver->add_sta_node(hapd->drv_priv, addr, auth_alg);
 293 }
 294
 295
 296 int hostapd_sta_auth(struct hostapd_data *hapd, const u8 *addr,
 297                      u16 seq, u16 status, const u8 *ie, size_t len)
 298 {
 299         if (hapd->driver == NULL || hapd->driver->sta_auth == NULL)
 300                 return 0;
 301         return hapd->driver->sta_auth(hapd->drv_priv, hapd->own_addr, addr,
 302                                       seq, status, ie, len);
 303 }
 304
 305
 306 int hostapd_sta_assoc(struct hostapd_data *hapd, const u8 *addr,
 307                       int reassoc, u16 status, const u8 *ie, size_t len)
 308 {
 309         if (hapd->driver == NULL || hapd->driver->sta_assoc == NULL)
 310                 return 0;
 311         return hapd->driver->sta_assoc(hapd->drv_priv, hapd->own_addr, addr,
 312                                        reassoc, status, ie, len);
 313 }
 314
 315
 316 int hostapd_sta_add(struct hostapd_data *hapd,
 317                     const u8 *addr, u16 aid, u16 capability,
 318                     const u8 *supp_rates, size_t supp_rates_len,
 319                     u16 listen_interval,
 320                     const struct ieee80211_ht_capabilities *ht_capab,
 321                     u32 flags, u8 uapsd_queues, u8 max_sp)
 322 {
 323         struct hostapd_sta_add_params params;
 324
 325         if (hapd->driver == NULL)
 326                 return 0;
 327         if (hapd->driver->sta_add == NULL)
 328                 return 0;
 329
 330         os_memset(&params, 0, sizeof(params));
 331         params.addr = addr;
 332         params.aid = aid;
 333         params.capability = capability;
 334         params.supp_rates = supp_rates;
 335         params.supp_rates_len = supp_rates_len;
 336         params.listen_interval = listen_interval;
 337         params.ht_capabilities = ht_capab;
 338         params.flags = hostapd_sta_flags_to_drv(flags);
 339         params.uapsd_queues = uapsd_queues;
 340         params.max_sp = max_sp;
 341         return hapd->driver->sta_add(hapd->drv_priv, &params);
 342 }
 343
 344
 345 int hostapd_add_tspec(struct hostapd_data *hapd, const u8 *addr,
 346                       u8 *tspec_ie, size_t tspec_ielen)
 347 {
 348         if (hapd->driver == NULL || hapd->driver->add_tspec == NULL)
 349                 return 0;
 350         return hapd->driver->add_tspec(hapd->drv_priv, addr, tspec_ie,
 351                                        tspec_ielen);
 352 }
 353
 354
 355 int hostapd_set_privacy(struct hostapd_data *hapd, int enabled)
 356 {
 357         if (hapd->driver == NULL || hapd->driver->set_privacy == NULL)
 358                 return 0;
 359         return hapd->driver->set_privacy(hapd->drv_priv, enabled);
 360 }
 361
 362
 363 int hostapd_set_generic_elem(struct hostapd_data *hapd, const u8 *elem,
 364                              size_t elem_len)
 365 {
 366         if (hapd->driver == NULL || hapd->driver->set_generic_elem == NULL)
 367                 return 0;
 368         return hapd->driver->set_generic_elem(hapd->drv_priv, elem, elem_len);
 369 }
 370
 371
 372 int hostapd_get_ssid(struct hostapd_data *hapd, u8 *buf, size_t len)
 373 {
 374         if (hapd->driver == NULL || hapd->driver->hapd_get_ssid == NULL)
 375                 return 0;
 376         return hapd->driver->hapd_get_ssid(hapd->drv_priv, buf, len);
 377 }
 378
 379
 380 int hostapd_set_ssid(struct hostapd_data *hapd, const u8 *buf, size_t len)
 381 {
 382         if (hapd->driver == NULL || hapd->driver->hapd_set_ssid == NULL)
 383                 return 0;
 384         return hapd->driver->hapd_set_ssid(hapd->drv_priv, buf, len);
 385 }
 386
 387
 388 int hostapd_if_add(struct hostapd_data *hapd, enum wpa_driver_if_type type,
 389                    const char *ifname, const u8 *addr, void *bss_ctx,
 390                    void **drv_priv, char *force_ifname, u8 *if_addr,
 391                    const char *bridge)
 392 {
 393         if (hapd->driver == NULL || hapd->driver->if_add == NULL)
 394                 return -1;
 395         return hapd->driver->if_add(hapd->drv_priv, type, ifname, addr,
 396                                     bss_ctx, drv_priv, force_ifname, if_addr,
 397                                     bridge);
 398 }
 399
 400
 401 int hostapd_if_remove(struct hostapd_data *hapd, enum wpa_driver_if_type type,
 402                       const char *ifname)
 403 {
 404         if (hapd->driver == NULL || hapd->driver->if_remove == NULL)
 405                 return -1;
 406         return hapd->driver->if_remove(hapd->drv_priv, type, ifname);
 407 }
 408
 409
 410 int hostapd_set_ieee8021x(struct hostapd_data *hapd,
 411                           struct wpa_bss_params *params)
 412 {
 413         if (hapd->driver == NULL || hapd->driver->set_ieee8021x == NULL)
 414                 return 0;
 415         return hapd->driver->set_ieee8021x(hapd->drv_priv, params);
 416 }
 417
 418
 419 int hostapd_get_seqnum(const char *ifname, struct hostapd_data *hapd,
 420                        const u8 *addr, int idx, u8 *seq)
 421 {
 422         if (hapd->driver == NULL || hapd->driver->get_seqnum == NULL)
 423                 return 0;
 424         return hapd->driver->get_seqnum(ifname, hapd->drv_priv, addr, idx,
 425                                         seq);
 426 }
 427
 428
 429 int hostapd_flush(struct hostapd_data *hapd)
 430 {
 431         if (hapd->driver == NULL || hapd->driver->flush == NULL)
 432                 return 0;
 433         return hapd->driver->flush(hapd->drv_priv);
 434 }
 435
 436
 437 int hostapd_set_freq(struct hostapd_data *hapd, int mode, int freq,
 438                      int channel, int ht_enabled, int sec_channel_offset)
 439 {
 440         struct hostapd_freq_params data;
 441         if (hapd->driver == NULL)
 442                 return 0;
 443         if (hapd->driver->set_freq == NULL)
 444                 return 0;
 445         os_memset(&data, 0, sizeof(data));
 446         data.mode = mode;
 447         data.freq = freq;
 448         data.channel = channel;
 449         data.ht_enabled = ht_enabled;
 450         data.sec_channel_offset = sec_channel_offset;
 451         return hapd->driver->set_freq(hapd->drv_priv, &data);
 452 }
 453
 454 int hostapd_set_rts(struct hostapd_data *hapd, int rts)
 455 {
 456         if (hapd->driver == NULL || hapd->driver->set_rts == NULL)
 457                 return 0;
 458         return hapd->driver->set_rts(hapd->drv_priv, rts);
 459 }
 460
 461
 462 int hostapd_set_frag(struct hostapd_data *hapd, int frag)
 463 {
 464         if (hapd->driver == NULL || hapd->driver->set_frag == NULL)
 465                 return 0;
 466         return hapd->driver->set_frag(hapd->drv_priv, frag);
 467 }
 468
 469
 470 int hostapd_sta_set_flags(struct hostapd_data *hapd, u8 *addr,
 471                           int total_flags, int flags_or, int flags_and)
 472 {
 473         if (hapd->driver == NULL || hapd->driver->sta_set_flags == NULL)
 474                 return 0;
 475         return hapd->driver->sta_set_flags(hapd->drv_priv, addr, total_flags,
 476                                            flags_or, flags_and);
 477 }
 478
 479
 480 int hostapd_set_country(struct hostapd_data *hapd, const char *country)
 481 {
 482         if (hapd->driver == NULL ||
 483             hapd->driver->set_country == NULL)
 484                 return 0;
 485         return hapd->driver->set_country(hapd->drv_priv, country);
 486 }
 487
 488
 489 int hostapd_set_tx_queue_params(struct hostapd_data *hapd, int queue, int aifs,
 490                                 int cw_min, int cw_max, int burst_time)
 491 {
 492         if (hapd->driver == NULL || hapd->driver->set_tx_queue_params == NULL)
 493                 return 0;
 494         return hapd->driver->set_tx_queue_params(hapd->drv_priv, queue, aifs,
 495                                                  cw_min, cw_max, burst_time);
 496 }
 497
 498
 499 struct hostapd_hw_modes *
 500 hostapd_get_hw_feature_data(struct hostapd_data *hapd, u16 *num_modes,
 501                             u16 *flags)
 502 {
 503         if (hapd->driver == NULL ||
 504             hapd->driver->get_hw_feature_data == NULL)
 505                 return NULL;
 506         return hapd->driver->get_hw_feature_data(hapd->drv_priv, num_modes,
 507                                                  flags);
 508 }
 509
 510
 511 int hostapd_driver_commit(struct hostapd_data *hapd)
 512 {
 513         if (hapd->driver == NULL || hapd->driver->commit == NULL)
 514                 return 0;
 515         return hapd->driver->commit(hapd->drv_priv);
 516 }
 517
 518
 519 int hostapd_drv_none(struct hostapd_data *hapd)
 520 {
 521         return hapd->driver && os_strcmp(hapd->driver->name, "none") == 0;
 522 }
 523
 524
 525 int hostapd_driver_scan(struct hostapd_data *hapd,
 526                         struct wpa_driver_scan_params *params)
 527 {
 528         if (hapd->driver && hapd->driver->scan2)
 529                 return hapd->driver->scan2(hapd->drv_priv, params);
 530         return -1;
 531 }
 532
 533
 534 struct wpa_scan_results * hostapd_driver_get_scan_results(
 535         struct hostapd_data *hapd)
 536 {
 537         if (hapd->driver && hapd->driver->get_scan_results2)
 538                 return hapd->driver->get_scan_results2(hapd->drv_priv);
 539         return NULL;
 540 }
 541
 542
 543 int hostapd_driver_set_noa(struct hostapd_data *hapd, u8 count, int start,
 544                            int duration)
 545 {
 546         if (hapd->driver && hapd->driver->set_noa)
 547                 return hapd->driver->set_noa(hapd->drv_priv, count, start,
 548                                              duration);
 549         return -1;
 550 }
 551
 552
 553 int hostapd_drv_set_key(const char *ifname, struct hostapd_data *hapd,
 554                         enum wpa_alg alg, const u8 *addr,
 555                         int key_idx, int set_tx,
 556                         const u8 *seq, size_t seq_len,
 557                         const u8 *key, size_t key_len)
 558 {
 559         if (hapd->driver == NULL || hapd->driver->set_key == NULL)
 560                 return 0;
 561         return hapd->driver->set_key(ifname, hapd->drv_priv, alg, addr,
 562                                      key_idx, set_tx, seq, seq_len, key,
 563                                      key_len);
 564 }
 565
 566
 567 int hostapd_drv_send_mlme(struct hostapd_data *hapd,
 568                           const void *msg, size_t len, int noack)
 569 {
 570         if (hapd->driver == NULL || hapd->driver->send_mlme == NULL)
 571                 return 0;
 572         return hapd->driver->send_mlme(hapd->drv_priv, msg, len, noack);
 573 }
 574
 575
 576 int hostapd_drv_sta_deauth(struct hostapd_data *hapd,
 577                            const u8 *addr, int reason)
 578 {
 579         if (hapd->driver == NULL || hapd->driver->sta_deauth == NULL)
 580                 return 0;
 581         return hapd->driver->sta_deauth(hapd->drv_priv, hapd->own_addr, addr,
 582                                         reason);
 583 }
 584
 585
 586 int hostapd_drv_sta_disassoc(struct hostapd_data *hapd,
 587                              const u8 *addr, int reason)
 588 {
 589         if (hapd->driver == NULL || hapd->driver->sta_disassoc == NULL)
 590                 return 0;
 591         return hapd->driver->sta_disassoc(hapd->drv_priv, hapd->own_addr, addr,
 592                                           reason);
 593 }