[deliverable/linux.git] / net / wireless / ibss.c

/*
 * Some IBSS support code for cfg80211.
 *
 * Copyright 2009	Johannes Berg <johannes@sipsolutions.net>
 */

#include <linux/etherdevice.h>
#include <linux/if_arp.h>
#include <linux/slab.h>
#include <linux/export.h>
#include <net/cfg80211.h>
#include "wext-compat.h"
#include "nl80211.h"


void __cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_bss *bss;
#ifdef CONFIG_CFG80211_WEXT
	union iwreq_data wrqu;
#endif

	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
		return;

	if (!wdev->ssid_len)
		return;

	bss = cfg80211_get_bss(wdev->wiphy, NULL, bssid,
			       wdev->ssid, wdev->ssid_len,
			       WLAN_CAPABILITY_IBSS, WLAN_CAPABILITY_IBSS);

	if (WARN_ON(!bss))
		return;

	if (wdev->current_bss) {
		cfg80211_unhold_bss(wdev->current_bss);
		cfg80211_put_bss(&wdev->current_bss->pub);
	}

	cfg80211_hold_bss(bss_from_pub(bss));
	wdev->current_bss = bss_from_pub(bss);

	wdev->sme_state = CFG80211_SME_CONNECTED;
	cfg80211_upload_connect_keys(wdev);

	nl80211_send_ibss_bssid(wiphy_to_dev(wdev->wiphy), dev, bssid,
				GFP_KERNEL);
#ifdef CONFIG_CFG80211_WEXT
	memset(&wrqu, 0, sizeof(wrqu));
	memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN);
	wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
#endif
}

void cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid, gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	struct cfg80211_event *ev;
	unsigned long flags;

	CFG80211_DEV_WARN_ON(wdev->sme_state != CFG80211_SME_CONNECTING);

	ev = kzalloc(sizeof(*ev), gfp);
	if (!ev)
		return;

	ev->type = EVENT_IBSS_JOINED;
	memcpy(ev->cr.bssid, bssid, ETH_ALEN);

	spin_lock_irqsave(&wdev->event_lock, flags);
	list_add_tail(&ev->list, &wdev->event_list);
	spin_unlock_irqrestore(&wdev->event_lock, flags);
	queue_work(cfg80211_wq, &rdev->event_work);
}
EXPORT_SYMBOL(cfg80211_ibss_joined);

int __cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
			 struct net_device *dev,
			 struct cfg80211_ibss_params *params,
			 struct cfg80211_cached_keys *connkeys)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	int err;

	ASSERT_WDEV_LOCK(wdev);

	if (wdev->ssid_len)
		return -EALREADY;

	if (!params->basic_rates) {
		/*
		* If no rates were explicitly configured,
		* use the mandatory rate set for 11b or
		* 11a for maximum compatibility.
		*/
		struct ieee80211_supported_band *sband =
			rdev->wiphy.bands[params->channel->band];
		int j;
		u32 flag = params->channel->band == IEEE80211_BAND_5GHZ ?
			IEEE80211_RATE_MANDATORY_A :
			IEEE80211_RATE_MANDATORY_B;

		for (j = 0; j < sband->n_bitrates; j++) {
			if (sband->bitrates[j].flags & flag)
				params->basic_rates |= BIT(j);
		}
	}

	if (WARN_ON(wdev->connect_keys))
		kfree(wdev->connect_keys);
	wdev->connect_keys = connkeys;

	wdev->ibss_fixed = params->channel_fixed;
#ifdef CONFIG_CFG80211_WEXT
	wdev->wext.ibss.channel = params->channel;
#endif
	wdev->sme_state = CFG80211_SME_CONNECTING;

	err = cfg80211_can_use_chan(rdev, wdev, params->channel,
				    params->channel_fixed
				    ? CHAN_MODE_SHARED
				    : CHAN_MODE_EXCLUSIVE);
	if (err) {
		wdev->connect_keys = NULL;
		return err;
	}

	err = rdev->ops->join_ibss(&rdev->wiphy, dev, params);
	if (err) {
		wdev->connect_keys = NULL;
		wdev->sme_state = CFG80211_SME_IDLE;
		return err;
	}

	memcpy(wdev->ssid, params->ssid, params->ssid_len);
	wdev->ssid_len = params->ssid_len;

	return 0;
}

int cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
		       struct net_device *dev,
		       struct cfg80211_ibss_params *params,
		       struct cfg80211_cached_keys *connkeys)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	int err;

	mutex_lock(&rdev->devlist_mtx);
	wdev_lock(wdev);
	err = __cfg80211_join_ibss(rdev, dev, params, connkeys);
	wdev_unlock(wdev);
	mutex_unlock(&rdev->devlist_mtx);

	return err;
}

