ibss.c revision af296bdb8da4d0a4284de10fc4a61497272ddf11
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_IBSS_JOIN_TIMEOUT (7 * HZ) 30469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 31469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ) 32469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ) 33dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli#define IEEE80211_IBSS_RSN_INACTIVITY_LIMIT (10 * HZ) 34469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 35469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MAX_STA_ENTRIES 128 36469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 37d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlichstatic struct beacon_data * 38d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlichieee80211_ibss_build_presp(struct ieee80211_sub_if_data *sdata, 39d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const int beacon_int, const u32 basic_rates, 40d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const u16 capability, u64 tsf, 41d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct cfg80211_chan_def *chandef, 42cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich bool *have_higher_than_11mbit, 43cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_csa_settings *csa_settings) 44469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 45469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 46469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 472103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rates_n = 0, i, ri; 48469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 49469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 50469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 51d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich u32 rate_flags, rates = 0, rates_added = 0; 52c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg struct beacon_data *presp; 53c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg int frame_len; 542103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int shift; 552448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg 56469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Build IBSS probe response */ 57c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg frame_len = sizeof(struct ieee80211_hdr_3addr) + 58c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 12 /* struct ieee80211_mgmt.u.beacon */ + 59c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + IEEE80211_MAX_SSID_LEN /* max SSID */ + 60c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + 8 /* max Supported Rates */ + 61c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 3 /* max DS params */ + 62c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 4 /* IBSS params */ + 63cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 5 /* Channel Switch Announcement */ + 64c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + (IEEE80211_MAX_SUPP_RATES - 8) + 65c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + sizeof(struct ieee80211_ht_cap) + 66c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + sizeof(struct ieee80211_ht_operation) + 67c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg ifibss->ie_len; 68c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg presp = kzalloc(sizeof(*presp) + frame_len, GFP_KERNEL); 69c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg if (!presp) 70d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return NULL; 71c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 72c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg presp->head = (void *)(presp + 1); 73c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 74c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg mgmt = (void *) presp->head; 75469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 76469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_STYPE_PROBE_RESP); 77e83e6541cee0a12bc445b0f4fad5214df5803087Johannes Berg eth_broadcast_addr(mgmt->da); 7847846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN); 79469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN); 8057c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int); 81707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith mgmt->u.beacon.timestamp = cpu_to_le64(tsf); 82469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->u.beacon.capab_info = cpu_to_le16(capability); 83469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 84c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg pos = (u8 *)mgmt + offsetof(struct ieee80211_mgmt, u.beacon.variable); 85c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 86469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SSID; 87469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = ifibss->ssid_len; 88469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, ifibss->ssid, ifibss->ssid_len); 89c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg pos += ifibss->ssid_len; 90469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 91d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sband = local->hw.wiphy->bands[chandef->chan->band]; 92d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich rate_flags = ieee80211_chandef_rate_flags(chandef); 93d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich shift = ieee80211_chandef_get_shift(chandef); 94d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich rates_n = 0; 95d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (have_higher_than_11mbit) 96d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich *have_higher_than_11mbit = false; 97d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 982103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (i = 0; i < sband->n_bitrates; i++) { 992103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if ((rate_flags & sband->bitrates[i].flags) != rate_flags) 1002103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 101d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (sband->bitrates[i].bitrate > 110 && 102d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich have_higher_than_11mbit) 103d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich *have_higher_than_11mbit = true; 1042103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 1052103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rates |= BIT(i); 1062103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rates_n++; 1072103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich } 1082103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 109469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SUPP_RATES; 1102103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich *pos++ = min_t(int, 8, rates_n); 1112103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (ri = 0; ri < sband->n_bitrates; ri++) { 1122103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate, 1132103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 5 * (1 << shift)); 114c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg u8 basic = 0; 1152103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (!(rates & BIT(ri))) 1162103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 1172103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 1182103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (basic_rates & BIT(ri)) 119c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg basic = 0x80; 1202103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich *pos++ = basic | (u8) rate; 12193c75786e8d8e8e245a479209a84b19292d08e7eSimon Wunderlich if (++rates_added == 8) { 12293c75786e8d8e8e245a479209a84b19292d08e7eSimon Wunderlich ri++; /* continue at next rate for EXT_SUPP_RATES */ 1232103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich break; 12493c75786e8d8e8e245a479209a84b19292d08e7eSimon Wunderlich } 125c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg } 126469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 127469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->band == IEEE80211_BAND_2GHZ) { 128469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_DS_PARAMS; 129469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 1; 130d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich *pos++ = ieee80211_frequency_to_channel( 131d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef->chan->center_freq); 132469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 133469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 134469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_IBSS_PARAMS; 135469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 2; 136469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* FIX: set ATIM window based on scan results */ 137469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 138469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 139469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 140cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (csa_settings) { 141cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = WLAN_EID_CHANNEL_SWITCH; 142cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = 3; 143cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = csa_settings->block_tx ? 1 : 0; 144cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = ieee80211_frequency_to_channel( 145cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich csa_settings->chandef.chan->center_freq); 146af296bdb8da4d0a4284de10fc4a61497272ddf11Michal Kazior presp->csa_counter_offsets[0] = (pos - presp->head); 147cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = csa_settings->count; 148cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 149cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1502103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich /* put the remaining rates in WLAN_EID_EXT_SUPP_RATES */ 1512103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (rates_n > 8) { 152469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_EXT_SUPP_RATES; 1532103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich *pos++ = rates_n - 8; 1542103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (; ri < sband->n_bitrates; ri++) { 1552103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate, 1562103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 5 * (1 << shift)); 157c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg u8 basic = 0; 1582103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (!(rates & BIT(ri))) 1592103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 1602103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 1612103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (basic_rates & BIT(ri)) 162c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg basic = 0x80; 1632103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich *pos++ = basic | (u8) rate; 164c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg } 165469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 166469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 167c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg if (ifibss->ie_len) { 168c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg memcpy(pos, ifibss->ie, ifibss->ie_len); 169c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg pos += ifibss->ie_len; 170c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg } 171af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 17213c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* add HT capability and information IEs */ 173d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (chandef->width != NL80211_CHAN_WIDTH_20_NOHT && 174d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef->width != NL80211_CHAN_WIDTH_5 && 175d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef->width != NL80211_CHAN_WIDTH_10 && 176683b6d3b31a51956ea540df00abb0b78894924c1Johannes Berg sband->ht_cap.ht_supported) { 177822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich struct ieee80211_sta_ht_cap ht_cap; 178822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 179822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memcpy(&ht_cap, &sband->ht_cap, sizeof(ht_cap)); 180822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich ieee80211_apply_htcap_overrides(sdata, &ht_cap); 181822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 182822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich pos = ieee80211_ie_build_ht_cap(pos, &ht_cap, ht_cap.cap); 1830d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan /* 1840d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan * Note: According to 802.11n-2009 9.13.3.1, HT Protection 1850d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan * field and RIFS Mode are reserved in IBSS mode, therefore 1860d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan * keep them at 0 1870d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan */ 188074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg pos = ieee80211_ie_build_ht_oper(pos, &sband->ht_cap, 189d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef, 0); 19013c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 19113c40c54682ffe62977f670681268a26d500d6faAlexander Simon 19232c5057b22a60b23353dda93c57e475856ca286cJohannes Berg if (local->hw.queues >= IEEE80211_NUM_ACS) { 1939eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = WLAN_EID_VENDOR_SPECIFIC; 1949eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 7; /* len */ 1959eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0x00; /* Microsoft OUI 00:50:F2 */ 1969eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0x50; 1979eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0xf2; 1989eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 2; /* WME */ 1999eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0; /* WME info */ 2009eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 1; /* WME ver */ 2019eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf *pos++ = 0; /* U-APSD no in use */ 2029eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf } 2039eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 204c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg presp->head_len = pos - presp->head; 205c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg if (WARN_ON(presp->head_len > frame_len)) 206d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich goto error; 207d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 208d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return presp; 209d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlicherror: 210d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich kfree(presp); 211d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return NULL; 212d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich} 213d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 214d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlichstatic void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 215d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const u8 *bssid, const int beacon_int, 216b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville struct cfg80211_chan_def *req_chandef, 217d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const u32 basic_rates, 218d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const u16 capability, u64 tsf, 219d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich bool creator) 220d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich{ 221d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 222d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct ieee80211_local *local = sdata->local; 223d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct ieee80211_mgmt *mgmt; 224d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct cfg80211_bss *bss; 225d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich u32 bss_change; 226d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct cfg80211_chan_def chandef; 227b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville struct ieee80211_channel *chan; 228d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct beacon_data *presp; 229d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich enum nl80211_bss_scan_width scan_width; 230d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich bool have_higher_than_11mbit; 2312beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho bool radar_required; 23255fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg int err; 233d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 234d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata_assert_lock(sdata); 235d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 236d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich /* Reset own TSF to allow time synchronization work. */ 237d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich drv_reset_tsf(local, sdata); 238d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 239d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (!ether_addr_equal(ifibss->bssid, bssid)) 240d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sta_info_flush(sdata); 241d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 242d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich /* if merging, indicate to driver that we leave the old IBSS */ 243d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (sdata->vif.bss_conf.ibss_joined) { 244d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.ibss_joined = false; 245d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.ibss_creator = false; 246d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.enable_beacon = false; 247d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich netif_carrier_off(sdata->dev); 248d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich ieee80211_bss_info_change_notify(sdata, 249d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich BSS_CHANGED_IBSS | 250d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich BSS_CHANGED_BEACON_ENABLED); 25155fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg drv_leave_ibss(local, sdata); 252d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 253d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 254d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich presp = rcu_dereference_protected(ifibss->presp, 255d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 2560c2bef4621c5feb5bda9068c9964b2e9acf57017Monam Agarwal RCU_INIT_POINTER(ifibss->presp, NULL); 257d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (presp) 258d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich kfree_rcu(presp, rcu_head); 259d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 260d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0; 261d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 262b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville /* make a copy of the chandef, it could be modified below. */ 263b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville chandef = *req_chandef; 264b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville chan = chandef.chan; 265174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef, 266174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer NL80211_IFTYPE_ADHOC)) { 267d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (chandef.width == NL80211_CHAN_WIDTH_5 || 268d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.width == NL80211_CHAN_WIDTH_10 || 269d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.width == NL80211_CHAN_WIDTH_20_NOHT || 270d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.width == NL80211_CHAN_WIDTH_20) { 271d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata_info(sdata, 272d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich "Failed to join IBSS, beacons forbidden\n"); 273d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return; 274d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 275d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.width = NL80211_CHAN_WIDTH_20; 276d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.center_freq1 = chan->center_freq; 2778e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich /* check again for downgraded chandef */ 278174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef, 279174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer NL80211_IFTYPE_ADHOC)) { 2808e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich sdata_info(sdata, 2818e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich "Failed to join IBSS, beacons forbidden\n"); 2828e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich return; 2838e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich } 2848e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich } 2858e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 2868e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 2872beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho &chandef, NL80211_IFTYPE_ADHOC); 2886658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho if (err < 0) { 2896658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho sdata_info(sdata, 2906658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho "Failed to join IBSS, invalid chandef\n"); 2916658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho return; 2926658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho } 2932beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho if (err > 0 && !ifibss->userspace_handles_dfs) { 2942beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho sdata_info(sdata, 2952beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho "Failed to join IBSS, DFS channel without control program\n"); 2962beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho return; 297d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 298d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 2992beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho radar_required = err; 3002beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho 30134a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 302d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (ieee80211_vif_use_channel(sdata, &chandef, 303d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich ifibss->fixed_channel ? 304d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich IEEE80211_CHANCTX_SHARED : 305d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich IEEE80211_CHANCTX_EXCLUSIVE)) { 306d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata_info(sdata, "Failed to join IBSS, no channel context\n"); 30734a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 308d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return; 309d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 310cc901de1bcb0372583466075bfa62e3049dc6288Michal Kazior sdata->radar_required = radar_required; 31134a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 312d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 313d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich memcpy(ifibss->bssid, bssid, ETH_ALEN); 314d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 315d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich presp = ieee80211_ibss_build_presp(sdata, beacon_int, basic_rates, 316d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich capability, tsf, &chandef, 317cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich &have_higher_than_11mbit, NULL); 318d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (!presp) 319c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg return; 320c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 321c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg rcu_assign_pointer(ifibss->presp, presp); 322d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich mgmt = (void *)presp->head; 323469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 324d6a83228823fc0cc8d79d95c9f0bf568b7317862Johannes Berg sdata->vif.bss_conf.enable_beacon = true; 3252d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg sdata->vif.bss_conf.beacon_int = beacon_int; 326fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->vif.bss_conf.basic_rates = basic_rates; 3270ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak sdata->vif.bss_conf.ssid_len = ifibss->ssid_len; 3280ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak memcpy(sdata->vif.bss_conf.ssid, ifibss->ssid, ifibss->ssid_len); 3292d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change = BSS_CHANGED_BEACON_INT; 3302d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= ieee80211_reset_erp_info(sdata); 3312d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BSSID; 3322d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON; 3332d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON_ENABLED; 334392cfdb10dab6c7dfa5fed18d8a44d7453d42196Teemu Paasikivi bss_change |= BSS_CHANGED_BASIC_RATES; 33513c40c54682ffe62977f670681268a26d500d6faAlexander Simon bss_change |= BSS_CHANGED_HT; 3368fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg bss_change |= BSS_CHANGED_IBSS; 3370ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak bss_change |= BSS_CHANGED_SSID; 3382f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich 3392f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich /* 3402f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * In 5 GHz/802.11a, we can always use short slot time. 3412f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * (IEEE 802.11-2012 18.3.8.7) 3422f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * 3432f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * In 2.4GHz, we must always use long slots in IBSS for compatibility 3442f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * reasons. 3452f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * (IEEE 802.11-2012 19.4.5) 3462f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * 3472f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * HT follows these specifications (IEEE 802.11-2012 20.3.18) 3482f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich */ 3492f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich sdata->vif.bss_conf.use_short_slot = chan->band == IEEE80211_BAND_5GHZ; 3502f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich bss_change |= BSS_CHANGED_ERP_SLOT; 3512f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich 3522ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich /* cf. IEEE 802.11 9.2.12 */ 3532ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich if (chan->band == IEEE80211_BAND_2GHZ && have_higher_than_11mbit) 3542ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich sdata->flags |= IEEE80211_SDATA_OPERATING_GMODE; 3552ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich else 3562ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich sdata->flags &= ~IEEE80211_SDATA_OPERATING_GMODE; 3572ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich 35855fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_set_wmm_default(sdata, true); 35955fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg 3608fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg sdata->vif.bss_conf.ibss_joined = true; 361c13a765bd96f4e2f52d218ee6e5c0715380eeeb8Sujith Manoharan sdata->vif.bss_conf.ibss_creator = creator; 362469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 36355fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg err = drv_join_ibss(local, sdata); 36455fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg if (err) { 36555fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ibss_joined = false; 36655fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ibss_creator = false; 36755fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.enable_beacon = false; 36855fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ssid_len = 0; 36955fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg RCU_INIT_POINTER(ifibss->presp, NULL); 37055fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg kfree_rcu(presp, rcu_head); 37134a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 37255fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_vif_release_channel(sdata); 37334a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 37455fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata_info(sdata, "Failed to join IBSS, driver failure: %d\n", 37555fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg err); 37655fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg return; 37755fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg } 37855fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg 37955fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_bss_info_change_notify(sdata, bss_change); 380469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 381469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 382af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 383af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3857ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chandef); 3867ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich bss = cfg80211_inform_bss_width_frame(local->hw.wiphy, chan, 3877ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width, mgmt, 3887ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich presp->head_len, 0, GFP_KERNEL); 3895b112d3d098c97b867cc580f590395cd1e72f18cJohannes Berg cfg80211_put_bss(local->hw.wiphy, bss); 39086a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_on(sdata->dev); 391fe94f3a4ffaa20c7470038c69ffc8e545ef5f90aAntonio Quartulli cfg80211_ibss_joined(sdata->dev, ifibss->bssid, chan, GFP_KERNEL); 392469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 393469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 394af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 395af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_bss *bss) 396469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 3970c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss = 3980c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg container_of((void *)bss, struct cfg80211_bss, priv); 399b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg struct ieee80211_supported_band *sband; 40075a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich struct cfg80211_chan_def chandef; 401b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u32 basic_rates; 402b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int i, j; 4030c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg u16 beacon_int = cbss->beacon_interval; 4048cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg const struct cfg80211_bss_ies *ies; 40575a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich enum nl80211_channel_type chan_type; 4068cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg u64 tsf; 4072103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich u32 rate_flags; 4082103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int shift; 40957c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 4108d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 4117a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 41257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg if (beacon_int < 10) 41357c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int = 10; 41457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 41575a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich switch (sdata->u.ibss.chandef.width) { 41675a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 41775a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_20: 41875a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_40: 41975a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich chan_type = cfg80211_get_chandef_type(&sdata->u.ibss.chandef); 42075a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, chan_type); 42175a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 42275a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_5: 42375a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_10: 42475a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, 42575a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich NL80211_CHAN_WIDTH_20_NOHT); 42675a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich chandef.width = sdata->u.ibss.chandef.width; 42775a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 42875a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich default: 42975a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich /* fall back to 20 MHz for unsupported modes */ 43075a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, 43175a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich NL80211_CHAN_WIDTH_20_NOHT); 43275a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 43375a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich } 43475a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich 4350c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sband = sdata->local->hw.wiphy->bands[cbss->channel->band]; 4362103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rate_flags = ieee80211_chandef_rate_flags(&sdata->u.ibss.chandef); 4372103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich shift = ieee80211_vif_get_shift(&sdata->vif); 438b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 439b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates = 0; 440b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 441b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < bss->supp_rates_len; i++) { 4422103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rate = bss->supp_rates[i] & 0x7f; 443b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg bool is_basic = !!(bss->supp_rates[i] & 0x80); 444b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 445b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (j = 0; j < sband->n_bitrates; j++) { 4462103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int brate; 4472103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if ((rate_flags & sband->bitrates[j].flags) 4482103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich != rate_flags) 4492103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 4502103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 4512103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich brate = DIV_ROUND_UP(sband->bitrates[j].bitrate, 4522103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 5 * (1 << shift)); 4532103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (brate == rate) { 454b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (is_basic) 455b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates |= BIT(j); 456b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg break; 457b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 458b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 459b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 460b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 4618cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg rcu_read_lock(); 4628cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg ies = rcu_dereference(cbss->ies); 4638cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg tsf = ies->tsf; 4648cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg rcu_read_unlock(); 4658cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg 4660c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg __ieee80211_sta_join_ibss(sdata, cbss->bssid, 46757c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int, 46875a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich &chandef, 469b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates, 4700c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->capability, 4718cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg tsf, false); 472469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 473469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 474cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichint ieee80211_ibss_csa_beacon(struct ieee80211_sub_if_data *sdata, 475cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_csa_settings *csa_settings) 476cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 477cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 478cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct beacon_data *presp, *old_presp; 479cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_bss *cbss; 480cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich const struct cfg80211_bss_ies *ies; 481cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u16 capability; 482cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u64 tsf; 483cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int ret = 0; 484cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 485cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_assert_lock(sdata); 486cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 487cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability = WLAN_CAPABILITY_IBSS; 488cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 489cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ifibss->privacy) 490cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 491cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 492cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cbss = cfg80211_get_bss(sdata->local->hw.wiphy, ifibss->chandef.chan, 493cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, ifibss->ssid, 494cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 495cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_CAPABILITY_PRIVACY, 496cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability); 497cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 498cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (WARN_ON(!cbss)) { 499cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ret = -EINVAL; 500cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto out; 501cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 502cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 503cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_read_lock(); 504cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies = rcu_dereference(cbss->ies); 505cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich tsf = ies->tsf; 506cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_read_unlock(); 507cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 508cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 509cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich old_presp = rcu_dereference_protected(ifibss->presp, 510cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 511cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 512cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich presp = ieee80211_ibss_build_presp(sdata, 513cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata->vif.bss_conf.beacon_int, 514cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata->vif.bss_conf.basic_rates, 515cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability, tsf, &ifibss->chandef, 516cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich NULL, csa_settings); 517cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (!presp) { 518cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ret = -ENOMEM; 519cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto out; 520cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 521cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 522cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_assign_pointer(ifibss->presp, presp); 523cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (old_presp) 524cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich kfree_rcu(old_presp, rcu_head); 525cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 526dddd586bee9325e890a671f8e24ae39418338295Luciano Coelho return BSS_CHANGED_BEACON; 527cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich out: 528cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return ret; 529cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 530cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 531cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichint ieee80211_ibss_finish_csa(struct ieee80211_sub_if_data *sdata) 532cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 533cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 534cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_bss *cbss; 535faf046e7231bf008715bbffe5cca2ed3aa31be1bMichal Kazior int err, changed = 0; 536cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u16 capability; 537cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 538bafdc614a1f4f8be8cde41b8ab10ac17e67c1837Simon Wunderlich sdata_assert_lock(sdata); 539bafdc614a1f4f8be8cde41b8ab10ac17e67c1837Simon Wunderlich 540cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* update cfg80211 bss information with the new channel */ 541cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (!is_zero_ether_addr(ifibss->bssid)) { 542cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability = WLAN_CAPABILITY_IBSS; 543cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 544cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ifibss->privacy) 545cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 546cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 547cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cbss = cfg80211_get_bss(sdata->local->hw.wiphy, 548cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->chandef.chan, 549cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, ifibss->ssid, 550cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 551cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_CAPABILITY_PRIVACY, 552cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability); 553cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* XXX: should not really modify cfg80211 data */ 554cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (cbss) { 55533787fc4bea0347d78a211d1f38289b73d9ec1a6Luciano Coelho cbss->channel = sdata->csa_chandef.chan; 556cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 557cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 558cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 559cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 56033787fc4bea0347d78a211d1f38289b73d9ec1a6Luciano Coelho ifibss->chandef = sdata->csa_chandef; 561cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 562cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* generate the beacon */ 563cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich err = ieee80211_ibss_csa_beacon(sdata, NULL); 564cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 565cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return err; 566cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 567faf046e7231bf008715bbffe5cca2ed3aa31be1bMichal Kazior changed |= err; 568dddd586bee9325e890a671f8e24ae39418338295Luciano Coelho 569faf046e7231bf008715bbffe5cca2ed3aa31be1bMichal Kazior return changed; 570cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 571cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 572cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichvoid ieee80211_ibss_stop(struct ieee80211_sub_if_data *sdata) 573cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 574cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 575cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 576cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cancel_work_sync(&ifibss->csa_connection_drop_work); 577cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 578cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 57952874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartullistatic struct sta_info *ieee80211_ibss_finish_sta(struct sta_info *sta) 5808bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 5818bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 5828bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 5838bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u8 addr[ETH_ALEN]; 5848bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 5858bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg memcpy(addr, sta->sta.addr, ETH_ALEN); 5868bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 587bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "Adding new IBSS station %pM\n", addr); 5888bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 58983d5cc012441531ab0bf6f99881958e964e9cf11Johannes Berg sta_info_pre_move_state(sta, IEEE80211_STA_AUTH); 59083d5cc012441531ab0bf6f99881958e964e9cf11Johannes Berg sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC); 591267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli /* authorize the station only if the network is not RSN protected. If 592267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli * not wait for the userspace to authorize it */ 593267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli if (!sta->sdata->u.ibss.control_port) 594267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED); 5958bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 5968bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rate_control_rate_init(sta); 5978bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 5988bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* If it fails, maybe we raced another insertion? */ 5998bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (sta_info_insert_rcu(sta)) 6008bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta_info_get(sdata, addr); 6018bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta; 6028bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 6038bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6048bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergstatic struct sta_info * 60552874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulliieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, const u8 *bssid, 60652874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli const u8 *addr, u32 supp_rates) 6078bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 6088bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 6098bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 6108bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_local *local = sdata->local; 6118bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 61255de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg struct ieee80211_chanctx_conf *chanctx_conf; 613b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan struct ieee80211_supported_band *sband; 61474608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 61555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg int band; 6168bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6178bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* 6188bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * XXX: Consider removing the least recently used entry and 6198bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * allow new one to be added. 6208bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg */ 6218bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 622bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n", 623e87cc4728f0e2fb663e592a1141742b1d6c63256Joe Perches sdata->name, addr); 6248bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6258bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6268bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6278bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6288bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) { 6298bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6308bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6318bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6328bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 633b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) { 6348bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6358bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6368bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6378bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 63855de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_lock(); 63955de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 64055de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (WARN_ON_ONCE(!chanctx_conf)) 64155de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg return NULL; 6424bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg band = chanctx_conf->def.chan->band; 64374608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chanctx_conf->def); 64455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 64555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg 6468bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_KERNEL); 6478bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (!sta) { 6488bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6498bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6508bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6518bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6528bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->last_rx = jiffies; 6538bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6548bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* make sure mandatory rates are always added */ 655b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan sband = local->hw.wiphy->bands[band]; 6568bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->sta.supp_rates[band] = supp_rates | 65774608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, scan_width); 6588bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 65952874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli return ieee80211_ibss_finish_sta(sta); 6606d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli} 6616d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 662871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlichstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 663871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich{ 664871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_local *local = sdata->local; 665871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich int active = 0; 666871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info *sta; 667871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 668871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata_assert_lock(sdata); 669871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 670871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich rcu_read_lock(); 671871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 672871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich list_for_each_entry_rcu(sta, &local->sta_list, list) { 673871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (sta->sdata == sdata && 674871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 675871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich jiffies)) { 676871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich active++; 677871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich break; 678871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 679871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 680871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 681871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich rcu_read_unlock(); 682871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 683871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich return active; 684871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich} 685871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 686871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlichstatic void ieee80211_ibss_disconnect(struct ieee80211_sub_if_data *sdata) 687871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich{ 688871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 689871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_local *local = sdata->local; 690871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct cfg80211_bss *cbss; 691871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct beacon_data *presp; 692871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info *sta; 693871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich u16 capability; 694871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 695d4c80d9df6d1e4473b1409e4d220ca3d1612125cSujith Manoharan if (!is_zero_ether_addr(ifibss->bssid)) { 696871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability = WLAN_CAPABILITY_IBSS; 697871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 698871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (ifibss->privacy) 699871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 700871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 701871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cbss = cfg80211_get_bss(local->hw.wiphy, ifibss->chandef.chan, 702871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->bssid, ifibss->ssid, 703871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 704871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich WLAN_CAPABILITY_PRIVACY, 705871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability); 706871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 707871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (cbss) { 708871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cfg80211_unlink_bss(local->hw.wiphy, cbss); 709871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 710871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 711871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 712871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 713871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->state = IEEE80211_IBSS_MLME_SEARCH; 714871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 715871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta_info_flush(sdata); 716871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 717871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_lock_bh(&ifibss->incomplete_lock); 718871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich while (!list_empty(&ifibss->incomplete_stations)) { 719871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta = list_first_entry(&ifibss->incomplete_stations, 720871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info, list); 721871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich list_del(&sta->list); 722871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_unlock_bh(&ifibss->incomplete_lock); 723871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 724871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta_info_free(local, sta); 725871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_lock_bh(&ifibss->incomplete_lock); 726871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 727871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_unlock_bh(&ifibss->incomplete_lock); 728871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 729871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich netif_carrier_off(sdata->dev); 730871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 731871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ibss_joined = false; 732871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ibss_creator = false; 733871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.enable_beacon = false; 734871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ssid_len = 0; 735871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 736871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich /* remove beacon */ 737871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich presp = rcu_dereference_protected(ifibss->presp, 738871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 739871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich RCU_INIT_POINTER(sdata->u.ibss.presp, NULL); 740871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (presp) 741871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich kfree_rcu(presp, rcu_head); 742871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 743871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state); 744871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED | 745871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich BSS_CHANGED_IBSS); 74655fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg drv_leave_ibss(local, sdata); 74734a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 748871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_vif_release_channel(sdata); 74934a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 750871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich} 751871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 752cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic void ieee80211_csa_connection_drop_work(struct work_struct *work) 753cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 754cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_sub_if_data *sdata = 755cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich container_of(work, struct ieee80211_sub_if_data, 756cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u.ibss.csa_connection_drop_work); 757cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 7586f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho sdata_lock(sdata); 7596f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho 760cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_ibss_disconnect(sdata); 761cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich synchronize_rcu(); 762cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich skb_queue_purge(&sdata->skb_queue); 763cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 764cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* trigger a scan to find another IBSS network to join */ 765cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_queue_work(&sdata->local->hw, &sdata->work); 7666f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho 7676f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho sdata_unlock(sdata); 768cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 769cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 7708e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlichstatic void ieee80211_ibss_csa_mark_radar(struct ieee80211_sub_if_data *sdata) 7718e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich{ 7728e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 7738e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich int err; 7748e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 7758e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich /* if the current channel is a DFS channel, mark the channel as 7768e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich * unavailable. 7778e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich */ 7788e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 7792beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho &ifibss->chandef, 7802beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho NL80211_IFTYPE_ADHOC); 7818e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich if (err > 0) 7828e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich cfg80211_radar_event(sdata->local->hw.wiphy, &ifibss->chandef, 7838e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich GFP_ATOMIC); 7848e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich} 7858e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 786cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic bool 787cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichieee80211_ibss_process_chanswitch(struct ieee80211_sub_if_data *sdata, 788cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems *elems, 789cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich bool beacon) 790cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 791cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_csa_settings params; 792c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh struct ieee80211_csa_ie csa_ie; 793cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 794cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich enum nl80211_channel_type ch_type; 79582a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho int err; 796cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u32 sta_flags; 797cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 798dbd72850dcc9738b42a9762ef8c4a1a66b30d897Michal Kazior sdata_assert_lock(sdata); 799dbd72850dcc9738b42a9762ef8c4a1a66b30d897Michal Kazior 800cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags = IEEE80211_STA_DISABLE_VHT; 801cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (ifibss->chandef.width) { 802cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_5: 803cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_10: 804cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 805cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags |= IEEE80211_STA_DISABLE_HT; 806cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* fall through */ 807cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20: 808cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags |= IEEE80211_STA_DISABLE_40MHZ; 809cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 810cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich default: 811cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 812cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 813cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 814cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich memset(¶ms, 0, sizeof(params)); 815c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh memset(&csa_ie, 0, sizeof(csa_ie)); 816cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich err = ieee80211_parse_ch_switch_ie(sdata, elems, beacon, 817cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->chandef.chan->band, 818c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh sta_flags, ifibss->bssid, &csa_ie); 819cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* can't switch to destination channel, fail */ 820cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 821cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 822cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 823cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* did not contain a CSA */ 824cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err) 825cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return false; 826cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 8270834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich /* channel switch is not supported, disconnect */ 8280834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich if (!(sdata->local->hw.wiphy->flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 8290834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich goto disconnect; 8300834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich 831c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.count = csa_ie.count; 832c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.chandef = csa_ie.chandef; 833c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh 834cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (ifibss->chandef.width) { 835cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 836cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20: 837cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_40: 838cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* keep our current HT mode (HT20/HT40+/HT40-), even if 839cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * another mode has been announced. The mode is not adopted 840cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * within the beacon while doing CSA and we should therefore 841cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * keep the mode which we announce. 842cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich */ 843cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ch_type = cfg80211_get_chandef_type(&ifibss->chandef); 844cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_chandef_create(¶ms.chandef, params.chandef.chan, 845cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ch_type); 846cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 847cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_5: 848cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_10: 849cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (params.chandef.width != ifibss->chandef.width) { 850cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_info(sdata, 851cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "IBSS %pM received channel switch from incompatible channel width (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n", 852cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, 853cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq, 854cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.width, 855cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq1, 856cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq2); 857cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 858cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 859cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 860cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich default: 861cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* should not happen, sta_flags should prevent VHT modes. */ 862cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WARN_ON(1); 863cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 864cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 865cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 866174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer if (!cfg80211_reg_can_beacon(sdata->local->hw.wiphy, ¶ms.chandef, 867174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer NL80211_IFTYPE_ADHOC)) { 868cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_info(sdata, 869cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "IBSS %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n", 870cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, 871cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq, 872cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.width, 873cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq1, 874cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq2); 875cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 876cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 877cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 878cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 8792beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho ¶ms.chandef, 8802beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho NL80211_IFTYPE_ADHOC); 881cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 882cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 8832beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho if (err > 0 && !ifibss->userspace_handles_dfs) { 8848e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich /* IBSS-DFS only allowed with a control program */ 8852beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho goto disconnect; 886cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 887cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 8882beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho params.radar_required = err; 8892beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho 89082a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (cfg80211_chandef_identical(¶ms.chandef, 89182a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho &sdata->vif.bss_conf.chandef)) { 89282a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ibss_dbg(sdata, 89382a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho "received csa with an identical chandef, ignoring\n"); 89482a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho return true; 895cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 896cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 897cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* all checks done, now perform the channel switch. */ 898cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ibss_dbg(sdata, 899cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "received channel switch announcement to go to channel %d MHz\n", 900cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq); 901cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 902c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.block_tx = !!csa_ie.mode; 903cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 90482a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (ieee80211_channel_switch(sdata->local->hw.wiphy, sdata->dev, 90582a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ¶ms)) 90682a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho goto disconnect; 907cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9088e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich ieee80211_ibss_csa_mark_radar(sdata); 9098e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 910cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return true; 911cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichdisconnect: 912cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ibss_dbg(sdata, "Can't handle channel switch, disconnect\n"); 913cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_queue_work(&sdata->local->hw, 914cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich &ifibss->csa_connection_drop_work); 915cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9168e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich ieee80211_ibss_csa_mark_radar(sdata); 9178e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 918cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return true; 919cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 920cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 921cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic void 922cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichieee80211_rx_mgmt_spectrum_mgmt(struct ieee80211_sub_if_data *sdata, 923cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_mgmt *mgmt, size_t len, 924cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_rx_status *rx_status, 925cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems *elems) 926cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 927cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int required_len; 928cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 929cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (len < IEEE80211_MIN_ACTION_SIZE + 1) 930cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 931cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 932cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* CSA is the only action we handle for now */ 933cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (mgmt->u.action.u.measurement.action_code != 934cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_ACTION_SPCT_CHL_SWITCH) 935cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 936cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 937cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich required_len = IEEE80211_MIN_ACTION_SIZE + 938cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sizeof(mgmt->u.action.u.chan_switch); 939cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (len < required_len) 940cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 941cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 94282a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (!sdata->vif.csa_active) 94382a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ieee80211_ibss_process_chanswitch(sdata, elems, false); 944cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 945cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9462cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartullistatic void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data *sdata, 9472cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli struct ieee80211_mgmt *mgmt, 9482cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli size_t len) 9492cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli{ 9502cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli u16 reason = le16_to_cpu(mgmt->u.deauth.reason_code); 9512cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9522cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli if (len < IEEE80211_DEAUTH_FRAME_LEN) 9532cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli return; 9542cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9552cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli ibss_dbg(sdata, "RX DeAuth SA=%pM DA=%pM BSSID=%pM (reason: %d)\n", 9562cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli mgmt->sa, mgmt->da, mgmt->bssid, reason); 9572cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli sta_info_destroy_addr(sdata, mgmt->sa); 9582cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli} 9592cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9606d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartullistatic void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata, 9616d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli struct ieee80211_mgmt *mgmt, 9626d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli size_t len) 9636d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli{ 9646d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli u16 auth_alg, auth_transaction; 9656d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9668d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 9676d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9686d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (len < 24 + 6) 9696d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return; 9706d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9716d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); 9726d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); 9736d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 974bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 975bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n", 976bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->da, mgmt->bssid, auth_transaction); 9777bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli 9787bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1) 9797bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli return; 9807bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli 9812cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli /* 9826d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * IEEE 802.11 standard does not require authentication in IBSS 9836d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * networks and most implementations do not seem to use it. 9846d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * However, try to reply to authentication attempts if someone 9856d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * has actually implemented this. 9866d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli */ 987700e8ea6770df3113e735bcc76ecd6ffac71a13cJouni Malinen ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, 0, NULL, 0, 9881672c0e31917f49d31d30d79067103432bc20cc7Johannes Berg mgmt->sa, sdata->u.ibss.bssid, NULL, 0, 0, 0); 9898bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 9908bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 991469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 992d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_mgmt *mgmt, size_t len, 993469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 994d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee802_11_elems *elems) 995469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 996469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 9970c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 998469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 999469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 1000469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 1001469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 1002469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 1003469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 100474608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 100513c40c54682ffe62977f670681268a26d500d6faAlexander Simon struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band]; 100613c40c54682ffe62977f670681268a26d500d6faAlexander Simon bool rates_updated = false; 1007469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10083afc2167f60a327a2c1e1e2600ef209a3c2b75b7Emmanuel Grumbach channel = ieee80211_get_channel(local->hw.wiphy, rx_status->freq); 10093afc2167f60a327a2c1e1e2600ef209a3c2b75b7Emmanuel Grumbach if (!channel) 1010469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1011469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10129eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sdata->vif.type == NL80211_IFTYPE_ADHOC && 1013b203ca39126bad99583c908be587df067820a1eaJoe Perches ether_addr_equal(mgmt->bssid, sdata->u.ibss.bssid)) { 1014469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1015469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 1016abe60632f311d515b082b450504ee24006023951Johannes Berg sta = sta_info_get(sdata, mgmt->sa); 1017469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10189eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (elems->supp_rates) { 10192103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich supp_rates = ieee80211_sta_get_rates(sdata, elems, 10209ebb61a23d90703344fc609fbee8da67b1e7456cAshok Nagarajan band, NULL); 10219eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta) { 10229eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf u32 prev_rates; 10239eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 10249eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf prev_rates = sta->sta.supp_rates[band]; 10259eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf /* make sure mandatory rates are always added */ 102674608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_20; 102774608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich if (rx_status->flag & RX_FLAG_5MHZ) 102874608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_5; 102974608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich if (rx_status->flag & RX_FLAG_10MHZ) 103074608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_10; 1031469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 103274608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich sta->sta.supp_rates[band] = supp_rates | 103374608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, 103474608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width); 10359eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta->sta.supp_rates[band] != prev_rates) { 1036bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1037bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "updated supp_rates set for %pM based on beacon/probe_resp (0x%x -> 0x%x)\n", 1038bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sta->sta.addr, prev_rates, 1039bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sta->sta.supp_rates[band]); 104013c40c54682ffe62977f670681268a26d500d6faAlexander Simon rates_updated = true; 10419eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf } 10428bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } else { 10438bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 10449eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid, 104552874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli mgmt->sa, supp_rates); 10468bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 104734e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg } 10489eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 10499eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta && elems->wmm_info) 1050c2c98fdeb5c897499644eb247285c8e3dacc6450Johannes Berg set_sta_flag(sta, WLAN_STA_WME); 10519eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 1052074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg if (sta && elems->ht_operation && elems->ht_cap_elem && 10533aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 10543aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_5 && 10553aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_10) { 105613c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* we both use HT */ 1057e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg struct ieee80211_ht_cap htcap_ie; 10584bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg struct cfg80211_chan_def chandef; 10594bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg 10604bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg ieee80211_ht_oper_to_chandef(channel, 10614bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg elems->ht_operation, 10624bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg &chandef); 106313c40c54682ffe62977f670681268a26d500d6faAlexander Simon 1064e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg memcpy(&htcap_ie, elems->ht_cap_elem, sizeof(htcap_ie)); 106513c40c54682ffe62977f670681268a26d500d6faAlexander Simon 106613c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* 106713c40c54682ffe62977f670681268a26d500d6faAlexander Simon * fall back to HT20 if we don't use or use 106813c40c54682ffe62977f670681268a26d500d6faAlexander Simon * the other extension channel 106913c40c54682ffe62977f670681268a26d500d6faAlexander Simon */ 10703aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich if (chandef.center_freq1 != 10713aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.center_freq1) 1072e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg htcap_ie.cap_info &= 1073e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg cpu_to_le16(~IEEE80211_HT_CAP_SUP_WIDTH_20_40); 1074e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg 1075e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg rates_updated |= ieee80211_ht_cap_ie_to_sta_ht_cap( 1076e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg sdata, sband, &htcap_ie, sta); 107713c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 107813c40c54682ffe62977f670681268a26d500d6faAlexander Simon 1079e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli if (sta && rates_updated) { 1080e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli drv_sta_rc_update(local, sdata, &sta->sta, 1081e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli IEEE80211_RC_SUPP_RATES_CHANGED); 108213c40c54682ffe62977f670681268a26d500d6faAlexander Simon rate_control_rate_init(sta); 1083e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli } 108413c40c54682ffe62977f670681268a26d500d6faAlexander Simon 10859eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf rcu_read_unlock(); 1086469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1087469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1088469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 1089d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach channel); 1090469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 1091469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1092469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10930c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = container_of((void *)bss, struct cfg80211_bss, priv); 10940c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 10958cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg /* same for beacon and probe response */ 10968cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg beacon_timestamp = le64_to_cpu(mgmt->u.beacon.timestamp); 1097469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1098469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 1099469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1100469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 11010c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (!(cbss->capability & WLAN_CAPABILITY_IBSS)) 1102469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1103469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1104469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 110555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (sdata->u.ibss.fixed_channel && 11063aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.chan != cbss->channel) 1107469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1108469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1109469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 1110469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 1111469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 1112469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 1113469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1114469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1115cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* process channel switch */ 111682a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (sdata->vif.csa_active || 111782a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ieee80211_ibss_process_chanswitch(sdata, elems, true)) 1118cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto put_bss; 1119cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 112034e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 1121b203ca39126bad99583c908be587df067820a1eaJoe Perches if (ether_addr_equal(cbss->bssid, sdata->u.ibss.bssid)) 112234e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 112334e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 1124cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* we use a fixed BSSID */ 1125cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (sdata->u.ibss.fixed_bssid) 1126cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto put_bss; 1127cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1128f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen if (ieee80211_have_rx_timestamp(rx_status)) { 1129f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen /* time when timestamp field was received */ 1130f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen rx_timestamp = 1131f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen ieee80211_calculate_rx_timestamp(local, rx_status, 1132f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen len + FCS_LEN, 24); 11332448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } else { 11342448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* 11352448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * second best option: get current TSF 11362448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * (will return -1 if not supported) 11372448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg */ 113837a41b4affa33bb237d3692bf51f1b5ebcaf29d8Eliad Peller rx_timestamp = drv_get_tsf(local, sdata); 11392448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } 1140469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1141bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1142bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 1143bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->bssid, 1144bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)rx_timestamp, 1145bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)beacon_timestamp, 1146bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 1147bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg jiffies); 1148469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1149469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 1150bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1151bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n", 1152bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->bssid); 1153469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 11542103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich supp_rates = ieee80211_sta_get_rates(sdata, elems, band, NULL); 115534e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 115652874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli supp_rates); 11578bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 1158469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1159469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1160469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 1161469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 1162469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1163469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 11648bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergvoid ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data *sdata, 11658bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg const u8 *bssid, const u8 *addr, 11668bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u32 supp_rates) 1167469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 11682e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1169469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 1170469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 117155de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg struct ieee80211_chanctx_conf *chanctx_conf; 1172b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan struct ieee80211_supported_band *sband; 117374608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 117455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg int band; 1175469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1176af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 1177af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 1178af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 1179af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 1180469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 1181bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n", 1182e87cc4728f0e2fb663e592a1141742b1d6c63256Joe Perches sdata->name, addr); 11838bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1184469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1185469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 11862e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) 11878bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 11882e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau 1189b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) 11908bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1191469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 119255de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_lock(); 119355de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 119455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (WARN_ON_ONCE(!chanctx_conf)) { 119555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 119655de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg return; 119755de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg } 11984bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg band = chanctx_conf->def.chan->band; 119974608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chanctx_conf->def); 120055de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 120155de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg 12028bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 1203469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 12048bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1205469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1206c8716d9dc13c7f6ee92f2bfc6cc3b723b417bff8Rajkumar Manoharan sta->last_rx = jiffies; 1207d9a7ddb05e5419ca5e4b54f57074dc33c7ea991cJohannes Berg 1208469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 1209b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan sband = local->hw.wiphy->bands[band]; 1210469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 121174608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, scan_width); 1212469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12138bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock(&ifibss->incomplete_lock); 12148bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_add(&sta->list, &ifibss->incomplete_stations); 12158bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock(&ifibss->incomplete_lock); 12168bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 1217469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1218469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1219dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartullistatic void ieee80211_ibss_sta_expire(struct ieee80211_sub_if_data *sdata) 1220dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli{ 1221dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli struct ieee80211_local *local = sdata->local; 1222dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli struct sta_info *sta, *tmp; 1223dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli unsigned long exp_time = IEEE80211_IBSS_INACTIVITY_LIMIT; 1224dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli unsigned long exp_rsn_time = IEEE80211_IBSS_RSN_INACTIVITY_LIMIT; 1225dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1226dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli mutex_lock(&local->sta_mtx); 1227dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1228dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli list_for_each_entry_safe(sta, tmp, &local->sta_list, list) { 1229dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli if (sdata != sta->sdata) 1230dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli continue; 1231dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1232dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli if (time_after(jiffies, sta->last_rx + exp_time) || 1233dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli (time_after(jiffies, sta->last_rx + exp_rsn_time) && 1234dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta->sta_state != IEEE80211_STA_AUTHORIZED)) { 1235dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta_dbg(sta->sdata, "expiring inactive %sSTA %pM\n", 1236dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta->sta_state != IEEE80211_STA_AUTHORIZED ? 1237dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli "not authorized " : "", sta->sta.addr); 1238dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1239dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli WARN_ON(__sta_info_destroy(sta)); 1240dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli } 1241dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli } 1242dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1243dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli mutex_unlock(&local->sta_mtx); 1244dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli} 1245dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1246ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 1247ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_JOINED 1248ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 1249469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1250469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 1251469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1252469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 12537ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 1254469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12558d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 12567a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1257af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 1258af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 1259469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1260dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli ieee80211_ibss_sta_expire(sdata); 1261af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1262450aae3d7b60a970f266349a837dfb30a539198bSujith if (time_before(jiffies, ifibss->last_scan_completed + 1263450aae3d7b60a970f266349a837dfb30a539198bSujith IEEE80211_IBSS_MERGE_INTERVAL)) 1264450aae3d7b60a970f266349a837dfb30a539198bSujith return; 1265450aae3d7b60a970f266349a837dfb30a539198bSujith 1266469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 1267469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1268469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1269c037b8367c7e2b775a99d74037f5df014d2fbf06John W. Linville if (ifibss->fixed_channel) 1270469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1271469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1272bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, 1273bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n"); 1274469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12757ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&ifibss->chandef); 127634bcf71502413f8903ade93746f2d0f04b937a78Stanislaw Gruszka ieee80211_request_ibss_scan(sdata, ifibss->ssid, ifibss->ssid_len, 12777ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich NULL, scan_width); 1278469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1279469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1280af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 1281469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1282469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1283469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 1284469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 1285469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 1286469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12878d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 12887a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1289af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 1290469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 1291469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 1292469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 1293469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 1294469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 1295469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 1296469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 129747846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg bssid[i] ^= sdata->vif.addr[i]; 1298469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 1299469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 1300469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1301469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1302bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, "Creating new IBSS network, BSSID %pM\n", bssid); 1303469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1304469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 1305469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1306fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 1307469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 1308469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 1309469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 1310469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 131157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int, 131275a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich &ifibss->chandef, ifibss->basic_rates, 1313c13a765bd96f4e2f52d218ee6e5c0715380eeeb8Sujith Manoharan capability, 0, true); 1314469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1315469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1316ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 1317ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_SEARCH 1318ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 1319ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault 1320af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 1321469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1322469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1323469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 13240c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 1325af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 1326469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 13277ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 1328469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 1329e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg u16 capability; 1330469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13318d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 13327a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1333469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 1334bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "sta_find_ibss (active_ibss=%d)\n", active_ibss); 1335469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1336469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 1337af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 1338469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1339e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability = WLAN_CAPABILITY_IBSS; 1340fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 1341e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 1342af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 1343af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 1344af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 13453aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich chan = ifibss->chandef.chan; 1346af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 1347469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 13480c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid, 13490c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg ifibss->ssid, ifibss->ssid_len, 13500c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY, 13510c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg capability); 13520c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 13530c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss) { 13540c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct ieee80211_bss *bss; 1355469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13560c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg bss = (void *)cbss->priv; 1357bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1358bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "sta_find_ibss: selected %pM current %pM\n", 1359bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg cbss->bssid, ifibss->bssid); 1360bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, 1361bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "Selected IBSS BSSID %pM based on configured SSID\n", 1362bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg cbss->bssid); 1363469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1364af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 1365469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 1366af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 1367d419b9f0fa69e79ccba3e5e79a58a52ae0c2ed6aReinette Chatre } 1368469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1369d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli /* if a fixed bssid and a fixed freq have been provided create the IBSS 1370d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli * directly and do not waste time scanning 1371d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli */ 1372d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli if (ifibss->fixed_bssid && ifibss->fixed_channel) { 1373d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli sdata_info(sdata, "Created IBSS using preconfigured BSSID %pM\n", 1374d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli bssid); 1375d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli ieee80211_sta_create_ibss(sdata); 1376d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli return; 1377d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli } 1378d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli 1379d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli 1380bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "sta_find_ibss: did not try to join ibss\n"); 1381469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1382469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 1383ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault if (time_after(jiffies, ifibss->last_scan_completed + 1384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 1385bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, "Trigger new scan to find an IBSS to join\n"); 1386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13877ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&ifibss->chandef); 138834bcf71502413f8903ade93746f2d0f04b937a78Stanislaw Gruszka ieee80211_request_ibss_scan(sdata, ifibss->ssid, 13897ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich ifibss->ssid_len, chan, 13907ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width); 1391ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault } else { 1392469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 1393469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1394469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 139555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) 139655de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg ieee80211_sta_create_ibss(sdata); 1397469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1398af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 1399af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 1400469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1401469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1402469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1403469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 1404c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct sk_buff *req) 1405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1406c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct ieee80211_mgmt *mgmt = (void *)req->data; 1407469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1408469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 1409c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg int tx_last_beacon, len = req->len; 1410469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 1411c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg struct beacon_data *presp; 1412469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 1413469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14148d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 14157a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 141640b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg presp = rcu_dereference_protected(ifibss->presp, 14178d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg lockdep_is_held(&sdata->wdev.mtx)); 141840b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg 1419469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 142040b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg len < 24 + 2 || !presp) 1421469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1422469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14232448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg tx_last_beacon = drv_tx_last_beacon(local); 1424469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1425bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1426bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n", 1427bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->da, mgmt->bssid, tx_last_beacon); 1428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14291ed76487ce115110171480deabd3cd4656f9803eFelix Fietkau if (!tx_last_beacon && is_multicast_ether_addr(mgmt->da)) 1430469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1431469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1432b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(mgmt->bssid, ifibss->bssid) && 1433888d04dfbe7e09f930fdaafb257cce2c54c9c3f3Felix Fietkau !is_broadcast_ether_addr(mgmt->bssid)) 1434469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1435469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1436469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 1437469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 1438469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 1439469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 1440bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "Invalid SSID IE in ProbeReq from %pM\n", 1441bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa); 1442469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1443469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1444469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 1445469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 14460da780c269957783d341fc3559e6b4c9912af7b4Benoit Papillault memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 1447469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 1448469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1449469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1450469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1451469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 1452c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg skb = dev_alloc_skb(local->tx_headroom + presp->head_len); 1453469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 1454469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1455469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1456c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg skb_reserve(skb, local->tx_headroom); 1457c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg memcpy(skb_put(skb, presp->head_len), presp->head, presp->head_len); 1458c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 1459c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg memcpy(((struct ieee80211_mgmt *) skb->data)->da, mgmt->sa, ETH_ALEN); 1460c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg ibss_dbg(sdata, "Sending ProbeResp to %pM\n", mgmt->sa); 146162ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; 1462691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich 1463691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich /* avoid excessive retries for probe request to wildcard SSIDs */ 1464691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich if (pos[1] == 0) 1465691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_NO_ACK; 1466691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich 146762ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg ieee80211_tx_skb(sdata, skb); 1468469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1469469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1470d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbachstatic 1471d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbachvoid ieee80211_rx_mgmt_probe_beacon(struct ieee80211_sub_if_data *sdata, 1472d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_mgmt *mgmt, size_t len, 1473d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_rx_status *rx_status) 1474469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1475469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 1476469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 1477469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1478d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach BUILD_BUG_ON(offsetof(typeof(mgmt->u.probe_resp), variable) != 1479d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach offsetof(typeof(mgmt->u.beacon), variable)); 1480d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach 1481d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach /* 1482d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach * either beacon or probe_resp but the variable field is at the 1483d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach * same offset 1484d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach */ 1485469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 1486469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 1487469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1488469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 1490b2e506bfc4d752b68a0ccaae1e977898263eba4cJohannes Berg false, &elems); 1491469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1492d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems); 1493469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1494469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14951fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 14961fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct sk_buff *skb) 1497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 1499469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 1500469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 1501cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems elems; 1502cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int ies_len; 1503469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1504f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 1505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 1506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 1507469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15088d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_lock(sdata); 15097a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1510c926d006c1514cfb3572893f41f2324e96823661Tim Harvey if (!sdata->u.ibss.ssid_len) 1511c926d006c1514cfb3572893f41f2324e96823661Tim Harvey goto mgmt_out; /* not ready to merge yet */ 1512c926d006c1514cfb3572893f41f2324e96823661Tim Harvey 1513469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 1514469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 1515c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, skb); 1516469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1517469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 1518469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 1519d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach ieee80211_rx_mgmt_probe_beacon(sdata, mgmt, skb->len, 1520d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach rx_status); 1521469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1522469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 1523469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 1524469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 15252cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli case IEEE80211_STYPE_DEAUTH: 15262cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli ieee80211_rx_mgmt_deauth_ibss(sdata, mgmt, skb->len); 15272cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli break; 1528cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case IEEE80211_STYPE_ACTION: 1529cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (mgmt->u.action.category) { 1530cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case WLAN_CATEGORY_SPECTRUM_MGMT: 1531cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies_len = skb->len - 1532cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich offsetof(struct ieee80211_mgmt, 1533cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u.action.u.chan_switch.variable); 1534cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1535cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ies_len < 0) 1536cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1537cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1538cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee802_11_parse_elems( 1539cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich mgmt->u.action.u.chan_switch.variable, 1540cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies_len, true, &elems); 1541cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1542cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (elems.parse_error) 1543cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1544cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1545cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_rx_mgmt_spectrum_mgmt(sdata, mgmt, skb->len, 1546cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rx_status, &elems); 1547cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1548cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 1549469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 15507a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1551c926d006c1514cfb3572893f41f2324e96823661Tim Harvey mgmt_out: 15528d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_unlock(sdata); 1553469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1554469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15551fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_work(struct ieee80211_sub_if_data *sdata) 1556469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 15571fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 15588bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 1559469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15608d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_lock(sdata); 15617a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 15627a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg /* 15637a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * Work could be scheduled after scan or similar 15647a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * when we aren't even joined (or trying) with a 15657a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * network. 15667a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg */ 15677a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg if (!ifibss->ssid_len) 15687a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg goto out; 1569469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15708bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 15718bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg while (!list_empty(&ifibss->incomplete_stations)) { 15728bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = list_first_entry(&ifibss->incomplete_stations, 15738bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info, list); 15748bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_del(&sta->list); 15758bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 15768bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 157752874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli ieee80211_ibss_finish_sta(sta); 15788bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 15798bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 15808bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 15818bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 15828bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 1583469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 1584469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 1585469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 1586469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1587469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 1588469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 1589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1590469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 1591469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 1592469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1593469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1594469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15957a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg out: 15968d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_unlock(sdata); 15973a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg} 15983a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg 1599469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 1600469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1601469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 1602469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 16035bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 1604a61829437e68c8b2036cf5005ed0e875451c9120Stanislaw Gruszka ieee80211_queue_work(&sdata->local->hw, &sdata->work); 16055bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 16065bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 1607469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 1608469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1609469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1610469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 1612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 16138bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg INIT_LIST_HEAD(&ifibss->incomplete_stations); 16148bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_init(&ifibss->incomplete_lock); 1615cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich INIT_WORK(&ifibss->csa_connection_drop_work, 1616cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_csa_connection_drop_work); 1617469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1618469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1619469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 1620469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 1621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1622af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 1623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 162429b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_lock(&local->iflist_mtx); 162529b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg list_for_each_entry(sdata, &local->interfaces, list) { 16269607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg if (!ieee80211_sdata_running(sdata)) 16270e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 1628af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 1629af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 1630af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 16317a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 1632469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 163329b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_unlock(&local->iflist_mtx); 1634469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1635469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1636af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 1637af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 1638af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 1639ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich u32 changed = 0; 16402103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich u32 rate_flags; 16412103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich struct ieee80211_supported_band *sband; 164271965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho enum ieee80211_chanctx_mode chanmode; 164371965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho struct ieee80211_local *local = sdata->local; 164471965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho int radar_detect_width = 0; 16452103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int i; 164671965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho int ret; 164771965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho 164871965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho ret = cfg80211_chandef_dfs_required(local->hw.wiphy, 164971965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho ¶ms->chandef, 165071965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho sdata->wdev.iftype); 165171965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho if (ret < 0) 165271965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho return ret; 165371965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho 165471965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho if (ret > 0) { 165571965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho if (!params->userspace_handles_dfs) 165671965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho return -EINVAL; 165771965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho radar_detect_width = BIT(params->chandef.width); 165871965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho } 165971965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho 166071965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho chanmode = (params->channel_fixed && !ret) ? 166171965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho IEEE80211_CHANCTX_SHARED : IEEE80211_CHANCTX_EXCLUSIVE; 166271965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho 166371965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho mutex_lock(&local->chanctx_mtx); 166471965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho ret = ieee80211_check_combinations(sdata, ¶ms->chandef, chanmode, 166571965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho radar_detect_width); 166671965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho mutex_unlock(&local->chanctx_mtx); 166771965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho if (ret < 0) 166871965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho return ret; 1669af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1670af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 1671af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 1672af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 1673af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 1674af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 1675af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1676fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.privacy = params->privacy; 1677267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli sdata->u.ibss.control_port = params->control_port; 16788e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich sdata->u.ibss.userspace_handles_dfs = params->userspace_handles_dfs; 1679fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->u.ibss.basic_rates = params->basic_rates; 1680c7d37a66e345df2fdf1aa7b2c9a6d3d53846ca5bKrzysztof HaÅ‚asa sdata->u.ibss.last_scan_completed = jiffies; 16812103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 16822103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich /* fix basic_rates if channel does not support these rates */ 16832103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rate_flags = ieee80211_chandef_rate_flags(¶ms->chandef); 168471965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho sband = local->hw.wiphy->bands[params->chandef.chan->band]; 16852103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (i = 0; i < sband->n_bitrates; i++) { 16862103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if ((rate_flags & sband->bitrates[i].flags) != rate_flags) 16872103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich sdata->u.ibss.basic_rates &= ~BIT(i); 16882103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich } 1689dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau memcpy(sdata->vif.bss_conf.mcast_rate, params->mcast_rate, 1690dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau sizeof(params->mcast_rate)); 1691fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg 169257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg sdata->vif.bss_conf.beacon_int = params->beacon_interval; 169357c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 16943aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef = params->chandef; 1695af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 1696af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1697af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 1698af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 1699af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 1700af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 1701af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 1702af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 1703af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1704af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 1705af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 1706af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1707badecb001a310408d3473b1fc2ed5aefd0bc92a9Antonio Quartulli memcpy(sdata->u.ibss.ssid, params->ssid, params->ssid_len); 17080e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 17090e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 1710822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memcpy(&sdata->u.ibss.ht_capa, ¶ms->ht_capa, 1711822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich sizeof(sdata->u.ibss.ht_capa)); 1712822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memcpy(&sdata->u.ibss.ht_capa_mask, ¶ms->ht_capa_mask, 1713822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich sizeof(sdata->u.ibss.ht_capa_mask)); 1714822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1715ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich /* 1716ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is 1717ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * reserved, but an HT STA shall protect HT transmissions as though 1718ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * the HT Protection field were set to non-HT mixed mode. 1719ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 1720ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * In an IBSS, the RIFS Mode field of the HT Operation element is 1721ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * also reserved, but an HT STA shall operate as though this field 1722ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * were set to 1. 1723ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich */ 1724ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1725ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich sdata->vif.bss_conf.ht_operation_mode |= 1726ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED 1727ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich | IEEE80211_HT_PARAM_RIFS_MODE; 1728ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1729ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich changed |= BSS_CHANGED_HT; 1730ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich ieee80211_bss_info_change_notify(sdata, changed); 1731ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 173204ecd2578e712c301fa1369d2a8f298a2b4b146aJohannes Berg sdata->smps_mode = IEEE80211_SMPS_OFF; 173371965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho sdata->needed_rx_chains = local->rx_chains; 173404ecd2578e712c301fa1369d2a8f298a2b4b146aJohannes Berg 173571965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho ieee80211_queue_work(&local->hw, &sdata->work); 1736af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1737af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1738af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1739af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1740af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 1741af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 17425ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 17435ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 1744871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_ibss_disconnect(sdata); 1745b78a4932f5fb11fadf41e69c606a33fa6787574cSimon Wunderlich ifibss->ssid_len = 0; 1746871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich memset(ifibss->bssid, 0, ETH_ALEN); 1747af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1748af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 1749af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 1750822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1751822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich /* on the next join, re-program HT parameters */ 1752822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memset(&ifibss->ht_capa, 0, sizeof(ifibss->ht_capa)); 1753822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memset(&ifibss->ht_capa_mask, 0, sizeof(ifibss->ht_capa_mask)); 1754822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1755af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 1756af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 175735f20c14a103ca2c7062999e934a513b83d84de6Johannes Berg skb_queue_purge(&sdata->skb_queue); 17585cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 1759bc05d19f4b884b1dbbce48912710ae3f972c89d2Johannes Berg del_timer_sync(&sdata->u.ibss.timer); 17607a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1761af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1762af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1763