ibss.c revision af8cdcd828ad751fae8e6cbfe94eef9f2f23b14b
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" 25469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "rate.h" 26469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 27469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL (2 * HZ) 28469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL_SLOW (15 * HZ) 29469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ) 30469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 31469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ) 324a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen#define IEEE80211_IBSS_MERGE_DELAY 0x400000 33469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ) 34469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 35469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MAX_STA_ENTRIES 128 36469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 37469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 38469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata, 39469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 40469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len) 41469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 42469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 auth_alg, auth_transaction, status_code; 43469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 44469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (len < 24 + 6) 45469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 46469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 47469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); 48469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); 49469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg status_code = le16_to_cpu(mgmt->u.auth.status_code); 50469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 51469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 52469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * IEEE 802.11 standard does not require authentication in IBSS 53469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * networks and most implementations do not seem to use it. 54469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * However, try to reply to authentication attempts if someone 55469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * has actually implemented this. 56469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 57469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (auth_alg == WLAN_AUTH_OPEN && auth_transaction == 1) 58469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, NULL, 0, 59469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.bssid, 0); 60469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 61469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 62af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 63af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const u8 *bssid, const int beacon_int, 64af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan, 65af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const size_t supp_rates_len, 66af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const u8 *supp_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; 71af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg int rates, i, j; 72469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 73469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 74469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 75469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 76469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 77469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->ops->reset_tsf) { 78469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reset own TSF to allow time synchronization work. */ 79469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->ops->reset_tsf(local_to_hw(local)); 80469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 81469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 82af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = ifibss->skb; 83af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(ifibss->presp, NULL); 84af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 85af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->data = skb->head; 86af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->len = 0; 87af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reset_tail_pointer(skb); 88af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reserve(skb, sdata->local->hw.extra_tx_headroom); 89469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 90af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (memcmp(ifibss->bssid, bssid, ETH_ALEN)) 91af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 92469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 93469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ifibss->bssid, bssid, ETH_ALEN); 94469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 95469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.beacon_int = beacon_int >= 10 ? beacon_int : 10; 96469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 97af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0; 98469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 99af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_if_config(sdata, IEEE80211_IFCC_BSSID); 100469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 101af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg local->oper_channel = chan; 102af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg local->oper_channel_type = NL80211_CHAN_NO_HT; 103af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL); 104af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sband = local->hw.wiphy->bands[chan->band]; 105469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 106469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Build IBSS probe response */ 107af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mgmt = (void *) skb_put(skb, 24 + sizeof(mgmt->u.beacon)); 108469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt, 0, 24 + sizeof(mgmt->u.beacon)); 109469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 110469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_STYPE_PROBE_RESP); 111469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt->da, 0xff, ETH_ALEN); 112469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->sa, sdata->dev->dev_addr, ETH_ALEN); 113469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN); 114af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mgmt->u.beacon.beacon_int = cpu_to_le16(local->hw.conf.beacon_int); 115707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith mgmt->u.beacon.timestamp = cpu_to_le64(tsf); 116469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->u.beacon.capab_info = cpu_to_le16(capability); 117469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 118469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + ifibss->ssid_len); 119469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SSID; 120469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = ifibss->ssid_len; 121469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, ifibss->ssid, ifibss->ssid_len); 122469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 123469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = supp_rates_len; 124469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rates > 8) 125469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = 8; 126469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 127469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SUPP_RATES; 128469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 129469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, supp_rates, rates); 130469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 131469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->band == IEEE80211_BAND_2GHZ) { 132469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 1); 133469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_DS_PARAMS; 134469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 1; 135af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg *pos++ = ieee80211_frequency_to_channel(chan->center_freq); 136469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 137469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 138469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 2); 139469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_IBSS_PARAMS; 140469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 2; 141469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* FIX: set ATIM window based on scan results */ 142469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 143469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 144469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 145469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (supp_rates_len > 8) { 146469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = supp_rates_len - 8; 147469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 148469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_EXT_SUPP_RATES; 149469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 150469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, &supp_rates[8], rates); 151469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 152469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 153af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->ie_len) 154af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(skb_put(skb, ifibss->ie_len), 155af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ifibss->ie, ifibss->ie_len); 156af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 157af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(ifibss->presp, skb); 158469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 159469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_if_config(sdata, IEEE80211_IFCC_BEACON | 160469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IFCC_BEACON_ENABLED); 161469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 162469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = 0; 163469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < supp_rates_len; i++) { 164469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int bitrate = (supp_rates[i] & 0x7f) * 5; 165469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (j = 0; j < sband->n_bitrates; j++) 166469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->bitrates[j].bitrate == bitrate) 167469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates |= BIT(j); 168469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 169469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 170469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_def_wmm_params(sdata, supp_rates_len, supp_rates); 171469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 172469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 173af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 174af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 175469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 176af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cfg80211_inform_bss_frame(local->hw.wiphy, local->hw.conf.channel, 177af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mgmt, skb->len, 0, GFP_KERNEL); 178af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cfg80211_ibss_joined(sdata->dev, ifibss->bssid, GFP_KERNEL); 179469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 180469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 181af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 182af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_bss *bss) 183469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 184af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg __ieee80211_sta_join_ibss(sdata, bss->cbss.bssid, 185af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.beacon_interval, 186af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.channel, 187af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->supp_rates_len, bss->supp_rates, 188af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.capability, 189af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss->cbss.tsf); 190469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 191469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 192469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 193469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 194469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 195469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 196469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems *elems, 197469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bool beacon) 198469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 199469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 200469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int freq; 201469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 202469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 203469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 204469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 205469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 206469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 207469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 208469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ds_params && elems->ds_params_len == 1) 209469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = ieee80211_channel_to_frequency(elems->ds_params[0]); 210469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 211469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = rx_status->freq; 212469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 213469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 214469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 215469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 216469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 217469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 218469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->vif.type == NL80211_IFTYPE_ADHOC && elems->supp_rates && 219469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) { 220469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg supp_rates = ieee80211_sta_get_rates(local, elems, band); 221469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 222469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 223469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 224469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_get(local, mgmt->sa); 225469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta) { 226469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 prev_rates; 227469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 228469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg prev_rates = sta->sta.supp_rates[band]; 229469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 230469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 231469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 232469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 233469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 234469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sta.supp_rates[band] != prev_rates) 235469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: updated supp_rates set " 236469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "for %pM based on beacon info (0x%llx | " 237469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "0x%llx -> 0x%llx)\n", 238469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, 239469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.addr, 240469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) prev_rates, 241469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) supp_rates, 242469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) sta->sta.supp_rates[band]); 243469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 244469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else 245469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 246469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 247469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 248469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 249469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 250469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 251469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel, beacon); 252469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 253469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 254469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 255469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* was just updated in ieee80211_bss_info_update */ 256469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg beacon_timestamp = bss->cbss.tsf; 257469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 258469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 259469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 260469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* merge only on beacons (???) */ 261469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!beacon) 262469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 263469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 264469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* we use a fixed BSSID */ 265af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.bssid) 266469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 267469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 268469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 269469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!(bss->cbss.capability & WLAN_CAPABILITY_IBSS)) 270469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 271469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 272469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 273469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (bss->cbss.channel != local->oper_channel) 274469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 275469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 276469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 277469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 278469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 279469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 280469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 281469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 28234e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 28334e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen if (memcmp(bss->cbss.bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) 28434e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 28534e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 286469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_TSFT) { 287469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 288469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * For correct IBSS merging we need mactime; since mactime is 289469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * defined as the time the first data symbol of the frame hits 290469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * the PHY, and the timestamp of the beacon is defined as "the 291469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * time that the data symbol containing the first bit of the 292469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * timestamp is transmitted to the PHY plus the transmitting 293469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * STA's delays through its local PHY from the MAC-PHY 294469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * interface to its interface with the WM" (802.11 11.1.2) 295469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * - equals the time this bit arrives at the receiver - we have 296469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * to take into account the offset between the two. 297469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 298469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * E.g. at 1 MBit that means mactime is 192 usec earlier 299469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * (=24 bytes * 8 usecs/byte) than the beacon timestamp. 300469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 301469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate; 302469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 303469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_HT) 304469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = 65; /* TODO: HT rates */ 305469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 306469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = local->hw.wiphy->bands[band]-> 307469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bitrates[rx_status->rate_idx].bitrate; 308469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 309469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = rx_status->mactime + (24 * 8 * 10 / rate); 310469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (local && local->ops && local->ops->get_tsf) 311469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* second best option: get current TSF */ 312469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = local->ops->get_tsf(local_to_hw(local)); 313469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 314469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* can't merge without knowing the TSF */ 315469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = -1LLU; 316469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 317469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 318469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "RX beacon SA=%pM BSSID=" 319469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 320469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->sa, mgmt->bssid, 321469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)rx_timestamp, 322469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)beacon_timestamp, 323469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 324469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies); 325469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 326469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3274a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen /* give slow hardware some time to do the TSF sync */ 3284a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen if (rx_timestamp < IEEE80211_IBSS_MERGE_DELAY) 3294a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen goto put_bss; 3304a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen 331469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 332469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 333469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: beacon TSF higher than " 334469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "local TSF - IBSS merge with BSSID %pM\n", 335469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->bssid); 336469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 337469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 338469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 339469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 340469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 341469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 342469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 343469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 344469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 345469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* 346469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Add a new IBSS station, will also be called by the RX code when, 347469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * in IBSS mode, receiving a frame from a yet-unknown station, hence 348469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * must be callable in atomic context. 349469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 350469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstruct sta_info *ieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, 351469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *bssid,u8 *addr, u32 supp_rates) 352469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 353469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 354469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 355469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int band = local->hw.conf.channel->band; 356469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 357af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 358af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 359af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 360af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 361469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 362af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (net_ratelimit()) 363af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA entry %pM\n", 364af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->dev->name, addr); 365469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 366469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 367469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 368469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) 369469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 370469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 371469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 372469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Adding new IBSS station %pM (dev=%s)\n", 373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg wiphy_name(local->hw.wiphy), addr, sdata->dev->name); 374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 375469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 377469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 379469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 380469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_sta_flags(sta, WLAN_STA_AUTHORIZED); 381469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 382469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 383469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate_control_rate_init(sta); 387469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 388469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta_info_insert(sta)) 389469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 390469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 391469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return sta; 392469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 393469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 394469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 395469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 396469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 397469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active = 0; 398469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 399469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 400469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 401469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 402469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 403469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sdata == sdata && 404469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies)) { 406469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active++; 407469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 408469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 409469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 410469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 411469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 412469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 413469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return active; 414469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 415469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 416469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 417469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 418469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 419469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 420469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 421af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 422af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 423469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 424469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT); 425af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 426469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 427469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 429af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 430469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 431469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 432469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: No active IBSS STAs - trying to scan for other " 433469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "IBSS networks with same SSID (merge)\n", sdata->dev->name); 434469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 435469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* XXX maybe racy? */ 436469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->local->scan_req) 437469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 438469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 439469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(sdata->local->int_scan_req.ssids[0].ssid, 440469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid, IEEE80211_MAX_SSID_LEN); 441469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->local->int_scan_req.ssids[0].ssid_len = ifibss->ssid_len; 442469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_request_scan(sdata, &sdata->local->int_scan_req); 443469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 444469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 445af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 446469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 447469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 448469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 449469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 450469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 451469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 452469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 supp_rates[IEEE80211_MAX_SUPP_RATES]; 453469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 454469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 455469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 456af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 457469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 458469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 459469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 460469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 461469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 462469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 463469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 464469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[i] ^= sdata->dev->dev_addr[i]; 465469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 466469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 467469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 468469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 469469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Creating new IBSS network, BSSID %pM\n", 470469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, bssid); 471469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 472af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sband = local->hw.wiphy->bands[ifibss->channel->band]; 473469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 474469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->hw.conf.beacon_int == 0) 475469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.beacon_int = 100; 476469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 477469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->default_key) 480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 481469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 482469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 483469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 484469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = supp_rates; 485469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < sband->n_bitrates; i++) { 486469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate = sband->bitrates[i].bitrate; 487469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = (u8) (rate / 5); 488469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 490af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg __ieee80211_sta_join_ibss(sdata, bssid, local->hw.conf.beacon_int, 491af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ifibss->channel, sband->n_bitrates, 492af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg supp_rates, capability, 0); 493469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 494469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 495af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 496469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 499469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 500af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 501469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 502469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 503469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 504469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: sta_find_ibss (active_ibss=%d)\n", 507469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, active_ibss); 508469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 509469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 510469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 511af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 512469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 513af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 514af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 515af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 516af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg chan = ifibss->channel; 517af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 518469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 519af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bss = (void *)cfg80211_get_bss(local->hw.wiphy, chan, bssid, 520469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid, ifibss->ssid_len, 521469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WLAN_CAPABILITY_IBSS, 522469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WLAN_CAPABILITY_IBSS); 523469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 524469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 525469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (bss) 526469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " sta_find_ibss: selected %pM current " 527469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM\n", bss->cbss.bssid, ifibss->bssid); 528469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 529469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 530af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (bss && memcmp(ifibss->bssid, bss->cbss.bssid, ETH_ALEN)) { 531469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Selected IBSS BSSID %pM" 532469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " based on configured SSID\n", 533469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, bss->cbss.bssid); 534469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 535af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 536469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 537af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 538469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (bss) 539469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 540469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 541469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 542469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " did not try to join ibss\n"); 543469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 544469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 545469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 546469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_JOINED && 547469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg !ieee80211_sta_active_ibss(sdata)) { 548af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 549af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 550af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else if (time_after(jiffies, ifibss->last_scan_completed + 551469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 552469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Trigger new scan to find an IBSS to " 553469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "join\n", sdata->dev->name); 554469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 555469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* XXX maybe racy? */ 556469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->scan_req) 557af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 558469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 559469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(local->int_scan_req.ssids[0].ssid, 560469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid, IEEE80211_MAX_SSID_LEN); 561af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg local->int_scan_req.ssids[0].ssid_len = 562af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ifibss->ssid_len; 563af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_request_scan(sdata, &local->int_scan_req); 564469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (ifibss->state != IEEE80211_IBSS_MLME_JOINED) { 565469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 566469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 567469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 568469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) { 569af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!(local->oper_channel->flags & IEEE80211_CHAN_NO_IBSS)) { 570af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_create_ibss(sdata); 571af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 572af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 573469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: IBSS not allowed on" 574469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " %d MHz\n", sdata->dev->name, 575469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.channel->center_freq); 576469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 577469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* No IBSS found - decrease scan interval and continue 578469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * scanning. */ 579469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg interval = IEEE80211_SCAN_INTERVAL_SLOW; 580469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 581469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 582469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_SEARCH; 583af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 584af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 585469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 586469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 587469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 588469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 590469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len) 591469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 592469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 593469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 594469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int tx_last_beacon; 595469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 596469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *resp; 597469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 598469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 599469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 600af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg len < 24 + 2 || !ifibss->presp) 601469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 602469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->ops->tx_last_beacon) 604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg tx_last_beacon = local->ops->tx_last_beacon(local_to_hw(local)); 605469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 606469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg tx_last_beacon = 1; 607469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 608469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 609469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: RX ProbeReq SA=%pM DA=%pM BSSID=%pM" 610469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " (tx_last_beacon=%d)\n", 611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->sa, mgmt->da, 612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->bssid, tx_last_beacon); 613469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 614469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!tx_last_beacon) 616469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 617469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 618469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->bssid, ifibss->bssid, ETH_ALEN) != 0 && 619469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) != 0) 620469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 622469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 625469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 626469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 627469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Invalid SSID IE in ProbeReq " 628469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "from %pM\n", 629469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->sa); 630469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 631469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 632469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 633469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 634469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 635af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg !memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 636469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 637469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 638469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 639469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 640469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 641af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = skb_copy(ifibss->presp, GFP_KERNEL); 642469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 643469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 644469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 645469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg resp = (struct ieee80211_mgmt *) skb->data; 646469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(resp->da, mgmt->sa, ETH_ALEN); 647469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 648469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Sending ProbeResp to %pM\n", 649469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, resp->da); 650469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 651469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_tx_skb(sdata, skb, 0); 652469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 653469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 654469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata, 655469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 656469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 657469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 658469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 659469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 660469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 661469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 662469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->da, sdata->dev->dev_addr, ETH_ALEN)) 663469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; /* ignore ProbeResp to foreign address */ 664469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 665469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 666469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 667469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 668469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 669469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 670469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg &elems); 671469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 672469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false); 673469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 674469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 675469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata, 676469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 677469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 678469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 679469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 680469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 681469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 682469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 683469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Process beacon from the current BSS */ 684469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt; 685469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 686469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 687469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 688469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems); 689469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 690469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true); 691469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 692469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 693469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 694469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb) 695469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 696469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 697469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 698469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 699469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 700469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status = (struct ieee80211_rx_status *) skb->cb; 701469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 702469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 703469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 704469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 705469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 706469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, mgmt, skb->len); 707469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 708469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 709469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len, 710469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 711469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 712469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 713469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, 714469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 715469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 716469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 717469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 718469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 719469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 720469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 721469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg kfree_skb(skb); 722469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 723469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 724469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_work(struct work_struct *work) 725469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 726469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 727469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg container_of(work, struct ieee80211_sub_if_data, u.ibss.work); 728469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 729469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss; 730469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 731469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 732469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!netif_running(sdata->dev)) 733469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 734469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 735469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->sw_scanning || local->hw_scanning) 736469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 737469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 738469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_ADHOC)) 739469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 740469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss = &sdata->u.ibss; 741469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 742469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg while ((skb = skb_dequeue(&ifibss->skb_queue))) 743469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_rx_queued_mgmt(sdata, skb); 744469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 745469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!test_and_clear_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request)) 746469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 747469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 748469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 749469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 750469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 751469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 752469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 753469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 754469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 755469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 756469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 757469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 758469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 759469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 760469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 761469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 762469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 763469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 764469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 765469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 766469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 767469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 768469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request); 769469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg queue_work(local->hw.workqueue, &ifibss->work); 770469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 771469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 772469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 773469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 774469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 775469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 776469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg INIT_WORK(&ifibss->work, ieee80211_ibss_work); 777469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 778469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 779469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_head_init(&ifibss->skb_queue); 780469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 781469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 782469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 783469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 784469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 785af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 786469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 787af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_read_lock(); 788af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg list_for_each_entry_rcu(sdata, &local->interfaces, list) { 789af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 790af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 791af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 792af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_find_ibss(sdata); 793469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 794af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_read_unlock(); 795469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 796469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 797469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergieee80211_rx_result 798469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergieee80211_ibss_rx_mgmt(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb, 799469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 800469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 801469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 802469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 803469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 804469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 805469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (skb->len < 24) 806469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 807469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 808469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 809469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 810469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 811469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 812469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 813469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 814469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(skb->cb, rx_status, sizeof(*rx_status)); 815469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 816469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 817469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_tail(&sdata->u.ibss.skb_queue, skb); 818469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg queue_work(local->hw.workqueue, &sdata->u.ibss.work); 819469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_QUEUED; 820469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 821469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 822469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 823469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 824af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 825af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 826af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 827af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 828af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 829af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 830af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.ssid, params->ssid, IEEE80211_MAX_SSID_LEN); 831af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 832af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 833af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 834af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 835af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 836af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 837af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 838af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 839af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.channel = params->channel; 840af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 841af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 842af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 843af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 844af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 845af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 846af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 847af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 848af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 849af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom + 850af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 36 /* bitrates */ + 851af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 34 /* SSID */ + 852af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 3 /* DS params */ + 853af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 4 /* IBSS params */ + 854af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg params->ie_len); 855af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!skb) 856af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return -ENOMEM; 857af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 858af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.skb = skb; 859af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 860af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 861af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 862af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 863af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg queue_work(sdata->local->hw.workqueue, &sdata->u.ibss.work); 864af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 865af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 866af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 867af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 868af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 869af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 870af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 871af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 872af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg del_timer_sync(&sdata->u.ibss.timer); 873af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg clear_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 874af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cancel_work_sync(&sdata->u.ibss.work); 875af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg clear_bit(IEEE80211_IBSS_REQ_RUN, &sdata->u.ibss.request); 876af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 877af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 878af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 879af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 880af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 881af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = sdata->u.ibss.presp; 882af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg rcu_assign_pointer(sdata->u.ibss.presp, NULL); 883af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_if_config(sdata, IEEE80211_IFCC_BEACON_ENABLED); 884af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 885af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree_skb(skb); 886af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 887af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_queue_purge(&sdata->u.ibss.skb_queue); 888af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memset(sdata->u.ibss.bssid, 0, ETH_ALEN); 889af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 890af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 891af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 892