[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"
#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,
			       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->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_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,
			  struct ieee80211_channel *channel, 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;

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

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;
	struct ieee80211_channel *check_chan;
	u8 radar_detect_width = 0;
	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))
		kfree(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
	check_chan = params->chandef.chan;
	if (params->userspace_handles_dfs) {
		/* Check for radar even if the current channel is not
		 * a radar channel - it might decide to change to DFS
		 * channel later.
		 */
		radar_detect_width = BIT(params->chandef.width);
	}

	err = cfg80211_can_use_iftype_chan(rdev, wdev, wdev->iftype,
					   check_chan,
					   (params->channel_fixed &&
					    !radar_detect_width)
					   ? CHAN_MODE_SHARED
					   : CHAN_MODE_EXCLUSIVE,
					   radar_detect_width);

	if (err) {
		wdev->connect_keys = NULL;
		return err;
	}

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

	ASSERT_WDEV_LOCK(wdev);

	kfree(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_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_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_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;

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

	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
		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	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,
04a773ad JB	33	WLAN_CAPABILITY_IBSS, WLAN_CAPABILITY_IBSS);
	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
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	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	{
	60	struct wireless_dev *wdev = dev->ieee80211_ptr;
	61	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	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
667503dd JB	85	int __cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
667503dd JB	86	struct net_device *dev,
fffd0934 JB	87	struct cfg80211_ibss_params *params,
fffd0934 JB	88	struct cfg80211_cached_keys *connkeys)
04a773ad JB	89	{
04a773ad JB	90	struct wireless_dev *wdev = dev->ieee80211_ptr;
5336fa88 SW	91	struct ieee80211_channel *check_chan;
5336fa88 SW	92	u8 radar_detect_width = 0;
04a773ad JB	93	int err;
04a773ad JB	94
667503dd JB	95	ASSERT_WDEV_LOCK(wdev);
667503dd JB	96
04a773ad JB	97	if (wdev->ssid_len)
	98	return -EALREADY;
	99
93b05238 JB	100	if (!params->basic_rates) {
	101	/*
	102	* If no rates were explicitly configured,
	103	* use the mandatory rate set for 11b or
	104	* 11a for maximum compatibility.
	105	*/
	106	struct ieee80211_supported_band *sband =
683b6d3b	107	rdev->wiphy.bands[params->chandef.chan->band];
93b05238	108	int j;
683b6d3b	109	u32 flag = params->chandef.chan->band == IEEE80211_BAND_5GHZ ?
93b05238 JB	110	IEEE80211_RATE_MANDATORY_A :
	111	IEEE80211_RATE_MANDATORY_B;
	112
	113	for (j = 0; j < sband->n_bitrates; j++) {
	114	if (sband->bitrates[j].flags & flag)
	115	params->basic_rates \|= BIT(j);
	116	}
	117	}
	118
fffd0934 JB	119	if (WARN_ON(wdev->connect_keys))
	120	kfree(wdev->connect_keys);
	121	wdev->connect_keys = connkeys;
	122
c30a3d38	123	wdev->ibss_fixed = params->channel_fixed;
5336fa88	124	wdev->ibss_dfs_possible = params->userspace_handles_dfs;
9e0e2961	125	wdev->chandef = params->chandef;
3d23e349	126	#ifdef CONFIG_CFG80211_WEXT
683b6d3b	127	wdev->wext.ibss.chandef = params->chandef;
04a773ad	128	#endif
5336fa88 SW	129	check_chan = params->chandef.chan;
5336fa88 SW	130	if (params->userspace_handles_dfs) {
7b2106ae LC	131	/* Check for radar even if the current channel is not
	132	* a radar channel - it might decide to change to DFS
	133	* channel later.
5336fa88 SW	134	*/
5336fa88 SW	135	radar_detect_width = BIT(params->chandef.width);
5336fa88 SW	136	}
	137
	138	err = cfg80211_can_use_iftype_chan(rdev, wdev, wdev->iftype,
	139	check_chan,
	140	(params->channel_fixed &&
	141	!radar_detect_width)
	142	? CHAN_MODE_SHARED
	143	: CHAN_MODE_EXCLUSIVE,
	144	radar_detect_width);
e4e32459	145
e4e32459 MK	146	if (err) {
	147	wdev->connect_keys = NULL;
	148	return err;
	149	}
	150
e35e4d28	151	err = rdev_join_ibss(rdev, dev, params);
fffd0934 JB	152	if (err) {
fffd0934 JB	153	wdev->connect_keys = NULL;
04a773ad	154	return err;
fffd0934	155	}
04a773ad JB	156
	157	memcpy(wdev->ssid, params->ssid, params->ssid_len);
	158	wdev->ssid_len = params->ssid_len;
	159
	160	return 0;
	161	}
	162
667503dd JB	163	int cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
667503dd JB	164	struct net_device *dev,
fffd0934 JB	165	struct cfg80211_ibss_params *params,
fffd0934 JB	166	struct cfg80211_cached_keys *connkeys)
667503dd JB	167	{
	168	struct wireless_dev *wdev = dev->ieee80211_ptr;
	169	int err;
	170
5fe231e8 JB	171	ASSERT_RTNL();
5fe231e8 JB	172
667503dd	173	wdev_lock(wdev);
fffd0934	174	err = __cfg80211_join_ibss(rdev, dev, params, connkeys);
667503dd JB	175	wdev_unlock(wdev);
	176
	177	return err;
	178	}
	179
	180	static void __cfg80211_clear_ibss(struct net_device *dev, bool nowext)
