ieee80211_ioctl.c 29 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132
  1. /*
  2. * Copyright 2002-2005, Instant802 Networks, Inc.
  3. * Copyright 2005-2006, Devicescape Software, Inc.
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License version 2 as
  7. * published by the Free Software Foundation.
  8. */
  9. #include <linux/module.h>
  10. #include <linux/init.h>
  11. #include <linux/netdevice.h>
  12. #include <linux/types.h>
  13. #include <linux/slab.h>
  14. #include <linux/skbuff.h>
  15. #include <linux/etherdevice.h>
  16. #include <linux/if_arp.h>
  17. #include <linux/wireless.h>
  18. #include <net/iw_handler.h>
  19. #include <asm/uaccess.h>
  20. #include <net/mac80211.h>
  21. #include "ieee80211_i.h"
  22. #include "ieee80211_rate.h"
  23. #include "wpa.h"
  24. #include "aes_ccm.h"
  25. static int ieee80211_set_encryption(struct net_device *dev, u8 *sta_addr,
  26. int idx, int alg, int remove,
  27. int set_tx_key, const u8 *_key,
  28. size_t key_len)
  29. {
  30. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  31. int ret = 0;
  32. struct sta_info *sta;
  33. struct ieee80211_key *key;
  34. struct ieee80211_sub_if_data *sdata;
  35. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  36. if (idx < 0 || idx >= NUM_DEFAULT_KEYS) {
  37. printk(KERN_DEBUG "%s: set_encrypt - invalid idx=%d\n",
  38. dev->name, idx);
  39. return -EINVAL;
  40. }
  41. if (is_broadcast_ether_addr(sta_addr)) {
  42. sta = NULL;
  43. key = sdata->keys[idx];
  44. } else {
  45. set_tx_key = 0;
  46. /*
  47. * According to the standard, the key index of a pairwise
  48. * key must be zero. However, some AP are broken when it
  49. * comes to WEP key indices, so we work around this.
  50. */
  51. if (idx != 0 && alg != ALG_WEP) {
  52. printk(KERN_DEBUG "%s: set_encrypt - non-zero idx for "
  53. "individual key\n", dev->name);
  54. return -EINVAL;
  55. }
  56. sta = sta_info_get(local, sta_addr);
  57. if (!sta) {
  58. #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
  59. DECLARE_MAC_BUF(mac);
  60. printk(KERN_DEBUG "%s: set_encrypt - unknown addr "
  61. "%s\n",
  62. dev->name, print_mac(mac, sta_addr));
  63. #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
  64. return -ENOENT;
  65. }
  66. key = sta->key;
  67. }
  68. if (remove) {
  69. ieee80211_key_free(key);
  70. key = NULL;
  71. } else {
  72. /*
  73. * Automatically frees any old key if present.
  74. */
  75. key = ieee80211_key_alloc(sdata, sta, alg, idx, key_len, _key);
  76. if (!key) {
  77. ret = -ENOMEM;
  78. goto err_out;
  79. }
  80. }
  81. if (set_tx_key || (!sta && !sdata->default_key && key))
  82. ieee80211_set_default_key(sdata, idx);
  83. ret = 0;
  84. err_out:
  85. if (sta)
  86. sta_info_put(sta);
  87. return ret;
  88. }
  89. static int ieee80211_ioctl_siwgenie(struct net_device *dev,
  90. struct iw_request_info *info,
  91. struct iw_point *data, char *extra)
  92. {
  93. struct ieee80211_sub_if_data *sdata;
  94. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  95. if (sdata->flags & IEEE80211_SDATA_USERSPACE_MLME)
  96. return -EOPNOTSUPP;
  97. if (sdata->type == IEEE80211_IF_TYPE_STA ||
  98. sdata->type == IEEE80211_IF_TYPE_IBSS) {
  99. int ret = ieee80211_sta_set_extra_ie(dev, extra, data->length);
  100. if (ret)
  101. return ret;
  102. sdata->u.sta.flags &= ~IEEE80211_STA_AUTO_BSSID_SEL;
  103. ieee80211_sta_req_auth(dev, &sdata->u.sta);
  104. return 0;
  105. }
  106. return -EOPNOTSUPP;
  107. }
  108. static int ieee80211_ioctl_giwname(struct net_device *dev,
  109. struct iw_request_info *info,
  110. char *name, char *extra)
  111. {
  112. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  113. switch (local->hw.conf.phymode) {
  114. case MODE_IEEE80211A:
  115. strcpy(name, "IEEE 802.11a");
  116. break;
  117. case MODE_IEEE80211B:
  118. strcpy(name, "IEEE 802.11b");
  119. break;
  120. case MODE_IEEE80211G:
  121. strcpy(name, "IEEE 802.11g");
  122. break;
  123. default:
  124. strcpy(name, "IEEE 802.11");
  125. break;
  126. }
  127. return 0;
  128. }
  129. static int ieee80211_ioctl_giwrange(struct net_device *dev,
  130. struct iw_request_info *info,
  131. struct iw_point *data, char *extra)
  132. {
  133. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  134. struct iw_range *range = (struct iw_range *) extra;
  135. struct ieee80211_hw_mode *mode = NULL;
  136. int c = 0;
  137. data->length = sizeof(struct iw_range);
  138. memset(range, 0, sizeof(struct iw_range));
  139. range->we_version_compiled = WIRELESS_EXT;
  140. range->we_version_source = 21;
  141. range->retry_capa = IW_RETRY_LIMIT;
  142. range->retry_flags = IW_RETRY_LIMIT;
  143. range->min_retry = 0;
  144. range->max_retry = 255;
  145. range->min_rts = 0;
  146. range->max_rts = 2347;
  147. range->min_frag = 256;
  148. range->max_frag = 2346;
  149. range->encoding_size[0] = 5;
  150. range->encoding_size[1] = 13;
  151. range->num_encoding_sizes = 2;
  152. range->max_encoding_tokens = NUM_DEFAULT_KEYS;
  153. range->max_qual.qual = local->hw.max_signal;
  154. range->max_qual.level = local->hw.max_rssi;
  155. range->max_qual.noise = local->hw.max_noise;
  156. range->max_qual.updated = local->wstats_flags;
  157. range->avg_qual.qual = local->hw.max_signal/2;
  158. range->avg_qual.level = 0;
  159. range->avg_qual.noise = 0;
  160. range->avg_qual.updated = local->wstats_flags;
  161. range->enc_capa = IW_ENC_CAPA_WPA | IW_ENC_CAPA_WPA2 |
  162. IW_ENC_CAPA_CIPHER_TKIP | IW_ENC_CAPA_CIPHER_CCMP;
  163. list_for_each_entry(mode, &local->modes_list, list) {
  164. int i = 0;
  165. if (!(local->enabled_modes & (1 << mode->mode)) ||
  166. (local->hw_modes & local->enabled_modes &
  167. (1 << MODE_IEEE80211G) && mode->mode == MODE_IEEE80211B))
  168. continue;
  169. while (i < mode->num_channels && c < IW_MAX_FREQUENCIES) {
  170. struct ieee80211_channel *chan = &mode->channels[i];
  171. if (chan->flag & IEEE80211_CHAN_W_SCAN) {
  172. range->freq[c].i = chan->chan;
  173. range->freq[c].m = chan->freq * 100000;
  174. range->freq[c].e = 1;
  175. c++;
  176. }
  177. i++;
  178. }
  179. }
  180. range->num_channels = c;
  181. range->num_frequency = c;
  182. IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
  183. IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWTHRSPY);
  184. IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
  185. IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
  186. return 0;
  187. }
  188. static int ieee80211_ioctl_siwmode(struct net_device *dev,
  189. struct iw_request_info *info,
  190. __u32 *mode, char *extra)
  191. {
  192. struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  193. int type;
  194. if (sdata->type == IEEE80211_IF_TYPE_VLAN)
  195. return -EOPNOTSUPP;
  196. switch (*mode) {
  197. case IW_MODE_INFRA:
  198. type = IEEE80211_IF_TYPE_STA;
  199. break;
  200. case IW_MODE_ADHOC:
  201. type = IEEE80211_IF_TYPE_IBSS;
  202. break;
  203. case IW_MODE_MONITOR:
  204. type = IEEE80211_IF_TYPE_MNTR;
  205. break;
  206. default:
  207. return -EINVAL;
  208. }
  209. if (type == sdata->type)
  210. return 0;
  211. if (netif_running(dev))
  212. return -EBUSY;
  213. ieee80211_if_reinit(dev);
  214. ieee80211_if_set_type(dev, type);
  215. return 0;
  216. }
  217. static int ieee80211_ioctl_giwmode(struct net_device *dev,
  218. struct iw_request_info *info,
  219. __u32 *mode, char *extra)
  220. {
  221. struct ieee80211_sub_if_data *sdata;
  222. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  223. switch (sdata->type) {
  224. case IEEE80211_IF_TYPE_AP:
  225. *mode = IW_MODE_MASTER;
  226. break;
  227. case IEEE80211_IF_TYPE_STA:
  228. *mode = IW_MODE_INFRA;
  229. break;
  230. case IEEE80211_IF_TYPE_IBSS:
  231. *mode = IW_MODE_ADHOC;
  232. break;
  233. case IEEE80211_IF_TYPE_MNTR:
  234. *mode = IW_MODE_MONITOR;
  235. break;
  236. case IEEE80211_IF_TYPE_WDS:
  237. *mode = IW_MODE_REPEAT;
  238. break;
  239. case IEEE80211_IF_TYPE_VLAN:
  240. *mode = IW_MODE_SECOND; /* FIXME */
  241. break;
  242. default:
  243. *mode = IW_MODE_AUTO;
  244. break;
  245. }
  246. return 0;
  247. }
  248. int ieee80211_set_channel(struct ieee80211_local *local, int channel, int freq)
  249. {
  250. struct ieee80211_hw_mode *mode;
  251. int c, set = 0;
  252. int ret = -EINVAL;
  253. list_for_each_entry(mode, &local->modes_list, list) {
  254. if (!(local->enabled_modes & (1 << mode->mode)))
  255. continue;
  256. for (c = 0; c < mode->num_channels; c++) {
  257. struct ieee80211_channel *chan = &mode->channels[c];
  258. if (chan->flag & IEEE80211_CHAN_W_SCAN &&
  259. ((chan->chan == channel) || (chan->freq == freq))) {
  260. local->oper_channel = chan;
  261. local->oper_hw_mode = mode;
  262. set = 1;
  263. break;
  264. }
  265. }
  266. if (set)
  267. break;
  268. }
  269. if (set) {
  270. if (local->sta_scanning)
  271. ret = 0;
  272. else
  273. ret = ieee80211_hw_config(local);
  274. rate_control_clear(local);
  275. }
  276. return ret;
  277. }
  278. static int ieee80211_ioctl_siwfreq(struct net_device *dev,
  279. struct iw_request_info *info,
  280. struct iw_freq *freq, char *extra)
  281. {
  282. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  283. struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  284. if (sdata->type == IEEE80211_IF_TYPE_STA)
  285. sdata->u.sta.flags &= ~IEEE80211_STA_AUTO_CHANNEL_SEL;
  286. /* freq->e == 0: freq->m = channel; otherwise freq = m * 10^e */
  287. if (freq->e == 0) {
  288. if (freq->m < 0) {
  289. if (sdata->type == IEEE80211_IF_TYPE_STA)
  290. sdata->u.sta.flags |=
  291. IEEE80211_STA_AUTO_CHANNEL_SEL;
  292. return 0;
  293. } else
  294. return ieee80211_set_channel(local, freq->m, -1);
  295. } else {
  296. int i, div = 1000000;
  297. for (i = 0; i < freq->e; i++)
  298. div /= 10;
  299. if (div > 0)
  300. return ieee80211_set_channel(local, -1, freq->m / div);
  301. else
  302. return -EINVAL;
  303. }
  304. }
  305. static int ieee80211_ioctl_giwfreq(struct net_device *dev,
  306. struct iw_request_info *info,
  307. struct iw_freq *freq, char *extra)
  308. {
  309. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  310. /* TODO: in station mode (Managed/Ad-hoc) might need to poll low-level
  311. * driver for the current channel with firmware-based management */
  312. freq->m = local->hw.conf.freq;
  313. freq->e = 6;
  314. return 0;
  315. }
  316. static int ieee80211_ioctl_siwessid(struct net_device *dev,
  317. struct iw_request_info *info,
  318. struct iw_point *data, char *ssid)
  319. {
  320. struct ieee80211_sub_if_data *sdata;
  321. size_t len = data->length;
  322. /* iwconfig uses nul termination in SSID.. */
  323. if (len > 0 && ssid[len - 1] == '\0')
  324. len--;
  325. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  326. if (sdata->type == IEEE80211_IF_TYPE_STA ||
  327. sdata->type == IEEE80211_IF_TYPE_IBSS) {
  328. int ret;
  329. if (sdata->flags & IEEE80211_SDATA_USERSPACE_MLME) {
  330. if (len > IEEE80211_MAX_SSID_LEN)
  331. return -EINVAL;
  332. memcpy(sdata->u.sta.ssid, ssid, len);
  333. sdata->u.sta.ssid_len = len;
  334. return 0;
  335. }
  336. if (data->flags)
  337. sdata->u.sta.flags &= ~IEEE80211_STA_AUTO_SSID_SEL;
  338. else
  339. sdata->u.sta.flags |= IEEE80211_STA_AUTO_SSID_SEL;
  340. ret = ieee80211_sta_set_ssid(dev, ssid, len);
  341. if (ret)
  342. return ret;
  343. ieee80211_sta_req_auth(dev, &sdata->u.sta);
  344. return 0;
  345. }
  346. if (sdata->type == IEEE80211_IF_TYPE_AP) {
  347. memcpy(sdata->u.ap.ssid, ssid, len);
  348. memset(sdata->u.ap.ssid + len, 0,
  349. IEEE80211_MAX_SSID_LEN - len);
  350. sdata->u.ap.ssid_len = len;
  351. return ieee80211_if_config(dev);
  352. }
  353. return -EOPNOTSUPP;
  354. }
  355. static int ieee80211_ioctl_giwessid(struct net_device *dev,
  356. struct iw_request_info *info,
  357. struct iw_point *data, char *ssid)
  358. {
  359. size_t len;
  360. struct ieee80211_sub_if_data *sdata;
  361. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  362. if (sdata->type == IEEE80211_IF_TYPE_STA ||
  363. sdata->type == IEEE80211_IF_TYPE_IBSS) {
  364. int res = ieee80211_sta_get_ssid(dev, ssid, &len);
  365. if (res == 0) {
  366. data->length = len;
  367. data->flags = 1;
  368. } else
  369. data->flags = 0;
  370. return res;
  371. }
  372. if (sdata->type == IEEE80211_IF_TYPE_AP) {
  373. len = sdata->u.ap.ssid_len;
  374. if (len > IW_ESSID_MAX_SIZE)
  375. len = IW_ESSID_MAX_SIZE;
  376. memcpy(ssid, sdata->u.ap.ssid, len);
  377. data->length = len;
  378. data->flags = 1;
  379. return 0;
  380. }
  381. return -EOPNOTSUPP;
  382. }
  383. static int ieee80211_ioctl_siwap(struct net_device *dev,
  384. struct iw_request_info *info,
  385. struct sockaddr *ap_addr, char *extra)
  386. {
  387. struct ieee80211_sub_if_data *sdata;
  388. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  389. if (sdata->type == IEEE80211_IF_TYPE_STA ||
  390. sdata->type == IEEE80211_IF_TYPE_IBSS) {
  391. int ret;
  392. if (sdata->flags & IEEE80211_SDATA_USERSPACE_MLME) {
  393. memcpy(sdata->u.sta.bssid, (u8 *) &ap_addr->sa_data,
  394. ETH_ALEN);
  395. return 0;
  396. }
  397. if (is_zero_ether_addr((u8 *) &ap_addr->sa_data))
  398. sdata->u.sta.flags |= IEEE80211_STA_AUTO_BSSID_SEL |
  399. IEEE80211_STA_AUTO_CHANNEL_SEL;
  400. else if (is_broadcast_ether_addr((u8 *) &ap_addr->sa_data))
  401. sdata->u.sta.flags |= IEEE80211_STA_AUTO_BSSID_SEL;
  402. else
  403. sdata->u.sta.flags &= ~IEEE80211_STA_AUTO_BSSID_SEL;
  404. ret = ieee80211_sta_set_bssid(dev, (u8 *) &ap_addr->sa_data);
  405. if (ret)
  406. return ret;
  407. ieee80211_sta_req_auth(dev, &sdata->u.sta);
  408. return 0;
  409. } else if (sdata->type == IEEE80211_IF_TYPE_WDS) {
  410. if (memcmp(sdata->u.wds.remote_addr, (u8 *) &ap_addr->sa_data,
  411. ETH_ALEN) == 0)
  412. return 0;
  413. return ieee80211_if_update_wds(dev, (u8 *) &ap_addr->sa_data);
  414. }
  415. return -EOPNOTSUPP;
  416. }
  417. static int ieee80211_ioctl_giwap(struct net_device *dev,
  418. struct iw_request_info *info,
  419. struct sockaddr *ap_addr, char *extra)
  420. {
  421. struct ieee80211_sub_if_data *sdata;
  422. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  423. if (sdata->type == IEEE80211_IF_TYPE_STA ||
  424. sdata->type == IEEE80211_IF_TYPE_IBSS) {
  425. ap_addr->sa_family = ARPHRD_ETHER;
  426. memcpy(&ap_addr->sa_data, sdata->u.sta.bssid, ETH_ALEN);
  427. return 0;
  428. } else if (sdata->type == IEEE80211_IF_TYPE_WDS) {
  429. ap_addr->sa_family = ARPHRD_ETHER;
  430. memcpy(&ap_addr->sa_data, sdata->u.wds.remote_addr, ETH_ALEN);
  431. return 0;
  432. }
  433. return -EOPNOTSUPP;
  434. }
  435. static int ieee80211_ioctl_siwscan(struct net_device *dev,
  436. struct iw_request_info *info,
  437. union iwreq_data *wrqu, char *extra)
  438. {
  439. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  440. struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  441. struct iw_scan_req *req = NULL;
  442. u8 *ssid = NULL;
  443. size_t ssid_len = 0;
  444. if (!netif_running(dev))
  445. return -ENETDOWN;
  446. if (wrqu->data.length == sizeof(struct iw_scan_req) &&
  447. wrqu->data.flags & IW_SCAN_THIS_ESSID) {
  448. req = (struct iw_scan_req *)extra;
  449. ssid = req->essid;
  450. ssid_len = req->essid_len;
  451. } else {
  452. switch (sdata->type) {
  453. case IEEE80211_IF_TYPE_STA:
  454. case IEEE80211_IF_TYPE_IBSS:
  455. if (local->scan_flags & IEEE80211_SCAN_MATCH_SSID) {
  456. ssid = sdata->u.sta.ssid;
  457. ssid_len = sdata->u.sta.ssid_len;
  458. }
  459. break;
  460. case IEEE80211_IF_TYPE_AP:
  461. if (local->scan_flags & IEEE80211_SCAN_MATCH_SSID) {
  462. ssid = sdata->u.ap.ssid;
  463. ssid_len = sdata->u.ap.ssid_len;
  464. }
  465. break;
  466. default:
  467. return -EOPNOTSUPP;
  468. }
  469. }
  470. return ieee80211_sta_req_scan(dev, ssid, ssid_len);
  471. }
  472. static int ieee80211_ioctl_giwscan(struct net_device *dev,
  473. struct iw_request_info *info,
  474. struct iw_point *data, char *extra)
  475. {
  476. int res;
  477. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  478. if (local->sta_scanning)
  479. return -EAGAIN;
  480. res = ieee80211_sta_scan_results(dev, extra, data->length);
  481. if (res >= 0) {
  482. data->length = res;
  483. return 0;
  484. }
  485. data->length = 0;
  486. return res;
  487. }
  488. static int ieee80211_ioctl_siwrate(struct net_device *dev,
  489. struct iw_request_info *info,
  490. struct iw_param *rate, char *extra)
  491. {
  492. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  493. struct ieee80211_hw_mode *mode;
  494. int i;
  495. u32 target_rate = rate->value / 100000;
  496. struct ieee80211_sub_if_data *sdata;
  497. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  498. if (!sdata->bss)
  499. return -ENODEV;
  500. mode = local->oper_hw_mode;
  501. /* target_rate = -1, rate->fixed = 0 means auto only, so use all rates
  502. * target_rate = X, rate->fixed = 1 means only rate X
  503. * target_rate = X, rate->fixed = 0 means all rates <= X */
  504. sdata->bss->max_ratectrl_rateidx = -1;
  505. sdata->bss->force_unicast_rateidx = -1;
  506. if (rate->value < 0)
  507. return 0;
  508. for (i=0; i< mode->num_rates; i++) {
  509. struct ieee80211_rate *rates = &mode->rates[i];
  510. int this_rate = rates->rate;
  511. if (target_rate == this_rate) {
  512. sdata->bss->max_ratectrl_rateidx = i;
  513. if (rate->fixed)
  514. sdata->bss->force_unicast_rateidx = i;
  515. break;
  516. }
  517. }
  518. return 0;
  519. }
  520. static int ieee80211_ioctl_giwrate(struct net_device *dev,
  521. struct iw_request_info *info,
  522. struct iw_param *rate, char *extra)
  523. {
  524. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  525. struct sta_info *sta;
  526. struct ieee80211_sub_if_data *sdata;
  527. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  528. if (sdata->type == IEEE80211_IF_TYPE_STA)
  529. sta = sta_info_get(local, sdata->u.sta.bssid);
  530. else
  531. return -EOPNOTSUPP;
  532. if (!sta)
  533. return -ENODEV;
  534. if (sta->txrate < local->oper_hw_mode->num_rates)
  535. rate->value = local->oper_hw_mode->rates[sta->txrate].rate * 100000;
  536. else
  537. rate->value = 0;
  538. sta_info_put(sta);
  539. return 0;
  540. }
  541. static int ieee80211_ioctl_siwtxpower(struct net_device *dev,
  542. struct iw_request_info *info,
  543. union iwreq_data *data, char *extra)
  544. {
  545. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  546. bool need_reconfig = 0;
  547. if ((data->txpower.flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM)
  548. return -EINVAL;
  549. if (data->txpower.flags & IW_TXPOW_RANGE)
  550. return -EINVAL;
  551. if (!data->txpower.fixed)
  552. return -EINVAL;
  553. if (local->hw.conf.power_level != data->txpower.value) {
  554. local->hw.conf.power_level = data->txpower.value;
  555. need_reconfig = 1;
  556. }
  557. if (local->hw.conf.radio_enabled != !(data->txpower.disabled)) {
  558. local->hw.conf.radio_enabled = !(data->txpower.disabled);
  559. need_reconfig = 1;
  560. }
  561. if (need_reconfig) {
  562. ieee80211_hw_config(local);
  563. /* The return value of hw_config is not of big interest here,
  564. * as it doesn't say that it failed because of _this_ config
  565. * change or something else. Ignore it. */
  566. }
  567. return 0;
  568. }
  569. static int ieee80211_ioctl_giwtxpower(struct net_device *dev,
  570. struct iw_request_info *info,
  571. union iwreq_data *data, char *extra)
  572. {
  573. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  574. data->txpower.fixed = 1;
  575. data->txpower.disabled = !(local->hw.conf.radio_enabled);
  576. data->txpower.value = local->hw.conf.power_level;
  577. data->txpower.flags = IW_TXPOW_DBM;
  578. return 0;
  579. }
  580. static int ieee80211_ioctl_siwrts(struct net_device *dev,
  581. struct iw_request_info *info,
  582. struct iw_param *rts, char *extra)
  583. {
  584. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  585. if (rts->disabled)
  586. local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD;
  587. else if (rts->value < 0 || rts->value > IEEE80211_MAX_RTS_THRESHOLD)
  588. return -EINVAL;
  589. else
  590. local->rts_threshold = rts->value;
  591. /* If the wlan card performs RTS/CTS in hardware/firmware,
  592. * configure it here */
  593. if (local->ops->set_rts_threshold)
  594. local->ops->set_rts_threshold(local_to_hw(local),
  595. local->rts_threshold);
  596. return 0;
  597. }
  598. static int ieee80211_ioctl_giwrts(struct net_device *dev,
  599. struct iw_request_info *info,
  600. struct iw_param *rts, char *extra)
  601. {
  602. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  603. rts->value = local->rts_threshold;
  604. rts->disabled = (rts->value >= IEEE80211_MAX_RTS_THRESHOLD);
  605. rts->fixed = 1;
  606. return 0;
  607. }
  608. static int ieee80211_ioctl_siwfrag(struct net_device *dev,
  609. struct iw_request_info *info,
  610. struct iw_param *frag, char *extra)
  611. {
  612. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  613. if (frag->disabled)
  614. local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD;
  615. else if (frag->value < 256 ||
  616. frag->value > IEEE80211_MAX_FRAG_THRESHOLD)
  617. return -EINVAL;
  618. else {
  619. /* Fragment length must be even, so strip LSB. */
  620. local->fragmentation_threshold = frag->value & ~0x1;
  621. }
  622. /* If the wlan card performs fragmentation in hardware/firmware,
  623. * configure it here */
  624. if (local->ops->set_frag_threshold)
  625. local->ops->set_frag_threshold(
  626. local_to_hw(local),
  627. local->fragmentation_threshold);
  628. return 0;
  629. }
  630. static int ieee80211_ioctl_giwfrag(struct net_device *dev,
  631. struct iw_request_info *info,
  632. struct iw_param *frag, char *extra)
  633. {
  634. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  635. frag->value = local->fragmentation_threshold;
  636. frag->disabled = (frag->value >= IEEE80211_MAX_RTS_THRESHOLD);
  637. frag->fixed = 1;
  638. return 0;
  639. }
  640. static int ieee80211_ioctl_siwretry(struct net_device *dev,
  641. struct iw_request_info *info,
  642. struct iw_param *retry, char *extra)
  643. {
  644. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  645. if (retry->disabled ||
  646. (retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
  647. return -EINVAL;
  648. if (retry->flags & IW_RETRY_MAX)
  649. local->long_retry_limit = retry->value;
  650. else if (retry->flags & IW_RETRY_MIN)
  651. local->short_retry_limit = retry->value;
  652. else {
  653. local->long_retry_limit = retry->value;
  654. local->short_retry_limit = retry->value;
  655. }
  656. if (local->ops->set_retry_limit) {
  657. return local->ops->set_retry_limit(
  658. local_to_hw(local),
  659. local->short_retry_limit,
  660. local->long_retry_limit);
  661. }
  662. return 0;
  663. }
  664. static int ieee80211_ioctl_giwretry(struct net_device *dev,
  665. struct iw_request_info *info,
  666. struct iw_param *retry, char *extra)
  667. {
  668. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  669. retry->disabled = 0;
  670. if (retry->flags == 0 || retry->flags & IW_RETRY_MIN) {
  671. /* first return min value, iwconfig will ask max value
  672. * later if needed */
  673. retry->flags |= IW_RETRY_LIMIT;
  674. retry->value = local->short_retry_limit;
  675. if (local->long_retry_limit != local->short_retry_limit)
  676. retry->flags |= IW_RETRY_MIN;
  677. return 0;
  678. }
  679. if (retry->flags & IW_RETRY_MAX) {
  680. retry->flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
  681. retry->value = local->long_retry_limit;
  682. }
  683. return 0;
  684. }
  685. static int ieee80211_ioctl_siwmlme(struct net_device *dev,
  686. struct iw_request_info *info,
  687. struct iw_point *data, char *extra)
  688. {
  689. struct ieee80211_sub_if_data *sdata;
  690. struct iw_mlme *mlme = (struct iw_mlme *) extra;
  691. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  692. if (sdata->type != IEEE80211_IF_TYPE_STA &&
  693. sdata->type != IEEE80211_IF_TYPE_IBSS)
  694. return -EINVAL;
  695. switch (mlme->cmd) {
  696. case IW_MLME_DEAUTH:
  697. /* TODO: mlme->addr.sa_data */
  698. return ieee80211_sta_deauthenticate(dev, mlme->reason_code);
  699. case IW_MLME_DISASSOC:
  700. /* TODO: mlme->addr.sa_data */
  701. return ieee80211_sta_disassociate(dev, mlme->reason_code);
  702. default:
  703. return -EOPNOTSUPP;
  704. }
  705. }
  706. static int ieee80211_ioctl_siwencode(struct net_device *dev,
  707. struct iw_request_info *info,
  708. struct iw_point *erq, char *keybuf)
  709. {
  710. struct ieee80211_sub_if_data *sdata;
  711. int idx, i, alg = ALG_WEP;
  712. u8 bcaddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
  713. int remove = 0;
  714. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  715. idx = erq->flags & IW_ENCODE_INDEX;
  716. if (idx == 0) {
  717. if (sdata->default_key)
  718. for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
  719. if (sdata->default_key == sdata->keys[i]) {
  720. idx = i;
  721. break;
  722. }
  723. }
  724. } else if (idx < 1 || idx > 4)
  725. return -EINVAL;
  726. else
  727. idx--;
  728. if (erq->flags & IW_ENCODE_DISABLED)
  729. remove = 1;
  730. else if (erq->length == 0) {
  731. /* No key data - just set the default TX key index */
  732. ieee80211_set_default_key(sdata, idx);
  733. return 0;
  734. }
  735. return ieee80211_set_encryption(
  736. dev, bcaddr,
  737. idx, alg, remove,
  738. !sdata->default_key,
  739. keybuf, erq->length);
  740. }
  741. static int ieee80211_ioctl_giwencode(struct net_device *dev,
  742. struct iw_request_info *info,
  743. struct iw_point *erq, char *key)
  744. {
  745. struct ieee80211_sub_if_data *sdata;
  746. int idx, i;
  747. sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  748. idx = erq->flags & IW_ENCODE_INDEX;
  749. if (idx < 1 || idx > 4) {
  750. idx = -1;
  751. if (!sdata->default_key)
  752. idx = 0;
  753. else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
  754. if (sdata->default_key == sdata->keys[i]) {
  755. idx = i;
  756. break;
  757. }
  758. }
  759. if (idx < 0)
  760. return -EINVAL;
  761. } else
  762. idx--;
  763. erq->flags = idx + 1;
  764. if (!sdata->keys[idx]) {
  765. erq->length = 0;
  766. erq->flags |= IW_ENCODE_DISABLED;
  767. return 0;
  768. }
  769. memcpy(key, sdata->keys[idx]->conf.key,
  770. min_t(int, erq->length, sdata->keys[idx]->conf.keylen));
  771. erq->length = sdata->keys[idx]->conf.keylen;
  772. erq->flags |= IW_ENCODE_ENABLED;
  773. return 0;
  774. }
  775. static int ieee80211_ioctl_siwauth(struct net_device *dev,
  776. struct iw_request_info *info,
  777. struct iw_param *data, char *extra)
  778. {
  779. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  780. struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  781. int ret = 0;
  782. switch (data->flags & IW_AUTH_INDEX) {
  783. case IW_AUTH_WPA_VERSION:
  784. case IW_AUTH_CIPHER_PAIRWISE:
  785. case IW_AUTH_CIPHER_GROUP:
  786. case IW_AUTH_WPA_ENABLED:
  787. case IW_AUTH_RX_UNENCRYPTED_EAPOL:
  788. break;
  789. case IW_AUTH_KEY_MGMT:
  790. if (sdata->type != IEEE80211_IF_TYPE_STA)
  791. ret = -EINVAL;
  792. else {
  793. /*
  794. * Key management was set by wpa_supplicant,
  795. * we only need this to associate to a network
  796. * that has privacy enabled regardless of not
  797. * having a key.
  798. */
  799. sdata->u.sta.key_management_enabled = !!data->value;
  800. }
  801. break;
  802. case IW_AUTH_80211_AUTH_ALG:
  803. if (sdata->type == IEEE80211_IF_TYPE_STA ||
  804. sdata->type == IEEE80211_IF_TYPE_IBSS)
  805. sdata->u.sta.auth_algs = data->value;
  806. else
  807. ret = -EOPNOTSUPP;
  808. break;
  809. case IW_AUTH_PRIVACY_INVOKED:
  810. if (local->ops->set_privacy_invoked)
  811. ret = local->ops->set_privacy_invoked(
  812. local_to_hw(local), data->value);
  813. break;
  814. default:
  815. ret = -EOPNOTSUPP;
  816. break;
  817. }
  818. return ret;
  819. }
  820. /* Get wireless statistics. Called by /proc/net/wireless and by SIOCGIWSTATS */
  821. static struct iw_statistics *ieee80211_get_wireless_stats(struct net_device *dev)
  822. {
  823. struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
  824. struct iw_statistics *wstats = &local->wstats;
  825. struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  826. struct sta_info *sta = NULL;
  827. if (sdata->type == IEEE80211_IF_TYPE_STA ||
  828. sdata->type == IEEE80211_IF_TYPE_IBSS)
  829. sta = sta_info_get(local, sdata->u.sta.bssid);
  830. if (!sta) {
  831. wstats->discard.fragment = 0;
  832. wstats->discard.misc = 0;
  833. wstats->qual.qual = 0;
  834. wstats->qual.level = 0;
  835. wstats->qual.noise = 0;
  836. wstats->qual.updated = IW_QUAL_ALL_INVALID;
  837. } else {
  838. wstats->qual.level = sta->last_rssi;
  839. wstats->qual.qual = sta->last_signal;
  840. wstats->qual.noise = sta->last_noise;
  841. wstats->qual.updated = local->wstats_flags;
  842. sta_info_put(sta);
  843. }
  844. return wstats;
  845. }
  846. static int ieee80211_ioctl_giwauth(struct net_device *dev,
  847. struct iw_request_info *info,
  848. struct iw_param *data, char *extra)
  849. {
  850. struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  851. int ret = 0;
  852. switch (data->flags & IW_AUTH_INDEX) {
  853. case IW_AUTH_80211_AUTH_ALG:
  854. if (sdata->type == IEEE80211_IF_TYPE_STA ||
  855. sdata->type == IEEE80211_IF_TYPE_IBSS)
  856. data->value = sdata->u.sta.auth_algs;
  857. else
  858. ret = -EOPNOTSUPP;
  859. break;
  860. default:
  861. ret = -EOPNOTSUPP;
  862. break;
  863. }
  864. return ret;
  865. }
  866. static int ieee80211_ioctl_siwencodeext(struct net_device *dev,
  867. struct iw_request_info *info,
  868. struct iw_point *erq, char *extra)
  869. {
  870. struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
  871. struct iw_encode_ext *ext = (struct iw_encode_ext *) extra;
  872. int uninitialized_var(alg), idx, i, remove = 0;
  873. switch (ext->alg) {
  874. case IW_ENCODE_ALG_NONE:
  875. remove = 1;
  876. break;
  877. case IW_ENCODE_ALG_WEP:
  878. alg = ALG_WEP;
  879. break;
  880. case IW_ENCODE_ALG_TKIP:
  881. alg = ALG_TKIP;
  882. break;
  883. case IW_ENCODE_ALG_CCMP:
  884. alg = ALG_CCMP;
  885. break;
  886. default:
  887. return -EOPNOTSUPP;
  888. }
  889. if (erq->flags & IW_ENCODE_DISABLED)
  890. remove = 1;
  891. idx = erq->flags & IW_ENCODE_INDEX;
  892. if (idx < 1 || idx > 4) {
  893. idx = -1;
  894. if (!sdata->default_key)
  895. idx = 0;
  896. else for (i = 0; i < NUM_DEFAULT_KEYS; i++) {
  897. if (sdata->default_key == sdata->keys[i]) {
  898. idx = i;
  899. break;
  900. }
  901. }
  902. if (idx < 0)
  903. return -EINVAL;
  904. } else
  905. idx--;
  906. return ieee80211_set_encryption(dev, ext->addr.sa_data, idx, alg,
  907. remove,
  908. ext->ext_flags &
  909. IW_ENCODE_EXT_SET_TX_KEY,
  910. ext->key, ext->key_len);
  911. }
  912. /* Structures to export the Wireless Handlers */
  913. static const iw_handler ieee80211_handler[] =
  914. {
  915. (iw_handler) NULL, /* SIOCSIWCOMMIT */
  916. (iw_handler) ieee80211_ioctl_giwname, /* SIOCGIWNAME */
  917. (iw_handler) NULL, /* SIOCSIWNWID */
  918. (iw_handler) NULL, /* SIOCGIWNWID */
  919. (iw_handler) ieee80211_ioctl_siwfreq, /* SIOCSIWFREQ */
  920. (iw_handler) ieee80211_ioctl_giwfreq, /* SIOCGIWFREQ */
  921. (iw_handler) ieee80211_ioctl_siwmode, /* SIOCSIWMODE */
  922. (iw_handler) ieee80211_ioctl_giwmode, /* SIOCGIWMODE */
  923. (iw_handler) NULL, /* SIOCSIWSENS */
  924. (iw_handler) NULL, /* SIOCGIWSENS */
  925. (iw_handler) NULL /* not used */, /* SIOCSIWRANGE */
  926. (iw_handler) ieee80211_ioctl_giwrange, /* SIOCGIWRANGE */
  927. (iw_handler) NULL /* not used */, /* SIOCSIWPRIV */
  928. (iw_handler) NULL /* kernel code */, /* SIOCGIWPRIV */
  929. (iw_handler) NULL /* not used */, /* SIOCSIWSTATS */
  930. (iw_handler) NULL /* kernel code */, /* SIOCGIWSTATS */
  931. (iw_handler) NULL, /* SIOCSIWSPY */
  932. (iw_handler) NULL, /* SIOCGIWSPY */
  933. (iw_handler) NULL, /* SIOCSIWTHRSPY */
  934. (iw_handler) NULL, /* SIOCGIWTHRSPY */
  935. (iw_handler) ieee80211_ioctl_siwap, /* SIOCSIWAP */
  936. (iw_handler) ieee80211_ioctl_giwap, /* SIOCGIWAP */
  937. (iw_handler) ieee80211_ioctl_siwmlme, /* SIOCSIWMLME */
  938. (iw_handler) NULL, /* SIOCGIWAPLIST */
  939. (iw_handler) ieee80211_ioctl_siwscan, /* SIOCSIWSCAN */
  940. (iw_handler) ieee80211_ioctl_giwscan, /* SIOCGIWSCAN */
  941. (iw_handler) ieee80211_ioctl_siwessid, /* SIOCSIWESSID */
  942. (iw_handler) ieee80211_ioctl_giwessid, /* SIOCGIWESSID */
  943. (iw_handler) NULL, /* SIOCSIWNICKN */
  944. (iw_handler) NULL, /* SIOCGIWNICKN */
  945. (iw_handler) NULL, /* -- hole -- */
  946. (iw_handler) NULL, /* -- hole -- */
  947. (iw_handler) ieee80211_ioctl_siwrate, /* SIOCSIWRATE */
  948. (iw_handler) ieee80211_ioctl_giwrate, /* SIOCGIWRATE */
  949. (iw_handler) ieee80211_ioctl_siwrts, /* SIOCSIWRTS */
  950. (iw_handler) ieee80211_ioctl_giwrts, /* SIOCGIWRTS */
  951. (iw_handler) ieee80211_ioctl_siwfrag, /* SIOCSIWFRAG */
  952. (iw_handler) ieee80211_ioctl_giwfrag, /* SIOCGIWFRAG */
  953. (iw_handler) ieee80211_ioctl_siwtxpower, /* SIOCSIWTXPOW */
  954. (iw_handler) ieee80211_ioctl_giwtxpower, /* SIOCGIWTXPOW */
  955. (iw_handler) ieee80211_ioctl_siwretry, /* SIOCSIWRETRY */
  956. (iw_handler) ieee80211_ioctl_giwretry, /* SIOCGIWRETRY */
  957. (iw_handler) ieee80211_ioctl_siwencode, /* SIOCSIWENCODE */
  958. (iw_handler) ieee80211_ioctl_giwencode, /* SIOCGIWENCODE */
  959. (iw_handler) NULL, /* SIOCSIWPOWER */
  960. (iw_handler) NULL, /* SIOCGIWPOWER */
  961. (iw_handler) NULL, /* -- hole -- */
  962. (iw_handler) NULL, /* -- hole -- */
  963. (iw_handler) ieee80211_ioctl_siwgenie, /* SIOCSIWGENIE */
  964. (iw_handler) NULL, /* SIOCGIWGENIE */
  965. (iw_handler) ieee80211_ioctl_siwauth, /* SIOCSIWAUTH */
  966. (iw_handler) ieee80211_ioctl_giwauth, /* SIOCGIWAUTH */
  967. (iw_handler) ieee80211_ioctl_siwencodeext, /* SIOCSIWENCODEEXT */
  968. (iw_handler) NULL, /* SIOCGIWENCODEEXT */
  969. (iw_handler) NULL, /* SIOCSIWPMKSA */
  970. (iw_handler) NULL, /* -- hole -- */
  971. };
  972. const struct iw_handler_def ieee80211_iw_handler_def =
  973. {
  974. .num_standard = ARRAY_SIZE(ieee80211_handler),
  975. .standard = (iw_handler *) ieee80211_handler,
  976. .get_wireless_stats = ieee80211_get_wireless_stats,
  977. };