PageRenderTime 80ms CodeModel.GetById 17ms app.highlight 59ms RepoModel.GetById 1ms app.codeStats 0ms

/net/wireless/ibss.c

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