sme.c 43 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * SME code for cfg80211
  4. * both driver SME event handling and the SME implementation
  5. * (for nl80211's connect() and wext)
  6. *
  7. * Copyright 2009 Johannes Berg <[email protected]>
  8. * Copyright (C) 2009, 2020, 2022-2023 Intel Corporation. All rights reserved.
  9. * Copyright 2017 Intel Deutschland GmbH
  10. */
  11. #include <linux/etherdevice.h>
  12. #include <linux/if_arp.h>
  13. #include <linux/slab.h>
  14. #include <linux/workqueue.h>
  15. #include <linux/wireless.h>
  16. #include <linux/export.h>
  17. #include <net/iw_handler.h>
  18. #include <net/cfg80211.h>
  19. #include <net/rtnetlink.h>
  20. #include "nl80211.h"
  21. #include "reg.h"
  22. #include "rdev-ops.h"
  23. /*
  24. * Software SME in cfg80211, using auth/assoc/deauth calls to the
  25. * driver. This is for implementing nl80211's connect/disconnect
  26. * and wireless extensions (if configured.)
  27. */
  28. struct cfg80211_conn {
  29. struct cfg80211_connect_params params;
  30. /* these are sub-states of the _CONNECTING sme_state */
  31. enum {
  32. CFG80211_CONN_SCANNING,
  33. CFG80211_CONN_SCAN_AGAIN,
  34. CFG80211_CONN_AUTHENTICATE_NEXT,
  35. CFG80211_CONN_AUTHENTICATING,
  36. CFG80211_CONN_AUTH_FAILED_TIMEOUT,
  37. CFG80211_CONN_ASSOCIATE_NEXT,
  38. CFG80211_CONN_ASSOCIATING,
  39. CFG80211_CONN_ASSOC_FAILED,
  40. CFG80211_CONN_ASSOC_FAILED_TIMEOUT,
  41. CFG80211_CONN_DEAUTH,
  42. CFG80211_CONN_ABANDON,
  43. CFG80211_CONN_CONNECTED,
  44. } state;
  45. u8 bssid[ETH_ALEN], prev_bssid[ETH_ALEN];
  46. const u8 *ie;
  47. size_t ie_len;
  48. bool auto_auth, prev_bssid_valid;
  49. };
  50. static void cfg80211_sme_free(struct wireless_dev *wdev)
  51. {
  52. if (!wdev->conn)
  53. return;
  54. kfree(wdev->conn->ie);
  55. kfree(wdev->conn);
  56. wdev->conn = NULL;
  57. }
  58. static int cfg80211_conn_scan(struct wireless_dev *wdev)
  59. {
  60. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  61. struct cfg80211_scan_request *request;
  62. int n_channels, err;
  63. ASSERT_WDEV_LOCK(wdev);
  64. if (rdev->scan_req || rdev->scan_msg)
  65. return -EBUSY;
  66. if (wdev->conn->params.channel)
  67. n_channels = 1;
  68. else
  69. n_channels = ieee80211_get_num_supported_channels(wdev->wiphy);
  70. request = kzalloc(sizeof(*request) + sizeof(request->ssids[0]) +
  71. sizeof(request->channels[0]) * n_channels,
  72. GFP_KERNEL);
  73. if (!request)
  74. return -ENOMEM;
  75. if (wdev->conn->params.channel) {
  76. enum nl80211_band band = wdev->conn->params.channel->band;
  77. struct ieee80211_supported_band *sband =
  78. wdev->wiphy->bands[band];
  79. if (!sband) {
  80. kfree(request);
  81. return -EINVAL;
  82. }
  83. request->channels[0] = wdev->conn->params.channel;
  84. request->rates[band] = (1 << sband->n_bitrates) - 1;
  85. } else {
  86. int i = 0, j;
  87. enum nl80211_band band;
  88. struct ieee80211_supported_band *bands;
  89. struct ieee80211_channel *channel;
  90. for (band = 0; band < NUM_NL80211_BANDS; band++) {
  91. bands = wdev->wiphy->bands[band];
  92. if (!bands)
  93. continue;
  94. for (j = 0; j < bands->n_channels; j++) {
  95. channel = &bands->channels[j];
  96. if (channel->flags & IEEE80211_CHAN_DISABLED)
  97. continue;
  98. request->channels[i++] = channel;
  99. }
  100. request->rates[band] = (1 << bands->n_bitrates) - 1;
  101. }
  102. n_channels = i;
  103. }
  104. request->n_channels = n_channels;
  105. request->ssids = (void *)&request->channels[n_channels];
  106. request->n_ssids = 1;
  107. memcpy(request->ssids[0].ssid, wdev->conn->params.ssid,
  108. wdev->conn->params.ssid_len);
  109. request->ssids[0].ssid_len = wdev->conn->params.ssid_len;
  110. eth_broadcast_addr(request->bssid);
  111. request->wdev = wdev;
  112. request->wiphy = &rdev->wiphy;
  113. request->scan_start = jiffies;
  114. rdev->scan_req = request;
  115. err = rdev_scan(rdev, request);
  116. if (!err) {
  117. wdev->conn->state = CFG80211_CONN_SCANNING;
  118. nl80211_send_scan_start(rdev, wdev);
  119. dev_hold(wdev->netdev);
  120. } else {
  121. rdev->scan_req = NULL;
  122. kfree(request);
  123. }
  124. return err;
  125. }
  126. static int cfg80211_conn_do_work(struct wireless_dev *wdev,
  127. enum nl80211_timeout_reason *treason)
  128. {
  129. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  130. struct cfg80211_connect_params *params;
  131. struct cfg80211_auth_request auth_req = {};
  132. struct cfg80211_assoc_request req = {};
  133. int err;
  134. ASSERT_WDEV_LOCK(wdev);
  135. if (!wdev->conn)
  136. return 0;
  137. params = &wdev->conn->params;
  138. switch (wdev->conn->state) {
  139. case CFG80211_CONN_SCANNING:
  140. /* didn't find it during scan ... */
  141. return -ENOENT;
  142. case CFG80211_CONN_SCAN_AGAIN:
  143. return cfg80211_conn_scan(wdev);
  144. case CFG80211_CONN_AUTHENTICATE_NEXT:
  145. if (WARN_ON(!rdev->ops->auth))
  146. return -EOPNOTSUPP;
  147. wdev->conn->state = CFG80211_CONN_AUTHENTICATING;
  148. auth_req.key = params->key;
  149. auth_req.key_len = params->key_len;
  150. auth_req.key_idx = params->key_idx;
  151. auth_req.auth_type = params->auth_type;
  152. auth_req.bss = cfg80211_get_bss(&rdev->wiphy, params->channel,
  153. params->bssid,
  154. params->ssid, params->ssid_len,
  155. IEEE80211_BSS_TYPE_ESS,
  156. IEEE80211_PRIVACY_ANY);
  157. auth_req.link_id = -1;
  158. err = cfg80211_mlme_auth(rdev, wdev->netdev, &auth_req);
  159. cfg80211_put_bss(&rdev->wiphy, auth_req.bss);
  160. return err;
  161. case CFG80211_CONN_AUTH_FAILED_TIMEOUT:
  162. *treason = NL80211_TIMEOUT_AUTH;
  163. return -ENOTCONN;
  164. case CFG80211_CONN_ASSOCIATE_NEXT:
  165. if (WARN_ON(!rdev->ops->assoc))
  166. return -EOPNOTSUPP;
  167. wdev->conn->state = CFG80211_CONN_ASSOCIATING;
  168. if (wdev->conn->prev_bssid_valid)
  169. req.prev_bssid = wdev->conn->prev_bssid;
  170. req.ie = params->ie;
  171. req.ie_len = params->ie_len;
  172. req.use_mfp = params->mfp != NL80211_MFP_NO;
  173. req.crypto = params->crypto;
  174. req.flags = params->flags;
  175. req.ht_capa = params->ht_capa;
  176. req.ht_capa_mask = params->ht_capa_mask;
  177. req.vht_capa = params->vht_capa;
  178. req.vht_capa_mask = params->vht_capa_mask;
  179. req.link_id = -1;
  180. req.bss = cfg80211_get_bss(&rdev->wiphy, params->channel,
  181. params->bssid,
  182. params->ssid, params->ssid_len,
  183. IEEE80211_BSS_TYPE_ESS,
  184. IEEE80211_PRIVACY_ANY);
  185. if (!req.bss) {
  186. err = -ENOENT;
  187. } else {
  188. err = cfg80211_mlme_assoc(rdev, wdev->netdev, &req);
  189. cfg80211_put_bss(&rdev->wiphy, req.bss);
  190. }
  191. if (err)
  192. cfg80211_mlme_deauth(rdev, wdev->netdev, params->bssid,
  193. NULL, 0,
  194. WLAN_REASON_DEAUTH_LEAVING,
  195. false);
  196. return err;
  197. case CFG80211_CONN_ASSOC_FAILED_TIMEOUT:
  198. *treason = NL80211_TIMEOUT_ASSOC;
  199. fallthrough;
  200. case CFG80211_CONN_ASSOC_FAILED:
  201. cfg80211_mlme_deauth(rdev, wdev->netdev, params->bssid,
  202. NULL, 0,
  203. WLAN_REASON_DEAUTH_LEAVING, false);
  204. return -ENOTCONN;
  205. case CFG80211_CONN_DEAUTH:
  206. cfg80211_mlme_deauth(rdev, wdev->netdev, params->bssid,
  207. NULL, 0,
  208. WLAN_REASON_DEAUTH_LEAVING, false);
  209. fallthrough;
  210. case CFG80211_CONN_ABANDON:
  211. /* free directly, disconnected event already sent */
  212. cfg80211_sme_free(wdev);
  213. return 0;
  214. default:
  215. return 0;
  216. }
  217. }
  218. void cfg80211_conn_work(struct work_struct *work)
  219. {
  220. struct cfg80211_registered_device *rdev =
  221. container_of(work, struct cfg80211_registered_device, conn_work);
  222. struct wireless_dev *wdev;
  223. u8 bssid_buf[ETH_ALEN], *bssid = NULL;
  224. enum nl80211_timeout_reason treason;
  225. wiphy_lock(&rdev->wiphy);
  226. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  227. if (!wdev->netdev)
  228. continue;
  229. wdev_lock(wdev);
  230. if (!netif_running(wdev->netdev)) {
  231. wdev_unlock(wdev);
  232. continue;
  233. }
  234. if (!wdev->conn ||
  235. wdev->conn->state == CFG80211_CONN_CONNECTED) {
  236. wdev_unlock(wdev);
  237. continue;
  238. }
  239. if (wdev->conn->params.bssid) {
  240. memcpy(bssid_buf, wdev->conn->params.bssid, ETH_ALEN);
  241. bssid = bssid_buf;
  242. }
  243. treason = NL80211_TIMEOUT_UNSPECIFIED;
  244. if (cfg80211_conn_do_work(wdev, &treason)) {
  245. struct cfg80211_connect_resp_params cr;
  246. memset(&cr, 0, sizeof(cr));
  247. cr.status = -1;
  248. cr.links[0].bssid = bssid;
  249. cr.timeout_reason = treason;
  250. __cfg80211_connect_result(wdev->netdev, &cr, false);
  251. }
  252. wdev_unlock(wdev);
  253. }
  254. wiphy_unlock(&rdev->wiphy);
  255. }
  256. static void cfg80211_step_auth_next(struct cfg80211_conn *conn,
  257. struct cfg80211_bss *bss)
  258. {
  259. memcpy(conn->bssid, bss->bssid, ETH_ALEN);
  260. conn->params.bssid = conn->bssid;
  261. conn->params.channel = bss->channel;
  262. conn->state = CFG80211_CONN_AUTHENTICATE_NEXT;
  263. }
  264. /* Returned bss is reference counted and must be cleaned up appropriately. */
  265. static struct cfg80211_bss *cfg80211_get_conn_bss(struct wireless_dev *wdev)
  266. {
  267. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  268. struct cfg80211_bss *bss;
  269. ASSERT_WDEV_LOCK(wdev);
  270. bss = cfg80211_get_bss(wdev->wiphy, wdev->conn->params.channel,
  271. wdev->conn->params.bssid,
  272. wdev->conn->params.ssid,
  273. wdev->conn->params.ssid_len,
  274. wdev->conn_bss_type,
  275. IEEE80211_PRIVACY(wdev->conn->params.privacy));
  276. if (!bss)
  277. return NULL;
  278. cfg80211_step_auth_next(wdev->conn, bss);
  279. schedule_work(&rdev->conn_work);
  280. return bss;
  281. }
  282. static void __cfg80211_sme_scan_done(struct net_device *dev)
  283. {
  284. struct wireless_dev *wdev = dev->ieee80211_ptr;
  285. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  286. struct cfg80211_bss *bss;
  287. ASSERT_WDEV_LOCK(wdev);
  288. if (!wdev->conn)
  289. return;
  290. if (wdev->conn->state != CFG80211_CONN_SCANNING &&
  291. wdev->conn->state != CFG80211_CONN_SCAN_AGAIN)
  292. return;
  293. bss = cfg80211_get_conn_bss(wdev);
  294. if (bss)
  295. cfg80211_put_bss(&rdev->wiphy, bss);
  296. else
  297. schedule_work(&rdev->conn_work);
  298. }
  299. void cfg80211_sme_scan_done(struct net_device *dev)
  300. {
  301. struct wireless_dev *wdev = dev->ieee80211_ptr;
  302. wdev_lock(wdev);
  303. __cfg80211_sme_scan_done(dev);
  304. wdev_unlock(wdev);
  305. }
  306. void cfg80211_sme_rx_auth(struct wireless_dev *wdev, const u8 *buf, size_t len)
  307. {
  308. struct wiphy *wiphy = wdev->wiphy;
  309. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  310. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  311. u16 status_code = le16_to_cpu(mgmt->u.auth.status_code);
  312. ASSERT_WDEV_LOCK(wdev);
  313. if (!wdev->conn || wdev->conn->state == CFG80211_CONN_CONNECTED)
  314. return;
  315. if (status_code == WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG &&
  316. wdev->conn->auto_auth &&
  317. wdev->conn->params.auth_type != NL80211_AUTHTYPE_NETWORK_EAP) {
  318. /* select automatically between only open, shared, leap */
  319. switch (wdev->conn->params.auth_type) {
  320. case NL80211_AUTHTYPE_OPEN_SYSTEM:
  321. if (wdev->connect_keys)
  322. wdev->conn->params.auth_type =
  323. NL80211_AUTHTYPE_SHARED_KEY;
  324. else
  325. wdev->conn->params.auth_type =
  326. NL80211_AUTHTYPE_NETWORK_EAP;
  327. break;
  328. case NL80211_AUTHTYPE_SHARED_KEY:
  329. wdev->conn->params.auth_type =
  330. NL80211_AUTHTYPE_NETWORK_EAP;
  331. break;
  332. default:
  333. /* huh? */
  334. wdev->conn->params.auth_type =
  335. NL80211_AUTHTYPE_OPEN_SYSTEM;
  336. break;
  337. }
  338. wdev->conn->state = CFG80211_CONN_AUTHENTICATE_NEXT;
  339. schedule_work(&rdev->conn_work);
  340. } else if (status_code != WLAN_STATUS_SUCCESS) {
  341. struct cfg80211_connect_resp_params cr;
  342. memset(&cr, 0, sizeof(cr));
  343. cr.status = status_code;
  344. cr.links[0].bssid = mgmt->bssid;
  345. cr.timeout_reason = NL80211_TIMEOUT_UNSPECIFIED;
  346. __cfg80211_connect_result(wdev->netdev, &cr, false);
  347. } else if (wdev->conn->state == CFG80211_CONN_AUTHENTICATING) {
  348. wdev->conn->state = CFG80211_CONN_ASSOCIATE_NEXT;
  349. schedule_work(&rdev->conn_work);
  350. }
  351. }
  352. bool cfg80211_sme_rx_assoc_resp(struct wireless_dev *wdev, u16 status)
  353. {
  354. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  355. if (!wdev->conn)
  356. return false;
  357. if (status == WLAN_STATUS_SUCCESS) {
  358. wdev->conn->state = CFG80211_CONN_CONNECTED;
  359. return false;
  360. }
  361. if (wdev->conn->prev_bssid_valid) {
  362. /*
  363. * Some stupid APs don't accept reassoc, so we
  364. * need to fall back to trying regular assoc;
  365. * return true so no event is sent to userspace.
  366. */
  367. wdev->conn->prev_bssid_valid = false;
  368. wdev->conn->state = CFG80211_CONN_ASSOCIATE_NEXT;
  369. schedule_work(&rdev->conn_work);
  370. return true;
  371. }
  372. wdev->conn->state = CFG80211_CONN_ASSOC_FAILED;
  373. schedule_work(&rdev->conn_work);
  374. return false;
  375. }
  376. void cfg80211_sme_deauth(struct wireless_dev *wdev)
  377. {
  378. cfg80211_sme_free(wdev);
  379. }
  380. void cfg80211_sme_auth_timeout(struct wireless_dev *wdev)
  381. {
  382. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  383. if (!wdev->conn)
  384. return;
  385. wdev->conn->state = CFG80211_CONN_AUTH_FAILED_TIMEOUT;
  386. schedule_work(&rdev->conn_work);
  387. }
  388. void cfg80211_sme_disassoc(struct wireless_dev *wdev)
  389. {
  390. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  391. if (!wdev->conn)
  392. return;
  393. wdev->conn->state = CFG80211_CONN_DEAUTH;
  394. schedule_work(&rdev->conn_work);
  395. }
  396. void cfg80211_sme_assoc_timeout(struct wireless_dev *wdev)
  397. {
  398. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  399. if (!wdev->conn)
  400. return;
  401. wdev->conn->state = CFG80211_CONN_ASSOC_FAILED_TIMEOUT;
  402. schedule_work(&rdev->conn_work);
  403. }
  404. void cfg80211_sme_abandon_assoc(struct wireless_dev *wdev)
  405. {
  406. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  407. if (!wdev->conn)
  408. return;
  409. wdev->conn->state = CFG80211_CONN_ABANDON;
  410. schedule_work(&rdev->conn_work);
  411. }
  412. static void cfg80211_wdev_release_bsses(struct wireless_dev *wdev)
  413. {
  414. unsigned int link;
  415. for_each_valid_link(wdev, link) {
  416. if (!wdev->links[link].client.current_bss)
  417. continue;
  418. cfg80211_unhold_bss(wdev->links[link].client.current_bss);
  419. cfg80211_put_bss(wdev->wiphy,
  420. &wdev->links[link].client.current_bss->pub);
  421. wdev->links[link].client.current_bss = NULL;
  422. }
  423. }
  424. static int cfg80211_sme_get_conn_ies(struct wireless_dev *wdev,
  425. const u8 *ies, size_t ies_len,
  426. const u8 **out_ies, size_t *out_ies_len)
  427. {
  428. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  429. u8 *buf;
  430. size_t offs;
  431. if (!rdev->wiphy.extended_capabilities_len ||
  432. (ies && cfg80211_find_ie(WLAN_EID_EXT_CAPABILITY, ies, ies_len))) {
  433. *out_ies = kmemdup(ies, ies_len, GFP_KERNEL);
  434. if (!*out_ies)
  435. return -ENOMEM;
  436. *out_ies_len = ies_len;
  437. return 0;
  438. }
  439. buf = kmalloc(ies_len + rdev->wiphy.extended_capabilities_len + 2,
  440. GFP_KERNEL);
  441. if (!buf)
  442. return -ENOMEM;
  443. if (ies_len) {
  444. static const u8 before_extcapa[] = {
  445. /* not listing IEs expected to be created by driver */
  446. WLAN_EID_RSN,
  447. WLAN_EID_QOS_CAPA,
  448. WLAN_EID_RRM_ENABLED_CAPABILITIES,
  449. WLAN_EID_MOBILITY_DOMAIN,
  450. WLAN_EID_SUPPORTED_REGULATORY_CLASSES,
  451. WLAN_EID_BSS_COEX_2040,
  452. };
  453. offs = ieee80211_ie_split(ies, ies_len, before_extcapa,
  454. ARRAY_SIZE(before_extcapa), 0);
  455. memcpy(buf, ies, offs);
  456. /* leave a whole for extended capabilities IE */
  457. memcpy(buf + offs + rdev->wiphy.extended_capabilities_len + 2,
  458. ies + offs, ies_len - offs);
  459. } else {
  460. offs = 0;
  461. }
  462. /* place extended capabilities IE (with only driver capabilities) */
  463. buf[offs] = WLAN_EID_EXT_CAPABILITY;
  464. buf[offs + 1] = rdev->wiphy.extended_capabilities_len;
  465. memcpy(buf + offs + 2,
  466. rdev->wiphy.extended_capabilities,
  467. rdev->wiphy.extended_capabilities_len);
  468. *out_ies = buf;
  469. *out_ies_len = ies_len + rdev->wiphy.extended_capabilities_len + 2;
  470. return 0;
  471. }
  472. static int cfg80211_sme_connect(struct wireless_dev *wdev,
  473. struct cfg80211_connect_params *connect,
  474. const u8 *prev_bssid)
  475. {
  476. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  477. struct cfg80211_bss *bss;
  478. int err;
  479. if (!rdev->ops->auth || !rdev->ops->assoc)
  480. return -EOPNOTSUPP;
  481. cfg80211_wdev_release_bsses(wdev);
  482. if (wdev->connected) {
  483. cfg80211_sme_free(wdev);
  484. wdev->connected = false;
  485. }
  486. if (wdev->conn)
  487. return -EINPROGRESS;
  488. wdev->conn = kzalloc(sizeof(*wdev->conn), GFP_KERNEL);
  489. if (!wdev->conn)
  490. return -ENOMEM;
  491. /*
  492. * Copy all parameters, and treat explicitly IEs, BSSID, SSID.
  493. */
  494. memcpy(&wdev->conn->params, connect, sizeof(*connect));
  495. if (connect->bssid) {
  496. wdev->conn->params.bssid = wdev->conn->bssid;
  497. memcpy(wdev->conn->bssid, connect->bssid, ETH_ALEN);
  498. }
  499. if (cfg80211_sme_get_conn_ies(wdev, connect->ie, connect->ie_len,
  500. &wdev->conn->ie,
  501. &wdev->conn->params.ie_len)) {
  502. kfree(wdev->conn);
  503. wdev->conn = NULL;
  504. return -ENOMEM;
  505. }
  506. wdev->conn->params.ie = wdev->conn->ie;
  507. if (connect->auth_type == NL80211_AUTHTYPE_AUTOMATIC) {
  508. wdev->conn->auto_auth = true;
  509. /* start with open system ... should mostly work */
  510. wdev->conn->params.auth_type =
  511. NL80211_AUTHTYPE_OPEN_SYSTEM;
  512. } else {
  513. wdev->conn->auto_auth = false;
  514. }
  515. wdev->conn->params.ssid = wdev->u.client.ssid;
  516. wdev->conn->params.ssid_len = wdev->u.client.ssid_len;
  517. /* see if we have the bss already */
  518. bss = cfg80211_get_bss(wdev->wiphy, wdev->conn->params.channel,
  519. wdev->conn->params.bssid,
  520. wdev->conn->params.ssid,
  521. wdev->conn->params.ssid_len,
  522. wdev->conn_bss_type,
  523. IEEE80211_PRIVACY(wdev->conn->params.privacy));
  524. if (prev_bssid) {
  525. memcpy(wdev->conn->prev_bssid, prev_bssid, ETH_ALEN);
  526. wdev->conn->prev_bssid_valid = true;
  527. }
  528. /* we're good if we have a matching bss struct */
  529. if (bss) {
  530. enum nl80211_timeout_reason treason;
  531. cfg80211_step_auth_next(wdev->conn, bss);
  532. err = cfg80211_conn_do_work(wdev, &treason);
  533. cfg80211_put_bss(wdev->wiphy, bss);
  534. } else {
  535. /* otherwise we'll need to scan for the AP first */
  536. err = cfg80211_conn_scan(wdev);
  537. /*
  538. * If we can't scan right now, then we need to scan again
  539. * after the current scan finished, since the parameters
  540. * changed (unless we find a good AP anyway).
  541. */
  542. if (err == -EBUSY) {
  543. err = 0;
  544. wdev->conn->state = CFG80211_CONN_SCAN_AGAIN;
  545. }
  546. }
  547. if (err)
  548. cfg80211_sme_free(wdev);
  549. return err;
  550. }
  551. static int cfg80211_sme_disconnect(struct wireless_dev *wdev, u16 reason)
  552. {
  553. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  554. int err;
  555. if (!wdev->conn)
  556. return 0;
  557. if (!rdev->ops->deauth)
  558. return -EOPNOTSUPP;
  559. if (wdev->conn->state == CFG80211_CONN_SCANNING ||
  560. wdev->conn->state == CFG80211_CONN_SCAN_AGAIN) {
  561. err = 0;
  562. goto out;
  563. }
  564. /* wdev->conn->params.bssid must be set if > SCANNING */
  565. err = cfg80211_mlme_deauth(rdev, wdev->netdev,
  566. wdev->conn->params.bssid,
  567. NULL, 0, reason, false);
  568. out:
  569. cfg80211_sme_free(wdev);
  570. return err;
  571. }
  572. /*
  573. * code shared for in-device and software SME
  574. */
  575. static bool cfg80211_is_all_idle(void)
  576. {
  577. struct cfg80211_registered_device *rdev;
  578. struct wireless_dev *wdev;
  579. bool is_all_idle = true;
  580. /*
  581. * All devices must be idle as otherwise if you are actively
  582. * scanning some new beacon hints could be learned and would
  583. * count as new regulatory hints.
  584. * Also if there is any other active beaconing interface we
  585. * need not issue a disconnect hint and reset any info such
  586. * as chan dfs state, etc.
  587. */
  588. list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
  589. list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
  590. wdev_lock(wdev);
  591. if (wdev->conn || wdev->connected ||
  592. cfg80211_beaconing_iface_active(wdev))
  593. is_all_idle = false;
  594. wdev_unlock(wdev);
  595. }
  596. }
  597. return is_all_idle;
  598. }
  599. static void disconnect_work(struct work_struct *work)
  600. {
  601. rtnl_lock();
  602. if (cfg80211_is_all_idle())
  603. regulatory_hint_disconnect();
  604. rtnl_unlock();
  605. }
  606. DECLARE_WORK(cfg80211_disconnect_work, disconnect_work);
  607. static void
  608. cfg80211_connect_result_release_bsses(struct wireless_dev *wdev,
  609. struct cfg80211_connect_resp_params *cr)
  610. {
  611. unsigned int link;
  612. for_each_valid_link(cr, link) {
  613. if (!cr->links[link].bss)
  614. continue;
  615. cfg80211_unhold_bss(bss_from_pub(cr->links[link].bss));
  616. cfg80211_put_bss(wdev->wiphy, cr->links[link].bss);
  617. }
  618. }
  619. /*
  620. * API calls for drivers implementing connect/disconnect and
  621. * SME event handling
  622. */
  623. /* This method must consume bss one way or another */
  624. void __cfg80211_connect_result(struct net_device *dev,
  625. struct cfg80211_connect_resp_params *cr,
  626. bool wextev)
  627. {
  628. struct wireless_dev *wdev = dev->ieee80211_ptr;
  629. const struct element *country_elem = NULL;
  630. const struct element *ssid;
  631. const u8 *country_data;
  632. u8 country_datalen;
  633. #ifdef CONFIG_CFG80211_WEXT
  634. union iwreq_data wrqu;
  635. #endif
  636. unsigned int link;
  637. const u8 *connected_addr;
  638. bool bss_not_found = false;
  639. ASSERT_WDEV_LOCK(wdev);
  640. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
  641. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT))
  642. goto out;
  643. if (cr->valid_links) {
  644. if (WARN_ON(!cr->ap_mld_addr))
  645. goto out;
  646. for_each_valid_link(cr, link) {
  647. if (WARN_ON(!cr->links[link].addr))
  648. goto out;
  649. }
  650. if (WARN_ON(wdev->connect_keys))
  651. goto out;
  652. }
  653. wdev->unprot_beacon_reported = 0;
  654. nl80211_send_connect_result(wiphy_to_rdev(wdev->wiphy), dev, cr,
  655. GFP_KERNEL);
  656. connected_addr = cr->valid_links ? cr->ap_mld_addr : cr->links[0].bssid;
  657. #ifdef CONFIG_CFG80211_WEXT
  658. if (wextev && !cr->valid_links) {
  659. if (cr->req_ie && cr->status == WLAN_STATUS_SUCCESS) {
  660. memset(&wrqu, 0, sizeof(wrqu));
  661. wrqu.data.length = cr->req_ie_len;
  662. wireless_send_event(dev, IWEVASSOCREQIE, &wrqu,
  663. cr->req_ie);
  664. }
  665. if (cr->resp_ie && cr->status == WLAN_STATUS_SUCCESS) {
  666. memset(&wrqu, 0, sizeof(wrqu));
  667. wrqu.data.length = cr->resp_ie_len;
  668. wireless_send_event(dev, IWEVASSOCRESPIE, &wrqu,
  669. cr->resp_ie);
  670. }
  671. memset(&wrqu, 0, sizeof(wrqu));
  672. wrqu.ap_addr.sa_family = ARPHRD_ETHER;
  673. if (connected_addr && cr->status == WLAN_STATUS_SUCCESS) {
  674. memcpy(wrqu.ap_addr.sa_data, connected_addr, ETH_ALEN);
  675. memcpy(wdev->wext.prev_bssid, connected_addr, ETH_ALEN);
  676. wdev->wext.prev_bssid_valid = true;
  677. }
  678. wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
  679. }
  680. #endif
  681. if (cr->status == WLAN_STATUS_SUCCESS) {
  682. if (!wiphy_to_rdev(wdev->wiphy)->ops->connect) {
  683. for_each_valid_link(cr, link) {
  684. if (WARN_ON_ONCE(!cr->links[link].bss))
  685. break;
  686. }
  687. }
  688. for_each_valid_link(cr, link) {
  689. /* don't do extra lookups for failures */
  690. if (cr->links[link].status != WLAN_STATUS_SUCCESS)
  691. continue;
  692. if (cr->links[link].bss)
  693. continue;
  694. cr->links[link].bss =
  695. cfg80211_get_bss(wdev->wiphy, NULL,
  696. cr->links[link].bssid,
  697. wdev->u.client.ssid,
  698. wdev->u.client.ssid_len,
  699. wdev->conn_bss_type,
  700. IEEE80211_PRIVACY_ANY);
  701. if (!cr->links[link].bss) {
  702. bss_not_found = true;
  703. break;
  704. }
  705. cfg80211_hold_bss(bss_from_pub(cr->links[link].bss));
  706. }
  707. }
  708. cfg80211_wdev_release_bsses(wdev);
  709. if (cr->status != WLAN_STATUS_SUCCESS) {
  710. kfree_sensitive(wdev->connect_keys);
  711. wdev->connect_keys = NULL;
  712. wdev->u.client.ssid_len = 0;
  713. wdev->conn_owner_nlportid = 0;
  714. cfg80211_connect_result_release_bsses(wdev, cr);
  715. cfg80211_sme_free(wdev);
  716. return;
  717. }
  718. if (WARN_ON(bss_not_found)) {
  719. cfg80211_connect_result_release_bsses(wdev, cr);
  720. return;
  721. }
  722. memset(wdev->links, 0, sizeof(wdev->links));
  723. for_each_valid_link(cr, link) {
  724. if (cr->links[link].status == WLAN_STATUS_SUCCESS)
  725. continue;
  726. cr->valid_links &= ~BIT(link);
  727. /* don't require bss pointer for failed links */
  728. if (!cr->links[link].bss)
  729. continue;
  730. cfg80211_unhold_bss(bss_from_pub(cr->links[link].bss));
  731. cfg80211_put_bss(wdev->wiphy, cr->links[link].bss);
  732. }
  733. wdev->valid_links = cr->valid_links;
  734. for_each_valid_link(cr, link)
  735. wdev->links[link].client.current_bss =
  736. bss_from_pub(cr->links[link].bss);
  737. wdev->connected = true;
  738. ether_addr_copy(wdev->u.client.connected_addr, connected_addr);
  739. if (cr->valid_links) {
  740. for_each_valid_link(cr, link)
  741. memcpy(wdev->links[link].addr, cr->links[link].addr,
  742. ETH_ALEN);
  743. }
  744. if (!(wdev->wiphy->flags & WIPHY_FLAG_HAS_STATIC_WEP))
  745. cfg80211_upload_connect_keys(wdev);
  746. rcu_read_lock();
  747. for_each_valid_link(cr, link) {
  748. country_elem =
  749. ieee80211_bss_get_elem(cr->links[link].bss,
  750. WLAN_EID_COUNTRY);
  751. if (country_elem)
  752. break;
  753. }
  754. if (!country_elem) {
  755. rcu_read_unlock();
  756. return;
  757. }
  758. country_datalen = country_elem->datalen;
  759. country_data = kmemdup(country_elem->data, country_datalen, GFP_ATOMIC);
  760. rcu_read_unlock();
  761. if (!country_data)
  762. return;
  763. regulatory_hint_country_ie(wdev->wiphy,
  764. cr->links[link].bss->channel->band,
  765. country_data, country_datalen);
  766. kfree(country_data);
  767. if (!wdev->u.client.ssid_len) {
  768. rcu_read_lock();
  769. for_each_valid_link(cr, link) {
  770. ssid = ieee80211_bss_get_elem(cr->links[link].bss,
  771. WLAN_EID_SSID);
  772. if (!ssid || !ssid->datalen)
  773. continue;
  774. memcpy(wdev->u.client.ssid, ssid->data, ssid->datalen);
  775. wdev->u.client.ssid_len = ssid->datalen;
  776. break;
  777. }
  778. rcu_read_unlock();
  779. }
  780. return;
  781. out:
  782. for_each_valid_link(cr, link)
  783. cfg80211_put_bss(wdev->wiphy, cr->links[link].bss);
  784. }
  785. static void cfg80211_update_link_bss(struct wireless_dev *wdev,
  786. struct cfg80211_bss **bss)
  787. {
  788. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  789. struct cfg80211_internal_bss *ibss;
  790. if (!*bss)
  791. return;
  792. ibss = bss_from_pub(*bss);
  793. if (list_empty(&ibss->list)) {
  794. struct cfg80211_bss *found = NULL, *tmp = *bss;
  795. found = cfg80211_get_bss(wdev->wiphy, NULL,
  796. (*bss)->bssid,
  797. wdev->u.client.ssid,
  798. wdev->u.client.ssid_len,
  799. wdev->conn_bss_type,
  800. IEEE80211_PRIVACY_ANY);
  801. if (found) {
  802. /* The same BSS is already updated so use it
  803. * instead, as it has latest info.
  804. */
  805. *bss = found;
  806. } else {
  807. /* Update with BSS provided by driver, it will
  808. * be freshly added and ref cnted, we can free
  809. * the old one.
  810. *
  811. * signal_valid can be false, as we are not
  812. * expecting the BSS to be found.
  813. *
  814. * keep the old timestamp to avoid confusion
  815. */
  816. cfg80211_bss_update(rdev, ibss, false,
  817. ibss->ts);
  818. }
  819. cfg80211_put_bss(wdev->wiphy, tmp);
  820. }
  821. }
  822. /* Consumes bss object(s) one way or another */
  823. void cfg80211_connect_done(struct net_device *dev,
  824. struct cfg80211_connect_resp_params *params,
  825. gfp_t gfp)
  826. {
  827. struct wireless_dev *wdev = dev->ieee80211_ptr;
  828. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  829. struct cfg80211_event *ev;
  830. unsigned long flags;
  831. u8 *next;
  832. size_t link_info_size = 0;
  833. unsigned int link;
  834. for_each_valid_link(params, link) {
  835. cfg80211_update_link_bss(wdev, &params->links[link].bss);
  836. link_info_size += params->links[link].bssid ? ETH_ALEN : 0;
  837. link_info_size += params->links[link].addr ? ETH_ALEN : 0;
  838. }
  839. ev = kzalloc(sizeof(*ev) + (params->ap_mld_addr ? ETH_ALEN : 0) +
  840. params->req_ie_len + params->resp_ie_len +
  841. params->fils.kek_len + params->fils.pmk_len +
  842. (params->fils.pmkid ? WLAN_PMKID_LEN : 0) + link_info_size,
  843. gfp);
  844. if (!ev) {
  845. for_each_valid_link(params, link)
  846. cfg80211_put_bss(wdev->wiphy,
  847. params->links[link].bss);
  848. return;
  849. }
  850. ev->type = EVENT_CONNECT_RESULT;
  851. next = ((u8 *)ev) + sizeof(*ev);
  852. if (params->ap_mld_addr) {
  853. ev->cr.ap_mld_addr = next;
  854. memcpy((void *)ev->cr.ap_mld_addr, params->ap_mld_addr,
  855. ETH_ALEN);
  856. next += ETH_ALEN;
  857. }
  858. if (params->req_ie_len) {
  859. ev->cr.req_ie = next;
  860. ev->cr.req_ie_len = params->req_ie_len;
  861. memcpy((void *)ev->cr.req_ie, params->req_ie,
  862. params->req_ie_len);
  863. next += params->req_ie_len;
  864. }
  865. if (params->resp_ie_len) {
  866. ev->cr.resp_ie = next;
  867. ev->cr.resp_ie_len = params->resp_ie_len;
  868. memcpy((void *)ev->cr.resp_ie, params->resp_ie,
  869. params->resp_ie_len);
  870. next += params->resp_ie_len;
  871. }
  872. if (params->fils.kek_len) {
  873. ev->cr.fils.kek = next;
  874. ev->cr.fils.kek_len = params->fils.kek_len;
  875. memcpy((void *)ev->cr.fils.kek, params->fils.kek,
  876. params->fils.kek_len);
  877. next += params->fils.kek_len;
  878. }
  879. if (params->fils.pmk_len) {
  880. ev->cr.fils.pmk = next;
  881. ev->cr.fils.pmk_len = params->fils.pmk_len;
  882. memcpy((void *)ev->cr.fils.pmk, params->fils.pmk,
  883. params->fils.pmk_len);
  884. next += params->fils.pmk_len;
  885. }
  886. if (params->fils.pmkid) {
  887. ev->cr.fils.pmkid = next;
  888. memcpy((void *)ev->cr.fils.pmkid, params->fils.pmkid,
  889. WLAN_PMKID_LEN);
  890. next += WLAN_PMKID_LEN;
  891. }
  892. ev->cr.fils.update_erp_next_seq_num = params->fils.update_erp_next_seq_num;
  893. if (params->fils.update_erp_next_seq_num)
  894. ev->cr.fils.erp_next_seq_num = params->fils.erp_next_seq_num;
  895. ev->cr.valid_links = params->valid_links;
  896. for_each_valid_link(params, link) {
  897. if (params->links[link].bss)
  898. cfg80211_hold_bss(
  899. bss_from_pub(params->links[link].bss));
  900. ev->cr.links[link].bss = params->links[link].bss;
  901. if (params->links[link].addr) {
  902. ev->cr.links[link].addr = next;
  903. memcpy((void *)ev->cr.links[link].addr,
  904. params->links[link].addr,
  905. ETH_ALEN);
  906. next += ETH_ALEN;
  907. }
  908. if (params->links[link].bssid) {
  909. ev->cr.links[link].bssid = next;
  910. memcpy((void *)ev->cr.links[link].bssid,
  911. params->links[link].bssid,
  912. ETH_ALEN);
  913. next += ETH_ALEN;
  914. }
  915. }
  916. ev->cr.status = params->status;
  917. ev->cr.timeout_reason = params->timeout_reason;
  918. spin_lock_irqsave(&wdev->event_lock, flags);
  919. list_add_tail(&ev->list, &wdev->event_list);
  920. spin_unlock_irqrestore(&wdev->event_lock, flags);
  921. queue_work(cfg80211_wq, &rdev->event_work);
  922. }
  923. EXPORT_SYMBOL(cfg80211_connect_done);
  924. /* Consumes bss object one way or another */
  925. void __cfg80211_roamed(struct wireless_dev *wdev,
  926. struct cfg80211_roam_info *info)
  927. {
  928. #ifdef CONFIG_CFG80211_WEXT
  929. union iwreq_data wrqu;
  930. #endif
  931. unsigned int link;
  932. const u8 *connected_addr;
  933. ASSERT_WDEV_LOCK(wdev);
  934. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
  935. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT))
  936. goto out;
  937. if (WARN_ON(!wdev->connected))
  938. goto out;
  939. if (info->valid_links) {
  940. if (WARN_ON(!info->ap_mld_addr))
  941. goto out;
  942. for_each_valid_link(info, link) {
  943. if (WARN_ON(!info->links[link].addr))
  944. goto out;
  945. }
  946. }
  947. cfg80211_wdev_release_bsses(wdev);
  948. for_each_valid_link(info, link) {
  949. if (WARN_ON(!info->links[link].bss))
  950. goto out;
  951. }
  952. memset(wdev->links, 0, sizeof(wdev->links));
  953. wdev->valid_links = info->valid_links;
  954. for_each_valid_link(info, link) {
  955. cfg80211_hold_bss(bss_from_pub(info->links[link].bss));
  956. wdev->links[link].client.current_bss =
  957. bss_from_pub(info->links[link].bss);
  958. }
  959. connected_addr = info->valid_links ?
  960. info->ap_mld_addr :
  961. info->links[0].bss->bssid;
  962. ether_addr_copy(wdev->u.client.connected_addr, connected_addr);
  963. if (info->valid_links) {
  964. for_each_valid_link(info, link)
  965. memcpy(wdev->links[link].addr, info->links[link].addr,
  966. ETH_ALEN);
  967. }
  968. wdev->unprot_beacon_reported = 0;
  969. nl80211_send_roamed(wiphy_to_rdev(wdev->wiphy),
  970. wdev->netdev, info, GFP_KERNEL);
  971. #ifdef CONFIG_CFG80211_WEXT
  972. if (!info->valid_links) {
  973. if (info->req_ie) {
  974. memset(&wrqu, 0, sizeof(wrqu));
  975. wrqu.data.length = info->req_ie_len;
  976. wireless_send_event(wdev->netdev, IWEVASSOCREQIE,
  977. &wrqu, info->req_ie);
  978. }
  979. if (info->resp_ie) {
  980. memset(&wrqu, 0, sizeof(wrqu));
  981. wrqu.data.length = info->resp_ie_len;
  982. wireless_send_event(wdev->netdev, IWEVASSOCRESPIE,
  983. &wrqu, info->resp_ie);
  984. }
  985. memset(&wrqu, 0, sizeof(wrqu));
  986. wrqu.ap_addr.sa_family = ARPHRD_ETHER;
  987. memcpy(wrqu.ap_addr.sa_data, connected_addr, ETH_ALEN);
  988. memcpy(wdev->wext.prev_bssid, connected_addr, ETH_ALEN);
  989. wdev->wext.prev_bssid_valid = true;
  990. wireless_send_event(wdev->netdev, SIOCGIWAP, &wrqu, NULL);
  991. }
  992. #endif
  993. return;
  994. out:
  995. for_each_valid_link(info, link)
  996. cfg80211_put_bss(wdev->wiphy, info->links[link].bss);
  997. }
  998. /* Consumes info->links.bss object(s) one way or another */
  999. void cfg80211_roamed(struct net_device *dev, struct cfg80211_roam_info *info,
  1000. gfp_t gfp)
  1001. {
  1002. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1003. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  1004. struct cfg80211_event *ev;
  1005. unsigned long flags;
  1006. u8 *next;
  1007. unsigned int link;
  1008. size_t link_info_size = 0;
  1009. bool bss_not_found = false;
  1010. for_each_valid_link(info, link) {
  1011. link_info_size += info->links[link].addr ? ETH_ALEN : 0;
  1012. link_info_size += info->links[link].bssid ? ETH_ALEN : 0;
  1013. if (info->links[link].bss)
  1014. continue;
  1015. info->links[link].bss =
  1016. cfg80211_get_bss(wdev->wiphy,
  1017. info->links[link].channel,
  1018. info->links[link].bssid,
  1019. wdev->u.client.ssid,
  1020. wdev->u.client.ssid_len,
  1021. wdev->conn_bss_type,
  1022. IEEE80211_PRIVACY_ANY);
  1023. if (!info->links[link].bss) {
  1024. bss_not_found = true;
  1025. break;
  1026. }
  1027. }
  1028. if (WARN_ON(bss_not_found))
  1029. goto out;
  1030. ev = kzalloc(sizeof(*ev) + info->req_ie_len + info->resp_ie_len +
  1031. info->fils.kek_len + info->fils.pmk_len +
  1032. (info->fils.pmkid ? WLAN_PMKID_LEN : 0) +
  1033. (info->ap_mld_addr ? ETH_ALEN : 0) + link_info_size, gfp);
  1034. if (!ev)
  1035. goto out;
  1036. ev->type = EVENT_ROAMED;
  1037. next = ((u8 *)ev) + sizeof(*ev);
  1038. if (info->req_ie_len) {
  1039. ev->rm.req_ie = next;
  1040. ev->rm.req_ie_len = info->req_ie_len;
  1041. memcpy((void *)ev->rm.req_ie, info->req_ie, info->req_ie_len);
  1042. next += info->req_ie_len;
  1043. }
  1044. if (info->resp_ie_len) {
  1045. ev->rm.resp_ie = next;
  1046. ev->rm.resp_ie_len = info->resp_ie_len;
  1047. memcpy((void *)ev->rm.resp_ie, info->resp_ie,
  1048. info->resp_ie_len);
  1049. next += info->resp_ie_len;
  1050. }
  1051. if (info->fils.kek_len) {
  1052. ev->rm.fils.kek = next;
  1053. ev->rm.fils.kek_len = info->fils.kek_len;
  1054. memcpy((void *)ev->rm.fils.kek, info->fils.kek,
  1055. info->fils.kek_len);
  1056. next += info->fils.kek_len;
  1057. }
  1058. if (info->fils.pmk_len) {
  1059. ev->rm.fils.pmk = next;
  1060. ev->rm.fils.pmk_len = info->fils.pmk_len;
  1061. memcpy((void *)ev->rm.fils.pmk, info->fils.pmk,
  1062. info->fils.pmk_len);
  1063. next += info->fils.pmk_len;
  1064. }
  1065. if (info->fils.pmkid) {
  1066. ev->rm.fils.pmkid = next;
  1067. memcpy((void *)ev->rm.fils.pmkid, info->fils.pmkid,
  1068. WLAN_PMKID_LEN);
  1069. next += WLAN_PMKID_LEN;
  1070. }
  1071. ev->rm.fils.update_erp_next_seq_num = info->fils.update_erp_next_seq_num;
  1072. if (info->fils.update_erp_next_seq_num)
  1073. ev->rm.fils.erp_next_seq_num = info->fils.erp_next_seq_num;
  1074. if (info->ap_mld_addr) {
  1075. ev->rm.ap_mld_addr = next;
  1076. memcpy((void *)ev->rm.ap_mld_addr, info->ap_mld_addr,
  1077. ETH_ALEN);
  1078. next += ETH_ALEN;
  1079. }
  1080. ev->rm.valid_links = info->valid_links;
  1081. for_each_valid_link(info, link) {
  1082. ev->rm.links[link].bss = info->links[link].bss;
  1083. if (info->links[link].addr) {
  1084. ev->rm.links[link].addr = next;
  1085. memcpy((void *)ev->rm.links[link].addr,
  1086. info->links[link].addr,
  1087. ETH_ALEN);
  1088. next += ETH_ALEN;
  1089. }
  1090. if (info->links[link].bssid) {
  1091. ev->rm.links[link].bssid = next;
  1092. memcpy((void *)ev->rm.links[link].bssid,
  1093. info->links[link].bssid,
  1094. ETH_ALEN);
  1095. next += ETH_ALEN;
  1096. }
  1097. }
  1098. spin_lock_irqsave(&wdev->event_lock, flags);
  1099. list_add_tail(&ev->list, &wdev->event_list);
  1100. spin_unlock_irqrestore(&wdev->event_lock, flags);
  1101. queue_work(cfg80211_wq, &rdev->event_work);
  1102. return;
  1103. out:
  1104. for_each_valid_link(info, link)
  1105. cfg80211_put_bss(wdev->wiphy, info->links[link].bss);
  1106. }
  1107. EXPORT_SYMBOL(cfg80211_roamed);
  1108. void __cfg80211_port_authorized(struct wireless_dev *wdev, const u8 *peer_addr,
  1109. const u8 *td_bitmap, u8 td_bitmap_len)
  1110. {
  1111. ASSERT_WDEV_LOCK(wdev);
  1112. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
  1113. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT &&
  1114. wdev->iftype != NL80211_IFTYPE_AP &&
  1115. wdev->iftype != NL80211_IFTYPE_P2P_GO))
  1116. return;
  1117. if (wdev->iftype == NL80211_IFTYPE_STATION ||
  1118. wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) {
  1119. if (WARN_ON(!wdev->connected) ||
  1120. WARN_ON(!ether_addr_equal(wdev->u.client.connected_addr, peer_addr)))
  1121. return;
  1122. }
  1123. nl80211_send_port_authorized(wiphy_to_rdev(wdev->wiphy), wdev->netdev,
  1124. peer_addr, td_bitmap, td_bitmap_len);
  1125. }
  1126. void cfg80211_port_authorized(struct net_device *dev, const u8 *peer_addr,
  1127. const u8 *td_bitmap, u8 td_bitmap_len, gfp_t gfp)
  1128. {
  1129. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1130. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  1131. struct cfg80211_event *ev;
  1132. unsigned long flags;
  1133. if (WARN_ON(!peer_addr))
  1134. return;
  1135. ev = kzalloc(sizeof(*ev) + td_bitmap_len, gfp);
  1136. if (!ev)
  1137. return;
  1138. ev->type = EVENT_PORT_AUTHORIZED;
  1139. memcpy(ev->pa.peer_addr, peer_addr, ETH_ALEN);
  1140. ev->pa.td_bitmap = ((u8 *)ev) + sizeof(*ev);
  1141. ev->pa.td_bitmap_len = td_bitmap_len;
  1142. memcpy((void *)ev->pa.td_bitmap, td_bitmap, td_bitmap_len);
  1143. /*
  1144. * Use the wdev event list so that if there are pending
  1145. * connected/roamed events, they will be reported first.
  1146. */
  1147. spin_lock_irqsave(&wdev->event_lock, flags);
  1148. list_add_tail(&ev->list, &wdev->event_list);
  1149. spin_unlock_irqrestore(&wdev->event_lock, flags);
  1150. queue_work(cfg80211_wq, &rdev->event_work);
  1151. }
  1152. EXPORT_SYMBOL(cfg80211_port_authorized);
  1153. void __cfg80211_disconnected(struct net_device *dev, const u8 *ie,
  1154. size_t ie_len, u16 reason, bool from_ap)
  1155. {
  1156. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1157. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  1158. int i;
  1159. #ifdef CONFIG_CFG80211_WEXT
  1160. union iwreq_data wrqu;
  1161. #endif
  1162. ASSERT_WDEV_LOCK(wdev);
  1163. if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION &&
  1164. wdev->iftype != NL80211_IFTYPE_P2P_CLIENT))
  1165. return;
  1166. cfg80211_wdev_release_bsses(wdev);
  1167. wdev->connected = false;
  1168. wdev->u.client.ssid_len = 0;
  1169. wdev->conn_owner_nlportid = 0;
  1170. kfree_sensitive(wdev->connect_keys);
  1171. wdev->connect_keys = NULL;
  1172. nl80211_send_disconnected(rdev, dev, reason, ie, ie_len, from_ap);
  1173. /* stop critical protocol if supported */
  1174. if (rdev->ops->crit_proto_stop && rdev->crit_proto_nlportid) {
  1175. rdev->crit_proto_nlportid = 0;
  1176. rdev_crit_proto_stop(rdev, wdev);
  1177. }
  1178. /*
  1179. * Delete all the keys ... pairwise keys can't really
  1180. * exist any more anyway, but default keys might.
  1181. */
  1182. if (rdev->ops->del_key) {
  1183. int max_key_idx = 5;
  1184. if (wiphy_ext_feature_isset(
  1185. wdev->wiphy,
  1186. NL80211_EXT_FEATURE_BEACON_PROTECTION) ||
  1187. wiphy_ext_feature_isset(
  1188. wdev->wiphy,
  1189. NL80211_EXT_FEATURE_BEACON_PROTECTION_CLIENT))
  1190. max_key_idx = 7;
  1191. for (i = 0; i <= max_key_idx; i++)
  1192. rdev_del_key(rdev, dev, -1, i, false, NULL);
  1193. }
  1194. rdev_set_qos_map(rdev, dev, NULL);
  1195. #ifdef CONFIG_CFG80211_WEXT
  1196. memset(&wrqu, 0, sizeof(wrqu));
  1197. wrqu.ap_addr.sa_family = ARPHRD_ETHER;
  1198. wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
  1199. wdev->wext.connect.ssid_len = 0;
  1200. #endif
  1201. schedule_work(&cfg80211_disconnect_work);
  1202. }
  1203. void cfg80211_disconnected(struct net_device *dev, u16 reason,
  1204. const u8 *ie, size_t ie_len,
  1205. bool locally_generated, gfp_t gfp)
  1206. {
  1207. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1208. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  1209. struct cfg80211_event *ev;
  1210. unsigned long flags;
  1211. ev = kzalloc(sizeof(*ev) + ie_len, gfp);
  1212. if (!ev)
  1213. return;
  1214. ev->type = EVENT_DISCONNECTED;
  1215. ev->dc.ie = ((u8 *)ev) + sizeof(*ev);
  1216. ev->dc.ie_len = ie_len;
  1217. memcpy((void *)ev->dc.ie, ie, ie_len);
  1218. ev->dc.reason = reason;
  1219. ev->dc.locally_generated = locally_generated;
  1220. spin_lock_irqsave(&wdev->event_lock, flags);
  1221. list_add_tail(&ev->list, &wdev->event_list);
  1222. spin_unlock_irqrestore(&wdev->event_lock, flags);
  1223. queue_work(cfg80211_wq, &rdev->event_work);
  1224. }
  1225. EXPORT_SYMBOL(cfg80211_disconnected);
  1226. /*
  1227. * API calls for nl80211/wext compatibility code
  1228. */
  1229. int cfg80211_connect(struct cfg80211_registered_device *rdev,
  1230. struct net_device *dev,
  1231. struct cfg80211_connect_params *connect,
  1232. struct cfg80211_cached_keys *connkeys,
  1233. const u8 *prev_bssid)
  1234. {
  1235. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1236. int err;
  1237. ASSERT_WDEV_LOCK(wdev);
  1238. /*
  1239. * If we have an ssid_len, we're trying to connect or are
  1240. * already connected, so reject a new SSID unless it's the
  1241. * same (which is the case for re-association.)
  1242. */
  1243. if (wdev->u.client.ssid_len &&
  1244. (wdev->u.client.ssid_len != connect->ssid_len ||
  1245. memcmp(wdev->u.client.ssid, connect->ssid, wdev->u.client.ssid_len)))
  1246. return -EALREADY;
  1247. /*
  1248. * If connected, reject (re-)association unless prev_bssid
  1249. * matches the current BSSID.
  1250. */
  1251. if (wdev->connected) {
  1252. if (!prev_bssid)
  1253. return -EALREADY;
  1254. if (!ether_addr_equal(prev_bssid,
  1255. wdev->u.client.connected_addr))
  1256. return -ENOTCONN;
  1257. }
  1258. /*
  1259. * Reject if we're in the process of connecting with WEP,
  1260. * this case isn't very interesting and trying to handle
  1261. * it would make the code much more complex.
  1262. */
  1263. if (wdev->connect_keys)
  1264. return -EINPROGRESS;
  1265. cfg80211_oper_and_ht_capa(&connect->ht_capa_mask,
  1266. rdev->wiphy.ht_capa_mod_mask);
  1267. cfg80211_oper_and_vht_capa(&connect->vht_capa_mask,
  1268. rdev->wiphy.vht_capa_mod_mask);
  1269. if (connkeys && connkeys->def >= 0) {
  1270. int idx;
  1271. u32 cipher;
  1272. idx = connkeys->def;
  1273. cipher = connkeys->params[idx].cipher;
  1274. /* If given a WEP key we may need it for shared key auth */
  1275. if (cipher == WLAN_CIPHER_SUITE_WEP40 ||
  1276. cipher == WLAN_CIPHER_SUITE_WEP104) {
  1277. connect->key_idx = idx;
  1278. connect->key = connkeys->params[idx].key;
  1279. connect->key_len = connkeys->params[idx].key_len;
  1280. /*
  1281. * If ciphers are not set (e.g. when going through
  1282. * iwconfig), we have to set them appropriately here.
  1283. */
  1284. if (connect->crypto.cipher_group == 0)
  1285. connect->crypto.cipher_group = cipher;
  1286. if (connect->crypto.n_ciphers_pairwise == 0) {
  1287. connect->crypto.n_ciphers_pairwise = 1;
  1288. connect->crypto.ciphers_pairwise[0] = cipher;
  1289. }
  1290. }
  1291. connect->crypto.wep_keys = connkeys->params;
  1292. connect->crypto.wep_tx_key = connkeys->def;
  1293. } else {
  1294. if (WARN_ON(connkeys))
  1295. return -EINVAL;
  1296. /* connect can point to wdev->wext.connect which
  1297. * can hold key data from a previous connection
  1298. */
  1299. connect->key = NULL;
  1300. connect->key_len = 0;
  1301. connect->key_idx = 0;
  1302. }
  1303. wdev->connect_keys = connkeys;
  1304. memcpy(wdev->u.client.ssid, connect->ssid, connect->ssid_len);
  1305. wdev->u.client.ssid_len = connect->ssid_len;
  1306. wdev->conn_bss_type = connect->pbss ? IEEE80211_BSS_TYPE_PBSS :
  1307. IEEE80211_BSS_TYPE_ESS;
  1308. if (!rdev->ops->connect)
  1309. err = cfg80211_sme_connect(wdev, connect, prev_bssid);
  1310. else
  1311. err = rdev_connect(rdev, dev, connect);
  1312. if (err) {
  1313. wdev->connect_keys = NULL;
  1314. /*
  1315. * This could be reassoc getting refused, don't clear
  1316. * ssid_len in that case.
  1317. */
  1318. if (!wdev->connected)
  1319. wdev->u.client.ssid_len = 0;
  1320. return err;
  1321. }
  1322. return 0;
  1323. }
  1324. int cfg80211_disconnect(struct cfg80211_registered_device *rdev,
  1325. struct net_device *dev, u16 reason, bool wextev)
  1326. {
  1327. struct wireless_dev *wdev = dev->ieee80211_ptr;
  1328. int err = 0;
  1329. ASSERT_WDEV_LOCK(wdev);
  1330. kfree_sensitive(wdev->connect_keys);
  1331. wdev->connect_keys = NULL;
  1332. wdev->conn_owner_nlportid = 0;
  1333. if (wdev->conn)
  1334. err = cfg80211_sme_disconnect(wdev, reason);
  1335. else if (!rdev->ops->disconnect)
  1336. cfg80211_mlme_down(rdev, dev);
  1337. else if (wdev->u.client.ssid_len)
  1338. err = rdev_disconnect(rdev, dev, reason);
  1339. /*
  1340. * Clear ssid_len unless we actually were fully connected,
  1341. * in which case cfg80211_disconnected() will take care of
  1342. * this later.
  1343. */
  1344. if (!wdev->connected)
  1345. wdev->u.client.ssid_len = 0;
  1346. return err;
  1347. }
  1348. /*
  1349. * Used to clean up after the connection / connection attempt owner socket
  1350. * disconnects
  1351. */
  1352. void cfg80211_autodisconnect_wk(struct work_struct *work)
  1353. {
  1354. struct wireless_dev *wdev =
  1355. container_of(work, struct wireless_dev, disconnect_wk);
  1356. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  1357. wiphy_lock(wdev->wiphy);
  1358. wdev_lock(wdev);
  1359. if (wdev->conn_owner_nlportid) {
  1360. switch (wdev->iftype) {
  1361. case NL80211_IFTYPE_ADHOC:
  1362. __cfg80211_leave_ibss(rdev, wdev->netdev, false);
  1363. break;
  1364. case NL80211_IFTYPE_AP:
  1365. case NL80211_IFTYPE_P2P_GO:
  1366. __cfg80211_stop_ap(rdev, wdev->netdev, -1, false);
  1367. break;
  1368. case NL80211_IFTYPE_MESH_POINT:
  1369. __cfg80211_leave_mesh(rdev, wdev->netdev);
  1370. break;
  1371. case NL80211_IFTYPE_STATION:
  1372. case NL80211_IFTYPE_P2P_CLIENT:
  1373. /*
  1374. * Use disconnect_bssid if still connecting and
  1375. * ops->disconnect not implemented. Otherwise we can
  1376. * use cfg80211_disconnect.
  1377. */
  1378. if (rdev->ops->disconnect || wdev->connected)
  1379. cfg80211_disconnect(rdev, wdev->netdev,
  1380. WLAN_REASON_DEAUTH_LEAVING,
  1381. true);
  1382. else
  1383. cfg80211_mlme_deauth(rdev, wdev->netdev,
  1384. wdev->disconnect_bssid,
  1385. NULL, 0,
  1386. WLAN_REASON_DEAUTH_LEAVING,
  1387. false);
  1388. break;
  1389. default:
  1390. break;
  1391. }
  1392. }
  1393. wdev_unlock(wdev);
  1394. wiphy_unlock(wdev->wiphy);
  1395. }