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> 9d98ad83ee86e523cc00cbf425f456fbd14b4fdc4Johannes Berg * Copyright 2013-2014 Intel Mobile Communications GmbH 10469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 11469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * This program is free software; you can redistribute it and/or modify 12469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * it under the terms of the GNU General Public License version 2 as 13469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * published by the Free Software Foundation. 14469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 15469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 16469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/delay.h> 175a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 18469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/if_ether.h> 19469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/skbuff.h> 20469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/if_arp.h> 21469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/etherdevice.h> 22469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/rtnetlink.h> 23469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <net/mac80211.h> 24469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 25469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "ieee80211_i.h" 262448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg#include "driver-ops.h" 27469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "rate.h" 28469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 29469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL (2 * HZ) 30469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ) 31469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 32469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ) 33469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ) 34dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli#define IEEE80211_IBSS_RSN_INACTIVITY_LIMIT (10 * HZ) 35469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 36469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MAX_STA_ENTRIES 128 37469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 38d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlichstatic struct beacon_data * 39d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlichieee80211_ibss_build_presp(struct ieee80211_sub_if_data *sdata, 40d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const int beacon_int, const u32 basic_rates, 41d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const u16 capability, u64 tsf, 42d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct cfg80211_chan_def *chandef, 43cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich bool *have_higher_than_11mbit, 44cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_csa_settings *csa_settings) 45469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 46469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 47469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 482103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rates_n = 0, i, ri; 49469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 50469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 51469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 52d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich u32 rate_flags, rates = 0, rates_added = 0; 53c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg struct beacon_data *presp; 54c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg int frame_len; 552103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int shift; 562448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg 57469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Build IBSS probe response */ 58c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg frame_len = sizeof(struct ieee80211_hdr_3addr) + 59c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 12 /* struct ieee80211_mgmt.u.beacon */ + 60c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + IEEE80211_MAX_SSID_LEN /* max SSID */ + 61c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + 8 /* max Supported Rates */ + 62c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 3 /* max DS params */ + 63c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 4 /* IBSS params */ + 64cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 5 /* Channel Switch Announcement */ + 65c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + (IEEE80211_MAX_SUPP_RATES - 8) + 66c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + sizeof(struct ieee80211_ht_cap) + 67c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 2 + sizeof(struct ieee80211_ht_operation) + 68c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg ifibss->ie_len; 69c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg presp = kzalloc(sizeof(*presp) + frame_len, GFP_KERNEL); 70c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg if (!presp) 71d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return NULL; 72c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 73c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg presp->head = (void *)(presp + 1); 74c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 75c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg mgmt = (void *) presp->head; 76469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 77469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_STYPE_PROBE_RESP); 78e83e6541cee0a12bc445b0f4fad5214df5803087Johannes Berg eth_broadcast_addr(mgmt->da); 7947846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN); 80469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN); 8157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_int); 82707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith mgmt->u.beacon.timestamp = cpu_to_le64(tsf); 83469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->u.beacon.capab_info = cpu_to_le16(capability); 84469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 85c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg pos = (u8 *)mgmt + offsetof(struct ieee80211_mgmt, u.beacon.variable); 86c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 87469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SSID; 88469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = ifibss->ssid_len; 89469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, ifibss->ssid, ifibss->ssid_len); 90c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg pos += ifibss->ssid_len; 91469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 92d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sband = local->hw.wiphy->bands[chandef->chan->band]; 93d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich rate_flags = ieee80211_chandef_rate_flags(chandef); 94d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich shift = ieee80211_chandef_get_shift(chandef); 95d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich rates_n = 0; 96d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (have_higher_than_11mbit) 97d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich *have_higher_than_11mbit = false; 98d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 992103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (i = 0; i < sband->n_bitrates; i++) { 1002103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if ((rate_flags & sband->bitrates[i].flags) != rate_flags) 1012103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 102d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (sband->bitrates[i].bitrate > 110 && 103d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich have_higher_than_11mbit) 104d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich *have_higher_than_11mbit = true; 1052103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 1062103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rates |= BIT(i); 1072103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rates_n++; 1082103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich } 1092103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 110469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SUPP_RATES; 1112103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich *pos++ = min_t(int, 8, rates_n); 1122103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (ri = 0; ri < sband->n_bitrates; ri++) { 1132103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate, 1142103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 5 * (1 << shift)); 115c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg u8 basic = 0; 1162103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (!(rates & BIT(ri))) 1172103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 1182103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 1192103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (basic_rates & BIT(ri)) 120c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg basic = 0x80; 1212103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich *pos++ = basic | (u8) rate; 12293c75786e8d8e8e245a479209a84b19292d08e7eSimon Wunderlich if (++rates_added == 8) { 12393c75786e8d8e8e245a479209a84b19292d08e7eSimon Wunderlich ri++; /* continue at next rate for EXT_SUPP_RATES */ 1242103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich break; 12593c75786e8d8e8e245a479209a84b19292d08e7eSimon Wunderlich } 126c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg } 127469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 128469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->band == IEEE80211_BAND_2GHZ) { 129469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_DS_PARAMS; 130469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 1; 131d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich *pos++ = ieee80211_frequency_to_channel( 132d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef->chan->center_freq); 133469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 134469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 135469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_IBSS_PARAMS; 136469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 2; 137469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* FIX: set ATIM window based on scan results */ 138469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 139469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 140469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 141cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (csa_settings) { 142cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = WLAN_EID_CHANNEL_SWITCH; 143cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = 3; 144cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = csa_settings->block_tx ? 1 : 0; 145cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = ieee80211_frequency_to_channel( 146cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich csa_settings->chandef.chan->center_freq); 147af296bdb8da4d0a4284de10fc4a61497272ddf11Michal Kazior presp->csa_counter_offsets[0] = (pos - presp->head); 148cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich *pos++ = csa_settings->count; 149cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 150cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1512103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich /* put the remaining rates in WLAN_EID_EXT_SUPP_RATES */ 1522103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (rates_n > 8) { 153469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_EXT_SUPP_RATES; 1542103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich *pos++ = rates_n - 8; 1552103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (; ri < sband->n_bitrates; ri++) { 1562103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rate = DIV_ROUND_UP(sband->bitrates[ri].bitrate, 1572103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 5 * (1 << shift)); 158c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg u8 basic = 0; 1592103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (!(rates & BIT(ri))) 1602103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 1612103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 1622103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (basic_rates & BIT(ri)) 163c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg basic = 0x80; 1642103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich *pos++ = basic | (u8) rate; 165c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg } 166469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 167469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 168c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg if (ifibss->ie_len) { 169c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg memcpy(pos, ifibss->ie, ifibss->ie_len); 170c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg pos += ifibss->ie_len; 171c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg } 172af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 17313c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* add HT capability and information IEs */ 174d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (chandef->width != NL80211_CHAN_WIDTH_20_NOHT && 175d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef->width != NL80211_CHAN_WIDTH_5 && 176d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef->width != NL80211_CHAN_WIDTH_10 && 177683b6d3b31a51956ea540df00abb0b78894924c1Johannes Berg sband->ht_cap.ht_supported) { 178822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich struct ieee80211_sta_ht_cap ht_cap; 179822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 180822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memcpy(&ht_cap, &sband->ht_cap, sizeof(ht_cap)); 181822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich ieee80211_apply_htcap_overrides(sdata, &ht_cap); 182822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 183822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich pos = ieee80211_ie_build_ht_cap(pos, &ht_cap, ht_cap.cap); 1840d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan /* 1850d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan * Note: According to 802.11n-2009 9.13.3.1, HT Protection 1860d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan * field and RIFS Mode are reserved in IBSS mode, therefore 1870d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan * keep them at 0 1880d894ec5017f7f463254e24fd2206e41d13cadffAshok Nagarajan */ 189074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg pos = ieee80211_ie_build_ht_oper(pos, &sband->ht_cap, 190d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef, 0); 19113c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 19213c40c54682ffe62977f670681268a26d500d6faAlexander Simon 19340b861a0eeb06bbfa472b456482ebf89b6886926Arik Nemtsov if (local->hw.queues >= IEEE80211_NUM_ACS) 19440b861a0eeb06bbfa472b456482ebf89b6886926Arik Nemtsov pos = ieee80211_add_wmm_info_ie(pos, 0); /* U-APSD not in use */ 1959eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 196c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg presp->head_len = pos - presp->head; 197c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg if (WARN_ON(presp->head_len > frame_len)) 198d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich goto error; 199d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 200d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return presp; 201d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlicherror: 202d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich kfree(presp); 203d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return NULL; 204d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich} 205d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 206d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlichstatic void __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 207d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const u8 *bssid, const int beacon_int, 208b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville struct cfg80211_chan_def *req_chandef, 209d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const u32 basic_rates, 210d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich const u16 capability, u64 tsf, 211d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich bool creator) 212d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich{ 213d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 214d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct ieee80211_local *local = sdata->local; 215d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct ieee80211_mgmt *mgmt; 216d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct cfg80211_bss *bss; 217d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich u32 bss_change; 218d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct cfg80211_chan_def chandef; 219b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville struct ieee80211_channel *chan; 220d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich struct beacon_data *presp; 221d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich enum nl80211_bss_scan_width scan_width; 222d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich bool have_higher_than_11mbit; 2232beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho bool radar_required; 22455fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg int err; 225d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 226d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata_assert_lock(sdata); 227d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 228d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich /* Reset own TSF to allow time synchronization work. */ 229d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich drv_reset_tsf(local, sdata); 230d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 231d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (!ether_addr_equal(ifibss->bssid, bssid)) 232d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sta_info_flush(sdata); 233d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 234d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich /* if merging, indicate to driver that we leave the old IBSS */ 235d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (sdata->vif.bss_conf.ibss_joined) { 236d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.ibss_joined = false; 237d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.ibss_creator = false; 238d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->vif.bss_conf.enable_beacon = false; 239d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich netif_carrier_off(sdata->dev); 240d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich ieee80211_bss_info_change_notify(sdata, 241d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich BSS_CHANGED_IBSS | 242d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich BSS_CHANGED_BEACON_ENABLED); 24355fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg drv_leave_ibss(local, sdata); 244d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 245d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 246d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich presp = rcu_dereference_protected(ifibss->presp, 247d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 2480c2bef4621c5feb5bda9068c9964b2e9acf57017Monam Agarwal RCU_INIT_POINTER(ifibss->presp, NULL); 249d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (presp) 250d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich kfree_rcu(presp, rcu_head); 251d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 252d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata->drop_unencrypted = capability & WLAN_CAPABILITY_PRIVACY ? 1 : 0; 253d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 254b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville /* make a copy of the chandef, it could be modified below. */ 255b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville chandef = *req_chandef; 256b35c809708ad245a36bef94d6fb1e83f6ab850aaJohn W. Linville chan = chandef.chan; 257174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef, 258174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer NL80211_IFTYPE_ADHOC)) { 259d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (chandef.width == NL80211_CHAN_WIDTH_5 || 260d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.width == NL80211_CHAN_WIDTH_10 || 261d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.width == NL80211_CHAN_WIDTH_20_NOHT || 262d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.width == NL80211_CHAN_WIDTH_20) { 263d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata_info(sdata, 264d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich "Failed to join IBSS, beacons forbidden\n"); 265d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return; 266d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 267d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.width = NL80211_CHAN_WIDTH_20; 268d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich chandef.center_freq1 = chan->center_freq; 2698e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich /* check again for downgraded chandef */ 270174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer if (!cfg80211_reg_can_beacon(local->hw.wiphy, &chandef, 271174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer NL80211_IFTYPE_ADHOC)) { 2728e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich sdata_info(sdata, 2738e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich "Failed to join IBSS, beacons forbidden\n"); 2748e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich return; 2758e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich } 2768e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich } 2778e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 2788e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 2792beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho &chandef, NL80211_IFTYPE_ADHOC); 2806658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho if (err < 0) { 2816658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho sdata_info(sdata, 2826658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho "Failed to join IBSS, invalid chandef\n"); 2836658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho return; 2846658ab80fd4ef940fc2366ddb66690a15ea69c18Luciano Coelho } 2852beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho if (err > 0 && !ifibss->userspace_handles_dfs) { 2862beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho sdata_info(sdata, 2872beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho "Failed to join IBSS, DFS channel without control program\n"); 2882beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho return; 289d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 290d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 2912beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho radar_required = err; 2922beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho 29334a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 294d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (ieee80211_vif_use_channel(sdata, &chandef, 295d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich ifibss->fixed_channel ? 296d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich IEEE80211_CHANCTX_SHARED : 297d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich IEEE80211_CHANCTX_EXCLUSIVE)) { 298d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich sdata_info(sdata, "Failed to join IBSS, no channel context\n"); 29934a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 300d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich return; 301d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich } 302cc901de1bcb0372583466075bfa62e3049dc6288Michal Kazior sdata->radar_required = radar_required; 30334a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 304d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 305d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich memcpy(ifibss->bssid, bssid, ETH_ALEN); 306d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich 307d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich presp = ieee80211_ibss_build_presp(sdata, beacon_int, basic_rates, 308d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich capability, tsf, &chandef, 309cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich &have_higher_than_11mbit, NULL); 310d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich if (!presp) 311c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg return; 312c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 313c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg rcu_assign_pointer(ifibss->presp, presp); 314d51b70ff5122d31e27733ba03c3afd62bb86bd63Simon Wunderlich mgmt = (void *)presp->head; 315469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 316d6a83228823fc0cc8d79d95c9f0bf568b7317862Johannes Berg sdata->vif.bss_conf.enable_beacon = true; 3172d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg sdata->vif.bss_conf.beacon_int = beacon_int; 318fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->vif.bss_conf.basic_rates = basic_rates; 3190ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak sdata->vif.bss_conf.ssid_len = ifibss->ssid_len; 3200ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak memcpy(sdata->vif.bss_conf.ssid, ifibss->ssid, ifibss->ssid_len); 3212d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change = BSS_CHANGED_BEACON_INT; 3222d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= ieee80211_reset_erp_info(sdata); 3232d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BSSID; 3242d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON; 3252d0ddec5b2b859f06116f631fc0ffe94fbceb556Johannes Berg bss_change |= BSS_CHANGED_BEACON_ENABLED; 326392cfdb10dab6c7dfa5fed18d8a44d7453d42196Teemu Paasikivi bss_change |= BSS_CHANGED_BASIC_RATES; 32713c40c54682ffe62977f670681268a26d500d6faAlexander Simon bss_change |= BSS_CHANGED_HT; 3288fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg bss_change |= BSS_CHANGED_IBSS; 3290ca54f6c5fd4ce58aa044d1fc7f00d7f6cf2801cMarek Puzyniak bss_change |= BSS_CHANGED_SSID; 3302f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich 3312f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich /* 3322f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * In 5 GHz/802.11a, we can always use short slot time. 3332f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * (IEEE 802.11-2012 18.3.8.7) 3342f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * 3352f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * In 2.4GHz, we must always use long slots in IBSS for compatibility 3362f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * reasons. 3372f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * (IEEE 802.11-2012 19.4.5) 3382f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * 3392f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich * HT follows these specifications (IEEE 802.11-2012 20.3.18) 3402f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich */ 3412f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich sdata->vif.bss_conf.use_short_slot = chan->band == IEEE80211_BAND_5GHZ; 3422f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich bss_change |= BSS_CHANGED_ERP_SLOT; 3432f91a96799d155d56a0663dbe00fc45c6721a763Simon Wunderlich 3442ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich /* cf. IEEE 802.11 9.2.12 */ 3452ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich if (chan->band == IEEE80211_BAND_2GHZ && have_higher_than_11mbit) 3462ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich sdata->flags |= IEEE80211_SDATA_OPERATING_GMODE; 3472ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich else 3482ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich sdata->flags &= ~IEEE80211_SDATA_OPERATING_GMODE; 3492ec9c1f67ab1f58b5bf5ac19e4b61b9f75c83a04Simon Wunderlich 35055fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_set_wmm_default(sdata, true); 35155fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg 3528fc214ba958648ab111a173f2db7b0e1dfed5b11Johannes Berg sdata->vif.bss_conf.ibss_joined = true; 353c13a765bd96f4e2f52d218ee6e5c0715380eeeb8Sujith Manoharan sdata->vif.bss_conf.ibss_creator = creator; 354469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 35555fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg err = drv_join_ibss(local, sdata); 35655fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg if (err) { 35755fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ibss_joined = false; 35855fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ibss_creator = false; 35955fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.enable_beacon = false; 36055fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata->vif.bss_conf.ssid_len = 0; 36155fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg RCU_INIT_POINTER(ifibss->presp, NULL); 36255fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg kfree_rcu(presp, rcu_head); 36334a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 36455fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_vif_release_channel(sdata); 36534a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 36655fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg sdata_info(sdata, "Failed to join IBSS, driver failure: %d\n", 36755fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg err); 36855fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg return; 36955fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg } 37055fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg 37155fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg ieee80211_bss_info_change_notify(sdata, bss_change); 372469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 374af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 375af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3777ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chandef); 3787ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich bss = cfg80211_inform_bss_width_frame(local->hw.wiphy, chan, 3797ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width, mgmt, 3807ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich presp->head_len, 0, GFP_KERNEL); 3815b112d3d098c97b867cc580f590395cd1e72f18cJohannes Berg cfg80211_put_bss(local->hw.wiphy, bss); 38286a2ea4134b48f6371103cfceb521bf2d2bf76cdEliad Peller netif_carrier_on(sdata->dev); 383fe94f3a4ffaa20c7470038c69ffc8e545ef5f90aAntonio Quartulli cfg80211_ibss_joined(sdata->dev, ifibss->bssid, chan, GFP_KERNEL); 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 386af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 387af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_bss *bss) 388469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 3890c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss = 3900c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg container_of((void *)bss, struct cfg80211_bss, priv); 391b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg struct ieee80211_supported_band *sband; 39275a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich struct cfg80211_chan_def chandef; 393b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg u32 basic_rates; 394b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg int i, j; 3950c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg u16 beacon_int = cbss->beacon_interval; 3968cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg const struct cfg80211_bss_ies *ies; 39775a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich enum nl80211_channel_type chan_type; 3988cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg u64 tsf; 3992103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich u32 rate_flags; 4002103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int shift; 40157c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 4028d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 4037a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 40457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg if (beacon_int < 10) 40557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int = 10; 40657c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 40775a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich switch (sdata->u.ibss.chandef.width) { 40875a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 40975a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_20: 41075a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_40: 41175a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich chan_type = cfg80211_get_chandef_type(&sdata->u.ibss.chandef); 41275a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, chan_type); 41375a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 41475a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_5: 41575a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich case NL80211_CHAN_WIDTH_10: 41675a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, 41775a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich NL80211_CHAN_WIDTH_20_NOHT); 41875a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich chandef.width = sdata->u.ibss.chandef.width; 41975a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 42075a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich default: 42175a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich /* fall back to 20 MHz for unsupported modes */ 42275a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich cfg80211_chandef_create(&chandef, cbss->channel, 42375a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich NL80211_CHAN_WIDTH_20_NOHT); 42475a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich break; 42575a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich } 42675a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich 4270c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg sband = sdata->local->hw.wiphy->bands[cbss->channel->band]; 4282103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rate_flags = ieee80211_chandef_rate_flags(&sdata->u.ibss.chandef); 4292103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich shift = ieee80211_vif_get_shift(&sdata->vif); 430b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 431b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates = 0; 432b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 433b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (i = 0; i < bss->supp_rates_len; i++) { 4342103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int rate = bss->supp_rates[i] & 0x7f; 435b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg bool is_basic = !!(bss->supp_rates[i] & 0x80); 436b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 437b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg for (j = 0; j < sband->n_bitrates; j++) { 4382103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int brate; 4392103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if ((rate_flags & sband->bitrates[j].flags) 4402103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich != rate_flags) 4412103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich continue; 4422103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 4432103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich brate = DIV_ROUND_UP(sband->bitrates[j].bitrate, 4442103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 5 * (1 << shift)); 4452103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if (brate == rate) { 446b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg if (is_basic) 447b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates |= BIT(j); 448b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg break; 449b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 450b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 451b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg } 452b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg 4538cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg rcu_read_lock(); 4548cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg ies = rcu_dereference(cbss->ies); 4558cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg tsf = ies->tsf; 4568cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg rcu_read_unlock(); 4578cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg 4580c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg __ieee80211_sta_join_ibss(sdata, cbss->bssid, 45957c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg beacon_int, 46075a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich &chandef, 461b59066a291ca7c12a1e5b58f3ada5ab6e32cb6bdJohannes Berg basic_rates, 4620c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss->capability, 4638cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg tsf, false); 464469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 465469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 466cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichint ieee80211_ibss_csa_beacon(struct ieee80211_sub_if_data *sdata, 467cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_csa_settings *csa_settings) 468cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 469cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 470cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct beacon_data *presp, *old_presp; 471cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_bss *cbss; 472cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich const struct cfg80211_bss_ies *ies; 473cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u16 capability; 474cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u64 tsf; 475cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int ret = 0; 476cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 477cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_assert_lock(sdata); 478cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 479cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability = WLAN_CAPABILITY_IBSS; 480cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 481cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ifibss->privacy) 482cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 483cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 484cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cbss = cfg80211_get_bss(sdata->local->hw.wiphy, ifibss->chandef.chan, 485cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, ifibss->ssid, 486cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 487cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_CAPABILITY_PRIVACY, 488cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability); 489cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 490cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (WARN_ON(!cbss)) { 491cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ret = -EINVAL; 492cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto out; 493cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 494cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 495cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_read_lock(); 496cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies = rcu_dereference(cbss->ies); 497cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich tsf = ies->tsf; 498cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_read_unlock(); 499cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 500cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 501cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich old_presp = rcu_dereference_protected(ifibss->presp, 502cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 503cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 504cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich presp = ieee80211_ibss_build_presp(sdata, 505cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata->vif.bss_conf.beacon_int, 506cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata->vif.bss_conf.basic_rates, 507cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability, tsf, &ifibss->chandef, 508cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich NULL, csa_settings); 509cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (!presp) { 510cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ret = -ENOMEM; 511cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto out; 512cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 513cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 514cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rcu_assign_pointer(ifibss->presp, presp); 515cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (old_presp) 516cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich kfree_rcu(old_presp, rcu_head); 517cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 518dddd586bee9325e890a671f8e24ae39418338295Luciano Coelho return BSS_CHANGED_BEACON; 519cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich out: 520cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return ret; 521cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 522cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 523cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichint ieee80211_ibss_finish_csa(struct ieee80211_sub_if_data *sdata) 524cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 525cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 526cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_bss *cbss; 527faf046e7231bf008715bbffe5cca2ed3aa31be1bMichal Kazior int err, changed = 0; 528cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u16 capability; 529cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 530bafdc614a1f4f8be8cde41b8ab10ac17e67c1837Simon Wunderlich sdata_assert_lock(sdata); 531bafdc614a1f4f8be8cde41b8ab10ac17e67c1837Simon Wunderlich 532cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* update cfg80211 bss information with the new channel */ 533cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (!is_zero_ether_addr(ifibss->bssid)) { 534cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability = WLAN_CAPABILITY_IBSS; 535cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 536cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ifibss->privacy) 537cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 538cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 539cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cbss = cfg80211_get_bss(sdata->local->hw.wiphy, 540cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->chandef.chan, 541cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, ifibss->ssid, 542cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 543cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_CAPABILITY_PRIVACY, 544cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich capability); 545cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* XXX: should not really modify cfg80211 data */ 546cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (cbss) { 54733787fc4bea0347d78a211d1f38289b73d9ec1a6Luciano Coelho cbss->channel = sdata->csa_chandef.chan; 548cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 549cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 550cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 551cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 55233787fc4bea0347d78a211d1f38289b73d9ec1a6Luciano Coelho ifibss->chandef = sdata->csa_chandef; 553cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 554cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* generate the beacon */ 555cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich err = ieee80211_ibss_csa_beacon(sdata, NULL); 556cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 557cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return err; 558cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 559faf046e7231bf008715bbffe5cca2ed3aa31be1bMichal Kazior changed |= err; 560dddd586bee9325e890a671f8e24ae39418338295Luciano Coelho 561faf046e7231bf008715bbffe5cca2ed3aa31be1bMichal Kazior return changed; 562cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 563cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 564cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichvoid ieee80211_ibss_stop(struct ieee80211_sub_if_data *sdata) 565cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 566cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 567cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 568cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cancel_work_sync(&ifibss->csa_connection_drop_work); 569cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 570cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 57152874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartullistatic struct sta_info *ieee80211_ibss_finish_sta(struct sta_info *sta) 5728bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 5738bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 5748bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_sub_if_data *sdata = sta->sdata; 5758bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u8 addr[ETH_ALEN]; 5768bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 5778bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg memcpy(addr, sta->sta.addr, ETH_ALEN); 5788bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 579bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "Adding new IBSS station %pM\n", addr); 5808bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 58183d5cc012441531ab0bf6f99881958e964e9cf11Johannes Berg sta_info_pre_move_state(sta, IEEE80211_STA_AUTH); 58283d5cc012441531ab0bf6f99881958e964e9cf11Johannes Berg sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC); 583267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli /* authorize the station only if the network is not RSN protected. If 584267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli * not wait for the userspace to authorize it */ 585267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli if (!sta->sdata->u.ibss.control_port) 586267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli sta_info_pre_move_state(sta, IEEE80211_STA_AUTHORIZED); 5878bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 5888bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rate_control_rate_init(sta); 5898bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 5908bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* If it fails, maybe we raced another insertion? */ 5918bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (sta_info_insert_rcu(sta)) 5928bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta_info_get(sdata, addr); 5938bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return sta; 5948bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 5958bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 5968bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergstatic struct sta_info * 59752874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulliieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, const u8 *bssid, 59852874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli const u8 *addr, u32 supp_rates) 5998bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg __acquires(RCU) 6008bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg{ 6018bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 6028bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct ieee80211_local *local = sdata->local; 6038bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 60455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg struct ieee80211_chanctx_conf *chanctx_conf; 605b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan struct ieee80211_supported_band *sband; 60674608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 60755de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg int band; 6088bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6098bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* 6108bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * XXX: Consider removing the least recently used entry and 6118bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg * allow new one to be added. 6128bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg */ 6138bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 614bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n", 615e87cc4728f0e2fb663e592a1141742b1d6c63256Joe Perches sdata->name, addr); 6168bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6178bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6188bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6198bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6208bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) { 6218bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6228bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6238bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6248bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 625b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) { 6268bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6278bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6288bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6298bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 63055de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_lock(); 63155de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 63255de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (WARN_ON_ONCE(!chanctx_conf)) 63355de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg return NULL; 6344bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg band = chanctx_conf->def.chan->band; 63574608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chanctx_conf->def); 63655de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 63755de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg 6388bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_KERNEL); 6398bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg if (!sta) { 6408bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_lock(); 6418bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return NULL; 6428bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 6438bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6448bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->last_rx = jiffies; 6458bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 6468bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg /* make sure mandatory rates are always added */ 647b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan sband = local->hw.wiphy->bands[band]; 6488bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta->sta.supp_rates[band] = supp_rates | 64974608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, scan_width); 6508bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 65152874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli return ieee80211_ibss_finish_sta(sta); 6526d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli} 6536d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 654871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlichstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 655871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich{ 656871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_local *local = sdata->local; 657871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich int active = 0; 658871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info *sta; 659871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 660871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata_assert_lock(sdata); 661871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 662871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich rcu_read_lock(); 663871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 664871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich list_for_each_entry_rcu(sta, &local->sta_list, list) { 665871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (sta->sdata == sdata && 666871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 667871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich jiffies)) { 668871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich active++; 669871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich break; 670871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 671871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 672871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 673871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich rcu_read_unlock(); 674871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 675871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich return active; 676871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich} 677871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 678871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlichstatic void ieee80211_ibss_disconnect(struct ieee80211_sub_if_data *sdata) 679871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich{ 680871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 681871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct ieee80211_local *local = sdata->local; 682871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct cfg80211_bss *cbss; 683871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct beacon_data *presp; 684871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info *sta; 685871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich u16 capability; 686871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 687d4c80d9df6d1e4473b1409e4d220ca3d1612125cSujith Manoharan if (!is_zero_ether_addr(ifibss->bssid)) { 688871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability = WLAN_CAPABILITY_IBSS; 689871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 690871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (ifibss->privacy) 691871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability |= WLAN_CAPABILITY_PRIVACY; 692871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 693871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cbss = cfg80211_get_bss(local->hw.wiphy, ifibss->chandef.chan, 694871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->bssid, ifibss->ssid, 695871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->ssid_len, WLAN_CAPABILITY_IBSS | 696871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich WLAN_CAPABILITY_PRIVACY, 697871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich capability); 698871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 699871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (cbss) { 700871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cfg80211_unlink_bss(local->hw.wiphy, cbss); 701871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich cfg80211_put_bss(sdata->local->hw.wiphy, cbss); 702871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 703871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 704871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 705871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ifibss->state = IEEE80211_IBSS_MLME_SEARCH; 706871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 707871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta_info_flush(sdata); 708871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 709871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_lock_bh(&ifibss->incomplete_lock); 710871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich while (!list_empty(&ifibss->incomplete_stations)) { 711871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta = list_first_entry(&ifibss->incomplete_stations, 712871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich struct sta_info, list); 713871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich list_del(&sta->list); 714871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_unlock_bh(&ifibss->incomplete_lock); 715871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 716871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sta_info_free(local, sta); 717871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_lock_bh(&ifibss->incomplete_lock); 718871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich } 719871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich spin_unlock_bh(&ifibss->incomplete_lock); 720871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 721871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich netif_carrier_off(sdata->dev); 722871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 723871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ibss_joined = false; 724871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ibss_creator = false; 725871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.enable_beacon = false; 726871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich sdata->vif.bss_conf.ssid_len = 0; 727871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 728871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich /* remove beacon */ 729871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich presp = rcu_dereference_protected(ifibss->presp, 730871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich lockdep_is_held(&sdata->wdev.mtx)); 731871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich RCU_INIT_POINTER(sdata->u.ibss.presp, NULL); 732871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich if (presp) 733871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich kfree_rcu(presp, rcu_head); 734871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 735871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state); 736871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED | 737871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich BSS_CHANGED_IBSS); 73855fff50113daa178010a38e0dc27172f06d17b8eJohannes Berg drv_leave_ibss(local, sdata); 73934a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_lock(&local->mtx); 740871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_vif_release_channel(sdata); 74134a3740d6b392896b71e36cd5cd68837a8f94a5cJohannes Berg mutex_unlock(&local->mtx); 742871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich} 743871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich 744cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic void ieee80211_csa_connection_drop_work(struct work_struct *work) 745cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 746cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_sub_if_data *sdata = 747cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich container_of(work, struct ieee80211_sub_if_data, 748cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u.ibss.csa_connection_drop_work); 749cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 7506f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho sdata_lock(sdata); 7516f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho 752cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_ibss_disconnect(sdata); 753cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich synchronize_rcu(); 754cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich skb_queue_purge(&sdata->skb_queue); 755cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 756cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* trigger a scan to find another IBSS network to join */ 757cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_queue_work(&sdata->local->hw, &sdata->work); 7586f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho 7596f07d216f5662def442cb8034f45119b5a33f6ffLuciano Coelho sdata_unlock(sdata); 760cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 761cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 7628e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlichstatic void ieee80211_ibss_csa_mark_radar(struct ieee80211_sub_if_data *sdata) 7638e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich{ 7648e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 7658e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich int err; 7668e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 7678e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich /* if the current channel is a DFS channel, mark the channel as 7688e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich * unavailable. 7698e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich */ 7708e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 7712beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho &ifibss->chandef, 7722beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho NL80211_IFTYPE_ADHOC); 7738e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich if (err > 0) 7748e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich cfg80211_radar_event(sdata->local->hw.wiphy, &ifibss->chandef, 7758e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich GFP_ATOMIC); 7768e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich} 7778e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 778cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic bool 779cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichieee80211_ibss_process_chanswitch(struct ieee80211_sub_if_data *sdata, 780cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems *elems, 781cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich bool beacon) 782cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 783cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct cfg80211_csa_settings params; 784c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh struct ieee80211_csa_ie csa_ie; 785cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 786cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich enum nl80211_channel_type ch_type; 78782a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho int err; 788cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u32 sta_flags; 789cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 790dbd72850dcc9738b42a9762ef8c4a1a66b30d897Michal Kazior sdata_assert_lock(sdata); 791dbd72850dcc9738b42a9762ef8c4a1a66b30d897Michal Kazior 792cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags = IEEE80211_STA_DISABLE_VHT; 793cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (ifibss->chandef.width) { 794cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_5: 795cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_10: 796cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 797cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags |= IEEE80211_STA_DISABLE_HT; 798cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* fall through */ 799cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20: 800cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sta_flags |= IEEE80211_STA_DISABLE_40MHZ; 801cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 802cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich default: 803cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 804cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 805cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 806cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich memset(¶ms, 0, sizeof(params)); 807c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh memset(&csa_ie, 0, sizeof(csa_ie)); 80884469a45a1bedec9918e94ab2f78c5dc0739e4a7Luciano Coelho err = ieee80211_parse_ch_switch_ie(sdata, elems, 809cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->chandef.chan->band, 810c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh sta_flags, ifibss->bssid, &csa_ie); 811cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* can't switch to destination channel, fail */ 812cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 813cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 814cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 815cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* did not contain a CSA */ 816cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err) 817cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return false; 818cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 8190834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich /* channel switch is not supported, disconnect */ 8200834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich if (!(sdata->local->hw.wiphy->flags & WIPHY_FLAG_HAS_CHANNEL_SWITCH)) 8210834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich goto disconnect; 8220834ae3c3af44480834cce128b6fef83006e537fSimon Wunderlich 823c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.count = csa_ie.count; 824c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.chandef = csa_ie.chandef; 825c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh 826cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (ifibss->chandef.width) { 827cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20_NOHT: 828cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_20: 829cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_40: 830cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* keep our current HT mode (HT20/HT40+/HT40-), even if 831cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * another mode has been announced. The mode is not adopted 832cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * within the beacon while doing CSA and we should therefore 833cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich * keep the mode which we announce. 834cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich */ 835cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ch_type = cfg80211_get_chandef_type(&ifibss->chandef); 836cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich cfg80211_chandef_create(¶ms.chandef, params.chandef.chan, 837cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ch_type); 838cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 839cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_5: 840cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case NL80211_CHAN_WIDTH_10: 841cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (params.chandef.width != ifibss->chandef.width) { 842cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_info(sdata, 843cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "IBSS %pM received channel switch from incompatible channel width (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n", 844cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, 845cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq, 846cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.width, 847cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq1, 848cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq2); 849cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 850cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 851cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 852cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich default: 853cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* should not happen, sta_flags should prevent VHT modes. */ 854cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WARN_ON(1); 855cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 856cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 857cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 858174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer if (!cfg80211_reg_can_beacon(sdata->local->hw.wiphy, ¶ms.chandef, 859174e0cd28af0fe3c6c634c3e4d9e042c683bd7f7Ilan Peer NL80211_IFTYPE_ADHOC)) { 860cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sdata_info(sdata, 861cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "IBSS %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n", 862cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ifibss->bssid, 863cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq, 864cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.width, 865cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq1, 866cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.center_freq2); 867cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 868cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 869cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 870cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich err = cfg80211_chandef_dfs_required(sdata->local->hw.wiphy, 8712beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho ¶ms.chandef, 8722beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho NL80211_IFTYPE_ADHOC); 873cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (err < 0) 874cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto disconnect; 8752beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho if (err > 0 && !ifibss->userspace_handles_dfs) { 8768e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich /* IBSS-DFS only allowed with a control program */ 8772beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho goto disconnect; 878cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 879cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 8802beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho params.radar_required = err; 8812beb6dab2d799ee8934cb0801845e551ad8c70f2Luciano Coelho 88282a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (cfg80211_chandef_identical(¶ms.chandef, 88382a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho &sdata->vif.bss_conf.chandef)) { 88482a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ibss_dbg(sdata, 88582a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho "received csa with an identical chandef, ignoring\n"); 88682a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho return true; 887cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 888cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 889cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* all checks done, now perform the channel switch. */ 890cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ibss_dbg(sdata, 891cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich "received channel switch announcement to go to channel %d MHz\n", 892cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich params.chandef.chan->center_freq); 893cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 894c0f17eb9b2d4d322c099a0700437209149224583Chun-Yeow Yeoh params.block_tx = !!csa_ie.mode; 895cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 89682a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (ieee80211_channel_switch(sdata->local->hw.wiphy, sdata->dev, 89782a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ¶ms)) 89882a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho goto disconnect; 899cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9008e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich ieee80211_ibss_csa_mark_radar(sdata); 9018e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 902cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return true; 903cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichdisconnect: 904cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ibss_dbg(sdata, "Can't handle channel switch, disconnect\n"); 905cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_queue_work(&sdata->local->hw, 906cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich &ifibss->csa_connection_drop_work); 907cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9088e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich ieee80211_ibss_csa_mark_radar(sdata); 9098e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich 910cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return true; 911cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 912cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 913cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichstatic void 914cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlichieee80211_rx_mgmt_spectrum_mgmt(struct ieee80211_sub_if_data *sdata, 915cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_mgmt *mgmt, size_t len, 916cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee80211_rx_status *rx_status, 917cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems *elems) 918cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich{ 919cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int required_len; 920cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 921cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (len < IEEE80211_MIN_ACTION_SIZE + 1) 922cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 923cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 924cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* CSA is the only action we handle for now */ 925cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (mgmt->u.action.u.measurement.action_code != 926cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich WLAN_ACTION_SPCT_CHL_SWITCH) 927cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 928cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 929cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich required_len = IEEE80211_MIN_ACTION_SIZE + 930cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich sizeof(mgmt->u.action.u.chan_switch); 931cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (len < required_len) 932cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich return; 933cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 93482a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (!sdata->vif.csa_active) 93582a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ieee80211_ibss_process_chanswitch(sdata, elems, false); 936cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich} 937cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 9382cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartullistatic void ieee80211_rx_mgmt_deauth_ibss(struct ieee80211_sub_if_data *sdata, 9392cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli struct ieee80211_mgmt *mgmt, 9402cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli size_t len) 9412cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli{ 9422cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli u16 reason = le16_to_cpu(mgmt->u.deauth.reason_code); 9432cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9442cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli if (len < IEEE80211_DEAUTH_FRAME_LEN) 9452cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli return; 9462cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9472cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli ibss_dbg(sdata, "RX DeAuth SA=%pM DA=%pM BSSID=%pM (reason: %d)\n", 9482cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli mgmt->sa, mgmt->da, mgmt->bssid, reason); 9492cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli sta_info_destroy_addr(sdata, mgmt->sa); 9502cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli} 9512cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli 9526d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartullistatic void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata, 9536d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli struct ieee80211_mgmt *mgmt, 9546d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli size_t len) 9556d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli{ 9566d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli u16 auth_alg, auth_transaction; 9576d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9588d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 9596d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9606d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli if (len < 24 + 6) 9616d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli return; 9626d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 9636d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); 9646d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); 9656d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli 966bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 967bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX Auth SA=%pM DA=%pM BSSID=%pM (auth_transaction=%d)\n", 968bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->da, mgmt->bssid, auth_transaction); 9697bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli 9707bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli if (auth_alg != WLAN_AUTH_OPEN || auth_transaction != 1) 9717bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli return; 9727bed20503f62ae9660c7b5cd6c3603960e422450Antonio Quartulli 9732cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli /* 9746d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * IEEE 802.11 standard does not require authentication in IBSS 9756d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * networks and most implementations do not seem to use it. 9766d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * However, try to reply to authentication attempts if someone 9776d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli * has actually implemented this. 9786d810f10325522cfcf498dc6d64b9f96e1f5153fAntonio Quartulli */ 979700e8ea6770df3113e735bcc76ecd6ffac71a13cJouni Malinen ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, 0, NULL, 0, 9801672c0e31917f49d31d30d79067103432bc20cc7Johannes Berg mgmt->sa, sdata->u.ibss.bssid, NULL, 0, 0, 0); 9818bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg} 9828bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 983469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 984d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_mgmt *mgmt, size_t len, 985469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 986d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee802_11_elems *elems) 987469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 988469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 9890c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 990469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 991469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 992469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 993469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 994469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 995469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 99674608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 99713c40c54682ffe62977f670681268a26d500d6faAlexander Simon struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band]; 99813c40c54682ffe62977f670681268a26d500d6faAlexander Simon bool rates_updated = false; 999469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10003afc2167f60a327a2c1e1e2600ef209a3c2b75b7Emmanuel Grumbach channel = ieee80211_get_channel(local->hw.wiphy, rx_status->freq); 10013afc2167f60a327a2c1e1e2600ef209a3c2b75b7Emmanuel Grumbach if (!channel) 1002469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1003469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10049eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sdata->vif.type == NL80211_IFTYPE_ADHOC && 1005b203ca39126bad99583c908be587df067820a1eaJoe Perches ether_addr_equal(mgmt->bssid, sdata->u.ibss.bssid)) { 1006469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1007469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 1008abe60632f311d515b082b450504ee24006023951Johannes Berg sta = sta_info_get(sdata, mgmt->sa); 1009469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10109eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (elems->supp_rates) { 10112103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich supp_rates = ieee80211_sta_get_rates(sdata, elems, 10129ebb61a23d90703344fc609fbee8da67b1e7456cAshok Nagarajan band, NULL); 10139eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta) { 10149eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf u32 prev_rates; 10159eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 10169eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf prev_rates = sta->sta.supp_rates[band]; 10179eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf /* make sure mandatory rates are always added */ 101874608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_20; 101974608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich if (rx_status->flag & RX_FLAG_5MHZ) 102074608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_5; 102174608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich if (rx_status->flag & RX_FLAG_10MHZ) 102274608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = NL80211_BSS_CHAN_WIDTH_10; 1023469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 102474608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich sta->sta.supp_rates[band] = supp_rates | 102574608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, 102674608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width); 10279eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta->sta.supp_rates[band] != prev_rates) { 1028bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1029bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "updated supp_rates set for %pM based on beacon/probe_resp (0x%x -> 0x%x)\n", 1030bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sta->sta.addr, prev_rates, 1031bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sta->sta.supp_rates[band]); 103213c40c54682ffe62977f670681268a26d500d6faAlexander Simon rates_updated = true; 10339eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf } 10348bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } else { 10358bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 10369eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf sta = ieee80211_ibss_add_sta(sdata, mgmt->bssid, 103752874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli mgmt->sa, supp_rates); 10388bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 103934e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg } 10409eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 10419eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf if (sta && elems->wmm_info) 1042a74a8c846fb699f3277c0c21278bd4c414074b4aJohannes Berg sta->sta.wme = true; 10439eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf 1044074d46d1d23f27488a3f314e29cae2453541f17dJohannes Berg if (sta && elems->ht_operation && elems->ht_cap_elem && 10453aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_20_NOHT && 10463aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_5 && 10473aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.width != NL80211_CHAN_WIDTH_10) { 104813c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* we both use HT */ 1049e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg struct ieee80211_ht_cap htcap_ie; 10504bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg struct cfg80211_chan_def chandef; 10514bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg 10524bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg ieee80211_ht_oper_to_chandef(channel, 10534bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg elems->ht_operation, 10544bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg &chandef); 105513c40c54682ffe62977f670681268a26d500d6faAlexander Simon 1056e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg memcpy(&htcap_ie, elems->ht_cap_elem, sizeof(htcap_ie)); 105713c40c54682ffe62977f670681268a26d500d6faAlexander Simon 105813c40c54682ffe62977f670681268a26d500d6faAlexander Simon /* 105913c40c54682ffe62977f670681268a26d500d6faAlexander Simon * fall back to HT20 if we don't use or use 106013c40c54682ffe62977f670681268a26d500d6faAlexander Simon * the other extension channel 106113c40c54682ffe62977f670681268a26d500d6faAlexander Simon */ 10623aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich if (chandef.center_freq1 != 10633aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.center_freq1) 1064e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg htcap_ie.cap_info &= 1065e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg cpu_to_le16(~IEEE80211_HT_CAP_SUP_WIDTH_20_40); 1066e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg 1067e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg rates_updated |= ieee80211_ht_cap_ie_to_sta_ht_cap( 1068e1a0c6b3a4b27ed5f21291d0bbee2167ec201ef5Johannes Berg sdata, sband, &htcap_ie, sta); 106913c40c54682ffe62977f670681268a26d500d6faAlexander Simon } 107013c40c54682ffe62977f670681268a26d500d6faAlexander Simon 1071e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli if (sta && rates_updated) { 1072e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli drv_sta_rc_update(local, sdata, &sta->sta, 1073e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli IEEE80211_RC_SUPP_RATES_CHANGED); 107413c40c54682ffe62977f670681268a26d500d6faAlexander Simon rate_control_rate_init(sta); 1075e687f61eedab8895e5669cb82cebe0253631cd8cAntonio Quartulli } 107613c40c54682ffe62977f670681268a26d500d6faAlexander Simon 10779eba612549f575d7dccda672ce932e15e7392d83Bruno Randolf rcu_read_unlock(); 1078469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1079469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1080469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 1081d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach channel); 1082469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 1083469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1084469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 10850c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = container_of((void *)bss, struct cfg80211_bss, priv); 10860c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 10878cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg /* same for beacon and probe response */ 10888cef2c9df88fdd13f518e6607de9d664b31f26ccJohannes Berg beacon_timestamp = le64_to_cpu(mgmt->u.beacon.timestamp); 1089469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1090469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 1091469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1092469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 10930c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (!(cbss->capability & WLAN_CAPABILITY_IBSS)) 1094469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1095469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1096469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 109755de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (sdata->u.ibss.fixed_channel && 10983aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef.chan != cbss->channel) 1099469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1100469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1101469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 1102469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 1103469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 1104469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 1105469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 1106469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1107cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* process channel switch */ 110882a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho if (sdata->vif.csa_active || 110982a8e17d4a4faae2366aca61c617af87bcc822c1Luciano Coelho ieee80211_ibss_process_chanswitch(sdata, elems, true)) 1110cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto put_bss; 1111cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 111234e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 1113b203ca39126bad99583c908be587df067820a1eaJoe Perches if (ether_addr_equal(cbss->bssid, sdata->u.ibss.bssid)) 111434e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 111534e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 1116cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich /* we use a fixed BSSID */ 1117cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (sdata->u.ibss.fixed_bssid) 1118cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich goto put_bss; 1119cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1120f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen if (ieee80211_have_rx_timestamp(rx_status)) { 1121f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen /* time when timestamp field was received */ 1122f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen rx_timestamp = 1123f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen ieee80211_calculate_rx_timestamp(local, rx_status, 1124f4bda337bbb6e245e2a07f344990adeb6a70ff35Thomas Pedersen len + FCS_LEN, 24); 11252448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } else { 11262448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg /* 11272448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * second best option: get current TSF 11282448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg * (will return -1 if not supported) 11292448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg */ 113037a41b4affa33bb237d3692bf51f1b5ebcaf29d8Eliad Peller rx_timestamp = drv_get_tsf(local, sdata); 11312448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg } 1132469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1133bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1134bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX beacon SA=%pM BSSID=%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 1135bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->bssid, 1136bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)rx_timestamp, 1137bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)beacon_timestamp, 1138bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 1139bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg jiffies); 1140469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1141469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 1142bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1143bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "beacon TSF higher than local TSF - IBSS merge with BSSID %pM\n", 1144bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->bssid); 1145469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 11462103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich supp_rates = ieee80211_sta_get_rates(sdata, elems, band, NULL); 114734e895075e21be3e21e71d6317440d1ee7969ad0Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, 114852874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli supp_rates); 11498bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 1150469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1151469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1152469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 1153469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 1154469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1155469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 11568bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Bergvoid ieee80211_ibss_rx_no_sta(struct ieee80211_sub_if_data *sdata, 11578bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg const u8 *bssid, const u8 *addr, 11588bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg u32 supp_rates) 1159469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 11602e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1161469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 1162469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 116355de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg struct ieee80211_chanctx_conf *chanctx_conf; 1164b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan struct ieee80211_supported_band *sband; 116574608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 116655de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg int band; 1167469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1168af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* 1169af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * XXX: Consider removing the least recently used entry and 1170af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg * allow new one to be added. 1171af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg */ 1172469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 1173bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg net_info_ratelimited("%s: No room for a new IBSS STA entry %pM\n", 1174e87cc4728f0e2fb663e592a1141742b1d6c63256Joe Perches sdata->name, addr); 11758bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1176469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1177469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 11782e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau if (ifibss->state == IEEE80211_IBSS_MLME_SEARCH) 11798bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 11802e10d330f8d5f039fa1e00baf59435ab0f11c722Felix Fietkau 1181b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(bssid, sdata->u.ibss.bssid)) 11828bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1183469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 118455de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_lock(); 118555de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); 118655de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg if (WARN_ON_ONCE(!chanctx_conf)) { 118755de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 118855de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg return; 118955de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg } 11904bf88530be971bf95a7830ca61b4120980bf4347Johannes Berg band = chanctx_conf->def.chan->band; 119174608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&chanctx_conf->def); 119255de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg rcu_read_unlock(); 119355de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg 11948bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 1195469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 11968bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg return; 1197469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1198c8716d9dc13c7f6ee92f2bfc6cc3b723b417bff8Rajkumar Manoharan sta->last_rx = jiffies; 1199d9a7ddb05e5419ca5e4b54f57074dc33c7ea991cJohannes Berg 1200469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 1201b422c6cd7e93bb613030f14d7d8a0cc73f115629Ashok Nagarajan sband = local->hw.wiphy->bands[band]; 1202469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 120374608aca4d82e2855b1a6a2cd60331d1a98f2d6aSimon Wunderlich ieee80211_mandatory_rates(sband, scan_width); 1204469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12058bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock(&ifibss->incomplete_lock); 12068bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_add(&sta->list, &ifibss->incomplete_stations); 12078bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock(&ifibss->incomplete_lock); 12088bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 1209469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1210469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1211dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartullistatic void ieee80211_ibss_sta_expire(struct ieee80211_sub_if_data *sdata) 1212dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli{ 1213dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli struct ieee80211_local *local = sdata->local; 1214dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli struct sta_info *sta, *tmp; 1215dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli unsigned long exp_time = IEEE80211_IBSS_INACTIVITY_LIMIT; 1216dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli unsigned long exp_rsn_time = IEEE80211_IBSS_RSN_INACTIVITY_LIMIT; 1217dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1218dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli mutex_lock(&local->sta_mtx); 1219dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1220dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli list_for_each_entry_safe(sta, tmp, &local->sta_list, list) { 1221dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli if (sdata != sta->sdata) 1222dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli continue; 1223dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1224dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli if (time_after(jiffies, sta->last_rx + exp_time) || 1225dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli (time_after(jiffies, sta->last_rx + exp_rsn_time) && 1226dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta->sta_state != IEEE80211_STA_AUTHORIZED)) { 1227dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta_dbg(sta->sdata, "expiring inactive %sSTA %pM\n", 1228dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli sta->sta_state != IEEE80211_STA_AUTHORIZED ? 1229dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli "not authorized " : "", sta->sta.addr); 1230dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1231dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli WARN_ON(__sta_info_destroy(sta)); 1232dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli } 1233dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli } 1234dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1235dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli mutex_unlock(&local->sta_mtx); 1236dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli} 1237dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli 1238ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 1239ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_JOINED 1240ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 1241469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1242469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 1243469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1244469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 12457ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 1246469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12478d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 12487a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1249af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 1250af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + IEEE80211_IBSS_MERGE_INTERVAL)); 1251469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1252dad9defd28912dc408763d461b9a6b1a762c07eaAntonio Quartulli ieee80211_ibss_sta_expire(sdata); 1253af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1254450aae3d7b60a970f266349a837dfb30a539198bSujith if (time_before(jiffies, ifibss->last_scan_completed + 1255450aae3d7b60a970f266349a837dfb30a539198bSujith IEEE80211_IBSS_MERGE_INTERVAL)) 1256450aae3d7b60a970f266349a837dfb30a539198bSujith return; 1257450aae3d7b60a970f266349a837dfb30a539198bSujith 1258469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 1259469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1260469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1261c037b8367c7e2b775a99d74037f5df014d2fbf06John W. Linville if (ifibss->fixed_channel) 1262469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1263469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1264bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, 1265bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "No active IBSS STAs - trying to scan for other IBSS networks with same SSID (merge)\n"); 1266469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12677ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&ifibss->chandef); 126834bcf71502413f8903ade93746f2d0f04b937a78Stanislaw Gruszka ieee80211_request_ibss_scan(sdata, ifibss->ssid, ifibss->ssid_len, 12697ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich NULL, scan_width); 1270469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1271469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1272af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 1273469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1274469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1275469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 1276469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 1277469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 1278469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 12798d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 12807a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1281af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) { 1282469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 1283469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 1284469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 1285469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 1286469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 1287469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 1288469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 128947846c9b0c10808d9337d2e7d09361f3e0a0a71aJohannes Berg bssid[i] ^= sdata->vif.addr[i]; 1290469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 1291469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 1292469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1293469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1294bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, "Creating new IBSS network, BSSID %pM\n", bssid); 1295469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1296469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 1297469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1298fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 1299469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 1300469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 1301469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 1302469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 130357c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg __ieee80211_sta_join_ibss(sdata, bssid, sdata->vif.bss_conf.beacon_int, 130475a423f493ffdf741acae27bf179cd560f7813d7Simon Wunderlich &ifibss->chandef, ifibss->basic_rates, 1305c13a765bd96f4e2f52d218ee6e5c0715380eeeb8Sujith Manoharan capability, 0, true); 1306469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1307469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1308ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault/* 1309ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault * This function is called with state == IEEE80211_IBSS_MLME_SEARCH 1310ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault */ 1311ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault 1312af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergstatic void ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 1313469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1314469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1315469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 13160c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct cfg80211_bss *cbss; 1317af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_channel *chan = NULL; 1318469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 13197ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich enum nl80211_bss_scan_width scan_width; 1320469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 1321e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg u16 capability; 1322469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13238d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 13247a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1325469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 1326bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "sta_find_ibss (active_ibss=%d)\n", active_ibss); 1327469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1328469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 1329af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 1330469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1331e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability = WLAN_CAPABILITY_IBSS; 1332fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg if (ifibss->privacy) 1333e0d61887c2ee19bb63f6a8c0e2c149184e879501Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 1334af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_bssid) 1335af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg bssid = ifibss->bssid; 1336af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (ifibss->fixed_channel) 13373aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich chan = ifibss->chandef.chan; 1338af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (!is_zero_ether_addr(ifibss->bssid)) 1339469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 13400c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg cbss = cfg80211_get_bss(local->hw.wiphy, chan, bssid, 13410c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg ifibss->ssid, ifibss->ssid_len, 13420c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_PRIVACY, 13430c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg capability); 13440c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg 13450c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg if (cbss) { 13460c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg struct ieee80211_bss *bss; 1347469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13480c1ad2cac1cb54db38fd4cc1822965071ee83f6eJohannes Berg bss = (void *)cbss->priv; 1349bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1350bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "sta_find_ibss: selected %pM current %pM\n", 1351bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg cbss->bssid, ifibss->bssid); 1352bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, 1353bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "Selected IBSS BSSID %pM based on configured SSID\n", 1354bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg cbss->bssid); 1355469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1356af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg ieee80211_sta_join_ibss(sdata, bss); 1357469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 1358af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return; 1359d419b9f0fa69e79ccba3e5e79a58a52ae0c2ed6aReinette Chatre } 1360469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1361d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli /* if a fixed bssid and a fixed freq have been provided create the IBSS 1362d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli * directly and do not waste time scanning 1363d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli */ 1364d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli if (ifibss->fixed_bssid && ifibss->fixed_channel) { 1365d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli sdata_info(sdata, "Created IBSS using preconfigured BSSID %pM\n", 1366d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli bssid); 1367d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli ieee80211_sta_create_ibss(sdata); 1368d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli return; 1369d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli } 1370d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli 1371d8eb741eb374804e864751c7f3919ae50321d831Antonio Quartulli 1372bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "sta_find_ibss: did not try to join ibss\n"); 1373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 1375ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault if (time_after(jiffies, ifibss->last_scan_completed + 1376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 1377bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg sdata_info(sdata, "Trigger new scan to find an IBSS to join\n"); 1378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 13797ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width = cfg80211_chandef_to_scan_width(&ifibss->chandef); 138034bcf71502413f8903ade93746f2d0f04b937a78Stanislaw Gruszka ieee80211_request_ibss_scan(sdata, ifibss->ssid, 13817ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich ifibss->ssid_len, chan, 13827ca15a0ae865067aac8d36e27e0acbe4a8f1e70aSimon Wunderlich scan_width); 1383ce9058aedd75f14785400dcc49a2bc352ca38871Benoit Papillault } else { 1384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 1385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 138755de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) 138855de908ab292c03f1eb280f51170ddb9c6b57e31Johannes Berg ieee80211_sta_create_ibss(sdata); 1389469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1390af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg mod_timer(&ifibss->timer, 1391af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg round_jiffies(jiffies + interval)); 1392469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1393469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1394469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1395469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 1396c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct sk_buff *req) 1397469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1398c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg struct ieee80211_mgmt *mgmt = (void *)req->data; 1399469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1400469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 1401c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg int tx_last_beacon, len = req->len; 1402469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 1403c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg struct beacon_data *presp; 1404469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 1405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14068d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_assert_lock(sdata); 14077a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 140840b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg presp = rcu_dereference_protected(ifibss->presp, 14098d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg lockdep_is_held(&sdata->wdev.mtx)); 141040b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg 1411469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 141240b275b69ee660274b77fb612b0db31fd282fc3fJohannes Berg len < 24 + 2 || !presp) 1413469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1414469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14152448798133d747ad339e57099e32a1d1e68aca1cJohannes Berg tx_last_beacon = drv_tx_last_beacon(local); 1416469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1417bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, 1418bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg "RX ProbeReq SA=%pM DA=%pM BSSID=%pM (tx_last_beacon=%d)\n", 1419bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa, mgmt->da, mgmt->bssid, tx_last_beacon); 1420469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14211ed76487ce115110171480deabd3cd4656f9803eFelix Fietkau if (!tx_last_beacon && is_multicast_ether_addr(mgmt->da)) 1422469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1423469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1424b203ca39126bad99583c908be587df067820a1eaJoe Perches if (!ether_addr_equal(mgmt->bssid, ifibss->bssid) && 1425888d04dfbe7e09f930fdaafb257cce2c54c9c3f3Felix Fietkau !is_broadcast_ether_addr(mgmt->bssid)) 1426469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1427469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 1429469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 1430469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 1431469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 1432bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg ibss_dbg(sdata, "Invalid SSID IE in ProbeReq from %pM\n", 1433bdcbd8e0e3ffdad32b14b6373e67bfcf5fd3f002Johannes Berg mgmt->sa); 1434469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1435469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1436469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 1437469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 14380da780c269957783d341fc3559e6b4c9912af7b4Benoit Papillault memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len))) { 1439469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 1440469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1441469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1442469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1443469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 1444c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg skb = dev_alloc_skb(local->tx_headroom + presp->head_len); 1445469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 1446469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1447469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1448c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg skb_reserve(skb, local->tx_headroom); 1449c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg memcpy(skb_put(skb, presp->head_len), presp->head, presp->head_len); 1450c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg 1451c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg memcpy(((struct ieee80211_mgmt *) skb->data)->da, mgmt->sa, ETH_ALEN); 1452c3ffeab4345830aadfc78444933754330f1339e7Johannes Berg ibss_dbg(sdata, "Sending ProbeResp to %pM\n", mgmt->sa); 145362ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; 1454691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich 1455691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich /* avoid excessive retries for probe request to wildcard SSIDs */ 1456691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich if (pos[1] == 0) 1457691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_NO_ACK; 1458691eb61bcfa1e98bdbbd29388bc518a76ae2fdd4Simon Wunderlich 145962ae67be31c2346b6d74653a148ddbd1b9a94424Johannes Berg ieee80211_tx_skb(sdata, skb); 1460469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1461469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1462d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbachstatic 1463d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbachvoid ieee80211_rx_mgmt_probe_beacon(struct ieee80211_sub_if_data *sdata, 1464d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_mgmt *mgmt, size_t len, 1465d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach struct ieee80211_rx_status *rx_status) 1466469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1467469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 1468469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 1469469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1470d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach BUILD_BUG_ON(offsetof(typeof(mgmt->u.probe_resp), variable) != 1471d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach offsetof(typeof(mgmt->u.beacon), variable)); 1472d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach 1473d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach /* 1474d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach * either beacon or probe_resp but the variable field is at the 1475d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach * same offset 1476d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach */ 1477469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 1478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 1479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 1480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1481469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 1482b2e506bfc4d752b68a0ccaae1e977898263eba4cJohannes Berg false, &elems); 1483469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1484d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems); 1485469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1486469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 14871fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 14881fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct sk_buff *skb) 1489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1490469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 1491469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 1492469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 1493cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich struct ieee802_11_elems elems; 1494cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich int ies_len; 1495469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1496f1d58c2521eb160178b2151d6326d8dc5d7c8560Johannes Berg rx_status = IEEE80211_SKB_RXCB(skb); 1497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 1498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 1499469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15008d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_lock(sdata); 15017a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1502c926d006c1514cfb3572893f41f2324e96823661Tim Harvey if (!sdata->u.ibss.ssid_len) 1503c926d006c1514cfb3572893f41f2324e96823661Tim Harvey goto mgmt_out; /* not ready to merge yet */ 1504c926d006c1514cfb3572893f41f2324e96823661Tim Harvey 1505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 1506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 1507c269a20393500e84e8cbae23ca6d65e1107433c4Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, skb); 1508469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1509469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 1510469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 1511d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach ieee80211_rx_mgmt_probe_beacon(sdata, mgmt, skb->len, 1512d45c41722a3eca639ced2c4c93665ced229b1da9Emmanuel Grumbach rx_status); 1513469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1514469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 1515469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 1516469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 15172cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli case IEEE80211_STYPE_DEAUTH: 15182cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli ieee80211_rx_mgmt_deauth_ibss(sdata, mgmt, skb->len); 15192cc59e784b54fb95accbd5f5a9d12041eec72dbcAntonio Quartulli break; 1520cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case IEEE80211_STYPE_ACTION: 1521cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich switch (mgmt->u.action.category) { 1522cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich case WLAN_CATEGORY_SPECTRUM_MGMT: 1523cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies_len = skb->len - 1524cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich offsetof(struct ieee80211_mgmt, 1525cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich u.action.u.chan_switch.variable); 1526cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1527cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (ies_len < 0) 1528cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1529cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1530cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee802_11_parse_elems( 1531cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich mgmt->u.action.u.chan_switch.variable, 1532cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ies_len, true, &elems); 1533cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1534cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich if (elems.parse_error) 1535cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1536cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich 1537cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_rx_mgmt_spectrum_mgmt(sdata, mgmt, skb->len, 1538cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich rx_status, &elems); 1539cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich break; 1540cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich } 1541469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 15427a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1543c926d006c1514cfb3572893f41f2324e96823661Tim Harvey mgmt_out: 15448d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_unlock(sdata); 1545469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1546469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15471fa57d017366fb26b58af110a38b36a4f0214a62Johannes Bergvoid ieee80211_ibss_work(struct ieee80211_sub_if_data *sdata) 1548469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 15491fa57d017366fb26b58af110a38b36a4f0214a62Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 15508bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info *sta; 1551469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15528d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_lock(sdata); 15537a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 15547a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg /* 15557a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * Work could be scheduled after scan or similar 15567a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * when we aren't even joined (or trying) with a 15577a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg * network. 15587a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg */ 15597a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg if (!ifibss->ssid_len) 15607a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg goto out; 1561469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15628bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 15638bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg while (!list_empty(&ifibss->incomplete_stations)) { 15648bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg sta = list_first_entry(&ifibss->incomplete_stations, 15658bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg struct sta_info, list); 15668bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg list_del(&sta->list); 15678bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 15688bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 156952874a5e3917dde3b081521b014d6e4b226aacffAntonio Quartulli ieee80211_ibss_finish_sta(sta); 15708bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg rcu_read_unlock(); 15718bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_bh(&ifibss->incomplete_lock); 15728bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg } 15738bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_unlock_bh(&ifibss->incomplete_lock); 15748bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg 1575469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 1576469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 1577469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 1578469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1579469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 1580469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 1581469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1582469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 1583469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 1584469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 1585469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 1586469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15877a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg out: 15888d61ffa5e01c5f676431d12caba17db164a48a86Johannes Berg sdata_unlock(sdata); 15893a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg} 15903a4d4aa2d38e5305b5e93dffdc9dd2f975129328Johannes Berg 1591469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 1592469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1593469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 1594469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 15955bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 1596a61829437e68c8b2036cf5005ed0e875451c9120Stanislaw Gruszka ieee80211_queue_work(&sdata->local->hw, &sdata->work); 15975bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg} 15985bb644a0fd25a5e083ecbfaa92a211db99aa6ef7Johannes Berg 1599469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 1600469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1601469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 1602469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 1604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 16058bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg INIT_LIST_HEAD(&ifibss->incomplete_stations); 16068bf11d8d081106c3cce8281a0150e716f8ac5d22Johannes Berg spin_lock_init(&ifibss->incomplete_lock); 1607cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich INIT_WORK(&ifibss->csa_connection_drop_work, 1608cd7760e62c2ac8581f050b2d36501d1a60beaf83Simon Wunderlich ieee80211_csa_connection_drop_work); 1609469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1610469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 1612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 1613469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 1614af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct ieee80211_sub_if_data *sdata; 1615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 161629b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_lock(&local->iflist_mtx); 161729b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg list_for_each_entry(sdata, &local->interfaces, list) { 16189607e6b66a0d25ca63b70d54a4283fa13d8f7c9dJohannes Berg if (!ieee80211_sdata_running(sdata)) 16190e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg continue; 1620af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->vif.type != NL80211_IFTYPE_ADHOC) 1621af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg continue; 1622af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.last_scan_completed = jiffies; 16237a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg ieee80211_queue_work(&local->hw, &sdata->work); 1624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 162529b4a4f7c7b588b5568edd0da42f38623b81fc66Johannes Berg mutex_unlock(&local->iflist_mtx); 1626469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 1627469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 1628af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_join(struct ieee80211_sub_if_data *sdata, 1629af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg struct cfg80211_ibss_params *params) 1630af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 1631ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich u32 changed = 0; 16322103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich u32 rate_flags; 16332103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich struct ieee80211_supported_band *sband; 163471965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho enum ieee80211_chanctx_mode chanmode; 163571965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho struct ieee80211_local *local = sdata->local; 163671965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho int radar_detect_width = 0; 16372103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich int i; 163871965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho int ret; 163971965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho 164071965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho ret = cfg80211_chandef_dfs_required(local->hw.wiphy, 164171965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho ¶ms->chandef, 164271965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho sdata->wdev.iftype); 164371965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho if (ret < 0) 164471965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho return ret; 164571965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho 164671965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho if (ret > 0) { 164771965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho if (!params->userspace_handles_dfs) 164871965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho return -EINVAL; 164971965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho radar_detect_width = BIT(params->chandef.width); 165071965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho } 165171965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho 165271965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho chanmode = (params->channel_fixed && !ret) ? 165371965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho IEEE80211_CHANCTX_SHARED : IEEE80211_CHANCTX_EXCLUSIVE; 165471965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho 165571965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho mutex_lock(&local->chanctx_mtx); 165671965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho ret = ieee80211_check_combinations(sdata, ¶ms->chandef, chanmode, 165771965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho radar_detect_width); 165871965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho mutex_unlock(&local->chanctx_mtx); 165971965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho if (ret < 0) 166071965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho return ret; 1661af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1662af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->bssid) { 1663af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg memcpy(sdata->u.ibss.bssid, params->bssid, ETH_ALEN); 1664af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = true; 1665af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } else 1666af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_bssid = false; 1667af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1668fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg sdata->u.ibss.privacy = params->privacy; 1669267335d63b808dc861f3a4dc81a605489a8a13acAntonio Quartulli sdata->u.ibss.control_port = params->control_port; 16708e8d347da7613d0315295e730f2eecf9fe6f36baSimon Wunderlich sdata->u.ibss.userspace_handles_dfs = params->userspace_handles_dfs; 1671fbd2c8dcbc69616d2e15b8a269a86b3a05d45aeaTeemu Paasikivi sdata->u.ibss.basic_rates = params->basic_rates; 1672c7d37a66e345df2fdf1aa7b2c9a6d3d53846ca5bKrzysztof HaÅ‚asa sdata->u.ibss.last_scan_completed = jiffies; 16732103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich 16742103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich /* fix basic_rates if channel does not support these rates */ 16752103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich rate_flags = ieee80211_chandef_rate_flags(¶ms->chandef); 167671965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho sband = local->hw.wiphy->bands[params->chandef.chan->band]; 16772103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich for (i = 0; i < sband->n_bitrates; i++) { 16782103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich if ((rate_flags & sband->bitrates[i].flags) != rate_flags) 16792103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich sdata->u.ibss.basic_rates &= ~BIT(i); 16802103dec14792be2c2194a454630b01120d30e5cbSimon Wunderlich } 1681dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau memcpy(sdata->vif.bss_conf.mcast_rate, params->mcast_rate, 1682dd5b4cc71cd09c33e1579cc6d5720656e94e52deFelix Fietkau sizeof(params->mcast_rate)); 1683fffd0934b9390f34bec45762192b7edd3b12b4b5Johannes Berg 168457c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg sdata->vif.bss_conf.beacon_int = params->beacon_interval; 168557c4d7b4c4986037be51476b8e3025d5ba18d8b8Johannes Berg 16863aede78aad2a7e39a81b4b0caa771d40254a6787Simon Wunderlich sdata->u.ibss.chandef = params->chandef; 1687af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.fixed_channel = params->channel_fixed; 1688af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1689af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (params->ie) { 1690af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie = kmemdup(params->ie, params->ie_len, 1691af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg GFP_KERNEL); 1692af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg if (sdata->u.ibss.ie) 1693af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ie_len = params->ie_len; 1694af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg } 1695af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1696af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.state = IEEE80211_IBSS_MLME_SEARCH; 1697af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg sdata->u.ibss.ibss_join_req = jiffies; 1698af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1699badecb001a310408d3473b1fc2ed5aefd0bc92a9Antonio Quartulli memcpy(sdata->u.ibss.ssid, params->ssid, params->ssid_len); 17000e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg sdata->u.ibss.ssid_len = params->ssid_len; 17010e41f715c04f85a40ae6531d660be2241717be1cJohannes Berg 1702822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memcpy(&sdata->u.ibss.ht_capa, ¶ms->ht_capa, 1703822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich sizeof(sdata->u.ibss.ht_capa)); 1704822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memcpy(&sdata->u.ibss.ht_capa_mask, ¶ms->ht_capa_mask, 1705822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich sizeof(sdata->u.ibss.ht_capa_mask)); 1706822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1707ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich /* 1708ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 802.11n-2009 9.13.3.1: In an IBSS, the HT Protection field is 1709ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * reserved, but an HT STA shall protect HT transmissions as though 1710ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * the HT Protection field were set to non-HT mixed mode. 1711ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * 1712ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * In an IBSS, the RIFS Mode field of the HT Operation element is 1713ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * also reserved, but an HT STA shall operate as though this field 1714ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich * were set to 1. 1715ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich */ 1716ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1717ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich sdata->vif.bss_conf.ht_operation_mode |= 1718ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich IEEE80211_HT_OP_MODE_PROTECTION_NONHT_MIXED 1719ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich | IEEE80211_HT_PARAM_RIFS_MODE; 1720ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 1721ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich changed |= BSS_CHANGED_HT; 1722ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich ieee80211_bss_info_change_notify(sdata, changed); 1723ff3cc5f40f36db1a60a8f1051be7fbc92233419bSimon Wunderlich 172404ecd2578e712c301fa1369d2a8f298a2b4b146aJohannes Berg sdata->smps_mode = IEEE80211_SMPS_OFF; 172571965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho sdata->needed_rx_chains = local->rx_chains; 172604ecd2578e712c301fa1369d2a8f298a2b4b146aJohannes Berg 172771965c1d04b2b48ab7c56395bd1f996a56aaa592Luciano Coelho ieee80211_queue_work(&local->hw, &sdata->work); 1728af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1729af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1730af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1731af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1732af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Bergint ieee80211_ibss_leave(struct ieee80211_sub_if_data *sdata) 1733af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg{ 17345ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 17355ea096c0c85e80335889539899af9a4717976e0bTeemu Paasikivi 1736871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich ieee80211_ibss_disconnect(sdata); 1737b78a4932f5fb11fadf41e69c606a33fa6787574cSimon Wunderlich ifibss->ssid_len = 0; 1738871a4180b8b62dbed54cd203c33bdab7fce24e6fSimon Wunderlich memset(ifibss->bssid, 0, ETH_ALEN); 1739af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 1740af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg /* remove beacon */ 1741af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg kfree(sdata->u.ibss.ie); 1742822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1743822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich /* on the next join, re-program HT parameters */ 1744822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memset(&ifibss->ht_capa, 0, sizeof(ifibss->ht_capa)); 1745822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich memset(&ifibss->ht_capa_mask, 0, sizeof(ifibss->ht_capa_mask)); 1746822854b0b1d8f893279ca717f3d084aa5fcd9ff5Simon Wunderlich 1747af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg synchronize_rcu(); 1748af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg 174935f20c14a103ca2c7062999e934a513b83d84de6Johannes Berg skb_queue_purge(&sdata->skb_queue); 17505cff20e6c5a6591a79d3b027af222870f52bb550Johannes Berg 1751bc05d19f4b884b1dbbce48912710ae3f972c89d2Johannes Berg del_timer_sync(&sdata->u.ibss.timer); 17527a17a33c0da37f8d24222c967550d19dabf13617Johannes Berg 1753af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg return 0; 1754af8cdcd828ad751fae8e6cbfe94eef9f2f23b14bJohannes Berg} 1755