2 * Driver for RNDIS based wireless USB devices.
4 * Copyright (C) 2007 by Bjorge Dijkstra <bjd@jooz.net>
5 * Copyright (C) 2008-2009 by Jussi Kivilinna <jussi.kivilinna@mbnet.fi>
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, or
10 * (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
21 * Portions of this file are based on NDISwrapper project,
22 * Copyright (C) 2003-2005 Pontus Fuchs, Giridhar Pemmasani
23 * http://ndiswrapper.sourceforge.net/
26 // #define DEBUG // error path messages, extra info
27 // #define VERBOSE // more; success messages
29 #include <linux/module.h>
30 #include <linux/init.h>
31 #include <linux/netdevice.h>
32 #include <linux/etherdevice.h>
33 #include <linux/ethtool.h>
34 #include <linux/workqueue.h>
35 #include <linux/mutex.h>
36 #include <linux/mii.h>
37 #include <linux/usb.h>
38 #include <linux/usb/cdc.h>
39 #include <linux/wireless.h>
40 #include <linux/ieee80211.h>
41 #include <linux/if_arp.h>
42 #include <linux/ctype.h>
43 #include <linux/spinlock.h>
44 #include <net/iw_handler.h>
45 #include <net/cfg80211.h>
46 #include <linux/usb/usbnet.h>
47 #include <linux/usb/rndis_host.h>
50 /* NOTE: All these are settings for Broadcom chipset */
51 static char modparam_country
[4] = "EU";
52 module_param_string(country
, modparam_country
, 4, 0444);
53 MODULE_PARM_DESC(country
, "Country code (ISO 3166-1 alpha-2), default: EU");
55 static int modparam_frameburst
= 1;
56 module_param_named(frameburst
, modparam_frameburst
, int, 0444);
57 MODULE_PARM_DESC(frameburst
, "enable frame bursting (default: on)");
59 static int modparam_afterburner
= 0;
60 module_param_named(afterburner
, modparam_afterburner
, int, 0444);
61 MODULE_PARM_DESC(afterburner
,
62 "enable afterburner aka '125 High Speed Mode' (default: off)");
64 static int modparam_power_save
= 0;
65 module_param_named(power_save
, modparam_power_save
, int, 0444);
66 MODULE_PARM_DESC(power_save
,
67 "set power save mode: 0=off, 1=on, 2=fast (default: off)");
69 static int modparam_power_output
= 3;
70 module_param_named(power_output
, modparam_power_output
, int, 0444);
71 MODULE_PARM_DESC(power_output
,
72 "set power output: 0=25%, 1=50%, 2=75%, 3=100% (default: 100%)");
74 static int modparam_roamtrigger
= -70;
75 module_param_named(roamtrigger
, modparam_roamtrigger
, int, 0444);
76 MODULE_PARM_DESC(roamtrigger
,
77 "set roaming dBm trigger: -80=optimize for distance, "
78 "-60=bandwidth (default: -70)");
80 static int modparam_roamdelta
= 1;
81 module_param_named(roamdelta
, modparam_roamdelta
, int, 0444);
82 MODULE_PARM_DESC(roamdelta
,
83 "set roaming tendency: 0=aggressive, 1=moderate, "
84 "2=conservative (default: moderate)");
86 static int modparam_workaround_interval
= 500;
87 module_param_named(workaround_interval
, modparam_workaround_interval
,
89 MODULE_PARM_DESC(workaround_interval
,
90 "set stall workaround interval in msecs (default: 500)");
93 /* various RNDIS OID defs */
94 #define OID_GEN_LINK_SPEED cpu_to_le32(0x00010107)
95 #define OID_GEN_RNDIS_CONFIG_PARAMETER cpu_to_le32(0x0001021b)
97 #define OID_GEN_XMIT_OK cpu_to_le32(0x00020101)
98 #define OID_GEN_RCV_OK cpu_to_le32(0x00020102)
99 #define OID_GEN_XMIT_ERROR cpu_to_le32(0x00020103)
100 #define OID_GEN_RCV_ERROR cpu_to_le32(0x00020104)
101 #define OID_GEN_RCV_NO_BUFFER cpu_to_le32(0x00020105)
103 #define OID_802_3_CURRENT_ADDRESS cpu_to_le32(0x01010102)
104 #define OID_802_3_MULTICAST_LIST cpu_to_le32(0x01010103)
105 #define OID_802_3_MAXIMUM_LIST_SIZE cpu_to_le32(0x01010104)
107 #define OID_802_11_BSSID cpu_to_le32(0x0d010101)
108 #define OID_802_11_SSID cpu_to_le32(0x0d010102)
109 #define OID_802_11_INFRASTRUCTURE_MODE cpu_to_le32(0x0d010108)
110 #define OID_802_11_ADD_WEP cpu_to_le32(0x0d010113)
111 #define OID_802_11_REMOVE_WEP cpu_to_le32(0x0d010114)
112 #define OID_802_11_DISASSOCIATE cpu_to_le32(0x0d010115)
113 #define OID_802_11_AUTHENTICATION_MODE cpu_to_le32(0x0d010118)
114 #define OID_802_11_PRIVACY_FILTER cpu_to_le32(0x0d010119)
115 #define OID_802_11_BSSID_LIST_SCAN cpu_to_le32(0x0d01011a)
116 #define OID_802_11_ENCRYPTION_STATUS cpu_to_le32(0x0d01011b)
117 #define OID_802_11_ADD_KEY cpu_to_le32(0x0d01011d)
118 #define OID_802_11_REMOVE_KEY cpu_to_le32(0x0d01011e)
119 #define OID_802_11_ASSOCIATION_INFORMATION cpu_to_le32(0x0d01011f)
120 #define OID_802_11_PMKID cpu_to_le32(0x0d010123)
121 #define OID_802_11_NETWORK_TYPES_SUPPORTED cpu_to_le32(0x0d010203)
122 #define OID_802_11_NETWORK_TYPE_IN_USE cpu_to_le32(0x0d010204)
123 #define OID_802_11_TX_POWER_LEVEL cpu_to_le32(0x0d010205)
124 #define OID_802_11_RSSI cpu_to_le32(0x0d010206)
125 #define OID_802_11_RSSI_TRIGGER cpu_to_le32(0x0d010207)
126 #define OID_802_11_FRAGMENTATION_THRESHOLD cpu_to_le32(0x0d010209)
127 #define OID_802_11_RTS_THRESHOLD cpu_to_le32(0x0d01020a)
128 #define OID_802_11_SUPPORTED_RATES cpu_to_le32(0x0d01020e)
129 #define OID_802_11_CONFIGURATION cpu_to_le32(0x0d010211)
130 #define OID_802_11_BSSID_LIST cpu_to_le32(0x0d010217)
133 /* Typical noise/maximum signal level values taken from ndiswrapper iw_ndis.h */
134 #define WL_NOISE -96 /* typical noise level in dBm */
135 #define WL_SIGMAX -32 /* typical maximum signal level in dBm */
138 /* Assume that Broadcom 4320 (only chipset at time of writing known to be
139 * based on wireless rndis) has default txpower of 13dBm.
140 * This value is from Linksys WUSB54GSC User Guide, Appendix F: Specifications.
141 * 100% : 20 mW ~ 13dBm
142 * 75% : 15 mW ~ 12dBm
143 * 50% : 10 mW ~ 10dBm
146 #define BCM4320_DEFAULT_TXPOWER_DBM_100 13
147 #define BCM4320_DEFAULT_TXPOWER_DBM_75 12
148 #define BCM4320_DEFAULT_TXPOWER_DBM_50 10
149 #define BCM4320_DEFAULT_TXPOWER_DBM_25 7
152 /* codes for "status" field of completion messages */
153 #define RNDIS_STATUS_ADAPTER_NOT_READY cpu_to_le32(0xc0010011)
154 #define RNDIS_STATUS_ADAPTER_NOT_OPEN cpu_to_le32(0xc0010012)
157 /* NDIS data structures. Taken from wpa_supplicant driver_ndis.c
158 * slightly modified for datatype endianess, etc
160 #define NDIS_802_11_LENGTH_SSID 32
161 #define NDIS_802_11_LENGTH_RATES 8
162 #define NDIS_802_11_LENGTH_RATES_EX 16
164 enum ndis_80211_net_type
{
165 NDIS_80211_TYPE_FREQ_HOP
,
166 NDIS_80211_TYPE_DIRECT_SEQ
,
167 NDIS_80211_TYPE_OFDM_A
,
168 NDIS_80211_TYPE_OFDM_G
171 enum ndis_80211_net_infra
{
172 NDIS_80211_INFRA_ADHOC
,
173 NDIS_80211_INFRA_INFRA
,
174 NDIS_80211_INFRA_AUTO_UNKNOWN
177 enum ndis_80211_auth_mode
{
178 NDIS_80211_AUTH_OPEN
,
179 NDIS_80211_AUTH_SHARED
,
180 NDIS_80211_AUTH_AUTO_SWITCH
,
182 NDIS_80211_AUTH_WPA_PSK
,
183 NDIS_80211_AUTH_WPA_NONE
,
184 NDIS_80211_AUTH_WPA2
,
185 NDIS_80211_AUTH_WPA2_PSK
188 enum ndis_80211_encr_status
{
189 NDIS_80211_ENCR_WEP_ENABLED
,
190 NDIS_80211_ENCR_DISABLED
,
191 NDIS_80211_ENCR_WEP_KEY_ABSENT
,
192 NDIS_80211_ENCR_NOT_SUPPORTED
,
193 NDIS_80211_ENCR_TKIP_ENABLED
,
194 NDIS_80211_ENCR_TKIP_KEY_ABSENT
,
195 NDIS_80211_ENCR_CCMP_ENABLED
,
196 NDIS_80211_ENCR_CCMP_KEY_ABSENT
199 enum ndis_80211_priv_filter
{
200 NDIS_80211_PRIV_ACCEPT_ALL
,
201 NDIS_80211_PRIV_8021X_WEP
204 enum ndis_80211_status_type
{
205 NDIS_80211_STATUSTYPE_AUTHENTICATION
,
206 NDIS_80211_STATUSTYPE_MEDIASTREAMMODE
,
207 NDIS_80211_STATUSTYPE_PMKID_CANDIDATELIST
,
208 NDIS_80211_STATUSTYPE_RADIOSTATE
,
211 enum ndis_80211_media_stream_mode
{
212 NDIS_80211_MEDIA_STREAM_OFF
,
213 NDIS_80211_MEDIA_STREAM_ON
216 enum ndis_80211_radio_status
{
217 NDIS_80211_RADIO_STATUS_ON
,
218 NDIS_80211_RADIO_STATUS_HARDWARE_OFF
,
219 NDIS_80211_RADIO_STATUS_SOFTWARE_OFF
,
222 enum ndis_80211_addkey_bits
{
223 NDIS_80211_ADDKEY_8021X_AUTH
= cpu_to_le32(1 << 28),
224 NDIS_80211_ADDKEY_SET_INIT_RECV_SEQ
= cpu_to_le32(1 << 29),
225 NDIS_80211_ADDKEY_PAIRWISE_KEY
= cpu_to_le32(1 << 30),
226 NDIS_80211_ADDKEY_TRANSMIT_KEY
= cpu_to_le32(1 << 31)
229 enum ndis_80211_addwep_bits
{
230 NDIS_80211_ADDWEP_PERCLIENT_KEY
= cpu_to_le32(1 << 30),
231 NDIS_80211_ADDWEP_TRANSMIT_KEY
= cpu_to_le32(1 << 31)
234 struct ndis_80211_auth_request
{
239 } __attribute__((packed
));
241 struct ndis_80211_pmkid_candidate
{
245 } __attribute__((packed
));
247 struct ndis_80211_pmkid_cand_list
{
249 __le32 num_candidates
;
250 struct ndis_80211_pmkid_candidate candidate_list
[0];
251 } __attribute__((packed
));
253 struct ndis_80211_status_indication
{
256 enum ndis_80211_media_stream_mode media_stream_mode
;
257 enum ndis_80211_radio_status radio_status
;
258 struct ndis_80211_auth_request auth_request
[0];
259 struct ndis_80211_pmkid_cand_list cand_list
;
261 } __attribute__((packed
));
263 struct ndis_80211_ssid
{
265 u8 essid
[NDIS_802_11_LENGTH_SSID
];
266 } __attribute__((packed
));
268 struct ndis_80211_conf_freq_hop
{
273 } __attribute__((packed
));
275 struct ndis_80211_conf
{
277 __le32 beacon_period
;
280 struct ndis_80211_conf_freq_hop fh_config
;
281 } __attribute__((packed
));
283 struct ndis_80211_bssid_ex
{
287 struct ndis_80211_ssid ssid
;
291 struct ndis_80211_conf config
;
293 u8 rates
[NDIS_802_11_LENGTH_RATES_EX
];
296 } __attribute__((packed
));
298 struct ndis_80211_bssid_list_ex
{
300 struct ndis_80211_bssid_ex bssid
[0];
301 } __attribute__((packed
));
303 struct ndis_80211_fixed_ies
{
305 __le16 beacon_interval
;
307 } __attribute__((packed
));
309 struct ndis_80211_wep_key
{
314 } __attribute__((packed
));
316 struct ndis_80211_key
{
324 } __attribute__((packed
));
326 struct ndis_80211_remove_key
{
331 } __attribute__((packed
));
333 struct ndis_config_param
{
339 } __attribute__((packed
));
341 struct ndis_80211_assoc_info
{
346 __le16 listen_interval
;
347 u8 cur_ap_address
[6];
349 __le32 req_ie_length
;
350 __le32 offset_req_ies
;
357 __le32 resp_ie_length
;
358 __le32 offset_resp_ies
;
359 } __attribute__((packed
));
361 /* these have to match what is in wpa_supplicant */
362 enum wpa_alg
{ WPA_ALG_NONE
, WPA_ALG_WEP
, WPA_ALG_TKIP
, WPA_ALG_CCMP
};
363 enum wpa_cipher
{ CIPHER_NONE
, CIPHER_WEP40
, CIPHER_TKIP
, CIPHER_CCMP
,
365 enum wpa_key_mgmt
{ KEY_MGMT_802_1X
, KEY_MGMT_PSK
, KEY_MGMT_NONE
,
366 KEY_MGMT_802_1X_NO_WPA
, KEY_MGMT_WPA_NONE
};
371 #define NET_TYPE_11FB 0
373 #define CAP_MODE_80211A 1
374 #define CAP_MODE_80211B 2
375 #define CAP_MODE_80211G 4
376 #define CAP_MODE_MASK 7
378 #define WORK_LINK_UP (1<<0)
379 #define WORK_LINK_DOWN (1<<1)
380 #define WORK_SET_MULTICAST_LIST (1<<2)
382 #define COMMAND_BUFFER_SIZE (CONTROL_BUFFER_SIZE + sizeof(struct rndis_set))
384 static const struct ieee80211_channel rndis_channels
[] = {
385 { .center_freq
= 2412 },
386 { .center_freq
= 2417 },
387 { .center_freq
= 2422 },
388 { .center_freq
= 2427 },
389 { .center_freq
= 2432 },
390 { .center_freq
= 2437 },
391 { .center_freq
= 2442 },
392 { .center_freq
= 2447 },
393 { .center_freq
= 2452 },
394 { .center_freq
= 2457 },
395 { .center_freq
= 2462 },
396 { .center_freq
= 2467 },
397 { .center_freq
= 2472 },
398 { .center_freq
= 2484 },
401 static const struct ieee80211_rate rndis_rates
[] = {
403 { .bitrate
= 20, .flags
= IEEE80211_RATE_SHORT_PREAMBLE
},
404 { .bitrate
= 55, .flags
= IEEE80211_RATE_SHORT_PREAMBLE
},
405 { .bitrate
= 110, .flags
= IEEE80211_RATE_SHORT_PREAMBLE
},
416 static const u32 rndis_cipher_suites
[] = {
417 WLAN_CIPHER_SUITE_WEP40
,
418 WLAN_CIPHER_SUITE_WEP104
,
419 WLAN_CIPHER_SUITE_TKIP
,
420 WLAN_CIPHER_SUITE_CCMP
,
423 struct rndis_wlan_encr_key
{
432 /* RNDIS device private data */
433 struct rndis_wlan_private
{
434 struct usbnet
*usbdev
;
436 struct wireless_dev wdev
;
438 struct cfg80211_scan_request
*scan_request
;
440 struct workqueue_struct
*workqueue
;
441 struct delayed_work stats_work
;
442 struct delayed_work scan_work
;
443 struct work_struct work
;
444 struct mutex command_lock
;
445 spinlock_t stats_lock
;
446 unsigned long work_pending
;
448 struct ieee80211_supported_band band
;
449 struct ieee80211_channel channels
[ARRAY_SIZE(rndis_channels
)];
450 struct ieee80211_rate rates
[ARRAY_SIZE(rndis_rates
)];
451 u32 cipher_suites
[ARRAY_SIZE(rndis_cipher_suites
)];
453 struct iw_statistics iwstats
;
454 struct iw_statistics privstats
;
459 /* module parameters */
460 char param_country
[4];
461 int param_frameburst
;
462 int param_afterburner
;
463 int param_power_save
;
464 int param_power_output
;
465 int param_roamtrigger
;
467 u32 param_workaround_interval
;
472 struct ndis_80211_ssid essid
;
473 __le32 current_command_oid
;
475 /* encryption stuff */
476 int encr_tx_key_index
;
477 struct rndis_wlan_encr_key encr_keys
[4];
484 int wpa_cipher_group
;
486 u8 command_buffer
[COMMAND_BUFFER_SIZE
];
492 static int rndis_change_virtual_intf(struct wiphy
*wiphy
,
493 struct net_device
*dev
,
494 enum nl80211_iftype type
, u32
*flags
,
495 struct vif_params
*params
);
497 static int rndis_scan(struct wiphy
*wiphy
, struct net_device
*dev
,
498 struct cfg80211_scan_request
*request
);
500 static int rndis_set_wiphy_params(struct wiphy
*wiphy
, u32 changed
);
502 static int rndis_set_tx_power(struct wiphy
*wiphy
, enum tx_power_setting type
,
504 static int rndis_get_tx_power(struct wiphy
*wiphy
, int *dbm
);
506 static struct cfg80211_ops rndis_config_ops
= {
507 .change_virtual_intf
= rndis_change_virtual_intf
,
509 .set_wiphy_params
= rndis_set_wiphy_params
,
510 .set_tx_power
= rndis_set_tx_power
,
511 .get_tx_power
= rndis_get_tx_power
,
514 static void *rndis_wiphy_privid
= &rndis_wiphy_privid
;
517 static struct rndis_wlan_private
*get_rndis_wlan_priv(struct usbnet
*dev
)
519 return (struct rndis_wlan_private
*)dev
->driver_priv
;
523 static u32
get_bcm4320_power_dbm(struct rndis_wlan_private
*priv
)
525 switch (priv
->param_power_output
) {
528 return BCM4320_DEFAULT_TXPOWER_DBM_100
;
530 return BCM4320_DEFAULT_TXPOWER_DBM_75
;
532 return BCM4320_DEFAULT_TXPOWER_DBM_50
;
534 return BCM4320_DEFAULT_TXPOWER_DBM_25
;
539 static bool is_wpa_key(struct rndis_wlan_private
*priv
, int idx
)
541 int cipher
= priv
->encr_keys
[idx
].cipher
;
543 return (cipher
== WLAN_CIPHER_SUITE_CCMP
||
544 cipher
== WLAN_CIPHER_SUITE_TKIP
);
549 static const char *oid_to_string(__le32 oid
)
552 #define OID_STR(oid) case oid: return(#oid)
553 /* from rndis_host.h */
554 OID_STR(OID_802_3_PERMANENT_ADDRESS
);
555 OID_STR(OID_GEN_MAXIMUM_FRAME_SIZE
);
556 OID_STR(OID_GEN_CURRENT_PACKET_FILTER
);
557 OID_STR(OID_GEN_PHYSICAL_MEDIUM
);
559 /* from rndis_wlan.c */
560 OID_STR(OID_GEN_LINK_SPEED
);
561 OID_STR(OID_GEN_RNDIS_CONFIG_PARAMETER
);
563 OID_STR(OID_GEN_XMIT_OK
);
564 OID_STR(OID_GEN_RCV_OK
);
565 OID_STR(OID_GEN_XMIT_ERROR
);
566 OID_STR(OID_GEN_RCV_ERROR
);
567 OID_STR(OID_GEN_RCV_NO_BUFFER
);
569 OID_STR(OID_802_3_CURRENT_ADDRESS
);
570 OID_STR(OID_802_3_MULTICAST_LIST
);
571 OID_STR(OID_802_3_MAXIMUM_LIST_SIZE
);
573 OID_STR(OID_802_11_BSSID
);
574 OID_STR(OID_802_11_SSID
);
575 OID_STR(OID_802_11_INFRASTRUCTURE_MODE
);
576 OID_STR(OID_802_11_ADD_WEP
);
577 OID_STR(OID_802_11_REMOVE_WEP
);
578 OID_STR(OID_802_11_DISASSOCIATE
);
579 OID_STR(OID_802_11_AUTHENTICATION_MODE
);
580 OID_STR(OID_802_11_PRIVACY_FILTER
);
581 OID_STR(OID_802_11_BSSID_LIST_SCAN
);
582 OID_STR(OID_802_11_ENCRYPTION_STATUS
);
583 OID_STR(OID_802_11_ADD_KEY
);
584 OID_STR(OID_802_11_REMOVE_KEY
);
585 OID_STR(OID_802_11_ASSOCIATION_INFORMATION
);
586 OID_STR(OID_802_11_PMKID
);
587 OID_STR(OID_802_11_NETWORK_TYPES_SUPPORTED
);
588 OID_STR(OID_802_11_NETWORK_TYPE_IN_USE
);
589 OID_STR(OID_802_11_TX_POWER_LEVEL
);
590 OID_STR(OID_802_11_RSSI
);
591 OID_STR(OID_802_11_RSSI_TRIGGER
);
592 OID_STR(OID_802_11_FRAGMENTATION_THRESHOLD
);
593 OID_STR(OID_802_11_RTS_THRESHOLD
);
594 OID_STR(OID_802_11_SUPPORTED_RATES
);
595 OID_STR(OID_802_11_CONFIGURATION
);
596 OID_STR(OID_802_11_BSSID_LIST
);
603 static const char *oid_to_string(__le32 oid
)
610 /* translate error code */
611 static int rndis_error_status(__le32 rndis_status
)
614 switch (rndis_status
) {
615 case RNDIS_STATUS_SUCCESS
:
618 case RNDIS_STATUS_FAILURE
:
619 case RNDIS_STATUS_INVALID_DATA
:
622 case RNDIS_STATUS_NOT_SUPPORTED
:
625 case RNDIS_STATUS_ADAPTER_NOT_READY
:
626 case RNDIS_STATUS_ADAPTER_NOT_OPEN
:
634 static int rndis_query_oid(struct usbnet
*dev
, __le32 oid
, void *data
, int *len
)
636 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(dev
);
639 struct rndis_msg_hdr
*header
;
640 struct rndis_query
*get
;
641 struct rndis_query_c
*get_c
;
645 buflen
= *len
+ sizeof(*u
.get
);
646 if (buflen
< CONTROL_BUFFER_SIZE
)
647 buflen
= CONTROL_BUFFER_SIZE
;
649 if (buflen
> COMMAND_BUFFER_SIZE
) {
650 u
.buf
= kmalloc(buflen
, GFP_KERNEL
);
654 u
.buf
= priv
->command_buffer
;
657 mutex_lock(&priv
->command_lock
);
659 memset(u
.get
, 0, sizeof *u
.get
);
660 u
.get
->msg_type
= RNDIS_MSG_QUERY
;
661 u
.get
->msg_len
= cpu_to_le32(sizeof *u
.get
);
664 priv
->current_command_oid
= oid
;
665 ret
= rndis_command(dev
, u
.header
, buflen
);
666 priv
->current_command_oid
= 0;
668 devdbg(dev
, "rndis_query_oid(%s): rndis_command() failed, %d "
669 "(%08x)", oid_to_string(oid
), ret
,
670 le32_to_cpu(u
.get_c
->status
));
673 ret
= le32_to_cpu(u
.get_c
->len
);
676 memcpy(data
, u
.buf
+ le32_to_cpu(u
.get_c
->offset
) + 8, *len
);
677 ret
= rndis_error_status(u
.get_c
->status
);
680 devdbg(dev
, "rndis_query_oid(%s): device returned "
681 "error, 0x%08x (%d)", oid_to_string(oid
),
682 le32_to_cpu(u
.get_c
->status
), ret
);
685 mutex_unlock(&priv
->command_lock
);
687 if (u
.buf
!= priv
->command_buffer
)
693 static int rndis_set_oid(struct usbnet
*dev
, __le32 oid
, void *data
, int len
)
695 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(dev
);
698 struct rndis_msg_hdr
*header
;
699 struct rndis_set
*set
;
700 struct rndis_set_c
*set_c
;
704 buflen
= len
+ sizeof(*u
.set
);
705 if (buflen
< CONTROL_BUFFER_SIZE
)
706 buflen
= CONTROL_BUFFER_SIZE
;
708 if (buflen
> COMMAND_BUFFER_SIZE
) {
709 u
.buf
= kmalloc(buflen
, GFP_KERNEL
);
713 u
.buf
= priv
->command_buffer
;
716 mutex_lock(&priv
->command_lock
);
718 memset(u
.set
, 0, sizeof *u
.set
);
719 u
.set
->msg_type
= RNDIS_MSG_SET
;
720 u
.set
->msg_len
= cpu_to_le32(sizeof(*u
.set
) + len
);
722 u
.set
->len
= cpu_to_le32(len
);
723 u
.set
->offset
= cpu_to_le32(sizeof(*u
.set
) - 8);
724 u
.set
->handle
= cpu_to_le32(0);
725 memcpy(u
.buf
+ sizeof(*u
.set
), data
, len
);
727 priv
->current_command_oid
= oid
;
728 ret
= rndis_command(dev
, u
.header
, buflen
);
729 priv
->current_command_oid
= 0;
731 devdbg(dev
, "rndis_set_oid(%s): rndis_command() failed, %d "
732 "(%08x)", oid_to_string(oid
), ret
,
733 le32_to_cpu(u
.set_c
->status
));
736 ret
= rndis_error_status(u
.set_c
->status
);
739 devdbg(dev
, "rndis_set_oid(%s): device returned error, "
740 "0x%08x (%d)", oid_to_string(oid
),
741 le32_to_cpu(u
.set_c
->status
), ret
);
744 mutex_unlock(&priv
->command_lock
);
746 if (u
.buf
!= priv
->command_buffer
)
752 static int rndis_reset(struct usbnet
*usbdev
)
754 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
755 struct rndis_reset
*reset
;
758 mutex_lock(&priv
->command_lock
);
760 reset
= (void *)priv
->command_buffer
;
761 memset(reset
, 0, sizeof(*reset
));
762 reset
->msg_type
= RNDIS_MSG_RESET
;
763 reset
->msg_len
= cpu_to_le32(sizeof(*reset
));
764 priv
->current_command_oid
= 0;
765 ret
= rndis_command(usbdev
, (void *)reset
, CONTROL_BUFFER_SIZE
);
767 mutex_unlock(&priv
->command_lock
);
776 * Specs say that we can only set config parameters only soon after device
778 * value_type: 0 = u32, 2 = unicode string
780 static int rndis_set_config_parameter(struct usbnet
*dev
, char *param
,
781 int value_type
, void *value
)
783 struct ndis_config_param
*infobuf
;
784 int value_len
, info_len
, param_len
, ret
, i
;
789 value_len
= sizeof(__le32
);
790 else if (value_type
== 2)
791 value_len
= strlen(value
) * sizeof(__le16
);
795 param_len
= strlen(param
) * sizeof(__le16
);
796 info_len
= sizeof(*infobuf
) + param_len
+ value_len
;
801 infobuf
= kmalloc(info_len
, GFP_KERNEL
);
807 /* extra 12 bytes are for padding (debug output) */
808 memset(infobuf
, 0xCC, info_len
+ 12);
812 devdbg(dev
, "setting config parameter: %s, value: %s",
815 devdbg(dev
, "setting config parameter: %s, value: %d",
816 param
, *(u32
*)value
);
818 infobuf
->name_offs
= cpu_to_le32(sizeof(*infobuf
));
819 infobuf
->name_length
= cpu_to_le32(param_len
);
820 infobuf
->type
= cpu_to_le32(value_type
);
821 infobuf
->value_offs
= cpu_to_le32(sizeof(*infobuf
) + param_len
);
822 infobuf
->value_length
= cpu_to_le32(value_len
);
824 /* simple string to unicode string conversion */
825 unibuf
= (void *)infobuf
+ sizeof(*infobuf
);
826 for (i
= 0; i
< param_len
/ sizeof(__le16
); i
++)
827 unibuf
[i
] = cpu_to_le16(param
[i
]);
829 if (value_type
== 2) {
830 unibuf
= (void *)infobuf
+ sizeof(*infobuf
) + param_len
;
831 for (i
= 0; i
< value_len
/ sizeof(__le16
); i
++)
832 unibuf
[i
] = cpu_to_le16(((u8
*)value
)[i
]);
834 dst_value
= (void *)infobuf
+ sizeof(*infobuf
) + param_len
;
835 *dst_value
= cpu_to_le32(*(u32
*)value
);
839 devdbg(dev
, "info buffer (len: %d):", info_len
);
840 for (i
= 0; i
< info_len
; i
+= 12) {
841 u32
*tmp
= (u32
*)((u8
*)infobuf
+ i
);
842 devdbg(dev
, "%08X:%08X:%08X",
845 cpu_to_be32(tmp
[2]));
849 ret
= rndis_set_oid(dev
, OID_GEN_RNDIS_CONFIG_PARAMETER
,
852 devdbg(dev
, "setting rndis config parameter failed, %d.", ret
);
858 static int rndis_set_config_parameter_str(struct usbnet
*dev
,
859 char *param
, char *value
)
861 return(rndis_set_config_parameter(dev
, param
, 2, value
));
864 /*static int rndis_set_config_parameter_u32(struct usbnet *dev,
865 char *param, u32 value)
867 return(rndis_set_config_parameter(dev, param, 0, &value));
872 * data conversion functions
874 static int level_to_qual(int level
)
876 int qual
= 100 * (level
- WL_NOISE
) / (WL_SIGMAX
- WL_NOISE
);
877 return qual
>= 0 ? (qual
<= 100 ? qual
: 100) : 0;
881 static void dsconfig_to_freq(unsigned int dsconfig
, struct iw_freq
*freq
)
887 /* see comment in wireless.h above the "struct iw_freq"
888 * definition for an explanation of this if
889 * NOTE: 1000000 is due to the kHz
891 if (dsconfig
> 1000000) {
892 freq
->m
= dsconfig
/ 10;
897 /* convert from kHz to Hz */
902 static int freq_to_dsconfig(struct iw_freq
*freq
, unsigned int *dsconfig
)
904 if (freq
->m
< 1000 && freq
->e
== 0) {
905 if (freq
->m
>= 1 && freq
->m
<= 14)
906 *dsconfig
= ieee80211_dsss_chan_to_freq(freq
->m
) * 1000;
912 for (i
= freq
->e
; i
> 0; i
--)
924 static void restore_keys(struct usbnet
*usbdev
);
925 static int rndis_check_bssid_list(struct usbnet
*usbdev
);
927 static int get_essid(struct usbnet
*usbdev
, struct ndis_80211_ssid
*ssid
)
932 ret
= rndis_query_oid(usbdev
, OID_802_11_SSID
, ssid
, &len
);
939 unsigned char tmp
[NDIS_802_11_LENGTH_SSID
+ 1];
941 memcpy(tmp
, ssid
->essid
, le32_to_cpu(ssid
->length
));
942 tmp
[le32_to_cpu(ssid
->length
)] = 0;
943 devdbg(usbdev
, "get_essid: '%s', ret: %d", tmp
, ret
);
950 static int set_essid(struct usbnet
*usbdev
, struct ndis_80211_ssid
*ssid
)
952 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
955 ret
= rndis_set_oid(usbdev
, OID_802_11_SSID
, ssid
, sizeof(*ssid
));
957 memcpy(&priv
->essid
, ssid
, sizeof(priv
->essid
));
959 devdbg(usbdev
, "set_essid: radio_on = 1");
966 static int get_bssid(struct usbnet
*usbdev
, u8 bssid
[ETH_ALEN
])
971 ret
= rndis_query_oid(usbdev
, OID_802_11_BSSID
, bssid
, &len
);
974 memset(bssid
, 0, ETH_ALEN
);
979 static int get_association_info(struct usbnet
*usbdev
,
980 struct ndis_80211_assoc_info
*info
, int len
)
982 return rndis_query_oid(usbdev
, OID_802_11_ASSOCIATION_INFORMATION
,
986 static int is_associated(struct usbnet
*usbdev
)
991 ret
= get_bssid(usbdev
, bssid
);
993 return (ret
== 0 && !is_zero_ether_addr(bssid
));
997 static int disassociate(struct usbnet
*usbdev
, int reset_ssid
)
999 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1000 struct ndis_80211_ssid ssid
;
1003 if (priv
->radio_on
) {
1004 ret
= rndis_set_oid(usbdev
, OID_802_11_DISASSOCIATE
, NULL
, 0);
1007 devdbg(usbdev
, "disassociate: radio_on = 0");
1014 /* disassociate causes radio to be turned off; if reset_ssid
1015 * is given, set random ssid to enable radio */
1017 ssid
.length
= cpu_to_le32(sizeof(ssid
.essid
));
1018 get_random_bytes(&ssid
.essid
[2], sizeof(ssid
.essid
)-2);
1019 ssid
.essid
[0] = 0x1;
1020 ssid
.essid
[1] = 0xff;
1021 for (i
= 2; i
< sizeof(ssid
.essid
); i
++)
1022 ssid
.essid
[i
] = 0x1 + (ssid
.essid
[i
] * 0xfe / 0xff);
1023 ret
= set_essid(usbdev
, &ssid
);
1029 static int set_auth_mode(struct usbnet
*usbdev
, int wpa_version
, int authalg
)
1031 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1035 devdbg(usbdev
, "set_auth_mode: wpa_version=0x%x authalg=0x%x "
1036 "keymgmt=0x%x", wpa_version
, authalg
, priv
->wpa_keymgmt
);
1038 if (wpa_version
& IW_AUTH_WPA_VERSION_WPA2
) {
1039 if (priv
->wpa_keymgmt
& IW_AUTH_KEY_MGMT_802_1X
)
1040 auth_mode
= NDIS_80211_AUTH_WPA2
;
1042 auth_mode
= NDIS_80211_AUTH_WPA2_PSK
;
1043 } else if (wpa_version
& IW_AUTH_WPA_VERSION_WPA
) {
1044 if (priv
->wpa_keymgmt
& IW_AUTH_KEY_MGMT_802_1X
)
1045 auth_mode
= NDIS_80211_AUTH_WPA
;
1046 else if (priv
->wpa_keymgmt
& IW_AUTH_KEY_MGMT_PSK
)
1047 auth_mode
= NDIS_80211_AUTH_WPA_PSK
;
1049 auth_mode
= NDIS_80211_AUTH_WPA_NONE
;
1050 } else if (authalg
& IW_AUTH_ALG_SHARED_KEY
) {
1051 if (authalg
& IW_AUTH_ALG_OPEN_SYSTEM
)
1052 auth_mode
= NDIS_80211_AUTH_AUTO_SWITCH
;
1054 auth_mode
= NDIS_80211_AUTH_SHARED
;
1056 auth_mode
= NDIS_80211_AUTH_OPEN
;
1058 tmp
= cpu_to_le32(auth_mode
);
1059 ret
= rndis_set_oid(usbdev
, OID_802_11_AUTHENTICATION_MODE
, &tmp
,
1062 devwarn(usbdev
, "setting auth mode failed (%08X)", ret
);
1066 priv
->wpa_version
= wpa_version
;
1067 priv
->wpa_authalg
= authalg
;
1072 static int set_priv_filter(struct usbnet
*usbdev
)
1074 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1077 devdbg(usbdev
, "set_priv_filter: wpa_version=0x%x", priv
->wpa_version
);
1079 if (priv
->wpa_version
& IW_AUTH_WPA_VERSION_WPA2
||
1080 priv
->wpa_version
& IW_AUTH_WPA_VERSION_WPA
)
1081 tmp
= cpu_to_le32(NDIS_80211_PRIV_8021X_WEP
);
1083 tmp
= cpu_to_le32(NDIS_80211_PRIV_ACCEPT_ALL
);
1085 return rndis_set_oid(usbdev
, OID_802_11_PRIVACY_FILTER
, &tmp
,
1090 static int set_encr_mode(struct usbnet
*usbdev
, int pairwise
, int groupwise
)
1092 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1096 devdbg(usbdev
, "set_encr_mode: cipher_pair=0x%x cipher_group=0x%x",
1100 if (pairwise
& IW_AUTH_CIPHER_CCMP
)
1101 encr_mode
= NDIS_80211_ENCR_CCMP_ENABLED
;
1102 else if (pairwise
& IW_AUTH_CIPHER_TKIP
)
1103 encr_mode
= NDIS_80211_ENCR_TKIP_ENABLED
;
1105 (IW_AUTH_CIPHER_WEP40
| IW_AUTH_CIPHER_WEP104
))
1106 encr_mode
= NDIS_80211_ENCR_WEP_ENABLED
;
1107 else if (groupwise
& IW_AUTH_CIPHER_CCMP
)
1108 encr_mode
= NDIS_80211_ENCR_CCMP_ENABLED
;
1109 else if (groupwise
& IW_AUTH_CIPHER_TKIP
)
1110 encr_mode
= NDIS_80211_ENCR_TKIP_ENABLED
;
1112 encr_mode
= NDIS_80211_ENCR_DISABLED
;
1114 tmp
= cpu_to_le32(encr_mode
);
1115 ret
= rndis_set_oid(usbdev
, OID_802_11_ENCRYPTION_STATUS
, &tmp
,
1118 devwarn(usbdev
, "setting encr mode failed (%08X)", ret
);
1122 priv
->wpa_cipher_pair
= pairwise
;
1123 priv
->wpa_cipher_group
= groupwise
;
1128 static int set_assoc_params(struct usbnet
*usbdev
)
1130 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1132 set_auth_mode(usbdev
, priv
->wpa_version
, priv
->wpa_authalg
);
1133 set_priv_filter(usbdev
);
1134 set_encr_mode(usbdev
, priv
->wpa_cipher_pair
, priv
->wpa_cipher_group
);
1140 static int set_infra_mode(struct usbnet
*usbdev
, int mode
)
1142 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1146 devdbg(usbdev
, "set_infra_mode: infra_mode=0x%x", priv
->infra_mode
);
1148 tmp
= cpu_to_le32(mode
);
1149 ret
= rndis_set_oid(usbdev
, OID_802_11_INFRASTRUCTURE_MODE
, &tmp
,
1152 devwarn(usbdev
, "setting infra mode failed (%08X)", ret
);
1156 /* NDIS drivers clear keys when infrastructure mode is
1157 * changed. But Linux tools assume otherwise. So set the
1159 restore_keys(usbdev
);
1161 priv
->infra_mode
= mode
;
1166 static int set_rts_threshold(struct usbnet
*usbdev
, u32 rts_threshold
)
1170 devdbg(usbdev
, "set_rts_threshold %i", rts_threshold
);
1172 if (rts_threshold
< 0 || rts_threshold
> 2347)
1173 rts_threshold
= 2347;
1175 tmp
= cpu_to_le32(rts_threshold
);
1176 return rndis_set_oid(usbdev
, OID_802_11_RTS_THRESHOLD
, &tmp
,
1181 static int set_frag_threshold(struct usbnet
*usbdev
, u32 frag_threshold
)
1185 devdbg(usbdev
, "set_frag_threshold %i", frag_threshold
);
1187 if (frag_threshold
< 256 || frag_threshold
> 2346)
1188 frag_threshold
= 2346;
1190 tmp
= cpu_to_le32(frag_threshold
);
1191 return rndis_set_oid(usbdev
, OID_802_11_FRAGMENTATION_THRESHOLD
, &tmp
,
1196 static void set_default_iw_params(struct usbnet
*usbdev
)
1198 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1200 priv
->wpa_keymgmt
= 0;
1201 priv
->wpa_version
= 0;
1203 set_infra_mode(usbdev
, NDIS_80211_INFRA_INFRA
);
1204 set_auth_mode(usbdev
, IW_AUTH_WPA_VERSION_DISABLED
,
1205 IW_AUTH_ALG_OPEN_SYSTEM
);
1206 set_priv_filter(usbdev
);
1207 set_encr_mode(usbdev
, IW_AUTH_CIPHER_NONE
, IW_AUTH_CIPHER_NONE
);
1211 static int deauthenticate(struct usbnet
*usbdev
)
1215 ret
= disassociate(usbdev
, 1);
1216 set_default_iw_params(usbdev
);
1221 /* index must be 0 - N, as per NDIS */
1222 static int add_wep_key(struct usbnet
*usbdev
, char *key
, int key_len
, int index
)
1224 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1225 struct ndis_80211_wep_key ndis_key
;
1228 if ((key_len
!= 5 && key_len
!= 13) || index
< 0 || index
> 3)
1232 cipher
= WLAN_CIPHER_SUITE_WEP40
;
1234 cipher
= WLAN_CIPHER_SUITE_WEP104
;
1236 memset(&ndis_key
, 0, sizeof(ndis_key
));
1238 ndis_key
.size
= cpu_to_le32(sizeof(ndis_key
));
1239 ndis_key
.length
= cpu_to_le32(key_len
);
1240 ndis_key
.index
= cpu_to_le32(index
);
1241 memcpy(&ndis_key
.material
, key
, key_len
);
1243 if (index
== priv
->encr_tx_key_index
) {
1244 ndis_key
.index
|= NDIS_80211_ADDWEP_TRANSMIT_KEY
;
1245 ret
= set_encr_mode(usbdev
, IW_AUTH_CIPHER_WEP104
,
1246 IW_AUTH_CIPHER_NONE
);
1248 devwarn(usbdev
, "encryption couldn't be enabled (%08X)",
1252 ret
= rndis_set_oid(usbdev
, OID_802_11_ADD_WEP
, &ndis_key
,
1255 devwarn(usbdev
, "adding encryption key %d failed (%08X)",
1260 priv
->encr_keys
[index
].len
= key_len
;
1261 priv
->encr_keys
[index
].cipher
= cipher
;
1262 memcpy(&priv
->encr_keys
[index
].material
, key
, key_len
);
1263 memset(&priv
->encr_keys
[index
].bssid
, 0xff, ETH_ALEN
);
1269 static int add_wpa_key(struct usbnet
*usbdev
, const u8
*key
, int key_len
,
1270 int index
, const u8
*addr
, const u8
*rx_seq
, int cipher
,
1273 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1274 struct ndis_80211_key ndis_key
;
1278 if (index
< 0 || index
>= 4) {
1279 devdbg(usbdev
, "add_wpa_key: index out of range (%i)", index
);
1282 if (key_len
> sizeof(ndis_key
.material
) || key_len
< 0) {
1283 devdbg(usbdev
, "add_wpa_key: key length out of range (%i)",
1287 if ((flags
& NDIS_80211_ADDKEY_SET_INIT_RECV_SEQ
) && !rx_seq
) {
1288 devdbg(usbdev
, "add_wpa_key: recv seq flag without buffer");
1291 is_addr_ok
= addr
&& !is_zero_ether_addr(addr
) &&
1292 !is_broadcast_ether_addr(addr
);
1293 if ((flags
& NDIS_80211_ADDKEY_PAIRWISE_KEY
) && !is_addr_ok
) {
1294 devdbg(usbdev
, "add_wpa_key: pairwise but bssid invalid (%pM)",
1299 devdbg(usbdev
, "add_wpa_key(%i): flags:%i%i%i", index
,
1300 !!(flags
& NDIS_80211_ADDKEY_TRANSMIT_KEY
),
1301 !!(flags
& NDIS_80211_ADDKEY_PAIRWISE_KEY
),
1302 !!(flags
& NDIS_80211_ADDKEY_SET_INIT_RECV_SEQ
));
1304 memset(&ndis_key
, 0, sizeof(ndis_key
));
1306 ndis_key
.size
= cpu_to_le32(sizeof(ndis_key
) -
1307 sizeof(ndis_key
.material
) + key_len
);
1308 ndis_key
.length
= cpu_to_le32(key_len
);
1309 ndis_key
.index
= cpu_to_le32(index
) | flags
;
1311 if (cipher
== WLAN_CIPHER_SUITE_TKIP
&& key_len
== 32) {
1312 /* wpa_supplicant gives us the Michael MIC RX/TX keys in
1313 * different order than NDIS spec, so swap the order here. */
1314 memcpy(ndis_key
.material
, key
, 16);
1315 memcpy(ndis_key
.material
+ 16, key
+ 24, 8);
1316 memcpy(ndis_key
.material
+ 24, key
+ 16, 8);
1318 memcpy(ndis_key
.material
, key
, key_len
);
1320 if (flags
& NDIS_80211_ADDKEY_SET_INIT_RECV_SEQ
)
1321 memcpy(ndis_key
.rsc
, rx_seq
, 6);
1323 if (flags
& NDIS_80211_ADDKEY_PAIRWISE_KEY
) {
1325 memcpy(ndis_key
.bssid
, addr
, ETH_ALEN
);
1328 if (priv
->infra_mode
== NDIS_80211_INFRA_ADHOC
)
1329 memset(ndis_key
.bssid
, 0xff, ETH_ALEN
);
1331 get_bssid(usbdev
, ndis_key
.bssid
);
1334 ret
= rndis_set_oid(usbdev
, OID_802_11_ADD_KEY
, &ndis_key
,
1335 le32_to_cpu(ndis_key
.size
));
1336 devdbg(usbdev
, "add_wpa_key: OID_802_11_ADD_KEY -> %08X", ret
);
1340 memset(&priv
->encr_keys
[index
], 0, sizeof(priv
->encr_keys
[index
]));
1341 priv
->encr_keys
[index
].len
= key_len
;
1342 priv
->encr_keys
[index
].cipher
= cipher
;
1343 memcpy(&priv
->encr_keys
[index
].material
, key
, key_len
);
1344 if (flags
& NDIS_80211_ADDKEY_PAIRWISE_KEY
)
1345 memcpy(&priv
->encr_keys
[index
].bssid
, ndis_key
.bssid
, ETH_ALEN
);
1347 memset(&priv
->encr_keys
[index
].bssid
, 0xff, ETH_ALEN
);
1349 if (flags
& NDIS_80211_ADDKEY_TRANSMIT_KEY
)
1350 priv
->encr_tx_key_index
= index
;
1356 static int restore_key(struct usbnet
*usbdev
, int key_idx
)
1358 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1359 struct rndis_wlan_encr_key key
;
1362 key
= priv
->encr_keys
[key_idx
];
1364 devdbg(usbdev
, "restore_key: %i:%s:%i", key_idx
,
1365 is_wpa_key(priv
, key_idx
) ? "wpa" : "wep",
1371 if (is_wpa_key(priv
, key_idx
)) {
1374 /*if (priv->encr_tx_key_index == key_idx)
1375 flags |= NDIS_80211_ADDKEY_TRANSMIT_KEY;*/
1377 if (!is_zero_ether_addr(key
.bssid
) &&
1378 !is_broadcast_ether_addr(key
.bssid
))
1379 flags
|= NDIS_80211_ADDKEY_PAIRWISE_KEY
;
1381 return add_wpa_key(usbdev
, key
.material
, key
.len
, key_idx
,
1382 key
.bssid
, NULL
, key
.cipher
, flags
);
1385 return add_wep_key(usbdev
, key
.material
, key
.len
, key_idx
);
1389 static void restore_keys(struct usbnet
*usbdev
)
1393 for (i
= 0; i
< 4; i
++)
1394 restore_key(usbdev
, i
);
1398 static void clear_key(struct rndis_wlan_private
*priv
, int idx
)
1400 memset(&priv
->encr_keys
[idx
], 0, sizeof(priv
->encr_keys
[idx
]));
1404 /* remove_key is for both wep and wpa */
1405 static int remove_key(struct usbnet
*usbdev
, int index
, u8 bssid
[ETH_ALEN
])
1407 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1408 struct ndis_80211_remove_key remove_key
;
1413 if (priv
->encr_keys
[index
].len
== 0)
1416 is_wpa
= is_wpa_key(priv
, index
);
1418 devdbg(usbdev
, "remove_key: %i:%s:%i", index
, is_wpa
? "wpa" : "wep",
1419 priv
->encr_keys
[index
].len
);
1421 clear_key(priv
, index
);
1424 remove_key
.size
= cpu_to_le32(sizeof(remove_key
));
1425 remove_key
.index
= cpu_to_le32(index
);
1428 if (!is_broadcast_ether_addr(bssid
))
1430 NDIS_80211_ADDKEY_PAIRWISE_KEY
;
1431 memcpy(remove_key
.bssid
, bssid
,
1432 sizeof(remove_key
.bssid
));
1434 memset(remove_key
.bssid
, 0xff,
1435 sizeof(remove_key
.bssid
));
1437 ret
= rndis_set_oid(usbdev
, OID_802_11_REMOVE_KEY
, &remove_key
,
1438 sizeof(remove_key
));
1442 keyindex
= cpu_to_le32(index
);
1443 ret
= rndis_set_oid(usbdev
, OID_802_11_REMOVE_WEP
, &keyindex
,
1447 "removing encryption key %d failed (%08X)",
1453 /* if it is transmit key, disable encryption */
1454 if (index
== priv
->encr_tx_key_index
)
1455 set_encr_mode(usbdev
, IW_AUTH_CIPHER_NONE
, IW_AUTH_CIPHER_NONE
);
1461 static void set_multicast_list(struct usbnet
*usbdev
)
1463 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1464 struct dev_mc_list
*mclist
;
1469 filter
= RNDIS_PACKET_TYPE_DIRECTED
| RNDIS_PACKET_TYPE_BROADCAST
;
1471 if (usbdev
->net
->flags
& IFF_PROMISC
) {
1472 filter
|= RNDIS_PACKET_TYPE_PROMISCUOUS
|
1473 RNDIS_PACKET_TYPE_ALL_LOCAL
;
1474 } else if (usbdev
->net
->flags
& IFF_ALLMULTI
||
1475 usbdev
->net
->mc_count
> priv
->multicast_size
) {
1476 filter
|= RNDIS_PACKET_TYPE_ALL_MULTICAST
;
1477 } else if (usbdev
->net
->mc_count
> 0) {
1478 size
= min(priv
->multicast_size
, usbdev
->net
->mc_count
);
1479 buf
= kmalloc(size
* ETH_ALEN
, GFP_KERNEL
);
1482 "couldn't alloc %d bytes of memory",
1487 mclist
= usbdev
->net
->mc_list
;
1488 for (i
= 0; i
< size
&& mclist
; mclist
= mclist
->next
) {
1489 if (mclist
->dmi_addrlen
!= ETH_ALEN
)
1492 memcpy(buf
+ i
* ETH_ALEN
, mclist
->dmi_addr
, ETH_ALEN
);
1496 ret
= rndis_set_oid(usbdev
, OID_802_3_MULTICAST_LIST
, buf
,
1498 if (ret
== 0 && i
> 0)
1499 filter
|= RNDIS_PACKET_TYPE_MULTICAST
;
1501 filter
|= RNDIS_PACKET_TYPE_ALL_MULTICAST
;
1503 devdbg(usbdev
, "OID_802_3_MULTICAST_LIST(%d, max: %d) -> %d",
1504 i
, priv
->multicast_size
, ret
);
1509 ret
= rndis_set_oid(usbdev
, OID_GEN_CURRENT_PACKET_FILTER
, &filter
,
1512 devwarn(usbdev
, "couldn't set packet filter: %08x",
1513 le32_to_cpu(filter
));
1516 devdbg(usbdev
, "OID_GEN_CURRENT_PACKET_FILTER(%08x) -> %d",
1517 le32_to_cpu(filter
), ret
);
1524 static int rndis_change_virtual_intf(struct wiphy
*wiphy
,
1525 struct net_device
*dev
,
1526 enum nl80211_iftype type
, u32
*flags
,
1527 struct vif_params
*params
)
1529 struct usbnet
*usbdev
= netdev_priv(dev
);
1533 case NL80211_IFTYPE_ADHOC
:
1534 mode
= NDIS_80211_INFRA_ADHOC
;
1536 case NL80211_IFTYPE_STATION
:
1537 mode
= NDIS_80211_INFRA_INFRA
;
1543 return set_infra_mode(usbdev
, mode
);
1547 static int rndis_set_wiphy_params(struct wiphy
*wiphy
, u32 changed
)
1549 struct rndis_wlan_private
*priv
= wiphy_priv(wiphy
);
1550 struct usbnet
*usbdev
= priv
->usbdev
;
1553 if (changed
& WIPHY_PARAM_FRAG_THRESHOLD
) {
1554 err
= set_frag_threshold(usbdev
, wiphy
->frag_threshold
);
1559 if (changed
& WIPHY_PARAM_RTS_THRESHOLD
) {
1560 err
= set_rts_threshold(usbdev
, wiphy
->rts_threshold
);
1569 static int rndis_set_tx_power(struct wiphy
*wiphy
, enum tx_power_setting type
,
1572 struct rndis_wlan_private
*priv
= wiphy_priv(wiphy
);
1573 struct usbnet
*usbdev
= priv
->usbdev
;
1575 devdbg(usbdev
, "rndis_set_tx_power type:0x%x dbm:%i", type
, dbm
);
1577 /* Device doesn't support changing txpower after initialization, only
1578 * turn off/on radio. Support 'auto' mode and setting same dBm that is
1581 if (type
== TX_POWER_AUTOMATIC
|| dbm
== get_bcm4320_power_dbm(priv
)) {
1582 if (!priv
->radio_on
)
1583 disassociate(usbdev
, 1); /* turn on radio */
1592 static int rndis_get_tx_power(struct wiphy
*wiphy
, int *dbm
)
1594 struct rndis_wlan_private
*priv
= wiphy_priv(wiphy
);
1595 struct usbnet
*usbdev
= priv
->usbdev
;
1597 *dbm
= get_bcm4320_power_dbm(priv
);
1599 devdbg(usbdev
, "rndis_get_tx_power dbm:%i", *dbm
);
1605 #define SCAN_DELAY_JIFFIES (6 * HZ)
1606 static int rndis_scan(struct wiphy
*wiphy
, struct net_device
*dev
,
1607 struct cfg80211_scan_request
*request
)
1609 struct usbnet
*usbdev
= netdev_priv(dev
);
1610 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1614 devdbg(usbdev
, "cfg80211.scan");
1616 /* Get current bssid list from device before new scan, as new scan
1617 * clears internal bssid list.
1619 rndis_check_bssid_list(usbdev
);
1624 if (priv
->scan_request
&& priv
->scan_request
!= request
)
1627 priv
->scan_request
= request
;
1629 tmp
= cpu_to_le32(1);
1630 ret
= rndis_set_oid(usbdev
, OID_802_11_BSSID_LIST_SCAN
, &tmp
,
1633 /* Wait before retrieving scan results from device */
1634 queue_delayed_work(priv
->workqueue
, &priv
->scan_work
,
1635 SCAN_DELAY_JIFFIES
);
1642 static struct cfg80211_bss
*rndis_bss_info_update(struct usbnet
*usbdev
,
1643 struct ndis_80211_bssid_ex
*bssid
)
1645 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1646 struct ieee80211_channel
*channel
;
1650 u16 beacon_interval
;
1651 struct ndis_80211_fixed_ies
*fixed
;
1652 int ie_len
, bssid_len
;
1655 devdbg(usbdev
, " found bssid: '%.32s' [%pM]", bssid
->ssid
.essid
,
1658 /* parse bssid structure */
1659 bssid_len
= le32_to_cpu(bssid
->length
);
1661 if (bssid_len
< sizeof(struct ndis_80211_bssid_ex
) +
1662 sizeof(struct ndis_80211_fixed_ies
))
1665 fixed
= (struct ndis_80211_fixed_ies
*)bssid
->ies
;
1667 ie
= (void *)(bssid
->ies
+ sizeof(struct ndis_80211_fixed_ies
));
1668 ie_len
= min(bssid_len
- (int)sizeof(*bssid
),
1669 (int)le32_to_cpu(bssid
->ie_length
));
1670 ie_len
-= sizeof(struct ndis_80211_fixed_ies
);
1674 /* extract data for cfg80211_inform_bss */
1675 channel
= ieee80211_get_channel(priv
->wdev
.wiphy
,
1676 KHZ_TO_MHZ(le32_to_cpu(bssid
->config
.ds_config
)));
1680 signal
= level_to_qual(le32_to_cpu(bssid
->rssi
));
1681 timestamp
= le64_to_cpu(*(__le64
*)fixed
->timestamp
);
1682 capability
= le16_to_cpu(fixed
->capabilities
);
1683 beacon_interval
= le16_to_cpu(fixed
->beacon_interval
);
1685 return cfg80211_inform_bss(priv
->wdev
.wiphy
, channel
, bssid
->mac
,
1686 timestamp
, capability
, beacon_interval
, ie
, ie_len
, signal
,
1691 static int rndis_check_bssid_list(struct usbnet
*usbdev
)
1694 struct ndis_80211_bssid_list_ex
*bssid_list
;
1695 struct ndis_80211_bssid_ex
*bssid
;
1696 int ret
= -EINVAL
, len
, count
, bssid_len
;
1697 bool resized
= false;
1699 devdbg(usbdev
, "check_bssid_list");
1701 len
= CONTROL_BUFFER_SIZE
;
1703 buf
= kmalloc(len
, GFP_KERNEL
);
1709 ret
= rndis_query_oid(usbdev
, OID_802_11_BSSID_LIST
, buf
, &len
);
1713 if (!resized
&& len
> CONTROL_BUFFER_SIZE
) {
1720 bssid
= bssid_list
->bssid
;
1721 bssid_len
= le32_to_cpu(bssid
->length
);
1722 count
= le32_to_cpu(bssid_list
->num_items
);
1723 devdbg(usbdev
, "check_bssid_list: %d BSSIDs found (buflen: %d)", count
,
1726 while (count
&& ((void *)bssid
+ bssid_len
) <= (buf
+ len
)) {
1727 rndis_bss_info_update(usbdev
, bssid
);
1729 bssid
= (void *)bssid
+ bssid_len
;
1730 bssid_len
= le32_to_cpu(bssid
->length
);
1740 static void rndis_get_scan_results(struct work_struct
*work
)
1742 struct rndis_wlan_private
*priv
=
1743 container_of(work
, struct rndis_wlan_private
, scan_work
.work
);
1744 struct usbnet
*usbdev
= priv
->usbdev
;
1747 devdbg(usbdev
, "get_scan_results");
1749 if (!priv
->scan_request
)
1752 ret
= rndis_check_bssid_list(usbdev
);
1754 cfg80211_scan_done(priv
->scan_request
, ret
< 0);
1756 priv
->scan_request
= NULL
;
1761 * wireless extension handlers
1764 static int rndis_iw_commit(struct net_device
*dev
,
1765 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
1772 static int rndis_iw_set_essid(struct net_device
*dev
,
1773 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *essid
)
1775 struct ndis_80211_ssid ssid
;
1776 int length
= wrqu
->essid
.length
;
1777 struct usbnet
*usbdev
= netdev_priv(dev
);
1779 devdbg(usbdev
, "SIOCSIWESSID: [flags:%d,len:%d] '%.32s'",
1780 wrqu
->essid
.flags
, wrqu
->essid
.length
, essid
);
1782 if (length
> NDIS_802_11_LENGTH_SSID
)
1783 length
= NDIS_802_11_LENGTH_SSID
;
1785 ssid
.length
= cpu_to_le32(length
);
1787 memcpy(ssid
.essid
, essid
, length
);
1789 memset(ssid
.essid
, 0, NDIS_802_11_LENGTH_SSID
);
1791 set_assoc_params(usbdev
);
1793 if (!wrqu
->essid
.flags
|| length
== 0)
1794 return disassociate(usbdev
, 1);
1796 /* Pause and purge rx queue, so we don't pass packets before
1797 * 'media connect'-indication.
1799 usbnet_pause_rx(usbdev
);
1800 usbnet_purge_paused_rxq(usbdev
);
1802 return set_essid(usbdev
, &ssid
);
1807 static int rndis_iw_get_essid(struct net_device
*dev
,
1808 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *essid
)
1810 struct ndis_80211_ssid ssid
;
1811 struct usbnet
*usbdev
= netdev_priv(dev
);
1814 ret
= get_essid(usbdev
, &ssid
);
1816 if (ret
== 0 && le32_to_cpu(ssid
.length
) > 0) {
1817 wrqu
->essid
.flags
= 1;
1818 wrqu
->essid
.length
= le32_to_cpu(ssid
.length
);
1819 memcpy(essid
, ssid
.essid
, wrqu
->essid
.length
);
1820 essid
[wrqu
->essid
.length
] = 0;
1822 memset(essid
, 0, sizeof(NDIS_802_11_LENGTH_SSID
));
1823 wrqu
->essid
.flags
= 0;
1824 wrqu
->essid
.length
= 0;
1826 devdbg(usbdev
, "SIOCGIWESSID: %s", essid
);
1831 static int rndis_iw_get_bssid(struct net_device
*dev
,
1832 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
1834 struct usbnet
*usbdev
= netdev_priv(dev
);
1835 unsigned char bssid
[ETH_ALEN
];
1838 ret
= get_bssid(usbdev
, bssid
);
1841 devdbg(usbdev
, "SIOCGIWAP: %pM", bssid
);
1843 devdbg(usbdev
, "SIOCGIWAP: <not associated>");
1845 wrqu
->ap_addr
.sa_family
= ARPHRD_ETHER
;
1846 memcpy(wrqu
->ap_addr
.sa_data
, bssid
, ETH_ALEN
);
1852 static int rndis_iw_set_bssid(struct net_device
*dev
,
1853 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
1855 struct usbnet
*usbdev
= netdev_priv(dev
);
1856 u8
*bssid
= (u8
*)wrqu
->ap_addr
.sa_data
;
1859 devdbg(usbdev
, "SIOCSIWAP: %pM", bssid
);
1861 ret
= rndis_set_oid(usbdev
, OID_802_11_BSSID
, bssid
, ETH_ALEN
);
1863 /* user apps may set ap's mac address, which is not required;
1864 * they may fail to work if this function fails, so return
1867 devwarn(usbdev
, "setting AP mac address failed (%08X)", ret
);
1873 static int rndis_iw_set_auth(struct net_device
*dev
,
1874 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
1876 struct iw_param
*p
= &wrqu
->param
;
1877 struct usbnet
*usbdev
= netdev_priv(dev
);
1878 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1879 int ret
= -ENOTSUPP
;
1881 switch (p
->flags
& IW_AUTH_INDEX
) {
1882 case IW_AUTH_WPA_VERSION
:
1883 devdbg(usbdev
, "SIOCSIWAUTH: WPA_VERSION, %08x", p
->value
);
1884 priv
->wpa_version
= p
->value
;
1888 case IW_AUTH_CIPHER_PAIRWISE
:
1889 devdbg(usbdev
, "SIOCSIWAUTH: CIPHER_PAIRWISE, %08x", p
->value
);
1890 priv
->wpa_cipher_pair
= p
->value
;
1894 case IW_AUTH_CIPHER_GROUP
:
1895 devdbg(usbdev
, "SIOCSIWAUTH: CIPHER_GROUP, %08x", p
->value
);
1896 priv
->wpa_cipher_group
= p
->value
;
1900 case IW_AUTH_KEY_MGMT
:
1901 devdbg(usbdev
, "SIOCSIWAUTH: KEY_MGMT, %08x", p
->value
);
1902 priv
->wpa_keymgmt
= p
->value
;
1906 case IW_AUTH_TKIP_COUNTERMEASURES
:
1907 devdbg(usbdev
, "SIOCSIWAUTH: TKIP_COUNTERMEASURES, %08x",
1912 case IW_AUTH_DROP_UNENCRYPTED
:
1913 devdbg(usbdev
, "SIOCSIWAUTH: DROP_UNENCRYPTED, %08x", p
->value
);
1917 case IW_AUTH_80211_AUTH_ALG
:
1918 devdbg(usbdev
, "SIOCSIWAUTH: 80211_AUTH_ALG, %08x", p
->value
);
1919 priv
->wpa_authalg
= p
->value
;
1923 case IW_AUTH_WPA_ENABLED
:
1924 devdbg(usbdev
, "SIOCSIWAUTH: WPA_ENABLED, %08x", p
->value
);
1925 if (wrqu
->param
.value
)
1926 deauthenticate(usbdev
);
1930 case IW_AUTH_RX_UNENCRYPTED_EAPOL
:
1931 devdbg(usbdev
, "SIOCSIWAUTH: RX_UNENCRYPTED_EAPOL, %08x",
1936 case IW_AUTH_ROAMING_CONTROL
:
1937 devdbg(usbdev
, "SIOCSIWAUTH: ROAMING_CONTROL, %08x", p
->value
);
1941 case IW_AUTH_PRIVACY_INVOKED
:
1942 devdbg(usbdev
, "SIOCSIWAUTH: invalid cmd %d",
1943 wrqu
->param
.flags
& IW_AUTH_INDEX
);
1947 devdbg(usbdev
, "SIOCSIWAUTH: UNKNOWN %08x, %08x",
1948 p
->flags
& IW_AUTH_INDEX
, p
->value
);
1954 static int rndis_iw_get_auth(struct net_device
*dev
,
1955 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
1957 struct iw_param
*p
= &wrqu
->param
;
1958 struct usbnet
*usbdev
= netdev_priv(dev
);
1959 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1961 switch (p
->flags
& IW_AUTH_INDEX
) {
1962 case IW_AUTH_WPA_VERSION
:
1963 p
->value
= priv
->wpa_version
;
1965 case IW_AUTH_CIPHER_PAIRWISE
:
1966 p
->value
= priv
->wpa_cipher_pair
;
1968 case IW_AUTH_CIPHER_GROUP
:
1969 p
->value
= priv
->wpa_cipher_group
;
1971 case IW_AUTH_KEY_MGMT
:
1972 p
->value
= priv
->wpa_keymgmt
;
1974 case IW_AUTH_80211_AUTH_ALG
:
1975 p
->value
= priv
->wpa_authalg
;
1978 devdbg(usbdev
, "SIOCGIWAUTH: invalid cmd %d",
1979 wrqu
->param
.flags
& IW_AUTH_INDEX
);
1986 static int rndis_iw_set_encode(struct net_device
*dev
,
1987 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
1989 struct usbnet
*usbdev
= netdev_priv(dev
);
1990 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
1991 struct rndis_wlan_encr_key key
;
1992 int ret
, index
, key_len
;
1995 index
= (wrqu
->encoding
.flags
& IW_ENCODE_INDEX
);
1997 /* iwconfig gives index as 1 - N */
2001 index
= priv
->encr_tx_key_index
;
2003 if (index
< 0 || index
>= 4) {
2004 devwarn(usbdev
, "encryption index out of range (%u)", index
);
2008 /* remove key if disabled */
2009 if (wrqu
->data
.flags
& IW_ENCODE_DISABLED
) {
2010 if (remove_key(usbdev
, index
, NULL
))
2016 /* global encryption state (for all keys) */
2017 if (wrqu
->data
.flags
& IW_ENCODE_OPEN
)
2018 ret
= set_auth_mode(usbdev
, IW_AUTH_WPA_VERSION_DISABLED
,
2019 IW_AUTH_ALG_OPEN_SYSTEM
);
2020 else /*if (wrqu->data.flags & IW_ENCODE_RESTRICTED)*/
2021 ret
= set_auth_mode(usbdev
, IW_AUTH_WPA_VERSION_DISABLED
,
2022 IW_AUTH_ALG_SHARED_KEY
);
2026 if (wrqu
->data
.length
> 0) {
2027 key_len
= wrqu
->data
.length
;
2030 /* must be set as tx key */
2031 if (priv
->encr_keys
[index
].len
== 0)
2033 key
= priv
->encr_keys
[index
];
2035 keybuf
= key
.material
;
2036 priv
->encr_tx_key_index
= index
;
2039 if (add_wep_key(usbdev
, keybuf
, key_len
, index
) != 0)
2042 if (index
== priv
->encr_tx_key_index
)
2043 /* ndis drivers want essid to be set after setting encr */
2044 set_essid(usbdev
, &priv
->essid
);
2050 static int rndis_iw_set_encode_ext(struct net_device
*dev
,
2051 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
2053 struct iw_encode_ext
*ext
= (struct iw_encode_ext
*)extra
;
2054 struct usbnet
*usbdev
= netdev_priv(dev
);
2055 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2056 int keyidx
, flags
, cipher
;
2058 keyidx
= wrqu
->encoding
.flags
& IW_ENCODE_INDEX
;
2060 /* iwconfig gives index as 1 - N */
2064 keyidx
= priv
->encr_tx_key_index
;
2066 if (keyidx
< 0 || keyidx
>= 4) {
2067 devwarn(usbdev
, "encryption index out of range (%u)", keyidx
);
2071 if (ext
->alg
== WPA_ALG_WEP
) {
2072 if (ext
->ext_flags
& IW_ENCODE_EXT_SET_TX_KEY
)
2073 priv
->encr_tx_key_index
= keyidx
;
2074 return add_wep_key(usbdev
, ext
->key
, ext
->key_len
, keyidx
);
2078 if (ext
->alg
== IW_ENCODE_ALG_TKIP
)
2079 cipher
= WLAN_CIPHER_SUITE_TKIP
;
2080 else if (ext
->alg
== IW_ENCODE_ALG_CCMP
)
2081 cipher
= WLAN_CIPHER_SUITE_CCMP
;
2083 if ((wrqu
->encoding
.flags
& IW_ENCODE_DISABLED
) ||
2084 ext
->alg
== IW_ENCODE_ALG_NONE
|| ext
->key_len
== 0)
2085 return remove_key(usbdev
, keyidx
, NULL
);
2091 if (ext
->ext_flags
& IW_ENCODE_EXT_RX_SEQ_VALID
)
2092 flags
|= NDIS_80211_ADDKEY_SET_INIT_RECV_SEQ
;
2093 if (!(ext
->ext_flags
& IW_ENCODE_EXT_GROUP_KEY
))
2094 flags
|= NDIS_80211_ADDKEY_PAIRWISE_KEY
;
2095 if (ext
->ext_flags
& IW_ENCODE_EXT_SET_TX_KEY
)
2096 flags
|= NDIS_80211_ADDKEY_TRANSMIT_KEY
;
2098 return add_wpa_key(usbdev
, ext
->key
, ext
->key_len
, keyidx
,
2099 (u8
*)&ext
->addr
.sa_data
, ext
->rx_seq
, cipher
,
2104 static int rndis_iw_set_genie(struct net_device
*dev
,
2105 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
2107 struct usbnet
*usbdev
= netdev_priv(dev
);
2108 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2114 for (j
= 0; j
< wrqu
->data
.length
; j
+= 8)
2116 "SIOCSIWGENIE %04x - "
2117 "%02x %02x %02x %02x %02x %02x %02x %02x", j
,
2118 gie
[j
+ 0], gie
[j
+ 1], gie
[j
+ 2], gie
[j
+ 3],
2119 gie
[j
+ 4], gie
[j
+ 5], gie
[j
+ 6], gie
[j
+ 7]);
2121 /* clear existing IEs */
2122 if (priv
->wpa_ie_len
) {
2123 kfree(priv
->wpa_ie
);
2124 priv
->wpa_ie_len
= 0;
2128 priv
->wpa_ie
= kmalloc(wrqu
->data
.length
, GFP_KERNEL
);
2130 priv
->wpa_ie_len
= wrqu
->data
.length
;
2131 memcpy(priv
->wpa_ie
, extra
, priv
->wpa_ie_len
);
2138 static int rndis_iw_get_genie(struct net_device
*dev
,
2139 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
2141 struct usbnet
*usbdev
= netdev_priv(dev
);
2142 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2144 devdbg(usbdev
, "SIOCGIWGENIE");
2146 if (priv
->wpa_ie_len
== 0 || priv
->wpa_ie
== NULL
) {
2147 wrqu
->data
.length
= 0;
2151 if (wrqu
->data
.length
< priv
->wpa_ie_len
)
2154 wrqu
->data
.length
= priv
->wpa_ie_len
;
2155 memcpy(extra
, priv
->wpa_ie
, priv
->wpa_ie_len
);
2161 static int rndis_iw_set_freq(struct net_device
*dev
,
2162 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
2164 struct usbnet
*usbdev
= netdev_priv(dev
);
2165 struct ndis_80211_conf config
;
2166 unsigned int dsconfig
;
2169 /* this OID is valid only when not associated */
2170 if (is_associated(usbdev
))
2174 if (freq_to_dsconfig(&wrqu
->freq
, &dsconfig
))
2177 len
= sizeof(config
);
2178 ret
= rndis_query_oid(usbdev
, OID_802_11_CONFIGURATION
, &config
, &len
);
2180 devdbg(usbdev
, "SIOCSIWFREQ: querying configuration failed");
2184 config
.ds_config
= cpu_to_le32(dsconfig
);
2186 devdbg(usbdev
, "SIOCSIWFREQ: %d * 10^%d", wrqu
->freq
.m
, wrqu
->freq
.e
);
2187 return rndis_set_oid(usbdev
, OID_802_11_CONFIGURATION
, &config
,
2192 static int rndis_iw_get_freq(struct net_device
*dev
,
2193 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
2195 struct usbnet
*usbdev
= netdev_priv(dev
);
2196 struct ndis_80211_conf config
;
2199 len
= sizeof(config
);
2200 ret
= rndis_query_oid(usbdev
, OID_802_11_CONFIGURATION
, &config
, &len
);
2202 dsconfig_to_freq(le32_to_cpu(config
.ds_config
), &wrqu
->freq
);
2204 devdbg(usbdev
, "SIOCGIWFREQ: %d", wrqu
->freq
.m
);
2209 static int rndis_iw_get_rate(struct net_device
*dev
,
2210 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
2212 struct usbnet
*usbdev
= netdev_priv(dev
);
2217 ret
= rndis_query_oid(usbdev
, OID_GEN_LINK_SPEED
, &tmp
, &len
);
2219 wrqu
->bitrate
.value
= le32_to_cpu(tmp
) * 100;
2220 wrqu
->bitrate
.disabled
= 0;
2221 wrqu
->bitrate
.flags
= 1;
2227 static int rndis_iw_set_mlme(struct net_device
*dev
,
2228 struct iw_request_info
*info
, union iwreq_data
*wrqu
, char *extra
)
2230 struct usbnet
*usbdev
= netdev_priv(dev
);
2231 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2232 struct iw_mlme
*mlme
= (struct iw_mlme
*)extra
;
2233 unsigned char bssid
[ETH_ALEN
];
2235 get_bssid(usbdev
, bssid
);
2237 if (memcmp(bssid
, mlme
->addr
.sa_data
, ETH_ALEN
))
2240 switch (mlme
->cmd
) {
2241 case IW_MLME_DEAUTH
:
2242 return deauthenticate(usbdev
);
2243 case IW_MLME_DISASSOC
:
2244 return disassociate(usbdev
, priv
->radio_on
);
2253 static struct iw_statistics
*rndis_get_wireless_stats(struct net_device
*dev
)
2255 struct usbnet
*usbdev
= netdev_priv(dev
);
2256 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2257 unsigned long flags
;
2259 spin_lock_irqsave(&priv
->stats_lock
, flags
);
2260 memcpy(&priv
->iwstats
, &priv
->privstats
, sizeof(priv
->iwstats
));
2261 spin_unlock_irqrestore(&priv
->stats_lock
, flags
);
2263 return &priv
->iwstats
;
2267 #define IW_IOCTL(x) [(x) - SIOCSIWCOMMIT]
2268 static const iw_handler rndis_iw_handler
[] =
2270 IW_IOCTL(SIOCSIWCOMMIT
) = rndis_iw_commit
,
2271 IW_IOCTL(SIOCGIWNAME
) = (iw_handler
) cfg80211_wext_giwname
,
2272 IW_IOCTL(SIOCSIWFREQ
) = rndis_iw_set_freq
,
2273 IW_IOCTL(SIOCGIWFREQ
) = rndis_iw_get_freq
,
2274 IW_IOCTL(SIOCSIWMODE
) = (iw_handler
) cfg80211_wext_siwmode
,
2275 IW_IOCTL(SIOCGIWMODE
) = (iw_handler
) cfg80211_wext_giwmode
,
2276 IW_IOCTL(SIOCGIWRANGE
) = (iw_handler
) cfg80211_wext_giwrange
,
2277 IW_IOCTL(SIOCSIWAP
) = rndis_iw_set_bssid
,
2278 IW_IOCTL(SIOCGIWAP
) = rndis_iw_get_bssid
,
2279 IW_IOCTL(SIOCSIWSCAN
) = (iw_handler
) cfg80211_wext_siwscan
,
2280 IW_IOCTL(SIOCGIWSCAN
) = (iw_handler
) cfg80211_wext_giwscan
,
2281 IW_IOCTL(SIOCSIWESSID
) = rndis_iw_set_essid
,
2282 IW_IOCTL(SIOCGIWESSID
) = rndis_iw_get_essid
,
2283 IW_IOCTL(SIOCGIWRATE
) = rndis_iw_get_rate
,
2284 IW_IOCTL(SIOCSIWRTS
) = (iw_handler
) cfg80211_wext_siwrts
,
2285 IW_IOCTL(SIOCGIWRTS
) = (iw_handler
) cfg80211_wext_giwrts
,
2286 IW_IOCTL(SIOCSIWFRAG
) = (iw_handler
) cfg80211_wext_siwfrag
,
2287 IW_IOCTL(SIOCGIWFRAG
) = (iw_handler
) cfg80211_wext_giwfrag
,
2288 IW_IOCTL(SIOCSIWTXPOW
) = (iw_handler
) cfg80211_wext_siwtxpower
,
2289 IW_IOCTL(SIOCGIWTXPOW
) = (iw_handler
) cfg80211_wext_giwtxpower
,
2290 IW_IOCTL(SIOCSIWENCODE
) = rndis_iw_set_encode
,
2291 IW_IOCTL(SIOCSIWENCODEEXT
) = rndis_iw_set_encode_ext
,
2292 IW_IOCTL(SIOCSIWAUTH
) = rndis_iw_set_auth
,
2293 IW_IOCTL(SIOCGIWAUTH
) = rndis_iw_get_auth
,
2294 IW_IOCTL(SIOCSIWGENIE
) = rndis_iw_set_genie
,
2295 IW_IOCTL(SIOCGIWGENIE
) = rndis_iw_get_genie
,
2296 IW_IOCTL(SIOCSIWMLME
) = rndis_iw_set_mlme
,
2299 static const iw_handler rndis_wlan_private_handler
[] = {
2302 static const struct iw_priv_args rndis_wlan_private_args
[] = {
2306 static const struct iw_handler_def rndis_iw_handlers
= {
2307 .num_standard
= ARRAY_SIZE(rndis_iw_handler
),
2308 .num_private
= ARRAY_SIZE(rndis_wlan_private_handler
),
2309 .num_private_args
= ARRAY_SIZE(rndis_wlan_private_args
),
2310 .standard
= (iw_handler
*)rndis_iw_handler
,
2311 .private = (iw_handler
*)rndis_wlan_private_handler
,
2312 .private_args
= (struct iw_priv_args
*)rndis_wlan_private_args
,
2313 .get_wireless_stats
= rndis_get_wireless_stats
,
2317 static void rndis_wlan_do_link_up_work(struct usbnet
*usbdev
)
2319 struct ndis_80211_assoc_info
*info
;
2320 union iwreq_data evt
;
2321 u8 assoc_buf
[sizeof(*info
) + IW_CUSTOM_MAX
+ 32];
2325 memset(assoc_buf
, 0, sizeof(assoc_buf
));
2326 info
= (void *)assoc_buf
;
2328 netif_carrier_on(usbdev
->net
);
2330 /* Get association info IEs from device and send them back to
2332 ret
= get_association_info(usbdev
, info
, sizeof(assoc_buf
));
2334 evt
.data
.length
= le32_to_cpu(info
->req_ie_length
);
2335 if (evt
.data
.length
> 0) {
2336 offset
= le32_to_cpu(info
->offset_req_ies
);
2337 wireless_send_event(usbdev
->net
,
2338 IWEVASSOCREQIE
, &evt
,
2339 (char *)info
+ offset
);
2342 evt
.data
.length
= le32_to_cpu(info
->resp_ie_length
);
2343 if (evt
.data
.length
> 0) {
2344 offset
= le32_to_cpu(info
->offset_resp_ies
);
2345 wireless_send_event(usbdev
->net
,
2346 IWEVASSOCRESPIE
, &evt
,
2347 (char *)info
+ offset
);
2350 usbnet_resume_rx(usbdev
);
2353 ret
= get_bssid(usbdev
, bssid
);
2356 evt
.data
.length
= 0;
2357 memcpy(evt
.ap_addr
.sa_data
, bssid
, ETH_ALEN
);
2358 wireless_send_event(usbdev
->net
, SIOCGIWAP
, &evt
, NULL
);
2361 usbnet_resume_rx(usbdev
);
2364 static void rndis_wlan_do_link_down_work(struct usbnet
*usbdev
)
2366 union iwreq_data evt
;
2368 netif_carrier_off(usbdev
->net
);
2371 evt
.data
.length
= 0;
2372 memset(evt
.ap_addr
.sa_data
, 0, ETH_ALEN
);
2373 wireless_send_event(usbdev
->net
, SIOCGIWAP
, &evt
, NULL
);
2376 static void rndis_wlan_worker(struct work_struct
*work
)
2378 struct rndis_wlan_private
*priv
=
2379 container_of(work
, struct rndis_wlan_private
, work
);
2380 struct usbnet
*usbdev
= priv
->usbdev
;
2382 if (test_and_clear_bit(WORK_LINK_UP
, &priv
->work_pending
))
2383 rndis_wlan_do_link_up_work(usbdev
);
2385 if (test_and_clear_bit(WORK_LINK_DOWN
, &priv
->work_pending
))
2386 rndis_wlan_do_link_down_work(usbdev
);
2388 if (test_and_clear_bit(WORK_SET_MULTICAST_LIST
, &priv
->work_pending
))
2389 set_multicast_list(usbdev
);
2392 static void rndis_wlan_set_multicast_list(struct net_device
*dev
)
2394 struct usbnet
*usbdev
= netdev_priv(dev
);
2395 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2397 if (test_bit(WORK_SET_MULTICAST_LIST
, &priv
->work_pending
))
2400 set_bit(WORK_SET_MULTICAST_LIST
, &priv
->work_pending
);
2401 queue_work(priv
->workqueue
, &priv
->work
);
2405 static void rndis_wlan_auth_indication(struct usbnet
*usbdev
,
2406 struct ndis_80211_status_indication
*indication
,
2412 bool pairwise_error
, group_error
;
2413 struct ndis_80211_auth_request
*auth_req
;
2415 /* must have at least one array entry */
2416 if (len
< offsetof(struct ndis_80211_status_indication
, u
) +
2417 sizeof(struct ndis_80211_auth_request
)) {
2418 devinfo(usbdev
, "authentication indication: "
2419 "too short message (%i)", len
);
2423 buf
= (void *)&indication
->u
.auth_request
[0];
2424 buflen
= len
- offsetof(struct ndis_80211_status_indication
, u
);
2426 while (buflen
>= sizeof(*auth_req
)) {
2427 auth_req
= (void *)buf
;
2429 flags
= le32_to_cpu(auth_req
->flags
);
2430 pairwise_error
= false;
2431 group_error
= false;
2434 type
= "reauth request";
2436 type
= "key update request";
2438 pairwise_error
= true;
2439 type
= "pairwise_error";
2443 type
= "group_error";
2446 devinfo(usbdev
, "authentication indication: %s (0x%08x)", type
,
2447 le32_to_cpu(auth_req
->flags
));
2449 if (pairwise_error
|| group_error
) {
2450 union iwreq_data wrqu
;
2451 struct iw_michaelmicfailure micfailure
;
2453 memset(&micfailure
, 0, sizeof(micfailure
));
2455 micfailure
.flags
|= IW_MICFAILURE_PAIRWISE
;
2457 micfailure
.flags
|= IW_MICFAILURE_GROUP
;
2459 memcpy(micfailure
.src_addr
.sa_data
, auth_req
->bssid
,
2462 memset(&wrqu
, 0, sizeof(wrqu
));
2463 wrqu
.data
.length
= sizeof(micfailure
);
2464 wireless_send_event(usbdev
->net
, IWEVMICHAELMICFAILURE
,
2465 &wrqu
, (u8
*)&micfailure
);
2468 buflen
-= le32_to_cpu(auth_req
->length
);
2469 buf
+= le32_to_cpu(auth_req
->length
);
2473 static void rndis_wlan_pmkid_cand_list_indication(struct usbnet
*usbdev
,
2474 struct ndis_80211_status_indication
*indication
,
2477 struct ndis_80211_pmkid_cand_list
*cand_list
;
2478 int list_len
, expected_len
, i
;
2480 if (len
< offsetof(struct ndis_80211_status_indication
, u
) +
2481 sizeof(struct ndis_80211_pmkid_cand_list
)) {
2482 devinfo(usbdev
, "pmkid candidate list indication: "
2483 "too short message (%i)", len
);
2487 list_len
= le32_to_cpu(indication
->u
.cand_list
.num_candidates
) *
2488 sizeof(struct ndis_80211_pmkid_candidate
);
2489 expected_len
= sizeof(struct ndis_80211_pmkid_cand_list
) + list_len
+
2490 offsetof(struct ndis_80211_status_indication
, u
);
2492 if (len
< expected_len
) {
2493 devinfo(usbdev
, "pmkid candidate list indication: "
2494 "list larger than buffer (%i < %i)",
2499 cand_list
= &indication
->u
.cand_list
;
2501 devinfo(usbdev
, "pmkid candidate list indication: "
2502 "version %i, candidates %i",
2503 le32_to_cpu(cand_list
->version
),
2504 le32_to_cpu(cand_list
->num_candidates
));
2506 if (le32_to_cpu(cand_list
->version
) != 1)
2509 for (i
= 0; i
< le32_to_cpu(cand_list
->num_candidates
); i
++) {
2510 struct iw_pmkid_cand pcand
;
2511 union iwreq_data wrqu
;
2512 struct ndis_80211_pmkid_candidate
*cand
=
2513 &cand_list
->candidate_list
[i
];
2515 devdbg(usbdev
, "cand[%i]: flags: 0x%08x, bssid: %pM",
2516 i
, le32_to_cpu(cand
->flags
), cand
->bssid
);
2518 memset(&pcand
, 0, sizeof(pcand
));
2519 if (le32_to_cpu(cand
->flags
) & 0x01)
2520 pcand
.flags
|= IW_PMKID_CAND_PREAUTH
;
2522 memcpy(pcand
.bssid
.sa_data
, cand
->bssid
, ETH_ALEN
);
2524 memset(&wrqu
, 0, sizeof(wrqu
));
2525 wrqu
.data
.length
= sizeof(pcand
);
2526 wireless_send_event(usbdev
->net
, IWEVPMKIDCAND
, &wrqu
,
2531 static void rndis_wlan_media_specific_indication(struct usbnet
*usbdev
,
2532 struct rndis_indicate
*msg
, int buflen
)
2534 struct ndis_80211_status_indication
*indication
;
2537 offset
= offsetof(struct rndis_indicate
, status
) +
2538 le32_to_cpu(msg
->offset
);
2539 len
= le32_to_cpu(msg
->length
);
2542 devinfo(usbdev
, "media specific indication, "
2543 "ignore too short message (%i < 8)", len
);
2547 if (offset
+ len
> buflen
) {
2548 devinfo(usbdev
, "media specific indication, "
2549 "too large to fit to buffer (%i > %i)",
2550 offset
+ len
, buflen
);
2554 indication
= (void *)((u8
*)msg
+ offset
);
2556 switch (le32_to_cpu(indication
->status_type
)) {
2557 case NDIS_80211_STATUSTYPE_RADIOSTATE
:
2558 devinfo(usbdev
, "radio state indication: %i",
2559 le32_to_cpu(indication
->u
.radio_status
));
2562 case NDIS_80211_STATUSTYPE_MEDIASTREAMMODE
:
2563 devinfo(usbdev
, "media stream mode indication: %i",
2564 le32_to_cpu(indication
->u
.media_stream_mode
));
2567 case NDIS_80211_STATUSTYPE_AUTHENTICATION
:
2568 rndis_wlan_auth_indication(usbdev
, indication
, len
);
2571 case NDIS_80211_STATUSTYPE_PMKID_CANDIDATELIST
:
2572 rndis_wlan_pmkid_cand_list_indication(usbdev
, indication
, len
);
2576 devinfo(usbdev
, "media specific indication: "
2577 "unknown status type 0x%08x",
2578 le32_to_cpu(indication
->status_type
));
2583 static void rndis_wlan_indication(struct usbnet
*usbdev
, void *ind
, int buflen
)
2585 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2586 struct rndis_indicate
*msg
= ind
;
2588 switch (msg
->status
) {
2589 case RNDIS_STATUS_MEDIA_CONNECT
:
2590 if (priv
->current_command_oid
== OID_802_11_ADD_KEY
) {
2591 /* OID_802_11_ADD_KEY causes sometimes extra
2592 * "media connect" indications which confuses driver
2593 * and userspace to think that device is
2594 * roaming/reassociating when it isn't.
2596 devdbg(usbdev
, "ignored OID_802_11_ADD_KEY triggered "
2601 usbnet_pause_rx(usbdev
);
2603 devinfo(usbdev
, "media connect");
2605 /* queue work to avoid recursive calls into rndis_command */
2606 set_bit(WORK_LINK_UP
, &priv
->work_pending
);
2607 queue_work(priv
->workqueue
, &priv
->work
);
2610 case RNDIS_STATUS_MEDIA_DISCONNECT
:
2611 devinfo(usbdev
, "media disconnect");
2613 /* queue work to avoid recursive calls into rndis_command */
2614 set_bit(WORK_LINK_DOWN
, &priv
->work_pending
);
2615 queue_work(priv
->workqueue
, &priv
->work
);
2618 case RNDIS_STATUS_MEDIA_SPECIFIC_INDICATION
:
2619 rndis_wlan_media_specific_indication(usbdev
, msg
, buflen
);
2623 devinfo(usbdev
, "indication: 0x%08x",
2624 le32_to_cpu(msg
->status
));
2630 static int rndis_wlan_get_caps(struct usbnet
*usbdev
)
2635 } networks_supported
;
2636 int len
, retval
, i
, n
;
2637 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2639 /* determine supported modes */
2640 len
= sizeof(networks_supported
);
2641 retval
= rndis_query_oid(usbdev
, OID_802_11_NETWORK_TYPES_SUPPORTED
,
2642 &networks_supported
, &len
);
2644 n
= le32_to_cpu(networks_supported
.num_items
);
2647 for (i
= 0; i
< n
; i
++) {
2648 switch (le32_to_cpu(networks_supported
.items
[i
])) {
2649 case NDIS_80211_TYPE_FREQ_HOP
:
2650 case NDIS_80211_TYPE_DIRECT_SEQ
:
2651 priv
->caps
|= CAP_MODE_80211B
;
2653 case NDIS_80211_TYPE_OFDM_A
:
2654 priv
->caps
|= CAP_MODE_80211A
;
2656 case NDIS_80211_TYPE_OFDM_G
:
2657 priv
->caps
|= CAP_MODE_80211G
;
2667 #define STATS_UPDATE_JIFFIES (HZ)
2668 static void rndis_update_wireless_stats(struct work_struct
*work
)
2670 struct rndis_wlan_private
*priv
=
2671 container_of(work
, struct rndis_wlan_private
, stats_work
.work
);
2672 struct usbnet
*usbdev
= priv
->usbdev
;
2673 struct iw_statistics iwstats
;
2676 unsigned long flags
;
2677 int update_jiffies
= STATS_UPDATE_JIFFIES
;
2680 spin_lock_irqsave(&priv
->stats_lock
, flags
);
2681 memcpy(&iwstats
, &priv
->privstats
, sizeof(iwstats
));
2682 spin_unlock_irqrestore(&priv
->stats_lock
, flags
);
2684 /* only update stats when connected */
2685 if (!is_associated(usbdev
)) {
2686 iwstats
.qual
.qual
= 0;
2687 iwstats
.qual
.level
= 0;
2688 iwstats
.qual
.updated
= IW_QUAL_QUAL_UPDATED
2689 | IW_QUAL_LEVEL_UPDATED
2690 | IW_QUAL_NOISE_INVALID
2691 | IW_QUAL_QUAL_INVALID
2692 | IW_QUAL_LEVEL_INVALID
;
2697 ret
= rndis_query_oid(usbdev
, OID_802_11_RSSI
, &rssi
, &len
);
2699 devdbg(usbdev
, "stats: OID_802_11_RSSI -> %d, rssi:%d", ret
,
2702 memset(&iwstats
.qual
, 0, sizeof(iwstats
.qual
));
2703 iwstats
.qual
.qual
= level_to_qual(le32_to_cpu(rssi
));
2704 iwstats
.qual
.level
= level_to_qual(le32_to_cpu(rssi
));
2705 iwstats
.qual
.updated
= IW_QUAL_QUAL_UPDATED
2706 | IW_QUAL_LEVEL_UPDATED
2707 | IW_QUAL_NOISE_INVALID
;
2710 memset(&iwstats
.discard
, 0, sizeof(iwstats
.discard
));
2713 ret
= rndis_query_oid(usbdev
, OID_GEN_XMIT_ERROR
, &tmp
, &len
);
2715 iwstats
.discard
.misc
+= le32_to_cpu(tmp
);
2718 ret
= rndis_query_oid(usbdev
, OID_GEN_RCV_ERROR
, &tmp
, &len
);
2720 iwstats
.discard
.misc
+= le32_to_cpu(tmp
);
2723 ret
= rndis_query_oid(usbdev
, OID_GEN_RCV_NO_BUFFER
, &tmp
, &len
);
2725 iwstats
.discard
.misc
+= le32_to_cpu(tmp
);
2727 /* Workaround transfer stalls on poor quality links.
2728 * TODO: find right way to fix these stalls (as stalls do not happen
2729 * with ndiswrapper/windows driver). */
2730 if (iwstats
.qual
.qual
<= 25) {
2731 /* Decrease stats worker interval to catch stalls.
2732 * faster. Faster than 400-500ms causes packet loss,
2733 * Slower doesn't catch stalls fast enough.
2735 j
= msecs_to_jiffies(priv
->param_workaround_interval
);
2736 if (j
> STATS_UPDATE_JIFFIES
)
2737 j
= STATS_UPDATE_JIFFIES
;
2742 /* Send scan OID. Use of both OIDs is required to get device
2745 tmp
= cpu_to_le32(1);
2746 rndis_set_oid(usbdev
, OID_802_11_BSSID_LIST_SCAN
, &tmp
,
2749 len
= CONTROL_BUFFER_SIZE
;
2750 buf
= kmalloc(len
, GFP_KERNEL
);
2754 rndis_query_oid(usbdev
, OID_802_11_BSSID_LIST
, buf
, &len
);
2758 spin_lock_irqsave(&priv
->stats_lock
, flags
);
2759 memcpy(&priv
->privstats
, &iwstats
, sizeof(iwstats
));
2760 spin_unlock_irqrestore(&priv
->stats_lock
, flags
);
2762 if (update_jiffies
>= HZ
)
2763 update_jiffies
= round_jiffies_relative(update_jiffies
);
2765 j
= round_jiffies_relative(update_jiffies
);
2766 if (abs(j
- update_jiffies
) <= 10)
2770 queue_delayed_work(priv
->workqueue
, &priv
->stats_work
, update_jiffies
);
2774 static int bcm4320a_early_init(struct usbnet
*usbdev
)
2776 /* bcm4320a doesn't handle configuration parameters well. Try
2777 * set any and you get partially zeroed mac and broken device.
2784 static int bcm4320b_early_init(struct usbnet
*usbdev
)
2786 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2789 /* Early initialization settings, setting these won't have effect
2790 * if called after generic_rndis_bind().
2793 priv
->param_country
[0] = modparam_country
[0];
2794 priv
->param_country
[1] = modparam_country
[1];
2795 priv
->param_country
[2] = 0;
2796 priv
->param_frameburst
= modparam_frameburst
;
2797 priv
->param_afterburner
= modparam_afterburner
;
2798 priv
->param_power_save
= modparam_power_save
;
2799 priv
->param_power_output
= modparam_power_output
;
2800 priv
->param_roamtrigger
= modparam_roamtrigger
;
2801 priv
->param_roamdelta
= modparam_roamdelta
;
2803 priv
->param_country
[0] = toupper(priv
->param_country
[0]);
2804 priv
->param_country
[1] = toupper(priv
->param_country
[1]);
2805 /* doesn't support EU as country code, use FI instead */
2806 if (!strcmp(priv
->param_country
, "EU"))
2807 strcpy(priv
->param_country
, "FI");
2809 if (priv
->param_power_save
< 0)
2810 priv
->param_power_save
= 0;
2811 else if (priv
->param_power_save
> 2)
2812 priv
->param_power_save
= 2;
2814 if (priv
->param_power_output
< 0)
2815 priv
->param_power_output
= 0;
2816 else if (priv
->param_power_output
> 3)
2817 priv
->param_power_output
= 3;
2819 if (priv
->param_roamtrigger
< -80)
2820 priv
->param_roamtrigger
= -80;
2821 else if (priv
->param_roamtrigger
> -60)
2822 priv
->param_roamtrigger
= -60;
2824 if (priv
->param_roamdelta
< 0)
2825 priv
->param_roamdelta
= 0;
2826 else if (priv
->param_roamdelta
> 2)
2827 priv
->param_roamdelta
= 2;
2829 if (modparam_workaround_interval
< 0)
2830 priv
->param_workaround_interval
= 500;
2832 priv
->param_workaround_interval
= modparam_workaround_interval
;
2834 rndis_set_config_parameter_str(usbdev
, "Country", priv
->param_country
);
2835 rndis_set_config_parameter_str(usbdev
, "FrameBursting",
2836 priv
->param_frameburst
? "1" : "0");
2837 rndis_set_config_parameter_str(usbdev
, "Afterburner",
2838 priv
->param_afterburner
? "1" : "0");
2839 sprintf(buf
, "%d", priv
->param_power_save
);
2840 rndis_set_config_parameter_str(usbdev
, "PowerSaveMode", buf
);
2841 sprintf(buf
, "%d", priv
->param_power_output
);
2842 rndis_set_config_parameter_str(usbdev
, "PwrOut", buf
);
2843 sprintf(buf
, "%d", priv
->param_roamtrigger
);
2844 rndis_set_config_parameter_str(usbdev
, "RoamTrigger", buf
);
2845 sprintf(buf
, "%d", priv
->param_roamdelta
);
2846 rndis_set_config_parameter_str(usbdev
, "RoamDelta", buf
);
2851 /* same as rndis_netdev_ops but with local multicast handler */
2852 static const struct net_device_ops rndis_wlan_netdev_ops
= {
2853 .ndo_open
= usbnet_open
,
2854 .ndo_stop
= usbnet_stop
,
2855 .ndo_start_xmit
= usbnet_start_xmit
,
2856 .ndo_tx_timeout
= usbnet_tx_timeout
,
2857 .ndo_set_mac_address
= eth_mac_addr
,
2858 .ndo_validate_addr
= eth_validate_addr
,
2859 .ndo_set_multicast_list
= rndis_wlan_set_multicast_list
,
2863 static int rndis_wlan_bind(struct usbnet
*usbdev
, struct usb_interface
*intf
)
2865 struct wiphy
*wiphy
;
2866 struct rndis_wlan_private
*priv
;
2870 /* allocate wiphy and rndis private data
2871 * NOTE: We only support a single virtual interface, so wiphy
2872 * and wireless_dev are somewhat synonymous for this device.
2874 wiphy
= wiphy_new(&rndis_config_ops
, sizeof(struct rndis_wlan_private
));
2878 priv
= wiphy_priv(wiphy
);
2879 usbdev
->net
->ieee80211_ptr
= &priv
->wdev
;
2880 priv
->wdev
.wiphy
= wiphy
;
2881 priv
->wdev
.iftype
= NL80211_IFTYPE_STATION
;
2883 /* These have to be initialized before calling generic_rndis_bind().
2884 * Otherwise we'll be in big trouble in rndis_wlan_early_init().
2886 usbdev
->driver_priv
= priv
;
2887 usbdev
->net
->wireless_handlers
= &rndis_iw_handlers
;
2888 priv
->usbdev
= usbdev
;
2890 mutex_init(&priv
->command_lock
);
2891 spin_lock_init(&priv
->stats_lock
);
2893 /* because rndis_command() sleeps we need to use workqueue */
2894 priv
->workqueue
= create_singlethread_workqueue("rndis_wlan");
2895 INIT_WORK(&priv
->work
, rndis_wlan_worker
);
2896 INIT_DELAYED_WORK(&priv
->stats_work
, rndis_update_wireless_stats
);
2897 INIT_DELAYED_WORK(&priv
->scan_work
, rndis_get_scan_results
);
2899 /* try bind rndis_host */
2900 retval
= generic_rndis_bind(usbdev
, intf
, FLAG_RNDIS_PHYM_WIRELESS
);
2904 /* generic_rndis_bind set packet filter to multicast_all+
2905 * promisc mode which doesn't work well for our devices (device
2906 * picks up rssi to closest station instead of to access point).
2908 * rndis_host wants to avoid all OID as much as possible
2909 * so do promisc/multicast handling in rndis_wlan.
2911 usbdev
->net
->netdev_ops
= &rndis_wlan_netdev_ops
;
2913 tmp
= RNDIS_PACKET_TYPE_DIRECTED
| RNDIS_PACKET_TYPE_BROADCAST
;
2914 retval
= rndis_set_oid(usbdev
, OID_GEN_CURRENT_PACKET_FILTER
, &tmp
,
2918 retval
= rndis_query_oid(usbdev
, OID_802_3_MAXIMUM_LIST_SIZE
, &tmp
,
2920 priv
->multicast_size
= le32_to_cpu(tmp
);
2921 if (retval
< 0 || priv
->multicast_size
< 0)
2922 priv
->multicast_size
= 0;
2923 if (priv
->multicast_size
> 0)
2924 usbdev
->net
->flags
|= IFF_MULTICAST
;
2926 usbdev
->net
->flags
&= ~IFF_MULTICAST
;
2928 priv
->iwstats
.qual
.qual
= 0;
2929 priv
->iwstats
.qual
.level
= 0;
2930 priv
->iwstats
.qual
.updated
= IW_QUAL_QUAL_UPDATED
2931 | IW_QUAL_LEVEL_UPDATED
2932 | IW_QUAL_NOISE_INVALID
2933 | IW_QUAL_QUAL_INVALID
2934 | IW_QUAL_LEVEL_INVALID
;
2936 /* fill-out wiphy structure and register w/ cfg80211 */
2937 memcpy(wiphy
->perm_addr
, usbdev
->net
->dev_addr
, ETH_ALEN
);
2938 wiphy
->privid
= rndis_wiphy_privid
;
2939 wiphy
->interface_modes
= BIT(NL80211_IFTYPE_STATION
)
2940 | BIT(NL80211_IFTYPE_ADHOC
);
2941 wiphy
->max_scan_ssids
= 1;
2943 /* TODO: fill-out band/encr information based on priv->caps */
2944 rndis_wlan_get_caps(usbdev
);
2946 memcpy(priv
->channels
, rndis_channels
, sizeof(rndis_channels
));
2947 memcpy(priv
->rates
, rndis_rates
, sizeof(rndis_rates
));
2948 priv
->band
.channels
= priv
->channels
;
2949 priv
->band
.n_channels
= ARRAY_SIZE(rndis_channels
);
2950 priv
->band
.bitrates
= priv
->rates
;
2951 priv
->band
.n_bitrates
= ARRAY_SIZE(rndis_rates
);
2952 wiphy
->bands
[IEEE80211_BAND_2GHZ
] = &priv
->band
;
2953 wiphy
->signal_type
= CFG80211_SIGNAL_TYPE_UNSPEC
;
2955 memcpy(priv
->cipher_suites
, rndis_cipher_suites
,
2956 sizeof(rndis_cipher_suites
));
2957 wiphy
->cipher_suites
= priv
->cipher_suites
;
2958 wiphy
->n_cipher_suites
= ARRAY_SIZE(rndis_cipher_suites
);
2960 set_wiphy_dev(wiphy
, &usbdev
->udev
->dev
);
2962 if (wiphy_register(wiphy
)) {
2967 set_default_iw_params(usbdev
);
2969 /* set default rts/frag */
2970 rndis_set_wiphy_params(wiphy
,
2971 WIPHY_PARAM_FRAG_THRESHOLD
| WIPHY_PARAM_RTS_THRESHOLD
);
2975 disassociate(usbdev
, 1);
2976 netif_carrier_off(usbdev
->net
);
2981 cancel_delayed_work_sync(&priv
->stats_work
);
2982 cancel_delayed_work_sync(&priv
->scan_work
);
2983 cancel_work_sync(&priv
->work
);
2984 flush_workqueue(priv
->workqueue
);
2985 destroy_workqueue(priv
->workqueue
);
2992 static void rndis_wlan_unbind(struct usbnet
*usbdev
, struct usb_interface
*intf
)
2994 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
2996 /* turn radio off */
2997 disassociate(usbdev
, 0);
2999 cancel_delayed_work_sync(&priv
->stats_work
);
3000 cancel_delayed_work_sync(&priv
->scan_work
);
3001 cancel_work_sync(&priv
->work
);
3002 flush_workqueue(priv
->workqueue
);
3003 destroy_workqueue(priv
->workqueue
);
3005 if (priv
&& priv
->wpa_ie_len
)
3006 kfree(priv
->wpa_ie
);
3008 rndis_unbind(usbdev
, intf
);
3010 wiphy_unregister(priv
->wdev
.wiphy
);
3011 wiphy_free(priv
->wdev
.wiphy
);
3015 static int rndis_wlan_reset(struct usbnet
*usbdev
)
3017 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
3020 devdbg(usbdev
, "rndis_wlan_reset");
3022 retval
= rndis_reset(usbdev
);
3024 devwarn(usbdev
, "rndis_reset() failed: %d", retval
);
3026 /* rndis_reset cleared multicast list, so restore here.
3027 (set_multicast_list() also turns on current packet filter) */
3028 set_multicast_list(usbdev
);
3030 queue_delayed_work(priv
->workqueue
, &priv
->stats_work
,
3031 round_jiffies_relative(STATS_UPDATE_JIFFIES
));
3033 return deauthenticate(usbdev
);
3037 static int rndis_wlan_stop(struct usbnet
*usbdev
)
3039 struct rndis_wlan_private
*priv
= get_rndis_wlan_priv(usbdev
);
3043 devdbg(usbdev
, "rndis_wlan_stop");
3045 retval
= disassociate(usbdev
, 0);
3047 priv
->work_pending
= 0;
3048 cancel_delayed_work_sync(&priv
->stats_work
);
3049 cancel_delayed_work_sync(&priv
->scan_work
);
3050 cancel_work_sync(&priv
->work
);
3051 flush_workqueue(priv
->workqueue
);
3053 if (priv
->scan_request
) {
3054 cfg80211_scan_done(priv
->scan_request
, true);
3055 priv
->scan_request
= NULL
;
3058 /* Set current packet filter zero to block receiving data packets from
3061 rndis_set_oid(usbdev
, OID_GEN_CURRENT_PACKET_FILTER
, &filter
,
3068 static const struct driver_info bcm4320b_info
= {
3069 .description
= "Wireless RNDIS device, BCM4320b based",
3070 .flags
= FLAG_WLAN
| FLAG_FRAMING_RN
| FLAG_NO_SETINT
|
3071 FLAG_AVOID_UNLINK_URBS
,
3072 .bind
= rndis_wlan_bind
,
3073 .unbind
= rndis_wlan_unbind
,
3074 .status
= rndis_status
,
3075 .rx_fixup
= rndis_rx_fixup
,
3076 .tx_fixup
= rndis_tx_fixup
,
3077 .reset
= rndis_wlan_reset
,
3078 .stop
= rndis_wlan_stop
,
3079 .early_init
= bcm4320b_early_init
,
3080 .indication
= rndis_wlan_indication
,
3083 static const struct driver_info bcm4320a_info
= {
3084 .description
= "Wireless RNDIS device, BCM4320a based",
3085 .flags
= FLAG_WLAN
| FLAG_FRAMING_RN
| FLAG_NO_SETINT
|
3086 FLAG_AVOID_UNLINK_URBS
,
3087 .bind
= rndis_wlan_bind
,
3088 .unbind
= rndis_wlan_unbind
,
3089 .status
= rndis_status
,
3090 .rx_fixup
= rndis_rx_fixup
,
3091 .tx_fixup
= rndis_tx_fixup
,
3092 .reset
= rndis_wlan_reset
,
3093 .stop
= rndis_wlan_stop
,
3094 .early_init
= bcm4320a_early_init
,
3095 .indication
= rndis_wlan_indication
,
3098 static const struct driver_info rndis_wlan_info
= {
3099 .description
= "Wireless RNDIS device",
3100 .flags
= FLAG_WLAN
| FLAG_FRAMING_RN
| FLAG_NO_SETINT
|
3101 FLAG_AVOID_UNLINK_URBS
,
3102 .bind
= rndis_wlan_bind
,
3103 .unbind
= rndis_wlan_unbind
,
3104 .status
= rndis_status
,
3105 .rx_fixup
= rndis_rx_fixup
,
3106 .tx_fixup
= rndis_tx_fixup
,
3107 .reset
= rndis_wlan_reset
,
3108 .stop
= rndis_wlan_stop
,
3109 .early_init
= bcm4320a_early_init
,
3110 .indication
= rndis_wlan_indication
,
3113 /*-------------------------------------------------------------------------*/
3115 static const struct usb_device_id products
[] = {
3116 #define RNDIS_MASTER_INTERFACE \
3117 .bInterfaceClass = USB_CLASS_COMM, \
3118 .bInterfaceSubClass = 2 /* ACM */, \
3119 .bInterfaceProtocol = 0x0ff
3121 /* INF driver for these devices have DriverVer >= 4.xx.xx.xx and many custom
3122 * parameters available. Chipset marked as 'BCM4320SKFBG' in NDISwrapper-wiki.
3125 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3126 | USB_DEVICE_ID_MATCH_DEVICE
,
3128 .idProduct
= 0x00bc, /* Buffalo WLI-U2-KG125S */
3129 RNDIS_MASTER_INTERFACE
,
3130 .driver_info
= (unsigned long) &bcm4320b_info
,
3132 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3133 | USB_DEVICE_ID_MATCH_DEVICE
,
3135 .idProduct
= 0x011b, /* U.S. Robotics USR5421 */
3136 RNDIS_MASTER_INTERFACE
,
3137 .driver_info
= (unsigned long) &bcm4320b_info
,
3139 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3140 | USB_DEVICE_ID_MATCH_DEVICE
,
3142 .idProduct
= 0x011b, /* Belkin F5D7051 */
3143 RNDIS_MASTER_INTERFACE
,
3144 .driver_info
= (unsigned long) &bcm4320b_info
,
3146 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3147 | USB_DEVICE_ID_MATCH_DEVICE
,
3148 .idVendor
= 0x1799, /* Belkin has two vendor ids */
3149 .idProduct
= 0x011b, /* Belkin F5D7051 */
3150 RNDIS_MASTER_INTERFACE
,
3151 .driver_info
= (unsigned long) &bcm4320b_info
,
3153 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3154 | USB_DEVICE_ID_MATCH_DEVICE
,
3156 .idProduct
= 0x0014, /* Linksys WUSB54GSv2 */
3157 RNDIS_MASTER_INTERFACE
,
3158 .driver_info
= (unsigned long) &bcm4320b_info
,
3160 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3161 | USB_DEVICE_ID_MATCH_DEVICE
,
3163 .idProduct
= 0x0026, /* Linksys WUSB54GSC */
3164 RNDIS_MASTER_INTERFACE
,
3165 .driver_info
= (unsigned long) &bcm4320b_info
,
3167 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3168 | USB_DEVICE_ID_MATCH_DEVICE
,
3170 .idProduct
= 0x1717, /* Asus WL169gE */
3171 RNDIS_MASTER_INTERFACE
,
3172 .driver_info
= (unsigned long) &bcm4320b_info
,
3174 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3175 | USB_DEVICE_ID_MATCH_DEVICE
,
3177 .idProduct
= 0xd11b, /* Eminent EM4045 */
3178 RNDIS_MASTER_INTERFACE
,
3179 .driver_info
= (unsigned long) &bcm4320b_info
,
3181 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3182 | USB_DEVICE_ID_MATCH_DEVICE
,
3184 .idProduct
= 0x0715, /* BT Voyager 1055 */
3185 RNDIS_MASTER_INTERFACE
,
3186 .driver_info
= (unsigned long) &bcm4320b_info
,
3188 /* These devices have DriverVer < 4.xx.xx.xx and do not have any custom
3189 * parameters available, hardware probably contain older firmware version with
3190 * no way of updating. Chipset marked as 'BCM4320????' in NDISwrapper-wiki.
3193 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3194 | USB_DEVICE_ID_MATCH_DEVICE
,
3196 .idProduct
= 0x000e, /* Linksys WUSB54GSv1 */
3197 RNDIS_MASTER_INTERFACE
,
3198 .driver_info
= (unsigned long) &bcm4320a_info
,
3200 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3201 | USB_DEVICE_ID_MATCH_DEVICE
,
3203 .idProduct
= 0x0111, /* U.S. Robotics USR5420 */
3204 RNDIS_MASTER_INTERFACE
,
3205 .driver_info
= (unsigned long) &bcm4320a_info
,
3207 .match_flags
= USB_DEVICE_ID_MATCH_INT_INFO
3208 | USB_DEVICE_ID_MATCH_DEVICE
,
3210 .idProduct
= 0x004b, /* BUFFALO WLI-USB-G54 */
3211 RNDIS_MASTER_INTERFACE
,
3212 .driver_info
= (unsigned long) &bcm4320a_info
,
3214 /* Generic Wireless RNDIS devices that we don't have exact
3215 * idVendor/idProduct/chip yet.
3218 /* RNDIS is MSFT's un-official variant of CDC ACM */
3219 USB_INTERFACE_INFO(USB_CLASS_COMM
, 2 /* ACM */, 0x0ff),
3220 .driver_info
= (unsigned long) &rndis_wlan_info
,
3222 /* "ActiveSync" is an undocumented variant of RNDIS, used in WM5 */
3223 USB_INTERFACE_INFO(USB_CLASS_MISC
, 1, 1),
3224 .driver_info
= (unsigned long) &rndis_wlan_info
,
3228 MODULE_DEVICE_TABLE(usb
, products
);
3230 static struct usb_driver rndis_wlan_driver
= {
3231 .name
= "rndis_wlan",
3232 .id_table
= products
,
3233 .probe
= usbnet_probe
,
3234 .disconnect
= usbnet_disconnect
,
3235 .suspend
= usbnet_suspend
,
3236 .resume
= usbnet_resume
,
3239 static int __init
rndis_wlan_init(void)
3241 return usb_register(&rndis_wlan_driver
);
3243 module_init(rndis_wlan_init
);
3245 static void __exit
rndis_wlan_exit(void)
3247 usb_deregister(&rndis_wlan_driver
);
3249 module_exit(rndis_wlan_exit
);
3251 MODULE_AUTHOR("Bjorge Dijkstra");
3252 MODULE_AUTHOR("Jussi Kivilinna");
3253 MODULE_DESCRIPTION("Driver for RNDIS based USB Wireless adapters");
3254 MODULE_LICENSE("GPL");