wext-compat.c 31 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277
  1. /*
  2. * cfg80211 - wext compat code
  3. *
  4. * This is temporary code until all wireless functionality is migrated
  5. * into cfg80211, when that happens all the exports here go away and
  6. * we directly assign the wireless handlers of wireless interfaces.
  7. *
  8. * Copyright 2008-2009 Johannes Berg <johannes@sipsolutions.net>
  9. */
  10. #include <linux/wireless.h>
  11. #include <linux/nl80211.h>
  12. #include <linux/if_arp.h>
  13. #include <linux/etherdevice.h>
  14. #include <net/iw_handler.h>
  15. #include <net/cfg80211.h>
  16. #include "core.h"
  17. int cfg80211_wext_giwname(struct net_device *dev,
  18. struct iw_request_info *info,
  19. char *name, char *extra)
  20. {
  21. struct wireless_dev *wdev = dev->ieee80211_ptr;
  22. struct ieee80211_supported_band *sband;
  23. bool is_ht = false, is_a = false, is_b = false, is_g = false;
  24. if (!wdev)
  25. return -EOPNOTSUPP;
  26. sband = wdev->wiphy->bands[IEEE80211_BAND_5GHZ];
  27. if (sband) {
  28. is_a = true;
  29. is_ht |= sband->ht_cap.ht_supported;
  30. }
  31. sband = wdev->wiphy->bands[IEEE80211_BAND_2GHZ];
  32. if (sband) {
  33. int i;
  34. /* Check for mandatory rates */
  35. for (i = 0; i < sband->n_bitrates; i++) {
  36. if (sband->bitrates[i].bitrate == 10)
  37. is_b = true;
  38. if (sband->bitrates[i].bitrate == 60)
  39. is_g = true;
  40. }
  41. is_ht |= sband->ht_cap.ht_supported;
  42. }
  43. strcpy(name, "IEEE 802.11");
  44. if (is_a)
  45. strcat(name, "a");
  46. if (is_b)
  47. strcat(name, "b");
  48. if (is_g)
  49. strcat(name, "g");
  50. if (is_ht)
  51. strcat(name, "n");
  52. return 0;
  53. }
  54. EXPORT_SYMBOL_GPL(cfg80211_wext_giwname);
  55. int cfg80211_wext_siwmode(struct net_device *dev, struct iw_request_info *info,
  56. u32 *mode, char *extra)
  57. {
  58. struct wireless_dev *wdev = dev->ieee80211_ptr;
  59. struct cfg80211_registered_device *rdev;
  60. struct vif_params vifparams;
  61. enum nl80211_iftype type;
  62. int ret;
  63. if (!wdev)
  64. return -EOPNOTSUPP;
  65. rdev = wiphy_to_dev(wdev->wiphy);
  66. if (!rdev->ops->change_virtual_intf)
  67. return -EOPNOTSUPP;
  68. /* don't support changing VLANs, you just re-create them */
  69. if (wdev->iftype == NL80211_IFTYPE_AP_VLAN)
  70. return -EOPNOTSUPP;
  71. switch (*mode) {
  72. case IW_MODE_INFRA:
  73. type = NL80211_IFTYPE_STATION;
  74. break;
  75. case IW_MODE_ADHOC:
  76. type = NL80211_IFTYPE_ADHOC;
  77. break;
  78. case IW_MODE_REPEAT:
  79. type = NL80211_IFTYPE_WDS;
  80. break;
  81. case IW_MODE_MONITOR:
  82. type = NL80211_IFTYPE_MONITOR;
  83. break;
  84. default:
  85. return -EINVAL;
  86. }
  87. if (type == wdev->iftype)
  88. return 0;
  89. memset(&vifparams, 0, sizeof(vifparams));
  90. ret = rdev->ops->change_virtual_intf(wdev->wiphy, dev, type,
  91. NULL, &vifparams);
  92. WARN_ON(!ret && wdev->iftype != type);
  93. return ret;
  94. }
  95. EXPORT_SYMBOL_GPL(cfg80211_wext_siwmode);
  96. int cfg80211_wext_giwmode(struct net_device *dev, struct iw_request_info *info,
  97. u32 *mode, char *extra)
  98. {
  99. struct wireless_dev *wdev = dev->ieee80211_ptr;
  100. if (!wdev)
  101. return -EOPNOTSUPP;
  102. switch (wdev->iftype) {
  103. case NL80211_IFTYPE_AP:
  104. *mode = IW_MODE_MASTER;
  105. break;
  106. case NL80211_IFTYPE_STATION:
  107. *mode = IW_MODE_INFRA;
  108. break;
  109. case NL80211_IFTYPE_ADHOC:
  110. *mode = IW_MODE_ADHOC;
  111. break;
  112. case NL80211_IFTYPE_MONITOR:
  113. *mode = IW_MODE_MONITOR;
  114. break;
  115. case NL80211_IFTYPE_WDS:
  116. *mode = IW_MODE_REPEAT;
  117. break;
  118. case NL80211_IFTYPE_AP_VLAN:
  119. *mode = IW_MODE_SECOND; /* FIXME */
  120. break;
  121. default:
  122. *mode = IW_MODE_AUTO;
  123. break;
  124. }
  125. return 0;
  126. }
  127. EXPORT_SYMBOL_GPL(cfg80211_wext_giwmode);
  128. int cfg80211_wext_giwrange(struct net_device *dev,
  129. struct iw_request_info *info,
  130. struct iw_point *data, char *extra)
  131. {
  132. struct wireless_dev *wdev = dev->ieee80211_ptr;
  133. struct iw_range *range = (struct iw_range *) extra;
  134. enum ieee80211_band band;
  135. int i, c = 0;
  136. if (!wdev)
  137. return -EOPNOTSUPP;
  138. data->length = sizeof(struct iw_range);
  139. memset(range, 0, sizeof(struct iw_range));
  140. range->we_version_compiled = WIRELESS_EXT;
  141. range->we_version_source = 21;
  142. range->retry_capa = IW_RETRY_LIMIT;
  143. range->retry_flags = IW_RETRY_LIMIT;
  144. range->min_retry = 0;
  145. range->max_retry = 255;
  146. range->min_rts = 0;
  147. range->max_rts = 2347;
  148. range->min_frag = 256;
  149. range->max_frag = 2346;
  150. range->max_encoding_tokens = 4;
  151. range->max_qual.updated = IW_QUAL_NOISE_INVALID;
  152. switch (wdev->wiphy->signal_type) {
  153. case CFG80211_SIGNAL_TYPE_NONE:
  154. break;
  155. case CFG80211_SIGNAL_TYPE_MBM:
  156. range->max_qual.level = -110;
  157. range->max_qual.qual = 70;
  158. range->avg_qual.qual = 35;
  159. range->max_qual.updated |= IW_QUAL_DBM;
  160. range->max_qual.updated |= IW_QUAL_QUAL_UPDATED;
  161. range->max_qual.updated |= IW_QUAL_LEVEL_UPDATED;
  162. break;
  163. case CFG80211_SIGNAL_TYPE_UNSPEC:
  164. range->max_qual.level = 100;
  165. range->max_qual.qual = 100;
  166. range->avg_qual.qual = 50;
  167. range->max_qual.updated |= IW_QUAL_QUAL_UPDATED;
  168. range->max_qual.updated |= IW_QUAL_LEVEL_UPDATED;
  169. break;
  170. }
  171. range->avg_qual.level = range->max_qual.level / 2;
  172. range->avg_qual.noise = range->max_qual.noise / 2;
  173. range->avg_qual.updated = range->max_qual.updated;
  174. for (i = 0; i < wdev->wiphy->n_cipher_suites; i++) {
  175. switch (wdev->wiphy->cipher_suites[i]) {
  176. case WLAN_CIPHER_SUITE_TKIP:
  177. range->enc_capa |= (IW_ENC_CAPA_CIPHER_TKIP |
  178. IW_ENC_CAPA_WPA);
  179. break;
  180. case WLAN_CIPHER_SUITE_CCMP:
  181. range->enc_capa |= (IW_ENC_CAPA_CIPHER_CCMP |
  182. IW_ENC_CAPA_WPA2);
  183. break;
  184. case WLAN_CIPHER_SUITE_WEP40:
  185. range->encoding_size[range->num_encoding_sizes++] =
  186. WLAN_KEY_LEN_WEP40;
  187. break;
  188. case WLAN_CIPHER_SUITE_WEP104:
  189. range->encoding_size[range->num_encoding_sizes++] =
  190. WLAN_KEY_LEN_WEP104;
  191. break;
  192. }
  193. }
  194. for (band = 0; band < IEEE80211_NUM_BANDS; band ++) {
  195. struct ieee80211_supported_band *sband;
  196. sband = wdev->wiphy->bands[band];
  197. if (!sband)
  198. continue;
  199. for (i = 0; i < sband->n_channels && c < IW_MAX_FREQUENCIES; i++) {
  200. struct ieee80211_channel *chan = &sband->channels[i];
  201. if (!(chan->flags & IEEE80211_CHAN_DISABLED)) {
  202. range->freq[c].i =
  203. ieee80211_frequency_to_channel(
  204. chan->center_freq);
  205. range->freq[c].m = chan->center_freq;
  206. range->freq[c].e = 6;
  207. c++;
  208. }
  209. }
  210. }
  211. range->num_channels = c;
  212. range->num_frequency = c;
  213. IW_EVENT_CAPA_SET_KERNEL(range->event_capa);
  214. IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWAP);
  215. IW_EVENT_CAPA_SET(range->event_capa, SIOCGIWSCAN);
  216. if (wdev->wiphy->max_scan_ssids > 0)
  217. range->scan_capa |= IW_SCAN_CAPA_ESSID;
  218. return 0;
  219. }
  220. EXPORT_SYMBOL_GPL(cfg80211_wext_giwrange);
  221. /**
  222. * cfg80211_wext_freq - get wext frequency for non-"auto"
  223. * @wiphy: the wiphy
  224. * @freq: the wext freq encoding
  225. *
  226. * Returns a channel, %NULL for auto, or an ERR_PTR for errors!
  227. */
  228. struct ieee80211_channel *cfg80211_wext_freq(struct wiphy *wiphy,
  229. struct iw_freq *freq)
  230. {
  231. struct ieee80211_channel *chan;
  232. int f;
  233. /*
  234. * Parse frequency - return NULL for auto and
  235. * -EINVAL for impossible things.
  236. */
  237. if (freq->e == 0) {
  238. if (freq->m < 0)
  239. return NULL;
  240. f = ieee80211_channel_to_frequency(freq->m);
  241. } else {
  242. int i, div = 1000000;
  243. for (i = 0; i < freq->e; i++)
  244. div /= 10;
  245. if (div <= 0)
  246. return ERR_PTR(-EINVAL);
  247. f = freq->m / div;
  248. }
  249. /*
  250. * Look up channel struct and return -EINVAL when
  251. * it cannot be found.
  252. */
  253. chan = ieee80211_get_channel(wiphy, f);
  254. if (!chan)
  255. return ERR_PTR(-EINVAL);
  256. return chan;
  257. }
  258. EXPORT_SYMBOL_GPL(cfg80211_wext_freq);
  259. int cfg80211_wext_siwrts(struct net_device *dev,
  260. struct iw_request_info *info,
  261. struct iw_param *rts, char *extra)
  262. {
  263. struct wireless_dev *wdev = dev->ieee80211_ptr;
  264. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  265. u32 orts = wdev->wiphy->rts_threshold;
  266. int err;
  267. if (rts->disabled || !rts->fixed)
  268. wdev->wiphy->rts_threshold = (u32) -1;
  269. else if (rts->value < 0)
  270. return -EINVAL;
  271. else
  272. wdev->wiphy->rts_threshold = rts->value;
  273. err = rdev->ops->set_wiphy_params(wdev->wiphy,
  274. WIPHY_PARAM_RTS_THRESHOLD);
  275. if (err)
  276. wdev->wiphy->rts_threshold = orts;
  277. return err;
  278. }
  279. EXPORT_SYMBOL_GPL(cfg80211_wext_siwrts);
  280. int cfg80211_wext_giwrts(struct net_device *dev,
  281. struct iw_request_info *info,
  282. struct iw_param *rts, char *extra)
  283. {
  284. struct wireless_dev *wdev = dev->ieee80211_ptr;
  285. rts->value = wdev->wiphy->rts_threshold;
  286. rts->disabled = rts->value == (u32) -1;
  287. rts->fixed = 1;
  288. return 0;
  289. }
  290. EXPORT_SYMBOL_GPL(cfg80211_wext_giwrts);
  291. int cfg80211_wext_siwfrag(struct net_device *dev,
  292. struct iw_request_info *info,
  293. struct iw_param *frag, char *extra)
  294. {
  295. struct wireless_dev *wdev = dev->ieee80211_ptr;
  296. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  297. u32 ofrag = wdev->wiphy->frag_threshold;
  298. int err;
  299. if (frag->disabled || !frag->fixed)
  300. wdev->wiphy->frag_threshold = (u32) -1;
  301. else if (frag->value < 256)
  302. return -EINVAL;
  303. else {
  304. /* Fragment length must be even, so strip LSB. */
  305. wdev->wiphy->frag_threshold = frag->value & ~0x1;
  306. }
  307. err = rdev->ops->set_wiphy_params(wdev->wiphy,
  308. WIPHY_PARAM_FRAG_THRESHOLD);
  309. if (err)
  310. wdev->wiphy->frag_threshold = ofrag;
  311. return err;
  312. }
  313. EXPORT_SYMBOL_GPL(cfg80211_wext_siwfrag);
  314. int cfg80211_wext_giwfrag(struct net_device *dev,
  315. struct iw_request_info *info,
  316. struct iw_param *frag, char *extra)
  317. {
  318. struct wireless_dev *wdev = dev->ieee80211_ptr;
  319. frag->value = wdev->wiphy->frag_threshold;
  320. frag->disabled = frag->value == (u32) -1;
  321. frag->fixed = 1;
  322. return 0;
  323. }
  324. EXPORT_SYMBOL_GPL(cfg80211_wext_giwfrag);
  325. int cfg80211_wext_siwretry(struct net_device *dev,
  326. struct iw_request_info *info,
  327. struct iw_param *retry, char *extra)
  328. {
  329. struct wireless_dev *wdev = dev->ieee80211_ptr;
  330. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  331. u32 changed = 0;
  332. u8 olong = wdev->wiphy->retry_long;
  333. u8 oshort = wdev->wiphy->retry_short;
  334. int err;
  335. if (retry->disabled ||
  336. (retry->flags & IW_RETRY_TYPE) != IW_RETRY_LIMIT)
  337. return -EINVAL;
  338. if (retry->flags & IW_RETRY_LONG) {
  339. wdev->wiphy->retry_long = retry->value;
  340. changed |= WIPHY_PARAM_RETRY_LONG;
  341. } else if (retry->flags & IW_RETRY_SHORT) {
  342. wdev->wiphy->retry_short = retry->value;
  343. changed |= WIPHY_PARAM_RETRY_SHORT;
  344. } else {
  345. wdev->wiphy->retry_short = retry->value;
  346. wdev->wiphy->retry_long = retry->value;
  347. changed |= WIPHY_PARAM_RETRY_LONG;
  348. changed |= WIPHY_PARAM_RETRY_SHORT;
  349. }
  350. if (!changed)
  351. return 0;
  352. err = rdev->ops->set_wiphy_params(wdev->wiphy, changed);
  353. if (err) {
  354. wdev->wiphy->retry_short = oshort;
  355. wdev->wiphy->retry_long = olong;
  356. }
  357. return err;
  358. }
  359. EXPORT_SYMBOL_GPL(cfg80211_wext_siwretry);
  360. int cfg80211_wext_giwretry(struct net_device *dev,
  361. struct iw_request_info *info,
  362. struct iw_param *retry, char *extra)
  363. {
  364. struct wireless_dev *wdev = dev->ieee80211_ptr;
  365. retry->disabled = 0;
  366. if (retry->flags == 0 || (retry->flags & IW_RETRY_SHORT)) {
  367. /*
  368. * First return short value, iwconfig will ask long value
  369. * later if needed
  370. */
  371. retry->flags |= IW_RETRY_LIMIT;
  372. retry->value = wdev->wiphy->retry_short;
  373. if (wdev->wiphy->retry_long != wdev->wiphy->retry_short)
  374. retry->flags |= IW_RETRY_LONG;
  375. return 0;
  376. }
  377. if (retry->flags & IW_RETRY_LONG) {
  378. retry->flags = IW_RETRY_LIMIT | IW_RETRY_LONG;
  379. retry->value = wdev->wiphy->retry_long;
  380. }
  381. return 0;
  382. }
  383. EXPORT_SYMBOL_GPL(cfg80211_wext_giwretry);
  384. static int __cfg80211_set_encryption(struct cfg80211_registered_device *rdev,
  385. struct net_device *dev, const u8 *addr,
  386. bool remove, bool tx_key, int idx,
  387. struct key_params *params)
  388. {
  389. struct wireless_dev *wdev = dev->ieee80211_ptr;
  390. int err, i;
  391. if (!wdev->wext.keys) {
  392. wdev->wext.keys = kzalloc(sizeof(*wdev->wext.keys),
  393. GFP_KERNEL);
  394. if (!wdev->wext.keys)
  395. return -ENOMEM;
  396. for (i = 0; i < 6; i++)
  397. wdev->wext.keys->params[i].key =
  398. wdev->wext.keys->data[i];
  399. }
  400. if (wdev->iftype != NL80211_IFTYPE_ADHOC &&
  401. wdev->iftype != NL80211_IFTYPE_STATION)
  402. return -EOPNOTSUPP;
  403. if (params->cipher == WLAN_CIPHER_SUITE_AES_CMAC) {
  404. if (!wdev->current_bss)
  405. return -ENOLINK;
  406. if (!rdev->ops->set_default_mgmt_key)
  407. return -EOPNOTSUPP;
  408. if (idx < 4 || idx > 5)
  409. return -EINVAL;
  410. } else if (idx < 0 || idx > 3)
  411. return -EINVAL;
  412. if (remove) {
  413. err = 0;
  414. if (wdev->current_bss)
  415. err = rdev->ops->del_key(&rdev->wiphy, dev, idx, addr);
  416. if (!err) {
  417. if (!addr) {
  418. wdev->wext.keys->params[idx].key_len = 0;
  419. wdev->wext.keys->params[idx].cipher = 0;
  420. }
  421. if (idx == wdev->wext.default_key)
  422. wdev->wext.default_key = -1;
  423. else if (idx == wdev->wext.default_mgmt_key)
  424. wdev->wext.default_mgmt_key = -1;
  425. }
  426. /*
  427. * Applications using wireless extensions expect to be
  428. * able to delete keys that don't exist, so allow that.
  429. */
  430. if (err == -ENOENT)
  431. return 0;
  432. return err;
  433. }
  434. if (addr)
  435. tx_key = false;
  436. if (cfg80211_validate_key_settings(rdev, params, idx, addr))
  437. return -EINVAL;
  438. err = 0;
  439. if (wdev->current_bss)
  440. err = rdev->ops->add_key(&rdev->wiphy, dev, idx, addr, params);
  441. if (err)
  442. return err;
  443. if (!addr) {
  444. wdev->wext.keys->params[idx] = *params;
  445. memcpy(wdev->wext.keys->data[idx],
  446. params->key, params->key_len);
  447. wdev->wext.keys->params[idx].key =
  448. wdev->wext.keys->data[idx];
  449. }
  450. if ((params->cipher == WLAN_CIPHER_SUITE_WEP40 ||
  451. params->cipher == WLAN_CIPHER_SUITE_WEP104) &&
  452. (tx_key || (!addr && wdev->wext.default_key == -1))) {
  453. if (wdev->current_bss)
  454. err = rdev->ops->set_default_key(&rdev->wiphy,
  455. dev, idx);
  456. if (!err)
  457. wdev->wext.default_key = idx;
  458. return err;
  459. }
  460. if (params->cipher == WLAN_CIPHER_SUITE_AES_CMAC &&
  461. (tx_key || (!addr && wdev->wext.default_mgmt_key == -1))) {
  462. if (wdev->current_bss)
  463. err = rdev->ops->set_default_mgmt_key(&rdev->wiphy,
  464. dev, idx);
  465. if (!err)
  466. wdev->wext.default_mgmt_key = idx;
  467. return err;
  468. }
  469. return 0;
  470. }
  471. static int cfg80211_set_encryption(struct cfg80211_registered_device *rdev,
  472. struct net_device *dev, const u8 *addr,
  473. bool remove, bool tx_key, int idx,
  474. struct key_params *params)
  475. {
  476. int err;
  477. wdev_lock(dev->ieee80211_ptr);
  478. err = __cfg80211_set_encryption(rdev, dev, addr, remove,
  479. tx_key, idx, params);
  480. wdev_unlock(dev->ieee80211_ptr);
  481. return err;
  482. }
  483. int cfg80211_wext_siwencode(struct net_device *dev,
  484. struct iw_request_info *info,
  485. struct iw_point *erq, char *keybuf)
  486. {
  487. struct wireless_dev *wdev = dev->ieee80211_ptr;
  488. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  489. int idx, err;
  490. bool remove = false;
  491. struct key_params params;
  492. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  493. wdev->iftype != NL80211_IFTYPE_ADHOC)
  494. return -EOPNOTSUPP;
  495. /* no use -- only MFP (set_default_mgmt_key) is optional */
  496. if (!rdev->ops->del_key ||
  497. !rdev->ops->add_key ||
  498. !rdev->ops->set_default_key)
  499. return -EOPNOTSUPP;
  500. idx = erq->flags & IW_ENCODE_INDEX;
  501. if (idx == 0) {
  502. idx = wdev->wext.default_key;
  503. if (idx < 0)
  504. idx = 0;
  505. } else if (idx < 1 || idx > 4)
  506. return -EINVAL;
  507. else
  508. idx--;
  509. if (erq->flags & IW_ENCODE_DISABLED)
  510. remove = true;
  511. else if (erq->length == 0) {
  512. /* No key data - just set the default TX key index */
  513. err = 0;
  514. wdev_lock(wdev);
  515. if (wdev->current_bss)
  516. err = rdev->ops->set_default_key(&rdev->wiphy,
  517. dev, idx);
  518. if (!err)
  519. wdev->wext.default_key = idx;
  520. wdev_unlock(wdev);
  521. return err;
  522. }
  523. memset(&params, 0, sizeof(params));
  524. params.key = keybuf;
  525. params.key_len = erq->length;
  526. if (erq->length == 5)
  527. params.cipher = WLAN_CIPHER_SUITE_WEP40;
  528. else if (erq->length == 13)
  529. params.cipher = WLAN_CIPHER_SUITE_WEP104;
  530. else if (!remove)
  531. return -EINVAL;
  532. return cfg80211_set_encryption(rdev, dev, NULL, remove,
  533. wdev->wext.default_key == -1,
  534. idx, &params);
  535. }
  536. EXPORT_SYMBOL_GPL(cfg80211_wext_siwencode);
  537. int cfg80211_wext_siwencodeext(struct net_device *dev,
  538. struct iw_request_info *info,
  539. struct iw_point *erq, char *extra)
  540. {
  541. struct wireless_dev *wdev = dev->ieee80211_ptr;
  542. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  543. struct iw_encode_ext *ext = (struct iw_encode_ext *) extra;
  544. const u8 *addr;
  545. int idx;
  546. bool remove = false;
  547. struct key_params params;
  548. u32 cipher;
  549. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  550. wdev->iftype != NL80211_IFTYPE_ADHOC)
  551. return -EOPNOTSUPP;
  552. /* no use -- only MFP (set_default_mgmt_key) is optional */
  553. if (!rdev->ops->del_key ||
  554. !rdev->ops->add_key ||
  555. !rdev->ops->set_default_key)
  556. return -EOPNOTSUPP;
  557. switch (ext->alg) {
  558. case IW_ENCODE_ALG_NONE:
  559. remove = true;
  560. cipher = 0;
  561. break;
  562. case IW_ENCODE_ALG_WEP:
  563. if (ext->key_len == 5)
  564. cipher = WLAN_CIPHER_SUITE_WEP40;
  565. else if (ext->key_len == 13)
  566. cipher = WLAN_CIPHER_SUITE_WEP104;
  567. else
  568. return -EINVAL;
  569. break;
  570. case IW_ENCODE_ALG_TKIP:
  571. cipher = WLAN_CIPHER_SUITE_TKIP;
  572. break;
  573. case IW_ENCODE_ALG_CCMP:
  574. cipher = WLAN_CIPHER_SUITE_CCMP;
  575. break;
  576. case IW_ENCODE_ALG_AES_CMAC:
  577. cipher = WLAN_CIPHER_SUITE_AES_CMAC;
  578. break;
  579. default:
  580. return -EOPNOTSUPP;
  581. }
  582. if (erq->flags & IW_ENCODE_DISABLED)
  583. remove = true;
  584. idx = erq->flags & IW_ENCODE_INDEX;
  585. if (cipher == WLAN_CIPHER_SUITE_AES_CMAC) {
  586. if (idx < 4 || idx > 5) {
  587. idx = wdev->wext.default_mgmt_key;
  588. if (idx < 0)
  589. return -EINVAL;
  590. } else
  591. idx--;
  592. } else {
  593. if (idx < 1 || idx > 4) {
  594. idx = wdev->wext.default_key;
  595. if (idx < 0)
  596. return -EINVAL;
  597. } else
  598. idx--;
  599. }
  600. addr = ext->addr.sa_data;
  601. if (is_broadcast_ether_addr(addr))
  602. addr = NULL;
  603. memset(&params, 0, sizeof(params));
  604. params.key = ext->key;
  605. params.key_len = ext->key_len;
  606. params.cipher = cipher;
  607. if (ext->ext_flags & IW_ENCODE_EXT_RX_SEQ_VALID) {
  608. params.seq = ext->rx_seq;
  609. params.seq_len = 6;
  610. }
  611. return cfg80211_set_encryption(
  612. rdev, dev, addr, remove,
  613. ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY,
  614. idx, &params);
  615. }
  616. EXPORT_SYMBOL_GPL(cfg80211_wext_siwencodeext);
  617. int cfg80211_wext_giwencode(struct net_device *dev,
  618. struct iw_request_info *info,
  619. struct iw_point *erq, char *keybuf)
  620. {
  621. struct wireless_dev *wdev = dev->ieee80211_ptr;
  622. int idx;
  623. if (wdev->iftype != NL80211_IFTYPE_STATION &&
  624. wdev->iftype != NL80211_IFTYPE_ADHOC)
  625. return -EOPNOTSUPP;
  626. idx = erq->flags & IW_ENCODE_INDEX;
  627. if (idx == 0) {
  628. idx = wdev->wext.default_key;
  629. if (idx < 0)
  630. idx = 0;
  631. } else if (idx < 1 || idx > 4)
  632. return -EINVAL;
  633. else
  634. idx--;
  635. erq->flags = idx + 1;
  636. if (!wdev->wext.keys || !wdev->wext.keys->params[idx].cipher) {
  637. erq->flags |= IW_ENCODE_DISABLED;
  638. erq->length = 0;
  639. return 0;
  640. }
  641. erq->length = min_t(size_t, erq->length,
  642. wdev->wext.keys->params[idx].key_len);
  643. memcpy(keybuf, wdev->wext.keys->params[idx].key, erq->length);
  644. erq->flags |= IW_ENCODE_ENABLED;
  645. return 0;
  646. }
  647. EXPORT_SYMBOL_GPL(cfg80211_wext_giwencode);
  648. int cfg80211_wext_siwtxpower(struct net_device *dev,
  649. struct iw_request_info *info,
  650. union iwreq_data *data, char *extra)
  651. {
  652. struct wireless_dev *wdev = dev->ieee80211_ptr;
  653. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  654. enum tx_power_setting type;
  655. int dbm = 0;
  656. if ((data->txpower.flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM)
  657. return -EINVAL;
  658. if (data->txpower.flags & IW_TXPOW_RANGE)
  659. return -EINVAL;
  660. if (!rdev->ops->set_tx_power)
  661. return -EOPNOTSUPP;
  662. /* only change when not disabling */
  663. if (!data->txpower.disabled) {
  664. rfkill_set_sw_state(rdev->rfkill, false);
  665. if (data->txpower.fixed) {
  666. /*
  667. * wext doesn't support negative values, see
  668. * below where it's for automatic
  669. */
  670. if (data->txpower.value < 0)
  671. return -EINVAL;
  672. dbm = data->txpower.value;
  673. type = TX_POWER_FIXED;
  674. /* TODO: do regulatory check! */
  675. } else {
  676. /*
  677. * Automatic power level setting, max being the value
  678. * passed in from userland.
  679. */
  680. if (data->txpower.value < 0) {
  681. type = TX_POWER_AUTOMATIC;
  682. } else {
  683. dbm = data->txpower.value;
  684. type = TX_POWER_LIMITED;
  685. }
  686. }
  687. } else {
  688. rfkill_set_sw_state(rdev->rfkill, true);
  689. schedule_work(&rdev->rfkill_sync);
  690. return 0;
  691. }
  692. return rdev->ops->set_tx_power(wdev->wiphy, type, dbm);;
  693. }
  694. EXPORT_SYMBOL_GPL(cfg80211_wext_siwtxpower);
  695. int cfg80211_wext_giwtxpower(struct net_device *dev,
  696. struct iw_request_info *info,
  697. union iwreq_data *data, char *extra)
  698. {
  699. struct wireless_dev *wdev = dev->ieee80211_ptr;
  700. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  701. int err, val;
  702. if ((data->txpower.flags & IW_TXPOW_TYPE) != IW_TXPOW_DBM)
  703. return -EINVAL;
  704. if (data->txpower.flags & IW_TXPOW_RANGE)
  705. return -EINVAL;
  706. if (!rdev->ops->get_tx_power)
  707. return -EOPNOTSUPP;
  708. err = rdev->ops->get_tx_power(wdev->wiphy, &val);
  709. if (err)
  710. return err;
  711. /* well... oh well */
  712. data->txpower.fixed = 1;
  713. data->txpower.disabled = rfkill_blocked(rdev->rfkill);
  714. data->txpower.value = val;
  715. data->txpower.flags = IW_TXPOW_DBM;
  716. return 0;
  717. }
  718. EXPORT_SYMBOL_GPL(cfg80211_wext_giwtxpower);
  719. static int cfg80211_set_auth_alg(struct wireless_dev *wdev,
  720. s32 auth_alg)
  721. {
  722. int nr_alg = 0;
  723. if (!auth_alg)
  724. return -EINVAL;
  725. if (auth_alg & ~(IW_AUTH_ALG_OPEN_SYSTEM |
  726. IW_AUTH_ALG_SHARED_KEY |
  727. IW_AUTH_ALG_LEAP))
  728. return -EINVAL;
  729. if (auth_alg & IW_AUTH_ALG_OPEN_SYSTEM) {
  730. nr_alg++;
  731. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_OPEN_SYSTEM;
  732. }
  733. if (auth_alg & IW_AUTH_ALG_SHARED_KEY) {
  734. nr_alg++;
  735. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_SHARED_KEY;
  736. }
  737. if (auth_alg & IW_AUTH_ALG_LEAP) {
  738. nr_alg++;
  739. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_NETWORK_EAP;
  740. }
  741. if (nr_alg > 1)
  742. wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
  743. return 0;
  744. }
  745. static int cfg80211_set_wpa_version(struct wireless_dev *wdev, u32 wpa_versions)
  746. {
  747. wdev->wext.connect.crypto.wpa_versions = 0;
  748. if (wpa_versions & ~(IW_AUTH_WPA_VERSION_WPA |
  749. IW_AUTH_WPA_VERSION_WPA2|
  750. IW_AUTH_WPA_VERSION_DISABLED))
  751. return -EINVAL;
  752. if ((wpa_versions & IW_AUTH_WPA_VERSION_DISABLED) &&
  753. (wpa_versions & (IW_AUTH_WPA_VERSION_WPA|
  754. IW_AUTH_WPA_VERSION_WPA2)))
  755. return -EINVAL;
  756. if (wpa_versions & IW_AUTH_WPA_VERSION_DISABLED)
  757. wdev->wext.connect.crypto.wpa_versions &=
  758. ~(NL80211_WPA_VERSION_1|NL80211_WPA_VERSION_2);
  759. if (wpa_versions & IW_AUTH_WPA_VERSION_WPA)
  760. wdev->wext.connect.crypto.wpa_versions |=
  761. NL80211_WPA_VERSION_1;
  762. if (wpa_versions & IW_AUTH_WPA_VERSION_WPA2)
  763. wdev->wext.connect.crypto.wpa_versions |=
  764. NL80211_WPA_VERSION_2;
  765. return 0;
  766. }
  767. static int cfg80211_set_cipher_group(struct wireless_dev *wdev, u32 cipher)
  768. {
  769. wdev->wext.connect.crypto.cipher_group = 0;
  770. if (cipher & IW_AUTH_CIPHER_WEP40)
  771. wdev->wext.connect.crypto.cipher_group =
  772. WLAN_CIPHER_SUITE_WEP40;
  773. else if (cipher & IW_AUTH_CIPHER_WEP104)
  774. wdev->wext.connect.crypto.cipher_group =
  775. WLAN_CIPHER_SUITE_WEP104;
  776. else if (cipher & IW_AUTH_CIPHER_TKIP)
  777. wdev->wext.connect.crypto.cipher_group =
  778. WLAN_CIPHER_SUITE_TKIP;
  779. else if (cipher & IW_AUTH_CIPHER_CCMP)
  780. wdev->wext.connect.crypto.cipher_group =
  781. WLAN_CIPHER_SUITE_CCMP;
  782. else if (cipher & IW_AUTH_CIPHER_AES_CMAC)
  783. wdev->wext.connect.crypto.cipher_group =
  784. WLAN_CIPHER_SUITE_AES_CMAC;
  785. else
  786. return -EINVAL;
  787. return 0;
  788. }
  789. static int cfg80211_set_cipher_pairwise(struct wireless_dev *wdev, u32 cipher)
  790. {
  791. int nr_ciphers = 0;
  792. u32 *ciphers_pairwise = wdev->wext.connect.crypto.ciphers_pairwise;
  793. if (cipher & IW_AUTH_CIPHER_WEP40) {
  794. ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_WEP40;
  795. nr_ciphers++;
  796. }
  797. if (cipher & IW_AUTH_CIPHER_WEP104) {
  798. ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_WEP104;
  799. nr_ciphers++;
  800. }
  801. if (cipher & IW_AUTH_CIPHER_TKIP) {
  802. ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_TKIP;
  803. nr_ciphers++;
  804. }
  805. if (cipher & IW_AUTH_CIPHER_CCMP) {
  806. ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_CCMP;
  807. nr_ciphers++;
  808. }
  809. if (cipher & IW_AUTH_CIPHER_AES_CMAC) {
  810. ciphers_pairwise[nr_ciphers] = WLAN_CIPHER_SUITE_AES_CMAC;
  811. nr_ciphers++;
  812. }
  813. BUILD_BUG_ON(NL80211_MAX_NR_CIPHER_SUITES < 5);
  814. wdev->wext.connect.crypto.n_ciphers_pairwise = nr_ciphers;
  815. return 0;
  816. }
  817. static int cfg80211_set_key_mgt(struct wireless_dev *wdev, u32 key_mgt)
  818. {
  819. int nr_akm_suites = 0;
  820. if (key_mgt & ~(IW_AUTH_KEY_MGMT_802_1X |
  821. IW_AUTH_KEY_MGMT_PSK))
  822. return -EINVAL;
  823. if (key_mgt & IW_AUTH_KEY_MGMT_802_1X) {
  824. wdev->wext.connect.crypto.akm_suites[nr_akm_suites] =
  825. WLAN_AKM_SUITE_8021X;
  826. nr_akm_suites++;
  827. }
  828. if (key_mgt & IW_AUTH_KEY_MGMT_PSK) {
  829. wdev->wext.connect.crypto.akm_suites[nr_akm_suites] =
  830. WLAN_AKM_SUITE_PSK;
  831. nr_akm_suites++;
  832. }
  833. wdev->wext.connect.crypto.n_akm_suites = nr_akm_suites;
  834. return 0;
  835. }
  836. int cfg80211_wext_siwauth(struct net_device *dev,
  837. struct iw_request_info *info,
  838. struct iw_param *data, char *extra)
  839. {
  840. struct wireless_dev *wdev = dev->ieee80211_ptr;
  841. if (wdev->iftype != NL80211_IFTYPE_STATION)
  842. return -EOPNOTSUPP;
  843. switch (data->flags & IW_AUTH_INDEX) {
  844. case IW_AUTH_PRIVACY_INVOKED:
  845. wdev->wext.connect.privacy = data->value;
  846. return 0;
  847. case IW_AUTH_WPA_VERSION:
  848. return cfg80211_set_wpa_version(wdev, data->value);
  849. case IW_AUTH_CIPHER_GROUP:
  850. return cfg80211_set_cipher_group(wdev, data->value);
  851. case IW_AUTH_KEY_MGMT:
  852. return cfg80211_set_key_mgt(wdev, data->value);
  853. case IW_AUTH_CIPHER_PAIRWISE:
  854. return cfg80211_set_cipher_pairwise(wdev, data->value);
  855. case IW_AUTH_80211_AUTH_ALG:
  856. return cfg80211_set_auth_alg(wdev, data->value);
  857. case IW_AUTH_WPA_ENABLED:
  858. case IW_AUTH_RX_UNENCRYPTED_EAPOL:
  859. case IW_AUTH_DROP_UNENCRYPTED:
  860. case IW_AUTH_MFP:
  861. return 0;
  862. default:
  863. return -EOPNOTSUPP;
  864. }
  865. }
  866. EXPORT_SYMBOL_GPL(cfg80211_wext_siwauth);
  867. int cfg80211_wext_giwauth(struct net_device *dev,
  868. struct iw_request_info *info,
  869. struct iw_param *data, char *extra)
  870. {
  871. /* XXX: what do we need? */
  872. return -EOPNOTSUPP;
  873. }
  874. EXPORT_SYMBOL_GPL(cfg80211_wext_giwauth);
  875. int cfg80211_wext_siwpower(struct net_device *dev,
  876. struct iw_request_info *info,
  877. struct iw_param *wrq, char *extra)
  878. {
  879. struct wireless_dev *wdev = dev->ieee80211_ptr;
  880. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  881. bool ps = wdev->wext.ps;
  882. int timeout = wdev->wext.ps_timeout;
  883. int err;
  884. if (wdev->iftype != NL80211_IFTYPE_STATION)
  885. return -EINVAL;
  886. if (!rdev->ops->set_power_mgmt)
  887. return -EOPNOTSUPP;
  888. if (wrq->disabled) {
  889. ps = false;
  890. } else {
  891. switch (wrq->flags & IW_POWER_MODE) {
  892. case IW_POWER_ON: /* If not specified */
  893. case IW_POWER_MODE: /* If set all mask */
  894. case IW_POWER_ALL_R: /* If explicitely state all */
  895. ps = true;
  896. break;
  897. default: /* Otherwise we ignore */
  898. return -EINVAL;
  899. }
  900. if (wrq->flags & ~(IW_POWER_MODE | IW_POWER_TIMEOUT))
  901. return -EINVAL;
  902. if (wrq->flags & IW_POWER_TIMEOUT)
  903. timeout = wrq->value / 1000;
  904. }
  905. err = rdev->ops->set_power_mgmt(wdev->wiphy, dev, ps, timeout);
  906. if (err)
  907. return err;
  908. wdev->wext.ps = ps;
  909. wdev->wext.ps_timeout = timeout;
  910. return 0;
  911. }
  912. EXPORT_SYMBOL_GPL(cfg80211_wext_siwpower);
  913. int cfg80211_wext_giwpower(struct net_device *dev,
  914. struct iw_request_info *info,
  915. struct iw_param *wrq, char *extra)
  916. {
  917. struct wireless_dev *wdev = dev->ieee80211_ptr;
  918. wrq->disabled = !wdev->wext.ps;
  919. return 0;
  920. }
  921. EXPORT_SYMBOL_GPL(cfg80211_wext_giwpower);
  922. int cfg80211_wds_wext_siwap(struct net_device *dev,
  923. struct iw_request_info *info,
  924. struct sockaddr *addr, char *extra)
  925. {
  926. struct wireless_dev *wdev = dev->ieee80211_ptr;
  927. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  928. int err;
  929. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_WDS))
  930. return -EINVAL;
  931. if (addr->sa_family != ARPHRD_ETHER)
  932. return -EINVAL;
  933. if (netif_running(dev))
  934. return -EBUSY;
  935. if (!rdev->ops->set_wds_peer)
  936. return -EOPNOTSUPP;
  937. err = rdev->ops->set_wds_peer(wdev->wiphy, dev, (u8 *) &addr->sa_data);
  938. if (err)
  939. return err;
  940. memcpy(&wdev->wext.bssid, (u8 *) &addr->sa_data, ETH_ALEN);
  941. return 0;
  942. }
  943. EXPORT_SYMBOL_GPL(cfg80211_wds_wext_siwap);
  944. int cfg80211_wds_wext_giwap(struct net_device *dev,
  945. struct iw_request_info *info,
  946. struct sockaddr *addr, char *extra)
  947. {
  948. struct wireless_dev *wdev = dev->ieee80211_ptr;
  949. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_WDS))
  950. return -EINVAL;
  951. addr->sa_family = ARPHRD_ETHER;
  952. memcpy(&addr->sa_data, wdev->wext.bssid, ETH_ALEN);
  953. return 0;
  954. }
  955. EXPORT_SYMBOL_GPL(cfg80211_wds_wext_giwap);
  956. int cfg80211_wext_siwrate(struct net_device *dev,
  957. struct iw_request_info *info,
  958. struct iw_param *rate, char *extra)
  959. {
  960. struct wireless_dev *wdev = dev->ieee80211_ptr;
  961. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  962. struct cfg80211_bitrate_mask mask;
  963. if (!rdev->ops->set_bitrate_mask)
  964. return -EOPNOTSUPP;
  965. mask.fixed = 0;
  966. mask.maxrate = 0;
  967. if (rate->value < 0) {
  968. /* nothing */
  969. } else if (rate->fixed) {
  970. mask.fixed = rate->value / 1000; /* kbps */
  971. } else {
  972. mask.maxrate = rate->value / 1000; /* kbps */
  973. }
  974. return rdev->ops->set_bitrate_mask(wdev->wiphy, dev, NULL, &mask);
  975. }
  976. EXPORT_SYMBOL_GPL(cfg80211_wext_siwrate);
  977. int cfg80211_wext_giwrate(struct net_device *dev,
  978. struct iw_request_info *info,
  979. struct iw_param *rate, char *extra)
  980. {
  981. struct wireless_dev *wdev = dev->ieee80211_ptr;
  982. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  983. /* we are under RTNL - globally locked - so can use a static struct */
  984. static struct station_info sinfo;
  985. u8 addr[ETH_ALEN];
  986. int err;
  987. if (wdev->iftype != NL80211_IFTYPE_STATION)
  988. return -EOPNOTSUPP;
  989. if (!rdev->ops->get_station)
  990. return -EOPNOTSUPP;
  991. err = 0;
  992. wdev_lock(wdev);
  993. if (wdev->current_bss)
  994. memcpy(addr, wdev->current_bss->pub.bssid, ETH_ALEN);
  995. else
  996. err = -EOPNOTSUPP;
  997. wdev_unlock(wdev);
  998. if (err)
  999. return err;
  1000. err = rdev->ops->get_station(&rdev->wiphy, dev, addr, &sinfo);
  1001. if (err)
  1002. return err;
  1003. if (!(sinfo.filled & STATION_INFO_TX_BITRATE))
  1004. return -EOPNOTSUPP;
  1005. rate->value = 0;
  1006. if (!(sinfo.txrate.flags & RATE_INFO_FLAGS_MCS))
  1007. rate->value = 100000 * sinfo.txrate.legacy;
  1008. return 0;
  1009. }
  1010. EXPORT_SYMBOL_GPL(cfg80211_wext_giwrate);
  1011. /* Get wireless statistics. Called by /proc/net/wireless and by SIOCGIWSTATS */
  1012. struct iw_statistics *cfg80211_wireless_stats(struct net_device *dev)
  1013. {
  1014. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1015. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  1016. /* we are under RTNL - globally locked - so can use static structs */
  1017. static struct iw_statistics wstats;
  1018. static struct station_info sinfo;
  1019. u8 bssid[ETH_ALEN];
  1020. if (dev->ieee80211_ptr->iftype != NL80211_IFTYPE_STATION)
  1021. return NULL;
  1022. if (!rdev->ops->get_station)
  1023. return NULL;
  1024. /* Grab BSSID of current BSS, if any */
  1025. wdev_lock(wdev);
  1026. if (!wdev->current_bss) {
  1027. wdev_unlock(wdev);
  1028. return NULL;
  1029. }
  1030. memcpy(bssid, wdev->current_bss->pub.bssid, ETH_ALEN);
  1031. wdev_unlock(wdev);
  1032. if (rdev->ops->get_station(&rdev->wiphy, dev, bssid, &sinfo))
  1033. return NULL;
  1034. memset(&wstats, 0, sizeof(wstats));
  1035. switch (rdev->wiphy.signal_type) {
  1036. case CFG80211_SIGNAL_TYPE_MBM:
  1037. if (sinfo.filled & STATION_INFO_SIGNAL) {
  1038. int sig = sinfo.signal;
  1039. wstats.qual.updated |= IW_QUAL_LEVEL_UPDATED;
  1040. wstats.qual.updated |= IW_QUAL_QUAL_UPDATED;
  1041. wstats.qual.updated |= IW_QUAL_DBM;
  1042. wstats.qual.level = sig;
  1043. if (sig < -110)
  1044. sig = -110;
  1045. else if (sig > -40)
  1046. sig = -40;
  1047. wstats.qual.qual = sig + 110;
  1048. break;
  1049. }
  1050. case CFG80211_SIGNAL_TYPE_UNSPEC:
  1051. if (sinfo.filled & STATION_INFO_SIGNAL) {
  1052. wstats.qual.updated |= IW_QUAL_LEVEL_UPDATED;
  1053. wstats.qual.updated |= IW_QUAL_QUAL_UPDATED;
  1054. wstats.qual.level = sinfo.signal;
  1055. wstats.qual.qual = sinfo.signal;
  1056. break;
  1057. }
  1058. default:
  1059. wstats.qual.updated |= IW_QUAL_LEVEL_INVALID;
  1060. wstats.qual.updated |= IW_QUAL_QUAL_INVALID;
  1061. }
  1062. wstats.qual.updated |= IW_QUAL_NOISE_INVALID;
  1063. return &wstats;
  1064. }
  1065. EXPORT_SYMBOL_GPL(cfg80211_wireless_stats);