ibss.c revision 6d810f10325522cfcf498dc6d64b9f96e1f5153f
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> 165a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 17469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/if_ether.h> 18469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/skbuff.h> 19469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/if_arp.h> 20469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/etherdevice.h> 21469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/rtnetlink.h> 22469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <net/mac80211.h> 23469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <asm/unaligned.h> 24469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 25469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "ieee80211_i.h" 262448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg#include "driver-ops.h" 27469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "rate.h" 28469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 29469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL (2 * HZ) 30469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL_SLOW (15 * HZ) 31469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ) 32469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 33469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ) 34469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ) 35469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 36469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MAX_STA_ENTRIES 128 37469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 38469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 39af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 40af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const u8 *bssid, const int beacon_int, 41af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan, 42b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg const u32 basic_rates, 43af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const u16 capability, u64 tsf) 44469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 45469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 46469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 47b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rates, i; 48469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 49469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 50469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 51469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 52f446d10f214091408b7300f15c9adf60569edf28Johannes Berg struct cfg80211_bss *bss; 5357c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg u32 bss_change; 54b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u8 supp_rates[IEEE80211_MAX_SUPP_RATES]; 5513c40c54682ffe62977f670681268a26d500d6faAlexander Simon enum nl80211_channel_type channel_type; 562448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg 577a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 587a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 592448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* Reset own TSF to allow time synchronization work. */ 6037a41b4affa33bb237d3692bf51f1b5ebcaf29d8Eliad Peller drv_reset_tsf(local, sdata); 61469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 62af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = ifibss->skb; 63a9b3cd7f323b2e57593e7215362a7b02fc933e3aStephen Hemminger RCU_INIT_POINTER(ifibss->presp, NULL); 64af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 65af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->data = skb->head; 66af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->len = 0; 67af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reset_tail_pointer(skb); 68af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reserve(skb, sdata->local->hw.extra_tx_headroom); 69469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 70af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (memcmp(ifibss->bssid, bssid, ETH_ALEN)) 71af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 72469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7349b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg /* if merging, indicate to driver that we leave the old IBSS */ 7449b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg if (sdata->vif.bss_conf.ibss_joined) { 7549b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg sdata->vif.bss_conf.ibss_joined = false; 7686a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_off(sdata->dev); 7749b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_IBSS); 7849b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg } 7949b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg 80469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ifibss->bssid, bssid, ETH_ALEN); 81469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 82af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0; 83469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 8413c40c54682ffe62977f670681268a26d500d6faAlexander Simon channel_type = ifibss->channel_type; 8513c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (channel_type > NL80211_CHAN_HT20 && 8613c40c54682ffe62977f670681268a26d500d6faAlexander Simon !cfg80211_can_beacon_sec_chan(local->hw.wiphy, chan, channel_type)) 8713c40c54682ffe62977f670681268a26d500d6faAlexander Simon channel_type = NL80211_CHAN_HT20; 8813c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (!ieee80211_set_channel_type(local, sdata, channel_type)) { 8913c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* can only fail due to HT40+/- mismatch */ 9013c40c54682ffe62977f670681268a26d500d6faAlexander Simon channel_type = NL80211_CHAN_HT20; 9113c40c54682ffe62977f670681268a26d500d6faAlexander Simon WARN_ON(!ieee80211_set_channel_type(local, sdata, 9213c40c54682ffe62977f670681268a26d500d6faAlexander Simon NL80211_CHAN_HT20)); 9313c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 94af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_CHANNEL); 9557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 96af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sband = local->hw.wiphy->bands[chan->band]; 97469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 98b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg /* build supported rates array */ 99b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg pos = supp_rates; 100b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < sband->n_bitrates; i++) { 101b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rate = sband->bitrates[i].bitrate; 102b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u8 basic = 0; 103b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (basic_rates & BIT(i)) 104b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic = 0x80; 105b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg *pos++ = basic | (u8) (rate / 5); 106b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 107b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 108469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Build IBSS probe response */ 109af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mgmt = (void *) skb_put(skb, 24 + sizeof(mgmt->u.beacon)); 110469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt, 0, 24 + sizeof(mgmt->u.beacon)); 111469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 112469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_STYPE_PROBE_RESP); 113469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt->da, 0xff, ETH_ALEN); 11447846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN); 115469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN); 11657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int); 117707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith mgmt->u.beacon.timestamp = cpu_to_le64(tsf); 118469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->u.beacon.capab_info = cpu_to_le16(capability); 119469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 120469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + ifibss->ssid_len); 121469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SSID; 122469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = ifibss->ssid_len; 123469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, ifibss->ssid, ifibss->ssid_len); 124469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 125b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg rates = sband->n_bitrates; 126469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rates > 8) 127469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = 8; 128469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 129469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SUPP_RATES; 130469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 131469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, supp_rates, rates); 132469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 133469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->band == IEEE80211_BAND_2GHZ) { 134469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 1); 135469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_DS_PARAMS; 136469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 1; 137af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg *pos++ = ieee80211_frequency_to_channel(chan->center_freq); 138469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 139469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 140469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 2); 141469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_IBSS_PARAMS; 142469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 2; 143469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* FIX: set ATIM window based on scan results */ 144469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 145469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 146469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 147b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (sband->n_bitrates > 8) { 148b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg rates = sband->n_bitrates - 8; 149469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 150469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_EXT_SUPP_RATES; 151469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 152469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, &supp_rates[8], rates); 153469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 154469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 155af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->ie_len) 156af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(skb_put(skb, ifibss->ie_len), 157af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ifibss->ie, ifibss->ie_len); 158af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 15913c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* add HT capability and information IEs */ 16013c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (channel_type && sband->ht_cap.ht_supported) { 16113c40c54682ffe62977f670681268a26d500d6faAlexander Simon pos = skb_put(skb, 4 + 16213c40c54682ffe62977f670681268a26d500d6faAlexander Simon sizeof(struct ieee80211_ht_cap) + 16313c40c54682ffe62977f670681268a26d500d6faAlexander Simon sizeof(struct ieee80211_ht_info)); 16413c40c54682ffe62977f670681268a26d500d6faAlexander Simon pos = ieee80211_ie_build_ht_cap(pos, &sband->ht_cap, 16513c40c54682ffe62977f670681268a26d500d6faAlexander Simon sband->ht_cap.cap); 16613c40c54682ffe62977f670681268a26d500d6faAlexander Simon pos = ieee80211_ie_build_ht_info(pos, 16713c40c54682ffe62977f670681268a26d500d6faAlexander Simon &sband->ht_cap, 16813c40c54682ffe62977f670681268a26d500d6faAlexander Simon chan, 16913c40c54682ffe62977f670681268a26d500d6faAlexander Simon channel_type); 17013c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 17113c40c54682ffe62977f670681268a26d500d6faAlexander Simon 1729eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (local->hw.queues >= 4) { 1739eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf pos = skb_put(skb, 9); 1749eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = WLAN_EID_VENDOR_SPECIFIC; 1759eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 7; /* len */ 1769eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0x00; /* Microsoft OUI 00:50:F2 */ 1779eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0x50; 1789eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0xf2; 1799eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 2; /* WME */ 1809eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0; /* WME info */ 1819eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 1; /* WME ver */ 1829eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0; /* U-APSD no in use */ 1839eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf } 1849eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 185cf778b00e96df6d64f8e21b8395d1f8a859ecdc7Eric Dumazet rcu_assign_pointer(ifibss->presp, skb); 186469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1872d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg sdata->vif.bss_conf.beacon_int = beacon_int; 188fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->vif.bss_conf.basic_rates = basic_rates; 1892d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change = BSS_CHANGED_BEACON_INT; 1902d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= ieee80211_reset_erp_info(sdata); 1912d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BSSID; 1922d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON; 1932d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON_ENABLED; 194392cfdb10dab6c7dfa5fed18d8a44d7453d42196Teemu Paasikivi bss_change |= BSS_CHANGED_BASIC_RATES; 19513c40c54682ffe62977f670681268a26d500d6faAlexander Simon bss_change |= BSS_CHANGED_HT; 1968fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg bss_change |= BSS_CHANGED_IBSS; 1978fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg sdata->vif.bss_conf.ibss_joined = true; 1982d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, bss_change); 199469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 200b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg ieee80211_sta_def_wmm_params(sdata, sband->n_bitrates, supp_rates); 201469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 202469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 203af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 204af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 205469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 206f446d10f214091408b7300f15c9adf60569edf28Johannes Berg bss = cfg80211_inform_bss_frame(local->hw.wiphy, local->hw.conf.channel, 207f446d10f214091408b7300f15c9adf60569edf28Johannes Berg mgmt, skb->len, 0, GFP_KERNEL); 208f446d10f214091408b7300f15c9adf60569edf28Johannes Berg cfg80211_put_bss(bss); 20986a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_on(sdata->dev); 210af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cfg80211_ibss_joined(sdata->dev, ifibss->bssid, GFP_KERNEL); 211469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 212469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 213af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 214af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_bss *bss) 215469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 2160c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss = 2170c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg container_of((void *)bss, struct cfg80211_bss, priv); 218b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg struct ieee80211_supported_band *sband; 219b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u32 basic_rates; 220b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int i, j; 2210c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg u16 beacon_int = cbss->beacon_interval; 22257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 2237a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&sdata->u.ibss.mtx); 2247a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 22557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg if (beacon_int < 10) 22657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int = 10; 22757c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 2280c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sband = sdata->local->hw.wiphy->bands[cbss->channel->band]; 229b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 230b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates = 0; 231b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 232b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < bss->supp_rates_len; i++) { 233b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rate = (bss->supp_rates[i] & 0x7f) * 5; 234b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg bool is_basic = !!(bss->supp_rates[i] & 0x80); 235b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 236b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (j = 0; j < sband->n_bitrates; j++) { 237b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (sband->bitrates[j].bitrate == rate) { 238b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (is_basic) 239b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates |= BIT(j); 240b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg break; 241b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 242b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 243b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 244b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 2450c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg __ieee80211_sta_join_ibss(sdata, cbss->bssid, 24657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int, 2470c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->channel, 248b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates, 2490c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->capability, 2500c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->tsf); 251469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 252469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 2536d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartullistatic struct sta_info *ieee80211_ibss_finish_sta(struct sta_info *sta, 2546d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli bool auth) 2558bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 2568bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 2578bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 2588bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u8 addr[ETH_ALEN]; 2598bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2608bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg memcpy(addr, sta->sta.addr, ETH_ALEN); 2618bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2628bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 2638bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg wiphy_debug(sdata->local->hw.wiphy, 2648bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg "Adding new IBSS station %pM (dev=%s)\n", 2658bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg addr, sdata->name); 2668bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg#endif 2678bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2688bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta_info_move_state(sta, IEEE80211_STA_AUTH); 2698bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta_info_move_state(sta, IEEE80211_STA_ASSOC); 2708bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta_info_move_state(sta, IEEE80211_STA_AUTHORIZED); 2718bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2728bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rate_control_rate_init(sta); 2738bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2748bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* If it fails, maybe we raced another insertion? */ 2758bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (sta_info_insert_rcu(sta)) 2768bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta_info_get(sdata, addr); 2776d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (auth) { 27824dd0dd74ec8dc4abada132e380dc179459b0f77Antonio Quartulli#ifdef CONFIG_MAC80211_IBSS_DEBUG 2796d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli printk(KERN_DEBUG "TX Auth SA=%pM DA=%pM BSSID=%pM" 2806d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli "(auth_transaction=1)\n", sdata->vif.addr, 2816d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli sdata->u.ibss.bssid, addr); 28224dd0dd74ec8dc4abada132e380dc179459b0f77Antonio Quartulli#endif 2836d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli ieee80211_send_auth(sdata, 1, WLAN_AUTH_OPEN, NULL, 0, 2846d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli addr, sdata->u.ibss.bssid, NULL, 0, 0); 2856d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli } 2868bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta; 2878bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 2888bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2898bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergstatic struct sta_info * 2908bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, 2918bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg const u8 *bssid, const u8 *addr, 2926d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli u32 supp_rates, bool auth) 2938bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 2948bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 2958bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 2968bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_local *local = sdata->local; 2978bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 2988bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg int band = local->hw.conf.channel->band; 2998bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3008bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* 3018bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * XXX: Consider removing the least recently used entry and 3028bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * allow new one to be added. 3038bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg */ 3048bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 3058bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (net_ratelimit()) 3068bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA entry %pM\n", 3078bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sdata->name, addr); 3088bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 3098bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 3108bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 3118bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3128bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) { 3138bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 3148bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 3158bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 3168bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3178bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) { 3188bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 3198bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 3208bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 3218bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3228bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_KERNEL); 3238bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (!sta) { 3248bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 3258bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 3268bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 3278bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3288bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->last_rx = jiffies; 3298bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3308bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* make sure mandatory rates are always added */ 3318bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->sta.supp_rates[band] = supp_rates | 3328bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg ieee80211_mandatory_rates(local, band); 3338bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3346d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return ieee80211_ibss_finish_sta(sta, auth); 3356d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli} 3366d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3376d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartullistatic void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata, 3386d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli struct ieee80211_mgmt *mgmt, 3396d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli size_t len) 3406d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli{ 3416d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli u16 auth_alg, auth_transaction; 3426d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3436d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli lockdep_assert_held(&sdata->u.ibss.mtx); 3446d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3456d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (len < 24 + 6) 3466d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return; 3476d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3486d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); 3496d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); 3506d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3516d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1) 3526d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return; 3536d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli#ifdef CONFIG_MAC80211_IBSS_DEBUG 3546d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli printk(KERN_DEBUG "%s: RX Auth SA=%pM DA=%pM BSSID=%pM." 3556d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli "(auth_transaction=%d)\n", 3566d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli sdata->name, mgmt->sa, mgmt->da, mgmt->bssid, auth_transaction); 3576d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli#endif 3586d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli sta_info_destroy_addr(sdata, mgmt->sa); 3596d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 0, false); 3606d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli rcu_read_unlock(); 3616d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3626d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli /* 3636d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * IEEE 802.11 standard does not require authentication in IBSS 3646d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * networks and most implementations do not seem to use it. 3656d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * However, try to reply to authentication attempts if someone 3666d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * has actually implemented this. 3676d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli */ 3686d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, NULL, 0, 3696d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli mgmt->sa, sdata->u.ibss.bssid, NULL, 0, 0); 3708bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 3718bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 372469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 375469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems *elems, 377469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bool beacon) 378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 379469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 380469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int freq; 3810c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 382469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 383469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 387469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 38813c40c54682ffe62977f670681268a26d500d6faAlexander Simon struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band]; 38913c40c54682ffe62977f670681268a26d500d6faAlexander Simon bool rates_updated = false; 390469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 391469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ds_params && elems->ds_params_len == 1) 39259eb21a6504731fc16db4cf9463065dd61093e08Bruno Randolf freq = ieee80211_channel_to_frequency(elems->ds_params[0], 39359eb21a6504731fc16db4cf9463065dd61093e08Bruno Randolf band); 394469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 395469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = rx_status->freq; 396469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 397469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 398469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 399469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 400469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 401469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4029eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sdata->vif.type == NL80211_IFTYPE_ADHOC && 403469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) { 404469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 406abe60632f311d515b082b450504ee24006023951Johannes Berg sta = sta_info_get(sdata, mgmt->sa); 407469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4089eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (elems->supp_rates) { 4099eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf supp_rates = ieee80211_sta_get_rates(local, elems, 4109eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf band); 4119eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta) { 4129eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf u32 prev_rates; 4139eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 4149eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf prev_rates = sta->sta.supp_rates[band]; 4159eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf /* make sure mandatory rates are always added */ 4169eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta->sta.supp_rates[band] = supp_rates | 4179eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf ieee80211_mandatory_rates(local, band); 418469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4199eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta->sta.supp_rates[band] != prev_rates) { 420469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 4219eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf printk(KERN_DEBUG 4229eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf "%s: updated supp_rates set " 4239eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf "for %pM based on beacon" 4249eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf "/probe_resp (0x%x -> 0x%x)\n", 4259eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sdata->name, sta->sta.addr, 4269eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf prev_rates, 4279eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta->sta.supp_rates[band]); 428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 42913c40c54682ffe62977f670681268a26d500d6faAlexander Simon rates_updated = true; 4309eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf } 4318bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } else { 4328bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 4339eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid, 4346d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli mgmt->sa, supp_rates, true); 4358bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 43634e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg } 4379eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 4389eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta && elems->wmm_info) 439c2c98fdeb5c897499644eb247285c8e3dacc6450Johannes Berg set_sta_flag(sta, WLAN_STA_WME); 4409eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 44113c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (sta && elems->ht_info_elem && elems->ht_cap_elem && 44213c40c54682ffe62977f670681268a26d500d6faAlexander Simon sdata->u.ibss.channel_type != NL80211_CHAN_NO_HT) { 44313c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* we both use HT */ 44413c40c54682ffe62977f670681268a26d500d6faAlexander Simon struct ieee80211_sta_ht_cap sta_ht_cap_new; 44513c40c54682ffe62977f670681268a26d500d6faAlexander Simon enum nl80211_channel_type channel_type = 44613c40c54682ffe62977f670681268a26d500d6faAlexander Simon ieee80211_ht_info_to_channel_type( 44713c40c54682ffe62977f670681268a26d500d6faAlexander Simon elems->ht_info_elem); 44813c40c54682ffe62977f670681268a26d500d6faAlexander Simon 44913c40c54682ffe62977f670681268a26d500d6faAlexander Simon ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband, 45013c40c54682ffe62977f670681268a26d500d6faAlexander Simon elems->ht_cap_elem, 45113c40c54682ffe62977f670681268a26d500d6faAlexander Simon &sta_ht_cap_new); 45213c40c54682ffe62977f670681268a26d500d6faAlexander Simon 45313c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* 45413c40c54682ffe62977f670681268a26d500d6faAlexander Simon * fall back to HT20 if we don't use or use 45513c40c54682ffe62977f670681268a26d500d6faAlexander Simon * the other extension channel 45613c40c54682ffe62977f670681268a26d500d6faAlexander Simon */ 45713c40c54682ffe62977f670681268a26d500d6faAlexander Simon if ((channel_type == NL80211_CHAN_HT40MINUS || 45813c40c54682ffe62977f670681268a26d500d6faAlexander Simon channel_type == NL80211_CHAN_HT40PLUS) && 45913c40c54682ffe62977f670681268a26d500d6faAlexander Simon channel_type != sdata->u.ibss.channel_type) 46013c40c54682ffe62977f670681268a26d500d6faAlexander Simon sta_ht_cap_new.cap &= 46113c40c54682ffe62977f670681268a26d500d6faAlexander Simon ~IEEE80211_HT_CAP_SUP_WIDTH_20_40; 46213c40c54682ffe62977f670681268a26d500d6faAlexander Simon 46313c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (memcmp(&sta->sta.ht_cap, &sta_ht_cap_new, 46413c40c54682ffe62977f670681268a26d500d6faAlexander Simon sizeof(sta_ht_cap_new))) { 46513c40c54682ffe62977f670681268a26d500d6faAlexander Simon memcpy(&sta->sta.ht_cap, &sta_ht_cap_new, 46613c40c54682ffe62977f670681268a26d500d6faAlexander Simon sizeof(sta_ht_cap_new)); 46713c40c54682ffe62977f670681268a26d500d6faAlexander Simon rates_updated = true; 46813c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 46913c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 47013c40c54682ffe62977f670681268a26d500d6faAlexander Simon 47113c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (sta && rates_updated) 47213c40c54682ffe62977f670681268a26d500d6faAlexander Simon rate_control_rate_init(sta); 47313c40c54682ffe62977f670681268a26d500d6faAlexander Simon 4749eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf rcu_read_unlock(); 475469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 476469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 477469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel, beacon); 479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 481469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4820c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = container_of((void *)bss, struct cfg80211_bss, priv); 4830c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 484469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* was just updated in ieee80211_bss_info_update */ 4850c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg beacon_timestamp = cbss->tsf; 486469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 487469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 488469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* we use a fixed BSSID */ 490a98bfec2985221d8e0904a526cbe88590eaad2a6Benoit Papillault if (sdata->u.ibss.fixed_bssid) 491469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 492469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 493469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 4940c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (!(cbss->capability & WLAN_CAPABILITY_IBSS)) 495469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 496469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 4980c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss->channel != local->oper_channel) 499469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 500469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 501469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 502469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 503469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 504469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 50734e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 5080c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (memcmp(cbss->bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) 50934e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 51034e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 5116ebacbb79d2d05978ba50a24d8cbe2a76ff2014cJohannes Berg if (rx_status->flag & RX_FLAG_MACTIME_MPDU) { 512469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 513469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * For correct IBSS merging we need mactime; since mactime is 514469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * defined as the time the first data symbol of the frame hits 515469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * the PHY, and the timestamp of the beacon is defined as "the 516469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * time that the data symbol containing the first bit of the 517469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * timestamp is transmitted to the PHY plus the transmitting 518469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * STA's delays through its local PHY from the MAC-PHY 519469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * interface to its interface with the WM" (802.11 11.1.2) 520469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * - equals the time this bit arrives at the receiver - we have 521469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * to take into account the offset between the two. 522469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 523469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * E.g. at 1 MBit that means mactime is 192 usec earlier 524469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * (=24 bytes * 8 usecs/byte) than the beacon timestamp. 525469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 526469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate; 527469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 528469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_HT) 529469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = 65; /* TODO: HT rates */ 530469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 531469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = local->hw.wiphy->bands[band]-> 532469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bitrates[rx_status->rate_idx].bitrate; 533469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 534469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = rx_status->mactime + (24 * 8 * 10 / rate); 5352448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } else { 5362448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* 5372448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * second best option: get current TSF 5382448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * (will return -1 if not supported) 5392448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg */ 54037a41b4affa33bb237d3692bf51f1b5ebcaf29d8Eliad Peller rx_timestamp = drv_get_tsf(local, sdata); 5412448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } 542469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 543469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 544469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "RX beacon SA=%pM BSSID=" 545469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 546469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->sa, mgmt->bssid, 547469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)rx_timestamp, 548469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)beacon_timestamp, 549469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 550469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies); 551469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 552469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 553469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 554469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 555469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: beacon TSF higher than " 556469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "local TSF - IBSS merge with BSSID %pM\n", 55747846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->bssid); 558469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 559469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 56009a08cff3d13315c948e6aee5cf912f8f1db54e7Bruno Randolf supp_rates = ieee80211_sta_get_rates(local, elems, band); 56134e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 5626d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli supp_rates, true); 5638bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 564469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 565469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 566469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 567469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 568469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 569469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 5708bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergvoid ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data *sdata, 5718bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg const u8 *bssid, const u8 *addr, 5728bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u32 supp_rates) 573469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 5742e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 575469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 576469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 577469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int band = local->hw.conf.channel->band; 578469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 579af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 580af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 581af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 582af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 583469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 584af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (net_ratelimit()) 585af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA entry %pM\n", 58647846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, addr); 5878bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 588469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 5902e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) 5918bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 5922e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau 593469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) 5948bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 595469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 5968bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 597469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 5988bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 599469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 600c8716d9dc13c7f6ee92f2bfc6cc3b723b417bff8Rajkumar Manoharan sta->last_rx = jiffies; 601d9a7ddb05e5419ca5e4b54f57074dc33c7ea991cJohannes Berg 602469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 605469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6068bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock(&ifibss->incomplete_lock); 6078bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_add(&sta->list, &ifibss->incomplete_stations); 6088bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock(&ifibss->incomplete_lock); 6098bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 610469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 613469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 614469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active = 0; 616469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 617469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6187a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&sdata->u.ibss.mtx); 6197a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 620469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 622469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sdata == sdata && 624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 625469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies)) { 626469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active++; 627469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 628469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 629469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 630469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 631469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 632469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 633469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return active; 634469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 635469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 636ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 637ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_JOINED 638ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 639469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 640469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 641469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 642469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 643469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6447a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 6457a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 646af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 647af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 648469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 649469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT); 650af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 651450aae3d7b60a970f266349a837dfb30a539198bSujith if (time_before(jiffies, ifibss->last_scan_completed + 652450aae3d7b60a970f266349a837dfb30a539198bSujith IEEE80211_IBSS_MERGE_INTERVAL)) 653450aae3d7b60a970f266349a837dfb30a539198bSujith return; 654450aae3d7b60a970f266349a837dfb30a539198bSujith 655469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 656469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 657469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 658af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 659469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 660469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 661469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: No active IBSS STAs - trying to scan for other " 66247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg "IBSS networks with same SSID (merge)\n", sdata->name); 663469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 664be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg ieee80211_request_internal_scan(sdata, 66539d02a7d90602d4557ee05db2a157a4e0ec3a3d3Mohammed Shafi Shajakhan ifibss->ssid, ifibss->ssid_len, NULL); 666469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 667469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 668af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 669469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 670469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 671469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 672469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 673469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 674469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6757a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 6767a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 677af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 678469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 679469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 680469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 681469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 682469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 683469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 684469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 68547846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg bssid[i] ^= sdata->vif.addr[i]; 686469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 687469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 688469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 689469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 690469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Creating new IBSS network, BSSID %pM\n", 69147846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, bssid); 692469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 693469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 694469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 695fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 696469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 697469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 698469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 699469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 70057c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int, 701fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi ifibss->channel, ifibss->basic_rates, 702b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg capability, 0); 703469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 704469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 705ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 706ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_SEARCH 707ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 708ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault 709af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 710469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 711469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 712469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 7130c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 714af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 715469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 716469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 717e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg u16 capability; 718469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7197a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 7207a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 721469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 722469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 723469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: sta_find_ibss (active_ibss=%d)\n", 72447846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, active_ibss); 725469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 726469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 727469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 728af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 729469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 730e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability = WLAN_CAPABILITY_IBSS; 731fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 732e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 733af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 734af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 735af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 736af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg chan = ifibss->channel; 737af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 738469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 7390c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid, 7400c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg ifibss->ssid, ifibss->ssid_len, 7410c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY, 7420c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg capability); 7430c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 7440c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss) { 7450c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct ieee80211_bss *bss; 746469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7470c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg bss = (void *)cbss->priv; 748469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 749469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " sta_find_ibss: selected %pM current " 7500c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg "%pM\n", cbss->bssid, ifibss->bssid); 751469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 752469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 753469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Selected IBSS BSSID %pM" 754469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " based on configured SSID\n", 7550c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sdata->name, cbss->bssid); 756469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 757af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 758469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 759af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 760d419b9f0fa69e79ccba3e5e79a58a52ae0c2ed6aReinette Chatre } 761469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 762469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 763469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " did not try to join ibss\n"); 764469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 765469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 766469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 767ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault if (time_after(jiffies, ifibss->last_scan_completed + 768469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 769469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Trigger new scan to find an IBSS to " 77047846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg "join\n", sdata->name); 771469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 772be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg ieee80211_request_internal_scan(sdata, 773be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg ifibss->ssid, ifibss->ssid_len, 774be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg ifibss->fixed_channel ? ifibss->channel : NULL); 775ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault } else { 776469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 777469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 778469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 779469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) { 780af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!(local->oper_channel->flags & IEEE80211_CHAN_NO_IBSS)) { 781af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_create_ibss(sdata); 782af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 783af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 784469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: IBSS not allowed on" 78547846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg " %d MHz\n", sdata->name, 786469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.channel->center_freq); 787469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 788469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* No IBSS found - decrease scan interval and continue 789469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * scanning. */ 790469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg interval = IEEE80211_SCAN_INTERVAL_SLOW; 791469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 792469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 793af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 794af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 795469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 796469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 797469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 798469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 799c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct sk_buff *req) 800469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 801c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct ieee80211_mgmt *mgmt = (void *)req->data; 802469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 803469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 804c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg int tx_last_beacon, len = req->len; 805469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 806469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *resp; 80740b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg struct sk_buff *presp; 808469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 809469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 8107a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 8117a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 81240b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg presp = rcu_dereference_protected(ifibss->presp, 81340b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg lockdep_is_held(&ifibss->mtx)); 81440b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg 815469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 81640b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg len < 24 + 2 || !presp) 817469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 818469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 8192448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg tx_last_beacon = drv_tx_last_beacon(local); 820469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 821469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 822469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: RX ProbeReq SA=%pM DA=%pM BSSID=%pM" 823469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " (tx_last_beacon=%d)\n", 82447846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->sa, mgmt->da, 825469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->bssid, tx_last_beacon); 826469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 827469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 8281ed76487ce115110171480deabd3cd4656f9803eFelix Fietkau if (!tx_last_beacon && is_multicast_ether_addr(mgmt->da)) 829469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 830469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 831469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->bssid, ifibss->bssid, ETH_ALEN) != 0 && 832469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) != 0) 833469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 834469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 835469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 836469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 837469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 838469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 839469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 840469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Invalid SSID IE in ProbeReq " 841469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "from %pM\n", 84247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->sa); 843469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 844469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 845469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 846469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 847469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 8480da780c269957783d341fc3559e6b4c9912af7b4Benoit Papillault memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 849469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 850469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 851469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 852469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 853469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 85440b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg skb = skb_copy(presp, GFP_KERNEL); 855469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 856469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 857469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 858469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg resp = (struct ieee80211_mgmt *) skb->data; 859469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(resp->da, mgmt->sa, ETH_ALEN); 860469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 861469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Sending ProbeResp to %pM\n", 86247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, resp->da); 863469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 86462ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; 86562ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg ieee80211_tx_skb(sdata, skb); 866469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 867469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 868469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata, 869469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 870469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 871469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 872469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 873469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 874469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 875469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 876469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 877469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 878469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 879469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 880469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 881469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg &elems); 882469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 883469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false); 884469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 885469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 886469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata, 887469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 888469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 889469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 890469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 891469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 892469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 893469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 894469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Process beacon from the current BSS */ 895469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt; 896469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 897469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 898469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 899469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems); 900469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 901469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true); 902469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 903469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9041fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 9051fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct sk_buff *skb) 906469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 907469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 908469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 909469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 910469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 911f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 912469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 913469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 914469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9157a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_lock(&sdata->u.ibss.mtx); 9167a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 917c926d006c1514cfb3572893f41f2324e96823661Tim Harvey if (!sdata->u.ibss.ssid_len) 918c926d006c1514cfb3572893f41f2324e96823661Tim Harvey goto mgmt_out; /* not ready to merge yet */ 919c926d006c1514cfb3572893f41f2324e96823661Tim Harvey 920469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 921469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 922c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, skb); 923469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 924469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 925469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len, 926469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 927469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 928469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 929469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, 930469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 931469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 932469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 933469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 934469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 935469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 9367a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 937c926d006c1514cfb3572893f41f2324e96823661Tim Harvey mgmt_out: 9387a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_unlock(&sdata->u.ibss.mtx); 939469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 940469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9411fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_work(struct ieee80211_sub_if_data *sdata) 942469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 9431fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 9448bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 945469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9467a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_lock(&ifibss->mtx); 9477a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 9487a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg /* 9497a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * Work could be scheduled after scan or similar 9507a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * when we aren't even joined (or trying) with a 9517a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * network. 9527a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg */ 9537a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg if (!ifibss->ssid_len) 9547a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg goto out; 955469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9568bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 9578bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg while (!list_empty(&ifibss->incomplete_stations)) { 9588bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = list_first_entry(&ifibss->incomplete_stations, 9598bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info, list); 9608bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_del(&sta->list); 9618bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 9628bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 9636d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli ieee80211_ibss_finish_sta(sta, true); 9648bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 9658bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 9668bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 9678bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 9688bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 969469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 970469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 971469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 972469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 973469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 974469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 975469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 976469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 977469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 978469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 979469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 980469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9817a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg out: 9827a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_unlock(&ifibss->mtx); 9833a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg} 9843a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg 985469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 986469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 987469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 988469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 989469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 990469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 991469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9925bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (local->quiescing) { 9935bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 9945bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 9955bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 9965bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 9977a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 998469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 999469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10005bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#ifdef CONFIG_PM 10015bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_quiesce(struct ieee80211_sub_if_data *sdata) 10025bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 10035bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 10045bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 10055bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (del_timer_sync(&ifibss->timer)) 10065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 10075bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 10085bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 10095bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_restart(struct ieee80211_sub_if_data *sdata) 10105bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 10115bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 10125bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 10135bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (ifibss->timer_running) { 10145bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg add_timer(&ifibss->timer); 10155bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = false; 10165bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 10175bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 10185bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#endif 10195bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 1020469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 1021469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1022469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1023469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1024469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 1025469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 10267a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_init(&ifibss->mtx); 10278bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg INIT_LIST_HEAD(&ifibss->incomplete_stations); 10288bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_init(&ifibss->incomplete_lock); 1029469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1030469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1031469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 1032469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 1033469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1034af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 1035469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 103629b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_lock(&local->iflist_mtx); 103729b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg list_for_each_entry(sdata, &local->interfaces, list) { 10389607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg if (!ieee80211_sdata_running(sdata)) 10390e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 1040af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 1041af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 1042af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 10437a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 1044469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 104529b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_unlock(&local->iflist_mtx); 1046469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1047469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1048af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 1049af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 1050af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 1051af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 1052ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich u32 changed = 0; 1053af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 10547a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom + 105513c40c54682ffe62977f670681268a26d500d6faAlexander Simon sizeof(struct ieee80211_hdr_3addr) + 105613c40c54682ffe62977f670681268a26d500d6faAlexander Simon 12 /* struct ieee80211_mgmt.u.beacon */ + 105713c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + IEEE80211_MAX_SSID_LEN /* max SSID */ + 105813c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + 8 /* max Supported Rates */ + 105913c40c54682ffe62977f670681268a26d500d6faAlexander Simon 3 /* max DS params */ + 106013c40c54682ffe62977f670681268a26d500d6faAlexander Simon 4 /* IBSS params */ + 106113c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + (IEEE80211_MAX_SUPP_RATES - 8) + 106213c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + sizeof(struct ieee80211_ht_cap) + 106313c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + sizeof(struct ieee80211_ht_info) + 10647a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg params->ie_len); 10657a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg if (!skb) 10667a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg return -ENOMEM; 10677a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 10687a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_lock(&sdata->u.ibss.mtx); 10697a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1070af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 1071af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 1072af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 1073af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 1074af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 1075af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1076fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.privacy = params->privacy; 1077fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->u.ibss.basic_rates = params->basic_rates; 1078dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau memcpy(sdata->vif.bss_conf.mcast_rate, params->mcast_rate, 1079dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau sizeof(params->mcast_rate)); 1080fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg 108157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg sdata->vif.bss_conf.beacon_int = params->beacon_interval; 108257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 1083af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.channel = params->channel; 108413c40c54682ffe62977f670681268a26d500d6faAlexander Simon sdata->u.ibss.channel_type = params->channel_type; 1085af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 1086af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1087adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg /* fix ourselves to that channel now already */ 1088adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg if (params->channel_fixed) { 1089adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg sdata->local->oper_channel = params->channel; 109013c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (!ieee80211_set_channel_type(sdata->local, sdata, 1091fb03c5eb8c0bbf4561cb5aa72e0a9546e9574661Dan Carpenter params->channel_type)) { 1092fb03c5eb8c0bbf4561cb5aa72e0a9546e9574661Dan Carpenter mutex_unlock(&sdata->u.ibss.mtx); 1093cb71b8d80334add8991862f9fd36dc50874944ceSimon Wunderlich kfree_skb(skb); 109413c40c54682ffe62977f670681268a26d500d6faAlexander Simon return -EINVAL; 1095fb03c5eb8c0bbf4561cb5aa72e0a9546e9574661Dan Carpenter } 1096adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg } 1097adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg 1098af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 1099af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 1100af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 1101af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 1102af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 1103af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 1104af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1105af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.skb = skb; 1106af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 1107af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 1108af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 11090e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg memcpy(sdata->u.ibss.ssid, params->ssid, IEEE80211_MAX_SSID_LEN); 11100e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 11110e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 11127da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_unlock(&sdata->u.ibss.mtx); 11137da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg 11147da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_lock(&sdata->local->mtx); 11155cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 11167da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_unlock(&sdata->local->mtx); 11175cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 1118ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich /* 1119ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is 1120ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * reserved, but an HT STA shall protect HT transmissions as though 1121ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * the HT Protection field were set to non-HT mixed mode. 1122ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 1123ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * In an IBSS, the RIFS Mode field of the HT Operation element is 1124ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * also reserved, but an HT STA shall operate as though this field 1125ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * were set to 1. 1126ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich */ 1127ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1128ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich sdata->vif.bss_conf.ht_operation_mode |= 1129ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED 1130ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich | IEEE80211_HT_PARAM_RIFS_MODE; 1131ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1132ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich changed |= BSS_CHANGED_HT; 1133ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich ieee80211_bss_info_change_notify(sdata, changed); 1134ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 113564592c8fc0e99d445fc3fdedddeb6088e20086f1Johannes Berg ieee80211_queue_work(&sdata->local->hw, &sdata->work); 1136af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1137af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1138af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1139af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1140af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 1141af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 1142af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 11435ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 11445ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct ieee80211_local *local = sdata->local; 11455ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct cfg80211_bss *cbss; 11465ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi u16 capability; 11477a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg int active_ibss; 11488bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 11497a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 11507a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_lock(&sdata->u.ibss.mtx); 11515ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 1152f3209bea110cade12e2b133da8b8499689cb0e2eJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 1153f3209bea110cade12e2b133da8b8499689cb0e2eJohannes Berg memset(sdata->u.ibss.bssid, 0, ETH_ALEN); 1154f3209bea110cade12e2b133da8b8499689cb0e2eJohannes Berg sdata->u.ibss.ssid_len = 0; 1155f3209bea110cade12e2b133da8b8499689cb0e2eJohannes Berg 11565ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi active_ibss = ieee80211_sta_active_ibss(sdata); 11575ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 11585ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi if (!active_ibss && !is_zero_ether_addr(ifibss->bssid)) { 11595ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi capability = WLAN_CAPABILITY_IBSS; 11605ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 11615ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi if (ifibss->privacy) 11625ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi capability |= WLAN_CAPABILITY_PRIVACY; 11635ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 11645ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi cbss = cfg80211_get_bss(local->hw.wiphy, ifibss->channel, 11655ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi ifibss->bssid, ifibss->ssid, 11665ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 11675ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi WLAN_CAPABILITY_PRIVACY, 11685ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi capability); 11695ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 11705ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi if (cbss) { 11715ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi cfg80211_unlink_bss(local->hw.wiphy, cbss); 11725ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi cfg80211_put_bss(cbss); 11735ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi } 11745ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi } 1175af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1176af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 11778bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 11788bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 11798bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg while (!list_empty(&ifibss->incomplete_stations)) { 11808bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = list_first_entry(&ifibss->incomplete_stations, 11818bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info, list); 11828bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_del(&sta->list); 11838bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 11848bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 11858bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta_info_free(local, sta); 11868bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 11878bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 11888bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 11898bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 119086a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_off(sdata->dev); 1191af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1192af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 1193af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 119440b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg skb = rcu_dereference_protected(sdata->u.ibss.presp, 119540b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg lockdep_is_held(&sdata->u.ibss.mtx)); 1196a9b3cd7f323b2e57593e7215362a7b02fc933e3aStephen Hemminger RCU_INIT_POINTER(sdata->u.ibss.presp, NULL); 11978fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg sdata->vif.bss_conf.ibss_joined = false; 11988fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED | 11998fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg BSS_CHANGED_IBSS); 1200af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 1201af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree_skb(skb); 1202af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 120335f20c14a103ca2c7062999e934a513b83d84de6Johannes Berg skb_queue_purge(&sdata->skb_queue); 12045cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 1205bc05d19f4b884b1dbbce48912710ae3f972c89d2Johannes Berg del_timer_sync(&sdata->u.ibss.timer); 12067a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 12077a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_unlock(&sdata->u.ibss.mtx); 1208bc05d19f4b884b1dbbce48912710ae3f972c89d2Johannes Berg 12097da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_lock(&local->mtx); 12105cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 12117da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_unlock(&local->mtx); 1212af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1213af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1214af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1215