[deliverable/linux.git] / net / ieee80211 / softmac / ieee80211softmac_assoc.c

/*
 * This file contains the softmac's association logic.
 *
 * Copyright (c) 2005, 2006 Johannes Berg <johannes@sipsolutions.net>
 *                          Joseph Jezak <josejx@gentoo.org>
 *                          Larry Finger <Larry.Finger@lwfinger.net>
 *                          Danny van Dyk <kugelfang@gentoo.org>
 *                          Michael Buesch <mbuesch@freenet.de>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
 *
 * The full GNU General Public License is included in this distribution in the
 * file called COPYING.
 */

#include "ieee80211softmac_priv.h"

/*
 * Overview
 *
 * Before you can associate, you have to authenticate.
 *
 */

/* Sends out an association request to the desired AP */
static void
ieee80211softmac_assoc(struct ieee80211softmac_device *mac, struct ieee80211softmac_network *net)
{
	unsigned long flags;

	/* Switch to correct channel for this network */
	mac->set_channel(mac->dev, net->channel);

	/* Send association request */
	ieee80211softmac_send_mgt_frame(mac, net, IEEE80211_STYPE_ASSOC_REQ, 0);

	dprintk(KERN_INFO PFX "sent association request!\n");

	spin_lock_irqsave(&mac->lock, flags);
	mac->associnfo.associated = 0; /* just to make sure */

	/* Set a timer for timeout */
	/* FIXME: make timeout configurable */
	if (likely(mac->running))
		schedule_delayed_work(&mac->associnfo.timeout, 5 * HZ);
	spin_unlock_irqrestore(&mac->lock, flags);
}

void
ieee80211softmac_assoc_timeout(struct work_struct *work)
{
	struct ieee80211softmac_device *mac =
		container_of(work, struct ieee80211softmac_device,
			     associnfo.timeout.work);
	struct ieee80211softmac_network *n;

	mutex_lock(&mac->associnfo.mutex);
	/* we might race against ieee80211softmac_handle_assoc_response,
	 * so make sure only one of us does something */
	if (!mac->associnfo.associating)
		goto out;
	mac->associnfo.associating = 0;
	mac->associnfo.bssvalid = 0;
	mac->associnfo.associated = 0;

	n = ieee80211softmac_get_network_by_bssid_locked(mac, mac->associnfo.bssid);

	dprintk(KERN_INFO PFX "assoc request timed out!\n");
	ieee80211softmac_call_events(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATE_TIMEOUT, n);
out:
	mutex_unlock(&mac->associnfo.mutex);
}

void
ieee80211softmac_disassoc(struct ieee80211softmac_device *mac)
{
	unsigned long flags;

	spin_lock_irqsave(&mac->lock, flags);
	if (mac->associnfo.associating)
		cancel_delayed_work(&mac->associnfo.timeout);

	netif_carrier_off(mac->dev);

	mac->associnfo.associated = 0;
	mac->associnfo.bssvalid = 0;
	mac->associnfo.associating = 0;
	ieee80211softmac_init_bss(mac);
	ieee80211softmac_call_events_locked(mac, IEEE80211SOFTMAC_EVENT_DISASSOCIATED, NULL);
	spin_unlock_irqrestore(&mac->lock, flags);
}

/* Sends out a disassociation request to the desired AP */
void
ieee80211softmac_send_disassoc_req(struct ieee80211softmac_device *mac, u16 reason)
{
	struct ieee80211softmac_network *found;

	if (mac->associnfo.bssvalid && mac->associnfo.associated) {
		found = ieee80211softmac_get_network_by_bssid(mac, mac->associnfo.bssid);
		if (found)
			ieee80211softmac_send_mgt_frame(mac, found, IEEE80211_STYPE_DISASSOC, reason);
	}

	ieee80211softmac_disassoc(mac);
}

static inline int
we_support_all_basic_rates(struct ieee80211softmac_device *mac, u8 *from, u8 from_len)
{
	int idx;
	u8 rate;

	for (idx = 0; idx < (from_len); idx++) {
		rate = (from)[idx];
		if (!(rate & IEEE80211_BASIC_RATE_MASK))
			continue;
		rate &= ~IEEE80211_BASIC_RATE_MASK;
		if (!ieee80211softmac_ratesinfo_rate_supported(&mac->ratesinfo, rate))
			return 0;
	}
	return 1;
}

static int
network_matches_request(struct ieee80211softmac_device *mac, struct ieee80211_network *net)
{
	/* we cannot associate to networks whose name we don't know */
	if (ieee80211_is_empty_essid(net->ssid, net->ssid_len))
		return 0;
	/* do not associate to a network whose BSSBasicRateSet we cannot support */
	if (!we_support_all_basic_rates(mac, net->rates, net->rates_len))
		return 0;
	/* do we really need to check the ex rates? */
	if (!we_support_all_basic_rates(mac, net->rates_ex, net->rates_ex_len))
		return 0;

	/* assume that users know what they're doing ...
	 * (note we don't let them select a net we're incompatible with) */
	if (mac->associnfo.bssfixed) {
		return !memcmp(mac->associnfo.bssid, net->bssid, ETH_ALEN);
	}

	/* if 'ANY' network requested, take any that doesn't have privacy enabled */
	if (mac->associnfo.req_essid.len == 0
	    && !(net->capability & WLAN_CAPABILITY_PRIVACY))
		return 1;
	if (net->ssid_len != mac->associnfo.req_essid.len)
		return 0;
	if (!memcmp(net->ssid, mac->associnfo.req_essid.data, mac->associnfo.req_essid.len))
		return 1;
	return 0;
}