static void __cfg80211_clear_ibss(struct net_device *dev, bool nowext)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	int i;

	ASSERT_WDEV_LOCK(wdev);

	kfree(wdev->connect_keys);
	wdev->connect_keys = NULL;

	/*
	 * Delete all the keys ... pairwise keys can't really
	 * exist any more anyway, but default keys might.
	 */
	if (rdev->ops->del_key)
		for (i = 0; i < 6; i++)
			rdev->ops->del_key(wdev->wiphy, dev, i, false, NULL);

	if (wdev->current_bss) {
		cfg80211_unhold_bss(wdev->current_bss);
		cfg80211_put_bss(&wdev->current_bss->pub);
	}

	wdev->current_bss = NULL;
	wdev->sme_state = CFG80211_SME_IDLE;
	wdev->ssid_len = 0;
#ifdef CONFIG_CFG80211_WEXT
	if (!nowext)
		wdev->wext.ibss.ssid_len = 0;
#endif
}

void cfg80211_clear_ibss(struct net_device *dev, bool nowext)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;

	wdev_lock(wdev);
	__cfg80211_clear_ibss(dev, nowext);
	wdev_unlock(wdev);
}

int __cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
			  struct net_device *dev, bool nowext)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	int err;

	ASSERT_WDEV_LOCK(wdev);

	if (!wdev->ssid_len)
		return -ENOLINK;

	err = rdev->ops->leave_ibss(&rdev->wiphy, dev);

	if (err)
		return err;

	__cfg80211_clear_ibss(dev, nowext);

	return 0;
}

int cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
			struct net_device *dev, bool nowext)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	int err;

	wdev_lock(wdev);
	err = __cfg80211_leave_ibss(rdev, dev, nowext);
	wdev_unlock(wdev);

	return err;
}

#ifdef CONFIG_CFG80211_WEXT
int cfg80211_ibss_wext_join(struct cfg80211_registered_device *rdev,
			    struct wireless_dev *wdev)
{
	struct cfg80211_cached_keys *ck = NULL;
	enum ieee80211_band band;
	int i, err;

	ASSERT_WDEV_LOCK(wdev);

	if (!wdev->wext.ibss.beacon_interval)
		wdev->wext.ibss.beacon_interval = 100;

	/* try to find an IBSS channel if none requested ... */
	if (!wdev->wext.ibss.channel) {
		for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
			struct ieee80211_supported_band *sband;
			struct ieee80211_channel *chan;

			sband = rdev->wiphy.bands[band];
			if (!sband)
				continue;

			for (i = 0; i < sband->n_channels; i++) {
				chan = &sband->channels[i];
				if (chan->flags & IEEE80211_CHAN_NO_IBSS)
					continue;
				if (chan->flags & IEEE80211_CHAN_DISABLED)
					continue;
				wdev->wext.ibss.channel = chan;
				break;
			}

			if (wdev->wext.ibss.channel)
				break;
		}

		if (!wdev->wext.ibss.channel)
			return -EINVAL;
	}

	/* don't join -- SSID is not there */
	if (!wdev->wext.ibss.ssid_len)
		return 0;

	if (!netif_running(wdev->netdev))
		return 0;

	if (wdev->wext.keys) {
		wdev->wext.keys->def = wdev->wext.default_key;
		wdev->wext.keys->defmgmt = wdev->wext.default_mgmt_key;
	}

	wdev->wext.ibss.privacy = wdev->wext.default_key != -1;

	if (wdev->wext.keys) {
		ck = kmemdup(wdev->wext.keys, sizeof(*ck), GFP_KERNEL);
		if (!ck)
			return -ENOMEM;
		for (i = 0; i < 6; i++)
			ck->params[i].key = ck->data[i];
	}
	err = __cfg80211_join_ibss(rdev, wdev->netdev,
				   &wdev->wext.ibss, ck);
	if (err)
		kfree(ck);

	return err;
}

int cfg80211_ibss_wext_siwfreq(struct net_device *dev,
			       struct iw_request_info *info,
			       struct iw_freq *wextfreq, char *extra)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	struct ieee80211_channel *chan = NULL;
	int err, freq;

	/* call only for ibss! */
	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
		return -EINVAL;

	if (!rdev->ops->join_ibss)
		return -EOPNOTSUPP;

	freq = cfg80211_wext_freq(wdev->wiphy, wextfreq);
	if (freq < 0)
		return freq;

	if (freq) {
		chan = ieee80211_get_channel(wdev->wiphy, freq);
		if (!chan)
			return -EINVAL;
		if (chan->flags & IEEE80211_CHAN_NO_IBSS ||
		    chan->flags & IEEE80211_CHAN_DISABLED)
			return -EINVAL;
	}

	if (wdev->wext.ibss.channel == chan)
		return 0;

	wdev_lock(wdev);
	err = 0;
	if (wdev->ssid_len)
		err = __cfg80211_leave_ibss(rdev, dev, true);
	wdev_unlock(wdev);

	if (err)
		return err;

	if (chan) {
		wdev->wext.ibss.channel = chan;
		wdev->wext.ibss.channel_fixed = true;
	} else {
		/* cfg80211_ibss_wext_join will pick one if needed */
		wdev->wext.ibss.channel_fixed = false;
	}

	mutex_lock(&rdev->devlist_mtx);
	wdev_lock(wdev);
	err = cfg80211_ibss_wext_join(rdev, wdev);
	wdev_unlock(wdev);
	mutex_unlock(&rdev->devlist_mtx);

	return err;
}

