1 /******************************************************************************
4 * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved.
5 * Linux device driver for RTL8192SU
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of version 2 of the GNU General Public License as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * You should have received a copy of the GNU General Public License along with
17 * this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
20 * Modifications for inclusion into the Linux staging tree are
21 * Copyright(c) 2010 Larry Finger. All rights reserved.
23 * Contact information:
24 * WLAN FAE <wlanfae@realtek.com>.
25 * Larry Finger <Larry.Finger@lwfinger.net>
27 ******************************************************************************/
31 #include "drv_types.h"
32 #include "ieee80211.h"
34 #include "osdep_service.h"
35 #include "wlan_bssdef.h"
37 static const u8 WPA_OUI_TYPE
[] = {0x00, 0x50, 0xf2, 1};
38 static const u8 WPA_CIPHER_SUITE_NONE
[] = {0x00, 0x50, 0xf2, 0};
39 static const u8 WPA_CIPHER_SUITE_WEP40
[] = {0x00, 0x50, 0xf2, 1};
40 static const u8 WPA_CIPHER_SUITE_TKIP
[] = {0x00, 0x50, 0xf2, 2};
41 static const u8 WPA_CIPHER_SUITE_CCMP
[] = {0x00, 0x50, 0xf2, 4};
42 static const u8 WPA_CIPHER_SUITE_WEP104
[] = {0x00, 0x50, 0xf2, 5};
44 static const u8 RSN_CIPHER_SUITE_NONE
[] = {0x00, 0x0f, 0xac, 0};
45 static const u8 RSN_CIPHER_SUITE_WEP40
[] = {0x00, 0x0f, 0xac, 1};
46 static const u8 RSN_CIPHER_SUITE_TKIP
[] = {0x00, 0x0f, 0xac, 2};
47 static const u8 RSN_CIPHER_SUITE_CCMP
[] = {0x00, 0x0f, 0xac, 4};
48 static const u8 RSN_CIPHER_SUITE_WEP104
[] = {0x00, 0x0f, 0xac, 5};
50 /*-----------------------------------------------------------
51 * for adhoc-master to generate ie and provide supported-rate to fw
52 *-----------------------------------------------------------
55 static u8 WIFI_CCKRATES
[] = {
56 (IEEE80211_CCK_RATE_1MB
| IEEE80211_BASIC_RATE_MASK
),
57 (IEEE80211_CCK_RATE_2MB
| IEEE80211_BASIC_RATE_MASK
),
58 (IEEE80211_CCK_RATE_5MB
| IEEE80211_BASIC_RATE_MASK
),
59 (IEEE80211_CCK_RATE_11MB
| IEEE80211_BASIC_RATE_MASK
)
62 static u8 WIFI_OFDMRATES
[] = {
63 (IEEE80211_OFDM_RATE_6MB
),
64 (IEEE80211_OFDM_RATE_9MB
),
65 (IEEE80211_OFDM_RATE_12MB
),
66 (IEEE80211_OFDM_RATE_18MB
),
67 (IEEE80211_OFDM_RATE_24MB
),
68 (IEEE80211_OFDM_RATE_36MB
),
69 (IEEE80211_OFDM_RATE_48MB
),
70 (IEEE80211_OFDM_RATE_54MB
)
73 uint
r8712_is_cckrates_included(u8
*rate
)
77 while (rate
[i
] != 0) {
78 if ((((rate
[i
]) & 0x7f) == 2) || (((rate
[i
]) & 0x7f) == 4) ||
79 (((rate
[i
]) & 0x7f) == 11) || (((rate
[i
]) & 0x7f) == 22))
86 uint
r8712_is_cckratesonly_included(u8
*rate
)
90 while (rate
[i
] != 0) {
91 if ((((rate
[i
]) & 0x7f) != 2) && (((rate
[i
]) & 0x7f) != 4) &&
92 (((rate
[i
]) & 0x7f) != 11) && (((rate
[i
]) & 0x7f) != 22))
99 /* r8712_set_ie will update frame length */
100 u8
*r8712_set_ie(u8
*pbuf
, sint index
, uint len
, u8
*source
, uint
*frlen
)
103 *(pbuf
+ 1) = (u8
)len
;
105 memcpy((void *)(pbuf
+ 2), (void *)source
, len
);
106 *frlen
= *frlen
+ (len
+ 2);
107 return pbuf
+ len
+ 2;
110 /*----------------------------------------------------------------------------
111 index: the information element id index, limit is the limit for search
112 -----------------------------------------------------------------------------*/
113 u8
*r8712_get_ie(u8
*pbuf
, sint index
, sint
*len
, sint limit
)
137 static void set_supported_rate(u8
*SupportedRates
, uint mode
)
139 memset(SupportedRates
, 0, NDIS_802_11_LENGTH_RATES_EX
);
142 memcpy(SupportedRates
, WIFI_CCKRATES
,
143 IEEE80211_CCK_RATE_LEN
);
147 memcpy(SupportedRates
, WIFI_OFDMRATES
,
148 IEEE80211_NUM_OFDM_RATESLEN
);
151 memcpy(SupportedRates
, WIFI_CCKRATES
, IEEE80211_CCK_RATE_LEN
);
152 memcpy(SupportedRates
+ IEEE80211_CCK_RATE_LEN
, WIFI_OFDMRATES
,
153 IEEE80211_NUM_OFDM_RATESLEN
);
158 static uint
r8712_get_rateset_len(u8
*rateset
)
163 if ((rateset
[i
]) == 0)
172 int r8712_generate_ie(struct registry_priv
*pregistrypriv
)
175 struct wlan_bssid_ex
*pdev_network
= &pregistrypriv
->dev_network
;
176 u8
*ie
= pdev_network
->IEs
;
178 /*timestamp will be inserted by hardware*/
181 /*beacon interval : 2bytes*/
182 *(u16
*)ie
= cpu_to_le16((u16
)pdev_network
->Configuration
.BeaconPeriod
);
187 *(u16
*)ie
|= cpu_to_le16(cap_IBSS
);
188 if (pregistrypriv
->preamble
== PREAMBLE_SHORT
)
189 *(u16
*)ie
|= cpu_to_le16(cap_ShortPremble
);
190 if (pdev_network
->Privacy
)
191 *(u16
*)ie
|= cpu_to_le16(cap_Privacy
);
195 ie
= r8712_set_ie(ie
, _SSID_IE_
, pdev_network
->Ssid
.SsidLength
,
196 pdev_network
->Ssid
.Ssid
, &sz
);
198 set_supported_rate(pdev_network
->SupportedRates
,
199 pregistrypriv
->wireless_mode
);
200 rateLen
= r8712_get_rateset_len(pdev_network
->SupportedRates
);
202 ie
= r8712_set_ie(ie
, _SUPPORTEDRATES_IE_
, 8,
203 pdev_network
->SupportedRates
, &sz
);
204 ie
= r8712_set_ie(ie
, _EXT_SUPPORTEDRATES_IE_
, (rateLen
- 8),
205 (pdev_network
->SupportedRates
+ 8), &sz
);
207 ie
= r8712_set_ie(ie
, _SUPPORTEDRATES_IE_
,
208 rateLen
, pdev_network
->SupportedRates
, &sz
);
210 ie
= r8712_set_ie(ie
, _DSSET_IE_
, 1,
211 (u8
*)&(pdev_network
->Configuration
.DSConfig
), &sz
);
212 /*IBSS Parameter Set*/
213 ie
= r8712_set_ie(ie
, _IBSS_PARA_IE_
, 2,
214 (u8
*)&(pdev_network
->Configuration
.ATIMWindow
), &sz
);
218 unsigned char *r8712_get_wpa_ie(unsigned char *pie
, int *wpa_ie_len
, int limit
)
222 unsigned char wpa_oui_type
[] = {0x00, 0x50, 0xf2, 0x01};
226 pbuf
= r8712_get_ie(pbuf
, _WPA_IE_ID_
, &len
, limit
);
228 /*check if oui matches...*/
229 if (memcmp((pbuf
+ 2), wpa_oui_type
,
230 sizeof(wpa_oui_type
)))
233 memcpy((u8
*)&val16
, (pbuf
+ 6), sizeof(val16
));
234 val16
= le16_to_cpu(val16
);
237 *wpa_ie_len
= *(pbuf
+ 1);
243 limit
= limit
- (pbuf
- pie
) - 2 - len
;
252 unsigned char *r8712_get_wpa2_ie(unsigned char *pie
, int *rsn_ie_len
, int limit
)
254 return r8712_get_ie(pie
, _WPA2_IE_ID_
, rsn_ie_len
, limit
);
257 static int r8712_get_wpa_cipher_suite(u8
*s
)
259 if (!memcmp(s
, (void *)WPA_CIPHER_SUITE_NONE
, WPA_SELECTOR_LEN
))
260 return WPA_CIPHER_NONE
;
261 if (!memcmp(s
, (void *)WPA_CIPHER_SUITE_WEP40
, WPA_SELECTOR_LEN
))
262 return WPA_CIPHER_WEP40
;
263 if (!memcmp(s
, (void *)WPA_CIPHER_SUITE_TKIP
, WPA_SELECTOR_LEN
))
264 return WPA_CIPHER_TKIP
;
265 if (!memcmp(s
, (void *)WPA_CIPHER_SUITE_CCMP
, WPA_SELECTOR_LEN
))
266 return WPA_CIPHER_CCMP
;
267 if (!memcmp(s
, (void *)WPA_CIPHER_SUITE_WEP104
, WPA_SELECTOR_LEN
))
268 return WPA_CIPHER_WEP104
;
272 static int r8712_get_wpa2_cipher_suite(u8
*s
)
274 if (!memcmp(s
, (void *)RSN_CIPHER_SUITE_NONE
, RSN_SELECTOR_LEN
))
275 return WPA_CIPHER_NONE
;
276 if (!memcmp(s
, (void *)RSN_CIPHER_SUITE_WEP40
, RSN_SELECTOR_LEN
))
277 return WPA_CIPHER_WEP40
;
278 if (!memcmp(s
, (void *)RSN_CIPHER_SUITE_TKIP
, RSN_SELECTOR_LEN
))
279 return WPA_CIPHER_TKIP
;
280 if (!memcmp(s
, (void *)RSN_CIPHER_SUITE_CCMP
, RSN_SELECTOR_LEN
))
281 return WPA_CIPHER_CCMP
;
282 if (!memcmp(s
, (void *)RSN_CIPHER_SUITE_WEP104
, RSN_SELECTOR_LEN
))
283 return WPA_CIPHER_WEP104
;
287 int r8712_parse_wpa_ie(u8
*wpa_ie
, int wpa_ie_len
, int *group_cipher
,
288 int *pairwise_cipher
)
294 if (wpa_ie_len
<= 0) {
295 /* No WPA IE - fail silently */
298 if ((*wpa_ie
!= _WPA_IE_ID_
) || (*(wpa_ie
+ 1) != (u8
)(wpa_ie_len
- 2))
299 || (memcmp(wpa_ie
+ 2, (void *)WPA_OUI_TYPE
, WPA_SELECTOR_LEN
)))
303 left
= wpa_ie_len
- 8;
305 if (left
>= WPA_SELECTOR_LEN
) {
306 *group_cipher
= r8712_get_wpa_cipher_suite(pos
);
307 pos
+= WPA_SELECTOR_LEN
;
308 left
-= WPA_SELECTOR_LEN
;
313 count
= le16_to_cpu(*(u16
*)pos
);
316 if (count
== 0 || left
< count
* WPA_SELECTOR_LEN
)
318 for (i
= 0; i
< count
; i
++) {
319 *pairwise_cipher
|= r8712_get_wpa_cipher_suite(pos
);
320 pos
+= WPA_SELECTOR_LEN
;
321 left
-= WPA_SELECTOR_LEN
;
323 } else if (left
== 1)
328 int r8712_parse_wpa2_ie(u8
*rsn_ie
, int rsn_ie_len
, int *group_cipher
,
329 int *pairwise_cipher
)
335 if (rsn_ie_len
<= 0) {
336 /* No RSN IE - fail silently */
339 if ((*rsn_ie
!= _WPA2_IE_ID_
) || (*(rsn_ie
+1) != (u8
)(rsn_ie_len
- 2)))
343 left
= rsn_ie_len
- 4;
345 if (left
>= RSN_SELECTOR_LEN
) {
346 *group_cipher
= r8712_get_wpa2_cipher_suite(pos
);
347 pos
+= RSN_SELECTOR_LEN
;
348 left
-= RSN_SELECTOR_LEN
;
353 count
= le16_to_cpu(*(u16
*)pos
);
356 if (count
== 0 || left
< count
* RSN_SELECTOR_LEN
)
358 for (i
= 0; i
< count
; i
++) {
359 *pairwise_cipher
|= r8712_get_wpa2_cipher_suite(pos
);
360 pos
+= RSN_SELECTOR_LEN
;
361 left
-= RSN_SELECTOR_LEN
;
363 } else if (left
== 1)
368 int r8712_get_sec_ie(u8
*in_ie
, uint in_len
, u8
*rsn_ie
, u16
*rsn_len
,
369 u8
*wpa_ie
, u16
*wpa_len
)
372 u8 wpa_oui
[4] = {0x0, 0x50, 0xf2, 0x01};
375 /*Search required WPA or WPA2 IE and copy to sec_ie[ ]*/
376 cnt
= (_TIMESTAMP_
+ _BEACON_ITERVAL_
+ _CAPABILITY_
);
377 while (cnt
< in_len
) {
378 authmode
= in_ie
[cnt
];
379 if ((authmode
== _WPA_IE_ID_
) &&
380 (!memcmp(&in_ie
[cnt
+ 2], &wpa_oui
[0], 4))) {
381 memcpy(wpa_ie
, &in_ie
[cnt
], in_ie
[cnt
+ 1] + 2);
382 *wpa_len
= in_ie
[cnt
+1]+2;
383 cnt
+= in_ie
[cnt
+ 1] + 2; /*get next */
385 if (authmode
== _WPA2_IE_ID_
) {
386 memcpy(rsn_ie
, &in_ie
[cnt
],
388 *rsn_len
= in_ie
[cnt
+1] + 2;
389 cnt
+= in_ie
[cnt
+1] + 2; /*get next*/
391 cnt
+= in_ie
[cnt
+1] + 2; /*get next*/
394 return *rsn_len
+ *wpa_len
;
397 int r8712_get_wps_ie(u8
*in_ie
, uint in_len
, u8
*wps_ie
, uint
*wps_ielen
)
401 u8 eid
, wps_oui
[4] = {0x0, 0x50, 0xf2, 0x04};
405 while (cnt
< in_len
) {
407 if ((eid
== _WPA_IE_ID_
) &&
408 (!memcmp(&in_ie
[cnt
+2], wps_oui
, 4))) {
409 memcpy(wps_ie
, &in_ie
[cnt
], in_ie
[cnt
+1]+2);
410 *wps_ielen
= in_ie
[cnt
+1]+2;
411 cnt
+= in_ie
[cnt
+1]+2;
415 cnt
+= in_ie
[cnt
+1]+2; /* goto next */