static void
ieee80211softmac_assoc_notify_scan(struct net_device *dev, int event_type, void *context)
{
	struct ieee80211softmac_device *mac = ieee80211_priv(dev);
	ieee80211softmac_assoc_work(&mac->associnfo.work.work);
}

static void
ieee80211softmac_assoc_notify_auth(struct net_device *dev, int event_type, void *context)
{
	struct ieee80211softmac_device *mac = ieee80211_priv(dev);

	switch (event_type) {
	case IEEE80211SOFTMAC_EVENT_AUTHENTICATED:
		ieee80211softmac_assoc_work(&mac->associnfo.work.work);
		break;
	case IEEE80211SOFTMAC_EVENT_AUTH_FAILED:
	case IEEE80211SOFTMAC_EVENT_AUTH_TIMEOUT:
		ieee80211softmac_disassoc(mac);
		break;
	}
}

/* This function is called to handle userspace requests (asynchronously) */
void
ieee80211softmac_assoc_work(struct work_struct *work)
{
	struct ieee80211softmac_device *mac =
		container_of(work, struct ieee80211softmac_device,
			     associnfo.work.work);
	struct ieee80211softmac_network *found = NULL;
	struct ieee80211_network *net = NULL, *best = NULL;
	int bssvalid;
	unsigned long flags;

	mutex_lock(&mac->associnfo.mutex);

	if (!mac->associnfo.associating)
		goto out;

	/* ieee80211_disassoc might clear this */
	bssvalid = mac->associnfo.bssvalid;

	/* meh */
	if (mac->associnfo.associated)
		ieee80211softmac_send_disassoc_req(mac, WLAN_REASON_DISASSOC_STA_HAS_LEFT);

	/* try to find the requested network in our list, if we found one already */
	if (bssvalid || mac->associnfo.bssfixed)
		found = ieee80211softmac_get_network_by_bssid(mac, mac->associnfo.bssid);

	/* Search the ieee80211 networks for this network if we didn't find it by bssid,
	 * but only if we've scanned at least once (to get a better list of networks to
	 * select from). If we have not scanned before, the !found logic below will be
	 * invoked and will scan. */
	if (!found && (mac->associnfo.scan_retry < IEEE80211SOFTMAC_ASSOC_SCAN_RETRY_LIMIT))
	{
		s8 rssi = -128;	/* if I don't initialise, gcc emits an invalid warning
				   because it cannot follow the best pointer logic. */
		spin_lock_irqsave(&mac->ieee->lock, flags);
		list_for_each_entry(net, &mac->ieee->network_list, list) {
			/* we're supposed to find the network with
			 * the best signal here, as we're asked to join
			 * any network with a specific ESSID, and many
			 * different ones could have that.
			 *
			 * I'll for now just go with the reported rssi.
			 *
			 * We also should take into account the rateset
			 * here to find the best BSSID to try.
			 */
			if (network_matches_request(mac, net)) {
				if (!best) {
					best = net;
					rssi = best->stats.rssi;
					continue;
				}
				/* we already had a matching network, so
				 * compare their properties to get the
				 * better of the two ... (see above)
				 */
				if (rssi < net->stats.rssi) {
					best = net;
					rssi = best->stats.rssi;
				}
			}
		}
		/* if we unlock here, we might get interrupted and the `best'
		 * pointer could go stale */
		if (best) {
			found = ieee80211softmac_create_network(mac, best);
			/* if found is still NULL, then we got -ENOMEM somewhere */
			if (found)
				ieee80211softmac_add_network(mac, found);
		}
		spin_unlock_irqrestore(&mac->ieee->lock, flags);
	}

	if (!found) {
		if (mac->associnfo.scan_retry > 0) {
			mac->associnfo.scan_retry--;

			/* We know of no such network. Let's scan.
			 * NB: this also happens if we had no memory to copy the network info...
			 * Maybe we can hope to have more memory after scanning finishes ;)
			 */
			dprintk(KERN_INFO PFX "Associate: Scanning for networks first.\n");
			ieee80211softmac_notify(mac->dev, IEEE80211SOFTMAC_EVENT_SCAN_FINISHED, ieee80211softmac_assoc_notify_scan, NULL);
			if (ieee80211softmac_start_scan(mac)) {
				dprintk(KERN_INFO PFX "Associate: failed to initiate scan. Is device up?\n");
			}
			goto out;
		} else {
			mac->associnfo.associating = 0;
			mac->associnfo.associated = 0;

			dprintk(KERN_INFO PFX "Unable to find matching network after scan!\n");
			/* reset the retry counter for the next user request since we
			 * break out and don't reschedule ourselves after this point. */
			mac->associnfo.scan_retry = IEEE80211SOFTMAC_ASSOC_SCAN_RETRY_LIMIT;
			ieee80211softmac_call_events(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATE_NET_NOT_FOUND, NULL);
			goto out;
		}
	}

	/* reset the retry counter for the next user request since we
	 * now found a net and will try to associate to it, but not
	 * schedule this function again. */
	mac->associnfo.scan_retry = IEEE80211SOFTMAC_ASSOC_SCAN_RETRY_LIMIT;
	mac->associnfo.bssvalid = 1;
	memcpy(mac->associnfo.bssid, found->bssid, ETH_ALEN);
	/* copy the ESSID for displaying it */
	mac->associnfo.associate_essid.len = found->essid.len;
	memcpy(mac->associnfo.associate_essid.data, found->essid.data, IW_ESSID_MAX_SIZE + 1);

	/* we found a network! authenticate (if necessary) and associate to it. */
	if (found->authenticating) {
		dprintk(KERN_INFO PFX "Already requested authentication, waiting...\n");
		if(!mac->associnfo.assoc_wait) {
			mac->associnfo.assoc_wait = 1;
			ieee80211softmac_notify_internal(mac, IEEE80211SOFTMAC_EVENT_ANY, found, ieee80211softmac_assoc_notify_auth, NULL, GFP_KERNEL);
		}
		goto out;
	}
	if (!found->authenticated && !found->authenticating) {
		/* This relies on the fact that _auth_req only queues the work,
		 * otherwise adding the notification would be racy. */
		if (!ieee80211softmac_auth_req(mac, found)) {
			if(!mac->associnfo.assoc_wait) {
				dprintk(KERN_INFO PFX "Cannot associate without being authenticated, requested authentication\n");
				mac->associnfo.assoc_wait = 1;
				ieee80211softmac_notify_internal(mac, IEEE80211SOFTMAC_EVENT_ANY, found, ieee80211softmac_assoc_notify_auth, NULL, GFP_KERNEL);
			}
		} else {
			printkl(KERN_WARNING PFX "Not authenticated, but requesting authentication failed. Giving up to associate\n");
			mac->associnfo.assoc_wait = 0;
			ieee80211softmac_call_events(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATE_FAILED, found);
		}
		goto out;
	}
	/* finally! now we can start associating */
	mac->associnfo.assoc_wait = 0;
	ieee80211softmac_assoc(mac, found);

out:
	mutex_unlock(&mac->associnfo.mutex);
}

