4 * Copyright (C) 2005 Mike Baker,
5 * Felix Fietkau <openwrt@nbd.name>
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.
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.
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.
25 #include <linux/config.h>
26 #include <linux/module.h>
27 #include <linux/init.h>
28 #include <linux/if_arp.h>
29 #include <asm/uaccess.h>
30 #include <linux/wireless.h>
32 #include <net/iw_handler.h>
35 static struct net_device
*dev
;
36 static unsigned short bss_force
;
37 char buf
[WLC_IOCTL_MAXLEN
];
39 /* The frequency of each channel in MHz */
40 const long channel_frequency
[] = {
41 2412, 2417, 2422, 2427, 2432, 2437, 2442,
42 2447, 2452, 2457, 2462, 2467, 2472, 2484
44 #define NUM_CHANNELS ( sizeof(channel_frequency) / sizeof(channel_frequency[0]) )
46 typedef struct internal_wsec_key
{
48 uint8 unknown_1
; // 0x01
50 uint8 unknown_2
[7]; // 0x03
53 char data
[32]; // 0x0e
57 static int wlcompat_private_ioctl(struct net_device
*dev
,
58 struct iw_request_info
*info
,
59 union iwreq_data
*wrqu
,
62 void print_buffer(int len
, unsigned char *buf
);
65 static int wl_ioctl(struct net_device
*dev
, int cmd
, void *buf
, int len
)
67 mm_segment_t old_fs
= get_fs();
74 strncpy(ifr
.ifr_name
, dev
->name
, IFNAMSIZ
);
75 ifr
.ifr_data
= (caddr_t
) &ioc
;
77 ret
= dev
->do_ioctl(dev
,&ifr
,SIOCDEVPRIVATE
);
82 static int wl_set_val(struct net_device
*dev
, char *var
, void *val
, int len
)
88 /* check for overflow */
89 if ((buf_len
= strlen(var
)) + 1 + len
> sizeof(buf
))
95 /* append int value onto the end of the name string */
96 memcpy(&(buf
[buf_len
]), val
, len
);
99 ret
= wl_ioctl(dev
, WLC_SET_VAR
, buf
, buf_len
);
103 static int wl_get_val(struct net_device
*dev
, char *var
, void *val
, int len
)
109 /* check for overflow */
110 if ((buf_len
= strlen(var
)) + 1 > sizeof(buf
) || len
> sizeof(buf
))
114 if (ret
= wl_ioctl(dev
, WLC_GET_VAR
, buf
, buf_len
+ len
))
117 memcpy(val
, buf
, len
);
121 int get_primary_key(struct net_device
*dev
)
125 for (key
= val
= 0; (key
< 4) && (val
== 0); key
++) {
127 if (wl_ioctl(dev
, WLC_GET_KEY_PRIMARY
, &val
, sizeof(val
)) < 0)
134 static int wlcompat_ioctl_getiwrange(struct net_device
*dev
,
138 struct iw_range
*range
;
140 range
= (struct iw_range
*) extra
;
142 range
->we_version_compiled
= WIRELESS_EXT
;
143 range
->we_version_source
= WIRELESS_EXT
;
145 range
->min_nwid
= range
->max_nwid
= 0;
147 range
->num_channels
= NUM_CHANNELS
;
149 for (i
= 0; i
< NUM_CHANNELS
; i
++) {
150 range
->freq
[k
].i
= i
+ 1;
151 range
->freq
[k
].m
= channel_frequency
[i
] * 100000;
152 range
->freq
[k
].e
= 1;
154 if (k
>= IW_MAX_FREQUENCIES
)
157 range
->num_frequency
= k
;
158 range
->sensitivity
= 3;
160 /* nbd: don't know what this means, but other drivers set it this way */
161 range
->pmp_flags
= IW_POWER_PERIOD
;
162 range
->pmt_flags
= IW_POWER_TIMEOUT
;
163 range
->pm_capa
= IW_POWER_PERIOD
| IW_POWER_TIMEOUT
| IW_POWER_UNICAST_R
;
166 range
->max_pmp
= 65535000;
168 range
->max_pmt
= 65535 * 1000;
171 if (wl_ioctl(dev
, WLC_GET_RTS
, &range
->max_rts
, sizeof(int)) < 0)
172 range
->max_rts
= 2347;
174 range
->min_frag
= 256;
176 if (wl_ioctl(dev
, WLC_GET_FRAG
, &range
->max_frag
, sizeof(int)) < 0)
177 range
->max_frag
= 2346;
179 range
->txpower_capa
= IW_TXPOW_DBM
;
185 static int wlcompat_set_scan(struct net_device
*dev
,
186 struct iw_request_info
*info
,
187 union iwreq_data
*wrqu
,
190 int ap
= 0, oldap
= 0;
191 wl_scan_params_t params
;
193 memset(¶ms
, 0, sizeof(params
));
195 /* use defaults (same parameters as wl scan) */
196 memset(¶ms
.bssid
, 0xff, sizeof(params
.bssid
));
197 params
.bss_type
= DOT11_BSSTYPE_ANY
;
198 params
.scan_type
= -1;
200 params
.active_time
= -1;
201 params
.passive_time
= -1;
202 params
.home_time
= -1;
204 /* can only scan in STA mode */
205 wl_ioctl(dev
, WLC_GET_AP
, &oldap
, sizeof(oldap
));
207 wl_ioctl(dev
, WLC_SET_AP
, &ap
, sizeof(ap
));
209 if (wl_ioctl(dev
, WLC_SCAN
, ¶ms
, 64) < 0)
213 wl_ioctl(dev
, WLC_SET_AP
, &oldap
, sizeof(oldap
));
219 static int wlcompat_get_scan(struct net_device
*dev
,
220 struct iw_request_info
*info
,
221 union iwreq_data
*wrqu
,
224 wl_scan_results_t
*results
= (wl_scan_results_t
*) buf
;
225 wl_bss_info_t
*bss_info
;
227 char *current_ev
= extra
;
229 char *end_buf
= extra
+ IW_SCAN_MAX_DATA
;
233 if (wl_ioctl(dev
, WLC_SCAN_RESULTS
, buf
, WLC_IOCTL_MAXLEN
) < 0)
236 bss_info
= &(results
->bss_info
[0]);
237 info_ptr
= (char *) bss_info
;
238 for (i
= 0; i
< results
->count
; i
++) {
240 /* send the cell address (must be sent first) */
242 iwe
.u
.ap_addr
.sa_family
= ARPHRD_ETHER
;
243 memcpy(&iwe
.u
.ap_addr
.sa_data
, &bss_info
->BSSID
, sizeof(bss_info
->BSSID
));
244 current_ev
= iwe_stream_add_event(current_ev
, end_buf
, &iwe
, IW_EV_ADDR_LEN
);
247 iwe
.cmd
= SIOCGIWESSID
;
248 iwe
.u
.data
.length
= bss_info
->SSID_len
;
249 if (iwe
.u
.data
.length
> IW_ESSID_MAX_SIZE
)
250 iwe
.u
.data
.length
= IW_ESSID_MAX_SIZE
;
251 iwe
.u
.data
.flags
= 1;
252 current_ev
= iwe_stream_add_point(current_ev
, end_buf
, &iwe
, bss_info
->SSID
);
254 /* send frequency/channel info */
255 iwe
.cmd
= SIOCGIWFREQ
;
257 iwe
.u
.freq
.m
= bss_info
->channel
;
258 current_ev
= iwe_stream_add_event(current_ev
, end_buf
, &iwe
, IW_EV_FREQ_LEN
);
260 /* add quality statistics */
262 iwe
.u
.qual
.level
= bss_info
->RSSI
;
263 iwe
.u
.qual
.noise
= bss_info
->phy_noise
;
265 current_ev
= iwe_stream_add_event(current_ev
, end_buf
, &iwe
, IW_EV_QUAL_LEN
);
267 /* send rate information */
268 iwe
.cmd
= SIOCGIWRATE
;
269 current_val
= current_ev
+ IW_EV_LCP_LEN
;
270 iwe
.u
.bitrate
.fixed
= iwe
.u
.bitrate
.disabled
= 0;
272 for(j
= 0 ; j
< bss_info
->rateset
.count
; j
++) {
273 iwe
.u
.bitrate
.value
= ((bss_info
->rateset
.rates
[j
] & 0x7f) * 500000);
274 current_val
= iwe_stream_add_value(current_ev
, current_val
, end_buf
, &iwe
, IW_EV_PARAM_LEN
);
276 if((current_val
- current_ev
) > IW_EV_LCP_LEN
)
277 current_ev
= current_val
;
279 info_ptr
+= sizeof(wl_bss_info_t
);
280 if (bss_info
->ie_length
% 4)
281 info_ptr
+= bss_info
->ie_length
+ 4 - (bss_info
->ie_length
% 4);
283 info_ptr
+= bss_info
->ie_length
;
284 bss_info
= (wl_bss_info_t
*) info_ptr
;
287 wrqu
->data
.length
= (current_ev
- extra
);
288 wrqu
->data
.flags
= 0;
293 static int wlcompat_ioctl(struct net_device
*dev
,
294 struct iw_request_info
*info
,
295 union iwreq_data
*wrqu
,
300 strcpy(wrqu
->name
, "IEEE 802.11-DS");
306 if (wl_ioctl(dev
,WLC_GET_CHANNEL
, &ci
, sizeof(ci
)) < 0)
309 wrqu
->freq
.m
= ci
.target_channel
;
315 if (wrqu
->freq
.m
== -1) {
317 if (wl_ioctl(dev
, WLC_SET_CHANNEL
, &wrqu
->freq
.m
, sizeof(int)) < 0)
320 if (wrqu
->freq
.e
== 1) {
322 int f
= wrqu
->freq
.m
/ 100000;
323 while ((channel
< NUM_CHANNELS
+ 1) && (f
!= channel_frequency
[channel
]))
326 if (channel
== NUM_CHANNELS
) // channel not found
330 wrqu
->freq
.m
= channel
+ 1;
332 if ((wrqu
->freq
.e
== 0) && (wrqu
->freq
.m
< 1000)) {
333 if (wl_ioctl(dev
, WLC_SET_CHANNEL
, &wrqu
->freq
.m
, sizeof(int)) < 0)
347 memset(®
, 0, sizeof(reg
));
349 if (wrqu
->ap_addr
.sa_family
!= ARPHRD_ETHER
)
352 if (wl_ioctl(dev
, WLC_GET_AP
, &ap
, sizeof(ap
)) < 0)
355 if (wl_ioctl(dev
, WLC_GET_INFRA
, &infra
, sizeof(infra
)) < 0)
359 wl_ioctl(dev
, WLC_SET_BSSID
, wrqu
->ap_addr
.sa_data
, 6);
363 wl_ioctl(dev
, WLC_R_REG
, ®
, sizeof(reg
));
365 reg
.val
&= 0x0000ffff;
366 reg
.val
|= bss_force
<< 16;
367 wl_ioctl(dev
, WLC_W_REG
, ®
, sizeof(reg
));
370 if (wl_ioctl(dev
, ((ap
|| !infra
) ? WLC_SET_BSSID
: WLC_REASSOC
), wrqu
->ap_addr
.sa_data
, 6) < 0)
379 memset(®
, 0, sizeof(reg
));
383 wl_ioctl(dev
, WLC_R_REG
, ®
, sizeof(reg
));
384 printk("bss time = 0x%08x", reg
.val
);
387 wl_ioctl(dev
, WLC_R_REG
, ®
, sizeof(reg
));
388 printk("%08x\n", reg
.val
);
391 wrqu
->ap_addr
.sa_family
= ARPHRD_ETHER
;
392 if (wl_ioctl(dev
,WLC_GET_BSSID
,wrqu
->ap_addr
.sa_data
,6) < 0)
400 if (wl_ioctl(dev
,WLC_GET_SSID
, &ssid
, sizeof(wlc_ssid_t
)) < 0)
403 wrqu
->essid
.flags
= wrqu
->data
.flags
= 1;
404 wrqu
->essid
.length
= wrqu
->data
.length
= ssid
.SSID_len
+ 1;
405 memcpy(extra
,ssid
.SSID
,ssid
.SSID_len
+ 1);
411 memset(&ssid
, 0, sizeof(ssid
));
412 ssid
.SSID_len
= strlen(extra
);
413 if (ssid
.SSID_len
> WLC_ESSID_MAX_SIZE
)
414 ssid
.SSID_len
= WLC_ESSID_MAX_SIZE
;
415 memcpy(ssid
.SSID
, extra
, ssid
.SSID_len
);
416 if (wl_ioctl(dev
, WLC_SET_SSID
, &ssid
, sizeof(ssid
)) < 0)
422 if (wl_ioctl(dev
,WLC_GET_RTS
,&(wrqu
->rts
.value
),sizeof(int)) < 0)
428 if (wl_ioctl(dev
,WLC_SET_RTS
,&(wrqu
->rts
.value
),sizeof(int)) < 0)
434 if (wl_ioctl(dev
,WLC_GET_FRAG
,&(wrqu
->frag
.value
),sizeof(int)) < 0)
440 if (wl_ioctl(dev
,WLC_SET_FRAG
,&(wrqu
->frag
.value
),sizeof(int)) < 0)
448 wl_ioctl(dev
, WLC_GET_RADIO
, &radio
, sizeof(int));
450 if (wl_get_val(dev
, "qtxpower", &(wrqu
->txpower
.value
), sizeof(int)) < 0)
453 wrqu
->txpower
.value
&= ~WL_TXPWR_OVERRIDE
;
454 wrqu
->txpower
.value
/= 4;
456 wrqu
->txpower
.fixed
= 0;
457 wrqu
->txpower
.disabled
= radio
;
458 wrqu
->txpower
.flags
= IW_TXPOW_DBM
;
463 /* This is weird: WLC_SET_RADIO with 1 as argument disables the radio */
464 int radio
= wrqu
->txpower
.disabled
;
466 wl_ioctl(dev
, WLC_SET_RADIO
, &radio
, sizeof(int));
468 if (!wrqu
->txpower
.disabled
&& (wrqu
->txpower
.value
> 0)) {
471 if (wl_get_val(dev
, "qtxpower", &value
, sizeof(int)) < 0)
474 value
&= WL_TXPWR_OVERRIDE
;
475 wrqu
->txpower
.value
*= 4;
476 wrqu
->txpower
.value
|= value
;
478 if (wrqu
->txpower
.flags
!= IW_TXPOW_DBM
)
481 if (wrqu
->txpower
.value
> 0)
482 if (wl_set_val(dev
, "qtxpower", &(wrqu
->txpower
.value
), sizeof(int)) < 0)
489 int val
= 0, wep
= 1, wrestrict
= 1;
490 int index
= (wrqu
->data
.flags
& IW_ENCODE_INDEX
) - 1;
493 index
= get_primary_key(dev
);
495 if (wrqu
->data
.flags
& IW_ENCODE_DISABLED
) {
497 if (wl_ioctl(dev
, WLC_SET_WSEC
, &wep
, sizeof(val
)) < 0)
502 if (wl_ioctl(dev
, WLC_SET_WSEC
, &wep
, sizeof(val
)) < 0)
505 if (wrqu
->data
.flags
& IW_ENCODE_OPEN
)
508 if (wrqu
->data
.pointer
&& (wrqu
->data
.length
> 0) && (wrqu
->data
.length
<= 16)) {
510 memset(&key
, 0, sizeof(key
));
512 key
.flags
= WL_PRIMARY_KEY
;
513 key
.len
= wrqu
->data
.length
;
515 memcpy(key
.data
, wrqu
->data
.pointer
, wrqu
->data
.length
);
517 if (wl_ioctl(dev
, WLC_SET_KEY
, &key
, sizeof(key
)) < 0)
522 wl_ioctl(dev
, WLC_SET_KEY_PRIMARY
, &index
, sizeof(index
));
525 wl_ioctl(dev
, WLC_SET_WEP_RESTRICT
, &wrestrict
, sizeof(wrestrict
));
533 if (wl_ioctl(dev
, WLC_GET_WEP
, &val
, sizeof(val
)) < 0)
538 int key
= get_primary_key(dev
);
540 wrqu
->data
.flags
= IW_ENCODE_ENABLED
;
545 info_addr
= (int *) dev
->priv
;
546 wep_key
= (wkey
*) ((*info_addr
) + 0x2752 + (key
* 0x110));
548 wrqu
->data
.flags
|= key
+ 1;
549 wrqu
->data
.length
= wep_key
->len
;
551 memset(extra
, 0, 16);
552 memcpy(extra
, wep_key
->data
, 16);
554 wrqu
->data
.flags
|= IW_ENCODE_NOKEY
;
557 wrqu
->data
.flags
= IW_ENCODE_DISABLED
;
564 return wlcompat_ioctl_getiwrange(dev
, extra
);
569 int ap
= -1, infra
= -1, passive
= 0, wet
= 0;
571 switch (wrqu
->mode
) {
572 case IW_MODE_MONITOR
:
597 wl_ioctl(dev
, WLC_SET_PASSIVE
, &passive
, sizeof(passive
));
598 wl_ioctl(dev
, WLC_SET_MONITOR
, &passive
, sizeof(passive
));
599 wl_ioctl(dev
, WLC_SET_WET
, &wet
, sizeof(wet
));
601 wl_ioctl(dev
, WLC_SET_AP
, &ap
, sizeof(ap
));
603 wl_ioctl(dev
, WLC_SET_INFRA
, &infra
, sizeof(infra
));
610 int ap
, infra
, wet
, passive
;
612 if (wl_ioctl(dev
, WLC_GET_AP
, &ap
, sizeof(ap
)) < 0)
614 if (wl_ioctl(dev
, WLC_GET_INFRA
, &infra
, sizeof(infra
)) < 0)
616 if (wl_ioctl(dev
, WLC_GET_PASSIVE
, &passive
, sizeof(passive
)) < 0)
618 if (wl_ioctl(dev
, WLC_GET_WET
, &wet
, sizeof(wet
)) < 0)
622 wrqu
->mode
= IW_MODE_MONITOR
;
624 wrqu
->mode
= IW_MODE_ADHOC
;
627 wrqu
->mode
= IW_MODE_MASTER
;
630 wrqu
->mode
= IW_MODE_REPEAT
;
632 wrqu
->mode
= IW_MODE_INFRA
;
640 if (info
->cmd
>= SIOCIWFIRSTPRIV
)
641 return wlcompat_private_ioctl(dev
, info
, wrqu
, extra
);
650 static const iw_handler wlcompat_handler
[] = {
651 NULL
, /* SIOCSIWCOMMIT */
652 wlcompat_ioctl
, /* SIOCGIWNAME */
653 NULL
, /* SIOCSIWNWID */
654 NULL
, /* SIOCGIWNWID */
655 wlcompat_ioctl
, /* SIOCSIWFREQ */
656 wlcompat_ioctl
, /* SIOCGIWFREQ */
657 wlcompat_ioctl
, /* SIOCSIWMODE */
658 wlcompat_ioctl
, /* SIOCGIWMODE */
659 NULL
, /* SIOCSIWSENS */
660 NULL
, /* SIOCGIWSENS */
661 NULL
, /* SIOCSIWRANGE, unused */
662 wlcompat_ioctl
, /* SIOCGIWRANGE */
663 NULL
, /* SIOCSIWPRIV */
664 NULL
, /* SIOCGIWPRIV */
665 NULL
, /* SIOCSIWSTATS */
666 NULL
, /* SIOCGIWSTATS */
667 iw_handler_set_spy
, /* SIOCSIWSPY */
668 iw_handler_get_spy
, /* SIOCGIWSPY */
669 iw_handler_set_thrspy
, /* SIOCSIWTHRSPY */
670 iw_handler_get_thrspy
, /* SIOCGIWTHRSPY */
671 wlcompat_ioctl
, /* SIOCSIWAP */
672 wlcompat_ioctl
, /* SIOCGIWAP */
673 NULL
, /* -- hole -- */
674 NULL
, /* SIOCGIWAPLIST */
675 wlcompat_set_scan
, /* SIOCSIWSCAN */
676 wlcompat_get_scan
, /* SIOCGIWSCAN */
677 wlcompat_ioctl
, /* SIOCSIWESSID */
678 wlcompat_ioctl
, /* SIOCGIWESSID */
679 NULL
, /* SIOCSIWNICKN */
680 NULL
, /* SIOCGIWNICKN */
681 NULL
, /* -- hole -- */
682 NULL
, /* -- hole -- */
683 NULL
, /* SIOCSIWRATE */
684 NULL
, /* SIOCGIWRATE */
685 wlcompat_ioctl
, /* SIOCSIWRTS */
686 wlcompat_ioctl
, /* SIOCGIWRTS */
687 wlcompat_ioctl
, /* SIOCSIWFRAG */
688 wlcompat_ioctl
, /* SIOCGIWFRAG */
689 wlcompat_ioctl
, /* SIOCSIWTXPOW */
690 wlcompat_ioctl
, /* SIOCGIWTXPOW */
691 NULL
, /* SIOCSIWRETRY */
692 NULL
, /* SIOCGIWRETRY */
693 wlcompat_ioctl
, /* SIOCSIWENCODE */
694 wlcompat_ioctl
, /* SIOCGIWENCODE */
698 #define WLCOMPAT_SET_MONITOR SIOCIWFIRSTPRIV + 0
699 #define WLCOMPAT_GET_MONITOR SIOCIWFIRSTPRIV + 1
700 #define WLCOMPAT_SET_TXPWR_LIMIT SIOCIWFIRSTPRIV + 2
701 #define WLCOMPAT_GET_TXPWR_LIMIT SIOCIWFIRSTPRIV + 3
702 #define WLCOMPAT_SET_ANTDIV SIOCIWFIRSTPRIV + 4
703 #define WLCOMPAT_GET_ANTDIV SIOCIWFIRSTPRIV + 5
704 #define WLCOMPAT_SET_TXANT SIOCIWFIRSTPRIV + 6
705 #define WLCOMPAT_GET_TXANT SIOCIWFIRSTPRIV + 7
706 #define WLCOMPAT_SET_BSS_FORCE SIOCIWFIRSTPRIV + 8
707 #define WLCOMPAT_GET_BSS_FORCE SIOCIWFIRSTPRIV + 9
710 static int wlcompat_private_ioctl(struct net_device
*dev
,
711 struct iw_request_info
*info
,
712 union iwreq_data
*wrqu
,
715 int *value
= (int *) wrqu
->name
;
718 case WLCOMPAT_SET_MONITOR
:
720 if (wl_ioctl(dev
, WLC_SET_MONITOR
, value
, sizeof(int)) < 0)
725 case WLCOMPAT_GET_MONITOR
:
727 if (wl_ioctl(dev
, WLC_GET_MONITOR
, extra
, sizeof(int)) < 0)
732 case WLCOMPAT_SET_TXPWR_LIMIT
:
737 if (wl_get_val(dev
, "qtxpower", &val
, sizeof(int)) < 0)
741 val
|= WL_TXPWR_OVERRIDE
;
743 val
&= ~WL_TXPWR_OVERRIDE
;
745 if (wl_set_val(dev
, "qtxpower", &val
, sizeof(int)) < 0)
750 case WLCOMPAT_GET_TXPWR_LIMIT
:
752 if (wl_get_val(dev
, "qtxpower", value
, sizeof(int)) < 0)
755 *value
= ((*value
& WL_TXPWR_OVERRIDE
) == WL_TXPWR_OVERRIDE
? 1 : 0);
759 case WLCOMPAT_SET_ANTDIV
:
761 if (wl_ioctl(dev
, WLC_SET_ANTDIV
, value
, sizeof(int)) < 0)
766 case WLCOMPAT_GET_ANTDIV
:
768 if (wl_ioctl(dev
, WLC_GET_ANTDIV
, extra
, sizeof(int)) < 0)
773 case WLCOMPAT_SET_TXANT
:
775 if (wl_ioctl(dev
, WLC_SET_TXANT
, value
, sizeof(int)) < 0)
780 case WLCOMPAT_GET_TXANT
:
782 if (wl_ioctl(dev
, WLC_GET_TXANT
, extra
, sizeof(int)) < 0)
787 case WLCOMPAT_SET_BSS_FORCE
:
789 bss_force
= (unsigned short) *value
;
792 case WLCOMPAT_GET_BSS_FORCE
:
794 *extra
= (int) bss_force
;
806 static const struct iw_priv_args wlcompat_private_args
[] =
808 { WLCOMPAT_SET_MONITOR
,
809 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
813 { WLCOMPAT_GET_MONITOR
,
815 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
818 { WLCOMPAT_SET_TXPWR_LIMIT
,
819 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
823 { WLCOMPAT_GET_TXPWR_LIMIT
,
825 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
828 { WLCOMPAT_SET_ANTDIV
,
829 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
833 { WLCOMPAT_GET_ANTDIV
,
835 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
838 { WLCOMPAT_SET_TXANT
,
839 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
843 { WLCOMPAT_GET_TXANT
,
845 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
848 { WLCOMPAT_SET_BSS_FORCE
,
849 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
853 { WLCOMPAT_GET_BSS_FORCE
,
855 IW_PRIV_TYPE_INT
| IW_PRIV_SIZE_FIXED
| 1,
860 static const iw_handler wlcompat_private
[] =
862 wlcompat_private_ioctl
,
867 static const struct iw_handler_def wlcompat_handler_def
=
869 .standard
= (iw_handler
*) wlcompat_handler
,
870 .num_standard
= sizeof(wlcompat_handler
)/sizeof(iw_handler
),
871 .private = wlcompat_private
,
873 .private_args
= wlcompat_private_args
,
874 .num_private_args
= sizeof(wlcompat_private_args
) / sizeof(wlcompat_private_args
[0])
879 void print_buffer(int len
, unsigned char *buf
) {
882 for (x
=0;x
<len
&& x
<180 ;x
++) {
885 printk("%02X",buf
[x
]);
894 static int (*old_ioctl
)(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
);
895 static int new_ioctl(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
) {
897 struct iwreq
*iwr
= (struct iwreq
*) ifr
;
898 struct iw_request_info info
;
901 printk("dev: %s ioctl: 0x%04x\n",dev
->name
,cmd
);
904 if (cmd
>= SIOCIWFIRSTPRIV
) {
907 ret
= wlcompat_private_ioctl(dev
, &info
, &(iwr
->u
), (char *) &(iwr
->u
));
909 } else if (cmd
==SIOCDEVPRIVATE
) {
910 wl_ioctl_t
*ioc
= (wl_ioctl_t
*)ifr
->ifr_data
;
911 unsigned char *buf
= ioc
->buf
;
912 printk(" cmd: %d buf: 0x%08x len: %d\n",ioc
->cmd
,&(ioc
->buf
),ioc
->len
);
914 print_buffer(ioc
->len
, buf
);
915 ret
= old_ioctl(dev
,ifr
,cmd
);
917 print_buffer(ioc
->len
, buf
);
918 printk(" ret: %d\n", ret
);
921 ret
= old_ioctl(dev
,ifr
,cmd
);
926 static int __init
wlcompat_init()
929 char *devname
= "eth0";
932 while (!found
&& (dev
= dev_get_by_name(devname
))) {
933 if ((dev
->wireless_handlers
== NULL
) && ((wl_ioctl(dev
, WLC_GET_MAGIC
, &i
, sizeof(i
)) == 0) && i
== WLC_IOCTL_MAGIC
))
939 printk("No Broadcom devices found.\n");
944 old_ioctl
= dev
->do_ioctl
;
945 dev
->do_ioctl
= new_ioctl
;
946 dev
->wireless_handlers
= (struct iw_handler_def
*)&wlcompat_handler_def
;
948 printk("broadcom driver private data: 0x%08x\n", dev
->priv
);
953 static void __exit
wlcompat_exit()
955 dev
->wireless_handlers
= NULL
;
956 dev
->do_ioctl
= old_ioctl
;
961 MODULE_AUTHOR("openwrt.org");
962 MODULE_LICENSE("GPL");
964 module_init(wlcompat_init
);
965 module_exit(wlcompat_exit
);