wext.c 29 KB

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