ibss.c revision ce9058aedd75f14785400dcc49a2bc352ca38871
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); 12047846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg memcpy(mgmt->sa, sdata->vif.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{ 1900c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss = 1910c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg container_of((void *)bss, struct cfg80211_bss, priv); 192b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg struct ieee80211_supported_band *sband; 193b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u32 basic_rates; 194b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int i, j; 1950c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg u16 beacon_int = cbss->beacon_interval; 19657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 19757c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg if (beacon_int < 10) 19857c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int = 10; 19957c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 2000c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sband = sdata->local->hw.wiphy->bands[cbss->channel->band]; 201b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 202b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates = 0; 203b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 204b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < bss->supp_rates_len; i++) { 205b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rate = (bss->supp_rates[i] & 0x7f) * 5; 206b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg bool is_basic = !!(bss->supp_rates[i] & 0x80); 207b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 208b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (j = 0; j < sband->n_bitrates; j++) { 209b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (sband->bitrates[j].bitrate == rate) { 210b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (is_basic) 211b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates |= BIT(j); 212b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg break; 213b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 214b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 215b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 216b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 2170c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg __ieee80211_sta_join_ibss(sdata, cbss->bssid, 21857c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int, 2190c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->channel, 220b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates, 2210c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->capability, 2220c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->tsf); 223469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 224469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 225469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 226469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 227469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 228469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 229469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems *elems, 230469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bool beacon) 231469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 232469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 233469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int freq; 2340c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 235469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 236469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 237469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 238469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 239469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 240469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 241469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 242469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ds_params && elems->ds_params_len == 1) 243469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = ieee80211_channel_to_frequency(elems->ds_params[0]); 244469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 245469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = rx_status->freq; 246469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 247469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 248469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 249469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 250469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 251469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 252469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->vif.type == NL80211_IFTYPE_ADHOC && elems->supp_rates && 253469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) { 254469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg supp_rates = ieee80211_sta_get_rates(local, elems, band); 255469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 256469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 257469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 258abe60632f311d515b082b450504ee24006023951Johannes Berg sta = sta_info_get(sdata, mgmt->sa); 259469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta) { 260469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 prev_rates; 261469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 262469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg prev_rates = sta->sta.supp_rates[band]; 263469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 264469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 265469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 266469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 267469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 268469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sta.supp_rates[band] != prev_rates) 269469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: updated supp_rates set " 270469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "for %pM based on beacon info (0x%llx | " 271469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "0x%llx -> 0x%llx)\n", 27247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, 273469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.addr, 274469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) prev_rates, 275469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) supp_rates, 276469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) sta->sta.supp_rates[band]); 277469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 278469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else 279469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 280469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 281469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 282469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 283469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 284469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 285469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel, beacon); 286469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 287469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 288469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 2890c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = container_of((void *)bss, struct cfg80211_bss, priv); 2900c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 291469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* was just updated in ieee80211_bss_info_update */ 2920c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg beacon_timestamp = cbss->tsf; 293469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 294469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 295469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 296469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* merge only on beacons (???) */ 297469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!beacon) 298469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 299469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 300469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* we use a fixed BSSID */ 301af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.bssid) 302469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 303469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 304469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 3050c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (!(cbss->capability & WLAN_CAPABILITY_IBSS)) 306469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 307469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 308469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 3090c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss->channel != local->oper_channel) 310469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 311469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 312469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 313469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 314469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 315469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 316469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 317469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 31834e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 3190c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (memcmp(cbss->bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) 32034e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 32134e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 322469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_TSFT) { 323469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 324469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * For correct IBSS merging we need mactime; since mactime is 325469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * defined as the time the first data symbol of the frame hits 326469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * the PHY, and the timestamp of the beacon is defined as "the 327469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * time that the data symbol containing the first bit of the 328469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * timestamp is transmitted to the PHY plus the transmitting 329469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * STA's delays through its local PHY from the MAC-PHY 330469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * interface to its interface with the WM" (802.11 11.1.2) 331469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * - equals the time this bit arrives at the receiver - we have 332469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * to take into account the offset between the two. 333469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 334469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * E.g. at 1 MBit that means mactime is 192 usec earlier 335469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * (=24 bytes * 8 usecs/byte) than the beacon timestamp. 336469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 337469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate; 338469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 339469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_HT) 340469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = 65; /* TODO: HT rates */ 341469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 342469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = local->hw.wiphy->bands[band]-> 343469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bitrates[rx_status->rate_idx].bitrate; 344469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 345469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = rx_status->mactime + (24 * 8 * 10 / rate); 3462448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } else { 3472448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* 3482448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * second best option: get current TSF 3492448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * (will return -1 if not supported) 3502448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg */ 3512448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg rx_timestamp = drv_get_tsf(local); 3522448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } 353469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 354469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 355469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "RX beacon SA=%pM BSSID=" 356469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 357469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->sa, mgmt->bssid, 358469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)rx_timestamp, 359469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)beacon_timestamp, 360469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 361469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies); 362469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 363469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3644a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen /* give slow hardware some time to do the TSF sync */ 3654a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen if (rx_timestamp < IEEE80211_IBSS_MERGE_DELAY) 3664a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen goto put_bss; 3674a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen 368469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 369469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 370469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: beacon TSF higher than " 371469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "local TSF - IBSS merge with BSSID %pM\n", 37247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->bssid); 373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 375469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 377469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 379469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 380469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 381469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 382469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* 383469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Add a new IBSS station, will also be called by the RX code when, 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * in IBSS mode, receiving a frame from a yet-unknown station, hence 385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * must be callable in atomic context. 386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 387469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstruct sta_info *ieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, 388469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *bssid,u8 *addr, u32 supp_rates) 389469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 3902e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 391469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 392469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 393469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int band = local->hw.conf.channel->band; 394469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 395af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 396af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 397af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 398af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 399469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 400af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (net_ratelimit()) 401af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA entry %pM\n", 40247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, addr); 403469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 404469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4062e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) 4072e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau return NULL; 4082e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau 409469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) 410469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 411469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 412469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 413469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Adding new IBSS station %pM (dev=%s)\n", 41447846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg wiphy_name(local->hw.wiphy), addr, sdata->name); 415469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 416469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 417469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 418469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 419469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 420469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 421469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_sta_flags(sta, WLAN_STA_AUTHORIZED); 422469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 423469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 424469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 425469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 426469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 427469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate_control_rate_init(sta); 428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 429469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta_info_insert(sta)) 430469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 431469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 432469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return sta; 433469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 434469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 435469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 436469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 437469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 438469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active = 0; 439469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 440469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 441469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 442469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 443469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 444469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sdata == sdata && 445469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 446469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies)) { 447469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active++; 448469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 449469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 450469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 451469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 452469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 453469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 454469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return active; 455469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 456469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 457ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 458ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_JOINED 459ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 460469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 461469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 462469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 463469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 464469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 465af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 466af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 467469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 468469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT); 469af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 470450aae3d7b60a970f266349a837dfb30a539198bSujith if (time_before(jiffies, ifibss->last_scan_completed + 471450aae3d7b60a970f266349a837dfb30a539198bSujith IEEE80211_IBSS_MERGE_INTERVAL)) 472450aae3d7b60a970f266349a837dfb30a539198bSujith return; 473450aae3d7b60a970f266349a837dfb30a539198bSujith 474469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 475469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 476469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 477af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: No active IBSS STAs - trying to scan for other " 48147846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg "IBSS networks with same SSID (merge)\n", sdata->name); 482469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 483f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ieee80211_request_internal_scan(sdata, ifibss->ssid, ifibss->ssid_len); 484469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 485469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 486af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 487469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 488469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 490469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 491469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 492469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 493469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 494469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 495af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 496469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 499469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 500469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 501469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 502469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 50347846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg bssid[i] ^= sdata->vif.addr[i]; 504469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 507469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 508469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Creating new IBSS network, BSSID %pM\n", 50947846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, bssid); 510469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 511af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sband = local->hw.wiphy->bands[ifibss->channel->band]; 512469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 513469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 514469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 515fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 516469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 517469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 518469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 519469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 52057c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int, 521b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg ifibss->channel, 3, /* first two are basic */ 522b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg capability, 0); 523469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 524469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 525ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 526ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_SEARCH 527ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 528ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault 529af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 530469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 531469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 532469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 5330c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 534af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 535469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 536469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 537e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg u16 capability; 538469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 539469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 540469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 541469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: sta_find_ibss (active_ibss=%d)\n", 54247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, active_ibss); 543469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 544469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 545469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 546af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 547469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 548e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability = WLAN_CAPABILITY_IBSS; 549fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 550e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 551af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 552af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 553af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 554af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg chan = ifibss->channel; 555af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 556469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 5570c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid, 5580c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg ifibss->ssid, ifibss->ssid_len, 5590c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY, 5600c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg capability); 5610c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 5620c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss) { 5630c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct ieee80211_bss *bss; 564469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 5650c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg bss = (void *)cbss->priv; 566469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 567469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " sta_find_ibss: selected %pM current " 5680c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg "%pM\n", cbss->bssid, ifibss->bssid); 569469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 570469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 571469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Selected IBSS BSSID %pM" 572469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " based on configured SSID\n", 5730c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sdata->name, cbss->bssid); 574469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 575af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 576469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 577af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 578d419b9f0fa69e79ccba3e5e79a58a52ae0c2ed6aReinette Chatre } 579469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 580469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 581469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " did not try to join ibss\n"); 582469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 583469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 584469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 585ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault if (time_after(jiffies, ifibss->last_scan_completed + 586469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 587469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Trigger new scan to find an IBSS to " 58847846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg "join\n", sdata->name); 589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 590f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ieee80211_request_internal_scan(sdata, ifibss->ssid, 591f3b85252f081581a8f257545ed748062dce7798bJohannes Berg ifibss->ssid_len); 592ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault } else { 593469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 594469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 595469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 596469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) { 597af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!(local->oper_channel->flags & IEEE80211_CHAN_NO_IBSS)) { 598af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_create_ibss(sdata); 599af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 600af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 601469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: IBSS not allowed on" 60247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg " %d MHz\n", sdata->name, 603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.channel->center_freq); 604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 605469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* No IBSS found - decrease scan interval and continue 606469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * scanning. */ 607469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg interval = IEEE80211_SCAN_INTERVAL_SLOW; 608469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 609469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 610af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 611af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 613469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 614469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 616469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 617469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len) 618469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 619469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 620469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int tx_last_beacon; 622469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *resp; 624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 625469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 626469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 627af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg len < 24 + 2 || !ifibss->presp) 628469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 629469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6302448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg tx_last_beacon = drv_tx_last_beacon(local); 631469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 632469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 633469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: RX ProbeReq SA=%pM DA=%pM BSSID=%pM" 634469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " (tx_last_beacon=%d)\n", 63547846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->sa, mgmt->da, 636469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->bssid, tx_last_beacon); 637469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 638469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 639469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!tx_last_beacon) 640469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 641469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 642469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->bssid, ifibss->bssid, ETH_ALEN) != 0 && 643469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) != 0) 644469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 645469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 646469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 647469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 648469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 649469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 650469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 651469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Invalid SSID IE in ProbeReq " 652469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "from %pM\n", 65347846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->sa); 654469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 655469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 656469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 657469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 658469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 659af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg !memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 660469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 661469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 662469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 663469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 664469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 665af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = skb_copy(ifibss->presp, GFP_KERNEL); 666469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 667469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 668469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 669469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg resp = (struct ieee80211_mgmt *) skb->data; 670469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(resp->da, mgmt->sa, ETH_ALEN); 671469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 672469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Sending ProbeResp to %pM\n", 67347846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, resp->da); 674469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 67562ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; 67662ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg ieee80211_tx_skb(sdata, skb); 677469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 678469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 679469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata, 680469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 681469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 682469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 683469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 684469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 685469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 686469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 68747846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg if (memcmp(mgmt->da, sdata->vif.addr, ETH_ALEN)) 688469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; /* ignore ProbeResp to foreign address */ 689469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 690469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 691469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 692469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 693469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 694469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 695469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg &elems); 696469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 697469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false); 698469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 699469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 700469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata, 701469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 702469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 703469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 704469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 705469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 706469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 707469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 708469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Process beacon from the current BSS */ 709469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt; 710469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 711469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 712469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 713469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems); 714469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 715469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true); 716469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 717469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 718469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 719469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb) 720469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 721469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 722469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 723469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 724469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 725f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 726469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 727469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 728469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 729469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 730469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 731469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, mgmt, skb->len); 732469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 733469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 734469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len, 735469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 736469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 737469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 738469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, 739469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 740469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 741469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 742469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 743469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 744469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 745469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 746469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg kfree_skb(skb); 747469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 748469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 749469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_work(struct work_struct *work) 750469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 751469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 752469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg container_of(work, struct ieee80211_sub_if_data, u.ibss.work); 753469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 754469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss; 755469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 756469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7575bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (WARN_ON(local->suspended)) 7585bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 7595bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 7609607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg if (!ieee80211_sdata_running(sdata)) 761469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 762469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 763fbe9c429f195111bbf7f1630efa19aee295fd8e7Helmut Schaa if (local->scanning) 764469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 765469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 766469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_ADHOC)) 767469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 768469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss = &sdata->u.ibss; 769469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 770469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg while ((skb = skb_dequeue(&ifibss->skb_queue))) 771469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_rx_queued_mgmt(sdata, skb); 772469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 773469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!test_and_clear_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request)) 774469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 775469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 776469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 777469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 778469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 779469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 780469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 781469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 782469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 783469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 784469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 785469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 786469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 787469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 788469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 789469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 790469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 791469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 792469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 793469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 794469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 795469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7965bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (local->quiescing) { 7975bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 7985bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 7995bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 8005bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 801469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request); 80242935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez ieee80211_queue_work(&local->hw, &ifibss->work); 803469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 804469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 8055bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#ifdef CONFIG_PM 8065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_quiesce(struct ieee80211_sub_if_data *sdata) 8075bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 8085bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 8095bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 8105bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg cancel_work_sync(&ifibss->work); 8115bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (del_timer_sync(&ifibss->timer)) 8125bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 8135bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 8145bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 8155bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_restart(struct ieee80211_sub_if_data *sdata) 8165bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 8175bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 8185bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 8195bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (ifibss->timer_running) { 8205bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg add_timer(&ifibss->timer); 8215bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = false; 8225bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 8235bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 8245bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#endif 8255bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 826469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 827469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 828469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 829469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 830469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg INIT_WORK(&ifibss->work, ieee80211_ibss_work); 831469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 832469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 833469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_head_init(&ifibss->skb_queue); 834469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 835469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 836469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 837469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 838469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 839af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 840469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 84129b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_lock(&local->iflist_mtx); 84229b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg list_for_each_entry(sdata, &local->interfaces, list) { 8439607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg if (!ieee80211_sdata_running(sdata)) 8440e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 845af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 846af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 8470e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg if (!sdata->u.ibss.ssid_len) 8480e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 849af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 85051f98f1313d2fc4b1d3a3e1f4db7cf4925b29df6Johannes Berg mod_timer(&sdata->u.ibss.timer, 0); 851469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 85229b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_unlock(&local->iflist_mtx); 853469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 854469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 855469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergieee80211_rx_result 856f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Bergieee80211_ibss_rx_mgmt(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb) 857469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 858469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 859469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 860469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 861469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 862469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (skb->len < 24) 863469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 864469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 865469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 866469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 867469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 868469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 869469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 870469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 871469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 872469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 873469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_tail(&sdata->u.ibss.skb_queue, skb); 87442935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez ieee80211_queue_work(&local->hw, &sdata->u.ibss.work); 875469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_QUEUED; 876469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 877469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 878469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 879469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 880af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 881af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 882af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 883af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 884af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 885af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 886af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 887af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 888af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 889af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 890af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 891af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 892fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.privacy = params->privacy; 893fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg 89457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg sdata->vif.bss_conf.beacon_int = params->beacon_interval; 89557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 896af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.channel = params->channel; 897af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 898af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 899af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 900af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 901af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 902af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 903af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 904af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 905af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 906af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom + 907af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 36 /* bitrates */ + 908af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 34 /* SSID */ + 909af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 3 /* DS params */ + 910af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 4 /* IBSS params */ + 911af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg params->ie_len); 912af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!skb) 913af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return -ENOMEM; 914af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 915af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.skb = skb; 916af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 917af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 918af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 9190e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg memcpy(sdata->u.ibss.ssid, params->ssid, IEEE80211_MAX_SSID_LEN); 9200e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9210e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg /* 9220e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * The ssid_len setting below is used to see whether 9230e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * we are active, and we need all other settings 9240e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg * before that may get visible. 9250e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg */ 9260e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg mb(); 9270e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9280e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 9290e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 9305cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 9315cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 932af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 93342935ecaf4e784d0815afa9a7e5fe7e141157ca3Luis R. Rodriguez ieee80211_queue_work(&sdata->local->hw, &sdata->u.ibss.work); 934af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 935af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 936af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 937af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 938af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 939af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 940af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 941af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 942af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg del_timer_sync(&sdata->u.ibss.timer); 943af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg clear_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 944af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cancel_work_sync(&sdata->u.ibss.work); 945af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg clear_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 946af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 947af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 948af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 949af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 950af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 951af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = sdata->u.ibss.presp; 952af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(sdata->u.ibss.presp, NULL); 9532d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED); 954af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 955af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree_skb(skb); 956af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 957af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_queue_purge(&sdata->u.ibss.skb_queue); 958af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memset(sdata->u.ibss.bssid, 0, ETH_ALEN); 9595cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg sdata->u.ibss.ssid_len = 0; 9605cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 9615cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 962af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 963af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 964af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 965