/* call this to do whatever is necessary when we're associated */
static void
ieee80211softmac_associated(struct ieee80211softmac_device *mac,
	struct ieee80211_assoc_response * resp,
	struct ieee80211softmac_network *net)
{
	u16 cap = le16_to_cpu(resp->capability);
	u8 erp_value = net->erp_value;

	mac->associnfo.associating = 0;
	mac->bssinfo.supported_rates = net->supported_rates;
	ieee80211softmac_recalc_txrates(mac);

	mac->associnfo.associated = 1;

	mac->associnfo.short_preamble_available =
		(cap & WLAN_CAPABILITY_SHORT_PREAMBLE) != 0;
	ieee80211softmac_process_erp(mac, erp_value);

	if (mac->set_bssid_filter)
		mac->set_bssid_filter(mac->dev, net->bssid);
	memcpy(mac->ieee->bssid, net->bssid, ETH_ALEN);
	netif_carrier_on(mac->dev);

	mac->association_id = le16_to_cpup(&resp->aid);
}

/* received frame handling functions */
int
ieee80211softmac_handle_assoc_response(struct net_device * dev,
				       struct ieee80211_assoc_response * resp,
				       struct ieee80211_network * _ieee80211_network)
{
	/* NOTE: the network parameter has to be mostly ignored by
	 *       this code because it is the ieee80211's pointer
	 *       to the struct, not ours (we made a copy)
	 */
	struct ieee80211softmac_device *mac = ieee80211_priv(dev);
	u16 status = le16_to_cpup(&resp->status);
	struct ieee80211softmac_network *network = NULL;
	unsigned long flags;
	DECLARE_MAC_BUF(mac2);

	if (unlikely(!mac->running))
		return -ENODEV;

	spin_lock_irqsave(&mac->lock, flags);

	if (!mac->associnfo.associating) {
		/* we race against the timeout function, so make sure
		 * only one of us can do work */
		spin_unlock_irqrestore(&mac->lock, flags);
		return 0;
	}
	network = ieee80211softmac_get_network_by_bssid_locked(mac, resp->header.addr3);

	/* someone sending us things without us knowing him? Ignore. */
	if (!network) {
		dprintk(KERN_INFO PFX "Received unrequested assocation response from %s\n",
			print_mac(mac2, resp->header.addr3));
		spin_unlock_irqrestore(&mac->lock, flags);
		return 0;
	}

	/* now that we know it was for us, we can cancel the timeout */
	cancel_delayed_work(&mac->associnfo.timeout);

	/* if the association response included an ERP IE, update our saved
	 * copy */
	if (_ieee80211_network->flags & NETWORK_HAS_ERP_VALUE)
		network->erp_value = _ieee80211_network->erp_value;

	switch (status) {
		case 0:
			dprintk(KERN_INFO PFX "associated!\n");
			ieee80211softmac_associated(mac, resp, network);
			ieee80211softmac_call_events_locked(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATED, network);
			break;
		case WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH:
			if (!network->auth_desynced_once) {
				/* there seem to be a few rare cases where our view of
				 * the world is obscured, or buggy APs that don't DEAUTH
				 * us properly. So we handle that, but allow it only once.
				 */
				printkl(KERN_INFO PFX "We were not authenticated during association, retrying...\n");
				network->authenticated = 0;
				/* we don't want to do this more than once ... */
				network->auth_desynced_once = 1;
				schedule_delayed_work(&mac->associnfo.work, 0);
				break;
			}
		default:
			dprintk(KERN_INFO PFX "associating failed (reason: 0x%x)!\n", status);
			mac->associnfo.associating = 0;
			mac->associnfo.bssvalid = 0;
			mac->associnfo.associated = 0;
			ieee80211softmac_call_events_locked(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATE_FAILED, network);
	}

