ibss.c revision 707c1b4e68a2811ff2c9e75750a98a3310789a2d
1469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* 2469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * IBSS mode implementation 3469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2003-2008, Jouni Malinen <j@w1.fi> 4469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2004, Instant802 Networks, Inc. 5469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2005, Devicescape Software, Inc. 6469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> 7469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2007, Michael Wu <flamingice@sourmilk.net> 8469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Copyright 2009, Johannes Berg <johannes@sipsolutions.net> 9469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 10469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * This program is free software; you can redistribute it and/or modify 11469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * it under the terms of the GNU General Public License version 2 as 12469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * published by the Free Software Foundation. 13469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 14469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 15469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/delay.h> 16469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/if_ether.h> 17469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/skbuff.h> 18469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/if_arp.h> 19469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/etherdevice.h> 20469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <linux/rtnetlink.h> 21469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <net/mac80211.h> 22469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include <asm/unaligned.h> 23469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 24469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "ieee80211_i.h" 25469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#include "rate.h" 26469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 27469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL (2 * HZ) 28469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_SCAN_INTERVAL_SLOW (15 * HZ) 29469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_JOIN_TIMEOUT (7 * HZ) 30469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 31469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MERGE_INTERVAL (30 * HZ) 324a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen#define IEEE80211_IBSS_MERGE_DELAY 0x400000 33469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_INACTIVITY_LIMIT (60 * HZ) 34469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 35469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#define IEEE80211_IBSS_MAX_STA_ENTRIES 128 36469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 37469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 38469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_auth_ibss(struct ieee80211_sub_if_data *sdata, 39469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 40469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len) 41469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 42469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 auth_alg, auth_transaction, status_code; 43469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 44469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (len < 24 + 6) 45469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 46469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 47469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); 48469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); 49469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg status_code = le16_to_cpu(mgmt->u.auth.status_code); 50469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 51469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 52469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * IEEE 802.11 standard does not require authentication in IBSS 53469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * networks and most implementations do not seem to use it. 54469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * However, try to reply to authentication attempts if someone 55469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * has actually implemented this. 56469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 57469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (auth_alg == WLAN_AUTH_OPEN && auth_transaction == 1) 58469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_send_auth(sdata, 2, WLAN_AUTH_OPEN, NULL, 0, 59469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.bssid, 0); 60469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 61469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 62469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int __ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 63469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid, const int beacon_int, 64469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const int freq, 65469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const size_t supp_rates_len, 66469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *supp_rates, 67707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith const u16 capability, u64 tsf) 68469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 69469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 70469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 71469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int res = 0, rates, i, j; 72469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 73469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 74469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 75469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 76469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg union iwreq_data wrqu; 77469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 78469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->ops->reset_tsf) { 79469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reset own TSF to allow time synchronization work. */ 80469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->ops->reset_tsf(local_to_hw(local)); 81469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 82469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 83469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if ((ifibss->flags & IEEE80211_IBSS_PREV_BSSID_SET) && 84469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(ifibss->bssid, bssid, ETH_ALEN) == 0) 85469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return res; 86469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 87469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb = dev_alloc_skb(local->hw.extra_tx_headroom + 400); 88469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) { 89469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: failed to allocate buffer for probe " 90469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "response\n", sdata->dev->name); 91469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return -ENOMEM; 92469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 93469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 94469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!(ifibss->flags & IEEE80211_IBSS_PREV_BSSID_SET)) { 95469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Remove possible STA entries from other IBSS networks. */ 96469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta_info_flush_delayed(sdata); 97469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 98469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 99469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ifibss->bssid, bssid, ETH_ALEN); 100469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg res = ieee80211_if_config(sdata, IEEE80211_IFCC_BSSID); 101469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (res) 102469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return res; 103469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 104469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.beacon_int = beacon_int >= 10 ? beacon_int : 10; 105469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 106469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = capability & 107469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WLAN_CAPABILITY_PRIVACY ? 1 : 0; 108469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 109469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg res = ieee80211_set_freq(sdata, freq); 110469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 111469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (res) 112469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return res; 113469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 114469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; 115469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 116469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Build IBSS probe response */ 117469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 118469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_reserve(skb, local->hw.extra_tx_headroom); 119469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 120469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) 121469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_put(skb, 24 + sizeof(mgmt->u.beacon)); 122469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt, 0, 24 + sizeof(mgmt->u.beacon)); 123469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 124469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_STYPE_PROBE_RESP); 125469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(mgmt->da, 0xff, ETH_ALEN); 126469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->sa, sdata->dev->dev_addr, ETH_ALEN); 127469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN); 128469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->u.beacon.beacon_int = 129469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg cpu_to_le16(local->hw.conf.beacon_int); 130707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith mgmt->u.beacon.timestamp = cpu_to_le64(tsf); 131469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->u.beacon.capab_info = cpu_to_le16(capability); 132469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 133469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + ifibss->ssid_len); 134469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SSID; 135469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = ifibss->ssid_len; 136469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, ifibss->ssid, ifibss->ssid_len); 137469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 138469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = supp_rates_len; 139469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rates > 8) 140469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = 8; 141469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 142469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_SUPP_RATES; 143469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 144469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, supp_rates, rates); 145469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 146469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->band == IEEE80211_BAND_2GHZ) { 147469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 1); 148469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_DS_PARAMS; 149469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 1; 150469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = ieee80211_frequency_to_channel(freq); 151469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 152469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 153469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + 2); 154469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_IBSS_PARAMS; 155469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 2; 156469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* FIX: set ATIM window based on scan results */ 157469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 158469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = 0; 159469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 160469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (supp_rates_len > 8) { 161469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = supp_rates_len - 8; 162469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = skb_put(skb, 2 + rates); 163469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = WLAN_EID_EXT_SUPP_RATES; 164469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = rates; 165469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(pos, &supp_rates[8], rates); 166469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 167469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 168469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->probe_resp = skb; 169469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 170469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_if_config(sdata, IEEE80211_IFCC_BEACON | 171469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IFCC_BEACON_ENABLED); 172469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 173469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 174469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates = 0; 175469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < supp_rates_len; i++) { 176469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int bitrate = (supp_rates[i] & 0x7f) * 5; 177469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (j = 0; j < sband->n_bitrates; j++) 178469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sband->bitrates[j].bitrate == bitrate) 179469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rates |= BIT(j); 180469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 181469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 182469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_def_wmm_params(sdata, supp_rates_len, supp_rates); 183469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 184469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->flags |= IEEE80211_IBSS_PREV_BSSID_SET; 185469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_JOINED; 186469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mod_timer(&ifibss->timer, jiffies + IEEE80211_IBSS_MERGE_INTERVAL); 187469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 188469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(&wrqu, 0, sizeof(wrqu)); 189469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN); 190469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg wireless_send_event(sdata->dev, SIOCGIWAP, &wrqu, NULL); 191469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 192469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return res; 193469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 194469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 195469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_join_ibss(struct ieee80211_sub_if_data *sdata, 196469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss) 197469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 198469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return __ieee80211_sta_join_ibss(sdata, 199469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss->cbss.bssid, 200469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss->cbss.beacon_interval, 201469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss->cbss.channel->center_freq, 202469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss->supp_rates_len, bss->supp_rates, 203707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith bss->cbss.capability, 204707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith bss->cbss.tsf); 205469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 206469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 207469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, 208469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 209469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 210469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status, 211469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems *elems, 212469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bool beacon) 213469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 214469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 215469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int freq; 216469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 217469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 218469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_channel *channel; 219469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u64 beacon_timestamp, rx_timestamp; 220469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 supp_rates = 0; 221469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg enum ieee80211_band band = rx_status->band; 222469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 223469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ds_params && elems->ds_params_len == 1) 224469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = ieee80211_channel_to_frequency(elems->ds_params[0]); 225469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 226469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg freq = rx_status->freq; 227469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 228469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel = ieee80211_get_channel(local->hw.wiphy, freq); 229469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 230469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!channel || channel->flags & IEEE80211_CHAN_DISABLED) 231469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 232469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 233469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->vif.type == NL80211_IFTYPE_ADHOC && elems->supp_rates && 234469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) { 235469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg supp_rates = ieee80211_sta_get_rates(local, elems, band); 236469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 237469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 238469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 239469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_get(local, mgmt->sa); 240469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta) { 241469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u32 prev_rates; 242469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 243469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg prev_rates = sta->sta.supp_rates[band]; 244469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 245469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 246469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 247469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 248469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 249469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sta.supp_rates[band] != prev_rates) 250469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: updated supp_rates set " 251469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "for %pM based on beacon info (0x%llx | " 252469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "0x%llx -> 0x%llx)\n", 253469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, 254469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.addr, 255469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) prev_rates, 256469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) supp_rates, 257469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long) sta->sta.supp_rates[band]); 258469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 259469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else 260469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 261469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 262469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 263469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 264469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 265469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, 266469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg channel, beacon); 267469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!bss) 268469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 269469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 270469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* was just updated in ieee80211_bss_info_update */ 271469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg beacon_timestamp = bss->cbss.tsf; 272469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 273469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* check if we need to merge IBSS */ 274469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 275469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* merge only on beacons (???) */ 276469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!beacon) 277469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 278469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 279469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* we use a fixed BSSID */ 280469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->u.ibss.flags & IEEE80211_IBSS_BSSID_SET) 281469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 282469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 283469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* not an IBSS */ 284469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!(bss->cbss.capability & WLAN_CAPABILITY_IBSS)) 285469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 286469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 287469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different channel */ 288469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (bss->cbss.channel != local->oper_channel) 289469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 290469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 291469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* different SSID */ 292469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (elems->ssid_len != sdata->u.ibss.ssid_len || 293469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(elems->ssid, sdata->u.ibss.ssid, 294469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->u.ibss.ssid_len)) 295469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg goto put_bss; 296469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 29734e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen /* same BSSID */ 29834e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen if (memcmp(bss->cbss.bssid, sdata->u.ibss.bssid, ETH_ALEN) == 0) 29934e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen goto put_bss; 30034e8f08231388f9e16c6f1e2461f53afaf7f1e5eAlina Friedrichsen 301469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_TSFT) { 302469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* 303469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * For correct IBSS merging we need mactime; since mactime is 304469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * defined as the time the first data symbol of the frame hits 305469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * the PHY, and the timestamp of the beacon is defined as "the 306469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * time that the data symbol containing the first bit of the 307469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * timestamp is transmitted to the PHY plus the transmitting 308469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * STA's delays through its local PHY from the MAC-PHY 309469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * interface to its interface with the WM" (802.11 11.1.2) 310469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * - equals the time this bit arrives at the receiver - we have 311469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * to take into account the offset between the two. 312469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * 313469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * E.g. at 1 MBit that means mactime is 192 usec earlier 314469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * (=24 bytes * 8 usecs/byte) than the beacon timestamp. 315469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 316469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate; 317469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 318469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (rx_status->flag & RX_FLAG_HT) 319469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = 65; /* TODO: HT rates */ 320469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 321469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate = local->hw.wiphy->bands[band]-> 322469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bitrates[rx_status->rate_idx].bitrate; 323469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 324469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = rx_status->mactime + (24 * 8 * 10 / rate); 325469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (local && local->ops && local->ops->get_tsf) 326469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* second best option: get current TSF */ 327469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = local->ops->get_tsf(local_to_hw(local)); 328469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 329469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* can't merge without knowing the TSF */ 330469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_timestamp = -1LLU; 331469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 332469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 333469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "RX beacon SA=%pM BSSID=" 334469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM TSF=0x%llx BCN=0x%llx diff=%lld @%lu\n", 335469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->sa, mgmt->bssid, 336469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)rx_timestamp, 337469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)beacon_timestamp, 338469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long long)(rx_timestamp - beacon_timestamp), 339469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies); 340469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 341469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 3424a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen /* give slow hardware some time to do the TSF sync */ 3434a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen if (rx_timestamp < IEEE80211_IBSS_MERGE_DELAY) 3444a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen goto put_bss; 3454a332a385a86e31bfe181d969a8cb5579798fe03Alina Friedrichsen 346469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (beacon_timestamp > rx_timestamp) { 347469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 348469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: beacon TSF higher than " 349469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "local TSF - IBSS merge with BSSID %pM\n", 350469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->bssid); 351469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 352469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_join_ibss(sdata, bss); 353469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_add_sta(sdata, mgmt->bssid, mgmt->sa, supp_rates); 354469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 355469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 356469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg put_bss: 357469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 358469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 359469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 360469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* 361469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * Add a new IBSS station, will also be called by the RX code when, 362469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * in IBSS mode, receiving a frame from a yet-unknown station, hence 363469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * must be callable in atomic context. 364469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg */ 365469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstruct sta_info *ieee80211_ibss_add_sta(struct ieee80211_sub_if_data *sdata, 366469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *bssid,u8 *addr, u32 supp_rates) 367469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 368469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 369469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 370469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int band = local->hw.conf.channel->band; 371469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 372469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* TODO: Could consider removing the least recently used entry and 373469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * allow new one to be added. */ 374469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->num_sta >= IEEE80211_IBSS_MAX_STA_ENTRIES) { 375469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (net_ratelimit()) { 376469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: No room for a new IBSS STA " 377469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "entry %pM\n", sdata->dev->name, addr); 378469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 379469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 380469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 381469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 382469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (compare_ether_addr(bssid, sdata->u.ibss.bssid)) 383469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 384469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 385469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_VERBOSE_DEBUG 386469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Adding new IBSS station %pM (dev=%s)\n", 387469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg wiphy_name(local->hw.wiphy), addr, sdata->dev->name); 388469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 389469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 390469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta = sta_info_alloc(sdata, addr, GFP_ATOMIC); 391469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!sta) 392469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 393469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 394469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_sta_flags(sta, WLAN_STA_AUTHORIZED); 395469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 396469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* make sure mandatory rates are always added */ 397469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sta->sta.supp_rates[band] = supp_rates | 398469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_mandatory_rates(local, band); 399469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 400469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rate_control_rate_init(sta); 401469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 402469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta_info_insert(sta)) 403469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return NULL; 404469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 405469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return sta; 406469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 407469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 408469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_active_ibss(struct ieee80211_sub_if_data *sdata) 409469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 410469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 411469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active = 0; 412469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sta_info *sta; 413469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 414469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_lock(); 415469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 416469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg list_for_each_entry_rcu(sta, &local->sta_list, list) { 417469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sta->sdata == sdata && 418469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg time_after(sta->last_rx + IEEE80211_IBSS_MERGE_INTERVAL, 419469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg jiffies)) { 420469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active++; 421469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 422469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 423469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 424469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 425469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rcu_read_unlock(); 426469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 427469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return active; 428469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 429469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 430469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 431469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_sta_merge_ibss(struct ieee80211_sub_if_data *sdata) 432469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 433469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 434469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 435469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mod_timer(&ifibss->timer, jiffies + IEEE80211_IBSS_MERGE_INTERVAL); 436469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 437469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_expire(sdata, IEEE80211_IBSS_INACTIVITY_LIMIT); 438469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_sta_active_ibss(sdata)) 439469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 440469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 441469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if ((ifibss->flags & IEEE80211_IBSS_BSSID_SET) && 442469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (!(ifibss->flags & IEEE80211_IBSS_AUTO_CHANNEL_SEL))) 443469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 444469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 445469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: No active IBSS STAs - trying to scan for other " 446469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "IBSS networks with same SSID (merge)\n", sdata->dev->name); 447469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 448469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* XXX maybe racy? */ 449469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->local->scan_req) 450469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 451469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 452469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(sdata->local->int_scan_req.ssids[0].ssid, 453469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid, IEEE80211_MAX_SSID_LEN); 454469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->local->int_scan_req.ssids[0].ssid_len = ifibss->ssid_len; 455469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_request_scan(sdata, &sdata->local->int_scan_req); 456469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 457469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 458469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_create_ibss(struct ieee80211_sub_if_data *sdata) 459469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 460469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 461469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 462469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_supported_band *sband; 463469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos; 464469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 bssid[ETH_ALEN]; 465469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 supp_rates[IEEE80211_MAX_SUPP_RATES]; 466469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 capability; 467469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int i; 468469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 469469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->flags & IEEE80211_IBSS_BSSID_SET) { 470469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(bssid, ifibss->bssid, ETH_ALEN); 471469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 472469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Generate random, not broadcast, locally administered BSSID. Mix in 473469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * own MAC address to make sure that devices that do not have proper 474469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * random number generator get different BSSID. */ 475469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg get_random_bytes(bssid, ETH_ALEN); 476469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < ETH_ALEN; i++) 477469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[i] ^= sdata->dev->dev_addr[i]; 478469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] &= ~0x01; 479469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid[0] |= 0x02; 480469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 481469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 482469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Creating new IBSS network, BSSID %pM\n", 483469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, bssid); 484469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 485469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; 486469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 487469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->hw.conf.beacon_int == 0) 488469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.beacon_int = 100; 489469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 490469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability = WLAN_CAPABILITY_IBSS; 491469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 492469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata->default_key) 493469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg capability |= WLAN_CAPABILITY_PRIVACY; 494469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 495469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->drop_unencrypted = 0; 496469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 497469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = supp_rates; 498469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg for (i = 0; i < sband->n_bitrates; i++) { 499469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int rate = sband->bitrates[i].bitrate; 500469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *pos++ = (u8) (rate / 5); 501469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 502469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 503469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return __ieee80211_sta_join_ibss(sdata, 504469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid, local->hw.conf.beacon_int, 505469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.channel->center_freq, 506469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sband->n_bitrates, supp_rates, 507707c1b4e68a2811ff2c9e75750a98a3310789a2dSujith capability, 0); 508469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 509469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 510469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic int ieee80211_sta_find_ibss(struct ieee80211_sub_if_data *sdata) 511469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 512469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 513469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 514469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_bss *bss; 515469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg const u8 *bssid = NULL; 516469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int active_ibss; 517469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 518469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->ssid_len == 0) 519469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return -EINVAL; 520469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 521469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg active_ibss = ieee80211_sta_active_ibss(sdata); 522469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 523469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: sta_find_ibss (active_ibss=%d)\n", 524469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, active_ibss); 525469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 526469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 527469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (active_ibss) 528469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return 0; 529469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 530469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->flags & IEEE80211_IBSS_BSSID_SET) 531469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bssid = ifibss->bssid; 532469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg bss = (void *)cfg80211_get_bss(local->hw.wiphy, NULL, bssid, 533469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid, ifibss->ssid_len, 534469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WLAN_CAPABILITY_IBSS, 535469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WLAN_CAPABILITY_IBSS); 536469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 537469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 538469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (bss) 539469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " sta_find_ibss: selected %pM current " 540469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "%pM\n", bss->cbss.bssid, ifibss->bssid); 541469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 542469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 543469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (bss && 544469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (!(ifibss->flags & IEEE80211_IBSS_PREV_BSSID_SET) || 545469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(ifibss->bssid, bss->cbss.bssid, ETH_ALEN))) { 546469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int ret; 547469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 548469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Selected IBSS BSSID %pM" 549469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " based on configured SSID\n", 550469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, bss->cbss.bssid); 551469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 552469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ret = ieee80211_sta_join_ibss(sdata, bss); 553469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 554469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return ret; 555469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (bss) 556469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_put(local, bss); 557469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 558469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 559469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG " did not try to join ibss\n"); 560469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 561469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 562469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Selected IBSS not found in current scan results - try to scan */ 563469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state == IEEE80211_IBSS_MLME_JOINED && 564469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg !ieee80211_sta_active_ibss(sdata)) { 565469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mod_timer(&ifibss->timer, jiffies + 566469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_MERGE_INTERVAL); 567469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (time_after(jiffies, local->last_scan_completed + 568469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_SCAN_INTERVAL)) { 569469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Trigger new scan to find an IBSS to " 570469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "join\n", sdata->dev->name); 571469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 572469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* XXX maybe racy? */ 573469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->scan_req) 574469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return -EBUSY; 575469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 576469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(local->int_scan_req.ssids[0].ssid, 577469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid, IEEE80211_MAX_SSID_LEN); 578469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->int_scan_req.ssids[0].ssid_len = ifibss->ssid_len; 579469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return ieee80211_request_scan(sdata, &local->int_scan_req); 580469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else if (ifibss->state != IEEE80211_IBSS_MLME_JOINED) { 581469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int interval = IEEE80211_SCAN_INTERVAL; 582469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 583469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (time_after(jiffies, ifibss->ibss_join_req + 584469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_JOIN_TIMEOUT)) { 585469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!(local->oper_channel->flags & 586469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_CHAN_NO_IBSS)) 587469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return ieee80211_sta_create_ibss(sdata); 588469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: IBSS not allowed on" 589469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " %d MHz\n", sdata->dev->name, 590469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg local->hw.conf.channel->center_freq); 591469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 592469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* No IBSS found - decrease scan interval and continue 593469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg * scanning. */ 594469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg interval = IEEE80211_SCAN_INTERVAL_SLOW; 595469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 596469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 597469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->state = IEEE80211_IBSS_MLME_SEARCH; 598469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mod_timer(&ifibss->timer, jiffies + interval); 599469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return 0; 600469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 601469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 602469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return 0; 603469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 604469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 605469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_req(struct ieee80211_sub_if_data *sdata, 606469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 607469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len) 608469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 609469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 610469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 611469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg int tx_last_beacon; 612469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 613469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *resp; 614469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u8 *pos, *end; 615469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 616469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->state != IEEE80211_IBSS_MLME_JOINED || 617469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg len < 24 + 2 || !ifibss->probe_resp) 618469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 619469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 620469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->ops->tx_last_beacon) 621469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg tx_last_beacon = local->ops->tx_last_beacon(local_to_hw(local)); 622469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg else 623469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg tx_last_beacon = 1; 624469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 625469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 626469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: RX ProbeReq SA=%pM DA=%pM BSSID=%pM" 627469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg " (tx_last_beacon=%d)\n", 628469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->sa, mgmt->da, 629469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt->bssid, tx_last_beacon); 630469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 631469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 632469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!tx_last_beacon) 633469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 634469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 635469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->bssid, ifibss->bssid, ETH_ALEN) != 0 && 636469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(mgmt->bssid, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) != 0) 637469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 638469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 639469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg end = ((u8 *) mgmt) + len; 640469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos = mgmt->u.probe_req.variable; 641469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[0] != WLAN_EID_SSID || 642469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg pos + 2 + pos[1] > end) { 643469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 644469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Invalid SSID IE in ProbeReq " 645469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "from %pM\n", 646469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, mgmt->sa); 647469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif 648469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 649469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 650469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (pos[1] != 0 && 651469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (pos[1] != ifibss->ssid_len || 652469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcmp(pos + 2, ifibss->ssid, ifibss->ssid_len) != 0)) { 653469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Ignore ProbeReq for foreign SSID */ 654469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 655469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 656469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 657469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Reply with ProbeResp */ 658469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb = skb_copy(ifibss->probe_resp, GFP_KERNEL); 659469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!skb) 660469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 661469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 662469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg resp = (struct ieee80211_mgmt *) skb->data; 663469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(resp->da, mgmt->sa, ETH_ALEN); 664469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#ifdef CONFIG_MAC80211_IBSS_DEBUG 665469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Sending ProbeResp to %pM\n", 666469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg sdata->dev->name, resp->da); 667469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg#endif /* CONFIG_MAC80211_IBSS_DEBUG */ 668469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_tx_skb(sdata, skb, 0); 669469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 670469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 671469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata, 672469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 673469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 674469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 675469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 676469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 677469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 678469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 679469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (memcmp(mgmt->da, sdata->dev->dev_addr, ETH_ALEN)) 680469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; /* ignore ProbeResp to foreign address */ 681469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 682469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; 683469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 684469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 685469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 686469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, 687469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg &elems); 688469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 689469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, false); 690469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 691469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 692469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata, 693469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt, 694469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t len, 695469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 696469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 697469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg size_t baselen; 698469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee802_11_elems elems; 699469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 700469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg /* Process beacon from the current BSS */ 701469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt; 702469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (baselen > len) 703469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 704469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 705469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee802_11_parse_elems(mgmt->u.beacon.variable, len - baselen, &elems); 706469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 707469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems, true); 708469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 709469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 710469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, 711469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb) 712469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 713469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status; 714469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 715469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 716469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 717469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status = (struct ieee80211_rx_status *) skb->cb; 718469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 719469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 720469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 721469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 722469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 723469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_req(sdata, mgmt, skb->len); 724469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 725469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 726469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_probe_resp(sdata, mgmt, skb->len, 727469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 728469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 729469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 730469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, 731469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg rx_status); 732469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 733469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 734469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_rx_mgmt_auth_ibss(sdata, mgmt, skb->len); 735469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 736469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 737469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 738469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg kfree_skb(skb); 739469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 740469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 741469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_work(struct work_struct *work) 742469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 743469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 744469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg container_of(work, struct ieee80211_sub_if_data, u.ibss.work); 745469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 746469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss; 747469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct sk_buff *skb; 748469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 749469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!netif_running(sdata->dev)) 750469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 751469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 752469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (local->sw_scanning || local->hw_scanning) 753469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 754469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 755469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_ADHOC)) 756469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 757469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss = &sdata->u.ibss; 758469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 759469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg while ((skb = skb_dequeue(&ifibss->skb_queue))) 760469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_ibss_rx_queued_mgmt(sdata, skb); 761469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 762469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (!test_and_clear_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request)) 763469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return; 764469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 765469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (ifibss->state) { 766469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_SEARCH: 767469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 768469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 769469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_IBSS_MLME_JOINED: 770469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_merge_ibss(sdata); 771469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 772469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg default: 773469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg WARN_ON(1); 774469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg break; 775469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 776469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 777469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 778469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergstatic void ieee80211_ibss_timer(unsigned long data) 779469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 780469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = 781469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (struct ieee80211_sub_if_data *) data; 782469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 783469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 784469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 785469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg set_bit(IEEE80211_IBSS_REQ_RUN, &ifibss->request); 786469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg queue_work(local->hw.workqueue, &ifibss->work); 787469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 788469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 789469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_setup_sdata(struct ieee80211_sub_if_data *sdata) 790469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 791469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 792469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 793469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg INIT_WORK(&ifibss->work, ieee80211_ibss_work); 794469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg setup_timer(&ifibss->timer, ieee80211_ibss_timer, 795469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg (unsigned long) sdata); 796469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_head_init(&ifibss->skb_queue); 797469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 798469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->flags |= IEEE80211_IBSS_AUTO_BSSID_SEL | 799469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg IEEE80211_IBSS_AUTO_CHANNEL_SEL; 800469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 801469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 80279f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsenint ieee80211_ibss_commit(struct ieee80211_sub_if_data *sdata) 80379f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen{ 80479f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 80579f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen 80679f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen ifibss->flags &= ~IEEE80211_IBSS_PREV_BSSID_SET; 80779f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen 80879f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen if (ifibss->ssid_len) 80979f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen ifibss->flags |= IEEE80211_IBSS_SSID_SET; 81079f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen else 81179f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen ifibss->flags &= ~IEEE80211_IBSS_SSID_SET; 81279f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen 81379f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen ifibss->ibss_join_req = jiffies; 81479f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen ifibss->state = IEEE80211_IBSS_MLME_SEARCH; 81579f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen 81679f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen return ieee80211_sta_find_ibss(sdata); 81779f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen} 81879f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen 819469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergint ieee80211_ibss_set_ssid(struct ieee80211_sub_if_data *sdata, char *ssid, size_t len) 820469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 821469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 822469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 823469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (len > IEEE80211_MAX_SSID_LEN) 824469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return -EINVAL; 825469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 826469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ifibss->ssid_len != len || memcmp(ifibss->ssid, ssid, len) != 0) { 827469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(ifibss->ssid, 0, sizeof(ifibss->ssid)); 828469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ifibss->ssid, ssid, len); 829469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->ssid_len = len; 830469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 831469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 83279f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen return ieee80211_ibss_commit(sdata); 833469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 834469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 835469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergint ieee80211_ibss_get_ssid(struct ieee80211_sub_if_data *sdata, char *ssid, size_t *len) 836469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 837469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 838469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 839469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ssid, ifibss->ssid, ifibss->ssid_len); 840469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg *len = ifibss->ssid_len; 841469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 842469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return 0; 843469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 844469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 845469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergint ieee80211_ibss_set_bssid(struct ieee80211_sub_if_data *sdata, u8 *bssid) 846469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 847469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss = &sdata->u.ibss; 848469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 849469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (is_valid_ether_addr(bssid)) { 850469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(ifibss->bssid, bssid, ETH_ALEN); 851469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->flags |= IEEE80211_IBSS_BSSID_SET; 852469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } else { 853469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memset(ifibss->bssid, 0, ETH_ALEN); 854469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss->flags &= ~IEEE80211_IBSS_BSSID_SET; 855469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 856469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 857469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (netif_running(sdata->dev)) { 858469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (ieee80211_if_config(sdata, IEEE80211_IFCC_BSSID)) { 859469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg printk(KERN_DEBUG "%s: Failed to config new BSSID to " 860469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg "the low-level driver\n", sdata->dev->name); 861469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 862469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 863469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 86479f6440c527c61bcd84edfbdeb390841b9fe5095Alina Friedrichsen return ieee80211_ibss_commit(sdata); 865469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 866469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 867469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg/* scan finished notification */ 868469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergvoid ieee80211_ibss_notify_scan_completed(struct ieee80211_local *local) 869469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 870469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_sub_if_data *sdata = local->scan_sdata; 871469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_if_ibss *ifibss; 872469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 873469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (sdata && sdata->vif.type == NL80211_IFTYPE_ADHOC) { 874469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ifibss = &sdata->u.ibss; 875469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if ((!(ifibss->flags & IEEE80211_IBSS_PREV_BSSID_SET)) || 876469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg !ieee80211_sta_active_ibss(sdata)) 877469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg ieee80211_sta_find_ibss(sdata); 878469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 879469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 880469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 881469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergieee80211_rx_result 882469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Bergieee80211_ibss_rx_mgmt(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb, 883469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_rx_status *rx_status) 884469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg{ 885469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_local *local = sdata->local; 886469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg struct ieee80211_mgmt *mgmt; 887469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg u16 fc; 888469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 889469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg if (skb->len < 24) 890469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 891469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 892469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg mgmt = (struct ieee80211_mgmt *) skb->data; 893469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg fc = le16_to_cpu(mgmt->frame_control); 894469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 895469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg switch (fc & IEEE80211_FCTL_STYPE) { 896469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_RESP: 897469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_BEACON: 898469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg memcpy(skb->cb, rx_status, sizeof(*rx_status)); 899469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_PROBE_REQ: 900469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg case IEEE80211_STYPE_AUTH: 901469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg skb_queue_tail(&sdata->u.ibss.skb_queue, skb); 902469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg queue_work(local->hw.workqueue, &sdata->u.ibss.work); 903469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_QUEUED; 904469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg } 905469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg 906469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg return RX_DROP_MONITOR; 907469002983fc90c2ff0959e2b03335c0fe2e4d5a9Johannes Berg} 908