[mirror_ubuntu-bionic-kernel.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 <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_WIRELESS_EXT
	union iwreq_data wrqu;
#endif

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

	if (WARN_ON(!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);

	cfg80211_upload_connect_keys(wdev);

	nl80211_send_ibss_bssid(wiphy_to_dev(wdev->wiphy), dev, bssid,
				GFP_KERNEL);
#ifdef CONFIG_WIRELESS_EXT
	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;

	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);
	schedule_work(&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 (WARN_ON(wdev->connect_keys))
		kfree(wdev->connect_keys);
	wdev->connect_keys = connkeys;

#ifdef CONFIG_WIRELESS_EXT
	wdev->wext.ibss.channel = params->channel;
#endif
	err = rdev->ops->join_ibss(&rdev->wiphy, 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;

	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;

	/*
	 * 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, NULL);

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

	wdev->current_bss = NULL;
	wdev->ssid_len = 0;
#ifdef CONFIG_WIRELESS_EXT
	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);
}

static 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_WIRELESS_EXT
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.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 *freq, char *extra)
{
	struct wireless_dev *wdev = dev->ieee80211_ptr;
	struct ieee80211_channel *chan;
	int err;

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

	if (!wiphy_to_dev(wdev->wiphy)->ops->join_ibss)
		return -EOPNOTSUPP;

	chan = cfg80211_wext_freq(wdev->wiphy, freq);
	if (chan && IS_ERR(chan))
		return PTR_ERR(chan);

	if (chan &&
	    (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(wiphy_to_dev(wdev->wiphy),
					    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;
	}

	wdev_lock(wdev);
	err = cfg80211_ibss_wext_join(wiphy_to_dev(wdev->wiphy), 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.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;
	size_t len = data->length;
	int err;

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

	if (!wiphy_to_dev(wdev->wiphy)->ops->join_ibss)
		return -EOPNOTSUPP;

	wdev_lock(wdev);
	err = 0;
	if (wdev->ssid_len)
		err = __cfg80211_leave_ibss(wiphy_to_dev(wdev->wiphy),
					    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(wiphy_to_dev(wdev->wiphy), 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;
	u8 *bssid = ap_addr->sa_data;
	int err;

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

	if (!wiphy_to_dev(wdev->wiphy)->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 &&
	    compare_ether_addr(bssid, wdev->wext.ibss.bssid) == 0)
		return 0;

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