int cfg80211_ibss_wext_giwfreq(struct net_device *dev,
			       struct iw_request_info *info,
			       struct iw_freq *freq, char *extra)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct ieee80211_channel *chan = NULL;

	/* call only for ibss! */
	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
		return -EINVAL;

	wdev_lock(wdev);
	if (wdev->current_bss)
		chan = wdev->current_bss->pub.channel;
	else if (wdev->wext.ibss.channel)
		chan = wdev->wext.ibss.channel;
	wdev_unlock(wdev);

	if (chan) {
		freq->m = chan->center_freq;
		freq->e = 6;
		return 0;
	}

	/* no channel if not joining */
	return -EINVAL;
}

int cfg80211_ibss_wext_siwessid(struct net_device *dev,
				struct iw_request_info *info,
				struct iw_point *data, char *ssid)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	size_t len = data->length;
	int err;

	/* call only for ibss! */
	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
		return -EINVAL;

	if (!rdev->ops->join_ibss)
		return -EOPNOTSUPP;

	wdev_lock(wdev);
	err = 0;
	if (wdev->ssid_len)
		err = __cfg80211_leave_ibss(rdev, dev, true);
	wdev_unlock(wdev);

	if (err)
		return err;

	/* iwconfig uses nul termination in SSID.. */
	if (len > 0 && ssid[len - 1] == '\0')
		len--;

	wdev->wext.ibss.ssid = wdev->ssid;
	memcpy(wdev->wext.ibss.ssid, ssid, len);
	wdev->wext.ibss.ssid_len = len;

	mutex_lock(&rdev->devlist_mtx);
	wdev_lock(wdev);
	err = cfg80211_ibss_wext_join(rdev, wdev);
	wdev_unlock(wdev);
	mutex_unlock(&rdev->devlist_mtx);

	return err;
}

int cfg80211_ibss_wext_giwessid(struct net_device *dev,
				struct iw_request_info *info,
				struct iw_point *data, char *ssid)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;

	/* call only for ibss! */
	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
		return -EINVAL;

	data->flags = 0;

	wdev_lock(wdev);
	if (wdev->ssid_len) {
		data->flags = 1;
		data->length = wdev->ssid_len;
		memcpy(ssid, wdev->ssid, data->length);
	} else if (wdev->wext.ibss.ssid && wdev->wext.ibss.ssid_len) {
		data->flags = 1;
		data->length = wdev->wext.ibss.ssid_len;
		memcpy(ssid, wdev->wext.ibss.ssid, data->length);
	}
	wdev_unlock(wdev);

	return 0;
}

int cfg80211_ibss_wext_siwap(struct net_device *dev,
			     struct iw_request_info *info,
			     struct sockaddr *ap_addr, char *extra)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	u8 *bssid = ap_addr->sa_data;
	int err;

	/* call only for ibss! */
	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
		return -EINVAL;

	if (!rdev->ops->join_ibss)
		return -EOPNOTSUPP;

	if (ap_addr->sa_family != ARPHRD_ETHER)
		return -EINVAL;

	/* automatic mode */
	if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid))
		bssid = NULL;

	/* both automatic */
	if (!bssid && !wdev->wext.ibss.bssid)
		return 0;

	/* fixed already - and no change */
	if (wdev->wext.ibss.bssid && bssid &&
	    ether_addr_equal(bssid, wdev->wext.ibss.bssid))
		return 0;

	wdev_lock(wdev);
	err = 0;
	if (wdev->ssid_len)
		err = __cfg80211_leave_ibss(rdev, dev, true);
	wdev_unlock(wdev);

	if (err)
		return err;

	if (bssid) {
		memcpy(wdev->wext.bssid, bssid, ETH_ALEN);
		wdev->wext.ibss.bssid = wdev->wext.bssid;
	} else
		wdev->wext.ibss.bssid = NULL;

	mutex_lock(&rdev->devlist_mtx);
	wdev_lock(wdev);
	err = cfg80211_ibss_wext_join(rdev, wdev);
	wdev_unlock(wdev);
	mutex_unlock(&rdev->devlist_mtx);

	return err;
}

