ibss.c revision d4c80d9df6d1e4473b1409e4d220ca3d1612125c
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); 146cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata->csa_counter_offset_beacon = (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_supported_band *sband; 224d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct ieee80211_mgmt *mgmt; 225d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct cfg80211_bss *bss; 226d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich u32 bss_change; 227d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct cfg80211_chan_def chandef; 228b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville struct ieee80211_channel *chan; 229d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct beacon_data *presp; 230d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich enum nl80211_bss_scan_width scan_width; 231d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich bool have_higher_than_11mbit; 2328e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich bool radar_required = false; 23355fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg int err; 234d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 235d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata_assert_lock(sdata); 236d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 237d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich /* Reset own TSF to allow time synchronization work. */ 238d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich drv_reset_tsf(local, sdata); 239d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 240d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (!ether_addr_equal(ifibss->bssid, bssid)) 241d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sta_info_flush(sdata); 242d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 243d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich /* if merging, indicate to driver that we leave the old IBSS */ 244d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (sdata->vif.bss_conf.ibss_joined) { 245d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.ibss_joined = false; 246d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.ibss_creator = false; 247d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.enable_beacon = false; 248d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich netif_carrier_off(sdata->dev); 249d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich ieee80211_bss_info_change_notify(sdata, 250d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich BSS_CHANGED_IBSS | 251d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich BSS_CHANGED_BEACON_ENABLED); 25255fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg drv_leave_ibss(local, sdata); 253d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 254d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 255d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich presp = rcu_dereference_protected(ifibss->presp, 256d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 257d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich rcu_assign_pointer(ifibss->presp, NULL); 258d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (presp) 259d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich kfree_rcu(presp, rcu_head); 260d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 261d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0; 262d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 263b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville /* make a copy of the chandef, it could be modified below. */ 264b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville chandef = *req_chandef; 265b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville chan = chandef.chan; 266d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef)) { 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 */ 2788e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef)) { 2798e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich sdata_info(sdata, 2808e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich "Failed to join IBSS, beacons forbidden\n"); 2818e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich return; 2828e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich } 2838e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich } 2848e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 2858e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 2868e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich &chandef); 2878e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich if (err > 0) { 2888e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich if (!ifibss->userspace_handles_dfs) { 2898e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich sdata_info(sdata, 2908e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich "Failed to join IBSS, DFS channel without control program\n"); 2918e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich return; 2928e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich } 2938e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich radar_required = true; 294d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 295d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 29634a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 297d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich ieee80211_vif_release_channel(sdata); 298d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (ieee80211_vif_use_channel(sdata, &chandef, 299d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich ifibss->fixed_channel ? 300d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich IEEE80211_CHANCTX_SHARED : 301d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich IEEE80211_CHANCTX_EXCLUSIVE)) { 302d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata_info(sdata, "Failed to join IBSS, no channel context\n"); 30334a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 304d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return; 305d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 30634a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 307d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 308d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich memcpy(ifibss->bssid, bssid, ETH_ALEN); 309d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 310d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sband = local->hw.wiphy->bands[chan->band]; 311d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 312d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich presp = ieee80211_ibss_build_presp(sdata, beacon_int, basic_rates, 313d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich capability, tsf, &chandef, 314cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich &have_higher_than_11mbit, NULL); 315d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (!presp) 316c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg return; 317c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 318c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg rcu_assign_pointer(ifibss->presp, presp); 319d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich mgmt = (void *)presp->head; 320469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3218e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich sdata->radar_required = radar_required; 322d6a83228823fc0cc8d79d95c9f0bf568b7317862Johannes Berg sdata->vif.bss_conf.enable_beacon = true; 3232d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg sdata->vif.bss_conf.beacon_int = beacon_int; 324fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->vif.bss_conf.basic_rates = basic_rates; 3250ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak sdata->vif.bss_conf.ssid_len = ifibss->ssid_len; 3260ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak memcpy(sdata->vif.bss_conf.ssid, ifibss->ssid, ifibss->ssid_len); 3272d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change = BSS_CHANGED_BEACON_INT; 3282d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= ieee80211_reset_erp_info(sdata); 3292d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BSSID; 3302d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON; 3312d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON_ENABLED; 332392cfdb10dab6c7dfa5fed18d8a44d7453d42196Teemu Paasikivi bss_change |= BSS_CHANGED_BASIC_RATES; 33313c40c54682ffe62977f670681268a26d500d6faAlexander Simon bss_change |= BSS_CHANGED_HT; 3348fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg bss_change |= BSS_CHANGED_IBSS; 3350ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak bss_change |= BSS_CHANGED_SSID; 3362f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich 3372f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich /* 3382f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * In 5 GHz/802.11a, we can always use short slot time. 3392f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * (IEEE 802.11-2012 18.3.8.7) 3402f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * 3412f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * In 2.4GHz, we must always use long slots in IBSS for compatibility 3422f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * reasons. 3432f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * (IEEE 802.11-2012 19.4.5) 3442f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * 3452f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * HT follows these specifications (IEEE 802.11-2012 20.3.18) 3462f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich */ 3472f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich sdata->vif.bss_conf.use_short_slot = chan->band == IEEE80211_BAND_5GHZ; 3482f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich bss_change |= BSS_CHANGED_ERP_SLOT; 3492f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich 3502ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich /* cf. IEEE 802.11 9.2.12 */ 3512ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich if (chan->band == IEEE80211_BAND_2GHZ && have_higher_than_11mbit) 3522ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich sdata->flags |= IEEE80211_SDATA_OPERATING_GMODE; 3532ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich else 3542ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich sdata->flags &= ~IEEE80211_SDATA_OPERATING_GMODE; 3552ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich 35655fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_set_wmm_default(sdata, true); 35755fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg 3588fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg sdata->vif.bss_conf.ibss_joined = true; 359c13a765bd96f4e2f52d218ee6e5c0715380eeeb8Sujith Manoharan sdata->vif.bss_conf.ibss_creator = creator; 360469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 36155fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg err = drv_join_ibss(local, sdata); 36255fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg if (err) { 36355fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ibss_joined = false; 36455fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ibss_creator = false; 36555fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.enable_beacon = false; 36655fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ssid_len = 0; 36755fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg RCU_INIT_POINTER(ifibss->presp, NULL); 36855fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg kfree_rcu(presp, rcu_head); 36934a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 37055fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_vif_release_channel(sdata); 37134a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 37255fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata_info(sdata, "Failed to join IBSS, driver failure: %d\n", 37355fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg err); 37455fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg return; 37555fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg } 37655fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg 37755fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_bss_info_change_notify(sdata, bss_change); 378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 379469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 380af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 381af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 382469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3837ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chandef); 3847ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich bss = cfg80211_inform_bss_width_frame(local->hw.wiphy, chan, 3857ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width, mgmt, 3867ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich presp->head_len, 0, GFP_KERNEL); 3875b112d3d098c97b867cc580f590395cd1e72f18cJohannes Berg cfg80211_put_bss(local->hw.wiphy, bss); 38886a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_on(sdata->dev); 389af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg cfg80211_ibss_joined(sdata->dev, ifibss->bssid, GFP_KERNEL); 390469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 391469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 392af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 393af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_bss *bss) 394469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 3950c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss = 3960c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg container_of((void *)bss, struct cfg80211_bss, priv); 397b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg struct ieee80211_supported_band *sband; 39875a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich struct cfg80211_chan_def chandef; 399b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u32 basic_rates; 400b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int i, j; 4010c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg u16 beacon_int = cbss->beacon_interval; 4028cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg const struct cfg80211_bss_ies *ies; 40375a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich enum nl80211_channel_type chan_type; 4048cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg u64 tsf; 4052103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich u32 rate_flags; 4062103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int shift; 40757c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 4088d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 4097a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 41057c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg if (beacon_int < 10) 41157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int = 10; 41257c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 41375a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich switch (sdata->u.ibss.chandef.width) { 41475a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 41575a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_20: 41675a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_40: 41775a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich chan_type = cfg80211_get_chandef_type(&sdata->u.ibss.chandef); 41875a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, chan_type); 41975a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 42075a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_5: 42175a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_10: 42275a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, 42375a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich NL80211_CHAN_WIDTH_20_NOHT); 42475a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich chandef.width = sdata->u.ibss.chandef.width; 42575a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 42675a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich default: 42775a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich /* fall back to 20 MHz for unsupported modes */ 42875a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, 42975a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich NL80211_CHAN_WIDTH_20_NOHT); 43075a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 43175a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich } 43275a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich 4330c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sband = sdata->local->hw.wiphy->bands[cbss->channel->band]; 4342103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rate_flags = ieee80211_chandef_rate_flags(&sdata->u.ibss.chandef); 4352103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich shift = ieee80211_vif_get_shift(&sdata->vif); 436b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 437b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates = 0; 438b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 439b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < bss->supp_rates_len; i++) { 4402103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rate = bss->supp_rates[i] & 0x7f; 441b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg bool is_basic = !!(bss->supp_rates[i] & 0x80); 442b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 443b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (j = 0; j < sband->n_bitrates; j++) { 4442103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int brate; 4452103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if ((rate_flags & sband->bitrates[j].flags) 4462103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich != rate_flags) 4472103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 4482103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 4492103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich brate = DIV_ROUND_UP(sband->bitrates[j].bitrate, 4502103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 5 * (1 << shift)); 4512103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (brate == rate) { 452b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (is_basic) 453b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates |= BIT(j); 454b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg break; 455b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 456b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 457b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 458b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 4598cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg rcu_read_lock(); 4608cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg ies = rcu_dereference(cbss->ies); 4618cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg tsf = ies->tsf; 4628cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg rcu_read_unlock(); 4638cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg 4640c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg __ieee80211_sta_join_ibss(sdata, cbss->bssid, 46557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int, 46675a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich &chandef, 467b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates, 4680c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->capability, 4698cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg tsf, false); 470469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 471469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 472cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichint ieee80211_ibss_csa_beacon(struct ieee80211_sub_if_data *sdata, 473cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_csa_settings *csa_settings) 474cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 475cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 476cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct beacon_data *presp, *old_presp; 477cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_bss *cbss; 478cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich const struct cfg80211_bss_ies *ies; 479cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u16 capability; 480cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u64 tsf; 481cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int ret = 0; 482cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 483cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_assert_lock(sdata); 484cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 485cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability = WLAN_CAPABILITY_IBSS; 486cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 487cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ifibss->privacy) 488cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 489cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 490cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cbss = cfg80211_get_bss(sdata->local->hw.wiphy, ifibss->chandef.chan, 491cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, ifibss->ssid, 492cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 493cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_CAPABILITY_PRIVACY, 494cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability); 495cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 496cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (WARN_ON(!cbss)) { 497cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ret = -EINVAL; 498cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto out; 499cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 500cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 501cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_read_lock(); 502cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies = rcu_dereference(cbss->ies); 503cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich tsf = ies->tsf; 504cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_read_unlock(); 505cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 506cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 507cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich old_presp = rcu_dereference_protected(ifibss->presp, 508cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 509cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 510cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich presp = ieee80211_ibss_build_presp(sdata, 511cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata->vif.bss_conf.beacon_int, 512cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata->vif.bss_conf.basic_rates, 513cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability, tsf, &ifibss->chandef, 514cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich NULL, csa_settings); 515cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (!presp) { 516cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ret = -ENOMEM; 517cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto out; 518cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 519cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 520cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_assign_pointer(ifibss->presp, presp); 521cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (old_presp) 522cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich kfree_rcu(old_presp, rcu_head); 523cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 5249449410f3b30a27824aa02adec485e18b740b756Simon Wunderlich /* it might not send the beacon for a while. send an action frame 5259449410f3b30a27824aa02adec485e18b740b756Simon Wunderlich * immediately to announce the channel switch. 5269449410f3b30a27824aa02adec485e18b740b756Simon Wunderlich */ 5279449410f3b30a27824aa02adec485e18b740b756Simon Wunderlich if (csa_settings) 5289449410f3b30a27824aa02adec485e18b740b756Simon Wunderlich ieee80211_send_action_csa(sdata, csa_settings); 5299449410f3b30a27824aa02adec485e18b740b756Simon Wunderlich 530dddd586bee9325e890a671f8e24ae39418338295Luciano Coelho return BSS_CHANGED_BEACON; 531cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich out: 532cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return ret; 533cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 534cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 535cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichint ieee80211_ibss_finish_csa(struct ieee80211_sub_if_data *sdata) 536cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 537cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 538cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_bss *cbss; 539cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int err; 540cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u16 capability; 541cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 542bafdc614a1f4f8be8cde41b8ab10ac17e67c1837Simon Wunderlich sdata_assert_lock(sdata); 543bafdc614a1f4f8be8cde41b8ab10ac17e67c1837Simon Wunderlich 544cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* update cfg80211 bss information with the new channel */ 545cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (!is_zero_ether_addr(ifibss->bssid)) { 546cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability = WLAN_CAPABILITY_IBSS; 547cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 548cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ifibss->privacy) 549cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 550cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 551cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cbss = cfg80211_get_bss(sdata->local->hw.wiphy, 552cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->chandef.chan, 553cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, ifibss->ssid, 554cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 555cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_CAPABILITY_PRIVACY, 556cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability); 557cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* XXX: should not really modify cfg80211 data */ 558cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (cbss) { 55933787fc4bea0347d78a211d1f38289b73d9ec1a6Luciano Coelho cbss->channel = sdata->csa_chandef.chan; 560cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 561cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 562cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 563cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 56433787fc4bea0347d78a211d1f38289b73d9ec1a6Luciano Coelho ifibss->chandef = sdata->csa_chandef; 565cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 566cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* generate the beacon */ 567cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich err = ieee80211_ibss_csa_beacon(sdata, NULL); 568cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 569cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return err; 570cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 571dddd586bee9325e890a671f8e24ae39418338295Luciano Coelho if (err) 572dddd586bee9325e890a671f8e24ae39418338295Luciano Coelho ieee80211_bss_info_change_notify(sdata, err); 573dddd586bee9325e890a671f8e24ae39418338295Luciano Coelho 574cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return 0; 575cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 576cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 577cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichvoid ieee80211_ibss_stop(struct ieee80211_sub_if_data *sdata) 578cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 579cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 580cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 581cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cancel_work_sync(&ifibss->csa_connection_drop_work); 582cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 583cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 58452874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartullistatic struct sta_info *ieee80211_ibss_finish_sta(struct sta_info *sta) 5858bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 5868bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 5878bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 5888bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u8 addr[ETH_ALEN]; 5898bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 5908bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg memcpy(addr, sta->sta.addr, ETH_ALEN); 5918bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 592bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "Adding new IBSS station %pM\n", addr); 5938bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 59483d5cc012441531ab0bf6f99881958e964e9cf11Johannes Berg sta_info_pre_move_state(sta, IEEE80211_STA_AUTH); 59583d5cc012441531ab0bf6f99881958e964e9cf11Johannes Berg sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC); 596267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli /* authorize the station only if the network is not RSN protected. If 597267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli * not wait for the userspace to authorize it */ 598267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli if (!sta->sdata->u.ibss.control_port) 599267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED); 6008bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6018bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rate_control_rate_init(sta); 6028bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6038bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* If it fails, maybe we raced another insertion? */ 6048bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (sta_info_insert_rcu(sta)) 6058bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta_info_get(sdata, addr); 6068bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta; 6078bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 6088bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6098bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergstatic struct sta_info * 61052874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulliieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, const u8 *bssid, 61152874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli const u8 *addr, u32 supp_rates) 6128bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 6138bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 6148bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 6158bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_local *local = sdata->local; 6168bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 61755de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg struct ieee80211_chanctx_conf *chanctx_conf; 618b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan struct ieee80211_supported_band *sband; 61974608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 62055de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg int band; 6218bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6228bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* 6238bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * XXX: Consider removing the least recently used entry and 6248bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * allow new one to be added. 6258bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg */ 6268bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 627bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n", 628e87cc4728f0e2fb663e592a1141742b1d6c63256Joe Perches sdata->name, addr); 6298bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6308bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6318bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6328bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6338bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) { 6348bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6358bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6368bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6378bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 638b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) { 6398bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6408bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6418bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6428bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 64355de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_lock(); 64455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 64555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (WARN_ON_ONCE(!chanctx_conf)) 64655de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg return NULL; 6474bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg band = chanctx_conf->def.chan->band; 64874608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chanctx_conf->def); 64955de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 65055de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg 6518bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_KERNEL); 6528bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (!sta) { 6538bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6548bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6558bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6568bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6578bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->last_rx = jiffies; 6588bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6598bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* make sure mandatory rates are always added */ 660b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan sband = local->hw.wiphy->bands[band]; 6618bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->sta.supp_rates[band] = supp_rates | 66274608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, scan_width); 6638bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 66452874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli return ieee80211_ibss_finish_sta(sta); 6656d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli} 6666d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 667871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlichstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 668871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich{ 669871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_local *local = sdata->local; 670871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich int active = 0; 671871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info *sta; 672871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 673871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata_assert_lock(sdata); 674871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 675871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich rcu_read_lock(); 676871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 677871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich list_for_each_entry_rcu(sta, &local->sta_list, list) { 678871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (sta->sdata == sdata && 679871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 680871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich jiffies)) { 681871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich active++; 682871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich break; 683871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 684871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 685871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 686871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich rcu_read_unlock(); 687871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 688871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich return active; 689871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich} 690871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 691871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlichstatic void ieee80211_ibss_disconnect(struct ieee80211_sub_if_data *sdata) 692871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich{ 693871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 694871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_local *local = sdata->local; 695871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct cfg80211_bss *cbss; 696871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct beacon_data *presp; 697871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info *sta; 698871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich u16 capability; 699871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 700d4c80d9df6d1e4473b1409e4d220ca3d1612125cSujith Manoharan if (!is_zero_ether_addr(ifibss->bssid)) { 701871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability = WLAN_CAPABILITY_IBSS; 702871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 703871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (ifibss->privacy) 704871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 705871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 706871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cbss = cfg80211_get_bss(local->hw.wiphy, ifibss->chandef.chan, 707871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->bssid, ifibss->ssid, 708871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 709871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich WLAN_CAPABILITY_PRIVACY, 710871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability); 711871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 712871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (cbss) { 713871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cfg80211_unlink_bss(local->hw.wiphy, cbss); 714871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 715871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 716871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 717871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 718871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->state = IEEE80211_IBSS_MLME_SEARCH; 719871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 720871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta_info_flush(sdata); 721871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 722871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_lock_bh(&ifibss->incomplete_lock); 723871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich while (!list_empty(&ifibss->incomplete_stations)) { 724871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta = list_first_entry(&ifibss->incomplete_stations, 725871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info, list); 726871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich list_del(&sta->list); 727871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_unlock_bh(&ifibss->incomplete_lock); 728871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 729871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta_info_free(local, sta); 730871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_lock_bh(&ifibss->incomplete_lock); 731871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 732871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_unlock_bh(&ifibss->incomplete_lock); 733871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 734871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich netif_carrier_off(sdata->dev); 735871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 736871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ibss_joined = false; 737871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ibss_creator = false; 738871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.enable_beacon = false; 739871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ssid_len = 0; 740871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 741871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich /* remove beacon */ 742871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich presp = rcu_dereference_protected(ifibss->presp, 743871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 744871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich RCU_INIT_POINTER(sdata->u.ibss.presp, NULL); 745871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (presp) 746871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich kfree_rcu(presp, rcu_head); 747871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 748871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state); 749871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED | 750871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich BSS_CHANGED_IBSS); 75155fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg drv_leave_ibss(local, sdata); 75234a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 753871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_vif_release_channel(sdata); 75434a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 755871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich} 756871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 757cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic void ieee80211_csa_connection_drop_work(struct work_struct *work) 758cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 759cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_sub_if_data *sdata = 760cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich container_of(work, struct ieee80211_sub_if_data, 761cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u.ibss.csa_connection_drop_work); 762cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 7636f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho sdata_lock(sdata); 7646f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho 765cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_ibss_disconnect(sdata); 766cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich synchronize_rcu(); 767cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich skb_queue_purge(&sdata->skb_queue); 768cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 769cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* trigger a scan to find another IBSS network to join */ 770cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_queue_work(&sdata->local->hw, &sdata->work); 7716f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho 7726f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho sdata_unlock(sdata); 773cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 774cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 7758e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlichstatic void ieee80211_ibss_csa_mark_radar(struct ieee80211_sub_if_data *sdata) 7768e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich{ 7778e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 7788e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich int err; 7798e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 7808e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich /* if the current channel is a DFS channel, mark the channel as 7818e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich * unavailable. 7828e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich */ 7838e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 7848e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich &ifibss->chandef); 7858e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich if (err > 0) 7868e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich cfg80211_radar_event(sdata->local->hw.wiphy, &ifibss->chandef, 7878e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich GFP_ATOMIC); 7888e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich} 7898e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 790cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic bool 791cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichieee80211_ibss_process_chanswitch(struct ieee80211_sub_if_data *sdata, 792cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems *elems, 793cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich bool beacon) 794cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 795cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_csa_settings params; 796c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh struct ieee80211_csa_ie csa_ie; 797cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 798cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich enum nl80211_channel_type ch_type; 79982a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho int err; 800cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u32 sta_flags; 801cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 802cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags = IEEE80211_STA_DISABLE_VHT; 803cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (ifibss->chandef.width) { 804cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_5: 805cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_10: 806cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 807cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags |= IEEE80211_STA_DISABLE_HT; 808cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* fall through */ 809cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20: 810cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags |= IEEE80211_STA_DISABLE_40MHZ; 811cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 812cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich default: 813cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 814cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 815cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 816cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich memset(¶ms, 0, sizeof(params)); 817c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh memset(&csa_ie, 0, sizeof(csa_ie)); 818cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich err = ieee80211_parse_ch_switch_ie(sdata, elems, beacon, 819cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->chandef.chan->band, 820c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh sta_flags, ifibss->bssid, &csa_ie); 821cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* can't switch to destination channel, fail */ 822cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 823cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 824cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 825cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* did not contain a CSA */ 826cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err) 827cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return false; 828cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 8290834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich /* channel switch is not supported, disconnect */ 8300834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich if (!(sdata->local->hw.wiphy->flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 8310834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich goto disconnect; 8320834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich 833c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.count = csa_ie.count; 834c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.chandef = csa_ie.chandef; 835c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh 836cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (ifibss->chandef.width) { 837cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 838cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20: 839cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_40: 840cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* keep our current HT mode (HT20/HT40+/HT40-), even if 841cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * another mode has been announced. The mode is not adopted 842cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * within the beacon while doing CSA and we should therefore 843cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * keep the mode which we announce. 844cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich */ 845cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ch_type = cfg80211_get_chandef_type(&ifibss->chandef); 846cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_chandef_create(¶ms.chandef, params.chandef.chan, 847cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ch_type); 848cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 849cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_5: 850cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_10: 851cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (params.chandef.width != ifibss->chandef.width) { 852cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_info(sdata, 853cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "IBSS %pM received channel switch from incompatible channel width (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n", 854cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, 855cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq, 856cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.width, 857cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq1, 858cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq2); 859cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 860cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 861cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 862cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich default: 863cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* should not happen, sta_flags should prevent VHT modes. */ 864cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WARN_ON(1); 865cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 866cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 867cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 8688e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich if (!cfg80211_reg_can_beacon(sdata->local->hw.wiphy, ¶ms.chandef)) { 869cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_info(sdata, 870cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "IBSS %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n", 871cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, 872cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq, 873cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.width, 874cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq1, 875cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq2); 876cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 877cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 878cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 879cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 880cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ¶ms.chandef); 881cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 882cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 883cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err) { 8848e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich /* IBSS-DFS only allowed with a control program */ 8858e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich if (!ifibss->userspace_handles_dfs) 8868e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich goto disconnect; 887cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 8888e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich params.radar_required = true; 889cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 890cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 89182a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (cfg80211_chandef_identical(¶ms.chandef, 89282a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho &sdata->vif.bss_conf.chandef)) { 89382a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ibss_dbg(sdata, 89482a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho "received csa with an identical chandef, ignoring\n"); 89582a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho return true; 896cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 897cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 898cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* all checks done, now perform the channel switch. */ 899cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ibss_dbg(sdata, 900cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "received channel switch announcement to go to channel %d MHz\n", 901cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq); 902cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 903c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.block_tx = !!csa_ie.mode; 904cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 90582a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (ieee80211_channel_switch(sdata->local->hw.wiphy, sdata->dev, 90682a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ¶ms)) 90782a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho goto disconnect; 908cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9098e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich ieee80211_ibss_csa_mark_radar(sdata); 9108e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 911cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return true; 912cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichdisconnect: 913cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ibss_dbg(sdata, "Can't handle channel switch, disconnect\n"); 914cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_queue_work(&sdata->local->hw, 915cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich &ifibss->csa_connection_drop_work); 916cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9178e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich ieee80211_ibss_csa_mark_radar(sdata); 9188e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 919cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return true; 920cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 921cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 922cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic void 923cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichieee80211_rx_mgmt_spectrum_mgmt(struct ieee80211_sub_if_data *sdata, 924cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_mgmt *mgmt, size_t len, 925cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_rx_status *rx_status, 926cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems *elems) 927cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 928cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int required_len; 929cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 930cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (len < IEEE80211_MIN_ACTION_SIZE + 1) 931cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 932cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 933cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* CSA is the only action we handle for now */ 934cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (mgmt->u.action.u.measurement.action_code != 935cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_ACTION_SPCT_CHL_SWITCH) 936cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 937cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 938cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich required_len = IEEE80211_MIN_ACTION_SIZE + 939cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sizeof(mgmt->u.action.u.chan_switch); 940cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (len < required_len) 941cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 942cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 94382a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (!sdata->vif.csa_active) 94482a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ieee80211_ibss_process_chanswitch(sdata, elems, false); 945cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 946cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9472cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartullistatic void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data *sdata, 9482cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli struct ieee80211_mgmt *mgmt, 9492cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli size_t len) 9502cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli{ 9512cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli u16 reason = le16_to_cpu(mgmt->u.deauth.reason_code); 9522cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9532cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli if (len < IEEE80211_DEAUTH_FRAME_LEN) 9542cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli return; 9552cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9562cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli ibss_dbg(sdata, "RX DeAuth SA=%pM DA=%pM BSSID=%pM (reason: %d)\n", 9572cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli mgmt->sa, mgmt->da, mgmt->bssid, reason); 9582cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli sta_info_destroy_addr(sdata, mgmt->sa); 9592cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli} 9602cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9616d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartullistatic void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata, 9626d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli struct ieee80211_mgmt *mgmt, 9636d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli size_t len) 9646d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli{ 9656d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli u16 auth_alg, auth_transaction; 9666d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9678d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 9686d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9696d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (len < 24 + 6) 9706d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return; 9716d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9726d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); 9736d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); 9746d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 975bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 976bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n", 977bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->da, mgmt->bssid, auth_transaction); 9787bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli 9797bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1) 9807bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli return; 9817bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli 9822cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli /* 9836d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * IEEE 802.11 standard does not require authentication in IBSS 9846d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * networks and most implementations do not seem to use it. 9856d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * However, try to reply to authentication attempts if someone 9866d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * has actually implemented this. 9876d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli */ 988700e8ea6770df3113e735bcc76ecd6ffac71a13cJouni Malinen ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, 0, NULL, 0, 9891672c0e31917f49d31d30d79067103432bc20cc7Johannes Berg mgmt->sa, sdata->u.ibss.bssid, NULL, 0, 0, 0); 9908bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 9918bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 992469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 993d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_mgmt *mgmt, size_t len, 994469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 995d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee802_11_elems *elems) 996469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 997469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 998469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int freq; 9990c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 1000469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 1001469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 1002469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 1003469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 1004469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 1005469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 100674608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 100713c40c54682ffe62977f670681268a26d500d6faAlexander Simon struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band]; 100813c40c54682ffe62977f670681268a26d500d6faAlexander Simon bool rates_updated = false; 1009469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10101cd8e88e17729f57a9c7f751103e522596bb5de2Johannes Berg if (elems->ds_params) 101159eb21a6504731fc16db4cf9463065dd61093e08Bruno Randolf freq = ieee80211_channel_to_frequency(elems->ds_params[0], 101259eb21a6504731fc16db4cf9463065dd61093e08Bruno Randolf band); 1013469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 1014469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = rx_status->freq; 1015469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1016469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 1017469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1018469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 1019469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1020469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10219eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sdata->vif.type == NL80211_IFTYPE_ADHOC && 1022b203ca39126bad99583c908be587df067820a1eaJoe Perches ether_addr_equal(mgmt->bssid, sdata->u.ibss.bssid)) { 1023469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1024469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 1025abe60632f311d515b082b450504ee24006023951Johannes Berg sta = sta_info_get(sdata, mgmt->sa); 1026469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10279eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (elems->supp_rates) { 10282103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich supp_rates = ieee80211_sta_get_rates(sdata, elems, 10299ebb61a23d90703344fc609fbee8da67b1e7456cAshok Nagarajan band, NULL); 10309eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta) { 10319eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf u32 prev_rates; 10329eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 10339eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf prev_rates = sta->sta.supp_rates[band]; 10349eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf /* make sure mandatory rates are always added */ 103574608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_20; 103674608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich if (rx_status->flag & RX_FLAG_5MHZ) 103774608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_5; 103874608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich if (rx_status->flag & RX_FLAG_10MHZ) 103974608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_10; 1040469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 104174608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich sta->sta.supp_rates[band] = supp_rates | 104274608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, 104374608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width); 10449eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta->sta.supp_rates[band] != prev_rates) { 1045bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1046bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "updated supp_rates set for %pM based on beacon/probe_resp (0x%x -> 0x%x)\n", 1047bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sta->sta.addr, prev_rates, 1048bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sta->sta.supp_rates[band]); 104913c40c54682ffe62977f670681268a26d500d6faAlexander Simon rates_updated = true; 10509eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf } 10518bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } else { 10528bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 10539eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid, 105452874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli mgmt->sa, supp_rates); 10558bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 105634e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg } 10579eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 10589eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta && elems->wmm_info) 1059c2c98fdeb5c897499644eb247285c8e3dacc6450Johannes Berg set_sta_flag(sta, WLAN_STA_WME); 10609eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 1061074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg if (sta && elems->ht_operation && elems->ht_cap_elem && 10623aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 10633aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_5 && 10643aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_10) { 106513c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* we both use HT */ 1066e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg struct ieee80211_ht_cap htcap_ie; 10674bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg struct cfg80211_chan_def chandef; 10684bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg 10694bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg ieee80211_ht_oper_to_chandef(channel, 10704bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg elems->ht_operation, 10714bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg &chandef); 107213c40c54682ffe62977f670681268a26d500d6faAlexander Simon 1073e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg memcpy(&htcap_ie, elems->ht_cap_elem, sizeof(htcap_ie)); 107413c40c54682ffe62977f670681268a26d500d6faAlexander Simon 107513c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* 107613c40c54682ffe62977f670681268a26d500d6faAlexander Simon * fall back to HT20 if we don't use or use 107713c40c54682ffe62977f670681268a26d500d6faAlexander Simon * the other extension channel 107813c40c54682ffe62977f670681268a26d500d6faAlexander Simon */ 10793aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich if (chandef.center_freq1 != 10803aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.center_freq1) 1081e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg htcap_ie.cap_info &= 1082e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg cpu_to_le16(~IEEE80211_HT_CAP_SUP_WIDTH_20_40); 1083e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg 1084e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg rates_updated |= ieee80211_ht_cap_ie_to_sta_ht_cap( 1085e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg sdata, sband, &htcap_ie, sta); 108613c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 108713c40c54682ffe62977f670681268a26d500d6faAlexander Simon 1088e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli if (sta && rates_updated) { 1089e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli drv_sta_rc_update(local, sdata, &sta->sta, 1090e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli IEEE80211_RC_SUPP_RATES_CHANGED); 109113c40c54682ffe62977f670681268a26d500d6faAlexander Simon rate_control_rate_init(sta); 1092e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli } 109313c40c54682ffe62977f670681268a26d500d6faAlexander Simon 10949eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf rcu_read_unlock(); 1095469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1096469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1097469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 1098d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach channel); 1099469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 1100469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1101469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 11020c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = container_of((void *)bss, struct cfg80211_bss, priv); 11030c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 11048cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg /* same for beacon and probe response */ 11058cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg beacon_timestamp = le64_to_cpu(mgmt->u.beacon.timestamp); 1106469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1107469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 1108469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1109469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 11100c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (!(cbss->capability & WLAN_CAPABILITY_IBSS)) 1111469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1112469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1113469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 111455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (sdata->u.ibss.fixed_channel && 11153aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.chan != cbss->channel) 1116469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1117469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1118469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 1119469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 1120469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 1121469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 1122469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1123469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1124cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* process channel switch */ 112582a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (sdata->vif.csa_active || 112682a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ieee80211_ibss_process_chanswitch(sdata, elems, true)) 1127cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto put_bss; 1128cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 112934e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 1130b203ca39126bad99583c908be587df067820a1eaJoe Perches if (ether_addr_equal(cbss->bssid, sdata->u.ibss.bssid)) 113134e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 113234e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 1133cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* we use a fixed BSSID */ 1134cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (sdata->u.ibss.fixed_bssid) 1135cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto put_bss; 1136cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1137f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen if (ieee80211_have_rx_timestamp(rx_status)) { 1138f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen /* time when timestamp field was received */ 1139f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen rx_timestamp = 1140f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen ieee80211_calculate_rx_timestamp(local, rx_status, 1141f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen len + FCS_LEN, 24); 11422448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } else { 11432448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* 11442448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * second best option: get current TSF 11452448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * (will return -1 if not supported) 11462448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg */ 114737a41b4affa33bb237d3692bf51f1b5ebcaf29d8Eliad Peller rx_timestamp = drv_get_tsf(local, sdata); 11482448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } 1149469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1150bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1151bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 1152bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->bssid, 1153bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)rx_timestamp, 1154bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)beacon_timestamp, 1155bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 1156bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg jiffies); 1157469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1158469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 1159bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1160bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n", 1161bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->bssid); 1162469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 11632103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich supp_rates = ieee80211_sta_get_rates(sdata, elems, band, NULL); 116434e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 116552874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli supp_rates); 11668bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 1167469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1168469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1169469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 1170469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 1171469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1172469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 11738bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergvoid ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data *sdata, 11748bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg const u8 *bssid, const u8 *addr, 11758bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u32 supp_rates) 1176469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 11772e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1178469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 1179469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 118055de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg struct ieee80211_chanctx_conf *chanctx_conf; 1181b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan struct ieee80211_supported_band *sband; 118274608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 118355de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg int band; 1184469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1185af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 1186af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 1187af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 1188af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 1189469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 1190bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n", 1191e87cc4728f0e2fb663e592a1141742b1d6c63256Joe Perches sdata->name, addr); 11928bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1193469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1194469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 11952e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) 11968bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 11972e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau 1198b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) 11998bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1200469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 120155de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_lock(); 120255de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 120355de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (WARN_ON_ONCE(!chanctx_conf)) { 120455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 120555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg return; 120655de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg } 12074bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg band = chanctx_conf->def.chan->band; 120874608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chanctx_conf->def); 120955de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 121055de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg 12118bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 1212469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 12138bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1214469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1215c8716d9dc13c7f6ee92f2bfc6cc3b723b417bff8Rajkumar Manoharan sta->last_rx = jiffies; 1216d9a7ddb05e5419ca5e4b54f57074dc33c7ea991cJohannes Berg 1217469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 1218b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan sband = local->hw.wiphy->bands[band]; 1219469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 122074608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, scan_width); 1221469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12228bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock(&ifibss->incomplete_lock); 12238bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_add(&sta->list, &ifibss->incomplete_stations); 12248bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock(&ifibss->incomplete_lock); 12258bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 1226469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1227469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1228dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartullistatic void ieee80211_ibss_sta_expire(struct ieee80211_sub_if_data *sdata) 1229dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli{ 1230dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli struct ieee80211_local *local = sdata->local; 1231dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli struct sta_info *sta, *tmp; 1232dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli unsigned long exp_time = IEEE80211_IBSS_INACTIVITY_LIMIT; 1233dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli unsigned long exp_rsn_time = IEEE80211_IBSS_RSN_INACTIVITY_LIMIT; 1234dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1235dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli mutex_lock(&local->sta_mtx); 1236dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1237dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli list_for_each_entry_safe(sta, tmp, &local->sta_list, list) { 1238dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli if (sdata != sta->sdata) 1239dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli continue; 1240dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1241dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli if (time_after(jiffies, sta->last_rx + exp_time) || 1242dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli (time_after(jiffies, sta->last_rx + exp_rsn_time) && 1243dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta->sta_state != IEEE80211_STA_AUTHORIZED)) { 1244dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta_dbg(sta->sdata, "expiring inactive %sSTA %pM\n", 1245dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta->sta_state != IEEE80211_STA_AUTHORIZED ? 1246dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli "not authorized " : "", sta->sta.addr); 1247dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1248dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli WARN_ON(__sta_info_destroy(sta)); 1249dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli } 1250dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli } 1251dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1252dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli mutex_unlock(&local->sta_mtx); 1253dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli} 1254dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1255ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 1256ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_JOINED 1257ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 1258469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1259469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 1260469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1261469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 12627ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 1263469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12648d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 12657a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1266af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 1267af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 1268469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1269dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli ieee80211_ibss_sta_expire(sdata); 1270af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1271450aae3d7b60a970f266349a837dfb30a539198bSujith if (time_before(jiffies, ifibss->last_scan_completed + 1272450aae3d7b60a970f266349a837dfb30a539198bSujith IEEE80211_IBSS_MERGE_INTERVAL)) 1273450aae3d7b60a970f266349a837dfb30a539198bSujith return; 1274450aae3d7b60a970f266349a837dfb30a539198bSujith 1275469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 1276469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1277469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1278c037b8367c7e2b775a99d74037f5df014d2fbf06John W. Linville if (ifibss->fixed_channel) 1279469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1280469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1281bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, 1282bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n"); 1283469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12847ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&ifibss->chandef); 128534bcf71502413f8903ade93746f2d0f04b937a78Stanislaw Gruszka ieee80211_request_ibss_scan(sdata, ifibss->ssid, ifibss->ssid_len, 12867ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich NULL, scan_width); 1287469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1288469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1289af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 1290469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1291469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1292469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 1293469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 1294469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 1295469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12968d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 12977a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1298af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 1299469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 1300469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 1301469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 1302469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 1303469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 1304469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 1305469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 130647846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg bssid[i] ^= sdata->vif.addr[i]; 1307469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 1308469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 1309469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1310469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1311bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, "Creating new IBSS network, BSSID %pM\n", bssid); 1312469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1313469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 1314469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1315fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 1316469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 1317469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 1318469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 1319469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 132057c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int, 132175a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich &ifibss->chandef, ifibss->basic_rates, 1322c13a765bd96f4e2f52d218ee6e5c0715380eeeb8Sujith Manoharan capability, 0, true); 1323469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1324469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1325ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 1326ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_SEARCH 1327ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 1328ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault 1329af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 1330469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1331469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1332469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 13330c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 1334af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 1335469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 13367ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 1337469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 1338e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg u16 capability; 1339469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13408d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 13417a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1342469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 1343bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "sta_find_ibss (active_ibss=%d)\n", active_ibss); 1344469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1345469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 1346af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 1347469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1348e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability = WLAN_CAPABILITY_IBSS; 1349fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 1350e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 1351af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 1352af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 1353af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 13543aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich chan = ifibss->chandef.chan; 1355af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 1356469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 13570c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid, 13580c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg ifibss->ssid, ifibss->ssid_len, 13590c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY, 13600c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg capability); 13610c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 13620c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss) { 13630c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct ieee80211_bss *bss; 1364469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13650c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg bss = (void *)cbss->priv; 1366bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1367bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "sta_find_ibss: selected %pM current %pM\n", 1368bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg cbss->bssid, ifibss->bssid); 1369bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, 1370bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "Selected IBSS BSSID %pM based on configured SSID\n", 1371bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg cbss->bssid); 1372469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1373af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 1374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 1375af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 1376d419b9f0fa69e79ccba3e5e79a58a52ae0c2ed6aReinette Chatre } 1377469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1378d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli /* if a fixed bssid and a fixed freq have been provided create the IBSS 1379d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli * directly and do not waste time scanning 1380d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli */ 1381d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli if (ifibss->fixed_bssid && ifibss->fixed_channel) { 1382d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli sdata_info(sdata, "Created IBSS using preconfigured BSSID %pM\n", 1383d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli bssid); 1384d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli ieee80211_sta_create_ibss(sdata); 1385d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli return; 1386d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli } 1387d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli 1388d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli 1389bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "sta_find_ibss: did not try to join ibss\n"); 1390469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1391469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 1392ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault if (time_after(jiffies, ifibss->last_scan_completed + 1393469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 1394bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, "Trigger new scan to find an IBSS to join\n"); 1395469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13967ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&ifibss->chandef); 139734bcf71502413f8903ade93746f2d0f04b937a78Stanislaw Gruszka ieee80211_request_ibss_scan(sdata, ifibss->ssid, 13987ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich ifibss->ssid_len, chan, 13997ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width); 1400ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault } else { 1401469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 1402469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1403469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 140455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) 140555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg ieee80211_sta_create_ibss(sdata); 1406469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1407af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 1408af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 1409469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1410469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1411469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1412469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 1413c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct sk_buff *req) 1414469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1415c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct ieee80211_mgmt *mgmt = (void *)req->data; 1416469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1417469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 1418c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg int tx_last_beacon, len = req->len; 1419469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 1420c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg struct beacon_data *presp; 1421469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 1422469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14238d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 14247a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 142540b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg presp = rcu_dereference_protected(ifibss->presp, 14268d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg lockdep_is_held(&sdata->wdev.mtx)); 142740b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg 1428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 142940b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg len < 24 + 2 || !presp) 1430469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1431469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14322448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg tx_last_beacon = drv_tx_last_beacon(local); 1433469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1434bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1435bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n", 1436bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->da, mgmt->bssid, tx_last_beacon); 1437469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14381ed76487ce115110171480deabd3cd4656f9803eFelix Fietkau if (!tx_last_beacon && is_multicast_ether_addr(mgmt->da)) 1439469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1440469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1441b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(mgmt->bssid, ifibss->bssid) && 1442888d04dfbe7e09f930fdaafb257cce2c54c9c3f3Felix Fietkau !is_broadcast_ether_addr(mgmt->bssid)) 1443469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1444469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1445469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 1446469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 1447469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 1448469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 1449bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "Invalid SSID IE in ProbeReq from %pM\n", 1450bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa); 1451469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1452469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1453469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 1454469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 14550da780c269957783d341fc3559e6b4c9912af7b4Benoit Papillault memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 1456469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 1457469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1458469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1459469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1460469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 1461c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg skb = dev_alloc_skb(local->tx_headroom + presp->head_len); 1462469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 1463469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1464469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1465c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg skb_reserve(skb, local->tx_headroom); 1466c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg memcpy(skb_put(skb, presp->head_len), presp->head, presp->head_len); 1467c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 1468c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg memcpy(((struct ieee80211_mgmt *) skb->data)->da, mgmt->sa, ETH_ALEN); 1469c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg ibss_dbg(sdata, "Sending ProbeResp to %pM\n", mgmt->sa); 147062ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; 147162ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg ieee80211_tx_skb(sdata, skb); 1472469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1473469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1474d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbachstatic 1475d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbachvoid ieee80211_rx_mgmt_probe_beacon(struct ieee80211_sub_if_data *sdata, 1476d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_mgmt *mgmt, size_t len, 1477d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_rx_status *rx_status) 1478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 1480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 1481469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1482d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach BUILD_BUG_ON(offsetof(typeof(mgmt->u.probe_resp), variable) != 1483d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach offsetof(typeof(mgmt->u.beacon), variable)); 1484d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach 1485d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach /* 1486d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach * either beacon or probe_resp but the variable field is at the 1487d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach * same offset 1488d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach */ 1489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 1490469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 1491469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1492469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1493469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 1494b2e506bfc4d752b68a0ccaae1e977898263eba4cJohannes Berg false, &elems); 1495469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1496d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems); 1497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14991fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 15001fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct sk_buff *skb) 1501469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1502469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 1503469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 1504469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 1505cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems elems; 1506cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int ies_len; 1507469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1508f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 1509469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 1510469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 1511469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15128d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_lock(sdata); 15137a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1514c926d006c1514cfb3572893f41f2324e96823661Tim Harvey if (!sdata->u.ibss.ssid_len) 1515c926d006c1514cfb3572893f41f2324e96823661Tim Harvey goto mgmt_out; /* not ready to merge yet */ 1516c926d006c1514cfb3572893f41f2324e96823661Tim Harvey 1517469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 1518469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 1519c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, skb); 1520469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1521469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 1522469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 1523d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach ieee80211_rx_mgmt_probe_beacon(sdata, mgmt, skb->len, 1524d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach rx_status); 1525469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1526469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 1527469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 1528469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 15292cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli case IEEE80211_STYPE_DEAUTH: 15302cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli ieee80211_rx_mgmt_deauth_ibss(sdata, mgmt, skb->len); 15312cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli break; 1532cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case IEEE80211_STYPE_ACTION: 1533cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (mgmt->u.action.category) { 1534cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case WLAN_CATEGORY_SPECTRUM_MGMT: 1535cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies_len = skb->len - 1536cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich offsetof(struct ieee80211_mgmt, 1537cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u.action.u.chan_switch.variable); 1538cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1539cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ies_len < 0) 1540cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1541cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1542cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee802_11_parse_elems( 1543cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich mgmt->u.action.u.chan_switch.variable, 1544cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies_len, true, &elems); 1545cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1546cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (elems.parse_error) 1547cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1548cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1549cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_rx_mgmt_spectrum_mgmt(sdata, mgmt, skb->len, 1550cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rx_status, &elems); 1551cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1552cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 1553469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 15547a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1555c926d006c1514cfb3572893f41f2324e96823661Tim Harvey mgmt_out: 15568d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_unlock(sdata); 1557469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1558469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15591fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_work(struct ieee80211_sub_if_data *sdata) 1560469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 15611fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 15628bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 1563469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15648d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_lock(sdata); 15657a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 15667a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg /* 15677a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * Work could be scheduled after scan or similar 15687a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * when we aren't even joined (or trying) with a 15697a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * network. 15707a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg */ 15717a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg if (!ifibss->ssid_len) 15727a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg goto out; 1573469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15748bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 15758bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg while (!list_empty(&ifibss->incomplete_stations)) { 15768bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = list_first_entry(&ifibss->incomplete_stations, 15778bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info, list); 15788bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_del(&sta->list); 15798bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 15808bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 158152874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli ieee80211_ibss_finish_sta(sta); 15828bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 15838bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 15848bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 15858bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 15868bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 1587469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 1588469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 1589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 1590469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1591469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 1592469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 1593469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1594469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 1595469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 1596469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1597469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1598469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15997a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg out: 16008d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_unlock(sdata); 16013a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg} 16023a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg 1603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 1604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1605469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 1606469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 16075bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 1608a61829437e68c8b2036cf5005ed0e875451c9120Stanislaw Gruszka ieee80211_queue_work(&sdata->local->hw, &sdata->work); 16095bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 16105bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 1611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 1612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1613469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1614469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 1616469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 16178bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg INIT_LIST_HEAD(&ifibss->incomplete_stations); 16188bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_init(&ifibss->incomplete_lock); 1619cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich INIT_WORK(&ifibss->csa_connection_drop_work, 1620cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_csa_connection_drop_work); 1621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1622469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 1624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 1625469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1626af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 1627469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 162829b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_lock(&local->iflist_mtx); 162929b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg list_for_each_entry(sdata, &local->interfaces, list) { 16309607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg if (!ieee80211_sdata_running(sdata)) 16310e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 1632af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 1633af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 1634af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 16357a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 1636469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 163729b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_unlock(&local->iflist_mtx); 1638469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1639469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1640af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 1641af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 1642af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 1643ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich u32 changed = 0; 16442103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich u32 rate_flags; 16452103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich struct ieee80211_supported_band *sband; 16462103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int i; 1647af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1648af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 1649af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 1650af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 1651af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 1652af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 1653af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1654fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.privacy = params->privacy; 1655267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli sdata->u.ibss.control_port = params->control_port; 16568e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich sdata->u.ibss.userspace_handles_dfs = params->userspace_handles_dfs; 1657fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->u.ibss.basic_rates = params->basic_rates; 16582103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 16592103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich /* fix basic_rates if channel does not support these rates */ 16602103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rate_flags = ieee80211_chandef_rate_flags(¶ms->chandef); 16612103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich sband = sdata->local->hw.wiphy->bands[params->chandef.chan->band]; 16622103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (i = 0; i < sband->n_bitrates; i++) { 16632103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if ((rate_flags & sband->bitrates[i].flags) != rate_flags) 16642103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich sdata->u.ibss.basic_rates &= ~BIT(i); 16652103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich } 1666dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau memcpy(sdata->vif.bss_conf.mcast_rate, params->mcast_rate, 1667dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau sizeof(params->mcast_rate)); 1668fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg 166957c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg sdata->vif.bss_conf.beacon_int = params->beacon_interval; 167057c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 16713aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef = params->chandef; 1672af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 1673af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1674af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 1675af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 1676af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 1677af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 1678af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 1679af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 1680af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1681af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 1682af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 1683af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1684badecb001a310408d3473b1fc2ed5aefd0bc92a9Antonio Quartulli memcpy(sdata->u.ibss.ssid, params->ssid, params->ssid_len); 16850e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 16860e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 1687822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memcpy(&sdata->u.ibss.ht_capa, ¶ms->ht_capa, 1688822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich sizeof(sdata->u.ibss.ht_capa)); 1689822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memcpy(&sdata->u.ibss.ht_capa_mask, ¶ms->ht_capa_mask, 1690822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich sizeof(sdata->u.ibss.ht_capa_mask)); 1691822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1692ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich /* 1693ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is 1694ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * reserved, but an HT STA shall protect HT transmissions as though 1695ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * the HT Protection field were set to non-HT mixed mode. 1696ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 1697ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * In an IBSS, the RIFS Mode field of the HT Operation element is 1698ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * also reserved, but an HT STA shall operate as though this field 1699ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * were set to 1. 1700ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich */ 1701ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1702ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich sdata->vif.bss_conf.ht_operation_mode |= 1703ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED 1704ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich | IEEE80211_HT_PARAM_RIFS_MODE; 1705ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1706ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich changed |= BSS_CHANGED_HT; 1707ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich ieee80211_bss_info_change_notify(sdata, changed); 1708ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 170904ecd2578e712c301fa1369d2a8f298a2b4b146aJohannes Berg sdata->smps_mode = IEEE80211_SMPS_OFF; 171004ecd2578e712c301fa1369d2a8f298a2b4b146aJohannes Berg sdata->needed_rx_chains = sdata->local->rx_chains; 171104ecd2578e712c301fa1369d2a8f298a2b4b146aJohannes Berg 171264592c8fc0e99d445fc3fdedddeb6088e20086f1Johannes Berg ieee80211_queue_work(&sdata->local->hw, &sdata->work); 1713af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1714af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1715af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1716af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1717af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 1718af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 17195ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 17205ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 1721871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_ibss_disconnect(sdata); 1722b78a4932f5fb11fadf41e69c606a33fa6787574cSimon Wunderlich ifibss->ssid_len = 0; 1723871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich memset(ifibss->bssid, 0, ETH_ALEN); 1724af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1725af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 1726af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 1727822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1728822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich /* on the next join, re-program HT parameters */ 1729822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memset(&ifibss->ht_capa, 0, sizeof(ifibss->ht_capa)); 1730822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memset(&ifibss->ht_capa_mask, 0, sizeof(ifibss->ht_capa_mask)); 1731822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1732af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 1733af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 173435f20c14a103ca2c7062999e934a513b83d84de6Johannes Berg skb_queue_purge(&sdata->skb_queue); 17355cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 1736bc05d19f4b884b1dbbce48912710ae3f972c89d2Johannes Berg del_timer_sync(&sdata->u.ibss.timer); 17377a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1738af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1739af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1740