ibss.c revision 62ae67be31c2346b6d74653a148ddbd1b9a94424
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; 76f446d10f214091408b7300f15c9adf60569edf28Johannes Berg struct cfg80211_bss *bss; 7757c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg u32 bss_change; 78b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u8 supp_rates[IEEE80211_MAX_SUPP_RATES]; 792448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg 802448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* Reset own TSF to allow time synchronization work. */ 812448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg drv_reset_tsf(local); 82469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 83af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = ifibss->skb; 84af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(ifibss->presp, NULL); 85af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 86af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->data = skb->head; 87af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->len = 0; 88af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reset_tail_pointer(skb); 89af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reserve(skb, sdata->local->hw.extra_tx_headroom); 90469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 91af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (memcmp(ifibss->bssid, bssid, ETH_ALEN)) 92af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 93469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 94469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ifibss->bssid, bssid, ETH_ALEN); 95469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 96af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0; 97469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 98af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg local->oper_channel = chan; 99af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg local->oper_channel_type = NL80211_CHAN_NO_HT; 100af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL); 10157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 102af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sband = local->hw.wiphy->bands[chan->band]; 103469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 104b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg /* build supported rates array */ 105b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg pos = supp_rates; 106b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < sband->n_bitrates; i++) { 107b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rate = sband->bitrates[i].bitrate; 108b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u8 basic = 0; 109b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (basic_rates & BIT(i)) 110b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic = 0x80; 111b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg *pos++ = basic | (u8) (rate / 5); 112b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 113b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 114469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Build IBSS probe response */ 115af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mgmt = (void *) skb_put(skb, 24 + sizeof(mgmt->u.beacon)); 116469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt, 0, 24 + sizeof(mgmt->u.beacon)); 117469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 118469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_STYPE_PROBE_RESP); 119469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt->da, 0xff, ETH_ALEN); 120469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->sa, sdata->dev->dev_addr, ETH_ALEN); 121469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN); 12257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int); 123707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith mgmt->u.beacon.timestamp = cpu_to_le64(tsf); 124469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->u.beacon.capab_info = cpu_to_le16(capability); 125469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 126469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + ifibss->ssid_len); 127469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SSID; 128469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = ifibss->ssid_len; 129469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, ifibss->ssid, ifibss->ssid_len); 130469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 131b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg rates = sband->n_bitrates; 132469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rates > 8) 133469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = 8; 134469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 135469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SUPP_RATES; 136469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 137469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, supp_rates, rates); 138469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 139469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->band == IEEE80211_BAND_2GHZ) { 140469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 1); 141469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_DS_PARAMS; 142469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 1; 143af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg *pos++ = ieee80211_frequency_to_channel(chan->center_freq); 144469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 145469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 146469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 2); 147469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_IBSS_PARAMS; 148469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 2; 149469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* FIX: set ATIM window based on scan results */ 150469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 151469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 152469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 153b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (sband->n_bitrates > 8) { 154b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg rates = sband->n_bitrates - 8; 155469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 156469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_EXT_SUPP_RATES; 157469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 158469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, &supp_rates[8], rates); 159469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 160469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 161af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->ie_len) 162af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(skb_put(skb, ifibss->ie_len), 163af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ifibss->ie, ifibss->ie_len); 164af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 165af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(ifibss->presp, skb); 166469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1672d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg sdata->vif.bss_conf.beacon_int = beacon_int; 1682d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change = BSS_CHANGED_BEACON_INT; 1692d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= ieee80211_reset_erp_info(sdata); 1702d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BSSID; 1712d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON; 1722d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON_ENABLED; 1732d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, bss_change); 174469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 175b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg ieee80211_sta_def_wmm_params(sdata, sband->n_bitrates, supp_rates); 176469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 177469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 178af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 179af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 180469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 181f446d10f214091408b7300f15c9adf60569edf28Johannes Berg bss = cfg80211_inform_bss_frame(local->hw.wiphy, local->hw.conf.channel, 182f446d10f214091408b7300f15c9adf60569edf28Johannes Berg mgmt, skb->len, 0, GFP_KERNEL); 183f446d10f214091408b7300f15c9adf60569edf28Johannes Berg cfg80211_put_bss(bss); 184af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cfg80211_ibss_joined(sdata->dev, ifibss->bssid, GFP_KERNEL); 185469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 186469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 187af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 188af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_bss *bss) 189469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 190b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg struct ieee80211_supported_band *sband; 191b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u32 basic_rates; 192b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int i, j; 19357c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg u16 beacon_int = bss->cbss.beacon_interval; 19457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 19557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg if (beacon_int < 10) 19657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int = 10; 19757c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 198b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg sband = sdata->local->hw.wiphy->bands[bss->cbss.channel->band]; 199b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 200b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates = 0; 201b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 202b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < bss->supp_rates_len; i++) { 203b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rate = (bss->supp_rates[i] & 0x7f) * 5; 204b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg bool is_basic = !!(bss->supp_rates[i] & 0x80); 205b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 206b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (j = 0; j < sband->n_bitrates; j++) { 207b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (sband->bitrates[j].bitrate == rate) { 208b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (is_basic) 209b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates |= BIT(j); 210b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg break; 211b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 212b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 213b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 214b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 215af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg __ieee80211_sta_join_ibss(sdata, bss->cbss.bssid, 21657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int, 217af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.channel, 218b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates, 219af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.capability, 220af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.tsf); 221469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 222469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 223469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 224469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 225469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 226469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 227469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems *elems, 228469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bool beacon) 229469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 230469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 231469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int freq; 232469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 233469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 234469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 235469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 236469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 237469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 238469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 239469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ds_params && elems->ds_params_len == 1) 240469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = ieee80211_channel_to_frequency(elems->ds_params[0]); 241469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 242469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = rx_status->freq; 243469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 244469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 245469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 246469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 247469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 248469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 249469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->vif.type == NL80211_IFTYPE_ADHOC && elems->supp_rates && 250469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) { 251469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg supp_rates = ieee80211_sta_get_rates(local, elems, band); 252469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 253469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 254469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 255469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_get(local, mgmt->sa); 256469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta) { 257469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 prev_rates; 258469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 259469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg prev_rates = sta->sta.supp_rates[band]; 260469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 261469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 262469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 263469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 264469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 265469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sta.supp_rates[band] != prev_rates) 266469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: updated supp_rates set " 267469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "for %pM based on beacon info (0x%llx | " 268469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "0x%llx -> 0x%llx)\n", 269469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, 270469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.addr, 271469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) prev_rates, 272469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) supp_rates, 273469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) sta->sta.supp_rates[band]); 274469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 275469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else 276469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 277469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 278469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 279469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 280469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 281469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 282469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel, beacon); 283469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 284469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 285469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 286469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* was just updated in ieee80211_bss_info_update */ 287469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg beacon_timestamp = bss->cbss.tsf; 288469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 289469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 290469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 291469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* merge only on beacons (???) */ 292469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!beacon) 293469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 294469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 295469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* we use a fixed BSSID */ 296af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.bssid) 297469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 298469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 299469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 300469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!(bss->cbss.capability & WLAN_CAPABILITY_IBSS)) 301469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 302469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 303469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 304469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (bss->cbss.channel != local->oper_channel) 305469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 306469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 307469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 308469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 309469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 310469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 311469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 312469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 31334e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 31434e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen if (memcmp(bss->cbss.bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) 31534e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 31634e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 317469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_TSFT) { 318469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 319469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * For correct IBSS merging we need mactime; since mactime is 320469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * defined as the time the first data symbol of the frame hits 321469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * the PHY, and the timestamp of the beacon is defined as "the 322469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * time that the data symbol containing the first bit of the 323469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * timestamp is transmitted to the PHY plus the transmitting 324469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * STA's delays through its local PHY from the MAC-PHY 325469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * interface to its interface with the WM" (802.11 11.1.2) 326469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * - equals the time this bit arrives at the receiver - we have 327469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * to take into account the offset between the two. 328469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 329469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * E.g. at 1 MBit that means mactime is 192 usec earlier 330469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * (=24 bytes * 8 usecs/byte) than the beacon timestamp. 331469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 332469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate; 333469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 334469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_HT) 335469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = 65; /* TODO: HT rates */ 336469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 337469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = local->hw.wiphy->bands[band]-> 338469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bitrates[rx_status->rate_idx].bitrate; 339469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 340469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = rx_status->mactime + (24 * 8 * 10 / rate); 3412448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } else { 3422448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* 3432448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * second best option: get current TSF 3442448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * (will return -1 if not supported) 3452448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg */ 3462448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg rx_timestamp = drv_get_tsf(local); 3472448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } 348469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 349469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 350469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "RX beacon SA=%pM BSSID=" 351469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 352469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->sa, mgmt->bssid, 353469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)rx_timestamp, 354469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)beacon_timestamp, 355469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 356469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies); 357469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 358469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3594a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen /* give slow hardware some time to do the TSF sync */ 3604a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen if (rx_timestamp < IEEE80211_IBSS_MERGE_DELAY) 3614a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen goto put_bss; 3624a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen 363469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 364469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 365469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: beacon TSF higher than " 366469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "local TSF - IBSS merge with BSSID %pM\n", 367469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->bssid); 368469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 369469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 370469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 371469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 372469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 375469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 377469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* 378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Add a new IBSS station, will also be called by the RX code when, 379469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * in IBSS mode, receiving a frame from a yet-unknown station, hence 380469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * must be callable in atomic context. 381469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 382469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstruct sta_info *ieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, 383469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *bssid,u8 *addr, u32 supp_rates) 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 387469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int band = local->hw.conf.channel->band; 388469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 389af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 390af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 391af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 392af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 393469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 394af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (net_ratelimit()) 395af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA entry %pM\n", 396af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->dev->name, addr); 397469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 398469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 399469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 400469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) 401469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 402469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 403469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 404469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Adding new IBSS station %pM (dev=%s)\n", 405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg wiphy_name(local->hw.wiphy), addr, sdata->dev->name); 406469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 407469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 408469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 409469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 410469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 411469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 412469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_sta_flags(sta, WLAN_STA_AUTHORIZED); 413469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 414469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 415469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 416469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 417469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 418469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate_control_rate_init(sta); 419469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 420469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta_info_insert(sta)) 421469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 422469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 423469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return sta; 424469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 425469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 426469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 427469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 429469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active = 0; 430469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 431469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 432469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 433469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 434469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 435469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sdata == sdata && 436469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 437469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies)) { 438469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active++; 439469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 440469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 441469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 442469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 443469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 444469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 445469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return active; 446469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 447469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 448469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 449469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 450469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 451469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 452469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 453af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 454af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 455469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 456469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT); 457af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 458450aae3d7b60a970f266349a837dfb30a539198bSujith if (time_before(jiffies, ifibss->last_scan_completed + 459450aae3d7b60a970f266349a837dfb30a539198bSujith IEEE80211_IBSS_MERGE_INTERVAL)) 460450aae3d7b60a970f266349a837dfb30a539198bSujith return; 461450aae3d7b60a970f266349a837dfb30a539198bSujith 462469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 463469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 464469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 465af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 466469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 467469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 468469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: No active IBSS STAs - trying to scan for other " 469469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "IBSS networks with same SSID (merge)\n", sdata->dev->name); 470469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 471f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ieee80211_request_internal_scan(sdata, ifibss->ssid, ifibss->ssid_len); 472469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 473469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 474af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 475469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 476469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 477469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 481469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 482469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 483af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 484469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 485469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 486469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 487469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 488469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 490469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 491469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[i] ^= sdata->dev->dev_addr[i]; 492469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 493469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 494469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 495469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 496469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Creating new IBSS network, BSSID %pM\n", 497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, bssid); 498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 499af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sband = local->hw.wiphy->bands[ifibss->channel->band]; 500469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 501469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 502469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 503fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 504469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 507469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 50857c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int, 509b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg ifibss->channel, 3, /* first two are basic */ 510b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg capability, 0); 511469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 512469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 513af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 514469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 515469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 516469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 517469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 518af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 519469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 520469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 521e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg u16 capability; 522469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 523469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 524469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 525469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: sta_find_ibss (active_ibss=%d)\n", 526469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, active_ibss); 527469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 528469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 529469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 530af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 531469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 532e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability = WLAN_CAPABILITY_IBSS; 533fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 534e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 535af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 536af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 537af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 538af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg chan = ifibss->channel; 539af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 540469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 541af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss = (void *)cfg80211_get_bss(local->hw.wiphy, chan, bssid, 542469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid, ifibss->ssid_len, 543e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg WLAN_CAPABILITY_IBSS | 544db67645db623caa12976293caa95fcd33d8c11b4Johannes Berg WLAN_CAPABILITY_PRIVACY, 545db67645db623caa12976293caa95fcd33d8c11b4Johannes Berg capability); 546469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 547d419b9f0fa69e79ccba3e5e79a58a52ae0c2ed6aReinette Chatre if (bss) { 548469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 549469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " sta_find_ibss: selected %pM current " 550469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM\n", bss->cbss.bssid, ifibss->bssid); 551469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 552469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 553469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Selected IBSS BSSID %pM" 554469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " based on configured SSID\n", 555469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, bss->cbss.bssid); 556469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 557af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 558469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 559af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 560d419b9f0fa69e79ccba3e5e79a58a52ae0c2ed6aReinette Chatre } 561469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 562469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 563469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " did not try to join ibss\n"); 564469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 565469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 566469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 567469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_JOINED && 568469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg !ieee80211_sta_active_ibss(sdata)) { 569af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 570af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 571af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else if (time_after(jiffies, ifibss->last_scan_completed + 572469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 573469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Trigger new scan to find an IBSS to " 574469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "join\n", sdata->dev->name); 575469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 576f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ieee80211_request_internal_scan(sdata, ifibss->ssid, 577f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ifibss->ssid_len); 578469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (ifibss->state != IEEE80211_IBSS_MLME_JOINED) { 579469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 580469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 581469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 582469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) { 583af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!(local->oper_channel->flags & IEEE80211_CHAN_NO_IBSS)) { 584af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_create_ibss(sdata); 585af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 586af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 587469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: IBSS not allowed on" 588469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " %d MHz\n", sdata->dev->name, 589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.channel->center_freq); 590469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 591469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* No IBSS found - decrease scan interval and continue 592469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * scanning. */ 593469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg interval = IEEE80211_SCAN_INTERVAL_SLOW; 594469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 595469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 596469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_SEARCH; 597af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 598af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 599469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 600469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 601469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 602469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len) 605469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 606469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 607469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 608469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int tx_last_beacon; 609469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 610469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *resp; 611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 613469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 614af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg len < 24 + 2 || !ifibss->presp) 615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 616469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6172448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg tx_last_beacon = drv_tx_last_beacon(local); 618469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 619469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 620469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: RX ProbeReq SA=%pM DA=%pM BSSID=%pM" 621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " (tx_last_beacon=%d)\n", 622469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->sa, mgmt->da, 623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->bssid, tx_last_beacon); 624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 625469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 626469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!tx_last_beacon) 627469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 628469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 629469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->bssid, ifibss->bssid, ETH_ALEN) != 0 && 630469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) != 0) 631469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 632469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 633469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 634469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 635469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 636469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 637469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 638469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Invalid SSID IE in ProbeReq " 639469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "from %pM\n", 640469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->sa); 641469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 642469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 643469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 644469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 645469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 646af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg !memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 647469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 648469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 649469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 650469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 651469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 652af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = skb_copy(ifibss->presp, GFP_KERNEL); 653469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 654469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 655469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 656469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg resp = (struct ieee80211_mgmt *) skb->data; 657469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(resp->da, mgmt->sa, ETH_ALEN); 658469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 659469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Sending ProbeResp to %pM\n", 660469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, resp->da); 661469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 66262ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; 66362ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg ieee80211_tx_skb(sdata, skb); 664469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 665469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 666469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata, 667469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 668469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 669469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 670469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 671469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 672469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 673469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 674469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->da, sdata->dev->dev_addr, ETH_ALEN)) 675469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; /* ignore ProbeResp to foreign address */ 676469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 677469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 678469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 679469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 680469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 681469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 682469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg &elems); 683469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 684469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false); 685469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 686469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 687469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata, 688469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 689469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 690469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 691469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 692469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 693469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 694469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 695469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Process beacon from the current BSS */ 696469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt; 697469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 698469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 699469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 700469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems); 701469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 702469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true); 703469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 704469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 705469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 706469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb) 707469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 708469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 709469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 710469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 711469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 712f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 713469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 714469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 715469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 716469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 717469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 718469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, mgmt, skb->len); 719469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 720469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 721469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len, 722469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 723469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 724469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 725469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, 726469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 727469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 728469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 729469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 730469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 731469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 732469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 733469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg kfree_skb(skb); 734469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 735469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 736469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_work(struct work_struct *work) 737469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 738469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 739469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg container_of(work, struct ieee80211_sub_if_data, u.ibss.work); 740469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 741469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss; 742469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 743469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7445bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (WARN_ON(local->suspended)) 7455bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 7465bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 747469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!netif_running(sdata->dev)) 748469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 749469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 750fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa if (local->scanning) 751469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 752469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 753469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_ADHOC)) 754469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 755469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss = &sdata->u.ibss; 756469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 757469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg while ((skb = skb_dequeue(&ifibss->skb_queue))) 758469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_rx_queued_mgmt(sdata, skb); 759469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 760469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!test_and_clear_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request)) 761469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 762469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 763469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 764469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 765469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 766469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 767469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 768469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 769469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 770469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 771469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 772469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 773469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 774469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 775469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 776469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 777469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 778469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 779469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 780469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 781469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 782469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7835bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (local->quiescing) { 7845bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 7855bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 7865bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 7875bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 788469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request); 78942935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez ieee80211_queue_work(&local->hw, &ifibss->work); 790469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 791469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7925bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#ifdef CONFIG_PM 7935bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_quiesce(struct ieee80211_sub_if_data *sdata) 7945bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 7955bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 7965bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 7975bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg cancel_work_sync(&ifibss->work); 7985bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (del_timer_sync(&ifibss->timer)) 7995bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 8005bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 8015bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 8025bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_restart(struct ieee80211_sub_if_data *sdata) 8035bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 8045bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 8055bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 8065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (ifibss->timer_running) { 8075bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg add_timer(&ifibss->timer); 8085bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = false; 8095bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 8105bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 8115bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#endif 8125bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 813469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 814469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 815469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 816469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 817469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg INIT_WORK(&ifibss->work, ieee80211_ibss_work); 818469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 819469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 820469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_head_init(&ifibss->skb_queue); 821469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 822469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 823469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 824469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 825469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 826af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 827469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 82829b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_lock(&local->iflist_mtx); 82929b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg list_for_each_entry(sdata, &local->interfaces, list) { 8300e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg if (!netif_running(sdata->dev)) 8310e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 832af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 833af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 8340e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg if (!sdata->u.ibss.ssid_len) 8350e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 836af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 83751f98f1313d2fc4b1d3a3e1f4db7cf4925b29df6Johannes Berg mod_timer(&sdata->u.ibss.timer, 0); 838469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 83929b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_unlock(&local->iflist_mtx); 840469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 841469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 842469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergieee80211_rx_result 843f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Bergieee80211_ibss_rx_mgmt(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb) 844469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 845469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 846469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 847469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 848469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 849469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (skb->len < 24) 850469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 851469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 852469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 853469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 854469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 855469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 856469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 857469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 858469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 859469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 860469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_tail(&sdata->u.ibss.skb_queue, skb); 86142935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez ieee80211_queue_work(&local->hw, &sdata->u.ibss.work); 862469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_QUEUED; 863469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 864469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 865469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 866469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 867af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 868af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 869af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 870af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 871af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 872af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 873af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 874af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 875af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 876af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 877af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 878af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 879fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.privacy = params->privacy; 880fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg 88157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg sdata->vif.bss_conf.beacon_int = params->beacon_interval; 88257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 883af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.channel = params->channel; 884af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 885af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 886af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 887af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 888af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 889af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 890af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 891af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 892af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 893af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom + 894af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 36 /* bitrates */ + 895af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 34 /* SSID */ + 896af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 3 /* DS params */ + 897af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 4 /* IBSS params */ + 898af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg params->ie_len); 899af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!skb) 900af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return -ENOMEM; 901af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 902af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.skb = skb; 903af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 904af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 905af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 9060e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg memcpy(sdata->u.ibss.ssid, params->ssid, IEEE80211_MAX_SSID_LEN); 9070e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9080e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg /* 9090e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * The ssid_len setting below is used to see whether 9100e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * we are active, and we need all other settings 9110e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * before that may get visible. 9120e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg */ 9130e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg mb(); 9140e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9150e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 9160e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9175cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 9185cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 919af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 92042935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez ieee80211_queue_work(&sdata->local->hw, &sdata->u.ibss.work); 921af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 922af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 923af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 924af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 925af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 926af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 927af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 928af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 929af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg del_timer_sync(&sdata->u.ibss.timer); 930af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg clear_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 931af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cancel_work_sync(&sdata->u.ibss.work); 932af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg clear_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 933af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 934af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 935af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 936af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 937af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 938af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = sdata->u.ibss.presp; 939af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(sdata->u.ibss.presp, NULL); 9402d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED); 941af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 942af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree_skb(skb); 943af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 944af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_queue_purge(&sdata->u.ibss.skb_queue); 945af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memset(sdata->u.ibss.bssid, 0, ETH_ALEN); 9465cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg sdata->u.ibss.ssid_len = 0; 9475cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 9485cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 949af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 950af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 951af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 952