mlme.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830
  1. /*
  2. * cfg80211 MLME SAP interface
  3. *
  4. * Copyright (c) 2009, Jouni Malinen <j@w1.fi>
  5. * Copyright (c) 2015 Intel Deutschland GmbH
  6. */
  7. #include <linux/kernel.h>
  8. #include <linux/module.h>
  9. #include <linux/etherdevice.h>
  10. #include <linux/netdevice.h>
  11. #include <linux/nl80211.h>
  12. #include <linux/slab.h>
  13. #include <linux/wireless.h>
  14. #include <net/cfg80211.h>
  15. #include <net/iw_handler.h>
  16. #include "core.h"
  17. #include "nl80211.h"
  18. #include "rdev-ops.h"
  19. void cfg80211_rx_assoc_resp(struct net_device *dev, struct cfg80211_bss *bss,
  20. const u8 *buf, size_t len, int uapsd_queues)
  21. {
  22. struct wireless_dev *wdev = dev->ieee80211_ptr;
  23. struct wiphy *wiphy = wdev->wiphy;
  24. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  25. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  26. u8 *ie = mgmt->u.assoc_resp.variable;
  27. int ieoffs = offsetof(struct ieee80211_mgmt, u.assoc_resp.variable);
  28. u16 status_code = le16_to_cpu(mgmt->u.assoc_resp.status_code);
  29. trace_cfg80211_send_rx_assoc(dev, bss);
  30. /*
  31. * This is a bit of a hack, we don't notify userspace of
  32. * a (re-)association reply if we tried to send a reassoc
  33. * and got a reject -- we only try again with an assoc
  34. * frame instead of reassoc.
  35. */
  36. if (cfg80211_sme_rx_assoc_resp(wdev, status_code)) {
  37. cfg80211_unhold_bss(bss_from_pub(bss));
  38. cfg80211_put_bss(wiphy, bss);
  39. return;
  40. }
  41. nl80211_send_rx_assoc(rdev, dev, buf, len, GFP_KERNEL, uapsd_queues);
  42. /* update current_bss etc., consumes the bss reference */
  43. __cfg80211_connect_result(dev, mgmt->bssid, NULL, 0, ie, len - ieoffs,
  44. status_code,
  45. status_code == WLAN_STATUS_SUCCESS, bss);
  46. }
  47. EXPORT_SYMBOL(cfg80211_rx_assoc_resp);
  48. static void cfg80211_process_auth(struct wireless_dev *wdev,
  49. const u8 *buf, size_t len)
  50. {
  51. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  52. nl80211_send_rx_auth(rdev, wdev->netdev, buf, len, GFP_KERNEL);
  53. cfg80211_sme_rx_auth(wdev, buf, len);
  54. }
  55. static void cfg80211_process_deauth(struct wireless_dev *wdev,
  56. const u8 *buf, size_t len)
  57. {
  58. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  59. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  60. const u8 *bssid = mgmt->bssid;
  61. u16 reason_code = le16_to_cpu(mgmt->u.deauth.reason_code);
  62. bool from_ap = !ether_addr_equal(mgmt->sa, wdev->netdev->dev_addr);
  63. nl80211_send_deauth(rdev, wdev->netdev, buf, len, GFP_KERNEL);
  64. if (!wdev->current_bss ||
  65. !ether_addr_equal(wdev->current_bss->pub.bssid, bssid))
  66. return;
  67. __cfg80211_disconnected(wdev->netdev, NULL, 0, reason_code, from_ap);
  68. cfg80211_sme_deauth(wdev);
  69. }
  70. static void cfg80211_process_disassoc(struct wireless_dev *wdev,
  71. const u8 *buf, size_t len)
  72. {
  73. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  74. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
  75. const u8 *bssid = mgmt->bssid;
  76. u16 reason_code = le16_to_cpu(mgmt->u.disassoc.reason_code);
  77. bool from_ap = !ether_addr_equal(mgmt->sa, wdev->netdev->dev_addr);
  78. nl80211_send_disassoc(rdev, wdev->netdev, buf, len, GFP_KERNEL);
  79. if (WARN_ON(!wdev->current_bss ||
  80. !ether_addr_equal(wdev->current_bss->pub.bssid, bssid)))
  81. return;
  82. __cfg80211_disconnected(wdev->netdev, NULL, 0, reason_code, from_ap);
  83. cfg80211_sme_disassoc(wdev);
  84. }
  85. void cfg80211_rx_mlme_mgmt(struct net_device *dev, const u8 *buf, size_t len)
  86. {
  87. struct wireless_dev *wdev = dev->ieee80211_ptr;
  88. struct ieee80211_mgmt *mgmt = (void *)buf;
  89. ASSERT_WDEV_LOCK(wdev);
  90. trace_cfg80211_rx_mlme_mgmt(dev, buf, len);
  91. if (WARN_ON(len < 2))
  92. return;
  93. if (ieee80211_is_auth(mgmt->frame_control))
  94. cfg80211_process_auth(wdev, buf, len);
  95. else if (ieee80211_is_deauth(mgmt->frame_control))
  96. cfg80211_process_deauth(wdev, buf, len);
  97. else if (ieee80211_is_disassoc(mgmt->frame_control))
  98. cfg80211_process_disassoc(wdev, buf, len);
  99. }
  100. EXPORT_SYMBOL(cfg80211_rx_mlme_mgmt);
  101. void cfg80211_auth_timeout(struct net_device *dev, const u8 *addr)
  102. {
  103. struct wireless_dev *wdev = dev->ieee80211_ptr;
  104. struct wiphy *wiphy = wdev->wiphy;
  105. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  106. trace_cfg80211_send_auth_timeout(dev, addr);
  107. nl80211_send_auth_timeout(rdev, dev, addr, GFP_KERNEL);
  108. cfg80211_sme_auth_timeout(wdev);
  109. }
  110. EXPORT_SYMBOL(cfg80211_auth_timeout);
  111. void cfg80211_assoc_timeout(struct net_device *dev, struct cfg80211_bss *bss)
  112. {
  113. struct wireless_dev *wdev = dev->ieee80211_ptr;
  114. struct wiphy *wiphy = wdev->wiphy;
  115. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  116. trace_cfg80211_send_assoc_timeout(dev, bss->bssid);
  117. nl80211_send_assoc_timeout(rdev, dev, bss->bssid, GFP_KERNEL);
  118. cfg80211_sme_assoc_timeout(wdev);
  119. cfg80211_unhold_bss(bss_from_pub(bss));
  120. cfg80211_put_bss(wiphy, bss);
  121. }
  122. EXPORT_SYMBOL(cfg80211_assoc_timeout);
  123. void cfg80211_tx_mlme_mgmt(struct net_device *dev, const u8 *buf, size_t len)
  124. {
  125. struct wireless_dev *wdev = dev->ieee80211_ptr;
  126. struct ieee80211_mgmt *mgmt = (void *)buf;
  127. ASSERT_WDEV_LOCK(wdev);
  128. trace_cfg80211_tx_mlme_mgmt(dev, buf, len);
  129. if (WARN_ON(len < 2))
  130. return;
  131. if (ieee80211_is_deauth(mgmt->frame_control))
  132. cfg80211_process_deauth(wdev, buf, len);
  133. else
  134. cfg80211_process_disassoc(wdev, buf, len);
  135. }
  136. EXPORT_SYMBOL(cfg80211_tx_mlme_mgmt);
  137. void cfg80211_michael_mic_failure(struct net_device *dev, const u8 *addr,
  138. enum nl80211_key_type key_type, int key_id,
  139. const u8 *tsc, gfp_t gfp)
  140. {
  141. struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
  142. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  143. #ifdef CONFIG_CFG80211_WEXT
  144. union iwreq_data wrqu;
  145. char *buf = kmalloc(128, gfp);
  146. if (buf) {
  147. sprintf(buf, "MLME-MICHAELMICFAILURE.indication("
  148. "keyid=%d %scast addr=%pM)", key_id,
  149. key_type == NL80211_KEYTYPE_GROUP ? "broad" : "uni",
  150. addr);
  151. memset(&wrqu, 0, sizeof(wrqu));
  152. wrqu.data.length = strlen(buf);
  153. wireless_send_event(dev, IWEVCUSTOM, &wrqu, buf);
  154. kfree(buf);
  155. }
  156. #endif
  157. trace_cfg80211_michael_mic_failure(dev, addr, key_type, key_id, tsc);
  158. nl80211_michael_mic_failure(rdev, dev, addr, key_type, key_id, tsc, gfp);
  159. }
  160. EXPORT_SYMBOL(cfg80211_michael_mic_failure);
  161. /* some MLME handling for userspace SME */
  162. int cfg80211_mlme_auth(struct cfg80211_registered_device *rdev,
  163. struct net_device *dev,
  164. struct ieee80211_channel *chan,
  165. enum nl80211_auth_type auth_type,
  166. const u8 *bssid,
  167. const u8 *ssid, int ssid_len,
  168. const u8 *ie, int ie_len,
  169. const u8 *key, int key_len, int key_idx,
  170. const u8 *sae_data, int sae_data_len)
  171. {
  172. struct wireless_dev *wdev = dev->ieee80211_ptr;
  173. struct cfg80211_auth_request req = {
  174. .ie = ie,
  175. .ie_len = ie_len,
  176. .sae_data = sae_data,
  177. .sae_data_len = sae_data_len,
  178. .auth_type = auth_type,
  179. .key = key,
  180. .key_len = key_len,
  181. .key_idx = key_idx,
  182. };
  183. int err;
  184. ASSERT_WDEV_LOCK(wdev);
  185. if (auth_type == NL80211_AUTHTYPE_SHARED_KEY)
  186. if (!key || !key_len || key_idx < 0 || key_idx > 4)
  187. return -EINVAL;
  188. if (wdev->current_bss &&
  189. ether_addr_equal(bssid, wdev->current_bss->pub.bssid))
  190. return -EALREADY;
  191. req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
  192. IEEE80211_BSS_TYPE_ESS,
  193. IEEE80211_PRIVACY_ANY);
  194. if (!req.bss)
  195. return -ENOENT;
  196. err = rdev_auth(rdev, dev, &req);
  197. cfg80211_put_bss(&rdev->wiphy, req.bss);
  198. return err;
  199. }
  200. /* Do a logical ht_capa &= ht_capa_mask. */
  201. void cfg80211_oper_and_ht_capa(struct ieee80211_ht_cap *ht_capa,
  202. const struct ieee80211_ht_cap *ht_capa_mask)
  203. {
  204. int i;
  205. u8 *p1, *p2;
  206. if (!ht_capa_mask) {
  207. memset(ht_capa, 0, sizeof(*ht_capa));
  208. return;
  209. }
  210. p1 = (u8*)(ht_capa);
  211. p2 = (u8*)(ht_capa_mask);
  212. for (i = 0; i<sizeof(*ht_capa); i++)
  213. p1[i] &= p2[i];
  214. }
  215. /* Do a logical ht_capa &= ht_capa_mask. */
  216. void cfg80211_oper_and_vht_capa(struct ieee80211_vht_cap *vht_capa,
  217. const struct ieee80211_vht_cap *vht_capa_mask)
  218. {
  219. int i;
  220. u8 *p1, *p2;
  221. if (!vht_capa_mask) {
  222. memset(vht_capa, 0, sizeof(*vht_capa));
  223. return;
  224. }
  225. p1 = (u8*)(vht_capa);
  226. p2 = (u8*)(vht_capa_mask);
  227. for (i = 0; i < sizeof(*vht_capa); i++)
  228. p1[i] &= p2[i];
  229. }
  230. int cfg80211_mlme_assoc(struct cfg80211_registered_device *rdev,
  231. struct net_device *dev,
  232. struct ieee80211_channel *chan,
  233. const u8 *bssid,
  234. const u8 *ssid, int ssid_len,
  235. struct cfg80211_assoc_request *req)
  236. {
  237. struct wireless_dev *wdev = dev->ieee80211_ptr;
  238. int err;
  239. ASSERT_WDEV_LOCK(wdev);
  240. if (wdev->current_bss &&
  241. (!req->prev_bssid || !ether_addr_equal(wdev->current_bss->pub.bssid,
  242. req->prev_bssid)))
  243. return -EALREADY;
  244. cfg80211_oper_and_ht_capa(&req->ht_capa_mask,
  245. rdev->wiphy.ht_capa_mod_mask);
  246. cfg80211_oper_and_vht_capa(&req->vht_capa_mask,
  247. rdev->wiphy.vht_capa_mod_mask);
  248. req->bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
  249. IEEE80211_BSS_TYPE_ESS,
  250. IEEE80211_PRIVACY_ANY);
  251. if (!req->bss)
  252. return -ENOENT;
  253. err = rdev_assoc(rdev, dev, req);
  254. if (!err)
  255. cfg80211_hold_bss(bss_from_pub(req->bss));
  256. else
  257. cfg80211_put_bss(&rdev->wiphy, req->bss);
  258. return err;
  259. }
  260. int cfg80211_mlme_deauth(struct cfg80211_registered_device *rdev,
  261. struct net_device *dev, const u8 *bssid,
  262. const u8 *ie, int ie_len, u16 reason,
  263. bool local_state_change)
  264. {
  265. struct wireless_dev *wdev = dev->ieee80211_ptr;
  266. struct cfg80211_deauth_request req = {
  267. .bssid = bssid,
  268. .reason_code = reason,
  269. .ie = ie,
  270. .ie_len = ie_len,
  271. .local_state_change = local_state_change,
  272. };
  273. ASSERT_WDEV_LOCK(wdev);
  274. if (local_state_change &&
  275. (!wdev->current_bss ||
  276. !ether_addr_equal(wdev->current_bss->pub.bssid, bssid)))
  277. return 0;
  278. return rdev_deauth(rdev, dev, &req);
  279. }
  280. int cfg80211_mlme_disassoc(struct cfg80211_registered_device *rdev,
  281. struct net_device *dev, const u8 *bssid,
  282. const u8 *ie, int ie_len, u16 reason,
  283. bool local_state_change)
  284. {
  285. struct wireless_dev *wdev = dev->ieee80211_ptr;
  286. struct cfg80211_disassoc_request req = {
  287. .reason_code = reason,
  288. .local_state_change = local_state_change,
  289. .ie = ie,
  290. .ie_len = ie_len,
  291. };
  292. int err;
  293. ASSERT_WDEV_LOCK(wdev);
  294. if (!wdev->current_bss)
  295. return -ENOTCONN;
  296. if (ether_addr_equal(wdev->current_bss->pub.bssid, bssid))
  297. req.bss = &wdev->current_bss->pub;
  298. else
  299. return -ENOTCONN;
  300. err = rdev_disassoc(rdev, dev, &req);
  301. if (err)
  302. return err;
  303. /* driver should have reported the disassoc */
  304. WARN_ON(wdev->current_bss);
  305. return 0;
  306. }
  307. void cfg80211_mlme_down(struct cfg80211_registered_device *rdev,
  308. struct net_device *dev)
  309. {
  310. struct wireless_dev *wdev = dev->ieee80211_ptr;
  311. u8 bssid[ETH_ALEN];
  312. ASSERT_WDEV_LOCK(wdev);
  313. if (!rdev->ops->deauth)
  314. return;
  315. if (!wdev->current_bss)
  316. return;
  317. memcpy(bssid, wdev->current_bss->pub.bssid, ETH_ALEN);
  318. cfg80211_mlme_deauth(rdev, dev, bssid, NULL, 0,
  319. WLAN_REASON_DEAUTH_LEAVING, false);
  320. }
  321. struct cfg80211_mgmt_registration {
  322. struct list_head list;
  323. struct wireless_dev *wdev;
  324. u32 nlportid;
  325. int match_len;
  326. __le16 frame_type;
  327. u8 match[];
  328. };
  329. static void
  330. cfg80211_process_mlme_unregistrations(struct cfg80211_registered_device *rdev)
  331. {
  332. struct cfg80211_mgmt_registration *reg;
  333. ASSERT_RTNL();
  334. spin_lock_bh(&rdev->mlme_unreg_lock);
  335. while ((reg = list_first_entry_or_null(&rdev->mlme_unreg,
  336. struct cfg80211_mgmt_registration,
  337. list))) {
  338. list_del(&reg->list);
  339. spin_unlock_bh(&rdev->mlme_unreg_lock);
  340. if (rdev->ops->mgmt_frame_register) {
  341. u16 frame_type = le16_to_cpu(reg->frame_type);
  342. rdev_mgmt_frame_register(rdev, reg->wdev,
  343. frame_type, false);
  344. }
  345. kfree(reg);
  346. spin_lock_bh(&rdev->mlme_unreg_lock);
  347. }
  348. spin_unlock_bh(&rdev->mlme_unreg_lock);
  349. }
  350. void cfg80211_mlme_unreg_wk(struct work_struct *wk)
  351. {
  352. struct cfg80211_registered_device *rdev;
  353. rdev = container_of(wk, struct cfg80211_registered_device,
  354. mlme_unreg_wk);
  355. rtnl_lock();
  356. cfg80211_process_mlme_unregistrations(rdev);
  357. rtnl_unlock();
  358. }
  359. int cfg80211_mlme_register_mgmt(struct wireless_dev *wdev, u32 snd_portid,
  360. u16 frame_type, const u8 *match_data,
  361. int match_len)
  362. {
  363. struct wiphy *wiphy = wdev->wiphy;
  364. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  365. struct cfg80211_mgmt_registration *reg, *nreg;
  366. int err = 0;
  367. u16 mgmt_type;
  368. if (!wdev->wiphy->mgmt_stypes)
  369. return -EOPNOTSUPP;
  370. if ((frame_type & IEEE80211_FCTL_FTYPE) != IEEE80211_FTYPE_MGMT)
  371. return -EINVAL;
  372. if (frame_type & ~(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE))
  373. return -EINVAL;
  374. mgmt_type = (frame_type & IEEE80211_FCTL_STYPE) >> 4;
  375. if (!(wdev->wiphy->mgmt_stypes[wdev->iftype].rx & BIT(mgmt_type)))
  376. return -EINVAL;
  377. nreg = kzalloc(sizeof(*reg) + match_len, GFP_KERNEL);
  378. if (!nreg)
  379. return -ENOMEM;
  380. spin_lock_bh(&wdev->mgmt_registrations_lock);
  381. list_for_each_entry(reg, &wdev->mgmt_registrations, list) {
  382. int mlen = min(match_len, reg->match_len);
  383. if (frame_type != le16_to_cpu(reg->frame_type))
  384. continue;
  385. if (memcmp(reg->match, match_data, mlen) == 0) {
  386. err = -EALREADY;
  387. break;
  388. }
  389. }
  390. if (err) {
  391. kfree(nreg);
  392. goto out;
  393. }
  394. memcpy(nreg->match, match_data, match_len);
  395. nreg->match_len = match_len;
  396. nreg->nlportid = snd_portid;
  397. nreg->frame_type = cpu_to_le16(frame_type);
  398. nreg->wdev = wdev;
  399. list_add(&nreg->list, &wdev->mgmt_registrations);
  400. spin_unlock_bh(&wdev->mgmt_registrations_lock);
  401. /* process all unregistrations to avoid driver confusion */
  402. cfg80211_process_mlme_unregistrations(rdev);
  403. if (rdev->ops->mgmt_frame_register)
  404. rdev_mgmt_frame_register(rdev, wdev, frame_type, true);
  405. return 0;
  406. out:
  407. spin_unlock_bh(&wdev->mgmt_registrations_lock);
  408. return err;
  409. }
  410. void cfg80211_mlme_unregister_socket(struct wireless_dev *wdev, u32 nlportid)
  411. {
  412. struct wiphy *wiphy = wdev->wiphy;
  413. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  414. struct cfg80211_mgmt_registration *reg, *tmp;
  415. spin_lock_bh(&wdev->mgmt_registrations_lock);
  416. list_for_each_entry_safe(reg, tmp, &wdev->mgmt_registrations, list) {
  417. if (reg->nlportid != nlportid)
  418. continue;
  419. list_del(&reg->list);
  420. spin_lock(&rdev->mlme_unreg_lock);
  421. list_add_tail(&reg->list, &rdev->mlme_unreg);
  422. spin_unlock(&rdev->mlme_unreg_lock);
  423. schedule_work(&rdev->mlme_unreg_wk);
  424. }
  425. spin_unlock_bh(&wdev->mgmt_registrations_lock);
  426. if (nlportid && rdev->crit_proto_nlportid == nlportid) {
  427. rdev->crit_proto_nlportid = 0;
  428. rdev_crit_proto_stop(rdev, wdev);
  429. }
  430. if (nlportid == wdev->ap_unexpected_nlportid)
  431. wdev->ap_unexpected_nlportid = 0;
  432. }
  433. void cfg80211_mlme_purge_registrations(struct wireless_dev *wdev)
  434. {
  435. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
  436. spin_lock_bh(&wdev->mgmt_registrations_lock);
  437. spin_lock(&rdev->mlme_unreg_lock);
  438. list_splice_tail_init(&wdev->mgmt_registrations, &rdev->mlme_unreg);
  439. spin_unlock(&rdev->mlme_unreg_lock);
  440. spin_unlock_bh(&wdev->mgmt_registrations_lock);
  441. cfg80211_process_mlme_unregistrations(rdev);
  442. }
  443. int cfg80211_mlme_mgmt_tx(struct cfg80211_registered_device *rdev,
  444. struct wireless_dev *wdev,
  445. struct cfg80211_mgmt_tx_params *params, u64 *cookie)
  446. {
  447. const struct ieee80211_mgmt *mgmt;
  448. u16 stype;
  449. if (!wdev->wiphy->mgmt_stypes)
  450. return -EOPNOTSUPP;
  451. if (!rdev->ops->mgmt_tx)
  452. return -EOPNOTSUPP;
  453. if (params->len < 24 + 1)
  454. return -EINVAL;
  455. mgmt = (const struct ieee80211_mgmt *)params->buf;
  456. if (!ieee80211_is_mgmt(mgmt->frame_control))
  457. return -EINVAL;
  458. stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE;
  459. if (!(wdev->wiphy->mgmt_stypes[wdev->iftype].tx & BIT(stype >> 4)))
  460. return -EINVAL;
  461. if (ieee80211_is_action(mgmt->frame_control) &&
  462. mgmt->u.action.category != WLAN_CATEGORY_PUBLIC) {
  463. int err = 0;
  464. wdev_lock(wdev);
  465. switch (wdev->iftype) {
  466. case NL80211_IFTYPE_ADHOC:
  467. case NL80211_IFTYPE_STATION:
  468. case NL80211_IFTYPE_P2P_CLIENT:
  469. if (!wdev->current_bss) {
  470. err = -ENOTCONN;
  471. break;
  472. }
  473. if (!ether_addr_equal(wdev->current_bss->pub.bssid,
  474. mgmt->bssid)) {
  475. err = -ENOTCONN;
  476. break;
  477. }
  478. /*
  479. * check for IBSS DA must be done by driver as
  480. * cfg80211 doesn't track the stations
  481. */
  482. if (wdev->iftype == NL80211_IFTYPE_ADHOC)
  483. break;
  484. /* for station, check that DA is the AP */
  485. if (!ether_addr_equal(wdev->current_bss->pub.bssid,
  486. mgmt->da)) {
  487. err = -ENOTCONN;
  488. break;
  489. }
  490. break;
  491. case NL80211_IFTYPE_AP:
  492. case NL80211_IFTYPE_P2P_GO:
  493. case NL80211_IFTYPE_AP_VLAN:
  494. if (!ether_addr_equal(mgmt->bssid, wdev_address(wdev)))
  495. err = -EINVAL;
  496. break;
  497. case NL80211_IFTYPE_MESH_POINT:
  498. if (!ether_addr_equal(mgmt->sa, mgmt->bssid)) {
  499. err = -EINVAL;
  500. break;
  501. }
  502. /*
  503. * check for mesh DA must be done by driver as
  504. * cfg80211 doesn't track the stations
  505. */
  506. break;
  507. case NL80211_IFTYPE_P2P_DEVICE:
  508. /*
  509. * fall through, P2P device only supports
  510. * public action frames
  511. */
  512. default:
  513. err = -EOPNOTSUPP;
  514. break;
  515. }
  516. wdev_unlock(wdev);
  517. if (err)
  518. return err;
  519. }
  520. if (!ether_addr_equal(mgmt->sa, wdev_address(wdev)))
  521. return -EINVAL;
  522. /* Transmit the Action frame as requested by user space */
  523. return rdev_mgmt_tx(rdev, wdev, params, cookie);
  524. }
  525. bool cfg80211_rx_mgmt(struct wireless_dev *wdev, int freq, int sig_mbm,
  526. const u8 *buf, size_t len, u32 flags)
  527. {
  528. struct wiphy *wiphy = wdev->wiphy;
  529. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  530. struct cfg80211_mgmt_registration *reg;
  531. const struct ieee80211_txrx_stypes *stypes =
  532. &wiphy->mgmt_stypes[wdev->iftype];
  533. struct ieee80211_mgmt *mgmt = (void *)buf;
  534. const u8 *data;
  535. int data_len;
  536. bool result = false;
  537. __le16 ftype = mgmt->frame_control &
  538. cpu_to_le16(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE);
  539. u16 stype;
  540. trace_cfg80211_rx_mgmt(wdev, freq, sig_mbm);
  541. stype = (le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE) >> 4;
  542. if (!(stypes->rx & BIT(stype))) {
  543. trace_cfg80211_return_bool(false);
  544. return false;
  545. }
  546. data = buf + ieee80211_hdrlen(mgmt->frame_control);
  547. data_len = len - ieee80211_hdrlen(mgmt->frame_control);
  548. spin_lock_bh(&wdev->mgmt_registrations_lock);
  549. list_for_each_entry(reg, &wdev->mgmt_registrations, list) {
  550. if (reg->frame_type != ftype)
  551. continue;
  552. if (reg->match_len > data_len)
  553. continue;
  554. if (memcmp(reg->match, data, reg->match_len))
  555. continue;
  556. /* found match! */
  557. /* Indicate the received Action frame to user space */
  558. if (nl80211_send_mgmt(rdev, wdev, reg->nlportid,
  559. freq, sig_mbm,
  560. buf, len, flags, GFP_ATOMIC))
  561. continue;
  562. result = true;
  563. break;
  564. }
  565. spin_unlock_bh(&wdev->mgmt_registrations_lock);
  566. trace_cfg80211_return_bool(result);
  567. return result;
  568. }
  569. EXPORT_SYMBOL(cfg80211_rx_mgmt);
  570. void cfg80211_dfs_channels_update_work(struct work_struct *work)
  571. {
  572. struct delayed_work *delayed_work;
  573. struct cfg80211_registered_device *rdev;
  574. struct cfg80211_chan_def chandef;
  575. struct ieee80211_supported_band *sband;
  576. struct ieee80211_channel *c;
  577. struct wiphy *wiphy;
  578. bool check_again = false;
  579. unsigned long timeout, next_time = 0;
  580. int bandid, i;
  581. delayed_work = container_of(work, struct delayed_work, work);
  582. rdev = container_of(delayed_work, struct cfg80211_registered_device,
  583. dfs_update_channels_wk);
  584. wiphy = &rdev->wiphy;
  585. rtnl_lock();
  586. for (bandid = 0; bandid < IEEE80211_NUM_BANDS; bandid++) {
  587. sband = wiphy->bands[bandid];
  588. if (!sband)
  589. continue;
  590. for (i = 0; i < sband->n_channels; i++) {
  591. c = &sband->channels[i];
  592. if (c->dfs_state != NL80211_DFS_UNAVAILABLE)
  593. continue;
  594. timeout = c->dfs_state_entered + msecs_to_jiffies(
  595. IEEE80211_DFS_MIN_NOP_TIME_MS);
  596. if (time_after_eq(jiffies, timeout)) {
  597. c->dfs_state = NL80211_DFS_USABLE;
  598. c->dfs_state_entered = jiffies;
  599. cfg80211_chandef_create(&chandef, c,
  600. NL80211_CHAN_NO_HT);
  601. nl80211_radar_notify(rdev, &chandef,
  602. NL80211_RADAR_NOP_FINISHED,
  603. NULL, GFP_ATOMIC);
  604. continue;
  605. }
  606. if (!check_again)
  607. next_time = timeout - jiffies;
  608. else
  609. next_time = min(next_time, timeout - jiffies);
  610. check_again = true;
  611. }
  612. }
  613. rtnl_unlock();
  614. /* reschedule if there are other channels waiting to be cleared again */
  615. if (check_again)
  616. queue_delayed_work(cfg80211_wq, &rdev->dfs_update_channels_wk,
  617. next_time);
  618. }
  619. void cfg80211_radar_event(struct wiphy *wiphy,
  620. struct cfg80211_chan_def *chandef,
  621. gfp_t gfp)
  622. {
  623. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  624. unsigned long timeout;
  625. trace_cfg80211_radar_event(wiphy, chandef);
  626. /* only set the chandef supplied channel to unavailable, in
  627. * case the radar is detected on only one of multiple channels
  628. * spanned by the chandef.
  629. */
  630. cfg80211_set_dfs_state(wiphy, chandef, NL80211_DFS_UNAVAILABLE);
  631. timeout = msecs_to_jiffies(IEEE80211_DFS_MIN_NOP_TIME_MS);
  632. queue_delayed_work(cfg80211_wq, &rdev->dfs_update_channels_wk,
  633. timeout);
  634. nl80211_radar_notify(rdev, chandef, NL80211_RADAR_DETECTED, NULL, gfp);
  635. }
  636. EXPORT_SYMBOL(cfg80211_radar_event);
  637. void cfg80211_cac_event(struct net_device *netdev,
  638. const struct cfg80211_chan_def *chandef,
  639. enum nl80211_radar_event event, gfp_t gfp)
  640. {
  641. struct wireless_dev *wdev = netdev->ieee80211_ptr;
  642. struct wiphy *wiphy = wdev->wiphy;
  643. struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
  644. unsigned long timeout;
  645. trace_cfg80211_cac_event(netdev, event);
  646. if (WARN_ON(!wdev->cac_started))
  647. return;
  648. if (WARN_ON(!wdev->chandef.chan))
  649. return;
  650. switch (event) {
  651. case NL80211_RADAR_CAC_FINISHED:
  652. timeout = wdev->cac_start_time +
  653. msecs_to_jiffies(wdev->cac_time_ms);
  654. WARN_ON(!time_after_eq(jiffies, timeout));
  655. cfg80211_set_dfs_state(wiphy, chandef, NL80211_DFS_AVAILABLE);
  656. break;
  657. case NL80211_RADAR_CAC_ABORTED:
  658. break;
  659. default:
  660. WARN_ON(1);
  661. return;
  662. }
  663. wdev->cac_started = false;
  664. nl80211_radar_notify(rdev, chandef, event, netdev, gfp);
  665. }
  666. EXPORT_SYMBOL(cfg80211_cac_event);