	spin_unlock_irqrestore(&mac->lock, flags);
	return 0;
}

void
ieee80211softmac_try_reassoc(struct ieee80211softmac_device *mac)
{
	unsigned long flags;

	spin_lock_irqsave(&mac->lock, flags);
	mac->associnfo.associating = 1;
	schedule_delayed_work(&mac->associnfo.work, 0);
	spin_unlock_irqrestore(&mac->lock, flags);
}

int
ieee80211softmac_handle_disassoc(struct net_device * dev,
				 struct ieee80211_disassoc *disassoc)
{
	struct ieee80211softmac_device *mac = ieee80211_priv(dev);

	if (unlikely(!mac->running))
		return -ENODEV;

	if (memcmp(disassoc->header.addr2, mac->associnfo.bssid, ETH_ALEN))
		return 0;

	if (memcmp(disassoc->header.addr1, mac->dev->dev_addr, ETH_ALEN))
		return 0;

	dprintk(KERN_INFO PFX "got disassoc frame\n");
	ieee80211softmac_disassoc(mac);

	ieee80211softmac_try_reassoc(mac);

	return 0;
}

int
ieee80211softmac_handle_reassoc_req(struct net_device * dev,
				    struct ieee80211_reassoc_request * resp)
{
	struct ieee80211softmac_device *mac = ieee80211_priv(dev);
	struct ieee80211softmac_network *network;

	if (unlikely(!mac->running))
		return -ENODEV;

	network = ieee80211softmac_get_network_by_bssid(mac, resp->header.addr3);
	if (!network) {
		dprintkl(KERN_INFO PFX "reassoc request from unknown network\n");
		return 0;
	}
	schedule_delayed_work(&mac->associnfo.work, 0);

	return 0;
}
Commit	Line	Data
4855d25b JB	1	/*
	2	* This file contains the softmac's association logic.
	3	*
79859051 JB	4	* Copyright (c) 2005, 2006 Johannes Berg <johannes@sipsolutions.net>
	5	* Joseph Jezak <josejx@gentoo.org>
	6	* Larry Finger <Larry.Finger@lwfinger.net>
	7	* Danny van Dyk <kugelfang@gentoo.org>
	8	* Michael Buesch <mbuesch@freenet.de>
4855d25b JB	9	*
	10	* This program is free software; you can redistribute it and/or modify it
	11	* under the terms of version 2 of the GNU General Public License as
	12	* published by the Free Software Foundation.
	13	*
	14	* This program is distributed in the hope that it will be useful, but WITHOUT
	15	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	16	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	17	* more details.
	18	*
	19	* You should have received a copy of the GNU General Public License
	20	* along with this program; if not, write to the Free Software
	21	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
	22	*
	23	* The full GNU General Public License is included in this distribution in the
	24	* file called COPYING.
	25	*/
	26
370121e5 JB	27	#include "ieee80211softmac_priv.h"
	28
	29	/*
	30	* Overview
	31	*
	32	* Before you can associate, you have to authenticate.
64265651	33	*
370121e5 JB	34	*/
	35
	36	/* Sends out an association request to the desired AP */
	37	static void
	38	ieee80211softmac_assoc(struct ieee80211softmac_device mac, struct ieee80211softmac_network net)
	39	{
	40	unsigned long flags;
9a107aa2	41
370121e5 JB	42	/* Switch to correct channel for this network */
370121e5 JB	43	mac->set_channel(mac->dev, net->channel);
64265651	44
370121e5 JB	45	/* Send association request */
370121e5 JB	46	ieee80211softmac_send_mgt_frame(mac, net, IEEE80211_STYPE_ASSOC_REQ, 0);
64265651	47
370121e5 JB	48	dprintk(KERN_INFO PFX "sent association request!\n");
370121e5 JB	49
370121e5	50	spin_lock_irqsave(&mac->lock, flags);
7c28ad2d	51	mac->associnfo.associated = 0; /* just to make sure */
370121e5 JB	52
	53	/* Set a timer for timeout */
	54	/* FIXME: make timeout configurable */
d57336e3 DD	55	if (likely(mac->running))
	56	schedule_delayed_work(&mac->associnfo.timeout, 5 * HZ);
	57	spin_unlock_irqrestore(&mac->lock, flags);
370121e5 JB	58	}
	59
	60	void