04a773ad JB	181	{
04a773ad JB	182	struct wireless_dev *wdev = dev->ieee80211_ptr;
fffd0934 JB	183	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
fffd0934 JB	184	int i;
04a773ad	185
667503dd JB	186	ASSERT_WDEV_LOCK(wdev);
667503dd JB	187
fffd0934 JB	188	kfree(wdev->connect_keys);
	189	wdev->connect_keys = NULL;
	190
fa9ffc74 KP	191	rdev_set_qos_map(rdev, dev, NULL);
fa9ffc74 KP	192
fffd0934 JB	193	/*
	194	* Delete all the keys ... pairwise keys can't really
	195	* exist any more anyway, but default keys might.
	196	*/
	197	if (rdev->ops->del_key)
	198	for (i = 0; i < 6; i++)
e35e4d28	199	rdev_del_key(rdev, dev, i, false, NULL);
fffd0934	200
04a773ad JB	201	if (wdev->current_bss) {
04a773ad JB	202	cfg80211_unhold_bss(wdev->current_bss);
5b112d3d	203	cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
04a773ad JB	204	}
	205
	206	wdev->current_bss = NULL;
	207	wdev->ssid_len = 0;
9e0e2961	208	memset(&wdev->chandef, 0, sizeof(wdev->chandef));
3d23e349	209	#ifdef CONFIG_CFG80211_WEXT
9d308429	210	if (!nowext)
cbe8fa9c	211	wdev->wext.ibss.ssid_len = 0;
9d308429	212	#endif
04a773ad JB	213	}
04a773ad JB	214
667503dd JB	215	void cfg80211_clear_ibss(struct net_device *dev, bool nowext)
	216	{
	217	struct wireless_dev *wdev = dev->ieee80211_ptr;
	218
	219	wdev_lock(wdev);
	220	__cfg80211_clear_ibss(dev, nowext);
	221	wdev_unlock(wdev);
	222	}
	223
98d3a7ca JB	224	int __cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
98d3a7ca JB	225	struct net_device *dev, bool nowext)
04a773ad	226	{
78485475	227	struct wireless_dev *wdev = dev->ieee80211_ptr;
04a773ad JB	228	int err;
04a773ad JB	229
667503dd JB	230	ASSERT_WDEV_LOCK(wdev);
667503dd JB	231
78485475 JB	232	if (!wdev->ssid_len)
	233	return -ENOLINK;
	234
e35e4d28	235	err = rdev_leave_ibss(rdev, dev);
04a773ad JB	236
	237	if (err)
	238	return err;
	239
667503dd	240	__cfg80211_clear_ibss(dev, nowext);
04a773ad JB	241
	242	return 0;
	243	}
	244
667503dd JB	245	int cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
	246	struct net_device *dev, bool nowext)
	247	{
	248	struct wireless_dev *wdev = dev->ieee80211_ptr;
	249	int err;
	250
	251	wdev_lock(wdev);
	252	err = __cfg80211_leave_ibss(rdev, dev, nowext);
	253	wdev_unlock(wdev);
	254
	255	return err;
	256	}
	257