int cfg80211_ibss_wext_giwap(struct net_device *dev,
			     struct iw_request_info *info,
			     struct sockaddr *ap_addr, char *extra)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;

	/* call only for ibss! */
	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
		return -EINVAL;

	ap_addr->sa_family = ARPHRD_ETHER;

	wdev_lock(wdev);
	if (wdev->current_bss)
		memcpy(ap_addr->sa_data, wdev->current_bss->pub.bssid, ETH_ALEN);
	else if (wdev->wext.ibss.bssid)
		memcpy(ap_addr->sa_data, wdev->wext.ibss.bssid, ETH_ALEN);
	else
		memset(ap_addr->sa_data, 0, ETH_ALEN);

	wdev_unlock(wdev);

	return 0;
}
#endif
Commit	Line	Data
04a773ad JB	1	/*
	2	* Some IBSS support code for cfg80211.
	3	*
	4	* Copyright 2009 Johannes Berg <johannes@sipsolutions.net>
	5	*/
	6
	7	#include <linux/etherdevice.h>
	8	#include <linux/if_arp.h>
5a0e3ad6	9	#include <linux/slab.h>
bc3b2d7f	10	#include <linux/export.h>
04a773ad	11	#include <net/cfg80211.h>
0e82ffe3	12	#include "wext-compat.h"
04a773ad JB	13	#include "nl80211.h"
	14
	15
667503dd	16	void __cfg80211_ibss_joined(struct net_device dev, const u8 bssid)
04a773ad JB	17	{
	18	struct wireless_dev *wdev = dev->ieee80211_ptr;
	19	struct cfg80211_bss *bss;
3d23e349	20	#ifdef CONFIG_CFG80211_WEXT
04a773ad JB	21	union iwreq_data wrqu;
	22	#endif
	23
	24	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	25	return;
	26
f7969969	27	if (!wdev->ssid_len)
04a773ad JB	28	return;
04a773ad JB	29
04a773ad JB	30	bss = cfg80211_get_bss(wdev->wiphy, NULL, bssid,
	31	wdev->ssid, wdev->ssid_len,
	32	WLAN_CAPABILITY_IBSS, WLAN_CAPABILITY_IBSS);
	33
	34	if (WARN_ON(!bss))
	35	return;
	36
	37	if (wdev->current_bss) {
	38	cfg80211_unhold_bss(wdev->current_bss);
19957bb3	39	cfg80211_put_bss(&wdev->current_bss->pub);
04a773ad JB	40	}
04a773ad JB	41
19957bb3 JB	42	cfg80211_hold_bss(bss_from_pub(bss));
19957bb3 JB	43	wdev->current_bss = bss_from_pub(bss);
04a773ad	44
28f33366	45	wdev->sme_state = CFG80211_SME_CONNECTED;
fffd0934 JB	46	cfg80211_upload_connect_keys(wdev);
fffd0934 JB	47
667503dd JB	48	nl80211_send_ibss_bssid(wiphy_to_dev(wdev->wiphy), dev, bssid,
667503dd JB	49	GFP_KERNEL);
3d23e349	50	#ifdef CONFIG_CFG80211_WEXT
04a773ad JB	51	memset(&wrqu, 0, sizeof(wrqu));
	52	memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN);
	53	wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
	54	#endif
	55	}