c4028958	61	ieee80211softmac_assoc_timeout(struct work_struct *work)
370121e5	62	{
c4028958 DH	63	struct ieee80211softmac_device *mac =
	64	container_of(work, struct ieee80211softmac_device,
	65	associnfo.timeout.work);
9f101fc5	66	struct ieee80211softmac_network *n;
370121e5	67
7c28ad2d	68	mutex_lock(&mac->associnfo.mutex);
370121e5 JB	69	/* we might race against ieee80211softmac_handle_assoc_response,
370121e5 JB	70	* so make sure only one of us does something */
7c28ad2d MB	71	if (!mac->associnfo.associating)
7c28ad2d MB	72	goto out;
370121e5 JB	73	mac->associnfo.associating = 0;
370121e5 JB	74	mac->associnfo.bssvalid = 0;
7c28ad2d	75	mac->associnfo.associated = 0;
9f101fc5 JJ	76
9f101fc5 JJ	77	n = ieee80211softmac_get_network_by_bssid_locked(mac, mac->associnfo.bssid);
370121e5 JB	78
370121e5 JB	79	dprintk(KERN_INFO PFX "assoc request timed out!\n");
9f101fc5	80	ieee80211softmac_call_events(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATE_TIMEOUT, n);
7c28ad2d MB	81	out:
7c28ad2d MB	82	mutex_unlock(&mac->associnfo.mutex);
370121e5 JB	83	}
370121e5 JB	84
9a1771e8	85	void
6d92f83f	86	ieee80211softmac_disassoc(struct ieee80211softmac_device *mac)
370121e5 JB	87	{
370121e5 JB	88	unsigned long flags;
6d92f83f DD	89
	90	spin_lock_irqsave(&mac->lock, flags);
	91	if (mac->associnfo.associating)
	92	cancel_delayed_work(&mac->associnfo.timeout);
	93
	94	netif_carrier_off(mac->dev);
	95
7c28ad2d	96	mac->associnfo.associated = 0;
6d92f83f DD	97	mac->associnfo.bssvalid = 0;
6d92f83f DD	98	mac->associnfo.associating = 0;
5acd0c41	99	ieee80211softmac_init_bss(mac);
6d92f83f DD	100	ieee80211softmac_call_events_locked(mac, IEEE80211SOFTMAC_EVENT_DISASSOCIATED, NULL);
	101	spin_unlock_irqrestore(&mac->lock, flags);
	102	}
	103
	104	/* Sends out a disassociation request to the desired AP */
	105	void
	106	ieee80211softmac_send_disassoc_req(struct ieee80211softmac_device *mac, u16 reason)
	107	{
370121e5	108	struct ieee80211softmac_network *found;
370121e5	109
7c28ad2d	110	if (mac->associnfo.bssvalid && mac->associnfo.associated) {
370121e5 JB	111	found = ieee80211softmac_get_network_by_bssid(mac, mac->associnfo.bssid);
	112	if (found)
	113	ieee80211softmac_send_mgt_frame(mac, found, IEEE80211_STYPE_DISASSOC, reason);
370121e5 JB	114	}
370121e5 JB	115
6d92f83f	116	ieee80211softmac_disassoc(mac);
370121e5 JB	117	}
	118
	119	static inline int
	120	we_support_all_basic_rates(struct ieee80211softmac_device mac, u8 from, u8 from_len)
	121	{
8462fe3c DD	122	int idx;
8462fe3c DD	123	u8 rate;
370121e5 JB	124
	125	for (idx = 0; idx < (from_len); idx++) {
	126	rate = (from)[idx];
	127	if (!(rate & IEEE80211_BASIC_RATE_MASK))
	128	continue;
370121e5	129	rate &= ~IEEE80211_BASIC_RATE_MASK;
8462fe3c	130	if (!ieee80211softmac_ratesinfo_rate_supported(&mac->ratesinfo, rate))
370121e5 JB	131	return 0;
	132	}
	133	return 1;
	134	}
	135
	136	static int
	137	network_matches_request(struct ieee80211softmac_device mac, struct ieee80211_network net)
	138	{
	139	/* we cannot associate to networks whose name we don't know */
	140	if (ieee80211_is_empty_essid(net->ssid, net->ssid_len))
	141	return 0;
	142	/* do not associate to a network whose BSSBasicRateSet we cannot support */
	143	if (!we_support_all_basic_rates(mac, net->rates, net->rates_len))
	144	return 0;
	145	/* do we really need to check the ex rates? */
	146	if (!we_support_all_basic_rates(mac, net->rates_ex, net->rates_ex_len))
	147	return 0;
	148
818667f7 JB	149	/* assume that users know what they're doing ...
	150	* (note we don't let them select a net we're incompatible with) */
	151	if (mac->associnfo.bssfixed) {
	152	return !memcmp(mac->associnfo.bssid, net->bssid, ETH_ALEN);
	153	}
	154
370121e5	155	/* if 'ANY' network requested, take any that doesn't have privacy enabled */
64265651	156	if (mac->associnfo.req_essid.len == 0
370121e5 JB	157	&& !(net->capability & WLAN_CAPABILITY_PRIVACY))
	158	return 1;
	159	if (net->ssid_len != mac->associnfo.req_essid.len)
	160	return 0;
	161	if (!memcmp(net->ssid, mac->associnfo.req_essid.data, mac->associnfo.req_essid.len))
	162	return 1;
	163	return 0;
	164	}
	165
	166	static void
6ae15df1	167	ieee80211softmac_assoc_notify_scan(struct net_device dev, int event_type, void context)
370121e5 JB	168	{
370121e5 JB	169	struct ieee80211softmac_device *mac = ieee80211_priv(dev);
6f07a8a3	170	ieee80211softmac_assoc_work(&mac->associnfo.work.work);
370121e5 JB	171	}
370121e5 JB	172
6ae15df1 DD	173	static void
	174	ieee80211softmac_assoc_notify_auth(struct net_device dev, int event_type, void context)
	175	{
	176	struct ieee80211softmac_device *mac = ieee80211_priv(dev);
	177
	178	switch (event_type) {
	179	case IEEE80211SOFTMAC_EVENT_AUTHENTICATED:
6f07a8a3	180	ieee80211softmac_assoc_work(&mac->associnfo.work.work);
6ae15df1 DD	181	break;
	182	case IEEE80211SOFTMAC_EVENT_AUTH_FAILED:
	183	case IEEE80211SOFTMAC_EVENT_AUTH_TIMEOUT:
	184	ieee80211softmac_disassoc(mac);
	185	break;
	186	}
	187	}
	188
