1 /*
2  * cfg80211 - wext compat code
3  *
4  * This is temporary code until all wireless functionality is migrated
5  * into cfg80211, when that happens all the exports here go away and
6  * we directly assign the wireless handlers of wireless interfaces.
7  *
8  * Copyright 2008-2009	Johannes Berg <johannes@sipsolutions.net>
9  */
10 
11 #include <linux/export.h>
12 #include <linux/wireless.h>
13 #include <linux/nl80211.h>
14 #include <linux/if_arp.h>
15 #include <linux/etherdevice.h>
16 #include <linux/slab.h>
17 #include <net/iw_handler.h>
18 #include <net/cfg80211.h>
19 #include <net/cfg80211-wext.h>
20 #include "wext-compat.h"
21 #include "core.h"
22 
cfg80211_wext_giwname(struct net_device * dev,struct iw_request_info * info,char * name,char * extra)23 int cfg80211_wext_giwname(struct net_device *dev,
24 			  struct iw_request_info *info,
25 			  char *name, char *extra)
26 {
27 	struct wireless_dev *wdev = dev->ieee80211_ptr;
28 	struct ieee80211_supported_band *sband;
29 	bool is_ht = false, is_a = false, is_b = false, is_g = false;
30 
31 	if (!wdev)
32 		return -EOPNOTSUPP;
33 
34 	sband = wdev->wiphy->bands[IEEE80211_BAND_5GHZ];
35 	if (sband) {
36 		is_a = true;
37 		is_ht |= sband->ht_cap.ht_supported;
38 	}
39 
40 	sband = wdev->wiphy->bands[IEEE80211_BAND_2GHZ];
41 	if (sband) {
42 		int i;
43 		/* Check for mandatory rates */
44 		for (i = 0; i < sband->n_bitrates; i++) {
45 			if (sband->bitrates[i].bitrate == 10)
46 				is_b = true;
47 			if (sband->bitrates[i].bitrate == 60)
48 				is_g = true;
49 		}
50 		is_ht |= sband->ht_cap.ht_supported;
51 	}
52 
53 	strcpy(name, "IEEE 802.11");
54 	if (is_a)
55 		strcat(name, "a");
56 	if (is_b)
57 		strcat(name, "b");
58 	if (is_g)
59 		strcat(name, "g");
60 	if (is_ht)
61 		strcat(name, "n");
62 
63 	return 0;
64 }
65 EXPORT_SYMBOL_GPL(cfg80211_wext_giwname);
66 
cfg80211_wext_siwmode(struct net_device * dev,struct iw_request_info * info,u32 * mode,char * extra)67 int cfg80211_wext_siwmode(struct net_device *dev, struct iw_request_info *info,
68 			  u32 *mode, char *extra)
69 {
70 	struct wireless_dev *wdev = dev->ieee80211_ptr;
71 	struct cfg80211_registered_device *rdev;
72 	struct vif_params vifparams;
73 	enum nl80211_iftype type;
74 	int ret;
75 
76 	rdev = wiphy_to_dev(wdev->wiphy);
77 
78 	switch (*mode) {
79 	case IW_MODE_INFRA:
80 		type = NL80211_IFTYPE_STATION;
81 		break;
82 	case IW_MODE_ADHOC:
83 		type = NL80211_IFTYPE_ADHOC;
84 		break;
85 	case IW_MODE_REPEAT:
86 		type = NL80211_IFTYPE_WDS;
87 		break;
88 	case IW_MODE_MONITOR:
89 		type = NL80211_IFTYPE_MONITOR;
90 		break;
91 	default:
92 		return -EINVAL;
93 	}
94 
95 	if (type == wdev->iftype)
96 		return 0;
97 
98 	memset(&vifparams, 0, sizeof(vifparams));
99 
100 	cfg80211_lock_rdev(rdev);
101 	ret = cfg80211_change_iface(rdev, dev, type, NULL, &vifparams);
102 	cfg80211_unlock_rdev(rdev);
103 
104 	return ret;
105 }
106 EXPORT_SYMBOL_GPL(cfg80211_wext_siwmode);
107 
cfg80211_wext_giwmode(struct net_device * dev,struct iw_request_info * info,u32 * mode,char * extra)108 int cfg80211_wext_giwmode(struct net_device *dev, struct iw_request_info *info,
109 			  u32 *mode, char *extra)
110 {
111 	struct wireless_dev *wdev = dev->ieee80211_ptr;
112 
113 	if (!wdev)
114 		return -EOPNOTSUPP;
115 
116 	switch (wdev->iftype) {
117 	case NL80211_IFTYPE_AP:
118 		*mode = IW_MODE_MASTER;
119 		break;
120 	case NL80211_IFTYPE_STATION:
121 		*mode = IW_MODE_INFRA;
122 		break;
123 	case NL80211_IFTYPE_ADHOC:
124 		*mode = IW_MODE_ADHOC;
125 		break;
126 	case NL80211_IFTYPE_MONITOR:
127 		*mode = IW_MODE_MONITOR;
128 		break;
129 	case NL80211_IFTYPE_WDS:
130 		*mode = IW_MODE_REPEAT;
131 		break;
132 	case NL80211_IFTYPE_AP_VLAN:
133 		*mode = IW_MODE_SECOND;		/* FIXME */
134 		break;
135 	default:
136 		*mode = IW_MODE_AUTO;
137 		break;
138 	}
139 	return 0;
140 }
141 EXPORT_SYMBOL_GPL(cfg80211_wext_giwmode);
142 
143 
cfg80211_wext_giwrange(struct net_device * dev,struct iw_request_info * info,struct iw_point * data,char * extra)144 int cfg80211_wext_giwrange(struct net_device *dev,
145 			   struct iw_request_info *info,
146 			   struct iw_point *data, char *extra)
147 {
148 	struct wireless_dev *wdev = dev->ieee80211_ptr;
149 	struct iw_range *range = (struct iw_range *) extra;
150 	enum ieee80211_band band;
151 	int i, c = 0;
152 
153 	if (!wdev)
154 		return -EOPNOTSUPP;
155 
156 	data->length = sizeof(struct iw_range);
157 	memset(range, 0, sizeof(struct iw_range));
158 
159 	range->we_version_compiled = WIRELESS_EXT;
160 	range->we_version_source = 21;
161 	range->retry_capa = IW_RETRY_LIMIT;
162 	range->retry_flags = IW_RETRY_LIMIT;
163 	range->min_retry = 0;
164 	range->max_retry = 255;
165 	range->min_rts = 0;
166 	range->max_rts = 2347;
167 	range->min_frag = 256;
168 	range->max_frag = 2346;
169 
170 	range->max_encoding_tokens = 4;
171 
172 	range->max_qual.updated = IW_QUAL_NOISE_INVALID;
173 
174 	switch (wdev->wiphy->signal_type) {
175 	case CFG80211_SIGNAL_TYPE_NONE:
176 		break;
177 	case CFG80211_SIGNAL_TYPE_MBM:
178 		range->max_qual.level = -110;
179 		range->max_qual.qual = 70;
180 		range->avg_qual.qual = 35;
181 		range->max_qual.updated |= IW_QUAL_DBM;
182 		range->max_qual.updated |= IW_QUAL_QUAL_UPDATED;
183 		range->max_qual.updated |= IW_QUAL_LEVEL_UPDATED;
184 		break;
185 	case CFG80211_SIGNAL_TYPE_UNSPEC:
186 		range->max_qual.level = 100;
187 		range->max_qual.qual = 100;
188 		range->avg_qual.qual = 50;
189 		range->max_qual.updated |= IW_QUAL_QUAL_UPDATED;
190 		range->max_qual.updated |= IW_QUAL_LEVEL_UPDATED;
191 		break;
192 	}
193 
194 	range->avg_qual.level = range->max_qual.level / 2;
195 	range->avg_qual.noise = range->max_qual.noise / 2;
196 	range->avg_qual.updated = range->max_qual.updated;
197 
198 	for (i = 0; i < wdev->wiphy->n_cipher_suites; i++) {
199 		switch (wdev->wiphy->cipher_suites[i]) {
200 		case WLAN_CIPHER_SUITE_TKIP:
201 			range->enc_capa |= (IW_ENC_CAPA_CIPHER_TKIP |
202 					    IW_ENC_CAPA_WPA);
203 			break;
204 
205 		case WLAN_CIPHER_SUITE_CCMP:
206 			range->enc_capa |= (IW_ENC_CAPA_CIPHER_CCMP |
207 					    IW_ENC_CAPA_WPA2);
208 			break;
209 
210 		case WLAN_CIPHER_SUITE_WEP40:
211 			range->encoding_size[range->num_encoding_sizes++] =
212 				WLAN_KEY_LEN_WEP40;
213 			break;
214 
215 		case WLAN_CIPHER_SUITE_WEP104:
216 			range->encoding_size[range->num_encoding_sizes++] =
217 				WLAN_KEY_LEN_WEP104;
218 			break;
219 		}
220 	}
221 
222 	for (band = 0; band < IEEE80211_NUM_BANDS; band ++) {
223 		struct ieee80211_supported_band *sband;
224 
225 		sband = wdev->wiphy->bands[band];
226 
227 		if (!sband)
228 			continue;
229 
230 		for (i = 0; i < sband->n_channels && c < IW_MAX_FREQUENCIES; i++) {
231 			struct ieee80211_channel *chan = &sband->channels[i];
232 
233 			if (!(chan->flags & IEEE80211_CHAN_DISABLED)) {
234 				range->freq[c].i =
235 					ieee80211_frequency_to_channel(
236 						chan->center_freq);
237 				range->freq[c].m = chan->center_freq;
238 				range->freq[c].e = 6;
239 				c++;
240 			}
241 		}
242 	}
243 	range->num_channels = c;
244 	range->num_frequency = c;
245 
246 	IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
247 	IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
248 	IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
249 
250 	if (wdev->wiphy->max_scan_ssids > 0)
251 		range->scan_capa |= IW_SCAN_CAPA_ESSID;
252 
253 	return 0;
254 }
255 EXPORT_SYMBOL_GPL(cfg80211_wext_giwrange);
256 
257 
258 /**
259  * cfg80211_wext_freq - get wext frequency for non-"auto"
260  * @wiphy: the wiphy
261  * @freq: the wext freq encoding
262  *
263  * Returns a frequency, or a negative error code, or 0 for auto.
264  */
cfg80211_wext_freq(struct wiphy * wiphy,struct iw_freq * freq)265 int cfg80211_wext_freq(struct wiphy *wiphy, struct iw_freq *freq)
266 {
267 	/*
268 	 * Parse frequency - return 0 for auto and
269 	 * -EINVAL for impossible things.
270 	 */
271 	if (freq->e == 0) {
272 		enum ieee80211_band band = IEEE80211_BAND_2GHZ;
273 		if (freq->m < 0)
274 			return 0;
275 		if (freq->m > 14)
276 			band = IEEE80211_BAND_5GHZ;
277 		return ieee80211_channel_to_frequency(freq->m, band);
278 	} else {
279 		int i, div = 1000000;
280 		for (i = 0; i < freq->e; i++)
281 			div /= 10;
282 		if (div <= 0)
283 			return -EINVAL;
284 		return freq->m / div;
285 	}
286 }
287 
cfg80211_wext_siwrts(struct net_device * dev,struct iw_request_info * info,struct iw_param * rts,char * extra)288 int cfg80211_wext_siwrts(struct net_device *dev,
289 			 struct iw_request_info *info,
290 			 struct iw_param *rts, char *extra)
291 {
292 	struct wireless_dev *wdev = dev->ieee80211_ptr;
293 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
294 	u32 orts = wdev->wiphy->rts_threshold;
295 	int err;
296 
297 	if (rts->disabled || !rts->fixed)
298 		wdev->wiphy->rts_threshold = (u32) -1;
299 	else if (rts->value < 0)
300 		return -EINVAL;
301 	else
302 		wdev->wiphy->rts_threshold = rts->value;
303 
304 	err = rdev->ops->set_wiphy_params(wdev->wiphy,
305 					  WIPHY_PARAM_RTS_THRESHOLD);
306 	if (err)
307 		wdev->wiphy->rts_threshold = orts;
308 
309 	return err;
310 }
311 EXPORT_SYMBOL_GPL(cfg80211_wext_siwrts);
312 
cfg80211_wext_giwrts(struct net_device * dev,struct iw_request_info * info,struct iw_param * rts,char * extra)313 int cfg80211_wext_giwrts(struct net_device *dev,
314 			 struct iw_request_info *info,
315 			 struct iw_param *rts, char *extra)
316 {
317 	struct wireless_dev *wdev = dev->ieee80211_ptr;
318 
319 	rts->value = wdev->wiphy->rts_threshold;
320 	rts->disabled = rts->value == (u32) -1;
321 	rts->fixed = 1;
322 
323 	return 0;
324 }
325 EXPORT_SYMBOL_GPL(cfg80211_wext_giwrts);
326 
cfg80211_wext_siwfrag(struct net_device * dev,struct iw_request_info * info,struct iw_param * frag,char * extra)327 int cfg80211_wext_siwfrag(struct net_device *dev,
328 			  struct iw_request_info *info,
329 			  struct iw_param *frag, char *extra)
330 {
331 	struct wireless_dev *wdev = dev->ieee80211_ptr;
332 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
333 	u32 ofrag = wdev->wiphy->frag_threshold;
334 	int err;
335 
336 	if (frag->disabled || !frag->fixed)
337 		wdev->wiphy->frag_threshold = (u32) -1;
338 	else if (frag->value < 256)
339 		return -EINVAL;
340 	else {
341 		/* Fragment length must be even, so strip LSB. */
342 		wdev->wiphy->frag_threshold = frag->value & ~0x1;
343 	}
344 
345 	err = rdev->ops->set_wiphy_params(wdev->wiphy,
346 					  WIPHY_PARAM_FRAG_THRESHOLD);
347 	if (err)
348 		wdev->wiphy->frag_threshold = ofrag;
349 
350 	return err;
351 }
352 EXPORT_SYMBOL_GPL(cfg80211_wext_siwfrag);
353 
cfg80211_wext_giwfrag(struct net_device * dev,struct iw_request_info * info,struct iw_param * frag,char * extra)354 int cfg80211_wext_giwfrag(struct net_device *dev,
355 			  struct iw_request_info *info,
356 			  struct iw_param *frag, char *extra)
357 {
358 	struct wireless_dev *wdev = dev->ieee80211_ptr;
359 
360 	frag->value = wdev->wiphy->frag_threshold;
361 	frag->disabled = frag->value == (u32) -1;
362 	frag->fixed = 1;
363 
364 	return 0;
365 }
366 EXPORT_SYMBOL_GPL(cfg80211_wext_giwfrag);
367 
cfg80211_wext_siwretry(struct net_device * dev,struct iw_request_info * info,struct iw_param * retry,char * extra)368 static int cfg80211_wext_siwretry(struct net_device *dev,
369 				  struct iw_request_info *info,
370 				  struct iw_param *retry, char *extra)
371 {
372 	struct wireless_dev *wdev = dev->ieee80211_ptr;
373 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
374 	u32 changed = 0;
375 	u8 olong = wdev->wiphy->retry_long;
376 	u8 oshort = wdev->wiphy->retry_short;
377 	int err;
378 
379 	if (retry->disabled ||
380 	    (retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
381 		return -EINVAL;
382 
383 	if (retry->flags & IW_RETRY_LONG) {
384 		wdev->wiphy->retry_long = retry->value;
385 		changed |= WIPHY_PARAM_RETRY_LONG;
386 	} else if (retry->flags & IW_RETRY_SHORT) {
387 		wdev->wiphy->retry_short = retry->value;
388 		changed |= WIPHY_PARAM_RETRY_SHORT;
389 	} else {
390 		wdev->wiphy->retry_short = retry->value;
391 		wdev->wiphy->retry_long = retry->value;
392 		changed |= WIPHY_PARAM_RETRY_LONG;
393 		changed |= WIPHY_PARAM_RETRY_SHORT;
394 	}
395 
396 	if (!changed)
397 		return 0;
398 
399 	err = rdev->ops->set_wiphy_params(wdev->wiphy, changed);
400 	if (err) {
401 		wdev->wiphy->retry_short = oshort;
402 		wdev->wiphy->retry_long = olong;
403 	}
404 
405 	return err;
406 }
407 
cfg80211_wext_giwretry(struct net_device * dev,struct iw_request_info * info,struct iw_param * retry,char * extra)408 int cfg80211_wext_giwretry(struct net_device *dev,
409 			   struct iw_request_info *info,
410 			   struct iw_param *retry, char *extra)
411 {
412 	struct wireless_dev *wdev = dev->ieee80211_ptr;
413 
414 	retry->disabled = 0;
415 
416 	if (retry->flags == 0 || (retry->flags & IW_RETRY_SHORT)) {
417 		/*
418 		 * First return short value, iwconfig will ask long value
419 		 * later if needed
420 		 */
421 		retry->flags |= IW_RETRY_LIMIT;
422 		retry->value = wdev->wiphy->retry_short;
423 		if (wdev->wiphy->retry_long != wdev->wiphy->retry_short)
424 			retry->flags |= IW_RETRY_LONG;
425 
426 		return 0;
427 	}
428 
429 	if (retry->flags & IW_RETRY_LONG) {
430 		retry->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
431 		retry->value = wdev->wiphy->retry_long;
432 	}
433 
434 	return 0;
435 }
436 EXPORT_SYMBOL_GPL(cfg80211_wext_giwretry);
437 
__cfg80211_set_encryption(struct cfg80211_registered_device * rdev,struct net_device * dev,bool pairwise,const u8 * addr,bool remove,bool tx_key,int idx,struct key_params * params)438 static int __cfg80211_set_encryption(struct cfg80211_registered_device *rdev,
439 				     struct net_device *dev, bool pairwise,
440 				     const u8 *addr, bool remove, bool tx_key,
441 				     int idx, struct key_params *params)
442 {
443 	struct wireless_dev *wdev = dev->ieee80211_ptr;
444 	int err, i;
445 	bool rejoin = false;
446 
447 	if (pairwise && !addr)
448 		return -EINVAL;
449 
450 	if (!wdev->wext.keys) {
451 		wdev->wext.keys = kzalloc(sizeof(*wdev->wext.keys),
452 					      GFP_KERNEL);
453 		if (!wdev->wext.keys)
454 			return -ENOMEM;
455 		for (i = 0; i < 6; i++)
456 			wdev->wext.keys->params[i].key =
457 				wdev->wext.keys->data[i];
458 	}
459 
460 	if (wdev->iftype != NL80211_IFTYPE_ADHOC &&
461 	    wdev->iftype != NL80211_IFTYPE_STATION)
462 		return -EOPNOTSUPP;
463 
464 	if (params->cipher == WLAN_CIPHER_SUITE_AES_CMAC) {
465 		if (!wdev->current_bss)
466 			return -ENOLINK;
467 
468 		if (!rdev->ops->set_default_mgmt_key)
469 			return -EOPNOTSUPP;
470 
471 		if (idx < 4 || idx > 5)
472 			return -EINVAL;
473 	} else if (idx < 0 || idx > 3)
474 		return -EINVAL;
475 
476 	if (remove) {
477 		err = 0;
478 		if (wdev->current_bss) {
479 			/*
480 			 * If removing the current TX key, we will need to
481 			 * join a new IBSS without the privacy bit clear.
482 			 */
483 			if (idx == wdev->wext.default_key &&
484 			    wdev->iftype == NL80211_IFTYPE_ADHOC) {
485 				__cfg80211_leave_ibss(rdev, wdev->netdev, true);
486 				rejoin = true;
487 			}
488 
489 			if (!pairwise && addr &&
490 			    !(rdev->wiphy.flags & WIPHY_FLAG_IBSS_RSN))
491 				err = -ENOENT;
492 			else
493 				err = rdev->ops->del_key(&rdev->wiphy, dev, idx,
494 							 pairwise, addr);
495 		}
496 		wdev->wext.connect.privacy = false;
497 		/*
498 		 * Applications using wireless extensions expect to be
499 		 * able to delete keys that don't exist, so allow that.
500 		 */
501 		if (err == -ENOENT)
502 			err = 0;
503 		if (!err) {
504 			if (!addr) {
505 				wdev->wext.keys->params[idx].key_len = 0;
506 				wdev->wext.keys->params[idx].cipher = 0;
507 			}
508 			if (idx == wdev->wext.default_key)
509 				wdev->wext.default_key = -1;
510 			else if (idx == wdev->wext.default_mgmt_key)
511 				wdev->wext.default_mgmt_key = -1;
512 		}
513 
514 		if (!err && rejoin)
515 			err = cfg80211_ibss_wext_join(rdev, wdev);
516 
517 		return err;
518 	}
519 
520 	if (addr)
521 		tx_key = false;
522 
523 	if (cfg80211_validate_key_settings(rdev, params, idx, pairwise, addr))
524 		return -EINVAL;
525 
526 	err = 0;
527 	if (wdev->current_bss)
528 		err = rdev->ops->add_key(&rdev->wiphy, dev, idx,
529 					 pairwise, addr, params);
530 	if (err)
531 		return err;
532 
533 	if (!addr) {
534 		wdev->wext.keys->params[idx] = *params;
535 		memcpy(wdev->wext.keys->data[idx],
536 			params->key, params->key_len);
537 		wdev->wext.keys->params[idx].key =
538 			wdev->wext.keys->data[idx];
539 	}
540 
541 	if ((params->cipher == WLAN_CIPHER_SUITE_WEP40 ||
542 	     params->cipher == WLAN_CIPHER_SUITE_WEP104) &&
543 	    (tx_key || (!addr && wdev->wext.default_key == -1))) {
544 		if (wdev->current_bss) {
545 			/*
546 			 * If we are getting a new TX key from not having
547 			 * had one before we need to join a new IBSS with
548 			 * the privacy bit set.
549 			 */
550 			if (wdev->iftype == NL80211_IFTYPE_ADHOC &&
551 			    wdev->wext.default_key == -1) {
552 				__cfg80211_leave_ibss(rdev, wdev->netdev, true);
553 				rejoin = true;
554 			}
555 			err = rdev->ops->set_default_key(&rdev->wiphy, dev,
556 							 idx, true, true);
557 		}
558 		if (!err) {
559 			wdev->wext.default_key = idx;
560 			if (rejoin)
561 				err = cfg80211_ibss_wext_join(rdev, wdev);
562 		}
563 		return err;
564 	}
565 
566 	if (params->cipher == WLAN_CIPHER_SUITE_AES_CMAC &&
567 	    (tx_key || (!addr && wdev->wext.default_mgmt_key == -1))) {
568 		if (wdev->current_bss)
569 			err = rdev->ops->set_default_mgmt_key(&rdev->wiphy,
570 							      dev, idx);
571 		if (!err)
572 			wdev->wext.default_mgmt_key = idx;
573 		return err;
574 	}
575 
576 	return 0;
577 }
578 
cfg80211_set_encryption(struct cfg80211_registered_device * rdev,struct net_device * dev,bool pairwise,const u8 * addr,bool remove,bool tx_key,int idx,struct key_params * params)579 static int cfg80211_set_encryption(struct cfg80211_registered_device *rdev,
580 				   struct net_device *dev, bool pairwise,
581 				   const u8 *addr, bool remove, bool tx_key,
582 				   int idx, struct key_params *params)
583 {
584 	int err;
585 
586 	/* devlist mutex needed for possible IBSS re-join */
587 	mutex_lock(&rdev->devlist_mtx);
588 	wdev_lock(dev->ieee80211_ptr);
589 	err = __cfg80211_set_encryption(rdev, dev, pairwise, addr,
590 					remove, tx_key, idx, params);
591 	wdev_unlock(dev->ieee80211_ptr);
592 	mutex_unlock(&rdev->devlist_mtx);
593 
594 	return err;
595 }
596 
cfg80211_wext_siwencode(struct net_device * dev,struct iw_request_info * info,struct iw_point * erq,char * keybuf)597 static int cfg80211_wext_siwencode(struct net_device *dev,
598 				   struct iw_request_info *info,
599 				   struct iw_point *erq, char *keybuf)
600 {
601 	struct wireless_dev *wdev = dev->ieee80211_ptr;
602 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
603 	int idx, err;
604 	bool remove = false;
605 	struct key_params params;
606 
607 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
608 	    wdev->iftype != NL80211_IFTYPE_ADHOC)
609 		return -EOPNOTSUPP;
610 
611 	/* no use -- only MFP (set_default_mgmt_key) is optional */
612 	if (!rdev->ops->del_key ||
613 	    !rdev->ops->add_key ||
614 	    !rdev->ops->set_default_key)
615 		return -EOPNOTSUPP;
616 
617 	idx = erq->flags & IW_ENCODE_INDEX;
618 	if (idx == 0) {
619 		idx = wdev->wext.default_key;
620 		if (idx < 0)
621 			idx = 0;
622 	} else if (idx < 1 || idx > 4)
623 		return -EINVAL;
624 	else
625 		idx--;
626 
627 	if (erq->flags & IW_ENCODE_DISABLED)
628 		remove = true;
629 	else if (erq->length == 0) {
630 		/* No key data - just set the default TX key index */
631 		err = 0;
632 		wdev_lock(wdev);
633 		if (wdev->current_bss)
634 			err = rdev->ops->set_default_key(&rdev->wiphy, dev,
635 							 idx, true, true);
636 		if (!err)
637 			wdev->wext.default_key = idx;
638 		wdev_unlock(wdev);
639 		return err;
640 	}
641 
642 	memset(&params, 0, sizeof(params));
643 	params.key = keybuf;
644 	params.key_len = erq->length;
645 	if (erq->length == 5)
646 		params.cipher = WLAN_CIPHER_SUITE_WEP40;
647 	else if (erq->length == 13)
648 		params.cipher = WLAN_CIPHER_SUITE_WEP104;
649 	else if (!remove)
650 		return -EINVAL;
651 
652 	return cfg80211_set_encryption(rdev, dev, false, NULL, remove,
653 				       wdev->wext.default_key == -1,
654 				       idx, &params);
655 }
656 
cfg80211_wext_siwencodeext(struct net_device * dev,struct iw_request_info * info,struct iw_point * erq,char * extra)657 static int cfg80211_wext_siwencodeext(struct net_device *dev,
658 				      struct iw_request_info *info,
659 				      struct iw_point *erq, char *extra)
660 {
661 	struct wireless_dev *wdev = dev->ieee80211_ptr;
662 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
663 	struct iw_encode_ext *ext = (struct iw_encode_ext *) extra;
664 	const u8 *addr;
665 	int idx;
666 	bool remove = false;
667 	struct key_params params;
668 	u32 cipher;
669 
670 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
671 	    wdev->iftype != NL80211_IFTYPE_ADHOC)
672 		return -EOPNOTSUPP;
673 
674 	/* no use -- only MFP (set_default_mgmt_key) is optional */
675 	if (!rdev->ops->del_key ||
676 	    !rdev->ops->add_key ||
677 	    !rdev->ops->set_default_key)
678 		return -EOPNOTSUPP;
679 
680 	switch (ext->alg) {
681 	case IW_ENCODE_ALG_NONE:
682 		remove = true;
683 		cipher = 0;
684 		break;
685 	case IW_ENCODE_ALG_WEP:
686 		if (ext->key_len == 5)
687 			cipher = WLAN_CIPHER_SUITE_WEP40;
688 		else if (ext->key_len == 13)
689 			cipher = WLAN_CIPHER_SUITE_WEP104;
690 		else
691 			return -EINVAL;
692 		break;
693 	case IW_ENCODE_ALG_TKIP:
694 		cipher = WLAN_CIPHER_SUITE_TKIP;
695 		break;
696 	case IW_ENCODE_ALG_CCMP:
697 		cipher = WLAN_CIPHER_SUITE_CCMP;
698 		break;
699 	case IW_ENCODE_ALG_AES_CMAC:
700 		cipher = WLAN_CIPHER_SUITE_AES_CMAC;
701 		break;
702 	default:
703 		return -EOPNOTSUPP;
704 	}
705 
706 	if (erq->flags & IW_ENCODE_DISABLED)
707 		remove = true;
708 
709 	idx = erq->flags & IW_ENCODE_INDEX;
710 	if (cipher == WLAN_CIPHER_SUITE_AES_CMAC) {
711 		if (idx < 4 || idx > 5) {
712 			idx = wdev->wext.default_mgmt_key;
713 			if (idx < 0)
714 				return -EINVAL;
715 		} else
716 			idx--;
717 	} else {
718 		if (idx < 1 || idx > 4) {
719 			idx = wdev->wext.default_key;
720 			if (idx < 0)
721 				return -EINVAL;
722 		} else
723 			idx--;
724 	}
725 
726 	addr = ext->addr.sa_data;
727 	if (is_broadcast_ether_addr(addr))
728 		addr = NULL;
729 
730 	memset(&params, 0, sizeof(params));
731 	params.key = ext->key;
732 	params.key_len = ext->key_len;
733 	params.cipher = cipher;
734 
735 	if (ext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) {
736 		params.seq = ext->rx_seq;
737 		params.seq_len = 6;
738 	}
739 
740 	return cfg80211_set_encryption(
741 			rdev, dev,
742 			!(ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY),
743 			addr, remove,
744 			ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY,
745 			idx, &params);
746 }
747 
cfg80211_wext_giwencode(struct net_device * dev,struct iw_request_info * info,struct iw_point * erq,char * keybuf)748 static int cfg80211_wext_giwencode(struct net_device *dev,
749 				   struct iw_request_info *info,
750 				   struct iw_point *erq, char *keybuf)
751 {
752 	struct wireless_dev *wdev = dev->ieee80211_ptr;
753 	int idx;
754 
755 	if (wdev->iftype != NL80211_IFTYPE_STATION &&
756 	    wdev->iftype != NL80211_IFTYPE_ADHOC)
757 		return -EOPNOTSUPP;
758 
759 	idx = erq->flags & IW_ENCODE_INDEX;
760 	if (idx == 0) {
761 		idx = wdev->wext.default_key;
762 		if (idx < 0)
763 			idx = 0;
764 	} else if (idx < 1 || idx > 4)
765 		return -EINVAL;
766 	else
767 		idx--;
768 
769 	erq->flags = idx + 1;
770 
771 	if (!wdev->wext.keys || !wdev->wext.keys->params[idx].cipher) {
772 		erq->flags |= IW_ENCODE_DISABLED;
773 		erq->length = 0;
774 		return 0;
775 	}
776 
777 	erq->length = min_t(size_t, erq->length,
778 			    wdev->wext.keys->params[idx].key_len);
779 	memcpy(keybuf, wdev->wext.keys->params[idx].key, erq->length);
780 	erq->flags |= IW_ENCODE_ENABLED;
781 
782 	return 0;
783 }
784 
cfg80211_wext_siwfreq(struct net_device * dev,struct iw_request_info * info,struct iw_freq * wextfreq,char * extra)785 static int cfg80211_wext_siwfreq(struct net_device *dev,
786 				 struct iw_request_info *info,
787 				 struct iw_freq *wextfreq, char *extra)
788 {
789 	struct wireless_dev *wdev = dev->ieee80211_ptr;
790 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
791 	int freq, err;
792 
793 	switch (wdev->iftype) {
794 	case NL80211_IFTYPE_STATION:
795 		return cfg80211_mgd_wext_siwfreq(dev, info, wextfreq, extra);
796 	case NL80211_IFTYPE_ADHOC:
797 		return cfg80211_ibss_wext_siwfreq(dev, info, wextfreq, extra);
798 	case NL80211_IFTYPE_MONITOR:
799 	case NL80211_IFTYPE_WDS:
800 	case NL80211_IFTYPE_MESH_POINT:
801 		freq = cfg80211_wext_freq(wdev->wiphy, wextfreq);
802 		if (freq < 0)
803 			return freq;
804 		if (freq == 0)
805 			return -EINVAL;
806 		mutex_lock(&rdev->devlist_mtx);
807 		wdev_lock(wdev);
808 		err = cfg80211_set_freq(rdev, wdev, freq, NL80211_CHAN_NO_HT);
809 		wdev_unlock(wdev);
810 		mutex_unlock(&rdev->devlist_mtx);
811 		return err;
812 	default:
813 		return -EOPNOTSUPP;
814 	}
815 }
816 
cfg80211_wext_giwfreq(struct net_device * dev,struct iw_request_info * info,struct iw_freq * freq,char * extra)817 static int cfg80211_wext_giwfreq(struct net_device *dev,
818 				 struct iw_request_info *info,
819 				 struct iw_freq *freq, char *extra)
820 {
821 	struct wireless_dev *wdev = dev->ieee80211_ptr;
822 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
823 	struct ieee80211_channel *chan;
824 
825 	switch (wdev->iftype) {
826 	case NL80211_IFTYPE_STATION:
827 		return cfg80211_mgd_wext_giwfreq(dev, info, freq, extra);
828 	case NL80211_IFTYPE_ADHOC:
829 		return cfg80211_ibss_wext_giwfreq(dev, info, freq, extra);
830 	case NL80211_IFTYPE_MONITOR:
831 		if (!rdev->ops->get_channel)
832 			return -EINVAL;
833 
834 		chan = rdev->ops->get_channel(wdev->wiphy);
835 		if (!chan)
836 			return -EINVAL;
837 		freq->m = chan->center_freq;
838 		freq->e = 6;
839 		return 0;
840 	default:
841 		if (!wdev->channel)
842 			return -EINVAL;
843 		freq->m = wdev->channel->center_freq;
844 		freq->e = 6;
845 		return 0;
846 	}
847 }
848 
cfg80211_wext_siwtxpower(struct net_device * dev,struct iw_request_info * info,union iwreq_data * data,char * extra)849 static int cfg80211_wext_siwtxpower(struct net_device *dev,
850 				    struct iw_request_info *info,
851 				    union iwreq_data *data, char *extra)
852 {
853 	struct wireless_dev *wdev = dev->ieee80211_ptr;
854 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
855 	enum nl80211_tx_power_setting type;
856 	int dbm = 0;
857 
858 	if ((data->txpower.flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM)
859 		return -EINVAL;
860 	if (data->txpower.flags & IW_TXPOW_RANGE)
861 		return -EINVAL;
862 
863 	if (!rdev->ops->set_tx_power)
864 		return -EOPNOTSUPP;
865 
866 	/* only change when not disabling */
867 	if (!data->txpower.disabled) {
868 		rfkill_set_sw_state(rdev->rfkill, false);
869 
870 		if (data->txpower.fixed) {
871 			/*
872 			 * wext doesn't support negative values, see
873 			 * below where it's for automatic
874 			 */
875 			if (data->txpower.value < 0)
876 				return -EINVAL;
877 			dbm = data->txpower.value;
878 			type = NL80211_TX_POWER_FIXED;
879 			/* TODO: do regulatory check! */
880 		} else {
881 			/*
882 			 * Automatic power level setting, max being the value
883 			 * passed in from userland.
884 			 */
885 			if (data->txpower.value < 0) {
886 				type = NL80211_TX_POWER_AUTOMATIC;
887 			} else {
888 				dbm = data->txpower.value;
889 				type = NL80211_TX_POWER_LIMITED;
890 			}
891 		}
892 	} else {
893 		rfkill_set_sw_state(rdev->rfkill, true);
894 		schedule_work(&rdev->rfkill_sync);
895 		return 0;
896 	}
897 
898 	return rdev->ops->set_tx_power(wdev->wiphy, type, DBM_TO_MBM(dbm));
899 }
900 
cfg80211_wext_giwtxpower(struct net_device * dev,struct iw_request_info * info,union iwreq_data * data,char * extra)901 static int cfg80211_wext_giwtxpower(struct net_device *dev,
902 				    struct iw_request_info *info,
903 				    union iwreq_data *data, char *extra)
904 {
905 	struct wireless_dev *wdev = dev->ieee80211_ptr;
906 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
907 	int err, val;
908 
909 	if ((data->txpower.flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM)
910 		return -EINVAL;
911 	if (data->txpower.flags & IW_TXPOW_RANGE)
912 		return -EINVAL;
913 
914 	if (!rdev->ops->get_tx_power)
915 		return -EOPNOTSUPP;
916 
917 	err = rdev->ops->get_tx_power(wdev->wiphy, &val);
918 	if (err)
919 		return err;
920 
921 	/* well... oh well */
922 	data->txpower.fixed = 1;
923 	data->txpower.disabled = rfkill_blocked(rdev->rfkill);
924 	data->txpower.value = val;
925 	data->txpower.flags = IW_TXPOW_DBM;
926 
927 	return 0;
928 }
929 
cfg80211_set_auth_alg(struct wireless_dev * wdev,s32 auth_alg)930 static int cfg80211_set_auth_alg(struct wireless_dev *wdev,
931 				 s32 auth_alg)
932 {
933 	int nr_alg = 0;
934 
935 	if (!auth_alg)
936 		return -EINVAL;
937 
938 	if (auth_alg & ~(IW_AUTH_ALG_OPEN_SYSTEM |
939 			 IW_AUTH_ALG_SHARED_KEY |
940 			 IW_AUTH_ALG_LEAP))
941 		return -EINVAL;
942 
943 	if (auth_alg & IW_AUTH_ALG_OPEN_SYSTEM) {
944 		nr_alg++;
945 		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_OPEN_SYSTEM;
946 	}
947 
948 	if (auth_alg & IW_AUTH_ALG_SHARED_KEY) {
949 		nr_alg++;
950 		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_SHARED_KEY;
951 	}
952 
953 	if (auth_alg & IW_AUTH_ALG_LEAP) {
954 		nr_alg++;
955 		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_NETWORK_EAP;
956 	}
957 
958 	if (nr_alg > 1)
959 		wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
960 
961 	return 0;
962 }
963 
cfg80211_set_wpa_version(struct wireless_dev * wdev,u32 wpa_versions)964 static int cfg80211_set_wpa_version(struct wireless_dev *wdev, u32 wpa_versions)
965 {
966 	if (wpa_versions & ~(IW_AUTH_WPA_VERSION_WPA |
967 			     IW_AUTH_WPA_VERSION_WPA2|
968 		             IW_AUTH_WPA_VERSION_DISABLED))
969 		return -EINVAL;
970 
971 	if ((wpa_versions & IW_AUTH_WPA_VERSION_DISABLED) &&
972 	    (wpa_versions & (IW_AUTH_WPA_VERSION_WPA|
973 			     IW_AUTH_WPA_VERSION_WPA2)))
974 		return -EINVAL;
975 
976 	if (wpa_versions & IW_AUTH_WPA_VERSION_DISABLED)
977 		wdev->wext.connect.crypto.wpa_versions &=
978 			~(NL80211_WPA_VERSION_1|NL80211_WPA_VERSION_2);
979 
980 	if (wpa_versions & IW_AUTH_WPA_VERSION_WPA)
981 		wdev->wext.connect.crypto.wpa_versions |=
982 			NL80211_WPA_VERSION_1;
983 
984 	if (wpa_versions & IW_AUTH_WPA_VERSION_WPA2)
985 		wdev->wext.connect.crypto.wpa_versions |=
986 			NL80211_WPA_VERSION_2;
987 
988 	return 0;
989 }
990 
cfg80211_set_cipher_group(struct wireless_dev * wdev,u32 cipher)991 static int cfg80211_set_cipher_group(struct wireless_dev *wdev, u32 cipher)
992 {
993 	if (cipher & IW_AUTH_CIPHER_WEP40)
994 		wdev->wext.connect.crypto.cipher_group =
995 			WLAN_CIPHER_SUITE_WEP40;
996 	else if (cipher & IW_AUTH_CIPHER_WEP104)
997 		wdev->wext.connect.crypto.cipher_group =
998 			WLAN_CIPHER_SUITE_WEP104;
999 	else if (cipher & IW_AUTH_CIPHER_TKIP)
1000 		wdev->wext.connect.crypto.cipher_group =
1001 			WLAN_CIPHER_SUITE_TKIP;
1002 	else if (cipher & IW_AUTH_CIPHER_CCMP)
1003 		wdev->wext.connect.crypto.cipher_group =
1004 			WLAN_CIPHER_SUITE_CCMP;
1005 	else if (cipher & IW_AUTH_CIPHER_AES_CMAC)
1006 		wdev->wext.connect.crypto.cipher_group =
1007 			WLAN_CIPHER_SUITE_AES_CMAC;
1008 	else if (cipher & IW_AUTH_CIPHER_NONE)
1009 		wdev->wext.connect.crypto.cipher_group = 0;
1010 	else
1011 		return -EINVAL;
1012 
1013 	return 0;
1014 }
1015 
cfg80211_set_cipher_pairwise(struct wireless_dev * wdev,u32 cipher)1016 static int cfg80211_set_cipher_pairwise(struct wireless_dev *wdev, u32 cipher)
1017 {
1018 	int nr_ciphers = 0;
1019 	u32 *ciphers_pairwise = wdev->wext.connect.crypto.ciphers_pairwise;
1020 
1021 	if (cipher & IW_AUTH_CIPHER_WEP40) {
1022 		ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_WEP40;
1023 		nr_ciphers++;
1024 	}
1025 
1026 	if (cipher & IW_AUTH_CIPHER_WEP104) {
1027 		ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_WEP104;
1028 		nr_ciphers++;
1029 	}
1030 
1031 	if (cipher & IW_AUTH_CIPHER_TKIP) {
1032 		ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_TKIP;
1033 		nr_ciphers++;
1034 	}
1035 
1036 	if (cipher & IW_AUTH_CIPHER_CCMP) {
1037 		ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_CCMP;
1038 		nr_ciphers++;
1039 	}
1040 
1041 	if (cipher & IW_AUTH_CIPHER_AES_CMAC) {
1042 		ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_AES_CMAC;
1043 		nr_ciphers++;
1044 	}
1045 
1046 	BUILD_BUG_ON(NL80211_MAX_NR_CIPHER_SUITES < 5);
1047 
1048 	wdev->wext.connect.crypto.n_ciphers_pairwise = nr_ciphers;
1049 
1050 	return 0;
1051 }
1052 
1053 
cfg80211_set_key_mgt(struct wireless_dev * wdev,u32 key_mgt)1054 static int cfg80211_set_key_mgt(struct wireless_dev *wdev, u32 key_mgt)
1055 {
1056 	int nr_akm_suites = 0;
1057 
1058 	if (key_mgt & ~(IW_AUTH_KEY_MGMT_802_1X |
1059 			IW_AUTH_KEY_MGMT_PSK))
1060 		return -EINVAL;
1061 
1062 	if (key_mgt & IW_AUTH_KEY_MGMT_802_1X) {
1063 		wdev->wext.connect.crypto.akm_suites[nr_akm_suites] =
1064 			WLAN_AKM_SUITE_8021X;
1065 		nr_akm_suites++;
1066 	}
1067 
1068 	if (key_mgt & IW_AUTH_KEY_MGMT_PSK) {
1069 		wdev->wext.connect.crypto.akm_suites[nr_akm_suites] =
1070 			WLAN_AKM_SUITE_PSK;
1071 		nr_akm_suites++;
1072 	}
1073 
1074 	wdev->wext.connect.crypto.n_akm_suites = nr_akm_suites;
1075 
1076 	return 0;
1077 }
1078 
cfg80211_wext_siwauth(struct net_device * dev,struct iw_request_info * info,struct iw_param * data,char * extra)1079 static int cfg80211_wext_siwauth(struct net_device *dev,
1080 				 struct iw_request_info *info,
1081 				 struct iw_param *data, char *extra)
1082 {
1083 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1084 
1085 	if (wdev->iftype != NL80211_IFTYPE_STATION)
1086 		return -EOPNOTSUPP;
1087 
1088 	switch (data->flags & IW_AUTH_INDEX) {
1089 	case IW_AUTH_PRIVACY_INVOKED:
1090 		wdev->wext.connect.privacy = data->value;
1091 		return 0;
1092 	case IW_AUTH_WPA_VERSION:
1093 		return cfg80211_set_wpa_version(wdev, data->value);
1094 	case IW_AUTH_CIPHER_GROUP:
1095 		return cfg80211_set_cipher_group(wdev, data->value);
1096 	case IW_AUTH_KEY_MGMT:
1097 		return cfg80211_set_key_mgt(wdev, data->value);
1098 	case IW_AUTH_CIPHER_PAIRWISE:
1099 		return cfg80211_set_cipher_pairwise(wdev, data->value);
1100 	case IW_AUTH_80211_AUTH_ALG:
1101 		return cfg80211_set_auth_alg(wdev, data->value);
1102 	case IW_AUTH_WPA_ENABLED:
1103 	case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1104 	case IW_AUTH_DROP_UNENCRYPTED:
1105 	case IW_AUTH_MFP:
1106 		return 0;
1107 	default:
1108 		return -EOPNOTSUPP;
1109 	}
1110 }
1111 
cfg80211_wext_giwauth(struct net_device * dev,struct iw_request_info * info,struct iw_param * data,char * extra)1112 static int cfg80211_wext_giwauth(struct net_device *dev,
1113 				 struct iw_request_info *info,
1114 				 struct iw_param *data, char *extra)
1115 {
1116 	/* XXX: what do we need? */
1117 
1118 	return -EOPNOTSUPP;
1119 }
1120 
cfg80211_wext_siwpower(struct net_device * dev,struct iw_request_info * info,struct iw_param * wrq,char * extra)1121 static int cfg80211_wext_siwpower(struct net_device *dev,
1122 				  struct iw_request_info *info,
1123 				  struct iw_param *wrq, char *extra)
1124 {
1125 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1126 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1127 	bool ps = wdev->ps;
1128 	int timeout = wdev->ps_timeout;
1129 	int err;
1130 
1131 	if (wdev->iftype != NL80211_IFTYPE_STATION)
1132 		return -EINVAL;
1133 
1134 	if (!rdev->ops->set_power_mgmt)
1135 		return -EOPNOTSUPP;
1136 
1137 	if (wrq->disabled) {
1138 		ps = false;
1139 	} else {
1140 		switch (wrq->flags & IW_POWER_MODE) {
1141 		case IW_POWER_ON:       /* If not specified */
1142 		case IW_POWER_MODE:     /* If set all mask */
1143 		case IW_POWER_ALL_R:    /* If explicitely state all */
1144 			ps = true;
1145 			break;
1146 		default:                /* Otherwise we ignore */
1147 			return -EINVAL;
1148 		}
1149 
1150 		if (wrq->flags & ~(IW_POWER_MODE | IW_POWER_TIMEOUT))
1151 			return -EINVAL;
1152 
1153 		if (wrq->flags & IW_POWER_TIMEOUT)
1154 			timeout = wrq->value / 1000;
1155 	}
1156 
1157 	err = rdev->ops->set_power_mgmt(wdev->wiphy, dev, ps, timeout);
1158 	if (err)
1159 		return err;
1160 
1161 	wdev->ps = ps;
1162 	wdev->ps_timeout = timeout;
1163 
1164 	return 0;
1165 
1166 }
1167 
cfg80211_wext_giwpower(struct net_device * dev,struct iw_request_info * info,struct iw_param * wrq,char * extra)1168 static int cfg80211_wext_giwpower(struct net_device *dev,
1169 				  struct iw_request_info *info,
1170 				  struct iw_param *wrq, char *extra)
1171 {
1172 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1173 
1174 	wrq->disabled = !wdev->ps;
1175 
1176 	return 0;
1177 }
1178 
cfg80211_wds_wext_siwap(struct net_device * dev,struct iw_request_info * info,struct sockaddr * addr,char * extra)1179 static int cfg80211_wds_wext_siwap(struct net_device *dev,
1180 				   struct iw_request_info *info,
1181 				   struct sockaddr *addr, char *extra)
1182 {
1183 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1184 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1185 	int err;
1186 
1187 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_WDS))
1188 		return -EINVAL;
1189 
1190 	if (addr->sa_family != ARPHRD_ETHER)
1191 		return -EINVAL;
1192 
1193 	if (netif_running(dev))
1194 		return -EBUSY;
1195 
1196 	if (!rdev->ops->set_wds_peer)
1197 		return -EOPNOTSUPP;
1198 
1199 	err = rdev->ops->set_wds_peer(wdev->wiphy, dev, (u8 *) &addr->sa_data);
1200 	if (err)
1201 		return err;
1202 
1203 	memcpy(&wdev->wext.bssid, (u8 *) &addr->sa_data, ETH_ALEN);
1204 
1205 	return 0;
1206 }
1207 
cfg80211_wds_wext_giwap(struct net_device * dev,struct iw_request_info * info,struct sockaddr * addr,char * extra)1208 static int cfg80211_wds_wext_giwap(struct net_device *dev,
1209 				   struct iw_request_info *info,
1210 				   struct sockaddr *addr, char *extra)
1211 {
1212 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1213 
1214 	if (WARN_ON(wdev->iftype != NL80211_IFTYPE_WDS))
1215 		return -EINVAL;
1216 
1217 	addr->sa_family = ARPHRD_ETHER;
1218 	memcpy(&addr->sa_data, wdev->wext.bssid, ETH_ALEN);
1219 
1220 	return 0;
1221 }
1222 
cfg80211_wext_siwrate(struct net_device * dev,struct iw_request_info * info,struct iw_param * rate,char * extra)1223 static int cfg80211_wext_siwrate(struct net_device *dev,
1224 				 struct iw_request_info *info,
1225 				 struct iw_param *rate, char *extra)
1226 {
1227 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1228 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1229 	struct cfg80211_bitrate_mask mask;
1230 	u32 fixed, maxrate;
1231 	struct ieee80211_supported_band *sband;
1232 	int band, ridx;
1233 	bool match = false;
1234 
1235 	if (!rdev->ops->set_bitrate_mask)
1236 		return -EOPNOTSUPP;
1237 
1238 	memset(&mask, 0, sizeof(mask));
1239 	fixed = 0;
1240 	maxrate = (u32)-1;
1241 
1242 	if (rate->value < 0) {
1243 		/* nothing */
1244 	} else if (rate->fixed) {
1245 		fixed = rate->value / 100000;
1246 	} else {
1247 		maxrate = rate->value / 100000;
1248 	}
1249 
1250 	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
1251 		sband = wdev->wiphy->bands[band];
1252 		if (sband == NULL)
1253 			continue;
1254 		for (ridx = 0; ridx < sband->n_bitrates; ridx++) {
1255 			struct ieee80211_rate *srate = &sband->bitrates[ridx];
1256 			if (fixed == srate->bitrate) {
1257 				mask.control[band].legacy = 1 << ridx;
1258 				match = true;
1259 				break;
1260 			}
1261 			if (srate->bitrate <= maxrate) {
1262 				mask.control[band].legacy |= 1 << ridx;
1263 				match = true;
1264 			}
1265 		}
1266 	}
1267 
1268 	if (!match)
1269 		return -EINVAL;
1270 
1271 	return rdev->ops->set_bitrate_mask(wdev->wiphy, dev, NULL, &mask);
1272 }
1273 
cfg80211_wext_giwrate(struct net_device * dev,struct iw_request_info * info,struct iw_param * rate,char * extra)1274 static int cfg80211_wext_giwrate(struct net_device *dev,
1275 				 struct iw_request_info *info,
1276 				 struct iw_param *rate, char *extra)
1277 {
1278 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1279 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1280 	/* we are under RTNL - globally locked - so can use a static struct */
1281 	static struct station_info sinfo;
1282 	u8 addr[ETH_ALEN];
1283 	int err;
1284 
1285 	if (wdev->iftype != NL80211_IFTYPE_STATION)
1286 		return -EOPNOTSUPP;
1287 
1288 	if (!rdev->ops->get_station)
1289 		return -EOPNOTSUPP;
1290 
1291 	err = 0;
1292 	wdev_lock(wdev);
1293 	if (wdev->current_bss)
1294 		memcpy(addr, wdev->current_bss->pub.bssid, ETH_ALEN);
1295 	else
1296 		err = -EOPNOTSUPP;
1297 	wdev_unlock(wdev);
1298 	if (err)
1299 		return err;
1300 
1301 	err = rdev->ops->get_station(&rdev->wiphy, dev, addr, &sinfo);
1302 	if (err)
1303 		return err;
1304 
1305 	if (!(sinfo.filled & STATION_INFO_TX_BITRATE))
1306 		return -EOPNOTSUPP;
1307 
1308 	rate->value = 100000 * cfg80211_calculate_bitrate(&sinfo.txrate);
1309 
1310 	return 0;
1311 }
1312 
1313 /* Get wireless statistics.  Called by /proc/net/wireless and by SIOCGIWSTATS */
cfg80211_wireless_stats(struct net_device * dev)1314 static struct iw_statistics *cfg80211_wireless_stats(struct net_device *dev)
1315 {
1316 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1317 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1318 	/* we are under RTNL - globally locked - so can use static structs */
1319 	static struct iw_statistics wstats;
1320 	static struct station_info sinfo;
1321 	u8 bssid[ETH_ALEN];
1322 
1323 	if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION)
1324 		return NULL;
1325 
1326 	if (!rdev->ops->get_station)
1327 		return NULL;
1328 
1329 	/* Grab BSSID of current BSS, if any */
1330 	wdev_lock(wdev);
1331 	if (!wdev->current_bss) {
1332 		wdev_unlock(wdev);
1333 		return NULL;
1334 	}
1335 	memcpy(bssid, wdev->current_bss->pub.bssid, ETH_ALEN);
1336 	wdev_unlock(wdev);
1337 
1338 	if (rdev->ops->get_station(&rdev->wiphy, dev, bssid, &sinfo))
1339 		return NULL;
1340 
1341 	memset(&wstats, 0, sizeof(wstats));
1342 
1343 	switch (rdev->wiphy.signal_type) {
1344 	case CFG80211_SIGNAL_TYPE_MBM:
1345 		if (sinfo.filled & STATION_INFO_SIGNAL) {
1346 			int sig = sinfo.signal;
1347 			wstats.qual.updated |= IW_QUAL_LEVEL_UPDATED;
1348 			wstats.qual.updated |= IW_QUAL_QUAL_UPDATED;
1349 			wstats.qual.updated |= IW_QUAL_DBM;
1350 			wstats.qual.level = sig;
1351 			if (sig < -110)
1352 				sig = -110;
1353 			else if (sig > -40)
1354 				sig = -40;
1355 			wstats.qual.qual = sig + 110;
1356 			break;
1357 		}
1358 	case CFG80211_SIGNAL_TYPE_UNSPEC:
1359 		if (sinfo.filled & STATION_INFO_SIGNAL) {
1360 			wstats.qual.updated |= IW_QUAL_LEVEL_UPDATED;
1361 			wstats.qual.updated |= IW_QUAL_QUAL_UPDATED;
1362 			wstats.qual.level = sinfo.signal;
1363 			wstats.qual.qual = sinfo.signal;
1364 			break;
1365 		}
1366 	default:
1367 		wstats.qual.updated |= IW_QUAL_LEVEL_INVALID;
1368 		wstats.qual.updated |= IW_QUAL_QUAL_INVALID;
1369 	}
1370 
1371 	wstats.qual.updated |= IW_QUAL_NOISE_INVALID;
1372 	if (sinfo.filled & STATION_INFO_RX_DROP_MISC)
1373 		wstats.discard.misc = sinfo.rx_dropped_misc;
1374 	if (sinfo.filled & STATION_INFO_TX_FAILED)
1375 		wstats.discard.retries = sinfo.tx_failed;
1376 
1377 	return &wstats;
1378 }
1379 
cfg80211_wext_siwap(struct net_device * dev,struct iw_request_info * info,struct sockaddr * ap_addr,char * extra)1380 static int cfg80211_wext_siwap(struct net_device *dev,
1381 			       struct iw_request_info *info,
1382 			       struct sockaddr *ap_addr, char *extra)
1383 {
1384 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1385 
1386 	switch (wdev->iftype) {
1387 	case NL80211_IFTYPE_ADHOC:
1388 		return cfg80211_ibss_wext_siwap(dev, info, ap_addr, extra);
1389 	case NL80211_IFTYPE_STATION:
1390 		return cfg80211_mgd_wext_siwap(dev, info, ap_addr, extra);
1391 	case NL80211_IFTYPE_WDS:
1392 		return cfg80211_wds_wext_siwap(dev, info, ap_addr, extra);
1393 	default:
1394 		return -EOPNOTSUPP;
1395 	}
1396 }
1397 
cfg80211_wext_giwap(struct net_device * dev,struct iw_request_info * info,struct sockaddr * ap_addr,char * extra)1398 static int cfg80211_wext_giwap(struct net_device *dev,
1399 			       struct iw_request_info *info,
1400 			       struct sockaddr *ap_addr, char *extra)
1401 {
1402 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1403 
1404 	switch (wdev->iftype) {
1405 	case NL80211_IFTYPE_ADHOC:
1406 		return cfg80211_ibss_wext_giwap(dev, info, ap_addr, extra);
1407 	case NL80211_IFTYPE_STATION:
1408 		return cfg80211_mgd_wext_giwap(dev, info, ap_addr, extra);
1409 	case NL80211_IFTYPE_WDS:
1410 		return cfg80211_wds_wext_giwap(dev, info, ap_addr, extra);
1411 	default:
1412 		return -EOPNOTSUPP;
1413 	}
1414 }
1415 
cfg80211_wext_siwessid(struct net_device * dev,struct iw_request_info * info,struct iw_point * data,char * ssid)1416 static int cfg80211_wext_siwessid(struct net_device *dev,
1417 				  struct iw_request_info *info,
1418 				  struct iw_point *data, char *ssid)
1419 {
1420 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1421 
1422 	switch (wdev->iftype) {
1423 	case NL80211_IFTYPE_ADHOC:
1424 		return cfg80211_ibss_wext_siwessid(dev, info, data, ssid);
1425 	case NL80211_IFTYPE_STATION:
1426 		return cfg80211_mgd_wext_siwessid(dev, info, data, ssid);
1427 	default:
1428 		return -EOPNOTSUPP;
1429 	}
1430 }
1431 
cfg80211_wext_giwessid(struct net_device * dev,struct iw_request_info * info,struct iw_point * data,char * ssid)1432 static int cfg80211_wext_giwessid(struct net_device *dev,
1433 				  struct iw_request_info *info,
1434 				  struct iw_point *data, char *ssid)
1435 {
1436 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1437 
1438 	data->flags = 0;
1439 	data->length = 0;
1440 
1441 	switch (wdev->iftype) {
1442 	case NL80211_IFTYPE_ADHOC:
1443 		return cfg80211_ibss_wext_giwessid(dev, info, data, ssid);
1444 	case NL80211_IFTYPE_STATION:
1445 		return cfg80211_mgd_wext_giwessid(dev, info, data, ssid);
1446 	default:
1447 		return -EOPNOTSUPP;
1448 	}
1449 }
1450 
cfg80211_wext_siwpmksa(struct net_device * dev,struct iw_request_info * info,struct iw_point * data,char * extra)1451 static int cfg80211_wext_siwpmksa(struct net_device *dev,
1452 				  struct iw_request_info *info,
1453 				  struct iw_point *data, char *extra)
1454 {
1455 	struct wireless_dev *wdev = dev->ieee80211_ptr;
1456 	struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
1457 	struct cfg80211_pmksa cfg_pmksa;
1458 	struct iw_pmksa *pmksa = (struct iw_pmksa *)extra;
1459 
1460 	memset(&cfg_pmksa, 0, sizeof(struct cfg80211_pmksa));
1461 
1462 	if (wdev->iftype != NL80211_IFTYPE_STATION)
1463 		return -EINVAL;
1464 
1465 	cfg_pmksa.bssid = pmksa->bssid.sa_data;
1466 	cfg_pmksa.pmkid = pmksa->pmkid;
1467 
1468 	switch (pmksa->cmd) {
1469 	case IW_PMKSA_ADD:
1470 		if (!rdev->ops->set_pmksa)
1471 			return -EOPNOTSUPP;
1472 
1473 		return rdev->ops->set_pmksa(&rdev->wiphy, dev, &cfg_pmksa);
1474 
1475 	case IW_PMKSA_REMOVE:
1476 		if (!rdev->ops->del_pmksa)
1477 			return -EOPNOTSUPP;
1478 
1479 		return rdev->ops->del_pmksa(&rdev->wiphy, dev, &cfg_pmksa);
1480 
1481 	case IW_PMKSA_FLUSH:
1482 		if (!rdev->ops->flush_pmksa)
1483 			return -EOPNOTSUPP;
1484 
1485 		return rdev->ops->flush_pmksa(&rdev->wiphy, dev);
1486 
1487 	default:
1488 		return -EOPNOTSUPP;
1489 	}
1490 }
1491 
1492 static const iw_handler cfg80211_handlers[] = {
1493 	[IW_IOCTL_IDX(SIOCGIWNAME)]	= (iw_handler) cfg80211_wext_giwname,
1494 	[IW_IOCTL_IDX(SIOCSIWFREQ)]	= (iw_handler) cfg80211_wext_siwfreq,
1495 	[IW_IOCTL_IDX(SIOCGIWFREQ)]	= (iw_handler) cfg80211_wext_giwfreq,
1496 	[IW_IOCTL_IDX(SIOCSIWMODE)]	= (iw_handler) cfg80211_wext_siwmode,
1497 	[IW_IOCTL_IDX(SIOCGIWMODE)]	= (iw_handler) cfg80211_wext_giwmode,
1498 	[IW_IOCTL_IDX(SIOCGIWRANGE)]	= (iw_handler) cfg80211_wext_giwrange,
1499 	[IW_IOCTL_IDX(SIOCSIWAP)]	= (iw_handler) cfg80211_wext_siwap,
1500 	[IW_IOCTL_IDX(SIOCGIWAP)]	= (iw_handler) cfg80211_wext_giwap,
1501 	[IW_IOCTL_IDX(SIOCSIWMLME)]	= (iw_handler) cfg80211_wext_siwmlme,
1502 	[IW_IOCTL_IDX(SIOCSIWSCAN)]	= (iw_handler) cfg80211_wext_siwscan,
1503 	[IW_IOCTL_IDX(SIOCGIWSCAN)]	= (iw_handler) cfg80211_wext_giwscan,
1504 	[IW_IOCTL_IDX(SIOCSIWESSID)]	= (iw_handler) cfg80211_wext_siwessid,
1505 	[IW_IOCTL_IDX(SIOCGIWESSID)]	= (iw_handler) cfg80211_wext_giwessid,
1506 	[IW_IOCTL_IDX(SIOCSIWRATE)]	= (iw_handler) cfg80211_wext_siwrate,
1507 	[IW_IOCTL_IDX(SIOCGIWRATE)]	= (iw_handler) cfg80211_wext_giwrate,
1508 	[IW_IOCTL_IDX(SIOCSIWRTS)]	= (iw_handler) cfg80211_wext_siwrts,
1509 	[IW_IOCTL_IDX(SIOCGIWRTS)]	= (iw_handler) cfg80211_wext_giwrts,
1510 	[IW_IOCTL_IDX(SIOCSIWFRAG)]	= (iw_handler) cfg80211_wext_siwfrag,
1511 	[IW_IOCTL_IDX(SIOCGIWFRAG)]	= (iw_handler) cfg80211_wext_giwfrag,
1512 	[IW_IOCTL_IDX(SIOCSIWTXPOW)]	= (iw_handler) cfg80211_wext_siwtxpower,
1513 	[IW_IOCTL_IDX(SIOCGIWTXPOW)]	= (iw_handler) cfg80211_wext_giwtxpower,
1514 	[IW_IOCTL_IDX(SIOCSIWRETRY)]	= (iw_handler) cfg80211_wext_siwretry,
1515 	[IW_IOCTL_IDX(SIOCGIWRETRY)]	= (iw_handler) cfg80211_wext_giwretry,
1516 	[IW_IOCTL_IDX(SIOCSIWENCODE)]	= (iw_handler) cfg80211_wext_siwencode,
1517 	[IW_IOCTL_IDX(SIOCGIWENCODE)]	= (iw_handler) cfg80211_wext_giwencode,
1518 	[IW_IOCTL_IDX(SIOCSIWPOWER)]	= (iw_handler) cfg80211_wext_siwpower,
1519 	[IW_IOCTL_IDX(SIOCGIWPOWER)]	= (iw_handler) cfg80211_wext_giwpower,
1520 	[IW_IOCTL_IDX(SIOCSIWGENIE)]	= (iw_handler) cfg80211_wext_siwgenie,
1521 	[IW_IOCTL_IDX(SIOCSIWAUTH)]	= (iw_handler) cfg80211_wext_siwauth,
1522 	[IW_IOCTL_IDX(SIOCGIWAUTH)]	= (iw_handler) cfg80211_wext_giwauth,
1523 	[IW_IOCTL_IDX(SIOCSIWENCODEEXT)]= (iw_handler) cfg80211_wext_siwencodeext,
1524 	[IW_IOCTL_IDX(SIOCSIWPMKSA)]	= (iw_handler) cfg80211_wext_siwpmksa,
1525 };
1526 
1527 const struct iw_handler_def cfg80211_wext_handler = {
1528 	.num_standard		= ARRAY_SIZE(cfg80211_handlers),
1529 	.standard		= cfg80211_handlers,
1530 	.get_wireless_stats = cfg80211_wireless_stats,
1531 };
1532