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