370121e5 JB	189	/* This function is called to handle userspace requests (asynchronously) */
370121e5 JB	190	void
c4028958	191	ieee80211softmac_assoc_work(struct work_struct *work)
370121e5	192	{
c4028958 DH	193	struct ieee80211softmac_device *mac =
	194	container_of(work, struct ieee80211softmac_device,
	195	associnfo.work.work);
370121e5 JB	196	struct ieee80211softmac_network *found = NULL;
370121e5 JB	197	struct ieee80211_network net = NULL, best = NULL;
6d92f83f	198	int bssvalid;
370121e5	199	unsigned long flags;
6d92f83f	200
7c28ad2d MB	201	mutex_lock(&mac->associnfo.mutex);
	202
	203	if (!mac->associnfo.associating)
	204	goto out;
	205
6d92f83f DD	206	/* ieee80211_disassoc might clear this */
	207	bssvalid = mac->associnfo.bssvalid;
	208
370121e5	209	/* meh */
7c28ad2d	210	if (mac->associnfo.associated)
6d92f83f	211	ieee80211softmac_send_disassoc_req(mac, WLAN_REASON_DISASSOC_STA_HAS_LEFT);
370121e5 JB	212
370121e5 JB	213	/* try to find the requested network in our list, if we found one already */
6d92f83f	214	if (bssvalid \|\| mac->associnfo.bssfixed)
64265651 YH	215	found = ieee80211softmac_get_network_by_bssid(mac, mac->associnfo.bssid);
64265651 YH	216
1dc09776 JB	217	/* Search the ieee80211 networks for this network if we didn't find it by bssid,
	218	* but only if we've scanned at least once (to get a better list of networks to
	219	* select from). If we have not scanned before, the !found logic below will be
	220	* invoked and will scan. */
	221	if (!found && (mac->associnfo.scan_retry < IEEE80211SOFTMAC_ASSOC_SCAN_RETRY_LIMIT))
370121e5	222	{
78e4f36e JB	223	s8 rssi = -128; /* if I don't initialise, gcc emits an invalid warning
78e4f36e JB	224	because it cannot follow the best pointer logic. */
370121e5 JB	225	spin_lock_irqsave(&mac->ieee->lock, flags);
	226	list_for_each_entry(net, &mac->ieee->network_list, list) {
	227	/* we're supposed to find the network with
	228	* the best signal here, as we're asked to join
	229	* any network with a specific ESSID, and many
	230	* different ones could have that.
	231	*
78e4f36e	232	* I'll for now just go with the reported rssi.
370121e5 JB	233	*
	234	* We also should take into account the rateset
	235	* here to find the best BSSID to try.
	236	*/
	237	if (network_matches_request(mac, net)) {
	238	if (!best) {
	239	best = net;
78e4f36e	240	rssi = best->stats.rssi;
370121e5 JB	241	continue;
	242	}
	243	/* we already had a matching network, so
	244	* compare their properties to get the
	245	* better of the two ... (see above)
	246	*/
78e4f36e JB	247	if (rssi < net->stats.rssi) {
	248	best = net;
	249	rssi = best->stats.rssi;
	250	}
370121e5 JB	251	}
	252	}
	253	/* if we unlock here, we might get interrupted and the `best'
	254	* pointer could go stale */
	255	if (best) {
	256	found = ieee80211softmac_create_network(mac, best);
	257	/* if found is still NULL, then we got -ENOMEM somewhere */
	258	if (found)
	259	ieee80211softmac_add_network(mac, found);
	260	}
	261	spin_unlock_irqrestore(&mac->ieee->lock, flags);
	262	}
	263
	264	if (!found) {
	265	if (mac->associnfo.scan_retry > 0) {
370121e5	266	mac->associnfo.scan_retry--;
7c28ad2d	267
64265651	268	/* We know of no such network. Let's scan.
370121e5 JB	269	* NB: this also happens if we had no memory to copy the network info...
	270	* Maybe we can hope to have more memory after scanning finishes ;)
	271	*/
1dc09776	272	dprintk(KERN_INFO PFX "Associate: Scanning for networks first.\n");
6ae15df1	273	ieee80211softmac_notify(mac->dev, IEEE80211SOFTMAC_EVENT_SCAN_FINISHED, ieee80211softmac_assoc_notify_scan, NULL);
4cf92a3c	274	if (ieee80211softmac_start_scan(mac)) {
1dc09776	275	dprintk(KERN_INFO PFX "Associate: failed to initiate scan. Is device up?\n");
4cf92a3c	276	}
7c28ad2d	277	goto out;
818667f7	278	} else {
370121e5	279	mac->associnfo.associating = 0;
7c28ad2d	280	mac->associnfo.associated = 0;
370121e5	281
1dc09776	282	dprintk(KERN_INFO PFX "Unable to find matching network after scan!\n");
818667f7 JB	283	/* reset the retry counter for the next user request since we
	284	* break out and don't reschedule ourselves after this point. */
	285	mac->associnfo.scan_retry = IEEE80211SOFTMAC_ASSOC_SCAN_RETRY_LIMIT;
370121e5	286	ieee80211softmac_call_events(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATE_NET_NOT_FOUND, NULL);
7c28ad2d	287	goto out;
370121e5 JB	288	}
370121e5 JB	289	}
818667f7 JB	290
	291	/* reset the retry counter for the next user request since we
	292	* now found a net and will try to associate to it, but not
	293	* schedule this function again. */
	294	mac->associnfo.scan_retry = IEEE80211SOFTMAC_ASSOC_SCAN_RETRY_LIMIT;
370121e5 JB	295	mac->associnfo.bssvalid = 1;
	296	memcpy(mac->associnfo.bssid, found->bssid, ETH_ALEN);
	297	/* copy the ESSID for displaying it */
	298	mac->associnfo.associate_essid.len = found->essid.len;
	299	memcpy(mac->associnfo.associate_essid.data, found->essid.data, IW_ESSID_MAX_SIZE + 1);
7c28ad2d	300
370121e5	301	/* we found a network! authenticate (if necessary) and associate to it. */
cb74c432 JJ	302	if (found->authenticating) {
	303	dprintk(KERN_INFO PFX "Already requested authentication, waiting...\n");
	304	if(!mac->associnfo.assoc_wait) {
	305	mac->associnfo.assoc_wait = 1;
4a232e72	306	ieee80211softmac_notify_internal(mac, IEEE80211SOFTMAC_EVENT_ANY, found, ieee80211softmac_assoc_notify_auth, NULL, GFP_KERNEL);
cb74c432	307	}
7c28ad2d	308	goto out;
cb74c432 JJ	309	}
cb74c432 JJ	310	if (!found->authenticated && !found->authenticating) {
370121e5 JB	311	/* This relies on the fact that _auth_req only queues the work,
	312	* otherwise adding the notification would be racy. */
	313	if (!ieee80211softmac_auth_req(mac, found)) {
cb74c432 JJ	314	if(!mac->associnfo.assoc_wait) {
	315	dprintk(KERN_INFO PFX "Cannot associate without being authenticated, requested authentication\n");
	316	mac->associnfo.assoc_wait = 1;
4a232e72	317	ieee80211softmac_notify_internal(mac, IEEE80211SOFTMAC_EVENT_ANY, found, ieee80211softmac_assoc_notify_auth, NULL, GFP_KERNEL);
cb74c432	318	}
370121e5 JB	319	} else {
370121e5 JB	320	printkl(KERN_WARNING PFX "Not authenticated, but requesting authentication failed. Giving up to associate\n");
cb74c432	321	mac->associnfo.assoc_wait = 0;
370121e5 JB	322	ieee80211softmac_call_events(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATE_FAILED, found);
370121e5 JB	323	}
7c28ad2d	324	goto out;
370121e5 JB	325	}
370121e5 JB	326	/* finally! now we can start associating */
cb74c432	327	mac->associnfo.assoc_wait = 0;
370121e5	328	ieee80211softmac_assoc(mac, found);
7c28ad2d MB	329
	330	out:
	331	mutex_unlock(&mac->associnfo.mutex);
370121e5 JB	332	}
	333
	334	/* call this to do whatever is necessary when we're associated */
	335	static void
	336	ieee80211softmac_associated(struct ieee80211softmac_device *mac,
	337	struct ieee80211_assoc_response * resp,
	338	struct ieee80211softmac_network *net)
	339	{
5acd0c41 DD	340	u16 cap = le16_to_cpu(resp->capability);
	341	u8 erp_value = net->erp_value;
	342
370121e5	343	mac->associnfo.associating = 0;
5acd0c41	344	mac->bssinfo.supported_rates = net->supported_rates;
8462fe3c DD	345	ieee80211softmac_recalc_txrates(mac);
8462fe3c DD	346
7c28ad2d	347	mac->associnfo.associated = 1;
5acd0c41 DD	348
	349	mac->associnfo.short_preamble_available =
	350	(cap & WLAN_CAPABILITY_SHORT_PREAMBLE) != 0;
	351	ieee80211softmac_process_erp(mac, erp_value);
	352
370121e5 JB	353	if (mac->set_bssid_filter)
	354	mac->set_bssid_filter(mac->dev, net->bssid);
	355	memcpy(mac->ieee->bssid, net->bssid, ETH_ALEN);
2dd50801	356	netif_carrier_on(mac->dev);
64265651	357
370121e5 JB	358	mac->association_id = le16_to_cpup(&resp->aid);
	359	}
	360
	361	/* received frame handling functions */
	362	int
	363	ieee80211softmac_handle_assoc_response(struct net_device * dev,
	364	struct ieee80211_assoc_response * resp,
5acd0c41	365	struct ieee80211_network * _ieee80211_network)
370121e5	366	{
5acd0c41	367	/* NOTE: the network parameter has to be mostly ignored by
370121e5 JB	368	* this code because it is the ieee80211's pointer
	369	* to the struct, not ours (we made a copy)
	370	*/
	371	struct ieee80211softmac_device *mac = ieee80211_priv(dev);
	372	u16 status = le16_to_cpup(&resp->status);
	373	struct ieee80211softmac_network *network = NULL;
	374	unsigned long flags;
0795af57	375	DECLARE_MAC_BUF(mac2);
d57336e3 DD	376
	377	if (unlikely(!mac->running))
	378	return -ENODEV;
64265651	379
370121e5 JB	380	spin_lock_irqsave(&mac->lock, flags);
	381
	382	if (!mac->associnfo.associating) {
	383	/* we race against the timeout function, so make sure
	384	* only one of us can do work */
	385	spin_unlock_irqrestore(&mac->lock, flags);
	386	return 0;
	387	}
	388	network = ieee80211softmac_get_network_by_bssid_locked(mac, resp->header.addr3);
	389
	390	/* someone sending us things without us knowing him? Ignore. */
	391	if (!network) {
0795af57 JP	392	dprintk(KERN_INFO PFX "Received unrequested assocation response from %s\n",
0795af57 JP	393	print_mac(mac2, resp->header.addr3));
370121e5 JB	394	spin_unlock_irqrestore(&mac->lock, flags);
	395	return 0;
	396	}
	397
	398	/* now that we know it was for us, we can cancel the timeout */
	399	cancel_delayed_work(&mac->associnfo.timeout);
	400
5acd0c41 DD	401	/* if the association response included an ERP IE, update our saved
	402	* copy */
	403	if (_ieee80211_network->flags & NETWORK_HAS_ERP_VALUE)
	404	network->erp_value = _ieee80211_network->erp_value;
	405
370121e5 JB	406	switch (status) {
	407	case 0:
	408	dprintk(KERN_INFO PFX "associated!\n");
	409	ieee80211softmac_associated(mac, resp, network);
	410	ieee80211softmac_call_events_locked(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATED, network);
	411	break;
	412	case WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH:
	413	if (!network->auth_desynced_once) {
	414	/* there seem to be a few rare cases where our view of
	415	* the world is obscured, or buggy APs that don't DEAUTH
	416	* us properly. So we handle that, but allow it only once.
	417	*/
	418	printkl(KERN_INFO PFX "We were not authenticated during association, retrying...\n");
	419	network->authenticated = 0;
	420	/* we don't want to do this more than once ... */
	421	network->auth_desynced_once = 1;
c4028958	422	schedule_delayed_work(&mac->associnfo.work, 0);
370121e5 JB	423	break;
	424	}
	425	default:
	426	dprintk(KERN_INFO PFX "associating failed (reason: 0x%x)!\n", status);
	427	mac->associnfo.associating = 0;
	428	mac->associnfo.bssvalid = 0;
7c28ad2d	429	mac->associnfo.associated = 0;
370121e5 JB	430	ieee80211softmac_call_events_locked(mac, IEEE80211SOFTMAC_EVENT_ASSOCIATE_FAILED, network);
370121e5 JB	431	}
64265651	432
370121e5 JB	433	spin_unlock_irqrestore(&mac->lock, flags);
	434	return 0;
	435	}
	436
