PageRenderTime 1097ms CodeModel.GetById 17ms RepoModel.GetById 1ms app.codeStats 0ms

/drivers/staging/rtl8187se/ieee80211/ieee80211_wx.c

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