ibss.c revision fffd0934b9390f34bec45762192b7edd3b12b4b5
1469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* 2469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * IBSS mode implementation 3469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2003-2008, Jouni Malinen <j@w1.fi> 4469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2004, Instant802 Networks, Inc. 5469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2005, Devicescape Software, Inc. 6469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> 7469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2007, Michael Wu <flamingice@sourmilk.net> 8469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2009, Johannes Berg <johannes@sipsolutions.net> 9469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 10469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * This program is free software; you can redistribute it and/or modify 11469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * it under the terms of the GNU General Public License version 2 as 12469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * published by the Free Software Foundation. 13469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 14469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/delay.h> 16469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/if_ether.h> 17469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/skbuff.h> 18469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/if_arp.h> 19469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/etherdevice.h> 20469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/rtnetlink.h> 21469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <net/mac80211.h> 22469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <asm/unaligned.h> 23469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 24469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "ieee80211_i.h" 252448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg#include "driver-ops.h" 26469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "rate.h" 27469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 28469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL (2 * HZ) 29469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL_SLOW (15 * HZ) 30469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ) 31469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 32469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ) 334a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen#define IEEE80211_IBSS_MERGE_DELAY 0x400000 34469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ) 35469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 36469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MAX_STA_ENTRIES 128 37469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 38469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 39469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata, 40469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 41469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len) 42469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 43469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 auth_alg, auth_transaction, status_code; 44469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 45469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (len < 24 + 6) 46469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 47469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 48469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); 49469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); 50469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg status_code = le16_to_cpu(mgmt->u.auth.status_code); 51469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 52469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 53469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * IEEE 802.11 standard does not require authentication in IBSS 54469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * networks and most implementations do not seem to use it. 55469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * However, try to reply to authentication attempts if someone 56469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * has actually implemented this. 57469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 58469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (auth_alg == WLAN_AUTH_OPEN && auth_transaction == 1) 59469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, NULL, 0, 60fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.bssid, NULL, 0, 0); 61469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 62469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 63af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 64af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const u8 *bssid, const int beacon_int, 65af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan, 66b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg const u32 basic_rates, 67af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const u16 capability, u64 tsf) 68469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 69469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 70469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 71b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rates, i; 72469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 73469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 74469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 75469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 7657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg u32 bss_change; 77b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u8 supp_rates[IEEE80211_MAX_SUPP_RATES]; 782448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg 792448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* Reset own TSF to allow time synchronization work. */ 802448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg drv_reset_tsf(local); 81469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 82af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = ifibss->skb; 83af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(ifibss->presp, NULL); 84af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 85af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->data = skb->head; 86af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->len = 0; 87af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reset_tail_pointer(skb); 88af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reserve(skb, sdata->local->hw.extra_tx_headroom); 89469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 90af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (memcmp(ifibss->bssid, bssid, ETH_ALEN)) 91af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 92469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 93469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ifibss->bssid, bssid, ETH_ALEN); 94469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 95af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0; 96469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 97af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg local->oper_channel = chan; 98af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg local->oper_channel_type = NL80211_CHAN_NO_HT; 99af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL); 10057c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 101af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sband = local->hw.wiphy->bands[chan->band]; 102469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 103b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg /* build supported rates array */ 104b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg pos = supp_rates; 105b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < sband->n_bitrates; i++) { 106b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rate = sband->bitrates[i].bitrate; 107b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u8 basic = 0; 108b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (basic_rates & BIT(i)) 109b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic = 0x80; 110b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg *pos++ = basic | (u8) (rate / 5); 111b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 112b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 113469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Build IBSS probe response */ 114af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mgmt = (void *) skb_put(skb, 24 + sizeof(mgmt->u.beacon)); 115469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt, 0, 24 + sizeof(mgmt->u.beacon)); 116469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 117469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_STYPE_PROBE_RESP); 118469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt->da, 0xff, ETH_ALEN); 119469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->sa, sdata->dev->dev_addr, ETH_ALEN); 120469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN); 12157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int); 122707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith mgmt->u.beacon.timestamp = cpu_to_le64(tsf); 123469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->u.beacon.capab_info = cpu_to_le16(capability); 124469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 125469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + ifibss->ssid_len); 126469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SSID; 127469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = ifibss->ssid_len; 128469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, ifibss->ssid, ifibss->ssid_len); 129469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 130b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg rates = sband->n_bitrates; 131469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rates > 8) 132469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = 8; 133469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 134469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SUPP_RATES; 135469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 136469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, supp_rates, rates); 137469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 138469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->band == IEEE80211_BAND_2GHZ) { 139469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 1); 140469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_DS_PARAMS; 141469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 1; 142af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg *pos++ = ieee80211_frequency_to_channel(chan->center_freq); 143469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 144469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 145469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 2); 146469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_IBSS_PARAMS; 147469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 2; 148469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* FIX: set ATIM window based on scan results */ 149469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 150469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 151469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 152b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (sband->n_bitrates > 8) { 153b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg rates = sband->n_bitrates - 8; 154469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 155469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_EXT_SUPP_RATES; 156469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 157469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, &supp_rates[8], rates); 158469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 159469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 160af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->ie_len) 161af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(skb_put(skb, ifibss->ie_len), 162af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ifibss->ie, ifibss->ie_len); 163af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 164af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(ifibss->presp, skb); 165469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1662d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg sdata->vif.bss_conf.beacon_int = beacon_int; 1672d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change = BSS_CHANGED_BEACON_INT; 1682d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= ieee80211_reset_erp_info(sdata); 1692d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BSSID; 1702d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON; 1712d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON_ENABLED; 1722d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, bss_change); 173469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 174b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg ieee80211_sta_def_wmm_params(sdata, sband->n_bitrates, supp_rates); 175469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 176469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 177af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 178af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 179469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 180af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cfg80211_inform_bss_frame(local->hw.wiphy, local->hw.conf.channel, 181af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mgmt, skb->len, 0, GFP_KERNEL); 182af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cfg80211_ibss_joined(sdata->dev, ifibss->bssid, GFP_KERNEL); 183469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 184469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 185af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 186af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_bss *bss) 187469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 188b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg struct ieee80211_supported_band *sband; 189b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u32 basic_rates; 190b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int i, j; 19157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg u16 beacon_int = bss->cbss.beacon_interval; 19257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 19357c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg if (beacon_int < 10) 19457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int = 10; 19557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 196b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg sband = sdata->local->hw.wiphy->bands[bss->cbss.channel->band]; 197b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 198b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates = 0; 199b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 200b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < bss->supp_rates_len; i++) { 201b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rate = (bss->supp_rates[i] & 0x7f) * 5; 202b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg bool is_basic = !!(bss->supp_rates[i] & 0x80); 203b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 204b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (j = 0; j < sband->n_bitrates; j++) { 205b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (sband->bitrates[j].bitrate == rate) { 206b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (is_basic) 207b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates |= BIT(j); 208b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg break; 209b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 210b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 211b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 212b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 213af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg __ieee80211_sta_join_ibss(sdata, bss->cbss.bssid, 21457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int, 215af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.channel, 216b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates, 217af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.capability, 218af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.tsf); 219469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 220469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 221469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 222469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 223469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 224469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 225469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems *elems, 226469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bool beacon) 227469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 228469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 229469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int freq; 230469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 231469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 232469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 233469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 234469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 235469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 236469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 237469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ds_params && elems->ds_params_len == 1) 238469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = ieee80211_channel_to_frequency(elems->ds_params[0]); 239469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 240469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = rx_status->freq; 241469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 242469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 243469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 244469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 245469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 246469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 247469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->vif.type == NL80211_IFTYPE_ADHOC && elems->supp_rates && 248469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) { 249469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg supp_rates = ieee80211_sta_get_rates(local, elems, band); 250469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 251469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 252469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 253469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_get(local, mgmt->sa); 254469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta) { 255469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 prev_rates; 256469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 257469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg prev_rates = sta->sta.supp_rates[band]; 258469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 259469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 260469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 261469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 262469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 263469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sta.supp_rates[band] != prev_rates) 264469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: updated supp_rates set " 265469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "for %pM based on beacon info (0x%llx | " 266469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "0x%llx -> 0x%llx)\n", 267469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, 268469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.addr, 269469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) prev_rates, 270469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) supp_rates, 271469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) sta->sta.supp_rates[band]); 272469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 273469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else 274469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 275469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 276469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 277469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 278469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 279469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 280469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel, beacon); 281469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 282469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 283469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 284469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* was just updated in ieee80211_bss_info_update */ 285469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg beacon_timestamp = bss->cbss.tsf; 286469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 287469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 288469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 289469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* merge only on beacons (???) */ 290469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!beacon) 291469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 292469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 293469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* we use a fixed BSSID */ 294af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.bssid) 295469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 296469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 297469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 298469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!(bss->cbss.capability & WLAN_CAPABILITY_IBSS)) 299469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 300469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 301469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 302469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (bss->cbss.channel != local->oper_channel) 303469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 304469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 305469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 306469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 307469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 308469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 309469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 310469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 31134e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 31234e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen if (memcmp(bss->cbss.bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) 31334e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 31434e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 315469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_TSFT) { 316469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 317469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * For correct IBSS merging we need mactime; since mactime is 318469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * defined as the time the first data symbol of the frame hits 319469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * the PHY, and the timestamp of the beacon is defined as "the 320469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * time that the data symbol containing the first bit of the 321469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * timestamp is transmitted to the PHY plus the transmitting 322469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * STA's delays through its local PHY from the MAC-PHY 323469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * interface to its interface with the WM" (802.11 11.1.2) 324469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * - equals the time this bit arrives at the receiver - we have 325469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * to take into account the offset between the two. 326469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 327469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * E.g. at 1 MBit that means mactime is 192 usec earlier 328469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * (=24 bytes * 8 usecs/byte) than the beacon timestamp. 329469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 330469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate; 331469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 332469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_HT) 333469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = 65; /* TODO: HT rates */ 334469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 335469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = local->hw.wiphy->bands[band]-> 336469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bitrates[rx_status->rate_idx].bitrate; 337469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 338469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = rx_status->mactime + (24 * 8 * 10 / rate); 3392448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } else { 3402448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* 3412448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * second best option: get current TSF 3422448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * (will return -1 if not supported) 3432448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg */ 3442448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg rx_timestamp = drv_get_tsf(local); 3452448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } 346469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 347469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 348469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "RX beacon SA=%pM BSSID=" 349469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 350469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->sa, mgmt->bssid, 351469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)rx_timestamp, 352469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)beacon_timestamp, 353469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 354469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies); 355469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 356469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3574a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen /* give slow hardware some time to do the TSF sync */ 3584a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen if (rx_timestamp < IEEE80211_IBSS_MERGE_DELAY) 3594a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen goto put_bss; 3604a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen 361469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 362469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 363469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: beacon TSF higher than " 364469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "local TSF - IBSS merge with BSSID %pM\n", 365469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->bssid); 366469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 367469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 368469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 369469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 370469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 371469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 372469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 375469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* 376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Add a new IBSS station, will also be called by the RX code when, 377469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * in IBSS mode, receiving a frame from a yet-unknown station, hence 378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * must be callable in atomic context. 379469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 380469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstruct sta_info *ieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, 381469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *bssid,u8 *addr, u32 supp_rates) 382469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 383469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int band = local->hw.conf.channel->band; 386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 387af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 388af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 389af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 390af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 391469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 392af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (net_ratelimit()) 393af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA entry %pM\n", 394af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->dev->name, addr); 395469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 396469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 397469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 398469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) 399469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 400469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 401469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 402469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Adding new IBSS station %pM (dev=%s)\n", 403469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg wiphy_name(local->hw.wiphy), addr, sdata->dev->name); 404469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 406469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 407469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 408469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 409469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 410469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_sta_flags(sta, WLAN_STA_AUTHORIZED); 411469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 412469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 413469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 414469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 415469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 416469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate_control_rate_init(sta); 417469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 418469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta_info_insert(sta)) 419469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 420469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 421469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return sta; 422469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 423469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 424469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 425469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 426469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 427469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active = 0; 428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 429469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 430469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 431469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 432469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 433469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sdata == sdata && 434469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 435469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies)) { 436469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active++; 437469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 438469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 439469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 440469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 441469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 442469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 443469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return active; 444469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 445469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 446469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 447469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 448469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 449469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 450469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 451af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 452af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 453469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 454469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT); 455af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 456469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 457469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 458469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 459af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 460469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 461469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 462469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: No active IBSS STAs - trying to scan for other " 463469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "IBSS networks with same SSID (merge)\n", sdata->dev->name); 464469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 465f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ieee80211_request_internal_scan(sdata, ifibss->ssid, ifibss->ssid_len); 466469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 467469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 468af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 469469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 470469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 471469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 472469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 473469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 474469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 475469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 476469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 477af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 481469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 482469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 483469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 484469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 485469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[i] ^= sdata->dev->dev_addr[i]; 486469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 487469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 488469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 490469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Creating new IBSS network, BSSID %pM\n", 491469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, bssid); 492469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 493af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sband = local->hw.wiphy->bands[ifibss->channel->band]; 494469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 495469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 496469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 497fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 499469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 500469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 501469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 50257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int, 503b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg ifibss->channel, 3, /* first two are basic */ 504b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg capability, 0); 505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 507af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 508469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 509469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 510469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 511469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 512af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 513469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 514469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 515e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg u16 capability; 516469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 517469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 518469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 519469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: sta_find_ibss (active_ibss=%d)\n", 520469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, active_ibss); 521469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 522469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 523469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 524af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 525469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 526e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability = WLAN_CAPABILITY_IBSS; 527fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 528e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 529af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 530af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 531af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 532af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg chan = ifibss->channel; 533af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 534469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 535af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss = (void *)cfg80211_get_bss(local->hw.wiphy, chan, bssid, 536469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid, ifibss->ssid_len, 537e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg WLAN_CAPABILITY_IBSS | 538db67645db623caa12976293caa95fcd33d8c11b4Johannes Berg WLAN_CAPABILITY_PRIVACY, 539db67645db623caa12976293caa95fcd33d8c11b4Johannes Berg capability); 540469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 541469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 542469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (bss) 543469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " sta_find_ibss: selected %pM current " 544469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM\n", bss->cbss.bssid, ifibss->bssid); 545469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 546469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 547af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (bss && memcmp(ifibss->bssid, bss->cbss.bssid, ETH_ALEN)) { 548469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Selected IBSS BSSID %pM" 549469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " based on configured SSID\n", 550469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, bss->cbss.bssid); 551469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 552af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 553469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 554af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 555469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (bss) 556469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 557469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 558469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 559469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " did not try to join ibss\n"); 560469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 561469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 562469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 563469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_JOINED && 564469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg !ieee80211_sta_active_ibss(sdata)) { 565af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 566af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 567af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else if (time_after(jiffies, ifibss->last_scan_completed + 568469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 569469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Trigger new scan to find an IBSS to " 570469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "join\n", sdata->dev->name); 571469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 572f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ieee80211_request_internal_scan(sdata, ifibss->ssid, 573f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ifibss->ssid_len); 574469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (ifibss->state != IEEE80211_IBSS_MLME_JOINED) { 575469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 576469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 577469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 578469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) { 579af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!(local->oper_channel->flags & IEEE80211_CHAN_NO_IBSS)) { 580af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_create_ibss(sdata); 581af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 582af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 583469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: IBSS not allowed on" 584469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " %d MHz\n", sdata->dev->name, 585469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.channel->center_freq); 586469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 587469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* No IBSS found - decrease scan interval and continue 588469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * scanning. */ 589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg interval = IEEE80211_SCAN_INTERVAL_SLOW; 590469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 591469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 592469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_SEARCH; 593af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 594af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 595469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 596469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 597469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 598469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 599469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 600469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len) 601469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 602469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int tx_last_beacon; 605469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 606469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *resp; 607469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 608469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 609469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 610af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg len < 24 + 2 || !ifibss->presp) 611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6132448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg tx_last_beacon = drv_tx_last_beacon(local); 614469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 616469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: RX ProbeReq SA=%pM DA=%pM BSSID=%pM" 617469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " (tx_last_beacon=%d)\n", 618469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->sa, mgmt->da, 619469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->bssid, tx_last_beacon); 620469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 622469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!tx_last_beacon) 623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 625469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->bssid, ifibss->bssid, ETH_ALEN) != 0 && 626469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) != 0) 627469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 628469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 629469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 630469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 631469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 632469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 633469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 634469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Invalid SSID IE in ProbeReq " 635469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "from %pM\n", 636469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->sa); 637469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 638469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 639469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 640469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 641469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 642af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg !memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 643469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 644469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 645469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 646469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 647469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 648af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = skb_copy(ifibss->presp, GFP_KERNEL); 649469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 650469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 651469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 652469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg resp = (struct ieee80211_mgmt *) skb->data; 653469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(resp->da, mgmt->sa, ETH_ALEN); 654469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 655469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Sending ProbeResp to %pM\n", 656469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, resp->da); 657469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 658469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_tx_skb(sdata, skb, 0); 659469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 660469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 661469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata, 662469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 663469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 664469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 665469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 666469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 667469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 668469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 669469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->da, sdata->dev->dev_addr, ETH_ALEN)) 670469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; /* ignore ProbeResp to foreign address */ 671469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 672469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 673469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 674469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 675469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 676469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 677469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg &elems); 678469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 679469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false); 680469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 681469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 682469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata, 683469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 684469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 685469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 686469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 687469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 688469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 689469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 690469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Process beacon from the current BSS */ 691469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt; 692469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 693469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 694469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 695469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems); 696469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 697469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true); 698469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 699469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 700469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 701469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb) 702469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 703469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 704469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 705469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 706469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 707f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 708469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 709469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 710469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 711469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 712469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 713469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, mgmt, skb->len); 714469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 715469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 716469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len, 717469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 718469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 719469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 720469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, 721469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 722469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 723469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 724469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 725469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 726469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 727469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 728469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg kfree_skb(skb); 729469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 730469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 731469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_work(struct work_struct *work) 732469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 733469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 734469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg container_of(work, struct ieee80211_sub_if_data, u.ibss.work); 735469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 736469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss; 737469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 738469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7395bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (WARN_ON(local->suspended)) 7405bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 7415bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 742469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!netif_running(sdata->dev)) 743469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 744469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 745469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->sw_scanning || local->hw_scanning) 746469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 747469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 748469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_ADHOC)) 749469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 750469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss = &sdata->u.ibss; 751469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 752469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg while ((skb = skb_dequeue(&ifibss->skb_queue))) 753469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_rx_queued_mgmt(sdata, skb); 754469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 755469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!test_and_clear_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request)) 756469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 757469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 758469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 759469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 760469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 761469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 762469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 763469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 764469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 765469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 766469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 767469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 768469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 769469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 770469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 771469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 772469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 773469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 774469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 775469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 776469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 777469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7785bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (local->quiescing) { 7795bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 7805bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 7815bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 7825bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 783469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request); 784469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg queue_work(local->hw.workqueue, &ifibss->work); 785469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 786469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7875bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#ifdef CONFIG_PM 7885bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_quiesce(struct ieee80211_sub_if_data *sdata) 7895bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 7905bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 7915bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 7925bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg cancel_work_sync(&ifibss->work); 7935bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (del_timer_sync(&ifibss->timer)) 7945bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 7955bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 7965bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 7975bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_restart(struct ieee80211_sub_if_data *sdata) 7985bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 7995bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 8005bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 8015bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (ifibss->timer_running) { 8025bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg add_timer(&ifibss->timer); 8035bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = false; 8045bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 8055bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 8065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#endif 8075bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 808469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 809469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 810469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 811469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 812469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg INIT_WORK(&ifibss->work, ieee80211_ibss_work); 813469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 814469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 815469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_head_init(&ifibss->skb_queue); 816469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 817469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 818469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 819469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 820469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 821af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 822469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 82329b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_lock(&local->iflist_mtx); 82429b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg list_for_each_entry(sdata, &local->interfaces, list) { 8250e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg if (!netif_running(sdata->dev)) 8260e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 827af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 828af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 8290e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg if (!sdata->u.ibss.ssid_len) 8300e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 831af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 832af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_find_ibss(sdata); 833469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 83429b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_unlock(&local->iflist_mtx); 835469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 836469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 837469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergieee80211_rx_result 838f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Bergieee80211_ibss_rx_mgmt(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb) 839469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 840469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 841469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 842469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 843469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 844469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (skb->len < 24) 845469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 846469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 847469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 848469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 849469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 850469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 851469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 852469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 853469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 854469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 855469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_tail(&sdata->u.ibss.skb_queue, skb); 856469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg queue_work(local->hw.workqueue, &sdata->u.ibss.work); 857469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_QUEUED; 858469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 859469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 860469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 861469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 862af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 863af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 864af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 865af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 866af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 867af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 868af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 869af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 870af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 871af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 872af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 873af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 874fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.privacy = params->privacy; 875fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg 87657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg sdata->vif.bss_conf.beacon_int = params->beacon_interval; 87757c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 878af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.channel = params->channel; 879af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 880af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 881af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 882af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 883af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 884af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 885af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 886af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 887af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 888af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom + 889af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 36 /* bitrates */ + 890af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 34 /* SSID */ + 891af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 3 /* DS params */ + 892af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 4 /* IBSS params */ + 893af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg params->ie_len); 894af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!skb) 895af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return -ENOMEM; 896af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 897af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.skb = skb; 898af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 899af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 900af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 9010e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg memcpy(sdata->u.ibss.ssid, params->ssid, IEEE80211_MAX_SSID_LEN); 9020e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9030e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg /* 9040e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * The ssid_len setting below is used to see whether 9050e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * we are active, and we need all other settings 9060e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * before that may get visible. 9070e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg */ 9080e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg mb(); 9090e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9100e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 9110e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9125cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 9135cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 914af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 915af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg queue_work(sdata->local->hw.workqueue, &sdata->u.ibss.work); 916af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 917af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 918af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 919af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 920af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 921af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 922af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 923af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 924af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg del_timer_sync(&sdata->u.ibss.timer); 925af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg clear_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 926af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cancel_work_sync(&sdata->u.ibss.work); 927af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg clear_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 928af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 929af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 930af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 931af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 932af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 933af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = sdata->u.ibss.presp; 934af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(sdata->u.ibss.presp, NULL); 9352d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED); 936af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 937af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree_skb(skb); 938af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 939af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_queue_purge(&sdata->u.ibss.skb_queue); 940af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memset(sdata->u.ibss.bssid, 0, ETH_ALEN); 9415cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg sdata->u.ibss.ssid_len = 0; 9425cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 9435cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 944af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 945af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 946af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 947