ieee80211_wx.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742
  1. /******************************************************************************
  2. Copyright(c) 2004-2005 Intel Corporation. All rights reserved.
  3. Portions of this file are based on the WEP enablement code provided by the
  4. Host AP project hostap-drivers v0.1.3
  5. Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen
  6. <jkmaline@cc.hut.fi>
  7. Copyright (c) 2002-2003, Jouni Malinen <jkmaline@cc.hut.fi>
  8. This program is free software; you can redistribute it and/or modify it
  9. under the terms of version 2 of the GNU General Public License as
  10. 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
  14. more details.
  15. You should have received a copy of the GNU General Public License along with
  16. this program; if not, write to the Free Software Foundation, Inc., 59
  17. Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  18. The full GNU General Public License is included in this distribution in the
  19. file called LICENSE.
  20. Contact Information:
  21. James P. Ketrenos <ipw2100-admin@linux.intel.com>
  22. Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  23. ******************************************************************************/
  24. #include <linux/kmod.h>
  25. #include <linux/module.h>
  26. #include <linux/jiffies.h>
  27. #include <net/ieee80211.h>
  28. #include <linux/wireless.h>
  29. static const char *ieee80211_modes[] = {
  30. "?", "a", "b", "ab", "g", "ag", "bg", "abg"
  31. };
  32. #define MAX_CUSTOM_LEN 64
  33. static char *ipw2100_translate_scan(struct ieee80211_device *ieee,
  34. char *start, char *stop,
  35. struct ieee80211_network *network)
  36. {
  37. char custom[MAX_CUSTOM_LEN];
  38. char *p;
  39. struct iw_event iwe;
  40. int i, j;
  41. u8 max_rate, rate;
  42. /* First entry *MUST* be the AP MAC address */
  43. iwe.cmd = SIOCGIWAP;
  44. iwe.u.ap_addr.sa_family = ARPHRD_ETHER;
  45. memcpy(iwe.u.ap_addr.sa_data, network->bssid, ETH_ALEN);
  46. start = iwe_stream_add_event(start, stop, &iwe, IW_EV_ADDR_LEN);
  47. /* Remaining entries will be displayed in the order we provide them */
  48. /* Add the ESSID */
  49. iwe.cmd = SIOCGIWESSID;
  50. iwe.u.data.flags = 1;
  51. if (network->flags & NETWORK_EMPTY_ESSID) {
  52. iwe.u.data.length = sizeof("<hidden>");
  53. start = iwe_stream_add_point(start, stop, &iwe, "<hidden>");
  54. } else {
  55. iwe.u.data.length = min(network->ssid_len, (u8) 32);
  56. start = iwe_stream_add_point(start, stop, &iwe, network->ssid);
  57. }
  58. /* Add the protocol name */
  59. iwe.cmd = SIOCGIWNAME;
  60. snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11%s",
  61. ieee80211_modes[network->mode]);
  62. start = iwe_stream_add_event(start, stop, &iwe, IW_EV_CHAR_LEN);
  63. /* Add mode */
  64. iwe.cmd = SIOCGIWMODE;
  65. if (network->capability & (WLAN_CAPABILITY_ESS | WLAN_CAPABILITY_IBSS)) {
  66. if (network->capability & WLAN_CAPABILITY_ESS)
  67. iwe.u.mode = IW_MODE_MASTER;
  68. else
  69. iwe.u.mode = IW_MODE_ADHOC;
  70. start = iwe_stream_add_event(start, stop, &iwe, IW_EV_UINT_LEN);
  71. }
  72. /* Add frequency/channel */
  73. iwe.cmd = SIOCGIWFREQ;
  74. /* iwe.u.freq.m = ieee80211_frequency(network->channel, network->mode);
  75. iwe.u.freq.e = 3; */
  76. iwe.u.freq.m = network->channel;
  77. iwe.u.freq.e = 0;
  78. iwe.u.freq.i = 0;
  79. start = iwe_stream_add_event(start, stop, &iwe, IW_EV_FREQ_LEN);
  80. /* Add encryption capability */
  81. iwe.cmd = SIOCGIWENCODE;
  82. if (network->capability & WLAN_CAPABILITY_PRIVACY)
  83. iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY;
  84. else
  85. iwe.u.data.flags = IW_ENCODE_DISABLED;
  86. iwe.u.data.length = 0;
  87. start = iwe_stream_add_point(start, stop, &iwe, network->ssid);
  88. /* Add basic and extended rates */
  89. max_rate = 0;
  90. p = custom;
  91. p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): ");
  92. for (i = 0, j = 0; i < network->rates_len;) {
  93. if (j < network->rates_ex_len &&
  94. ((network->rates_ex[j] & 0x7F) <
  95. (network->rates[i] & 0x7F)))
  96. rate = network->rates_ex[j++] & 0x7F;
  97. else
  98. rate = network->rates[i++] & 0x7F;
  99. if (rate > max_rate)
  100. max_rate = rate;
  101. p += snprintf(p, MAX_CUSTOM_LEN - (p - custom),
  102. "%d%s ", rate >> 1, (rate & 1) ? ".5" : "");
  103. }
  104. for (; j < network->rates_ex_len; j++) {
  105. rate = network->rates_ex[j] & 0x7F;
  106. p += snprintf(p, MAX_CUSTOM_LEN - (p - custom),
  107. "%d%s ", rate >> 1, (rate & 1) ? ".5" : "");
  108. if (rate > max_rate)
  109. max_rate = rate;
  110. }
  111. iwe.cmd = SIOCGIWRATE;
  112. iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0;
  113. iwe.u.bitrate.value = max_rate * 500000;
  114. start = iwe_stream_add_event(start, stop, &iwe, IW_EV_PARAM_LEN);
  115. iwe.cmd = IWEVCUSTOM;
  116. iwe.u.data.length = p - custom;
  117. if (iwe.u.data.length)
  118. start = iwe_stream_add_point(start, stop, &iwe, custom);
  119. /* Add quality statistics */
  120. iwe.cmd = IWEVQUAL;
  121. iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED |
  122. IW_QUAL_NOISE_UPDATED;
  123. if (!(network->stats.mask & IEEE80211_STATMASK_RSSI)) {
  124. iwe.u.qual.updated |= IW_QUAL_QUAL_INVALID |
  125. IW_QUAL_LEVEL_INVALID;
  126. iwe.u.qual.qual = 0;
  127. iwe.u.qual.level = 0;
  128. } else {
  129. iwe.u.qual.level = network->stats.rssi;
  130. if (ieee->perfect_rssi == ieee->worst_rssi)
  131. iwe.u.qual.qual = 100;
  132. else
  133. iwe.u.qual.qual =
  134. (100 *
  135. (ieee->perfect_rssi - ieee->worst_rssi) *
  136. (ieee->perfect_rssi - ieee->worst_rssi) -
  137. (ieee->perfect_rssi - network->stats.rssi) *
  138. (15 * (ieee->perfect_rssi - ieee->worst_rssi) +
  139. 62 * (ieee->perfect_rssi -
  140. network->stats.rssi))) /
  141. ((ieee->perfect_rssi -
  142. ieee->worst_rssi) * (ieee->perfect_rssi -
  143. ieee->worst_rssi));
  144. if (iwe.u.qual.qual > 100)
  145. iwe.u.qual.qual = 100;
  146. else if (iwe.u.qual.qual < 1)
  147. iwe.u.qual.qual = 0;
  148. }
  149. if (!(network->stats.mask & IEEE80211_STATMASK_NOISE)) {
  150. iwe.u.qual.updated |= IW_QUAL_NOISE_INVALID;
  151. iwe.u.qual.noise = 0;
  152. } else {
  153. iwe.u.qual.noise = network->stats.noise;
  154. }
  155. start = iwe_stream_add_event(start, stop, &iwe, IW_EV_QUAL_LEN);
  156. iwe.cmd = IWEVCUSTOM;
  157. p = custom;
  158. iwe.u.data.length = p - custom;
  159. if (iwe.u.data.length)
  160. start = iwe_stream_add_point(start, stop, &iwe, custom);
  161. if (network->wpa_ie_len) {
  162. char buf[MAX_WPA_IE_LEN * 2 + 30];
  163. u8 *p = buf;
  164. p += sprintf(p, "wpa_ie=");
  165. for (i = 0; i < network->wpa_ie_len; i++) {
  166. p += sprintf(p, "%02x", network->wpa_ie[i]);
  167. }
  168. memset(&iwe, 0, sizeof(iwe));
  169. iwe.cmd = IWEVCUSTOM;
  170. iwe.u.data.length = strlen(buf);
  171. start = iwe_stream_add_point(start, stop, &iwe, buf);
  172. }
  173. if (network->rsn_ie_len) {
  174. char buf[MAX_WPA_IE_LEN * 2 + 30];
  175. u8 *p = buf;
  176. p += sprintf(p, "rsn_ie=");
  177. for (i = 0; i < network->rsn_ie_len; i++) {
  178. p += sprintf(p, "%02x", network->rsn_ie[i]);
  179. }
  180. memset(&iwe, 0, sizeof(iwe));
  181. iwe.cmd = IWEVCUSTOM;
  182. iwe.u.data.length = strlen(buf);
  183. start = iwe_stream_add_point(start, stop, &iwe, buf);
  184. }
  185. /* Add EXTRA: Age to display seconds since last beacon/probe response
  186. * for given network. */
  187. iwe.cmd = IWEVCUSTOM;
  188. p = custom;
  189. p += snprintf(p, MAX_CUSTOM_LEN - (p - custom),
  190. " Last beacon: %dms ago",
  191. jiffies_to_msecs(jiffies - network->last_scanned));
  192. iwe.u.data.length = p - custom;
  193. if (iwe.u.data.length)
  194. start = iwe_stream_add_point(start, stop, &iwe, custom);
  195. return start;
  196. }
  197. #define SCAN_ITEM_SIZE 128
  198. int ieee80211_wx_get_scan(struct ieee80211_device *ieee,
  199. struct iw_request_info *info,
  200. union iwreq_data *wrqu, char *extra)
  201. {
  202. struct ieee80211_network *network;
  203. unsigned long flags;
  204. int err = 0;
  205. char *ev = extra;
  206. char *stop = ev + wrqu->data.length;
  207. int i = 0;
  208. IEEE80211_DEBUG_WX("Getting scan\n");
  209. spin_lock_irqsave(&ieee->lock, flags);
  210. list_for_each_entry(network, &ieee->network_list, list) {
  211. i++;
  212. if (stop - ev < SCAN_ITEM_SIZE) {
  213. err = -E2BIG;
  214. break;
  215. }
  216. if (ieee->scan_age == 0 ||
  217. time_after(network->last_scanned + ieee->scan_age, jiffies))
  218. ev = ipw2100_translate_scan(ieee, ev, stop, network);
  219. else
  220. IEEE80211_DEBUG_SCAN("Not showing network '%s ("
  221. MAC_FMT ")' due to age (%dms).\n",
  222. escape_essid(network->ssid,
  223. network->ssid_len),
  224. MAC_ARG(network->bssid),
  225. jiffies_to_msecs(jiffies -
  226. network->
  227. last_scanned));
  228. }
  229. spin_unlock_irqrestore(&ieee->lock, flags);
  230. wrqu->data.length = ev - extra;
  231. wrqu->data.flags = 0;
  232. IEEE80211_DEBUG_WX("exit: %d networks returned.\n", i);
  233. return err;
  234. }
  235. int ieee80211_wx_set_encode(struct ieee80211_device *ieee,
  236. struct iw_request_info *info,
  237. union iwreq_data *wrqu, char *keybuf)
  238. {
  239. struct iw_point *erq = &(wrqu->encoding);
  240. struct net_device *dev = ieee->dev;
  241. struct ieee80211_security sec = {
  242. .flags = 0
  243. };
  244. int i, key, key_provided, len;
  245. struct ieee80211_crypt_data **crypt;
  246. int host_crypto = ieee->host_encrypt || ieee->host_decrypt || ieee->host_build_iv;
  247. IEEE80211_DEBUG_WX("SET_ENCODE\n");
  248. key = erq->flags & IW_ENCODE_INDEX;
  249. if (key) {
  250. if (key > WEP_KEYS)
  251. return -EINVAL;
  252. key--;
  253. key_provided = 1;
  254. } else {
  255. key_provided = 0;
  256. key = ieee->tx_keyidx;
  257. }
  258. IEEE80211_DEBUG_WX("Key: %d [%s]\n", key, key_provided ?
  259. "provided" : "default");
  260. crypt = &ieee->crypt[key];
  261. if (erq->flags & IW_ENCODE_DISABLED) {
  262. if (key_provided && *crypt) {
  263. IEEE80211_DEBUG_WX("Disabling encryption on key %d.\n",
  264. key);
  265. ieee80211_crypt_delayed_deinit(ieee, crypt);
  266. } else
  267. IEEE80211_DEBUG_WX("Disabling encryption.\n");
  268. /* Check all the keys to see if any are still configured,
  269. * and if no key index was provided, de-init them all */
  270. for (i = 0; i < WEP_KEYS; i++) {
  271. if (ieee->crypt[i] != NULL) {
  272. if (key_provided)
  273. break;
  274. ieee80211_crypt_delayed_deinit(ieee,
  275. &ieee->crypt[i]);
  276. }
  277. }
  278. if (i == WEP_KEYS) {
  279. sec.enabled = 0;
  280. sec.encrypt = 0;
  281. sec.level = SEC_LEVEL_0;
  282. sec.flags |= SEC_ENABLED | SEC_LEVEL | SEC_ENCRYPT;
  283. }
  284. goto done;
  285. }
  286. sec.enabled = 1;
  287. sec.encrypt = 1;
  288. sec.flags |= SEC_ENABLED | SEC_ENCRYPT;
  289. if (*crypt != NULL && (*crypt)->ops != NULL &&
  290. strcmp((*crypt)->ops->name, "WEP") != 0) {
  291. /* changing to use WEP; deinit previously used algorithm
  292. * on this key */
  293. ieee80211_crypt_delayed_deinit(ieee, crypt);
  294. }
  295. if (*crypt == NULL && host_crypto) {
  296. struct ieee80211_crypt_data *new_crypt;
  297. /* take WEP into use */
  298. new_crypt = kmalloc(sizeof(struct ieee80211_crypt_data),
  299. GFP_KERNEL);
  300. if (new_crypt == NULL)
  301. return -ENOMEM;
  302. memset(new_crypt, 0, sizeof(struct ieee80211_crypt_data));
  303. new_crypt->ops = ieee80211_get_crypto_ops("WEP");
  304. if (!new_crypt->ops) {
  305. request_module("ieee80211_crypt_wep");
  306. new_crypt->ops = ieee80211_get_crypto_ops("WEP");
  307. }
  308. if (new_crypt->ops && try_module_get(new_crypt->ops->owner))
  309. new_crypt->priv = new_crypt->ops->init(key);
  310. if (!new_crypt->ops || !new_crypt->priv) {
  311. kfree(new_crypt);
  312. new_crypt = NULL;
  313. printk(KERN_WARNING "%s: could not initialize WEP: "
  314. "load module ieee80211_crypt_wep\n", dev->name);
  315. return -EOPNOTSUPP;
  316. }
  317. *crypt = new_crypt;
  318. }
  319. /* If a new key was provided, set it up */
  320. if (erq->length > 0) {
  321. len = erq->length <= 5 ? 5 : 13;
  322. memcpy(sec.keys[key], keybuf, erq->length);
  323. if (len > erq->length)
  324. memset(sec.keys[key] + erq->length, 0,
  325. len - erq->length);
  326. IEEE80211_DEBUG_WX("Setting key %d to '%s' (%d:%d bytes)\n",
  327. key, escape_essid(sec.keys[key], len),
  328. erq->length, len);
  329. sec.key_sizes[key] = len;
  330. if (*crypt)
  331. (*crypt)->ops->set_key(sec.keys[key], len, NULL,
  332. (*crypt)->priv);
  333. sec.flags |= (1 << key);
  334. /* This ensures a key will be activated if no key is
  335. * explicitely set */
  336. if (key == sec.active_key)
  337. sec.flags |= SEC_ACTIVE_KEY;
  338. } else {
  339. if (host_crypto) {
  340. len = (*crypt)->ops->get_key(sec.keys[key], WEP_KEY_LEN,
  341. NULL, (*crypt)->priv);
  342. if (len == 0) {
  343. /* Set a default key of all 0 */
  344. IEEE80211_DEBUG_WX("Setting key %d to all "
  345. "zero.\n", key);
  346. memset(sec.keys[key], 0, 13);
  347. (*crypt)->ops->set_key(sec.keys[key], 13, NULL,
  348. (*crypt)->priv);
  349. sec.key_sizes[key] = 13;
  350. sec.flags |= (1 << key);
  351. }
  352. }
  353. /* No key data - just set the default TX key index */
  354. if (key_provided) {
  355. IEEE80211_DEBUG_WX("Setting key %d to default Tx "
  356. "key.\n", key);
  357. ieee->tx_keyidx = key;
  358. sec.active_key = key;
  359. sec.flags |= SEC_ACTIVE_KEY;
  360. }
  361. }
  362. if (erq->flags & (IW_ENCODE_OPEN | IW_ENCODE_RESTRICTED)) {
  363. ieee->open_wep = !(erq->flags & IW_ENCODE_RESTRICTED);
  364. sec.auth_mode = ieee->open_wep ? WLAN_AUTH_OPEN :
  365. WLAN_AUTH_SHARED_KEY;
  366. sec.flags |= SEC_AUTH_MODE;
  367. IEEE80211_DEBUG_WX("Auth: %s\n",
  368. sec.auth_mode == WLAN_AUTH_OPEN ?
  369. "OPEN" : "SHARED KEY");
  370. }
  371. /* For now we just support WEP, so only set that security level...
  372. * TODO: When WPA is added this is one place that needs to change */
  373. sec.flags |= SEC_LEVEL;
  374. sec.level = SEC_LEVEL_1; /* 40 and 104 bit WEP */
  375. sec.encode_alg[key] = SEC_ALG_WEP;
  376. done:
  377. if (ieee->set_security)
  378. ieee->set_security(dev, &sec);
  379. /* Do not reset port if card is in Managed mode since resetting will
  380. * generate new IEEE 802.11 authentication which may end up in looping
  381. * with IEEE 802.1X. If your hardware requires a reset after WEP
  382. * configuration (for example... Prism2), implement the reset_port in
  383. * the callbacks structures used to initialize the 802.11 stack. */
  384. if (ieee->reset_on_keychange &&
  385. ieee->iw_mode != IW_MODE_INFRA &&
  386. ieee->reset_port && ieee->reset_port(dev)) {
  387. printk(KERN_DEBUG "%s: reset_port failed\n", dev->name);
  388. return -EINVAL;
  389. }
  390. return 0;
  391. }
  392. int ieee80211_wx_get_encode(struct ieee80211_device *ieee,
  393. struct iw_request_info *info,
  394. union iwreq_data *wrqu, char *keybuf)
  395. {
  396. struct iw_point *erq = &(wrqu->encoding);
  397. int len, key;
  398. struct ieee80211_crypt_data *crypt;
  399. struct ieee80211_security *sec = &ieee->sec;
  400. IEEE80211_DEBUG_WX("GET_ENCODE\n");
  401. key = erq->flags & IW_ENCODE_INDEX;
  402. if (key) {
  403. if (key > WEP_KEYS)
  404. return -EINVAL;
  405. key--;
  406. } else
  407. key = ieee->tx_keyidx;
  408. crypt = ieee->crypt[key];
  409. erq->flags = key + 1;
  410. if (!sec->enabled) {
  411. erq->length = 0;
  412. erq->flags |= IW_ENCODE_DISABLED;
  413. return 0;
  414. }
  415. len = sec->key_sizes[key];
  416. memcpy(keybuf, sec->keys[key], len);
  417. erq->length = (len >= 0 ? len : 0);
  418. erq->flags |= IW_ENCODE_ENABLED;
  419. if (ieee->open_wep)
  420. erq->flags |= IW_ENCODE_OPEN;
  421. else
  422. erq->flags |= IW_ENCODE_RESTRICTED;
  423. return 0;
  424. }
  425. int ieee80211_wx_set_encodeext(struct ieee80211_device *ieee,
  426. struct iw_request_info *info,
  427. union iwreq_data *wrqu, char *extra)
  428. {
  429. struct net_device *dev = ieee->dev;
  430. struct iw_point *encoding = &wrqu->encoding;
  431. struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
  432. int i, idx, ret = 0;
  433. int group_key = 0;
  434. const char *alg, *module;
  435. struct ieee80211_crypto_ops *ops;
  436. struct ieee80211_crypt_data **crypt;
  437. struct ieee80211_security sec = {
  438. .flags = 0,
  439. };
  440. idx = encoding->flags & IW_ENCODE_INDEX;
  441. if (idx) {
  442. if (idx < 1 || idx > WEP_KEYS)
  443. return -EINVAL;
  444. idx--;
  445. } else
  446. idx = ieee->tx_keyidx;
  447. if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
  448. crypt = &ieee->crypt[idx];
  449. group_key = 1;
  450. } else {
  451. /* some Cisco APs use idx>0 for unicast in dynamic WEP */
  452. if (idx != 0 && ext->alg != IW_ENCODE_ALG_WEP)
  453. return -EINVAL;
  454. if (ieee->iw_mode == IW_MODE_INFRA)
  455. crypt = &ieee->crypt[idx];
  456. else
  457. return -EINVAL;
  458. }
  459. sec.flags |= SEC_ENABLED | SEC_ENCRYPT;
  460. if ((encoding->flags & IW_ENCODE_DISABLED) ||
  461. ext->alg == IW_ENCODE_ALG_NONE) {
  462. if (*crypt)
  463. ieee80211_crypt_delayed_deinit(ieee, crypt);
  464. for (i = 0; i < WEP_KEYS; i++)
  465. if (ieee->crypt[i] != NULL)
  466. break;
  467. if (i == WEP_KEYS) {
  468. sec.enabled = 0;
  469. sec.encrypt = 0;
  470. sec.level = SEC_LEVEL_0;
  471. sec.flags |= SEC_LEVEL;
  472. }
  473. goto done;
  474. }
  475. sec.enabled = 1;
  476. sec.encrypt = 1;
  477. if (group_key ? !ieee->host_mc_decrypt :
  478. !(ieee->host_encrypt || ieee->host_decrypt ||
  479. ieee->host_encrypt_msdu))
  480. goto skip_host_crypt;
  481. switch (ext->alg) {
  482. case IW_ENCODE_ALG_WEP:
  483. alg = "WEP";
  484. module = "ieee80211_crypt_wep";
  485. break;
  486. case IW_ENCODE_ALG_TKIP:
  487. alg = "TKIP";
  488. module = "ieee80211_crypt_tkip";
  489. break;
  490. case IW_ENCODE_ALG_CCMP:
  491. alg = "CCMP";
  492. module = "ieee80211_crypt_ccmp";
  493. break;
  494. default:
  495. IEEE80211_DEBUG_WX("%s: unknown crypto alg %d\n",
  496. dev->name, ext->alg);
  497. ret = -EINVAL;
  498. goto done;
  499. }
  500. ops = ieee80211_get_crypto_ops(alg);
  501. if (ops == NULL) {
  502. request_module(module);
  503. ops = ieee80211_get_crypto_ops(alg);
  504. }
  505. if (ops == NULL) {
  506. IEEE80211_DEBUG_WX("%s: unknown crypto alg %d\n",
  507. dev->name, ext->alg);
  508. ret = -EINVAL;
  509. goto done;
  510. }
  511. if (*crypt == NULL || (*crypt)->ops != ops) {
  512. struct ieee80211_crypt_data *new_crypt;
  513. ieee80211_crypt_delayed_deinit(ieee, crypt);
  514. new_crypt = (struct ieee80211_crypt_data *)
  515. kmalloc(sizeof(*new_crypt), GFP_KERNEL);
  516. if (new_crypt == NULL) {
  517. ret = -ENOMEM;
  518. goto done;
  519. }
  520. memset(new_crypt, 0, sizeof(struct ieee80211_crypt_data));
  521. new_crypt->ops = ops;
  522. if (new_crypt->ops && try_module_get(new_crypt->ops->owner))
  523. new_crypt->priv = new_crypt->ops->init(idx);
  524. if (new_crypt->priv == NULL) {
  525. kfree(new_crypt);
  526. ret = -EINVAL;
  527. goto done;
  528. }
  529. *crypt = new_crypt;
  530. }
  531. if (ext->key_len > 0 && (*crypt)->ops->set_key &&
  532. (*crypt)->ops->set_key(ext->key, ext->key_len, ext->rx_seq,
  533. (*crypt)->priv) < 0) {
  534. IEEE80211_DEBUG_WX("%s: key setting failed\n", dev->name);
  535. ret = -EINVAL;
  536. goto done;
  537. }
  538. skip_host_crypt:
  539. if (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY) {
  540. ieee->tx_keyidx = idx;
  541. sec.active_key = idx;
  542. sec.flags |= SEC_ACTIVE_KEY;
  543. }
  544. if (ext->alg != IW_ENCODE_ALG_NONE) {
  545. memcpy(sec.keys[idx], ext->key, ext->key_len);
  546. sec.key_sizes[idx] = ext->key_len;
  547. sec.flags |= (1 << idx);
  548. if (ext->alg == IW_ENCODE_ALG_WEP) {
  549. sec.encode_alg[idx] = SEC_ALG_WEP;
  550. sec.flags |= SEC_LEVEL;
  551. sec.level = SEC_LEVEL_1;
  552. } else if (ext->alg == IW_ENCODE_ALG_TKIP) {
  553. sec.encode_alg[idx] = SEC_ALG_TKIP;
  554. sec.flags |= SEC_LEVEL;
  555. sec.level = SEC_LEVEL_2;
  556. } else if (ext->alg == IW_ENCODE_ALG_CCMP) {
  557. sec.encode_alg[idx] = SEC_ALG_CCMP;
  558. sec.flags |= SEC_LEVEL;
  559. sec.level = SEC_LEVEL_3;
  560. }
  561. /* Don't set sec level for group keys. */
  562. if (group_key)
  563. sec.flags &= ~SEC_LEVEL;
  564. }
  565. done:
  566. if (ieee->set_security)
  567. ieee->set_security(ieee->dev, &sec);
  568. /*
  569. * Do not reset port if card is in Managed mode since resetting will
  570. * generate new IEEE 802.11 authentication which may end up in looping
  571. * with IEEE 802.1X. If your hardware requires a reset after WEP
  572. * configuration (for example... Prism2), implement the reset_port in
  573. * the callbacks structures used to initialize the 802.11 stack.
  574. */
  575. if (ieee->reset_on_keychange &&
  576. ieee->iw_mode != IW_MODE_INFRA &&
  577. ieee->reset_port && ieee->reset_port(dev)) {
  578. IEEE80211_DEBUG_WX("%s: reset_port failed\n", dev->name);
  579. return -EINVAL;
  580. }
  581. return ret;
  582. }
  583. int ieee80211_wx_get_encodeext(struct ieee80211_device *ieee,
  584. struct iw_request_info *info,
  585. union iwreq_data *wrqu, char *extra)
  586. {
  587. struct iw_point *encoding = &wrqu->encoding;
  588. struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
  589. struct ieee80211_security *sec = &ieee->sec;
  590. int idx, max_key_len;
  591. max_key_len = encoding->length - sizeof(*ext);
  592. if (max_key_len < 0)
  593. return -EINVAL;
  594. idx = encoding->flags & IW_ENCODE_INDEX;
  595. if (idx) {
  596. if (idx < 1 || idx > WEP_KEYS)
  597. return -EINVAL;
  598. idx--;
  599. } else
  600. idx = ieee->tx_keyidx;
  601. if (!ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY &&
  602. ext->alg != IW_ENCODE_ALG_WEP)
  603. if (idx != 0 || ieee->iw_mode != IW_MODE_INFRA)
  604. return -EINVAL;
  605. encoding->flags = idx + 1;
  606. memset(ext, 0, sizeof(*ext));
  607. if (!sec->enabled) {
  608. ext->alg = IW_ENCODE_ALG_NONE;
  609. ext->key_len = 0;
  610. encoding->flags |= IW_ENCODE_DISABLED;
  611. } else {
  612. if (sec->encode_alg[idx] == SEC_ALG_WEP)
  613. ext->alg = IW_ENCODE_ALG_WEP;
  614. else if (sec->encode_alg[idx] == SEC_ALG_TKIP)
  615. ext->alg = IW_ENCODE_ALG_TKIP;
  616. else if (sec->encode_alg[idx] == SEC_ALG_CCMP)
  617. ext->alg = IW_ENCODE_ALG_CCMP;
  618. else
  619. return -EINVAL;
  620. ext->key_len = sec->key_sizes[idx];
  621. memcpy(ext->key, sec->keys[idx], ext->key_len);
  622. encoding->flags |= IW_ENCODE_ENABLED;
  623. if (ext->key_len &&
  624. (ext->alg == IW_ENCODE_ALG_TKIP ||
  625. ext->alg == IW_ENCODE_ALG_CCMP))
  626. ext->ext_flags |= IW_ENCODE_EXT_TX_SEQ_VALID;
  627. }
  628. return 0;
  629. }
  630. EXPORT_SYMBOL(ieee80211_wx_set_encodeext);
  631. EXPORT_SYMBOL(ieee80211_wx_get_encodeext);
  632. EXPORT_SYMBOL(ieee80211_wx_get_scan);
  633. EXPORT_SYMBOL(ieee80211_wx_set_encode);
  634. EXPORT_SYMBOL(ieee80211_wx_get_encode);