ibss.c revision 9ebb61a23d90703344fc609fbee8da67b1e7456c
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 24469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "ieee80211_i.h" 252448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg#include "driver-ops.h" 26469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "rate.h" 27469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 28469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL (2 * HZ) 29469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL_SLOW (15 * HZ) 30469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ) 31469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 32469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ) 33469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ) 34469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 35469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MAX_STA_ENTRIES 128 36469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 37469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 38af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 39af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const u8 *bssid, const int beacon_int, 40af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan, 41b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg const u32 basic_rates, 42af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg const u16 capability, u64 tsf) 43469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 44469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 45469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 46b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rates, i; 47469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 48469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 49469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 50469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 51f446d10f214091408b7300f15c9adf60569edf28Johannes Berg struct cfg80211_bss *bss; 5257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg u32 bss_change; 53b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u8 supp_rates[IEEE80211_MAX_SUPP_RATES]; 5413c40c54682ffe62977f670681268a26d500d6faAlexander Simon enum nl80211_channel_type channel_type; 552448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg 567a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 577a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 582448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* Reset own TSF to allow time synchronization work. */ 5937a41b4affa33bb237d3692bf51f1b5ebcaf29d8Eliad Peller drv_reset_tsf(local, sdata); 60469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 61af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb = ifibss->skb; 62a9b3cd7f323b2e57593e7215362a7b02fc933e3aStephen Hemminger RCU_INIT_POINTER(ifibss->presp, NULL); 63af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 64af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->data = skb->head; 65af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb->len = 0; 66af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reset_tail_pointer(skb); 67af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg skb_reserve(skb, sdata->local->hw.extra_tx_headroom); 68469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 69888d04dfbe7e09f930fdaafb257cce2c54c9c3f3Felix Fietkau if (compare_ether_addr(ifibss->bssid, bssid)) 70af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 71469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7249b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg /* if merging, indicate to driver that we leave the old IBSS */ 7349b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg if (sdata->vif.bss_conf.ibss_joined) { 7449b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg sdata->vif.bss_conf.ibss_joined = false; 7586a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_off(sdata->dev); 7649b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_IBSS); 7749b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg } 7849b5c7f473f1bbcb30275dcaee2c06dfb8ec2279Johannes Berg 79469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ifibss->bssid, bssid, ETH_ALEN); 80469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 81af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0; 82469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 83ba1960257c5980f9b58057995ce3394bd8e48ca3Eliad Peller local->oper_channel = chan; 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) + 163074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg sizeof(struct ieee80211_ht_operation)); 16413c40c54682ffe62977f670681268a26d500d6faAlexander Simon pos = ieee80211_ie_build_ht_cap(pos, &sband->ht_cap, 16513c40c54682ffe62977f670681268a26d500d6faAlexander Simon sband->ht_cap.cap); 166074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg pos = ieee80211_ie_build_ht_oper(pos, &sband->ht_cap, 167074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg chan, channel_type); 16813c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 16913c40c54682ffe62977f670681268a26d500d6faAlexander Simon 17032c5057b22a60b23353dda93c57e475856ca286cJohannes Berg if (local->hw.queues >= IEEE80211_NUM_ACS) { 1719eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf pos = skb_put(skb, 9); 1729eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = WLAN_EID_VENDOR_SPECIFIC; 1739eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 7; /* len */ 1749eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0x00; /* Microsoft OUI 00:50:F2 */ 1759eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0x50; 1769eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0xf2; 1779eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 2; /* WME */ 1789eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0; /* WME info */ 1799eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 1; /* WME ver */ 1809eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0; /* U-APSD no in use */ 1819eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf } 1829eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 183cf778b00e96df6d64f8e21b8395d1f8a859ecdc7Eric Dumazet rcu_assign_pointer(ifibss->presp, skb); 184469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1852d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg sdata->vif.bss_conf.beacon_int = beacon_int; 186fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->vif.bss_conf.basic_rates = basic_rates; 1872d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change = BSS_CHANGED_BEACON_INT; 1882d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= ieee80211_reset_erp_info(sdata); 1892d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BSSID; 1902d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON; 1912d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON_ENABLED; 192392cfdb10dab6c7dfa5fed18d8a44d7453d42196Teemu Paasikivi bss_change |= BSS_CHANGED_BASIC_RATES; 19313c40c54682ffe62977f670681268a26d500d6faAlexander Simon bss_change |= BSS_CHANGED_HT; 1948fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg bss_change |= BSS_CHANGED_IBSS; 1958fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg sdata->vif.bss_conf.ibss_joined = true; 1962d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg ieee80211_bss_info_change_notify(sdata, bss_change); 197469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 198b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg ieee80211_sta_def_wmm_params(sdata, sband->n_bitrates, supp_rates); 199469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 200469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 201af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 202af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 203469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 204f446d10f214091408b7300f15c9adf60569edf28Johannes Berg bss = cfg80211_inform_bss_frame(local->hw.wiphy, local->hw.conf.channel, 205f446d10f214091408b7300f15c9adf60569edf28Johannes Berg mgmt, skb->len, 0, GFP_KERNEL); 206f446d10f214091408b7300f15c9adf60569edf28Johannes Berg cfg80211_put_bss(bss); 20786a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_on(sdata->dev); 208af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cfg80211_ibss_joined(sdata->dev, ifibss->bssid, GFP_KERNEL); 209469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 210469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 211af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 212af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_bss *bss) 213469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 2140c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss = 2150c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg container_of((void *)bss, struct cfg80211_bss, priv); 216b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg struct ieee80211_supported_band *sband; 217b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u32 basic_rates; 218b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int i, j; 2190c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg u16 beacon_int = cbss->beacon_interval; 22057c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 2217a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&sdata->u.ibss.mtx); 2227a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 22357c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg if (beacon_int < 10) 22457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int = 10; 22557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 2260c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sband = sdata->local->hw.wiphy->bands[cbss->channel->band]; 227b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 228b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates = 0; 229b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 230b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < bss->supp_rates_len; i++) { 231b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int rate = (bss->supp_rates[i] & 0x7f) * 5; 232b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg bool is_basic = !!(bss->supp_rates[i] & 0x80); 233b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 234b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (j = 0; j < sband->n_bitrates; j++) { 235b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (sband->bitrates[j].bitrate == rate) { 236b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (is_basic) 237b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates |= BIT(j); 238b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg break; 239b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 240b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 241b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 242b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 2430c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg __ieee80211_sta_join_ibss(sdata, cbss->bssid, 24457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int, 2450c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->channel, 246b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates, 2470c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->capability, 2480c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->tsf); 249469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 250469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 2516d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartullistatic struct sta_info *ieee80211_ibss_finish_sta(struct sta_info *sta, 2526d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli bool auth) 2538bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 2548bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 2558bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 2568bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u8 addr[ETH_ALEN]; 2578bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2588bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg memcpy(addr, sta->sta.addr, ETH_ALEN); 2598bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2608bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 2618bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg wiphy_debug(sdata->local->hw.wiphy, 2628bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg "Adding new IBSS station %pM (dev=%s)\n", 2638bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg addr, sdata->name); 2648bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg#endif 2658bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 26683d5cc012441531ab0bf6f99881958e964e9cf11Johannes Berg sta_info_pre_move_state(sta, IEEE80211_STA_AUTH); 26783d5cc012441531ab0bf6f99881958e964e9cf11Johannes Berg sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC); 268267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli /* authorize the station only if the network is not RSN protected. If 269267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli * not wait for the userspace to authorize it */ 270267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli if (!sta->sdata->u.ibss.control_port) 271267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED); 2728bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2738bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rate_control_rate_init(sta); 2748bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2758bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* If it fails, maybe we raced another insertion? */ 2768bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (sta_info_insert_rcu(sta)) 2778bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta_info_get(sdata, addr); 2786d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (auth) { 27924dd0dd74ec8dc4abada132e380dc179459b0f77Antonio Quartulli#ifdef CONFIG_MAC80211_IBSS_DEBUG 2806d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli printk(KERN_DEBUG "TX Auth SA=%pM DA=%pM BSSID=%pM" 2816d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli "(auth_transaction=1)\n", sdata->vif.addr, 2826d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli sdata->u.ibss.bssid, addr); 28324dd0dd74ec8dc4abada132e380dc179459b0f77Antonio Quartulli#endif 2846d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli ieee80211_send_auth(sdata, 1, WLAN_AUTH_OPEN, NULL, 0, 2856d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli addr, sdata->u.ibss.bssid, NULL, 0, 0); 2866d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli } 2878bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta; 2888bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 2898bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 2908bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergstatic struct sta_info * 2918bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, 2928bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg const u8 *bssid, const u8 *addr, 2936d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli u32 supp_rates, bool auth) 2948bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 2958bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 2968bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 2978bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_local *local = sdata->local; 2988bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 2998bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg int band = local->hw.conf.channel->band; 3008bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3018bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* 3028bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * XXX: Consider removing the least recently used entry and 3038bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * allow new one to be added. 3048bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg */ 3058bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 3068bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (net_ratelimit()) 3078bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA entry %pM\n", 3088bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sdata->name, addr); 3098bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 3108bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 3118bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 3128bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3138bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) { 3148bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 3158bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 3168bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 3178bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3188bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) { 3198bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 3208bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 3218bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 3228bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3238bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_KERNEL); 3248bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (!sta) { 3258bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 3268bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 3278bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 3288bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3298bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->last_rx = jiffies; 3308bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3318bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* make sure mandatory rates are always added */ 3328bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->sta.supp_rates[band] = supp_rates | 3338bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg ieee80211_mandatory_rates(local, band); 3348bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 3356d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return ieee80211_ibss_finish_sta(sta, auth); 3366d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli} 3376d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3386d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartullistatic void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata, 3396d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli struct ieee80211_mgmt *mgmt, 3406d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli size_t len) 3416d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli{ 3426d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli u16 auth_alg, auth_transaction; 3436d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3446d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli lockdep_assert_held(&sdata->u.ibss.mtx); 3456d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3466d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (len < 24 + 6) 3476d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return; 3486d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3496d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); 3506d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); 3516d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3526d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1) 3536d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return; 3546d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli#ifdef CONFIG_MAC80211_IBSS_DEBUG 3556d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli printk(KERN_DEBUG "%s: RX Auth SA=%pM DA=%pM BSSID=%pM." 3566d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli "(auth_transaction=%d)\n", 3576d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli sdata->name, mgmt->sa, mgmt->da, mgmt->bssid, auth_transaction); 3586d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli#endif 3596d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli sta_info_destroy_addr(sdata, mgmt->sa); 3606d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 0, false); 3616d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli rcu_read_unlock(); 3626d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 3636d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli /* 3646d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * IEEE 802.11 standard does not require authentication in IBSS 3656d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * networks and most implementations do not seem to use it. 3666d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * However, try to reply to authentication attempts if someone 3676d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * has actually implemented this. 3686d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli */ 3696d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, NULL, 0, 3706d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli mgmt->sa, sdata->u.ibss.bssid, NULL, 0, 0); 3718bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 3728bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 375469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 377469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems *elems, 378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bool beacon) 379469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 380469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 381469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int freq; 3820c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 383469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 387469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 388469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 38913c40c54682ffe62977f670681268a26d500d6faAlexander Simon struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band]; 39013c40c54682ffe62977f670681268a26d500d6faAlexander Simon bool rates_updated = false; 391469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 392469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ds_params && elems->ds_params_len == 1) 39359eb21a6504731fc16db4cf9463065dd61093e08Bruno Randolf freq = ieee80211_channel_to_frequency(elems->ds_params[0], 39459eb21a6504731fc16db4cf9463065dd61093e08Bruno Randolf band); 395469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 396469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = rx_status->freq; 397469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 398469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 399469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 400469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 401469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 402469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4039eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sdata->vif.type == NL80211_IFTYPE_ADHOC && 404888d04dfbe7e09f930fdaafb257cce2c54c9c3f3Felix Fietkau compare_ether_addr(mgmt->bssid, sdata->u.ibss.bssid) == 0) { 405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 406469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 407abe60632f311d515b082b450504ee24006023951Johannes Berg sta = sta_info_get(sdata, mgmt->sa); 408469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4099eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (elems->supp_rates) { 4109eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf supp_rates = ieee80211_sta_get_rates(local, elems, 4119ebb61a23d90703344fc609fbee8da67b1e7456cAshok Nagarajan band, NULL); 4129eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta) { 4139eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf u32 prev_rates; 4149eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 4159eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf prev_rates = sta->sta.supp_rates[band]; 4169eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf /* make sure mandatory rates are always added */ 4179eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta->sta.supp_rates[band] = supp_rates | 4189eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf ieee80211_mandatory_rates(local, band); 419469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4209eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta->sta.supp_rates[band] != prev_rates) { 421469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 4229eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf printk(KERN_DEBUG 4239eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf "%s: updated supp_rates set " 4249eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf "for %pM based on beacon" 4259eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf "/probe_resp (0x%x -> 0x%x)\n", 4269eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sdata->name, sta->sta.addr, 4279eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf prev_rates, 4289eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta->sta.supp_rates[band]); 429469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 43013c40c54682ffe62977f670681268a26d500d6faAlexander Simon rates_updated = true; 4319eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf } 4328bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } else { 4338bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 4349eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid, 4356d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli mgmt->sa, supp_rates, true); 4368bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 43734e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg } 4389eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 4399eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta && elems->wmm_info) 440c2c98fdeb5c897499644eb247285c8e3dacc6450Johannes Berg set_sta_flag(sta, WLAN_STA_WME); 4419eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 442074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg if (sta && elems->ht_operation && elems->ht_cap_elem && 44313c40c54682ffe62977f670681268a26d500d6faAlexander Simon sdata->u.ibss.channel_type != NL80211_CHAN_NO_HT) { 44413c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* we both use HT */ 44513c40c54682ffe62977f670681268a26d500d6faAlexander Simon struct ieee80211_sta_ht_cap sta_ht_cap_new; 44613c40c54682ffe62977f670681268a26d500d6faAlexander Simon enum nl80211_channel_type channel_type = 447074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg ieee80211_ht_oper_to_channel_type( 448074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg elems->ht_operation); 44913c40c54682ffe62977f670681268a26d500d6faAlexander Simon 45013c40c54682ffe62977f670681268a26d500d6faAlexander Simon ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband, 45113c40c54682ffe62977f670681268a26d500d6faAlexander Simon elems->ht_cap_elem, 45213c40c54682ffe62977f670681268a26d500d6faAlexander Simon &sta_ht_cap_new); 45313c40c54682ffe62977f670681268a26d500d6faAlexander Simon 45413c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* 45513c40c54682ffe62977f670681268a26d500d6faAlexander Simon * fall back to HT20 if we don't use or use 45613c40c54682ffe62977f670681268a26d500d6faAlexander Simon * the other extension channel 45713c40c54682ffe62977f670681268a26d500d6faAlexander Simon */ 45813c40c54682ffe62977f670681268a26d500d6faAlexander Simon if ((channel_type == NL80211_CHAN_HT40MINUS || 45913c40c54682ffe62977f670681268a26d500d6faAlexander Simon channel_type == NL80211_CHAN_HT40PLUS) && 46013c40c54682ffe62977f670681268a26d500d6faAlexander Simon channel_type != sdata->u.ibss.channel_type) 46113c40c54682ffe62977f670681268a26d500d6faAlexander Simon sta_ht_cap_new.cap &= 46213c40c54682ffe62977f670681268a26d500d6faAlexander Simon ~IEEE80211_HT_CAP_SUP_WIDTH_20_40; 46313c40c54682ffe62977f670681268a26d500d6faAlexander Simon 46413c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (memcmp(&sta->sta.ht_cap, &sta_ht_cap_new, 46513c40c54682ffe62977f670681268a26d500d6faAlexander Simon sizeof(sta_ht_cap_new))) { 46613c40c54682ffe62977f670681268a26d500d6faAlexander Simon memcpy(&sta->sta.ht_cap, &sta_ht_cap_new, 46713c40c54682ffe62977f670681268a26d500d6faAlexander Simon sizeof(sta_ht_cap_new)); 46813c40c54682ffe62977f670681268a26d500d6faAlexander Simon rates_updated = true; 46913c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 47013c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 47113c40c54682ffe62977f670681268a26d500d6faAlexander Simon 47213c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (sta && rates_updated) 47313c40c54682ffe62977f670681268a26d500d6faAlexander Simon rate_control_rate_init(sta); 47413c40c54682ffe62977f670681268a26d500d6faAlexander Simon 4759eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf rcu_read_unlock(); 476469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 477469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel, beacon); 480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 481469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 482469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 4830c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = container_of((void *)bss, struct cfg80211_bss, priv); 4840c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 485469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* was just updated in ieee80211_bss_info_update */ 4860c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg beacon_timestamp = cbss->tsf; 487469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 488469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 490469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* we use a fixed BSSID */ 491a98bfec2985221d8e0904a526cbe88590eaad2a6Benoit Papillault if (sdata->u.ibss.fixed_bssid) 492469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 493469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 494469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 4950c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (!(cbss->capability & WLAN_CAPABILITY_IBSS)) 496469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 4990c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss->channel != local->oper_channel) 500469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 501469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 502469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 503469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 504469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 507469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 50834e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 509888d04dfbe7e09f930fdaafb257cce2c54c9c3f3Felix Fietkau if (compare_ether_addr(cbss->bssid, sdata->u.ibss.bssid) == 0) 51034e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 51134e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 5126ebacbb79d2d05978ba50a24d8cbe2a76ff2014cJohannes Berg if (rx_status->flag & RX_FLAG_MACTIME_MPDU) { 513469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 514469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * For correct IBSS merging we need mactime; since mactime is 515469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * defined as the time the first data symbol of the frame hits 516469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * the PHY, and the timestamp of the beacon is defined as "the 517469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * time that the data symbol containing the first bit of the 518469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * timestamp is transmitted to the PHY plus the transmitting 519469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * STA's delays through its local PHY from the MAC-PHY 520469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * interface to its interface with the WM" (802.11 11.1.2) 521469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * - equals the time this bit arrives at the receiver - we have 522469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * to take into account the offset between the two. 523469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 524469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * E.g. at 1 MBit that means mactime is 192 usec earlier 525469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * (=24 bytes * 8 usecs/byte) than the beacon timestamp. 526469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 527469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate; 528469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 529469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_HT) 530469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = 65; /* TODO: HT rates */ 531469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 532469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = local->hw.wiphy->bands[band]-> 533469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bitrates[rx_status->rate_idx].bitrate; 534469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 535469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = rx_status->mactime + (24 * 8 * 10 / rate); 5362448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } else { 5372448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* 5382448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * second best option: get current TSF 5392448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * (will return -1 if not supported) 5402448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg */ 54137a41b4affa33bb237d3692bf51f1b5ebcaf29d8Eliad Peller rx_timestamp = drv_get_tsf(local, sdata); 5422448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } 543469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 544469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 545469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "RX beacon SA=%pM BSSID=" 546469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 547469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->sa, mgmt->bssid, 548469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)rx_timestamp, 549469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)beacon_timestamp, 550469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 551469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies); 552469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 553469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 554469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 555469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 556469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: beacon TSF higher than " 557469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "local TSF - IBSS merge with BSSID %pM\n", 55847846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->bssid); 559469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 560469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 5619ebb61a23d90703344fc609fbee8da67b1e7456cAshok Nagarajan supp_rates = ieee80211_sta_get_rates(local, elems, band, NULL); 56234e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 5636d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli supp_rates, true); 5648bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 565469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 566469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 567469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 568469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 569469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 570469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 5718bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergvoid ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data *sdata, 5728bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg const u8 *bssid, const u8 *addr, 5738bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u32 supp_rates) 574469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 5752e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 576469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 577469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 578469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int band = local->hw.conf.channel->band; 579469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 580af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 581af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 582af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 583af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 584469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 585af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (net_ratelimit()) 586af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA entry %pM\n", 58747846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, addr); 5888bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 590469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 5912e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) 5928bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 5932e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau 594469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) 5958bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 596469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 5978bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 598469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 5998bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 600469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 601c8716d9dc13c7f6ee92f2bfc6cc3b723b417bff8Rajkumar Manoharan sta->last_rx = jiffies; 602d9a7ddb05e5419ca5e4b54f57074dc33c7ea991cJohannes Berg 603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 605469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 606469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6078bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock(&ifibss->incomplete_lock); 6088bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_add(&sta->list, &ifibss->incomplete_stations); 6098bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock(&ifibss->incomplete_lock); 6108bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 613469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 614469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 616469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active = 0; 617469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 618469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6197a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&sdata->u.ibss.mtx); 6207a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 622469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sdata == sdata && 625469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 626469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies)) { 627469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active++; 628469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 629469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 630469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 631469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 632469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 633469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 634469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return active; 635469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 636469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 637ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 638ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_JOINED 639ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 640469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 641469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 642469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 643469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 644469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6457a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 6467a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 647af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 648af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 649469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 650469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT); 651af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 652450aae3d7b60a970f266349a837dfb30a539198bSujith if (time_before(jiffies, ifibss->last_scan_completed + 653450aae3d7b60a970f266349a837dfb30a539198bSujith IEEE80211_IBSS_MERGE_INTERVAL)) 654450aae3d7b60a970f266349a837dfb30a539198bSujith return; 655450aae3d7b60a970f266349a837dfb30a539198bSujith 656469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 657469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 658469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 659c037b8367c7e2b775a99d74037f5df014d2fbf06John W. Linville if (ifibss->fixed_channel) 660469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 661469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 662469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: No active IBSS STAs - trying to scan for other " 66347846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg "IBSS networks with same SSID (merge)\n", sdata->name); 664469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 665be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg ieee80211_request_internal_scan(sdata, 666c037b8367c7e2b775a99d74037f5df014d2fbf06John W. Linville ifibss->ssid, ifibss->ssid_len, NULL); 667469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 668469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 669af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 670469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 671469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 672469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 673469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 674469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 675469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 6767a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 6777a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 678af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 679469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 680469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 681469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 682469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 683469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 684469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 685469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 68647846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg bssid[i] ^= sdata->vif.addr[i]; 687469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 688469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 689469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 690469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 691469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Creating new IBSS network, BSSID %pM\n", 69247846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, bssid); 693469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 694469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 695469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 696fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 697469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 698469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 699469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 700469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 70157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int, 702fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi ifibss->channel, ifibss->basic_rates, 703b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg capability, 0); 704469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 705469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 706ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 707ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_SEARCH 708ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 709ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault 710af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 711469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 712469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 713469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 7140c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 715af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 716469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 717469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 718e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg u16 capability; 719469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7207a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 7217a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 722469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 723469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 724469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: sta_find_ibss (active_ibss=%d)\n", 72547846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, active_ibss); 726469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 727469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 728469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 729af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 730469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 731e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability = WLAN_CAPABILITY_IBSS; 732fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 733e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 734af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 735af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 736af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 737af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg chan = ifibss->channel; 738af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 739469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 7400c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid, 7410c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg ifibss->ssid, ifibss->ssid_len, 7420c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY, 7430c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg capability); 7440c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 7450c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss) { 7460c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct ieee80211_bss *bss; 747469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 7480c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg bss = (void *)cbss->priv; 749469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 750469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " sta_find_ibss: selected %pM current " 7510c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg "%pM\n", cbss->bssid, ifibss->bssid); 752469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 753469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 754469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Selected IBSS BSSID %pM" 755469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " based on configured SSID\n", 7560c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sdata->name, cbss->bssid); 757469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 758af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 759469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 760af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 761d419b9f0fa69e79ccba3e5e79a58a52ae0c2ed6aReinette Chatre } 762469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 763469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 764469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " did not try to join ibss\n"); 765469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 766469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 767469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 768ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault if (time_after(jiffies, ifibss->last_scan_completed + 769469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 770469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Trigger new scan to find an IBSS to " 77147846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg "join\n", sdata->name); 772469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 773be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg ieee80211_request_internal_scan(sdata, 774be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg ifibss->ssid, ifibss->ssid_len, 775be4a4b6a5d2f76393f545a2545fbaa1b65577e13Johannes Berg ifibss->fixed_channel ? ifibss->channel : NULL); 776ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault } else { 777469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 778469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 779469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 780469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) { 781af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!(local->oper_channel->flags & IEEE80211_CHAN_NO_IBSS)) { 782af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_create_ibss(sdata); 783af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 784af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 785469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: IBSS not allowed on" 78647846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg " %d MHz\n", sdata->name, 787469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.channel->center_freq); 788469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 789469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* No IBSS found - decrease scan interval and continue 790469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * scanning. */ 791469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg interval = IEEE80211_SCAN_INTERVAL_SLOW; 792469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 793469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 794af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 795af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 796469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 797469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 798469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 799469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 800c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct sk_buff *req) 801469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 802c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct ieee80211_mgmt *mgmt = (void *)req->data; 803469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 804469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 805c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg int tx_last_beacon, len = req->len; 806469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 807469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *resp; 80840b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg struct sk_buff *presp; 809469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 810469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 8117a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg lockdep_assert_held(&ifibss->mtx); 8127a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 81340b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg presp = rcu_dereference_protected(ifibss->presp, 81440b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg lockdep_is_held(&ifibss->mtx)); 81540b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg 816469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 81740b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg len < 24 + 2 || !presp) 818469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 819469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 8202448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg tx_last_beacon = drv_tx_last_beacon(local); 821469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 822469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 823469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: RX ProbeReq SA=%pM DA=%pM BSSID=%pM" 824469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " (tx_last_beacon=%d)\n", 82547846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->sa, mgmt->da, 826469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->bssid, tx_last_beacon); 827469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 828469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 8291ed76487ce115110171480deabd3cd4656f9803eFelix Fietkau if (!tx_last_beacon && is_multicast_ether_addr(mgmt->da)) 830469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 831469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 832888d04dfbe7e09f930fdaafb257cce2c54c9c3f3Felix Fietkau if (compare_ether_addr(mgmt->bssid, ifibss->bssid) != 0 && 833888d04dfbe7e09f930fdaafb257cce2c54c9c3f3Felix Fietkau !is_broadcast_ether_addr(mgmt->bssid)) 834469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 835469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 836469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 837469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 838469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 839469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 840469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 841469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Invalid SSID IE in ProbeReq " 842469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "from %pM\n", 84347846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, mgmt->sa); 844469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 845469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 846469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 847469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 848469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 8490da780c269957783d341fc3559e6b4c9912af7b4Benoit Papillault memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 850469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 851469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 852469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 853469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 854469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 85540b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg skb = skb_copy(presp, GFP_KERNEL); 856469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 857469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 858469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 859469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg resp = (struct ieee80211_mgmt *) skb->data; 860469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(resp->da, mgmt->sa, ETH_ALEN); 861469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 862469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Sending ProbeResp to %pM\n", 86347846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg sdata->name, resp->da); 864469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 86562ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; 86662ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg ieee80211_tx_skb(sdata, skb); 867469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 868469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 869469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata, 870469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 871469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 872469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 873469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 874469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 875469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 876469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 877469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 878469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 879469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 880469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 881469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 882469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg &elems); 883469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 884469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false); 885469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 886469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 887469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata, 888469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 889469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 890469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 891469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 892469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 893469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 894469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 895469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Process beacon from the current BSS */ 896469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt; 897469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 898469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 899469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 900469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems); 901469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 902469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true); 903469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 904469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9051fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 9061fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct sk_buff *skb) 907469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 908469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 909469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 910469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 911469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 912f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 913469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 914469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 915469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9167a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_lock(&sdata->u.ibss.mtx); 9177a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 918c926d006c1514cfb3572893f41f2324e96823661Tim Harvey if (!sdata->u.ibss.ssid_len) 919c926d006c1514cfb3572893f41f2324e96823661Tim Harvey goto mgmt_out; /* not ready to merge yet */ 920c926d006c1514cfb3572893f41f2324e96823661Tim Harvey 921469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 922469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 923c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, skb); 924469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 925469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 926469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len, 927469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 928469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 929469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 930469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, 931469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 932469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 933469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 934469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 935469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 936469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 9377a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 938c926d006c1514cfb3572893f41f2324e96823661Tim Harvey mgmt_out: 9397a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_unlock(&sdata->u.ibss.mtx); 940469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 941469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9421fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_work(struct ieee80211_sub_if_data *sdata) 943469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 9441fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 9458bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 946469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9477a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_lock(&ifibss->mtx); 9487a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 9497a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg /* 9507a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * Work could be scheduled after scan or similar 9517a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * when we aren't even joined (or trying) with a 9527a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * network. 9537a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg */ 9547a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg if (!ifibss->ssid_len) 9557a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg goto out; 956469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9578bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 9588bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg while (!list_empty(&ifibss->incomplete_stations)) { 9598bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = list_first_entry(&ifibss->incomplete_stations, 9608bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info, list); 9618bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_del(&sta->list); 9628bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 9638bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 9646d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli ieee80211_ibss_finish_sta(sta, true); 9658bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 9668bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 9678bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 9688bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 9698bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 970469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 971469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 972469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 973469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 974469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 975469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 976469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 977469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 978469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 979469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 980469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 981469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9827a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg out: 9837a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_unlock(&ifibss->mtx); 9843a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg} 9853a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg 986469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 987469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 988469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 989469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 990469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 991469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 992469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 9935bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (local->quiescing) { 9945bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 9955bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg return; 9965bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 9975bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 9987a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 999469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1000469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10015bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#ifdef CONFIG_PM 10025bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_quiesce(struct ieee80211_sub_if_data *sdata) 10035bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 10045bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 10055bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 10065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (del_timer_sync(&ifibss->timer)) 10075bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = true; 10085bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 10095bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 10105bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Bergvoid ieee80211_ibss_restart(struct ieee80211_sub_if_data *sdata) 10115bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg{ 10125bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 10135bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 10145bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg if (ifibss->timer_running) { 10155bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg add_timer(&ifibss->timer); 10165bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg ifibss->timer_running = false; 10175bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg } 10185bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 10195bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg#endif 10205bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 1021469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 1022469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1023469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1024469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1025469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 1026469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 10277a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_init(&ifibss->mtx); 10288bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg INIT_LIST_HEAD(&ifibss->incomplete_stations); 10298bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_init(&ifibss->incomplete_lock); 1030469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1031469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1032469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 1033469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 1034469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1035af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 1036469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 103729b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_lock(&local->iflist_mtx); 103829b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg list_for_each_entry(sdata, &local->interfaces, list) { 10399607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg if (!ieee80211_sdata_running(sdata)) 10400e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 1041af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 1042af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 1043af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 10447a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 1045469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 104629b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_unlock(&local->iflist_mtx); 1047469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1048469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1049af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 1050af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 1051af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 1052af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 1053ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich u32 changed = 0; 1054af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 10557a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg skb = dev_alloc_skb(sdata->local->hw.extra_tx_headroom + 105613c40c54682ffe62977f670681268a26d500d6faAlexander Simon sizeof(struct ieee80211_hdr_3addr) + 105713c40c54682ffe62977f670681268a26d500d6faAlexander Simon 12 /* struct ieee80211_mgmt.u.beacon */ + 105813c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + IEEE80211_MAX_SSID_LEN /* max SSID */ + 105913c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + 8 /* max Supported Rates */ + 106013c40c54682ffe62977f670681268a26d500d6faAlexander Simon 3 /* max DS params */ + 106113c40c54682ffe62977f670681268a26d500d6faAlexander Simon 4 /* IBSS params */ + 106213c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + (IEEE80211_MAX_SUPP_RATES - 8) + 106313c40c54682ffe62977f670681268a26d500d6faAlexander Simon 2 + sizeof(struct ieee80211_ht_cap) + 1064074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg 2 + sizeof(struct ieee80211_ht_operation) + 10657a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg params->ie_len); 10667a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg if (!skb) 10677a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg return -ENOMEM; 10687a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 10697a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_lock(&sdata->u.ibss.mtx); 10707a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1071af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 1072af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 1073af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 1074af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 1075af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 1076af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1077fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.privacy = params->privacy; 1078267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli sdata->u.ibss.control_port = params->control_port; 1079fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->u.ibss.basic_rates = params->basic_rates; 1080dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau memcpy(sdata->vif.bss_conf.mcast_rate, params->mcast_rate, 1081dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau sizeof(params->mcast_rate)); 1082fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg 108357c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg sdata->vif.bss_conf.beacon_int = params->beacon_interval; 108457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 1085af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.channel = params->channel; 108613c40c54682ffe62977f670681268a26d500d6faAlexander Simon sdata->u.ibss.channel_type = params->channel_type; 1087af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 1088af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1089adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg /* fix ourselves to that channel now already */ 1090adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg if (params->channel_fixed) { 1091adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg sdata->local->oper_channel = params->channel; 109213c40c54682ffe62977f670681268a26d500d6faAlexander Simon if (!ieee80211_set_channel_type(sdata->local, sdata, 1093fb03c5eb8c0bbf4561cb5aa72e0a9546e9574661Dan Carpenter params->channel_type)) { 1094fb03c5eb8c0bbf4561cb5aa72e0a9546e9574661Dan Carpenter mutex_unlock(&sdata->u.ibss.mtx); 1095cb71b8d80334add8991862f9fd36dc50874944ceSimon Wunderlich kfree_skb(skb); 109613c40c54682ffe62977f670681268a26d500d6faAlexander Simon return -EINVAL; 1097fb03c5eb8c0bbf4561cb5aa72e0a9546e9574661Dan Carpenter } 1098adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg } 1099adfba3c7c026a6a5560d2a43fefc9b198cb74462Johannes Berg 1100af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 1101af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 1102af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 1103af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 1104af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 1105af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 1106af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1107af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.skb = skb; 1108af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 1109af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 1110af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 11110e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg memcpy(sdata->u.ibss.ssid, params->ssid, IEEE80211_MAX_SSID_LEN); 11120e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 11130e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 11147da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_unlock(&sdata->u.ibss.mtx); 11157da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg 11167da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_lock(&sdata->local->mtx); 11175cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 11187da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_unlock(&sdata->local->mtx); 11195cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 1120ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich /* 1121ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is 1122ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * reserved, but an HT STA shall protect HT transmissions as though 1123ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * the HT Protection field were set to non-HT mixed mode. 1124ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 1125ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * In an IBSS, the RIFS Mode field of the HT Operation element is 1126ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * also reserved, but an HT STA shall operate as though this field 1127ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * were set to 1. 1128ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich */ 1129ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1130ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich sdata->vif.bss_conf.ht_operation_mode |= 1131ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED 1132ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich | IEEE80211_HT_PARAM_RIFS_MODE; 1133ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1134ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich changed |= BSS_CHANGED_HT; 1135ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich ieee80211_bss_info_change_notify(sdata, changed); 1136ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 113764592c8fc0e99d445fc3fdedddeb6088e20086f1Johannes Berg ieee80211_queue_work(&sdata->local->hw, &sdata->work); 1138af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1139af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1140af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1141af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1142af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 1143af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 1144af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct sk_buff *skb; 11455ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 11465ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct ieee80211_local *local = sdata->local; 11475ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct cfg80211_bss *cbss; 11485ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi u16 capability; 11497a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg int active_ibss; 11508bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 11517a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 11527a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_lock(&sdata->u.ibss.mtx); 11535ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 1154f3209bea110cade12e2b133da8b8499689cb0e2eJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 1155f3209bea110cade12e2b133da8b8499689cb0e2eJohannes Berg memset(sdata->u.ibss.bssid, 0, ETH_ALEN); 1156f3209bea110cade12e2b133da8b8499689cb0e2eJohannes Berg sdata->u.ibss.ssid_len = 0; 1157f3209bea110cade12e2b133da8b8499689cb0e2eJohannes Berg 11585ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi active_ibss = ieee80211_sta_active_ibss(sdata); 11595ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 11605ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi if (!active_ibss && !is_zero_ether_addr(ifibss->bssid)) { 11615ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi capability = WLAN_CAPABILITY_IBSS; 11625ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 11635ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi if (ifibss->privacy) 11645ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi capability |= WLAN_CAPABILITY_PRIVACY; 11655ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 11665ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi cbss = cfg80211_get_bss(local->hw.wiphy, ifibss->channel, 11675ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi ifibss->bssid, ifibss->ssid, 11685ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 11695ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi WLAN_CAPABILITY_PRIVACY, 11705ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi capability); 11715ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 11725ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi if (cbss) { 11735ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi cfg80211_unlink_bss(local->hw.wiphy, cbss); 11745ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi cfg80211_put_bss(cbss); 11755ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi } 11765ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi } 1177af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1178af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sta_info_flush(sdata->local, sdata); 11798bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 11808bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 11818bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg while (!list_empty(&ifibss->incomplete_stations)) { 11828bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = list_first_entry(&ifibss->incomplete_stations, 11838bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info, list); 11848bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_del(&sta->list); 11858bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 11868bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 11878bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta_info_free(local, sta); 11888bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 11898bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 11908bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 11918bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 119286a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_off(sdata->dev); 1193af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1194af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 1195af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 119640b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg skb = rcu_dereference_protected(sdata->u.ibss.presp, 119740b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg lockdep_is_held(&sdata->u.ibss.mtx)); 1198a9b3cd7f323b2e57593e7215362a7b02fc933e3aStephen Hemminger RCU_INIT_POINTER(sdata->u.ibss.presp, NULL); 11998fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg sdata->vif.bss_conf.ibss_joined = false; 12008fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED | 12018fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg BSS_CHANGED_IBSS); 1202af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 1203af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree_skb(skb); 1204af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 120535f20c14a103ca2c7062999e934a513b83d84de6Johannes Berg skb_queue_purge(&sdata->skb_queue); 12065cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 1207bc05d19f4b884b1dbbce48912710ae3f972c89d2Johannes Berg del_timer_sync(&sdata->u.ibss.timer); 12087a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 12097a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg mutex_unlock(&sdata->u.ibss.mtx); 1210bc05d19f4b884b1dbbce48912710ae3f972c89d2Johannes Berg 12117da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_lock(&local->mtx); 12125cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg ieee80211_recalc_idle(sdata->local); 12137da7cc1d42d8ce02cca16df8c021e6d657f1f8fdJohannes Berg mutex_unlock(&local->mtx); 1214af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1215af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1216af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1217