667503dd JB	56
	57	void cfg80211_ibss_joined(struct net_device dev, const u8 bssid, gfp_t gfp)
	58	{
	59	struct wireless_dev *wdev = dev->ieee80211_ptr;
	60	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	61	struct cfg80211_event *ev;
	62	unsigned long flags;
	63
28f33366	64	CFG80211_DEV_WARN_ON(wdev->sme_state != CFG80211_SME_CONNECTING);
f7969969	65
667503dd JB	66	ev = kzalloc(sizeof(*ev), gfp);
	67	if (!ev)
	68	return;
	69
	70	ev->type = EVENT_IBSS_JOINED;
	71	memcpy(ev->cr.bssid, bssid, ETH_ALEN);
	72
	73	spin_lock_irqsave(&wdev->event_lock, flags);
	74	list_add_tail(&ev->list, &wdev->event_list);
	75	spin_unlock_irqrestore(&wdev->event_lock, flags);
e60d7443	76	queue_work(cfg80211_wq, &rdev->event_work);
667503dd	77	}
04a773ad JB	78	EXPORT_SYMBOL(cfg80211_ibss_joined);
04a773ad JB	79
667503dd JB	80	int __cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
667503dd JB	81	struct net_device *dev,
fffd0934 JB	82	struct cfg80211_ibss_params *params,
fffd0934 JB	83	struct cfg80211_cached_keys *connkeys)
04a773ad JB	84	{
	85	struct wireless_dev *wdev = dev->ieee80211_ptr;
	86	int err;
	87
667503dd JB	88	ASSERT_WDEV_LOCK(wdev);
667503dd JB	89
04a773ad JB	90	if (wdev->ssid_len)
	91	return -EALREADY;
	92
93b05238 JB	93	if (!params->basic_rates) {
	94	/*
	95	* If no rates were explicitly configured,
	96	* use the mandatory rate set for 11b or
	97	* 11a for maximum compatibility.
	98	*/
	99	struct ieee80211_supported_band *sband =
	100	rdev->wiphy.bands[params->channel->band];
	101	int j;
	102	u32 flag = params->channel->band == IEEE80211_BAND_5GHZ ?
	103	IEEE80211_RATE_MANDATORY_A :
	104	IEEE80211_RATE_MANDATORY_B;
	105
	106	for (j = 0; j < sband->n_bitrates; j++) {
	107	if (sband->bitrates[j].flags & flag)
	108	params->basic_rates \|= BIT(j);
	109	}
	110	}
	111
fffd0934 JB	112	if (WARN_ON(wdev->connect_keys))
	113	kfree(wdev->connect_keys);
	114	wdev->connect_keys = connkeys;
	115
c30a3d38	116	wdev->ibss_fixed = params->channel_fixed;
3d23e349	117	#ifdef CONFIG_CFG80211_WEXT
cbe8fa9c	118	wdev->wext.ibss.channel = params->channel;
04a773ad	119	#endif
28f33366	120	wdev->sme_state = CFG80211_SME_CONNECTING;
e4e32459 MK	121
	122	err = cfg80211_can_use_chan(rdev, wdev, params->channel,
	123	params->channel_fixed
	124	? CHAN_MODE_SHARED
	125	: CHAN_MODE_EXCLUSIVE);
	126	if (err) {
	127	wdev->connect_keys = NULL;
	128	return err;
	129	}
	130
04a773ad	131	err = rdev->ops->join_ibss(&rdev->wiphy, dev, params);
fffd0934 JB	132	if (err) {
fffd0934 JB	133	wdev->connect_keys = NULL;
28f33366	134	wdev->sme_state = CFG80211_SME_IDLE;
04a773ad	135	return err;
fffd0934	136	}
04a773ad JB	137
	138	memcpy(wdev->ssid, params->ssid, params->ssid_len);
	139	wdev->ssid_len = params->ssid_len;
	140
	141	return 0;
	142	}
	143
667503dd JB	144	int cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
667503dd JB	145	struct net_device *dev,
fffd0934 JB	146	struct cfg80211_ibss_params *params,
fffd0934 JB	147	struct cfg80211_cached_keys *connkeys)
667503dd JB	148	{
	149	struct wireless_dev *wdev = dev->ieee80211_ptr;
	150	int err;
	151
59bbb6f7	152	mutex_lock(&rdev->devlist_mtx);
667503dd	153	wdev_lock(wdev);
fffd0934	154	err = __cfg80211_join_ibss(rdev, dev, params, connkeys);
667503dd	155	wdev_unlock(wdev);
59bbb6f7	156	mutex_unlock(&rdev->devlist_mtx);
667503dd JB	157
	158	return err;
	159	}
	160
	161	static void __cfg80211_clear_ibss(struct net_device *dev, bool nowext)
04a773ad JB	162	{
04a773ad JB	163	struct wireless_dev *wdev = dev->ieee80211_ptr;
fffd0934 JB	164	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
fffd0934 JB	165	int i;
04a773ad	166
667503dd JB	167	ASSERT_WDEV_LOCK(wdev);
667503dd JB	168
fffd0934 JB	169	kfree(wdev->connect_keys);
	170	wdev->connect_keys = NULL;
	171
	172	/*
	173	* Delete all the keys ... pairwise keys can't really
	174	* exist any more anyway, but default keys might.
	175	*/
	176	if (rdev->ops->del_key)
	177	for (i = 0; i < 6; i++)
e31b8213	178	rdev->ops->del_key(wdev->wiphy, dev, i, false, NULL);
fffd0934	179
04a773ad JB	180	if (wdev->current_bss) {
04a773ad JB	181	cfg80211_unhold_bss(wdev->current_bss);
19957bb3	182	cfg80211_put_bss(&wdev->current_bss->pub);
04a773ad JB	183	}
	184
	185	wdev->current_bss = NULL;
28f33366	186	wdev->sme_state = CFG80211_SME_IDLE;
04a773ad	187	wdev->ssid_len = 0;
3d23e349	188	#ifdef CONFIG_CFG80211_WEXT
9d308429	189	if (!nowext)
cbe8fa9c	190	wdev->wext.ibss.ssid_len = 0;
9d308429	191	#endif
04a773ad JB	192	}
04a773ad JB	193
667503dd JB	194	void cfg80211_clear_ibss(struct net_device *dev, bool nowext)
	195	{
	196	struct wireless_dev *wdev = dev->ieee80211_ptr;
	197
	198	wdev_lock(wdev);
	199	__cfg80211_clear_ibss(dev, nowext);
	200	wdev_unlock(wdev);
	201	}
	202
