wext.c 29 KB

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