3d23e349	258	#ifdef CONFIG_CFG80211_WEXT
fffd0934 JB	259	int cfg80211_ibss_wext_join(struct cfg80211_registered_device *rdev,
fffd0934 JB	260	struct wireless_dev *wdev)
04a773ad	261	{
fffd0934	262	struct cfg80211_cached_keys *ck = NULL;
04a773ad	263	enum ieee80211_band band;
fffd0934 JB	264	int i, err;
	265
	266	ASSERT_WDEV_LOCK(wdev);
04a773ad	267
cbe8fa9c JB	268	if (!wdev->wext.ibss.beacon_interval)
cbe8fa9c JB	269	wdev->wext.ibss.beacon_interval = 100;
8e30bc55	270
04a773ad	271	/* try to find an IBSS channel if none requested ... */
683b6d3b	272	if (!wdev->wext.ibss.chandef.chan) {
1fe4517c	273	struct ieee80211_channel *new_chan = NULL;
683b6d3b	274
04a773ad JB	275	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
	276	struct ieee80211_supported_band *sband;
	277	struct ieee80211_channel *chan;
	278
	279	sband = rdev->wiphy.bands[band];
	280	if (!sband)
	281	continue;
	282
	283	for (i = 0; i < sband->n_channels; i++) {
	284	chan = &sband->channels[i];
8fe02e16	285	if (chan->flags & IEEE80211_CHAN_NO_IR)
04a773ad JB	286	continue;
	287	if (chan->flags & IEEE80211_CHAN_DISABLED)
	288	continue;
1fe4517c	289	new_chan = chan;
04a773ad JB	290	break;
	291	}
	292
1fe4517c	293	if (new_chan)
04a773ad JB	294	break;
	295	}
	296
1fe4517c	297	if (!new_chan)
04a773ad	298	return -EINVAL;
1fe4517c SW	299
	300	cfg80211_chandef_create(&wdev->wext.ibss.chandef, new_chan,
	301	NL80211_CHAN_NO_HT);
04a773ad JB	302	}
	303
	304	/* don't join -- SSID is not there */
cbe8fa9c	305	if (!wdev->wext.ibss.ssid_len)
04a773ad JB	306	return 0;
	307
	308	if (!netif_running(wdev->netdev))
	309	return 0;
	310
3be61a38	311	if (wdev->wext.keys) {
fffd0934	312	wdev->wext.keys->def = wdev->wext.default_key;
3be61a38 JB	313	wdev->wext.keys->defmgmt = wdev->wext.default_mgmt_key;
3be61a38 JB	314	}
fffd0934 JB	315
	316	wdev->wext.ibss.privacy = wdev->wext.default_key != -1;
	317
	318	if (wdev->wext.keys) {
	319	ck = kmemdup(wdev->wext.keys, sizeof(*ck), GFP_KERNEL);
	320	if (!ck)
	321	return -ENOMEM;
	322	for (i = 0; i < 6; i++)
	323	ck->params[i].key = ck->data[i];
	324	}
	325	err = __cfg80211_join_ibss(rdev, wdev->netdev,
	326	&wdev->wext.ibss, ck);
	327	if (err)
	328	kfree(ck);
	329
	330	return err;