98d3a7ca JB	203	int __cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
98d3a7ca JB	204	struct net_device *dev, bool nowext)
04a773ad	205	{
78485475	206	struct wireless_dev *wdev = dev->ieee80211_ptr;
04a773ad JB	207	int err;
04a773ad JB	208
667503dd JB	209	ASSERT_WDEV_LOCK(wdev);
667503dd JB	210
78485475 JB	211	if (!wdev->ssid_len)
	212	return -ENOLINK;
	213
04a773ad JB	214	err = rdev->ops->leave_ibss(&rdev->wiphy, dev);
	215
	216	if (err)
	217	return err;
	218
667503dd	219	__cfg80211_clear_ibss(dev, nowext);
04a773ad JB	220
	221	return 0;
	222	}
	223
667503dd JB	224	int cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
	225	struct net_device *dev, bool nowext)
	226	{
	227	struct wireless_dev *wdev = dev->ieee80211_ptr;
	228	int err;
	229
	230	wdev_lock(wdev);
	231	err = __cfg80211_leave_ibss(rdev, dev, nowext);
	232	wdev_unlock(wdev);
	233
	234	return err;
	235	}
	236
3d23e349	237	#ifdef CONFIG_CFG80211_WEXT
fffd0934 JB	238	int cfg80211_ibss_wext_join(struct cfg80211_registered_device *rdev,
fffd0934 JB	239	struct wireless_dev *wdev)
04a773ad	240	{
fffd0934	241	struct cfg80211_cached_keys *ck = NULL;
04a773ad	242	enum ieee80211_band band;
fffd0934 JB	243	int i, err;
	244
	245	ASSERT_WDEV_LOCK(wdev);
04a773ad	246
cbe8fa9c JB	247	if (!wdev->wext.ibss.beacon_interval)
cbe8fa9c JB	248	wdev->wext.ibss.beacon_interval = 100;
8e30bc55	249
04a773ad	250	/* try to find an IBSS channel if none requested ... */
cbe8fa9c	251	if (!wdev->wext.ibss.channel) {
04a773ad JB	252	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
	253	struct ieee80211_supported_band *sband;
	254	struct ieee80211_channel *chan;
	255
	256	sband = rdev->wiphy.bands[band];
	257	if (!sband)
	258	continue;
	259
	260	for (i = 0; i < sband->n_channels; i++) {
	261	chan = &sband->channels[i];
	262	if (chan->flags & IEEE80211_CHAN_NO_IBSS)
	263	continue;
	264	if (chan->flags & IEEE80211_CHAN_DISABLED)
	265	continue;
cbe8fa9c	266	wdev->wext.ibss.channel = chan;
04a773ad JB	267	break;
	268	}
	269
cbe8fa9c	270	if (wdev->wext.ibss.channel)
04a773ad JB	271	break;
	272	}
	273
cbe8fa9c	274	if (!wdev->wext.ibss.channel)
04a773ad JB	275	return -EINVAL;
	276	}
	277
	278	/* don't join -- SSID is not there */
cbe8fa9c	279	if (!wdev->wext.ibss.ssid_len)
04a773ad JB	280	return 0;
	281
	282	if (!netif_running(wdev->netdev))
	283	return 0;
	284
3be61a38	285	if (wdev->wext.keys) {
fffd0934	286	wdev->wext.keys->def = wdev->wext.default_key;
3be61a38 JB	287	wdev->wext.keys->defmgmt = wdev->wext.default_mgmt_key;
3be61a38 JB	288	}
fffd0934 JB	289
	290	wdev->wext.ibss.privacy = wdev->wext.default_key != -1;
	291
	292	if (wdev->wext.keys) {
	293	ck = kmemdup(wdev->wext.keys, sizeof(*ck), GFP_KERNEL);
	294	if (!ck)
	295	return -ENOMEM;
	296	for (i = 0; i < 6; i++)
	297	ck->params[i].key = ck->data[i];
	298	}
	299	err = __cfg80211_join_ibss(rdev, wdev->netdev,
	300	&wdev->wext.ibss, ck);
	301	if (err)
	302	kfree(ck);
	303
	304	return err;
