Commit | Line | Data |
---|---|---|
21baa36d | 1 | // SPDX-License-Identifier: GPL-2.0 |
8fc8598e JC |
2 | /****************************************************************************** |
3 | ||
4 | Copyright(c) 2004 Intel Corporation. All rights reserved. | |
5 | ||
6 | Portions of this file are based on the WEP enablement code provided by the | |
7 | Host AP project hostap-drivers v0.1.3 | |
8 | Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen | |
9 | <jkmaline@cc.hut.fi> | |
10 | Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi> | |
11 | ||
8fc8598e JC |
12 | Contact Information: |
13 | James P. Ketrenos <ipw2100-admin@linux.intel.com> | |
14 | Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | |
15 | ||
16 | ******************************************************************************/ | |
17 | #include <linux/wireless.h> | |
8fc8598e | 18 | #include <linux/kmod.h> |
5a0e3ad6 | 19 | #include <linux/slab.h> |
8fc8598e JC |
20 | #include <linux/module.h> |
21 | ||
22 | #include "ieee80211.h" | |
8fc8598e JC |
23 | struct modes_unit { |
24 | char *mode_string; | |
25 | int mode_size; | |
26 | }; | |
6831574c | 27 | static struct modes_unit ieee80211_modes[] = { |
0b4ef0a6 GD |
28 | {"a", 1}, |
29 | {"b", 1}, | |
30 | {"g", 1}, | |
31 | {"?", 1}, | |
32 | {"N-24G", 5}, | |
33 | {"N-5G", 4}, | |
8fc8598e JC |
34 | }; |
35 | ||
8fc8598e | 36 | #define iwe_stream_add_event_rsl iwe_stream_add_event |
8fc8598e JC |
37 | |
38 | #define MAX_CUSTOM_LEN 64 | |
39 | static inline char *rtl819x_translate_scan(struct ieee80211_device *ieee, | |
e406322b | 40 | char *start, char *stop, |
8fc8598e | 41 | struct ieee80211_network *network, |
e406322b | 42 | struct iw_request_info *info) |
8fc8598e JC |
43 | { |
44 | char custom[MAX_CUSTOM_LEN]; | |
45 | char proto_name[IFNAMSIZ]; | |
46 | char *pname = proto_name; | |
47 | char *p; | |
48 | struct iw_event iwe; | |
49 | int i, j; | |
50 | u16 max_rate, rate; | |
51 | static u8 EWC11NHTCap[] = {0x00, 0x90, 0x4c, 0x33}; | |
52 | ||
53 | /* First entry *MUST* be the AP MAC address */ | |
54 | iwe.cmd = SIOCGIWAP; | |
55 | iwe.u.ap_addr.sa_family = ARPHRD_ETHER; | |
56 | memcpy(iwe.u.ap_addr.sa_data, network->bssid, ETH_ALEN); | |
8fc8598e | 57 | start = iwe_stream_add_event_rsl(info, start, stop, &iwe, IW_EV_ADDR_LEN); |
8fc8598e JC |
58 | /* Remaining entries will be displayed in the order we provide them */ |
59 | ||
60 | /* Add the ESSID */ | |
61 | iwe.cmd = SIOCGIWESSID; | |
62 | iwe.u.data.flags = 1; | |
63 | // if (network->flags & NETWORK_EMPTY_ESSID) { | |
64 | if (network->ssid_len == 0) { | |
65 | iwe.u.data.length = sizeof("<hidden>"); | |
e406322b | 66 | start = iwe_stream_add_point(info, start, stop, &iwe, "<hidden>"); |
e406322b | 67 | } else { |
8fc8598e | 68 | iwe.u.data.length = min(network->ssid_len, (u8)32); |
e406322b | 69 | start = iwe_stream_add_point(info, start, stop, &iwe, network->ssid); |
e406322b | 70 | } |
8fc8598e JC |
71 | /* Add the protocol name */ |
72 | iwe.cmd = SIOCGIWNAME; | |
f401441d | 73 | for (i = 0; i < ARRAY_SIZE(ieee80211_modes); i++) { |
8dd43050 | 74 | if (network->mode & BIT(i)) { |
f401441d SB |
75 | sprintf(pname, ieee80211_modes[i].mode_string, ieee80211_modes[i].mode_size); |
76 | pname += ieee80211_modes[i].mode_size; | |
8fc8598e JC |
77 | } |
78 | } | |
79 | *pname = '\0'; | |
80 | snprintf(iwe.u.name, IFNAMSIZ, "IEEE802.11%s", proto_name); | |
e406322b | 81 | start = iwe_stream_add_event_rsl(info, start, stop, &iwe, IW_EV_CHAR_LEN); |
e406322b MCC |
82 | /* Add mode */ |
83 | iwe.cmd = SIOCGIWMODE; | |
84 | if (network->capability & | |
8fc8598e JC |
85 | (WLAN_CAPABILITY_BSS | WLAN_CAPABILITY_IBSS)) { |
86 | if (network->capability & WLAN_CAPABILITY_BSS) | |
87 | iwe.u.mode = IW_MODE_MASTER; | |
88 | else | |
89 | iwe.u.mode = IW_MODE_ADHOC; | |
e406322b | 90 | start = iwe_stream_add_event_rsl(info, start, stop, &iwe, IW_EV_UINT_LEN); |
e406322b | 91 | } |
8fc8598e | 92 | |
e406322b | 93 | /* Add frequency/channel */ |
8fc8598e JC |
94 | iwe.cmd = SIOCGIWFREQ; |
95 | /* iwe.u.freq.m = ieee80211_frequency(network->channel, network->mode); | |
96 | iwe.u.freq.e = 3; */ | |
97 | iwe.u.freq.m = network->channel; | |
98 | iwe.u.freq.e = 0; | |
99 | iwe.u.freq.i = 0; | |
e406322b | 100 | start = iwe_stream_add_event_rsl(info, start, stop, &iwe, IW_EV_FREQ_LEN); |
8fc8598e JC |
101 | /* Add encryption capability */ |
102 | iwe.cmd = SIOCGIWENCODE; | |
103 | if (network->capability & WLAN_CAPABILITY_PRIVACY) | |
104 | iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; | |
105 | else | |
106 | iwe.u.data.flags = IW_ENCODE_DISABLED; | |
107 | iwe.u.data.length = 0; | |
e406322b | 108 | start = iwe_stream_add_point(info, start, stop, &iwe, network->ssid); |
8fc8598e JC |
109 | /* Add basic and extended rates */ |
110 | max_rate = 0; | |
111 | p = custom; | |
88b3673e | 112 | p += scnprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); |
8fc8598e JC |
113 | for (i = 0, j = 0; i < network->rates_len; ) { |
114 | if (j < network->rates_ex_len && | |
115 | ((network->rates_ex[j] & 0x7F) < | |
116 | (network->rates[i] & 0x7F))) | |
117 | rate = network->rates_ex[j++] & 0x7F; | |
118 | else | |
119 | rate = network->rates[i++] & 0x7F; | |
120 | if (rate > max_rate) | |
121 | max_rate = rate; | |
88b3673e | 122 | p += scnprintf(p, MAX_CUSTOM_LEN - (p - custom), |
8fc8598e JC |
123 | "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); |
124 | } | |
125 | for (; j < network->rates_ex_len; j++) { | |
126 | rate = network->rates_ex[j] & 0x7F; | |
88b3673e | 127 | p += scnprintf(p, MAX_CUSTOM_LEN - (p - custom), |
8fc8598e JC |
128 | "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); |
129 | if (rate > max_rate) | |
130 | max_rate = rate; | |
131 | } | |
132 | ||
ee16d7d3 | 133 | if (network->mode >= IEEE_N_24G) /* add N rate here */ { |
2c6d0ee3 | 134 | struct ht_capability_ele *ht_cap = NULL; |
8fc8598e JC |
135 | bool is40M = false, isShortGI = false; |
136 | u8 max_mcs = 0; | |
137 | if (!memcmp(network->bssht.bdHTCapBuf, EWC11NHTCap, 4)) | |
2c6d0ee3 | 138 | ht_cap = (struct ht_capability_ele *)&network->bssht.bdHTCapBuf[4]; |
8fc8598e | 139 | else |
2c6d0ee3 | 140 | ht_cap = (struct ht_capability_ele *)&network->bssht.bdHTCapBuf[0]; |
f401441d SB |
141 | is40M = (ht_cap->ChlWidth) ? 1 : 0; |
142 | isShortGI = (ht_cap->ChlWidth) ? | |
143 | ((ht_cap->ShortGI40Mhz) ? 1 : 0) : | |
144 | ((ht_cap->ShortGI20Mhz) ? 1 : 0); | |
8fc8598e JC |
145 | |
146 | max_mcs = HTGetHighestMCSRate(ieee, ht_cap->MCS, MCS_FILTER_ALL); | |
f401441d | 147 | rate = MCS_DATA_RATE[is40M][isShortGI][max_mcs & 0x7f]; |
8fc8598e JC |
148 | if (rate > max_rate) |
149 | max_rate = rate; | |
150 | } | |
8fc8598e JC |
151 | iwe.cmd = SIOCGIWRATE; |
152 | iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; | |
153 | iwe.u.bitrate.value = max_rate * 500000; | |
e406322b | 154 | start = iwe_stream_add_event_rsl(info, start, stop, &iwe, |
8fc8598e | 155 | IW_EV_PARAM_LEN); |
8fc8598e JC |
156 | iwe.cmd = IWEVCUSTOM; |
157 | iwe.u.data.length = p - custom; | |
158 | if (iwe.u.data.length) | |
f9eb26cf | 159 | start = iwe_stream_add_point(info, start, stop, &iwe, custom); |
8fc8598e JC |
160 | /* Add quality statistics */ |
161 | /* TODO: Fix these values... */ | |
162 | iwe.cmd = IWEVQUAL; | |
163 | iwe.u.qual.qual = network->stats.signal; | |
164 | iwe.u.qual.level = network->stats.rssi; | |
165 | iwe.u.qual.noise = network->stats.noise; | |
166 | iwe.u.qual.updated = network->stats.mask & IEEE80211_STATMASK_WEMASK; | |
167 | if (!(network->stats.mask & IEEE80211_STATMASK_RSSI)) | |
168 | iwe.u.qual.updated |= IW_QUAL_LEVEL_INVALID; | |
169 | if (!(network->stats.mask & IEEE80211_STATMASK_NOISE)) | |
170 | iwe.u.qual.updated |= IW_QUAL_NOISE_INVALID; | |
171 | if (!(network->stats.mask & IEEE80211_STATMASK_SIGNAL)) | |
172 | iwe.u.qual.updated |= IW_QUAL_QUAL_INVALID; | |
173 | iwe.u.qual.updated = 7; | |
e406322b | 174 | start = iwe_stream_add_event_rsl(info, start, stop, &iwe, IW_EV_QUAL_LEN); |
8fc8598e JC |
175 | iwe.cmd = IWEVCUSTOM; |
176 | p = custom; | |
177 | ||
178 | iwe.u.data.length = p - custom; | |
179 | if (iwe.u.data.length) | |
a1617c8c | 180 | start = iwe_stream_add_point(info, start, stop, &iwe, custom); |
e6c1ef6c | 181 | |
7a4f9419 | 182 | if (ieee->wpa_enabled && network->wpa_ie_len) { |
8fc8598e JC |
183 | char buf[MAX_WPA_IE_LEN * 2 + 30]; |
184 | // printk("WPA IE\n"); | |
185 | u8 *p = buf; | |
186 | p += sprintf(p, "wpa_ie="); | |
187 | for (i = 0; i < network->wpa_ie_len; i++) { | |
188 | p += sprintf(p, "%02x", network->wpa_ie[i]); | |
189 | } | |
190 | ||
191 | memset(&iwe, 0, sizeof(iwe)); | |
192 | iwe.cmd = IWEVCUSTOM; | |
193 | iwe.u.data.length = strlen(buf); | |
e406322b | 194 | start = iwe_stream_add_point(info, start, stop, &iwe, buf); |
e406322b | 195 | } |
8fc8598e | 196 | |
7a4f9419 | 197 | if (ieee->wpa_enabled && network->rsn_ie_len) { |
8fc8598e JC |
198 | char buf[MAX_WPA_IE_LEN * 2 + 30]; |
199 | ||
200 | u8 *p = buf; | |
201 | p += sprintf(p, "rsn_ie="); | |
202 | for (i = 0; i < network->rsn_ie_len; i++) { | |
203 | p += sprintf(p, "%02x", network->rsn_ie[i]); | |
204 | } | |
205 | ||
206 | memset(&iwe, 0, sizeof(iwe)); | |
207 | iwe.cmd = IWEVCUSTOM; | |
208 | iwe.u.data.length = strlen(buf); | |
e406322b | 209 | start = iwe_stream_add_point(info, start, stop, &iwe, buf); |
e406322b | 210 | } |
8fc8598e JC |
211 | |
212 | ||
213 | /* Add EXTRA: Age to display seconds since last beacon/probe response | |
214 | * for given network. */ | |
215 | iwe.cmd = IWEVCUSTOM; | |
216 | p = custom; | |
88b3673e | 217 | p += scnprintf(p, MAX_CUSTOM_LEN - (p - custom), |
8fc8598e JC |
218 | " Last beacon: %lums ago", (jiffies - network->last_scanned) / (HZ / 100)); |
219 | iwe.u.data.length = p - custom; | |
220 | if (iwe.u.data.length) | |
a1617c8c | 221 | start = iwe_stream_add_point(info, start, stop, &iwe, custom); |
8fc8598e JC |
222 | |
223 | return start; | |
224 | } | |
225 | ||
226 | int ieee80211_wx_get_scan(struct ieee80211_device *ieee, | |
227 | struct iw_request_info *info, | |
228 | union iwreq_data *wrqu, char *extra) | |
229 | { | |
230 | struct ieee80211_network *network; | |
231 | unsigned long flags; | |
232 | ||
233 | char *ev = extra; | |
234 | // char *stop = ev + IW_SCAN_MAX_DATA; | |
235 | char *stop = ev + wrqu->data.length;//IW_SCAN_MAX_DATA; | |
236 | //char *stop = ev + IW_SCAN_MAX_DATA; | |
237 | int i = 0; | |
238 | int err = 0; | |
239 | IEEE80211_DEBUG_WX("Getting scan\n"); | |
e379a9a8 | 240 | mutex_lock(&ieee->wx_mutex); |
8fc8598e JC |
241 | spin_lock_irqsave(&ieee->lock, flags); |
242 | ||
243 | list_for_each_entry(network, &ieee->network_list, list) { | |
244 | i++; | |
f401441d | 245 | if ((stop - ev) < 200) { |
8fc8598e JC |
246 | err = -E2BIG; |
247 | break; | |
e379a9a8 | 248 | } |
8fc8598e JC |
249 | if (ieee->scan_age == 0 || |
250 | time_after(network->last_scanned + ieee->scan_age, jiffies)) | |
251 | ev = rtl819x_translate_scan(ieee, ev, stop, network, info); | |
252 | else | |
253 | IEEE80211_DEBUG_SCAN( | |
254 | "Not showing network '%s (" | |
0ee9f67c | 255 | "%pM)' due to age (%lums).\n", |
8fc8598e JC |
256 | escape_essid(network->ssid, |
257 | network->ssid_len), | |
0ee9f67c | 258 | network->bssid, |
8fc8598e JC |
259 | (jiffies - network->last_scanned) / (HZ / 100)); |
260 | } | |
261 | ||
262 | spin_unlock_irqrestore(&ieee->lock, flags); | |
e379a9a8 | 263 | mutex_unlock(&ieee->wx_mutex); |
8fc8598e JC |
264 | wrqu->data.length = ev - extra; |
265 | wrqu->data.flags = 0; | |
266 | ||
267 | IEEE80211_DEBUG_WX("exit: %d networks returned.\n", i); | |
268 | ||
269 | return err; | |
270 | } | |
539b4f72 | 271 | EXPORT_SYMBOL(ieee80211_wx_get_scan); |
8fc8598e JC |
272 | |
273 | int ieee80211_wx_set_encode(struct ieee80211_device *ieee, | |
274 | struct iw_request_info *info, | |
275 | union iwreq_data *wrqu, char *keybuf) | |
276 | { | |
277 | struct iw_point *erq = &(wrqu->encoding); | |
278 | struct net_device *dev = ieee->dev; | |
279 | struct ieee80211_security sec = { | |
280 | .flags = 0 | |
281 | }; | |
282 | int i, key, key_provided, len; | |
283 | struct ieee80211_crypt_data **crypt; | |
284 | ||
285 | IEEE80211_DEBUG_WX("SET_ENCODE\n"); | |
286 | ||
287 | key = erq->flags & IW_ENCODE_INDEX; | |
288 | if (key) { | |
289 | if (key > WEP_KEYS) | |
290 | return -EINVAL; | |
291 | key--; | |
292 | key_provided = 1; | |
293 | } else { | |
294 | key_provided = 0; | |
295 | key = ieee->tx_keyidx; | |
296 | } | |
297 | ||
298 | IEEE80211_DEBUG_WX("Key: %d [%s]\n", key, key_provided ? | |
299 | "provided" : "default"); | |
300 | crypt = &ieee->crypt[key]; | |
301 | ||
302 | if (erq->flags & IW_ENCODE_DISABLED) { | |
303 | if (key_provided && *crypt) { | |
304 | IEEE80211_DEBUG_WX("Disabling encryption on key %d.\n", | |
305 | key); | |
306 | ieee80211_crypt_delayed_deinit(ieee, crypt); | |
307 | } else | |
308 | IEEE80211_DEBUG_WX("Disabling encryption.\n"); | |
309 | ||
310 | /* Check all the keys to see if any are still configured, | |
311 | * and if no key index was provided, de-init them all */ | |
312 | for (i = 0; i < WEP_KEYS; i++) { | |
deabe035 | 313 | if (ieee->crypt[i]) { |
8fc8598e JC |
314 | if (key_provided) |
315 | break; | |
316 | ieee80211_crypt_delayed_deinit( | |
317 | ieee, &ieee->crypt[i]); | |
318 | } | |
319 | } | |
320 | ||
321 | if (i == WEP_KEYS) { | |
322 | sec.enabled = 0; | |
323 | sec.level = SEC_LEVEL_0; | |
324 | sec.flags |= SEC_ENABLED | SEC_LEVEL; | |
325 | } | |
326 | ||
327 | goto done; | |
328 | } | |
329 | ||
330 | ||
331 | ||
332 | sec.enabled = 1; | |
333 | sec.flags |= SEC_ENABLED; | |
334 | ||
deabe035 | 335 | if (*crypt && (*crypt)->ops && |
8fc8598e JC |
336 | strcmp((*crypt)->ops->name, "WEP") != 0) { |
337 | /* changing to use WEP; deinit previously used algorithm | |
338 | * on this key */ | |
339 | ieee80211_crypt_delayed_deinit(ieee, crypt); | |
340 | } | |
341 | ||
deabe035 | 342 | if (!*crypt) { |
8fc8598e JC |
343 | struct ieee80211_crypt_data *new_crypt; |
344 | ||
345 | /* take WEP into use */ | |
7a6cb0d5 | 346 | new_crypt = kzalloc(sizeof(struct ieee80211_crypt_data), |
8fc8598e | 347 | GFP_KERNEL); |
3956c8ac | 348 | if (!new_crypt) |
8fc8598e | 349 | return -ENOMEM; |
5a5251b8 IS |
350 | new_crypt->ops = try_then_request_module(ieee80211_get_crypto_ops("WEP"), |
351 | "ieee80211_crypt_wep"); | |
8fc8598e | 352 | if (new_crypt->ops && try_module_get(new_crypt->ops->owner)) |
8fc8598e JC |
353 | new_crypt->priv = new_crypt->ops->init(key); |
354 | ||
355 | if (!new_crypt->ops || !new_crypt->priv) { | |
356 | kfree(new_crypt); | |
357 | new_crypt = NULL; | |
358 | ||
6a569336 SM |
359 | netdev_warn(dev, "could not initialize WEP: " |
360 | "load module ieee80211_crypt_wep\n"); | |
8fc8598e JC |
361 | return -EOPNOTSUPP; |
362 | } | |
363 | *crypt = new_crypt; | |
364 | } | |
365 | ||
366 | /* If a new key was provided, set it up */ | |
367 | if (erq->length > 0) { | |
368 | len = erq->length <= 5 ? 5 : 13; | |
369 | memcpy(sec.keys[key], keybuf, erq->length); | |
370 | if (len > erq->length) | |
371 | memset(sec.keys[key] + erq->length, 0, | |
372 | len - erq->length); | |
373 | IEEE80211_DEBUG_WX("Setting key %d to '%s' (%d:%d bytes)\n", | |
374 | key, escape_essid(sec.keys[key], len), | |
375 | erq->length, len); | |
376 | sec.key_sizes[key] = len; | |
e406322b | 377 | (*crypt)->ops->set_key(sec.keys[key], len, NULL, |
8fc8598e | 378 | (*crypt)->priv); |
8dd43050 | 379 | sec.flags |= BIT(key); |
8fc8598e | 380 | /* This ensures a key will be activated if no key is |
41dff4d6 VN |
381 | * explicitly set |
382 | */ | |
8fc8598e JC |
383 | if (key == sec.active_key) |
384 | sec.flags |= SEC_ACTIVE_KEY; | |
385 | ieee->tx_keyidx = key; | |
386 | ||
387 | } else { | |
388 | len = (*crypt)->ops->get_key(sec.keys[key], WEP_KEY_LEN, | |
389 | NULL, (*crypt)->priv); | |
390 | if (len == 0) { | |
391 | /* Set a default key of all 0 */ | |
392 | printk("Setting key %d to all zero.\n", | |
393 | key); | |
394 | ||
395 | IEEE80211_DEBUG_WX("Setting key %d to all zero.\n", | |
396 | key); | |
397 | memset(sec.keys[key], 0, 13); | |
398 | (*crypt)->ops->set_key(sec.keys[key], 13, NULL, | |
399 | (*crypt)->priv); | |
400 | sec.key_sizes[key] = 13; | |
8dd43050 | 401 | sec.flags |= BIT(key); |
8fc8598e JC |
402 | } |
403 | ||
404 | /* No key data - just set the default TX key index */ | |
405 | if (key_provided) { | |
406 | IEEE80211_DEBUG_WX( | |
407 | "Setting key %d to default Tx key.\n", key); | |
408 | ieee->tx_keyidx = key; | |
409 | sec.active_key = key; | |
410 | sec.flags |= SEC_ACTIVE_KEY; | |
411 | } | |
412 | } | |
413 | ||
414 | done: | |
415 | ieee->open_wep = !(erq->flags & IW_ENCODE_RESTRICTED); | |
416 | ieee->auth_mode = ieee->open_wep ? WLAN_AUTH_OPEN : WLAN_AUTH_SHARED_KEY; | |
417 | sec.auth_mode = ieee->open_wep ? WLAN_AUTH_OPEN : WLAN_AUTH_SHARED_KEY; | |
418 | sec.flags |= SEC_AUTH_MODE; | |
419 | IEEE80211_DEBUG_WX("Auth: %s\n", sec.auth_mode == WLAN_AUTH_OPEN ? | |
420 | "OPEN" : "SHARED KEY"); | |
421 | ||
422 | /* For now we just support WEP, so only set that security level... | |
423 | * TODO: When WPA is added this is one place that needs to change */ | |
424 | sec.flags |= SEC_LEVEL; | |
425 | sec.level = SEC_LEVEL_1; /* 40 and 104 bit WEP */ | |
426 | ||
427 | if (ieee->set_security) | |
428 | ieee->set_security(dev, &sec); | |
429 | ||
430 | /* Do not reset port if card is in Managed mode since resetting will | |
431 | * generate new IEEE 802.11 authentication which may end up in looping | |
432 | * with IEEE 802.1X. If your hardware requires a reset after WEP | |
433 | * configuration (for example... Prism2), implement the reset_port in | |
434 | * the callbacks structures used to initialize the 802.11 stack. */ | |
435 | if (ieee->reset_on_keychange && | |
436 | ieee->iw_mode != IW_MODE_INFRA && | |
437 | ieee->reset_port && ieee->reset_port(dev)) { | |
ea7a10ea | 438 | netdev_dbg(ieee->dev, "reset_port failed\n"); |
8fc8598e JC |
439 | return -EINVAL; |
440 | } | |
441 | return 0; | |
442 | } | |
539b4f72 | 443 | EXPORT_SYMBOL(ieee80211_wx_set_encode); |
8fc8598e JC |
444 | |
445 | int ieee80211_wx_get_encode(struct ieee80211_device *ieee, | |
446 | struct iw_request_info *info, | |
447 | union iwreq_data *wrqu, char *keybuf) | |
448 | { | |
449 | struct iw_point *erq = &(wrqu->encoding); | |
450 | int len, key; | |
451 | struct ieee80211_crypt_data *crypt; | |
452 | ||
453 | IEEE80211_DEBUG_WX("GET_ENCODE\n"); | |
454 | ||
f401441d | 455 | if (ieee->iw_mode == IW_MODE_MONITOR) |
8fc8598e JC |
456 | return -1; |
457 | ||
458 | key = erq->flags & IW_ENCODE_INDEX; | |
459 | if (key) { | |
460 | if (key > WEP_KEYS) | |
461 | return -EINVAL; | |
462 | key--; | |
463 | } else | |
464 | key = ieee->tx_keyidx; | |
465 | ||
466 | crypt = ieee->crypt[key]; | |
467 | erq->flags = key + 1; | |
468 | ||
deabe035 | 469 | if (!crypt || !crypt->ops) { |
8fc8598e JC |
470 | erq->length = 0; |
471 | erq->flags |= IW_ENCODE_DISABLED; | |
472 | return 0; | |
473 | } | |
8fc8598e JC |
474 | len = crypt->ops->get_key(keybuf, SCM_KEY_LEN, NULL, crypt->priv); |
475 | erq->length = (len >= 0 ? len : 0); | |
476 | ||
477 | erq->flags |= IW_ENCODE_ENABLED; | |
478 | ||
479 | if (ieee->open_wep) | |
480 | erq->flags |= IW_ENCODE_OPEN; | |
481 | else | |
482 | erq->flags |= IW_ENCODE_RESTRICTED; | |
483 | ||
484 | return 0; | |
485 | } | |
539b4f72 BT |
486 | EXPORT_SYMBOL(ieee80211_wx_get_encode); |
487 | ||
8fc8598e | 488 | int ieee80211_wx_set_encode_ext(struct ieee80211_device *ieee, |
e406322b MCC |
489 | struct iw_request_info *info, |
490 | union iwreq_data *wrqu, char *extra) | |
8fc8598e JC |
491 | { |
492 | int ret = 0; | |
8fc8598e | 493 | struct net_device *dev = ieee->dev; |
e406322b MCC |
494 | struct iw_point *encoding = &wrqu->encoding; |
495 | struct iw_encode_ext *ext = (struct iw_encode_ext *)extra; | |
496 | int i, idx; | |
497 | int group_key = 0; | |
498 | const char *alg, *module; | |
499 | struct ieee80211_crypto_ops *ops; | |
500 | struct ieee80211_crypt_data **crypt; | |
501 | ||
502 | struct ieee80211_security sec = { | |
503 | .flags = 0, | |
504 | }; | |
e406322b MCC |
505 | idx = encoding->flags & IW_ENCODE_INDEX; |
506 | if (idx) { | |
507 | if (idx < 1 || idx > WEP_KEYS) | |
508 | return -EINVAL; | |
509 | idx--; | |
510 | } else | |
511 | idx = ieee->tx_keyidx; | |
8fc8598e | 512 | |
e406322b | 513 | if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) { |
8fc8598e | 514 | |
e406322b | 515 | crypt = &ieee->crypt[idx]; |
8fc8598e | 516 | |
e406322b MCC |
517 | group_key = 1; |
518 | } else { | |
519 | /* some Cisco APs use idx>0 for unicast in dynamic WEP */ | |
e406322b MCC |
520 | if (idx != 0 && ext->alg != IW_ENCODE_ALG_WEP) |
521 | return -EINVAL; | |
522 | if (ieee->iw_mode == IW_MODE_INFRA) | |
8fc8598e | 523 | |
e406322b | 524 | crypt = &ieee->crypt[idx]; |
8fc8598e | 525 | |
e406322b MCC |
526 | else |
527 | return -EINVAL; | |
528 | } | |
8fc8598e | 529 | |
e406322b MCC |
530 | sec.flags |= SEC_ENABLED;// | SEC_ENCRYPT; |
531 | if ((encoding->flags & IW_ENCODE_DISABLED) || | |
532 | ext->alg == IW_ENCODE_ALG_NONE) { | |
533 | if (*crypt) | |
534 | ieee80211_crypt_delayed_deinit(ieee, crypt); | |
8fc8598e | 535 | |
e406322b | 536 | for (i = 0; i < WEP_KEYS; i++) |
8fc8598e | 537 | |
deabe035 | 538 | if (ieee->crypt[i]) |
8fc8598e | 539 | |
e406322b | 540 | break; |
8fc8598e | 541 | |
e406322b MCC |
542 | if (i == WEP_KEYS) { |
543 | sec.enabled = 0; | |
544 | // sec.encrypt = 0; | |
545 | sec.level = SEC_LEVEL_0; | |
546 | sec.flags |= SEC_LEVEL; | |
547 | } | |
e406322b MCC |
548 | goto done; |
549 | } | |
8fc8598e JC |
550 | |
551 | sec.enabled = 1; | |
552 | // sec.encrypt = 1; | |
e406322b MCC |
553 | switch (ext->alg) { |
554 | case IW_ENCODE_ALG_WEP: | |
555 | alg = "WEP"; | |
556 | module = "ieee80211_crypt_wep"; | |
557 | break; | |
558 | case IW_ENCODE_ALG_TKIP: | |
559 | alg = "TKIP"; | |
560 | module = "ieee80211_crypt_tkip"; | |
561 | break; | |
562 | case IW_ENCODE_ALG_CCMP: | |
563 | alg = "CCMP"; | |
564 | module = "ieee80211_crypt_ccmp"; | |
565 | break; | |
566 | default: | |
567 | IEEE80211_DEBUG_WX("%s: unknown crypto alg %d\n", | |
568 | dev->name, ext->alg); | |
569 | ret = -EINVAL; | |
570 | goto done; | |
571 | } | |
f401441d | 572 | printk("alg name:%s\n", alg); |
8fc8598e | 573 | |
5a5251b8 IS |
574 | ops = try_then_request_module(ieee80211_get_crypto_ops(alg), module); |
575 | if (!ops) { | |
e406322b MCC |
576 | IEEE80211_DEBUG_WX("%s: unknown crypto alg %d\n", |
577 | dev->name, ext->alg); | |
8fc8598e | 578 | printk("========>unknown crypto alg %d\n", ext->alg); |
e406322b MCC |
579 | ret = -EINVAL; |
580 | goto done; | |
581 | } | |
8fc8598e | 582 | |
deabe035 | 583 | if (!*crypt || (*crypt)->ops != ops) { |
e406322b | 584 | struct ieee80211_crypt_data *new_crypt; |
8fc8598e | 585 | |
e406322b | 586 | ieee80211_crypt_delayed_deinit(ieee, crypt); |
8fc8598e | 587 | |
e406322b | 588 | new_crypt = kzalloc(sizeof(*new_crypt), GFP_KERNEL); |
3956c8ac | 589 | if (!new_crypt) { |
e406322b MCC |
590 | ret = -ENOMEM; |
591 | goto done; | |
592 | } | |
593 | new_crypt->ops = ops; | |
594 | if (new_crypt->ops && try_module_get(new_crypt->ops->owner)) | |
595 | new_crypt->priv = new_crypt->ops->init(idx); | |
deabe035 | 596 | if (!new_crypt->priv) { |
e406322b MCC |
597 | kfree(new_crypt); |
598 | ret = -EINVAL; | |
599 | goto done; | |
600 | } | |
601 | *crypt = new_crypt; | |
e406322b MCC |
602 | } |
603 | ||
604 | if (ext->key_len > 0 && (*crypt)->ops->set_key && | |
605 | (*crypt)->ops->set_key(ext->key, ext->key_len, ext->rx_seq, | |
606 | (*crypt)->priv) < 0) { | |
607 | IEEE80211_DEBUG_WX("%s: key setting failed\n", dev->name); | |
8fc8598e | 608 | printk("key setting failed\n"); |
e406322b MCC |
609 | ret = -EINVAL; |
610 | goto done; | |
611 | } | |
8fc8598e | 612 | //skip_host_crypt: |
e406322b MCC |
613 | if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) { |
614 | ieee->tx_keyidx = idx; | |
615 | sec.active_key = idx; | |
616 | sec.flags |= SEC_ACTIVE_KEY; | |
617 | } | |
618 | ||
619 | if (ext->alg != IW_ENCODE_ALG_NONE) { | |
620 | //memcpy(sec.keys[idx], ext->key, ext->key_len); | |
621 | sec.key_sizes[idx] = ext->key_len; | |
8dd43050 | 622 | sec.flags |= BIT(idx); |
e406322b MCC |
623 | if (ext->alg == IW_ENCODE_ALG_WEP) { |
624 | // sec.encode_alg[idx] = SEC_ALG_WEP; | |
625 | sec.flags |= SEC_LEVEL; | |
626 | sec.level = SEC_LEVEL_1; | |
627 | } else if (ext->alg == IW_ENCODE_ALG_TKIP) { | |
628 | // sec.encode_alg[idx] = SEC_ALG_TKIP; | |
629 | sec.flags |= SEC_LEVEL; | |
630 | sec.level = SEC_LEVEL_2; | |
631 | } else if (ext->alg == IW_ENCODE_ALG_CCMP) { | |
632 | // sec.encode_alg[idx] = SEC_ALG_CCMP; | |
633 | sec.flags |= SEC_LEVEL; | |
634 | sec.level = SEC_LEVEL_3; | |
635 | } | |
636 | /* Don't set sec level for group keys. */ | |
637 | if (group_key) | |
638 | sec.flags &= ~SEC_LEVEL; | |
639 | } | |
8fc8598e | 640 | done: |
e406322b MCC |
641 | if (ieee->set_security) |
642 | ieee->set_security(ieee->dev, &sec); | |
8fc8598e | 643 | |
f4c04b8f | 644 | if (ieee->reset_on_keychange && |
e406322b MCC |
645 | ieee->iw_mode != IW_MODE_INFRA && |
646 | ieee->reset_port && ieee->reset_port(dev)) { | |
647 | IEEE80211_DEBUG_WX("%s: reset_port failed\n", dev->name); | |
648 | return -EINVAL; | |
649 | } | |
e406322b | 650 | return ret; |
8fc8598e | 651 | } |
539b4f72 | 652 | EXPORT_SYMBOL(ieee80211_wx_set_encode_ext); |
8fc8598e JC |
653 | |
654 | int ieee80211_wx_get_encode_ext(struct ieee80211_device *ieee, | |
655 | struct iw_request_info *info, | |
656 | union iwreq_data *wrqu, char *extra) | |
657 | { | |
658 | struct iw_point *encoding = &wrqu->encoding; | |
659 | struct iw_encode_ext *ext = (struct iw_encode_ext *)extra; | |
660 | struct ieee80211_crypt_data *crypt; | |
661 | int idx, max_key_len; | |
662 | ||
663 | max_key_len = encoding->length - sizeof(*ext); | |
664 | if (max_key_len < 0) | |
665 | return -EINVAL; | |
666 | ||
667 | idx = encoding->flags & IW_ENCODE_INDEX; | |
668 | if (idx) { | |
669 | if (idx < 1 || idx > WEP_KEYS) | |
670 | return -EINVAL; | |
671 | idx--; | |
672 | } else | |
673 | idx = ieee->tx_keyidx; | |
674 | ||
716323c0 | 675 | if (!(ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) && |
8fc8598e JC |
676 | ext->alg != IW_ENCODE_ALG_WEP) |
677 | if (idx != 0 || ieee->iw_mode != IW_MODE_INFRA) | |
678 | return -EINVAL; | |
679 | ||
680 | crypt = ieee->crypt[idx]; | |
681 | encoding->flags = idx + 1; | |
682 | memset(ext, 0, sizeof(*ext)); | |
683 | ||
deabe035 | 684 | if (!crypt || !crypt->ops) { |
8fc8598e JC |
685 | ext->alg = IW_ENCODE_ALG_NONE; |
686 | ext->key_len = 0; | |
687 | encoding->flags |= IW_ENCODE_DISABLED; | |
688 | } else { | |
f401441d | 689 | if (strcmp(crypt->ops->name, "WEP") == 0) |
8fc8598e JC |
690 | ext->alg = IW_ENCODE_ALG_WEP; |
691 | else if (strcmp(crypt->ops->name, "TKIP")) | |
692 | ext->alg = IW_ENCODE_ALG_TKIP; | |
693 | else if (strcmp(crypt->ops->name, "CCMP")) | |
694 | ext->alg = IW_ENCODE_ALG_CCMP; | |
695 | else | |
696 | return -EINVAL; | |
697 | ext->key_len = crypt->ops->get_key(ext->key, SCM_KEY_LEN, NULL, crypt->priv); | |
698 | encoding->flags |= IW_ENCODE_ENABLED; | |
699 | if (ext->key_len && | |
700 | (ext->alg == IW_ENCODE_ALG_TKIP || | |
701 | ext->alg == IW_ENCODE_ALG_CCMP)) | |
702 | ext->ext_flags |= IW_ENCODE_EXT_TX_SEQ_VALID; | |
8fc8598e JC |
703 | } |
704 | ||
705 | return 0; | |
706 | } | |
539b4f72 | 707 | EXPORT_SYMBOL(ieee80211_wx_get_encode_ext); |
8fc8598e JC |
708 | |
709 | int ieee80211_wx_set_mlme(struct ieee80211_device *ieee, | |
e406322b MCC |
710 | struct iw_request_info *info, |
711 | union iwreq_data *wrqu, char *extra) | |
8fc8598e | 712 | { |
f401441d | 713 | struct iw_mlme *mlme = (struct iw_mlme *)extra; |
8fc8598e | 714 | switch (mlme->cmd) { |
e406322b | 715 | case IW_MLME_DEAUTH: |
8fc8598e JC |
716 | case IW_MLME_DISASSOC: |
717 | ieee80211_disassociate(ieee); | |
718 | break; | |
24fbe875 | 719 | default: |
e406322b MCC |
720 | return -EOPNOTSUPP; |
721 | } | |
8fc8598e JC |
722 | return 0; |
723 | } | |
539b4f72 | 724 | EXPORT_SYMBOL(ieee80211_wx_set_mlme); |
8fc8598e JC |
725 | |
726 | int ieee80211_wx_set_auth(struct ieee80211_device *ieee, | |
e406322b MCC |
727 | struct iw_request_info *info, |
728 | struct iw_param *data, char *extra) | |
8fc8598e | 729 | { |
8fc8598e | 730 | switch (data->flags & IW_AUTH_INDEX) { |
e406322b | 731 | case IW_AUTH_WPA_VERSION: |
8fc8598e | 732 | /*need to support wpa2 here*/ |
8fc8598e | 733 | break; |
e406322b MCC |
734 | case IW_AUTH_CIPHER_PAIRWISE: |
735 | case IW_AUTH_CIPHER_GROUP: | |
736 | case IW_AUTH_KEY_MGMT: | |
737 | /* | |
8fc8598e JC |
738 | * * Host AP driver does not use these parameters and allows |
739 | * * wpa_supplicant to control them internally. | |
740 | * */ | |
e406322b MCC |
741 | break; |
742 | case IW_AUTH_TKIP_COUNTERMEASURES: | |
743 | ieee->tkip_countermeasures = data->value; | |
744 | break; | |
745 | case IW_AUTH_DROP_UNENCRYPTED: | |
746 | ieee->drop_unencrypted = data->value; | |
8fc8598e JC |
747 | break; |
748 | ||
749 | case IW_AUTH_80211_AUTH_ALG: | |
f8628a47 | 750 | //printk("======>%s():data->value is %d\n",__func__,data->value); |
8fc8598e | 751 | // ieee->open_wep = (data->value&IW_AUTH_ALG_OPEN_SYSTEM)?1:0; |
7a4f9419 | 752 | if (data->value & IW_AUTH_ALG_SHARED_KEY) { |
8fc8598e JC |
753 | ieee->open_wep = 0; |
754 | ieee->auth_mode = 1; | |
7a4f9419 | 755 | } else if (data->value & IW_AUTH_ALG_OPEN_SYSTEM) { |
8fc8598e JC |
756 | ieee->open_wep = 1; |
757 | ieee->auth_mode = 0; | |
7a4f9419 | 758 | } else if (data->value & IW_AUTH_ALG_LEAP) { |
8fc8598e JC |
759 | ieee->open_wep = 1; |
760 | ieee->auth_mode = 2; | |
c3fb338a | 761 | } else |
8fc8598e | 762 | return -EINVAL; |
8fc8598e JC |
763 | break; |
764 | ||
8fc8598e | 765 | case IW_AUTH_WPA_ENABLED: |
f401441d | 766 | ieee->wpa_enabled = (data->value) ? 1 : 0; |
8fc8598e JC |
767 | break; |
768 | ||
8fc8598e | 769 | case IW_AUTH_RX_UNENCRYPTED_EAPOL: |
e406322b | 770 | ieee->ieee802_1x = data->value; |
8fc8598e JC |
771 | break; |
772 | case IW_AUTH_PRIVACY_INVOKED: | |
773 | ieee->privacy_invoked = data->value; | |
774 | break; | |
775 | default: | |
e406322b | 776 | return -EOPNOTSUPP; |
8fc8598e | 777 | } |
8fc8598e JC |
778 | return 0; |
779 | } | |
539b4f72 | 780 | EXPORT_SYMBOL(ieee80211_wx_set_auth); |
539b4f72 | 781 | |
8fc8598e JC |
782 | int ieee80211_wx_set_gen_ie(struct ieee80211_device *ieee, u8 *ie, size_t len) |
783 | { | |
8fc8598e JC |
784 | u8 *buf; |
785 | ||
f401441d | 786 | if (len > MAX_WPA_IE_LEN || (len && !ie)) { |
a1617c8c SB |
787 | //printk("return error out, len:%d\n", len); |
788 | return -EINVAL; | |
8fc8598e JC |
789 | } |
790 | ||
791 | ||
c3fb338a | 792 | if (len) { |
f401441d | 793 | if (len != ie[1] + 2) { |
3d8affc0 | 794 | printk("len:%zu, ie:%d\n", len, ie[1]); |
8fc8598e JC |
795 | return -EINVAL; |
796 | } | |
94002c07 | 797 | buf = kmemdup(ie, len, GFP_KERNEL); |
deabe035 | 798 | if (!buf) |
8fc8598e | 799 | return -ENOMEM; |
8fc8598e JC |
800 | kfree(ieee->wpa_ie); |
801 | ieee->wpa_ie = buf; | |
802 | ieee->wpa_ie_len = len; | |
c3fb338a | 803 | } else { |
8fc8598e JC |
804 | kfree(ieee->wpa_ie); |
805 | ieee->wpa_ie = NULL; | |
806 | ieee->wpa_ie_len = 0; | |
807 | } | |
8fc8598e | 808 | return 0; |
8fc8598e | 809 | } |
8fc8598e | 810 | EXPORT_SYMBOL(ieee80211_wx_set_gen_ie); |