04a773ad JB	331	}
	332
	333	int cfg80211_ibss_wext_siwfreq(struct net_device *dev,
	334	struct iw_request_info *info,
59bbb6f7	335	struct iw_freq wextfreq, char extra)
04a773ad JB	336	{
04a773ad JB	337	struct wireless_dev *wdev = dev->ieee80211_ptr;
59bbb6f7 JB	338	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
	339	struct ieee80211_channel *chan = NULL;
	340	int err, freq;
04a773ad JB	341
	342	/* call only for ibss! */
	343	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	344	return -EINVAL;
	345
59bbb6f7	346	if (!rdev->ops->join_ibss)
04a773ad JB	347	return -EOPNOTSUPP;
04a773ad JB	348
59bbb6f7 JB	349	freq = cfg80211_wext_freq(wdev->wiphy, wextfreq);
	350	if (freq < 0)
	351	return freq;
04a773ad	352
59bbb6f7 JB	353	if (freq) {
	354	chan = ieee80211_get_channel(wdev->wiphy, freq);
	355	if (!chan)
	356	return -EINVAL;
8fe02e16	357	if (chan->flags & IEEE80211_CHAN_NO_IR \|\|
59bbb6f7 JB	358	chan->flags & IEEE80211_CHAN_DISABLED)
	359	return -EINVAL;
	360	}
04a773ad	361
683b6d3b	362	if (wdev->wext.ibss.chandef.chan == chan)
04a773ad JB	363	return 0;
04a773ad JB	364
667503dd JB	365	wdev_lock(wdev);
	366	err = 0;
	367	if (wdev->ssid_len)
59bbb6f7	368	err = __cfg80211_leave_ibss(rdev, dev, true);
667503dd JB	369	wdev_unlock(wdev);
	370
	371	if (err)
	372	return err;
04a773ad JB	373
04a773ad JB	374	if (chan) {
1fe4517c SW	375	cfg80211_chandef_create(&wdev->wext.ibss.chandef, chan,
1fe4517c SW	376	NL80211_CHAN_NO_HT);
cbe8fa9c	377	wdev->wext.ibss.channel_fixed = true;
04a773ad JB	378	} else {
04a773ad JB	379	/* cfg80211_ibss_wext_join will pick one if needed */
cbe8fa9c	380	wdev->wext.ibss.channel_fixed = false;
04a773ad JB	381	}
04a773ad JB	382
fffd0934	383	wdev_lock(wdev);
59bbb6f7	384	err = cfg80211_ibss_wext_join(rdev, wdev);
fffd0934 JB	385	wdev_unlock(wdev);
	386
	387	return err;
04a773ad	388	}
04a773ad JB	389
	390	int cfg80211_ibss_wext_giwfreq(struct net_device *dev,
	391	struct iw_request_info *info,
	392	struct iw_freq freq, char extra)
	393	{
	394	struct wireless_dev *wdev = dev->ieee80211_ptr;
	395	struct ieee80211_channel *chan = NULL;
	396
	397	/* call only for ibss! */
	398	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	399	return -EINVAL;
	400
667503dd	401	wdev_lock(wdev);
04a773ad	402	if (wdev->current_bss)
19957bb3	403	chan = wdev->current_bss->pub.channel;
683b6d3b JB	404	else if (wdev->wext.ibss.chandef.chan)
683b6d3b JB	405	chan = wdev->wext.ibss.chandef.chan;
667503dd	406	wdev_unlock(wdev);
04a773ad JB	407
	408	if (chan) {
	409	freq->m = chan->center_freq;
	410	freq->e = 6;
	411	return 0;
	412	}
	413
	414	/* no channel if not joining */
	415	return -EINVAL;
	416	}
04a773ad JB	417
	418	int cfg80211_ibss_wext_siwessid(struct net_device *dev,
	419	struct iw_request_info *info,
	420	struct iw_point data, char ssid)
	421	{
	422	struct wireless_dev *wdev = dev->ieee80211_ptr;
59bbb6f7	423	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
04a773ad JB	424	size_t len = data->length;
	425	int err;
	426
	427	/* call only for ibss! */
	428	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	429	return -EINVAL;
	430
59bbb6f7	431	if (!rdev->ops->join_ibss)
04a773ad JB	432	return -EOPNOTSUPP;
04a773ad JB	433
667503dd JB	434	wdev_lock(wdev);
	435	err = 0;
	436	if (wdev->ssid_len)
59bbb6f7	437	err = __cfg80211_leave_ibss(rdev, dev, true);
667503dd JB	438	wdev_unlock(wdev);
	439
	440	if (err)
	441	return err;
04a773ad JB	442
	443	/* iwconfig uses nul termination in SSID.. */
	444	if (len > 0 && ssid[len - 1] == '\0')
	445	len--;
	446
cbe8fa9c JB	447	wdev->wext.ibss.ssid = wdev->ssid;
	448	memcpy(wdev->wext.ibss.ssid, ssid, len);
	449	wdev->wext.ibss.ssid_len = len;
04a773ad	450
fffd0934	451	wdev_lock(wdev);
59bbb6f7	452	err = cfg80211_ibss_wext_join(rdev, wdev);
fffd0934 JB	453	wdev_unlock(wdev);
	454
	455	return err;
04a773ad	456	}
04a773ad JB	457
	458	int cfg80211_ibss_wext_giwessid(struct net_device *dev,
	459	struct iw_request_info *info,
	460	struct iw_point data, char ssid)
	461	{
	462	struct wireless_dev *wdev = dev->ieee80211_ptr;
	463
	464	/* call only for ibss! */
	465	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	466	return -EINVAL;
	467
	468	data->flags = 0;
	469
667503dd	470	wdev_lock(wdev);
04a773ad JB	471	if (wdev->ssid_len) {
	472	data->flags = 1;
	473	data->length = wdev->ssid_len;
	474	memcpy(ssid, wdev->ssid, data->length);
cbe8fa9c	475	} else if (wdev->wext.ibss.ssid && wdev->wext.ibss.ssid_len) {
04a773ad	476	data->flags = 1;
cbe8fa9c JB	477	data->length = wdev->wext.ibss.ssid_len;
cbe8fa9c JB	478	memcpy(ssid, wdev->wext.ibss.ssid, data->length);
04a773ad	479	}
667503dd	480	wdev_unlock(wdev);
04a773ad JB	481
	482	return 0;
	483	}
