projects / openwrt.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
various changes for kernel video support:
[openwrt.git] / package / wlcompat / src / wlcompat.c
1 /*
2 * wlcompat.c
3 *
4 * Copyright (C) 2005 Mike Baker
5 * Copyright (C) 2005-2007 Felix Fietkau <nbd@openwrt.org>
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; either version 2
10 * of the License, or (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
20 *
21 * $Id$
22 */
23
24
25 #include <linux/config.h>
26 #include <linux/module.h>
27 #include <linux/moduleparam.h>
28 #include <linux/init.h>
29 #include <linux/if_arp.h>
30 #include <linux/wireless.h>
31 #include <linux/timer.h>
32 #include <linux/delay.h>
33 #include <net/iw_handler.h>
34 #include <asm/uaccess.h>
35
36 #include <typedefs.h>
37 #include <bcmutils.h>
38 #include <wlioctl.h>
39
40 static struct net_device *dev;
41 static struct iw_statistics wstats;
42 #ifndef DEBUG
43 static int random = 1;
44 #endif
45 static int last_mode = -1;
46 static int scan_cur = 0;
47 char buf[WLC_IOCTL_MAXLEN];
48
49 /* The frequency of each channel in MHz */
50 const long channel_frequency[] = {
51 2412, 2417, 2422, 2427, 2432, 2437, 2442,
52 2447, 2452, 2457, 2462, 2467, 2472, 2484
53 };
54 #define NUM_CHANNELS ( sizeof(channel_frequency) / sizeof(channel_frequency[0]) )
55
56 #define SCAN_RETRY_MAX 5
57 #define RNG_POLL_FREQ 1
58
59 typedef struct internal_wsec_key {
60 uint8 index; // 0x00
61 uint8 unknown_1; // 0x01
62 uint8 type; // 0x02
63 uint8 unknown_2[7]; // 0x03
64 uint8 len; // 0x0a
65 uint8 pad[3];
66 char data[32]; // 0x0e
67 } wkey;
68
69
70 #ifdef DEBUG
71 void print_buffer(int len, unsigned char *buf);
72 #endif
73
74 static int wl_ioctl(struct net_device *dev, int cmd, void *buf, int len)
75 {
76 mm_segment_t old_fs = get_fs();
77 struct ifreq ifr;
78 int ret;
79 wl_ioctl_t ioc;
80 ioc.cmd = cmd;
81 ioc.buf = buf;
82 ioc.len = len;
83 strncpy(ifr.ifr_name, dev->name, IFNAMSIZ);
84 ifr.ifr_data = (caddr_t) &ioc;
85 set_fs(KERNEL_DS);
86 ret = dev->do_ioctl(dev,&ifr,SIOCDEVPRIVATE);
87 set_fs (old_fs);
88 return ret;
89 }
90
91 static int
92 wl_iovar_getbuf(struct net_device *dev, char *iovar, void *param, int paramlen, void *bufptr, int buflen)
93 {
94 int err;
95 uint namelen;
96 uint iolen;
97
98 namelen = strlen(iovar) + 1; /* length of iovar name plus null */
99 iolen = namelen + paramlen;
100
101 /* check for overflow */
102 if (iolen > buflen)
103 return (BCME_BUFTOOSHORT);
104
105 memcpy(bufptr, iovar, namelen); /* copy iovar name including null */
106 memcpy((int8*)bufptr + namelen, param, paramlen);
107
108 err = wl_ioctl(dev, WLC_GET_VAR, bufptr, buflen);
109
110 return (err);
111 }
112
113 static int
114 wl_iovar_setbuf(struct net_device *dev, char *iovar, void *param, int paramlen, void *bufptr, int buflen)
115 {
116 uint namelen;
117 uint iolen;
118
119 namelen = strlen(iovar) + 1; /* length of iovar name plus null */
120 iolen = namelen + paramlen;
121
122 /* check for overflow */
123 if (iolen > buflen)
124 return (BCME_BUFTOOSHORT);
125
126 memcpy(bufptr, iovar, namelen); /* copy iovar name including null */
127 memcpy((int8*)bufptr + namelen, param, paramlen);
128
129 return wl_ioctl(dev, WLC_SET_VAR, bufptr, iolen);
130 }
131
132 static int
133 wl_iovar_set(struct net_device *dev, char *iovar, void *param, int paramlen)
134 {
135 char smbuf[WLC_IOCTL_SMLEN];
136
137 return wl_iovar_setbuf(dev, iovar, param, paramlen, smbuf, sizeof(smbuf));
138 }
139
140 static int
141 wl_iovar_get(struct net_device *dev, char *iovar, void *bufptr, int buflen)
142 {
143 char smbuf[WLC_IOCTL_SMLEN];
144 int ret;
145
146 /* use the return buffer if it is bigger than what we have on the stack */
147 if (buflen > sizeof(smbuf)) {
148 ret = wl_iovar_getbuf(dev, iovar, NULL, 0, bufptr, buflen);
149 } else {
150 ret = wl_iovar_getbuf(dev, iovar, NULL, 0, smbuf, sizeof(smbuf));
151 if (ret == 0)
152 memcpy(bufptr, smbuf, buflen);
153 }
154
155 return ret;
156 }
157
158 #ifdef notyet
159 /*
160 * format a bsscfg indexed iovar buffer
161 */
162 static int
163 wl_bssiovar_mkbuf(char *iovar, int bssidx, void *param, int paramlen, void *bufptr, int buflen,
164 int *plen)
165 {
166 char *prefix = "bsscfg:";
167 int8* p;
168 uint prefixlen;
169 uint namelen;
170 uint iolen;
171
172 prefixlen = strlen(prefix); /* length of bsscfg prefix */
173 namelen = strlen(iovar) + 1; /* length of iovar name + null */
174 iolen = prefixlen + namelen + sizeof(int) + paramlen;
175
176 /* check for overflow */
177 if (buflen < 0 || iolen > (uint)buflen) {
178 *plen = 0;
179 return BCME_BUFTOOSHORT;
180 }
181
182 p = (int8*)bufptr;
183
184 /* copy prefix, no null */
185 memcpy(p, prefix, prefixlen);
186 p += prefixlen;
187
188 /* copy iovar name including null */
189 memcpy(p, iovar, namelen);
190 p += namelen;
191
192 /* bss config index as first param */
193 memcpy(p, &bssidx, sizeof(int32));
194 p += sizeof(int32);
195
196 /* parameter buffer follows */
197 if (paramlen)
198 memcpy(p, param, paramlen);
199
200 *plen = iolen;
201 return 0;
202 }
203
204 /*
205 * set named & bss indexed driver variable to buffer value
206 */
207 static int
208 wl_bssiovar_setbuf(struct net_device *dev, char *iovar, int bssidx, void *param, int paramlen, void *bufptr,
209 int buflen)
210 {
211 int err;
212 int iolen;
213
214 err = wl_bssiovar_mkbuf(iovar, bssidx, param, paramlen, bufptr, buflen, &iolen);
215 if (err)
216 return err;
217
218 return wl_ioctl(dev, WLC_SET_VAR, bufptr, iolen);
219 }
220
221 /*
222 * get named & bss indexed driver variable buffer value
223 */
224 static int
225 wl_bssiovar_getbuf(struct net_device *dev, char *iovar, int bssidx, void *param, int paramlen, void *bufptr,
226 int buflen)
227 {
228 int err;
229 int iolen;
230
231 err = wl_bssiovar_mkbuf(iovar, bssidx, param, paramlen, bufptr, buflen, &iolen);
232 if (err)
233 return err;
234
235 return wl_ioctl(dev, WLC_GET_VAR, bufptr, buflen);
236 }
237
238 /*
239 * set named & bss indexed driver variable to buffer value
240 */
241 static int
242 wl_bssiovar_set(struct net_device *dev, char *iovar, int bssidx, void *param, int paramlen)
243 {
244 char smbuf[WLC_IOCTL_SMLEN];
245
246 return wl_bssiovar_setbuf(dev, iovar, bssidx, param, paramlen, smbuf, sizeof(smbuf));
247 }
248
249 /*
250 * get named & bss indexed driver variable buffer value
251 */
252 static int
253 wl_bssiovar_get(struct net_device *dev, char *iovar, int bssidx, void *outbuf, int len)
254 {
255 char smbuf[WLC_IOCTL_SMLEN];
256 int err;
257
258 /* use the return buffer if it is bigger than what we have on the stack */
259 if (len > (int)sizeof(smbuf)) {
260 err = wl_bssiovar_getbuf(dev, iovar, bssidx, NULL, 0, outbuf, len);
261 } else {
262 memset(smbuf, 0, sizeof(smbuf));
263 err = wl_bssiovar_getbuf(dev, iovar, bssidx, NULL, 0, smbuf, sizeof(smbuf));
264 if (err == 0)
265 memcpy(outbuf, smbuf, len);
266 }
267
268 return err;
269 }
270 #endif
271
272 int get_primary_key(struct net_device *dev)
273 {
274 int key, val;
275
276 for (key = val = 0; (key < 4) && (val == 0); key++) {
277 val = key;
278 if (wl_ioctl(dev, WLC_GET_KEY_PRIMARY, &val, sizeof(val)) < 0)
279 return -EINVAL;
280 }
281 return key;
282 }
283
284
285 static int wlcompat_ioctl_getiwrange(struct net_device *dev,
286 char *extra)
287 {
288 int i, k;
289 struct iw_range *range;
290
291 range = (struct iw_range *) extra;
292 memset(extra, 0, sizeof(struct iw_range));
293
294 range->we_version_compiled = WIRELESS_EXT;
295 range->we_version_source = WIRELESS_EXT;
296
297 range->min_nwid = range->max_nwid = 0;
298
299 range->num_channels = NUM_CHANNELS;
300 k = 0;
301 for (i = 0; i < NUM_CHANNELS; i++) {
302 range->freq[k].i = i + 1;
303 range->freq[k].m = channel_frequency[i] * 100000;
304 range->freq[k].e = 1;
305 k++;
306 if (k >= IW_MAX_FREQUENCIES)
307 break;
308 }
309 range->num_frequency = k;
310 range->sensitivity = 3;
311
312 /* nbd: don't know what this means, but other drivers set it this way */
313 range->pmp_flags = IW_POWER_PERIOD;
314 range->pmt_flags = IW_POWER_TIMEOUT;
315 range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_UNICAST_R;
316
317 range->min_pmp = 0;
318 range->max_pmp = 65535000;
319 range->min_pmt = 0;
320 range->max_pmt = 65535 * 1000;
321
322 range->max_qual.qual = 0;
323 range->max_qual.level = 0;
324 range->max_qual.noise = 0;
325
326 range->min_rts = 0;
327 if (wl_iovar_get(dev, "rtsthresh", &range->max_rts, sizeof(int)) < 0)
328 range->max_rts = 2347;
329
330 range->min_frag = 256;
331
332 if (wl_iovar_get(dev, "fragthresh", &range->max_frag, sizeof(int)) < 0)
333 range->max_frag = 2346;
334
335 range->txpower_capa = IW_TXPOW_DBM;
336
337 return 0;
338 }
339
340
341 static int wlcompat_set_scan(struct net_device *dev,
342 struct iw_request_info *info,
343 union iwreq_data *wrqu,
344 char *extra)
345 {
346 int ap = 0;
347 wl_scan_params_t params;
348
349 memset(&params, 0, sizeof(params));
350
351 /* use defaults (same parameters as wl scan) */
352 memset(&params.bssid, 0xff, sizeof(params.bssid));
353 params.bss_type = DOT11_BSSTYPE_ANY;
354 params.scan_type = -1;
355 params.nprobes = -1;
356 params.active_time = -1;
357 params.passive_time = -1;
358 params.home_time = -1;
359
360 /* can only scan in STA mode */
361 wl_ioctl(dev, WLC_GET_AP, &last_mode, sizeof(last_mode));
362 if (last_mode > 0) {
363 /* switch to ap mode, scan result query will switch back */
364 wl_ioctl(dev, WLC_SET_AP, &ap, sizeof(ap));
365
366 /* wait 250 msec after mode change */
367 set_current_state(TASK_INTERRUPTIBLE);
368 schedule_timeout(msecs_to_jiffies(250));
369 }
370
371 scan_cur = SCAN_RETRY_MAX;
372 while (scan_cur-- && (wl_ioctl(dev, WLC_SCAN, &params, 64) < 0)) {
373 /* sometimes the driver takes a few tries... */
374 set_current_state(TASK_INTERRUPTIBLE);
375 schedule_timeout(msecs_to_jiffies(250));
376 }
377
378 if (!scan_cur)
379 return -EINVAL;
380
381 scan_cur = 0;
382
383 /* wait at least 2 seconds for results */
384 set_current_state(TASK_INTERRUPTIBLE);
385 schedule_timeout(msecs_to_jiffies(2000));
386
387 return 0;
388 }
389
390
391 struct iw_statistics *wlcompat_get_wireless_stats(struct net_device *dev)
392 {
393 struct wl_bss_info *bss_info = (struct wl_bss_info *) buf;
394 get_pktcnt_t pkt;
395 unsigned int rssi, noise, ap;
396
397 memset(&wstats, 0, sizeof(wstats));
398 memset(&pkt, 0, sizeof(pkt));
399 memset(buf, 0, sizeof(buf));
400 bss_info->version = 0x2000;
401 wl_ioctl(dev, WLC_GET_BSS_INFO, bss_info, WLC_IOCTL_MAXLEN);
402 wl_ioctl(dev, WLC_GET_PKTCNTS, &pkt, sizeof(pkt));
403
404 rssi = 0;
405 if ((wl_ioctl(dev, WLC_GET_AP, &ap, sizeof(ap)) < 0) || ap) {
406 if (wl_ioctl(dev, WLC_GET_PHY_NOISE, &noise, sizeof(noise)) < 0)
407 noise = 0;
408 } else {
409 // somehow the structure doesn't fit here
410 rssi = buf[82];
411 noise = buf[84];
412 }
413 rssi = (rssi == 0 ? 1 : rssi);
414 wstats.qual.updated = 0x10;
415 if (rssi <= 1)
416 wstats.qual.updated |= 0x20;
417 if (noise <= 1)
418 wstats.qual.updated |= 0x40;
419
420 if ((wstats.qual.updated & 0x60) == 0x60)
421 return NULL;
422
423 wstats.qual.level = rssi;
424 wstats.qual.noise = noise;
425 wstats.discard.misc = pkt.rx_bad_pkt;
426 wstats.discard.retries = pkt.tx_bad_pkt;
427
428 return &wstats;
429 }
430
431 static int wlcompat_get_scan(struct net_device *dev,
432 struct iw_request_info *info,
433 union iwreq_data *wrqu,
434 char *extra)
435 {
436 wl_scan_results_t *results = (wl_scan_results_t *) buf;
437 wl_bss_info_t *bss_info;
438 char *info_ptr;
439 char *current_ev = extra;
440 char *current_val;
441 char *end_buf = extra + IW_SCAN_MAX_DATA;
442 struct iw_event iwe;
443 int i, j;
444 int rssi, noise;
445
446 memset(buf, 0, WLC_IOCTL_MAXLEN);
447 results->buflen = WLC_IOCTL_MAXLEN - sizeof(wl_scan_results_t);
448
449 if (wl_ioctl(dev, WLC_SCAN_RESULTS, buf, WLC_IOCTL_MAXLEN) < 0)
450 return -EAGAIN;
451
452 if ((results->count <= 0) && (scan_cur++ < SCAN_RETRY_MAX))
453 return -EAGAIN;
454
455 bss_info = &(results->bss_info[0]);
456 info_ptr = (char *) bss_info;
457 for (i = 0; i < results->count; i++) {
458 /* send the cell address (must be sent first) */
459 iwe.cmd = SIOCGIWAP;
460 iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
461 memcpy(&iwe.u.ap_addr.sa_data, &bss_info->BSSID, sizeof(bss_info->BSSID));
462 current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe, IW_EV_ADDR_LEN);
463
464 /* send the ESSID */
465 iwe.cmd = SIOCGIWESSID;
466 iwe.u.data.length = bss_info->SSID_len;
467 if (iwe.u.data.length > IW_ESSID_MAX_SIZE)
468 iwe.u.data.length = IW_ESSID_MAX_SIZE;
469 iwe.u.data.flags = 1;
470 current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe, bss_info->SSID);
471
472 /* send mode */
473 if (bss_info->capability & (DOT11_CAP_ESS | DOT11_CAP_IBSS)) {
474 iwe.cmd = SIOCGIWMODE;
475 if (bss_info->capability & DOT11_CAP_ESS)
476 iwe.u.mode = IW_MODE_MASTER;
477 else if (bss_info->capability & DOT11_CAP_IBSS)
478 iwe.u.mode = IW_MODE_ADHOC;
479 current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe, IW_EV_UINT_LEN);
480 }
481
482 /* send frequency/channel info */
483 iwe.cmd = SIOCGIWFREQ;
484 iwe.u.freq.e = 0;
485 iwe.u.freq.m = bss_info->chanspec & WL_CHANSPEC_CHAN_MASK;
486 current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe, IW_EV_FREQ_LEN);
487
488 /* add quality statistics */
489 iwe.cmd = IWEVQUAL;
490 iwe.u.qual.qual = 0;
491 iwe.u.qual.level = bss_info->RSSI;
492 iwe.u.qual.noise = bss_info->phy_noise;
493 current_ev = iwe_stream_add_event(current_ev, end_buf, &iwe, IW_EV_QUAL_LEN);
494
495 /* send encryption capability */
496 iwe.cmd = SIOCGIWENCODE;
497 iwe.u.data.pointer = NULL;
498 iwe.u.data.length = 0;
499 if (bss_info->capability & DOT11_CAP_PRIVACY)
500 iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
501 else
502 iwe.u.data.flags = IW_ENCODE_DISABLED;
503 current_ev = iwe_stream_add_point(current_ev, end_buf, &iwe, NULL);
504
505 /* send rate information */
506 iwe.cmd = SIOCGIWRATE;
507 current_val = current_ev + IW_EV_LCP_LEN;
508 iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
509
510 for(j = 0 ; j < bss_info->rateset.count ; j++) {
511 iwe.u.bitrate.value = ((bss_info->rateset.rates[j] & 0x7f) * 500000);
512 current_val = iwe_stream_add_value(current_ev, current_val, end_buf, &iwe, IW_EV_PARAM_LEN);
513 }
514 if((current_val - current_ev) > IW_EV_LCP_LEN)
515 current_ev = current_val;
516
517 info_ptr += sizeof(wl_bss_info_t);
518 if (bss_info->ie_length % 4)
519 info_ptr += bss_info->ie_length + 4 - (bss_info->ie_length % 4);
520 else
521 info_ptr += bss_info->ie_length;
522 bss_info = (wl_bss_info_t *) info_ptr;
523 }
524
525 wrqu->data.length = (current_ev - extra);
526 wrqu->data.flags = 0;
527
528 if (last_mode > 0)
529 /* switch back to ap mode */
530 wl_ioctl(dev, WLC_SET_AP, &last_mode, sizeof(last_mode));
531
532 return 0;
533 }
534
535 static int wlcompat_ioctl(struct net_device *dev,
536 struct iw_request_info *info,
537 union iwreq_data *wrqu,
538 char *extra)
539 {
540 switch (info->cmd) {
541 case SIOCGIWNAME:
542 strcpy(wrqu->name, "IEEE 802.11-DS");
543 break;
544 case SIOCGIWFREQ:
545 {
546 channel_info_t ci;
547
548 if (wl_ioctl(dev,WLC_GET_CHANNEL, &ci, sizeof(ci)) < 0)
549 return -EINVAL;
550
551 wrqu->freq.m = ci.target_channel;
552 wrqu->freq.e = 0;
553 break;
554 }
555 case SIOCSIWFREQ:
556 {
557 if (wrqu->freq.m == -1) {
558 wrqu->freq.m = 0;
559 if (wl_ioctl(dev, WLC_SET_CHANNEL, &wrqu->freq.m, sizeof(int)) < 0)
560 return -EINVAL;
561 } else {
562 if (wrqu->freq.e == 1) {
563 int channel = 0;
564 int f = wrqu->freq.m / 100000;
565 while ((channel < NUM_CHANNELS + 1) && (f != channel_frequency[channel]))
566 channel++;
567
568 if (channel == NUM_CHANNELS) // channel not found
569 return -EINVAL;
570
571 wrqu->freq.e = 0;
572 wrqu->freq.m = channel + 1;
573 }
574 if ((wrqu->freq.e == 0) && (wrqu->freq.m < 1000)) {
575 if (wl_ioctl(dev, WLC_SET_CHANNEL, &wrqu->freq.m, sizeof(int)) < 0)
576 return -EINVAL;
577 } else {
578 return -EINVAL;
579 }
580 }
581 break;
582 }
583 case SIOCSIWAP:
584 {
585 int ap = 0;
586 int infra = 0;
587 rw_reg_t reg;
588
589 memset(&reg, 0, sizeof(reg));
590
591 if (wrqu->ap_addr.sa_family != ARPHRD_ETHER)
592 return -EINVAL;
593
594 if (wl_ioctl(dev, WLC_GET_AP, &ap, sizeof(ap)) < 0)
595 return -EINVAL;
596
597 if (wl_ioctl(dev, WLC_GET_INFRA, &infra, sizeof(infra)) < 0)
598 return -EINVAL;
599
600 if (!infra)
601 wl_ioctl(dev, WLC_SET_BSSID, wrqu->ap_addr.sa_data, 6);
602
603 if (wl_ioctl(dev, ((ap || !infra) ? WLC_SET_BSSID : WLC_REASSOC), wrqu->ap_addr.sa_data, 6) < 0)
604 return -EINVAL;
605
606 break;
607 }
608 case SIOCGIWAP:
609 {
610 wrqu->ap_addr.sa_family = ARPHRD_ETHER;
611 if (wl_ioctl(dev,WLC_GET_BSSID,wrqu->ap_addr.sa_data,6) < 0)
612 return -EINVAL;
613 break;
614 }
615 case SIOCGIWESSID:
616 {
617 wlc_ssid_t ssid;
618
619 if (wl_ioctl(dev,WLC_GET_SSID, &ssid, sizeof(wlc_ssid_t)) < 0)
620 return -EINVAL;
621
622 wrqu->essid.flags = wrqu->data.flags = 1;
623 wrqu->essid.length = wrqu->data.length = ssid.SSID_len + 1;
624 memcpy(extra,ssid.SSID,ssid.SSID_len + 1);
625 break;
626 }
627 case SIOCSIWESSID:
628 {
629 wlc_ssid_t ssid;
630 memset(&ssid, 0, sizeof(ssid));
631 ssid.SSID_len = strlen(extra);
632 if (ssid.SSID_len > 32)
633 ssid.SSID_len = 32;
634 memcpy(ssid.SSID, extra, ssid.SSID_len);
635 if (wl_ioctl(dev, WLC_SET_SSID, &ssid, sizeof(ssid)) < 0)
636 return -EINVAL;
637 break;
638 }
639 case SIOCGIWRTS:
640 {
641 if (wl_iovar_get(dev, "rtsthresh", &(wrqu->rts.value), sizeof(int)) < 0)
642 return -EINVAL;
643 break;
644 }
645 case SIOCSIWRTS:
646 {
647 if (wl_iovar_set(dev, "rtsthresh", &(wrqu->rts.value), sizeof(int)) < 0)
648 return -EINVAL;
649 break;
650 }
651 case SIOCGIWFRAG:
652 {
653 if (wl_iovar_get(dev, "fragthresh", &(wrqu->frag.value), sizeof(int)) < 0)
654 return -EINVAL;
655 break;
656 }
657 case SIOCSIWFRAG:
658 {
659 if (wl_iovar_set(dev, "fragthresh", &(wrqu->frag.value), sizeof(int)) < 0)
660 return -EINVAL;
661 break;
662 }
663 case SIOCGIWTXPOW:
664 {
665 int radio, override;
666
667 wl_ioctl(dev, WLC_GET_RADIO, &radio, sizeof(int));
668
669 if (wl_iovar_get(dev, "qtxpower", &(wrqu->txpower.value), sizeof(int)) < 0)
670 return -EINVAL;
671
672 override = (wrqu->txpower.value & WL_TXPWR_OVERRIDE) == WL_TXPWR_OVERRIDE;
673 wrqu->txpower.value &= ~WL_TXPWR_OVERRIDE;
674 if (!override && (wrqu->txpower.value > 76))
675 wrqu->txpower.value = 76;
676 wrqu->txpower.value /= 4;
677
678 wrqu->txpower.fixed = 0;
679 wrqu->txpower.disabled = radio;
680 wrqu->txpower.flags = IW_TXPOW_DBM;
681 break;
682 }
683 case SIOCSIWTXPOW:
684 {
685 /* This is weird: WLC_SET_RADIO with 1 as argument disables the radio */
686 int radio = wrqu->txpower.disabled;
687
688 wl_ioctl(dev, WLC_SET_RADIO, &radio, sizeof(int));
689
690 if (!wrqu->txpower.disabled && (wrqu->txpower.value > 0)) {
691 int value;
692
693 if (wl_iovar_get(dev, "qtxpower", &value, sizeof(int)) < 0)
694 return -EINVAL;
695
696 value &= WL_TXPWR_OVERRIDE;
697 wrqu->txpower.value *= 4;
698 wrqu->txpower.value |= value;
699
700 if (wrqu->txpower.flags != IW_TXPOW_DBM)
701 return -EINVAL;
702
703 if (wrqu->txpower.value > 0)
704 if (wl_iovar_set(dev, "qtxpower", &(wrqu->txpower.value), sizeof(int)) < 0)
705 return -EINVAL;
706 }
707 break;
708 }
709 case SIOCSIWENCODE:
710 {
711 int val = 0, wep = 1, wrestrict = 1;
712 int index = (wrqu->data.flags & IW_ENCODE_INDEX) - 1;
713
714 if (index < 0)
715 index = get_primary_key(dev);
716
717 if (wrqu->data.flags & IW_ENCODE_DISABLED) {
718 wep = 0;
719 if (wl_ioctl(dev, WLC_SET_WSEC, &wep, sizeof(val)) < 0)
720 return -EINVAL;
721 return 0;
722 }
723
724 if (wl_ioctl(dev, WLC_SET_WSEC, &wep, sizeof(val)) < 0)
725 return -EINVAL;
726
727 if (wrqu->data.flags & IW_ENCODE_OPEN)
728 wrestrict = 0;
729
730 if (wrqu->data.pointer && (wrqu->data.length > 0) && (wrqu->data.length <= 16)) {
731 wl_wsec_key_t key;
732 memset(&key, 0, sizeof(key));
733
734 key.flags = WL_PRIMARY_KEY;
735 key.len = wrqu->data.length;
736 key.index = index;
737 memcpy(key.data, wrqu->data.pointer, wrqu->data.length);
738
739 if (wl_ioctl(dev, WLC_SET_KEY, &key, sizeof(key)) < 0)
740 return -EINVAL;
741 }
742
743 if (index >= 0)
744 wl_ioctl(dev, WLC_SET_KEY_PRIMARY, &index, sizeof(index));
745
746 if (wrestrict >= 0)
747 wl_ioctl(dev, WLC_SET_WEP_RESTRICT, &wrestrict, sizeof(wrestrict));
748
749 break;
750 }
751 case SIOCGIWENCODE:
752 {
753 int val;
754 int key = get_primary_key(dev);
755 int *info_addr;
756 wkey *wep_key;
757
758 if (wl_ioctl(dev, WLC_GET_WSEC, &val, sizeof(val)) < 0)
759 return -EINVAL;
760 if (!(val & WEP_ENABLED)) {
761 wrqu->data.flags = IW_ENCODE_DISABLED;
762 break;
763 }
764
765 key = get_primary_key(dev);
766 wrqu->data.flags = IW_ENCODE_ENABLED;
767
768 /* the driver apparently doesn't allow us to read the wep key */
769 wrqu->data.flags |= IW_ENCODE_NOKEY;
770
771 break;
772 }
773 case SIOCGIWRANGE:
774 {
775 return wlcompat_ioctl_getiwrange(dev, extra);
776 break;
777 }
778 case SIOCSIWMODE:
779 {
780 int ap = -1, infra = -1, passive = 0, wet = 0;
781
782 switch (wrqu->mode) {
783 case IW_MODE_MONITOR:
784 passive = 1;
785 break;
786 case IW_MODE_ADHOC:
787 infra = 0;
788 ap = 0;
789 break;
790 case IW_MODE_MASTER:
791 infra = 1;
792 ap = 1;
793 break;
794 case IW_MODE_INFRA:
795 infra = 1;
796 ap = 0;
797 break;
798 case IW_MODE_REPEAT:
799 infra = 1;
800 ap = 0;
801 wet = 1;
802 break;
803
804 default:
805 return -EINVAL;
806 }
807
808 wl_ioctl(dev, WLC_SET_PASSIVE, &passive, sizeof(passive));
809 wl_ioctl(dev, WLC_SET_MONITOR, &passive, sizeof(passive));
810 wl_ioctl(dev, WLC_SET_WET, &wet, sizeof(wet));
811 if (ap >= 0)
812 wl_ioctl(dev, WLC_SET_AP, &ap, sizeof(ap));
813 if (infra >= 0)
814 wl_ioctl(dev, WLC_SET_INFRA, &infra, sizeof(infra));
815
816 break;
817
818 }
819 case SIOCGIWMODE:
820 {
821 int ap, infra, wet, passive;
822
823 if (wl_ioctl(dev, WLC_GET_AP, &ap, sizeof(ap)) < 0)
824 return -EINVAL;
825 if (wl_ioctl(dev, WLC_GET_INFRA, &infra, sizeof(infra)) < 0)
826 return -EINVAL;
827 if (wl_ioctl(dev, WLC_GET_PASSIVE, &passive, sizeof(passive)) < 0)
828 return -EINVAL;
829 if (wl_ioctl(dev, WLC_GET_WET, &wet, sizeof(wet)) < 0)
830 return -EINVAL;
831
832 if (passive) {
833 wrqu->mode = IW_MODE_MONITOR;
834 } else if (!infra) {
835 wrqu->mode = IW_MODE_ADHOC;
836 } else {
837 if (ap) {
838 wrqu->mode = IW_MODE_MASTER;
839 } else {
840 if (wet) {
841 wrqu->mode = IW_MODE_REPEAT;
842 } else {
843 wrqu->mode = IW_MODE_INFRA;
844 }
845 }
846 }
847 break;
848 }
849 default:
850 return -EINVAL;
851 break;
852 }
853
854 return 0;
855 }
856
857 static const iw_handler wlcompat_handler[] = {
858 NULL, /* SIOCSIWCOMMIT */
859 wlcompat_ioctl, /* SIOCGIWNAME */
860 NULL, /* SIOCSIWNWID */
861 NULL, /* SIOCGIWNWID */
862 wlcompat_ioctl, /* SIOCSIWFREQ */
863 wlcompat_ioctl, /* SIOCGIWFREQ */
864 wlcompat_ioctl, /* SIOCSIWMODE */
865 wlcompat_ioctl, /* SIOCGIWMODE */
866 NULL, /* SIOCSIWSENS */
867 NULL, /* SIOCGIWSENS */
868 NULL, /* SIOCSIWRANGE, unused */
869 wlcompat_ioctl, /* SIOCGIWRANGE */
870 NULL, /* SIOCSIWPRIV */
871 NULL, /* SIOCGIWPRIV */
872 NULL, /* SIOCSIWSTATS */
873 NULL, /* SIOCGIWSTATS */
874 iw_handler_set_spy, /* SIOCSIWSPY */
875 iw_handler_get_spy, /* SIOCGIWSPY */
876 iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
877 iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
878 wlcompat_ioctl, /* SIOCSIWAP */
879 wlcompat_ioctl, /* SIOCGIWAP */
880 NULL, /* -- hole -- */
881 NULL, /* SIOCGIWAPLIST */
882 wlcompat_set_scan, /* SIOCSIWSCAN */
883 wlcompat_get_scan, /* SIOCGIWSCAN */
884 wlcompat_ioctl, /* SIOCSIWESSID */
885 wlcompat_ioctl, /* SIOCGIWESSID */
886 NULL, /* SIOCSIWNICKN */
887 NULL, /* SIOCGIWNICKN */
888 NULL, /* -- hole -- */
889 NULL, /* -- hole -- */
890 NULL, /* SIOCSIWRATE */
891 NULL, /* SIOCGIWRATE */
892 wlcompat_ioctl, /* SIOCSIWRTS */
893 wlcompat_ioctl, /* SIOCGIWRTS */
894 wlcompat_ioctl, /* SIOCSIWFRAG */
895 wlcompat_ioctl, /* SIOCGIWFRAG */
896 wlcompat_ioctl, /* SIOCSIWTXPOW */
897 wlcompat_ioctl, /* SIOCGIWTXPOW */
898 NULL, /* SIOCSIWRETRY */
899 NULL, /* SIOCGIWRETRY */
900 wlcompat_ioctl, /* SIOCSIWENCODE */
901 wlcompat_ioctl, /* SIOCGIWENCODE */
902 };
903
904
905 static const struct iw_handler_def wlcompat_handler_def =
906 {
907 .standard = (iw_handler *) wlcompat_handler,
908 .num_standard = sizeof(wlcompat_handler)/sizeof(iw_handler),
909 };
910
911
912 #ifdef DEBUG
913 void print_buffer(int len, unsigned char *buf) {
914 int x;
915 if (buf != NULL) {
916 for (x=0;x<len && x<180 ;x++) {
917 if ((x % 4) == 0)
918 printk(" ");
919 printk("%02X",buf[x]);
920 }
921 } else {
922 printk(" NULL");
923 }
924 printk("\n");
925
926 }
927 #endif
928 static int (*old_ioctl)(struct net_device *dev, struct ifreq *ifr, int cmd);
929 static int new_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) {
930 int ret = 0;
931 struct iwreq *iwr = (struct iwreq *) ifr;
932 struct iw_request_info info;
933
934 #ifdef DEBUG
935 printk("dev: %s ioctl: 0x%04x\n",dev->name,cmd);
936 if (cmd==SIOCDEVPRIVATE) {
937 wl_ioctl_t *ioc = (wl_ioctl_t *)ifr->ifr_data;
938 unsigned char *buf = ioc->buf;
939 printk(" cmd: %d buf: 0x%08x len: %d\n",ioc->cmd,&(ioc->buf),ioc->len);
940 printk(" send: ->");
941 print_buffer(ioc->len, buf);
942 ret = old_ioctl(dev,ifr,cmd);
943 printk(" recv: ->");
944 print_buffer(ioc->len, buf);
945 printk(" ret: %d\n", ret);
946 } else
947 #endif
948 {
949 ret = old_ioctl(dev,ifr,cmd);
950 }
951 return ret;
952 }
953
954 #ifndef DEBUG
955 static struct timer_list rng_timer;
956 static spinlock_t rng_lock = SPIN_LOCK_UNLOCKED;
957
958 static void rng_timer_tick(unsigned long n)
959 {
960 struct net_device *dev = (struct net_device *) n;
961 unsigned long flags;
962 u16 data[4];
963 int i, ret;
964
965 ret = 0;
966 spin_lock_irqsave(&rng_lock, flags);
967 for (i = 0; i < 3; i++) {
968 ret |= wl_iovar_get(dev, "rand", &data[i], sizeof(u16));
969 }
970 spin_unlock_irqrestore(&rng_lock, flags);
971
972 if (!ret)
973 batch_entropy_store(*((u32 *) &data[0]), *((u32 *) &data[2]), (jiffies % 255));
974
975 mod_timer(&rng_timer, jiffies + (HZ/RNG_POLL_FREQ));
976 }
977 #endif
978
979 static int __init wlcompat_init()
980 {
981 int found = 0, i;
982 char devname[4] = "wl0";
983
984 while (!found && (dev = dev_get_by_name(devname))) {
985 if ((dev->wireless_handlers == NULL) && ((wl_ioctl(dev, WLC_GET_MAGIC, &i, sizeof(i)) == 0) && i == WLC_IOCTL_MAGIC))
986 found = 1;
987 devname[2]++;
988 }
989
990 if (!found) {
991 printk("No Broadcom devices found.\n");
992 return -ENODEV;
993 }
994
995
996 old_ioctl = dev->do_ioctl;
997 dev->do_ioctl = new_ioctl;
998 dev->wireless_handlers = (struct iw_handler_def *)&wlcompat_handler_def;
999 dev->get_wireless_stats = wlcompat_get_wireless_stats;
1000
1001 #ifndef DEBUG
1002 if (random) {
1003 init_timer(&rng_timer);
1004 rng_timer.function = rng_timer_tick;
1005 rng_timer.data = (unsigned long) dev;
1006 rng_timer_tick((unsigned long) dev);
1007 }
1008 #endif
1009
1010 #ifdef DEBUG
1011 printk("broadcom driver private data: 0x%08x\n", dev->priv);
1012 #endif
1013 return 0;
1014 }
1015
1016 static void __exit wlcompat_exit()
1017 {
1018 #ifndef DEBUG
1019 if (random)
1020 del_timer(&rng_timer);
1021 #endif
1022 dev->get_wireless_stats = NULL;
1023 dev->wireless_handlers = NULL;
1024 dev->do_ioctl = old_ioctl;
1025 return;
1026 }
1027
1028 EXPORT_NO_SYMBOLS;
1029 MODULE_AUTHOR("openwrt.org");
1030 MODULE_LICENSE("GPL");
1031
1032 #ifndef DEBUG
1033 module_param(random, int, 0);
1034 #endif
1035 module_init(wlcompat_init);
1036 module_exit(wlcompat_exit);
Personal OpenWRT clone
This page took 0.122495 seconds and 5 git commands to generate.