mlme.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675
  1. /*
  2. * cfg80211 MLME SAP interface
  3. *
  4. * Copyright (c) 2009, Jouni Malinen <j@w1.fi>
  5. */
  6. #include <linux/kernel.h>
  7. #include <linux/module.h>
  8. #include <linux/netdevice.h>
  9. #include <linux/nl80211.h>
  10. #include <linux/wireless.h>
  11. #include <net/cfg80211.h>
  12. #include <net/iw_handler.h>
  13. #include "core.h"
  14. #include "nl80211.h"
  15. void cfg80211_send_rx_auth(struct net_device *dev, const u8 *buf, size_t len)
  16. {
  17. struct wireless_dev *wdev = dev->ieee80211_ptr;
  18. struct wiphy *wiphy = wdev->wiphy;
  19. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  20. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  21. u8 *bssid = mgmt->bssid;
  22. int i;
  23. u16 status = le16_to_cpu(mgmt->u.auth.status_code);
  24. bool done = false;
  25. wdev_lock(wdev);
  26. for (i = 0; i < MAX_AUTH_BSSES; i++) {
  27. if (wdev->authtry_bsses[i] &&
  28. memcmp(wdev->authtry_bsses[i]->pub.bssid, bssid,
  29. ETH_ALEN) == 0) {
  30. if (status == WLAN_STATUS_SUCCESS) {
  31. wdev->auth_bsses[i] = wdev->authtry_bsses[i];
  32. } else {
  33. cfg80211_unhold_bss(wdev->authtry_bsses[i]);
  34. cfg80211_put_bss(&wdev->authtry_bsses[i]->pub);
  35. }
  36. wdev->authtry_bsses[i] = NULL;
  37. done = true;
  38. break;
  39. }
  40. }
  41. WARN_ON(!done);
  42. nl80211_send_rx_auth(rdev, dev, buf, len, GFP_KERNEL);
  43. cfg80211_sme_rx_auth(dev, buf, len);
  44. wdev_unlock(wdev);
  45. }
  46. EXPORT_SYMBOL(cfg80211_send_rx_auth);
  47. void cfg80211_send_rx_assoc(struct net_device *dev, const u8 *buf, size_t len)
  48. {
  49. u16 status_code;
  50. struct wireless_dev *wdev = dev->ieee80211_ptr;
  51. struct wiphy *wiphy = wdev->wiphy;
  52. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  53. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  54. u8 *ie = mgmt->u.assoc_resp.variable;
  55. int i, ieoffs = offsetof(struct ieee80211_mgmt, u.assoc_resp.variable);
  56. struct cfg80211_internal_bss *bss = NULL;
  57. wdev_lock(wdev);
  58. status_code = le16_to_cpu(mgmt->u.assoc_resp.status_code);
  59. /*
  60. * This is a bit of a hack, we don't notify userspace of
  61. * a (re-)association reply if we tried to send a reassoc
  62. * and got a reject -- we only try again with an assoc
  63. * frame instead of reassoc.
  64. */
  65. if (status_code != WLAN_STATUS_SUCCESS && wdev->conn &&
  66. cfg80211_sme_failed_reassoc(wdev))
  67. goto out;
  68. nl80211_send_rx_assoc(rdev, dev, buf, len, GFP_KERNEL);
  69. if (status_code == WLAN_STATUS_SUCCESS) {
  70. for (i = 0; i < MAX_AUTH_BSSES; i++) {
  71. if (!wdev->auth_bsses[i])
  72. continue;
  73. if (memcmp(wdev->auth_bsses[i]->pub.bssid, mgmt->bssid,
  74. ETH_ALEN) == 0) {
  75. bss = wdev->auth_bsses[i];
  76. wdev->auth_bsses[i] = NULL;
  77. /* additional reference to drop hold */
  78. cfg80211_ref_bss(bss);
  79. break;
  80. }
  81. }
  82. WARN_ON(!bss);
  83. } else if (wdev->conn) {
  84. cfg80211_sme_failed_assoc(wdev);
  85. /*
  86. * do not call connect_result() now because the
  87. * sme will schedule work that does it later.
  88. */
  89. goto out;
  90. }
  91. if (!wdev->conn && wdev->sme_state == CFG80211_SME_IDLE) {
  92. /*
  93. * This is for the userspace SME, the CONNECTING
  94. * state will be changed to CONNECTED by
  95. * __cfg80211_connect_result() below.
  96. */
  97. wdev->sme_state = CFG80211_SME_CONNECTING;
  98. }
  99. /* this consumes one bss reference (unless bss is NULL) */
  100. __cfg80211_connect_result(dev, mgmt->bssid, NULL, 0, ie, len - ieoffs,
  101. status_code,
  102. status_code == WLAN_STATUS_SUCCESS,
  103. bss ? &bss->pub : NULL);
  104. /* drop hold now, and also reference acquired above */
  105. if (bss) {
  106. cfg80211_unhold_bss(bss);
  107. cfg80211_put_bss(&bss->pub);
  108. }
  109. out:
  110. wdev_unlock(wdev);
  111. }
  112. EXPORT_SYMBOL(cfg80211_send_rx_assoc);
  113. void __cfg80211_send_deauth(struct net_device *dev,
  114. const u8 *buf, size_t len)
  115. {
  116. struct wireless_dev *wdev = dev->ieee80211_ptr;
  117. struct wiphy *wiphy = wdev->wiphy;
  118. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  119. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  120. const u8 *bssid = mgmt->bssid;
  121. int i;
  122. ASSERT_WDEV_LOCK(wdev);
  123. nl80211_send_deauth(rdev, dev, buf, len, GFP_KERNEL);
  124. if (wdev->current_bss &&
  125. memcmp(wdev->current_bss->pub.bssid, bssid, ETH_ALEN) == 0) {
  126. cfg80211_unhold_bss(wdev->current_bss);
  127. cfg80211_put_bss(&wdev->current_bss->pub);
  128. wdev->current_bss = NULL;
  129. } else for (i = 0; i < MAX_AUTH_BSSES; i++) {
  130. if (wdev->auth_bsses[i] &&
  131. memcmp(wdev->auth_bsses[i]->pub.bssid, bssid, ETH_ALEN) == 0) {
  132. cfg80211_unhold_bss(wdev->auth_bsses[i]);
  133. cfg80211_put_bss(&wdev->auth_bsses[i]->pub);
  134. wdev->auth_bsses[i] = NULL;
  135. break;
  136. }
  137. if (wdev->authtry_bsses[i] &&
  138. memcmp(wdev->authtry_bsses[i]->pub.bssid, bssid, ETH_ALEN) == 0) {
  139. cfg80211_unhold_bss(wdev->authtry_bsses[i]);
  140. cfg80211_put_bss(&wdev->authtry_bsses[i]->pub);
  141. wdev->authtry_bsses[i] = NULL;
  142. break;
  143. }
  144. }
  145. if (wdev->sme_state == CFG80211_SME_CONNECTED) {
  146. u16 reason_code;
  147. bool from_ap;
  148. reason_code = le16_to_cpu(mgmt->u.deauth.reason_code);
  149. from_ap = memcmp(mgmt->sa, dev->dev_addr, ETH_ALEN) != 0;
  150. __cfg80211_disconnected(dev, NULL, 0, reason_code, from_ap);
  151. } else if (wdev->sme_state == CFG80211_SME_CONNECTING) {
  152. __cfg80211_connect_result(dev, mgmt->bssid, NULL, 0, NULL, 0,
  153. WLAN_STATUS_UNSPECIFIED_FAILURE,
  154. false, NULL);
  155. }
  156. }
  157. EXPORT_SYMBOL(__cfg80211_send_deauth);
  158. void cfg80211_send_deauth(struct net_device *dev, const u8 *buf, size_t len)
  159. {
  160. struct wireless_dev *wdev = dev->ieee80211_ptr;
  161. wdev_lock(wdev);
  162. __cfg80211_send_deauth(dev, buf, len);
  163. wdev_unlock(wdev);
  164. }
  165. EXPORT_SYMBOL(cfg80211_send_deauth);
  166. void __cfg80211_send_disassoc(struct net_device *dev,
  167. const u8 *buf, size_t len)
  168. {
  169. struct wireless_dev *wdev = dev->ieee80211_ptr;
  170. struct wiphy *wiphy = wdev->wiphy;
  171. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  172. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  173. const u8 *bssid = mgmt->bssid;
  174. int i;
  175. u16 reason_code;
  176. bool from_ap;
  177. bool done = false;
  178. ASSERT_WDEV_LOCK(wdev);
  179. nl80211_send_disassoc(rdev, dev, buf, len, GFP_KERNEL);
  180. if (wdev->sme_state != CFG80211_SME_CONNECTED)
  181. return;
  182. if (wdev->current_bss &&
  183. memcmp(wdev->current_bss->pub.bssid, bssid, ETH_ALEN) == 0) {
  184. for (i = 0; i < MAX_AUTH_BSSES; i++) {
  185. if (wdev->authtry_bsses[i] || wdev->auth_bsses[i])
  186. continue;
  187. wdev->auth_bsses[i] = wdev->current_bss;
  188. wdev->current_bss = NULL;
  189. done = true;
  190. cfg80211_sme_disassoc(dev, i);
  191. break;
  192. }
  193. WARN_ON(!done);
  194. } else
  195. WARN_ON(1);
  196. reason_code = le16_to_cpu(mgmt->u.disassoc.reason_code);
  197. from_ap = memcmp(mgmt->sa, dev->dev_addr, ETH_ALEN) != 0;
  198. __cfg80211_disconnected(dev, NULL, 0, reason_code, from_ap);
  199. }
  200. EXPORT_SYMBOL(__cfg80211_send_disassoc);
  201. void cfg80211_send_disassoc(struct net_device *dev, const u8 *buf, size_t len)
  202. {
  203. struct wireless_dev *wdev = dev->ieee80211_ptr;
  204. wdev_lock(wdev);
  205. __cfg80211_send_disassoc(dev, buf, len);
  206. wdev_unlock(wdev);
  207. }
  208. EXPORT_SYMBOL(cfg80211_send_disassoc);
  209. static void __cfg80211_auth_remove(struct wireless_dev *wdev, const u8 *addr)
  210. {
  211. int i;
  212. bool done = false;
  213. ASSERT_WDEV_LOCK(wdev);
  214. for (i = 0; addr && i < MAX_AUTH_BSSES; i++) {
  215. if (wdev->authtry_bsses[i] &&
  216. memcmp(wdev->authtry_bsses[i]->pub.bssid,
  217. addr, ETH_ALEN) == 0) {
  218. cfg80211_unhold_bss(wdev->authtry_bsses[i]);
  219. cfg80211_put_bss(&wdev->authtry_bsses[i]->pub);
  220. wdev->authtry_bsses[i] = NULL;
  221. done = true;
  222. break;
  223. }
  224. }
  225. WARN_ON(!done);
  226. }
  227. void __cfg80211_auth_canceled(struct net_device *dev, const u8 *addr)
  228. {
  229. __cfg80211_auth_remove(dev->ieee80211_ptr, addr);
  230. }
  231. EXPORT_SYMBOL(__cfg80211_auth_canceled);
  232. void cfg80211_send_auth_timeout(struct net_device *dev, const u8 *addr)
  233. {
  234. struct wireless_dev *wdev = dev->ieee80211_ptr;
  235. struct wiphy *wiphy = wdev->wiphy;
  236. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  237. wdev_lock(wdev);
  238. nl80211_send_auth_timeout(rdev, dev, addr, GFP_KERNEL);
  239. if (wdev->sme_state == CFG80211_SME_CONNECTING)
  240. __cfg80211_connect_result(dev, addr, NULL, 0, NULL, 0,
  241. WLAN_STATUS_UNSPECIFIED_FAILURE,
  242. false, NULL);
  243. __cfg80211_auth_remove(wdev, addr);
  244. wdev_unlock(wdev);
  245. }
  246. EXPORT_SYMBOL(cfg80211_send_auth_timeout);
  247. void cfg80211_send_assoc_timeout(struct net_device *dev, const u8 *addr)
  248. {
  249. struct wireless_dev *wdev = dev->ieee80211_ptr;
  250. struct wiphy *wiphy = wdev->wiphy;
  251. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  252. int i;
  253. bool done = false;
  254. wdev_lock(wdev);
  255. nl80211_send_assoc_timeout(rdev, dev, addr, GFP_KERNEL);
  256. if (wdev->sme_state == CFG80211_SME_CONNECTING)
  257. __cfg80211_connect_result(dev, addr, NULL, 0, NULL, 0,
  258. WLAN_STATUS_UNSPECIFIED_FAILURE,
  259. false, NULL);
  260. for (i = 0; addr && i < MAX_AUTH_BSSES; i++) {
  261. if (wdev->auth_bsses[i] &&
  262. memcmp(wdev->auth_bsses[i]->pub.bssid,
  263. addr, ETH_ALEN) == 0) {
  264. cfg80211_unhold_bss(wdev->auth_bsses[i]);
  265. cfg80211_put_bss(&wdev->auth_bsses[i]->pub);
  266. wdev->auth_bsses[i] = NULL;
  267. done = true;
  268. break;
  269. }
  270. }
  271. WARN_ON(!done);
  272. wdev_unlock(wdev);
  273. }
  274. EXPORT_SYMBOL(cfg80211_send_assoc_timeout);
  275. void cfg80211_michael_mic_failure(struct net_device *dev, const u8 *addr,
  276. enum nl80211_key_type key_type, int key_id,
  277. const u8 *tsc, gfp_t gfp)
  278. {
  279. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  280. struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
  281. #ifdef CONFIG_CFG80211_WEXT
  282. union iwreq_data wrqu;
  283. char *buf = kmalloc(128, gfp);
  284. if (buf) {
  285. sprintf(buf, "MLME-MICHAELMICFAILURE.indication("
  286. "keyid=%d %scast addr=%pM)", key_id,
  287. key_type == NL80211_KEYTYPE_GROUP ? "broad" : "uni",
  288. addr);
  289. memset(&wrqu, 0, sizeof(wrqu));
  290. wrqu.data.length = strlen(buf);
  291. wireless_send_event(dev, IWEVCUSTOM, &wrqu, buf);
  292. kfree(buf);
  293. }
  294. #endif
  295. nl80211_michael_mic_failure(rdev, dev, addr, key_type, key_id, tsc, gfp);
  296. }
  297. EXPORT_SYMBOL(cfg80211_michael_mic_failure);
  298. /* some MLME handling for userspace SME */
  299. int __cfg80211_mlme_auth(struct cfg80211_registered_device *rdev,
  300. struct net_device *dev,
  301. struct ieee80211_channel *chan,
  302. enum nl80211_auth_type auth_type,
  303. const u8 *bssid,
  304. const u8 *ssid, int ssid_len,
  305. const u8 *ie, int ie_len,
  306. const u8 *key, int key_len, int key_idx)
  307. {
  308. struct wireless_dev *wdev = dev->ieee80211_ptr;
  309. struct cfg80211_auth_request req;
  310. struct cfg80211_internal_bss *bss;
  311. int i, err, slot = -1, nfree = 0;
  312. ASSERT_WDEV_LOCK(wdev);
  313. if (auth_type == NL80211_AUTHTYPE_SHARED_KEY)
  314. if (!key || !key_len || key_idx < 0 || key_idx > 4)
  315. return -EINVAL;
  316. if (wdev->current_bss &&
  317. memcmp(bssid, wdev->current_bss->pub.bssid, ETH_ALEN) == 0)
  318. return -EALREADY;
  319. for (i = 0; i < MAX_AUTH_BSSES; i++) {
  320. if (wdev->authtry_bsses[i] &&
  321. memcmp(bssid, wdev->authtry_bsses[i]->pub.bssid,
  322. ETH_ALEN) == 0)
  323. return -EALREADY;
  324. if (wdev->auth_bsses[i] &&
  325. memcmp(bssid, wdev->auth_bsses[i]->pub.bssid,
  326. ETH_ALEN) == 0)
  327. return -EALREADY;
  328. }
  329. memset(&req, 0, sizeof(req));
  330. req.ie = ie;
  331. req.ie_len = ie_len;
  332. req.auth_type = auth_type;
  333. req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
  334. WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS);
  335. req.key = key;
  336. req.key_len = key_len;
  337. req.key_idx = key_idx;
  338. if (!req.bss)
  339. return -ENOENT;
  340. bss = bss_from_pub(req.bss);
  341. for (i = 0; i < MAX_AUTH_BSSES; i++) {
  342. if (!wdev->auth_bsses[i] && !wdev->authtry_bsses[i]) {
  343. slot = i;
  344. nfree++;
  345. }
  346. }
  347. /* we need one free slot for disassoc and one for this auth */
  348. if (nfree < 2) {
  349. err = -ENOSPC;
  350. goto out;
  351. }
  352. wdev->authtry_bsses[slot] = bss;
  353. cfg80211_hold_bss(bss);
  354. err = rdev->ops->auth(&rdev->wiphy, dev, &req);
  355. if (err) {
  356. wdev->authtry_bsses[slot] = NULL;
  357. cfg80211_unhold_bss(bss);
  358. }
  359. out:
  360. if (err)
  361. cfg80211_put_bss(req.bss);
  362. return err;
  363. }
  364. int cfg80211_mlme_auth(struct cfg80211_registered_device *rdev,
  365. struct net_device *dev, struct ieee80211_channel *chan,
  366. enum nl80211_auth_type auth_type, const u8 *bssid,
  367. const u8 *ssid, int ssid_len,
  368. const u8 *ie, int ie_len,
  369. const u8 *key, int key_len, int key_idx)
  370. {
  371. int err;
  372. wdev_lock(dev->ieee80211_ptr);
  373. err = __cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid,
  374. ssid, ssid_len, ie, ie_len,
  375. key, key_len, key_idx);
  376. wdev_unlock(dev->ieee80211_ptr);
  377. return err;
  378. }
  379. int __cfg80211_mlme_assoc(struct cfg80211_registered_device *rdev,
  380. struct net_device *dev,
  381. struct ieee80211_channel *chan,
  382. const u8 *bssid, const u8 *prev_bssid,
  383. const u8 *ssid, int ssid_len,
  384. const u8 *ie, int ie_len, bool use_mfp,
  385. struct cfg80211_crypto_settings *crypt)
  386. {
  387. struct wireless_dev *wdev = dev->ieee80211_ptr;
  388. struct cfg80211_assoc_request req;
  389. struct cfg80211_internal_bss *bss;
  390. int i, err, slot = -1;
  391. bool was_connected = false;
  392. ASSERT_WDEV_LOCK(wdev);
  393. memset(&req, 0, sizeof(req));
  394. if (wdev->current_bss && prev_bssid &&
  395. memcmp(wdev->current_bss->pub.bssid, prev_bssid, ETH_ALEN) == 0) {
  396. /*
  397. * Trying to reassociate: Allow this to proceed and let the old
  398. * association to be dropped when the new one is completed.
  399. */
  400. if (wdev->sme_state == CFG80211_SME_CONNECTED) {
  401. was_connected = true;
  402. wdev->sme_state = CFG80211_SME_CONNECTING;
  403. }
  404. } else if (wdev->current_bss)
  405. return -EALREADY;
  406. req.ie = ie;
  407. req.ie_len = ie_len;
  408. memcpy(&req.crypto, crypt, sizeof(req.crypto));
  409. req.use_mfp = use_mfp;
  410. req.prev_bssid = prev_bssid;
  411. req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
  412. WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS);
  413. if (!req.bss) {
  414. if (was_connected)
  415. wdev->sme_state = CFG80211_SME_CONNECTED;
  416. return -ENOENT;
  417. }
  418. bss = bss_from_pub(req.bss);
  419. for (i = 0; i < MAX_AUTH_BSSES; i++) {
  420. if (bss == wdev->auth_bsses[i]) {
  421. slot = i;
  422. break;
  423. }
  424. }
  425. if (slot < 0) {
  426. err = -ENOTCONN;
  427. goto out;
  428. }
  429. err = rdev->ops->assoc(&rdev->wiphy, dev, &req);
  430. out:
  431. if (err && was_connected)
  432. wdev->sme_state = CFG80211_SME_CONNECTED;
  433. /* still a reference in wdev->auth_bsses[slot] */
  434. cfg80211_put_bss(req.bss);
  435. return err;
  436. }
  437. int cfg80211_mlme_assoc(struct cfg80211_registered_device *rdev,
  438. struct net_device *dev,
  439. struct ieee80211_channel *chan,
  440. const u8 *bssid, const u8 *prev_bssid,
  441. const u8 *ssid, int ssid_len,
  442. const u8 *ie, int ie_len, bool use_mfp,
  443. struct cfg80211_crypto_settings *crypt)
  444. {
  445. struct wireless_dev *wdev = dev->ieee80211_ptr;
  446. int err;
  447. wdev_lock(wdev);
  448. err = __cfg80211_mlme_assoc(rdev, dev, chan, bssid, prev_bssid,
  449. ssid, ssid_len, ie, ie_len, use_mfp, crypt);
  450. wdev_unlock(wdev);
  451. return err;
  452. }
  453. int __cfg80211_mlme_deauth(struct cfg80211_registered_device *rdev,
  454. struct net_device *dev, const u8 *bssid,
  455. const u8 *ie, int ie_len, u16 reason)
  456. {
  457. struct wireless_dev *wdev = dev->ieee80211_ptr;
  458. struct cfg80211_deauth_request req;
  459. int i;
  460. ASSERT_WDEV_LOCK(wdev);
  461. memset(&req, 0, sizeof(req));
  462. req.reason_code = reason;
  463. req.ie = ie;
  464. req.ie_len = ie_len;
  465. if (wdev->current_bss &&
  466. memcmp(wdev->current_bss->pub.bssid, bssid, ETH_ALEN) == 0) {
  467. req.bss = &wdev->current_bss->pub;
  468. } else for (i = 0; i < MAX_AUTH_BSSES; i++) {
  469. if (wdev->auth_bsses[i] &&
  470. memcmp(bssid, wdev->auth_bsses[i]->pub.bssid, ETH_ALEN) == 0) {
  471. req.bss = &wdev->auth_bsses[i]->pub;
  472. break;
  473. }
  474. if (wdev->authtry_bsses[i] &&
  475. memcmp(bssid, wdev->authtry_bsses[i]->pub.bssid, ETH_ALEN) == 0) {
  476. req.bss = &wdev->authtry_bsses[i]->pub;
  477. break;
  478. }
  479. }
  480. if (!req.bss)
  481. return -ENOTCONN;
  482. return rdev->ops->deauth(&rdev->wiphy, dev, &req, wdev);
  483. }
  484. int cfg80211_mlme_deauth(struct cfg80211_registered_device *rdev,
  485. struct net_device *dev, const u8 *bssid,
  486. const u8 *ie, int ie_len, u16 reason)
  487. {
  488. struct wireless_dev *wdev = dev->ieee80211_ptr;
  489. int err;
  490. wdev_lock(wdev);
  491. err = __cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason);
  492. wdev_unlock(wdev);
  493. return err;
  494. }
  495. static int __cfg80211_mlme_disassoc(struct cfg80211_registered_device *rdev,
  496. struct net_device *dev, const u8 *bssid,
  497. const u8 *ie, int ie_len, u16 reason)
  498. {
  499. struct wireless_dev *wdev = dev->ieee80211_ptr;
  500. struct cfg80211_disassoc_request req;
  501. ASSERT_WDEV_LOCK(wdev);
  502. if (wdev->sme_state != CFG80211_SME_CONNECTED)
  503. return -ENOTCONN;
  504. if (WARN_ON(!wdev->current_bss))
  505. return -ENOTCONN;
  506. memset(&req, 0, sizeof(req));
  507. req.reason_code = reason;
  508. req.ie = ie;
  509. req.ie_len = ie_len;
  510. if (memcmp(wdev->current_bss->pub.bssid, bssid, ETH_ALEN) == 0)
  511. req.bss = &wdev->current_bss->pub;
  512. else
  513. return -ENOTCONN;
  514. return rdev->ops->disassoc(&rdev->wiphy, dev, &req, wdev);
  515. }
  516. int cfg80211_mlme_disassoc(struct cfg80211_registered_device *rdev,
  517. struct net_device *dev, const u8 *bssid,
  518. const u8 *ie, int ie_len, u16 reason)
  519. {
  520. struct wireless_dev *wdev = dev->ieee80211_ptr;
  521. int err;
  522. wdev_lock(wdev);
  523. err = __cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason);
  524. wdev_unlock(wdev);
  525. return err;
  526. }
  527. void cfg80211_mlme_down(struct cfg80211_registered_device *rdev,
  528. struct net_device *dev)
  529. {
  530. struct wireless_dev *wdev = dev->ieee80211_ptr;
  531. struct cfg80211_deauth_request req;
  532. int i;
  533. ASSERT_WDEV_LOCK(wdev);
  534. if (!rdev->ops->deauth)
  535. return;
  536. memset(&req, 0, sizeof(req));
  537. req.reason_code = WLAN_REASON_DEAUTH_LEAVING;
  538. req.ie = NULL;
  539. req.ie_len = 0;
  540. if (wdev->current_bss) {
  541. req.bss = &wdev->current_bss->pub;
  542. rdev->ops->deauth(&rdev->wiphy, dev, &req, wdev);
  543. if (wdev->current_bss) {
  544. cfg80211_unhold_bss(wdev->current_bss);
  545. cfg80211_put_bss(&wdev->current_bss->pub);
  546. wdev->current_bss = NULL;
  547. }
  548. }
  549. for (i = 0; i < MAX_AUTH_BSSES; i++) {
  550. if (wdev->auth_bsses[i]) {
  551. req.bss = &wdev->auth_bsses[i]->pub;
  552. rdev->ops->deauth(&rdev->wiphy, dev, &req, wdev);
  553. if (wdev->auth_bsses[i]) {
  554. cfg80211_unhold_bss(wdev->auth_bsses[i]);
  555. cfg80211_put_bss(&wdev->auth_bsses[i]->pub);
  556. wdev->auth_bsses[i] = NULL;
  557. }
  558. }
  559. if (wdev->authtry_bsses[i]) {
  560. req.bss = &wdev->authtry_bsses[i]->pub;
  561. rdev->ops->deauth(&rdev->wiphy, dev, &req, wdev);
  562. if (wdev->authtry_bsses[i]) {
  563. cfg80211_unhold_bss(wdev->authtry_bsses[i]);
  564. cfg80211_put_bss(&wdev->authtry_bsses[i]->pub);
  565. wdev->authtry_bsses[i] = NULL;
  566. }
  567. }
  568. }
  569. }