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 * Modifications for inclusion into the Linux staging tree are
17 * Copyright(c) 2010 Larry Finger. All rights reserved.
19 * Contact information:
20 * WLAN FAE <wlanfae@realtek.com>.
21 * Larry Finger <Larry.Finger@lwfinger.net>
23 ******************************************************************************/
27 #include "drv_types.h"
28 #include "ieee80211.h"
30 #include "osdep_service.h"
31 #include "wlan_bssdef.h"
33 static const u8 WPA_OUI_TYPE[] = {0x00, 0x50, 0xf2, 1};
34 static const u8 WPA_CIPHER_SUITE_NONE[] = {0x00, 0x50, 0xf2, 0};
35 static const u8 WPA_CIPHER_SUITE_WEP40[] = {0x00, 0x50, 0xf2, 1};
36 static const u8 WPA_CIPHER_SUITE_TKIP[] = {0x00, 0x50, 0xf2, 2};
37 static const u8 WPA_CIPHER_SUITE_CCMP[] = {0x00, 0x50, 0xf2, 4};
38 static const u8 WPA_CIPHER_SUITE_WEP104[] = {0x00, 0x50, 0xf2, 5};
40 static const u8 RSN_CIPHER_SUITE_NONE[] = {0x00, 0x0f, 0xac, 0};
41 static const u8 RSN_CIPHER_SUITE_WEP40[] = {0x00, 0x0f, 0xac, 1};
42 static const u8 RSN_CIPHER_SUITE_TKIP[] = {0x00, 0x0f, 0xac, 2};
43 static const u8 RSN_CIPHER_SUITE_CCMP[] = {0x00, 0x0f, 0xac, 4};
44 static const u8 RSN_CIPHER_SUITE_WEP104[] = {0x00, 0x0f, 0xac, 5};
46 /*-----------------------------------------------------------
47 * for adhoc-master to generate ie and provide supported-rate to fw
48 *-----------------------------------------------------------
51 static u8 WIFI_CCKRATES[] = {
52 (IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK),
53 (IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK),
54 (IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK),
55 (IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK)
58 static u8 WIFI_OFDMRATES[] = {
59 (IEEE80211_OFDM_RATE_6MB),
60 (IEEE80211_OFDM_RATE_9MB),
61 (IEEE80211_OFDM_RATE_12MB),
62 (IEEE80211_OFDM_RATE_18MB),
63 (IEEE80211_OFDM_RATE_24MB),
64 (IEEE80211_OFDM_RATE_36MB),
65 (IEEE80211_OFDM_RATE_48MB),
66 (IEEE80211_OFDM_RATE_54MB)
69 uint r8712_is_cckrates_included(u8 *rate)
73 while (rate[i] != 0) {
74 if ((((rate[i]) & 0x7f) == 2) || (((rate[i]) & 0x7f) == 4) ||
75 (((rate[i]) & 0x7f) == 11) || (((rate[i]) & 0x7f) == 22))
82 uint r8712_is_cckratesonly_included(u8 *rate)
86 while (rate[i] != 0) {
87 if ((((rate[i]) & 0x7f) != 2) && (((rate[i]) & 0x7f) != 4) &&
88 (((rate[i]) & 0x7f) != 11) && (((rate[i]) & 0x7f) != 22))
95 /* r8712_set_ie will update frame length */
96 u8 *r8712_set_ie(u8 *pbuf, sint index, uint len, u8 *source, uint *frlen)
99 *(pbuf + 1) = (u8)len;
101 memcpy((void *)(pbuf + 2), (void *)source, len);
102 *frlen = *frlen + (len + 2);
103 return pbuf + len + 2;
106 /* ---------------------------------------------------------------------------
107 * index: the information element id index, limit is the limit for search
108 * ---------------------------------------------------------------------------
110 u8 *r8712_get_ie(u8 *pbuf, sint index, sint *len, sint limit)
134 static void set_supported_rate(u8 *rates, uint mode)
136 memset(rates, 0, NDIS_802_11_LENGTH_RATES_EX);
139 memcpy(rates, WIFI_CCKRATES, IEEE80211_CCK_RATE_LEN);
143 memcpy(rates, WIFI_OFDMRATES, IEEE80211_NUM_OFDM_RATESLEN);
146 memcpy(rates, WIFI_CCKRATES, IEEE80211_CCK_RATE_LEN);
147 memcpy(rates + IEEE80211_CCK_RATE_LEN, WIFI_OFDMRATES,
148 IEEE80211_NUM_OFDM_RATESLEN);
153 static uint r8712_get_rateset_len(u8 *rateset)
158 if ((rateset[i]) == 0)
167 int r8712_generate_ie(struct registry_priv *pregistrypriv)
169 int sz = 0, rate_len;
170 struct wlan_bssid_ex *pdev_network = &pregistrypriv->dev_network;
171 u8 *ie = pdev_network->IEs;
173 /*timestamp will be inserted by hardware*/
176 /*beacon interval : 2bytes*/
177 *(__le16 *)ie = cpu_to_le16((u16)pdev_network->Configuration.BeaconPeriod);
182 *(__le16 *)ie |= cpu_to_le16(cap_IBSS);
183 if (pregistrypriv->preamble == PREAMBLE_SHORT)
184 *(__le16 *)ie |= cpu_to_le16(cap_ShortPremble);
185 if (pdev_network->Privacy)
186 *(__le16 *)ie |= cpu_to_le16(cap_Privacy);
190 ie = r8712_set_ie(ie, _SSID_IE_, pdev_network->Ssid.SsidLength,
191 pdev_network->Ssid.Ssid, &sz);
193 set_supported_rate(pdev_network->rates, pregistrypriv->wireless_mode);
194 rate_len = r8712_get_rateset_len(pdev_network->rates);
196 ie = r8712_set_ie(ie, _SUPPORTEDRATES_IE_, 8,
197 pdev_network->rates, &sz);
198 ie = r8712_set_ie(ie, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8),
199 (pdev_network->rates + 8), &sz);
201 ie = r8712_set_ie(ie, _SUPPORTEDRATES_IE_,
202 rate_len, pdev_network->rates, &sz);
205 ie = r8712_set_ie(ie, _DSSET_IE_, 1,
206 (u8 *)&pdev_network->Configuration.DSConfig, &sz);
207 /*IBSS Parameter Set*/
208 ie = r8712_set_ie(ie, _IBSS_PARA_IE_, 2,
209 (u8 *)&pdev_network->Configuration.ATIMWindow, &sz);
213 unsigned char *r8712_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit)
217 unsigned char wpa_oui_type[] = {0x00, 0x50, 0xf2, 0x01};
221 pbuf = r8712_get_ie(pbuf, _WPA_IE_ID_, &len, limit);
223 /*check if oui matches...*/
224 if (memcmp((pbuf + 2), wpa_oui_type, sizeof(wpa_oui_type)))
227 memcpy((u8 *)&val16, (pbuf + 6), sizeof(val16));
228 le16_to_cpus(&val16);
231 *wpa_ie_len = *(pbuf + 1);
237 limit = limit - (pbuf - pie) - 2 - len;
246 unsigned char *r8712_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit)
248 return r8712_get_ie(pie, _WPA2_IE_ID_, rsn_ie_len, limit);
251 static int r8712_get_wpa_cipher_suite(u8 *s)
253 if (!memcmp(s, (void *)WPA_CIPHER_SUITE_NONE, WPA_SELECTOR_LEN))
254 return WPA_CIPHER_NONE;
255 if (!memcmp(s, (void *)WPA_CIPHER_SUITE_WEP40, WPA_SELECTOR_LEN))
256 return WPA_CIPHER_WEP40;
257 if (!memcmp(s, (void *)WPA_CIPHER_SUITE_TKIP, WPA_SELECTOR_LEN))
258 return WPA_CIPHER_TKIP;
259 if (!memcmp(s, (void *)WPA_CIPHER_SUITE_CCMP, WPA_SELECTOR_LEN))
260 return WPA_CIPHER_CCMP;
261 if (!memcmp(s, (void *)WPA_CIPHER_SUITE_WEP104, WPA_SELECTOR_LEN))
262 return WPA_CIPHER_WEP104;
266 static int r8712_get_wpa2_cipher_suite(u8 *s)
268 if (!memcmp(s, (void *)RSN_CIPHER_SUITE_NONE, RSN_SELECTOR_LEN))
269 return WPA_CIPHER_NONE;
270 if (!memcmp(s, (void *)RSN_CIPHER_SUITE_WEP40, RSN_SELECTOR_LEN))
271 return WPA_CIPHER_WEP40;
272 if (!memcmp(s, (void *)RSN_CIPHER_SUITE_TKIP, RSN_SELECTOR_LEN))
273 return WPA_CIPHER_TKIP;
274 if (!memcmp(s, (void *)RSN_CIPHER_SUITE_CCMP, RSN_SELECTOR_LEN))
275 return WPA_CIPHER_CCMP;
276 if (!memcmp(s, (void *)RSN_CIPHER_SUITE_WEP104, RSN_SELECTOR_LEN))
277 return WPA_CIPHER_WEP104;
281 int r8712_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher,
282 int *pairwise_cipher)
288 if (wpa_ie_len <= 0) {
289 /* No WPA IE - fail silently */
292 if ((*wpa_ie != _WPA_IE_ID_) ||
293 (*(wpa_ie + 1) != (u8)(wpa_ie_len - 2)) ||
294 (memcmp(wpa_ie + 2, (void *)WPA_OUI_TYPE, WPA_SELECTOR_LEN)))
298 left = wpa_ie_len - 8;
300 if (left >= WPA_SELECTOR_LEN) {
301 *group_cipher = r8712_get_wpa_cipher_suite(pos);
302 pos += WPA_SELECTOR_LEN;
303 left -= WPA_SELECTOR_LEN;
304 } else if (left > 0) {
309 count = le16_to_cpu(*(__le16 *)pos);
312 if (count == 0 || left < count * WPA_SELECTOR_LEN)
314 for (i = 0; i < count; i++) {
315 *pairwise_cipher |= r8712_get_wpa_cipher_suite(pos);
316 pos += WPA_SELECTOR_LEN;
317 left -= WPA_SELECTOR_LEN;
319 } else if (left == 1) {
325 int r8712_parse_wpa2_ie(u8 *rsn_ie, int rsn_ie_len, int *group_cipher,
326 int *pairwise_cipher)
332 if (rsn_ie_len <= 0) {
333 /* No RSN IE - fail silently */
336 if ((*rsn_ie != _WPA2_IE_ID_) ||
337 (*(rsn_ie + 1) != (u8)(rsn_ie_len - 2)))
341 left = rsn_ie_len - 4;
343 if (left >= RSN_SELECTOR_LEN) {
344 *group_cipher = r8712_get_wpa2_cipher_suite(pos);
345 pos += RSN_SELECTOR_LEN;
346 left -= RSN_SELECTOR_LEN;
347 } else if (left > 0) {
352 count = le16_to_cpu(*(__le16 *)pos);
355 if (count == 0 || left < count * RSN_SELECTOR_LEN)
357 for (i = 0; i < count; i++) {
358 *pairwise_cipher |= r8712_get_wpa2_cipher_suite(pos);
359 pos += RSN_SELECTOR_LEN;
360 left -= RSN_SELECTOR_LEN;
362 } 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*/
395 return *rsn_len + *wpa_len;
398 int r8712_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen)
402 u8 eid, wps_oui[4] = {0x0, 0x50, 0xf2, 0x04};
406 while (cnt < in_len) {
408 if ((eid == _WPA_IE_ID_) &&
409 (!memcmp(&in_ie[cnt + 2], wps_oui, 4))) {
410 memcpy(wps_ie, &in_ie[cnt], in_ie[cnt + 1] + 2);
411 *wps_ielen = in_ie[cnt + 1] + 2;
412 cnt += in_ie[cnt + 1] + 2;
416 cnt += in_ie[cnt + 1] + 2; /* goto next */