[mirror_ubuntu-bionic-kernel.git] / net / wireless / ibss.c

// SPDX-License-Identifier: GPL-2.0
/*
 * 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);

	if (!(wdev->wiphy->flags & WIPHY_FLAG_HAS_STATIC_WEP))
		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 == NL80211_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(connkeys && connkeys->def < 0))
		return -EINVAL;

	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
	cfg80211_sched_dfs_chan_update(rdev);
}

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 nl80211_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 < NUM_NL80211_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.ibss.privacy = wdev->wext.default_key != -1;

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