ibss.c revision f26cbf401be935eec13da6fca7088b50d797d78b 
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 <linux/slab.h>
10#include <linux/export.h>
11#include <net/cfg80211.h>
12#include "wext-compat.h"
13#include "nl80211.h"
14#include "rdev-ops.h"
15
16
17void __cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid,
18			    struct ieee80211_channel *channel)
19{
20	struct wireless_dev *wdev = dev->ieee80211_ptr;
21	struct cfg80211_bss *bss;
22#ifdef CONFIG_CFG80211_WEXT
23	union iwreq_data wrqu;
24#endif
25
26	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
27		return;
28
29	if (!wdev->ssid_len)
30		return;
31
32	bss = cfg80211_get_bss(wdev->wiphy, channel, bssid, NULL, 0,
33			       WLAN_CAPABILITY_IBSS, WLAN_CAPABILITY_IBSS);
34
35	if (WARN_ON(!bss))
36		return;
37
38	if (wdev->current_bss) {
39		cfg80211_unhold_bss(wdev->current_bss);
40		cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
41	}
42
43	cfg80211_hold_bss(bss_from_pub(bss));
44	wdev->current_bss = bss_from_pub(bss);
45
46	cfg80211_upload_connect_keys(wdev);
47
48	nl80211_send_ibss_bssid(wiphy_to_rdev(wdev->wiphy), dev, bssid,
49				GFP_KERNEL);
50#ifdef CONFIG_CFG80211_WEXT
51	memset(&wrqu, 0, sizeof(wrqu));
52	memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN);
53	wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
54#endif
55}
56
57void cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid,
58			  struct ieee80211_channel *channel, gfp_t gfp)
59{
60	struct wireless_dev *wdev = dev->ieee80211_ptr;
61	struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
62	struct cfg80211_event *ev;
63	unsigned long flags;
64
65	trace_cfg80211_ibss_joined(dev, bssid, channel);
66
67	if (WARN_ON(!channel))
68		return;
69
70	ev = kzalloc(sizeof(*ev), gfp);
71	if (!ev)
72		return;
73
74	ev->type = EVENT_IBSS_JOINED;
75	memcpy(ev->ij.bssid, bssid, ETH_ALEN);
76	ev->ij.channel = channel;
77
78	spin_lock_irqsave(&wdev->event_lock, flags);
79	list_add_tail(&ev->list, &wdev->event_list);
80	spin_unlock_irqrestore(&wdev->event_lock, flags);
81	queue_work(cfg80211_wq, &rdev->event_work);
82}
83EXPORT_SYMBOL(cfg80211_ibss_joined);
84
85static int __cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
86				struct net_device *dev,
87				struct cfg80211_ibss_params *params,
88				struct cfg80211_cached_keys *connkeys)
89{
90	struct wireless_dev *wdev = dev->ieee80211_ptr;
91	int err;
92
93	ASSERT_WDEV_LOCK(wdev);
94
95	if (wdev->ssid_len)
96		return -EALREADY;
97
98	if (!params->basic_rates) {
99		/*
100		* If no rates were explicitly configured,
101		* use the mandatory rate set for 11b or
102		* 11a for maximum compatibility.
103		*/
104		struct ieee80211_supported_band *sband =
105			rdev->wiphy.bands[params->chandef.chan->band];
106		int j;
107		u32 flag = params->chandef.chan->band == IEEE80211_BAND_5GHZ ?
108			IEEE80211_RATE_MANDATORY_A :
109			IEEE80211_RATE_MANDATORY_B;
110
111		for (j = 0; j < sband->n_bitrates; j++) {
112			if (sband->bitrates[j].flags & flag)
113				params->basic_rates |= BIT(j);
114		}
115	}
116
117	if (WARN_ON(wdev->connect_keys))
118		kfree(wdev->connect_keys);
119	wdev->connect_keys = connkeys;
120
121	wdev->ibss_fixed = params->channel_fixed;
122	wdev->ibss_dfs_possible = params->userspace_handles_dfs;
123	wdev->chandef = params->chandef;
124#ifdef CONFIG_CFG80211_WEXT
125	wdev->wext.ibss.chandef = params->chandef;
126#endif
127	err = rdev_join_ibss(rdev, dev, params);
128	if (err) {
129		wdev->connect_keys = NULL;
130		return err;
131	}
132
133	memcpy(wdev->ssid, params->ssid, params->ssid_len);
134	wdev->ssid_len = params->ssid_len;
135
136	return 0;
137}
138
139int cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
140		       struct net_device *dev,
141		       struct cfg80211_ibss_params *params,
142		       struct cfg80211_cached_keys *connkeys)
143{
144	struct wireless_dev *wdev = dev->ieee80211_ptr;
145	int err;
146
147	ASSERT_RTNL();
148
149	wdev_lock(wdev);
150	err = __cfg80211_join_ibss(rdev, dev, params, connkeys);
151	wdev_unlock(wdev);
152
153	return err;
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	kfree(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}
190
191void cfg80211_clear_ibss(struct net_device *dev, bool nowext)
192{
193	struct wireless_dev *wdev = dev->ieee80211_ptr;
194
195	wdev_lock(wdev);
196	__cfg80211_clear_ibss(dev, nowext);
197	wdev_unlock(wdev);
198}
199
200int __cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
201			  struct net_device *dev, bool nowext)
202{
203	struct wireless_dev *wdev = dev->ieee80211_ptr;
204	int err;
205
206	ASSERT_WDEV_LOCK(wdev);
207
208	if (!wdev->ssid_len)
209		return -ENOLINK;
210
211	err = rdev_leave_ibss(rdev, dev);
212
213	if (err)
214		return err;
215
216	__cfg80211_clear_ibss(dev, nowext);
217
218	return 0;
219}
220
221int cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
222			struct net_device *dev, bool nowext)
223{
224	struct wireless_dev *wdev = dev->ieee80211_ptr;
225	int err;
226
227	wdev_lock(wdev);
228	err = __cfg80211_leave_ibss(rdev, dev, nowext);
229	wdev_unlock(wdev);
230
231	return err;
232}
233
234#ifdef CONFIG_CFG80211_WEXT
235int cfg80211_ibss_wext_join(struct cfg80211_registered_device *rdev,
236			    struct wireless_dev *wdev)
237{
238	struct cfg80211_cached_keys *ck = NULL;
239	enum ieee80211_band band;
240	int i, err;
241
242	ASSERT_WDEV_LOCK(wdev);
243
244	if (!wdev->wext.ibss.beacon_interval)
245		wdev->wext.ibss.beacon_interval = 100;
246
247	/* try to find an IBSS channel if none requested ... */
248	if (!wdev->wext.ibss.chandef.chan) {
249		struct ieee80211_channel *new_chan = NULL;
250
251		for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
252			struct ieee80211_supported_band *sband;
253			struct ieee80211_channel *chan;
254
255			sband = rdev->wiphy.bands[band];
256			if (!sband)
257				continue;
258
259			for (i = 0; i < sband->n_channels; i++) {
260				chan = &sband->channels[i];
261				if (chan->flags & IEEE80211_CHAN_NO_IR)
262					continue;
263				if (chan->flags & IEEE80211_CHAN_DISABLED)
264					continue;
265				new_chan = chan;
266				break;
267			}
268
269			if (new_chan)
270				break;
271		}
272
273		if (!new_chan)
274			return -EINVAL;
275
276		cfg80211_chandef_create(&wdev->wext.ibss.chandef, new_chan,
277					NL80211_CHAN_NO_HT);
278	}
279
280	/* don't join -- SSID is not there */
281	if (!wdev->wext.ibss.ssid_len)
282		return 0;
283
284	if (!netif_running(wdev->netdev))
285		return 0;
286
287	if (wdev->wext.keys) {
288		wdev->wext.keys->def = wdev->wext.default_key;
289		wdev->wext.keys->defmgmt = wdev->wext.default_mgmt_key;
290	}
291
292	wdev->wext.ibss.privacy = wdev->wext.default_key != -1;
293
294	if (wdev->wext.keys) {
295		ck = kmemdup(wdev->wext.keys, sizeof(*ck), GFP_KERNEL);
296		if (!ck)
297			return -ENOMEM;
298		for (i = 0; i < 6; 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	wdev->wext.ibss.ssid = wdev->ssid;
424	memcpy(wdev->wext.ibss.ssid, ssid, len);
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		memset(ap_addr->sa_data, 0, ETH_ALEN);
537
538	wdev_unlock(wdev);
539
540	return 0;
541}
542#endif
543