sme.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991
  1. /*
  2. * SME code for cfg80211
  3. * both driver SME event handling and the SME implementation
  4. * (for nl80211's connect() and wext)
  5. *
  6. * Copyright 2009 Johannes Berg <johannes@sipsolutions.net>
  7. * Copyright (C) 2009 Intel Corporation. All rights reserved.
  8. */
  9. #include <linux/etherdevice.h>
  10. #include <linux/if_arp.h>
  11. #include <linux/slab.h>
  12. #include <linux/workqueue.h>
  13. #include <linux/wireless.h>
  14. #include <linux/export.h>
  15. #include <net/iw_handler.h>
  16. #include <net/cfg80211.h>
  17. #include <net/rtnetlink.h>
  18. #include "nl80211.h"
  19. #include "reg.h"
  20. #include "rdev-ops.h"
  21. /*
  22. * Software SME in cfg80211, using auth/assoc/deauth calls to the
  23. * driver. This is is for implementing nl80211's connect/disconnect
  24. * and wireless extensions (if configured.)
  25. */
  26. struct cfg80211_conn {
  27. struct cfg80211_connect_params params;
  28. /* these are sub-states of the _CONNECTING sme_state */
  29. enum {
  30. CFG80211_CONN_SCANNING,
  31. CFG80211_CONN_SCAN_AGAIN,
  32. CFG80211_CONN_AUTHENTICATE_NEXT,
  33. CFG80211_CONN_AUTHENTICATING,
  34. CFG80211_CONN_AUTH_FAILED,
  35. CFG80211_CONN_ASSOCIATE_NEXT,
  36. CFG80211_CONN_ASSOCIATING,
  37. CFG80211_CONN_ASSOC_FAILED,
  38. CFG80211_CONN_DEAUTH,
  39. CFG80211_CONN_CONNECTED,
  40. } state;
  41. u8 bssid[ETH_ALEN], prev_bssid[ETH_ALEN];
  42. u8 *ie;
  43. size_t ie_len;
  44. bool auto_auth, prev_bssid_valid;
  45. };
  46. static void cfg80211_sme_free(struct wireless_dev *wdev)
  47. {
  48. if (!wdev->conn)
  49. return;
  50. kfree(wdev->conn->ie);
  51. kfree(wdev->conn);
  52. wdev->conn = NULL;
  53. }
  54. static int cfg80211_conn_scan(struct wireless_dev *wdev)
  55. {
  56. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  57. struct cfg80211_scan_request *request;
  58. int n_channels, err;
  59. ASSERT_RTNL();
  60. ASSERT_RDEV_LOCK(rdev);
  61. ASSERT_WDEV_LOCK(wdev);
  62. if (rdev->scan_req || rdev->scan_msg)
  63. return -EBUSY;
  64. if (wdev->conn->params.channel)
  65. n_channels = 1;
  66. else
  67. n_channels = ieee80211_get_num_supported_channels(wdev->wiphy);
  68. request = kzalloc(sizeof(*request) + sizeof(request->ssids[0]) +
  69. sizeof(request->channels[0]) * n_channels,
  70. GFP_KERNEL);
  71. if (!request)
  72. return -ENOMEM;
  73. if (wdev->conn->params.channel)
  74. request->channels[0] = wdev->conn->params.channel;
  75. else {
  76. int i = 0, j;
  77. enum ieee80211_band band;
  78. struct ieee80211_supported_band *bands;
  79. struct ieee80211_channel *channel;
  80. for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
  81. bands = wdev->wiphy->bands[band];
  82. if (!bands)
  83. continue;
  84. for (j = 0; j < bands->n_channels; j++) {
  85. channel = &bands->channels[j];
  86. if (channel->flags & IEEE80211_CHAN_DISABLED)
  87. continue;
  88. request->channels[i++] = channel;
  89. }
  90. request->rates[band] = (1 << bands->n_bitrates) - 1;
  91. }
  92. n_channels = i;
  93. }
  94. request->n_channels = n_channels;
  95. request->ssids = (void *)&request->channels[n_channels];
  96. request->n_ssids = 1;
  97. memcpy(request->ssids[0].ssid, wdev->conn->params.ssid,
  98. wdev->conn->params.ssid_len);
  99. request->ssids[0].ssid_len = wdev->conn->params.ssid_len;
  100. request->wdev = wdev;
  101. request->wiphy = &rdev->wiphy;
  102. request->scan_start = jiffies;
  103. rdev->scan_req = request;
  104. err = rdev_scan(rdev, request);
  105. if (!err) {
  106. wdev->conn->state = CFG80211_CONN_SCANNING;
  107. nl80211_send_scan_start(rdev, wdev);
  108. dev_hold(wdev->netdev);
  109. } else {
  110. rdev->scan_req = NULL;
  111. kfree(request);
  112. }
  113. return err;
  114. }
  115. static int cfg80211_conn_do_work(struct wireless_dev *wdev)
  116. {
  117. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  118. struct cfg80211_connect_params *params;
  119. struct cfg80211_assoc_request req = {};
  120. int err;
  121. ASSERT_WDEV_LOCK(wdev);
  122. if (!wdev->conn)
  123. return 0;
  124. params = &wdev->conn->params;
  125. switch (wdev->conn->state) {
  126. case CFG80211_CONN_SCANNING:
  127. /* didn't find it during scan ... */
  128. return -ENOENT;
  129. case CFG80211_CONN_SCAN_AGAIN:
  130. return cfg80211_conn_scan(wdev);
  131. case CFG80211_CONN_AUTHENTICATE_NEXT:
  132. BUG_ON(!rdev->ops->auth);
  133. wdev->conn->state = CFG80211_CONN_AUTHENTICATING;
  134. return cfg80211_mlme_auth(rdev, wdev->netdev,
  135. params->channel, params->auth_type,
  136. params->bssid,
  137. params->ssid, params->ssid_len,
  138. NULL, 0,
  139. params->key, params->key_len,
  140. params->key_idx, NULL, 0);
  141. case CFG80211_CONN_AUTH_FAILED:
  142. return -ENOTCONN;
  143. case CFG80211_CONN_ASSOCIATE_NEXT:
  144. BUG_ON(!rdev->ops->assoc);
  145. wdev->conn->state = CFG80211_CONN_ASSOCIATING;
  146. if (wdev->conn->prev_bssid_valid)
  147. req.prev_bssid = wdev->conn->prev_bssid;
  148. req.ie = params->ie;
  149. req.ie_len = params->ie_len;
  150. req.use_mfp = params->mfp != NL80211_MFP_NO;
  151. req.crypto = params->crypto;
  152. req.flags = params->flags;
  153. req.ht_capa = params->ht_capa;
  154. req.ht_capa_mask = params->ht_capa_mask;
  155. req.vht_capa = params->vht_capa;
  156. req.vht_capa_mask = params->vht_capa_mask;
  157. err = cfg80211_mlme_assoc(rdev, wdev->netdev, params->channel,
  158. params->bssid, params->ssid,
  159. params->ssid_len, &req);
  160. if (err)
  161. cfg80211_mlme_deauth(rdev, wdev->netdev, params->bssid,
  162. NULL, 0,
  163. WLAN_REASON_DEAUTH_LEAVING,
  164. false);
  165. return err;
  166. case CFG80211_CONN_ASSOC_FAILED:
  167. cfg80211_mlme_deauth(rdev, wdev->netdev, params->bssid,
  168. NULL, 0,
  169. WLAN_REASON_DEAUTH_LEAVING, false);
  170. return -ENOTCONN;
  171. case CFG80211_CONN_DEAUTH:
  172. cfg80211_mlme_deauth(rdev, wdev->netdev, params->bssid,
  173. NULL, 0,
  174. WLAN_REASON_DEAUTH_LEAVING, false);
  175. /* free directly, disconnected event already sent */
  176. cfg80211_sme_free(wdev);
  177. return 0;
  178. default:
  179. return 0;
  180. }
  181. }
  182. void cfg80211_conn_work(struct work_struct *work)
  183. {
  184. struct cfg80211_registered_device *rdev =
  185. container_of(work, struct cfg80211_registered_device, conn_work);
  186. struct wireless_dev *wdev;
  187. u8 bssid_buf[ETH_ALEN], *bssid = NULL;
  188. rtnl_lock();
  189. list_for_each_entry(wdev, &rdev->wdev_list, list) {
  190. if (!wdev->netdev)
  191. continue;
  192. wdev_lock(wdev);
  193. if (!netif_running(wdev->netdev)) {
  194. wdev_unlock(wdev);
  195. continue;
  196. }
  197. if (!wdev->conn ||
  198. wdev->conn->state == CFG80211_CONN_CONNECTED) {
  199. wdev_unlock(wdev);
  200. continue;
  201. }
  202. if (wdev->conn->params.bssid) {
  203. memcpy(bssid_buf, wdev->conn->params.bssid, ETH_ALEN);
  204. bssid = bssid_buf;
  205. }
  206. if (cfg80211_conn_do_work(wdev)) {
  207. __cfg80211_connect_result(
  208. wdev->netdev, bssid,
  209. NULL, 0, NULL, 0,
  210. WLAN_STATUS_UNSPECIFIED_FAILURE,
  211. false, NULL);
  212. cfg80211_sme_free(wdev);
  213. }
  214. wdev_unlock(wdev);
  215. }
  216. rtnl_unlock();
  217. }
  218. /* Returned bss is reference counted and must be cleaned up appropriately. */
  219. static struct cfg80211_bss *cfg80211_get_conn_bss(struct wireless_dev *wdev)
  220. {
  221. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  222. struct cfg80211_bss *bss;
  223. u16 capa = WLAN_CAPABILITY_ESS;
  224. ASSERT_WDEV_LOCK(wdev);
  225. if (wdev->conn->params.privacy)
  226. capa |= WLAN_CAPABILITY_PRIVACY;
  227. bss = cfg80211_get_bss(wdev->wiphy, wdev->conn->params.channel,
  228. wdev->conn->params.bssid,
  229. wdev->conn->params.ssid,
  230. wdev->conn->params.ssid_len,
  231. WLAN_CAPABILITY_ESS | WLAN_CAPABILITY_PRIVACY,
  232. capa);
  233. if (!bss)
  234. return NULL;
  235. memcpy(wdev->conn->bssid, bss->bssid, ETH_ALEN);
  236. wdev->conn->params.bssid = wdev->conn->bssid;
  237. wdev->conn->params.channel = bss->channel;
  238. wdev->conn->state = CFG80211_CONN_AUTHENTICATE_NEXT;
  239. schedule_work(&rdev->conn_work);
  240. return bss;
  241. }
  242. static void __cfg80211_sme_scan_done(struct net_device *dev)
  243. {
  244. struct wireless_dev *wdev = dev->ieee80211_ptr;
  245. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  246. struct cfg80211_bss *bss;
  247. ASSERT_WDEV_LOCK(wdev);
  248. if (!wdev->conn)
  249. return;
  250. if (wdev->conn->state != CFG80211_CONN_SCANNING &&
  251. wdev->conn->state != CFG80211_CONN_SCAN_AGAIN)
  252. return;
  253. bss = cfg80211_get_conn_bss(wdev);
  254. if (bss)
  255. cfg80211_put_bss(&rdev->wiphy, bss);
  256. else
  257. schedule_work(&rdev->conn_work);
  258. }
  259. void cfg80211_sme_scan_done(struct net_device *dev)
  260. {
  261. struct wireless_dev *wdev = dev->ieee80211_ptr;
  262. wdev_lock(wdev);
  263. __cfg80211_sme_scan_done(dev);
  264. wdev_unlock(wdev);
  265. }
  266. void cfg80211_sme_rx_auth(struct wireless_dev *wdev, const u8 *buf, size_t len)
  267. {
  268. struct wiphy *wiphy = wdev->wiphy;
  269. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  270. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  271. u16 status_code = le16_to_cpu(mgmt->u.auth.status_code);
  272. ASSERT_WDEV_LOCK(wdev);
  273. if (!wdev->conn || wdev->conn->state == CFG80211_CONN_CONNECTED)
  274. return;
  275. if (status_code == WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG &&
  276. wdev->conn->auto_auth &&
  277. wdev->conn->params.auth_type != NL80211_AUTHTYPE_NETWORK_EAP) {
  278. /* select automatically between only open, shared, leap */
  279. switch (wdev->conn->params.auth_type) {
  280. case NL80211_AUTHTYPE_OPEN_SYSTEM:
  281. if (wdev->connect_keys)
  282. wdev->conn->params.auth_type =
  283. NL80211_AUTHTYPE_SHARED_KEY;
  284. else
  285. wdev->conn->params.auth_type =
  286. NL80211_AUTHTYPE_NETWORK_EAP;
  287. break;
  288. case NL80211_AUTHTYPE_SHARED_KEY:
  289. wdev->conn->params.auth_type =
  290. NL80211_AUTHTYPE_NETWORK_EAP;
  291. break;
  292. default:
  293. /* huh? */
  294. wdev->conn->params.auth_type =
  295. NL80211_AUTHTYPE_OPEN_SYSTEM;
  296. break;
  297. }
  298. wdev->conn->state = CFG80211_CONN_AUTHENTICATE_NEXT;
  299. schedule_work(&rdev->conn_work);
  300. } else if (status_code != WLAN_STATUS_SUCCESS) {
  301. __cfg80211_connect_result(wdev->netdev, mgmt->bssid,
  302. NULL, 0, NULL, 0,
  303. status_code, false, NULL);
  304. } else if (wdev->conn->state == CFG80211_CONN_AUTHENTICATING) {
  305. wdev->conn->state = CFG80211_CONN_ASSOCIATE_NEXT;
  306. schedule_work(&rdev->conn_work);
  307. }
  308. }
  309. bool cfg80211_sme_rx_assoc_resp(struct wireless_dev *wdev, u16 status)
  310. {
  311. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  312. if (!wdev->conn)
  313. return false;
  314. if (status == WLAN_STATUS_SUCCESS) {
  315. wdev->conn->state = CFG80211_CONN_CONNECTED;
  316. return false;
  317. }
  318. if (wdev->conn->prev_bssid_valid) {
  319. /*
  320. * Some stupid APs don't accept reassoc, so we
  321. * need to fall back to trying regular assoc;
  322. * return true so no event is sent to userspace.
  323. */
  324. wdev->conn->prev_bssid_valid = false;
  325. wdev->conn->state = CFG80211_CONN_ASSOCIATE_NEXT;
  326. schedule_work(&rdev->conn_work);
  327. return true;
  328. }
  329. wdev->conn->state = CFG80211_CONN_ASSOC_FAILED;
  330. schedule_work(&rdev->conn_work);
  331. return false;
  332. }
  333. void cfg80211_sme_deauth(struct wireless_dev *wdev)
  334. {
  335. cfg80211_sme_free(wdev);
  336. }
  337. void cfg80211_sme_auth_timeout(struct wireless_dev *wdev)
  338. {
  339. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  340. if (!wdev->conn)
  341. return;
  342. wdev->conn->state = CFG80211_CONN_AUTH_FAILED;
  343. schedule_work(&rdev->conn_work);
  344. }
  345. void cfg80211_sme_disassoc(struct wireless_dev *wdev)
  346. {
  347. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  348. if (!wdev->conn)
  349. return;
  350. wdev->conn->state = CFG80211_CONN_DEAUTH;
  351. schedule_work(&rdev->conn_work);
  352. }
  353. void cfg80211_sme_assoc_timeout(struct wireless_dev *wdev)
  354. {
  355. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  356. if (!wdev->conn)
  357. return;
  358. wdev->conn->state = CFG80211_CONN_ASSOC_FAILED;
  359. schedule_work(&rdev->conn_work);
  360. }
  361. static int cfg80211_sme_connect(struct wireless_dev *wdev,
  362. struct cfg80211_connect_params *connect,
  363. const u8 *prev_bssid)
  364. {
  365. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  366. struct cfg80211_bss *bss;
  367. int err;
  368. if (!rdev->ops->auth || !rdev->ops->assoc)
  369. return -EOPNOTSUPP;
  370. if (wdev->current_bss)
  371. return -EALREADY;
  372. if (WARN_ON(wdev->conn))
  373. return -EINPROGRESS;
  374. wdev->conn = kzalloc(sizeof(*wdev->conn), GFP_KERNEL);
  375. if (!wdev->conn)
  376. return -ENOMEM;
  377. /*
  378. * Copy all parameters, and treat explicitly IEs, BSSID, SSID.
  379. */
  380. memcpy(&wdev->conn->params, connect, sizeof(*connect));
  381. if (connect->bssid) {
  382. wdev->conn->params.bssid = wdev->conn->bssid;
  383. memcpy(wdev->conn->bssid, connect->bssid, ETH_ALEN);
  384. }
  385. if (connect->ie) {
  386. wdev->conn->ie = kmemdup(connect->ie, connect->ie_len,
  387. GFP_KERNEL);
  388. wdev->conn->params.ie = wdev->conn->ie;
  389. if (!wdev->conn->ie) {
  390. kfree(wdev->conn);
  391. wdev->conn = NULL;
  392. return -ENOMEM;
  393. }
  394. }
  395. if (connect->auth_type == NL80211_AUTHTYPE_AUTOMATIC) {
  396. wdev->conn->auto_auth = true;
  397. /* start with open system ... should mostly work */
  398. wdev->conn->params.auth_type =
  399. NL80211_AUTHTYPE_OPEN_SYSTEM;
  400. } else {
  401. wdev->conn->auto_auth = false;
  402. }
  403. wdev->conn->params.ssid = wdev->ssid;
  404. wdev->conn->params.ssid_len = connect->ssid_len;
  405. /* see if we have the bss already */
  406. bss = cfg80211_get_conn_bss(wdev);
  407. if (prev_bssid) {
  408. memcpy(wdev->conn->prev_bssid, prev_bssid, ETH_ALEN);
  409. wdev->conn->prev_bssid_valid = true;
  410. }
  411. /* we're good if we have a matching bss struct */
  412. if (bss) {
  413. wdev->conn->state = CFG80211_CONN_AUTHENTICATE_NEXT;
  414. err = cfg80211_conn_do_work(wdev);
  415. cfg80211_put_bss(wdev->wiphy, bss);
  416. } else {
  417. /* otherwise we'll need to scan for the AP first */
  418. err = cfg80211_conn_scan(wdev);
  419. /*
  420. * If we can't scan right now, then we need to scan again
  421. * after the current scan finished, since the parameters
  422. * changed (unless we find a good AP anyway).
  423. */
  424. if (err == -EBUSY) {
  425. err = 0;
  426. wdev->conn->state = CFG80211_CONN_SCAN_AGAIN;
  427. }
  428. }
  429. if (err)
  430. cfg80211_sme_free(wdev);
  431. return err;
  432. }
  433. static int cfg80211_sme_disconnect(struct wireless_dev *wdev, u16 reason)
  434. {
  435. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  436. int err;
  437. if (!wdev->conn)
  438. return 0;
  439. if (!rdev->ops->deauth)
  440. return -EOPNOTSUPP;
  441. if (wdev->conn->state == CFG80211_CONN_SCANNING ||
  442. wdev->conn->state == CFG80211_CONN_SCAN_AGAIN) {
  443. err = 0;
  444. goto out;
  445. }
  446. /* wdev->conn->params.bssid must be set if > SCANNING */
  447. err = cfg80211_mlme_deauth(rdev, wdev->netdev,
  448. wdev->conn->params.bssid,
  449. NULL, 0, reason, false);
  450. out:
  451. cfg80211_sme_free(wdev);
  452. return err;
  453. }
  454. /*
  455. * code shared for in-device and software SME
  456. */
  457. static bool cfg80211_is_all_idle(void)
  458. {
  459. struct cfg80211_registered_device *rdev;
  460. struct wireless_dev *wdev;
  461. bool is_all_idle = true;
  462. /*
  463. * All devices must be idle as otherwise if you are actively
  464. * scanning some new beacon hints could be learned and would
  465. * count as new regulatory hints.
  466. */
  467. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  468. list_for_each_entry(wdev, &rdev->wdev_list, list) {
  469. wdev_lock(wdev);
  470. if (wdev->conn || wdev->current_bss)
  471. is_all_idle = false;
  472. wdev_unlock(wdev);
  473. }
  474. }
  475. return is_all_idle;
  476. }
  477. static void disconnect_work(struct work_struct *work)
  478. {
  479. rtnl_lock();
  480. if (cfg80211_is_all_idle())
  481. regulatory_hint_disconnect();
  482. rtnl_unlock();
  483. }
  484. static DECLARE_WORK(cfg80211_disconnect_work, disconnect_work);
  485. /*
  486. * API calls for drivers implementing connect/disconnect and
  487. * SME event handling
  488. */
  489. /* This method must consume bss one way or another */
  490. void __cfg80211_connect_result(struct net_device *dev, const u8 *bssid,
  491. const u8 *req_ie, size_t req_ie_len,
  492. const u8 *resp_ie, size_t resp_ie_len,
  493. u16 status, bool wextev,
  494. struct cfg80211_bss *bss)
  495. {
  496. struct wireless_dev *wdev = dev->ieee80211_ptr;
  497. const u8 *country_ie;
  498. #ifdef CONFIG_CFG80211_WEXT
  499. union iwreq_data wrqu;
  500. #endif
  501. ASSERT_WDEV_LOCK(wdev);
  502. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
  503. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT)) {
  504. cfg80211_put_bss(wdev->wiphy, bss);
  505. return;
  506. }
  507. nl80211_send_connect_result(wiphy_to_dev(wdev->wiphy), dev,
  508. bssid, req_ie, req_ie_len,
  509. resp_ie, resp_ie_len,
  510. status, GFP_KERNEL);
  511. #ifdef CONFIG_CFG80211_WEXT
  512. if (wextev) {
  513. if (req_ie && status == WLAN_STATUS_SUCCESS) {
  514. memset(&wrqu, 0, sizeof(wrqu));
  515. wrqu.data.length = req_ie_len;
  516. wireless_send_event(dev, IWEVASSOCREQIE, &wrqu, req_ie);
  517. }
  518. if (resp_ie && status == WLAN_STATUS_SUCCESS) {
  519. memset(&wrqu, 0, sizeof(wrqu));
  520. wrqu.data.length = resp_ie_len;
  521. wireless_send_event(dev, IWEVASSOCRESPIE, &wrqu, resp_ie);
  522. }
  523. memset(&wrqu, 0, sizeof(wrqu));
  524. wrqu.ap_addr.sa_family = ARPHRD_ETHER;
  525. if (bssid && status == WLAN_STATUS_SUCCESS) {
  526. memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN);
  527. memcpy(wdev->wext.prev_bssid, bssid, ETH_ALEN);
  528. wdev->wext.prev_bssid_valid = true;
  529. }
  530. wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
  531. }
  532. #endif
  533. if (!bss && (status == WLAN_STATUS_SUCCESS)) {
  534. WARN_ON_ONCE(!wiphy_to_dev(wdev->wiphy)->ops->connect);
  535. bss = cfg80211_get_bss(wdev->wiphy, NULL, bssid,
  536. wdev->ssid, wdev->ssid_len,
  537. WLAN_CAPABILITY_ESS,
  538. WLAN_CAPABILITY_ESS);
  539. if (bss)
  540. cfg80211_hold_bss(bss_from_pub(bss));
  541. }
  542. if (wdev->current_bss) {
  543. cfg80211_unhold_bss(wdev->current_bss);
  544. cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
  545. wdev->current_bss = NULL;
  546. }
  547. if (status != WLAN_STATUS_SUCCESS) {
  548. kfree(wdev->connect_keys);
  549. wdev->connect_keys = NULL;
  550. wdev->ssid_len = 0;
  551. if (bss) {
  552. cfg80211_unhold_bss(bss_from_pub(bss));
  553. cfg80211_put_bss(wdev->wiphy, bss);
  554. }
  555. return;
  556. }
  557. if (WARN_ON(!bss))
  558. return;
  559. wdev->current_bss = bss_from_pub(bss);
  560. cfg80211_upload_connect_keys(wdev);
  561. rcu_read_lock();
  562. country_ie = ieee80211_bss_get_ie(bss, WLAN_EID_COUNTRY);
  563. if (!country_ie) {
  564. rcu_read_unlock();
  565. return;
  566. }
  567. country_ie = kmemdup(country_ie, 2 + country_ie[1], GFP_ATOMIC);
  568. rcu_read_unlock();
  569. if (!country_ie)
  570. return;
  571. /*
  572. * ieee80211_bss_get_ie() ensures we can access:
  573. * - country_ie + 2, the start of the country ie data, and
  574. * - and country_ie[1] which is the IE length
  575. */
  576. regulatory_hint_country_ie(wdev->wiphy, bss->channel->band,
  577. country_ie + 2, country_ie[1]);
  578. kfree(country_ie);
  579. }
  580. void cfg80211_connect_result(struct net_device *dev, const u8 *bssid,
  581. const u8 *req_ie, size_t req_ie_len,
  582. const u8 *resp_ie, size_t resp_ie_len,
  583. u16 status, gfp_t gfp)
  584. {
  585. struct wireless_dev *wdev = dev->ieee80211_ptr;
  586. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  587. struct cfg80211_event *ev;
  588. unsigned long flags;
  589. ev = kzalloc(sizeof(*ev) + req_ie_len + resp_ie_len, gfp);
  590. if (!ev)
  591. return;
  592. ev->type = EVENT_CONNECT_RESULT;
  593. if (bssid)
  594. memcpy(ev->cr.bssid, bssid, ETH_ALEN);
  595. if (req_ie_len) {
  596. ev->cr.req_ie = ((u8 *)ev) + sizeof(*ev);
  597. ev->cr.req_ie_len = req_ie_len;
  598. memcpy((void *)ev->cr.req_ie, req_ie, req_ie_len);
  599. }
  600. if (resp_ie_len) {
  601. ev->cr.resp_ie = ((u8 *)ev) + sizeof(*ev) + req_ie_len;
  602. ev->cr.resp_ie_len = resp_ie_len;
  603. memcpy((void *)ev->cr.resp_ie, resp_ie, resp_ie_len);
  604. }
  605. ev->cr.status = status;
  606. spin_lock_irqsave(&wdev->event_lock, flags);
  607. list_add_tail(&ev->list, &wdev->event_list);
  608. spin_unlock_irqrestore(&wdev->event_lock, flags);
  609. queue_work(cfg80211_wq, &rdev->event_work);
  610. }
  611. EXPORT_SYMBOL(cfg80211_connect_result);
  612. /* Consumes bss object one way or another */
  613. void __cfg80211_roamed(struct wireless_dev *wdev,
  614. struct cfg80211_bss *bss,
  615. const u8 *req_ie, size_t req_ie_len,
  616. const u8 *resp_ie, size_t resp_ie_len)
  617. {
  618. #ifdef CONFIG_CFG80211_WEXT
  619. union iwreq_data wrqu;
  620. #endif
  621. ASSERT_WDEV_LOCK(wdev);
  622. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
  623. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT))
  624. goto out;
  625. if (WARN_ON(!wdev->current_bss))
  626. goto out;
  627. cfg80211_unhold_bss(wdev->current_bss);
  628. cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
  629. wdev->current_bss = NULL;
  630. cfg80211_hold_bss(bss_from_pub(bss));
  631. wdev->current_bss = bss_from_pub(bss);
  632. nl80211_send_roamed(wiphy_to_dev(wdev->wiphy), wdev->netdev, bss->bssid,
  633. req_ie, req_ie_len, resp_ie, resp_ie_len,
  634. GFP_KERNEL);
  635. #ifdef CONFIG_CFG80211_WEXT
  636. if (req_ie) {
  637. memset(&wrqu, 0, sizeof(wrqu));
  638. wrqu.data.length = req_ie_len;
  639. wireless_send_event(wdev->netdev, IWEVASSOCREQIE,
  640. &wrqu, req_ie);
  641. }
  642. if (resp_ie) {
  643. memset(&wrqu, 0, sizeof(wrqu));
  644. wrqu.data.length = resp_ie_len;
  645. wireless_send_event(wdev->netdev, IWEVASSOCRESPIE,
  646. &wrqu, resp_ie);
  647. }
  648. memset(&wrqu, 0, sizeof(wrqu));
  649. wrqu.ap_addr.sa_family = ARPHRD_ETHER;
  650. memcpy(wrqu.ap_addr.sa_data, bss->bssid, ETH_ALEN);
  651. memcpy(wdev->wext.prev_bssid, bss->bssid, ETH_ALEN);
  652. wdev->wext.prev_bssid_valid = true;
  653. wireless_send_event(wdev->netdev, SIOCGIWAP, &wrqu, NULL);
  654. #endif
  655. return;
  656. out:
  657. cfg80211_put_bss(wdev->wiphy, bss);
  658. }
  659. void cfg80211_roamed(struct net_device *dev,
  660. struct ieee80211_channel *channel,
  661. const u8 *bssid,
  662. const u8 *req_ie, size_t req_ie_len,
  663. const u8 *resp_ie, size_t resp_ie_len, gfp_t gfp)
  664. {
  665. struct wireless_dev *wdev = dev->ieee80211_ptr;
  666. struct cfg80211_bss *bss;
  667. bss = cfg80211_get_bss(wdev->wiphy, channel, bssid, wdev->ssid,
  668. wdev->ssid_len, WLAN_CAPABILITY_ESS,
  669. WLAN_CAPABILITY_ESS);
  670. if (WARN_ON(!bss))
  671. return;
  672. cfg80211_roamed_bss(dev, bss, req_ie, req_ie_len, resp_ie,
  673. resp_ie_len, gfp);
  674. }
  675. EXPORT_SYMBOL(cfg80211_roamed);
  676. /* Consumes bss object one way or another */
  677. void cfg80211_roamed_bss(struct net_device *dev,
  678. struct cfg80211_bss *bss, const u8 *req_ie,
  679. size_t req_ie_len, const u8 *resp_ie,
  680. size_t resp_ie_len, gfp_t gfp)
  681. {
  682. struct wireless_dev *wdev = dev->ieee80211_ptr;
  683. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  684. struct cfg80211_event *ev;
  685. unsigned long flags;
  686. if (WARN_ON(!bss))
  687. return;
  688. ev = kzalloc(sizeof(*ev) + req_ie_len + resp_ie_len, gfp);
  689. if (!ev) {
  690. cfg80211_put_bss(wdev->wiphy, bss);
  691. return;
  692. }
  693. ev->type = EVENT_ROAMED;
  694. ev->rm.req_ie = ((u8 *)ev) + sizeof(*ev);
  695. ev->rm.req_ie_len = req_ie_len;
  696. memcpy((void *)ev->rm.req_ie, req_ie, req_ie_len);
  697. ev->rm.resp_ie = ((u8 *)ev) + sizeof(*ev) + req_ie_len;
  698. ev->rm.resp_ie_len = resp_ie_len;
  699. memcpy((void *)ev->rm.resp_ie, resp_ie, resp_ie_len);
  700. ev->rm.bss = bss;
  701. spin_lock_irqsave(&wdev->event_lock, flags);
  702. list_add_tail(&ev->list, &wdev->event_list);
  703. spin_unlock_irqrestore(&wdev->event_lock, flags);
  704. queue_work(cfg80211_wq, &rdev->event_work);
  705. }
  706. EXPORT_SYMBOL(cfg80211_roamed_bss);
  707. void __cfg80211_disconnected(struct net_device *dev, const u8 *ie,
  708. size_t ie_len, u16 reason, bool from_ap)
  709. {
  710. struct wireless_dev *wdev = dev->ieee80211_ptr;
  711. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  712. int i;
  713. #ifdef CONFIG_CFG80211_WEXT
  714. union iwreq_data wrqu;
  715. #endif
  716. ASSERT_WDEV_LOCK(wdev);
  717. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
  718. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT))
  719. return;
  720. if (wdev->current_bss) {
  721. cfg80211_unhold_bss(wdev->current_bss);
  722. cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
  723. }
  724. wdev->current_bss = NULL;
  725. wdev->ssid_len = 0;
  726. nl80211_send_disconnected(rdev, dev, reason, ie, ie_len, from_ap);
  727. /*
  728. * Delete all the keys ... pairwise keys can't really
  729. * exist any more anyway, but default keys might.
  730. */
  731. if (rdev->ops->del_key)
  732. for (i = 0; i < 6; i++)
  733. rdev_del_key(rdev, dev, i, false, NULL);
  734. rdev_set_qos_map(rdev, dev, NULL);
  735. #ifdef CONFIG_CFG80211_WEXT
  736. memset(&wrqu, 0, sizeof(wrqu));
  737. wrqu.ap_addr.sa_family = ARPHRD_ETHER;
  738. wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
  739. wdev->wext.connect.ssid_len = 0;
  740. #endif
  741. schedule_work(&cfg80211_disconnect_work);
  742. }
  743. void cfg80211_disconnected(struct net_device *dev, u16 reason,
  744. u8 *ie, size_t ie_len, gfp_t gfp)
  745. {
  746. struct wireless_dev *wdev = dev->ieee80211_ptr;
  747. struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy);
  748. struct cfg80211_event *ev;
  749. unsigned long flags;
  750. ev = kzalloc(sizeof(*ev) + ie_len, gfp);
  751. if (!ev)
  752. return;
  753. ev->type = EVENT_DISCONNECTED;
  754. ev->dc.ie = ((u8 *)ev) + sizeof(*ev);
  755. ev->dc.ie_len = ie_len;
  756. memcpy((void *)ev->dc.ie, ie, ie_len);
  757. ev->dc.reason = reason;
  758. spin_lock_irqsave(&wdev->event_lock, flags);
  759. list_add_tail(&ev->list, &wdev->event_list);
  760. spin_unlock_irqrestore(&wdev->event_lock, flags);
  761. queue_work(cfg80211_wq, &rdev->event_work);
  762. }
  763. EXPORT_SYMBOL(cfg80211_disconnected);
  764. /*
  765. * API calls for nl80211/wext compatibility code
  766. */
  767. int cfg80211_connect(struct cfg80211_registered_device *rdev,
  768. struct net_device *dev,
  769. struct cfg80211_connect_params *connect,
  770. struct cfg80211_cached_keys *connkeys,
  771. const u8 *prev_bssid)
  772. {
  773. struct wireless_dev *wdev = dev->ieee80211_ptr;
  774. int err;
  775. ASSERT_WDEV_LOCK(wdev);
  776. if (WARN_ON(wdev->connect_keys)) {
  777. kfree(wdev->connect_keys);
  778. wdev->connect_keys = NULL;
  779. }
  780. cfg80211_oper_and_ht_capa(&connect->ht_capa_mask,
  781. rdev->wiphy.ht_capa_mod_mask);
  782. if (connkeys && connkeys->def >= 0) {
  783. int idx;
  784. u32 cipher;
  785. idx = connkeys->def;
  786. cipher = connkeys->params[idx].cipher;
  787. /* If given a WEP key we may need it for shared key auth */
  788. if (cipher == WLAN_CIPHER_SUITE_WEP40 ||
  789. cipher == WLAN_CIPHER_SUITE_WEP104) {
  790. connect->key_idx = idx;
  791. connect->key = connkeys->params[idx].key;
  792. connect->key_len = connkeys->params[idx].key_len;
  793. /*
  794. * If ciphers are not set (e.g. when going through
  795. * iwconfig), we have to set them appropriately here.
  796. */
  797. if (connect->crypto.cipher_group == 0)
  798. connect->crypto.cipher_group = cipher;
  799. if (connect->crypto.n_ciphers_pairwise == 0) {
  800. connect->crypto.n_ciphers_pairwise = 1;
  801. connect->crypto.ciphers_pairwise[0] = cipher;
  802. }
  803. }
  804. }
  805. wdev->connect_keys = connkeys;
  806. memcpy(wdev->ssid, connect->ssid, connect->ssid_len);
  807. wdev->ssid_len = connect->ssid_len;
  808. if (!rdev->ops->connect)
  809. err = cfg80211_sme_connect(wdev, connect, prev_bssid);
  810. else
  811. err = rdev_connect(rdev, dev, connect);
  812. if (err) {
  813. wdev->connect_keys = NULL;
  814. wdev->ssid_len = 0;
  815. return err;
  816. }
  817. return 0;
  818. }
  819. int cfg80211_disconnect(struct cfg80211_registered_device *rdev,
  820. struct net_device *dev, u16 reason, bool wextev)
  821. {
  822. struct wireless_dev *wdev = dev->ieee80211_ptr;
  823. int err = 0;
  824. ASSERT_WDEV_LOCK(wdev);
  825. kfree(wdev->connect_keys);
  826. wdev->connect_keys = NULL;
  827. if (wdev->conn)
  828. err = cfg80211_sme_disconnect(wdev, reason);
  829. else if (!rdev->ops->disconnect)
  830. cfg80211_mlme_down(rdev, dev);
  831. else if (wdev->current_bss)
  832. err = rdev_disconnect(rdev, dev, reason);
  833. return err;
  834. }