2b50c245 UK	437	void
	438	ieee80211softmac_try_reassoc(struct ieee80211softmac_device *mac)
	439	{
	440	unsigned long flags;
	441
	442	spin_lock_irqsave(&mac->lock, flags);
	443	mac->associnfo.associating = 1;
db9a758c	444	schedule_delayed_work(&mac->associnfo.work, 0);
2b50c245 UK	445	spin_unlock_irqrestore(&mac->lock, flags);
	446	}
	447
370121e5 JB	448	int
	449	ieee80211softmac_handle_disassoc(struct net_device * dev,
	450	struct ieee80211_disassoc *disassoc)
	451	{
	452	struct ieee80211softmac_device *mac = ieee80211_priv(dev);
d57336e3 DD	453
	454	if (unlikely(!mac->running))
	455	return -ENODEV;
	456
48b2e4ce JB	457	if (memcmp(disassoc->header.addr2, mac->associnfo.bssid, ETH_ALEN))
48b2e4ce JB	458	return 0;
d57336e3	459
48b2e4ce JB	460	if (memcmp(disassoc->header.addr1, mac->dev->dev_addr, ETH_ALEN))
48b2e4ce JB	461	return 0;
d57336e3	462
370121e5	463	dprintk(KERN_INFO PFX "got disassoc frame\n");
6d92f83f DD	464	ieee80211softmac_disassoc(mac);
6d92f83f DD	465
2b50c245	466	ieee80211softmac_try_reassoc(mac);
6d92f83f	467
370121e5 JB	468	return 0;
370121e5 JB	469	}
b6c7658e JB	470
	471	int
	472	ieee80211softmac_handle_reassoc_req(struct net_device * dev,
	473	struct ieee80211_reassoc_request * resp)
	474	{
	475	struct ieee80211softmac_device *mac = ieee80211_priv(dev);
	476	struct ieee80211softmac_network *network;
	477
d57336e3 DD	478	if (unlikely(!mac->running))
	479	return -ENODEV;
	480
b6c7658e JB	481	network = ieee80211softmac_get_network_by_bssid(mac, resp->header.addr3);
	482	if (!network) {
	483	dprintkl(KERN_INFO PFX "reassoc request from unknown network\n");
	484	return 0;
	485	}
c4028958	486	schedule_delayed_work(&mac->associnfo.work, 0);
9b0b4d8a	487
b6c7658e JB	488	return 0;
b6c7658e JB	489	}