[linux-2.6-block.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"
#include "rdev-ops.h"


void __cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid,
			    struct ieee80211_channel *channel)
{
	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, channel, bssid, NULL, 0,
			       IEEE80211_BSS_TYPE_IBSS, IEEE80211_PRIVACY_ANY);

	if (WARN_ON(!bss))
		return;

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

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

	cfg80211_upload_connect_keys(wdev);

	nl80211_send_ibss_bssid(wiphy_to_rdev(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,
			  struct ieee80211_channel *channel, gfp_t gfp)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
	struct cfg80211_event *ev;
	unsigned long flags;

	trace_cfg80211_ibss_joined(dev, bssid, channel);

	if (WARN_ON(!channel))
		return;

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

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

	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);

static 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->chandef.chan->band];
		int j;
		u32 flag = params->chandef.chan->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))
		kzfree(wdev->connect_keys);
	wdev->connect_keys = connkeys;

	wdev->ibss_fixed = params->channel_fixed;
	wdev->ibss_dfs_possible = params->userspace_handles_dfs;
	wdev->chandef = params->chandef;
#ifdef CONFIG_CFG80211_WEXT
	wdev->wext.ibss.chandef = params->chandef;
#endif
	err = rdev_join_ibss(rdev, dev, params);
	if (err) {
		wdev->connect_keys = NULL;
		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;

	ASSERT_RTNL();

	wdev_lock(wdev);
	err = __cfg80211_join_ibss(rdev, dev, params, connkeys);
	wdev_unlock(wdev);

	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_rdev(wdev->wiphy);
	int i;

	ASSERT_WDEV_LOCK(wdev);

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

	rdev_set_qos_map(rdev, dev, 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_del_key(rdev, dev, i, false, NULL);

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

	wdev->current_bss = NULL;
	wdev->ssid_len = 0;
	memset(&wdev->chandef, 0, sizeof(wdev->chandef));
#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_leave_ibss(rdev, 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.chandef.chan) {
		struct ieee80211_channel *new_chan = NULL;

		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_IR)
					continue;
				if (chan->flags & IEEE80211_CHAN_DISABLED)
					continue;
				new_chan = chan;
				break;
			}

			if (new_chan)
				break;
		}

		if (!new_chan)
			return -EINVAL;

		cfg80211_chandef_create(&wdev->wext.ibss.chandef, new_chan,
					NL80211_CHAN_NO_HT);
	}

	/* 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_rdev(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(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_IR ||
		    chan->flags & IEEE80211_CHAN_DISABLED)
			return -EINVAL;
	}

	if (wdev->wext.ibss.chandef.chan == 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) {
		cfg80211_chandef_create(&wdev->wext.ibss.chandef, chan,
					NL80211_CHAN_NO_HT);
		wdev->wext.ibss.channel_fixed = true;
	} else {
		/* cfg80211_ibss_wext_join will pick one if needed */
		wdev->wext.ibss.channel_fixed = false;
	}

	wdev_lock(wdev);
	err = cfg80211_ibss_wext_join(rdev, wdev);
	wdev_unlock(wdev);

	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.chandef.chan)
		chan = wdev->wext.ibss.chandef.chan;
	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_rdev(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--;

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

	wdev_lock(wdev);
	err = cfg80211_ibss_wext_join(rdev, wdev);
	wdev_unlock(wdev);

	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_rdev(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;

	if (bssid && !is_valid_ether_addr(bssid))
		return -EINVAL;

	/* 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;

	wdev_lock(wdev);
	err = cfg80211_ibss_wext_join(rdev, wdev);
	wdev_unlock(wdev);

	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
		eth_zero_addr(ap_addr->sa_data);

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