04a773ad JB	305	}
	306
	307	int cfg80211_ibss_wext_siwfreq(struct net_device *dev,
	308	struct iw_request_info *info,
59bbb6f7	309	struct iw_freq wextfreq, char extra)
04a773ad JB	310	{
04a773ad JB	311	struct wireless_dev *wdev = dev->ieee80211_ptr;
59bbb6f7 JB	312	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	313	struct ieee80211_channel *chan = NULL;
	314	int err, freq;
04a773ad JB	315
	316	/* call only for ibss! */
	317	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	318	return -EINVAL;
	319
59bbb6f7	320	if (!rdev->ops->join_ibss)
04a773ad JB	321	return -EOPNOTSUPP;
04a773ad JB	322
59bbb6f7 JB	323	freq = cfg80211_wext_freq(wdev->wiphy, wextfreq);
	324	if (freq < 0)
	325	return freq;
04a773ad	326
59bbb6f7 JB	327	if (freq) {
	328	chan = ieee80211_get_channel(wdev->wiphy, freq);
	329	if (!chan)
	330	return -EINVAL;
	331	if (chan->flags & IEEE80211_CHAN_NO_IBSS \|\|
	332	chan->flags & IEEE80211_CHAN_DISABLED)
	333	return -EINVAL;
	334	}
04a773ad	335
cbe8fa9c	336	if (wdev->wext.ibss.channel == chan)
04a773ad JB	337	return 0;
04a773ad JB	338
667503dd JB	339	wdev_lock(wdev);
	340	err = 0;
	341	if (wdev->ssid_len)
59bbb6f7	342	err = __cfg80211_leave_ibss(rdev, dev, true);
667503dd JB	343	wdev_unlock(wdev);
	344
	345	if (err)
	346	return err;
04a773ad JB	347
04a773ad JB	348	if (chan) {
cbe8fa9c JB	349	wdev->wext.ibss.channel = chan;
cbe8fa9c JB	350	wdev->wext.ibss.channel_fixed = true;
04a773ad JB	351	} else {
04a773ad JB	352	/* cfg80211_ibss_wext_join will pick one if needed */
cbe8fa9c	353	wdev->wext.ibss.channel_fixed = false;
04a773ad JB	354	}
04a773ad JB	355
59bbb6f7	356	mutex_lock(&rdev->devlist_mtx);
fffd0934	357	wdev_lock(wdev);
59bbb6f7	358	err = cfg80211_ibss_wext_join(rdev, wdev);
fffd0934	359	wdev_unlock(wdev);
59bbb6f7	360	mutex_unlock(&rdev->devlist_mtx);
fffd0934 JB	361
fffd0934 JB	362	return err;
04a773ad	363	}
04a773ad JB	364
	365	int cfg80211_ibss_wext_giwfreq(struct net_device *dev,
	366	struct iw_request_info *info,
	367	struct iw_freq freq, char extra)
	368	{
	369	struct wireless_dev *wdev = dev->ieee80211_ptr;
	370	struct ieee80211_channel *chan = NULL;
	371
	372	/* call only for ibss! */
	373	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	374	return -EINVAL;
	375
667503dd	376	wdev_lock(wdev);
04a773ad	377	if (wdev->current_bss)
19957bb3	378	chan = wdev->current_bss->pub.channel;
cbe8fa9c JB	379	else if (wdev->wext.ibss.channel)
cbe8fa9c JB	380	chan = wdev->wext.ibss.channel;
667503dd	381	wdev_unlock(wdev);
04a773ad JB	382
	383	if (chan) {
	384	freq->m = chan->center_freq;
	385	freq->e = 6;
	386	return 0;
	387	}
	388
	389	/* no channel if not joining */
	390	return -EINVAL;
	391	}
04a773ad JB	392
	393	int cfg80211_ibss_wext_siwessid(struct net_device *dev,
	394	struct iw_request_info *info,
	395	struct iw_point data, char ssid)
	396	{
	397	struct wireless_dev *wdev = dev->ieee80211_ptr;
59bbb6f7	398	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
04a773ad JB	399	size_t len = data->length;
	400	int err;
	401
	402	/* call only for ibss! */
	403	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	404	return -EINVAL;
	405
59bbb6f7	406	if (!rdev->ops->join_ibss)
04a773ad JB	407	return -EOPNOTSUPP;
04a773ad JB	408
667503dd JB	409	wdev_lock(wdev);
	410	err = 0;
	411	if (wdev->ssid_len)
59bbb6f7	412	err = __cfg80211_leave_ibss(rdev, dev, true);
667503dd JB	413	wdev_unlock(wdev);
	414
	415	if (err)
	416	return err;
04a773ad JB	417
	418	/* iwconfig uses nul termination in SSID.. */
	419	if (len > 0 && ssid[len - 1] == '\0')
	420	len--;
	421
cbe8fa9c JB	422	wdev->wext.ibss.ssid = wdev->ssid;
	423	memcpy(wdev->wext.ibss.ssid, ssid, len);
	424	wdev->wext.ibss.ssid_len = len;
04a773ad	425
59bbb6f7	426	mutex_lock(&rdev->devlist_mtx);
fffd0934	427	wdev_lock(wdev);
59bbb6f7	428	err = cfg80211_ibss_wext_join(rdev, wdev);
fffd0934	429	wdev_unlock(wdev);
59bbb6f7	430	mutex_unlock(&rdev->devlist_mtx);
fffd0934 JB	431
fffd0934 JB	432	return err;
04a773ad	433	}
04a773ad JB	434
	435	int cfg80211_ibss_wext_giwessid(struct net_device *dev,
	436	struct iw_request_info *info,
	437	struct iw_point data, char ssid)
	438	{
	439	struct wireless_dev *wdev = dev->ieee80211_ptr;
	440
	441	/* call only for ibss! */
	442	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	443	return -EINVAL;
	444
	445	data->flags = 0;
	446
667503dd	447	wdev_lock(wdev);
04a773ad JB	448	if (wdev->ssid_len) {
	449	data->flags = 1;
	450	data->length = wdev->ssid_len;
	451	memcpy(ssid, wdev->ssid, data->length);
cbe8fa9c	452	} else if (wdev->wext.ibss.ssid && wdev->wext.ibss.ssid_len) {
04a773ad	453	data->flags = 1;
cbe8fa9c JB	454	data->length = wdev->wext.ibss.ssid_len;
cbe8fa9c JB	455	memcpy(ssid, wdev->wext.ibss.ssid, data->length);
04a773ad	456	}
667503dd	457	wdev_unlock(wdev);
04a773ad JB	458
	459	return 0;
	460	}
