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