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

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

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

#ifdef CONFIG_CFG80211_WEXT
	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;

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