04a773ad JB	461
	462	int cfg80211_ibss_wext_siwap(struct net_device *dev,
	463	struct iw_request_info *info,
	464	struct sockaddr ap_addr, char extra)
	465	{
	466	struct wireless_dev *wdev = dev->ieee80211_ptr;
59bbb6f7	467	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
04a773ad JB	468	u8 *bssid = ap_addr->sa_data;
	469	int err;
	470
	471	/* call only for ibss! */
	472	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	473	return -EINVAL;
	474
59bbb6f7	475	if (!rdev->ops->join_ibss)
04a773ad JB	476	return -EOPNOTSUPP;
	477
	478	if (ap_addr->sa_family != ARPHRD_ETHER)
	479	return -EINVAL;
	480
	481	/* automatic mode */
	482	if (is_zero_ether_addr(bssid) \|\| is_broadcast_ether_addr(bssid))
	483	bssid = NULL;
	484
	485	/* both automatic */
cbe8fa9c	486	if (!bssid && !wdev->wext.ibss.bssid)
04a773ad JB	487	return 0;
	488
	489	/* fixed already - and no change */
cbe8fa9c	490	if (wdev->wext.ibss.bssid && bssid &&
ac422d3c	491	ether_addr_equal(bssid, wdev->wext.ibss.bssid))
04a773ad JB	492	return 0;
04a773ad JB	493
667503dd JB	494	wdev_lock(wdev);
	495	err = 0;
	496	if (wdev->ssid_len)
59bbb6f7	497	err = __cfg80211_leave_ibss(rdev, dev, true);
667503dd JB	498	wdev_unlock(wdev);
	499
	500	if (err)
	501	return err;
04a773ad JB	502
04a773ad JB	503	if (bssid) {
cbe8fa9c JB	504	memcpy(wdev->wext.bssid, bssid, ETH_ALEN);
cbe8fa9c JB	505	wdev->wext.ibss.bssid = wdev->wext.bssid;
04a773ad	506	} else
cbe8fa9c	507	wdev->wext.ibss.bssid = NULL;
04a773ad	508
59bbb6f7	509	mutex_lock(&rdev->devlist_mtx);
fffd0934	510	wdev_lock(wdev);
59bbb6f7	511	err = cfg80211_ibss_wext_join(rdev, wdev);
fffd0934	512	wdev_unlock(wdev);
59bbb6f7	513	mutex_unlock(&rdev->devlist_mtx);
fffd0934 JB	514
fffd0934 JB	515	return err;
04a773ad	516	}
04a773ad JB	517
	518	int cfg80211_ibss_wext_giwap(struct net_device *dev,
	519	struct iw_request_info *info,
	520	struct sockaddr ap_addr, char extra)
	521	{
	522	struct wireless_dev *wdev = dev->ieee80211_ptr;
	523
	524	/* call only for ibss! */
	525	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	526	return -EINVAL;
	527
	528	ap_addr->sa_family = ARPHRD_ETHER;
	529
667503dd	530	wdev_lock(wdev);
7ebbe6bd	531	if (wdev->current_bss)
19957bb3	532	memcpy(ap_addr->sa_data, wdev->current_bss->pub.bssid, ETH_ALEN);
80e5b06a	533	else if (wdev->wext.ibss.bssid)
cbe8fa9c	534	memcpy(ap_addr->sa_data, wdev->wext.ibss.bssid, ETH_ALEN);
80e5b06a ZY	535	else
	536	memset(ap_addr->sa_data, 0, ETH_ALEN);
	537
667503dd JB	538	wdev_unlock(wdev);
667503dd JB	539
04a773ad JB	540	return 0;
04a773ad JB	541	}
04a773ad	542	#endif