04a773ad JB	484
	485	int cfg80211_ibss_wext_siwap(struct net_device *dev,
	486	struct iw_request_info *info,
	487	struct sockaddr ap_addr, char extra)
	488	{
	489	struct wireless_dev *wdev = dev->ieee80211_ptr;
59bbb6f7	490	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
04a773ad JB	491	u8 *bssid = ap_addr->sa_data;
	492	int err;
	493
	494	/* call only for ibss! */
	495	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	496	return -EINVAL;
	497
59bbb6f7	498	if (!rdev->ops->join_ibss)
04a773ad JB	499	return -EOPNOTSUPP;
	500
	501	if (ap_addr->sa_family != ARPHRD_ETHER)
	502	return -EINVAL;
	503
	504	/* automatic mode */
	505	if (is_zero_ether_addr(bssid) \|\| is_broadcast_ether_addr(bssid))
	506	bssid = NULL;
	507
	508	/* both automatic */
cbe8fa9c	509	if (!bssid && !wdev->wext.ibss.bssid)
04a773ad JB	510	return 0;
	511
	512	/* fixed already - and no change */
cbe8fa9c	513	if (wdev->wext.ibss.bssid && bssid &&
ac422d3c	514	ether_addr_equal(bssid, wdev->wext.ibss.bssid))
04a773ad JB	515	return 0;
04a773ad JB	516
667503dd JB	517	wdev_lock(wdev);
	518	err = 0;
	519	if (wdev->ssid_len)
59bbb6f7	520	err = __cfg80211_leave_ibss(rdev, dev, true);
667503dd JB	521	wdev_unlock(wdev);
	522
	523	if (err)
	524	return err;
04a773ad JB	525
04a773ad JB	526	if (bssid) {
cbe8fa9c JB	527	memcpy(wdev->wext.bssid, bssid, ETH_ALEN);
cbe8fa9c JB	528	wdev->wext.ibss.bssid = wdev->wext.bssid;
04a773ad	529	} else
cbe8fa9c	530	wdev->wext.ibss.bssid = NULL;
04a773ad	531
fffd0934	532	wdev_lock(wdev);
59bbb6f7	533	err = cfg80211_ibss_wext_join(rdev, wdev);
fffd0934 JB	534	wdev_unlock(wdev);
	535
	536	return err;
04a773ad	537	}
04a773ad JB	538
	539	int cfg80211_ibss_wext_giwap(struct net_device *dev,
	540	struct iw_request_info *info,
	541	struct sockaddr ap_addr, char extra)
	542	{
	543	struct wireless_dev *wdev = dev->ieee80211_ptr;
	544
	545	/* call only for ibss! */
	546	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
	547	return -EINVAL;
	548
	549	ap_addr->sa_family = ARPHRD_ETHER;
	550
667503dd	551	wdev_lock(wdev);
7ebbe6bd	552	if (wdev->current_bss)
19957bb3	553	memcpy(ap_addr->sa_data, wdev->current_bss->pub.bssid, ETH_ALEN);
80e5b06a	554	else if (wdev->wext.ibss.bssid)
cbe8fa9c	555	memcpy(ap_addr->sa_data, wdev->wext.ibss.bssid, ETH_ALEN);
80e5b06a ZY	556	else
	557	memset(ap_addr->sa_data, 0, ETH_ALEN);
	558
667503dd JB	559	wdev_unlock(wdev);
667503dd JB	560
04a773ad JB	561	return 0;
04a773ad JB	562	}
04a773ad	563	#endif