1 /*
2  *  Copyright (C) 2002 Intersil Americas Inc.
3  *            (C) 2003,2004 Aurelien Alleaume <slts@free.fr>
4  *            (C) 2003 Herbert Valerio Riedel <hvr@gnu.org>
5  *            (C) 2003 Luis R. Rodriguez <mcgrof@ruslug.rutgers.edu>
6  *
7  *  This program is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License as published by
9  *  the Free Software Foundation; either version 2 of the License
10  *
11  *  This program is distributed in the hope that it will be useful,
12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  *  GNU General Public License for more details.
15  *
16  *  You should have received a copy of the GNU General Public License
17  *  along with this program; if not, see <http://www.gnu.org/licenses/>.
18  *
19  */
20 
21 #include <linux/capability.h>
22 #include <linux/module.h>
23 #include <linux/kernel.h>
24 #include <linux/if_arp.h>
25 #include <linux/slab.h>
26 #include <linux/pci.h>
27 #include <linux/etherdevice.h>
28 
29 #include <linux/uaccess.h>
30 
31 #include "prismcompat.h"
32 #include "isl_ioctl.h"
33 #include "islpci_mgt.h"
34 #include "isl_oid.h"		/* additional types and defs for isl38xx fw */
35 #include "oid_mgt.h"
36 
37 #include <net/iw_handler.h>	/* New driver API */
38 
39 #define KEY_SIZE_WEP104 13	/* 104/128-bit WEP keys */
40 #define KEY_SIZE_WEP40  5	/* 40/64-bit WEP keys */
41 /* KEY_SIZE_TKIP should match isl_oid.h, struct obj_key.key[] size */
42 #define KEY_SIZE_TKIP   32	/* TKIP keys */
43 
44 static void prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid,
45 				u8 *wpa_ie, size_t wpa_ie_len);
46 static size_t prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie);
47 static int prism54_set_wpa(struct net_device *, struct iw_request_info *,
48 				__u32 *, char *);
49 
50 /* In 500 kbps */
51 static const unsigned char scan_rate_list[] = { 2, 4, 11, 22,
52 						12, 18, 24, 36,
53 						48, 72, 96, 108 };
54 
55 /**
56  * prism54_mib_mode_helper - MIB change mode helper function
57  * @mib: the &struct islpci_mib object to modify
58  * @iw_mode: new mode (%IW_MODE_*)
59  *
60  *  This is a helper function, hence it does not lock. Make sure
61  *  caller deals with locking *if* necessary. This function sets the
62  *  mode-dependent mib values and does the mapping of the Linux
63  *  Wireless API modes to Device firmware modes. It also checks for
64  *  correct valid Linux wireless modes.
65  */
66 static int
prism54_mib_mode_helper(islpci_private * priv,u32 iw_mode)67 prism54_mib_mode_helper(islpci_private *priv, u32 iw_mode)
68 {
69 	u32 config = INL_CONFIG_MANUALRUN;
70 	u32 mode, bsstype;
71 
72 	/* For now, just catch early the Repeater and Secondary modes here */
73 	if (iw_mode == IW_MODE_REPEAT || iw_mode == IW_MODE_SECOND) {
74 		printk(KERN_DEBUG
75 		       "%s(): Sorry, Repeater mode and Secondary mode "
76 		       "are not yet supported by this driver.\n", __func__);
77 		return -EINVAL;
78 	}
79 
80 	priv->iw_mode = iw_mode;
81 
82 	switch (iw_mode) {
83 	case IW_MODE_AUTO:
84 		mode = INL_MODE_CLIENT;
85 		bsstype = DOT11_BSSTYPE_ANY;
86 		break;
87 	case IW_MODE_ADHOC:
88 		mode = INL_MODE_CLIENT;
89 		bsstype = DOT11_BSSTYPE_IBSS;
90 		break;
91 	case IW_MODE_INFRA:
92 		mode = INL_MODE_CLIENT;
93 		bsstype = DOT11_BSSTYPE_INFRA;
94 		break;
95 	case IW_MODE_MASTER:
96 		mode = INL_MODE_AP;
97 		bsstype = DOT11_BSSTYPE_INFRA;
98 		break;
99 	case IW_MODE_MONITOR:
100 		mode = INL_MODE_PROMISCUOUS;
101 		bsstype = DOT11_BSSTYPE_ANY;
102 		config |= INL_CONFIG_RXANNEX;
103 		break;
104 	default:
105 		return -EINVAL;
106 	}
107 
108 	if (init_wds)
109 		config |= INL_CONFIG_WDS;
110 	mgt_set(priv, DOT11_OID_BSSTYPE, &bsstype);
111 	mgt_set(priv, OID_INL_CONFIG, &config);
112 	mgt_set(priv, OID_INL_MODE, &mode);
113 
114 	return 0;
115 }
116 
117 /**
118  * prism54_mib_init - fill MIB cache with defaults
119  *
120  *  this function initializes the struct given as @mib with defaults,
121  *  of which many are retrieved from the global module parameter
122  *  variables.
123  */
124 
125 void
prism54_mib_init(islpci_private * priv)126 prism54_mib_init(islpci_private *priv)
127 {
128 	u32 channel, authen, wep, filter, dot1x, mlme, conformance, power, mode;
129 	struct obj_buffer psm_buffer = {
130 		.size = PSM_BUFFER_SIZE,
131 		.addr = priv->device_psm_buffer
132 	};
133 
134 	channel = CARD_DEFAULT_CHANNEL;
135 	authen = CARD_DEFAULT_AUTHEN;
136 	wep = CARD_DEFAULT_WEP;
137 	filter = CARD_DEFAULT_FILTER; /* (0) Do not filter un-encrypted data */
138 	dot1x = CARD_DEFAULT_DOT1X;
139 	mlme = CARD_DEFAULT_MLME_MODE;
140 	conformance = CARD_DEFAULT_CONFORMANCE;
141 	power = 127;
142 	mode = CARD_DEFAULT_IW_MODE;
143 
144 	mgt_set(priv, DOT11_OID_CHANNEL, &channel);
145 	mgt_set(priv, DOT11_OID_AUTHENABLE, &authen);
146 	mgt_set(priv, DOT11_OID_PRIVACYINVOKED, &wep);
147 	mgt_set(priv, DOT11_OID_PSMBUFFER, &psm_buffer);
148 	mgt_set(priv, DOT11_OID_EXUNENCRYPTED, &filter);
149 	mgt_set(priv, DOT11_OID_DOT1XENABLE, &dot1x);
150 	mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlme);
151 	mgt_set(priv, OID_INL_DOT11D_CONFORMANCE, &conformance);
152 	mgt_set(priv, OID_INL_OUTPUTPOWER, &power);
153 
154 	/* This sets all of the mode-dependent values */
155 	prism54_mib_mode_helper(priv, mode);
156 }
157 
158 /* this will be executed outside of atomic context thanks to
159  * schedule_work(), thus we can as well use sleeping semaphore
160  * locking */
161 void
prism54_update_stats(struct work_struct * work)162 prism54_update_stats(struct work_struct *work)
163 {
164 	islpci_private *priv = container_of(work, islpci_private, stats_work);
165 	char *data;
166 	int j;
167 	struct obj_bss bss, *bss2;
168 	union oid_res_t r;
169 
170 	mutex_lock(&priv->stats_lock);
171 
172 /* Noise floor.
173  * I'm not sure if the unit is dBm.
174  * Note : If we are not connected, this value seems to be irrelevant. */
175 
176 	mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r);
177 	priv->local_iwstatistics.qual.noise = r.u;
178 
179 /* Get the rssi of the link. To do this we need to retrieve a bss. */
180 
181 	/* First get the MAC address of the AP we are associated with. */
182 	mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r);
183 	data = r.ptr;
184 
185 	/* copy this MAC to the bss */
186 	memcpy(bss.address, data, ETH_ALEN);
187 	kfree(data);
188 
189 	/* now ask for the corresponding bss */
190 	j = mgt_get_request(priv, DOT11_OID_BSSFIND, 0, (void *) &bss, &r);
191 	bss2 = r.ptr;
192 	/* report the rssi and use it to calculate
193 	 *  link quality through a signal-noise
194 	 *  ratio */
195 	priv->local_iwstatistics.qual.level = bss2->rssi;
196 	priv->local_iwstatistics.qual.qual =
197 	    bss2->rssi - priv->iwstatistics.qual.noise;
198 
199 	kfree(bss2);
200 
201 	/* report that the stats are new */
202 	priv->local_iwstatistics.qual.updated = 0x7;
203 
204 /* Rx : unable to decrypt the MPDU */
205 	mgt_get_request(priv, DOT11_OID_PRIVRXFAILED, 0, NULL, &r);
206 	priv->local_iwstatistics.discard.code = r.u;
207 
208 /* Tx : Max MAC retries num reached */
209 	mgt_get_request(priv, DOT11_OID_MPDUTXFAILED, 0, NULL, &r);
210 	priv->local_iwstatistics.discard.retries = r.u;
211 
212 	mutex_unlock(&priv->stats_lock);
213 }
214 
215 struct iw_statistics *
prism54_get_wireless_stats(struct net_device * ndev)216 prism54_get_wireless_stats(struct net_device *ndev)
217 {
218 	islpci_private *priv = netdev_priv(ndev);
219 
220 	/* If the stats are being updated return old data */
221 	if (mutex_trylock(&priv->stats_lock)) {
222 		memcpy(&priv->iwstatistics, &priv->local_iwstatistics,
223 		       sizeof (struct iw_statistics));
224 		/* They won't be marked updated for the next time */
225 		priv->local_iwstatistics.qual.updated = 0;
226 		mutex_unlock(&priv->stats_lock);
227 	} else
228 		priv->iwstatistics.qual.updated = 0;
229 
230 	/* Update our wireless stats, but do not schedule to often
231 	 * (max 1 HZ) */
232 	if ((priv->stats_timestamp == 0) ||
233 	    time_after(jiffies, priv->stats_timestamp + 1 * HZ)) {
234 		schedule_work(&priv->stats_work);
235 		priv->stats_timestamp = jiffies;
236 	}
237 
238 	return &priv->iwstatistics;
239 }
240 
241 static int
prism54_commit(struct net_device * ndev,struct iw_request_info * info,char * cwrq,char * extra)242 prism54_commit(struct net_device *ndev, struct iw_request_info *info,
243 	       char *cwrq, char *extra)
244 {
245 	islpci_private *priv = netdev_priv(ndev);
246 
247 	/* simply re-set the last set SSID, this should commit most stuff */
248 
249 	/* Commit in Monitor mode is not necessary, also setting essid
250 	 * in Monitor mode does not make sense and isn't allowed for this
251 	 * device's firmware */
252 	if (priv->iw_mode != IW_MODE_MONITOR)
253 		return mgt_set_request(priv, DOT11_OID_SSID, 0, NULL);
254 	return 0;
255 }
256 
257 static int
prism54_get_name(struct net_device * ndev,struct iw_request_info * info,char * cwrq,char * extra)258 prism54_get_name(struct net_device *ndev, struct iw_request_info *info,
259 		 char *cwrq, char *extra)
260 {
261 	islpci_private *priv = netdev_priv(ndev);
262 	char *capabilities;
263 	union oid_res_t r;
264 	int rvalue;
265 
266 	if (islpci_get_state(priv) < PRV_STATE_INIT) {
267 		strncpy(cwrq, "NOT READY!", IFNAMSIZ);
268 		return 0;
269 	}
270 	rvalue = mgt_get_request(priv, OID_INL_PHYCAPABILITIES, 0, NULL, &r);
271 
272 	switch (r.u) {
273 	case INL_PHYCAP_5000MHZ:
274 		capabilities = "IEEE 802.11a/b/g";
275 		break;
276 	case INL_PHYCAP_FAA:
277 		capabilities = "IEEE 802.11b/g - FAA Support";
278 		break;
279 	case INL_PHYCAP_2400MHZ:
280 	default:
281 		capabilities = "IEEE 802.11b/g";	/* Default */
282 		break;
283 	}
284 	strncpy(cwrq, capabilities, IFNAMSIZ);
285 	return rvalue;
286 }
287 
288 static int
prism54_set_freq(struct net_device * ndev,struct iw_request_info * info,struct iw_freq * fwrq,char * extra)289 prism54_set_freq(struct net_device *ndev, struct iw_request_info *info,
290 		 struct iw_freq *fwrq, char *extra)
291 {
292 	islpci_private *priv = netdev_priv(ndev);
293 	int rvalue;
294 	u32 c;
295 
296 	if (fwrq->m < 1000)
297 		/* we have a channel number */
298 		c = fwrq->m;
299 	else
300 		c = (fwrq->e == 1) ? channel_of_freq(fwrq->m / 100000) : 0;
301 
302 	rvalue = c ? mgt_set_request(priv, DOT11_OID_CHANNEL, 0, &c) : -EINVAL;
303 
304 	/* Call commit handler */
305 	return (rvalue ? rvalue : -EINPROGRESS);
306 }
307 
308 static int
prism54_get_freq(struct net_device * ndev,struct iw_request_info * info,struct iw_freq * fwrq,char * extra)309 prism54_get_freq(struct net_device *ndev, struct iw_request_info *info,
310 		 struct iw_freq *fwrq, char *extra)
311 {
312 	islpci_private *priv = netdev_priv(ndev);
313 	union oid_res_t r;
314 	int rvalue;
315 
316 	rvalue = mgt_get_request(priv, DOT11_OID_CHANNEL, 0, NULL, &r);
317 	fwrq->i = r.u;
318 	rvalue |= mgt_get_request(priv, DOT11_OID_FREQUENCY, 0, NULL, &r);
319 	fwrq->m = r.u;
320 	fwrq->e = 3;
321 
322 	return rvalue;
323 }
324 
325 static int
prism54_set_mode(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)326 prism54_set_mode(struct net_device *ndev, struct iw_request_info *info,
327 		 __u32 * uwrq, char *extra)
328 {
329 	islpci_private *priv = netdev_priv(ndev);
330 	u32 mlmeautolevel = CARD_DEFAULT_MLME_MODE;
331 
332 	/* Let's see if the user passed a valid Linux Wireless mode */
333 	if (*uwrq > IW_MODE_MONITOR || *uwrq < IW_MODE_AUTO) {
334 		printk(KERN_DEBUG
335 		       "%s: %s() You passed a non-valid init_mode.\n",
336 		       priv->ndev->name, __func__);
337 		return -EINVAL;
338 	}
339 
340 	down_write(&priv->mib_sem);
341 
342 	if (prism54_mib_mode_helper(priv, *uwrq)) {
343 		up_write(&priv->mib_sem);
344 		return -EOPNOTSUPP;
345 	}
346 
347 	/* the ACL code needs an intermediate mlmeautolevel. The wpa stuff an
348 	 * extended one.
349 	 */
350 	if ((*uwrq == IW_MODE_MASTER) && (priv->acl.policy != MAC_POLICY_OPEN))
351 		mlmeautolevel = DOT11_MLME_INTERMEDIATE;
352 	if (priv->wpa)
353 		mlmeautolevel = DOT11_MLME_EXTENDED;
354 
355 	mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel);
356 
357 	if (mgt_commit(priv)) {
358 		up_write(&priv->mib_sem);
359 		return -EIO;
360 	}
361 	priv->ndev->type = (priv->iw_mode == IW_MODE_MONITOR)
362 	    ? priv->monitor_type : ARPHRD_ETHER;
363 	up_write(&priv->mib_sem);
364 
365 	return 0;
366 }
367 
368 /* Use mib cache */
369 static int
prism54_get_mode(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)370 prism54_get_mode(struct net_device *ndev, struct iw_request_info *info,
371 		 __u32 * uwrq, char *extra)
372 {
373 	islpci_private *priv = netdev_priv(ndev);
374 
375 	BUG_ON((priv->iw_mode < IW_MODE_AUTO) || (priv->iw_mode >
376 						  IW_MODE_MONITOR));
377 	*uwrq = priv->iw_mode;
378 
379 	return 0;
380 }
381 
382 /* we use DOT11_OID_EDTHRESHOLD. From what I guess the card will not try to
383  * emit data if (sensitivity > rssi - noise) (in dBm).
384  * prism54_set_sens does not seem to work.
385  */
386 
387 static int
prism54_set_sens(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)388 prism54_set_sens(struct net_device *ndev, struct iw_request_info *info,
389 		 struct iw_param *vwrq, char *extra)
390 {
391 	islpci_private *priv = netdev_priv(ndev);
392 	u32 sens;
393 
394 	/* by default  the card sets this to 20. */
395 	sens = vwrq->disabled ? 20 : vwrq->value;
396 
397 	return mgt_set_request(priv, DOT11_OID_EDTHRESHOLD, 0, &sens);
398 }
399 
400 static int
prism54_get_sens(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)401 prism54_get_sens(struct net_device *ndev, struct iw_request_info *info,
402 		 struct iw_param *vwrq, char *extra)
403 {
404 	islpci_private *priv = netdev_priv(ndev);
405 	union oid_res_t r;
406 	int rvalue;
407 
408 	rvalue = mgt_get_request(priv, DOT11_OID_EDTHRESHOLD, 0, NULL, &r);
409 
410 	vwrq->value = r.u;
411 	vwrq->disabled = (vwrq->value == 0);
412 	vwrq->fixed = 1;
413 
414 	return rvalue;
415 }
416 
417 static int
prism54_get_range(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)418 prism54_get_range(struct net_device *ndev, struct iw_request_info *info,
419 		  struct iw_point *dwrq, char *extra)
420 {
421 	struct iw_range *range = (struct iw_range *) extra;
422 	islpci_private *priv = netdev_priv(ndev);
423 	u8 *data;
424 	int i, m, rvalue;
425 	struct obj_frequencies *freq;
426 	union oid_res_t r;
427 
428 	memset(range, 0, sizeof (struct iw_range));
429 	dwrq->length = sizeof (struct iw_range);
430 
431 	/* set the wireless extension version number */
432 	range->we_version_source = SUPPORTED_WIRELESS_EXT;
433 	range->we_version_compiled = WIRELESS_EXT;
434 
435 	/* Now the encoding capabilities */
436 	range->num_encoding_sizes = 3;
437 	/* 64(40) bits WEP */
438 	range->encoding_size[0] = 5;
439 	/* 128(104) bits WEP */
440 	range->encoding_size[1] = 13;
441 	/* 256 bits for WPA-PSK */
442 	range->encoding_size[2] = 32;
443 	/* 4 keys are allowed */
444 	range->max_encoding_tokens = 4;
445 
446 	/* we don't know the quality range... */
447 	range->max_qual.level = 0;
448 	range->max_qual.noise = 0;
449 	range->max_qual.qual = 0;
450 	/* these value describe an average quality. Needs more tweaking... */
451 	range->avg_qual.level = -80;	/* -80 dBm */
452 	range->avg_qual.noise = 0;	/* don't know what to put here */
453 	range->avg_qual.qual = 0;
454 
455 	range->sensitivity = 200;
456 
457 	/* retry limit capabilities */
458 	range->retry_capa = IW_RETRY_LIMIT | IW_RETRY_LIFETIME;
459 	range->retry_flags = IW_RETRY_LIMIT;
460 	range->r_time_flags = IW_RETRY_LIFETIME;
461 
462 	/* I don't know the range. Put stupid things here */
463 	range->min_retry = 1;
464 	range->max_retry = 65535;
465 	range->min_r_time = 1024;
466 	range->max_r_time = 65535 * 1024;
467 
468 	/* txpower is supported in dBm's */
469 	range->txpower_capa = IW_TXPOW_DBM;
470 
471 	/* Event capability (kernel + driver) */
472 	range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
473 	IW_EVENT_CAPA_MASK(SIOCGIWTHRSPY) |
474 	IW_EVENT_CAPA_MASK(SIOCGIWAP));
475 	range->event_capa[1] = IW_EVENT_CAPA_K_1;
476 	range->event_capa[4] = IW_EVENT_CAPA_MASK(IWEVCUSTOM);
477 
478 	range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
479 		IW_ENC_CAPA_CIPHER_TKIP;
480 
481 	if (islpci_get_state(priv) < PRV_STATE_INIT)
482 		return 0;
483 
484 	/* Request the device for the supported frequencies
485 	 * not really relevant since some devices will report the 5 GHz band
486 	 * frequencies even if they don't support them.
487 	 */
488 	rvalue =
489 	    mgt_get_request(priv, DOT11_OID_SUPPORTEDFREQUENCIES, 0, NULL, &r);
490 	freq = r.ptr;
491 
492 	range->num_channels = freq->nr;
493 	range->num_frequency = freq->nr;
494 
495 	m = min(IW_MAX_FREQUENCIES, (int) freq->nr);
496 	for (i = 0; i < m; i++) {
497 		range->freq[i].m = freq->mhz[i];
498 		range->freq[i].e = 6;
499 		range->freq[i].i = channel_of_freq(freq->mhz[i]);
500 	}
501 	kfree(freq);
502 
503 	rvalue |= mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r);
504 	data = r.ptr;
505 
506 	/* We got an array of char. It is NULL terminated. */
507 	i = 0;
508 	while ((i < IW_MAX_BITRATES) && (*data != 0)) {
509 		/*       the result must be in bps. The card gives us 500Kbps */
510 		range->bitrate[i] = *data * 500000;
511 		i++;
512 		data++;
513 	}
514 	range->num_bitrates = i;
515 	kfree(r.ptr);
516 
517 	return rvalue;
518 }
519 
520 /* Set AP address*/
521 
522 static int
prism54_set_wap(struct net_device * ndev,struct iw_request_info * info,struct sockaddr * awrq,char * extra)523 prism54_set_wap(struct net_device *ndev, struct iw_request_info *info,
524 		struct sockaddr *awrq, char *extra)
525 {
526 	islpci_private *priv = netdev_priv(ndev);
527 	char bssid[6];
528 	int rvalue;
529 
530 	if (awrq->sa_family != ARPHRD_ETHER)
531 		return -EINVAL;
532 
533 	/* prepare the structure for the set object */
534 	memcpy(&bssid[0], awrq->sa_data, ETH_ALEN);
535 
536 	/* set the bssid -- does this make sense when in AP mode? */
537 	rvalue = mgt_set_request(priv, DOT11_OID_BSSID, 0, &bssid);
538 
539 	return (rvalue ? rvalue : -EINPROGRESS);	/* Call commit handler */
540 }
541 
542 /* get AP address*/
543 
544 static int
prism54_get_wap(struct net_device * ndev,struct iw_request_info * info,struct sockaddr * awrq,char * extra)545 prism54_get_wap(struct net_device *ndev, struct iw_request_info *info,
546 		struct sockaddr *awrq, char *extra)
547 {
548 	islpci_private *priv = netdev_priv(ndev);
549 	union oid_res_t r;
550 	int rvalue;
551 
552 	rvalue = mgt_get_request(priv, DOT11_OID_BSSID, 0, NULL, &r);
553 	memcpy(awrq->sa_data, r.ptr, ETH_ALEN);
554 	awrq->sa_family = ARPHRD_ETHER;
555 	kfree(r.ptr);
556 
557 	return rvalue;
558 }
559 
560 static int
prism54_set_scan(struct net_device * dev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)561 prism54_set_scan(struct net_device *dev, struct iw_request_info *info,
562 		 struct iw_param *vwrq, char *extra)
563 {
564 	/* hehe the device does this automagicaly */
565 	return 0;
566 }
567 
568 /* a little helper that will translate our data into a card independent
569  * format that the Wireless Tools will understand. This was inspired by
570  * the "Aironet driver for 4500 and 4800 series cards" (GPL)
571  */
572 
573 static char *
prism54_translate_bss(struct net_device * ndev,struct iw_request_info * info,char * current_ev,char * end_buf,struct obj_bss * bss,char noise)574 prism54_translate_bss(struct net_device *ndev, struct iw_request_info *info,
575 		      char *current_ev, char *end_buf, struct obj_bss *bss,
576 		      char noise)
577 {
578 	struct iw_event iwe;	/* Temporary buffer */
579 	short cap;
580 	islpci_private *priv = netdev_priv(ndev);
581 	u8 wpa_ie[MAX_WPA_IE_LEN];
582 	size_t wpa_ie_len;
583 
584 	/* The first entry must be the MAC address */
585 	memcpy(iwe.u.ap_addr.sa_data, bss->address, ETH_ALEN);
586 	iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
587 	iwe.cmd = SIOCGIWAP;
588 	current_ev = iwe_stream_add_event(info, current_ev, end_buf,
589 					  &iwe, IW_EV_ADDR_LEN);
590 
591 	/* The following entries will be displayed in the same order we give them */
592 
593 	/* The ESSID. */
594 	iwe.u.data.length = bss->ssid.length;
595 	iwe.u.data.flags = 1;
596 	iwe.cmd = SIOCGIWESSID;
597 	current_ev = iwe_stream_add_point(info, current_ev, end_buf,
598 					  &iwe, bss->ssid.octets);
599 
600 	/* Capabilities */
601 #define CAP_ESS 0x01
602 #define CAP_IBSS 0x02
603 #define CAP_CRYPT 0x10
604 
605 	/* Mode */
606 	cap = bss->capinfo;
607 	iwe.u.mode = 0;
608 	if (cap & CAP_ESS)
609 		iwe.u.mode = IW_MODE_MASTER;
610 	else if (cap & CAP_IBSS)
611 		iwe.u.mode = IW_MODE_ADHOC;
612 	iwe.cmd = SIOCGIWMODE;
613 	if (iwe.u.mode)
614 		current_ev = iwe_stream_add_event(info, current_ev, end_buf,
615 						  &iwe, IW_EV_UINT_LEN);
616 
617 	/* Encryption capability */
618 	if (cap & CAP_CRYPT)
619 		iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
620 	else
621 		iwe.u.data.flags = IW_ENCODE_DISABLED;
622 	iwe.u.data.length = 0;
623 	iwe.cmd = SIOCGIWENCODE;
624 	current_ev = iwe_stream_add_point(info, current_ev, end_buf,
625 					  &iwe, NULL);
626 
627 	/* Add frequency. (short) bss->channel is the frequency in MHz */
628 	iwe.u.freq.m = bss->channel;
629 	iwe.u.freq.e = 6;
630 	iwe.cmd = SIOCGIWFREQ;
631 	current_ev = iwe_stream_add_event(info, current_ev, end_buf,
632 					  &iwe, IW_EV_FREQ_LEN);
633 
634 	/* Add quality statistics */
635 	iwe.u.qual.level = bss->rssi;
636 	iwe.u.qual.noise = noise;
637 	/* do a simple SNR for quality */
638 	iwe.u.qual.qual = bss->rssi - noise;
639 	iwe.cmd = IWEVQUAL;
640 	current_ev = iwe_stream_add_event(info, current_ev, end_buf,
641 					  &iwe, IW_EV_QUAL_LEN);
642 
643 	/* Add WPA/RSN Information Element, if any */
644 	wpa_ie_len = prism54_wpa_bss_ie_get(priv, bss->address, wpa_ie);
645 	if (wpa_ie_len > 0) {
646 		iwe.cmd = IWEVGENIE;
647 		iwe.u.data.length = min_t(size_t, wpa_ie_len, MAX_WPA_IE_LEN);
648 		current_ev = iwe_stream_add_point(info, current_ev, end_buf,
649 						  &iwe, wpa_ie);
650 	}
651 	/* Do the bitrates */
652 	{
653 		char *current_val = current_ev + iwe_stream_lcp_len(info);
654 		int i;
655 		int mask;
656 
657 		iwe.cmd = SIOCGIWRATE;
658 		/* Those two flags are ignored... */
659 		iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
660 
661 		/* Parse the bitmask */
662 		mask = 0x1;
663 		for(i = 0; i < sizeof(scan_rate_list); i++) {
664 			if(bss->rates & mask) {
665 				iwe.u.bitrate.value = (scan_rate_list[i] * 500000);
666 				current_val = iwe_stream_add_value(
667 					info, current_ev, current_val,
668 					end_buf, &iwe, IW_EV_PARAM_LEN);
669 			}
670 			mask <<= 1;
671 		}
672 		/* Check if we added any event */
673 		if ((current_val - current_ev) > iwe_stream_lcp_len(info))
674 			current_ev = current_val;
675 	}
676 
677 	return current_ev;
678 }
679 
680 static int
prism54_get_scan(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)681 prism54_get_scan(struct net_device *ndev, struct iw_request_info *info,
682 		 struct iw_point *dwrq, char *extra)
683 {
684 	islpci_private *priv = netdev_priv(ndev);
685 	int i, rvalue;
686 	struct obj_bsslist *bsslist;
687 	u32 noise = 0;
688 	char *current_ev = extra;
689 	union oid_res_t r;
690 
691 	if (islpci_get_state(priv) < PRV_STATE_INIT) {
692 		/* device is not ready, fail gently */
693 		dwrq->length = 0;
694 		return 0;
695 	}
696 
697 	/* first get the noise value. We will use it to report the link quality */
698 	rvalue = mgt_get_request(priv, DOT11_OID_NOISEFLOOR, 0, NULL, &r);
699 	noise = r.u;
700 
701 	/* Ask the device for a list of known bss.
702 	* The old API, using SIOCGIWAPLIST, had a hard limit of IW_MAX_AP=64.
703 	* The new API, using SIOCGIWSCAN, is only limited by the buffer size.
704 	* WE-14->WE-16, the buffer is limited to IW_SCAN_MAX_DATA bytes.
705 	* Starting with WE-17, the buffer can be as big as needed.
706 	* But the device won't repport anything if you change the value
707 	* of IWMAX_BSS=24. */
708 
709 	rvalue |= mgt_get_request(priv, DOT11_OID_BSSLIST, 0, NULL, &r);
710 	bsslist = r.ptr;
711 
712 	/* ok now, scan the list and translate its info */
713 	for (i = 0; i < (int) bsslist->nr; i++) {
714 		current_ev = prism54_translate_bss(ndev, info, current_ev,
715 						   extra + dwrq->length,
716 						   &(bsslist->bsslist[i]),
717 						   noise);
718 
719 		/* Check if there is space for one more entry */
720 		if((extra + dwrq->length - current_ev) <= IW_EV_ADDR_LEN) {
721 			/* Ask user space to try again with a bigger buffer */
722 			rvalue = -E2BIG;
723 			break;
724 		}
725 	}
726 
727 	kfree(bsslist);
728 	dwrq->length = (current_ev - extra);
729 	dwrq->flags = 0;	/* todo */
730 
731 	return rvalue;
732 }
733 
734 static int
prism54_set_essid(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)735 prism54_set_essid(struct net_device *ndev, struct iw_request_info *info,
736 		  struct iw_point *dwrq, char *extra)
737 {
738 	islpci_private *priv = netdev_priv(ndev);
739 	struct obj_ssid essid;
740 
741 	memset(essid.octets, 0, 33);
742 
743 	/* Check if we were asked for `any' */
744 	if (dwrq->flags && dwrq->length) {
745 		if (dwrq->length > 32)
746 			return -E2BIG;
747 		essid.length = dwrq->length;
748 		memcpy(essid.octets, extra, dwrq->length);
749 	} else
750 		essid.length = 0;
751 
752 	if (priv->iw_mode != IW_MODE_MONITOR)
753 		return mgt_set_request(priv, DOT11_OID_SSID, 0, &essid);
754 
755 	/* If in monitor mode, just save to mib */
756 	mgt_set(priv, DOT11_OID_SSID, &essid);
757 	return 0;
758 
759 }
760 
761 static int
prism54_get_essid(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)762 prism54_get_essid(struct net_device *ndev, struct iw_request_info *info,
763 		  struct iw_point *dwrq, char *extra)
764 {
765 	islpci_private *priv = netdev_priv(ndev);
766 	struct obj_ssid *essid;
767 	union oid_res_t r;
768 	int rvalue;
769 
770 	rvalue = mgt_get_request(priv, DOT11_OID_SSID, 0, NULL, &r);
771 	essid = r.ptr;
772 
773 	if (essid->length) {
774 		dwrq->flags = 1;	/* set ESSID to ON for Wireless Extensions */
775 		/* if it is too big, trunk it */
776 		dwrq->length = min((u8)IW_ESSID_MAX_SIZE, essid->length);
777 	} else {
778 		dwrq->flags = 0;
779 		dwrq->length = 0;
780 	}
781 	essid->octets[dwrq->length] = '\0';
782 	memcpy(extra, essid->octets, dwrq->length);
783 	kfree(essid);
784 
785 	return rvalue;
786 }
787 
788 /* Provides no functionality, just completes the ioctl. In essence this is a
789  * just a cosmetic ioctl.
790  */
791 static int
prism54_set_nick(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)792 prism54_set_nick(struct net_device *ndev, struct iw_request_info *info,
793 		 struct iw_point *dwrq, char *extra)
794 {
795 	islpci_private *priv = netdev_priv(ndev);
796 
797 	if (dwrq->length > IW_ESSID_MAX_SIZE)
798 		return -E2BIG;
799 
800 	down_write(&priv->mib_sem);
801 	memset(priv->nickname, 0, sizeof (priv->nickname));
802 	memcpy(priv->nickname, extra, dwrq->length);
803 	up_write(&priv->mib_sem);
804 
805 	return 0;
806 }
807 
808 static int
prism54_get_nick(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)809 prism54_get_nick(struct net_device *ndev, struct iw_request_info *info,
810 		 struct iw_point *dwrq, char *extra)
811 {
812 	islpci_private *priv = netdev_priv(ndev);
813 
814 	dwrq->length = 0;
815 
816 	down_read(&priv->mib_sem);
817 	dwrq->length = strlen(priv->nickname);
818 	memcpy(extra, priv->nickname, dwrq->length);
819 	up_read(&priv->mib_sem);
820 
821 	return 0;
822 }
823 
824 /* Set the allowed Bitrates */
825 
826 static int
prism54_set_rate(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)827 prism54_set_rate(struct net_device *ndev,
828 		 struct iw_request_info *info,
829 		 struct iw_param *vwrq, char *extra)
830 {
831 
832 	islpci_private *priv = netdev_priv(ndev);
833 	u32 rate, profile;
834 	char *data;
835 	int ret, i;
836 	union oid_res_t r;
837 
838 	if (vwrq->value == -1) {
839 		/* auto mode. No limit. */
840 		profile = 1;
841 		return mgt_set_request(priv, DOT11_OID_PROFILES, 0, &profile);
842 	}
843 
844 	ret = mgt_get_request(priv, DOT11_OID_SUPPORTEDRATES, 0, NULL, &r);
845 	if (ret) {
846 		kfree(r.ptr);
847 		return ret;
848 	}
849 
850 	rate = (u32) (vwrq->value / 500000);
851 	data = r.ptr;
852 	i = 0;
853 
854 	while (data[i]) {
855 		if (rate && (data[i] == rate)) {
856 			break;
857 		}
858 		if (vwrq->value == i) {
859 			break;
860 		}
861 		data[i] |= 0x80;
862 		i++;
863 	}
864 
865 	if (!data[i]) {
866 		kfree(r.ptr);
867 		return -EINVAL;
868 	}
869 
870 	data[i] |= 0x80;
871 	data[i + 1] = 0;
872 
873 	/* Now, check if we want a fixed or auto value */
874 	if (vwrq->fixed) {
875 		data[0] = data[i];
876 		data[1] = 0;
877 	}
878 
879 /*
880 	i = 0;
881 	printk("prism54 rate: ");
882 	while(data[i]) {
883 		printk("%u ", data[i]);
884 		i++;
885 	}
886 	printk("0\n");
887 */
888 	profile = -1;
889 	ret = mgt_set_request(priv, DOT11_OID_PROFILES, 0, &profile);
890 	ret |= mgt_set_request(priv, DOT11_OID_EXTENDEDRATES, 0, data);
891 	ret |= mgt_set_request(priv, DOT11_OID_RATES, 0, data);
892 
893 	kfree(r.ptr);
894 
895 	return ret;
896 }
897 
898 /* Get the current bit rate */
899 static int
prism54_get_rate(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)900 prism54_get_rate(struct net_device *ndev,
901 		 struct iw_request_info *info,
902 		 struct iw_param *vwrq, char *extra)
903 {
904 	islpci_private *priv = netdev_priv(ndev);
905 	int rvalue;
906 	char *data;
907 	union oid_res_t r;
908 
909 	/* Get the current bit rate */
910 	if ((rvalue = mgt_get_request(priv, GEN_OID_LINKSTATE, 0, NULL, &r)))
911 		return rvalue;
912 	vwrq->value = r.u * 500000;
913 
914 	/* request the device for the enabled rates */
915 	rvalue = mgt_get_request(priv, DOT11_OID_RATES, 0, NULL, &r);
916 	if (rvalue) {
917 		kfree(r.ptr);
918 		return rvalue;
919 	}
920 	data = r.ptr;
921 	vwrq->fixed = (data[0] != 0) && (data[1] == 0);
922 	kfree(r.ptr);
923 
924 	return 0;
925 }
926 
927 static int
prism54_set_rts(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)928 prism54_set_rts(struct net_device *ndev, struct iw_request_info *info,
929 		struct iw_param *vwrq, char *extra)
930 {
931 	islpci_private *priv = netdev_priv(ndev);
932 
933 	return mgt_set_request(priv, DOT11_OID_RTSTHRESH, 0, &vwrq->value);
934 }
935 
936 static int
prism54_get_rts(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)937 prism54_get_rts(struct net_device *ndev, struct iw_request_info *info,
938 		struct iw_param *vwrq, char *extra)
939 {
940 	islpci_private *priv = netdev_priv(ndev);
941 	union oid_res_t r;
942 	int rvalue;
943 
944 	/* get the rts threshold */
945 	rvalue = mgt_get_request(priv, DOT11_OID_RTSTHRESH, 0, NULL, &r);
946 	vwrq->value = r.u;
947 
948 	return rvalue;
949 }
950 
951 static int
prism54_set_frag(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)952 prism54_set_frag(struct net_device *ndev, struct iw_request_info *info,
953 		 struct iw_param *vwrq, char *extra)
954 {
955 	islpci_private *priv = netdev_priv(ndev);
956 
957 	return mgt_set_request(priv, DOT11_OID_FRAGTHRESH, 0, &vwrq->value);
958 }
959 
960 static int
prism54_get_frag(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)961 prism54_get_frag(struct net_device *ndev, struct iw_request_info *info,
962 		 struct iw_param *vwrq, char *extra)
963 {
964 	islpci_private *priv = netdev_priv(ndev);
965 	union oid_res_t r;
966 	int rvalue;
967 
968 	rvalue = mgt_get_request(priv, DOT11_OID_FRAGTHRESH, 0, NULL, &r);
969 	vwrq->value = r.u;
970 
971 	return rvalue;
972 }
973 
974 /* Here we have (min,max) = max retries for (small frames, big frames). Where
975  * big frame <=>  bigger than the rts threshold
976  * small frame <=>  smaller than the rts threshold
977  * This is not really the behavior expected by the wireless tool but it seems
978  * to be a common behavior in other drivers.
979  */
980 
981 static int
prism54_set_retry(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)982 prism54_set_retry(struct net_device *ndev, struct iw_request_info *info,
983 		  struct iw_param *vwrq, char *extra)
984 {
985 	islpci_private *priv = netdev_priv(ndev);
986 	u32 slimit = 0, llimit = 0;	/* short and long limit */
987 	u32 lifetime = 0;
988 	int rvalue = 0;
989 
990 	if (vwrq->disabled)
991 		/* we cannot disable this feature */
992 		return -EINVAL;
993 
994 	if (vwrq->flags & IW_RETRY_LIMIT) {
995 		if (vwrq->flags & IW_RETRY_SHORT)
996 			slimit = vwrq->value;
997 		else if (vwrq->flags & IW_RETRY_LONG)
998 			llimit = vwrq->value;
999 		else {
1000 			/* we are asked to set both */
1001 			slimit = vwrq->value;
1002 			llimit = vwrq->value;
1003 		}
1004 	}
1005 	if (vwrq->flags & IW_RETRY_LIFETIME)
1006 		/* Wireless tools use us unit while the device uses 1024 us unit */
1007 		lifetime = vwrq->value / 1024;
1008 
1009 	/* now set what is requested */
1010 	if (slimit)
1011 		rvalue =
1012 		    mgt_set_request(priv, DOT11_OID_SHORTRETRIES, 0, &slimit);
1013 	if (llimit)
1014 		rvalue |=
1015 		    mgt_set_request(priv, DOT11_OID_LONGRETRIES, 0, &llimit);
1016 	if (lifetime)
1017 		rvalue |=
1018 		    mgt_set_request(priv, DOT11_OID_MAXTXLIFETIME, 0,
1019 				    &lifetime);
1020 	return rvalue;
1021 }
1022 
1023 static int
prism54_get_retry(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)1024 prism54_get_retry(struct net_device *ndev, struct iw_request_info *info,
1025 		  struct iw_param *vwrq, char *extra)
1026 {
1027 	islpci_private *priv = netdev_priv(ndev);
1028 	union oid_res_t r;
1029 	int rvalue = 0;
1030 	vwrq->disabled = 0;	/* It cannot be disabled */
1031 
1032 	if ((vwrq->flags & IW_RETRY_TYPE) == IW_RETRY_LIFETIME) {
1033 		/* we are asked for the life time */
1034 		rvalue =
1035 		    mgt_get_request(priv, DOT11_OID_MAXTXLIFETIME, 0, NULL, &r);
1036 		vwrq->value = r.u * 1024;
1037 		vwrq->flags = IW_RETRY_LIFETIME;
1038 	} else if ((vwrq->flags & IW_RETRY_LONG)) {
1039 		/* we are asked for the long retry limit */
1040 		rvalue |=
1041 		    mgt_get_request(priv, DOT11_OID_LONGRETRIES, 0, NULL, &r);
1042 		vwrq->value = r.u;
1043 		vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
1044 	} else {
1045 		/* default. get the  short retry limit */
1046 		rvalue |=
1047 		    mgt_get_request(priv, DOT11_OID_SHORTRETRIES, 0, NULL, &r);
1048 		vwrq->value = r.u;
1049 		vwrq->flags = IW_RETRY_LIMIT | IW_RETRY_SHORT;
1050 	}
1051 
1052 	return rvalue;
1053 }
1054 
1055 static int
prism54_set_encode(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)1056 prism54_set_encode(struct net_device *ndev, struct iw_request_info *info,
1057 		   struct iw_point *dwrq, char *extra)
1058 {
1059 	islpci_private *priv = netdev_priv(ndev);
1060 	int rvalue = 0, force = 0;
1061 	int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0;
1062 	union oid_res_t r;
1063 
1064 	/* with the new API, it's impossible to get a NULL pointer.
1065 	 * New version of iwconfig set the IW_ENCODE_NOKEY flag
1066 	 * when no key is given, but older versions don't. */
1067 
1068 	if (dwrq->length > 0) {
1069 		/* we have a key to set */
1070 		int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1071 		int current_index;
1072 		struct obj_key key = { DOT11_PRIV_WEP, 0, "" };
1073 
1074 		/* get the current key index */
1075 		rvalue = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1076 		current_index = r.u;
1077 		/* Verify that the key is not marked as invalid */
1078 		if (!(dwrq->flags & IW_ENCODE_NOKEY)) {
1079 			if (dwrq->length > KEY_SIZE_TKIP) {
1080 				/* User-provided key data too big */
1081 				return -EINVAL;
1082 			}
1083 			if (dwrq->length > KEY_SIZE_WEP104) {
1084 				/* WPA-PSK TKIP */
1085 				key.type = DOT11_PRIV_TKIP;
1086 				key.length = KEY_SIZE_TKIP;
1087 			} else if (dwrq->length > KEY_SIZE_WEP40) {
1088 				/* WEP 104/128 */
1089 				key.length = KEY_SIZE_WEP104;
1090 			} else {
1091 				/* WEP 40/64 */
1092 				key.length = KEY_SIZE_WEP40;
1093 			}
1094 			memset(key.key, 0, sizeof (key.key));
1095 			memcpy(key.key, extra, dwrq->length);
1096 
1097 			if ((index < 0) || (index > 3))
1098 				/* no index provided use the current one */
1099 				index = current_index;
1100 
1101 			/* now send the key to the card  */
1102 			rvalue |=
1103 			    mgt_set_request(priv, DOT11_OID_DEFKEYX, index,
1104 					    &key);
1105 		}
1106 		/*
1107 		 * If a valid key is set, encryption should be enabled
1108 		 * (user may turn it off later).
1109 		 * This is also how "iwconfig ethX key on" works
1110 		 */
1111 		if ((index == current_index) && (key.length > 0))
1112 			force = 1;
1113 	} else {
1114 		int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1115 		if ((index >= 0) && (index <= 3)) {
1116 			/* we want to set the key index */
1117 			rvalue |=
1118 			    mgt_set_request(priv, DOT11_OID_DEFKEYID, 0,
1119 					    &index);
1120 		} else {
1121 			if (!(dwrq->flags & IW_ENCODE_MODE)) {
1122 				/* we cannot do anything. Complain. */
1123 				return -EINVAL;
1124 			}
1125 		}
1126 	}
1127 	/* now read the flags */
1128 	if (dwrq->flags & IW_ENCODE_DISABLED) {
1129 		/* Encoding disabled,
1130 		 * authen = DOT11_AUTH_OS;
1131 		 * invoke = 0;
1132 		 * exunencrypt = 0; */
1133 	}
1134 	if (dwrq->flags & IW_ENCODE_OPEN)
1135 		/* Encode but accept non-encoded packets. No auth */
1136 		invoke = 1;
1137 	if ((dwrq->flags & IW_ENCODE_RESTRICTED) || force) {
1138 		/* Refuse non-encoded packets. Auth */
1139 		authen = DOT11_AUTH_BOTH;
1140 		invoke = 1;
1141 		exunencrypt = 1;
1142 	}
1143 	/* do the change if requested  */
1144 	if ((dwrq->flags & IW_ENCODE_MODE) || force) {
1145 		rvalue |=
1146 		    mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
1147 		rvalue |=
1148 		    mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &invoke);
1149 		rvalue |=
1150 		    mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0,
1151 				    &exunencrypt);
1152 	}
1153 	return rvalue;
1154 }
1155 
1156 static int
prism54_get_encode(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)1157 prism54_get_encode(struct net_device *ndev, struct iw_request_info *info,
1158 		   struct iw_point *dwrq, char *extra)
1159 {
1160 	islpci_private *priv = netdev_priv(ndev);
1161 	struct obj_key *key;
1162 	u32 devindex, index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
1163 	u32 authen = 0, invoke = 0, exunencrypt = 0;
1164 	int rvalue;
1165 	union oid_res_t r;
1166 
1167 	/* first get the flags */
1168 	rvalue = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1169 	authen = r.u;
1170 	rvalue |= mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1171 	invoke = r.u;
1172 	rvalue |= mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1173 	exunencrypt = r.u;
1174 
1175 	if (invoke && (authen == DOT11_AUTH_BOTH) && exunencrypt)
1176 		dwrq->flags = IW_ENCODE_RESTRICTED;
1177 	else if ((authen == DOT11_AUTH_OS) && !exunencrypt) {
1178 		if (invoke)
1179 			dwrq->flags = IW_ENCODE_OPEN;
1180 		else
1181 			dwrq->flags = IW_ENCODE_DISABLED;
1182 	} else
1183 		/* The card should not work in this state */
1184 		dwrq->flags = 0;
1185 
1186 	/* get the current device key index */
1187 	rvalue |= mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1188 	devindex = r.u;
1189 	/* Now get the key, return it */
1190 	if (index == -1 || index > 3)
1191 		/* no index provided, use the current one */
1192 		index = devindex;
1193 	rvalue |= mgt_get_request(priv, DOT11_OID_DEFKEYX, index, NULL, &r);
1194 	key = r.ptr;
1195 	dwrq->length = key->length;
1196 	memcpy(extra, key->key, dwrq->length);
1197 	kfree(key);
1198 	/* return the used key index */
1199 	dwrq->flags |= devindex + 1;
1200 
1201 	return rvalue;
1202 }
1203 
1204 static int
prism54_get_txpower(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)1205 prism54_get_txpower(struct net_device *ndev, struct iw_request_info *info,
1206 		    struct iw_param *vwrq, char *extra)
1207 {
1208 	islpci_private *priv = netdev_priv(ndev);
1209 	union oid_res_t r;
1210 	int rvalue;
1211 
1212 	rvalue = mgt_get_request(priv, OID_INL_OUTPUTPOWER, 0, NULL, &r);
1213 	/* intersil firmware operates in 0.25 dBm (1/4 dBm) */
1214 	vwrq->value = (s32) r.u / 4;
1215 	vwrq->fixed = 1;
1216 	/* radio is not turned of
1217 	 * btw: how is possible to turn off only the radio
1218 	 */
1219 	vwrq->disabled = 0;
1220 
1221 	return rvalue;
1222 }
1223 
1224 static int
prism54_set_txpower(struct net_device * ndev,struct iw_request_info * info,struct iw_param * vwrq,char * extra)1225 prism54_set_txpower(struct net_device *ndev, struct iw_request_info *info,
1226 		    struct iw_param *vwrq, char *extra)
1227 {
1228 	islpci_private *priv = netdev_priv(ndev);
1229 	s32 u = vwrq->value;
1230 
1231 	/* intersil firmware operates in 0.25 dBm (1/4) */
1232 	u *= 4;
1233 	if (vwrq->disabled) {
1234 		/* don't know how to disable radio */
1235 		printk(KERN_DEBUG
1236 		       "%s: %s() disabling radio is not yet supported.\n",
1237 		       priv->ndev->name, __func__);
1238 		return -ENOTSUPP;
1239 	} else if (vwrq->fixed)
1240 		/* currently only fixed value is supported */
1241 		return mgt_set_request(priv, OID_INL_OUTPUTPOWER, 0, &u);
1242 	else {
1243 		printk(KERN_DEBUG
1244 		       "%s: %s() auto power will be implemented later.\n",
1245 		       priv->ndev->name, __func__);
1246 		return -ENOTSUPP;
1247 	}
1248 }
1249 
prism54_set_genie(struct net_device * ndev,struct iw_request_info * info,struct iw_point * data,char * extra)1250 static int prism54_set_genie(struct net_device *ndev,
1251 			     struct iw_request_info *info,
1252 			     struct iw_point *data, char *extra)
1253 {
1254 	islpci_private *priv = netdev_priv(ndev);
1255 	int alen, ret = 0;
1256 	struct obj_attachment *attach;
1257 
1258 	if (data->length > MAX_WPA_IE_LEN ||
1259 	    (data->length && extra == NULL))
1260 		return -EINVAL;
1261 
1262 	memcpy(priv->wpa_ie, extra, data->length);
1263 	priv->wpa_ie_len = data->length;
1264 
1265 	alen = sizeof(*attach) + priv->wpa_ie_len;
1266 	attach = kzalloc(alen, GFP_KERNEL);
1267 	if (attach == NULL)
1268 		return -ENOMEM;
1269 
1270 #define WLAN_FC_TYPE_MGMT 0
1271 #define WLAN_FC_STYPE_ASSOC_REQ 0
1272 #define WLAN_FC_STYPE_REASSOC_REQ 2
1273 
1274 	/* Note: endianness is covered by mgt_set_varlen */
1275 	attach->type = (WLAN_FC_TYPE_MGMT << 2) |
1276                (WLAN_FC_STYPE_ASSOC_REQ << 4);
1277 	attach->id = -1;
1278 	attach->size = priv->wpa_ie_len;
1279 	memcpy(attach->data, extra, priv->wpa_ie_len);
1280 
1281 	ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach,
1282 		priv->wpa_ie_len);
1283 	if (ret == 0) {
1284 		attach->type = (WLAN_FC_TYPE_MGMT << 2) |
1285 			(WLAN_FC_STYPE_REASSOC_REQ << 4);
1286 
1287 		ret = mgt_set_varlen(priv, DOT11_OID_ATTACHMENT, attach,
1288 			priv->wpa_ie_len);
1289 		if (ret == 0)
1290 			printk(KERN_DEBUG "%s: WPA IE Attachment was set\n",
1291 				ndev->name);
1292 	}
1293 
1294 	kfree(attach);
1295 	return ret;
1296 }
1297 
1298 
prism54_get_genie(struct net_device * ndev,struct iw_request_info * info,struct iw_point * data,char * extra)1299 static int prism54_get_genie(struct net_device *ndev,
1300 			     struct iw_request_info *info,
1301 			     struct iw_point *data, char *extra)
1302 {
1303 	islpci_private *priv = netdev_priv(ndev);
1304 	int len = priv->wpa_ie_len;
1305 
1306 	if (len <= 0) {
1307 		data->length = 0;
1308 		return 0;
1309 	}
1310 
1311 	if (data->length < len)
1312 		return -E2BIG;
1313 
1314 	data->length = len;
1315 	memcpy(extra, priv->wpa_ie, len);
1316 
1317 	return 0;
1318 }
1319 
prism54_set_auth(struct net_device * ndev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1320 static int prism54_set_auth(struct net_device *ndev,
1321 			       struct iw_request_info *info,
1322 			       union iwreq_data *wrqu, char *extra)
1323 {
1324 	islpci_private *priv = netdev_priv(ndev);
1325 	struct iw_param *param = &wrqu->param;
1326 	u32 mlmelevel = 0, authen = 0, dot1x = 0;
1327 	u32 exunencrypt = 0, privinvoked = 0, wpa = 0;
1328 	u32 old_wpa;
1329 	int ret = 0;
1330 	union oid_res_t r;
1331 
1332 	if (islpci_get_state(priv) < PRV_STATE_INIT)
1333 		return 0;
1334 
1335 	/* first get the flags */
1336 	down_write(&priv->mib_sem);
1337 	wpa = old_wpa = priv->wpa;
1338 	up_write(&priv->mib_sem);
1339 	ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1340 	authen = r.u;
1341 	ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1342 	privinvoked = r.u;
1343 	ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1344 	exunencrypt = r.u;
1345 	ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r);
1346 	dot1x = r.u;
1347 	ret = mgt_get_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, NULL, &r);
1348 	mlmelevel = r.u;
1349 
1350 	if (ret < 0)
1351 		goto out;
1352 
1353 	switch (param->flags & IW_AUTH_INDEX) {
1354 	case IW_AUTH_CIPHER_PAIRWISE:
1355 	case IW_AUTH_CIPHER_GROUP:
1356 	case IW_AUTH_KEY_MGMT:
1357 		break;
1358 
1359 	case IW_AUTH_WPA_ENABLED:
1360 		/* Do the same thing as IW_AUTH_WPA_VERSION */
1361 		if (param->value) {
1362 			wpa = 1;
1363 			privinvoked = 1; /* For privacy invoked */
1364 			exunencrypt = 1; /* Filter out all unencrypted frames */
1365 			dot1x = 0x01; /* To enable eap filter */
1366 			mlmelevel = DOT11_MLME_EXTENDED;
1367 			authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
1368 		} else {
1369 			wpa = 0;
1370 			privinvoked = 0;
1371 			exunencrypt = 0; /* Do not filter un-encrypted data */
1372 			dot1x = 0;
1373 			mlmelevel = DOT11_MLME_AUTO;
1374 		}
1375 		break;
1376 
1377 	case IW_AUTH_WPA_VERSION:
1378 		if (param->value & IW_AUTH_WPA_VERSION_DISABLED) {
1379 			wpa = 0;
1380 			privinvoked = 0;
1381 			exunencrypt = 0; /* Do not filter un-encrypted data */
1382 			dot1x = 0;
1383 			mlmelevel = DOT11_MLME_AUTO;
1384 		} else {
1385 			if (param->value & IW_AUTH_WPA_VERSION_WPA)
1386 				wpa = 1;
1387 			else if (param->value & IW_AUTH_WPA_VERSION_WPA2)
1388 				wpa = 2;
1389 			privinvoked = 1; /* For privacy invoked */
1390 			exunencrypt = 1; /* Filter out all unencrypted frames */
1391 			dot1x = 0x01; /* To enable eap filter */
1392 			mlmelevel = DOT11_MLME_EXTENDED;
1393 			authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
1394 		}
1395 		break;
1396 
1397 	case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1398 		/* dot1x should be the opposite of RX_UNENCRYPTED_EAPOL;
1399 		 * turn off dot1x when allowing receipt of unencrypted EAPOL
1400 		 * frames, turn on dot1x when receipt should be disallowed
1401 		 */
1402 		dot1x = param->value ? 0 : 0x01;
1403 		break;
1404 
1405 	case IW_AUTH_PRIVACY_INVOKED:
1406 		privinvoked = param->value ? 1 : 0;
1407 		break;
1408 
1409 	case IW_AUTH_DROP_UNENCRYPTED:
1410 		exunencrypt = param->value ? 1 : 0;
1411 		break;
1412 
1413 	case IW_AUTH_80211_AUTH_ALG:
1414 		if (param->value & IW_AUTH_ALG_SHARED_KEY) {
1415 			/* Only WEP uses _SK and _BOTH */
1416 			if (wpa > 0) {
1417 				ret = -EINVAL;
1418 				goto out;
1419 			}
1420 			authen = DOT11_AUTH_SK;
1421 		} else if (param->value & IW_AUTH_ALG_OPEN_SYSTEM) {
1422 			authen = DOT11_AUTH_OS;
1423 		} else {
1424 			ret = -EINVAL;
1425 			goto out;
1426 		}
1427 		break;
1428 
1429 	default:
1430 		return -EOPNOTSUPP;
1431 	}
1432 
1433 	/* Set all the values */
1434 	down_write(&priv->mib_sem);
1435 	priv->wpa = wpa;
1436 	up_write(&priv->mib_sem);
1437 	mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
1438 	mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &privinvoked);
1439 	mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &exunencrypt);
1440 	mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x);
1441 	mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlmelevel);
1442 
1443 out:
1444 	return ret;
1445 }
1446 
prism54_get_auth(struct net_device * ndev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1447 static int prism54_get_auth(struct net_device *ndev,
1448 			    struct iw_request_info *info,
1449 			    union iwreq_data *wrqu, char *extra)
1450 {
1451 	islpci_private *priv = netdev_priv(ndev);
1452 	struct iw_param *param = &wrqu->param;
1453 	u32 wpa = 0;
1454 	int ret = 0;
1455 	union oid_res_t r;
1456 
1457 	if (islpci_get_state(priv) < PRV_STATE_INIT)
1458 		return 0;
1459 
1460 	/* first get the flags */
1461 	down_write(&priv->mib_sem);
1462 	wpa = priv->wpa;
1463 	up_write(&priv->mib_sem);
1464 
1465 	switch (param->flags & IW_AUTH_INDEX) {
1466 	case IW_AUTH_CIPHER_PAIRWISE:
1467 	case IW_AUTH_CIPHER_GROUP:
1468 	case IW_AUTH_KEY_MGMT:
1469 		/*
1470 		 * wpa_supplicant will control these internally
1471 		 */
1472 		ret = -EOPNOTSUPP;
1473 		break;
1474 
1475 	case IW_AUTH_WPA_VERSION:
1476 		switch (wpa) {
1477 		case 1:
1478 			param->value = IW_AUTH_WPA_VERSION_WPA;
1479 			break;
1480 		case 2:
1481 			param->value = IW_AUTH_WPA_VERSION_WPA2;
1482 			break;
1483 		case 0:
1484 		default:
1485 			param->value = IW_AUTH_WPA_VERSION_DISABLED;
1486 			break;
1487 		}
1488 		break;
1489 
1490 	case IW_AUTH_DROP_UNENCRYPTED:
1491 		ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1492 		if (ret >= 0)
1493 			param->value = r.u > 0 ? 1 : 0;
1494 		break;
1495 
1496 	case IW_AUTH_80211_AUTH_ALG:
1497 		ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1498 		if (ret >= 0) {
1499 			switch (r.u) {
1500 			case DOT11_AUTH_OS:
1501 				param->value = IW_AUTH_ALG_OPEN_SYSTEM;
1502 				break;
1503 			case DOT11_AUTH_BOTH:
1504 			case DOT11_AUTH_SK:
1505 				param->value = IW_AUTH_ALG_SHARED_KEY;
1506 				break;
1507 			case DOT11_AUTH_NONE:
1508 			default:
1509 				param->value = 0;
1510 				break;
1511 			}
1512 		}
1513 		break;
1514 
1515 	case IW_AUTH_WPA_ENABLED:
1516 		param->value = wpa > 0 ? 1 : 0;
1517 		break;
1518 
1519 	case IW_AUTH_RX_UNENCRYPTED_EAPOL:
1520 		ret = mgt_get_request(priv, DOT11_OID_DOT1XENABLE, 0, NULL, &r);
1521 		if (ret >= 0)
1522 			param->value = r.u > 0 ? 1 : 0;
1523 		break;
1524 
1525 	case IW_AUTH_PRIVACY_INVOKED:
1526 		ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1527 		if (ret >= 0)
1528 			param->value = r.u > 0 ? 1 : 0;
1529 		break;
1530 
1531 	default:
1532 		return -EOPNOTSUPP;
1533 	}
1534 	return ret;
1535 }
1536 
prism54_set_encodeext(struct net_device * ndev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1537 static int prism54_set_encodeext(struct net_device *ndev,
1538 				 struct iw_request_info *info,
1539 				 union iwreq_data *wrqu,
1540 				 char *extra)
1541 {
1542 	islpci_private *priv = netdev_priv(ndev);
1543 	struct iw_point *encoding = &wrqu->encoding;
1544 	struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1545 	int idx, alg = ext->alg, set_key = 1;
1546 	union oid_res_t r;
1547 	int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0;
1548 	int ret = 0;
1549 
1550 	if (islpci_get_state(priv) < PRV_STATE_INIT)
1551 		return 0;
1552 
1553 	/* Determine and validate the key index */
1554 	idx = (encoding->flags & IW_ENCODE_INDEX) - 1;
1555 	if (idx) {
1556 		if (idx < 0 || idx > 3)
1557 			return -EINVAL;
1558 	} else {
1559 		ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1560 		if (ret < 0)
1561 			goto out;
1562 		idx = r.u;
1563 	}
1564 
1565 	if (encoding->flags & IW_ENCODE_DISABLED)
1566 		alg = IW_ENCODE_ALG_NONE;
1567 
1568 	if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
1569 		/* Only set transmit key index here, actual
1570 		 * key is set below if needed.
1571 		 */
1572 		ret = mgt_set_request(priv, DOT11_OID_DEFKEYID, 0, &idx);
1573 		set_key = ext->key_len > 0 ? 1 : 0;
1574 	}
1575 
1576 	if (set_key) {
1577 		struct obj_key key = { DOT11_PRIV_WEP, 0, "" };
1578 		switch (alg) {
1579 		case IW_ENCODE_ALG_NONE:
1580 			break;
1581 		case IW_ENCODE_ALG_WEP:
1582 			if (ext->key_len > KEY_SIZE_WEP104) {
1583 				ret = -EINVAL;
1584 				goto out;
1585 			}
1586 			if (ext->key_len > KEY_SIZE_WEP40)
1587 				key.length = KEY_SIZE_WEP104;
1588 			else
1589 				key.length = KEY_SIZE_WEP40;
1590 			break;
1591 		case IW_ENCODE_ALG_TKIP:
1592 			if (ext->key_len > KEY_SIZE_TKIP) {
1593 				ret = -EINVAL;
1594 				goto out;
1595 			}
1596 			key.type = DOT11_PRIV_TKIP;
1597 			key.length = KEY_SIZE_TKIP;
1598 			break;
1599 		default:
1600 			return -EINVAL;
1601 		}
1602 
1603 		if (key.length) {
1604 			memset(key.key, 0, sizeof(key.key));
1605 			memcpy(key.key, ext->key, ext->key_len);
1606 			ret = mgt_set_request(priv, DOT11_OID_DEFKEYX, idx,
1607 					    &key);
1608 			if (ret < 0)
1609 				goto out;
1610 		}
1611 	}
1612 
1613 	/* Read the flags */
1614 	if (encoding->flags & IW_ENCODE_DISABLED) {
1615 		/* Encoding disabled,
1616 		 * authen = DOT11_AUTH_OS;
1617 		 * invoke = 0;
1618 		 * exunencrypt = 0; */
1619 	}
1620 	if (encoding->flags & IW_ENCODE_OPEN) {
1621 		/* Encode but accept non-encoded packets. No auth */
1622 		invoke = 1;
1623 	}
1624 	if (encoding->flags & IW_ENCODE_RESTRICTED) {
1625 		/* Refuse non-encoded packets. Auth */
1626 		authen = DOT11_AUTH_BOTH;
1627 		invoke = 1;
1628 		exunencrypt = 1;
1629 	}
1630 
1631 	/* do the change if requested  */
1632 	if (encoding->flags & IW_ENCODE_MODE) {
1633 		ret = mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0,
1634 				      &authen);
1635 		ret = mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0,
1636 				      &invoke);
1637 		ret = mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0,
1638 				      &exunencrypt);
1639 	}
1640 
1641 out:
1642 	return ret;
1643 }
1644 
1645 
prism54_get_encodeext(struct net_device * ndev,struct iw_request_info * info,union iwreq_data * wrqu,char * extra)1646 static int prism54_get_encodeext(struct net_device *ndev,
1647 				 struct iw_request_info *info,
1648 				 union iwreq_data *wrqu,
1649 				 char *extra)
1650 {
1651 	islpci_private *priv = netdev_priv(ndev);
1652 	struct iw_point *encoding = &wrqu->encoding;
1653 	struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
1654 	int idx, max_key_len;
1655 	union oid_res_t r;
1656 	int authen = DOT11_AUTH_OS, invoke = 0, exunencrypt = 0, wpa = 0;
1657 	int ret = 0;
1658 
1659 	if (islpci_get_state(priv) < PRV_STATE_INIT)
1660 		return 0;
1661 
1662 	/* first get the flags */
1663 	ret = mgt_get_request(priv, DOT11_OID_AUTHENABLE, 0, NULL, &r);
1664 	authen = r.u;
1665 	ret = mgt_get_request(priv, DOT11_OID_PRIVACYINVOKED, 0, NULL, &r);
1666 	invoke = r.u;
1667 	ret = mgt_get_request(priv, DOT11_OID_EXUNENCRYPTED, 0, NULL, &r);
1668 	exunencrypt = r.u;
1669 	if (ret < 0)
1670 		goto out;
1671 
1672 	max_key_len = encoding->length - sizeof(*ext);
1673 	if (max_key_len < 0)
1674 		return -EINVAL;
1675 
1676 	idx = (encoding->flags & IW_ENCODE_INDEX) - 1;
1677 	if (idx) {
1678 		if (idx < 0 || idx > 3)
1679 			return -EINVAL;
1680 	} else {
1681 		ret = mgt_get_request(priv, DOT11_OID_DEFKEYID, 0, NULL, &r);
1682 		if (ret < 0)
1683 			goto out;
1684 		idx = r.u;
1685 	}
1686 
1687 	encoding->flags = idx + 1;
1688 	memset(ext, 0, sizeof(*ext));
1689 
1690 	switch (authen) {
1691 	case DOT11_AUTH_BOTH:
1692 	case DOT11_AUTH_SK:
1693 		wrqu->encoding.flags |= IW_ENCODE_RESTRICTED;
1694 		/* fall through */
1695 	case DOT11_AUTH_OS:
1696 	default:
1697 		wrqu->encoding.flags |= IW_ENCODE_OPEN;
1698 		break;
1699 	}
1700 
1701 	down_write(&priv->mib_sem);
1702 	wpa = priv->wpa;
1703 	up_write(&priv->mib_sem);
1704 
1705 	if (authen == DOT11_AUTH_OS && !exunencrypt && !invoke && !wpa) {
1706 		/* No encryption */
1707 		ext->alg = IW_ENCODE_ALG_NONE;
1708 		ext->key_len = 0;
1709 		wrqu->encoding.flags |= IW_ENCODE_DISABLED;
1710 	} else {
1711 		struct obj_key *key;
1712 
1713 		ret = mgt_get_request(priv, DOT11_OID_DEFKEYX, idx, NULL, &r);
1714 		if (ret < 0)
1715 			goto out;
1716 		key = r.ptr;
1717 		if (max_key_len < key->length) {
1718 			ret = -E2BIG;
1719 			goto out;
1720 		}
1721 		memcpy(ext->key, key->key, key->length);
1722 		ext->key_len = key->length;
1723 
1724 		switch (key->type) {
1725 		case DOT11_PRIV_TKIP:
1726 			ext->alg = IW_ENCODE_ALG_TKIP;
1727 			break;
1728 		default:
1729 		case DOT11_PRIV_WEP:
1730 			ext->alg = IW_ENCODE_ALG_WEP;
1731 			break;
1732 		}
1733 		wrqu->encoding.flags |= IW_ENCODE_ENABLED;
1734 	}
1735 
1736 out:
1737 	return ret;
1738 }
1739 
1740 
1741 static int
prism54_reset(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)1742 prism54_reset(struct net_device *ndev, struct iw_request_info *info,
1743 	      __u32 * uwrq, char *extra)
1744 {
1745 	islpci_reset(netdev_priv(ndev), 0);
1746 
1747 	return 0;
1748 }
1749 
1750 static int
prism54_get_oid(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)1751 prism54_get_oid(struct net_device *ndev, struct iw_request_info *info,
1752 		struct iw_point *dwrq, char *extra)
1753 {
1754 	union oid_res_t r;
1755 	int rvalue;
1756 	enum oid_num_t n = dwrq->flags;
1757 
1758 	rvalue = mgt_get_request(netdev_priv(ndev), n, 0, NULL, &r);
1759 	dwrq->length = mgt_response_to_str(n, &r, extra);
1760 	if ((isl_oid[n].flags & OID_FLAG_TYPE) != OID_TYPE_U32)
1761 		kfree(r.ptr);
1762 	return rvalue;
1763 }
1764 
1765 static int
prism54_set_u32(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)1766 prism54_set_u32(struct net_device *ndev, struct iw_request_info *info,
1767 		__u32 * uwrq, char *extra)
1768 {
1769 	u32 oid = uwrq[0], u = uwrq[1];
1770 
1771 	return mgt_set_request(netdev_priv(ndev), oid, 0, &u);
1772 }
1773 
1774 static int
prism54_set_raw(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)1775 prism54_set_raw(struct net_device *ndev, struct iw_request_info *info,
1776 		struct iw_point *dwrq, char *extra)
1777 {
1778 	u32 oid = dwrq->flags;
1779 
1780 	return mgt_set_request(netdev_priv(ndev), oid, 0, extra);
1781 }
1782 
1783 void
prism54_acl_init(struct islpci_acl * acl)1784 prism54_acl_init(struct islpci_acl *acl)
1785 {
1786 	mutex_init(&acl->lock);
1787 	INIT_LIST_HEAD(&acl->mac_list);
1788 	acl->size = 0;
1789 	acl->policy = MAC_POLICY_OPEN;
1790 }
1791 
1792 static void
prism54_clear_mac(struct islpci_acl * acl)1793 prism54_clear_mac(struct islpci_acl *acl)
1794 {
1795 	struct list_head *ptr, *next;
1796 	struct mac_entry *entry;
1797 
1798 	mutex_lock(&acl->lock);
1799 
1800 	if (acl->size == 0) {
1801 		mutex_unlock(&acl->lock);
1802 		return;
1803 	}
1804 
1805 	for (ptr = acl->mac_list.next, next = ptr->next;
1806 	     ptr != &acl->mac_list; ptr = next, next = ptr->next) {
1807 		entry = list_entry(ptr, struct mac_entry, _list);
1808 		list_del(ptr);
1809 		kfree(entry);
1810 	}
1811 	acl->size = 0;
1812 	mutex_unlock(&acl->lock);
1813 }
1814 
1815 void
prism54_acl_clean(struct islpci_acl * acl)1816 prism54_acl_clean(struct islpci_acl *acl)
1817 {
1818 	prism54_clear_mac(acl);
1819 }
1820 
1821 static int
prism54_add_mac(struct net_device * ndev,struct iw_request_info * info,struct sockaddr * awrq,char * extra)1822 prism54_add_mac(struct net_device *ndev, struct iw_request_info *info,
1823 		struct sockaddr *awrq, char *extra)
1824 {
1825 	islpci_private *priv = netdev_priv(ndev);
1826 	struct islpci_acl *acl = &priv->acl;
1827 	struct mac_entry *entry;
1828 	struct sockaddr *addr = (struct sockaddr *) extra;
1829 
1830 	if (addr->sa_family != ARPHRD_ETHER)
1831 		return -EOPNOTSUPP;
1832 
1833 	entry = kmalloc(sizeof (struct mac_entry), GFP_KERNEL);
1834 	if (entry == NULL)
1835 		return -ENOMEM;
1836 
1837 	memcpy(entry->addr, addr->sa_data, ETH_ALEN);
1838 
1839 	if (mutex_lock_interruptible(&acl->lock)) {
1840 		kfree(entry);
1841 		return -ERESTARTSYS;
1842 	}
1843 	list_add_tail(&entry->_list, &acl->mac_list);
1844 	acl->size++;
1845 	mutex_unlock(&acl->lock);
1846 
1847 	return 0;
1848 }
1849 
1850 static int
prism54_del_mac(struct net_device * ndev,struct iw_request_info * info,struct sockaddr * awrq,char * extra)1851 prism54_del_mac(struct net_device *ndev, struct iw_request_info *info,
1852 		struct sockaddr *awrq, char *extra)
1853 {
1854 	islpci_private *priv = netdev_priv(ndev);
1855 	struct islpci_acl *acl = &priv->acl;
1856 	struct mac_entry *entry;
1857 	struct sockaddr *addr = (struct sockaddr *) extra;
1858 
1859 	if (addr->sa_family != ARPHRD_ETHER)
1860 		return -EOPNOTSUPP;
1861 
1862 	if (mutex_lock_interruptible(&acl->lock))
1863 		return -ERESTARTSYS;
1864 	list_for_each_entry(entry, &acl->mac_list, _list) {
1865 		if (ether_addr_equal(entry->addr, addr->sa_data)) {
1866 			list_del(&entry->_list);
1867 			acl->size--;
1868 			kfree(entry);
1869 			mutex_unlock(&acl->lock);
1870 			return 0;
1871 		}
1872 	}
1873 	mutex_unlock(&acl->lock);
1874 	return -EINVAL;
1875 }
1876 
1877 static int
prism54_get_mac(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)1878 prism54_get_mac(struct net_device *ndev, struct iw_request_info *info,
1879 		struct iw_point *dwrq, char *extra)
1880 {
1881 	islpci_private *priv = netdev_priv(ndev);
1882 	struct islpci_acl *acl = &priv->acl;
1883 	struct mac_entry *entry;
1884 	struct sockaddr *dst = (struct sockaddr *) extra;
1885 
1886 	dwrq->length = 0;
1887 
1888 	if (mutex_lock_interruptible(&acl->lock))
1889 		return -ERESTARTSYS;
1890 
1891 	list_for_each_entry(entry, &acl->mac_list, _list) {
1892 		memcpy(dst->sa_data, entry->addr, ETH_ALEN);
1893 		dst->sa_family = ARPHRD_ETHER;
1894 		dwrq->length++;
1895 		dst++;
1896 	}
1897 	mutex_unlock(&acl->lock);
1898 	return 0;
1899 }
1900 
1901 /* Setting policy also clears the MAC acl, even if we don't change the default
1902  * policy
1903  */
1904 
1905 static int
prism54_set_policy(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)1906 prism54_set_policy(struct net_device *ndev, struct iw_request_info *info,
1907 		   __u32 * uwrq, char *extra)
1908 {
1909 	islpci_private *priv = netdev_priv(ndev);
1910 	struct islpci_acl *acl = &priv->acl;
1911 	u32 mlmeautolevel;
1912 
1913 	prism54_clear_mac(acl);
1914 
1915 	if ((*uwrq < MAC_POLICY_OPEN) || (*uwrq > MAC_POLICY_REJECT))
1916 		return -EINVAL;
1917 
1918 	down_write(&priv->mib_sem);
1919 
1920 	acl->policy = *uwrq;
1921 
1922 	/* the ACL code needs an intermediate mlmeautolevel */
1923 	if ((priv->iw_mode == IW_MODE_MASTER) &&
1924 	    (acl->policy != MAC_POLICY_OPEN))
1925 		mlmeautolevel = DOT11_MLME_INTERMEDIATE;
1926 	else
1927 		mlmeautolevel = CARD_DEFAULT_MLME_MODE;
1928 	if (priv->wpa)
1929 		mlmeautolevel = DOT11_MLME_EXTENDED;
1930 	mgt_set(priv, DOT11_OID_MLMEAUTOLEVEL, &mlmeautolevel);
1931 	/* restart the card with our new policy */
1932 	if (mgt_commit(priv)) {
1933 		up_write(&priv->mib_sem);
1934 		return -EIO;
1935 	}
1936 	up_write(&priv->mib_sem);
1937 
1938 	return 0;
1939 }
1940 
1941 static int
prism54_get_policy(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)1942 prism54_get_policy(struct net_device *ndev, struct iw_request_info *info,
1943 		   __u32 * uwrq, char *extra)
1944 {
1945 	islpci_private *priv = netdev_priv(ndev);
1946 	struct islpci_acl *acl = &priv->acl;
1947 
1948 	*uwrq = acl->policy;
1949 
1950 	return 0;
1951 }
1952 
1953 /* Return 1 only if client should be accepted. */
1954 
1955 static int
prism54_mac_accept(struct islpci_acl * acl,char * mac)1956 prism54_mac_accept(struct islpci_acl *acl, char *mac)
1957 {
1958 	struct mac_entry *entry;
1959 	int res = 0;
1960 
1961 	if (mutex_lock_interruptible(&acl->lock))
1962 		return -ERESTARTSYS;
1963 
1964 	if (acl->policy == MAC_POLICY_OPEN) {
1965 		mutex_unlock(&acl->lock);
1966 		return 1;
1967 	}
1968 
1969 	list_for_each_entry(entry, &acl->mac_list, _list) {
1970 		if (memcmp(entry->addr, mac, ETH_ALEN) == 0) {
1971 			res = 1;
1972 			break;
1973 		}
1974 	}
1975 	res = (acl->policy == MAC_POLICY_ACCEPT) ? !res : res;
1976 	mutex_unlock(&acl->lock);
1977 
1978 	return res;
1979 }
1980 
1981 static int
prism54_kick_all(struct net_device * ndev,struct iw_request_info * info,struct iw_point * dwrq,char * extra)1982 prism54_kick_all(struct net_device *ndev, struct iw_request_info *info,
1983 		 struct iw_point *dwrq, char *extra)
1984 {
1985 	struct obj_mlme *mlme;
1986 	int rvalue;
1987 
1988 	mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL);
1989 	if (mlme == NULL)
1990 		return -ENOMEM;
1991 
1992 	/* Tell the card to kick every client */
1993 	mlme->id = 0;
1994 	rvalue =
1995 	    mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme);
1996 	kfree(mlme);
1997 
1998 	return rvalue;
1999 }
2000 
2001 static int
prism54_kick_mac(struct net_device * ndev,struct iw_request_info * info,struct sockaddr * awrq,char * extra)2002 prism54_kick_mac(struct net_device *ndev, struct iw_request_info *info,
2003 		 struct sockaddr *awrq, char *extra)
2004 {
2005 	struct obj_mlme *mlme;
2006 	struct sockaddr *addr = (struct sockaddr *) extra;
2007 	int rvalue;
2008 
2009 	if (addr->sa_family != ARPHRD_ETHER)
2010 		return -EOPNOTSUPP;
2011 
2012 	mlme = kmalloc(sizeof (struct obj_mlme), GFP_KERNEL);
2013 	if (mlme == NULL)
2014 		return -ENOMEM;
2015 
2016 	/* Tell the card to only kick the corresponding bastard */
2017 	memcpy(mlme->address, addr->sa_data, ETH_ALEN);
2018 	mlme->id = -1;
2019 	rvalue =
2020 	    mgt_set_request(netdev_priv(ndev), DOT11_OID_DISASSOCIATE, 0, mlme);
2021 
2022 	kfree(mlme);
2023 
2024 	return rvalue;
2025 }
2026 
2027 /* Translate a TRAP oid into a wireless event. Called in islpci_mgt_receive. */
2028 
2029 static void
format_event(islpci_private * priv,char * dest,const char * str,const struct obj_mlme * mlme,u16 * length,int error)2030 format_event(islpci_private *priv, char *dest, const char *str,
2031 	     const struct obj_mlme *mlme, u16 *length, int error)
2032 {
2033 	int n = snprintf(dest, IW_CUSTOM_MAX,
2034 			 "%s %s %pM %s (%2.2X)",
2035 			 str,
2036 			 ((priv->iw_mode == IW_MODE_MASTER) ? "from" : "to"),
2037 			 mlme->address,
2038 			 (error ? (mlme->code ? " : REJECTED " : " : ACCEPTED ")
2039 			  : ""), mlme->code);
2040 	WARN_ON(n >= IW_CUSTOM_MAX);
2041 	*length = n;
2042 }
2043 
2044 static void
send_formatted_event(islpci_private * priv,const char * str,const struct obj_mlme * mlme,int error)2045 send_formatted_event(islpci_private *priv, const char *str,
2046 		     const struct obj_mlme *mlme, int error)
2047 {
2048 	union iwreq_data wrqu;
2049 	char *memptr;
2050 
2051 	memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL);
2052 	if (!memptr)
2053 		return;
2054 	wrqu.data.pointer = memptr;
2055 	wrqu.data.length = 0;
2056 	format_event(priv, memptr, str, mlme, &wrqu.data.length,
2057 		     error);
2058 	wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr);
2059 	kfree(memptr);
2060 }
2061 
2062 static void
send_simple_event(islpci_private * priv,const char * str)2063 send_simple_event(islpci_private *priv, const char *str)
2064 {
2065 	union iwreq_data wrqu;
2066 	char *memptr;
2067 	int n = strlen(str);
2068 
2069 	memptr = kmalloc(IW_CUSTOM_MAX, GFP_KERNEL);
2070 	if (!memptr)
2071 		return;
2072 	BUG_ON(n >= IW_CUSTOM_MAX);
2073 	wrqu.data.pointer = memptr;
2074 	wrqu.data.length = n;
2075 	strcpy(memptr, str);
2076 	wireless_send_event(priv->ndev, IWEVCUSTOM, &wrqu, memptr);
2077 	kfree(memptr);
2078 }
2079 
2080 static void
link_changed(struct net_device * ndev,u32 bitrate)2081 link_changed(struct net_device *ndev, u32 bitrate)
2082 {
2083 	islpci_private *priv = netdev_priv(ndev);
2084 
2085 	if (bitrate) {
2086 		netif_carrier_on(ndev);
2087 		if (priv->iw_mode == IW_MODE_INFRA) {
2088 			union iwreq_data uwrq;
2089 			prism54_get_wap(ndev, NULL, (struct sockaddr *) &uwrq,
2090 					NULL);
2091 			wireless_send_event(ndev, SIOCGIWAP, &uwrq, NULL);
2092 		} else
2093 			send_simple_event(netdev_priv(ndev),
2094 					  "Link established");
2095 	} else {
2096 		netif_carrier_off(ndev);
2097 		send_simple_event(netdev_priv(ndev), "Link lost");
2098 	}
2099 }
2100 
2101 /* Beacon/ProbeResp payload header */
2102 struct ieee80211_beacon_phdr {
2103 	u8 timestamp[8];
2104 	u16 beacon_int;
2105 	u16 capab_info;
2106 } __packed;
2107 
2108 #define WLAN_EID_GENERIC 0xdd
2109 static u8 wpa_oid[4] = { 0x00, 0x50, 0xf2, 1 };
2110 
2111 static void
prism54_wpa_bss_ie_add(islpci_private * priv,u8 * bssid,u8 * wpa_ie,size_t wpa_ie_len)2112 prism54_wpa_bss_ie_add(islpci_private *priv, u8 *bssid,
2113 		       u8 *wpa_ie, size_t wpa_ie_len)
2114 {
2115 	struct list_head *ptr;
2116 	struct islpci_bss_wpa_ie *bss = NULL;
2117 
2118 	if (wpa_ie_len > MAX_WPA_IE_LEN)
2119 		wpa_ie_len = MAX_WPA_IE_LEN;
2120 
2121 	mutex_lock(&priv->wpa_lock);
2122 
2123 	/* try to use existing entry */
2124 	list_for_each(ptr, &priv->bss_wpa_list) {
2125 		bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2126 		if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0) {
2127 			list_move(&bss->list, &priv->bss_wpa_list);
2128 			break;
2129 		}
2130 		bss = NULL;
2131 	}
2132 
2133 	if (bss == NULL) {
2134 		/* add a new BSS entry; if max number of entries is already
2135 		 * reached, replace the least recently updated */
2136 		if (priv->num_bss_wpa >= MAX_BSS_WPA_IE_COUNT) {
2137 			bss = list_entry(priv->bss_wpa_list.prev,
2138 					 struct islpci_bss_wpa_ie, list);
2139 			list_del(&bss->list);
2140 		} else {
2141 			bss = kzalloc(sizeof (*bss), GFP_ATOMIC);
2142 			if (bss != NULL)
2143 				priv->num_bss_wpa++;
2144 		}
2145 		if (bss != NULL) {
2146 			memcpy(bss->bssid, bssid, ETH_ALEN);
2147 			list_add(&bss->list, &priv->bss_wpa_list);
2148 		}
2149 	}
2150 
2151 	if (bss != NULL) {
2152 		memcpy(bss->wpa_ie, wpa_ie, wpa_ie_len);
2153 		bss->wpa_ie_len = wpa_ie_len;
2154 		bss->last_update = jiffies;
2155 	} else {
2156 		printk(KERN_DEBUG "Failed to add BSS WPA entry for "
2157 		       "%pM\n", bssid);
2158 	}
2159 
2160 	/* expire old entries from WPA list */
2161 	while (priv->num_bss_wpa > 0) {
2162 		bss = list_entry(priv->bss_wpa_list.prev,
2163 				 struct islpci_bss_wpa_ie, list);
2164 		if (!time_after(jiffies, bss->last_update + 60 * HZ))
2165 			break;
2166 
2167 		list_del(&bss->list);
2168 		priv->num_bss_wpa--;
2169 		kfree(bss);
2170 	}
2171 
2172 	mutex_unlock(&priv->wpa_lock);
2173 }
2174 
2175 static size_t
prism54_wpa_bss_ie_get(islpci_private * priv,u8 * bssid,u8 * wpa_ie)2176 prism54_wpa_bss_ie_get(islpci_private *priv, u8 *bssid, u8 *wpa_ie)
2177 {
2178 	struct list_head *ptr;
2179 	struct islpci_bss_wpa_ie *bss = NULL;
2180 	size_t len = 0;
2181 
2182 	mutex_lock(&priv->wpa_lock);
2183 
2184 	list_for_each(ptr, &priv->bss_wpa_list) {
2185 		bss = list_entry(ptr, struct islpci_bss_wpa_ie, list);
2186 		if (memcmp(bss->bssid, bssid, ETH_ALEN) == 0)
2187 			break;
2188 		bss = NULL;
2189 	}
2190 	if (bss) {
2191 		len = bss->wpa_ie_len;
2192 		memcpy(wpa_ie, bss->wpa_ie, len);
2193 	}
2194 	mutex_unlock(&priv->wpa_lock);
2195 
2196 	return len;
2197 }
2198 
2199 void
prism54_wpa_bss_ie_init(islpci_private * priv)2200 prism54_wpa_bss_ie_init(islpci_private *priv)
2201 {
2202 	INIT_LIST_HEAD(&priv->bss_wpa_list);
2203 	mutex_init(&priv->wpa_lock);
2204 }
2205 
2206 void
prism54_wpa_bss_ie_clean(islpci_private * priv)2207 prism54_wpa_bss_ie_clean(islpci_private *priv)
2208 {
2209 	struct islpci_bss_wpa_ie *bss, *n;
2210 
2211 	list_for_each_entry_safe(bss, n, &priv->bss_wpa_list, list) {
2212 		kfree(bss);
2213 	}
2214 }
2215 
2216 static void
prism54_process_bss_data(islpci_private * priv,u32 oid,u8 * addr,u8 * payload,size_t len)2217 prism54_process_bss_data(islpci_private *priv, u32 oid, u8 *addr,
2218 			 u8 *payload, size_t len)
2219 {
2220 	struct ieee80211_beacon_phdr *hdr;
2221 	u8 *pos, *end;
2222 
2223 	if (!priv->wpa)
2224 		return;
2225 
2226 	hdr = (struct ieee80211_beacon_phdr *) payload;
2227 	pos = (u8 *) (hdr + 1);
2228 	end = payload + len;
2229 	while (pos < end) {
2230 		if (pos + 2 + pos[1] > end) {
2231 			printk(KERN_DEBUG "Parsing Beacon/ProbeResp failed "
2232 			       "for %pM\n", addr);
2233 			return;
2234 		}
2235 		if (pos[0] == WLAN_EID_GENERIC && pos[1] >= 4 &&
2236 		    memcmp(pos + 2, wpa_oid, 4) == 0) {
2237 			prism54_wpa_bss_ie_add(priv, addr, pos, pos[1] + 2);
2238 			return;
2239 		}
2240 		pos += 2 + pos[1];
2241 	}
2242 }
2243 
2244 static void
handle_request(islpci_private * priv,struct obj_mlme * mlme,enum oid_num_t oid)2245 handle_request(islpci_private *priv, struct obj_mlme *mlme, enum oid_num_t oid)
2246 {
2247 	if (((mlme->state == DOT11_STATE_AUTHING) ||
2248 	     (mlme->state == DOT11_STATE_ASSOCING))
2249 	    && mgt_mlme_answer(priv)) {
2250 		/* Someone is requesting auth and we must respond. Just send back
2251 		 * the trap with error code set accordingly.
2252 		 */
2253 		mlme->code = prism54_mac_accept(&priv->acl,
2254 						mlme->address) ? 0 : 1;
2255 		mgt_set_request(priv, oid, 0, mlme);
2256 	}
2257 }
2258 
2259 static int
prism54_process_trap_helper(islpci_private * priv,enum oid_num_t oid,char * data)2260 prism54_process_trap_helper(islpci_private *priv, enum oid_num_t oid,
2261 			    char *data)
2262 {
2263 	struct obj_mlme *mlme = (struct obj_mlme *) data;
2264 	struct obj_mlmeex *mlmeex = (struct obj_mlmeex *) data;
2265 	struct obj_mlmeex *confirm;
2266 	u8 wpa_ie[MAX_WPA_IE_LEN];
2267 	int wpa_ie_len;
2268 	size_t len = 0; /* u16, better? */
2269 	u8 *payload = NULL, *pos = NULL;
2270 	int ret;
2271 
2272 	/* I think all trapable objects are listed here.
2273 	 * Some oids have a EX version. The difference is that they are emitted
2274 	 * in DOT11_MLME_EXTENDED mode (set with DOT11_OID_MLMEAUTOLEVEL)
2275 	 * with more info.
2276 	 * The few events already defined by the wireless tools are not really
2277 	 * suited. We use the more flexible custom event facility.
2278 	 */
2279 
2280 	if (oid >= DOT11_OID_BEACON) {
2281 		len = mlmeex->size;
2282 		payload = pos = mlmeex->data;
2283 	}
2284 
2285 	/* I fear prism54_process_bss_data won't work with big endian data */
2286 	if ((oid == DOT11_OID_BEACON) || (oid == DOT11_OID_PROBE))
2287 		prism54_process_bss_data(priv, oid, mlmeex->address,
2288 					 payload, len);
2289 
2290 	mgt_le_to_cpu(isl_oid[oid].flags & OID_FLAG_TYPE, (void *) mlme);
2291 
2292 	switch (oid) {
2293 
2294 	case GEN_OID_LINKSTATE:
2295 		link_changed(priv->ndev, (u32) *data);
2296 		break;
2297 
2298 	case DOT11_OID_MICFAILURE:
2299 		send_simple_event(priv, "Mic failure");
2300 		break;
2301 
2302 	case DOT11_OID_DEAUTHENTICATE:
2303 		send_formatted_event(priv, "DeAuthenticate request", mlme, 0);
2304 		break;
2305 
2306 	case DOT11_OID_AUTHENTICATE:
2307 		handle_request(priv, mlme, oid);
2308 		send_formatted_event(priv, "Authenticate request", mlme, 1);
2309 		break;
2310 
2311 	case DOT11_OID_DISASSOCIATE:
2312 		send_formatted_event(priv, "Disassociate request", mlme, 0);
2313 		break;
2314 
2315 	case DOT11_OID_ASSOCIATE:
2316 		handle_request(priv, mlme, oid);
2317 		send_formatted_event(priv, "Associate request", mlme, 1);
2318 		break;
2319 
2320 	case DOT11_OID_REASSOCIATE:
2321 		handle_request(priv, mlme, oid);
2322 		send_formatted_event(priv, "ReAssociate request", mlme, 1);
2323 		break;
2324 
2325 	case DOT11_OID_BEACON:
2326 		send_formatted_event(priv,
2327 				     "Received a beacon from an unknown AP",
2328 				     mlme, 0);
2329 		break;
2330 
2331 	case DOT11_OID_PROBE:
2332 		/* we received a probe from a client. */
2333 		send_formatted_event(priv, "Received a probe from client", mlme,
2334 				     0);
2335 		break;
2336 
2337 		/* Note : "mlme" is actually a "struct obj_mlmeex *" here, but this
2338 		 * is backward compatible layout-wise with "struct obj_mlme".
2339 		 */
2340 
2341 	case DOT11_OID_DEAUTHENTICATEEX:
2342 		send_formatted_event(priv, "DeAuthenticate request", mlme, 0);
2343 		break;
2344 
2345 	case DOT11_OID_AUTHENTICATEEX:
2346 		handle_request(priv, mlme, oid);
2347 		send_formatted_event(priv, "Authenticate request (ex)", mlme, 1);
2348 
2349 		if (priv->iw_mode != IW_MODE_MASTER
2350 				&& mlmeex->state != DOT11_STATE_AUTHING)
2351 			break;
2352 
2353 		confirm = kmalloc(sizeof(struct obj_mlmeex) + 6, GFP_ATOMIC);
2354 
2355 		if (!confirm)
2356 			break;
2357 
2358 		memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2359 		printk(KERN_DEBUG "Authenticate from: address:\t%pM\n",
2360 		       mlmeex->address);
2361 		confirm->id = -1; /* or mlmeex->id ? */
2362 		confirm->state = 0; /* not used */
2363 		confirm->code = 0;
2364 		confirm->size = 6;
2365 		confirm->data[0] = 0x00;
2366 		confirm->data[1] = 0x00;
2367 		confirm->data[2] = 0x02;
2368 		confirm->data[3] = 0x00;
2369 		confirm->data[4] = 0x00;
2370 		confirm->data[5] = 0x00;
2371 
2372 		ret = mgt_set_varlen(priv, DOT11_OID_ASSOCIATEEX, confirm, 6);
2373 
2374 		kfree(confirm);
2375 		if (ret)
2376 			return ret;
2377 		break;
2378 
2379 	case DOT11_OID_DISASSOCIATEEX:
2380 		send_formatted_event(priv, "Disassociate request (ex)", mlme, 0);
2381 		break;
2382 
2383 	case DOT11_OID_ASSOCIATEEX:
2384 		handle_request(priv, mlme, oid);
2385 		send_formatted_event(priv, "Associate request (ex)", mlme, 1);
2386 
2387 		if (priv->iw_mode != IW_MODE_MASTER
2388 				&& mlmeex->state != DOT11_STATE_ASSOCING)
2389 			break;
2390 
2391 		confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC);
2392 
2393 		if (!confirm)
2394 			break;
2395 
2396 		memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2397 
2398 		confirm->id = ((struct obj_mlmeex *)mlme)->id;
2399 		confirm->state = 0; /* not used */
2400 		confirm->code = 0;
2401 
2402 		wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie);
2403 
2404 		if (!wpa_ie_len) {
2405 			printk(KERN_DEBUG "No WPA IE found from address:\t%pM\n",
2406 			       mlmeex->address);
2407 			kfree(confirm);
2408 			break;
2409 		}
2410 
2411 		confirm->size = wpa_ie_len;
2412 		memcpy(&confirm->data, wpa_ie, wpa_ie_len);
2413 
2414 		mgt_set_varlen(priv, oid, confirm, wpa_ie_len);
2415 
2416 		kfree(confirm);
2417 
2418 		break;
2419 
2420 	case DOT11_OID_REASSOCIATEEX:
2421 		handle_request(priv, mlme, oid);
2422 		send_formatted_event(priv, "Reassociate request (ex)", mlme, 1);
2423 
2424 		if (priv->iw_mode != IW_MODE_MASTER
2425 				&& mlmeex->state != DOT11_STATE_ASSOCING)
2426 			break;
2427 
2428 		confirm = kmalloc(sizeof(struct obj_mlmeex), GFP_ATOMIC);
2429 
2430 		if (!confirm)
2431 			break;
2432 
2433 		memcpy(&confirm->address, mlmeex->address, ETH_ALEN);
2434 
2435 		confirm->id = mlmeex->id;
2436 		confirm->state = 0; /* not used */
2437 		confirm->code = 0;
2438 
2439 		wpa_ie_len = prism54_wpa_bss_ie_get(priv, mlmeex->address, wpa_ie);
2440 
2441 		if (!wpa_ie_len) {
2442 			printk(KERN_DEBUG "No WPA IE found from address:\t%pM\n",
2443 			       mlmeex->address);
2444 			kfree(confirm);
2445 			break;
2446 		}
2447 
2448 		confirm->size = wpa_ie_len;
2449 		memcpy(&confirm->data, wpa_ie, wpa_ie_len);
2450 
2451 		mgt_set_varlen(priv, oid, confirm, wpa_ie_len);
2452 
2453 		kfree(confirm);
2454 
2455 		break;
2456 
2457 	default:
2458 		return -EINVAL;
2459 	}
2460 
2461 	return 0;
2462 }
2463 
2464 /*
2465  * Process a device trap.  This is called via schedule_work(), outside of
2466  * interrupt context, no locks held.
2467  */
2468 void
prism54_process_trap(struct work_struct * work)2469 prism54_process_trap(struct work_struct *work)
2470 {
2471 	struct islpci_mgmtframe *frame =
2472 		container_of(work, struct islpci_mgmtframe, ws);
2473 	struct net_device *ndev = frame->ndev;
2474 	enum oid_num_t n = mgt_oidtonum(frame->header->oid);
2475 
2476 	if (n != OID_NUM_LAST)
2477 		prism54_process_trap_helper(netdev_priv(ndev), n, frame->data);
2478 	islpci_mgt_release(frame);
2479 }
2480 
2481 int
prism54_set_mac_address(struct net_device * ndev,void * addr)2482 prism54_set_mac_address(struct net_device *ndev, void *addr)
2483 {
2484 	islpci_private *priv = netdev_priv(ndev);
2485 	int ret;
2486 
2487 	if (ndev->addr_len != 6)
2488 		return -EINVAL;
2489 	ret = mgt_set_request(priv, GEN_OID_MACADDRESS, 0,
2490 			      &((struct sockaddr *) addr)->sa_data);
2491 	if (!ret)
2492 		memcpy(priv->ndev->dev_addr,
2493 		       &((struct sockaddr *) addr)->sa_data, ETH_ALEN);
2494 
2495 	return ret;
2496 }
2497 
2498 #define PRISM54_SET_WPA			SIOCIWFIRSTPRIV+12
2499 
2500 static int
prism54_set_wpa(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)2501 prism54_set_wpa(struct net_device *ndev, struct iw_request_info *info,
2502 		__u32 * uwrq, char *extra)
2503 {
2504 	islpci_private *priv = netdev_priv(ndev);
2505 	u32 mlme, authen, dot1x, filter, wep;
2506 
2507 	if (islpci_get_state(priv) < PRV_STATE_INIT)
2508 		return 0;
2509 
2510 	wep = 1; /* For privacy invoked */
2511 	filter = 1; /* Filter out all unencrypted frames */
2512 	dot1x = 0x01; /* To enable eap filter */
2513 	mlme = DOT11_MLME_EXTENDED;
2514 	authen = DOT11_AUTH_OS; /* Only WEP uses _SK and _BOTH */
2515 
2516 	down_write(&priv->mib_sem);
2517 	priv->wpa = *uwrq;
2518 
2519 	switch (priv->wpa) {
2520 		default:
2521 		case 0: /* Clears/disables WPA and friends */
2522 			wep = 0;
2523 			filter = 0; /* Do not filter un-encrypted data */
2524 			dot1x = 0;
2525 			mlme = DOT11_MLME_AUTO;
2526 			printk("%s: Disabling WPA\n", ndev->name);
2527 			break;
2528 		case 2:
2529 		case 1: /* WPA */
2530 			printk("%s: Enabling WPA\n", ndev->name);
2531 			break;
2532 	}
2533 	up_write(&priv->mib_sem);
2534 
2535 	mgt_set_request(priv, DOT11_OID_AUTHENABLE, 0, &authen);
2536 	mgt_set_request(priv, DOT11_OID_PRIVACYINVOKED, 0, &wep);
2537 	mgt_set_request(priv, DOT11_OID_EXUNENCRYPTED, 0, &filter);
2538 	mgt_set_request(priv, DOT11_OID_DOT1XENABLE, 0, &dot1x);
2539 	mgt_set_request(priv, DOT11_OID_MLMEAUTOLEVEL, 0, &mlme);
2540 
2541 	return 0;
2542 }
2543 
2544 static int
prism54_get_wpa(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)2545 prism54_get_wpa(struct net_device *ndev, struct iw_request_info *info,
2546 		__u32 * uwrq, char *extra)
2547 {
2548 	islpci_private *priv = netdev_priv(ndev);
2549 	*uwrq = priv->wpa;
2550 	return 0;
2551 }
2552 
2553 static int
prism54_set_prismhdr(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)2554 prism54_set_prismhdr(struct net_device *ndev, struct iw_request_info *info,
2555 		     __u32 * uwrq, char *extra)
2556 {
2557 	islpci_private *priv = netdev_priv(ndev);
2558 	priv->monitor_type =
2559 	    (*uwrq ? ARPHRD_IEEE80211_PRISM : ARPHRD_IEEE80211);
2560 	if (priv->iw_mode == IW_MODE_MONITOR)
2561 		priv->ndev->type = priv->monitor_type;
2562 
2563 	return 0;
2564 }
2565 
2566 static int
prism54_get_prismhdr(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)2567 prism54_get_prismhdr(struct net_device *ndev, struct iw_request_info *info,
2568 		     __u32 * uwrq, char *extra)
2569 {
2570 	islpci_private *priv = netdev_priv(ndev);
2571 	*uwrq = (priv->monitor_type == ARPHRD_IEEE80211_PRISM);
2572 	return 0;
2573 }
2574 
2575 static int
prism54_debug_oid(struct net_device * ndev,struct iw_request_info * info,__u32 * uwrq,char * extra)2576 prism54_debug_oid(struct net_device *ndev, struct iw_request_info *info,
2577 		  __u32 * uwrq, char *extra)
2578 {
2579 	islpci_private *priv = netdev_priv(ndev);
2580 
2581 	priv->priv_oid = *uwrq;
2582 	printk("%s: oid 0x%08X\n", ndev->name, *uwrq);
2583 
2584 	return 0;
2585 }
2586 
2587 static int
prism54_debug_get_oid(struct net_device * ndev,struct iw_request_info * info,struct iw_point * data,char * extra)2588 prism54_debug_get_oid(struct net_device *ndev, struct iw_request_info *info,
2589 		      struct iw_point *data, char *extra)
2590 {
2591 	islpci_private *priv = netdev_priv(ndev);
2592 	struct islpci_mgmtframe *response;
2593 	int ret = -EIO;
2594 
2595 	printk("%s: get_oid 0x%08X\n", ndev->name, priv->priv_oid);
2596 	data->length = 0;
2597 
2598 	if (islpci_get_state(priv) >= PRV_STATE_INIT) {
2599 		ret =
2600 		    islpci_mgt_transaction(priv->ndev, PIMFOR_OP_GET,
2601 					   priv->priv_oid, extra, 256,
2602 					   &response);
2603 		printk("%s: ret: %i\n", ndev->name, ret);
2604 		if (ret || !response
2605 		    || response->header->operation == PIMFOR_OP_ERROR) {
2606 			if (response) {
2607 				islpci_mgt_release(response);
2608 			}
2609 			printk("%s: EIO\n", ndev->name);
2610 			ret = -EIO;
2611 		}
2612 		if (!ret) {
2613 			data->length = response->header->length;
2614 			memcpy(extra, response->data, data->length);
2615 			islpci_mgt_release(response);
2616 			printk("%s: len: %i\n", ndev->name, data->length);
2617 		}
2618 	}
2619 
2620 	return ret;
2621 }
2622 
2623 static int
prism54_debug_set_oid(struct net_device * ndev,struct iw_request_info * info,struct iw_point * data,char * extra)2624 prism54_debug_set_oid(struct net_device *ndev, struct iw_request_info *info,
2625 		      struct iw_point *data, char *extra)
2626 {
2627 	islpci_private *priv = netdev_priv(ndev);
2628 	struct islpci_mgmtframe *response;
2629 	int ret = 0, response_op = PIMFOR_OP_ERROR;
2630 
2631 	printk("%s: set_oid 0x%08X\tlen: %d\n", ndev->name, priv->priv_oid,
2632 	       data->length);
2633 
2634 	if (islpci_get_state(priv) >= PRV_STATE_INIT) {
2635 		ret =
2636 		    islpci_mgt_transaction(priv->ndev, PIMFOR_OP_SET,
2637 					   priv->priv_oid, extra, data->length,
2638 					   &response);
2639 		printk("%s: ret: %i\n", ndev->name, ret);
2640 		if (ret || !response
2641 		    || response->header->operation == PIMFOR_OP_ERROR) {
2642 			if (response) {
2643 				islpci_mgt_release(response);
2644 			}
2645 			printk("%s: EIO\n", ndev->name);
2646 			ret = -EIO;
2647 		}
2648 		if (!ret) {
2649 			response_op = response->header->operation;
2650 			printk("%s: response_op: %i\n", ndev->name,
2651 			       response_op);
2652 			islpci_mgt_release(response);
2653 		}
2654 	}
2655 
2656 	return (ret ? ret : -EINPROGRESS);
2657 }
2658 
2659 static int
prism54_set_spy(struct net_device * ndev,struct iw_request_info * info,union iwreq_data * uwrq,char * extra)2660 prism54_set_spy(struct net_device *ndev,
2661 		struct iw_request_info *info,
2662 		union iwreq_data *uwrq, char *extra)
2663 {
2664 	islpci_private *priv = netdev_priv(ndev);
2665 	u32 u;
2666 	enum oid_num_t oid = OID_INL_CONFIG;
2667 
2668 	down_write(&priv->mib_sem);
2669 	mgt_get(priv, OID_INL_CONFIG, &u);
2670 
2671 	if ((uwrq->data.length == 0) && (priv->spy_data.spy_number > 0))
2672 		/* disable spy */
2673 		u &= ~INL_CONFIG_RXANNEX;
2674 	else if ((uwrq->data.length > 0) && (priv->spy_data.spy_number == 0))
2675 		/* enable spy */
2676 		u |= INL_CONFIG_RXANNEX;
2677 
2678 	mgt_set(priv, OID_INL_CONFIG, &u);
2679 	mgt_commit_list(priv, &oid, 1);
2680 	up_write(&priv->mib_sem);
2681 
2682 	return iw_handler_set_spy(ndev, info, uwrq, extra);
2683 }
2684 
2685 static const iw_handler prism54_handler[] = {
2686 	(iw_handler) prism54_commit,	/* SIOCSIWCOMMIT */
2687 	(iw_handler) prism54_get_name,	/* SIOCGIWNAME */
2688 	(iw_handler) NULL,	/* SIOCSIWNWID */
2689 	(iw_handler) NULL,	/* SIOCGIWNWID */
2690 	(iw_handler) prism54_set_freq,	/* SIOCSIWFREQ */
2691 	(iw_handler) prism54_get_freq,	/* SIOCGIWFREQ */
2692 	(iw_handler) prism54_set_mode,	/* SIOCSIWMODE */
2693 	(iw_handler) prism54_get_mode,	/* SIOCGIWMODE */
2694 	(iw_handler) prism54_set_sens,	/* SIOCSIWSENS */
2695 	(iw_handler) prism54_get_sens,	/* SIOCGIWSENS */
2696 	(iw_handler) NULL,	/* SIOCSIWRANGE */
2697 	(iw_handler) prism54_get_range,	/* SIOCGIWRANGE */
2698 	(iw_handler) NULL,	/* SIOCSIWPRIV */
2699 	(iw_handler) NULL,	/* SIOCGIWPRIV */
2700 	(iw_handler) NULL,	/* SIOCSIWSTATS */
2701 	(iw_handler) NULL,	/* SIOCGIWSTATS */
2702 	prism54_set_spy,	/* SIOCSIWSPY */
2703 	iw_handler_get_spy,	/* SIOCGIWSPY */
2704 	iw_handler_set_thrspy,	/* SIOCSIWTHRSPY */
2705 	iw_handler_get_thrspy,	/* SIOCGIWTHRSPY */
2706 	(iw_handler) prism54_set_wap,	/* SIOCSIWAP */
2707 	(iw_handler) prism54_get_wap,	/* SIOCGIWAP */
2708 	(iw_handler) NULL,	/* -- hole -- */
2709 	(iw_handler) NULL,	/* SIOCGIWAPLIST deprecated */
2710 	(iw_handler) prism54_set_scan,	/* SIOCSIWSCAN */
2711 	(iw_handler) prism54_get_scan,	/* SIOCGIWSCAN */
2712 	(iw_handler) prism54_set_essid,	/* SIOCSIWESSID */
2713 	(iw_handler) prism54_get_essid,	/* SIOCGIWESSID */
2714 	(iw_handler) prism54_set_nick,	/* SIOCSIWNICKN */
2715 	(iw_handler) prism54_get_nick,	/* SIOCGIWNICKN */
2716 	(iw_handler) NULL,	/* -- hole -- */
2717 	(iw_handler) NULL,	/* -- hole -- */
2718 	(iw_handler) prism54_set_rate,	/* SIOCSIWRATE */
2719 	(iw_handler) prism54_get_rate,	/* SIOCGIWRATE */
2720 	(iw_handler) prism54_set_rts,	/* SIOCSIWRTS */
2721 	(iw_handler) prism54_get_rts,	/* SIOCGIWRTS */
2722 	(iw_handler) prism54_set_frag,	/* SIOCSIWFRAG */
2723 	(iw_handler) prism54_get_frag,	/* SIOCGIWFRAG */
2724 	(iw_handler) prism54_set_txpower,	/* SIOCSIWTXPOW */
2725 	(iw_handler) prism54_get_txpower,	/* SIOCGIWTXPOW */
2726 	(iw_handler) prism54_set_retry,	/* SIOCSIWRETRY */
2727 	(iw_handler) prism54_get_retry,	/* SIOCGIWRETRY */
2728 	(iw_handler) prism54_set_encode,	/* SIOCSIWENCODE */
2729 	(iw_handler) prism54_get_encode,	/* SIOCGIWENCODE */
2730 	(iw_handler) NULL,	/* SIOCSIWPOWER */
2731 	(iw_handler) NULL,	/* SIOCGIWPOWER */
2732 	NULL,			/* -- hole -- */
2733 	NULL,			/* -- hole -- */
2734 	(iw_handler) prism54_set_genie,	/* SIOCSIWGENIE */
2735 	(iw_handler) prism54_get_genie,	/* SIOCGIWGENIE */
2736 	(iw_handler) prism54_set_auth,	/* SIOCSIWAUTH */
2737 	(iw_handler) prism54_get_auth,	/* SIOCGIWAUTH */
2738 	(iw_handler) prism54_set_encodeext, /* SIOCSIWENCODEEXT */
2739 	(iw_handler) prism54_get_encodeext, /* SIOCGIWENCODEEXT */
2740 	NULL,			/* SIOCSIWPMKSA */
2741 };
2742 
2743 /* The low order bit identify a SET (0) or a GET (1) ioctl.  */
2744 
2745 #define PRISM54_RESET		SIOCIWFIRSTPRIV
2746 #define PRISM54_GET_POLICY	SIOCIWFIRSTPRIV+1
2747 #define PRISM54_SET_POLICY	SIOCIWFIRSTPRIV+2
2748 #define PRISM54_GET_MAC		SIOCIWFIRSTPRIV+3
2749 #define PRISM54_ADD_MAC		SIOCIWFIRSTPRIV+4
2750 
2751 #define PRISM54_DEL_MAC		SIOCIWFIRSTPRIV+6
2752 
2753 #define PRISM54_KICK_MAC	SIOCIWFIRSTPRIV+8
2754 
2755 #define PRISM54_KICK_ALL	SIOCIWFIRSTPRIV+10
2756 
2757 #define PRISM54_GET_WPA		SIOCIWFIRSTPRIV+11
2758 #define PRISM54_SET_WPA		SIOCIWFIRSTPRIV+12
2759 
2760 #define PRISM54_DBG_OID		SIOCIWFIRSTPRIV+14
2761 #define PRISM54_DBG_GET_OID	SIOCIWFIRSTPRIV+15
2762 #define PRISM54_DBG_SET_OID	SIOCIWFIRSTPRIV+16
2763 
2764 #define PRISM54_GET_OID		SIOCIWFIRSTPRIV+17
2765 #define PRISM54_SET_OID_U32	SIOCIWFIRSTPRIV+18
2766 #define	PRISM54_SET_OID_STR	SIOCIWFIRSTPRIV+20
2767 #define	PRISM54_SET_OID_ADDR	SIOCIWFIRSTPRIV+22
2768 
2769 #define PRISM54_GET_PRISMHDR	SIOCIWFIRSTPRIV+23
2770 #define PRISM54_SET_PRISMHDR	SIOCIWFIRSTPRIV+24
2771 
2772 #define IWPRIV_SET_U32(n,x)	{ n, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2773 #define IWPRIV_SET_SSID(n,x)	{ n, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2774 #define IWPRIV_SET_ADDR(n,x)	{ n, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, "s_"x }
2775 #define IWPRIV_GET(n,x)	{ n, 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, "g_"x }
2776 
2777 #define IWPRIV_U32(n,x)		IWPRIV_SET_U32(n,x), IWPRIV_GET(n,x)
2778 #define IWPRIV_SSID(n,x)	IWPRIV_SET_SSID(n,x), IWPRIV_GET(n,x)
2779 #define IWPRIV_ADDR(n,x)	IWPRIV_SET_ADDR(n,x), IWPRIV_GET(n,x)
2780 
2781 /* Note : limited to 128 private ioctls (wireless tools 26) */
2782 
2783 static const struct iw_priv_args prism54_private_args[] = {
2784 /*{ cmd, set_args, get_args, name } */
2785 	{PRISM54_RESET, 0, 0, "reset"},
2786 	{PRISM54_GET_PRISMHDR, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2787 	 "get_prismhdr"},
2788 	{PRISM54_SET_PRISMHDR, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2789 	 "set_prismhdr"},
2790 	{PRISM54_GET_POLICY, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2791 	 "getPolicy"},
2792 	{PRISM54_SET_POLICY, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2793 	 "setPolicy"},
2794 	{PRISM54_GET_MAC, 0, IW_PRIV_TYPE_ADDR | 64, "getMac"},
2795 	{PRISM54_ADD_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2796 	 "addMac"},
2797 	{PRISM54_DEL_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2798 	 "delMac"},
2799 	{PRISM54_KICK_MAC, IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0,
2800 	 "kickMac"},
2801 	{PRISM54_KICK_ALL, 0, 0, "kickAll"},
2802 	{PRISM54_GET_WPA, 0, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
2803 	 "get_wpa"},
2804 	{PRISM54_SET_WPA, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2805 	 "set_wpa"},
2806 	{PRISM54_DBG_OID, IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0,
2807 	 "dbg_oid"},
2808 	{PRISM54_DBG_GET_OID, 0, IW_PRIV_TYPE_BYTE | 256, "dbg_get_oid"},
2809 	{PRISM54_DBG_SET_OID, IW_PRIV_TYPE_BYTE | 256, 0, "dbg_set_oid"},
2810 	/* --- sub-ioctls handlers --- */
2811 	{PRISM54_GET_OID,
2812 	 0, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | PRIV_STR_SIZE, ""},
2813 	{PRISM54_SET_OID_U32,
2814 	 IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2815 	{PRISM54_SET_OID_STR,
2816 	 IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2817 	{PRISM54_SET_OID_ADDR,
2818 	 IW_PRIV_TYPE_ADDR | IW_PRIV_SIZE_FIXED | 1, 0, ""},
2819 	/* --- sub-ioctls definitions --- */
2820 	IWPRIV_ADDR(GEN_OID_MACADDRESS, "addr"),
2821 	IWPRIV_GET(GEN_OID_LINKSTATE, "linkstate"),
2822 	IWPRIV_U32(DOT11_OID_BSSTYPE, "bsstype"),
2823 	IWPRIV_ADDR(DOT11_OID_BSSID, "bssid"),
2824 	IWPRIV_U32(DOT11_OID_STATE, "state"),
2825 	IWPRIV_U32(DOT11_OID_AID, "aid"),
2826 
2827 	IWPRIV_SSID(DOT11_OID_SSIDOVERRIDE, "ssidoverride"),
2828 
2829 	IWPRIV_U32(DOT11_OID_MEDIUMLIMIT, "medlimit"),
2830 	IWPRIV_U32(DOT11_OID_BEACONPERIOD, "beacon"),
2831 	IWPRIV_U32(DOT11_OID_DTIMPERIOD, "dtimperiod"),
2832 
2833 	IWPRIV_U32(DOT11_OID_AUTHENABLE, "authenable"),
2834 	IWPRIV_U32(DOT11_OID_PRIVACYINVOKED, "privinvok"),
2835 	IWPRIV_U32(DOT11_OID_EXUNENCRYPTED, "exunencrypt"),
2836 
2837 	IWPRIV_U32(DOT11_OID_REKEYTHRESHOLD, "rekeythresh"),
2838 
2839 	IWPRIV_U32(DOT11_OID_MAXTXLIFETIME, "maxtxlife"),
2840 	IWPRIV_U32(DOT11_OID_MAXRXLIFETIME, "maxrxlife"),
2841 	IWPRIV_U32(DOT11_OID_ALOFT_FIXEDRATE, "fixedrate"),
2842 	IWPRIV_U32(DOT11_OID_MAXFRAMEBURST, "frameburst"),
2843 	IWPRIV_U32(DOT11_OID_PSM, "psm"),
2844 
2845 	IWPRIV_U32(DOT11_OID_BRIDGELOCAL, "bridge"),
2846 	IWPRIV_U32(DOT11_OID_CLIENTS, "clients"),
2847 	IWPRIV_U32(DOT11_OID_CLIENTSASSOCIATED, "clientassoc"),
2848 	IWPRIV_U32(DOT11_OID_DOT1XENABLE, "dot1xenable"),
2849 	IWPRIV_U32(DOT11_OID_ANTENNARX, "rxant"),
2850 	IWPRIV_U32(DOT11_OID_ANTENNATX, "txant"),
2851 	IWPRIV_U32(DOT11_OID_ANTENNADIVERSITY, "antdivers"),
2852 	IWPRIV_U32(DOT11_OID_EDTHRESHOLD, "edthresh"),
2853 	IWPRIV_U32(DOT11_OID_PREAMBLESETTINGS, "preamble"),
2854 	IWPRIV_GET(DOT11_OID_RATES, "rates"),
2855 	IWPRIV_U32(DOT11_OID_OUTPUTPOWER, ".11outpower"),
2856 	IWPRIV_GET(DOT11_OID_SUPPORTEDRATES, "supprates"),
2857 	IWPRIV_GET(DOT11_OID_SUPPORTEDFREQUENCIES, "suppfreq"),
2858 
2859 	IWPRIV_U32(DOT11_OID_NOISEFLOOR, "noisefloor"),
2860 	IWPRIV_GET(DOT11_OID_FREQUENCYACTIVITY, "freqactivity"),
2861 	IWPRIV_U32(DOT11_OID_NONERPPROTECTION, "nonerpprotec"),
2862 	IWPRIV_U32(DOT11_OID_PROFILES, "profile"),
2863 	IWPRIV_GET(DOT11_OID_EXTENDEDRATES, "extrates"),
2864 	IWPRIV_U32(DOT11_OID_MLMEAUTOLEVEL, "mlmelevel"),
2865 
2866 	IWPRIV_GET(DOT11_OID_BSSS, "bsss"),
2867 	IWPRIV_GET(DOT11_OID_BSSLIST, "bsslist"),
2868 	IWPRIV_U32(OID_INL_MODE, "mode"),
2869 	IWPRIV_U32(OID_INL_CONFIG, "config"),
2870 	IWPRIV_U32(OID_INL_DOT11D_CONFORMANCE, ".11dconform"),
2871 	IWPRIV_GET(OID_INL_PHYCAPABILITIES, "phycapa"),
2872 	IWPRIV_U32(OID_INL_OUTPUTPOWER, "outpower"),
2873 };
2874 
2875 static const iw_handler prism54_private_handler[] = {
2876 	(iw_handler) prism54_reset,
2877 	(iw_handler) prism54_get_policy,
2878 	(iw_handler) prism54_set_policy,
2879 	(iw_handler) prism54_get_mac,
2880 	(iw_handler) prism54_add_mac,
2881 	(iw_handler) NULL,
2882 	(iw_handler) prism54_del_mac,
2883 	(iw_handler) NULL,
2884 	(iw_handler) prism54_kick_mac,
2885 	(iw_handler) NULL,
2886 	(iw_handler) prism54_kick_all,
2887 	(iw_handler) prism54_get_wpa,
2888 	(iw_handler) prism54_set_wpa,
2889 	(iw_handler) NULL,
2890 	(iw_handler) prism54_debug_oid,
2891 	(iw_handler) prism54_debug_get_oid,
2892 	(iw_handler) prism54_debug_set_oid,
2893 	(iw_handler) prism54_get_oid,
2894 	(iw_handler) prism54_set_u32,
2895 	(iw_handler) NULL,
2896 	(iw_handler) prism54_set_raw,
2897 	(iw_handler) NULL,
2898 	(iw_handler) prism54_set_raw,
2899 	(iw_handler) prism54_get_prismhdr,
2900 	(iw_handler) prism54_set_prismhdr,
2901 };
2902 
2903 const struct iw_handler_def prism54_handler_def = {
2904 	.num_standard = ARRAY_SIZE(prism54_handler),
2905 	.num_private = ARRAY_SIZE(prism54_private_handler),
2906 	.num_private_args = ARRAY_SIZE(prism54_private_args),
2907 	.standard = (iw_handler *) prism54_handler,
2908 	.private = (iw_handler *) prism54_private_handler,
2909 	.private_args = (struct iw_priv_args *) prism54_private_args,
2910 	.get_wireless_stats = prism54_get_wireless_stats,
2911 };
2912