1 /******************************************************************************
2 * rtl871x_ioctl_set.c
3 *
4 * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved.
5 * Linux device driver for RTL8192SU
6 *
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.
10 *
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
14 * more details.
15 *
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
19 *
20 * Modifications for inclusion into the Linux staging tree are
21 * Copyright(c) 2010 Larry Finger. All rights reserved.
22 *
23 * Contact information:
24 * WLAN FAE <wlanfae@realtek.com>
25 * Larry Finger <Larry.Finger@lwfinger.net>
26 *
27 ******************************************************************************/
28
29 #define _RTL871X_IOCTL_SET_C_
30
31 #include "osdep_service.h"
32 #include "drv_types.h"
33 #include "rtl871x_ioctl_set.h"
34 #include "usb_osintf.h"
35 #include "usb_ops.h"
36
37 #define IS_MAC_ADDRESS_BROADCAST(addr) \
38 ( \
39 ((addr[0] == 0xff) && (addr[1] == 0xff) && \
40 (addr[2] == 0xff) && (addr[3] == 0xff) && \
41 (addr[4] == 0xff) && (addr[5] == 0xff)) ? true : false \
42 )
43
validate_ssid(struct ndis_802_11_ssid * ssid)44 static u8 validate_ssid(struct ndis_802_11_ssid *ssid)
45 {
46 u8 i;
47
48 if (ssid->SsidLength > 32)
49 return false;
50 for (i = 0; i < ssid->SsidLength; i++) {
51 /* wifi, printable ascii code must be supported */
52 if (!((ssid->Ssid[i] >= 0x20) && (ssid->Ssid[i] <= 0x7e)))
53 return false;
54 }
55 return true;
56 }
57
do_join(struct _adapter * padapter)58 static u8 do_join(struct _adapter *padapter)
59 {
60 struct list_head *plist, *phead;
61 u8 *pibss = NULL;
62 struct mlme_priv *pmlmepriv = &(padapter->mlmepriv);
63 struct __queue *queue = &(pmlmepriv->scanned_queue);
64
65 phead = get_list_head(queue);
66 plist = get_next(phead);
67 pmlmepriv->cur_network.join_res = -2;
68 pmlmepriv->fw_state |= _FW_UNDER_LINKING;
69 pmlmepriv->pscanned = plist;
70 pmlmepriv->to_join = true;
71
72 /* adhoc mode will start with an empty queue, but skip checking */
73 if (!check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) &&
74 _queue_empty(queue)) {
75 if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
76 pmlmepriv->fw_state ^= _FW_UNDER_LINKING;
77 /* when set_ssid/set_bssid for do_join(), but scanning queue
78 * is empty we try to issue sitesurvey firstly
79 */
80 if (pmlmepriv->sitesurveyctrl.traffic_busy == false)
81 r8712_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid);
82 return true;
83 } else {
84 int ret;
85
86 ret = r8712_select_and_join_from_scan(pmlmepriv);
87 if (ret == _SUCCESS)
88 _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT);
89 else {
90 if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) {
91 /* submit r8712_createbss_cmd to change to an
92 * ADHOC_MASTER pmlmepriv->lock has been
93 * acquired by caller...
94 */
95 struct wlan_bssid_ex *pdev_network =
96 &(padapter->registrypriv.dev_network);
97 pmlmepriv->fw_state = WIFI_ADHOC_MASTER_STATE;
98 pibss = padapter->registrypriv.dev_network.
99 MacAddress;
100 memcpy(&pdev_network->Ssid,
101 &pmlmepriv->assoc_ssid,
102 sizeof(struct ndis_802_11_ssid));
103 r8712_update_registrypriv_dev_network(padapter);
104 r8712_generate_random_ibss(pibss);
105 if (r8712_createbss_cmd(padapter) != _SUCCESS)
106 return false;
107 pmlmepriv->to_join = false;
108 } else {
109 /* can't associate ; reset under-linking */
110 if (pmlmepriv->fw_state & _FW_UNDER_LINKING)
111 pmlmepriv->fw_state ^=
112 _FW_UNDER_LINKING;
113 /* when set_ssid/set_bssid for do_join(), but
114 * there are no desired bss in scanning queue
115 * we try to issue sitesurvey first
116 */
117 if (!pmlmepriv->sitesurveyctrl.traffic_busy)
118 r8712_sitesurvey_cmd(padapter,
119 &pmlmepriv->assoc_ssid);
120 }
121 }
122 }
123 return true;
124 }
125
r8712_set_802_11_bssid(struct _adapter * padapter,u8 * bssid)126 u8 r8712_set_802_11_bssid(struct _adapter *padapter, u8 *bssid)
127 {
128 unsigned long irqL;
129 u8 status = true;
130 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
131
132 if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid)) {
133 status = false;
134 return status;
135 }
136 spin_lock_irqsave(&pmlmepriv->lock, irqL);
137 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY |
138 _FW_UNDER_LINKING) == true) {
139 status = check_fwstate(pmlmepriv, _FW_UNDER_LINKING);
140 goto _Abort_Set_BSSID;
141 }
142 if (check_fwstate(pmlmepriv,
143 _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true) {
144 if (!memcmp(&pmlmepriv->cur_network.network.MacAddress, bssid,
145 ETH_ALEN)) {
146 if (check_fwstate(pmlmepriv,
147 WIFI_STATION_STATE) == false)
148 goto _Abort_Set_BSSID; /* driver is in
149 * WIFI_ADHOC_MASTER_STATE */
150 } else {
151 r8712_disassoc_cmd(padapter);
152 if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
153 r8712_ind_disconnect(padapter);
154 r8712_free_assoc_resources(padapter);
155 if ((check_fwstate(pmlmepriv,
156 WIFI_ADHOC_MASTER_STATE))) {
157 _clr_fwstate_(pmlmepriv,
158 WIFI_ADHOC_MASTER_STATE);
159 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
160 }
161 }
162 }
163 memcpy(&pmlmepriv->assoc_bssid, bssid, ETH_ALEN);
164 pmlmepriv->assoc_by_bssid = true;
165 status = do_join(padapter);
166 goto done;
167 _Abort_Set_BSSID:
168 done:
169 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
170 return status;
171 }
172
r8712_set_802_11_ssid(struct _adapter * padapter,struct ndis_802_11_ssid * ssid)173 void r8712_set_802_11_ssid(struct _adapter *padapter,
174 struct ndis_802_11_ssid *ssid)
175 {
176 unsigned long irqL;
177 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
178 struct wlan_network *pnetwork = &pmlmepriv->cur_network;
179
180 if (padapter->hw_init_completed == false)
181 return;
182 spin_lock_irqsave(&pmlmepriv->lock, irqL);
183 if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)) {
184 check_fwstate(pmlmepriv, _FW_UNDER_LINKING);
185 goto _Abort_Set_SSID;
186 }
187 if (check_fwstate(pmlmepriv, _FW_LINKED|WIFI_ADHOC_MASTER_STATE)) {
188 if ((pmlmepriv->assoc_ssid.SsidLength == ssid->SsidLength) &&
189 (!memcmp(&pmlmepriv->assoc_ssid.Ssid, ssid->Ssid,
190 ssid->SsidLength))) {
191 if ((check_fwstate(pmlmepriv,
192 WIFI_STATION_STATE) == false)) {
193 if (r8712_is_same_ibss(padapter,
194 pnetwork) == false) {
195 /* if in WIFI_ADHOC_MASTER_STATE or
196 * WIFI_ADHOC_STATE, create bss or
197 * rejoin again
198 */
199 r8712_disassoc_cmd(padapter);
200 if (check_fwstate(pmlmepriv,
201 _FW_LINKED) == true)
202 r8712_ind_disconnect(padapter);
203 r8712_free_assoc_resources(padapter);
204 if (check_fwstate(pmlmepriv,
205 WIFI_ADHOC_MASTER_STATE)) {
206 _clr_fwstate_(pmlmepriv,
207 WIFI_ADHOC_MASTER_STATE);
208 set_fwstate(pmlmepriv,
209 WIFI_ADHOC_STATE);
210 }
211 } else
212 goto _Abort_Set_SSID; /* driver is in
213 * WIFI_ADHOC_MASTER_STATE */
214 }
215 } else {
216 r8712_disassoc_cmd(padapter);
217 if (check_fwstate(pmlmepriv, _FW_LINKED) == true)
218 r8712_ind_disconnect(padapter);
219 r8712_free_assoc_resources(padapter);
220 if (check_fwstate(pmlmepriv,
221 WIFI_ADHOC_MASTER_STATE) == true) {
222 _clr_fwstate_(pmlmepriv,
223 WIFI_ADHOC_MASTER_STATE);
224 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
225 }
226 }
227 }
228 if (padapter->securitypriv.btkip_countermeasure == true)
229 goto _Abort_Set_SSID;
230 if (validate_ssid(ssid) == false)
231 goto _Abort_Set_SSID;
232 memcpy(&pmlmepriv->assoc_ssid, ssid, sizeof(struct ndis_802_11_ssid));
233 pmlmepriv->assoc_by_bssid = false;
234 do_join(padapter);
235 goto done;
236 _Abort_Set_SSID:
237 done:
238 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
239 }
240
r8712_set_802_11_infrastructure_mode(struct _adapter * padapter,enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)241 void r8712_set_802_11_infrastructure_mode(struct _adapter *padapter,
242 enum NDIS_802_11_NETWORK_INFRASTRUCTURE networktype)
243 {
244 unsigned long irqL;
245 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
246 struct wlan_network *cur_network = &pmlmepriv->cur_network;
247 enum NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state =
248 &(cur_network->network.InfrastructureMode);
249
250 if (*pold_state != networktype) {
251 spin_lock_irqsave(&pmlmepriv->lock, irqL);
252 if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) ||
253 (*pold_state == Ndis802_11IBSS))
254 r8712_disassoc_cmd(padapter);
255 if (check_fwstate(pmlmepriv,
256 _FW_LINKED|WIFI_ADHOC_MASTER_STATE) == true)
257 r8712_free_assoc_resources(padapter);
258 if ((check_fwstate(pmlmepriv, _FW_LINKED) == true) ||
259 (*pold_state == Ndis802_11Infrastructure) ||
260 (*pold_state == Ndis802_11IBSS)) {
261 /* will clr Linked_state before this function,
262 * we must have checked whether issue dis-assoc_cmd or
263 * not */
264 r8712_ind_disconnect(padapter);
265 }
266 *pold_state = networktype;
267 /* clear WIFI_STATION_STATE; WIFI_AP_STATE; WIFI_ADHOC_STATE;
268 * WIFI_ADHOC_MASTER_STATE */
269 _clr_fwstate_(pmlmepriv, WIFI_STATION_STATE | WIFI_AP_STATE |
270 WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE |
271 WIFI_AP_STATE);
272 switch (networktype) {
273 case Ndis802_11IBSS:
274 set_fwstate(pmlmepriv, WIFI_ADHOC_STATE);
275 break;
276 case Ndis802_11Infrastructure:
277 set_fwstate(pmlmepriv, WIFI_STATION_STATE);
278 break;
279 case Ndis802_11APMode:
280 set_fwstate(pmlmepriv, WIFI_AP_STATE);
281 break;
282 case Ndis802_11AutoUnknown:
283 case Ndis802_11InfrastructureMax:
284 break;
285 }
286 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
287 }
288 }
289
r8712_set_802_11_disassociate(struct _adapter * padapter)290 u8 r8712_set_802_11_disassociate(struct _adapter *padapter)
291 {
292 unsigned long irqL;
293 struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
294
295 spin_lock_irqsave(&pmlmepriv->lock, irqL);
296 if (check_fwstate(pmlmepriv, _FW_LINKED) == true) {
297 r8712_disassoc_cmd(padapter);
298 r8712_ind_disconnect(padapter);
299 r8712_free_assoc_resources(padapter);
300 }
301 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
302 return true;
303 }
304
r8712_set_802_11_bssid_list_scan(struct _adapter * padapter)305 u8 r8712_set_802_11_bssid_list_scan(struct _adapter *padapter)
306 {
307 struct mlme_priv *pmlmepriv = NULL;
308 unsigned long irqL;
309 u8 ret = true;
310
311 if (padapter == NULL)
312 return false;
313 pmlmepriv = &padapter->mlmepriv;
314 if (padapter->hw_init_completed == false)
315 return false;
316 spin_lock_irqsave(&pmlmepriv->lock, irqL);
317 if ((check_fwstate(pmlmepriv, _FW_UNDER_SURVEY|_FW_UNDER_LINKING)) ||
318 (pmlmepriv->sitesurveyctrl.traffic_busy == true)) {
319 /* Scan or linking is in progress, do nothing. */
320 ret = (u8)check_fwstate(pmlmepriv, _FW_UNDER_SURVEY);
321 } else {
322 r8712_free_network_queue(padapter);
323 ret = r8712_sitesurvey_cmd(padapter, NULL);
324 }
325 spin_unlock_irqrestore(&pmlmepriv->lock, irqL);
326 return ret;
327 }
328
r8712_set_802_11_authentication_mode(struct _adapter * padapter,enum NDIS_802_11_AUTHENTICATION_MODE authmode)329 u8 r8712_set_802_11_authentication_mode(struct _adapter *padapter,
330 enum NDIS_802_11_AUTHENTICATION_MODE authmode)
331 {
332 struct security_priv *psecuritypriv = &padapter->securitypriv;
333 u8 ret;
334
335 psecuritypriv->ndisauthtype = authmode;
336 if (psecuritypriv->ndisauthtype > 3)
337 psecuritypriv->AuthAlgrthm = 2; /* 802.1x */
338 if (r8712_set_auth(padapter, psecuritypriv) == _SUCCESS)
339 ret = true;
340 else
341 ret = false;
342 return ret;
343 }
344
r8712_set_802_11_add_wep(struct _adapter * padapter,struct NDIS_802_11_WEP * wep)345 u8 r8712_set_802_11_add_wep(struct _adapter *padapter,
346 struct NDIS_802_11_WEP *wep)
347 {
348 u8 bdefaultkey;
349 u8 btransmitkey;
350 sint keyid;
351 struct security_priv *psecuritypriv = &padapter->securitypriv;
352
353 bdefaultkey = (wep->KeyIndex & 0x40000000) > 0 ? false : true;
354 btransmitkey = (wep->KeyIndex & 0x80000000) > 0 ? true : false;
355 keyid = wep->KeyIndex & 0x3fffffff;
356 if (keyid >= WEP_KEYS)
357 return false;
358 switch (wep->KeyLength) {
359 case 5:
360 psecuritypriv->PrivacyAlgrthm = _WEP40_;
361 break;
362 case 13:
363 psecuritypriv->PrivacyAlgrthm = _WEP104_;
364 break;
365 default:
366 psecuritypriv->PrivacyAlgrthm = _NO_PRIVACY_;
367 break;
368 }
369 memcpy(psecuritypriv->DefKey[keyid].skey, &wep->KeyMaterial,
370 wep->KeyLength);
371 psecuritypriv->DefKeylen[keyid] = wep->KeyLength;
372 psecuritypriv->PrivacyKeyIndex = keyid;
373 if (r8712_set_key(padapter, psecuritypriv, keyid) == _FAIL)
374 return false;
375 return _SUCCESS;
376 }
377